Subversion Repositories FlightCtrl

Rev

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

Rev 1114 Rev 1116
Line 13... Line 13...
13
 
13
 
Line 14... Line 14...
14
extern char     MotorenEin;
14
extern char     MotorenEin;
15
 
15
 
16
 
16
 
17
void setJ16( char enabled ) {
17
void setJ16( char enabled ) {
18
        if( PARAM_LED_NEGATE )
18
/*      if( PARAM_LED_NEGATE )
19
                enabled = !enabled;
19
                enabled = !enabled;
-
 
20
        if( enabled && forceEnabled )
-
 
21
                J16_ON;
-
 
22
        else
-
 
23
                J16_OFF;*/
-
 
24
               
20
        if( enabled && forceEnabled )
25
        if((enabled && forceEnabled) ^ LED_NEGATE_J16)
21
                J16_ON;
26
                J16_ON;
Line 22... Line 27...
22
        else
27
        else
23
                J16_OFF;
28
                J16_OFF;                       
24
}
29
}
25
 
30
 
26
void setJ17( char enabled ) {
31
void setJ17( char enabled ) {
27
        if( PARAM_LED_NEGATE )
32
/*      if( PARAM_LED_NEGATE )
-
 
33
                enabled = !enabled;
-
 
34
        if( enabled && forceEnabled )
-
 
35
                J17_ON;
-
 
36
        else
-
 
37
                J17_OFF;*/
28
                enabled = !enabled;
38
               
29
        if( enabled && forceEnabled )
39
        if((enabled && forceEnabled) ^ LED_NEGATE_J17)
Line 30... Line 40...
30
                J17_ON;
40
                J17_ON;
31
        else
41
        else
32
                J17_OFF;
42
                J17_OFF;                       
33
}
43
}
34
 
44
 
35
// initializes the LED control outputs J16, J17
45
// initializes the LED control outputs J16, J17
36
void LED_Init( void ) {
46
void LED_Init( void ) {
37
        // set PC2 & PC3 as output (control of J16 & J17)
47
        // set PC2 & PC3 as output (control of J16 & J17)
38
        DDRC |= (1<<DDC2)|(1<<DDC3);
48
    DDRC |= (1<<DDC2)|(1<<DDC3);
Line 39... Line 49...
39
        setJ16( 0 );
49
        setJ16( 0 );
40
        setJ17( 0 );
50
        setJ17( 0 );
Line 41... Line 51...
41
        J16Blinkcount = 0; J16Mask = 128;
51
    J16Blinkcount = 0; J16Mask = 128;
-
 
52
    J17Blinkcount = 0; J17Mask = 128;
-
 
53
}
Line 42... Line 54...
42
        J17Blinkcount = 0; J17Mask = 128;
54
 
Line 43... Line 55...
43
}
55
 
44
 
56
// called in UpdateMotors() every 2ms
45
 
57
void LED_Update( void ) {
Line 46... Line 58...
46
// called in UpdateMotors() every 2ms
58
 
47
void LED_Update( void ) {
59
        static char     delay = 0;
Line 110... Line 122...
110
                       
122
                       
111
                        if( J16Mask == 1 )
123
                        if( J16Mask == 1 )
112
                                J16Mask = 128;
124
                                J16Mask = 128;
113
                        else
125
                        else
114
                                J16Mask /= 2;
126
                                J16Mask /= 2;
115
                        setJ16( J16Mask & EE_Parameter.J16Bitmask );
127
                        j16 = J16Mask & EE_Parameter.J16Bitmask;
Line 116... Line 128...
116
                }  
128
                }  
117
               
129
               
118
                /* J17
130
                /* J17
Line 127... Line 139...
127
                       
139
                       
128
                        if( J17Mask == 1 )
140
                        if( J17Mask == 1 )
129
                                J17Mask = 128;
141
                                J17Mask = 128;
130
                        else
142
                        else
131
                                J17Mask /= 2;
143
                                J17Mask /= 2;
132
                        setJ17( J17Mask & EE_Parameter.J17Bitmask );
144
                        j17 = J17Mask & EE_Parameter.J17Bitmask;
133
                }  
145
                }  
-
 
146
        }
-
 
147
 
-
 
148
        /*delay: 0...4 - BRIGHTNESS: 0-Aus...5-Max*/
-
 
149
        setJ16( j16 && (delay < PARAM_LED_BRIGHTNESS_J16 || UBat < EE_Parameter.UnterspannungsWarnung ));
134
        }
150
        setJ17( j17 && (delay < PARAM_LED_BRIGHTNESS_J17 || UBat < EE_Parameter.UnterspannungsWarnung ));