Rev 438 | Go to most recent revision | 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 |