Update cubesatsim.ino

cubesatsim/cubesatsim.ino

@@ -514,10 +514,17 @@ void get_tlm_fox() {
 /**/
 //      while ((millis() - sampleTime) < (unsigned int)samplePeriod)
      int startSleep = millis();	   
+     if ((millis() - sampleTime) < ((unsigned int)sampleTime - 250))  // was 250 100 500 for FSK
+        sleep(2.0); // 0.5);  // 25);  // initial period
+     while ((millis() - sampleTime) < ((unsigned int)sampleTime - 250))  // was 250 100
+        sleep(0.1); // 25); // 0.5);  // 25);
+	    
+/*	    
      if ((millis() - sampleTime) < ((unsigned int)frameTime - 250))  // was 250 100 500 for FSK
         sleep(2.0); // 0.5);  // 25);  // initial period
      while ((millis() - sampleTime) < ((unsigned int)frameTime - 250))  // was 250 100
         sleep(0.1); // 25); // 0.5);  // 25);
+*/
 //        sleep((unsigned int)sleepTime);
 /**/
 //      Serial.print("Sleep period: ");