SmartPDCode/f407/applications/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 "power.h"
#include "log.h"
#include "thread.h"
#include "lang.h"
#include "timer.h"
#include "cfg.h"
#include "cascade.h"
#include <sys/time.h>

#define LINES          5
#define REFRESH_TIME   300
//#define TEXT_ALIGN

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),
    UFLAG_REFRESH=(1<<3),
};

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_out_max;
    menu_data_t menu;
    
    uint64_t    flip_ms;
    uint64_t    refresh_ms;

    uint16_t    uflag;
    int         fliptime;

    modbus_data_t mb;
}menu_handle_t;
static int lang_id=LANG_ID_CHINESE;
//static int lang_id=LANG_ID_ENGLISH;
static menu_handle_t mnHandle={0};



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 modbus_data_t*get_pmb(menu_handle_t *h)
{
    if(h->menu.menu_lv==0) {
        return &paras_get()->cas;
    }
    else {
        return &h->mb;
    }
}

static int get_ch_out_max(menu_handle_t *h)
{
    int ch=0;
    paras_data_t *p=paras_get();
    
    return ch;
}
static int is_ph3_in(menu_handle_t *h)
{
    paras_data_t *p=paras_get();
    
    if ((p->prod.type == PDU_AC_I3O3 ||
         p->prod.type == PDU_AC_I3O1  ||
         p->prod.type == PDU_AC_I3O1_H)) {
        return 1;
    }
    return 0;
}
static int is_ph3_out(menu_handle_t *h)
{
    paras_data_t *p=paras_get();
    if (p->prod.type == PDU_AC_I3O3) {
        return 1;
    }
    return 0;
}
static int get_input(menu_handle_t *h, int ph, total_t *ttl)
{
    power_all_t all;
    
    power_data_get(&all);
    if(all.chs==0 || !ttl) {
        return -1;
    }
    *ttl = all.ttl.total[ph];
    return 0;
}
static int get_output(menu_handle_t *h, int ch, int ph, power_ch_t *pwr_ch)
{
    int i=-1,j=0;
    power_all_t all;

    power_data_get(&all);
    if(all.chs==0 || ch>all.chs|| !pwr_ch) {
        return -1;
    }
    *pwr_ch = all.pch[ch];
    
    return 0;
}
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 get_date(char *date, int len, struct tm *t)
{
    snprintf(date, len, "%04d%/%02d/%02d", (t->tm_year+1900), t->tm_mon+1, t->tm_mday);
}
static void get_time(char *time, int len, struct tm *t)
{
    snprintf(time, len, "%02d:%02d:%02d", t->tm_hour, t->tm_min, t->tm_sec);
}

