|
|
|
|
@ -208,7 +208,7 @@ void setup() {
|
|
|
|
|
Serial.println(R2, DEC);
|
|
|
|
|
Serial.println(" ");
|
|
|
|
|
|
|
|
|
|
#if defined(ARDUINO_ARCH_MBED_RP2040) && defined(ARDUINO_ARCH_RP2040) // if Arduino Mbed OS RP2040 Boards is used in Arduino IDE
|
|
|
|
|
#if !defined(ARDUINO_ARCH_MBED_RP2040) && defined(ARDUINO_ARCH_RP2040) // if Raspberry Pi RP2040 Boards is used in Arduino IDE
|
|
|
|
|
if (EEPROM.commit()) {
|
|
|
|
|
Serial.println("EEPROM successfully committed\n");
|
|
|
|
|
} else {
|
|
|
|
|
@ -371,7 +371,7 @@ void loop() {
|
|
|
|
|
else if (result == 'C' || result == 'c') {
|
|
|
|
|
Serial.println("Clearing stored gyro offsets in EEPROM\n");
|
|
|
|
|
eeprom_word_write(0, 0x00);
|
|
|
|
|
#if defined(ARDUINO_ARCH_MBED_RP2040) && defined(ARDUINO_ARCH_RP2040) // if Arduino Mbed OS RP2040 Boards is used in Arduino IDE
|
|
|
|
|
#if !defined(ARDUINO_ARCH_MBED_RP2040) && defined(ARDUINO_ARCH_RP2040) // if Raspberry Pi RP2040 Boards is used in Arduino IDE
|
|
|
|
|
|
|
|
|
|
if (EEPROM.commit()) {
|
|
|
|
|
Serial.println("EEPROM successfully committed\n");
|
|
|
|
|
@ -397,7 +397,7 @@ void loop() {
|
|
|
|
|
calibration = (calibration + 1) % 2;
|
|
|
|
|
// Serial.println(calibration + 1);
|
|
|
|
|
|
|
|
|
|
#if defined(ARDUINO_ARCH_MBED_RP2040) && defined(ARDUINO_ARCH_RP2040) // if Arduino Mbed OS RP2040 Boards is used in Arduino IDE
|
|
|
|
|
#if !defined(ARDUINO_ARCH_MBED_RP2040) && defined(ARDUINO_ARCH_RP2040) // if Raspberry Pi RP2040 Boards is used in Arduino IDE
|
|
|
|
|
|
|
|
|
|
if (EEPROM.commit()) {
|
|
|
|
|
Serial.println("EEPROM successfully committed");
|
|
|
|
|
@ -423,7 +423,7 @@ void loop() {
|
|
|
|
|
|
|
|
|
|
void eeprom_word_write(int addr, int val)
|
|
|
|
|
{
|
|
|
|
|
#if defined(ARDUINO_ARCH_MBED_RP2040) && defined(ARDUINO_ARCH_RP2040) // if Arduino Mbed OS RP2040 Boards is used in Arduino IDE
|
|
|
|
|
#if !defined(ARDUINO_ARCH_MBED_RP2040) && defined(ARDUINO_ARCH_RP2040) // if Raspberry Pi RP2040 Boards is used in Arduino IDE
|
|
|
|
|
EEPROM.write(addr * 2, lowByte(val));
|
|
|
|
|
EEPROM.write(addr * 2 + 1, highByte(val));
|
|
|
|
|
#endif
|
|
|
|
|
@ -432,7 +432,7 @@ void eeprom_word_write(int addr, int val)
|
|
|
|
|
short eeprom_word_read(int addr)
|
|
|
|
|
{
|
|
|
|
|
int result = 0;
|
|
|
|
|
#if defined(ARDUINO_ARCH_MBED_RP2040) && defined(ARDUINO_ARCH_RP2040) // if Arduino Mbed OS RP2040 Boards is used in Arduino IDE
|
|
|
|
|
#if !defined(ARDUINO_ARCH_MBED_RP2040) && defined(ARDUINO_ARCH_RP2040) // if Raspberry Pi RP2040 Boards is used in Arduino IDE
|
|
|
|
|
result = ((EEPROM.read(addr * 2 + 1) << 8) | EEPROM.read(addr * 2));
|
|
|
|
|
#endif
|
|
|
|
|
return result;
|
|
|
|
|
|