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

#define DBG if(0)

#define MON_DELAY           1000

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

menuItem* selectedMenuItem;
bool update_flag = false;

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


//
void menu_init(void)
{
#if 0  
    // Очередь для событий кнопок
    osMessageQDef(vButEventQueue, 1, uint8_t);
    v_queue_event = osMessageCreate(osMessageQ(vButEventQueue), NULL);
    
    // Обработка событий
    osThreadDef(M_Event_Thread, vMenuEvent, osPriorityNormal, 0, 6*configMINIMAL_STACK_SIZE);
    v_task_event_handle = osThreadCreate(osThread(M_Event_Thread), NULL);
#endif
    
    // Очередь для управляющих сигналов меню
    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, 6*configMINIMAL_STACK_SIZE);
    menu_control_handle = osThreadCreate(osThread(control_thr), NULL);
    
    // Обновление меню
    osThreadDef(menu_up_thr, vUpdate, osPriorityNormal, 0, 6*configMINIMAL_STACK_SIZE);
    menu_update_handle = osThreadCreate(osThread(menu_up_thr), NULL);
    
    // Начальный экран
    selectedMenuItem = (menuItem *) &m_main;
    (*(selectedMenuItem->func_draw))(selectedMenuItem->Select);

#if 0        
    osTimerDef(vSoundTimer, v_sound_tim);
	v_sound_timer_handle = osTimerCreate(osTimer(vSoundTimer), osTimerOnce, NULL);
    
    osMutexDef(menu_mut);
    v_menu_mutex_id = osMutexCreate(osMutex(menu_mut));      
#endif    
}

//
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();
                  
                    //(*(selectedMenuItem->func_button_down))();
                    //(*(selectedMenuItem->func_draw))(selectedMenuItem->Select);
                    
                    menu_unblock();
                }
            break;
            
            case CONTROL_BACK :
                DBG printf("Encoder back\r\n");
                if (menu_block(0) == osOK) {
                    button_left();
                  
                    //(*(selectedMenuItem->func_button_down))();
                    //(*(selectedMenuItem->func_draw))(selectedMenuItem->Select);
                    
                    menu_unblock();
                }
            break;
            
            case CONTROL_PUSH :
                printf("Encoder push");
            break;
        }
    
    }
}

//
static void vUpdate(void const *params)
{
    for (;;)
    {
        // Текущий экран меню нужно перерисовать
        if (update_flag)
        {
            (*(selectedMenuItem->func_draw))(selectedMenuItem->Select);
        }
        
        osDelay(MON_DELAY);
    }
}

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


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