Working on a RigidBody class