Code as of Mock 3.

For some reason the code doesn't stop the motors after 3 minutes
(perhaps this will be irrelevant when we upgrade to current staff
arduino code, which I think stops all motors when communication ends.
But that won't apply to the servo..... so perhaps this needs to be fixed
after all).