Arduino prelim

The preliminary sketch for running on the Arduino. Can't guarantee that it will do what it is supposed to with regards to the motors because I don't have the hardware to test that at the moment. Also, I may have misunderstood how our servo works.

Thoughts?