| 129,20 → 129,20 |
|---|
| if(UBat < 130) |
| { |
| BattLowVoltageWarning = 3 * EE_Parameter.UnterspannungsWarnung; |
| if(print) |
| if(print) |
| { |
| Piep(3,200); |
| printf(" 3 Cells "); |
| } |
| } |
| } |
| else |
| { |
| BattLowVoltageWarning = 4 * EE_Parameter.UnterspannungsWarnung; |
| if(print) |
| if(print) |
| { |
| Piep(4,200); |
| printf(" 4 Cells "); |
| } |
| } |
| } |
| } |
| else BattLowVoltageWarning = EE_Parameter.UnterspannungsWarnung; |
| 233,34 → 233,6 |
|---|
| eeprom_write_block(&Mixer, &EEPromArray[EEPROM_ADR_MIXER_TABLE], sizeof(Mixer)); |
| } |
| printf("\n\rMixer-Config: '%s' (%u Motors)",Mixer.Name,RequiredMotors); |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + Check connected BL-Ctrls |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| printf("\n\rFound BL-Ctrl: "); |
| motorread = 0; UpdateMotor = 0; SendMotorData(); while(!UpdateMotor); motorread = 0; // read the first I2C-Data |
| timer = SetDelay(2000); |
| for(i=0; i < MAX_MOTORS; i++) |
| { |
| UpdateMotor = 0; |
| SendMotorData(); |
| while(!UpdateMotor); |
| if(Mixer.Motor[i][0] > 0) // wait max 2 sec for the BL-Ctrls to wake up |
| { |
| while(!CheckDelay(timer) && !MotorPresent[i]) {UpdateMotor = 0; SendMotorData(); while(!UpdateMotor);}; |
| } |
| if(MotorPresent[i]) printf("%d ",i+1); |
| } |
| for(i=0; i < MAX_MOTORS; i++) |
| { |
| if(!MotorPresent[i] && Mixer.Motor[i][0] > 0) |
| { |
| printf("\n\r\n\r!! MISSING BL-CTRL: %d !!",i+1); |
| ServoActive = 1; // just in case the FC would be used as camera-stabilizer |
| } |
| MotorError[i] = 0; |
| } |
| printf("\n\r==================================="); |
| SendMotorData(); |
| |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + Check Settings |
| 358,7 → 330,7 |
|---|
| ROT_OFF; |
| if(SenderOkay) SenderOkay--; |
| else TIMSK1 |= _BV(ICIE1); // enable PPM-Input |
| //+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| //+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| //if(HoehenReglerAktiv && NaviDataOkay && SenderOkay < 160 && SenderOkay > 10 && FromNaviCtrl_Value.SerialDataOkay > 220) SenderOkay = 160; |
| //if(HoehenReglerAktiv && NaviDataOkay && SenderOkay < 101 && SenderOkay > 10 && FromNaviCtrl_Value.SerialDataOkay > 1) SenderOkay = 101; |
| //+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| 370,7 → 342,7 |
|---|
| GPS_Roll = 0; |
| } |
| } |
| if(!--I2CTimeout || MissingMotor) |
| if(!--I2CTimeout) |
| { |
| if(!I2CTimeout) |
| { |
| 428,10 → 400,10 |
|---|
| timer2 = 0; |
| FlugMinuten++; |
| FlugMinutenGesamt++; |
| eeprom_write_byte(&EEPromArray[EEPROM_ADR_MINUTES2],FlugMinuten / 256); |
| eeprom_write_byte(&EEPromArray[EEPROM_ADR_MINUTES2+1],FlugMinuten % 256); |
| eeprom_write_byte(&EEPromArray[EEPROM_ADR_MINUTES],FlugMinutenGesamt / 256); |
| eeprom_write_byte(&EEPromArray[EEPROM_ADR_MINUTES+1],FlugMinutenGesamt % 256); |
| eeprom_write_byte(&EEPromArray[EEPROM_ADR_MINUTES2],FlugMinuten / 256); |
| eeprom_write_byte(&EEPromArray[EEPROM_ADR_MINUTES2+1],FlugMinuten % 256); |
| eeprom_write_byte(&EEPromArray[EEPROM_ADR_MINUTES],FlugMinutenGesamt / 256); |
| eeprom_write_byte(&EEPromArray[EEPROM_ADR_MINUTES+1],FlugMinutenGesamt % 256); |
| timer = SetDelay(20); // falls "timer += 20;" mal nicht geht |
| } |
| } |