Subversion Repositories FlightCtrl

/*****************************************************************************************************************************
* File:                 led.c
*
* Purpose:              controlling LEDs
*
* Functions:    void LED_Init(void)
*                               void LED_Update(void)
*
*****************************************************************************************************************************/
#include "led.h"

#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;

//------------------------------------------------------------------------------------------------------
// initialisiert die Schalt-Ausgänge PORTC2 und PORTC3 an SV2 (control of J16 & J17)
//------------------------------------------------------------------------------------------------------
void LED_Init(void)
{
        DDRC |= (1<<DDC2)|(1<<DDC3);
        J16_OFF;
        J17_OFF;
        J16Blinkcount = 0; J16Mask = 128;
        J17Blinkcount = 0; J17Mask = 128;
}
//------------------------------------------------------------------------------------------------------


//--------------------------------------------------------------------------------------------------------------------------------
// wird aus UpdateMotors() alle 2ms aufgerufen
// damit können am Mikrokopter aussen angebrachte LEDs gesteuert werden
// deren Ankoppelung geschieht über PORTC2 und PORTC3
//--------------------------------------------------------------------------------------------------------------------------------
void LED_Update(void)
{
        static char delay = 0;
        static unsigned char J16Bitmask = 0;
        static unsigned char J17Bitmask = 0;
        if(!delay--)                                                    // 10ms Intervall
        {
                delay = 4;
               
                if(MikroKopterFlags & FLAG_LOWBAT || SenderOkay < 128)
                {
                        J16Bitmask = EE_Parameter.WARN_J16_Bitmask;
                        J17Bitmask = EE_Parameter.WARN_J17_Bitmask;
                }
                else
                {
                        J16Bitmask = EE_Parameter.J16Bitmask;
                        J17Bitmask = EE_Parameter.J17Bitmask;
                }
               
                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 > 250) && (Parameter_J16Timing > 220)) {if(J16Bitmask & 128) J16_ON; else J16_OFF;}
                else
               
                if((EE_Parameter.J16Timing > 250) && (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;
                }
               
                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 > 250) && (Parameter_J17Timing > 230)) {if(J17Bitmask & 128) J17_ON; else J17_OFF;}
                else
                if((EE_Parameter.J17Timing > 250) && (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;
                }
        } // Ende : 10ms Intervall
}
//--------------------------------------------------------------------------------------------------------------------------------