SmartPDCode/pro/ui/menu.c

#include <string.h>
#include <unistd.h>
#include "menu.h"
#include "lcd.h"
#include "led.h"
#include "beep.h"
#include "paras.h"
#include "cascade.h"
#include "elog.h"
#include "thread.h"
#include "common.h"
#include "lang.h"
#include "timer.h"
#include "cfg.h"


//#define TEXT_ALIGN

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

enum {
    MENU_SYSTEM=0,
    MENU_INPUT,
    MENU_OUTPUT,
    MENU_SENSOR,
    MENU_MODBUS,

    MENU_MAX
};
enum {
    MODBUS_ITEM_ADDR=0,
    MODBUS_ITEM_MODE,
    MODBUS_ITEM_SAVE,
    MODBUS_ITEM_QUIT,

    MODBUS_ITEM_MAX
};
enum {
    UFLAG_KEY=(1<<0),
    UFLAG_FLIP=(1<<1),
    UFLAG_TIMER=(1<<2),
};

typedef struct {
    int menu_id;
    int item_id;
    int item_max;
}page_data_t;
typedef struct {
    int menu_id;
    int menu_lv;    //level
    page_data_t page[MENU_MAX];
}menu_data_t;
typedef struct {
    int         fd;
    int         tmr;
    int         lang;

    int         ph_in;
    int         ph_out;
    int         ch_out;
    int         ch_max;
    menu_data_t menu;
    
    uint64_t    ms;
    uint16_t    uflag;
    int         fliptime;
}menu_handle_t;
static int lang_id=LANG_ID_CHINESE;
//static int lang_id=LANG_ID_ENGLISH;
static menu_handle_t mnHandle={0};


static inline GlobalDeviceManager* get_dm(void)
{
    return &__globalDeviceManage;
}
static uint64_t get_ms(void)
{
    struct timeval tv;
    gettimeofday(&tv, NULL);
    return (uint64_t)(tv.tv_sec)*1000 + (uint64_t)(tv.tv_usec)/1000;
}
static int get_ch_max(void)
{
    int ch=0;
    GlobalPowerManger *tmp;
    GlobalDeviceManager *dm=get_dm();
    
    if(list_empty(&dm->_globalPowerManger.list)) {
        return 0;
    }
    list_for_each_entry(tmp, &dm->_globalPowerManger.list, list)
    {
        ch++;
    }
    return ch;
}
static int is_ph3_in(GlobalDeviceManager *dm)
{
    if ((dm->_globalDevInfo.product.pwr_type == SmartPDU_Tree_AC_Tree ||
         dm->_globalDevInfo.product.pwr_type == SmartPDU_Tree_AC_One  ||
         dm->_globalDevInfo.product.pwr_type == SmartPDU_Tree_AC_One_B)) {
        return 1;
    }
    return 0;
}
static int is_ph3_out(GlobalDeviceManager *dm)
{
    if (dm->_globalDevInfo.product.pwr_type == SmartPDU_Tree_AC_Tree) {
        return 1;
    }
    return 0;
}
static int get_input(GlobalDeviceManager *dm, int ph, PowerInfo *info)
{
    int i=0;
    GlobalTreeACManager *tmp3=NULL;

    if (is_ph3_in(dm)) {
        if(list_empty(&dm->_globalPowerManger.list_Tree_AC)) {
            return -1;
        }

        list_for_each_entry(tmp3, &dm->_globalPowerManger.list_Tree_AC, list_Tree_AC) {
            i++;
            if (i==ph)
                break;
        }
        if (tmp3) {
            *info = tmp3->_PowerInfo;
        }
    }
    else {
        *info = dm->_globalPowerManger._PowerInfo;
    }
    return 0;
}
static int get_output(GlobalDeviceManager *dm, int ch, int ph, PowerInfo *info)
{
    int i=0,j=0;
    GlobalPowerManger *tmp;
    GlobalTreeACManager *tmp3 = NULL;
    
    list_for_each_entry(tmp, &dm->_globalPowerManger.list, list)
    {
        i++;
        if (i==ch) {
            if (is_ph3_out(dm)) {
                list_for_each_entry(tmp3, &tmp->list_Tree_AC, list_Tree_AC)
                {
                    j++;
                    if(j==ph) {
                        *info = tmp3->_PowerInfo;
                    }
                }
            }
            else {
                *info = tmp->_PowerInfo;
            }
            return 0;
        }
    }

    return -1;
}
static void refresh_handler(void *arg, int last)
{
    menu_handle_t *h=(menu_handle_t*)arg;
    h->uflag |= UFLAG_TIMER;
    
    if(last) {
        timer_stop(h->tmr);
    }
}
static void tmr_start(menu_handle_t *h, int ms)
{
    if(h->tmr!=-1) {
        timer_stop(h->tmr);
    }
    timer_start(h->tmr, ms, -1, refresh_handler, h);
}
static void tmr_stop(menu_handle_t *h)
{
    timer_stop(h->tmr);
    h->tmr = -1;
}

