陀螺仪LSM6DSV16X与AI集成(9)----中断获取FIFO数据并应用MotionFX库解析空间坐标

已于 2024-07-18 10:04:50 修改
阅读量1.1w 收藏 22
点赞数 36
分类专栏： 传感器 stm32cube 单片机 文章标签： stm32cubemx MotionFX LSM6DSV16X 陀螺仪 fifo 欧拉角 四元素
于 2024-06-28 00:20:02 首次发布
本文链接：https://blog.csdn.net/qq_24312945/article/details/140027929
版权
单片机 同时被 3 个专栏收录
266 篇文章 160 订阅
订阅专栏
stm32cube
146 篇文章 61 订阅
订阅专栏
传感器
102 篇文章 3 订阅
订阅专栏

陀螺仪LSM6DSV16X与AI集成.9--中断获取FIFO数据并应用MotionFX库解析空间坐标

概述

本文将探讨如何使用中断机制获取FIFO数据并应用MotionFX库解析空间坐标。MotionFX库是一种用于传感器融合的强大工具，可以将加速度计、陀螺仪和磁力计的数据融合在一起，实现精确的姿态和位置估计。本文将介绍如何初始化和配置MotionFX库，使用中断机制读取FIFO中的传感器数据。FIFO可以作为数据缓冲区，存储传感器的临时数据，防止数据丢失，特别是在处理器忙于其他任务时。本文将利用这些数据进行空间坐标的解析。本章案例基于上节的demo进行修改。
需要样片的可以加群申请：615061293 。

在这里插入图片描述

视频教学

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

陀螺仪LSM6DSV16X与AI集成(9)----中断获取FIFO数据并应用MotionFX库解析空间坐标

样品申请

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

源码下载

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

开启LED

配置PB14为输出模式。

在这里插入图片描述

在这里插入图片描述

开启INT中断

陀螺仪LSM6DSV16X的中断管脚接到了PA6，需要将PA6设置为中端口。

在这里插入图片描述

在这里插入图片描述

开启中断。

在这里插入图片描述

参考驱动程序

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

复位 FIFO

  1. 设置 FIFO 进入 Bypass 模式：将 FIFO_CTRL4 寄存器的 FIFO_MODE 位设置为 000。
  2. 将 FIFO 重新设置为所需模式：在复位命令之后，可以通过将 FIFO_CTRL4 寄存器的 FIFO_MODE 位设置为所需的模式（例如 001 表示 FIFO 模式）。

在这里插入图片描述

	lsm6dsv16x_fifo_mode_set(&dev_ctx, LSM6DSV16X_BYPASS_MODE);
	HAL_Delay(10);

添加到设置FIFO开启之前。

在这里插入图片描述

中断读取传感器数据

为了使用回调函数并获取FIFO中的数据，在main.c定义了以下变量。

/* USER CODE END 0 */
stmdev_ctx_t dev_ctx;
lsm6dsv16x_fifo_status_t fifo_status;

/// 用于存储FIFO中读取的数据，每条数据包含7个字节（1个标签字节和6个数据字节）
uint8_t fifo_data[FIFO_WATERMARK*2][7];
// FIFO中当前存储的数据数量
uint16_t fifo_num = 0;
// FIFO中断标志，用于标记是否有新的FIFO数据可供读取
uint8_t fifo_flag=0;

/* USER CODE END 0 */

mian.c中开启中断。

  lsm6dsv16x_pin_int_route_t pin_int;
	lsm6dsv16x_pin_int1_route_get(&dev_ctx, &pin_int);
  pin_int.fifo_th = PROPERTY_ENABLE;
  lsm6dsv16x_pin_int1_route_set(&dev_ctx, &pin_int);

在stm32h5xx_it.c中添加回调函数引用。

/* USER CODE BEGIN 0 */
extern void HAL_GPIO_EXTI_Callback(uint16_t GPIO_Pin);


/* USER CODE END 0 */

处理PA6外部中断线6（EXTI Line6）的中断。

/**
  * @brief This function handles EXTI Line6 interrupt.
  */
