more EEPROM

cubesatsim/cubesatsim.ino

@@ -1983,14 +1983,19 @@ void start_payload() {
     mpu6050.begin();	  
 
 //	    if (eeprom_word_read(0) == 0xA07)
+  float flag;
+  EEPROM.get(0, flag);
 	  
-  if (EEPROM.read(0) == 0xA7)
+  if ((int)flag == 0xA7)
   {
     Serial.println("Reading gyro offsets from EEPROM\n");
 
-    float xOffset = ((float)eeprom_word_read(1)) / 100.0;
+    float xOffset;
-    float yOffset = ((float)eeprom_word_read(2)) / 100.0;
+    float yOffset;	  
-    float zOffset = ((float)eeprom_word_read(3)) / 100.0;
+    float zOffset;
+    EEPROM.get(4, xOffset);
+    EEPROM.get(8, yOffset);
+    EEPROM.get(12, zOffset);	  
 
     Serial.println(xOffset, DEC);
     Serial.println(yOffset, DEC);
@@ -2015,7 +2020,8 @@ void start_payload() {
     EEPROM.put(12, (float)mpu6050.getGyroZoffset());	  
 
     float f;
-    Serial.println((int)EEPROM.get(0), HEX);	  
+    EEPROM.get(0, f);  		  
+    Serial.println((int)f, HEX);	  
     for (int i = 4; i += 4; i < 12) {
 	EEPROM.get(i, f);  
         Serial.println(f);	    
@@ -2067,7 +2073,7 @@ void read_payload()
     }
     else if (result == 'C') {
       Serial.println("Clearing stored gyro offsets in EEPROM\n");
-      eeprom_word_write(0, 0x00);
+      EEPROM.put(0, (float)0.0);
       first_time = true;
       setup();
     }
@@ -2215,7 +2221,7 @@ void read_payload()
 //  delay(100);
 }
 	
-
+/*
 void eeprom_word_write(int addr, int val)
 {
   EEPROM.write(addr * 2, lowByte(val));
@@ -2226,6 +2232,7 @@ short eeprom_word_read(int addr)
 {
   return ((EEPROM.read(addr * 2 + 1) << 8) | EEPROM.read(addr * 2));
 }
+*/
 
 void blink_setup() 
 {