WebSVN - FlightCtrl - Diff - Rev 1163 and 1208 - /branches/V0.71i_DSL_X


#include <inttypes.h>
#include "main.h"
#include "parameter.h"
 
unsigned char J16Blinkcount = 0, J16Mask = 1, J16Brightness = 0, J16 = 0;
unsigned char J17Blinkcount = 0, J17Mask = 1, J17Brightness = 0, J17 = 0;
 
unsigned char lightsEnabled = 0, lightsOn = 0;
 
extern char MotorenEin;
 
void setJ16(char enabled) {
    if ((enabled && lightsOn) ^ LED_NEGATE_J16) {
        J16_ON;
        DebugOut.Analog[24] = 100;
    } else {
        J16_OFF;
        DebugOut.Analog[24] = 0;
    }
}
 
void setJ17(char enabled) {
    if ((enabled && lightsOn) ^ LED_NEGATE_J17) {
        J17_ON;
        DebugOut.Analog[25] = 100;
    } else {
        J17_OFF;
        DebugOut.Analog[25] = 0;
    }
}
 
// initializes the LED control outputs J16, J17
 
void LED_Init(void) {
    // set PC2 & PC3 as output (control of J16 & J17)
    DDRC |= (1 << DDC2) | (1 << DDC3);
 
    lightsOn = lightsEnabled = 0;
 
    setJ16(0);
    setJ17(0);
 
    J16Blinkcount = 0;
    J16Mask = 128;
    J17Blinkcount = 0;
    J17Mask = 128;
}
 
static inline void checkLightsEnabled(void) {
 
    // Die LED's können mit den Motoren ein- ausgeschaltet werden
    if (PARAM_LED_ENGINE_ENABLED)
        lightsEnabled = MotorenEin;
    // Die LED's können mit den Motoren ein- ausgeschaltet werden
    else if (PARAM_LED_STICK_ENABLED) {
        if (!MotorenEin) {
            if (PPM_in[ EE_Parameter.Kanalbelegung[ K_GAS ] ] > 35 - 120
                    && PPM_in[ EE_Parameter.Kanalbelegung[ K_GAS ] ] < 120 - 35) {
                if (PPM_in[ EE_Parameter.Kanalbelegung[ K_GIER ] ] < -75)
                    lightsEnabled = 1;
                if (PPM_in[ EE_Parameter.Kanalbelegung[ K_GIER ] ] > 75)
                    lightsEnabled = 0;
            }
        }
    } else
        lightsEnabled = 1;
 
    lightsOn = lightsEnabled;
}
 
// called in UpdateMotors() every 2ms
 
void LED_Update(void) {
 
    static char delay = 0;
 
    if (!delay--) {
 
        delay = 9; // 20ms Intervall
 
        checkLightsEnabled();
 
        // Soll die Unterspannungswarnung zu einem schnelleren Blinken führen?
        // Grenze für Unterspannungswarnung erreicht?
        if (PARAM_LED_WARNING_SPEEDUP && UBat < EE_Parameter.UnterspannungsWarnung) {
            if (PARAM_LED_FORCE_WARNING_ENABLED) // Erzwingt die Aktivierung der Ausgänge
                lightsOn = 1;
            delay /= PARAM_LED_WARNING_SPEEDUP + 1;
        }
 
        // J16
        if (EE_Parameter.J16Timing > 250 && Parameter_J16Timing > 230)
            J16 = EE_Parameter.J16Bitmask & 128;
        else if (EE_Parameter.J16Timing > 250 && Parameter_J16Timing < 10)
            J16 = !(EE_Parameter.J16Bitmask & 128);
        else if (!J16Blinkcount--) {
            J16Blinkcount = Parameter_J16Timing - 1;
            J16Mask = (J16Mask == 1 ? 0x80 : J16Mask >> 1);
 
            J16 = EE_Parameter.J16Bitmask & J16Mask;
        }
 
        J16Brightness = EE_Parameter.J16Bitmask & J16Mask ? Parameter_J16Brightness / 23 : 0;
 
        // J17
        if (EE_Parameter.J17Timing > 250 && Parameter_J17Timing > 230)
            J17 = EE_Parameter.J17Bitmask & 128;
        else if (EE_Parameter.J17Timing > 250 && Parameter_J17Timing < 10)
            J17 = !(EE_Parameter.J17Bitmask & 128);
        else if (!J17Blinkcount--) {
            J17Blinkcount = Parameter_J17Timing - 1;
            J17Mask = (J17Mask == 1 ? 0x80 : J17Mask >> 1);
 
            J17 = EE_Parameter.J17Bitmask & J17Mask;
        }
 
        J17Brightness = EE_Parameter.J17Bitmask & J17Mask ? Parameter_J17Brightness / 23 : 0;
    }
 
    // delay: 0...9 - BRIGHTNESS/23: 0-Aus...10-Max - Bei Unterspannung volle Leuchtkraft
    setJ16(J16 && (delay < J16Brightness || UBat < EE_Parameter.UnterspannungsWarnung));
    setJ17(J17 && (delay < J17Brightness || UBat < EE_Parameter.UnterspannungsWarnung));
}
 

