Robot analysis and control - Asada, H. (Haruhiko) (John Wiley, 1986)