diff --git a/src/create.cpp b/src/create.cpp index 10846e5..a0f9da6 100644 --- a/src/create.cpp +++ b/src/create.cpp @@ -463,6 +463,15 @@ namespace create { sideMotorPower = roundf(side * 127); vacuumMotorPower = roundf(vacuum * 127); + if (model.getVersion() == V_1) { + uint8_t cmd[2] = { OC_MOTORS, + static_cast((side != 0.0 ? 1 : 0) | + (vacuum != 0.0 ? 2 : 0) | + (main != 0.0 ? 4 : 0)) + }; + return serial->send(cmd, 2); + } + uint8_t cmd[4] = { OC_MOTORS_PWM, mainMotorPower, sideMotorPower,