393 lines
10 KiB
C
393 lines
10 KiB
C
|
|
|||
|
|
/*************************************************************
|
|||
|
|
此文件函数主要是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("<<<lp_io_start\n"); */
|
|||
|
|
struct lp_dev_data *lp_dev = (struct lp_dev_data *)__this->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("<<<lp_io_stop\n"); */
|
|||
|
|
struct lp_dev_data *lp_dev = (struct lp_dev_data *)__this->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
|