Rev 2059 | Rev 2156 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 2059 | Rev 2092 | ||
---|---|---|---|
Line 122... | Line 122... | ||
122 | } |
122 | } |
123 | printf("\n\r\rUsing Parameter Set %d", getActiveParamSet()); |
123 | printf("\n\r\rUsing Parameter Set %d", getActiveParamSet()); |
124 | } |
124 | } |
Line 125... | Line 125... | ||
125 | 125 | ||
- | 126 | /***************************************************/ |
|
- | 127 | /* Read IMU Config from EEPROM */ |
|
- | 128 | /***************************************************/ |
|
- | 129 | uint8_t IMUConfig_readFromEEprom(void) { |
|
- | 130 | return readChecksummedBlock(IMUCONFIG_REVISION, (uint8_t*)&IMUConfig, EEPROM_ADR_IMU_CONFIG, sizeof(IMUConfig_t)); |
|
- | 131 | } |
|
- | 132 | ||
- | 133 | /***************************************************/ |
|
- | 134 | /* Write IMU Config to EEPROM */ |
|
- | 135 | /***************************************************/ |
|
- | 136 | void IMUConfig_writeToEEprom(void) { |
|
- | 137 | writeChecksummedBlock(IMUCONFIG_REVISION, (uint8_t*)&IMUConfig, EEPROM_ADR_IMU_CONFIG, sizeof(IMUConfig_t)); |
|
- | 138 | } |
|
- | 139 | ||
- | 140 | void IMUConfig_readOrDefault(void) { |
|
- | 141 | if(IMUConfig_readFromEEprom()) { |
|
- | 142 | printf("\n\rwriting default IMU config"); |
|
- | 143 | IMUConfig_default(); |
|
- | 144 | IMUConfig_writeToEEprom(); |
|
- | 145 | } |
|
- | 146 | } |
|
- | 147 | ||
126 | /***************************************************/ |
148 | /***************************************************/ |
127 | /* MixerTable */ |
149 | /* MixerTable */ |
128 | /***************************************************/ |
150 | /***************************************************/ |
129 | void mixerMatrix_writeToEEProm(void) { |
151 | void mixerMatrix_writeToEEProm(void) { |
130 | writeChecksummedBlock(EEMIXER_REVISION, (uint8_t*)&mixerMatrix, EEPROM_ADR_MIXER_TABLE, sizeof(mixerMatrix_t)); |
152 | writeChecksummedBlock(EEMIXER_REVISION, (uint8_t*)&mixerMatrix, EEPROM_ADR_MIXER_TABLE, sizeof(mixerMatrix_t)); |
Line 131... | Line 153... | ||
131 | } |
153 | } |
132 | 154 | ||
133 | void mixerMatrix_readOrDefault(void) { |
155 | void mixerMatrix_readOrDefault(void) { |
134 | // load mixer table |
156 | // load mixer table |
135 | if (readChecksummedBlock(EEMIXER_REVISION, (uint8_t*)&mixerMatrix, EEPROM_ADR_MIXER_TABLE, sizeof(mixerMatrix_t))) { |
157 | if (readChecksummedBlock(EEMIXER_REVISION, (uint8_t*)&mixerMatrix, EEPROM_ADR_MIXER_TABLE, sizeof(mixerMatrix_t))) { |
136 | printf("writing default mixerMatrix"); |
158 | printf("\n\rwriting default mixerMatrix"); |
137 | mixerMatrix_default(); // Quadro |
159 | mixerMatrix_default(); // Quadro |
138 | mixerMatrix_writeToEEProm(); |
160 | mixerMatrix_writeToEEProm(); |
139 | } |
161 | } |
Line 155... | Line 177... | ||
155 | writeChecksummedBlock(CHANNELMAP_REVISION, (uint8_t*)&channelMap, EEPROM_ADR_CHANNELMAP, sizeof(channelMap_t)); |
177 | writeChecksummedBlock(CHANNELMAP_REVISION, (uint8_t*)&channelMap, EEPROM_ADR_CHANNELMAP, sizeof(channelMap_t)); |
156 | } |
178 | } |
Line 157... | Line 179... | ||
157 | 179 | ||
158 | void channelMap_readOrDefault(void) { |
180 | void channelMap_readOrDefault(void) { |
159 | if (readChecksummedBlock(CHANNELMAP_REVISION, (uint8_t*)&channelMap, EEPROM_ADR_CHANNELMAP, sizeof(channelMap_t))) { |
181 | if (readChecksummedBlock(CHANNELMAP_REVISION, (uint8_t*)&channelMap, EEPROM_ADR_CHANNELMAP, sizeof(channelMap_t))) { |
160 | printf("writing default channel map"); |
182 | printf("\n\rwriting default channel map"); |
161 | channelMap_default(); |
183 | channelMap_default(); |
162 | channelMap_writeToEEProm(); |
184 | channelMap_writeToEEProm(); |
163 | wdt_enable(WDTO_500MS); |
185 | wdt_enable(WDTO_500MS); |
164 | } |
186 | } |