Robotics Assignment 2