Subversion Repositories FlightCtrl

Rev

Rev 1726 | Rev 1806 | 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);