uses the elements of the rpy array in the right order
completed test for the getClosestJointPose(...) method