#include "stm32g4xx_hal.h"
#include "cmsis_os.h"
#include "menu_tree.h"
#include "control.h"
#include "uart_bridge.h"
#include <stdio.h>

#define DBG if(0)

#define MON_DELAY           100

osMessageQId    menu_event;
osMutexId   menu_mutex;
osThreadId  menu_update_handle;
osThreadId  menu_control_handle;

menuItem* selectedMenuItem;
bool update_flag = false;

static void vUpdate(void const *params);
static osStatus menu_block(uint32_t ms);
static void menu_unblock(void);


//
void menu_init(void)
{
    
    // Очередь для управляющих сигналов меню
    osMessageQDef(vButEventQueue, 1, uint8_t);
    menu_event = osMessageCreate(osMessageQ(vButEventQueue), NULL);
    
    // Mutex для блокировки меню
    osMutexDef(menu_mut);
    menu_mutex  = osMutexCreate(osMutex(menu_mut));   

    // События. Сигналы энкодера
    osThreadDef(control_thr, vControl, osPriorityNormal, 0, 2*configMINIMAL_STACK_SIZE);
    menu_control_handle = osThreadCreate(osThread(control_thr), NULL);
    
    // Обновление меню
    osThreadDef(menu_up_thr, vUpdate, osPriorityNormal, 0, 4*configMINIMAL_STACK_SIZE);
    menu_update_handle = osThreadCreate(osThread(menu_up_thr), NULL);
    
    // Начальный экран
    selectedMenuItem = (menuItem *) &m_main;
    (*(selectedMenuItem->func_draw))(selectedMenuItem->Select);
}

//
void menu_send_event(control_t but)
{
    osMessagePut(menu_event, but, 0);  
}

//
static void vControl(void const *params)
{
    osEvent event;
    
    for (;;)
    {
        event = osMessageGet(menu_event, 100);
        
        if (event.status != osEventMessage)
            continue;
        
        switch (event.value.v)
        {
            case CONTROL_FWD :
                DBG printf("Encoder forward\r\n");
                if (menu_block(0) == osOK) {
                    button_right();
                    menu_unblock();
                }
            break;
            
            case CONTROL_BACK :
                DBG printf("Encoder back\r\n");
                if (menu_block(0) == osOK) {
                    button_left();
                    menu_unblock();
                }
            break;
            
            case CONTROL_PUSH :
                DBG printf("Encoder push");
                if (menu_block(0) == osOK) {
                    menuFocus();
                    menu_unblock();
                }
            break;
        }
    
    }
}

//
static void vUpdate(void const *params)
{
    for (;;)
    {
        osDelay(MON_DELAY);
        
#if 0        
        // Имитация изменения счетчиков для теста
        inc_raw_counters();
#endif        
        
        // Текущий экран меню нужно перерисовать
        if (update_flag)
        {
            (*(selectedMenuItem->func_draw))(selectedMenuItem->Select);
        }
    }
}

//
static osStatus menu_block(uint32_t ms)
{
    return osMutexWait(menu_mutex, ms);
}


//
static void menu_unblock(void)
{
    osMutexRelease(menu_mutex);
}