Rev 1622 | Rev 1639 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 1622 | Rev 1638 | ||
---|---|---|---|
Line 52... | Line 52... | ||
52 | printf("."); |
52 | printf("."); |
53 | if(MessLuftdruck < DESIRED_H_ADC) break; |
53 | if(MessLuftdruck < DESIRED_H_ADC) break; |
54 | } |
54 | } |
55 | SetParamByte(PID_PRESSURE_OFFSET, off); |
55 | SetParamByte(PID_PRESSURE_OFFSET, off); |
56 | DruckOffsetSetting = off; |
56 | DruckOffsetSetting = off; |
- | 57 | OCR0A = off; |
|
57 | Delay_ms_Mess(300); |
58 | Delay_ms_Mess(300); |
- | 59 | ||
58 | } |
60 | } |
Line 59... | Line 61... | ||
59 | 61 | ||
60 | void SucheGyroOffset(void) |
62 | void SucheGyroOffset(void) |
61 | { |
63 | { |
Line 68... | Line 70... | ||
68 | if(ready == 3 && i > 10) i = 9; |
70 | if(ready == 3 && i > 10) i = 9; |
69 | ready = 0; |
71 | ready = 0; |
70 | if(AdWertNick < 1020) AnalogOffsetNick--; else if(AdWertNick > 1030) AnalogOffsetNick++; else ready++; |
72 | if(AdWertNick < 1020) AnalogOffsetNick--; else if(AdWertNick > 1030) AnalogOffsetNick++; else ready++; |
71 | if(AdWertRoll < 1020) AnalogOffsetRoll--; else if(AdWertRoll > 1030) AnalogOffsetRoll++; else ready++; |
73 | if(AdWertRoll < 1020) AnalogOffsetRoll--; else if(AdWertRoll > 1030) AnalogOffsetRoll++; else ready++; |
72 | if(AdWertGier < 1020) AnalogOffsetGier--; else if(AdWertGier > 1030) AnalogOffsetGier++; else ready++; |
74 | if(AdWertGier < 1020) AnalogOffsetGier--; else if(AdWertGier > 1030) AnalogOffsetGier++; else ready++; |
73 | twi_state = 8; |
75 | twi_state = 18; |
74 | i2c_start(); |
76 | i2c_start(); |
75 | if(AnalogOffsetNick < 10) { GyroDefektN = 1; AnalogOffsetNick = 10;}; if(AnalogOffsetNick > 245) { GyroDefektN = 1; AnalogOffsetNick = 245;}; |
77 | if(AnalogOffsetNick < 10) { GyroDefektN = 1; AnalogOffsetNick = 10;}; if(AnalogOffsetNick > 245) { GyroDefektN = 1; AnalogOffsetNick = 245;}; |
76 | if(AnalogOffsetRoll < 10) { GyroDefektR = 1; AnalogOffsetRoll = 10;}; if(AnalogOffsetRoll > 245) { GyroDefektR = 1; AnalogOffsetRoll = 245;}; |
78 | if(AnalogOffsetRoll < 10) { GyroDefektR = 1; AnalogOffsetRoll = 10;}; if(AnalogOffsetRoll > 245) { GyroDefektR = 1; AnalogOffsetRoll = 245;}; |
77 | if(AnalogOffsetGier < 10) { GyroDefektG = 1; AnalogOffsetGier = 10;}; if(AnalogOffsetGier > 245) { GyroDefektG = 1; AnalogOffsetGier = 245;}; |
79 | if(AnalogOffsetGier < 10) { GyroDefektG = 1; AnalogOffsetGier = 10;}; if(AnalogOffsetGier > 245) { GyroDefektG = 1; AnalogOffsetGier = 245;}; |
78 | while(twi_state) if(CheckDelay(timeout)) {printf("\n\r DAC or I2C ERROR! Check I2C, 3Vref, DAC and BL-Ctrl"); break;} |
80 | while(twi_state) if(CheckDelay(timeout)) {printf("\n\r DAC or I2C ERROR! Check I2C, 3Vref, DAC and BL-Ctrl"); break;} |