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;} |