static void menu_system_paint(menu_handle_t *h, int font1, int font2, int item_h, key_val_t *kv)
{
    char xxx[40],tmp[60];
    time_t t=time(NULL);
    struct tm *tm=localtime(&t);
    
    //lcd_fill(COLOR_BLACK);
    sprintf(tmp, "SmartPDU");
    lcd_draw_string(10, 0, LCD_WIDTH-10, 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(10, item_h, LCD_WIDTH-10, item_h, tmp, font2, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);

    get_date(xxx, sizeof(xxx), tm);
    sprintf(tmp, "%s:%s", lang_get_str(h->lang, STR_ID_DATE), xxx);
    lcd_draw_string(10, item_h*2, LCD_WIDTH-10, item_h, tmp, font2, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);
    
    get_time(xxx, sizeof(xxx), tm);
    sprintf(tmp, "%s:%s", lang_get_str(h->lang, STR_ID_TIME), xxx);
    lcd_draw_string(10, item_h*3, LCD_WIDTH-10, item_h, tmp, font2, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);
		
		
    sprintf(tmp, "IP:%s", RT_LWIP_IPADDR);//getLocalIpAddress("e0"));
    lcd_draw_string(10, item_h*4, LCD_WIDTH-10, item_h, tmp, font2, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);
    //lcd_refresh();
}
static void menu_input_paint(menu_handle_t *h, int font1, int font2, int item_h, key_val_t *kv)
{
    int r;
    char tmp[100];
    total_t *pttl,ttl;

    pttl = &ttl;
    sprintf(tmp, "%s", lang_get_str(h->lang, STR_ID_INPUT));

    r = get_input(h, h->ph_in, pttl);
    if(r==0) {
        if(h->menu.menu_lv==1 && h->ph_in>0) {
            sprintf(tmp, "%s-L%d", lang_get_str(h->lang, STR_ID_INPUT), h->ph_in);
        }
    }

    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), pttl->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), pttl->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), pttl->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), pttl->total[0].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), pttl->voltage, lang_get_str(h->lang, STR_ID_CURRENT), pttl->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), pttl->power, lang_get_str(h->lang, STR_ID_FACTOR), pttl->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), pttl->consump);
    lcd_draw_string(0, item_h*3, LCD_WIDTH, item_h, tmp, font2, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);

    //lcd_refresh();
    
}
static void menu_output_paint(menu_handle_t *h, int font1, int font2, int item_h, key_val_t *kv)
{
    int r;
    char tmp[100];
    power_ch_t *pwr,info={0};

    pwr = &info;
    sprintf(tmp, "%s", lang_get_str(h->lang, STR_ID_OUTPUT));

    r = get_output(h, h->ch_out, h->ph_out, &info);
    if(r==0 && h->ch_out_max>0) {
        sprintf(tmp, "%s CH%d", lang_get_str(h->lang, STR_ID_OUTPUT), h->ch_out+1);
    }

    //lcd_fill(COLOR_BLACK);
    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), ((float)pwr->power[0].current/10.0));
    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), (((float)pwr->power[0].power) / 1000.0), lang_get_str(h->lang, STR_ID_FACTOR), 
								((float)pwr->power[0].factor)/100.0);
    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), ((float)pwr->power[0].consump)/1000.0);
    lcd_draw_string(0, item_h*3, LCD_WIDTH, item_h, tmp, font2, COLOR_WHITE, COLOR_BLACK, HORIZONTAL_LEFT, VERTICAL_CENTER);

    //lcd_refresh();
    
}
static void menu_sensor_paint(menu_handle_t *h, int font1, int font2, int item_h, key_val_t *kv)
{
    char tmp[100];

    //lcd_fill(COLOR_BLACK);
    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), h->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), h->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();
    
}
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];
    modbus_data_t *pmb=get_pmb(h);
    static uint8_t flash_cnt=0;
    
    if(h->uflag&UFLAG_TIMER) {
        flash_cnt++;
    }

    //lcd_fill(COLOR_BLACK);

    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->uflag&UFLAG_TIMER && 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->uflag&UFLAG_TIMER && 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) {
        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) {
        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();
}
/////////////////////////////////////////////////

int menu_init(void)
{
    int i;
    menu_handle_t *h=&mnHandle;
    misc_data_t *misc=&paras_get()->misc;
    
    memset(h, 0, sizeof(menu_handle_t));
    h->lang = paras_get()->sys.lang;
    h->tmr = timer_init();
    h->flip_ms = get_ms();
    h->refresh_ms = get_ms();
    h->uflag |= UFLAG_REFRESH;
    h->fliptime = misc->flip_time*1000;
    
    h->ph_in = 0;
    h->ph_out = 0;
    h->ch_out = 0;
    h->ch_out_max = 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, misc->rotate);
    
    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;
}


