陀螺仪LSM6DSV16X与AI集成(5)----6D方向检测功能

107 篇文章 56 订阅
63 篇文章 3 订阅

概述

陀螺仪通常可以读取三个方向上的旋转,即绕X轴、Y轴和Z轴的旋转。每个方向上的旋转包括正向旋转和反向旋转,因此一共有六个位置。这六个位置分别是:1.X轴正向旋转、2.X轴反向旋转、3.Y轴正向旋转、4.Y轴反向旋转、5.Z轴正向旋转、6.Z轴反向旋转
通过检测陀螺仪在每个方向上的旋转,可以确定物体的旋转姿态和方向,从而用于导航、飞行控制等应用。

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

在这里插入图片描述

视频教学

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

陀螺仪LSM6DSV16X与AI集成(5)----6D方向检测功能

样品申请

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

源码下载

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

生成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);

6D方向检测功能配置

1.使能六维位置检测功能,配置陀螺仪模块的中断引脚,使得当六维传感器检测到某种运动时,能够通过中断方式通知主控制器。
可以通过使能MD1_CFG (5Eh)中的INT1_6D开启6D事件。
在这里插入图片描述
在这里插入图片描述

pin_int.sixd = PROPERTY_ENABLE;
lsm6dsv16x_pin_int1_route_set(&dev_ctx, &pin_int);

2.使能中断,将中断配置应用到LSM6DSV16X模块上。
FUNCTIONS_ENABLE (50h)可以开启6D中断。

在这里插入图片描述

在 LSM6DSV16X 传感器的 TAP_CFG0 (56h) 寄存器中,LIR(Latched Interrupt Request)位用于控制中断请求的锁存。如果将 LIR 设为 0(默认值),则表示中断请求不锁存;如果设为 1,则中断请求被锁存。锁存中断意味着一旦中断被触发,它会保持其激活状态直到被明确地通过软件读取或清除。这通常用于确保不会错过任何中断事件,特别是在多任务环境中,其中一个中断可能会在处理另一个中断时发生。

在这里插入图片描述

irq.enable = 1;
irq.lir = 1;
lsm6dsv16x_interrupt_enable_set(&dev_ctx, irq);

选择滤波和角度阈值

滤波可以通过 TAP_CFG0 (56h) 设置低通滤波。

在这里插入图片描述

角度阈值可以通过 TAP_THS_6D (59h) 设置为60度,用于检测姿态变化。

在这里插入图片描述

设置滤波和角度阈值可用以下函数:

lsm6dsv16x_filt_sixd_feed_set(&dev_ctx, LSM6DSV16X_SIXD_FEED_LOW_PASS);
lsm6dsv16x_6d_threshold_set(&dev_ctx, LSM6DSV16X_DEG_60);

设置量程和速率

速率可以通过CTRL1 (10h)设置加速度速率。

在这里插入图片描述

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

在这里插入图片描述
设置加速度的量程和速率可以使用如下函数。

/* Set Output Data Rate.*/
  lsm6dsv16x_xl_data_rate_set(&dev_ctx, LSM6DSV16X_ODR_AT_120Hz);
  /* Set full scale */
  lsm6dsv16x_xl_full_scale_set(&dev_ctx, LSM6DSV16X_2g);

获取所有中断源的状态

判断是否发生了六维传感器事件,如果有发生,则将不同方向的事件标志位按位组合起来,其中包括了传感器的各种状态,比如 FIFO 状态、自由落体、唤醒、六维方向、数据就绪等状态。然后通过一系列的操作和寄存器读写,获取嵌入式功能执行状态、传感器中枢状态等信息,并将这些信息也保存,最后将这些信息返回给主控。这些数据可以通过以下寄存器进行设置。
ALL_INT_SRC (1Dh) 为所有中断的源寄存器,D6D_IA变量包含了自由落体状态的信息。

在这里插入图片描述

在这里插入图片描述

D6D_SRC (47h) 用于六维方向识别,该寄存器包含了用于检测设备方向的相关信息。
每个位都对应一个方向,用于表示设备是否在相应的方向上运动。例如,如果XH位和YL位都被置位,则表示设备正在以X轴正方向向上运动,并且Y轴负方向朝下。通过读取D6D_SRC寄存器的值,可以了解设备当前的运动方向,从而进行相应的处理。LSM6DSV16X传感器中的方向检测是基于重力加速度和线性加速度的,因此需要在使用之前进行校准和配置,以适应不同的应用场景。

