ROBOFRIEN_LED.cpp

00001 #include "ROBOFRIEN_LED.h"
00002 
00003 Timer LedTimer;
00004 DigitalOut myled1(LED1);
00005 DigitalOut myled4(LED4);
00006 
00007 void ROBOFRIEN_LED::Init(){
00008     LedTimer.start();
00009     myled1 = 0;
00010     myled4 = 0;
00011 }
00012 
00013 int ex_headlight_timer, ex_sidelight_timer;
00014 void ROBOFRIEN_LED::Update(){
00015     //// LED - HEAD LIGHT ///
00016     if( (HeadlightPeriod == 0) | (HeadlightDutyrate == 0) ){
00017         myled1 = 0;
00018     }else{
00019         if( (ex_headlight_timer +  ((int)HeadlightPeriod * 100) ) >=  LedTimer.read_ms() ){
00020             if( (ex_headlight_timer + (float)((int)HeadlightPeriod * 100) * ((float)HeadlightDutyrate / 100.0) ) >= LedTimer.read_ms() ){
00021                 myled1 = 1;   
00022             }else{
00023                 myled1 = 0;
00024             }
00025         }else{
00026             ex_headlight_timer = LedTimer.read_ms();
00027         }            
00028     } 
00029     //// LED - SIDE LIGHT ///
00030     if( (SidelightPeriod == 0) | (SidelightDutyrate == 0) ){
00031         myled4 = 0;        
00032     }else{
00033         if( (ex_sidelight_timer +  ((int)SidelightPeriod * 100) ) >=  LedTimer.read_ms() ){
00034             if( (ex_sidelight_timer + (float)((int)SidelightPeriod * 100) * ((float)SidelightDutyrate / 100.0) ) >= LedTimer.read_ms() ){
00035                 myled4 = 1;   
00036             }else{
00037                 myled4 = 0;
00038             }
00039         }else{
00040             ex_sidelight_timer = LedTimer.read_ms();
00041         }            
00042     }
00043     
00044     /////////// RESET //////////////
00045     if( LedTimer.read_ms() > 1000000000){
00046         ex_headlight_timer = 0;
00047         ex_sidelight_timer = 0;
00048         LedTimer.reset();   
00049     }
00050 
00051 }