#include "gpio.h"
#include "app_config.h"
#include "system/includes.h"
#include "device/wireless_charge.h"
#include "chgbox_ctrl.h"
#include "asm/adc_api.h"
#include "chgbox_box.h"
#include "device/chargebox.h"
#include "chgbox_wireless.h"

#if (TCFG_CHARGE_BOX_ENABLE)

#define LOG_TAG_CONST       APP_CHGBOX
#define LOG_TAG             "[CHG_WL]"
#define LOG_ERROR_ENABLE
#define LOG_DEBUG_ENABLE
#define LOG_INFO_ENABLE
/* #define LOG_DUMP_ENABLE */
#define LOG_CLI_ENABLE
#include "debug.h"

extern void delay_2ms(int cnt);
extern void wireless_port_set_wakeup_enable(u8 enable);

///////////////////////////////////////////////////////////////////////////////////////
////////////////////////////////无线充/////////////////////////////////////////////////
///////////////////////////////////////////////////////////////////////////////////////
#if(defined TCFG_WIRELESS_ENABLE) && (TCFG_WIRELESS_ENABLE)

_wireless_hdl wl_hdl;
#define __this (&wl_hdl)

static u16 wl_send_buff[10] __attribute__((aligned(4))); //10 * =20byte
static int wl_100ms_timer, wl_ad_timer, wl_ad_timeout;
static u32 g_wireless_voltage;
static u8  wl_send_over_msg, wl_init_ok;

//控制充电口电压范围
#define VOLTAGE_MIN     6100
#define VOLTAGE_MAX     6200

//取中间 (AD_OK_COUNTS-AD_CUT_COUNTS*2)计算均值（去掉头部与尾部）
#define AD_OK_COUNTS    5
#define AD_CUT_COUNTS   1

//无线充上线检测
#define WL_ONLINE_VOLT     3500  ///电压大于3.5才认为是有充电器放上来
#define WL_ONLINE_TIMES    3
#define WL_OFFLINE_TIMES   5

static u16  power_table[AD_OK_COUNTS];
static u16  power_table_tmp[AD_OK_COUNTS];

//无线充电通信的时候不能进入低功耗
static volatile u8 is_wl_comm_active = 0;
static u8 wl_comm_idle_query(void)
{
    return (!is_wl_comm_active);
}
REGISTER_LP_TARGET(wl_comm_lp_target) = {
    .name = "chgbox_wl_comm",
    .is_idle = wl_comm_idle_query,
};

/*------------------------------------------------------------------------------------*/
/**@brief    timer2中断回调
   @param    无
   @return   无
   @note     注意调用的所有代码需放在ram里
*/
/*------------------------------------------------------------------------------------*/
SEC(.chargebox_code)
___interrupt
static void wl_timer2_isr(void)
{
    JL_TIMER2->CON |= BIT(14);
    wireless_250us_run();
}

static const u32 timer_div[] = {
    /*0000*/    1,
    /*0001*/    4,
    /*0010*/    16,
    /*0011*/    64,
    /*0100*/    2,
    /*0101*/    8,
    /*0110*/    32,
    /*0111*/    128,
    /*1000*/    256,
    /*1001*/    4 * 256,
    /*1010*/    16 * 256,
    /*1011*/    64 * 256,
    /*1100*/    2 * 256,
    /*1101*/    8 * 256,
    /*1110*/    32 * 256,
    /*1111*/    128 * 256,
};
#define MAX_TIME_CNT            0x7fff
#define MIN_TIME_CNT            0x100
#define WL_TIMER_UNIT_US        250  //单位us
/*------------------------------------------------------------------------------------*/
/**@brief    开启timer2模块
   @param    无
   @return   无
   @note
*/
/*------------------------------------------------------------------------------------*/
static void wl_timer2_open(void)
{
    u32 prd_cnt, timer_clk;
    u8 index;
#if (TCFG_CLOCK_SYS_SRC == SYS_CLOCK_INPUT_PLL_RCL)
    timer_clk = clk_get("lsb");
#else
    timer_clk = clk_get("timer");
#endif
    JL_TIMER2->CON = BIT(14);//清pending
    for (index = 0; index < (sizeof(timer_div) / sizeof(timer_div[0])); index++) {
        prd_cnt = WL_TIMER_UNIT_US * (timer_clk / 1000000) / timer_div[index];
        if (prd_cnt > MIN_TIME_CNT && prd_cnt < MAX_TIME_CNT) {
            break;
        }
    }
    JL_TIMER2->CNT = 0;
    JL_TIMER2->PRD = prd_cnt;
    request_irq(IRQ_TIME2_IDX, 3, wl_timer2_isr, 0);
#if (TCFG_CLOCK_SYS_SRC == SYS_CLOCK_INPUT_PLL_RCL)
    JL_TIMER2->CON = (index << 4) | BIT(0); //lsb clk
#else
    JL_TIMER2->CON = (index << 4) | BIT(0) | BIT(3); //osc clk
#endif
    is_wl_comm_active = 1;
}