在这里插入图片描述

通过 int32_t lsm6dsv16x_all_sources_get(stmdev_ctx_t *ctx, lsm6dsv16x_all_sources_t *val) 函数可以获取所有中断源的状态。

	lsm6dsv16x_all_sources_t status;

	/* Read output only if new xl value is available */
	lsm6dsv16x_all_sources_get(&dev_ctx, &status);

	if (status.six_d) {
			sixd_event_catched = (status.six_d    << 6) |
								 (status.six_d_zh << 5) |
								 (status.six_d_zl << 4) |
								 (status.six_d_yh << 3) |
								 (status.six_d_yl << 2) |
							 	 (status.six_d_xh << 1) |
								 (status.six_d_xl << 0);
		}

发送相应信息

检查sixd_event_catched的第7位是否为1,如果第7位为1,表示检测到了六维传感器事件。
根据sixd_event_catched的具体数值,通过switch语句匹配不同的情况。每个情况对应着不同的六维传感器位置,并且针对每种情况都会生成相应的消息并调用tx_com函数发送消息。
最后,在处理完六维传感器事件后,将sixd_event_catched重置为0,以便下一次事件的检测。

  /* Infinite loop */
  /* USER CODE BEGIN WHILE */
  while (1)
  {
		/* wait forever (6D event handle in irq handler) */
		lsm6dsv16x_all_sources_t status;

		/* Read output only if new xl value is available */
		lsm6dsv16x_all_sources_get(&dev_ctx, &status);
		
		if (status.six_d) {
			sixd_event_catched = (status.six_d    << 6) |
													 (status.six_d_zh << 5) |
													 (status.six_d_zl << 4) |
													 (status.six_d_yh << 3) |
													 (status.six_d_yl << 2) |
													 (status.six_d_xh << 1) |
													 (status.six_d_xl << 0);
		}
		if (sixd_event_catched & 0x40) {

      switch (sixd_event_catched) {
      case 0x48:
        printf("6D Position A Y↑\r\n");
        break;
      case 0x41:
        printf("6D Position B X↓\r\n");
        break;
      case 0x42:
        printf("6D Position C X↑\r\n");
        break;
      case 0x44:
        printf("6D Position D Y↓\r\n");
        break;
      case 0x60:
        printf("6D Position E Z↑\r\n");
        break;
      case 0x50:
        printf("6D Position F Z↓\r\n");
        break;
      }
      sixd_event_catched = 0;
		}

		
    /* USER CODE END WHILE */

    /* USER CODE BEGIN 3 */
  }
  /* USER CODE END 3 */

演示

在这里插入图片描述
在这里插入图片描述

  • 41
    点赞
  • 18
    收藏
    觉得还不错? 一键收藏
  • 打赏
    打赏
  • 1
    评论
