Fixing order and orientation of encoders

The message sent over USB had the opposite order expected by ROS.

Also, motors do not spin in the same direction when moving forward so
the adding and substracting of pulses in the right encoder had to be
reversed.