Qmi8658a姿态传感器使用心得（2）linux

于 2024-07-19 11:44:44 发布
阅读量625 收藏 9
点赞数 29
文章标签： linux 运维 服务器
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/m0_74962389/article/details/140544017
版权

1 .COD 原理

COD 支持按需校准陀螺仪的X和Y轴。QMI8658A可以校准陀螺仪的X和Y轴的内部增益，提供更精确的灵敏度和更紧密的灵敏度分布。注意：Z轴不受COD影响。

1.1 运行COD的步骤

  1. 设置CTRL7.aEN = 0 和 CTRL7.gEN = 0 以禁用加速度计和陀螺仪。
  2. 通过CTRL9命令发送CTRL_CMD_ON_DEMAND_CALIBRATION (0xA2)。
  3. 等待大约1.5秒，直到QMI8658A完成CTRL9命令。
  4. 读取COD_STATUS寄存器(0x46)以检查COD执行的结果和状态。

1.2 COD状态

如果COD命令成功执行，COD_STATUS寄存器将输出0x00表示成功。非零值表示不同的失败模式。参阅COD状态寄存器（5.7）的详细信息。

1.3 保存和恢复新的增益参数

在成功运行COD后，新的增益将应用于未来的X和Y轴数据，并将这些参数更新到以下寄存器，供主机读取和保存：

  1. 陀螺仪-X增益 (16 bits) 将存储在dVX_L和dVX_H寄存器 (0x51, 0x52)
  2. 陀螺仪-Y增益 (16 bits) 将存储在dVY_L和dVY_H寄存器 (0x53, 0x54)
  3. 陀螺仪-Z增益 (16 bits) 将存储在dVZ_L和dVZ_H寄存器 (0x55, 0x56)

1.4恢复增益参数

  1. 禁用加速度计和陀螺仪 (设置CTRL7.aEN = 0 和 CTRL7.gEN = 0)。
  2. 将保存的陀螺仪-X增益写入寄存器CAL1_L和CAL1_H (0x0B, 0x0C)。
  3. 将保存的陀螺仪-Y增益写入寄存器CAL2_L和CAL2_H (0x0D, 0x0E)。
  4. 将保存的陀螺仪-Z增益写入寄存器CAL3_L和CAL3_H (0x0F, 0x10)。
  5. 写入0xAA到CTRL9寄存器以执行CTRL_CMD_APPLY_GYRO_GAINS命令。

2. COD状态寄存器

COD_STATUS寄存器地址：0x46

Bits名称默认描述
7X_Limit_L_Fail1’b00: COD通过低灵敏度检查; 1: COD失败
6X_Limit_H_Fail1’b00: COD通过高灵敏度检查; 1: COD失败
5Y_Limit_L_Fail1’b00: COD通过低灵敏度检查; 1: COD失败
4Y_Limit_H_Fail1’b00: COD通过高灵敏度检查; 1: COD失败
3Accel_Check1’b00: 加速度计检查通过; 1: 加速度计检查失败
2Startup_Failed1’b00: 陀螺仪启动成功; 1: 陀螺仪启动失败
1Gyro_Enabled1’b00: COD调用时陀螺仪未启用; 1: COD调用时陀螺仪启用
0COD_Failed1’b00: COD成功; 1: COD失败

3.CTRL9命令列表

CTRL9寄存器地址：0x0A

