Fixed bug with MSP motor reversing
Adjusted default MSP motor commands