A mathematical introduction to robotic manipulation solution manual pdf