Added all necessary functions.

Added goStraightInCM and goStraight.

NB: Changed parameters on goStraight
DriveStraight compiles.
Merge pull request #7 from RLBotball/driveStraight

Drive straight