updated Iterator to pointers and moved within PhysicsEngine Class