| 0,0 → 1,124 |
|---|
| #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) { |
| |
| // Mit dem Gier-Stick rechts lassen sich bei stehenden Motoren die LED's ein- und mit links ausschalten |
| if (!MotorenEin) { |
| if (PARAM_LED_STICK_ENABLED) { |
| 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; |
| } |
| |
| // Die LED's können mit den Motoren ein- ausgeschaltet werden |
| if (PARAM_LED_ENGINE_ENABLED) |
| lightsEnabled = MotorenEin; |
| |
| 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; |
| |
| if (EE_Parameter.J16Bitmask & J16Mask) |
| J16Brightness = Parameter_J16Brightness / 23; |
| else |
| J16Brightness = 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; |
| |
| if (EE_Parameter.J17Bitmask & J17Mask) |
| J17Brightness = Parameter_J17Brightness / 23; |
| else |
| J17Brightness = 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)); |
| } |