diff --git a/cubesatsim/cubesatsim.ino b/cubesatsim/cubesatsim.ino
index bff2796a..dd529423 100644
--- a/cubesatsim/cubesatsim.ino
+++ b/cubesatsim/cubesatsim.ino
@@ -135,15 +135,17 @@ void loop() {
 //  read_payload();	
   
   // encode as digits (APRS or CW mode) or binary (DUV FSK)	
-  if ((mode == BPSK) || (mode == FSK))  {
+  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();
 
+    while ((millis() - sampleTime) < ((unsigned int)samplePeriod)) // - 250))  // was 250 100
+      sleep(0.1); // 25); // 0.5);  // 25);
+    sampleTime = (unsigned int) millis();	  
+	
 //  delay(2000);
 //  test_radio();