MP Position Servo Sensor Reversed

[Ryan Tse]

The MP position servo always has very high steady state error.

@eli suggested this might be caused by a reversed sensor causing position loop error to get bigger instead of smaller.

This would also explain why the motors spin backwards after the velocity command is zero.