Theory of Applied Robotics: Kinematics, Dynamics, and Control