Reversed right side encoders ; fixed sign of right side wheel setpoint graphs ; tuned wheel PID loops