Robotics class final project