Subversion Repositories FlightCtrl

#include "twimaster.h"

uint8_t RequiredMotors;

/***************************************************/

/*          Read BL-Config from EEPROM             */

/***************************************************/

uint8_t BLConfig_ReadFromEEProm(uint8_t index)

{

        uint8_t crc;

        uint16_t eeadr = EEPROM_ADR_BLCONFIG + (uint16_t)index * sizeof(BLConfig_t);

        // calculate checksum in eeprom

        crc = EEProm_Checksum(eeadr, sizeof(BLConfig_t) - 1);

        // check crc

        if( crc != eeprom_read_byte((uint8_t*)(eeadr + sizeof(BLConfig_t) - 1)) ) return 0;

        // check revision

        if(eeprom_read_byte((uint8_t*)(eeadr)) != EEBLCONFIG_REVISON) return 0;

        // read mixer BLConfig

        eeprom_read_block((void *)&(BLConfig[index]), (void*)(eeadr), sizeof(BLConfig_t));

        return 1;

}

/***************************************************/

/*         Write BL-Config to EEPROM               */

/***************************************************/

uint8_t BLConfig_WriteToEEProm(uint8_t index)

{

        uint16_t eeadr = EEPROM_ADR_BLCONFIG + (uint16_t)index * sizeof(BLConfig_t);

        if(index >= MAX_MOTORS) return 0;

        if(BLConfig[index].Revision == EEBLCONFIG_REVISON)

        {

                // update crc

                BLConfig[index].crc = RAM_Checksum((uint8_t*)(&(BLConfig[index])), sizeof(BLConfig_t) - 1);

                // write to eeprom

                eeprom_write_block((void *) &(BLConfig[index]), (void*)(eeadr), sizeof(BLConfig_t));

                return 1;

        }

        else return 0;

}

/***************************************************/

/*    Default BLConfig                             */

/***************************************************/

void BLConfig_SetDefault(uint8_t index)

{

        if(index < MAX_MOTORS)

        {

                BLConfig[index].Revision = EEBLCONFIG_REVISON; // set revision

                BLConfig[index].SetMask =       MASK_SET_PWM_SCALING|MASK_SET_CURRENT_LIMIT|MASK_SET_TEMP_LIMIT|MASK_SET_CURRENT_SCALING|MASK_SET_BITCONFIG;

                BLConfig[index].PwmScaling = 255;               // MaxPWM

                BLConfig[index].CurrentLimit = 30;              // Current Limit in A

                BLConfig[index].TempLimit = 99;                 // Temperature Limit in °C

                BLConfig[index].CurrentScaling = 64;    // Current Scaling

                BLConfig[index].BitConfig = 0;                  // BitConfig

                BLConfig[index].crc = RAM_Checksum((uint8_t*)&(BLConfig[index]), sizeof(BLConfig_t) - 1); // update checksum

        }

}

        // load all BLConfig's

        for(i=0; i<MAX_MOTORS; i++)

        {

                if(ee_default || !BLConfig_ReadFromEEProm(i)) // could not read BLConfig from eeprom

                {

                        printf("\n\rGenerating default BL-Config for motor %d", i+1);

                        BLConfig_SetDefault(i);

                        BLConfig_WriteToEEProm(i);

                }

        }