Update cubesatsim.ino

cubesatsim/cubesatsim.ino

@@ -136,10 +136,14 @@ void loop() {
 //  read_payload();	
   
   // encode as digits (APRS or CW mode) or binary (DUV FSK)	
-  if ((mode == BPSK) || (mode == FSK))
-	  get_tlm_fox();
+  if ((mode == BPSK) || (mode == FSK))  {
+    get_tlm_fox();
+    while ((millis() - sampleTime) < ((unsigned int)samplePeriod - 250))  // was 250 100
+      sleep(0.1); // 25); // 0.5);  // 25);
+    sampleTime = (unsigned int) millis();	  
+  }
   else if (mode == AFSK)
-	  send_packet();
+    send_packet();
 
 //  delay(2000);
 //  test_radio();
@@ -537,7 +541,7 @@ void get_tlm_fox() {
       sampleTime = (unsigned int) millis();
     } else {
       Serial.println("first time - short sleep");
-      sleep(3.0);	    
+ //     sleep(3.0);	    
 //      firstTime = OFF;
     }