Clean up and working on marker rotation in a rigidbody's frame of reference