《DNK210 使用指南 -CanMV 版 V1.0》第二十二章 六轴传感器——原始数据读取实验

正点原子2024-10-24 18:40

第二十二章 六轴传感器------原始数据读取实验

本章将介绍板载六轴传感器的使用，结合前面章节介绍的machine.I2C类就能很方便地使用板载的六轴传感器。通过本章的学习，读者将学习到板载六轴传感器的基本使用。

本章分为如下几个小节：

22.1 SH3001驱动介绍及使用方法

22.2 硬件设计

22.3 程序设计

22.4 运行验证

22.1 SH3001驱动介绍及使用方法

SH3001是正点原子DNK210板载的六轴传感器芯片，是一款六轴IMU（Internal measurement unit，惯性从测量单元）。SH3001内部集成有三轴加速度计和三轴陀螺仪（角速度计），相较于多组件方案，免除了组合加速度计和陀螺仪时可能遇到的轴间差问题，并减小了体积和功耗。

SH3001内部集成有三轴加速度计和三轴陀螺仪，输出都是16位的数字量，可通过I2C接口与之进行数据交互。加速度计的测量范围最大可配置为±16g（g为重力加速度），静态测量精度高。陀螺仪的角速度测量范围最大可配置为±2000（dps），具有良好的动态相应特性。

SH3001的特点如下：

  1. 加速度计量程（g）：±2、±4、±8、±16

  2. 加速度计灵敏度（LSB/g）：16384、8192、4096、2048

  3. 陀螺仪量程（dps）：±125、±250、±500、±1000、±2000

  4. 陀螺仪灵敏度（LSB、dps）：262、131、65.5、32.8、16.4

  5. 封装：LGA14，2.5*3.0*0.9mm3

SH3001传感器的检测轴，如下图所示：

图22.1.1 SH3001检测轴方向

更多有关SH3001的芯片特性以及内部寄存器描述，请参考SH3001的数据手册------《SH3001.pdf》，读者可在A盘à硬件资料à芯片资料下找到这份文档。

为了方便读者使用正点原子DNK210开发板板载的这个SH3001六轴传感器芯片，正点原子团队为SH3001在正点原子DNK210开发板上的使用环境编写了sh3001.py这一SH3001驱动文件，sh3001.py可以在CanMV环境下使用。

sh3001.py驱动提供了SH3001的构造函数，用于创建一个SH3001对象，SH3001构造函数如下所示：

ini 复制代码 
class SH3001(i2c=None, attitude=False)

通过SH3001构造函数可以通过指定参数创建并初始化一个SH3001对象。

i2c指的是I2C对象，这个I2C对象需要先使用I2C的构造函数进行创建，有关I2C对象的介绍请看第二十章《machine.I2C类实验》。

attitude指的是是否在构造SH3001对象时初始化驱动自带的姿态解算功能，当attitude为True时，则在构造SH3001对象时初始化驱动自带的姿态解算功能，当attitude为False时，则在构造SH3001对象时不初始化驱动自带的姿态解算功能。

SH3001构造函数的使用示例如下所示：

javascript 复制代码 
from board import board_info
from fpioa_manager import fm
from machine import I2C
from sh3001 import SH3001

fm.register(board_info.IMU_SCL, fm.fpioa.I2C0_SCLK)
fm.register(board_info.IMU_SDA, fm.fpioa.I2C0_SDA)

i2c = I2C(I2C.I2C0, scl=board_info.IMU_SCL, sda=board_info.IMU_SDA)

sh3001 = SH3001(i2c)

从上面的示例中可以看到，从sh3001.py文件中导入了SH3001这个类，那么如何在应用脚本文件中导入另一个驱动文件中的类呢？在CanMV下非常简单，仅需使用CanMV IDE软件将需要被导入的驱动文件保存到CanMV任意文件系统的根目录下即可，具体的操作如下图所示：

图22.1.2 保存文件到CanMV文件系统

SH3001类为SH3001对象提供了acc_config()方法，用于配置SH3001对象的加速度计，acc_config()方法如下所示：

python 复制代码 
SH3001.acc_config(odr, range, freq, filter)

acc_config()方法用于配置SH3001对象的加速度计。

odr指的是SH3001对象加速度计的数据输出速率，可配置的参数以常量的形式保存在SH3001类中，可配置的值如下表所示：

表22.1.1 acc_config()中odr参数配置值描述

range指的是SH3001对象加速度计的量程，可配置的参数以常量的形式保存在SH3001类中，可配置的值如下表所示：

