Code from Summer 2012 Robotics REU at Harvey Mudd College