Autonomous!

Wrote most of the autonomous code, minus the arm code.  Also, we updated
the teleop for the new chassis.