#include "user_elect.h"
#include "define.h"
#include "stdarg.h"

tmosTaskID elect_task_id = INVALID_TASK_ID;
static bool elect_start_stat = false;

static uint16_t elect_task_process_event(uint8_t task_id, uint16_t events);
static void elect_left_work_stat(bool stat, elect_work_type_e type);
static void elect_right_work_stat(bool stat, elect_work_type_e type);

static vUser_elect_upload_stat_func xUpload_stat = NULL;
static elect_work_s elect_work[ELECT_COUNT] = {
	{.idx = 0,.stat = false,.type = ELECT_WORK_NULL,.workTime = 0,.func = elect_left_work_stat,},
	{.idx = 1,.stat = false,.type = ELECT_WORK_NULL,.workTime = 0,.func = elect_right_work_stat,},
};

/*******************************************************************************
  * @函数名称   elect_gpio_init
  * @函数说明   GPIO初始化
  * @输入参数  	无
  * @输出参数   无
  * @返回参数   无
*******************************************************************************/
static void elect_gpio_init(void)
{
    GPIO_InitTypeDef GPIO_InitStructure = {0};

    ELECT_GPIO_RCC_ENABLE;

    GPIO_InitStructure.GPIO_Pin = ELECT_LEFT_OPEN_PIN;
    GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;
    GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
    GPIO_Init(ELECT_LEFT_OPEN_GPIO, &GPIO_InitStructure);
    ELECT_LEFT_OPEN_OFF;

    GPIO_InitStructure.GPIO_Pin = ELECT_LEFT_CLOSE_PIN;
    GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;
    GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
    GPIO_Init(ELECT_LEFT_CLOSE_GPIO, &GPIO_InitStructure);
    ELECT_LEFT_CLOSE_OFF;

    GPIO_InitStructure.GPIO_Pin = ELECT_RIGHT_OPEN_PIN;
    GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;
    GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
    GPIO_Init(ELECT_RIGHT_OPEN_GPIO, &GPIO_InitStructure);
    ELECT_RIGHT_OPEN_OFF;

    GPIO_InitStructure.GPIO_Pin = ELECT_RIGHT_CLOSE_PIN;
    GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;
    GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
    GPIO_Init(ELECT_RIGHT_CLOSE_GPIO, &GPIO_InitStructure);
    ELECT_RIGHT_CLOSE_OFF;
}

/*******************************************************************************
  * @函数名称   elect_left_work_stat
  * @函数说明   设置左边电磁锁状态
  * @输入参数  	stat：开或关
               type：工作状态
  * @输出参数   无
  * @返回参数   无
*******************************************************************************/
static void elect_left_work_stat(bool stat, elect_work_type_e type)
{
	if(type == ELECT_WORK_START)
	{
		if(stat == true)
		{
			ELECT_LEFT_CLOSE_OFF;
			ELECT_LEFT_OPEN_ON;
		}
		else{
			ELECT_LEFT_OPEN_OFF;
			ELECT_LEFT_CLOSE_ON;
		}
	}
	else if(type == ELECT_WORK_END)
	{
		ELECT_LEFT_OPEN_OFF;
		ELECT_LEFT_CLOSE_OFF;
	}
}

/*******************************************************************************
  * @函数名称   elect_right_work_stat
  * @函数说明   设置右边电磁锁状态
  * @输入参数  	stat：开或关
               type：工作状态
  * @输出参数   无
  * @返回参数   无
*******************************************************************************/
static void elect_right_work_stat(bool stat, elect_work_type_e type)
{
	if(type == ELECT_WORK_START)
	{
		if(stat == true)
		{
			ELECT_RIGHT_CLOSE_OFF;
			ELECT_RIGHT_OPEN_ON;
		}
		else{
			ELECT_RIGHT_OPEN_OFF;
			ELECT_RIGHT_CLOSE_ON;
		}
	}
	else if(type == ELECT_WORK_END)
	{
		ELECT_RIGHT_OPEN_OFF;
		ELECT_RIGHT_CLOSE_OFF;
	}
}

