Subversion Repositories FlightCtrl

Rev

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 
  }