WebSVN - FlightCtrl - Diff - Rev 1765 and 1769 - /branches/V0.82a_ACC-HH


#include <inttypes.h>
#include "main.h"
 
uint16_t LED1_Timing = 0;
uint16_t LED2_Timing = 0;
unsigned char J16Blinkcount = 0, J16Mask = 1;
unsigned char J17Blinkcount = 0, J17Mask = 1;
 
// 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);
        J16_OFF;
        J17_OFF;
        J16Blinkcount = 0; J16Mask = 128;
        J17Blinkcount = 0; J17Mask = 128;
}
 
// called in UpdateMotors() every 2ms
void LED_Update(void)
{
        static char delay = 0;
        static unsigned char J16Bitmask = 0;
        static unsigned char J17Bitmask = 0;
        static unsigned char J16Warn = 0, J17Warn = 0;
        if(!delay--)  // 10ms Intervall
        {
        delay = 4;
 
        if(FC_StatusFlags & (FC_STATUS_LOWBAT | FC_STATUS_EMERGENCY_LANDING) || (VersionInfo.HardwareError[1] & FC_ERROR1_I2C))
        {
                if(EE_Parameter.WARN_J16_Bitmask)
                 {
          if(!J16Warn) J16Blinkcount = 4;
          J16Warn = 1;
                 }
                if(EE_Parameter.WARN_J17_Bitmask)
                 {
          if(!J17Warn) J17Blinkcount = 4;
          J17Warn = 1;
                 }
        }
        else
        {
        J16Warn = 0;
        J17Warn = 0;
                J16Bitmask = EE_Parameter.J16Bitmask;
                J17Bitmask = EE_Parameter.J17Bitmask;
        }
 
 if(!J16Warn)
  {
  if((EE_Parameter.BitConfig & CFG_MOTOR_BLINK) && !MotorenEin) {if(EE_Parameter.BitConfig & CFG_MOTOR_OFF_LED1) J16_ON; else J16_OFF;}
  else
  if((EE_Parameter.J16Timing > 247) && (Parameter_J16Timing > 220)) {if(J16Bitmask & 128) J16_ON; else J16_OFF;}
  else
  if((EE_Parameter.J16Timing > 247) && (Parameter_J16Timing < 10))  {if(J16Bitmask & 128) J16_OFF; else J16_ON;}
  else
  if(!J16Blinkcount--)
   {
     J16Blinkcount = Parameter_J16Timing-1;
     if(J16Mask == 1) J16Mask = 128; else J16Mask /= 2;
     if(J16Mask & J16Bitmask) J16_ON; else J16_OFF;
   }
  }
  else
  if(!J16Blinkcount--)
   {
     J16Blinkcount = 10-1;
     if(J16Mask == 1) J16Mask = 128; else J16Mask /= 2;
     if(J16Mask & EE_Parameter.WARN_J16_Bitmask) J16_ON; else J16_OFF;
   }
 
 if(!J17Warn)
  {
  if((EE_Parameter.BitConfig & CFG_MOTOR_BLINK) && !MotorenEin) {if(EE_Parameter.BitConfig & CFG_MOTOR_OFF_LED2) J17_ON; else J17_OFF;}
  else
  if((EE_Parameter.J17Timing > 247) && (Parameter_J17Timing > 220)) {if(J17Bitmask & 128) J17_ON; else J17_OFF;}
  else
  if((EE_Parameter.J17Timing > 247) && (Parameter_J17Timing < 10))  {if(J17Bitmask & 128) J17_OFF; else J17_ON;}
  else
  if(!J17Blinkcount--)
   {
     J17Blinkcount = Parameter_J17Timing-1;
     if(J17Mask == 1) J17Mask = 128; else J17Mask /= 2;
     if(J17Mask & J17Bitmask) J17_ON; else J17_OFF;
   }
  }
  else
  if(!J17Blinkcount--)
   {
     J17Blinkcount = 10-1;
     if(J17Mask == 1) J17Mask = 128; else J17Mask /= 2;
     if(J17Mask & EE_Parameter.WARN_J17_Bitmask) J17_ON; else J17_OFF;
   }
 }
}
 
 

