More cleanup of changes I had made to RigidBodyIMU