WebSVN - FlightCtrl - Diff - Rev 1197 and 1202 - /branches/v0.72p kmpec/led.c


#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;
 if(!delay--)  // 10ms Intervall
  {
 
  delay = 4;
 
 
 
 
/*
  //Unterspannungswarnung -> UserParameter4
  if(UBat < EE_Parameter.UnterspannungsWarnung)
  {
   if(!J16Blinkcount--)
   {
     J16Blinkcount = Parameter_J16Timing-1;
     if(J16Mask == 1) J16Mask = 128; else J16Mask /= 2;
     if(J16Mask & EE_Parameter.UserParam4) J16_ON; else J16_OFF;
   }  
  }
 
*/
  //Wenn Höhe halten aktiv -Bitmuster = UserParameter1
  if(HoehenReglerAktiv > 0 && Parameter_NaviGpsModeControl > 90 && Parameter_NaviGpsModeControl < 200)
  {
   if(!J16Blinkcount--)
   {
     J16Blinkcount = Parameter_J16Timing-1;
     if(J16Mask == 1) J16Mask = 128; else J16Mask /= 2;
     if(J16Mask & EE_Parameter.UserParam1) J16_ON; else J16_OFF;
   }  
  }  
 
  //Wenn AID aktiv -Bitmuster = UserParameter2
  else
  if(Parameter_NaviGpsModeControl < 100 )
  {
  if(!J16Blinkcount--)
   {
     J16Blinkcount = Parameter_J16Timing-1;
     if(J16Mask == 1) J16Mask = 128; else J16Mask /= 2;
     if(J16Mask & EE_Parameter.UserParam2) J16_ON; else J16_OFF;
   }  
  }
 else
 
  //Wenn ComingHome aktiv -Bitmuster = UserParameter3
 if(Parameter_NaviGpsModeControl > 150 )
  {
  if(!J16Blinkcount--)
   {
     J16Blinkcount = Parameter_J16Timing-1;
     if(J16Mask == 1) J16Mask = 128; else J16Mask /= 2;
     if(J16Mask & EE_Parameter.UserParam3) J16_ON; else J16_OFF;
   }  
  }
   
  else
  {
   J16_ON;
  }
 
   
   
  if((EE_Parameter.J17Timing > 250) && (Parameter_J17Timing > 230)) {if(EE_Parameter.J17Bitmask & 128) J17_ON; else J17_OFF;}
  else
  if((EE_Parameter.J17Timing > 250) && (Parameter_J17Timing < 10))  {if(EE_Parameter.J17Bitmask & 128) J17_OFF; else J17_ON;}
  else
  if(!J17Blinkcount--)
   {
     J17Blinkcount = Parameter_J17Timing-1;
     if(J17Mask == 1) J17Mask = 128; else J17Mask /= 2;
     if(J17Mask & EE_Parameter.J17Bitmask) J17_ON; else J17_OFF;
   }  
  }
}
 

