Added PhysicsSystemTest. Improvements in PhysicsSystem