diff --git a/src/common/base_classes/FOCMotor.cpp b/src/common/base_classes/FOCMotor.cpp
index 6ea26624..e0a00887 100644
--- a/src/common/base_classes/FOCMotor.cpp
+++ b/src/common/base_classes/FOCMotor.cpp
@@ -91,7 +91,7 @@ void FOCMotor::useMonitoring(Print &print){
 // utility function intended to be used with serial plotter to monitor motor variables
 // significantly slowing the execution down!!!!
 void FOCMotor::monitor() {
-  if( monitor_cnt++ < monitor_downsample ) return;
+  if( !monitor_downsample || monitor_cnt++ < (monitor_downsample-1) ) return;
   monitor_cnt = 0;
   if(!monitor_port) return;
   bool printed = 0;