Rev 1197	Rev 1202
1	#include <inttypes.h>	1	#include <inttypes.h>
2	#include "main.h"	2	#include "main.h"
3	//#include "fc.c"	-
-		3
4		4
5	uint16_t LED1_Timing = 0;	5	uint16_t LED1_Timing = 0;
6	uint16_t LED2_Timing = 0;	6	uint16_t LED2_Timing = 0;
7	unsigned char J16Blinkcount = 0, J16Mask = 1;	7	unsigned char J16Blinkcount = 0, J16Mask = 1;
8	unsigned char J17Blinkcount = 0, J17Mask = 1;	8	unsigned char J17Blinkcount = 0, J17Mask = 1;
9		9
10	// initializes the LED control outputs J16, J17	10	// initializes the LED control outputs J16, J17
11	void LED_Init(void)	11	void LED_Init(void)
12	{	12	{
13	// set PC2 & PC3 as output (control of J16 & J17)	13	// set PC2 & PC3 as output (control of J16 & J17)
14	DDRC \|= (1<<DDC2)\|(1<<DDC3);	14	DDRC \|= (1<<DDC2)\|(1<<DDC3);
15	J16_OFF;	15	J16_OFF;
16	J17_OFF;	16	J17_OFF;
17	J16Blinkcount = 0; J16Mask = 128;	17	J16Blinkcount = 0; J16Mask = 128;
18	J17Blinkcount = 0; J17Mask = 128;	18	J17Blinkcount = 0; J17Mask = 128;
19	}	19	}
20		20
21		21
22	// called in UpdateMotors() every 2ms	22	// called in UpdateMotors() every 2ms
23	void LED_Update(void)	23	void LED_Update(void)
24	{	24	{
25	static char delay = 0;	25	static char delay = 0;
26	if(!delay--) // 10ms Intervall	26	if(!delay--) // 10ms Intervall
27	{	27	{
28		28
29	delay = 4;	29	delay = 4;
-		30
-		31
-		32
-		33
-		34	/*
-		35	//Unterspannungswarnung -> UserParameter4
-		36	if(UBat < EE_Parameter.UnterspannungsWarnung)
-		37	{
-		38	if(!J16Blinkcount--)
-		39	{
-		40	J16Blinkcount = Parameter_J16Timing-1;
-		41	if(J16Mask == 1) J16Mask = 128; else J16Mask /= 2;
-		42	if(J16Mask & EE_Parameter.UserParam4) J16_ON; else J16_OFF;
-		43	}
-		44	}
-		45
30		46	*/
31	//Wenn Höhe halten aktiv -Bitmuster = UserParameter1	47	//Wenn Höhe halten aktiv -Bitmuster = UserParameter1
32	if(HoehenReglerAktiv > 0 && Parameter_NaviGpsModeControl > 90 && Parameter_NaviGpsModeControl < 200)	48	if(HoehenReglerAktiv > 0 && Parameter_NaviGpsModeControl > 90 && Parameter_NaviGpsModeControl < 200)
33	{	49	{
34	if(!J16Blinkcount--)	50	if(!J16Blinkcount--)
35	{	51	{
36	J16Blinkcount = Parameter_J16Timing-1;	52	J16Blinkcount = Parameter_J16Timing-1;
37	if(J16Mask == 1) J16Mask = 128; else J16Mask /= 2;	53	if(J16Mask == 1) J16Mask = 128; else J16Mask /= 2;
38	if(J16Mask & EE_Parameter.UserParam1) J16_ON; else J16_OFF;	54	if(J16Mask & EE_Parameter.UserParam1) J16_ON; else J16_OFF;
39	}	55	}
40	}	56	}
41		57
42	//Wenn AID aktiv -Bitmuster = UserParameter2	58	//Wenn AID aktiv -Bitmuster = UserParameter2
43	else	59	else
44	if(Parameter_NaviGpsModeControl < 100 )	60	if(Parameter_NaviGpsModeControl < 100 )
45	{	61	{
46	if(!J16Blinkcount--)	62	if(!J16Blinkcount--)
47	{	63	{
48	J16Blinkcount = Parameter_J16Timing-1;	64	J16Blinkcount = Parameter_J16Timing-1;
49	if(J16Mask == 1) J16Mask = 128; else J16Mask /= 2;	65	if(J16Mask == 1) J16Mask = 128; else J16Mask /= 2;
50	if(J16Mask & EE_Parameter.UserParam2) J16_ON; else J16_OFF;	66	if(J16Mask & EE_Parameter.UserParam2) J16_ON; else J16_OFF;
51	}	67	}
52	}	68	}
53	else	69	else
54		70
55	//Wenn ComingHome aktiv -Bitmuster = UserParameter3	71	//Wenn ComingHome aktiv -Bitmuster = UserParameter3
56	if(Parameter_NaviGpsModeControl > 150 )	72	if(Parameter_NaviGpsModeControl > 150 )
57	{	73	{
58	if(!J16Blinkcount--)	74	if(!J16Blinkcount--)
59	{	75	{
60	J16Blinkcount = Parameter_J16Timing-1;	76	J16Blinkcount = Parameter_J16Timing-1;
61	if(J16Mask == 1) J16Mask = 128; else J16Mask /= 2;	77	if(J16Mask == 1) J16Mask = 128; else J16Mask /= 2;
62	if(J16Mask & EE_Parameter.UserParam3) J16_ON; else J16_OFF;	78	if(J16Mask & EE_Parameter.UserParam3) J16_ON; else J16_OFF;
63	}	79	}
64	}	80	}
65		81
66	else	82	else
67	{	83	{
68	J16_ON;	84	J16_ON;
69	}	85	}
70		86
71		87
72		88
73	if((EE_Parameter.J17Timing > 250) && (Parameter_J17Timing > 230)) {if(EE_Parameter.J17Bitmask & 128) J17_ON; else J17_OFF;}	89	if((EE_Parameter.J17Timing > 250) && (Parameter_J17Timing > 230)) {if(EE_Parameter.J17Bitmask & 128) J17_ON; else J17_OFF;}
74	else	90	else
75	if((EE_Parameter.J17Timing > 250) && (Parameter_J17Timing < 10)) {if(EE_Parameter.J17Bitmask & 128) J17_OFF; else J17_ON;}	91	if((EE_Parameter.J17Timing > 250) && (Parameter_J17Timing < 10)) {if(EE_Parameter.J17Bitmask & 128) J17_OFF; else J17_ON;}
76	else	92	else
77	if(!J17Blinkcount--)	93	if(!J17Blinkcount--)
78	{	94	{
79	J17Blinkcount = Parameter_J17Timing-1;	95	J17Blinkcount = Parameter_J17Timing-1;
80	if(J17Mask == 1) J17Mask = 128; else J17Mask /= 2;	96	if(J17Mask == 1) J17Mask = 128; else J17Mask /= 2;
81	if(J17Mask & EE_Parameter.J17Bitmask) J17_ON; else J17_OFF;	97	if(J17Mask & EE_Parameter.J17Bitmask) J17_ON; else J17_OFF;
82	}	98	}
83	}	99	}
84	}	100	}
85		101

Subversion Repositories FlightCtrl

(root)/branches/v0.72p kmpec/led.c - Rev 1197 → 1202