Nearly finalized code

The code for the initial test of our robot is mostly complete. The only
thing remaining is simply calibration of the horizontal servo. Also,
there are plenty of Solidworks files included because I am stupid and
forget to commit stuff before switching branches.