Subversion Repositories FlightCtrl

#include <inttypes.h>
#include "main.h"
#include "parameter.h"

uint16_t        LED1_Timing = 0;
uint16_t        LED2_Timing = 0;

unsigned char   J16Blinkcount = 0, J16Mask = 1;
unsigned char   J17Blinkcount = 0, J17Mask = 1;

unsigned char   lightsEnabled = 0;

extern char     MotorenEin;


// 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( !MotorenEin ) {
       
                /* Mit dem Gier-Stick links lassen sich die LED's ein- und ausschalten.
                 */
                if( PARAM_LED_STICK_ENABLED ) {

                        if( PPM_in[ EE_Parameter.Kanalbelegung[ K_GAS ] ]  > 35-120 &&
                            PPM_in[ EE_Parameter.Kanalbelegung[ K_GAS ] ]  < 80 ) {
                           
                                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;
                }
        }
       
        if( PARAM_LED_ENGINE_ENABLED ) {
                lightsEnabled = MotorenEin;
        }
       
        if( !delay-- ) {

                delay = 4;      // 10ms Intervall

                // Soll die Unterspannungswarnung zu einem schnelleren Blinken führen?
                if( PARAM_LED_WARNING_ENABLED ) {
               
                        // Grenze für Unterspannungswarnung erreicht?
                        if( UBat < EE_Parameter.UnterspannungsWarnung ) {
                       
                                delay = 2;      // 5ms Intervall
                        }
                }
               
                /* J16
                 */
                if( ( EE_Parameter.J16Timing > 250 ) && ( Parameter_J16Timing > 230 ) ) {
                        if( EE_Parameter.J16Bitmask & 128 )
                                J16_ON;
                        else
                                J16_OFF;
                } else if( ( EE_Parameter.J16Timing > 250 ) && ( Parameter_J16Timing < 10 ) ) {
                        if( EE_Parameter.J16Bitmask & 128 )
                                J16_OFF;
                        else
                                J16_ON;
                } else if( !J16Blinkcount-- ) {
               
                        J16Blinkcount = Parameter_J16Timing-1;
                       
                        if( J16Mask == 1 )
                                J16Mask = 128;
                        else
                                J16Mask /= 2;
                        if( J16Mask & EE_Parameter.J16Bitmask )
                                J16_ON;
                        else
                                J16_OFF;
                }  
               
                /* J17
                 */
                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;
                }  
        }
       
               
        if( !lightsEnabled ) {
                J16_OFF;
                J17_OFF;
        }
}