Added base driving command. Also fixed math error in getAngle() of Vector2D.