firsteditionofAMathematicalIntroductiontoRoboticManipulation