Implement dynamics part of RigidBodyDriver