diff --git a/cubesatsim/cubesatsim.ino b/cubesatsim/cubesatsim.ino index e8c410df..a6e036d6 100644 --- a/cubesatsim/cubesatsim.ino +++ b/cubesatsim/cubesatsim.ino @@ -2876,6 +2876,7 @@ void read_payload() Serial1.println("OK"); delay(100); first_read = true; + start_payload(); // setup(); } @@ -2982,13 +2983,14 @@ void payload_OK_only() Serial.println("OK"); delay(100); first_time = true; - setup(); +// setup(); } else if (result == 'C') { Serial.println("Clearing stored gyro offsets in EEPROM\n"); EEPROM.put(0, (float)0.0); first_time = true; - setup(); + start_payload(); +// setup(); } if ((result == '?') || first_time == true) // commented back in if (true) @@ -3065,6 +3067,7 @@ void payload_OK_only() Serial1.println("OK"); delay(100); first_read = true; + start_payload(); // setup(); }