WebSVN - FlightCtrl - Diff - Rev 1639 and 1643


// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
// + Copyright (c) Holger Buss, Ingo Busker
// + only for non-profit use
// + www.MikroKopter.com
// + porting the sources to other systems or using the software on other systems (except hardware from www.mikrokopter.de) is not allowed
// + see the File "License.txt" for further Informations
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
 
#include "main.h"
#include "eeprom.h"
volatile int  Aktuell_Nick,Aktuell_Roll,Aktuell_Gier,Aktuell_ax, Aktuell_ay,Aktuell_az, UBat = 100;
volatile int  AdWertNickFilter = 0, AdWertRollFilter = 0, AdWertGierFilter = 0;
volatile int  HiResNick = 2500, HiResRoll = 2500;
volatile int  AdWertNick = 0, AdWertRoll = 0, AdWertGier = 0;
volatile int  AdWertAccRoll = 0,AdWertAccNick = 0,AdWertAccHoch = 0;
volatile char messanzahl_AccHoch = 0;
volatile long Luftdruck = 32000;
volatile long SummenHoehe = 0;
volatile int  StartLuftdruck;
volatile unsigned int  MessLuftdruck = 1023;
unsigned char DruckOffsetSetting;
signed char ExpandBaro = 0;
volatile int VarioMeter = 0;
volatile unsigned int ZaehlMessungen = 0;
unsigned char AnalogOffsetNick = 115,AnalogOffsetRoll = 115,AnalogOffsetGier = 115;
unsigned char GyroDefektN = 0,GyroDefektR = 0,GyroDefektG = 0;
volatile unsigned char AdReady = 1;
float NeutralAccZ_float;
//#######################################################################################
//
void ADC_Init(void)
//#######################################################################################
{
    ADMUX = 0;//Referenz ist extern
    ANALOG_ON;
}
 
#define DESIRED_H_ADC 800
 
void SucheLuftruckOffset(void)
{
 unsigned int off;
 off = GetParamByte(PID_PRESSURE_OFFSET);
 if(off > 20) off -= 10;
 OCR0A = off;
 ExpandBaro = 0;
 Delay_ms_Mess(100);
 if(MessLuftdruck < DESIRED_H_ADC) off = 0;
 for(; off < 250;off++)
  {
  OCR0A = off;
  Delay_ms_Mess(50);
  printf(".");
  if(MessLuftdruck < DESIRED_H_ADC) break;
  }
 SetParamByte(PID_PRESSURE_OFFSET, off);
 DruckOffsetSetting = off;
 OCR0A = off;
 Delay_ms_Mess(300);
 
}
 
void SucheGyroOffset(void)
{
 unsigned char i, ready = 0;
 int timeout;
 GyroDefektN = 0; GyroDefektR = 0; GyroDefektG = 0;
 timeout = SetDelay(2000);
 for(i=140; i != 0; i--)
  {
   if(ready == 3 && i > 10) i = 9;
   ready = 0;
   if(AdWertNick < 1020) AnalogOffsetNick--; else if(AdWertNick > 1030) AnalogOffsetNick++; else ready++;
   if(AdWertRoll < 1020) AnalogOffsetRoll--; else if(AdWertRoll > 1030) AnalogOffsetRoll++; else ready++;
   if(AdWertGier < 1020) AnalogOffsetGier--; else if(AdWertGier > 1030) AnalogOffsetGier++; else ready++;
   twi_state = 18;
   I2C_Start();
   if(AnalogOffsetNick < 10)  { GyroDefektN = 1; AnalogOffsetNick = 10;}; if(AnalogOffsetNick > 245) { GyroDefektN = 1; AnalogOffsetNick = 245;};
   if(AnalogOffsetRoll < 10)  { GyroDefektR = 1; AnalogOffsetRoll = 10;}; if(AnalogOffsetRoll > 245) { GyroDefektR = 1; AnalogOffsetRoll = 245;};
   if(AnalogOffsetGier < 10)  { GyroDefektG = 1; AnalogOffsetGier = 10;}; if(AnalogOffsetGier > 245) { GyroDefektG = 1; AnalogOffsetGier = 245;};
   while(twi_state) if(CheckDelay(timeout)) {printf("\n\r DAC or I2C ERROR! Check I2C, 3Vref, DAC and BL-Ctrl"); break;}
   AdReady = 0;
   ANALOG_ON;
   while(!AdReady);
   if(i<10) Delay_ms_Mess(10);
  }
   Delay_ms_Mess(70);
}
 
/*
0  n
1  r
2     g
3     y
4     x
5  n
6  r
7     u
8     z
9     L
10 n
11 r
12    g
13    y
14    x
15 n
16 r
17    L
*/
 