本文档旨在提供与ST的LSM6DS3 iNEMO惯性模块相关的使用信息和应用提示。   LSM6DS3是一个三维数字加速度计和三维数字陀螺仪系统,具有数字I2C/SPI串行接口标准输出,在复合正常模式下以0.9毫安的速度运行,在复合高性能模式下以1.25毫安(高达1.6千赫)的速度运行。多亏了陀螺仪和加速计的超低噪声性能,该设备将始终处于低功耗状态的特性与卓越的传感精度结合起来,为消费者提供最佳的运动体验。此外,加速计具有智能睡眠唤醒(活动)和返回睡眠(不活动)功能,允许高级节能。     该装置的动态用户可选择的满标度加速度范围为±2/±4/±8/±16 g,角速率范围为±125/±245/±500/±1000/±2000 dps。   LSM6DS3可以配置为通过使用自由下落事件、6D定向、抽头和双抽头感应、活动或不活动、唤醒事件的硬件识别来生成中断信号。   外部传感器专用连接模式的可用性允许实现传感器集线器功能。   LSM6DS3兼容主流OSs的要求,提供真实、虚拟和批处理模式的传感器。它被设计成在硬件上实现重要的运动、倾斜、计步器功能、时间戳,并支持具有熨烫校正(硬、软)的外部磁强计的数据采集   LSM6DS3有一个集成的智能先进先出(FIFO)缓冲区,最大为8KB,允许动态批处理重要数据(即外部传感器、步进计数器、时间戳和温度)   LSM6DS3采用小型塑料地网阵列组件(LGA-14L)提供,保证在-40°C到+85°C的扩展温度范围内工作。   SMD产品包的超小尺寸和重量使其成为手持便携式应用的理想选择,如智能手机、物联网设备、可穿戴设备或任何其他需要减小产品包尺寸和重量的应用。
### 回答1: LSM6DS3TR是一款MEMS传感器,用于测量加速度和角速度。它与STM32微控制器结合使用,可以实现6D功能(也称为六轴姿态识别)。下面将详细介绍LSM6DS3TR-CSTM32驱动和6D功能实现。 首先,驱动是一个软件模块,用于与硬件设备进行通信和控制。需要利用STM32的I2C或SPI接口与LSM6DS3TR进行通信。驱动程序包括初始化配置、寄存器读写、传感器数据获取等功能。在STM32上编写使用合适协议的驱动程序可以与LSM6DS3TR进行适当的接口通信以获取传感器数据。 接下来是6D功能的实现。6D功能是指通过检测传感器的倾斜和方向来识别设备的姿态。LSM6DS3TR可以检测水平和垂直方向上的加速度值,并将其与设定的阈值进行比较。根据不同的方向和阈值设置,可以识别设备的姿态,例如正向、反向、横向、竖向等。 为了实现6D功能,首先需要配置LSM6DS3TR的控制寄存器。可以使用驱动程序将适当的配置命令发送到传感器,设置运行模式、阈值和方向等参数。然后传感器会开始采集数据并将其与阈值进行比较。如果检测到超过阈值的加速度变化,传感器会触发中断信号,可以通过STM32的中断机制进行处理。 在STM32上编写适当的中断处理程序,可以根据中断信号来判断设备的姿态,从而实现6D功能。中断处理程序可以读取传感器的状态寄存器,确定触发中断的原因,并根据相应的姿态进行相应的动作或控制。 总之,LSM6DS3TR-CSTM32驱动程序可用于与传感器进行通信和控制。通过适当的配置和中断处理,可以实现6D功能,识别设备的姿态。这为姿态识别和控制应用提供了很大的便利。 ### 回答2: LSM6DS3TR是一款集成了三轴加速度计和三轴陀螺仪的传感器,适用于许多应用领域,包括移动设备、虚拟现实和物联网等。CSTM32是一个针对STM32微控制器的开发环境。 要实现LSM6DS3TR传感器在CSTM32上的驱动和6D功能,需要按照以下步骤进行: 1. 准备硬件:连接LSM6DS3TR传感器到CSTM32,通过I2C或SPI接口进行通信。 2. 配置传感器寄存器:使用CSTM32的GPIO和I2C/SPI库函数,通过写入和读取传感器的寄存器来配置传感器的各种功能和参数。包括设置测量范围、采样率、滤波器设置等。 3. 读取加速度计和陀螺仪数据:使用CSTM32的I2C/SPI库函数,读取传感器的加速度计和陀螺仪数据。可以通过使用中断或定时器来定期读取数据。 4. 实现6D功能LSM6DS3TR传感器支持6D功能,即可以检测物体的方向变化。通过读取传感器的寄存器,判断传感器的方向变化,并触发相应的事件或执行相关操作。 5. 数据处理和应用:读取到的加速度计和陀螺仪数据可以在CSTM32上进行进一步的数据处理和应用。可以通过公式转换为物体的姿态角度、速度等信息,以实现具体的应用需求。 在以上步骤中,需要使用CSTM32的GPIO、I2C/SPI和中断/定时器等相关功能进行编程操作,同时需要了解LSM6DS3TR传感器的相关寄存器和功能。在实际开发中,也可以参考ST公司提供的相关的驱动代码和开发文档,以加快开发进度和提高开发效率。

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

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

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

打赏作者

记帖

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

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

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

打赏作者

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

抵扣说明:

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

余额充值