/*------------------------------------------------------------------------------------*/
/**@brief    关闭timer2模块
   @param    无
   @return   无
   @note
*/
/*------------------------------------------------------------------------------------*/
static void wl_timer2_close(void)
{
    JL_TIMER2->CON = BIT(14);
    is_wl_comm_active = 0;
}

///dcdc en IO初始化
static void dcdc_io_init(void)
{
#if TCFG_DCDC_CTRL_EN
    gpio_set_die(TCFG_DCDC_EN_IO, 0);
    gpio_set_pull_down(TCFG_DCDC_EN_IO, 0);
    gpio_set_pull_up(TCFG_DCDC_EN_IO, 0);
    gpio_direction_output(TCFG_DCDC_EN_IO, 0);
#endif
}

/*------------------------------------------------------------------------------------*/
/**@brief    DCDC使能
   @param    无
   @return   无
   @note     使能后才能正常充电
*/
/*------------------------------------------------------------------------------------*/
static void dcdc_set_en(u8 en)
{
#if TCFG_DCDC_CTRL_EN
    log_info("dcdc en: %d\n", en);
    if (en) {
        gpio_direction_output(TCFG_DCDC_EN_IO, 1);
    } else {
        gpio_direction_output(TCFG_DCDC_EN_IO, 0);
    }
#endif
}

/*------------------------------------------------------------------------------------*/
/**@brief    无线充通信口初始化
   @param    无
   @return   无
*/
/*------------------------------------------------------------------------------------*/
static void wpc_io_init(void)
{
    gpio_set_die(TCFG_WPC_COMM_IO, 1);
    gpio_set_pull_down(TCFG_WPC_COMM_IO, 0);
    gpio_set_pull_up(TCFG_WPC_COMM_IO, 0);
    gpio_direction_output(TCFG_WPC_COMM_IO, 0);
}

/*------------------------------------------------------------------------------------*/
/**@brief    无线充AD检测上下线IO初始化
   @param    无
   @return   无
   @note
*/
/*------------------------------------------------------------------------------------*/
static void wl_ad_det_init(u8 die_en)
{
    gpio_set_die(TCFG_WL_AD_DET_IO, die_en);
    gpio_set_direction(TCFG_WL_AD_DET_IO, 1);
    gpio_set_pull_down(TCFG_WL_AD_DET_IO, 0);
    gpio_set_pull_up(TCFG_WL_AD_DET_IO, 0);
    if (!die_en) {
        gpio_set_pull_down(TCFG_WL_AD_DET_IO, 1);
        adc_add_sample_ch(TCFG_WL_AD_DET_CH);
        wireless_port_set_wakeup_enable(0);
    } else {
        wireless_port_set_wakeup_enable(1);
    }
}

