WebSVN - FlightCtrl - Diff - Rev 1166 and 1167 - /branches/V0.88e_ACC-HH_HR

    while(messanzahl_Druck == 0);
    if(i<10) Delay_ms_Mess(10);
+  }
    Delay_ms_Mess(70);
+}
-/*
- n
- r
-    g
-    y
- n
- r
-    z
-    l
- n
- r
-   x
-   g
-n
-r
-   u
-   y
-n
-r
-   x
- n
- r
-   g
-   y
- n
- r
-    z
-    l
- n
- r
-   x
-   g
-n
-r
-   u
-   y
-n
-r
-   x
-*/
-#define FILTER 3
 //#######################################################################################
 //
 SIGNAL(SIG_ADC)
 //#######################################################################################
+{
     static unsigned char kanal=0,state = 0;
     static signed int gier1, roll1, nick1;
         static signed long nick_filter, roll_filter;
-        static signed int accy, accx;
-//    ANALOG_OFF;
+        static signed int accy, accx;
     switch(state++)
+        {
-        case 0:
-J4High;
+        case 0:
             nick1 = ADC;
             kanal = AD_ROLL;
             break;
         case 1:
         case 2:
             gier1 = ADC;
             kanal = AD_ACC_Y;
             break;
         case 3:
-J5High;
             Aktuell_ay = NeutralAccY - ADC;
             accy = Aktuell_ay;
             kanal = AD_NICK;
             break;
         case 4:
-J4High;
             nick1 += ADC;
             kanal = AD_ROLL;
             break;
         case 5:
             roll1 += ADC;
             Mess_Integral_Hoch += AdWertAccHoch;      // Integrieren
             Mess_Integral_Hoch -= Mess_Integral_Hoch / 1024; // dämfen
             kanal = AD_NICK;
             break;
         case 7:
-J4High;
             nick1 += ADC;
             kanal = AD_ROLL;
             break;
         case 8:
             roll1 += ADC;
         case 10:
             gier1 += ADC;
             kanal = AD_NICK;
             break;
         case 11:
-J4High;
             nick1 += ADC;
             kanal = AD_ROLL;
             break;
         case 12:
             roll1 += ADC;
         case 13:
             UBat = (3 * UBat + ADC / 3) / 4;//(UBat + ((ADC * 39) / 256) + 19)  / 2;
             kanal = AD_ACC_Y;
             break;
         case 14:
-J5High;
             Aktuell_ay = NeutralAccY - ADC;
             accy += Aktuell_ay;
             kanal = AD_NICK;
             break;
         case 15:
-J4High;
             nick1 += ADC;
             kanal = AD_ROLL;
             break;
         case 16:
             roll1 += ADC;
             Aktuell_ax = ADC - NeutralAccX;
             accx += Aktuell_ax;
                     kanal = AD_NICK;
             break;
         case 18:
-J4High;
             nick1 += ADC;
             kanal = AD_ROLL;
             break;
         case 19:
             roll1 += ADC;
         case 20:
             gier1 += ADC;
             kanal = AD_ACC_Y;
             break;
         case 21:
-J5High;
             Aktuell_ay = NeutralAccY - ADC;
             accy += Aktuell_ay;
             kanal = AD_NICK;
             break;
         case 22:
-J4High;
             nick1 += ADC;
             kanal = AD_ROLL;
             break;
         case 23:
             roll1 += ADC;
                 kanal = AD_DRUCK;
             break;
         case 24:
             tmpLuftdruck += ADC;
             if(++messanzahl_Druck >= 5)
+                {
                 MessLuftdruck = ADC;
                 messanzahl_Druck = 0;
-                                HoeheD = (7 * HoeheD + (int) Parameter_Luftdruck_D * (int)(255 * ExpandBaro + StartLuftdruck - tmpLuftdruck - HoehenWert))/8;  // D-Anteil = neuerWert - AlterWert
+                                HoeheD = (7 * HoeheD + (int) Parameter_Luftdruck_D * (int)(255 * ExpandBaro + StartLuftdruck - tmpLuftdruck - HoehenWert)) / 8;  // D-Anteil = neuerWert - AlterWert
                 Luftdruck = (tmpLuftdruck + 3 * Luftdruck) / 4;
                 HoehenWert = 255 * ExpandBaro + StartLuftdruck - Luftdruck;
                 tmpLuftdruck = 0;
+                }
             kanal = AD_NICK;
             break;
         case 25:
-J4High;
             nick1 += ADC;
             kanal = AD_ROLL;
             break;
         case 26:
             roll1 += ADC;
             if(PlatinenVersion == 20)  AdWertGier = 2047 - (ADC + gier1 + 1) / 2;
                         else                                       AdWertGier = (ADC + gier1 + 1) / 2;
             kanal = AD_NICK;
             break;
         case 29:
-J4High;
             nick1 += ADC;
             kanal = AD_ROLL;
             break;
         case 30:
             roll1 += ADC;
             kanal = AD_ACC_Y;
             break;
         case 31:
-J5High;
             Aktuell_ay = NeutralAccY - ADC;
             AdWertAccRoll = (Aktuell_ay + accy);
             kanal = AD_NICK;
             break;
         case 32:
-J4High;
             AdWertNick = (ADC + nick1 + 3) / 5;
             nick_filter = (long) (1 * (long) nick_filter + 4 * (long)(ADC + nick1) + 1) / 2;
             if(PlatinenVersion == 10) { AdWertNick /= 2;nick_filter /=2;}
             HiResNick = nick_filter - 20 * AdNeutralNick;
             AdWertNickFilter = (long)(3L * (long)AdWertNickFilter + HiResNick + 2) / 4;
             state = 0;
             break;
+        }
     ADMUX = kanal;
     if(state != 0) ANALOG_ON;
-J4Low;
-J5Low;
+}
-/*
-//#######################################################################################
-//
-SIGNAL(SIG_ADC)
-//#######################################################################################
-{
-    static unsigned char kanal=0,state = 0;
-    static signed int gier1, roll1, nick1, nick_filter, roll_filter;
-        static signed int accy, accx;
-//    ANALOG_OFF;
-    switch(state++)
-        {
-        case 0:
-J4High;
-            nick1 = ADC;
-            kanal = AD_ROLL;
-            break;
-        case 1:
-            roll1 = ADC;
-                    kanal = AD_GIER;
-            break;
-        case 2:
-            gier1 = ADC;
-            kanal = AD_ACC_Y;
-            break;
-        case 3:
-            Aktuell_ay = NeutralAccY - ADC;
-            accy = Aktuell_ay;
-            kanal = AD_NICK;
-            break;
-        case 4:
-J4High;
-            nick1 += ADC;
-            kanal = AD_ROLL;
-            break;
-        case 5:
-            roll1 += ADC;
-                    kanal = AD_ACC_Z;
-            break;
-       case 6:
-            AdWertAccHoch =  (signed int) ADC - NeutralAccZ;
-            if(AdWertAccHoch > 1)
-             {
-              if(NeutralAccZ < 750)
-               {
-                NeutralAccZ += 0.02;
-                if(modell_fliegt < 500) NeutralAccZ += 0.1;
-               }
-             }
-             else if(AdWertAccHoch < -1)
-             {
-              if(NeutralAccZ > 550)
-                {
-                 NeutralAccZ-= 0.02;
-                 if(modell_fliegt < 500) NeutralAccZ -= 0.1;
-                }
-             }
-            messanzahl_AccHoch = 1;
-            Aktuell_az = ADC;
-            Mess_Integral_Hoch += AdWertAccHoch;      // Integrieren
-            Mess_Integral_Hoch -= Mess_Integral_Hoch / 1024; // dämfen
-                kanal = AD_DRUCK;
-            break;
-        case 7:
-            tmpLuftdruck += ADC;
-            if(++messanzahl_Druck >= 5)
-                {
-                MessLuftdruck = ADC;
-                messanzahl_Druck = 0;
-                                HoeheD = (7 * HoeheD + (int) Parameter_Luftdruck_D * (int)(255 * ExpandBaro + StartLuftdruck - tmpLuftdruck - HoehenWert))/8;  // D-Anteil = neuerWert - AlterWert
-                Luftdruck = (tmpLuftdruck + 3 * Luftdruck) / 4;
-                HoehenWert = 255 * ExpandBaro + StartLuftdruck - Luftdruck;
-                tmpLuftdruck = 0;
-                }
-            kanal = AD_NICK;
-            break;
-        case 8:
-J4High;
-            nick1 += ADC;
-            kanal = AD_ROLL;
-            break;
-        case 9:
-            roll1 += ADC;
-                    kanal = AD_ACC_X;
-            break;
-        case 10:
-            Aktuell_ax = ADC - NeutralAccX;
-            accx =  Aktuell_ax;
-                    kanal = AD_GIER;
-            break;
-        case 11:
-            if(PlatinenVersion == 10)  AdWertGier = (ADC + gier1) / 2;
-            else
-            if(PlatinenVersion == 20)  AdWertGier = 2047 - (ADC + gier1);
-                        else                                       AdWertGier = (ADC + gier1);
-            kanal = AD_NICK;
-            break;
-        case 12:
-J4High;
-            nick1 += ADC;
-            kanal = AD_ROLL;
-            break;
-        case 13:
-            roll1 += ADC;
-            kanal = AD_UBAT;
-            break;
-        case 14:
-            UBat = (3 * UBat + ADC / 3) / 4;//(UBat + ((ADC * 39) / 256) + 19)  / 2;
-            kanal = AD_ACC_Y;
-            break;
-        case 15:
-            Aktuell_ay = NeutralAccY - ADC;
-            AdWertAccRoll = (Aktuell_ay + accy);
-            kanal = AD_NICK;
-            break;
-        case 16:
-J4High;
-//            if(PlatinenVersion == 10)  AdWertNick = (ADC + nick1) / 5;
-//                      else                                       AdWertNick = (5 * AdWertNick + 2*(ADC + nick1)) / 10;
-            AdWertNick = 2*(ADC + nick1) / 5;
-            nick_filter = (2 * nick_filter + 2 * (ADC + nick1)) / 3;
-            HiResNick = nick_filter - 5 * AdNeutralNick;
-            AdWertNickFilter = (long)(3L * (long)AdWertNickFilter + 4 * HiResNick) / 4;
-            DebugOut.Analog[21] = AdWertNickFilter / 4;
-            kanal = AD_ROLL;
-            break;
-        case 17:
-//          if(PlatinenVersion == 10)  AdWertRoll = (ADC + roll1) / 5;
-//                      else                                       AdWertRoll = (5 * AdWertRoll + 2*(ADC + roll1)) / 10;
-            AdWertRoll = 2*(ADC + roll1) / 5;
-            roll_filter = (2 * roll_filter + 2 * (ADC + roll1)) / 3;
-            HiResRoll = roll_filter - 5 * AdNeutralRoll;
-            AdWertRollFilter = (long)(3 * (long)AdWertRollFilter + 4 * HiResRoll) / 4;
-            DebugOut.Analog[22] = AdWertRollFilter / 4;
-            kanal = AD_ACC_X;
-            break;
-        case 18:
-            Aktuell_ax = ADC - NeutralAccX;
-            AdWertAccNick =  (Aktuell_ax + accx);
-                    kanal = AD_NICK;
-            state = 0;
-                        AdReady = 1;
-            ZaehlMessungen++;
-J5High;
-            break;
-        default:
-            kanal = 0;
-            state = 0;
-            break;
-        }
-    ADMUX = kanal;
-    if(state != 0) ANALOG_ON;
-J4Low;
-J5Low;
-}
-*/
-/*
-//#######################################################################################
-//
-SIGNAL(SIG_ADC)
-//#######################################################################################
-{
-    static unsigned char kanal=0,state = 0;
-    static unsigned int gier1, roll1, nick1, accy, accx;
-    ANALOG_OFF;
-    switch(state++)
-        {
-        case 0:
-            gier1 = ADC;
-            kanal = AD_ROLL;
-            ZaehlMessungen++;
-            break;
-        case 1:
-            roll1 = ADC;
-            kanal = AD_NICK;
-            break;
-        case 2:
-            nick1 = ADC;
-            kanal = AD_ACC_Y;
-            break;
-        case 3:
-            Aktuell_ay = NeutralAccY - ADC;
-            accy = Aktuell_ay;
-            kanal = AD_ACC_X;
-            break;
-        case 4:
-            Aktuell_ax = ADC - NeutralAccX;
-            accx =  Aktuell_ax;
-                    kanal = AD_GIER;
-            break;
-        case 5:
-            gier1 += ADC;
-            kanal = AD_ROLL;
-            break;
-        case 6:
-            roll1 += ADC;
-            kanal = AD_NICK;
-            break;
-        case 7:
-            nick1 += ADC;
-            kanal = AD_UBAT;
-            break;
-        case 8:
-            UBat = (3 * UBat + ADC / 3) / 4;//(UBat + ((ADC * 39) / 256) + 19)  / 2;
-            kanal = AD_ACC_Z;
-            break;
-       case 9:
-            AdWertAccHoch =  (signed int) ADC - NeutralAccZ;
-            if(AdWertAccHoch > 1)
-             {
-              if(NeutralAccZ < 750)
-               {
-                NeutralAccZ += 0.02;
-                if(modell_fliegt < 500) NeutralAccZ += 0.1;
-               }
-             }
-             else if(AdWertAccHoch < -1)
-             {
-              if(NeutralAccZ > 550)
-                {
-                 NeutralAccZ-= 0.02;
-                 if(modell_fliegt < 500) NeutralAccZ -= 0.1;
-                }
-             }
-            messanzahl_AccHoch = 1;
-            Aktuell_az = ADC;
-            Mess_Integral_Hoch += AdWertAccHoch;      // Integrieren
-            Mess_Integral_Hoch -= Mess_Integral_Hoch / 1024; // dämfen
-            kanal = AD_GIER;
-            break;
-        case 10:
-            gier1 += ADC;
-            kanal = AD_ROLL;
-            break;
-        case 11:
-            roll1 += ADC;
-            kanal = AD_NICK;
-            break;
-        case 12:
-            nick1 += ADC;
-                kanal = AD_DRUCK;
-            break;
-        case 13:
-            tmpLuftdruck += ADC;
-            if(++messanzahl_Druck >= 5)
-                {
-                MessLuftdruck = ADC;
-                messanzahl_Druck = 0;
-                                HoeheD = (7 * HoeheD + (int) Parameter_Luftdruck_D * (int)(255 * ExpandBaro + StartLuftdruck - tmpLuftdruck - HoehenWert))/8;  // D-Anteil = neuerWert - AlterWert
-                Luftdruck = (tmpLuftdruck + 3 * Luftdruck) / 4;
-                HoehenWert = 255 * ExpandBaro + StartLuftdruck - Luftdruck;
-                tmpLuftdruck = 0;
-                }
-            kanal = AD_ACC_Y;
-            break;
-        case 14:
-            Aktuell_ay = NeutralAccY - ADC;
-            AdWertAccRoll = (Aktuell_ay + accy);
-            kanal = AD_ACC_X;
-            break;
-        case 15:
-            Aktuell_ax = ADC - NeutralAccX;
-            AdWertAccNick =  (Aktuell_ax + accx);
-                    kanal = AD_GIER;
-            break;
-        case 16:
-            if(PlatinenVersion == 10)  AdWertGier = (ADC + gier1) / 4;
-            else
-            if(PlatinenVersion == 20)  AdWertGier = 2047 - (ADC + gier1)/2;
-                        else                                       AdWertGier = (ADC + gier1) / 2;
-            kanal = AD_ROLL;
-            break;
-        case 17:
-            if(PlatinenVersion == 10)  AdWertRoll = (ADC + roll1) / 4;
-                        else                                       AdWertRoll = (ADC + roll1) / 2;
-            kanal = AD_NICK;
-            break;
-        case 18:
-            if(PlatinenVersion == 10)  AdWertNick = (ADC + nick1) / 4;
-                        else                                       AdWertNick = (ADC + nick1) / 2;
-            kanal = AD_GIER;
-            state = 0;
-                        AdReady = 1;
-            break;
-        default:
-            kanal = 0;
-            state = 0;
-            break;
-        }
-    ADMUX = kanal;
-    if(state != 0) ANALOG_ON;
-}
-*/

Subversion Repositories FlightCtrl

(root)/branches/V0.88e_ACC-HH_HR_MartinR/analog.c @ 2093 - Rev 1166 → 1167