Programming for Robotics I