Added autonomous script
Decided to put it into the robot code, rather then keeping it separate.