陀螺仪LSM6DSV16X与AI集成(6)----检测自由落体

已于 2024-03-14 11:10:40 修改
阅读量1.8w 收藏 29
点赞数 25
分类专栏： 单片机 传感器 stm32cube 文章标签： LSM6DSV16X 陀螺仪 STM32CUBEMX 自由落体 摔倒检测
于 2024-01-14 20:42:43 首次发布
本文链接：https://blog.csdn.net/qq_24312945/article/details/135588248
版权
单片机 同时被 3 个专栏收录
228 篇文章 129 订阅
订阅专栏
stm32cube
107 篇文章 56 订阅
订阅专栏
传感器
63 篇文章 3 订阅
订阅专栏

陀螺仪LSM6DSV16X与AI集成.6--检测自由落体

概述

本文介绍如何初始化传感器并配置其参数，以便在检测到自由落体事件时发送通知。

最近在弄ST和瑞萨RA的课程，需要样片的可以加群申请：615061293 。

在这里插入图片描述

视频教学

https://www.bilibili.com/video/BV1yi421o7Jr/

陀螺仪LSM6DSV16X与AI集成(6)----检测自由落体

样品申请

https://www.wjx.top/vm/OhcKxJk.aspx#

源码下载

https://download.csdn.net/download/qq_24312945/88947607

生成STM32CUBEMX

用STM32CUBEMX生成例程，这里使用MCU为STM32WB55RG。
配置时钟树，配置时钟为32M。

在这里插入图片描述

串口配置

查看原理图，PB6和PB7设置为开发板的串口。

在这里插入图片描述
配置串口。

在这里插入图片描述

IIC配置

在这里插入图片描述
配置IIC为快速模式，速度为400k。
在这里插入图片描述

CS和SA0设置

在这里插入图片描述

串口重定向

打开魔术棒，勾选MicroLIB

在这里插入图片描述

在main.c中，添加头文件，若不添加会出现 identifier “FILE” is undefined报错。

/* USER CODE BEGIN Includes */
#include "stdio.h"
/* USER CODE END Includes */

函数声明和串口重定向：

/* USER CODE BEGIN PFP */
int fputc(int ch, FILE *f){
	HAL_UART_Transmit(&huart1 , (uint8_t *)&ch, 1, 0xFFFF);
	return ch;
}
/* USER CODE END PFP */

参考程序

https://github.com/STMicroelectronics/lsm6dsv16x-pid/tree/main

初始换管脚

由于需要向LSM6DSV16X_I2C_ADD_L写入以及为IIC模式。
在这里插入图片描述

所以使能CS为高电平，配置为IIC模式。
配置SA0为高电平。

	printf("123123123");
  lsm6dsv16x_reset_t rst;
  stmdev_ctx_t dev_ctx;
  /* Initialize mems driver interface */
  dev_ctx.write_reg = platform_write;
  dev_ctx.read_reg = platform_read;
  dev_ctx.handle = &SENSOR_BUS;


  HAL_GPIO_WritePin(CS_GPIO_Port, CS_Pin, GPIO_PIN_SET);
  HAL_GPIO_WritePin(SA0_GPIO_Port, SA0_Pin, GPIO_PIN_RESET);

获取ID

可以向WHO_AM_I (0Fh)获取固定值，判断是否为0x70。

在这里插入图片描述

lsm6dsv16x_device_id_get为获取函数。

在这里插入图片描述

对应的获取ID驱动程序,如下所示。

  /* Wait sensor boot time */
  platform_delay(BOOT_TIME);
  /* Check device ID */
  lsm6dsv16x_device_id_get(&dev_ctx, &whoamI);
	printf("LSM6DSV16X_ID=0x%x,whoamI=0x%x",LSM6DSV16X_ID,whoamI);
  if (whoamI != LSM6DSV16X_ID)
    while (1);

复位操作

可以向CTRL3 (12h)的SW_RESET寄存器写入1进行复位。
在这里插入图片描述

lsm6dsv16x_reset_set为重置函数。
在这里插入图片描述

