Subversion Repositories FlightCtrl

Rev

Rev 211 | Show entire file | Regard whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 211 Rev 212
Line 73... Line 73...
73 
volatile int  KompassStartwert = 0;
 73 
volatile int  KompassStartwert = 0;
74 
volatile int  KompassRichtung = 0;
 74 
volatile int  KompassRichtung = 0;
75 
unsigned char MAX_GAS,MIN_GAS;
 75 
unsigned char MAX_GAS,MIN_GAS;
76 
unsigned char Notlandung = 0;
 76 
unsigned char Notlandung = 0;
77 
unsigned char HoehenReglerAktiv = 0;
 77 
unsigned char HoehenReglerAktiv = 0;
- 
 
 78 
//-------HF-------
- 
 
 79 
unsigned char LED_Switch = 0;
- 
 
 80 
unsigned char LED_flash  = 0;
- 
 
 81 
unsigned char LED_1  = 0;
- 
 
 82 
unsigned char LED_2  = 0;
- 
 
 83 
unsigned char LED_2on  = 0;
- 
 
 84 
//-------HF-------
Line 78... Line 85...
78 
 
 85 
 
79 
float GyroFaktor;
 86 
float GyroFaktor;
Line 80... Line 87...
80 
float IntegralFaktor;
 87 
float IntegralFaktor;
Line 287... Line 294...
287 
// + 252 -> Poti2
 294 
// + 252 -> Poti2
288 
// + 253 -> Poti3
 295 
// + 253 -> Poti3
289 
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
 296 
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
290 
void DefaultKonstanten1(void)
 297 
void DefaultKonstanten1(void)
291 
{
 298 
{
292 
 EE_Parameter.Kanalbelegung[K_NICK]  = 1;
 299 
 EE_Parameter.Kanalbelegung[K_NICK]  = 3;
293 
 EE_Parameter.Kanalbelegung[K_ROLL]  = 2;
 300 
 EE_Parameter.Kanalbelegung[K_ROLL]  = 2;
294 
 EE_Parameter.Kanalbelegung[K_GAS]   = 3;
 301 
 EE_Parameter.Kanalbelegung[K_GAS]   = 1;
295 
 EE_Parameter.Kanalbelegung[K_GIER]  = 4;
 302 
 EE_Parameter.Kanalbelegung[K_GIER]  = 4;
296 
 EE_Parameter.Kanalbelegung[K_POTI1] = 5;
 303 
 EE_Parameter.Kanalbelegung[K_POTI1] = 5;
297 
 EE_Parameter.Kanalbelegung[K_POTI2] = 6;
 304 
 EE_Parameter.Kanalbelegung[K_POTI2] = 6;
298 
 EE_Parameter.Kanalbelegung[K_POTI3] = 7;
 305 
 EE_Parameter.Kanalbelegung[K_POTI3] = 7;
299 
 EE_Parameter.Kanalbelegung[K_POTI4] = 8;
 306 
 EE_Parameter.Kanalbelegung[K_POTI4] = 8;
Line 334... Line 341...
334 
 memcpy(EE_Parameter.Name, "Sport\0", 12);  
 341 
 memcpy(EE_Parameter.Name, "Sport\0", 12);
335 
}
 342 
}
Line 336... Line 343...
336 
 
 343 
 
337 
void DefaultKonstanten2(void)
 344 
void DefaultKonstanten2(void)
338 
{
 345 
{
339 
 EE_Parameter.Kanalbelegung[K_NICK]  = 1;
 346 
 EE_Parameter.Kanalbelegung[K_NICK]  = 3;
340 
 EE_Parameter.Kanalbelegung[K_ROLL]  = 2;
 347 
 EE_Parameter.Kanalbelegung[K_ROLL]  = 2;
341 
 EE_Parameter.Kanalbelegung[K_GAS]   = 3;
 348 
 EE_Parameter.Kanalbelegung[K_GAS]   = 1;
342 
 EE_Parameter.Kanalbelegung[K_GIER]  = 4;
 349 
 EE_Parameter.Kanalbelegung[K_GIER]  = 4;
343 
 EE_Parameter.Kanalbelegung[K_POTI1] = 5;
 350 
 EE_Parameter.Kanalbelegung[K_POTI1] = 5;
344 
 EE_Parameter.Kanalbelegung[K_POTI2] = 6;
 351 
 EE_Parameter.Kanalbelegung[K_POTI2] = 6;
345 
 EE_Parameter.Kanalbelegung[K_POTI3] = 7;
 352 
 EE_Parameter.Kanalbelegung[K_POTI3] = 7;
Line 582... Line 589...
582 
    IntegralFaktor = ((float) Parameter_Gyro_I) / 44000;
 589 
    IntegralFaktor = ((float) Parameter_Gyro_I) / 44000;
Line 583... Line 590...
583 
 
 590 
 
584 
    if(EE_Parameter.GlobalConfig & CFG_HEADING_HOLD) IntegralFaktor =  0;
 591 
    if(EE_Parameter.GlobalConfig & CFG_HEADING_HOLD) IntegralFaktor =  0;
585 
    if(GyroFaktor < 0) GyroFaktor = 0;
 592 
    if(GyroFaktor < 0) GyroFaktor = 0;
- 
 
 593 
    if(IntegralFaktor < 0) IntegralFaktor = 0;
- 
 
 594 
       
- 
 
 595 
    //------HF------- LEDs Schalten - LED1 Normal, LED2 Blitzlicht
- 
 
 596 
        LED_Switch = PPM_in[EE_Parameter.Kanalbelegung[K_POTI2]];
- 
 
 597 
        if (((LED_Switch > 32) & (LED_Switch < 96)) | (LED_Switch > 160)) LED_2++; else if (LED_2 > 0) LED_2--;
- 
 
 598 
        if ((LED_Switch > 96)) LED_1++; else if (LED_1 > 0) LED_1--;
- 
 
 599 
        if (LED_1 >= 10) {LED_1 = 10; LED1_ON;}
- 
 
 600 
    if (LED_1 <=  1) LED1_OFF;
- 
 
 601 
        if (LED_2 >= 10) {LED_2 = 10; LED_2on = 1;}
- 
 
 602 
        if (LED_2 <=  1) LED_2on = 0;
- 
 
 603 
        if (LED_2on  ==  1) LED_flash++;
- 
 
 604 
        if (LED_flash > 77) LED2_ON; else LED2_OFF;
- 
 
 605 
        if (LED_flash > 80) LED_flash = 0;
- 
 
 606 
        //------HF------- End LEDs Schalten
586 
    if(IntegralFaktor < 0) IntegralFaktor = 0;
 607 
 
587 
    // greift in den Stick ein, um ungewolltes überschlagen zu verhindern
 608 
    // greift in den Stick ein, um ungewolltes überschlagen zu verhindern
588 
    if(!(EE_Parameter.LoopConfig & CFG_LOOP_LINKS) && !(EE_Parameter.LoopConfig & CFG_LOOP_RECHTS))
 609 
    if(!(EE_Parameter.LoopConfig & CFG_LOOP_LINKS) && !(EE_Parameter.LoopConfig & CFG_LOOP_RECHTS))
589 
     {
 610 
     {
590 
      if(IntegralNick >  60000)  
 611 
      if(IntegralNick >  60000)