MATH: Fix gimbal lock for ZXY.
MATH: Keep position when building rotation.
Merge pull request #944 from JoseJX/FixHeads

GRIM: Fix the head tracking broken by the changes to Rotation3D