对应的驱动程序,如下所示。

  /* Restore default configuration */
  lsm6dsv16x_reset_set(&dev_ctx, LSM6DSV16X_RESTORE_CTRL_REGS);
  do {
    lsm6dsv16x_reset_get(&dev_ctx, &rst);
  } while (rst != LSM6DSV16X_READY);

BDU设置

在很多传感器中，数据通常被存储在输出寄存器中，这些寄存器分为两部分：MSB和LSB。这两部分共同表示一个完整的数据值。例如，在一个加速度计中，MSB和LSB可能共同表示一个加速度的测量值。
连续更新模式（BDU = ‘0’）：在默认模式下，输出寄存器的值会持续不断地被更新。这意味着在你读取MSB和LSB的时候，寄存器中的数据可能会因为新的测量数据而更新。这可能导致一个问题：当你读取MSB时，如果寄存器更新了，接下来读取的LSB可能就是新的测量值的一部分，而不是与MSB相对应的值。这样，你得到的就是一个“拼凑”的数据，它可能无法准确代表任何实际的测量时刻。
块数据更新（BDU）模式（BDU = ‘1’）：当激活BDU功能时，输出寄存器中的内容不会在读取MSB和LSB之间更新。这就意味着一旦开始读取数据（无论是先读MSB还是LSB），寄存器中的那一组数据就被“锁定”，直到两部分都被读取完毕。这样可以确保你读取的MSB和LSB是同一测量时刻的数据，避免了读取到代表不同采样时刻的数据。
简而言之，BDU位的作用是确保在读取数据时，输出寄存器的内容保持稳定，从而避免读取到拼凑或错误的数据。这对于需要高精度和稳定性的应用尤为重要。
可以向CTRL3 (12h)的BDU寄存器写入1进行开启。

在这里插入图片描述

对应的驱动程序,如下所示。

  /* Enable Block Data Update */
  lsm6dsv16x_block_data_update_set(&dev_ctx, PROPERTY_ENABLE);

寄存器地址自动递增

IF_INC (Register Address Auto-Increment)：
当使用串行接口（如I²C, MIPI I3C, 或 SPI）进行多字节访问时，此位用于自动增加寄存器地址。默认值是1（启用），这样在连续读取多个寄存器时，地址会自动递增

在这里插入图片描述

对应的驱动程序,如下所示。

  /* Enable register address automatically incremented during a multiple byte
  access with a serial interface. */
  lsm6dsv16x_auto_increment_set(&dev_ctx, PROPERTY_ENABLE) ;

关闭FIFO

可以通过FIFO_CTRL4 (0Ah)关闭FIFO模式。
在这里插入图片描述

对应的驱动程序,如下所示。

	/* FIFO mode selection */
	lsm6dsv16x_fifo_mode_set(&dev_ctx, LSM6DSV16X_BYPASS_MODE);

设置量程

加速度量程可以通过CTRL8 (17h)的CTRL8 (17h)设置。

在这里插入图片描述

对应的驱动程序,如下所示。

  /* Full scale selection. */
	lsm6dsv16x_xl_full_scale_set(&dev_ctx, LSM6DSV16X_2g);

关闭角速度量程

陀螺仪的输出数据率选择可以通过CTRL2 (11h) 陀螺仪控制寄存器进行配置。由于不需要用到陀螺仪数据，所以可以关闭。
在这里插入图片描述
对应的驱动程序,如下所示。

  /* Output data rate selection - power down. */
	lsm6dsv16x_gy_data_rate_set(&dev_ctx, LSM6DSV16X_ODR_OFF);

输出数据设置

输出数据率范围从1.875 Hz到7.68 kHz不等，允许用户根据应用的需求来调整加速度计的性能和功耗。
CTRL1 (10h) 加速度计控制寄存器的配置选项。

在这里插入图片描述

对应的驱动程序,如下所示。

 /* Output data rate selection. */
	lsm6dsv16x_xl_data_rate_set(&dev_ctx, LSM6DSV16X_ODR_AT_120Hz);

设置自由落体功能的持续时间

