Made PIDMotor class use a SpeedController instead of Victors and Jaguars.
Fixed PIDMotor algorithm.
Fixed code styling.