Subversion Repositories FlightCtrl

Rev

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

Rev 1879 Rev 1912
Line 332... Line 332...
332
    StartLuftdruck = Luftdruck;
332
    StartLuftdruck = Luftdruck;
333
    VarioMeter = 0;
333
    VarioMeter = 0;
334
    Mess_Integral_Hoch = 0;
334
    Mess_Integral_Hoch = 0;
335
    KompassSollWert = KompassValue;
335
    KompassSollWert = KompassValue;
336
        KompassSignalSchlecht = 100;
336
        KompassSignalSchlecht = 100;
337
    GPS_Neutral();
-
 
338
    beeptime = 50;
337
    beeptime = 50;
339
        Umschlag180Nick = ((long) EE_Parameter.WinkelUmschlagNick * 2500L) + 15000L;
338
        Umschlag180Nick = ((long) EE_Parameter.WinkelUmschlagNick * 2500L) + 15000L;
340
        Umschlag180Roll = ((long) EE_Parameter.WinkelUmschlagRoll * 2500L) + 15000L;
339
        Umschlag180Roll = ((long) EE_Parameter.WinkelUmschlagRoll * 2500L) + 15000L;
341
    ExternHoehenValue = 0;
340
    ExternHoehenValue = 0;
342
    ErsatzKompass = KompassValue * GIER_GRAD_FAKTOR;
341
    ErsatzKompass = KompassValue * GIER_GRAD_FAKTOR;
Line 842... Line 841...
842
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
841
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
Line 843... Line 842...
843
 
842
 
844
 if(!NewPpmData-- || (FC_StatusFlags & FC_STATUS_EMERGENCY_LANDING))
843
 if(!NewPpmData-- || (FC_StatusFlags & FC_STATUS_EMERGENCY_LANDING))
845
  {
844
  {
-
 
845
        static int stick_nick,stick_roll;
846
        static int stick_nick,stick_roll;
846
        unsigned char stick_p;
-
 
847
    ParameterZuordnung();
-
 
848
        stick_p = EE_Parameter.Stick_P;
847
    ParameterZuordnung();
849
 
848
    stick_nick = (stick_nick * 3 + PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] * EE_Parameter.Stick_P) / 4;
850
    stick_nick = (stick_nick * 3 + PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] * stick_p) / 4;
849
    stick_nick += PPM_diff[EE_Parameter.Kanalbelegung[K_NICK]] * EE_Parameter.Stick_D;
851
    stick_nick += PPM_diff[EE_Parameter.Kanalbelegung[K_NICK]] * EE_Parameter.Stick_D;
850
    stick_roll = (stick_roll * 3 + PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] * EE_Parameter.Stick_P) / 4;
852
    stick_roll = (stick_roll * 3 + PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] * stick_p) / 4;
Line 851... Line 853...
851
    stick_roll += PPM_diff[EE_Parameter.Kanalbelegung[K_ROLL]] * EE_Parameter.Stick_D;
853
    stick_roll += PPM_diff[EE_Parameter.Kanalbelegung[K_ROLL]] * EE_Parameter.Stick_D;
852
 
854
 
853
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
855
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
Line 871... Line 873...
871
 
873
 
872
    StickGier = -PPM_in[EE_Parameter.Kanalbelegung[K_GIER]];
874
    StickGier = -PPM_in[EE_Parameter.Kanalbelegung[K_GIER]];
873
        if(StickGier > 4) StickGier -= 4;       else
875
        if(StickGier > 4) StickGier -= 4;       else
Line -... Line 876...
-
 
876
        if(StickGier < -4) StickGier += 4; else StickGier = 0;
-
 
877
 
874
        if(StickGier < -4) StickGier += 4; else StickGier = 0;
878
    if(GPS_AidMode) { StickNick /= 2; StickRoll /= 2; };// in that case the GPS controls stronger
875
 
879
 
876
    StickNick -= (GPS_Nick + GPS_Nick2);
880
    StickNick -= GPS_Nick;
Line 877... Line 881...
877
    StickRoll -= (GPS_Roll + GPS_Roll2);
881
    StickRoll -= GPS_Roll;
878
        StickGas  = PPM_in[EE_Parameter.Kanalbelegung[K_GAS]] + 120;
882
        StickGas  = PPM_in[EE_Parameter.Kanalbelegung[K_GAS]] + 120;
879
 
883