Subversion Repositories FlightCtrl

Rev

Rev 371 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 371 Rev 373
Line 105... Line 105...
105
unsigned char Parameter_UserParam3 = 0;
105
unsigned char Parameter_UserParam3 = 0;
106
unsigned char Parameter_UserParam4 = 0;
106
unsigned char Parameter_UserParam4 = 0;
107
unsigned char Parameter_ServoNickControl = 100;
107
unsigned char Parameter_ServoNickControl = 100;
108
struct mk_param_struct EE_Parameter;
108
struct mk_param_struct EE_Parameter;
Line 109... Line 109...
109
 
109
 
110
acc_neutral_struct ee_acc_neutral EEMEM;                // Reservierung im EEPROM
110
struct acc_neutral_struct ee_acc_neutral EEMEM;
Line 111... Line 111...
111
acc_neutral_struct acc_neutral;
111
struct acc_neutral_struct acc_neutral;
112
 
112
 
113
void Piep(unsigned char Anzahl)
113
void Piep(unsigned char Anzahl)
114
{
114
{
Line 137... Line 137...
137
               
137
               
138
        acc_neutral.X = abs(Mittelwert_AccNick) / ACC_AMPLIFY;
138
        acc_neutral.X = abs(Mittelwert_AccNick) / ACC_AMPLIFY;
139
        acc_neutral.Y = abs(Mittelwert_AccRoll) / ACC_AMPLIFY;
139
        acc_neutral.Y = abs(Mittelwert_AccRoll) / ACC_AMPLIFY;
Line 140... Line 140...
140
        acc_neutral.Z = Aktuell_az;
140
        acc_neutral.Z = Aktuell_az;
141
       
141
       
Line 142... Line 142...
142
        eeprom_write_block(&acc_neutral,&ee_acc_neutral,sizeof(acc_neutral_struct));
142
        eeprom_write_block(&acc_neutral,&ee_acc_neutral,sizeof(struct acc_neutral_struct));
143
}
143
}
144
 
144
 
Line 164... Line 164...
164
     }
164
     }
165
    AdNeutralNick= abs(MesswertNick);  
165
    AdNeutralNick= abs(MesswertNick);  
166
        AdNeutralRoll= abs(MesswertRoll);      
166
        AdNeutralRoll= abs(MesswertRoll);      
167
        AdNeutralGier= abs(MesswertGier);
167
        AdNeutralGier= abs(MesswertGier);
Line 168... Line 168...
168
       
168
       
Line 169... Line 169...
169
        eeprom_read_block(&acc_neutral,&ee_acc_neutral,sizeof(acc_neutral_struct));
169
        eeprom_read_block(&acc_neutral,&ee_acc_neutral,sizeof(struct acc_neutral_struct));
170
   
170
   
171
        Mess_IntegralNick = 0; 
171
        Mess_IntegralNick = 0; 
172
    Mess_IntegralNick2 = 0;
172
    Mess_IntegralNick2 = 0;
Line 512... Line 512...
512
                         if(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] < 70 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] > 70) setting = 3;
512
                         if(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] < 70 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] > 70) setting = 3;
513
                         if(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] <-70 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] > 70) setting = 4;
513
                         if(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] <-70 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] > 70) setting = 4;
514
                         if(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] <-70 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] < 70) setting = 5;
514
                         if(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] <-70 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] < 70) setting = 5;
515
                         eeprom_write_byte(&EEPromArray[EEPROM_ADR_ACTIVE_SET], setting);  // aktiven Datensatz merken
515
                         eeprom_write_byte(&EEPromArray[EEPROM_ADR_ACTIVE_SET], setting);  // aktiven Datensatz merken
516
                        }
516
                        }
517
                            ReadParameterSet(GetActiveParamSetNumber(), (unsigned char *) &EE_Parameter.Kanalbelegung[0], STRUCT_PARAM_LAENGE);
517
                            ReadParameterSet(GetActiveParamSetNumber(), (unsigned char *) &EE_Parameter.Kanalbelegung[0], sizeof(struct mk_param_struct));
518
                        Piep(GetActiveParamSetNumber());
518
                        Piep(GetActiveParamSetNumber());
519
                        if((EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG))  // Höhenregelung aktiviert?
519
                        if((EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG))  // Höhenregelung aktiviert?
520
                          {
520
                          {
521
                             if((MessLuftdruck > 950) || (MessLuftdruck < 750)) SucheLuftruckOffset();
521
                             if((MessLuftdruck > 950) || (MessLuftdruck < 750)) SucheLuftruckOffset();
522
                          }  
522
                          }