0,0 → 1,117 |
#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; |
else |
J16_OFF; |
} |
|
void setJ17(char enabled) { |
if ((enabled && lightsOn) ^ LED_NEGATE_J17) |
J17_ON; |
else |
J17_OFF; |
} |
|
// 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)); |
} |