Robotics Assignment for CAP 6671