| 88,17 → 88,21 |
|---|
| /***************************************************/ |
| /* Read Parameter from EEPROM as word */ |
| /***************************************************/ |
| /* |
| uint16_t getParamWord(uint16_t param_id) { |
| return eeprom_read_word((uint16_t *) &EEPromArray[EEPROM_ADR_PARAM_BEGIN |
| + param_id]); |
| } |
| */ |
| |
| /***************************************************/ |
| /* Write Parameter to EEPROM as word */ |
| /***************************************************/ |
| /* |
| void setParamWord(uint16_t param_id, uint16_t value) { |
| eeprom_write_word((uint16_t *) &EEPromArray[EEPROM_ADR_PARAM_BEGIN + param_id], value); |
| } |
| */ |
| |
| uint8_t calculateChecksum(uint8_t* data, uint16_t length) { |
| uint8_t result = 0; |
| 223,14 → 227,20 |
|---|
| /***************************************************/ |
| /* Sensor offsets */ |
| /***************************************************/ |
| uint8_t gyroAmplifierOffset_readFromEEProm(void) { |
| return readChecksummedBlock(SENSOROFFSET_REVISION, (uint8_t*)&gyroAmplifierOffset, EEPROM_ADR_GYROAMPLIFIER, sizeof(sensorOffset_t)); |
| } |
| |
| void gyroAmplifierOffset_writeToEEProm(void) { |
| return writeChecksummedBlock(SENSOROFFSET_REVISION, (uint8_t*)&gyroAmplifierOffset, EEPROM_ADR_GYROAMPLIFIER, sizeof(sensorOffset_t)); |
| } |
| |
| uint8_t gyroOffset_readFromEEProm(void) { |
| return readChecksummedBlock(SENSOROFFSET_REVISION, (uint8_t*)&gyroOffset, EEPROM_ADR_GYROOFFSET, sizeof(sensorOffset_t)) | |
| readChecksummedBlock(SENSOROFFSET_REVISION, (uint8_t*)&DACValues, EEPROM_ADR_DACVALUES, sizeof(sensorOffset_t)); |
| return readChecksummedBlock(SENSOROFFSET_REVISION, (uint8_t*)&gyroOffset, EEPROM_ADR_GYROOFFSET, sizeof(sensorOffset_t)); |
| } |
| |
| void gyroOffset_writeToEEProm(void) { |
| writeChecksummedBlock(SENSOROFFSET_REVISION, (uint8_t*)&gyroOffset, EEPROM_ADR_GYROOFFSET, sizeof(sensorOffset_t)); |
| writeChecksummedBlock(SENSOROFFSET_REVISION, (uint8_t*)&DACValues, EEPROM_ADR_DACVALUES, sizeof(sensorOffset_t)); |
| } |
| |
| uint8_t accOffset_readFromEEProm(void) { |