From c1763b981bfa9795648c6ba732964e58aa5ae85b Mon Sep 17 00:00:00 2001
From: alanbjohnston <alan.b.johnston@gmail.com>
Date: Mon, 5 Dec 2022 16:04:13 -0500
Subject: [PATCH] fix sim telem forced in FSK mode

---
 cubesatsim/cubesatsim.ino | 9 ++++-----
 1 file changed, 4 insertions(+), 5 deletions(-)

diff --git a/cubesatsim/cubesatsim.ino b/cubesatsim/cubesatsim.ino
index 9b1d3fb2..9623f417 100644
--- a/cubesatsim/cubesatsim.ino
+++ b/cubesatsim/cubesatsim.ino
@@ -148,7 +148,8 @@ void setup() {
 */    	  
   start_ina219();
 	
-  if (i2c_bus3 == false) 
+//  if (i2c_bus3 == false)	
+  if ((i2c_bus3 == false) || (mode == FSK))  // force simulated telemetry mode for FSK
     config_simulated_telem();		
     
 /*	
@@ -206,12 +207,10 @@ void loop() {
   int startSleep = millis();	
   loop_count++;
 	
-//  if (sim_mode == TRUE)
-  if ((sim_mode == TRUE) || (mode == FSK)) // don't read INA219s in FSK mode
+  if (sim_mode == TRUE)
     generate_simulated_telem();
   else
-  // query INA219 sensors and Payload sensors
-    read_ina219();	
+    read_ina219();	  // query INA219 sensors and Payload sensors
 	
   if (mode != FSK)	// don't read payload in FSK mode
     read_payload();