/************************************************************* 此文件函数主要是linein 插入检测 支持和sd卡 io复用检测 **************************************************************/ #include "app_config.h" #include "system/event.h" #include "system/init.h" #include "system/timer.h" #include "asm/power_interface.h" #include "asm/adc_api.h" #include "lp/lp.h" #include "lp/lp_dev.h" #include "gpio.h" #include "asm/sdmmc.h" #if TCFG_APP_LP_EN #define LP_STU_HOLD 0 #define LP_STU_ON 1 #define LP_STU_OFF 2 #define LP_DETECT_CNT 3 // 滤波计算 #define LOG_TAG_CONST APP_LP #define LOG_TAG "[APP_LP_DEV]" #define LOG_ERROR_ENABLE #define LOG_DEBUG_ENABLE #define LOG_INFO_ENABLE /*#define LOG_DUMP_ENABLE */ #define LOG_CLI_ENABLE #include "debug.h" struct lp_dev_opr { struct lp_dev_data *dev; u8 cnt; // 滤波计算 u8 stu; // 当前状态 u16 timer; // 定时器句柄 u8 online : 1; // 是否在线 u8 active : 1; // 进入sniff的判断标志 u8 init : 1; // 初始化完成标志 u8 step : 3; // 检测阶段 }; static struct lp_dev_opr lp_dev_hdl = {0}; #define __this (&lp_dev_hdl) /*----------------------------------------------------------------------------*/ /*@brief 获取lp是否在线 @param @return 1:在线 0:不在线 @note app通过这个接口判断lp是否在线 */ /*----------------------------------------------------------------------------*/ u8 lp_is_online(void) { #if ((defined TCFG_LP_DETECT_ENABLE) && (TCFG_LP_DETECT_ENABLE == 0)) return 1; #else return __this->online; #endif // TCFG_LP_DETECT_ENABLE } /*----------------------------------------------------------------------------*/ /*@brief 设置lp是否在线 @param 1:在线 0:不在线 @return null @note 检测驱动通过这个接口判断lp是否在线 */ /*----------------------------------------------------------------------------*/ void lp_set_online(u8 online) { __this->online = !!online; } /*----------------------------------------------------------------------------*/ /*@brief 发布设备上下线消息 @param 上下线消息 */ /*----------------------------------------------------------------------------*/ void lp_event_notify(u8 arg) { struct sys_event event = {0}; event.arg = (void *)DEVICE_EVENT_FROM_LP; event.type = SYS_DEVICE_EVENT; if (arg == DEVICE_EVENT_IN) { event.u.dev.event = DEVICE_EVENT_IN; } else if (arg == DEVICE_EVENT_OUT) { event.u.dev.event = DEVICE_EVENT_OUT; } else { return; } sys_event_notify(&event); } /*----------------------------------------------------------------------------*/ /*@brief 检测前使能io @param null @return null @note 检测驱动检测前使能io ,检测完成后设为高阻 可以节约功耗 (io检测、sd复用ad检测动态使用,单独ad检测不动态修改) */ /*----------------------------------------------------------------------------*/ static void lp_io_start(void) { /* printf("<<dev; if (__this->init) { return; } __this->init = 1; if (lp_dev->down) { gpio_set_pull_down(lp_dev->port, 1); } else { gpio_set_pull_down(lp_dev->port, 0); } if (lp_dev->up) { gpio_set_pull_up(lp_dev->port, 1); } else { gpio_set_pull_up(lp_dev->port, 0); } if (lp_dev->ad_channel == (u8)NO_CONFIG_PORT) { gpio_set_die(lp_dev->port, 1); } else { gpio_set_die(lp_dev->port, 0); } gpio_set_hd(lp_dev->port, 0); gpio_set_hd0(lp_dev->port, 0); gpio_direction_input(lp_dev->port); } /*----------------------------------------------------------------------------*/ /*@brief 检测完成关闭使能io @param null @return null @note 检测驱动检测前使能io ,检测完成后设为高阻 可以节约功耗 (io检测、sd复用ad检测动态使用,单独ad检测不动态修改) */ /*----------------------------------------------------------------------------*/ static void lp_io_stop(void) { /* printf("<<dev; if (!__this->init) { return; } __this->init = 0; gpio_direction_input(lp_dev->port); gpio_set_pull_up(lp_dev->port, 0); gpio_set_pull_down(lp_dev->port, 0); gpio_set_hd(lp_dev->port, 0); gpio_set_hd0(lp_dev->port, 0); gpio_set_die(lp_dev->port, 0); } /*----------------------------------------------------------------------------*/ /*@brief 检测是否在线 @param 驱动句柄 @return 1:有设备插入 0:没有设备插入 @note 检测驱动检测前使能io ,检测完成后设为高阻 可以节约功耗 (io检测、sd复用ad检测动态使用,单独ad检测不动态修改) */ /*----------------------------------------------------------------------------*/ static int lp_sample_detect(void *arg) { struct lp_dev_data *lp_dev = (struct lp_dev_data *)arg; u8 cur_stu; if (lp_dev->ad_channel == (u8)NO_CONFIG_PORT) { lp_io_start(); cur_stu = gpio_read(lp_dev->port) ? false : true; lp_io_stop(); if (!lp_dev->up) { cur_stu = !cur_stu; } } else { cur_stu = adc_get_value(lp_dev->ad_channel) > lp_dev->ad_vol ? false : true; /* printf("<%d> ", adc_get_value(lp_dev->ad_channel)); */ } /* putchar('A' + cur_stu); */ return cur_stu; } /*----------------------------------------------------------------------------*/ /*@brief sd cmd 复用检测是否在线 @param 驱动句柄 @return 1:有设备插入 0:没有设备插入 @note 检测驱动检测前使能io ,检测完成后设为高阻 可以节约功耗 (io检测、sd复用ad检测动态使用,单独ad检测不动态修改) */ /*----------------------------------------------------------------------------*/ static int lp_sample_mult_sd(void *arg) { struct lp_dev_data *lp_dev = (struct lp_dev_data *)arg; lp_io_start(); u16 ad_value = 0; u8 cur_stu; if (lp_dev->ad_channel == (u8)NO_CONFIG_PORT) { cur_stu = gpio_read(lp_dev->port) ? false : true; } else { adc_enter_occupy_mode(lp_dev->ad_channel); if (adc_occupy_run()) { ad_value = adc_get_occupy_value(); cur_stu = ad_value > lp_dev->ad_vol ? false : true; /* printf("\n<%d>\n", ad_value); */ } else { cur_stu = __this->stu; } adc_exit_occupy_mode(); } /* putchar('A'+cur_stu); */ /* putchar(cur_stu); */ lp_io_stop(); return cur_stu; } /*----------------------------------------------------------------------------*/ /*@brief 注册的定时器回调检测函数 @param 驱动句柄 @return null @note 定时进行检测 */ /*----------------------------------------------------------------------------*/ static void lp_detect(void *arg) { int cur_stu; struct sys_event event = {0}; #if ((TCFG_LP_MULTIPLEX_WITH_SD == ENABLE)) if (sd_io_suspend(TCFG_LP_SD_PORT, 0) == 0) { // 判断sd 看是否空闲 cur_stu = lp_sample_mult_sd(arg); sd_io_resume(TCFG_LP_SD_PORT, 0); // 使用完,回复sd } else { return; } #else if (__this->step == 0) { __this->step = 1; sys_timer_modify(__this->timer, 10); // 猜测是检测状态变化的时候改变定时器回调时间 return; } cur_stu = lp_sample_detect(arg); if (!__this->active) { __this->step = 0; sys_timer_modify(__this->timer, 500); // 猜测是检测状态不变化的时候改变定时器回调时间 } #endif if (cur_stu != __this->stu) { __this->stu = cur_stu; __this->cnt = 0; __this->active = 1; } else { __this->cnt++; } if (__this->cnt < LP_DETECT_CNT) { // 滤波计算 return; } __this->active = 0; // 检测一次完成 /* putchar(cur_stu); */ if ((lp_is_online()) && (!__this->stu)) { lp_set_online(false); lp_event_notify(DEVICE_EVENT_OUT); // 发布下线消息 } else if ((!lp_is_online()) && (__this->stu)) { lp_set_online(true); lp_event_notify(DEVICE_EVENT_IN); // 发布上线消息 } return; } void lp_detect_timer_add() { if (!__this || !(__this->dev)) { return; } if (__this->timer == 0) { __this->timer = sys_timer_add(__this->dev, lp_detect, 25); } } void lp_detect_timer_del() { if (__this && __this->timer) { sys_timer_del(__this->timer); __this->timer = 0; } } static int lp_driver_init(const struct dev_node *node, void *arg) { struct lp_dev_data *lp_dev = (struct lp_dev_data *)arg; if (!lp_dev->enable) { lp_set_online(true); return 0; } #if ((defined TCFG_LP_DETECT_ENABLE) && (TCFG_LP_DETECT_ENABLE == 0)) lp_set_online(true); // 没有配置detcct 默认在线 return 0; #endif if (lp_dev->port == (u8)NO_CONFIG_PORT) { lp_set_online(true); // 配置的io 不在范围 ,默认在线 return 0; } lp_set_online(false); #if (!(TCFG_LP_MULTIPLEX_WITH_SD)) // 复用情况和io检测仅在使用的时候配置io if (lp_dev->ad_channel != (u8)NO_CONFIG_PORT) { lp_io_start(); // 初始化io adc_add_sample_ch(lp_dev->ad_channel); } #endif __this->dev = lp_dev; __this->timer = sys_timer_add(arg, lp_detect, 50); return 0; } const struct device_operations lp_dev_ops = { .init = lp_driver_init, }; /*----------------------------------------------------------------------------*/ /*@brief 注册的定功耗检测函数 @param @return null @note 用于防止检测一次未完成进入了低功耗 */ /*----------------------------------------------------------------------------*/ static u8 lp_dev_idle_query(void) { return !__this->active; } REGISTER_LP_TARGET(lp_dev_lp_target) = { .name = "lp_dev", .is_idle = lp_dev_idle_query, }; #endif