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