void EXTI6_IRQHandler(void)
{
  /* USER CODE BEGIN EXTI6_IRQn 0 */

HAL_GPIO_EXTI_Callback(GPIO_PIN_6);
	
  /* USER CODE END EXTI6_IRQn 0 */
  HAL_GPIO_EXTI_IRQHandler(GPIO_PIN_6);
  /* USER CODE BEGIN EXTI6_IRQn 1 */

  /* USER CODE END EXTI6_IRQn 1 */
}

在main.c中添加回调函数的定义，检查中断是否由 GPIO_PIN_6 引脚触发，每次发生中断时从传感器获取当前的FIFO状态，并存储在 fifo_status 变量中。读取FIFO数据，并将这些数据存储在一个全局数组 fifo_data 中，以便在主循环或其他地方进行处理。通过切换 LED 的状态，可以直观地了解中断的发生。

/* USER CODE BEGIN 4 */
void HAL_GPIO_EXTI_Callback(uint16_t GPIO_Pin){
	
	if(GPIO_Pin == GPIO_PIN_6)
	{
		HAL_GPIO_TogglePin(LED1_GPIO_Port, LED1_Pin);
		lsm6dsv16x_fifo_status_get(&dev_ctx, &fifo_status);
		uint16_t num = 0;
    if (fifo_status.fifo_th == 1) {
			fifo_flag=1;
      num = fifo_status.fifo_level;
			fifo_num=num;
//      printf( "-- FIFO num %d \r\n", num);	
			uint16_t num_i;
      for(int i=0;i<num;i++)  {
        lsm6dsv16x_fifo_out_raw_t f_data;

        /* Read FIFO sensor value */
        lsm6dsv16x_fifo_out_raw_get(&dev_ctx, &f_data);
				
				fifo_data[i][0]=f_data.tag;
				fifo_data[i][1]=f_data.data[0];
				fifo_data[i][2]=f_data.data[1];
				fifo_data[i][3]=f_data.data[2];
				fifo_data[i][4]=f_data.data[3];
				fifo_data[i][5]=f_data.data[4];
				fifo_data[i][6]=f_data.data[5];				

//				printf("data[0]=%d,data[1]=%d,data[2]=%d,data[3]=%d,data[4]=%d,data[5]=%d,data[6]=%d\n",
//				fifo_data[i][0],
//				fifo_data[i][1],fifo_data[i][2],fifo_data[i][3],fifo_data[i][4],fifo_data[i][5],fifo_data[i][6]);
				
      }	
		}	
	
	}
}
/* USER CODE END 4 */

主程序