Rev 1765	Rev 1769
1	#include <inttypes.h>	1	#include <inttypes.h>
2	#include "main.h"	2	#include "main.h"
3		3
4	uint16_t LED1_Timing = 0;	4	uint16_t LED1_Timing = 0;
5	uint16_t LED2_Timing = 0;	5	uint16_t LED2_Timing = 0;
6	unsigned char J16Blinkcount = 0, J16Mask = 1;	6	unsigned char J16Blinkcount = 0, J16Mask = 1;
7	unsigned char J17Blinkcount = 0, J17Mask = 1;	7	unsigned char J17Blinkcount = 0, J17Mask = 1;
8		8
9	// initializes the LED control outputs J16, J17	9	// initializes the LED control outputs J16, J17
10	void LED_Init(void)	10	void LED_Init(void)
11	{	11	{
12	// set PC2 & PC3 as output (control of J16 & J17)	12	// set PC2 & PC3 as output (control of J16 & J17)
13	DDRC \|= (1<<DDC2)\|(1<<DDC3);	13	DDRC \|= (1<<DDC2)\|(1<<DDC3);
14	J16_OFF;	14	J16_OFF;
15	J17_OFF;	15	J17_OFF;
16	J16Blinkcount = 0; J16Mask = 128;	16	J16Blinkcount = 0; J16Mask = 128;
17	J17Blinkcount = 0; J17Mask = 128;	17	J17Blinkcount = 0; J17Mask = 128;
18	}	18	}
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;	23	static char delay = 0;
24	static unsigned char J16Bitmask = 0;	24	static unsigned char J16Bitmask = 0;
25	static unsigned char J17Bitmask = 0;	25	static unsigned char J17Bitmask = 0;
26	static unsigned char J16Warn = 0, J17Warn = 0;	26	static unsigned char J16Warn = 0, J17Warn = 0;
27	if(!delay--) // 10ms Intervall	27	if(!delay--) // 10ms Intervall
28	{	28	{
29	delay = 4;	29	delay = 4;
30		-
31	if(FC_StatusFlags & (FC_STATUS_LOWBAT \| FC_STATUS_EMERGENCY_LANDING) \|\| (VersionInfo.HardwareError[1] \| FC_ERROR1_I2C))	30	if(FC_StatusFlags & (FC_STATUS_LOWBAT \| FC_STATUS_EMERGENCY_LANDING) \|\| (VersionInfo.HardwareError[1] & FC_ERROR1_I2C))
32	{	31	{
33	if(EE_Parameter.WARN_J16_Bitmask)	32	if(EE_Parameter.WARN_J16_Bitmask)
34	{	33	{
35	if(!J16Warn) J16Blinkcount = 4;	34	if(!J16Warn) J16Blinkcount = 4;
36	J16Warn = 1;	35	J16Warn = 1;
37	}	36	}
38	if(EE_Parameter.WARN_J17_Bitmask)	37	if(EE_Parameter.WARN_J17_Bitmask)
39	{	38	{
40	if(!J17Warn) J17Blinkcount = 4;	39	if(!J17Warn) J17Blinkcount = 4;
41	J17Warn = 1;	40	J17Warn = 1;
42	}	41	}
43	}	42	}
44	else	43	else
45	{	44	{
46	J16Warn = 0;	45	J16Warn = 0;
47	J17Warn = 0;	46	J17Warn = 0;
48	J16Bitmask = EE_Parameter.J16Bitmask;	47	J16Bitmask = EE_Parameter.J16Bitmask;
49	J17Bitmask = EE_Parameter.J17Bitmask;	48	J17Bitmask = EE_Parameter.J17Bitmask;
50	}	49	}
51		50
52	if(!J16Warn)	51	if(!J16Warn)
53	{	52	{
54	if((EE_Parameter.BitConfig & CFG_MOTOR_BLINK) && !MotorenEin) {if(EE_Parameter.BitConfig & CFG_MOTOR_OFF_LED1) J16_ON; else J16_OFF;}	53	if((EE_Parameter.BitConfig & CFG_MOTOR_BLINK) && !MotorenEin) {if(EE_Parameter.BitConfig & CFG_MOTOR_OFF_LED1) J16_ON; else J16_OFF;}
55	else	54	else
56	if((EE_Parameter.J16Timing > 247) && (Parameter_J16Timing > 220)) {if(J16Bitmask & 128) J16_ON; else J16_OFF;}	55	if((EE_Parameter.J16Timing > 247) && (Parameter_J16Timing > 220)) {if(J16Bitmask & 128) J16_ON; else J16_OFF;}
57	else	56	else
58	if((EE_Parameter.J16Timing > 247) && (Parameter_J16Timing < 10)) {if(J16Bitmask & 128) J16_OFF; else J16_ON;}	57	if((EE_Parameter.J16Timing > 247) && (Parameter_J16Timing < 10)) {if(J16Bitmask & 128) J16_OFF; else J16_ON;}
59	else	58	else
60	if(!J16Blinkcount--)	59	if(!J16Blinkcount--)
61	{	60	{
62	J16Blinkcount = Parameter_J16Timing-1;	61	J16Blinkcount = Parameter_J16Timing-1;
63	if(J16Mask == 1) J16Mask = 128; else J16Mask /= 2;	62	if(J16Mask == 1) J16Mask = 128; else J16Mask /= 2;
64	if(J16Mask & J16Bitmask) J16_ON; else J16_OFF;	63	if(J16Mask & J16Bitmask) J16_ON; else J16_OFF;
65	}	64	}
66	}	65	}
67	else	66	else
68	if(!J16Blinkcount--)	67	if(!J16Blinkcount--)
69	{	68	{
70	J16Blinkcount = 10-1;	69	J16Blinkcount = 10-1;
71	if(J16Mask == 1) J16Mask = 128; else J16Mask /= 2;	70	if(J16Mask == 1) J16Mask = 128; else J16Mask /= 2;
72	if(J16Mask & EE_Parameter.WARN_J16_Bitmask) J16_ON; else J16_OFF;	71	if(J16Mask & EE_Parameter.WARN_J16_Bitmask) J16_ON; else J16_OFF;
73	}	72	}
74		73
75	if(!J17Warn)	74	if(!J17Warn)
76	{	75	{
77	if((EE_Parameter.BitConfig & CFG_MOTOR_BLINK) && !MotorenEin) {if(EE_Parameter.BitConfig & CFG_MOTOR_OFF_LED2) J17_ON; else J17_OFF;}	76	if((EE_Parameter.BitConfig & CFG_MOTOR_BLINK) && !MotorenEin) {if(EE_Parameter.BitConfig & CFG_MOTOR_OFF_LED2) J17_ON; else J17_OFF;}
78	else	77	else
79	if((EE_Parameter.J17Timing > 247) && (Parameter_J17Timing > 220)) {if(J17Bitmask & 128) J17_ON; else J17_OFF;}	78	if((EE_Parameter.J17Timing > 247) && (Parameter_J17Timing > 220)) {if(J17Bitmask & 128) J17_ON; else J17_OFF;}
80	else	79	else
81	if((EE_Parameter.J17Timing > 247) && (Parameter_J17Timing < 10)) {if(J17Bitmask & 128) J17_OFF; else J17_ON;}	80	if((EE_Parameter.J17Timing > 247) && (Parameter_J17Timing < 10)) {if(J17Bitmask & 128) J17_OFF; else J17_ON;}
82	else	81	else
83	if(!J17Blinkcount--)	82	if(!J17Blinkcount--)
84	{	83	{
85	J17Blinkcount = Parameter_J17Timing-1;	84	J17Blinkcount = Parameter_J17Timing-1;
86	if(J17Mask == 1) J17Mask = 128; else J17Mask /= 2;	85	if(J17Mask == 1) J17Mask = 128; else J17Mask /= 2;
87	if(J17Mask & J17Bitmask) J17_ON; else J17_OFF;	86	if(J17Mask & J17Bitmask) J17_ON; else J17_OFF;
88	}	87	}
89	}	88	}
90	else	89	else
91	if(!J17Blinkcount--)	90	if(!J17Blinkcount--)
92	{	91	{
93	J17Blinkcount = 10-1;	92	J17Blinkcount = 10-1;
94	if(J17Mask == 1) J17Mask = 128; else J17Mask /= 2;	93	if(J17Mask == 1) J17Mask = 128; else J17Mask /= 2;
95	if(J17Mask & EE_Parameter.WARN_J17_Bitmask) J17_ON; else J17_OFF;	94	if(J17Mask & EE_Parameter.WARN_J17_Bitmask) J17_ON; else J17_OFF;
96	}	95	}
97	}	96	}
98	}	97	}
99		98
100		99

Subversion Repositories FlightCtrl

(root)/branches/V0.82a_ACC-HH_MartinR/led.c @ 2044 - Rev 1765 → 1769