diff --git a/rcserial.h b/rcserial.h index fd9fad3..05209b9 100644 --- a/rcserial.h +++ b/rcserial.h @@ -88,6 +88,9 @@ void _rc_serial_add(const char* data, size_t len) { } void _handle_serial_send() { + static unsigned long lastRC = 0; + if (millis() - lastRC < 20) return; + lastRC = millis(); mutex_enter_blocking(&serial_mut); if (rcSerial.command == 0) { while (rcSerial.command < 30 && !queue_is_empty(&serial_write_queue)) {