Robot manipulators mathematics, programming, and control ; the computer control of robot manipulators - Paul, Richard P. (The MIT Press, 1984)