STM32C5开发LSM6DSV80X .5--运动唤醒检测
- 概述
- 视频教学
- 样品申请
- 源码下载
- 硬件准备
- 参考程序
- 串口配置
- IIC配置
- CS和SA0设置
- INT设置
- 生成项目
- 导入STM32CubeIDE
- 设置工程编码
- 串口 printf 重定向
- 参考程序
- CMake 编译配置
- 头文件设置
- 初始换管脚
- 变量定义
- 获取ID
- 复位传感器
- BDU设置
- 配置输出数据率与测量量程
- 外部中断回调函数
- 中断配置
- 中断功能
- 读取事件
- 演示
.5–运动唤醒检测)
概述
本章介绍如何使用 STM32C542CCT6 驱动 LSM6DSV80X 实现 Wake-up 运动检测。LSM6DSV80X 内置可配置的 Wake-up 标准中断,可利用 Low-G 加速度计对设备的动态运动进行检测,并在运动幅度超过设定阈值后通过 INT1/INT2 输出中断信号。
需要样片的可以加 qun 申请:925643491 / 615061293 。
视频教学
https://www.bilibili.com/video/BV1Hdpd6QEHZ/
样品申请
https://www.wjx.top/vm/OhcKxJk.aspx#
源码下载
硬件准备
首先需要准备一个开发板,这里我准备的是自己绘制的开发板,需要的可以进行申请。
主控为STM32C542CCT6,陀螺仪为LSM6DSV80X,磁力计为LIS2MDL。
参考程序
https://github.com/CoreMaker-lab/STM32C542_LSM6DSV80X_LIS2MDL
https://gitee.com/CoreMaker/STM32C542_LSM6DSV80X_LIS2MDL
串口配置
查看原理图,PA9和PA10设置为开发板的串口。
选择 Connectivity → USART1,设置为 Async 异步模式,波特率 115200、8 位数据、无校验、1 位停止位,启用收发模式。
串口的TX、RX 分别选择 PA9、PA10,均设置为复用模式(Alternate)、无上下拉、推挽输出,速度选择 Low。
IIC配置
STM32C542CCT6通过扩展接口与传感器模块连接,其中PB6作为I²C时钟线SCL,PB7作为I²C数据线SDA
首先在 STM32CubeMX2 中进入 Peripherals 外设配置页面,在 Connectivity 分类中选择 I2C1,并将 I2C1 外设使能。
如图所示,本实验的 I2C1 配置步骤如下:
- 点击左侧 Peripherals 外设配置入口
- 在 Connectivity 分类中选择 I2C1
- 将 I2C1 Mode 设置为 I2C,并确认 I2C1 显示为 Active
- Speed frequency 设置为 Fast mode - 400 kHz
- 确认 I2C1 的 GPIO 引脚映射,SCL 为 PB6,SDA 为 PB7
CS和SA0设置
确认I2C 模式选择和地址选择:
CS 需要处于 I2C 模式对应电平
SA0 需要固定为高电平或低电平
将 PA1 和 PB2 配置为普通 GPIO。
在 Pinout 页面, set PA1 and PB2 to GPIO → Configured, used for SA0 (I²C address selection) respectively和 CS(通信接口选择)。
进入 System → GPIO,将 PA1、PB2 设置为推挽输出、无上下拉、低速,由程序控制输出电平。
板载 LIS2MDL 的 CS 引脚连接 PA6。在 Pinout 页面,将 PA6 设置为 GPIO → Configured。
进入 System → GPIO,将 PA6 命名为 CS2,设置为推挽输出、无上下拉、低速,由程序控制输出电平。
INT设置
IMU 的 INT1(Pin4)连接 STM32C542 的 PB0,用于接收陀螺仪数据就绪中断。
将 PB0 配置为输入、无上下拉,开启 EXTI0,选择下降沿触发(Falling edge),使能中断及 IRQ Handler 生成。
生成项目
- 修改配置后,左下角会提示 Click to save,需要先保存当前工程配置
- 点击左侧 Project settings,进入工程生成设置页面
- 在 IDE Project Generation 中选择工程格式和工具链,本例选择 CMake + GCC,然后点击 Generate IDE project 生成工程
导入STM32CubeIDE
打开 STM32CubeIDE,选择 File → Import,导入 STM32CubeMX2 生成的 CMake 工程。
展开 Import STM32 Project,选择 STM32 CMake Project,点击 Next,进入工程路径选择页面。
- Project name:填写导入到 STM32CubeIDE 中显示的工程名称
- Source directory:选择 STM32CubeMX2 生成的 CMake 工程目录
- 点击 Next,继续完成工程导入
- Toolchain:选择 MCU ARM GCC,表示使用 ARM GCC 工具链进行编译
- MCU:确认芯片型号为 STM32C542CCTx,与前面 STM32CubeMX2 中选择的 MCU 保持一致
- CPU/Core:确认内核为 Cortex-M33,Core 为 0
- 点击 Finish,完成 CMake 工程导入
设置工程编码
在 Project Explorer 中选中工程,点击 Project → Properties。
选择 Resource,将 Text file encoding 设置为 Other → GBK,点击 Apply and Close 保存。
串口 printf 重定向
在 main.c 中添加以下头文件,并在 main() 前实现 _write(),将 printf() 输出重定向到 USART1,用于打印 MEMS 数据和调试信息。
#include"mx_usart1.h"#include<stdio.h>#include<string.h>int_write(intfile,char*ptr,intlen){hal_uart_handle_t*huart1=mx_usart1_uart_gethandle();if(huart1!=NULL){HAL_UART_Transmit(huart1,ptr,len,1000);}returnlen;}参考程序
https://github.com/STMicroelectronics/lsm6dsv80x-pid
添加对应驱动程序。
CMake 编译配置
在 CMakeLists.txt 中,将 .c 加入编译,并添加 -u _printf_float,启用 printf() 浮点输出支持。
target_sources(${CMAKE_PROJECT_NAME}PRIVATE lsm6dsv80x_reg.c)target_link_options(${CMAKE_PROJECT_NAME}PUBLIC-u _printf_float)头文件设置
添加头文件。
#include"lsm6dsv80x_reg.h"初始换管脚
由于需要向LSM6DSV80X_I2C_ADD_L写入以及为IIC模式。
所以使能CS为高电平,配置为IIC模式。
配置SA0为低电平。
printf("HELLO\n");HAL_GPIO_WritePin(CS1_PORT,CS1_PIN,HAL_GPIO_PIN_SET);HAL_GPIO_WritePin(SA0_PORT,SA0_PIN,HAL_GPIO_PIN_RESET);HAL_GPIO_WritePin(CS2_PORT,CS2_PIN,HAL_GPIO_PIN_SET);变量定义
定义全局变量
/* Private macro -------------------------------------------------------------*/#defineBOOT_TIME10//ms/* * Wake-up threshold: * WU_INACT_THS_W = 0 * 1 LSB = 7.8125 mg * 2 = 15.625 mg * 4 = 31.25 mg * 8 = 62.5 mg */#defineWAKEUP_THRESHOLD4/* Private variables ---------------------------------------------------------*/staticuint8_twhoamI;/* Private functions ---------------------------------------------------------*//* * WARNING: * Functions declare in this section are defined at the end of this file * and are strictly related to the hardware platform used. */staticint32_tplatform_write(void*handle,uint8_treg,constuint8_t*bufp,uint16_tlen);staticint32_tplatform_read(void*handle,uint8_treg,uint8_t*bufp,uint16_tlen);staticvoidplatform_delay(uint32_tms);staticstmdev_ctx_tdev_ctx;staticvolatileuint8_tthread_wake=0;staticint32_tplatform_write(void*handle,uint8_treg,constuint8_t*bufp,uint16_tlen){if(HAL_I2C_MASTER_MemWrite((hal_i2c_handle_t*)handle,LSM6DSV80X_I2C_ADD_L,reg,HAL_I2C_MEM_ADDR_8BIT,bufp,len,1000)!=HAL_OK)return-1;return0;}staticint32_tplatform_read(void*handle,uint8_treg,uint8_t*bufp,uint16_tlen){/* NOTE: the 0x80 read bit is only required on the SPI interface. * On I2C the register address must be sent as-is. */if(HAL_I2C_MASTER_MemRead((hal_i2c_handle_t*)handle,LSM6DSV80X_I2C_ADD_L,reg,HAL_I2C_MEM_ADDR_8BIT,bufp,len,1000)!=HAL_OK)return-1;return0;}staticvoidplatform_delay(uint32_tms){HAL_Delay(ms);}在main() 中定义中断路由、接口配置、中断模式和唤醒阈值结构体
lsm6dsv80x_pin_int_route_tpin_int={0};lsm6dsv80x_if_cfg_tif_cfg={0};lsm6dsv80x_interrupt_mode_tirq={0};lsm6dsv80x_act_thresholds_twu={0};获取ID
我们可以向WHO_AM_I (0Fh)获取固定值,判断是否为0x73。
对应的获取ID驱动程序,如下所示。
/* Initialize mems driver interface */dev_ctx.write_reg=platform_write;dev_ctx.read_reg=platform_read;dev_ctx.mdelay=platform_delay;dev_ctx.handle=mx_i2c1_i2c_gethandle();/* Wait sensor boot time */platform_delay(BOOT_TIME);/* Check device ID */lsm6dsv80x_device_id_get(&dev_ctx,&whoamI);printf("LSM6DSV80X_ID=0x%x,id=0x%x\n",LSM6DSV80X_ID,whoamI);if(whoamI!=LSM6DSV80X_ID)while(1);复位传感器
该代码首先对 传感器进行软件复位。
/* Perform device power-on-reset */lsm6dsv80x_reset_set(&dev_ctx,LSM6DSV80X_GLOBAL_RST);BDU设置
在很多传感器中,数据通常被存储在输出寄存器中,这些寄存器分为两部分:MSB和LSB。这两部分共同表示一个完整的数据值。例如,在一个加速度计中,MSB和LSB可能共同表示一个加速度的测量值。
连续更新模式(BDU = ‘0’):在默认模式下,输出寄存器的值会持续不断地被更新。这意味着在你读取MSB和LSB的时候,寄存器中的数据可能会因为新的测量数据而更新。这可能导致一个问题:当你读取MSB时,如果寄存器更新了,接下来读取的LSB可能就是新的测量值的一部分,而不是与MSB相对应的值。这样,你得到的就是一个“拼凑”的数据,它可能无法准确代表任何实际的测量时刻。
块数据更新(BDU)模式(BDU = ‘1’):当激活BDU功能时,输出寄存器中的内容不会在读取MSB和LSB之间更新。这就意味着一旦开始读取数据(无论是先读MSB还是LSB),寄存器中的那一组数据就被“锁定”,直到两部分都被读取完毕。这样可以确保你读取的MSB和LSB是同一测量时刻的数据,避免了读取到代表不同采样时刻的数据。
简而言之,BDU位的作用是确保在读取数据时,输出寄存器的内容保持稳定,从而避免读取到拼凑或错误的数据。这对于需要高精度和稳定性的应用尤为重要。
可以向CTRL3_C(12h)的BDU寄存器写入1进行开启。
对应的驱动程序,如下所示。
/* Enable Block Data Update */lsm6dsv80x_block_data_update_set(&dev_ctx,PROPERTY_ENABLE);配置输出数据率与测量量程
该代码用于配置加速度计和陀螺仪的基本采样参数:
● 将加速度计和陀螺仪的输出数据率均设置为 480 Hz。
● 将加速度计量程设置为 ±2 g。
对应程序如下所示。
/* * Set Low-G accelerometer. * * ODR = 480 Hz * FS = +/-2 g */lsm6dsv80x_xl_data_rate_set(&dev_ctx,LSM6DSV80X_ODR_AT_480Hz);lsm6dsv80x_xl_mode_set(&dev_ctx,LSM6DSV80X_XL_HIGH_PERFORMANCE_MD);lsm6dsv80x_xl_full_scale_set(&dev_ctx,LSM6DSV80X_2g);外部中断回调函数
当 LSM6DSV80X 传感器 的 INT1 引脚产生中断信号后,MCU 进入 EXTI 中断处理流程,并调用 HAL_EXTI_TriggerCallback()。
/** * @brief EXTI trigger callback */voidHAL_EXTI_TriggerCallback(hal_exti_handle_t*hexti,hal_exti_trigger_ttrigger){if(HAL_EXTI_GetInstance(hexti)==HAL_EXTI_GPIO_0){thread_wake=1;}}中断配置
对 LSM6DSV80X 的中断输出进行配置,将 INT1/INT2 设置为开漏输出并采用低电平有效方式,以配合硬件上的外部上拉电阻和 STM32 PB0 的下降沿外部中断。
/* * INT1/INT2: * open-drain + active low */lsm6dsv80x_read_reg(&dev_ctx,LSM6DSV80X_IF_CFG,(uint8_t*)&if_cfg,1);if_cfg.pp_od=1;if_cfg.h_lactive=1;lsm6dsv80x_write_reg(&dev_ctx,LSM6DSV80X_IF_CFG,(uint8_t*)&if_cfg,1);中断功能
开启 传感器 的基础事件中断功能,并将中断设置为锁存模式。当运动事件发生后,中断状态会保持,避免由于中断脉冲过短导致 STM32 未能及时响应;随后 MCU 可在主循环中读取中断源并完成对应事件处理。
/* * Enable basic interrupts (wake-up) and latched mode. * Without this the event is detected but never driven on INT1. */irq.enable=PROPERTY_ENABLE;irq.lir=PROPERTY_ENABLE;lsm6dsv80x_interrupt_enable_set(&dev_ctx,irq);开启 Low-G 加速度计滤波器的快速稳定功能,使 LPF2/HPF 在启动后能够更快进入稳定状态,减少滤波器建立过程对运动检测的影响,为后续 Wake-up 高通滤波和运动事件检测提供稳定的数据输入
/* * Enable XL Filter fast settling */lsm6dsv80x_filt_xl_fast_settling_set(&dev_ctx,PROPERTY_ENABLE);开启加速度计滤波器稳定阶段的中断屏蔽功能。当 Low-G 加速度计及其滤波器刚启动、数据尚未完全稳定时,暂时禁止 Wake-up 等硬件运动检测事件触发,从而减少滤波器建立过程产生的误中断;待加速度数据稳定后,再正常进行运动事件检测。
/* * Mask interrupt trigger during * accelerometer filter settling. */lsm6dsv80x_mask_trigger_xl_settl_set(&dev_ctx,PROPERTY_ENABLE);配置 Wake-up 运动检测的数据源为高通滤波输出,通过滤除重力等低频和直流分量,保留设备运动产生的动态加速度变化,使 Wake-up 功能能够更加准确地判断设备是否发生运动。
/* * Use High-Pass filter for * Wake-up detection. */lsm6dsv80x_filt_wkup_act_feed_set(&dev_ctx,LSM6DSV80X_WK_FEED_HIGH_PASS);配置 Wake-up 运动检测的阈值及持续时间,其中阈值权重设置为 7.8125 mg/LSB,并通过 WAKEUP_THRESHOLD 设置实际触发阈值;当前设置为 4,对应约 31.25 mg。当设备动态加速度超过设定阈值后即可触发 Wake-up 运动事件,同时保持 Activity/Inactivity 相关参数为基础配置。
/* * Wake-up threshold configuration. * * wu_inact_ths_w = 0: * 1 LSB = 7.8125 mg * * threshold = 4: * 4 x 7.8125 mg = 31.25 mg */wu.inactivity_cfg.inact_dur=0;wu.inactivity_cfg.xl_inact_odr=1;wu.inactivity_cfg.wu_inact_ths_w=0;wu.inactivity_ths=0;wu.threshold=WAKEUP_THRESHOLD;wu.duration=0;lsm6dsv80x_act_thresholds_set(&dev_ctx,&wu);将 Wake-up 运动事件映射至 INT1 引脚,当检测到动态加速度超过设定阈值后,MEMS 通过 INT1 产生中断通知 MCU。
/* * Route Wake-up event to INT1 */pin_int.wakeup=PROPERTY_ENABLE;lsm6dsv80x_pin_int1_route_set(&dev_ctx,&pin_int);printf("Wake-up Motion Detection start...\r\n");printf("Threshold = %d x 7.8125 mg\r\n",WAKEUP_THRESHOLD);读取事件
当 INT1 检测到 Wake-up 运动事件后,中断回调将 thread_wake 标志位置 1。主循环检测到该标志后读取传感器中断源,并通过 wake_up 状态位判断是否发生运动事件;如果检测有效,则通过串口输出运动提示。由于程序采用锁存中断模式,读取中断源的同时也可释放当前锁存状态,为下一次运动检测做准备。
while(1){if(thread_wake){lsm6dsv80x_all_sources_tstatus={0};thread_wake=0;/* Read interrupt source */lsm6dsv80x_all_sources_get(&dev_ctx,&status);/* Check Wake-up event */if(status.wake_up){printf("Motion detected\r\n");}}}演示
移动或晃动开发板,使动态加速度满足运动唤醒条件后,串口输出 Motion detected。本例只提示运动事件,不输出进入静止状态的信息。