表22.1.2 acc_config()中range参数配置值描述

freq指的是SH3001对象加速度计低通滤波器的截至频率，可配置的参数以常量的形式保存在SH3001类中，可配置的参数如下表所示：

表22.1.3 acc_config()中freq参数配置值描述

filter指的是是否使能SH3001对象加速度计的低通滤波器，可配置的参数以常量的形式保存在SH3001类中，可配置的参数如下表所示：

表22.1.4 acc_config()中filter参数配置值描述

acc_config()方法的使用示例如下所示：

javascript 复制代码 
from board import board_info
from fpioa_manager import fm
from machine import I2C
from sh3001 import SH3001

fm.register(board_info.IMU_SCL, fm.fpioa.I2C0_SCLK)
fm.register(board_info.IMU_SDA, fm.fpioa.I2C0_SDA)

i2c = I2C(I2C.I2C0, scl=board_info.IMU_SCL, sda=board_info.IMU_SDA)

sh3001 = SH3001(i2c)
sh3001.acc_config(SH3001.ACC_ODR_500HZ, SH3001.ACC_RANGE_16G, 
SH3001.ACC_FREQ_ODRX025, SH3001.ACC_FILTER_ENABLE)

SH3001类为SH3001对象提供了get_acc()方法，用于获取SH3001对象的三轴加速度值，get_acc()方法如下所示：

scss 复制代码 
SH3001.get_acc()

get_acc()方法用于获取SH3001对象的三轴加速度值，获取到的值为板载SH3001芯片输出的数字量，需要结合acc_config()方法配置的加速度计量程才能加算出实际的加速度值。

get_acc()方法的使用示例如下所示：

javascript 复制代码 
from board import board_info
from fpioa_manager import fm
from machine import I2C
from sh3001 import SH3001

fm.register(board_info.IMU_SCL, fm.fpioa.I2C0_SCLK)
fm.register(board_info.IMU_SDA, fm.fpioa.I2C0_SDA)

i2c = I2C(I2C.I2C0, scl=board_info.IMU_SCL, sda=board_info.IMU_SDA)

sh3001 = SH3001(i2c)
sh3001.acc_config(SH3001.ACC_ODR_500HZ, SH3001.ACC_RANGE_16G, SH3001.ACC_FREQ_ODRX025,
 SH3001.ACC_FILTER_ENABLE)
ax, ay, az = sh3001.get_acc()

SH3001类为SH3001对象提供了gyro_config()方法，用于配置SH3001对象的陀螺仪，gyro_config()方法如下所示：

css 复制代码 
SH3001.gyro_config(odr, rangex, rangey, rangez, freq, filter)

gyro_config()方法用于配置SH3001对象的陀螺仪。

odr指的是SH3001对象陀螺仪的数据输出速率，可配置的参数以常量的形式保存在SH3001类中，可配置的值如下表所示：

表22.1.5 gyro_config()中odr参数配置值描述

rangex、rangey、rangez指的是SH3001对象陀螺仪X、Y、Z轴的量程，可配置的参数以常量的形式保存在SH3001类中，可配置的值如下表所示：

表22.1.6 gyro_config()中rangex、rangey、rangez参数配置值描述

freq指的是SH3001对象陀螺仪低通滤波器的截至频率，可配置的参数以常量的形式保存在SH3001类中，可配置的参数如下表所示：

表22.1.7 gyro_config()中freq参数配置值描述

filter指的是是否使能SH3001对象陀螺仪的低通滤波器，可配置的参数以常量的形式保存在SH3001类中，可配置的参数如下表所示：

表22.1.8 gyro_config()中filter参数配置值描述

gyro_config()方法的使用示例如下所示：

javascript 复制代码 
from board import board_info
from fpioa_manager import fm
from machine import I2C
from sh3001 import SH3001

fm.register(board_info.IMU_SCL, fm.fpioa.I2C0_SCLK)
fm.register(board_info.IMU_SDA, fm.fpioa.I2C0_SDA)

i2c = I2C(I2C.I2C0, scl=board_info.IMU_SCL, sda=board_info.IMU_SDA)

sh3001 = SH3001(i2c)
sh3001.gyro_config(SH3001.GYOR_ODR_500HZ, SH3001.GYRO_RANGE_2000DPS, 
SH3001.GYRO_RANGE_2000DPS, SH3001.GYRO_RANGE_2000DPS, SH3001.GYRO_FREQ_00,
 SH3001.GYRO_FILTER_ENABLE)

