Subversion Repositories FlightCtrl

Rev

Rev 1021 | Rev 1111 | Go to most recent revision | Show entire file | Regard whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 1021 Rev 1036
Line 14... Line 14...
14
volatile char messanzahl_AccNick = 0, messanzahl_AccRoll = 0, messanzahl_AccHoch = 0;
14
volatile char messanzahl_AccNick = 0, messanzahl_AccRoll = 0, messanzahl_AccHoch = 0;
15
volatile long Luftdruck = 32000;
15
volatile long Luftdruck = 32000;
16
volatile int  StartLuftdruck;
16
volatile int  StartLuftdruck;
17
volatile unsigned int  MessLuftdruck = 1023;
17
volatile unsigned int  MessLuftdruck = 1023;
18
unsigned char DruckOffsetSetting;
18
unsigned char DruckOffsetSetting;
-
 
19
signed char ExpandBaro = 0;
19
volatile int HoeheD = 0;
20
volatile int HoeheD = 0;
20
volatile char messanzahl_Druck;
21
volatile char messanzahl_Druck;
21
volatile int  tmpLuftdruck;
22
volatile int  tmpLuftdruck;
22
volatile unsigned int ZaehlMessungen = 0;
23
volatile unsigned int ZaehlMessungen = 0;
23
unsigned char AnalogOffsetNick = 115,AnalogOffsetRoll = 115,AnalogOffsetGier = 115;
24
unsigned char AnalogOffsetNick = 115,AnalogOffsetRoll = 115,AnalogOffsetGier = 115;
Line 36... Line 37...
36
{
37
{
37
 unsigned int off;
38
 unsigned int off;
38
 off = eeprom_read_byte(&EEPromArray[EEPROM_ADR_LAST_OFFSET]);
39
 off = eeprom_read_byte(&EEPromArray[EEPROM_ADR_LAST_OFFSET]);
39
 if(off > 20) off -= 10;
40
 if(off > 20) off -= 10;
40
 OCR0A = off;
41
 OCR0A = off;
-
 
42
 ExpandBaro = 0;
41
 Delay_ms_Mess(100);
43
 Delay_ms_Mess(100);
42
 if(MessLuftdruck < 850) off = 0;
44
 if(MessLuftdruck < 850) off = 0;
43
 for(; off < 250;off++)
45
 for(; off < 250;off++)
44
  {
46
  {
45
  OCR0A = off;
47
  OCR0A = off;
46
  Delay_ms_Mess(50);
48
  Delay_ms_Mess(50);
47
  printf(".");  
49
  printf(".");  
48
  if(MessLuftdruck < 900) break;
50
  if(MessLuftdruck < 850) break;
49
  }
51
  }
50
 eeprom_write_byte(&EEPromArray[EEPROM_ADR_LAST_OFFSET], off);
52
 eeprom_write_byte(&EEPromArray[EEPROM_ADR_LAST_OFFSET], off);
51
 DruckOffsetSetting = off;
53
 DruckOffsetSetting = off;
52
 Delay_ms_Mess(300);
54
 Delay_ms_Mess(300);
53
}
55
}
Line 163... Line 165...
163
            tmpLuftdruck += ADC;
165
            tmpLuftdruck += ADC;
164
            if(++messanzahl_Druck >= 5)
166
            if(++messanzahl_Druck >= 5)
165
                {
167
                {
166
                MessLuftdruck = ADC;
168
                MessLuftdruck = ADC;
167
                messanzahl_Druck = 0;
169
                messanzahl_Druck = 0;
168
                                HoeheD = (7 * HoeheD + (int) Parameter_Luftdruck_D * (int)(StartLuftdruck - tmpLuftdruck - HoehenWert))/8;  // D-Anteil = neuerWert - AlterWert
170
                                HoeheD = (7 * HoeheD + (int) Parameter_Luftdruck_D * (int)(255 * ExpandBaro + StartLuftdruck - tmpLuftdruck - HoehenWert))/8;  // D-Anteil = neuerWert - AlterWert
169
                Luftdruck = (tmpLuftdruck + 3 * Luftdruck) / 4;
171
                Luftdruck = (tmpLuftdruck + 3 * Luftdruck) / 4;
170
                HoehenWert = StartLuftdruck - Luftdruck;
172
                HoehenWert = 255 * ExpandBaro + StartLuftdruck - Luftdruck;
171
                tmpLuftdruck = 0;
173
                tmpLuftdruck = 0;
172
                }
174
                }
173
            kanal = 0;
175
            kanal = 0;
174
            state = 0;
176
            state = 0;
175
            break;
177
            break;