diff --git a/cubesatsim/cubesatsim.ino b/cubesatsim/cubesatsim.ino
index c7f8c8be..ca668058 100644
--- a/cubesatsim/cubesatsim.ino
+++ b/cubesatsim/cubesatsim.ino
@@ -3658,11 +3658,12 @@ bool TimerHandler0(struct repeating_timer *t) {
       digitalWrite(BPSK_CONTROL_A, HIGH);  
 //      Serial.print("-");	    
       if (mode == FSK) {
-        if (!i2c_busy_now2) {
+//        if (!i2c_busy_now2) {
+         while (i2c_busy_now2) { }
 	      i2c_busy_now = true;
 	      clockgen.enableOutputOnly(1);	  
    	      i2c_busy_now = false;	
-        } else
+//        } else
 ;//		Serial.print("-");
       }
     } else {
@@ -3672,11 +3673,12 @@ bool TimerHandler0(struct repeating_timer *t) {
       digitalWrite(BPSK_CONTROL_B, HIGH);	
 //      Serial.print("_");	 
        if (mode == FSK) {
-         if (!i2c_busy_now2) {
+//         if (!i2c_busy_now2) {
+         while (i2c_busy_now2) { }
 	      i2c_busy_now = true;
 	      clockgen.enableOutputOnly(0);	
 	      i2c_busy_now = false;	      
-         } else
+//         } else
 ;//		Serial.print("-");
        }
     }