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

news2024/9/20 16:43:43

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

  • 概述
  • 视频教学
  • 样品申请
  • 源码下载
  • 生成STM32CUBEMX
  • 串口配置
  • IIC配置
  • CS和SA0设置
  • 串口重定向
  • 参考程序
  • 初始换管脚
  • 获取ID
  • 复位操作
  • BDU设置
  • 6D方向检测功能配置
  • 选择滤波和角度阈值
  • 设置量程和速率
  • 获取所有中断源的状态
  • 发送相应信息
  • 演示

概述

陀螺仪通常可以读取三个方向上的旋转，即绕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#

源码下载

生成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 */

演示

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

本文来自互联网用户投稿，该文观点仅代表作者本人，不代表本站立场。本站仅提供信息存储空间服务，不拥有所有权，不承担相关法律责任。如若转载，请注明出处：http://www.coloradmin.cn/o/1367572.html

如若内容造成侵权/违法违规/事实不符，请联系多彩编程网进行投诉反馈，一经查实，立即删除！

相关文章

计算机基础面试题 |18.精选计算机基础面试题

计算机基础面试题 |18.精选计算机基础面试题

&#x1f90d; 前端开发工程师&#xff08;主业&#xff09;、技术博主&#xff08;副业&#xff09;、已过CET6 &#x1f368; 阿珊和她的猫_CSDN个人主页 &#x1f560; 牛客高级专题作者、在牛客打造高质量专栏《前端面试必备》 &#x1f35a; 蓝桥云课签约作者、已在蓝桥云…
阅读更多...
大数据StarRocks(六) ：Catalog

大数据StarRocks(六) ：Catalog

StarRocks 自 2.3 版本起支持 Catalog&#xff08;数据目录&#xff09;功能&#xff0c;实现在一套系统内同时维护内、外部数据&#xff0c;方便您轻松访问并查询存储在各类外部源的数据。 1. 基本概念 内部数据&#xff1a;指保存在 StarRocks 中的数据。 外部数据&#xf…
阅读更多...
【QML COOK】- 003-处理鼠标事件

【QML COOK】- 003-处理鼠标事件

