Updated DrivetrainNormalDrive to include PID