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