SEC(.chargebox_code)
static u32 wl_read_ad_io_status(void)
{
    u32 v = 0;
    u32 mask = TCFG_WL_AD_DET_IO % IO_GROUP_NUM;
#if (TCFG_WL_AD_DET_IO <= IO_PORTA_15)
    v = !!(JL_PORTA->IN & BIT(mask));
#elif(TCFG_WL_AD_DET_IO <= IO_PORTB_15)
    v = !!(JL_PORTB->IN & BIT(mask));
#elif(TCFG_WL_AD_DET_IO <= IO_PORTC_15)
    v = !!(JL_PORTC->IN & BIT(mask));
#elif(TCFG_WL_AD_DET_IO <= IO_PORTD_7)
    v = !!(JL_PORTD->IN & BIT(mask));
#endif
    return v;
}

/*------------------------------------------------------------------------------------*/
/**@brief    获取无线充输入电压
   @param    无
   @return   无
   @note
*/
/*------------------------------------------------------------------------------------*/
static u16 get_wireless_voltage(void)
{
    u16 volt;
    //注意分压,上下拉及外部路相关， 默认开下拉四分一
    volt = adc_get_voltage(TCFG_WL_AD_DET_CH) * 4;
    return volt;
}

/*------------------------------------------------------------------------------------*/
/**@brief    无线充100ms调用
   @param    无
   @return   无
   @note
*/
/*------------------------------------------------------------------------------------*/
static void wireless_100ms_run_app(void *priv)
{
    if (sys_info.temperature_limit) {
        if (sys_info.status[WIRELESS_DET] == STATUS_ONLINE) {
            sys_info.status[WIRELESS_DET] = STATUS_OFFLINE;
            app_chargebox_event_to_user(CHGBOX_EVENT_WIRELESS_OFFLINE);
        }
        return;
    }
    //查看是否有数据需要发送
    wireless_100ms_run();
    if (__this->info.busy) {
        wl_timer2_open();
    }
}
/*------------------------------------------------------------------------------------*/
/**@brief    通过电压数组计算均值
   @param    无
   @return   无
   @note
*/
/*------------------------------------------------------------------------------------*/
static u16 wireless_calc_power(void)
{
    u8 i, j, k;
    u16 ad_sum, ad_min;
    memcpy(power_table_tmp, power_table, sizeof(power_table));
    for (i = 1; i < AD_OK_COUNTS; i++) {
        for (j = i; j > 0; j--) {
            if (power_table_tmp[j] < power_table_tmp[j - 1]) {
                ad_min = power_table_tmp[j];
                power_table_tmp[j] = power_table_tmp[j - 1];
                power_table_tmp[j - 1] = ad_min;
            }
        }
    }
    ad_sum = 0;
    for (k = AD_CUT_COUNTS; k < (AD_OK_COUNTS - AD_CUT_COUNTS); k++) {
        ad_sum = power_table_tmp[k] + ad_sum;
    }
    ad_sum = (ad_sum / (AD_OK_COUNTS - (AD_CUT_COUNTS * 2)));
    return ad_sum;
}

static void wireless_ad_detect_run(void *priv)
{
    static u8 power_cnt = 0;
    u16 power_tmp;
    power_tmp = get_wireless_voltage();
    power_table[power_cnt++] = power_tmp;
    if (power_cnt >= AD_OK_COUNTS) {
        usr_timer_del(wl_ad_timer);
        wl_ad_timer = 0;
        wl_ad_timeout = 0;
        power_cnt = 0;
        g_wireless_voltage = wireless_calc_power();
        if (g_wireless_voltage < WL_ONLINE_VOLT) {
            sys_info.status[WIRELESS_DET] = STATUS_OFFLINE;
            app_chargebox_event_to_user(CHGBOX_EVENT_WIRELESS_OFFLINE);
        }
        log_info("wireless_power: %d mV\n", g_wireless_voltage);
    }
}

static void wireless_ad_detect_start(void *priv)
{
    if (wl_ad_timer == 0) {
        wl_ad_timer = usr_timer_add(NULL, wireless_ad_detect_run, 10, 1);//10ms
    }
}

static void wireless_ad_detect_init(void)
{
    if (wl_ad_timeout == 0) {
        wl_ad_timeout = sys_timeout_add(NULL, wireless_ad_detect_start, 25);
    }
}

