diff --git a/src/parser.c b/src/parser.c index 54020b9..cac656c 100644 --- a/src/parser.c +++ b/src/parser.c @@ -1368,6 +1368,12 @@ static int cmd_mls(const uint8_t *data, uint8_t data_len) } led_set_state((led_state_t)state); + if (state == LED_STATE_OFF) + { + int imu_ret = imu_fifo_stop(); + DBG_PRINTF("[CMD] mls: fifo stop ret=%d\r\n", imu_ret); + } + send_response_u16("rls:", state); DBG_PRINTF("[CMD] mls -> LED state=%d\r\n", state); return 1;