diff --git a/src/main/drivers/pwm_output.c b/src/main/drivers/pwm_output.c
index 441f64835e..581b679ed6 100644
--- a/src/main/drivers/pwm_output.c
+++ b/src/main/drivers/pwm_output.c
@@ -674,9 +674,11 @@ FAST_CODE uint16_t prepareDshotPacket(motorDmaOutput_t *const motor)
         csum_data >>= 4;
     }
     // append checksum
+#ifdef USE_DSHOT_TELEMETRY
     if (useDshotTelemetry) {
         csum = ~csum;
     }
+#endif
     csum &= 0xf;
     packet = (packet << 4) | csum;