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