Rev 1163	Rev 1208
1	#include <inttypes.h>	1	#include <inttypes.h>
2	#include "main.h"	2	#include "main.h"
3	#include "parameter.h"	3	#include "parameter.h"
4		4
5	unsigned char J16Blinkcount = 0, J16Mask = 1, J16Brightness = 0, J16 = 0;	5	unsigned char J16Blinkcount = 0, J16Mask = 1, J16Brightness = 0, J16 = 0;
6	unsigned char J17Blinkcount = 0, J17Mask = 1, J17Brightness = 0, J17 = 0;	6	unsigned char J17Blinkcount = 0, J17Mask = 1, J17Brightness = 0, J17 = 0;
7		7
8	unsigned char lightsEnabled = 0, lightsOn = 0;	8	unsigned char lightsEnabled = 0, lightsOn = 0;
9		9
10	extern char MotorenEin;	10	extern char MotorenEin;
11		11
12	void setJ16(char enabled) {	12	void setJ16(char enabled) {
13	if ((enabled && lightsOn) ^ LED_NEGATE_J16)	13	if ((enabled && lightsOn) ^ LED_NEGATE_J16) {
14	J16_ON;	14	J16_ON;
-		15	DebugOut.Analog[24] = 100;
15	else	16	} else {
16	J16_OFF;	17	J16_OFF;
-		18	DebugOut.Analog[24] = 0;
-		19	}
17	}	20	}
18		21
19	void setJ17(char enabled) {	22	void setJ17(char enabled) {
20	if ((enabled && lightsOn) ^ LED_NEGATE_J17)	23	if ((enabled && lightsOn) ^ LED_NEGATE_J17) {
21	J17_ON;	24	J17_ON;
-		25	DebugOut.Analog[25] = 100;
22	else	26	} else {
23	J17_OFF;	27	J17_OFF;
-		28	DebugOut.Analog[25] = 0;
-		29	}
24	}	30	}
25		31
26	// initializes the LED control outputs J16, J17	32	// initializes the LED control outputs J16, J17
27		33
28	void LED_Init(void) {	34	void LED_Init(void) {
29	// set PC2 & PC3 as output (control of J16 & J17)	35	// set PC2 & PC3 as output (control of J16 & J17)
30	DDRC \|= (1 << DDC2) \| (1 << DDC3);	36	DDRC \|= (1 << DDC2) \| (1 << DDC3);
31		37
32	lightsOn = lightsEnabled = 0;	38	lightsOn = lightsEnabled = 0;
33		39
34	setJ16(0);	40	setJ16(0);
35	setJ17(0);	41	setJ17(0);
36		42
37	J16Blinkcount = 0;	43	J16Blinkcount = 0;
38	J16Mask = 128;	44	J16Mask = 128;
39	J17Blinkcount = 0;	45	J17Blinkcount = 0;
40	J17Mask = 128;	46	J17Mask = 128;
41	}	47	}
42		48
43	static inline void checkLightsEnabled(void) {	49	static inline void checkLightsEnabled(void) {
44		50
45	// Die LED's können mit den Motoren ein- ausgeschaltet werden	51	// Die LED's können mit den Motoren ein- ausgeschaltet werden
46	if (PARAM_LED_ENGINE_ENABLED)	52	if (PARAM_LED_ENGINE_ENABLED)
47	lightsEnabled = MotorenEin;	53	lightsEnabled = MotorenEin;
48	// Die LED's können mit den Motoren ein- ausgeschaltet werden	54	// Die LED's können mit den Motoren ein- ausgeschaltet werden
49	else if (PARAM_LED_STICK_ENABLED) {	55	else if (PARAM_LED_STICK_ENABLED) {
50	if (!MotorenEin) {	56	if (!MotorenEin) {
51	if (PPM_in[ EE_Parameter.Kanalbelegung[ K_GAS ] ] > 35 - 120	57	if (PPM_in[ EE_Parameter.Kanalbelegung[ K_GAS ] ] > 35 - 120
52	&& PPM_in[ EE_Parameter.Kanalbelegung[ K_GAS ] ] < 120 - 35) {	58	&& PPM_in[ EE_Parameter.Kanalbelegung[ K_GAS ] ] < 120 - 35) {
53	if (PPM_in[ EE_Parameter.Kanalbelegung[ K_GIER ] ] < -75)	59	if (PPM_in[ EE_Parameter.Kanalbelegung[ K_GIER ] ] < -75)
54	lightsEnabled = 1;	60	lightsEnabled = 1;
55	if (PPM_in[ EE_Parameter.Kanalbelegung[ K_GIER ] ] > 75)	61	if (PPM_in[ EE_Parameter.Kanalbelegung[ K_GIER ] ] > 75)
56	lightsEnabled = 0;	62	lightsEnabled = 0;
57	}	63	}
58	}	64	}
59	} else	65	} else
60	lightsEnabled = 1;	66	lightsEnabled = 1;
61		67
62	lightsOn = lightsEnabled;	68	lightsOn = lightsEnabled;
63	}	69	}
64		70
65	// called in UpdateMotors() every 2ms	71	// called in UpdateMotors() every 2ms
66		72
67	void LED_Update(void) {	73	void LED_Update(void) {
68		74
69	static char delay = 0;	75	static char delay = 0;
70		76
71	if (!delay--) {	77	if (!delay--) {
72		78
73	delay = 9; // 20ms Intervall	79	delay = 9; // 20ms Intervall
74		80
75	checkLightsEnabled();	81	checkLightsEnabled();
76		82
77	// Soll die Unterspannungswarnung zu einem schnelleren Blinken führen?	83	// Soll die Unterspannungswarnung zu einem schnelleren Blinken führen?
78	// Grenze für Unterspannungswarnung erreicht?	84	// Grenze für Unterspannungswarnung erreicht?
79	if (PARAM_LED_WARNING_SPEEDUP && UBat < EE_Parameter.UnterspannungsWarnung) {	85	if (PARAM_LED_WARNING_SPEEDUP && UBat < EE_Parameter.UnterspannungsWarnung) {
80	if (PARAM_LED_FORCE_WARNING_ENABLED) // Erzwingt die Aktivierung der Ausgänge	86	if (PARAM_LED_FORCE_WARNING_ENABLED) // Erzwingt die Aktivierung der Ausgänge
81	lightsOn = 1;	87	lightsOn = 1;
82	delay /= PARAM_LED_WARNING_SPEEDUP + 1;	88	delay /= PARAM_LED_WARNING_SPEEDUP + 1;
83	}	89	}
84		90
85	// J16	91	// J16
86	if (EE_Parameter.J16Timing > 250 && Parameter_J16Timing > 230)	92	if (EE_Parameter.J16Timing > 250 && Parameter_J16Timing > 230)
87	J16 = EE_Parameter.J16Bitmask & 128;	93	J16 = EE_Parameter.J16Bitmask & 128;
88	else if (EE_Parameter.J16Timing > 250 && Parameter_J16Timing < 10)	94	else if (EE_Parameter.J16Timing > 250 && Parameter_J16Timing < 10)
89	J16 = !(EE_Parameter.J16Bitmask & 128);	95	J16 = !(EE_Parameter.J16Bitmask & 128);
90	else if (!J16Blinkcount--) {	96	else if (!J16Blinkcount--) {
91	J16Blinkcount = Parameter_J16Timing - 1;	97	J16Blinkcount = Parameter_J16Timing - 1;
92	J16Mask = (J16Mask == 1 ? 0x80 : J16Mask >> 1);	98	J16Mask = (J16Mask == 1 ? 0x80 : J16Mask >> 1);
93		99
94	J16 = EE_Parameter.J16Bitmask & J16Mask;	100	J16 = EE_Parameter.J16Bitmask & J16Mask;
95	}	101	}
96		102
97	J16Brightness = EE_Parameter.J16Bitmask & J16Mask ? Parameter_J16Brightness / 23 : 0;	103	J16Brightness = EE_Parameter.J16Bitmask & J16Mask ? Parameter_J16Brightness / 23 : 0;
98		104
99	// J17	105	// J17
100	if (EE_Parameter.J17Timing > 250 && Parameter_J17Timing > 230)	106	if (EE_Parameter.J17Timing > 250 && Parameter_J17Timing > 230)
101	J17 = EE_Parameter.J17Bitmask & 128;	107	J17 = EE_Parameter.J17Bitmask & 128;
102	else if (EE_Parameter.J17Timing > 250 && Parameter_J17Timing < 10)	108	else if (EE_Parameter.J17Timing > 250 && Parameter_J17Timing < 10)
103	J17 = !(EE_Parameter.J17Bitmask & 128);	109	J17 = !(EE_Parameter.J17Bitmask & 128);
104	else if (!J17Blinkcount--) {	110	else if (!J17Blinkcount--) {
105	J17Blinkcount = Parameter_J17Timing - 1;	111	J17Blinkcount = Parameter_J17Timing - 1;
106	J17Mask = (J17Mask == 1 ? 0x80 : J17Mask >> 1);	112	J17Mask = (J17Mask == 1 ? 0x80 : J17Mask >> 1);
107		113
108	J17 = EE_Parameter.J17Bitmask & J17Mask;	114	J17 = EE_Parameter.J17Bitmask & J17Mask;
109	}	115	}
110		116
111	J17Brightness = EE_Parameter.J17Bitmask & J17Mask ? Parameter_J17Brightness / 23 : 0;	117	J17Brightness = EE_Parameter.J17Bitmask & J17Mask ? Parameter_J17Brightness / 23 : 0;
112	}	118	}
113		119
114	// delay: 0...9 - BRIGHTNESS/23: 0-Aus...10-Max - Bei Unterspannung volle Leuchtkraft	120	// delay: 0...9 - BRIGHTNESS/23: 0-Aus...10-Max - Bei Unterspannung volle Leuchtkraft
115	setJ16(J16 && (delay < J16Brightness \|\| UBat < EE_Parameter.UnterspannungsWarnung));	121	setJ16(J16 && (delay < J16Brightness \|\| UBat < EE_Parameter.UnterspannungsWarnung));
116	setJ17(J17 && (delay < J17Brightness \|\| UBat < EE_Parameter.UnterspannungsWarnung));	122	setJ17(J17 && (delay < J17Brightness \|\| UBat < EE_Parameter.UnterspannungsWarnung));
117	}	123	}
118		124

Subversion Repositories FlightCtrl

(root)/branches/V0.71i_DSL_X_LED/led.c @ 2509 - Rev 1163 → 1208