Code for first project in EECS 600 Algorithmics Robotics