/*------------------------------------------------------------------------------------*/
/**@brief    获取无线充当前提供的电压
   @param    无
   @return   无
   @note
*/
/*------------------------------------------------------------------------------------*/
u16 get_wireless_power(void)
{
    return g_wireless_voltage;
}

/*------------------------------------------------------------------------------------*/
/**@brief    无线充通信io设置
   @param    无
   @return   无
   @note     供库调用，注意代码要放ram
*/
/*------------------------------------------------------------------------------------*/
SEC(.chargebox_code)
void wpc_io_set(u8 mode)
{
    u8 io_num;
    switch (mode) {
    case IO_HIGH:
        gpio_direction_output(TCFG_WPC_COMM_IO, 1);
        break;
    case IO_LOW:
        gpio_direction_output(TCFG_WPC_COMM_IO, 0);
        wl_timer2_close(); //最后一个动作后关闭
        if (wl_send_over_msg) {
            app_chargebox_event_to_user(CHGBOX_EVENT_WL_DATA_OVER);
        }
        break;
    case IO_INIT:
        gpio_set_die(TCFG_WPC_COMM_IO, 1);
        gpio_set_pull_down(TCFG_WPC_COMM_IO, 0);
        gpio_set_pull_up(TCFG_WPC_COMM_IO, 0);
        gpio_direction_output(TCFG_WPC_COMM_IO, 0);
        break;
    case IO_OVERTURN://翻转
        io_num = TCFG_WPC_COMM_IO % IO_GROUP_NUM;
#if(TCFG_WPC_COMM_IO <= IO_PORTA_15)
        JL_PORTA->OUT ^= BIT(io_num);
#elif(TCFG_WPC_COMM_IO <= IO_PORTB_15)
        JL_PORTB->OUT ^= BIT(io_num);
#elif(TCFG_WPC_COMM_IO <= IO_PORTC_15)
        JL_PORTC->OUT ^= BIT(io_num);
#elif(TCFG_WPC_COMM_IO <= IO_PORTD_7)
        JL_PORTD->OUT ^= BIT(io_num);
#endif
        break;
    case IO_DIR_IN: //高阻
        gpio_direction_input(TCFG_WPC_COMM_IO);
        break;
    }
}

/*------------------------------------------------------------------------------------*/
/**@brief    无线充发送一个数据包封装
   @param    无
   @return   无
   @note     仅在握手阶段调用!!!
*/
/*------------------------------------------------------------------------------------*/
static bool wireless_send_pack_deal(void)
{
    bool ret = true;
    local_irq_disable();
    wl_timer2_open();
    __this->info.busy = 1;
    while (__this->info.busy) {
        asm("nop");
        if (JL_TIMER2->CON & BIT(15)) {
            JL_TIMER2->CON |= BIT(14);
            wireless_250us_run();
        }
        if (wl_read_ad_io_status() == 0) {
            ret = false;
            break;
        }
    }
    wl_timer2_close();
    local_irq_enable();
    if (ret == false) {
        sys_info.status[WIRELESS_DET] = STATUS_OFFLINE;
        app_chargebox_event_to_user(CHGBOX_EVENT_WIRELESS_OFFLINE);
    }
    return ret;
}

/*------------------------------------------------------------------------------------*/
/**@brief    打开无线充模块
   @param    无
   @return   无
   @note     检测到无线充上线时调用，发送相关的初始化指令
*/
/*------------------------------------------------------------------------------------*/
void wireless_api_open(void)
{
    if (sys_info.temperature_limit) {
        sys_info.status[WIRELESS_DET] = STATUS_OFFLINE;
        app_chargebox_event_to_user(CHGBOX_EVENT_WIRELESS_OFFLINE);
        return;
    }

    wireless_open(VOLTAGE_MIN, VOLTAGE_MAX);

    //发送信号强度包
    get_signal_value();
    if (wireless_send_pack_deal() == false) {
        goto __err_exit;
    }

    //发送身份包
    delay_2ms(3);
    get_identification();
    if (wireless_send_pack_deal() == false) {
        goto __err_exit;
    }

    //发送配置包
    delay_2ms(3);
    get_configuration();
    if (wireless_send_pack_deal() == false) {
        goto __err_exit;
    }

    wl_ad_det_init(0);//初始化成模拟口
    app_chargebox_event_to_user(CHGBOX_EVENT_WL_DATA_OVER);
    wl_100ms_timer = sys_timer_add(NULL, wireless_100ms_run_app, 100);
    wl_send_over_msg = 1;
    return;

__err_exit:
    wireless_close();
    return;
}

