Fixed up VectorController/MyMath.
Added javadoc to drive