在主循环中检查FIFO中断标志，如果有新的FIFO数据，则读取并处理这些数据。处理完成后，调用MotionFX库函数进行数据融合计算，以获得传感器的姿态和位置。

  /* Infinite loop */
  /* USER CODE BEGIN WHILE */
  while (1)
  {	
	if(fifo_flag)// 如果 FIFO 中断标志被设置
	{
		uint8_t acc_flag=0,gyr_flag=0;//加速度角速度标志位
		uint8_t deltatime_flag=0;//时间标志位
		for(int i=0;i<fifo_num;i++)// 遍历 FIFO 数据数组
		{
			// 获取数据指针
			datax = (int16_t *)&fifo_data[i][1];
			datay = (int16_t *)&fifo_data[i][3];
			dataz = (int16_t *)&fifo_data[i][5];
			ts = (int32_t *)&fifo_data[i][1];
			// 根据数据标签处理不同类型的数据
			switch (fifo_data[i][0]) {
        case LSM6DSV16X_XL_NC_TAG:// 加速度数据
					acc_flag=1;
					acc_x=lsm6dsv16x_from_fs4_to_mg(*datax);
					acc_y=lsm6dsv16x_from_fs4_to_mg(*datay);
					acc_z=lsm6dsv16x_from_fs4_to_mg(*dataz);				
          break;
        case LSM6DSV16X_GY_NC_TAG:// 角速度数据
					gyr_flag=1;
					gyr_x=lsm6dsv16x_from_fs4000_to_mdps(*datax);
					gyr_y=lsm6dsv16x_from_fs4000_to_mdps(*datay);
					gyr_z=lsm6dsv16x_from_fs4000_to_mdps(*dataz);					
          break;				
        case LSM6DSV16X_TIMESTAMP_TAG:// 时间戳数据
					deltatime_flag=1;
					if(deltatime_first==0)//第一次
					{
						deltatime_1=*ts;
						deltatime_2=deltatime_1;
						deltatime_first=1;
					}
					else
					{
						deltatime_2=*ts;
					}				
          break;
        default:
          break;				
			}
			// 如果加速度、角速度和时间戳数据都已获取
			if(acc_flag&&gyr_flag&&deltatime_flag)
			{
				lsm6dsv16x_motion_fx_determin();// 调用 MotionFX 处理函数
				acc_flag=0;
				gyr_flag=0;
				deltatime_flag=0;
				deltatime_1=deltatime_2;	// 更新时间戳		
			}			
		}
		// 清除 FIFO 标志和数据量
		fifo_flag=0;
		fifo_num=0;
		}	
//			HAL_Delay(10);
		
    /* USER CODE END WHILE */

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

演示

初始位置和数据输出如下所示。
在这里插入图片描述

在这里插入图片描述

逆时针旋转90°

在这里插入图片描述

在这里插入图片描述

逆时针旋转180°

在这里插入图片描述
在这里插入图片描述
逆时针旋转270°

在这里插入图片描述

在这里插入图片描述

记帖
关注
专栏目录
陀螺仪LSM6DSV16X与AI集成(7)-FIFO数据读取与配置
06-23
陀螺仪LSM6DSV16X与AI集成(7)----FIFO数据读取与配置 CSDN文字教程：https://blog.csdn.net/qq_24312945/article/details/139890938 B站教学视频：https://www.bilibili.com/video/BV12s421T73k/ LSM6DSV16X是一款高性能、低功耗的6轴IMU传感器，集成了3轴加速度计和3轴陀螺仪。本文将详细介绍如何配置和读取LSM6DSV16X传感器的FIFO数据，包括初始化、配置以及数据处理的完整流程， 以实现数据的批量处理和传输，减少系统功耗，提高应用的响应速度和数据处理效率。 主要内容 初始化LSM6DSV16X传感器并检查其设备ID 恢复传感器默认配置并设置必要的参数 配置FIFO模式和水印阈值 设置加速度计和陀螺仪的数据速率 连续读取FIFO中的传感器数据并解析输出 LSM6DSV16X传感器包含一个FIFO缓冲区，能够存储不同类型的数据，以节省系统功耗。主处理器不需要连续轮询传感器数据，而是可以在需要时唤醒并从FIFO中读取重要数据 。
motionFX ST意法半导体X-MEMS运动融合库
xbw3336661的博客
04-10 510
校准流程：MotionFX_MagCal_init、MotionFX_MagCal_run，直到当isCalibration=True时，可以存下来。欧拉角是NED坐标系（可以在motionFX库中设置坐标系output_type: 0:NED 1:ENU）初始化、磁力校准( osx_MotionFX_compass_Init )、设置各旋钮（knobs）start_automatic_gbias_cal: 自动计算阈值，需保持静止。xxxx_th_sc_6X:静止检测阈值 默认就好。
陀螺仪LSM6DSOW开发(7)----融合磁力计进行姿态解算
xh1479的博客
08-02 4404
MotionFX库包含用于校准陀螺仪、加速度计和磁力计传感器的例程。将磁力计的数据与加速度计和陀螺仪的数据融合，可以大幅提高姿态估计的精度。三轴加速度计提供设备的倾斜信息，陀螺仪提供角速度信息，而磁力计提供方位信息，三者结合可以提供更加准确和稳定的三维方向和姿态信息。
I2C 读取6D lsm6dsv加速度，角速度和温度
SWTSWT520的博客
08-27 623
表示。表示。通信上的RX和TX代表的意思：TXD 发送数据 Transmit(tx) Data 的简写形式RXD 接收数据 Receive(rx) Data 的简写形式2.platform_write 和I2C_WriteData 关系。platform_read和 I2C_ReadData关系：return 0;return 0;0x6areglenbufphandleregbufplen/**@brief TWI(I2C)读数据函数。
驱动LSM6DS3TR-C实现高效运动检测与数据采集(10)----融合磁力计进行姿态解算
xh1479的博客
07-21 9349
MotionFX库包含用于校准陀螺仪、加速度计和磁力计传感器的例程。将磁力计的数据与加速度计和陀螺仪的数据融合，可以大幅提高姿态估计的精度。三轴加速度计提供设备的倾斜信息，陀螺仪提供角速度信息，而磁力计提供方位信息，三者结合可以提供更加准确和稳定的三维方向和姿态信息。
en.DM00394369——motionFX.pdf
11-21
MotionFX 是 X-CUBE-MEMS1 软件的中间件库组件，可在 STM32 上运行。 它可提供实时运动传感器数据融合。它还执行陀螺仪偏差和磁力计硬铁校准。该算法以静态库格式提供，旨在用于基于 ARM® Cortex®-M4 架构的 STM32 微控制器。它以 STM32Cube 软件技术为基础而构建，便于在不同 STM32 微控制器之间移植。该 软 件 附 带 了 NUCLEO-F401RE 或 NUCLEO-L476RG 开 发 板 上 的 X-NUCLEO-IKS01A1 （ 可 选STEVAL-MKI160V1）或 X-NUCLEO-IKS01A2 扩展板上运行的示例实现。
陀螺仪LSM6DSV16X与AI集成(9)-中断获取FIFO数据并应用MotionFX库解析空间坐标
06-28
陀螺仪LSM6DSV16X与AI集成(8)----中断获取FIFO数据并应用MotionFX库解析空间坐标 CSDN文字教程：https://blog.csdn.net/qq_24312945/article/details/140027929 B站教学视频：...
陀螺仪LSM6DSV16X与AI集成(8)-MotionFX库解析空间坐标
06-24
陀螺仪LSM6DSV16X与AI集成(8)----MotionFX库解析空间坐标 CSDN文字教程：https://blog.csdn.net/qq_24312945/article/details/139908547 B站教学视频：https://www.bilibili.com/video/BV1ux4y1t7RS/ 本文将探讨如何...
驱动LSM6DS3TR-C实现高效运动检测与数据采集(8)-中断获取FIFO数据并应用MotionFX库解析空间坐标
07-13
驱动LSM6DS3TR-C实现高效运动检测与数据采集(8)----中断获取FIFO数据并应用MotionFX库解析空间坐标 CSDN文字教程：https://blog.csdn.net/qq_24312945/article/details/140391736 B站教学视频：...
陀螺仪LSM6DSV16X与AI集成(11)-融合磁力计进行姿态解算
最新发布
08-27
陀螺仪LSM6DSV16X与AI集成(11)----融合磁力计进行姿态解算 CSDN文字教程：https://blog.csdn.net/qq_24312945/article/details/141576430 B站教学视频：https://www.bilibili.com/video/BV1oTsJeTErb/ MotionFX库...
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 5万+
移植兆易创新SPI Nor Flash之GD25Q64Flash
STM32CUBEMX开发GD32F303（15）----外部中断EXTI
xh1479的博客
10-07 5万+
本章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
STM32CUBEMX开发GD32F303（16）----移植兆易创新SPI Nor Flash之GD25Q64Flash
xh1479的博客
10-07 4万+
STM32CUBEMX开发GD32F303（16）----移植兆易创新SPI Nor Flash之GD25Q64Flash
GD32F303固件库开发
xh1479的博客
11-02 4万+
GD32F303固件库开发
STM32CUBEIDE----配置输出串口中文和文本大小
xh1479的博客
10-22 4万+
关于STM32CUBEIDE无法通过串口打印中文字符，需要更改编码配置。点击proiect->Properties编码格式输入GMK。此时就可以正确输出中文字符。
评论
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

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

打赏作者

记帖

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

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

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

打赏作者

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

抵扣说明：

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

余额充值