Robot manipulators : mathematics, programming, and control : the computer control of robot manipulators