static void key_remap(key_val_t *kv, int rotate)
{
    key_print(kv);
    if(rotate==180) {
        if(kv->key==KEY_UP) {
            kv->key = KEY_DOWN;
        }
        else if(kv->key==KEY_DOWN) {
            kv->key = KEY_UP;
        }
    }
}
static int menu_modbus_key_handle(menu_handle_t *h, key_val_t *kv)
{
    int r=-1;
    
    if(h->menu.menu_lv==0) {
        h->mb = paras_get()->cas;
    }

    switch(kv->key) {
        case KEY_UP:
        {
            if(h->menu.menu_lv==0) {
                if(kv->type==TYPE_SHORT) {
                    h->menu.menu_id--;
                }
            }
            else 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.menu_lv==2) {
                modbus_data_t *pmb=&h->mb;
                if(h->menu.page[h->menu.menu_id].item_id==MODBUS_ITEM_ADDR) {         //addr
                    if(pmb->addr<POWER_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==0) {
                if(kv->type==TYPE_SHORT) {
                    h->menu.menu_id = MENU_SYSTEM;
                }
            }
            else 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.menu_lv==2) {
                modbus_data_t *pmb=&h->mb;
                if(h->menu.page[h->menu.menu_id].item_id==MODBUS_ITEM_ADDR) {         //addr
                    if(pmb->addr) {
                        pmb->addr--;
                    }
                    else {
                        pmb->addr = POWER_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(&h->mb);
                        //if(r==0) {
                            paras_get()->cas = h->mb;
                            //r = paras_save();
														cascade_reset(h->mb.mode,h->mb.addr);
													
                        //}

                    }
                    h->menu.page[h->menu.menu_id].item_id = 0;
                    h->menu.menu_lv = 0;
                    tmr_stop(h);
                }
                else {
                    h->menu.menu_lv = 2;
                    tmr_start(h, 500);
                }
            }
            else if(h->menu.menu_lv==2 && kv->type==TYPE_SHORT) {
                h->menu.menu_lv = 1;
            }
            else {
                if(kv->type==TYPE_LONG) {
                    h->menu.menu_lv = 1;
                }
            }
        }
        break;

        default:
        {
            if(h->menu.menu_lv==0 && h->uflag&UFLAG_FLIP) {
                h->menu.menu_id = MENU_SYSTEM;
            }
        }
    }
    
    return r;
}
static int menu_key_handle(menu_handle_t *h, key_val_t *kv)
{
    int r=0;
    int menu_id=h->menu.menu_id;

    h->ch_out_max = get_ch_out_max(h);
    switch(h->menu.menu_id) {
        case MENU_SYSTEM:
        case MENU_SENSOR:
        {
            if(h->menu.menu_lv==0) {
                if(h->uflag&UFLAG_FLIP || ((kv->key==KEY_UP || kv->key==KEY_DOWN) && kv->type==TYPE_SHORT)) {
                    if(kv->key==KEY_UP) {
                        h->menu.menu_id = h->menu.menu_id?(h->menu.menu_id-1):MENU_MAX-1;
                    }
                    else {
                        h->menu.menu_id = (h->menu.menu_id==MENU_MAX-1)?0:(h->menu.menu_id+1);
                    }
                }
            }
        }
        break;

        case MENU_INPUT:
        {
            if(h->menu.menu_lv==0) {
                if((kv->key==KEY_UP || kv->key==KEY_DOWN) && kv->type==TYPE_SHORT) {
                    if(kv->key==KEY_UP) {
                        h->menu.menu_id--;
                    }
                    else {
                        h->menu.menu_id++;
                    }
                }
                else if(kv->key==KEY_OK && kv->type==TYPE_SHORT) {
                    if(is_ph3_in(h)) {
                        h->ph_in = 1;
                        h->menu.menu_lv = 1;
                    }
                }
                else if(h->uflag&UFLAG_FLIP) {
                    if(is_ph3_in(h)) {
                        h->ph_in = 1;
                        h->menu.menu_lv = 1;
                    }
                    else {
                        h->menu.menu_id++;
                    }
                }
            }
            else if(h->menu.menu_lv==1) {
                if((kv->key==KEY_UP || kv->key==KEY_DOWN) && kv->type==TYPE_SHORT) {
                    if(kv->key==KEY_UP) {
                        if(h->ph_in>1) {
                            h->ph_in--;
                        }
                        else {
                            h->ph_in = 3;
                        }
                    }
                    else {
                        if(h->ph_in<3) {
                            h->ph_in++;
                        }
                        else {
                            h->ph_in = 1;
                        }
                    }
                }
                else if(h->uflag&UFLAG_FLIP) {
                    if(h->ph_in<3) {
                        h->ph_in++;
                    }
                    else {
                        h->ph_in = 0;
                        h->menu.menu_lv = 0;
                        h->menu.menu_id++;
                    }
                }
                else if(h->uflag&UFLAG_REFRESH) {
                    //
                }
                else {
                    h->ph_in = 0;
                    h->menu.menu_lv = 0;
                }
            }
        }
        break;

        case MENU_OUTPUT:
        {
            if(h->uflag&UFLAG_FLIP || ((kv->key==KEY_UP || kv->key==KEY_DOWN) && kv->type==TYPE_SHORT)) {
                if(kv->key==KEY_UP) {
                    if(h->ch_out>0) {
                        h->ch_out--;
                    }
                    else {
                        h->ch_out = 0;
                        h->menu.menu_id--;
                    }
                }
                else {
                    if(h->ch_out<h->ch_out_max-1) {
                        h->ch_out++;
                    }
                    else {
                        h->ch_out = 0;
                        h->menu.menu_id++;
                    }
                }
            }
        }
        break;

        case MENU_MODBUS:
        {
            r = menu_modbus_key_handle(h, kv);
        }
        break;
    }
    
    if(menu_id!=h->menu.menu_id) {
        lcd_fill(COLOR_BLACK);
    }

    return r;
}


