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); |