/*------------------------------------------------------------------------------------*/
/**@brief    关闭无线充模块
   @param    无
   @return   无
   @note     无线充下线时调用
*/
/*------------------------------------------------------------------------------------*/
void wireless_api_close(void)
{
    wireless_close();
    dcdc_set_en(0);
    wl_ad_det_init(1);
    wl_send_over_msg = 0;
    if (wl_100ms_timer) {
        sys_timer_del(wl_100ms_timer);
        wl_100ms_timer = 0;
    }
}

/*------------------------------------------------------------------------------------*/
/**@brief    无线充上线检测
   @param    无
   @return   无
   @note     利用AD值检测无线充的上线
*/
/*------------------------------------------------------------------------------------*/
static int wireless_on_det_timer;
static void wireless_online_det(void *priv)
{
    u16 power_voltage;
    static u16 wl_on_detect_cnt = 0;
    static u16 wl_off_detect_cnt = 0;
    sys_info.life_cnt = 0;
    power_voltage = get_wireless_voltage();
    if (power_voltage >= WL_ONLINE_VOLT) {
        wl_on_detect_cnt++;
        wl_off_detect_cnt = 0;
        g_wireless_voltage += power_voltage;
        if (wl_on_detect_cnt >= WL_ONLINE_TIMES) {
            wl_on_detect_cnt = 0;
            g_wireless_voltage = g_wireless_voltage / WL_ONLINE_TIMES;
            sys_info.status[WIRELESS_DET] = STATUS_ONLINE;
            app_chargebox_event_to_user(CHGBOX_EVENT_WIRELESS_ONLINE);
            goto __online_det_exit;
        }
    } else {
        wl_off_detect_cnt++;
        wl_on_detect_cnt = 0;
        g_wireless_voltage = 0;
        if (wl_off_detect_cnt >= WL_OFFLINE_TIMES) {
            wl_off_detect_cnt = 0;
            goto __online_det_exit;
        }
    }
    return;
__online_det_exit:
    wl_ad_det_init(1);//初始化成数字口
    usr_timer_del(wireless_on_det_timer);
    wireless_on_det_timer = 0;
}

void wireless_io_wakeup_deal(void)
{
    if (!wl_init_ok) {
        return;
    }
    if ((sys_info.status[WIRELESS_DET] == STATUS_OFFLINE) && (wireless_on_det_timer == 0)) {
        wl_ad_det_init(0);//初始化成AD口
        wireless_on_det_timer = usr_timer_add(NULL, wireless_online_det, 5, 1);//6ms
    }
}

void wireless_data_over_run(void)
{
    if (sys_info.status[WIRELESS_DET] == STATUS_OFFLINE) {
        return;
    }
    wireless_ad_detect_init();
}

/*------------------------------------------------------------------------------------*/
/**@brief    无线充模块初始化
   @param    无
   @return   无
   @note     初始化控制结构体、ad、对应的io，注册相关接口
*/
/*------------------------------------------------------------------------------------*/
void wireless_init_api(void)
{
    ///注意顺序不能改变
    memset(__this, 0x0, sizeof(_wireless_hdl));
    //AD采集初始化
    wl_ad_det_init(1);
    dcdc_io_init();
    wpc_io_init();
    wl_send_over_msg = 0;
    __this->get_wl_power = get_wireless_power;
    __this->dcdc_en_set = dcdc_set_en;
    __this->wpc_set = wpc_io_set;
    __this->send_buff = wl_send_buff;
    wireless_lib_init(__this, VOLTAGE_MIN, VOLTAGE_MAX);
    wl_init_ok = 1;
}
#endif//end of WIRELESS_ENABLE

#endif