private void HandleMonitor6(BinaryReader br, double ts) { RMPMonitor6Msg msg = new RMPMonitor6Msg(br); if (isBackwards) { status.motorTorqueLeft = msg.rightMotorTorque / 1463.0; status.motorTorqueRight = msg.leftMotorTorque / 1463.0; } else { status.motorTorqueLeft = msg.leftMotorTorque / 1463.0; status.motorTorqueRight = msg.rightMotorTorque / 1463.0; } status.wheelTorqueTs = ts; wheelTorqueTs = ts; }