Echelon form solution of direct kinematics for the general fully-parallel spherical wrist