Subversion Repositories FlightCtrl

    rc_sum_init();

    rc_sum_init();

        ADC_Init();

        ADC_Init();

        i2c_init();

        i2c_init();

        SPI_MasterInit();

        SPI_MasterInit();

        GRN_ON;

        GRN_ON;

    sei();

    sei();

    if((eeprom_read_byte(&EEPromArray[EEPROM_ADR_MIXER_TABLE]) == MIXER_REVISION) && // Check Revision in the first Byte

    if((eeprom_read_byte(&EEPromArray[EEPROM_ADR_MIXER_TABLE]) == MIXER_REVISION) && // Check Revision in the first Byte

       (eeprom_read_byte(&EEPromArray[EEPROM_ADR_VALID]) != 0xff))                   // Settings reset via Koptertool

       (eeprom_read_byte(&EEPromArray[EEPROM_ADR_VALID]) != 0xff))                   // Settings reset via Koptertool

        {

        {

         Mixer.Revision = MIXER_REVISION;

         Mixer.Revision = MIXER_REVISION;

     memcpy(Mixer.Name, "Quadro\0", 11);

     memcpy(Mixer.Name, "Quadro\0", 11);

     eeprom_write_block(&Mixer, &EEPromArray[EEPROM_ADR_MIXER_TABLE], sizeof(Mixer));

     eeprom_write_block(&Mixer, &EEPromArray[EEPROM_ADR_MIXER_TABLE], sizeof(Mixer));

    }

    }

    printf("\n\rMixer-Config: '%s' (%u Motors)",Mixer.Name,RequiredMotors);

    printf("\n\rMixer-Config: '%s' (%u Motors)",Mixer.Name,RequiredMotors);

// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++

// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++

// + Check connected BL-Ctrls

// + Check connected BL-Ctrls

// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++

// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++

        printf("\n\rFound BL-Ctrl: ");

        printf("\n\rFound BL-Ctrl: ");

       WriteParameterSet(i, (unsigned char *) &EE_Parameter.Kanalbelegung[0], STRUCT_PARAM_LAENGE);

       WriteParameterSet(i, (unsigned char *) &EE_Parameter.Kanalbelegung[0], STRUCT_PARAM_LAENGE);

      }

      }

          SetActiveParamSetNumber(3); // default-Setting

          SetActiveParamSetNumber(3); // default-Setting

          eeprom_write_byte(&EEPromArray[EEPROM_ADR_VALID], EE_DATENREVISION);

          eeprom_write_byte(&EEPromArray[EEPROM_ADR_VALID], EE_DATENREVISION);

        }

        }

    FlugMinuten = (int)eeprom_read_byte(&EEPromArray[EEPROM_ADR_MINUTES2]) * 256 + (int)eeprom_read_byte(&EEPromArray[EEPROM_ADR_MINUTES2+1]);

    FlugMinuten = (int)eeprom_read_byte(&EEPromArray[EEPROM_ADR_MINUTES2]) * 256 + (int)eeprom_read_byte(&EEPromArray[EEPROM_ADR_MINUTES2+1]);

    FlugMinutenGesamt = (int)eeprom_read_byte(&EEPromArray[EEPROM_ADR_MINUTES]) * 256 + (int)eeprom_read_byte(&EEPromArray[EEPROM_ADR_MINUTES+1]);

    FlugMinutenGesamt = (int)eeprom_read_byte(&EEPromArray[EEPROM_ADR_MINUTES]) * 256 + (int)eeprom_read_byte(&EEPromArray[EEPROM_ADR_MINUTES+1]);

    if(FlugMinutenGesamt == 0xffff || FlugMinuten == 0xffff)

    if(FlugMinutenGesamt == 0xffff || FlugMinuten == 0xffff)

         {

         {

          FlugMinuten = 0;

          FlugMinuten = 0;

    LcdClear();

    LcdClear();

    I2CTimeout = 5000;

    I2CTimeout = 5000;

    WinkelOut.Orientation = 1;

    WinkelOut.Orientation = 1;

         InitReceiver();

        LIBFC_ReceiverInit();

        printf("\n\r===================================\n\r");

        printf("\n\r===================================\n\r");

//SpektrumBinding();

//SpektrumBinding();

    timer = SetDelay(2000);

    timer = SetDelay(2000);

        timerPolling = SetDelay(250);

        timerPolling = SetDelay(250);

        while (1)

        while (1)

        {

        {

        if(CheckDelay(timerPolling))

        if(CheckDelay(timerPolling))

          timerPolling = SetDelay(100);

          timerPolling = SetDelay(100);

          Polling();

          LIBFC_Polling();

        }

        }