Rev 544 | Show entire file | Regard whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 544 | Rev 549 | ||
---|---|---|---|
Line 922... | Line 922... | ||
922 | LageKorrekturNick += ausgleichNick / ABGLEICH_ANZAHL; |
922 | LageKorrekturNick += ausgleichNick / ABGLEICH_ANZAHL; |
923 | } |
923 | } |
924 | else last_n_n = 1; |
924 | else last_n_n = 1; |
925 | } else last_n_n = 0; |
925 | } else last_n_n = 0; |
926 | } else cnt = 0; |
926 | } else cnt = 0; |
- | 927 | //Salvo 11.12.2007 |
|
- | 928 | w = (abs(Mittelwert_AccNick)); |
|
- | 929 | v = (abs(Mittelwert_AccRoll)); |
|
- | 930 | if ((w < ACC_WAAGRECHT_LIMIT) && (v < ACC_WAAGRECHT_LIMIT)) // Gyro nur in wwagrechter Lage nachtrimmen |
|
- | 931 | { |
|
- | 932 | ||
927 | if(cnt > EE_Parameter.Driftkomp) cnt = EE_Parameter.Driftkomp; |
933 | if(cnt > EE_Parameter.Driftkomp) cnt = EE_Parameter.Driftkomp; |
928 | if(IntegralFehlerNick > FEHLER_LIMIT) AdNeutralNick += cnt; |
934 | if(IntegralFehlerNick > FEHLER_LIMIT) AdNeutralNick += cnt; |
929 | if(IntegralFehlerNick < -FEHLER_LIMIT) AdNeutralNick -= cnt; |
935 | if(IntegralFehlerNick < -FEHLER_LIMIT) AdNeutralNick -= cnt; |
930 | 936 | } |
|
- | 937 | //Salvo End |
|
931 | // Roll +++++++++++++++++++++++++++++++++++++++++++++++++ |
938 | // Roll +++++++++++++++++++++++++++++++++++++++++++++++++ |
932 | cnt = 1;// + labs(IntegralFehlerNick) / 4096; |
939 | cnt = 1;// + labs(IntegralFehlerNick) / 4096; |
Line 933... | Line 940... | ||
933 | 940 | ||
934 | ausgleichRoll = 0; |
941 | ausgleichRoll = 0; |
Line 958... | Line 965... | ||
958 | } else last_r_n = 0; |
965 | } else last_r_n = 0; |
959 | } else |
966 | } else |
960 | { |
967 | { |
961 | cnt = 0; |
968 | cnt = 0; |
962 | } |
969 | } |
- | 970 | //Salvo 11.12.2007 |
|
- | 971 | w = (abs(Mittelwert_AccNick)); |
|
963 | //DebugOut.Analog[27] = ausgleichRoll; |
972 | v = (abs(Mittelwert_AccRoll)); |
- | 973 | if ((w < ACC_WAAGRECHT_LIMIT) && (v < ACC_WAAGRECHT_LIMIT)) // Gyro nur in wwagrechter Lage nachtrimmen |
|
- | 974 | { |
|
964 | if(cnt > EE_Parameter.Driftkomp) cnt = EE_Parameter.Driftkomp; |
975 | if(cnt > EE_Parameter.Driftkomp) cnt = EE_Parameter.Driftkomp; |
965 | //if(cnt > 1) beeptime = 50; |
- | |
966 | if(IntegralFehlerRoll > FEHLER_LIMIT) AdNeutralRoll += cnt; |
976 | if(IntegralFehlerRoll > FEHLER_LIMIT) AdNeutralRoll += cnt; |
967 | if(IntegralFehlerRoll < -FEHLER_LIMIT) AdNeutralRoll -= cnt; |
977 | if(IntegralFehlerRoll < -FEHLER_LIMIT) AdNeutralRoll -= cnt; |
- | 978 | } |
|
- | 979 | //Salvo End |
|
968 | //DebugOut.Analog[23] = AdNeutralNick;//10*(AdNeutralNick - StartNeutralNick); |
980 | //DebugOut.Analog[23] = AdNeutralNick;//10*(AdNeutralNick - StartNeutralNick); |
969 | //DebugOut.Analog[24] = 10*(AdNeutralRoll - StartNeutralRoll); |
981 | //DebugOut.Analog[24] = 10*(AdNeutralRoll - StartNeutralRoll); |
970 | } |
982 | } |
971 | else |
983 | else |
972 | { |
984 | { |