SH3001类为SH3001对象提供了get_gyro()方法，用于获取SH3001对象的三轴陀螺仪值，get_gyro()方法如下所示：

scss 复制代码 
SH3001.get_gyto()

get_gyto()方法用于获取SH3001对象的三轴陀螺仪值，获取到的值为板载SH3001芯片输出的数字量，需要结合gyro_config()方法配置的陀螺仪量程才能加算出实际的陀螺仪值。

get_gyro()方法的使用示例如下所示：

javascript 复制代码 
from board import board_info
from fpioa_manager import fm
from machine import I2C
from sh3001 import SH3001

fm.register(board_info.IMU_SCL, fm.fpioa.I2C0_SCLK)
fm.register(board_info.IMU_SDA, fm.fpioa.I2C0_SDA)

i2c = I2C(I2C.I2C0, scl=board_info.IMU_SCL, sda=board_info.IMU_SDA)

sh3001 = SH3001(i2c)
sh3001.gyro_config(SH3001.GYOR_ODR_500HZ, SH3001.GYRO_RANGE_2000DPS, 
SH3001.GYRO_RANGE_2000DPS, SH3001.GYRO_RANGE_2000DPS, SH3001.GYRO_FREQ_00,
 SH3001.GYRO_FILTER_ENABLE)
gx, gy, gz = sh3001.get_gyro()

SH3001类为SH3001对象提供了temp_config()方法，用于配置SH3001对象的温度计，temp_config()方法如下所示：

bash 复制代码 
SH3001.temp_config(odr, enable)

temp_config()方法用于配置SH3001对象的温度计。

odr指的是SH3001对象温度计的数据输出速率，可配置的参数以常量的形式保存在SH3001类中，可配置的值如下表所示：

表22.1.9 temp_config()中odr参数配置值描述

enable指的是是否使能SH3001对象的温度计，可配置的参数以常量的形式保存在SH3001类中，可配置的参数如下表所示：

表22.1.10 temp_config()中enable参数配置值描述

temp_config()方法的使用示例如下所示：

javascript 复制代码 
from board import board_info
from fpioa_manager import fm
from machine import I2C
from sh3001 import SH3001

fm.register(board_info.IMU_SCL, fm.fpioa.I2C0_SCLK)
fm.register(board_info.IMU_SDA, fm.fpioa.I2C0_SDA)

i2c = I2C(I2C.I2C0, scl=board_info.IMU_SCL, sda=board_info.IMU_SDA)

sh3001 = SH3001(i2c)
temp_config(SH3001.TEMP_ODR_63HZ, SH3001.TEMP_ENABLE)

SH3001类为SH3001对象提供了get_temp()方法，用于获取SH3001对象的温度计，get_gyro()方法如下所示：

scss 复制代码 
SH3001.get_temp()

get_temp()方法用于获取SH3001对象的温度计值，该温度计主要测量SH3001芯片内部的内部，因此并不能很直观得反映出环境温度的情况。

get_temp()方法的使用示例如下所示：

scss 复制代码 
from board import board_info
from fpioa_manager import fm
from machine import I2C
from sh3001 import SH3001

fm.register(board_info.IMU_SCL, fm.fpioa.I2C0_SCLK)
fm.register(board_info.IMU_SDA, fm.fpioa.I2C0_SDA)

i2c = I2C(I2C.I2C0, scl=board_info.IMU_SCL, sda=board_info.IMU_SDA)

sh3001 = SH3001(i2c)
temp_config(SH3001.TEMP_ODR_63HZ, SH3001.TEMP_ENABLE)
temp = sh3001.get_temp()

SH3001类为SH3001对象提供了get_attitude()方法，用于获取SH3001对象姿态解算后的欧拉角，get_attitude()方法如下所示：

scss 复制代码 
SH3001.get_attitude()

get_attitude()方法用于获取SH3001对象姿态解算后的欧拉角（俯仰角、横滚角和航向角），需要注意的是，通过三轴加速度和三轴陀螺仪数据进行姿态解算需要一定的数学算法支撑，本驱动的姿态解算算法仅供读者参考。

get_attitude()方法的使用示例如下所示：

python 复制代码 
from board import board_info
from fpioa_manager import fm
from machine import I2C
from sh3001 import SH3001

fm.register(board_info.IMU_SCL, fm.fpioa.I2C0_SCLK)
fm.register(board_info.IMU_SDA, fm.fpioa.I2C0_SDA)

