Subversion Repositories FlightCtrl

Rev

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

Rev 401 Rev 419
Line 750... Line 750...
750
        if(IntegralFehlerNick >  FEHLER_LIMIT2)
750
        if(IntegralFehlerNick >  FEHLER_LIMIT2)
751
         {
751
         {
752
           if(last_n_p)
752
           if(last_n_p)
753
           {
753
           {
754
            cnt += labs(IntegralFehlerNick) / FEHLER_LIMIT2;
754
            cnt += labs(IntegralFehlerNick) / FEHLER_LIMIT2;
755
            ausgleichNick = IntegralFehlerNick / 4;
755
            ausgleichNick = IntegralFehlerNick / 8;
756
            if(ausgleichNick > 5000) ausgleichNick = 5000;
756
            if(ausgleichNick > 5000) ausgleichNick = 5000;
757
            Mess_IntegralNick -= ausgleichNick;
757
            Mess_IntegralNick -= ausgleichNick;
758
           }
758
           }
759
           else last_n_p = 1;
759
           else last_n_p = 1;
760
         } else  last_n_p = 0;
760
         } else  last_n_p = 0;
761
        if(IntegralFehlerNick < -FEHLER_LIMIT2)
761
        if(IntegralFehlerNick < -FEHLER_LIMIT2)
762
         {
762
         {
763
           if(last_n_n)
763
           if(last_n_n)
764
            {
764
            {
765
             cnt += labs(IntegralFehlerNick) / FEHLER_LIMIT2;
765
             cnt += labs(IntegralFehlerNick) / FEHLER_LIMIT2;
766
             ausgleichNick = IntegralFehlerNick / 4;
766
             ausgleichNick = IntegralFehlerNick / 8;
767
             if(ausgleichNick < -5000) ausgleichNick = -5000;
767
             if(ausgleichNick < -5000) ausgleichNick = -5000;
768
             Mess_IntegralNick -= ausgleichNick;
768
             Mess_IntegralNick -= ausgleichNick;
769
            }
769
            }
770
           else last_n_n = 1;
770
           else last_n_n = 1;
771
         } else  last_n_n = 0;
771
         } else  last_n_n = 0;