static void menu_system_paint(menu_handle_t *h, int font1, int font2, int item_h)
{
    char time[60],tmp[100];
            
    lcd_fill(0);
    sprintf(tmp, "SmartPDU");
    lcd_draw_string(0, 0, LCD_WIDTH, item_h, tmp, font1, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_CENTER, VERTICAL_CENTER);

    sprintf(tmp, "%s:%s", lang_get_str(h->lang, STR_ID_VER), VERSION);
    lcd_draw_string(0, item_h, LCD_WIDTH, item_h, tmp, font2, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);

    get_curtime_str2(time, sizeof(time));
    sprintf(tmp, "%s:%s", lang_get_str(h->lang, STR_ID_TIME), time);
    lcd_draw_string(0, item_h*2, LCD_WIDTH, item_h, tmp, font2, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);

    sprintf(tmp, "IP:%s", getLocalIpAddress("eth0"));
    lcd_draw_string(0, item_h*3, LCD_WIDTH, item_h, tmp, font2, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);
    lcd_refresh();

    if(h->menu.menu_lv==0 && h->uflag&UFLAG_FLIP) {
        h->menu.menu_id++;
    }
}
static void menu_input_paint(menu_handle_t *h, int font1, int font2, int item_h)
{
    int r;
    char tmp[100];
    PowerInfo *pwr,info;
    GlobalDeviceManager *dm=get_dm();

    r = get_input(dm, h->ph_in, &info);
    if(r==0) {
        pwr = &info;
        if(is_ph3_in(dm)) {
            h->ph_in = (h->ph_in+1)%3;
        }

        lcd_fill(0);
        sprintf(tmp, "%s", lang_get_str(h->lang, STR_ID_INPUT));
        lcd_draw_string(0, 0, LCD_WIDTH, item_h, tmp, font1, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_CENTER, VERTICAL_CENTER);

    #ifdef TEXT_ALIGN
        sprintf(tmp, "%s:%0.2f", lang_get_str(h->lang, STR_ID_VOLTAGE), pwr->voltage);
        lcd_draw_string(0, item_h, LCD_WIDTH/2, item_h, tmp, font2, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);
        sprintf(tmp, "%s:%0.2f", lang_get_str(h->lang, STR_ID_CURRENT), pwr->current);
        lcd_draw_string(LCD_WIDTH/2, item_h, LCD_WIDTH/2, item_h, tmp, font2, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);

        sprintf(tmp, "%s:%0.2f", lang_get_str(h->lang, STR_ID_POWER), pwr->power);
        lcd_draw_string(0, item_h*2, LCD_WIDTH/2, item_h, tmp, font2, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);
        sprintf(tmp, "%s:%0.2f", lang_get_str(h->lang, STR_ID_FACTOR), pwr->factor);
        lcd_draw_string(LCD_WIDTH/2, item_h*2, LCD_WIDTH/2, item_h, tmp, font2, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);
    #else
        sprintf(tmp, "%s:%0.2f%s:%0.2f", lang_get_str(h->lang, STR_ID_VOLTAGE), pwr->voltage, lang_get_str(h->lang, STR_ID_CURRENT), pwr->current);
        lcd_draw_string(0, item_h, LCD_WIDTH, item_h, tmp, font2, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);

        sprintf(tmp, "%s:%0.2f%s:%0.2f", lang_get_str(h->lang, STR_ID_POWER), pwr->power, lang_get_str(h->lang, STR_ID_FACTOR), pwr->factor);
        lcd_draw_string(0, item_h*2, LCD_WIDTH, item_h, tmp, font2, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);
    #endif
        sprintf(tmp, "%s:%0.2f", lang_get_str(h->lang, STR_ID_CONSUMP), pwr->consumption);
        lcd_draw_string(0, item_h*3, LCD_WIDTH, item_h, tmp, font2, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);

        lcd_refresh();
    }
    else {
        h->ph_in = 0;
        if(h->menu.menu_lv==0 && h->uflag&UFLAG_FLIP) {
            h->menu.menu_id++;
        }
    }
}
static void menu_output_paint(menu_handle_t *h, int font1, int font2, int item_h)
{
    int r;
    char tmp[100];
    PowerInfo *pwr,info;
    GlobalDeviceManager *dm=get_dm();

    r = get_output(dm, h->ch_out, h->ph_out, &info);
    if(r==0) {
        pwr = &info;
        h->ch_out = (h->ch_out+1)%h->ch_max;
        if(is_ph3_out(dm)) {
            h->ph_out = (h->ph_out+1)%3;
        }

        lcd_fill(0);
        sprintf(tmp, "%s CH3", lang_get_str(h->lang, STR_ID_OUTPUT));
        lcd_draw_string(0, 0, LCD_WIDTH, item_h, tmp, font1, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_CENTER, VERTICAL_CENTER);

        char *pon=((pwr->status)?lang_get_str(h->lang, STR_ID_ON):lang_get_str(h->lang, STR_ID_OFF));
    #ifdef TEXT_ALIGN
        sprintf(tmp, "%s:%s", lang_get_str(h->lang, STR_ID_SWITCH), pon);
        lcd_draw_string(0, item_h, LCD_WIDTH/2, item_h, tmp, font2, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);
        sprintf(tmp, "%s:%0.2f", lang_get_str(h->lang, STR_ID_CURRENT), pwr->current);
        lcd_draw_string(LCD_WIDTH/2, item_h, LCD_WIDTH/2, item_h, tmp, font2, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);

        sprintf(tmp, "%s:%0.2f ", lang_get_str(h->lang, STR_ID_POWER), pwr->power);
        lcd_draw_string(0, item_h*2, LCD_WIDTH/2, item_h, tmp, font2, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);
        sprintf(tmp, "%s:%0.2f", lang_get_str(h->lang, STR_ID_FACTOR), pwr->factor);
        lcd_draw_string(LCD_WIDTH/2, item_h*2, LCD_WIDTH/2, item_h, tmp, font2, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);
    #else
        sprintf(tmp, "%s:%s %s:%0.2f", lang_get_str(h->lang, STR_ID_SWITCH), pon, lang_get_str(h->lang, STR_ID_CURRENT), pwr->current);
        lcd_draw_string(0, item_h, LCD_WIDTH, item_h, tmp, font2, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);

        sprintf(tmp, "%s:%0.2f%s:%0.2f", lang_get_str(h->lang, STR_ID_POWER), pwr->power, lang_get_str(h->lang, STR_ID_FACTOR), pwr->factor);
        lcd_draw_string(0, item_h*2, LCD_WIDTH, item_h, tmp, font2, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);
    #endif
        sprintf(tmp, "%s:%0.2f", lang_get_str(h->lang, STR_ID_CONSUMP), pwr->consumption);
        lcd_draw_string(0, item_h*3, LCD_WIDTH, item_h, tmp, font2, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);

        lcd_refresh();
    }
    else {
        h->ch_out = 0;
        if(h->menu.menu_lv==0 && h->uflag&UFLAG_FLIP) {
            h->menu.menu_id++;
        }
    }
}
static void menu_sensor_paint(menu_handle_t *h, int font1, int font2, int item_h)
{
    char tmp[100];
    GlobalDeviceManager *dm=get_dm();

    lcd_fill(0);
    sprintf(tmp, "%s/%s", lang_get_str(h->lang, STR_ID_TEMP), lang_get_str(h->lang, STR_ID_HUMI));
    lcd_draw_string(0, 0, LCD_WIDTH, item_h, tmp, font1, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_CENTER, VERTICAL_CENTER);

#ifdef TEXT_ALIGN
    sprintf(tmp, "%s:", lang_get_str(h->lang, STR_ID_TEMP));
    lcd_draw_string(0, item_h, LCD_WIDTH/2, item_h, tmp, font2, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);
    sprintf(tmp, "%0.1f", dm->g_modebus_read.temprature/100.0f);
    lcd_draw_string(LCD_WIDTH/2, item_h, LCD_WIDTH/2, item_h, tmp, font2, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);

    sprintf(tmp, "%s:", lang_get_str(h->lang, STR_ID_HUMI));
    lcd_draw_string(0, item_h*2, LCD_WIDTH/2, item_h, tmp, font2, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);
    sprintf(tmp, "%0.1f", dm->g_modebus_read.humidity/100.0f);
    lcd_draw_string(LCD_WIDTH/2, item_h*2, LCD_WIDTH/2, item_h, tmp, font2, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);
#else
    sprintf(tmp, " %s: %0.1f", lang_get_str(h->lang, STR_ID_TEMP), dm->g_modebus_read.temprature/100.0f);
    lcd_draw_string(0, item_h, LCD_WIDTH, item_h, tmp, font2, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);

    sprintf(tmp, " %s: %0.1f", lang_get_str(h->lang, STR_ID_HUMI), dm->g_modebus_read.humidity/100.0f);
    lcd_draw_string(0, item_h*2, LCD_WIDTH, item_h, tmp, font2, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);
#endif

    lcd_refresh();

    if(h->menu.menu_lv==0 && h->uflag&UFLAG_FLIP) {
        h->menu.menu_id++;
    }
}
static int menu_modbus_handle(menu_handle_t *h, ModbusInfo_t *pmb, key_val_t *kv)
{
    int r=-1;
    
    switch(kv->key) {
        case KEY_UP:
        {
            if(h->menu.menu_lv==1) {
                if(h->menu.page[h->menu.menu_id].item_id>0) {
                    h->menu.page[h->menu.menu_id].item_id--;
                }
                else {
                    h->menu.page[h->menu.menu_id].item_id = MODBUS_ITEM_QUIT;
                }
            }
            else {
                if(h->menu.page[h->menu.menu_id].item_id==MODBUS_ITEM_ADDR) {         //addr
                    if(pmb->addr<CASCADE_MAX) {
                        pmb->addr++;
                    }
                    else {
                        pmb->addr = 1;
                    }
                }
                else if(h->menu.page[h->menu.menu_id].item_id==MODBUS_ITEM_MODE) {    //mode
                    pmb->mode = !pmb->mode;
                }
            }
        }
        break;

        case KEY_DOWN:
        {
            if(h->menu.menu_lv==1) {
                if(h->menu.page[h->menu.menu_id].item_id<MODBUS_ITEM_QUIT) {
                    h->menu.page[h->menu.menu_id].item_id++;
                }
                else {
                    h->menu.page[h->menu.menu_id].item_id = 0;
                }
            }
            else {
                if(h->menu.page[h->menu.menu_id].item_id==MODBUS_ITEM_ADDR) {         //addr
                    if(pmb->addr) {
                        pmb->addr--;
                    }
                    else {
                        pmb->addr = CASCADE_MAX;
                    }
                }
                else if(h->menu.page[h->menu.menu_id].item_id==MODBUS_ITEM_MODE) {    //mode
                    pmb->mode = !pmb->mode;
                }
            }
        }
        break;

        case KEY_OK:
        {
            if(h->menu.menu_lv==1) {
                if(h->menu.page[h->menu.menu_id].item_id==MODBUS_ITEM_SAVE || h->menu.page[h->menu.menu_id].item_id==MODBUS_ITEM_QUIT) {         //save
                    if(h->menu.page[h->menu.menu_id].item_id==MODBUS_ITEM_SAVE) {
                        r = cascade_set_modbus(pmb);
                        if(r==0) {
                            r = paras_save();
                        }
                    }
                    h->menu.menu_lv = 0;
                    tmr_stop(h);
                }
                else {
                    h->menu.menu_lv = 2;
                    tmr_start(h, 500);
                }
            }
            else {
                if(kv->type==TYPE_SHORT) {
                    h->menu.menu_lv = 1;
                }
            }
        }
        break;
    }
    
    return r;
}
static void menu_modbus_paint(menu_handle_t *h, int font1, int font2, int item_h, key_val_t *kv)
{
    int r,font_color;
    char tmp[100];
    static uint8_t flash_cnt=0;
    
    GlobalDeviceManager *dm=get_dm();
    static ModbusInfo_t *pmb,mb_cas;
    GlobalDeviceInfo *dev=&dm->_globalDevInfo;

    if(h->menu.menu_lv) {
        pmb = &mb_cas;
    }
    else {
        mb_cas = dev->cascade;
        pmb = &dev->cascade;
    }
    r = menu_modbus_handle(h, pmb, kv);
    if(r==0) {
        dev->cascade = mb_cas;
    }
    
    if(kv->key==-1) {
        flash_cnt++;
    }

    lcd_fill(0);

    sprintf(tmp, "MODBUS %s", lang_get_str(h->lang, STR_ID_SETT));
    lcd_draw_string(0, 0, LCD_WIDTH, item_h, tmp, font1, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_CENTER, VERTICAL_CENTER);

    font_color = COLOR_WHITE;
    if(h->menu.menu_lv && h->menu.page[h->menu.menu_id].item_id==MODBUS_ITEM_ADDR) {
        if(h->menu.menu_lv==2) {
            font_color = (flash_cnt%2)?COLOR_WHITE:COLOR_BLACK;
        }
        sprintf(tmp, ">%s:", lang_get_str(h->lang, STR_ID_ADDR));
    }
    else {
        sprintf(tmp, " %s:", lang_get_str(h->lang, STR_ID_ADDR));
    }
    lcd_draw_string(0, item_h, LCD_WIDTH/2, item_h, tmp, font2, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);
    sprintf(tmp, "%d", pmb->addr);
    lcd_draw_string(LCD_WIDTH/2, item_h, LCD_WIDTH/2, item_h, tmp, font2, font_color, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);

    font_color = COLOR_WHITE;
    if(h->menu.menu_lv && h->menu.page[h->menu.menu_id].item_id==MODBUS_ITEM_MODE) {
        if(h->menu.menu_lv==2) {
            font_color = (flash_cnt%2)?COLOR_WHITE:COLOR_BLACK;
        }
        sprintf(tmp, ">%s:", lang_get_str(h->lang, STR_ID_MODE));
    }
    else {
        sprintf(tmp, " %s:", lang_get_str(h->lang, STR_ID_MODE));
    }
    lcd_draw_string(0, item_h*2, LCD_WIDTH/2, item_h, tmp, font2, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);
    sprintf(tmp, "%s", (pmb->mode==MODBUS_MASTER)?lang_get_str(h->lang, STR_ID_MASTER):lang_get_str(h->lang, STR_ID_SLAVE));
    lcd_draw_string(LCD_WIDTH/2, item_h*2, LCD_WIDTH/2, item_h, tmp, font2, font_color, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);

    font_color = COLOR_WHITE;
    if(h->menu.menu_lv && h->menu.page[h->menu.menu_id].item_id==MODBUS_ITEM_SAVE) {
        if(h->menu.menu_lv==2) {
            font_color = (flash_cnt%2)?COLOR_WHITE:COLOR_BLACK;
        }
        sprintf(tmp, ">%s", lang_get_str(h->lang, STR_ID_SAVE));
    }
    else {
        sprintf(tmp, " %s", lang_get_str(h->lang, STR_ID_SAVE));
    }
    lcd_draw_string(0, item_h*3, LCD_WIDTH/2, item_h, tmp, font2, font_color, COLOR_BLACK, HORIZONTAL_CENTER, VERTICAL_CENTER);
    
    font_color = COLOR_WHITE;
    if(h->menu.menu_lv && h->menu.page[h->menu.menu_id].item_id==MODBUS_ITEM_QUIT) {
        if(h->menu.menu_lv==2) {
            font_color = (flash_cnt%2)?COLOR_WHITE:COLOR_BLACK;
        }
        sprintf(tmp, ">%s", lang_get_str(h->lang, STR_ID_QUIT));
    }
    else {
        sprintf(tmp, " %s", lang_get_str(h->lang, STR_ID_QUIT));
    }
    lcd_draw_string(LCD_WIDTH/2, item_h*3, LCD_WIDTH/2, item_h, tmp, font2, font_color, COLOR_BLACK, HORIZONTAL_CENTER, VERTICAL_CENTER);

    lcd_refresh();

    if(h->menu.menu_lv==0 && h->uflag&UFLAG_FLIP) {
        h->menu.menu_id = MENU_SYSTEM;
    }
}
/////////////////////////////////////////////////

