Modify PID for speed control
Modify PID for direction control
Support negative motor power (moving backward), and remove the explicit
method to set the motor direction
Fix StartMotor
Add negative speed PID