From 7a268c9dca64b419d7b409585a9ce5e4c6a6359a Mon Sep 17 00:00:00 2001
From: alanbjohnston <alan.b.johnston@gmail.com>
Date: Mon, 22 Aug 2022 07:37:54 -0400
Subject: [PATCH] added payload reset

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

diff --git a/cubesatsim/cubesatsim.ino b/cubesatsim/cubesatsim.ino
index 1e8b288d..a372b3ad 100644
--- a/cubesatsim/cubesatsim.ino
+++ b/cubesatsim/cubesatsim.ino
@@ -2274,7 +2274,7 @@ void start_payload() {
   float zOffset;		  
   EEPROM.get(0, flag);
 	  
-  if (flag == 0xA07)
+  if ((flag == 0xA07) && (payload_command != PAYLOAD_RESET))
   {
     Serial.println("Reading gyro offsets from EEPROM\n");
 
@@ -2291,6 +2291,8 @@ void start_payload() {
   }
   else
   {
+    payload_command = false;
+	  
     Serial.println("Calculating gyro offsets and storing in EEPROM\n");
 
     mpu6050.calcGyroOffsets(true);
@@ -3978,7 +3980,8 @@ void prompt_for_input() {
 	            
       } else if ((serial_string[0] == 'p') || (serial_string[0] == 'P')) {	      
         Serial.println("Resetting the Payload");
-	payload_command = PAYLOAD_RESET;      
+	payload_command = PAYLOAD_RESET;
+	start_payload();      
       } else      
         Serial.println("No action");