/*******************************************************************************
  * @函数名称   set_elect_work_stat
  * @函数说明   设置电磁锁
  * @输入参数  	idx：锁下标
               stat：工作状态
  * @输出参数   无
  * @返回参数   无
*******************************************************************************/
void set_elect_work_stat(uint8_t idx, bool stat)
{
	elect_work[idx].stat = stat;
	elect_work[idx].type = ELECT_WORK_START;
	elect_work[idx].workTime = 0;
}

/*******************************************************************************
  * @函数名称   elect_work_pro
  * @函数说明   电磁锁执行
  * @输入参数  	elect：对象
  * @输出参数   无
  * @返回参数   无
*******************************************************************************/
static void elect_work_pro(elect_work_s *elect)
{
	if(elect->workTime == 0)
	{
		if(elect->type == ELECT_WORK_START)
		{
			elect->workTime = 50;
			elect->func(elect->stat, ELECT_WORK_START);
			elect->type = ELECT_WORK_END;
		}
		else if(elect->type == ELECT_WORK_END)
		{
			elect->func(elect->type, ELECT_WORK_END);
			elect->type = ELECT_WORK_NULL;
      if(xUpload_stat != NULL)
      {
          xUpload_stat(elect->idx, elect->stat);
      }
		}
	}
	else{
		elect->workTime--;
	}
}

/*******************************************************************************
  * @函数名称   elect_task
  * @函数说明   电磁锁任务
  * @输入参数  	无
  * @输出参数   无
  * @返回参数   无
*******************************************************************************/
static void elect_task(void)
{
	for(int i = 0; i < ELECT_COUNT; i++)
	{
		elect_work_pro(&elect_work[i]);
	}
}

/*******************************************************************************
  * @函数名称   elect_task_process_event
  * @函数说明   task的event处理回调函数,需要在注册task时候,传进去
  * @输入参数  	task_id：任务ID
               events：事件
  * @输出参数   无
  * @返回参数   无
*******************************************************************************/
static uint16_t elect_task_process_event(uint8_t task_id, uint16_t events)
{
    //event 处理
    if(events & (1 << ELECT_QUEUE_TIME))
    {
        elect_task();
        return (events ^ (1 << ELECT_QUEUE_TIME)); //异或的方式清除该事件运行标志，并返回未运行的事件标志
    }

    if(events & (1 << ELECT_QUEUE_START))
    {
        elect_work[LEFT_IDX].type = ELECT_WORK_START;
		    elect_work[RIGHT_IDX].type = ELECT_WORK_START;
        return (events ^ (1 << ELECT_QUEUE_START)); //异或的方式清除该事件运行标志，并返回未运行的事件标志
    }

    return 0;
}

/*******************************************************************************
  * @函数名称   elect_start
  * @函数说明   开机电磁锁开启
  * @输入参数  	addr：can地址
  * @输出参数   无
  * @返回参数   无
*******************************************************************************/
void elect_start(uint8_t addr)
{
	if(elect_start_stat == false && addr > 0)
	{
		elect_start_stat = true;
		bStatus_t stat = tmos_start_task(elect_task_id, (1 << ELECT_QUEUE_START), MS1_TO_SYSTEM_TIME(addr * 500));
	}
}

/*******************************************************************************
  * @函数名称   elect_task_init
  * @函数说明   ELECT任务初始化
  * @输入参数  	无
  * @输出参数   无
  * @返回参数   无
*******************************************************************************/
void elect_task_init(void)
{
    elect_task_id  = TMOS_ProcessEventRegister(elect_task_process_event);
    PRINT("elect_task_id=%d\n", elect_task_id);
    elect_gpio_init();
}

/*******************************************************************************
  * @函数名称   elect_task_start
  * @函数说明   ELECT任务开始
  * @输入参数  	无
  * @输出参数   无
  * @返回参数   无
*******************************************************************************/
void elect_task_start(void)
{
    bStatus_t stat = tmos_start_reload_task(elect_task_id, (1 << ELECT_QUEUE_TIME), MS1_TO_SYSTEM_TIME(ELECT_INTERVAL));
}

/*******************************************************************************
  * @函数名称   vUser_elect_set_upload_stat_func
  * @函数说明   设置上报电磁锁状态的回调函数
  * @输入参数  	func：函数指针
  * @输出参数   无
  * @返回参数   无
*******************************************************************************/
void vUser_elect_set_upload_stat_func(vUser_elect_upload_stat_func func)
{
    xUpload_stat = func;
}