public void Add(Body body) { Debug.Assert(BodyCount < BodyCapacity); body.IslandIndex = BodyCount; Bodies[BodyCount] = body; ++BodyCount; }