Rev 1116 | Rev 1125 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 1116 | Rev 1118 | ||
---|---|---|---|
Line 5... | Line 5... | ||
5 | uint16_t LED1_Timing = 0; |
5 | uint16_t LED1_Timing = 0; |
6 | uint16_t LED2_Timing = 0; |
6 | uint16_t LED2_Timing = 0; |
Line 7... | Line 7... | ||
7 | 7 | ||
8 | unsigned char J16Blinkcount = 0, J16Mask = 1; |
8 | unsigned char J16Blinkcount = 0, J16Mask = 1; |
- | 9 | unsigned char J17Blinkcount = 0, J17Mask = 1; |
|
Line 9... | Line 10... | ||
9 | unsigned char J17Blinkcount = 0, J17Mask = 1; |
10 | unsigned char J16 = 0, J17 = 0; |
10 | - | ||
Line 11... | Line 11... | ||
11 | unsigned char lightsEnabled = 0; |
11 | |
Line 12... | Line 12... | ||
12 | unsigned char forceEnabled = 0; |
12 | unsigned char lightsEnabled = 0, lightsOn = 0; |
Line 20... | Line 20... | ||
20 | if( enabled && forceEnabled ) |
20 | if( enabled && forceEnabled ) |
21 | J16_ON; |
21 | J16_ON; |
22 | else |
22 | else |
23 | J16_OFF;*/ |
23 | J16_OFF;*/ |
Line 24... | Line 24... | ||
24 | 24 | ||
25 | if((enabled && forceEnabled) ^ LED_NEGATE_J16) |
25 | if((enabled && lightsOn) ^ LED_NEGATE_J16) |
26 | J16_ON; |
26 | J16_ON; |
27 | else |
27 | else |
28 | J16_OFF; |
28 | J16_OFF; |
Line 34... | Line 34... | ||
34 | if( enabled && forceEnabled ) |
34 | if( enabled && forceEnabled ) |
35 | J17_ON; |
35 | J17_ON; |
36 | else |
36 | else |
37 | J17_OFF;*/ |
37 | J17_OFF;*/ |
Line 38... | Line 38... | ||
38 | 38 | ||
39 | if((enabled && forceEnabled) ^ LED_NEGATE_J17) |
39 | if((enabled && lightsOn) ^ LED_NEGATE_J17) |
40 | J17_ON; |
40 | J17_ON; |
41 | else |
41 | else |
42 | J17_OFF; |
42 | J17_OFF; |
Line 43... | Line 43... | ||
43 | } |
43 | } |
44 | 44 | ||
45 | // initializes the LED control outputs J16, J17 |
45 | // initializes the LED control outputs J16, J17 |
46 | void LED_Init( void ) { |
46 | void LED_Init( void ) { |
- | 47 | // set PC2 & PC3 as output (control of J16 & J17) |
|
- | 48 | DDRC |= (1<<DDC2)|(1<<DDC3); |
|
- | 49 | ||
47 | // set PC2 & PC3 as output (control of J16 & J17) |
50 | lightsOn = lightsEnabled = 0; |
48 | DDRC |= (1<<DDC2)|(1<<DDC3); |
51 | |
- | 52 | setJ16( 0); |
|
49 | setJ16( 0 ); |
53 | setJ17( 0); |
50 | setJ17( 0 ); |
54 | |
51 | J16Blinkcount = 0; J16Mask = 128; |
55 | J16Blinkcount = 0; J16Mask = 128; |
Line -... | Line 56... | ||
- | 56 | J17Blinkcount = 0; J17Mask = 128; |
|
- | 57 | } |
|
- | 58 | ||
- | 59 | void checkLightsEnabled(void) { |
|
- | 60 | ||
- | 61 | // Mit dem Gier-Stick rechts lassen sich bei stehenden Motoren die LED's ein- und mit links ausschalten |
|
- | 62 | if( !MotorenEin) { |
|
- | 63 | if( PARAM_LED_STICK_ENABLED) { |
|
- | 64 | if ( PPM_in[ EE_Parameter.Kanalbelegung[ K_GAS ] ] > 35-120 |
|
- | 65 | && PPM_in[ EE_Parameter.Kanalbelegung[ K_GAS ] ] < 80 ) { |
|
- | 66 | if( PPM_in[ EE_Parameter.Kanalbelegung[ K_GIER ] ] < -75 ) |
|
- | 67 | lightsEnabled = 1; |
|
- | 68 | if( PPM_in[ EE_Parameter.Kanalbelegung[ K_GIER ] ] > 75 ) |
|
- | 69 | lightsEnabled = 0; |
|
- | 70 | } |
|
- | 71 | } else |
|
- | 72 | lightsEnabled = 1; |
|
- | 73 | } |
|
- | 74 | ||
- | 75 | // Die LED's können mit den Motoren ein- ausgeschaltet werden |
|
- | 76 | if( PARAM_LED_ENGINE_ENABLED) |
|
- | 77 | lightsEnabled = MotorenEin; |
|
Line 52... | Line 78... | ||
52 | J17Blinkcount = 0; J17Mask = 128; |
78 | |
53 | } |
79 | lightsOn = lightsEnabled; |
Line 54... | Line 80... | ||
54 | 80 | } |
|
55 | - | ||
56 | // called in UpdateMotors() every 2ms |
- | |
57 | void LED_Update( void ) { |
- | |
58 | - | ||
Line 59... | Line -... | ||
59 | static char delay = 0; |
- | |
60 | static char j16 = 0; |
- | |
61 | static char j17 = 0; |
- | |
62 | - | ||
63 | if( !MotorenEin ) { |
- | |
64 | - | ||
65 | /* Mit dem Gier-Stick rechts lassen sich die LED's ein- und mit links ausschalten. |
- | |
66 | */ |
- | |
67 | if( PARAM_LED_STICK_ENABLED ) { |
81 | |
68 | - | ||
69 | if( PPM_in[ EE_Parameter.Kanalbelegung[ K_GAS ] ] > 35-120 && |
- | |
70 | PPM_in[ EE_Parameter.Kanalbelegung[ K_GAS ] ] < 80 ) { |
- | |
71 | - | ||
72 | if( PPM_in[ EE_Parameter.Kanalbelegung[ K_GIER ] ] < -75 ) { |
- | |
73 | lightsEnabled = 1; |
- | |
74 | } |
- | |
75 | - | ||
76 | if( PPM_in[ EE_Parameter.Kanalbelegung[ K_GIER ] ] > 75 ) { |
- | |
77 | lightsEnabled = 0; |
- | |
78 | } |
- | |
79 | } |
- | |
80 | } else { |
- | |
81 | lightsEnabled = 1; |
- | |
82 | } |
- | |
83 | } |
- | |
Line 84... | Line 82... | ||
84 | 82 | // called in UpdateMotors() every 2ms |
|
Line 85... | Line 83... | ||
85 | if( PARAM_LED_ENGINE_ENABLED ) { |
83 | void LED_Update( void ) { |
Line 86... | Line 84... | ||
86 | lightsEnabled = MotorenEin; |
84 | |
87 | } |
- | |
88 | - | ||
89 | forceEnabled = lightsEnabled; |
85 | static char delay = 0; |
90 | 86 | ||
91 | if( !delay-- ) { |
- | |
92 | 87 | checkLightsEnabled(); |
|
93 | delay = 4; // 10ms Intervall |
- | |
94 | 88 | ||
95 | // Soll die Unterspannungswarnung zu einem schnelleren Blinken führen? |
- | |
96 | if( PARAM_LED_WARNING_ENABLED ) { |
89 | if( !delay-- ) { |
97 | - | ||
98 | // Grenze für Unterspannungswarnung erreicht? |
- | |
99 | if( UBat < EE_Parameter.UnterspannungsWarnung ) { |
- | |
100 | - | ||
101 | // Erzwingt die Aktivierung der Ausgänge |
- | |
102 | if( PARAM_LED_FORCE_WARNING_ENABLED ) |
90 | |
Line 103... | Line 91... | ||
103 | forceEnabled = 1; |
91 | delay = 9; // 20ms Intervall |
104 | - | ||
105 | if( PARAM_LED_WARNING_FAST_ENABLED ) { |
92 | |
106 | delay = 1; // 2,5ms Intervall |
93 | // Soll die Unterspannungswarnung zu einem schnelleren Blinken führen? |
107 | } else { |
94 | // Grenze für Unterspannungswarnung erreicht? |
108 | delay = 2; // 5ms Intervall |
95 | if( PARAM_LED_WARNING_SPEEDUP && UBat < EE_Parameter.UnterspannungsWarnung ) { |
109 | } |
96 | if( PARAM_LED_FORCE_WARNING_ENABLED ) // Erzwingt die Aktivierung der Ausgänge |
110 | } |
- | |
111 | } |
97 | lightsOn = 1; |
112 | - | ||
113 | /* J16 |
98 | delay /= PARAM_LED_WARNING_SPEEDUP+1; |
114 | */ |
- | |
115 | if( ( EE_Parameter.J16Timing > 250 ) && ( Parameter_J16Timing > 230 ) ) { |
- | |
116 | setJ16( EE_Parameter.J16Bitmask & 128 ); |
- | |
117 | } else if( ( EE_Parameter.J16Timing > 250 ) && ( Parameter_J16Timing < 10 ) ) { |
99 | } |
118 | setJ16( !( EE_Parameter.J16Bitmask & 128 ) ); |
100 | |
Line 119... | Line 101... | ||
119 | } else if( !J16Blinkcount-- ) { |
101 | // J16 |
120 | - | ||
121 | J16Blinkcount = Parameter_J16Timing-1; |
102 | if( EE_Parameter.J16Timing > 250 && Parameter_J16Timing > 230 ) |
122 | 103 | J16 = EE_Parameter.J16Bitmask & 128; |
|
123 | if( J16Mask == 1 ) |
104 | else if( EE_Parameter.J16Timing > 250 && Parameter_J16Timing < 10 ) |
124 | J16Mask = 128; |
105 | J16 = !( EE_Parameter.J16Bitmask & 128 ); |
125 | else |
106 | else if( !J16Blinkcount-- ) { |
126 | J16Mask /= 2; |
- | |
127 | j16 = J16Mask & EE_Parameter.J16Bitmask; |
107 | J16Blinkcount = Parameter_J16Timing-1; |
128 | } |
- | |
129 | 108 | J16Mask = (J16Mask == 1 ? 0x80 : J16Mask >> 1); |
|
130 | /* J17 |
- | |
131 | */ |
- | |
132 | if( ( EE_Parameter.J17Timing > 250 ) && ( Parameter_J17Timing > 230 ) ) { |
- | |
133 | setJ17( EE_Parameter.J17Bitmask & 128 ); |
109 | J16 = EE_Parameter.J16Bitmask & J16Mask; |
134 | } else if( ( EE_Parameter.J17Timing > 250 ) && ( Parameter_J17Timing < 10 ) ) { |
110 | } |
135 | setJ17( !( EE_Parameter.J17Bitmask & 128 ) ); |
111 | |
Line 136... | Line 112... | ||
136 | } else if( !J17Blinkcount-- ) { |
112 | // J17 |
137 | 113 | if( EE_Parameter.J17Timing > 250 && Parameter_J17Timing > 230) |
|
138 | J17Blinkcount = Parameter_J17Timing-1; |
114 | J17 = EE_Parameter.J17Bitmask & 128 ; |
139 | 115 | else if( EE_Parameter.J17Timing > 250 && Parameter_J17Timing < 10) |