Robot Control: Dynamics, Motion Planning, and Analysis