SmartPDCode/pro/ui/led.c

#include "led.h"
#include "timer.h"
#include "gpio.h"
#include "elog.h"
#include "common.h"

#if 1
    #define LOGD  log_d
    #define LOGE  log_e
#else
    #define LOGD  printf
    #define LOGE  printf
#endif

#define LEDR_GPIO  106      //PD10=96+10
#define LEDG_GPIO  105      //PD9=96+9


typedef struct {
    int         gpio;
    int         on_level;
    int         off_level;
}led_info_t;
static led_info_t led_info[LED_ID_MAX]={
    {LEDR_GPIO, 0, 1},
    {LEDG_GPIO, 0, 1},
};


typedef struct {
    int         io;
    int         tmr;
    led_para_t  para;
    led_info_t  *info;
    uint32_t    cnt;
    int         id;
}led_data_t;

typedef struct {
    led_data_t  data[LED_ID_MAX];
}led_handle_t;
static led_handle_t ledHandle={0};

static void tmr_handler(void *arg, int last)
{
    int level;
    led_data_t *h=(led_data_t*)arg;
    
    h->cnt++;
    if(h->cnt%2) {
        if(h->para.off_ms>0) {
            gpio_set(h->io, h->info->on_level);
            timer_setup(h->tmr, h->para.off_ms, 0);
        }
    }
    else {
        if(h->para.on_ms>0) {
            gpio_set(h->io, h->info->off_level);
            timer_setup(h->tmr, h->para.on_ms, 0);
        }
    }
    
    if(last) {
        timer_stop(h->tmr);
    } 
}
//////////////////////////////////////////////////
int led_init(void)
{
    int i;
    led_handle_t *h=&ledHandle;
    
    for(i=0; i<LED_ID_MAX; i++) {
        h->data[i].info = &led_info[i];
        h->data[i].io = gpio_init(led_info[i].gpio, GPIO_OUT);
        gpio_set(h->data[i].io, led_info[i].off_level);
        h->data[i].tmr = -1;
        h->data[i].cnt = 0;
    }
    
    //led_para_t para={1000, 1000, -1};
    //led_set_ex(LED_ID_RED, &para);
    
    return 0;
}


int led_deinit(void)
{
    int i;
    led_handle_t *h=&ledHandle;
    
    for(i=0; i<LED_ID_MAX; i++) {
        gpio_deinit(h->data[i].io);
        timer_stop(h->data[i].tmr);
        
        h->data[i].io = -1;
        h->data[i].tmr = -1;
    }
    return 0;
}


int led_set(int mode)
{
    return 0;
}


int led_set_ex(int led_id, led_para_t *para)
{
    led_handle_t *h=&ledHandle;
    
    if(!para || para->times==0) {
        return -1;
    }

    led_data_t *ld=&h->data[led_id];
    if(ld->tmr!=-1) {
        timer_stop(ld->tmr);
    }
    
    ld->cnt = 0;
    ld->para = *para;
    if(ld->para.on_ms>0 && ld->para.off_ms>0) {
        ld->para.times *= 2;
    }
    ld->tmr = timer_start(ld->para.on_ms, 0, ld->para.times, tmr_handler, ld);
    
    return ld->tmr;
}


int led_stop(int h)
{
    led_data_t *ld=(led_data_t*)h;
    
    if(h==-1) {
        return -1;
    }
    
    timer_stop(ld->tmr);
    ld->tmr = -1;
    return 0;
}