Subversion Repositories FlightCtrl

#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;
        DebugOut.Analog[24] = 100;
    } else {
        J16_OFF;
        DebugOut.Analog[24] = 0;
    }
}

void setJ17(char enabled) {
    if ((enabled && lightsOn) ^ LED_NEGATE_J17) {
        J17_ON;
        DebugOut.Analog[25] = 100;
    } else {
        J17_OFF;
        DebugOut.Analog[25] = 0;
    }
}

// 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));
}