int menu_init(void)
{
    int i;
    menu_handle_t *h=&mnHandle;
    
    memset(h, 0, sizeof(menu_handle_t));
    h->lang = lang_id;
    h->tmr = timer_init();
    h->ms = get_ms();
    h->uflag = 1;
    h->fliptime = get_dm()->_globalDevInfo.misc.flip_time*1000;

    h->ph_in = 0;
    h->ph_out = 0;
    h->ch_out = 0;
    h->menu.menu_id = 0;
    h->menu.menu_lv = 0;
    for(i=0; i<MENU_MAX; i++) {
        h->menu.page[i].menu_id = i;
        h->menu.page[i].item_id = 0;
        h->menu.page[i].item_max = 0;
    }
    key_init();
    led_init();
    beep_init();
    lcd_init(LCD_WIDTH,LCD_HEIGHT,LCD_COLOR);
    
    return 0;
}

int menu_deinit(void)
{
    menu_handle_t *h=&mnHandle;
    
    timer_deinit(h->tmr);

    lcd_deinit();
    key_deinit();
    led_deinit();
    beep_deinit();
    
    return 0;
}

int menu_handle(void)
{
    int r;
    key_val_t kv;
    int item_h=LCD_HEIGHT/4;
    int font1=FONT_12,font2=FONT_12;
    menu_handle_t *h=&mnHandle;
    
    r = key_get(&kv);
    key_print(&kv);
    switch(kv.key) {
        case KEY_OK:
        {
            if(kv.type==TYPE_SHORT) {
                if(h->menu.menu_lv==0) {
                    if(lcd_get_angle()==ANGLE_0) {
                        //lcd_rotate(ANGLE_180);
                    }
                    else {
                        //lcd_rotate(ANGLE_0);
                    }
                }
            }
            else {
                if(h->menu.menu_lv==0) {
                    if(h->menu.menu_id==MENU_MODBUS) {
                        h->menu.menu_lv = 1;
                    }
                }
            }
            h->uflag = UFLAG_KEY;
        }
        break;

        case KEY_UP:
        {
            led_reset(); beep_reset();

            if(h->menu.menu_lv==0 && kv.type==TYPE_SHORT) {
                if(h->menu.menu_id>0) {
                    h->menu.menu_id--;
                }
                else {
                    h->menu.menu_id = MENU_MAX-1;
                }
            }
            h->uflag = UFLAG_KEY;
        }
        break;

        case KEY_DOWN:
        {
            led_reset(); beep_reset();
            if(h->menu.menu_lv==0 && kv.type==TYPE_SHORT) {
                if(h->menu.menu_id<MENU_MAX-1) {
                    h->menu.menu_id++;
                }
                else {
                    h->menu.menu_id = 0;
                }
            }
            h->uflag = UFLAG_KEY;
        }
        break;

        default:
        {
#if 0
            if(h->fliptime>0) {
                if(h->menu.menu_lv==0) {
                    if((get_ms()-h->ms)>=h->fliptime) {
                        if(h->menu.menu_id<MENU_MAX-1) {
                            if() {
                            h->menu.menu_id++;
                        }
                        else {
                            h->menu.menu_id = 0;
                        }
                        h->uflag = UFLAG_FLIP;
                        h->ms = get_ms();
                    }
                }
                else {
                    h->ms = get_ms();
                }
            }
#endif
        }
    }
    if(h->uflag==0) {
        return -1;
    }
    
    switch(h->menu.menu_id) {
        case MENU_SYSTEM:
        {
            menu_system_paint(h, font1, font2, item_h);
        }
        break;

        case MENU_INPUT:
        {
            h->menu.menu_id++;
            menu_input_paint(h, font1, font2, item_h);
        }
        break;

        case MENU_OUTPUT:
        {
            h->menu.menu_id++;
            menu_output_paint(h, font1, font2, item_h);
        }
        break;

        case MENU_SENSOR:
        {
            h->menu.menu_id++;
            menu_sensor_paint(h, font1, font2, item_h);
        }
        break;

        case MENU_MODBUS:
        {
            menu_modbus_paint(h, font1, font2, item_h, &kv);
        }
        break;
    }
    h->uflag = 0;
    
    return 0;
}