//#######################################################################################
//
ISR(ADC_vect)
//#######################################################################################
{
    static unsigned char kanal=0,state = 0;
    static signed int gier1, roll1, nick1, nick_filter, roll_filter;
        static signed int accy, accx,subcount = 0;
 
        static long tmpLuftdruck = 0;
        static char messanzahl_Druck = 0;
    switch(state++)
        {
        case 0:
            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_ACC_X;
            break;
        case 4:
            Aktuell_ax = ADC - NeutralAccX;
            accx =  Aktuell_ax;
            kanal = AD_NICK;
            break;
        case 5:
            nick1 += ADC;
            kanal = AD_ROLL;
            break;
        case 6:
            roll1 += ADC;
            kanal = AD_UBAT;
            break;
        case 7:
            UBat = (3 * UBat + ADC / 3) / 4;
                    kanal = AD_ACC_Z;
            break;
       case 8:
 
            AdWertAccHoch =  (signed int) ADC - NeutralAccZ;
            if(AdWertAccHoch > 1)
             {
              if(NeutralAccZ < 750)
               {
                subcount += 2;
                if(modell_fliegt < 500) subcount += 100;
               }
              if(subcount > 1000) { NeutralAccZ++; subcount -= 1000;}
             }
             else if(AdWertAccHoch < -1)
             {
              if(NeutralAccZ > 550)
                {
                 subcount -= 2;
                 if(modell_fliegt < 500) subcount -= 100;
                 if(subcount < -1000) { NeutralAccZ--; subcount += 1000;}
                }
             }
 
 
 
 
 
/*
            AdWertAccHoch =  (signed int) ADC - NeutralAccZ_float;
            if(AdWertAccHoch > 1)
             {
              if(NeutralAccZ_float < 750)
               {
                NeutralAccZ_float += 0.02;
                if(modell_fliegt < 500) NeutralAccZ_float += 0.1;
               }
             }
             else if(AdWertAccHoch < -1)
             {
              if(NeutralAccZ_float > 550)
                {
                 NeutralAccZ_float-= 0.02;
                 if(modell_fliegt < 500) NeutralAccZ_float -= 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 8:" fehlt hier absichtlich
        case 10:
            nick1 += ADC;
            kanal = AD_ROLL;
            break;
        case 11:
            roll1 += ADC;
                    kanal = AD_GIER;
            break;
        case 12:
            if(PlatinenVersion == 10)  AdWertGier = (ADC + gier1 + 1) / 2;
            else
            if(PlatinenVersion == 20)  AdWertGier = 2047 - (ADC + gier1);
                        else                                       AdWertGier = (ADC + gier1);
            kanal = AD_ACC_Y;
            break;
        case 13:
            Aktuell_ay = NeutralAccY - ADC;
            AdWertAccRoll = (Aktuell_ay + accy);
            kanal = AD_ACC_X;
            break;
        case 14:
            Aktuell_ax = ADC - NeutralAccX;
            AdWertAccNick =  (Aktuell_ax + accx);
            kanal = AD_NICK;
            break;
        case 15:
            nick1 += ADC;
            if(PlatinenVersion == 10) nick1 *= 2; else nick1 *= 4;
            AdWertNick = nick1 / 8;
            nick_filter = (nick_filter + nick1) / 2;
            HiResNick = nick_filter - AdNeutralNick;
            AdWertNickFilter = (AdWertNickFilter + HiResNick) / 2;
            kanal = AD_ROLL;
            break;
        case 16:
            roll1 += ADC;
            if(PlatinenVersion == 10) roll1 *= 2; else roll1 *= 4;
            AdWertRoll = roll1 / 8;
            roll_filter = (roll_filter + roll1) / 2;
            HiResRoll = roll_filter - AdNeutralRoll;
            AdWertRollFilter = (AdWertRollFilter + HiResRoll) / 2;
                kanal = AD_DRUCK;
            break;
        case 17:
            state = 0;
                        AdReady = 1;
            ZaehlMessungen++;
            // "break" fehlt hier absichtlich
        case 9:
                MessLuftdruck = ADC;
            tmpLuftdruck += MessLuftdruck;
            if(++messanzahl_Druck >= 18)
            {
                                Luftdruck = (7 * Luftdruck + tmpLuftdruck - (18 * 523) * (long)ExpandBaro + 4) / 8;  // -523.19 counts per 10 counts offset step
                                HoehenWert = StartLuftdruck - Luftdruck;
                                SummenHoehe -= SummenHoehe/SM_FILTER;
                                SummenHoehe += HoehenWert;
                                VarioMeter = (15 * VarioMeter + 8 * (int)(HoehenWert - SummenHoehe/SM_FILTER))/16;
                tmpLuftdruck /= 2;
                messanzahl_Druck = 18/2;
            }
            kanal = AD_NICK;
            break;
        default:
            kanal = 0; state = 0; kanal = AD_NICK;
            break;
        }
    ADMUX = kanal;
    if(state != 0) ANALOG_ON;
 
}
 
 
 
/*
//#######################################################################################
//
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;
    switch(state++)
        {
        case 0:
            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:
            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_NICK;
            break;
        case 7:
            nick1 += ADC;
            kanal = AD_ROLL;
            break;
        case 8:
            roll1 += ADC;
                    kanal = AD_ACC_X;
            break;
        case 9:
            Aktuell_ax = ADC - NeutralAccX;
            accx =  Aktuell_ax;
                    kanal = AD_GIER;
            break;
        case 10:
            gier1 += ADC;
            kanal = AD_NICK;
            break;
        case 11:
            nick1 += ADC;
            kanal = AD_ROLL;
            break;
        case 12:
            roll1 += ADC;
            kanal = AD_UBAT;
            break;
        case 13:
            UBat = (3 * UBat + ADC / 3) / 4;//(UBat + ((ADC * 39) / 256) + 19)  / 2;
            kanal = AD_ACC_Y;
            break;
        case 14:
            Aktuell_ay = NeutralAccY - ADC;
            accy += Aktuell_ay;
            kanal = AD_NICK;
            break;
        case 15:
            nick1 += ADC;
            kanal = AD_ROLL;
            break;
        case 16:
            roll1 += ADC;
            kanal = AD_ACC_X;
            break;
        case 17:
            Aktuell_ax = ADC - NeutralAccX;
            accx += Aktuell_ax;
                    kanal = AD_NICK;
            break;
        case 18:
            nick1 += ADC;
            kanal = AD_ROLL;
            break;
        case 19:
            roll1 += ADC;
                    kanal = AD_GIER;
            break;
        case 20:
            gier1 += ADC;
            kanal = AD_ACC_Y;
            break;
        case 21:
            Aktuell_ay = NeutralAccY - ADC;
            accy += Aktuell_ay;
            kanal = AD_NICK;
            break;
        case 22:
            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
                Luftdruck = (tmpLuftdruck + 3 * Luftdruck) / 4;
                HoehenWert = 255 * ExpandBaro + StartLuftdruck - Luftdruck;
                tmpLuftdruck = 0;
                }
            kanal = AD_NICK;
            break;
        case 25:
            nick1 += ADC;
            kanal = AD_ROLL;
            break;
        case 26:
            roll1 += ADC;
                    kanal = AD_ACC_X;
            break;
        case 27:
            Aktuell_ax = ADC - NeutralAccX;
            accx +=  Aktuell_ax;
                    kanal = AD_GIER;
            break;
        case 28:
            if(PlatinenVersion == 10)  AdWertGier = (ADC + gier1 + 2) / 4;
            else
            if(PlatinenVersion == 20)  AdWertGier = 2047 - (ADC + gier1 + 1) / 2;
                        else                                       AdWertGier = (ADC + gier1 + 1) / 2;
            kanal = AD_NICK;
            break;
        case 29:
            nick1 += ADC;
            kanal = AD_ROLL;
            break;
        case 30:
            roll1 += ADC;
            kanal = AD_ACC_Y;
            break;
        case 31:
            Aktuell_ay = NeutralAccY - ADC;
            AdWertAccRoll = (Aktuell_ay + accy);
            kanal = AD_NICK;
            break;
        case 32:
            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;
            DebugOut.Analog[21] = AdWertNickFilter / 4;
            kanal = AD_ROLL;
            break;
        case 33:
            AdWertRoll = (ADC + roll1 + 3) / 5;
            roll_filter = (long)(1 * (long)roll_filter + 4 * (long)(ADC + roll1) + 1) / 2;
            if(PlatinenVersion == 10) { AdWertRoll /= 2;roll_filter /=2;}
            HiResRoll = roll_filter - 20 * AdNeutralRoll;
            AdWertRollFilter = (long)(3L * (long)AdWertRollFilter + HiResRoll + 2) / 4;
            DebugOut.Analog[22] = AdWertRollFilter / 4;
            kanal = AD_ACC_X;
            break;
        case 34:
            Aktuell_ax = ADC - NeutralAccX;
            AdWertAccNick =  (Aktuell_ax + accx);
                    kanal = AD_NICK;
            state = 0;
                        AdReady = 1;
            ZaehlMessungen++;
            break;
        default:
            kanal = 0;
            state = 0;
            break;
        }
    ADMUX = kanal;
    if(state != 0) ANALOG_ON;
}
*/
 

Rev 1639	Rev 1643
1	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++	1	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
2	// + Copyright (c) Holger Buss, Ingo Busker	2	// + Copyright (c) Holger Buss, Ingo Busker
3	// + only for non-profit use	3	// + only for non-profit use
4	// + www.MikroKopter.com	4	// + www.MikroKopter.com
5	// + porting the sources to other systems or using the software on other systems (except hardware from www.mikrokopter.de) is not allowed	5	// + porting the sources to other systems or using the software on other systems (except hardware from www.mikrokopter.de) is not allowed
6	// + see the File "License.txt" for further Informations	6	// + see the File "License.txt" for further Informations
7	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++	7	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
8		8
9	#include "main.h"	9	#include "main.h"
10	#include "eeprom.h"	10	#include "eeprom.h"
11	volatile int Aktuell_Nick,Aktuell_Roll,Aktuell_Gier,Aktuell_ax, Aktuell_ay,Aktuell_az, UBat = 100;	11	volatile int Aktuell_Nick,Aktuell_Roll,Aktuell_Gier,Aktuell_ax, Aktuell_ay,Aktuell_az, UBat = 100;
12	volatile int AdWertNickFilter = 0, AdWertRollFilter = 0, AdWertGierFilter = 0;	12	volatile int AdWertNickFilter = 0, AdWertRollFilter = 0, AdWertGierFilter = 0;
13	volatile int HiResNick = 2500, HiResRoll = 2500;	13	volatile int HiResNick = 2500, HiResRoll = 2500;
14	volatile int AdWertNick = 0, AdWertRoll = 0, AdWertGier = 0;	14	volatile int AdWertNick = 0, AdWertRoll = 0, AdWertGier = 0;
15	volatile int AdWertAccRoll = 0,AdWertAccNick = 0,AdWertAccHoch = 0;	15	volatile int AdWertAccRoll = 0,AdWertAccNick = 0,AdWertAccHoch = 0;
16	volatile char messanzahl_AccHoch = 0;	16	volatile char messanzahl_AccHoch = 0;
17	volatile long Luftdruck = 32000;	17	volatile long Luftdruck = 32000;
18	volatile long SummenHoehe = 0;	18	volatile long SummenHoehe = 0;
19	volatile int StartLuftdruck;	19	volatile int StartLuftdruck;
20	volatile unsigned int MessLuftdruck = 1023;	20	volatile unsigned int MessLuftdruck = 1023;
21	unsigned char DruckOffsetSetting;	21	unsigned char DruckOffsetSetting;
22	signed char ExpandBaro = 0;	22	signed char ExpandBaro = 0;
23	volatile int VarioMeter = 0;	23	volatile int VarioMeter = 0;
24	volatile unsigned int ZaehlMessungen = 0;	24	volatile unsigned int ZaehlMessungen = 0;
25	unsigned char AnalogOffsetNick = 115,AnalogOffsetRoll = 115,AnalogOffsetGier = 115;	25	unsigned char AnalogOffsetNick = 115,AnalogOffsetRoll = 115,AnalogOffsetGier = 115;
26	unsigned char GyroDefektN = 0,GyroDefektR = 0,GyroDefektG = 0;	26	unsigned char GyroDefektN = 0,GyroDefektR = 0,GyroDefektG = 0;
27	volatile unsigned char AdReady = 1;	27	volatile unsigned char AdReady = 1;
-		28	float NeutralAccZ_float;
28	//#######################################################################################	29	//#######################################################################################
29	//	30	//
30	void ADC_Init(void)	31	void ADC_Init(void)
31	//#######################################################################################	32	//#######################################################################################
32	{	33	{
33	ADMUX = 0;//Referenz ist extern	34	ADMUX = 0;//Referenz ist extern
34	ANALOG_ON;	35	ANALOG_ON;
35	}	36	}
36		37
37	#define DESIRED_H_ADC 800	38	#define DESIRED_H_ADC 800
38		39
39	void SucheLuftruckOffset(void)	40	void SucheLuftruckOffset(void)
40	{	41	{
41	unsigned int off;	42	unsigned int off;
42	off = GetParamByte(PID_PRESSURE_OFFSET);	43	off = GetParamByte(PID_PRESSURE_OFFSET);
43	if(off > 20) off -= 10;	44	if(off > 20) off -= 10;
44	OCR0A = off;	45	OCR0A = off;
45	ExpandBaro = 0;	46	ExpandBaro = 0;
46	Delay_ms_Mess(100);	47	Delay_ms_Mess(100);
47	if(MessLuftdruck < DESIRED_H_ADC) off = 0;	48	if(MessLuftdruck < DESIRED_H_ADC) off = 0;
48	for(; off < 250;off++)	49	for(; off < 250;off++)
49	{	50	{
50	OCR0A = off;	51	OCR0A = off;
51	Delay_ms_Mess(50);	52	Delay_ms_Mess(50);
52	printf(".");	53	printf(".");
53	if(MessLuftdruck < DESIRED_H_ADC) break;	54	if(MessLuftdruck < DESIRED_H_ADC) break;
54	}	55	}
55	SetParamByte(PID_PRESSURE_OFFSET, off);	56	SetParamByte(PID_PRESSURE_OFFSET, off);
56	DruckOffsetSetting = off;	57	DruckOffsetSetting = off;
57	OCR0A = off;	58	OCR0A = off;
58	Delay_ms_Mess(300);	59	Delay_ms_Mess(300);
59		60
60	}	61	}
61		62
62	void SucheGyroOffset(void)	63	void SucheGyroOffset(void)
63	{	64	{
64	unsigned char i, ready = 0;	65	unsigned char i, ready = 0;
65	int timeout;	66	int timeout;
66	GyroDefektN = 0; GyroDefektR = 0; GyroDefektG = 0;	67	GyroDefektN = 0; GyroDefektR = 0; GyroDefektG = 0;
67	timeout = SetDelay(2000);	68	timeout = SetDelay(2000);
68	for(i=140; i != 0; i--)	69	for(i=140; i != 0; i--)
69	{	70	{
70	if(ready == 3 && i > 10) i = 9;	71	if(ready == 3 && i > 10) i = 9;
71	ready = 0;	72	ready = 0;
72	if(AdWertNick < 1020) AnalogOffsetNick--; else if(AdWertNick > 1030) AnalogOffsetNick++; else ready++;	73	if(AdWertNick < 1020) AnalogOffsetNick--; else if(AdWertNick > 1030) AnalogOffsetNick++; else ready++;
73	if(AdWertRoll < 1020) AnalogOffsetRoll--; else if(AdWertRoll > 1030) AnalogOffsetRoll++; else ready++;	74	if(AdWertRoll < 1020) AnalogOffsetRoll--; else if(AdWertRoll > 1030) AnalogOffsetRoll++; else ready++;
74	if(AdWertGier < 1020) AnalogOffsetGier--; else if(AdWertGier > 1030) AnalogOffsetGier++; else ready++;	75	if(AdWertGier < 1020) AnalogOffsetGier--; else if(AdWertGier > 1030) AnalogOffsetGier++; else ready++;
75	twi_state = 18;	76	twi_state = 18;
76	I2C_Start();	77	I2C_Start();
77	if(AnalogOffsetNick < 10) { GyroDefektN = 1; AnalogOffsetNick = 10;}; if(AnalogOffsetNick > 245) { GyroDefektN = 1; AnalogOffsetNick = 245;};	78	if(AnalogOffsetNick < 10) { GyroDefektN = 1; AnalogOffsetNick = 10;}; if(AnalogOffsetNick > 245) { GyroDefektN = 1; AnalogOffsetNick = 245;};
78	if(AnalogOffsetRoll < 10) { GyroDefektR = 1; AnalogOffsetRoll = 10;}; if(AnalogOffsetRoll > 245) { GyroDefektR = 1; AnalogOffsetRoll = 245;};	79	if(AnalogOffsetRoll < 10) { GyroDefektR = 1; AnalogOffsetRoll = 10;}; if(AnalogOffsetRoll > 245) { GyroDefektR = 1; AnalogOffsetRoll = 245;};
79	if(AnalogOffsetGier < 10) { GyroDefektG = 1; AnalogOffsetGier = 10;}; if(AnalogOffsetGier > 245) { GyroDefektG = 1; AnalogOffsetGier = 245;};	80	if(AnalogOffsetGier < 10) { GyroDefektG = 1; AnalogOffsetGier = 10;}; if(AnalogOffsetGier > 245) { GyroDefektG = 1; AnalogOffsetGier = 245;};
80	while(twi_state) if(CheckDelay(timeout)) {printf("\n\r DAC or I2C ERROR! Check I2C, 3Vref, DAC and BL-Ctrl"); break;}	81	while(twi_state) if(CheckDelay(timeout)) {printf("\n\r DAC or I2C ERROR! Check I2C, 3Vref, DAC and BL-Ctrl"); break;}
81	AdReady = 0;	82	AdReady = 0;
82	ANALOG_ON;	83	ANALOG_ON;
83	while(!AdReady);	84	while(!AdReady);
84	if(i<10) Delay_ms_Mess(10);	85	if(i<10) Delay_ms_Mess(10);
85	}	86	}
86	Delay_ms_Mess(70);	87	Delay_ms_Mess(70);
87	}	88	}
88		89
89	/*	90	/*
90	0 n	91	0 n
91	1 r	92	1 r
92	2 g	93	2 g
93	3 y	94	3 y
94	4 x	95	4 x
95	5 n	96	5 n
96	6 r	97	6 r
97	7 u	98	7 u
98	8 z	99	8 z
99	9 L	100	9 L
100	10 n	101	10 n
101	11 r	102	11 r
102	12 g	103	12 g
103	13 y	104	13 y
104	14 x	105	14 x
105	15 n	106	15 n
106	16 r	107	16 r
107	17 L	108	17 L
108	*/	109	*/
109		110
110	//#######################################################################################	111	//#######################################################################################
111	//	112	//
112	ISR(ADC_vect)	113	ISR(ADC_vect)
113	//#######################################################################################	114	//#######################################################################################
114	{	115	{
115	static unsigned char kanal=0,state = 0;	116	static unsigned char kanal=0,state = 0;
116	static signed int gier1, roll1, nick1, nick_filter, roll_filter;	117	static signed int gier1, roll1, nick1, nick_filter, roll_filter;
117	static signed int accy, accx,subcount = 0;	118	static signed int accy, accx,subcount = 0;
118		119
119	static long tmpLuftdruck = 0;	120	static long tmpLuftdruck = 0;
120	static char messanzahl_Druck = 0;	121	static char messanzahl_Druck = 0;
121	switch(state++)	122	switch(state++)
122	{	123	{
123	case 0:	124	case 0:
124	nick1 = ADC;	125	nick1 = ADC;
125	kanal = AD_ROLL;	126	kanal = AD_ROLL;
126	break;	127	break;
127	case 1:	128	case 1:
128	roll1 = ADC;	129	roll1 = ADC;
129	kanal = AD_GIER;	130	kanal = AD_GIER;
130	break;	131	break;
131	case 2:	132	case 2:
132	gier1 = ADC;	133	gier1 = ADC;
133	kanal = AD_ACC_Y;	134	kanal = AD_ACC_Y;
134	break;	135	break;
135	case 3:	136	case 3:
136	Aktuell_ay = NeutralAccY - ADC;	137	Aktuell_ay = NeutralAccY - ADC;
137	accy = Aktuell_ay;	138	accy = Aktuell_ay;
138	kanal = AD_ACC_X;	139	kanal = AD_ACC_X;
139	break;	140	break;
140	case 4:	141	case 4:
141	Aktuell_ax = ADC - NeutralAccX;	142	Aktuell_ax = ADC - NeutralAccX;
142	accx = Aktuell_ax;	143	accx = Aktuell_ax;
143	kanal = AD_NICK;	144	kanal = AD_NICK;
144	break;	145	break;
145	case 5:	146	case 5:
146	nick1 += ADC;	147	nick1 += ADC;
147	kanal = AD_ROLL;	148	kanal = AD_ROLL;
148	break;	149	break;
149	case 6:	150	case 6:
150	roll1 += ADC;	151	roll1 += ADC;
151	kanal = AD_UBAT;	152	kanal = AD_UBAT;
152	break;	153	break;
153	case 7:	154	case 7:
154	UBat = (3 * UBat + ADC / 3) / 4;	155	UBat = (3 * UBat + ADC / 3) / 4;
155	kanal = AD_ACC_Z;	156	kanal = AD_ACC_Z;
156	break;	157	break;
157	case 8:	158	case 8:
-		159
158	AdWertAccHoch = (signed int) ADC - NeutralAccZ;	160	AdWertAccHoch = (signed int) ADC - NeutralAccZ;
159	if(AdWertAccHoch > 1)	161	if(AdWertAccHoch > 1)
160	{	162	{
161	if(NeutralAccZ < 750)	163	if(NeutralAccZ < 750)
162	{	164	{
163	subcount += 2;	165	subcount += 2;
164	if(modell_fliegt < 500) subcount += 100;	166	if(modell_fliegt < 500) subcount += 100;
165	}	167	}
166	if(subcount > 1000) { NeutralAccZ++; subcount -= 1000;}	168	if(subcount > 1000) { NeutralAccZ++; subcount -= 1000;}
167	}	169	}
168	else if(AdWertAccHoch < -1)	170	else if(AdWertAccHoch < -1)
169	{	171	{
170	if(NeutralAccZ > 550)	172	if(NeutralAccZ > 550)
171	{	173	{
172	subcount -= 2;	174	subcount -= 2;
173	if(modell_fliegt < 500) subcount -= 100;	175	if(modell_fliegt < 500) subcount -= 100;
174	if(subcount < -1000) { NeutralAccZ--; subcount += 1000;}	176	if(subcount < -1000) { NeutralAccZ--; subcount += 1000;}
175	}	177	}
176	}	178	}
177	messanzahl_AccHoch = 1;	-
178	Aktuell_az = ADC;	-
179	Mess_Integral_Hoch += AdWertAccHoch; // Integrieren	-
180	Mess_Integral_Hoch -= Mess_Integral_Hoch / 1024; // dämfen	-
181		-
182	/*	179	/*
183	AdWertAccHoch = (signed int) ADC - NeutralAccZ;	180	AdWertAccHoch = (signed int) ADC - NeutralAccZ_float;
184	if(AdWertAccHoch > 1)	181	if(AdWertAccHoch > 1)
185	{	182	{
186	if(NeutralAccZ < 750)	183	if(NeutralAccZ_float < 750)
187	{	184	{
188	NeutralAccZ += 0.02;	185	NeutralAccZ_float += 0.02;
189	if(modell_fliegt < 500) NeutralAccZ += 0.1;	186	if(modell_fliegt < 500) NeutralAccZ_float += 0.1;
190	}	187	}
191	}	188	}
192	else if(AdWertAccHoch < -1)	189	else if(AdWertAccHoch < -1)
193	{	190	{
194	if(NeutralAccZ > 550)	191	if(NeutralAccZ_float > 550)
195	{	192	{
196	NeutralAccZ-= 0.02;	193	NeutralAccZ_float-= 0.02;
197	if(modell_fliegt < 500) NeutralAccZ -= 0.1;	194	if(modell_fliegt < 500) NeutralAccZ_float -= 0.1;
198	}	195	}
199	}	196	}
-		197	*/
200	messanzahl_AccHoch = 1;	198	messanzahl_AccHoch = 1;
201	Aktuell_az = ADC;	199	Aktuell_az = ADC;
202	Mess_Integral_Hoch += AdWertAccHoch; // Integrieren	200	Mess_Integral_Hoch += AdWertAccHoch; // Integrieren
203	Mess_Integral_Hoch -= Mess_Integral_Hoch / 1024; // dämfen	201	Mess_Integral_Hoch -= Mess_Integral_Hoch / 1024; // dämfen
204	*/	-
205	kanal = AD_DRUCK;	202	kanal = AD_DRUCK;
206	break;	203	break;
207	// "case 8:" fehlt hier absichtlich	204	// "case 8:" fehlt hier absichtlich
208	case 10:	205	case 10:
209	nick1 += ADC;	206	nick1 += ADC;
210	kanal = AD_ROLL;	207	kanal = AD_ROLL;
211	break;	208	break;
212	case 11:	209	case 11:
213	roll1 += ADC;	210	roll1 += ADC;
214	kanal = AD_GIER;	211	kanal = AD_GIER;
215	break;	212	break;
216	case 12:	213	case 12:
217	if(PlatinenVersion == 10) AdWertGier = (ADC + gier1 + 1) / 2;	214	if(PlatinenVersion == 10) AdWertGier = (ADC + gier1 + 1) / 2;
218	else	215	else
219	if(PlatinenVersion == 20) AdWertGier = 2047 - (ADC + gier1);	216	if(PlatinenVersion == 20) AdWertGier = 2047 - (ADC + gier1);
220	else AdWertGier = (ADC + gier1);	217	else AdWertGier = (ADC + gier1);
221	kanal = AD_ACC_Y;	218	kanal = AD_ACC_Y;
222	break;	219	break;
223	case 13:	220	case 13:
224	Aktuell_ay = NeutralAccY - ADC;	221	Aktuell_ay = NeutralAccY - ADC;
225	AdWertAccRoll = (Aktuell_ay + accy);	222	AdWertAccRoll = (Aktuell_ay + accy);
226	kanal = AD_ACC_X;	223	kanal = AD_ACC_X;
227	break;	224	break;
228	case 14:	225	case 14:
229	Aktuell_ax = ADC - NeutralAccX;	226	Aktuell_ax = ADC - NeutralAccX;
230	AdWertAccNick = (Aktuell_ax + accx);	227	AdWertAccNick = (Aktuell_ax + accx);
231	kanal = AD_NICK;	228	kanal = AD_NICK;
232	break;	229	break;
233	case 15:	230	case 15:
234	nick1 += ADC;	231	nick1 += ADC;
235	if(PlatinenVersion == 10) nick1 = 2; else nick1 = 4;	232	if(PlatinenVersion == 10) nick1 = 2; else nick1 = 4;
236	AdWertNick = nick1 / 8;	233	AdWertNick = nick1 / 8;
237	nick_filter = (nick_filter + nick1) / 2;	234	nick_filter = (nick_filter + nick1) / 2;
238	HiResNick = nick_filter - AdNeutralNick;	235	HiResNick = nick_filter - AdNeutralNick;
239	AdWertNickFilter = (AdWertNickFilter + HiResNick) / 2;	236	AdWertNickFilter = (AdWertNickFilter + HiResNick) / 2;
240	kanal = AD_ROLL;	237	kanal = AD_ROLL;
241	break;	238	break;
242	case 16:	239	case 16:
243	roll1 += ADC;	240	roll1 += ADC;
244	if(PlatinenVersion == 10) roll1 = 2; else roll1 = 4;	241	if(PlatinenVersion == 10) roll1 = 2; else roll1 = 4;
245	AdWertRoll = roll1 / 8;	242	AdWertRoll = roll1 / 8;
246	roll_filter = (roll_filter + roll1) / 2;	243	roll_filter = (roll_filter + roll1) / 2;
247	HiResRoll = roll_filter - AdNeutralRoll;	244	HiResRoll = roll_filter - AdNeutralRoll;
248	AdWertRollFilter = (AdWertRollFilter + HiResRoll) / 2;	245	AdWertRollFilter = (AdWertRollFilter + HiResRoll) / 2;
249	kanal = AD_DRUCK;	246	kanal = AD_DRUCK;
250	break;	247	break;
251	case 17:	248	case 17:
252	state = 0;	249	state = 0;
253	AdReady = 1;	250	AdReady = 1;
254	ZaehlMessungen++;	251	ZaehlMessungen++;
255	// "break" fehlt hier absichtlich	252	// "break" fehlt hier absichtlich
256	case 9:	253	case 9:
257	MessLuftdruck = ADC;	254	MessLuftdruck = ADC;
258	tmpLuftdruck += MessLuftdruck;	255	tmpLuftdruck += MessLuftdruck;
259	if(++messanzahl_Druck >= 18)	256	if(++messanzahl_Druck >= 18)
260	{	257	{
261	Luftdruck = (7 * Luftdruck + tmpLuftdruck - (18 * 523) * (long)ExpandBaro + 4) / 8; // -523.19 counts per 10 counts offset step	258	Luftdruck = (7 * Luftdruck + tmpLuftdruck - (18 * 523) * (long)ExpandBaro + 4) / 8; // -523.19 counts per 10 counts offset step
262	HoehenWert = StartLuftdruck - Luftdruck;	259	HoehenWert = StartLuftdruck - Luftdruck;
263	SummenHoehe -= SummenHoehe/SM_FILTER;	260	SummenHoehe -= SummenHoehe/SM_FILTER;
264	SummenHoehe += HoehenWert;	261	SummenHoehe += HoehenWert;
265	VarioMeter = (15 * VarioMeter + 8 * (int)(HoehenWert - SummenHoehe/SM_FILTER))/16;	262	VarioMeter = (15 * VarioMeter + 8 * (int)(HoehenWert - SummenHoehe/SM_FILTER))/16;
266	tmpLuftdruck /= 2;	263	tmpLuftdruck /= 2;
267	messanzahl_Druck = 18/2;	264	messanzahl_Druck = 18/2;
268	}	265	}
269	kanal = AD_NICK;	266	kanal = AD_NICK;
270	break;	267	break;
271	default:	268	default:
272	kanal = 0; state = 0; kanal = AD_NICK;	269	kanal = 0; state = 0; kanal = AD_NICK;
273	break;	270	break;
274	}	271	}
275	ADMUX = kanal;	272	ADMUX = kanal;
276	if(state != 0) ANALOG_ON;	273	if(state != 0) ANALOG_ON;
277		274
278	}	275	}
279		276
280		277
281		278
282	/*	279	/*
283	//#######################################################################################	280	//#######################################################################################
284	//	281	//
285	SIGNAL(SIG_ADC)	282	SIGNAL(SIG_ADC)
286	//#######################################################################################	283	//#######################################################################################
287	{	284	{
288	static unsigned char kanal=0,state = 0;	285	static unsigned char kanal=0,state = 0;
289	static signed int gier1, roll1, nick1;	286	static signed int gier1, roll1, nick1;
290	static signed long nick_filter, roll_filter;	287	static signed long nick_filter, roll_filter;
291	static signed int accy, accx;	288	static signed int accy, accx;
292	switch(state++)	289	switch(state++)
293	{	290	{
294	case 0:	291	case 0:
295	nick1 = ADC;	292	nick1 = ADC;
296	kanal = AD_ROLL;	293	kanal = AD_ROLL;
297	break;	294	break;
298	case 1:	295	case 1:
299	roll1 = ADC;	296	roll1 = ADC;
300	kanal = AD_GIER;	297	kanal = AD_GIER;
301	break;	298	break;
302	case 2:	299	case 2:
303	gier1 = ADC;	300	gier1 = ADC;
304	kanal = AD_ACC_Y;	301	kanal = AD_ACC_Y;
305	break;	302	break;
306	case 3:	303	case 3:
307	Aktuell_ay = NeutralAccY - ADC;	304	Aktuell_ay = NeutralAccY - ADC;
308	accy = Aktuell_ay;	305	accy = Aktuell_ay;
309	kanal = AD_NICK;	306	kanal = AD_NICK;
310	break;	307	break;
311	case 4:	308	case 4:
312	nick1 += ADC;	309	nick1 += ADC;
313	kanal = AD_ROLL;	310	kanal = AD_ROLL;
314	break;	311	break;
315	case 5:	312	case 5:
316	roll1 += ADC;	313	roll1 += ADC;
317	kanal = AD_ACC_Z;	314	kanal = AD_ACC_Z;
318	break;	315	break;
319	case 6:	316	case 6:
320	AdWertAccHoch = (signed int) ADC - NeutralAccZ;	317	AdWertAccHoch = (signed int) ADC - NeutralAccZ;
321	if(AdWertAccHoch > 1)	318	if(AdWertAccHoch > 1)
322	{	319	{
323	if(NeutralAccZ < 750)	320	if(NeutralAccZ < 750)
324	{	321	{
325	NeutralAccZ += 0.02;	322	NeutralAccZ += 0.02;
326	if(modell_fliegt < 500) NeutralAccZ += 0.1;	323	if(modell_fliegt < 500) NeutralAccZ += 0.1;
327	}	324	}
328	}	325	}
329	else if(AdWertAccHoch < -1)	326	else if(AdWertAccHoch < -1)
330	{	327	{
331	if(NeutralAccZ > 550)	328	if(NeutralAccZ > 550)
332	{	329	{
333	NeutralAccZ-= 0.02;	330	NeutralAccZ-= 0.02;
334	if(modell_fliegt < 500) NeutralAccZ -= 0.1;	331	if(modell_fliegt < 500) NeutralAccZ -= 0.1;
335	}	332	}
336	}	333	}
337	messanzahl_AccHoch = 1;	334	messanzahl_AccHoch = 1;
338	Aktuell_az = ADC;	335	Aktuell_az = ADC;
339	Mess_Integral_Hoch += AdWertAccHoch; // Integrieren	336	Mess_Integral_Hoch += AdWertAccHoch; // Integrieren
340	Mess_Integral_Hoch -= Mess_Integral_Hoch / 1024; // dämfen	337	Mess_Integral_Hoch -= Mess_Integral_Hoch / 1024; // dämfen
341	kanal = AD_NICK;	338	kanal = AD_NICK;
342	break;	339	break;
343	case 7:	340	case 7:
344	nick1 += ADC;	341	nick1 += ADC;
345	kanal = AD_ROLL;	342	kanal = AD_ROLL;
346	break;	343	break;
347	case 8:	344	case 8:
348	roll1 += ADC;	345	roll1 += ADC;
349	kanal = AD_ACC_X;	346	kanal = AD_ACC_X;
350	break;	347	break;
351	case 9:	348	case 9:
352	Aktuell_ax = ADC - NeutralAccX;	349	Aktuell_ax = ADC - NeutralAccX;
353	accx = Aktuell_ax;	350	accx = Aktuell_ax;
354	kanal = AD_GIER;	351	kanal = AD_GIER;
355	break;	352	break;
356	case 10:	353	case 10:
357	gier1 += ADC;	354	gier1 += ADC;
358	kanal = AD_NICK;	355	kanal = AD_NICK;
359	break;	356	break;
360	case 11:	357	case 11:
361	nick1 += ADC;	358	nick1 += ADC;
362	kanal = AD_ROLL;	359	kanal = AD_ROLL;
363	break;	360	break;
364	case 12:	361	case 12:
365	roll1 += ADC;	362	roll1 += ADC;
366	kanal = AD_UBAT;	363	kanal = AD_UBAT;
367	break;	364	break;
368	case 13:	365	case 13:
369	UBat = (3 * UBat + ADC / 3) / 4;//(UBat + ((ADC * 39) / 256) + 19) / 2;	366	UBat = (3 * UBat + ADC / 3) / 4;//(UBat + ((ADC * 39) / 256) + 19) / 2;
370	kanal = AD_ACC_Y;	367	kanal = AD_ACC_Y;
371	break;	368	break;
372	case 14:	369	case 14:
373	Aktuell_ay = NeutralAccY - ADC;	370	Aktuell_ay = NeutralAccY - ADC;
374	accy += Aktuell_ay;	371	accy += Aktuell_ay;
375	kanal = AD_NICK;	372	kanal = AD_NICK;
376	break;	373	break;
377	case 15:	374	case 15:
378	nick1 += ADC;	375	nick1 += ADC;
379	kanal = AD_ROLL;	376	kanal = AD_ROLL;
380	break;	377	break;
381	case 16:	378	case 16:
382	roll1 += ADC;	379	roll1 += ADC;
383	kanal = AD_ACC_X;	380	kanal = AD_ACC_X;
384	break;	381	break;
385	case 17:	382	case 17:
386	Aktuell_ax = ADC - NeutralAccX;	383	Aktuell_ax = ADC - NeutralAccX;
387	accx += Aktuell_ax;	384	accx += Aktuell_ax;
388	kanal = AD_NICK;	385	kanal = AD_NICK;
389	break;	386	break;
390	case 18:	387	case 18:
391	nick1 += ADC;	388	nick1 += ADC;
392	kanal = AD_ROLL;	389	kanal = AD_ROLL;
393	break;	390	break;
394	case 19:	391	case 19:
395	roll1 += ADC;	392	roll1 += ADC;
396	kanal = AD_GIER;	393	kanal = AD_GIER;
397	break;	394	break;
398	case 20:	395	case 20:
399	gier1 += ADC;	396	gier1 += ADC;
400	kanal = AD_ACC_Y;	397	kanal = AD_ACC_Y;
401	break;	398	break;
402	case 21:	399	case 21:
403	Aktuell_ay = NeutralAccY - ADC;	400	Aktuell_ay = NeutralAccY - ADC;
404	accy += Aktuell_ay;	401	accy += Aktuell_ay;
405	kanal = AD_NICK;	402	kanal = AD_NICK;
406	break;	403	break;
407	case 22:	404	case 22:
408	nick1 += ADC;	405	nick1 += ADC;
409	kanal = AD_ROLL;	406	kanal = AD_ROLL;
410	break;	407	break;
411	case 23:	408	case 23:
412	roll1 += ADC;	409	roll1 += ADC;
413	kanal = AD_DRUCK;	410	kanal = AD_DRUCK;
414	break;	411	break;
415	case 24:	412	case 24:
416	tmpLuftdruck += ADC;	413	tmpLuftdruck += ADC;
417	if(++messanzahl_Druck >= 5)	414	if(++messanzahl_Druck >= 5)
418	{	415	{
419	MessLuftdruck = ADC;	416	MessLuftdruck = ADC;
420	messanzahl_Druck = 0;	417	messanzahl_Druck = 0;
421	HoeheD = (7 * HoeheD + (int) Parameter_Luftdruck_D * (int)(255 * ExpandBaro + StartLuftdruck - tmpLuftdruck - HoehenWert)) / 8; // D-Anteil = neuerWert - AlterWert	418	HoeheD = (7 * HoeheD + (int) Parameter_Luftdruck_D * (int)(255 * ExpandBaro + StartLuftdruck - tmpLuftdruck - HoehenWert)) / 8; // D-Anteil = neuerWert - AlterWert
422	Luftdruck = (tmpLuftdruck + 3 * Luftdruck) / 4;	419	Luftdruck = (tmpLuftdruck + 3 * Luftdruck) / 4;
423	HoehenWert = 255 * ExpandBaro + StartLuftdruck - Luftdruck;	420	HoehenWert = 255 * ExpandBaro + StartLuftdruck - Luftdruck;
424	tmpLuftdruck = 0;	421	tmpLuftdruck = 0;
425	}	422	}
426	kanal = AD_NICK;	423	kanal = AD_NICK;
427	break;	424	break;
428	case 25:	425	case 25:
429	nick1 += ADC;	426	nick1 += ADC;
430	kanal = AD_ROLL;	427	kanal = AD_ROLL;
431	break;	428	break;
432	case 26:	429	case 26:
433	roll1 += ADC;	430	roll1 += ADC;
434	kanal = AD_ACC_X;	431	kanal = AD_ACC_X;
435	break;	432	break;
436	case 27:	433	case 27:
437	Aktuell_ax = ADC - NeutralAccX;	434	Aktuell_ax = ADC - NeutralAccX;
438	accx += Aktuell_ax;	435	accx += Aktuell_ax;
439	kanal = AD_GIER;	436	kanal = AD_GIER;
440	break;	437	break;
441	case 28:	438	case 28:
442	if(PlatinenVersion == 10) AdWertGier = (ADC + gier1 + 2) / 4;	439	if(PlatinenVersion == 10) AdWertGier = (ADC + gier1 + 2) / 4;
443	else	440	else
444	if(PlatinenVersion == 20) AdWertGier = 2047 - (ADC + gier1 + 1) / 2;	441	if(PlatinenVersion == 20) AdWertGier = 2047 - (ADC + gier1 + 1) / 2;
445	else AdWertGier = (ADC + gier1 + 1) / 2;	442	else AdWertGier = (ADC + gier1 + 1) / 2;
446	kanal = AD_NICK;	443	kanal = AD_NICK;
447	break;	444	break;
448	case 29:	445	case 29:
449	nick1 += ADC;	446	nick1 += ADC;
450	kanal = AD_ROLL;	447	kanal = AD_ROLL;
451	break;	448	break;
452	case 30:	449	case 30:
453	roll1 += ADC;	450	roll1 += ADC;
454	kanal = AD_ACC_Y;	451	kanal = AD_ACC_Y;
455	break;	452	break;
456	case 31:	453	case 31:
457	Aktuell_ay = NeutralAccY - ADC;	454	Aktuell_ay = NeutralAccY - ADC;
458	AdWertAccRoll = (Aktuell_ay + accy);	455	AdWertAccRoll = (Aktuell_ay + accy);
459	kanal = AD_NICK;	456	kanal = AD_NICK;
460	break;	457	break;
461	case 32:	458	case 32:
462	AdWertNick = (ADC + nick1 + 3) / 5;	459	AdWertNick = (ADC + nick1 + 3) / 5;
463	nick_filter = (long) (1 * (long) nick_filter + 4 * (long)(ADC + nick1) + 1) / 2;	460	nick_filter = (long) (1 * (long) nick_filter + 4 * (long)(ADC + nick1) + 1) / 2;
464	if(PlatinenVersion == 10) { AdWertNick /= 2;nick_filter /=2;}	461	if(PlatinenVersion == 10) { AdWertNick /= 2;nick_filter /=2;}
465	HiResNick = nick_filter - 20 * AdNeutralNick;	462	HiResNick = nick_filter - 20 * AdNeutralNick;
466	AdWertNickFilter = (long)(3L * (long)AdWertNickFilter + HiResNick + 2) / 4;	463	AdWertNickFilter = (long)(3L * (long)AdWertNickFilter + HiResNick + 2) / 4;
467	DebugOut.Analog[21] = AdWertNickFilter / 4;	464	DebugOut.Analog[21] = AdWertNickFilter / 4;
468	kanal = AD_ROLL;	465	kanal = AD_ROLL;
469	break;	466	break;
470	case 33:	467	case 33:
471	AdWertRoll = (ADC + roll1 + 3) / 5;	468	AdWertRoll = (ADC + roll1 + 3) / 5;
472	roll_filter = (long)(1 * (long)roll_filter + 4 * (long)(ADC + roll1) + 1) / 2;	469	roll_filter = (long)(1 * (long)roll_filter + 4 * (long)(ADC + roll1) + 1) / 2;
473	if(PlatinenVersion == 10) { AdWertRoll /= 2;roll_filter /=2;}	470	if(PlatinenVersion == 10) { AdWertRoll /= 2;roll_filter /=2;}
474	HiResRoll = roll_filter - 20 * AdNeutralRoll;	471	HiResRoll = roll_filter - 20 * AdNeutralRoll;
475	AdWertRollFilter = (long)(3L * (long)AdWertRollFilter + HiResRoll + 2) / 4;	472	AdWertRollFilter = (long)(3L * (long)AdWertRollFilter + HiResRoll + 2) / 4;
476	DebugOut.Analog[22] = AdWertRollFilter / 4;	473	DebugOut.Analog[22] = AdWertRollFilter / 4;
477	kanal = AD_ACC_X;	474	kanal = AD_ACC_X;
478	break;	475	break;
479	case 34:	476	case 34:
480	Aktuell_ax = ADC - NeutralAccX;	477	Aktuell_ax = ADC - NeutralAccX;
481	AdWertAccNick = (Aktuell_ax + accx);	478	AdWertAccNick = (Aktuell_ax + accx);
482	kanal = AD_NICK;	479	kanal = AD_NICK;
483	state = 0;	480	state = 0;
484	AdReady = 1;	481	AdReady = 1;
485	ZaehlMessungen++;	482	ZaehlMessungen++;
486	break;	483	break;
487	default:	484	default:
488	kanal = 0;	485	kanal = 0;
489	state = 0;	486	state = 0;
490	break;	487	break;
491	}	488	}
492	ADMUX = kanal;	489	ADMUX = kanal;
493	if(state != 0) ANALOG_ON;	490	if(state != 0) ANALOG_ON;
494	}	491	}
495	*/	492	*/
496		493

Subversion Repositories FlightCtrl

(root)/tags/V2.06e/analog.c @ 2690 - Rev 1639 → 1643