Foundations of Robotics - Theory