Redundancy Parametrization in Globally-Optimal Inverse Kinematics