Command NameCommand ValueProtocol TypeDescription
CTRL_CMD_ACK0x00Ctrl9Host acknowledges to end the protocol
CTRL_CMD_RST_FIFO0x04Ctrl9Reset FIFO from Host
CTRL_CMD_REQ_FIFO0x05Ctrl9RGet FIFO data from Device
CTRL_CMD_WRITE_WOM_SETTING0x08WCtrl9Set up and enable Wake on Motion (WoM)
CTRL_CMD_ACCEL_HOST_DELTA_OFFSET0x09WCtrl9Change accelerometer offset
CTRL_CMD_GYRO_HOST_DELTA_OFFSET0x0AWCtrl9Change gyroscope offset
CTRL_CMD_CONFIGURE_TAP0x0CWCtrl9Configure Tap detection
CTRL_CMD_CONFIGURE_PEDOMETER0x0DWCtrl9Configure Pedometer
CTRL_CMD_CONFIGURE_MOTION0x0EWCtrl9Configure Any Motion / No Motion detection
CTRL_CMD_RESET_PEDOMETER0x0FWCtrl9Reset pedometer count
CTRL_CMD_COPY_USID0x10Ctrl9RCopy USID and FW Version to UI registers
CTRL_CMD_SET_RPU0x11WCtrl9Configures IO pull-ups
CTRL_CMD_AHB_CLOCK_GATING0x12WCtrl9Internal AHB clock gating switch
CTRL_CMD_ON_DEMAND_CALIBRATION0xA2WCtrl9On-Demand Calibration on gyroscope
CTRL_CMD_APPLY_GYRO_GAINS0xAAWCtrl9Restore the saved Gyroscope gains

4.配置方法：

        特别注意：在校准过程中，尽量保持安静，减少环境对于校准结果的干扰；
        并且可以在开发过程中设计循环来实现定期校准的效果。保证陀螺仪的准确
        回复过往的增益参数时要注意变化。

