Jitter.Collision.CollisionSystemPersistentSAP.AddEntity C# (CSharp) Method

        public override void AddEntity(IBroadphaseEntity body)
        {
            if (body.BroadphaseTag < bodyList.Count && bodyList[body.BroadphaseTag] == body) return;

            body.BroadphaseTag = bodyList.Count;

            bodyList.Add(body);

            axis1.Add(new SweepPoint(body, true, 0)); axis1.Add(new SweepPoint(body, false, 0));
            axis2.Add(new SweepPoint(body, true, 1)); axis2.Add(new SweepPoint(body, false, 1));
            axis3.Add(new SweepPoint(body, true, 2)); axis3.Add(new SweepPoint(body, false, 2));

            ResizeMatrix(MatrixGrowFactor);

            addCounter++;
        }