Subversion Repositories FlightCtrl

Rev

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

Rev 492 Rev 871
Line 106... Line 106...
106 
//AdWertNick += Poti2;            
 106 
//AdWertNick += Poti2;            
107 
            kanal = 5;
 107 
            kanal = 5;
108 
            break;
 108 
            break;
109 
       case 9:
 109 
       case 9:
110 
            AdWertAccHoch =  (signed int) ADC - NeutralAccZ;
 110 
            AdWertAccHoch =  (signed int) ADC - NeutralAccZ;
111 
            AdWertAccHoch += abs(Aktuell_ay) / 4 + abs(Aktuell_ax) / 4;
 111 
//            AdWertAccHoch += abs(Aktuell_ay) / 4 + abs(Aktuell_ax) / 4;
112 
            if(AdWertAccHoch > 1)
 112 
            if(AdWertAccHoch > 1)
113 
             {
 113 
             {
- 
 
 114 
              if(NeutralAccZ < 750)
- 
 
 115 
               {
- 
 
 116 
                NeutralAccZ += 0.02;
114 
              if(NeutralAccZ < 800) NeutralAccZ+= 0.02;
 117 
                if(modell_fliegt < 500) NeutralAccZ += 0.1;
- 
 
 118 
               }
115 
             }  
 119 
             }  
116 
             else if(AdWertAccHoch < -1)
 120 
             else if(AdWertAccHoch < -1)
117 
             {
 121 
             {
- 
 
 122 
              if(NeutralAccZ > 550)
- 
 
 123 
                {
- 
 
 124 
                 NeutralAccZ-= 0.02;
118 
              if(NeutralAccZ > 600) NeutralAccZ-= 0.02;
 125 
                 if(modell_fliegt < 500) NeutralAccZ -= 0.1;              
- 
 
 126 
                }
119 
             }
 127 
             }
120 
            messanzahl_AccHoch = 1;
 128 
            messanzahl_AccHoch = 1;
121 
            Aktuell_az = ADC;
 129 
            Aktuell_az = ADC;
122 
            Mess_Integral_Hoch += AdWertAccHoch;      // Integrieren
 130 
            Mess_Integral_Hoch += AdWertAccHoch;      // Integrieren
123 
            Mess_Integral_Hoch -= Mess_Integral_Hoch / 1024; // dämfen
 131 
            Mess_Integral_Hoch -= Mess_Integral_Hoch / 1024; // dämfen
Line 127... Line 135...
127 
            tmpLuftdruck += ADC;
 135 
            tmpLuftdruck += ADC;
128 
            if(++messanzahl_Druck >= 5)
 136 
            if(++messanzahl_Druck >= 5)
129 
                {
 137 
                {
130 
                MessLuftdruck = ADC;
 138 
                MessLuftdruck = ADC;
131 
                messanzahl_Druck = 0;
 139 
                messanzahl_Druck = 0;
132 
                                HoeheD = (int)(StartLuftdruck - tmpLuftdruck - HoehenWert);  // D-Anteil = neuerWert - AlterWert
 140 
                                HoeheD = (7 * HoeheD + (int) Parameter_Luftdruck_D * (int)(StartLuftdruck - tmpLuftdruck - HoehenWert))/8;  // D-Anteil = neuerWert - AlterWert
133 
                Luftdruck = (tmpLuftdruck + 3 * Luftdruck) / 4;
 141 
                Luftdruck = (tmpLuftdruck + 3 * Luftdruck) / 4;
134 
                HoehenWert = StartLuftdruck - Luftdruck;
 142 
                HoehenWert = StartLuftdruck - Luftdruck;
135 
                tmpLuftdruck = 0;
 143 
                tmpLuftdruck = 0;
136 
                }
 144 
                }
137 
            kanal = 0;
 145 
            kanal = 0;