An inverse kinematic algorthim for manipulators with redundant degrees of freedom - Slotine, J J E; Yoerger, D R (International Journal of Robotics and Automation, 1987)