Specialize the discrete measurement code for RigidBodyMotion problems

For those, it is necessary to have separate measurement for the displacement and orientation components.