Initial commit of closed loop code.

A start on competition code with proportional closed loop control.
Merge branch 'master' of https://github.com/BitBucketsVEX/Vex2014