more EEPROM

pico-v0.1
alanbjohnston 4 years ago committed by GitHub
parent 6dfed1f280
commit 72098bff69
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23

@ -1983,14 +1983,19 @@ void start_payload() {
mpu6050.begin();
// if (eeprom_word_read(0) == 0xA07)
if (EEPROM.read(0) == 0xA7)
float flag;
EEPROM.get(0, flag);
if ((int)flag == 0xA7)
{
Serial.println("Reading gyro offsets from EEPROM\n");
float xOffset = ((float)eeprom_word_read(1)) / 100.0;
float yOffset = ((float)eeprom_word_read(2)) / 100.0;
float zOffset = ((float)eeprom_word_read(3)) / 100.0;
float xOffset;
float yOffset;
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()
{

Loading…
Cancel
Save

Powered by TurnKey Linux.