void start_calibration(){
    // Disable sensor and set calibration
    writeRegister(CTRL7, 0x00);  // Disable sensor
    
    writeRegister(CTRL9, 0xA2);  // send calibration command
    
    delay(1500);  // delay
    
    uint8_t statusInt = readRegister(STATUSINT);
    if (statusInt & 0x80) {
        // CmdDone is ok
    } else {
        // CmdDone is fail
    }

    writeRegister(CTRL9, 0x00);  // comfirm calibratino success
    
    uint8_t COD_STATUS = readRegister(0x46);
    if (COD_STATUS == 0x00) {
        // calibration success
    } else {
        // calibration fail
    }
    
    //update the gain 
    uint16_t gyroXGain = readRegister(0x51) | (readRegister(0x52) << 8);
    uint16_t gyroYGain = readRegister(0x53) | (readRegister(0x54) << 8);
    uint16_t gyroZGain = readRegister(0x55) | (readRegister(0x56) << 8);
    
    //save the data and send back to qmi8658a
    // Disable sensor and set calibration
    writeRegister(CTRL7, 0x00);

    // write in gyrox
    writeRegister(0x0B, gyroXGain & 0xFF);
    writeRegister(0x0C, (gyroXGain >> 8) & 0xFF);

    // write in gyroy
    writeRegister(0x0D, gyroYGain & 0xFF);
    writeRegister(0x0E, (gyroYGain >> 8) & 0xFF);

    // write in gytoz
    writeRegister(0x0F, gyroZGain & 0xFF);
    writeRegister(0x10, (gyroZGain >> 8) & 0xFF);

    //send command to CTRL9 and follow the permision
    writeRegister(CTRL9, 0xAA);  // update the gain

5.自检：

5.1加速度计自检

加速度计自检用于确定加速度计是否工作在可接受的参数范围内。该功能通过对加速度计的 X、Y 和 Z 轴施加静电力，并检测其机械结构响应。以下是实现自检的步骤：

  1. 禁用传感器 (CTRL7 = 0x00)。
  2. 设置适当的加速度计 ODR（CTRL2.aODR）并将 CTRL2.aST（bit7）置 1 以触发自检。
  3. 如果启用 INT2（CTRL1.bit4 = 1），等待 QMI8658A 将 INT2 置高，或 STATUSINT.bit0 置 1。
  4. 将 CTRL2.aST(bit7) 置 0，以清除 STATUSINT1.bit0 和/或 INT2。
  5. 检查 QMI8658A 将 INT2 置低，并将 STATUSINT1.bit0 置 0。
  6. 读取加速度计自检结果：
    • X 轴：dVX_L 和 dVX_H（寄存器 0x51 和 0x52）
    • Y 轴：dVY_L 和 dVY_H（寄存器 0x53 和 0x54）
    • Z 轴：dVZ_L 和 dVZ_H（寄存器 0x55 和 0x56）

如果三个轴的绝对结果均高于 200mg，则加速度计可视为功能正常。否则，视为功能不正常。

5.2陀螺仪自检

陀螺仪自检用于确定陀螺仪是否工作正常。该功能通过对陀螺仪的 X、Y 和 Z 轴施加静电力，并检测其机械结构响应。以下是实现自检的步骤：

  1. 禁用传感器 (CTRL7 = 0x00)。
  2. 将 gST 置 1（CTRL3.bit7 = 1）。
  3. 如果启用 INT2，等待 QMI8658A 将 INT2 置高，或 STATUSINT.bit0 置 1。
  4. 将 CTRL3.aST(bit7) 置 0，以清除 STATUSINT1.bit0 和/或 INT2。
  5. 检查 QMI8658A 将 INT2 置低，或将 STATUSINT1.bit0 置 0。
  6. 读取陀螺仪自检结果：
    • X 轴：dVX_L 和 dVX_H（寄存器 0x51 和 0x52）
    • Y 轴：dVY_L 和 dVY_H（寄存器 0x53 和 0x54）
    • Z 轴：dVZ_L 和 dVZ_H（寄存器 0x55 和 0x56）
// 加速度计自检
void accelerometer_self_test() {
    printf("Starting Accelerometer Self-Test...\n");
    
    // 禁用传感器
    write_register(CTRL7, 0x00);

    // 设置加速度计自检
    uint8_t ctrl2_val = read_register(CTRL2);
    ctrl2_val |= (1 << 7); // 设置aST位
    write_register(CTRL2, ctrl2_val);

    // 等待自检完成
    while (!(read_register(STATUSINT) & 0x01));

    // 读取自检结果
    int16_t ax = (int16_t)read_register_16(dVX_L, dVX_H);
    int16_t ay = (int16_t)read_register_16(dVY_L, dVY_H);
    int16_t az = (int16_t)read_register_16(dVZ_L, dVZ_H);

    printf("Accelerometer Self-Test Results:\n");
    printf("X: %d mg\n", ax);
    printf("Y: %d mg\n", ay);
    printf("Z: %d mg\n", az);

    // 清除aST位
    ctrl2_val &= ~(1 << 7);
    write_register(CTRL2, ctrl2_val);
}

// 陀螺仪自检
void gyroscope_self_test() {
    printf("Starting Gyroscope Self-Test...\n");

    // 禁用传感器
    write_register(CTRL7, 0x00);

    // 设置陀螺仪自检
    uint8_t ctrl3_val = read_register(CTRL3);
    ctrl3_val |= (1 << 7); // 设置gST位
    write_register(CTRL3, ctrl3_val);

    // 等待自检完成
    while (!(read_register(STATUSINT) & 0x01));

    // 读取自检结果
    int16_t gx = (int16_t)read_register_16(dVX_L, dVX_H);
    int16_t gy = (int16_t)read_register_16(dVY_L, dVY_H);
    int16_t gz = (int16_t)read_register_16(dVZ_L, dVZ_H);

    printf("Gyroscope Self-Test Results:\n");
    printf("X: %d dps\n", gx);
    printf("Y: %d dps\n", gy);
    printf("Z: %d dps\n", gz);

    // 清除gST位
    ctrl3_val &= ~(1 << 7);
    write_register(CTRL3, ctrl3_val);
}

小但同学
关注
  • 29
    点赞
  • 踩
  • 9
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
QMA8658A 六轴姿态传感器数据获取算法
11-03
在本文中，我们将深入探讨QMA8658A六轴姿态传感器的数据获取算法，以及如何利用这款传感器在嵌入式系统中实现精准的运动跟踪和姿态控制。QMA8658A是一款集成了3轴加速度计和3轴陀螺仪的高性能传感器，它能有效地提供...
qmi8658驱动源代码，spi接口
02-01
3. `13-52-27 QMI8658C Datasheet Rev A.pdf`：这很可能是QMI8658传感器的数据手册，包含了详细的硬件接口信息、电气特性、操作指令和性能参数，是理解和开发驱动程序的重要参考资料。 总的来说，这个项目提供了...
Qmi8658A姿态传感器使用心得（1）linux
Starry的博客
07-15 1359
在当今科技迅速发展的时代，精确的姿态测量对于各种应用至关重要，从智能手机、无人机到自动驾驶汽车和航空航天器。QMI8658A姿态传感器作为市场上的一款高性能产品，为用户提供了前所未有的测量精度和可靠性。本文将深入探讨QMI8658A传感器的技术特点、工作原理以及在不同领域的应用前景。技术规格与特点： QMI8658A姿态传感器集成了多种传感技术，包括加速度计、陀螺仪和磁力计，以提供全面的三维空间定位数据。
QMI8658 - 姿态传感器学习笔记 - Ⅰ
热门推荐
nicole088的专栏
07-28 1万+
QMI8658 传感的相关参数介绍在这里不摘抄，详细请查阅数据手册。在这里重点提一下 AttitudeEngine。QMI8658集成了称为 AttitudeEngine 的高级矢量数字信号处理器 (DSP) 运动协处理器。AttitudeEngine 以高内部采样率有效地编码高频运动，在较低频率的输出数据速率下保持完全的准确性。这使应用程序能够利用低输出数据速率 (ODR) 或按需（主机轮询），同时仍能获取准确的 3D 运动数据。
QMI8658 - 姿态传感器学习笔记 - Ⅲ
nicole088的专栏
05-25 4984
如果启用 FIFO 模式，如果 CTRL1.bit2 设置为 1，则 FIFO 中断可以配置到 INT1 引脚，如果 CTRL1.bit2 设置为 0，则可以将 FIFO 中断配置到 INT2 引脚。如果启用 DRDY 模式，如果 CTRL7.bit5(DRDY_DIS) 设置为 0，则 DRDY 信号将被路由到 INT2，如果 CTRL7.bit5(DRDY_DIS) 设置为 1，则 DRDY 信号将被路由到 INT2 引脚。如果 QMI8658A 未处于运动唤醒模式，则中断映射有两种模式，如下所述。
QMI8658 - 姿态传感器学习笔记 - Ⅱ
nicole088的专栏
08-04 3948
寄存器功能介紹
QMI8658C 驱动代码，使用模拟IIC接口
04-08
QMI8658C通常是一款微控制器或传感器，用于执行特定的硬件功能。在没有物理IIC总线支持的情况下，开发者可能需要使用模拟IIC来与这类设备进行通信。模拟IIC是一种软件实现的IIC协议，它利用GPIO（General Purpose ...
模拟IIC读取国产六轴陀螺仪QMI8658程序
07-12
QMI8658是一款国产的六轴陀螺仪，它结合了三轴角速度传感器和三轴加速度传感器，可以提供全方位的运动数据。模拟IIC（Inter-Integrated Circuit）通信是实现微控制器与这种传感器交互的一种方式，特别是在资源有限的...
QMI8658C驱程序源代码，GPIO模拟I2C接口QMI8658C驱动.zip
05-18
QMI8658C驱程序源代码，GPIO模拟I2C接口QMI8658C驱动； void QMI8658C_WriteReg(u8 reg_add, u8 reg_dat); uint8_t QMI8658C_ReadData(u8 reg_add); uint8_t QMI8658C_Reg_Init(void); uint8_t QMI8658C_ReadDev_...
接着探索Linux的世界 -- 基本指令（文件查看、时间相关、打包压缩等等）
weixin_73359101的博客
07-14 1674
命令输出到某个指定文件中，而不是输出到终端屏幕或终端窗口。我们从键盘输入什么，cat命令就打印什么。命令 + >> + 目标文件名。： 将命令的结果写入目标文件中；这两条指令的作用等价。
linux的学习（四）：磁盘，进程，定时，软件包的相关命令
weixin_45037073的博客
07-14 1132
关于磁盘管理，进程管理，定时任务，软件包管理的命令的使用。
定制 Linux 内核的意义
地球空间
07-17 252
2. **配置内核**：使用 `make menuconfig` 或 `make xconfig` 配置内核，选择需要支持的硬件和功能。1. **性能优化**：通过定制内核，可以针对特定的硬件或应用场景优化性能，比如减少不必要的驱动支持、优化调度算法等。7. **持续维护**：随着时间的推移，可能需要对内核进行更新和维护，以支持新的硬件和功能。6. **测试和调试**：启动系统，测试新内核的功能和性能，根据需要进行调试和优化。4. **安装内核**：编译完成后，将生成的内核镜像和相关的模块安装到系统中。
linux dev shm扩容
hello__bug的博客
07-14 259
ctrl + x 保存。
Linux 权限
最新发布
includemainprinf的博客
07-18 475
在Linux操作系统中，权限管理是一个至关重要的概念，它确保了系统的安全性和稳定性。同时可以在工作中，设置对象的权限，就算我们很多人使用一台服务器，我们也可以让别人看不到我们文件的内容，或者让别人无法对自己的文件进行操作！
文件在Linux下为binary格式在Windows下为utf-8格式
qq_38220334的博客
07-17 285
想着是不是之前遇到的问题，有可能是文件中含有特殊字符，然后用vim命令来编辑这个文件，发现，还真是含有一个特殊字符，然后将它删除掉，文件就变成utf-8格式的文件了。在Windows下和Mac下都是没有问题的，在华为云服务器上也是没问题的（操作系统不是centos），但是在自己搭建的Linux服务器（centos）上是有问题的。用shell或者Python脚本去将这个文件转为utf-8格式的，但是都失败了。
【Linux】深入探索`cp`命令：文件复制的全面指南
lph159的博客
07-18 291
cp命令用于复制文件或目录的内容。cp [选项] 源文件 目标文件或目录使用cp命令可以在文件系统中创建新的副本，无论是单个文件还是整个目录树。接下来我们将详细介绍cp命令的各个选项及其用法。
Linux HOOK机制与Netfilter HOOK
Flashing-C的博客
07-18 473
在计算机中基本所有的软件程序都可以通过hook方式进行行为拦截，hook方式就是改变原始的执行流。 Linux常见的HOOK方式：1、修改函数指针。2、用户态动态库拦截。①利用环境变量LD_PRELOAD和预装载机制进行HOOK；②利用函数ptrace可实现对已运行的程序进行HOOK；3、内核态系统调用拦截。通过修改全局系统调用表，对系统调用进行劫持；4、堆栈式文件系统拦截。5、LSM。6、Netfilter HOOK。
Linux高级IO
Wang3260584290的博客
07-14 844
Linux的高级IO
QMI8658A工作原理
04-11
QMI8658A是一款传感器芯片，主要用于测量物体的加速度、角速度和磁场。它采用了MEMS技术（微机电系统），结合了加速度计、陀螺仪和磁力计的功能。 QMI8658A的工作原理如下： 1. 加速度计：QMI8658A内部集成了三轴加速度计，通过测量物体在三个方向上的加速度来确定物体的运动状态。加速度计利用微机电系统中的微小质量和弹簧结构，当物体受到加速度时，质量会发生微小位移，通过测量位移的变化来计算加速度。 2. 陀螺仪：QMI8658A内部集成了三轴陀螺仪，用于测量物体的角速度。陀螺仪利用微机电系统中的旋转结构，当物体发生旋转时，旋转结构会产生微小的振动，通过测量振动的变化来计算角速度。 3. 磁力计：QMI8658A内部集成了三轴磁力计，用于测量物体周围的磁场强度。磁力计利用微机电系统中的磁敏材料，当物体周围的磁场发生变化时，磁敏材料会产生微小的电压变化，通过测量电压的变化来计算磁场强度。 QMI8658A通过集成这三种传感器，可以同时测量物体的加速度、角速度和磁场，从而提供更全面的运动状态信息。它广泛应用于智能手机、智能手表、运动追踪器等设备中。

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

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

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

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

余额充值