Rev 1726 | Rev 1793 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 1726 | Rev 1765 | ||
---|---|---|---|
Line 66... | Line 66... | ||
66 | printf("."); |
66 | printf("."); |
67 | if(MessLuftdruck < DESIRED_H_ADC) break; |
67 | if(MessLuftdruck < DESIRED_H_ADC) break; |
68 | } |
68 | } |
69 | DruckOffsetSetting = off; |
69 | DruckOffsetSetting = off; |
70 | } |
70 | } |
71 | #else |
71 | #else |
72 | off = GetParamByte(PID_PRESSURE_OFFSET); |
72 | off = GetParamByte(PID_PRESSURE_OFFSET); |
73 | if(off > 20) off -= 10; |
73 | if(off > 20) off -= 10; |
74 | OCR0A = off; |
74 | OCR0A = off; |
75 | Delay_ms_Mess(100); |
75 | Delay_ms_Mess(100); |
76 | if(MessLuftdruck < DESIRED_H_ADC) off = 0; |
76 | if(MessLuftdruck < DESIRED_H_ADC) off = 0; |
Line 82... | Line 82... | ||
82 | if(MessLuftdruck < DESIRED_H_ADC) break; |
82 | if(MessLuftdruck < DESIRED_H_ADC) break; |
83 | } |
83 | } |
84 | DruckOffsetSetting = off; |
84 | DruckOffsetSetting = off; |
85 | SetParamByte(PID_PRESSURE_OFFSET, off); |
85 | SetParamByte(PID_PRESSURE_OFFSET, off); |
86 | #endif |
86 | #endif |
87 | if((EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG) && (DruckOffsetSetting < 10 || DruckOffsetSetting >= 245)) VersionInfo.HardwareError[0] |= DEFEKT_PRESSURE; |
87 | if((EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG) && (DruckOffsetSetting < 10 || DruckOffsetSetting >= 245)) VersionInfo.HardwareError[0] |= FC_ERROR0_PRESSURE; |
88 | OCR0A = off; |
88 | OCR0A = off; |
89 | Delay_ms_Mess(300); |
89 | Delay_ms_Mess(300); |
90 | } |
90 | } |
Line 101... | Line 101... | ||
101 | ready = 0; |
101 | ready = 0; |
102 | if(AdWertNick < 1020) AnalogOffsetNick--; else if(AdWertNick > 1030) AnalogOffsetNick++; else ready++; |
102 | if(AdWertNick < 1020) AnalogOffsetNick--; else if(AdWertNick > 1030) AnalogOffsetNick++; else ready++; |
103 | if(AdWertRoll < 1020) AnalogOffsetRoll--; else if(AdWertRoll > 1030) AnalogOffsetRoll++; else ready++; |
103 | if(AdWertRoll < 1020) AnalogOffsetRoll--; else if(AdWertRoll > 1030) AnalogOffsetRoll++; else ready++; |
104 | if(AdWertGier < 1020) AnalogOffsetGier--; else if(AdWertGier > 1030) AnalogOffsetGier++; else ready++; |
104 | if(AdWertGier < 1020) AnalogOffsetGier--; else if(AdWertGier > 1030) AnalogOffsetGier++; else ready++; |
105 | I2C_Start(TWI_STATE_GYRO_OFFSET_TX); |
105 | I2C_Start(TWI_STATE_GYRO_OFFSET_TX); |
106 | if(AnalogOffsetNick < 10) { VersionInfo.HardwareError[0] |= DEFEKT_G_NICK; AnalogOffsetNick = 10;}; if(AnalogOffsetNick > 245) { VersionInfo.HardwareError[0] |= DEFEKT_G_NICK; AnalogOffsetNick = 245;}; |
106 | if(AnalogOffsetNick < 10) { VersionInfo.HardwareError[0] |= FC_ERROR0_GYRO_NICK; AnalogOffsetNick = 10;}; if(AnalogOffsetNick > 245) { VersionInfo.HardwareError[0] |= FC_ERROR0_GYRO_NICK; AnalogOffsetNick = 245;}; |
107 | if(AnalogOffsetRoll < 10) { VersionInfo.HardwareError[0] |= DEFEKT_G_ROLL; AnalogOffsetRoll = 10;}; if(AnalogOffsetRoll > 245) { VersionInfo.HardwareError[0] |= DEFEKT_G_ROLL; AnalogOffsetRoll = 245;}; |
107 | if(AnalogOffsetRoll < 10) { VersionInfo.HardwareError[0] |= FC_ERROR0_GYRO_ROLL; AnalogOffsetRoll = 10;}; if(AnalogOffsetRoll > 245) { VersionInfo.HardwareError[0] |= FC_ERROR0_GYRO_ROLL; AnalogOffsetRoll = 245;}; |
108 | if(AnalogOffsetGier < 10) { VersionInfo.HardwareError[0] |= DEFEKT_G_GIER; AnalogOffsetGier = 10;}; if(AnalogOffsetGier > 245) { VersionInfo.HardwareError[0] |= DEFEKT_G_GIER; AnalogOffsetGier = 245;}; |
108 | if(AnalogOffsetGier < 10) { VersionInfo.HardwareError[0] |= FC_ERROR0_GYRO_YAW; AnalogOffsetGier = 10;}; if(AnalogOffsetGier > 245) { VersionInfo.HardwareError[0] |= FC_ERROR0_GYRO_YAW; AnalogOffsetGier = 245;}; |
109 | while(twi_state) if(CheckDelay(timeout)) {printf("\n\r DAC or I2C ERROR! Check I2C, 3Vref, DAC and BL-Ctrl"); break;} |
109 | while(twi_state) if(CheckDelay(timeout)) {printf("\n\r DAC or I2C ERROR! Check I2C, 3Vref, DAC and BL-Ctrl"); break;} |
110 | AdReady = 0; |
110 | AdReady = 0; |
111 | ANALOG_ON; |
111 | ANALOG_ON; |
112 | while(!AdReady); |
112 | while(!AdReady); |
113 | if(i<10) Delay_ms_Mess(10); |
113 | if(i<10) Delay_ms_Mess(10); |