Admit a relative joint rotation to Rapier's independent twist coordinates.
With positive quaternion w, each free coordinate is 2 atan(q.axis / w);
locked coordinates require a zero numerator. This projects that coordinate
box, rather than claiming a nearest rotation in geodesic distance. At a
half turn the finite Rodrigues representation stops within 1e-12 radians.
Admit a relative joint rotation to Rapier's independent twist coordinates. With positive quaternion w, each free coordinate is 2 atan(q.axis / w); locked coordinates require a zero numerator. This projects that coordinate box, rather than claiming a nearest rotation in geodesic distance. At a half turn the finite Rodrigues representation stops within 1e-12 radians.