i2c = I2C(I2C.I2C0, scl=board_info.IMU_SCL, sda=board_info.IMU_SDA)

sh3001 = SH3001(i2c, attitude=True)
pitch, roll, yaw = sh3001.get_attitude()

22.2 硬件设计

22.2.1 例程功能

  1. 创建一个I2C对象和一个SH3001对象

  2. 每间隔一段时间读取并打印输出SH3001温度计、加速度计和陀螺仪的测量原始数据

22.2.2 硬件资源

  1. SH3001

IIC_SCL - IO22

IIC_SDA - IO23

22.2.3 原理图

本章实验内容，需要使用到板载的SH3001芯片，正点原子DNK210开发板上的SH3001芯片连接原理图，如下图所示：

图22.2.3.1 SH3001连接原理图

22.3 程序设计

22.3.1 SH3001驱动

有关SH3001驱动的介绍，请见第22.1小节《SH3001驱动介绍及使用方法》。

22.3.2 程序流程图

图22.3.2.1 六轴传感器------原始数据读取实验流程图

22.3.3 main.py代码

main.py中的脚本代码如下所示：

python 复制代码 
from board import board_info
from fpioa_manager import fm
from machine import I2C
import time
from sh3001 import SH3001

fm.register(board_info.IMU_SCL, fm.fpioa.I2C0_SCLK)
fm.register(board_info.IMU_SDA, fm.fpioa.I2C0_SDA)

i2c = I2C(I2C.I2C0, scl=board_info.IMU_SCL, sda=board_info.IMU_SDA)

sh3001 = SH3001(i2c)

while True:
    temp = sh3001.get_temp()
    ax, ay, az = sh3001.get_acc()
    gx, gy, gz = sh3001.get_gyro()
    print("T: %.2f Ax: %d Ay: %d Az: %d Gx: %d Gy: %d Gz: %d" % (temp, ax, ay, az, gx, gy, 
gz))
    time.sleep_ms(500)

可以看到首先构造了一个I2C对象，I2C对象的SCL和SDA信号使用的正是六轴传感器连接的对应IO。

接着构造了一个SH3001对象，并且传入了前面的I2C对象。

接着便在一个循环中读取并打印输出从SH3001对象获取到的温度值、加速度值和陀螺仪值。

22.4 运行验证

将DNK210开发板连接CanMV IDE，并将SH3001的驱动脚本文件保存到CanMV的文件系统后点击CanMV IDE上的"开始(运行脚本)"按钮后，可以看到"串行终端"窗口中输出了一系列信息，如下图所示：

图22.4.1 "串行终端"窗口打印输出

可以看到，"串行终端"不断输出从SH3001获取到的温度值、加速度值和陀螺仪值。

相关推荐
梓羽玩Python2 小时前
推荐6款效果逼真的AI 3D建模工具！
开源·github·产品
XiaoYu20025 小时前
31.JS高级-包管理工具详解
前端·javascript·程序员
Javatutouhouduan1 天前
Java程序员如何获得高并发经验？
java·分布式·后端·程序员·高并发·架构师
FirstMrRight2 天前
一起读本书吧~《认知觉醒》，潜意识里有你要的答案
程序员
WujieLi2 天前
独立开发沉思录周刊：vol17.没有目标的成长
人工智能·产品·设计
我要改名叫嘟嘟3 天前
过去四年，读过的那些心理学书籍
程序员
anOnion4 天前
37 岁程序员被裁日记
面试·程序员
前端西瓜哥4 天前
产品设计：Figma 中看似简单的选中交互
前端·产品
长沙红胖子Qt5 天前
硬件开发笔记（三十）：TPS54331电源设计（三）：设计好的原理图转设计PCB布板，12V输入电路布局设计
开源·产品·设计
热门推荐
01Windows10安装PCL1.14.0及点云配准02组基轨迹建模 GBTM的介绍与实现（Stata 或 R）03【经验分享】Ubuntu22.04安装微信(linux官方版)04前端vue3实现本地及在线文件预览（含pdf/txt/mp3/mp4/docx/xlsx/pptx）05制冷毛细管的计算方法介绍06RAG 实践- Ollama+RagFlow 部署本地知识库07ECharts 地图实战分析：实现一个完整的地图下钻功能08Coze扣子平台完整体验和实践（附国内和国际版对比）09苍穹外卖面试总结10基于YOLOv10深度学习的CT扫描图像肾结石智能检测系统【python源码+Pyqt5界面+数据集+训练代码】深度学习实战、目标检测