Subversion Repositories FlightCtrl

Rev

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
//