AMathematicalIntroductiontoRoboticManipulationRichardM.Murray,ZexiangLiandS.ShankarSastry