Robot control dynamics, motion planning, and analysis - Spong, Mark W.; Lewis, F.L; Abdallah, C.T (IEEE Press, 1993)