diff --git a/cubesatsim/cubesatsim.ino b/cubesatsim/cubesatsim.ino
index fdd842b9..3a200111 100644
--- a/cubesatsim/cubesatsim.ino
+++ b/cubesatsim/cubesatsim.ino
@@ -138,7 +138,7 @@ void loop() {
   // encode as digits (APRS or CW mode) or binary (DUV FSK)	
   if ((mode == BPSK) || (mode == FSK))  {
     get_tlm_fox();
-    while ((millis() - sampleTime) < ((unsigned int)samplePeriod - 250))  // was 250 100
+    while ((millis() - sampleTime) < ((unsigned int)samplePeriod)) // - 250))  // was 250 100
       sleep(0.1); // 25); // 0.5);  // 25);
     sampleTime = (unsigned int) millis();	  
   }