WAKE_UP_DUR (5Ch) 寄存器用于设置自由落体、唤醒和睡眠模式功能的持续时间。具体字段如下：
FF_DUR_5：与自由落体持续时间事件相关。完整的自由落体配置需要参考 FREE_FALL 寄存器。
WAKE_DUR [1:0]：定义唤醒事件的持续时间，默认值为00。
SLEEP_DUR [3:0]：定义进入睡眠模式前的持续时间，默认值为0000。

FREE_FALL (5Dh) 寄存器用于设置自由落体功能的持续时间和阈值。具体字段如下：
FF_DUR [4:0]：定义自由落体事件的持续时间，需要与 WAKE_UP_DUR 寄存器的 FF_DUR_5 位一起配置以设置完整的持续时间。
FF_THS [2:0]：定义自由落体检测的阈值，默认值为000。

在这里插入图片描述

对应的驱动程序,如下所示。

	/*  Set free fall duration.*/
	lsm6dsv16x_ff_time_windows_set(&dev_ctx, 0x06);

中断设置

MD1_CFG (5Eh) 这个寄存器用于配置哪些功能的中断信号会被路由到 INT1 引脚。每个位的设置决定了特定事件是否会触发 INT1 引脚的中断。具体功能如下：

INT1_SLEEP_CHANGE：活动/静止状态变化的中断事件路由到 INT1。
INT1_SINGLE_TAP：单次敲击识别的中断事件路由到 INT1。
INT1_WU：唤醒事件的中断路由到 INT1。
INT1_FF：自由落体事件的中断路由到 INT1。
INT1_DOUBLE_TAP：双次敲击识别的中断事件路由到 INT1。
INT1_6D：6D（方向改变）事件的中断路由到 INT1。
INT1_EMB_FUNC：嵌入式功能事件的中断路由到 INT1。
INT1_SHUB：传感器集线器通信结束的中断路由到 INT1。
每个功能旁边的 0 和 1 表示该功能的中断是否被禁用 (0) 或启用 (1)。默认值是 0，表示中断被禁用。如果将相应位设置为 1，则当相应的事件发生时，INT1 引脚将触发中断。

通过这个寄存器，开发者可以根据需要配置传感器，以确定在发生如敲击、唤醒、自由落体或方向改变等事件时是否生成中断信号，从而允许外部微控制器或处理器相应地响应这些事件。

在这里插入图片描述

FUNCTIONS_ENABLE（50h）这个寄存器用于控制不同的中断功能是否启用。具体功能包括：

INTERRUPTS_ENABLE：启用或禁用基本中断（6D/4D定向、自由落体、唤醒、敲击、活动/静止）。默认值为0，表示中断禁用。
TIMESTAMP_EN：启用或禁用时间戳计数器。如果启用，时间戳计数器的值可以在TIMESTAMP0（40h）、TIMESTAMP1（41h）和TIMESTAMP3（43h）寄存器中读取。默认值为0，表示禁用。
DIS_RST_LIR_ALL_INT：当此位设置为1时，读取ALL_INT_SRC（1Dh）寄存器不会重置锁存的中断信号。这在读取状态寄存器之前不重置某些状态标志时很有用。默认值为0。
INACT_EN [1:0]：启用活动/静止（睡眠）功能。根据设置，这可以配置加速度计进入不同的低功耗模式，并通过INACTIVITY_DUR（54h）寄存器选择加速度计的输出数据速率（ODR）。陀螺仪的配置也可能相应变化，例如进入睡眠模式或关闭电源模式。

这个寄存器让用户可以根据应用需求，灵活地选择哪些中断事件应该被监控，以及加速度计和陀螺仪的功耗管理策略。这些设置对于优化设备电池寿命和确保及时响应传感器事件非常重要。

在这里插入图片描述

对应的驱动程序,如下所示。

  /* Enable free fall event on either INT1 or INT2 pin */
	lsm6dsv16x_md1_cfg_t val1;
	lsm6dsv16x_functions_enable_t functions_enable;
	
	lsm6dsv16x_read_reg(&dev_ctx, LSM6DSV16X_MD1_CFG, (uint8_t *)&val1, 1);
	val1.int1_ff = PROPERTY_ENABLE;
	lsm6dsv16x_write_reg(&dev_ctx, LSM6DSV16X_MD1_CFG, (uint8_t *)&val1, 1);
	
	lsm6dsv16x_read_reg(&dev_ctx, LSM6DSV16X_FUNCTIONS_ENABLE, (uint8_t *)&functions_enable, 1);
	functions_enable.interrupts_enable = PROPERTY_ENABLE;
	lsm6dsv16x_write_reg(&dev_ctx, LSM6DSV16X_FUNCTIONS_ENABLE, (uint8_t *)&functions_enable, 1);

