diff --git a/src/pulses_avr.cpp b/src/pulses_avr.cpp
index 323116d7c..883b358cf 100644
--- a/src/pulses_avr.cpp
+++ b/src/pulses_avr.cpp
@@ -890,6 +890,10 @@ void setupPulses()
 
 #ifdef DSM2
     case PROTO_DSM2:
+#if defined(PCBGRUVIN9X)
+      OCR5A = (uint16_t)0x7d * (40-g_timeMainLast-2/*1ms*/);
+      TCNT5 = 0;
+#endif
       sei();
       setupPulsesDsm2();
 #if defined(PCBGRUVIN9X)