diff --git a/src/gruvin9x/somo14d.cpp b/src/gruvin9x/somo14d.cpp index b62b6206d..17709a2fa 100644 --- a/src/gruvin9x/somo14d.cpp +++ b/src/gruvin9x/somo14d.cpp @@ -78,8 +78,9 @@ NOINLINE uint8_t SomoWakeup() // This will happen before the SOMO14D busy flag gets set // Busy flag happens 20ms after the last data is clocked in if (i==0 && !busy) { - if(somo14command) { // Allow a command to be send even if the SOMO is busy, i.e. STOP or PAUSE + if (somo14command) { // Allow a command to be send even if the SOMO is busy, i.e. STOP or PAUSE somo14_current = somo14command; + somo14command = 0; busy = 1; } else if (!SOMOBUSY) { @@ -90,7 +91,6 @@ NOINLINE uint8_t SomoWakeup() somo14RIdx = (somo14RIdx + 1) % QUEUE_LENGTH; busy = 1; } - } // Start and stop bits