trc492 Fixed a few bugs in rare code paths of TrcPidDrive and TrcPidMotor.

Users who have contributed to this file

• trc492