Title: Theory of Robotics and Automation