Robotics minor assignment 1