WebSVN - FlightCtrl - Blame - Rev 2527

Rev	Author	Line No.	Line
927	hbuss	1	#include <inttypes.h>
		2	#include "main.h"
		3
		4	uint16_t LED1_Timing = 0;
		5	uint16_t LED2_Timing = 0;
		6	unsigned char J16Blinkcount = 0, J16Mask = 1;
		7	unsigned char J17Blinkcount = 0, J17Mask = 1;
2370	holgerb	8	unsigned char NC_Wait_for_LED = 0; // signal to NC: Wait for the LAD PAtter before switching to the next WP
2518	holgerb	9	unsigned int ShutterCounter = 0;
2527	holgerb	10	unsigned char Out1ChangedFlag = 0; // can be 0 or 0x80
927	hbuss	11	// initializes the LED control outputs J16, J17
		12	void LED_Init(void)
		13	{
1254	killagreg	14	// set PC2 & PC3 as output (control of J16 & J17)
		15	DDRC \|= (1<<DDC2)\|(1<<DDC3);
		16	J16_OFF;
		17	J17_OFF;
		18	J16Blinkcount = 0; J16Mask = 128;
		19	J17Blinkcount = 0; J17Mask = 128;
927	hbuss	20	}
		21
		22	// called in UpdateMotors() every 2ms
		23	void LED_Update(void)
		24	{
2518	holgerb	25	static char delay = 0, last_portC = 0;
1254	killagreg	26	static unsigned char J16Bitmask = 0;
		27	static unsigned char J17Bitmask = 0;
1423	hbuss	28	static unsigned char J16Warn = 0, J17Warn = 0;
2485	holgerb	29	static unsigned char from_nc = 0; // Copy for the timing
2348	holgerb	30
2485	holgerb	31	if(FromNC_WP_EventChannel_New) from_nc = FromNC_WP_EventChannel_New;
1933	holgerb	32	if(!delay--) // 20ms Intervall
1254	killagreg	33	{
2402	holgerb	34	J16Bitmask = EE_Parameter.J16Bitmask;
		35	J17Bitmask = EE_Parameter.J17Bitmask;
1933	holgerb	36	delay = 9;
2502	holgerb	37	if(FC_StatusFlags & (FC_STATUS_LOWBAT \| FC_STATUS_EMERGENCY_LANDING) \|\| (VersionInfo.HardwareError[1] & FC_ERROR1_I2C) \|\| !SenderOkay)
1254	killagreg	38	{
1765	killagreg	39	if(EE_Parameter.WARN_J16_Bitmask)
1423	hbuss	40	{
		41	if(!J16Warn) J16Blinkcount = 4;
		42	J16Warn = 1;
1765	killagreg	43	}
		44	if(EE_Parameter.WARN_J17_Bitmask)
1423	hbuss	45	{
		46	if(!J17Warn) J17Blinkcount = 4;
		47	J17Warn = 1;
1765	killagreg	48	}
1254	killagreg	49	}
		50	else
		51	{
1423	hbuss	52	J16Warn = 0;
		53	J17Warn = 0;
1254	killagreg	54	}
2183	holgerb	55	//DebugOut.Analog[29] = EE_Parameter.GlobalConfig3;
		56	// Output 1
		57	if(!J16Warn)
1423	hbuss	58	{
1940	holgerb	59	if((EE_Parameter.BitConfig & CFG_MOTOR_BLINK1) && !MotorenEin) {if(EE_Parameter.BitConfig & CFG_MOTOR_OFF_LED1) J16_ON; else J16_OFF;}
927	hbuss	60	else
2380	holgerb	61	if((EE_Parameter.J16Timing > 247) && (Parameter_J16Timing > 220)) {if(J16Bitmask & 128) J16_OFF; else J16_ON; J16Mask = 1; NC_Wait_for_LED = 0;} // Manual overwrite
1350	hbuss	62	else
2380	holgerb	63	if((EE_Parameter.J16Timing > 247) && (Parameter_J16Timing == 5)) {if(J16Bitmask & 128) J16_ON; else J16_OFF; J16Mask = 1; NC_Wait_for_LED = 0;} // Manual overwrite
1254	killagreg	64	else
		65	if(!J16Blinkcount--)
927	hbuss	66	{
2183	holgerb	67	if(EE_Parameter.GlobalConfig3 & CFG3_USE_NC_FOR_OUT1)
		68	{
		69	J16Blinkcount = from_nc / 2;
2380	holgerb	70	if(!from_nc) { NC_Wait_for_LED = 0; if(J16Bitmask & 128) J16_ON; else J16_OFF; J16Mask = 0; } // Ausschalten
2183	holgerb	71	else
		72	{
2370	holgerb	73	NC_Wait_for_LED = 1;
2183	holgerb	74	if(J16Mask == 0)
		75	{
2485	holgerb	76	from_nc = FromNC_WP_EventChannel_New;
		77	FromNC_WP_EventChannel_New = 0;
2380	holgerb	78	J16Mask = 64;
		79	if(J16Bitmask & 128) J16_ON; else J16_OFF; // Ausschalten
2183	holgerb	80	}
		81	else
		82	{
2485	holgerb	83	if(J16Mask & J16Bitmask) J16_ON; else J16_OFF;
2183	holgerb	84	J16Mask /= 2;
		85	}
		86	}
		87	}
		88	else
		89	{
		90	J16Blinkcount = Parameter_J16Timing / 2;
2402	holgerb	91	if(J16Mask == 1) { from_nc = 0; J16Mask = 64; } else J16Mask /= 2;
2183	holgerb	92	if(J16Mask & J16Bitmask) J16_ON; else J16_OFF;
2370	holgerb	93	NC_Wait_for_LED = 0;
2183	holgerb	94	}
1254	killagreg	95	}
1423	hbuss	96	}
2183	holgerb	97	else // warning case
1423	hbuss	98	if(!J16Blinkcount--)
		99	{
		100	J16Blinkcount = 10-1;
		101	if(J16Mask == 1) J16Mask = 128; else J16Mask /= 2;
		102	if(J16Mask & EE_Parameter.WARN_J16_Bitmask) J16_ON; else J16_OFF;
		103	}
2183	holgerb	104	// Output 2
1350	hbuss	105
1423	hbuss	106	if(!J17Warn)
		107	{
1940	holgerb	108	if((EE_Parameter.BitConfig & CFG_MOTOR_BLINK2) && !MotorenEin) {if(EE_Parameter.BitConfig & CFG_MOTOR_OFF_LED2) J17_ON; else J17_OFF;}
927	hbuss	109	else
2380	holgerb	110	if((EE_Parameter.J17Timing > 247) && (Parameter_J17Timing > 220)) {if(J17Bitmask & 128) J17_OFF; else J17_ON; J17Mask = 1;}
1350	hbuss	111	else
2380	holgerb	112	if((EE_Parameter.J17Timing > 247) && (Parameter_J17Timing == 5)) {if(J17Bitmask & 128) J17_ON; else J17_OFF; J17Mask = 1;}
1254	killagreg	113	else
		114	if(!J17Blinkcount--)
927	hbuss	115	{
1933	holgerb	116	J17Blinkcount = Parameter_J17Timing / 2;
2380	holgerb	117	if(J17Mask == 1) J17Mask = 64; else J17Mask /= 2;
2402	holgerb	118	if(J17Mask & J17Bitmask) J17_ON; else J17_OFF;
1254	killagreg	119	}
927	hbuss	120	}
2183	holgerb	121	else // warning case
1423	hbuss	122	if(!J17Blinkcount--)
		123	{
		124	J17Blinkcount = 10-1;
		125	if(J17Mask == 1) J17Mask = 128; else J17Mask /= 2;
		126	if(J17Mask & EE_Parameter.WARN_J17_Bitmask) J17_ON; else J17_OFF;
		127	}
2183	holgerb	128
2518	holgerb	129
		130	if(PORTC & (1<<PORTC2)) // output is on
		131	{
2527	holgerb	132	if(!(last_portC & (1<<PORTC2)))
		133	{
		134	Out1ChangedFlag = 0x80;// this Flag marks a changed Out1;
		135	ShutterCounter++; // count if output swiched to high
		136	}
2518	holgerb	137	FC_StatusFlags2 \|= FC_STATUS2_OUT1_ACTIVE; //else FC_StatusFlags2 &= ~FC_STATUS2_OUT1_ACTIVE; // Out1 (J16) -> wird in der SPI zur�ck gesetzt
		138	}
2040	holgerb	139	if(PORTC & (1<<PORTC3)) FC_StatusFlags2 \|= FC_STATUS2_OUT2_ACTIVE; else FC_StatusFlags2 &= ~FC_STATUS2_OUT2_ACTIVE; // Out2 (J17)
2518	holgerb	140	last_portC = PORTC;
1423	hbuss	141	}
927	hbuss	142	}
1423	hbuss	143

Subversion Repositories FlightCtrl

(root)/tags/V2.12a/led.c @ 2696 - Rev 2527