Code as of the end of the hackathon, part 1

Currently runs 2 servos. There are problems running 3 servos.