Subversion Repositories FlightCtrl

Rev

Rev 1554 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 1554 Rev 1607
Line 19... Line 19...
19
 
19
 
20
// called in UpdateMotors() every 2ms
20
// called in UpdateMotors() every 2ms
21
void LED_Update(void)
21
void LED_Update(void)
22
{
22
{
23
    static char delay = 0;
-
 
24
    static unsigned char J16Bitmask = 0;
-
 
-
 
23
    static char delay = 0;
25
    static unsigned char J17Bitmask = 0;
24
 
26
    if(!delay--)  // 10ms Intervall
25
    if(!delay--)  // 10ms Intervall
27
    {
26
    {
Line 28... Line 27...
28
        delay = 4;
27
        delay = 4;
29
 
28
 
30
        if(MikroKopterFlags & FLAG_LOWBAT || SenderOkay < 128)
29
        if (Parameter_J16Timing < 10)
31
        {
30
        {
32
            J16Bitmask = EE_Parameter.WARN_J16_Bitmask;
31
            J16_OFF;
33
            J17Bitmask = EE_Parameter.WARN_J17_Bitmask;
32
            J17_OFF;
34
        }
33
        }
35
        else
34
        else if (Parameter_J16Timing < 180)
36
        {
35
        {
37
            J16Bitmask = EE_Parameter.J16Bitmask;
36
            J16_ON;
38
            J17Bitmask = EE_Parameter.J17Bitmask;
-
 
39
        }
-
 
40
 
37
            J17_OFF;
41
        if((EE_Parameter.BitConfig & CFG_MOTOR_BLINK) && !MotorenEin) {if(EE_Parameter.BitConfig & CFG_MOTOR_OFF_LED1) J16_ON; else J16_OFF;}
-
 
42
        else
38
        }
43
            if((EE_Parameter.J16Timing > 250) && (Parameter_J16Timing > 220)) {if(J16Bitmask & 128) J16_ON; else J16_OFF;}
-
 
44
            else
39
        else
45
                if((EE_Parameter.J16Timing > 250) && (Parameter_J16Timing < 10))  {if(J16Bitmask & 128) J16_OFF; else J16_ON;}
-
 
46
                else
40
        {
47
                    if(!J16Blinkcount--)
-
 
48
                    {
-
 
49
                        J16Blinkcount = Parameter_J16Timing-1;
-
 
50
                        if(J16Mask == 1) J16Mask = 128; else J16Mask /= 2;
-
 
51
                        if(J16Mask & J16Bitmask) J16_ON; else J16_OFF;
-
 
52
                    }
-
 
53
 
41
            J16_ON;
54
        if((EE_Parameter.BitConfig & CFG_MOTOR_BLINK) && !MotorenEin) {if(EE_Parameter.BitConfig & CFG_MOTOR_OFF_LED2) J17_ON; else J17_OFF;}
-
 
55
        else
-
 
56
            if((EE_Parameter.J17Timing > 250) && (Parameter_J17Timing > 230)) {if(J17Bitmask & 128) J17_ON; else J17_OFF;}
-
 
57
            else
-
 
58
                if((EE_Parameter.J17Timing > 250) && (Parameter_J17Timing < 10))  {if(J17Bitmask & 128) J17_OFF; else J17_ON;}
-
 
59
                else
-
 
60
                    if(!J17Blinkcount--)
-
 
61
                    {
-
 
62
                        J17Blinkcount = Parameter_J17Timing-1;
-
 
63
                        if(J17Mask == 1) J17Mask = 128; else J17Mask /= 2;
-
 
64
                        if(J17Mask & J17Bitmask) J17_ON; else J17_OFF;
42
            J17_ON;
65
                    }
43
        }