Robot Autonomy HW4 - Steven Ford, Akshay Phatak, Pan Tan