int menu_handle(void)
{
    int r;
    uint64_t cur_ms;
    key_val_t kv;
    int rotate=lcd_get_rotate();
    int item_h=LCD_HEIGHT/LINES;
    int font1=FONT_24,font2=FONT_24;
    menu_handle_t *h=&mnHandle;
    
    r = key_get(&kv); key_remap(&kv, rotate);
    switch(kv.key) {
        case KEY_OK:
        {
            if(kv.type==TYPE_SHORT) {
                if(h->menu.menu_lv==0) {
            #if 0
                    if(rotate==0) {
                        lcd_rotate(180);
                    }
                    else {
                        lcd_rotate(0);
                    }
            #endif
                }
            }
        }
        break;

        case KEY_UP:
        case KEY_DOWN:
        {
            led_reset(); beep_reset();
        }
        break;

        default:
        {
            cur_ms = get_ms();
#if 1
            if(h->fliptime>0) {
                if((cur_ms-h->flip_ms)>=h->fliptime) {
                    h->uflag |= UFLAG_FLIP;
                    h->flip_ms = cur_ms;
                }
            }
#endif
            if((cur_ms-h->refresh_ms)>=REFRESH_TIME) {
                h->uflag |= UFLAG_REFRESH;
                h->refresh_ms = cur_ms;
            }
        }
    }
    if(h->uflag==0 && kv.key<0) {
        return -1;
    }
    //printf("___ uflag: %d\n", h->uflag);

    menu_key_handle(h, &kv);
    switch(h->menu.menu_id) {
        case MENU_SYSTEM:
        {
            menu_system_paint(h, font1, font2, item_h, &kv);
        }
        break;

        case MENU_INPUT:
        {
            menu_input_paint(h, font1, font2, item_h, &kv);
        }
        break;

        case MENU_OUTPUT:
        {
            menu_output_paint(h, font1, font2, item_h, &kv);
        }
        break;

        case MENU_SENSOR:
        {
            menu_sensor_paint(h, font1, font2, item_h, &kv);
        }
        break;

        case MENU_MODBUS:
        {
            menu_modbus_paint(h, font1, font2, item_h, &kv);
        }
        break;
    }
    h->uflag = 0;
    //printf("___ menu_id: %d, menu_lv: %d\n", h->menu.menu_id, h->menu.menu_lv);
    
    return 0;
}