Rev 871 | Rev 921 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 871 | Rev 918 | ||
---|---|---|---|
Line 18... | Line 18... | ||
18 | unsigned char DruckOffsetSetting; |
18 | unsigned char DruckOffsetSetting; |
19 | volatile int HoeheD = 0; |
19 | volatile int HoeheD = 0; |
20 | volatile char messanzahl_Druck; |
20 | volatile char messanzahl_Druck; |
21 | volatile int tmpLuftdruck; |
21 | volatile int tmpLuftdruck; |
22 | volatile unsigned int ZaehlMessungen = 0; |
22 | volatile unsigned int ZaehlMessungen = 0; |
23 | - | ||
- | 23 | unsigned char AnalogOffsetNick = 115,AnalogOffsetRoll = 115,AnalogOffsetGier = 115; |
|
- | 24 | unsigned char GyroDefektN = 0,GyroDefektR = 0,GyroDefektG = 0; |
|
24 | //####################################################################################### |
25 | //####################################################################################### |
25 | // |
26 | // |
26 | void ADC_Init(void) |
27 | void ADC_Init(void) |
27 | //####################################################################################### |
28 | //####################################################################################### |
28 | { |
29 | { |
Line 49... | Line 50... | ||
49 | eeprom_write_byte(&EEPromArray[EEPROM_ADR_LAST_OFFSET], off); |
50 | eeprom_write_byte(&EEPromArray[EEPROM_ADR_LAST_OFFSET], off); |
50 | DruckOffsetSetting = off; |
51 | DruckOffsetSetting = off; |
51 | Delay_ms_Mess(300); |
52 | Delay_ms_Mess(300); |
52 | } |
53 | } |
Line -... | Line 54... | ||
- | 54 | ||
- | 55 | void SucheGyroOffset(void) |
|
- | 56 | { |
|
- | 57 | unsigned char i, ready = 0; |
|
- | 58 | GyroDefektN = 0; GyroDefektR = 0; GyroDefektG = 0; |
|
- | 59 | for(i=140; i != 0; i--) |
|
- | 60 | { |
|
- | 61 | if(ready == 3 && i > 10) i = 5; |
|
- | 62 | ready = 0; |
|
- | 63 | if(AdWertNick < 1020) AnalogOffsetNick--; else if(AdWertNick > 1030) AnalogOffsetNick++; else ready++; |
|
- | 64 | if(AdWertRoll < 1020) AnalogOffsetRoll--; else if(AdWertRoll > 1030) AnalogOffsetRoll++; else ready++; |
|
- | 65 | if(AdWertGier < 1020) AnalogOffsetGier--; else if(AdWertGier > 1030) AnalogOffsetGier++; else ready++; |
|
- | 66 | twi_state = 8; |
|
- | 67 | i2c_start(); |
|
- | 68 | if(AnalogOffsetNick < 10) { GyroDefektN = 1; AnalogOffsetNick = 10;}; if(AnalogOffsetNick > 245) { GyroDefektN = 1; AnalogOffsetNick = 245;}; |
|
- | 69 | if(AnalogOffsetRoll < 10) { GyroDefektR = 1; AnalogOffsetRoll = 10;}; if(AnalogOffsetRoll > 245) { GyroDefektR = 1; AnalogOffsetRoll = 245;}; |
|
- | 70 | if(AnalogOffsetGier < 10) { GyroDefektG = 1; AnalogOffsetGier = 10;}; if(AnalogOffsetGier > 245) { GyroDefektG = 1; AnalogOffsetGier = 245;}; |
|
- | 71 | while(twi_state); |
|
- | 72 | messanzahl_Druck = 0; |
|
- | 73 | ANALOG_ON; |
|
- | 74 | while(messanzahl_Druck == 0); |
|
- | 75 | if(i<10) Delay_ms_Mess(10); |
|
- | 76 | } |
|
- | 77 | Delay_ms_Mess(50); |
|
- | 78 | } |
|
Line 53... | Line 79... | ||
53 | 79 | ||
54 | 80 | ||
55 | //####################################################################################### |
81 | //####################################################################################### |
56 | // |
82 | // |