Robot dynamics and control - Spong, Mark W. (John wiley and sons, 2009)