| 124,6 → 124,28 |
|---|
| } |
| |
| /***************************************************/ |
| /* Read IMU Config from EEPROM */ |
| /***************************************************/ |
| uint8_t IMUConfig_readFromEEprom(void) { |
| return readChecksummedBlock(IMUCONFIG_REVISION, (uint8_t*)&IMUConfig, EEPROM_ADR_IMU_CONFIG, sizeof(IMUConfig_t)); |
| } |
| |
| /***************************************************/ |
| /* Write IMU Config to EEPROM */ |
| /***************************************************/ |
| void IMUConfig_writeToEEprom(void) { |
| writeChecksummedBlock(IMUCONFIG_REVISION, (uint8_t*)&IMUConfig, EEPROM_ADR_IMU_CONFIG, sizeof(IMUConfig_t)); |
| } |
| |
| void IMUConfig_readOrDefault(void) { |
| if(IMUConfig_readFromEEprom()) { |
| printf("\n\rwriting default IMU config"); |
| IMUConfig_default(); |
| IMUConfig_writeToEEprom(); |
| } |
| } |
| |
| /***************************************************/ |
| /* MixerTable */ |
| /***************************************************/ |
| void mixerMatrix_writeToEEProm(void) { |
| 133,7 → 155,7 |
|---|
| void mixerMatrix_readOrDefault(void) { |
| // load mixer table |
| if (readChecksummedBlock(EEMIXER_REVISION, (uint8_t*)&mixerMatrix, EEPROM_ADR_MIXER_TABLE, sizeof(mixerMatrix_t))) { |
| printf("writing default mixerMatrix"); |
| printf("\n\rwriting default mixerMatrix"); |
| mixerMatrix_default(); // Quadro |
| mixerMatrix_writeToEEProm(); |
| } |
| 157,7 → 179,7 |
|---|
| |
| void channelMap_readOrDefault(void) { |
| if (readChecksummedBlock(CHANNELMAP_REVISION, (uint8_t*)&channelMap, EEPROM_ADR_CHANNELMAP, sizeof(channelMap_t))) { |
| printf("writing default channel map"); |
| printf("\n\rwriting default channel map"); |
| channelMap_default(); |
| channelMap_writeToEEProm(); |
| wdt_enable(WDTO_500MS); |