Rev 438 | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 438 | Rev 479 | ||
---|---|---|---|
Line 78... | Line 78... | ||
78 | case 3: |
78 | case 3: |
79 | UBat = (3 * UBat + ADC / 3) / 4;//(UBat + ((ADC * 39) / 256) + 19) / 2; |
79 | UBat = (3 * UBat + ADC / 3) / 4;//(UBat + ((ADC * 39) / 256) + 19) / 2; |
80 | kanal = 6; |
80 | kanal = 6; |
81 | break; |
81 | break; |
82 | case 4: |
82 | case 4: |
83 | Aktuell_ay = NeutralAccY - ADC; |
83 | Aktuell_ay = acc_neutral.Y - ADC; |
84 | AdWertAccRoll = Aktuell_ay; |
84 | AdWertAccRoll = Aktuell_ay; |
85 | kanal = 7; |
85 | kanal = 7; |
86 | break; |
86 | break; |
87 | case 5: |
87 | case 5: |
88 | Aktuell_ax = ADC - NeutralAccX; |
88 | Aktuell_ax = ADC - acc_neutral.X; |
89 | AdWertAccNick = Aktuell_ax; |
89 | AdWertAccNick = Aktuell_ax; |
90 | kanal = 0; |
90 | kanal = 0; |
91 | break; |
91 | break; |
92 | case 6: |
92 | case 6: |
93 | if(PlatinenVersion == 10) AdWertGier = (ADC + gier1) / 2; |
93 | if(PlatinenVersion == 10) AdWertGier = (ADC + gier1) / 2; |
Line 103... | Line 103... | ||
103 | if(PlatinenVersion == 10) AdWertNick = (ADC + nick1) / 2; |
103 | if(PlatinenVersion == 10) AdWertNick = (ADC + nick1) / 2; |
104 | else AdWertNick = ADC + nick1; |
104 | else AdWertNick = ADC + nick1; |
105 | kanal = 5; |
105 | kanal = 5; |
106 | break; |
106 | break; |
107 | case 9: |
107 | case 9: |
108 | AdWertAccHoch = (signed int) ADC - NeutralAccZ; |
108 | AdWertAccHoch = (signed int) ADC - acc_neutral.Z; |
109 | AdWertAccHoch += abs(Aktuell_ay) / 4 + abs(Aktuell_ax) / 4; |
109 | AdWertAccHoch += abs(Aktuell_ay) / 4 + abs(Aktuell_ax) / 4; |
110 | if(AdWertAccHoch > 1) |
110 | if(AdWertAccHoch > 1) |
111 | { |
111 | { |
112 | if(NeutralAccZ < 800) NeutralAccZ+= 0.02; |
112 | if(acc_neutral.Z < 800) acc_neutral.Z+= 0.02; |
113 | } |
113 | } |
114 | else if(AdWertAccHoch < -1) |
114 | else if(AdWertAccHoch < -1) |
115 | { |
115 | { |
116 | if(NeutralAccZ > 600) NeutralAccZ-= 0.02; |
116 | if(acc_neutral.Z > 600) acc_neutral.Z-= 0.02; |
117 | } |
117 | } |
118 | messanzahl_AccHoch = 1; |
118 | messanzahl_AccHoch = 1; |
119 | Aktuell_az = ADC; |
119 | Aktuell_az = ADC; |
120 | Mess_Integral_Hoch += AdWertAccHoch; // Integrieren |
120 | Mess_Integral_Hoch += AdWertAccHoch; // Integrieren |
121 | Mess_Integral_Hoch -= Mess_Integral_Hoch / 1024; // dämfen |
121 | Mess_Integral_Hoch -= Mess_Integral_Hoch / 1024; // dämfen |