获取所有中断源的状态

可以通过ALL_INT_SRC (1Dh)寄存器的FF_IA判断是否产生自由落体事件。

在这里插入图片描述

/* wait forever (6D event handle in irq handler) */
		lsm6dsv16x_all_sources_t status;
        if(HAL_GPIO_ReadPin(INT1_GPIO_Port,INT1_Pin)==0)
		{
			/* Read output only if new xl value is available */
			lsm6dsv16x_all_sources_get(&dev_ctx, &status);
			if (status.free_fall) {
				printf("Free Fall Detected!\n");
			}			
		
		
		}

演示

在这里插入图片描述

记帖
关注
  • 25
    点赞
  • 踩
  • 29
    收藏
    觉得还不错? 一键收藏
  • 打赏
    打赏
  • 0
    评论
专栏目录
陀螺仪lsm6ds0初始化
05-29
陀螺仪lsm6ds0寄存器初始化，包括角速度量程、加速度量程
ST_LSM6DS3_6轴传感器（3轴加速计+3轴陀螺仪）中文应用笔记+官方datasheet.rar
02-09
1.LSM6DS3是ST公司推出的一款 iNEMO 六轴惯性传感器模块（3D 数字加速度计+3D 数字陀螺仪） 2.文档包括：ST_LSM6DS3_6轴传感器（3轴加速计+3轴陀螺仪）中文应用笔记+官方datasheet，旨在为使用该芯片开发产品的小伙伴提供参考
陀螺仪LSM6DSV16X与AI集成(5)-6D方向检测功能
01-09
陀螺仪LSM6DSV16X与AI集成(5)----6D方向检测功能 CSDN文字教程：https://blog.csdn.net/qq_24312945/article/details/135469733 B站教学视频：https://www.bilibili.com/video/BV1jw41137Zo/ 陀螺仪通常可以读取三个方向上的旋转，即绕X轴、Y轴和Z轴的旋转。每个方向上的旋转包括正向旋转和反向旋转，因此一共有六个位置。这六个位置分别是：1.X轴正向旋转、2.X轴反向旋转、3.Y轴正向旋转、4.Y轴反向旋转、5.Z轴正向旋转、6.Z轴反向旋转 通过检测陀螺仪在每个方向上的旋转，可以确定物体的旋转姿态和方向，从而用于导航、飞行控制等应用。
驱动LSM6DS3TR-C实现高效运动检测与数据采集(3)----获取传感器数据
xh1479的博客
05-31 1万+
一旦传感器被正确初始化，可以通过SPI或I2C接口向传感器发送读取命令，并接收传感器返回的数据。这个读取过程包括获取LSM6DS3TR传感器提供的加速度计和陀螺仪数据，以及传感器对应的温度信息。
驱动LSM6DS3TR-C实现高效运动检测与数据采集(5)----姿态解算
xh1479的博客
06-16 1万+
lsm6ds3trc包含三轴陀螺仪与三轴加速度计。姿态有多种数学表示方式，常见的是四元数，欧拉角，矩阵和轴角。他们各自有其自身的优点，在不同的领域使用不同的表示方式。在四轴飞行器中使用到了四元数和欧拉角。
陀螺仪LSM6DSV16X与AI集成(6)-检测自由落体
最新发布
03-12
陀螺仪LSM6DSV16X与AI集成(6)----检测自由落体 CSDN文字教程：https://blog.csdn.net/qq_24312945/article/details/135588248 B站教学视频：https://www.bilibili.com/video/BV1yi421o7Jr/ 本文介绍如何初始化传感器...
驱动LSM6DS3TR-C实现高效运动检测与数据采集(5)-上报匿名上位机实现可视化
06-24
驱动LSM6DS3TR-C实现高效运动检测与数据采集(5)----上报匿名上位机实现可视化 CSDN文字教程：https://blog.csdn.net/qq_24312945/article/details/131250387 B站教学视频：...
中文AN5763：LSM6DSV16X：具有嵌入式机器学习内核和Qvar+检测功能.pdf
08-31
AN5763，LSM6DSV16X是一款ST的3 轴加速度计和 3 轴陀螺仪； LSM6DSV16X 是系统级封装的 3 轴数字加速度计和 3 轴数字陀螺仪，具有数字 I²C、SPI 和 MIPI I3C串行接口标准输出，组合工作在高性能模式下电流消耗只要 ...
驱动LSM6DS3TR-C实现高效运动检测与数据采集(2)----配置滤波器
xh1479的博客
05-29 1万+
在LSM6DS3TR-C中，加速度计和陀螺仪可以独立地开启/关闭，并且可以拥有不同的ODR和功耗模式。LSM6DS3TR-C有三种可用的操作模式：● 仅加速度计活动，陀螺仪处于断电状态● 仅陀螺仪活动，加速度计处于断电状态● 加速度计和陀螺仪传感器同时活动，ODR独立。
陀螺仪LSM6DSV16X与AI集成(2)----姿态解算
xh1479的博客
12-05 1万+
LSM6DSV16X包含三轴陀螺仪与三轴加速度计。姿态有多种数学表示方式，常见的是四元数，欧拉角，矩阵和轴角。他们各自有其自身的优点，在不同的领域使用不同的表示方式。在四轴飞行器中使用到了四元数和欧拉角。
陀螺仪LSM6DSV16X与AI集成(5)----6D方向检测功能
xh1479的博客
01-09 1万+
陀螺仪通常可以读取三个方向上的旋转，即绕X轴、Y轴和Z轴的旋转。每个方向上的旋转包括正向旋转和反向旋转，因此一共有六个位置。这六个位置分别是：1.X轴正向旋转、2.X轴反向旋转、3.Y轴正向旋转、4.Y轴反向旋转、5.Z轴正向旋转、6.Z轴反向旋转通过检测陀螺仪在每个方向上的旋转，可以确定物体的旋转姿态和方向，从而用于导航、飞行控制等应用。
陀螺仪LSM6DSV16X与AI集成(4)----Qvar触摸电容配置
xh1479的博客
12-10 1万+
Qvar，全称为电荷变化检测（Qvar stands for “Quasi-static VARiation”），是一种用于检测电荷变化的技术。这种技术通常用于传感器和其他电子设备中，特别是在惯性测量单元（IMU）和微机电系统（MEMS）技术中。Qvar 技术可以用于检测微小的电荷变化，这些变化可能是由于物理运动、环境变化或其他因素导致的。在 LSM6DSV16X 这类先进的 IMU 中，Qvar 技术用于增强用户界面功能，如轻触、双击、三击、长按或滑动手势。
驱动LSM6DS3TR-C实现高效运动检测与数据采集(1)----获取ID
xh1479的博客
05-28 1万+
本文将介绍如何驱动和利用LSM6DS3TR-C传感器，实现精确的运动感应功能。LSM6DS3TR-C是一款先进的6轴惯性测量单元（IMU），集成了三轴加速度计和三轴陀螺仪，可用于测量和检测设备的加速度、姿态和运动。 本文将提供LSM6DS3TR-C的基本介绍，包括其技术规格和主要特性。接下来，我们将详细讨论如何驱动LSM6DS3TR-C传感器，包括硬件连接和软件配置。我们将介绍常见的驱动方法和库，以帮助读者快速上手并实现基本的运动感应功能。
CAN协议解析
热门推荐
xh1479的博客
10-13 5万+
CAN能够使用多种物理介质作为通信媒介，最常用的是双绞线，还可以使用光纤等材料。CAN总线信号通过两条差分电压信号线CAN_ H和CAN_ L传输，当CAN_ H和CANL信号线上的电压值处于2. 5V左右时表明此时总线处于我们所谓的逻辑电平“1”的状态，也可以称做隐性状态;当CAN_ H比CAN_ L上电压值高时表示逻辑“0”，通常该状态下两条信号线上的电压值为CAN_ H=3. 5V和CAN_ L=1. 5V，此时是显性状态。下图是双绞线CAN总线电平标称值，图中显示了逻辑高电平和逻辑低电平所对应的大
STM32CUBEIDE（14）----外部中断EXTI
xh1479的博客
10-01 5万+
外部中断和事件控制器 (EXTI) 管理外部和内部异步事件 / 中断，并生成相应的事件请求到CPU/ 中断控制器和到电源管理的唤醒请求。本例程主要讲解如何使用外部中断触发LED。
GD32F303固件库开发（15）----外部中断EXTI
xh1479的博客
10-07 5万+
本章配置GD32F303使用EXTI进行驱动LED。
GD32F303固件库开发（16）----移植兆易创新SPI Nor Flash之GD25Q64Flash
xh1479的博客
10-09 4万+
移植兆易创新SPI Nor Flash之GD25Q64Flash
STM32CUBEMX开发GD32F303（15）----外部中断EXTI
xh1479的博客
10-07 4万+
本章STM32CUBEMX配置STM32F103，并且在GD32F303中进行开发，同时通过开发板内进行验证。使用外部中断EXTI进行驱动LED。
STM32CUBEIDE（15）----移植兆易创新SPI Nor Flash之GD25Q64Flash
xh1479的博客
10-07 4万+
SPI是串行外设接口（Serial Peripheral Interface）的缩写，是一种高速的，全双工，同步的通信总线，并且在芯片的管脚上只占用四根线，节约了芯片的管脚，同时为PCB的布局上节省空间，提供方便，正是出于这种简单易用的特性，越来越多的芯片集成了这种通信协议，比如 EEPROM，FLASH，实时时钟，AD转换器。 W25Q64 是一款SPI接口的Flash芯片，其存储空间为 64Mbit，相当于8M字节。W25Q64可以支持 SPI 的模式 0 和模式 3，也就是 CPOL=0/CPHA=0
驱动lsm6ds3tr-c实现高效运动检测与数据采集
12-15
LSM6DS3TR-C是一种集成了加速度计和陀螺仪功能的传感器芯片，可以用于实现运动检测和数据采集。为了实现高效的运动检测，我们可以采取以下措施： 首先，我们需要配置传感器的寄存器以适应我们的要求。我们可以使用芯片手册提供的配置寄存器的详细信息来设置传感器的采样率、灵敏度等参数。通过设置适当的参数，我们可以提高运动检测的准确性和灵敏度。 其次，为了高效地进行数据采集，我们可以使用中断机制来触发数据采集的操作。传感器芯片支持外部中断引脚，我们可以将其连接到微控制器或处理器的中断引脚上。当传感器检测到运动或达到预设的数据阈值时，会触发中断，然后我们的程序可以立即进行相应的数据采集操作，而无需轮询传感器。 此外，我们还可以利用传感器芯片提供的FIFO（First In First Out）缓冲区来存储传感器数据。FIFO缓冲区可以在传感器运动数据的采样过程中，按先进先出的原则存储数据。这样，我们可以在传感器检测到运动后立即进行数据采集，并且可以在适当的时候通过读取FIFO缓冲区中的数据来进行后续的处理和分析。 最后，为了实现高效的数据采集和处理，我们可以利用传感器芯片提供的SPI或I2C接口与微控制器或处理器进行通信。通过使用这些接口，我们可以快速地将传感器数据传输到微控制器或处理器，并进行实时的数据处理和分析。 综上所述，驱动LSM6DS3TR-C实现高效运动检测与数据采集的关键在于合理配置传感器参数、利用中断机制触发数据采集、利用FIFO缓冲区存储数据以及利用SPI或I2C接口进行高速数据传输和处理。通过这些措施，我们可以有效地实现高效运动检测和数据采集的功能。

“相关推荐”对你有帮助么？

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

记帖

你的鼓励将是我创作的最大动力

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付：¥1
获取中
扫码支付

您的余额不足，请更换扫码支付或充值

打赏作者

实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

1.余额是钱包充值的虚拟货币，按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载，可以购买VIP、付费专栏及课程。

余额充值