Subversion Repositories FlightCtrl

Rev

Rev 136 | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 136 Rev 143
Line 5... Line 5...
5
volatile unsigned char UpdateMotor = 0;
5
volatile unsigned char UpdateMotor = 0;
6
volatile unsigned int cntKompass = 0;
6
volatile unsigned int cntKompass = 0;
7
volatile unsigned int beeptime = 0;
7
volatile unsigned int beeptime = 0;
8
int ServoValue = 0;
8
int ServoValue = 0;
9
//Salvo 8.9.2007
9
//Salvo 8.9.2007
10
volatile unsigned int Kompass_Neuer_Wert= 0;
10
volatile uint8_t Kompass_Neuer_Wert= 0;
11
volatile unsigned int Kompass_Value_Old = 0;
11
volatile unsigned int Kompass_Value_Old = 0;
12
// Salvo End
12
// Salvo End
13
enum {
13
enum {
14
  STOP             = 0,
14
  STOP             = 0,
15
  CK               = 1,
15
  CK               = 1,
Line 141... Line 141...
141
     else ServoValue -= ((long) EE_Parameter.ServoNickComp * (IntegralNick / 128)) / 512;
141
     else ServoValue -= ((long) EE_Parameter.ServoNickComp * (IntegralNick / 128)) / 512;
Line 142... Line 142...
142
     
142
     
143
     if(ServoValue < EE_Parameter.ServoNickMin) ServoValue = EE_Parameter.ServoNickMin;
143
     if(ServoValue < EE_Parameter.ServoNickMin) ServoValue = EE_Parameter.ServoNickMin;
Line 144... Line 144...
144
     else if(ServoValue > EE_Parameter.ServoNickMax) ServoValue = EE_Parameter.ServoNickMax;
144
     else if(ServoValue > EE_Parameter.ServoNickMax) ServoValue = EE_Parameter.ServoNickMax;
145
 
145
 
146
     DebugOut.Analog[10] = ServoValue;    
146
//     DebugOut.Analog[10] = ServoValue;     
147
     OCR2A = ServoValue;// + 75;
147
     OCR2A = ServoValue;// + 75;
148
     timer = EE_Parameter.ServoNickRefresh;
148
     timer = EE_Parameter.ServoNickRefresh;
149
    }
149
    }