1. 编辑main.qml import QtQuickWindow {width: 800height: 800visible: truetitle: qsTr("Hello World")Image {id: backgroudanchors.fill: parentsource: "qrc:/Resources/Images/arrow.png"}MouseArea {anchors.fill: parentonClicked: backgroud.rot…
阅读更多...
Python(30)：非对称加密算法RSA的使用(openssl生成RSA公私钥对)

Python(30)：非对称加密算法RSA的使用(openssl生成RSA公私钥对)

Python(30)&#xff1a;非对称加密算法RSA的使用(openssl生成RSA公私钥对) 1、openssl生成RSA公私钥对 1.1、生成RSA公私钥对命令 [rootloaclhost ~]# openssl OpenSSL> genrsa -out rsa_private_key.pem 1024 Generating RSA private key, 1024 bit long modulus .. ...…
阅读更多...
微服务概述之单体架构

微服务概述之单体架构

微服务概述 互联网始于 1969年美国的阿帕网&#xff08;ARPA&#xff09;&#xff0c;最开始的阿帕网只在美国军方使用。随着时间的推移&#xff0c;一些大学也开始加入建设&#xff0c;慢慢演化成了现在的因特网 &#xff08;Internet&#xff09;。随着计算机网络的普及&…
阅读更多...
图像融合论文阅读：CrossFuse: 一种基于交叉注意机制的红外与可见光图像融合方法

图像融合论文阅读：CrossFuse: 一种基于交叉注意机制的红外与可见光图像融合方法

article{li2024crossfuse, title{CrossFuse: A novel cross attention mechanism based infrared and visible image fusion approach}, author{Li, Hui and Wu, Xiao-Jun}, journal{Information Fusion}, volume{103}, pages{102147}, year{2024}, publisher{Elsevier} } 论文…
阅读更多...
1.1map

1.1map

unordered_map和map的使用几乎是一致的&#xff0c;只是头文件和定义不同 #include<iostream> #include<map>//使用map需要的头文件 #include<unordered_map>//使用unordered_map需要的头文件 #include<set>//使用set需要的头文件 #include<uno…
阅读更多...
用通俗易懂的方式讲解：如何提升大模型 Agent 的能力?

用通俗易懂的方式讲解：如何提升大模型 Agent 的能力?

大型语言模型&#xff08;LLM&#xff09;的出现带火了Agent。利用LLM理解人类意图、生成复杂计划并且能够自主行动的能力。Agent具有无与伦比的能力&#xff0c;能够做出类似于人类复杂性的决策和完成一些复杂的工作。 目前市面上已经出现非常多得Agent框架&#xff1a;XAgen…
阅读更多...
如何使用PR制作抖音视频？抖音短视频创作素材剪辑模板PR项目工程文件

如何使用PR制作抖音视频？抖音短视频创作素材剪辑模板PR项目工程文件

如何使用PR软件制作抖音视频作品&#xff1f;Premiere Pro 抖音短视频创作素材剪辑模板PR项目工程文件。 3种分辨率&#xff1a;10801920、10801350、10801080。 来自PR模板网&#xff1a;https://prmuban.com/37058.html
阅读更多...
双向逆变器流程

双向逆变器流程

逆变过程 反向充电过程 首先AC整流&#xff0c;然后经过LLC电路进行DC-DC转换&#xff0c;这样就可以给电池充电了。也就是市电通过上面的电路就可以存储到电池里面。能量存储到电池里面&#xff0c;后面需要用的时候&#xff0c;也可以通过一定电路把能量释放出来。这就是逆变…
阅读更多...
20240107让Firefly的AIO-3399J开发板的Android11下配置为默认1080p录像

20240107让Firefly的AIO-3399J开发板的Android11下配置为默认1080p录像

20240107让Firefly的AIO-3399J开发板的Android11下配置为默认1080p录像 2024/1/7 23:01 开发板&#xff1a;Firefly的AIO-3399J【RK3399】 SDK&#xff1a;rk3399-android-11-r20211216.tar.xz【Android11】 Android11.0.tar.bz2.aa【ToyBrick】 Android11.0.tar.bz2.ab Androi…
阅读更多...
江科大-stm32-B站系统初识笔记P2

江科大-stm32-B站系统初识笔记P2

文章目录 一&#xff1a;ARM是什么二&#xff1a;关键字介绍 推荐视频&#xff1a;《 STM32入门教程-2023版 细致讲解 中文字幕》 一&#xff1a;ARM是什么 ①&#xff1a; ST – 意法半导体 M – Microelectronics 微电子 32 – 总线宽度 ARM架构: Cortex-A:Application 应用…
阅读更多...
linux常见操作,and一些练习题加线上练习网站，无须配置linux.持续更新中。。。。

linux常见操作,and一些练习题加线上练习网站，无须配置linux.持续更新中。。。。

文章目录 cd命令相对路径特殊的路径表达符和cd一起使用pwdmore 查看文件内容支持翻页小技巧clear用户&#xff0c;用户权限 and 用户的切换如何创建用户 ls和通配符的使用利用通配符 *grep 过滤管道符 |如何学习Linux在线练习网站 https://www.lanqiao.cn/courses/1 cd命令 cd…
阅读更多...
TrueNAS数据共享——SMB共享日志审计

TrueNAS数据共享——SMB共享日志审计

日志审计对于事后溯源十分重要&#xff0c;所以使用TrueNAS共享时&#xff0c;开启Samba audit审计日志功能很有必要。Full_Audit 允许记录共享上的所有操作&#xff0c;如创建文件、删除文件、更改路径… 一、编辑SMB服务 1、进入smb服务编辑 服务--找到SMB--动作--高级选项…
阅读更多...
Notepad++ v7.7.1 安装及添加插件

Notepad++ v7.7.1 安装及添加插件

1、notepad_v7.7.1.zip npp.7.7.1.Installer.x64.exe npp.7.7.1.Installer.x86.exe notepad_v7.7.1.ziphttps://www.123pan.com/s/VTMXjv-X6H6v.html 2、notepad插件包_64bit_4.zip ComparePlugin ---->文件对比插件 ComparePlugin.dllNppFTP ---->FTP、FTPES和SFTP …
阅读更多...
python自动化运维管理拓扑

python自动化运维管理拓扑

目录 1、简介 2、实验环境 3、拓扑图 4、需求及其代码 4.1、测试连通性 4.2、远程登陆 4.3、配置loopback 4.4、监控内存使用率 4.5、自动化巡检内存使用率 4.6、自动化配置snmp服务 4.7、提取分析字符串 &#x1f343;作者介绍&#xff1a;双非本科大三网络工程专业…
阅读更多...
记一次生产事故排查

记一次生产事故排查

背景&#xff1a;刚接手一个新工程&#xff0c;是一个给国内top级医院开发的老项目&#xff0c;因为历史原因&#xff0c;代码质量略低&#xff0c;测试难度略高。 上线很久的功能&#xff0c;最近一直频繁的爆发各种问题&#xff0c;经排查发现都是因为在业务过程中im聊天账号…
阅读更多...
Hyperledger Fabric 生成组织身份解析

Hyperledger Fabric 生成组织身份解析

fabric 版本 2.4.1 Fabric 网络通过证书和密钥来管理和认证成员身份&#xff0c;经常需要生成证书文件。通常这些操作可以使用 PKI 服务&#xff08;如 Fabric-CA&#xff09;或者 OpenSSL 工具来实现&#xff08;针对单个证书的签发&#xff09;。为了方便批量管理组织证书&am…
阅读更多...
网页设计工作室网站Web前端制作个人网页(html+css+javascript)网页设计网站模板采用DIV CSS布局制作，网页作品有多个页面

网页设计工作室网站Web前端制作个人网页(html+css+javascript)网页设计网站模板采用DIV CSS布局制作，网页作品有多个页面

网页设计工作室网站Web前端制作个人网页(htmlcssjavascript)网页设计网站模板采用DIV CSS布局制作&#xff0c;网页作品有多个页面 【网页设计工作室网站Web前端制作个人网页(htmlcssjavascript)网页设计网站模板采用DIV CSS布局制作&#xff0c;网页作品有多个页面】 https://…
阅读更多...
赋能软件开发：生成式AI在优化编程工作流中的应用与前景

赋能软件开发：生成式AI在优化编程工作流中的应用与前景

随着人工智能&#xff08;AI&#xff09;技术的快速发展&#xff0c;特别是生成式AI模型如GPT-3/4的出现&#xff0c;软件开发行业正经历一场变革&#xff0c;这些模型通过提供代码生成、自动化测试和错误检测等功能&#xff0c;极大地提高了开发效率和软件质量。 本文旨在深入…
阅读更多...
推荐文章
最新文章

Copyright @ 2022~2023