三轴加速度计LIS2DW12开发(1)----轮询获取加速度数据

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

概述

本文将介绍如何驱动和利用LIS2DW12传感器,实现精确的运动感应功能。
IS2DW12是一款高性能、超低功耗的三轴线性加速度计,属于“femto”系列,利用了成熟的微机械加速度计制造工艺。这个传感器提供可选择的全量程±2g/±4g/±8g/±16g,能够以1.6 Hz至1600 Hz的数据输出率测量加速度。它包含了一个32级的先进先出(FIFO)缓冲区,用于存储数据,以减少主处理器的干预需求。
此外,LIS2DW12具备自测功能,可在最终应用中验证传感器功能,并集成了一个处理运动和加速度检测的内部引擎。这包括自由落体、唤醒、敲击识别、活动/静止监测、静止/运动检测、纵向/横向检测以及6D/4D定向等功能。

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

在这里插入图片描述

视频教学

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

三轴加速度计LIS2DW12开发(1)----轮询获取加速度数据

样品申请

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

源码下载

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

通信模式

对于LIS2DW12,可以使用SPI或者IIC进行通讯。
最小系统图如下所示。

在这里插入图片描述

在CS管脚为1的时候,为IIC模式。


本文使用的板子原理图如下所示。
在这里插入图片描述

管脚定义

在这里插入图片描述

IIC通信模式

在使用IIC通讯模式的时候,SA0是用来控制IIC的地址位的。
对于IIC的地址,可以通过SDO/SA0引脚修改。SDO/SA0引脚可以用来修改设备地址的最低有效位。如果SDO/SA0引脚连接到电源电压,LSb(最低有效位)为’1’(地址0011001b);否则,如果SDO/SA0引脚连接到地线,LSb的值为’0’(地址0011000b)。

在这里插入图片描述
对应的IIC接口如下所示。
主要使用的管脚为CS、SCL、SDA、SA0。

在这里插入图片描述

速率

该模块支持的速度为普通模式(100k)和快速模式(400k)。
在这里插入图片描述

生成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/lis2dw12-pid

初始换管脚

由于需要向LIS2DW12_I2C_ADD_H写入以及为IIC模式。
在这里插入图片描述

所以使能CS为高电平,配置为IIC模式。
配置SA0为高电平。

  HAL_GPIO_WritePin(GPIOC, CS_Pin, GPIO_PIN_SET);
  HAL_GPIO_WritePin(GPIOC, SA0_Pin, GPIO_PIN_SET);

获取ID

我们可以向WHO_AM_I (0Fh)获取固定值,判断是否为0x44。
在这里插入图片描述

lis2dw12_device_id_get为获取函数。
在这里插入图片描述

对应的获取ID驱动程序,如下所示。

  /* Wait sensor boot time */
  platform_delay(BOOT_TIME);
  /* Check device ID */
  lis2dw12_device_id_get(&dev_ctx, &whoamI);
	printf("LIS2DW12_ID=0x%x,whoamI=0x%x",LIS2DW12_ID,whoamI);
  if (whoamI != LIS2DW12_ID)
    while (1) {
      /* manage here device not found */
    }

复位操作

可以向CTRL2 (21h)的SOFT_RESET寄存器写入1进行复位。

在这里插入图片描述
lis2dw12_reset_set为重置函数。

在这里插入图片描述

对应的驱动程序,如下所示。

  /* Restore default configuration */
  lis2dw12_reset_set(&dev_ctx, PROPERTY_ENABLE);

  do {
    lis2dw12_reset_get(&dev_ctx, &rst);
  } while (rst);

BDU设置

在很多传感器中,数据通常被存储在输出寄存器中,这些寄存器分为两部分:MSB和LSB。这两部分共同表示一个完整的数据值。例如,在一个加速度计中,MSB和LSB可能共同表示一个加速度的测量值。
连续更新模式(BDU = ‘0’):在默认模式下,输出寄存器的值会持续不断地被更新。这意味着在你读取MSB和LSB的时候,寄存器中的数据可能会因为新的测量数据而更新。这可能导致一个问题:当你读取MSB时,如果寄存器更新了,接下来读取的LSB可能就是新的测量值的一部分,而不是与MSB相对应的值。这样,你得到的就是一个“拼凑”的数据,它可能无法准确代表任何实际的测量时刻。
块数据更新(BDU)模式(BDU = ‘1’):当激活BDU功能时,输出寄存器中的内容不会在读取MSB和LSB之间更新。这就意味着一旦开始读取数据(无论是先读MSB还是LSB),寄存器中的那一组数据就被“锁定”,直到两部分都被读取完毕。这样可以确保你读取的MSB和LSB是同一测量时刻的数据,避免了读取到代表不同采样时刻的数据。
简而言之,BDU位的作用是确保在读取数据时,输出寄存器的内容保持稳定,从而避免读取到拼凑或错误的数据。这对于需要高精度和稳定性的应用尤为重要。
可以向CTRL2 (21h)的BDU寄存器写入1进行开启。

在这里插入图片描述

对应的驱动程序,如下所示。

/* Enable Block Data Update */
  lis2dw12_block_data_update_set(&dev_ctx, PROPERTY_ENABLE);

设置传感器的量程

FS[1:0] - 全量程选择:这两个位用于设置传感器的量程。量程决定了传感器可以测量的最大加速度值。例如,量程可以设置为±2g、±4g、±8g或±16g。这允许用户根据应用的特定需求调整传感器的灵敏度。
在这里插入图片描述

对应的驱动程序,如下所示。

  /* Set full scale */
  lis2dw12_full_scale_set(&dev_ctx, LIS2DW12_2g);

配置过滤器链

lis2dw12_filter_path_set(&dev_ctx, LIS2DW12_LPF_ON_OUT);:设置加速度计输出的过滤器路径。这里选择了输出上的低通滤波器(LPF),用于去除高频噪声。
lis2dw12_filter_bandwidth_set(&dev_ctx, LIS2DW12_ODR_DIV_4);:设置过滤器的带宽。这里的设置是将输出数据率(ODR)除以4,进一步决定了滤波器的截止频率。

配置电源模式

lis2dw12_power_mode_set(&dev_ctx, LIS2DW12_HIGH_PERFORMANCE);:这个调用设置加速度计的电源模式为高性能模式。这通常意味着更高的功耗,但提供更精确的测量。

设置输出数据速率

lis2dw12_data_rate_set(&dev_ctx, LIS2DW12_XL_ODR_25Hz);:设置加速度计的输出数据速率为每秒25次。输出数据速率决定了传感器多久采集一次数据,并影响数据的实时性和功耗。

  /* Enable Block Data Update */
  lis2dw12_block_data_update_set(&dev_ctx, PROPERTY_ENABLE);
  /* Set full scale */
  lis2dw12_full_scale_set(&dev_ctx, LIS2DW12_2g);
  /* Configure filtering chain
   * Accelerometer - filter path / bandwidth
   */
  lis2dw12_filter_path_set(&dev_ctx, LIS2DW12_LPF_ON_OUT);
  lis2dw12_filter_bandwidth_set(&dev_ctx, LIS2DW12_ODR_DIV_4);
  /* Configure power mode */
  lis2dw12_power_mode_set(&dev_ctx, LIS2DW12_HIGH_PERFORMANCE);
  /* Set Output Data Rate */
  lis2dw12_data_rate_set(&dev_ctx, LIS2DW12_XL_ODR_25Hz);

轮询获取加速度

检查新数据是否可用:
lis2dw12_flag_data_ready_get(&dev_ctx, &reg);:这个函数调用检查加速度计是否有新的数据可读。如果有新数据,reg 变量将被设置为非零值。
主要为读取STATUS (27h)的DRDY位。
在这里插入图片描述
如果 reg 是非零的,说明有新的加速度数据可读。
lis2dw12_acceleration_raw_get(&dev_ctx, data_raw_acceleration);:这个函数调用实际读取加速度计的原始数据,并存储在 data_raw_acceleration 数组中。
数据在28h-2Dh中。

在这里插入图片描述

在这里插入图片描述
加速度数据首先以原始格式(通常是整数)读取,然后需要转换为更有意义的单位,如毫重力(mg)。这里的转换函数 lis2dw12_from_fs2_to_mg() 根据加速度计的量程(这里假设为±2g)将原始数据转换为毫重力单位。
acceleration_mg[0] = lis2dw12_from_fs2_to_mg(data_raw_acceleration[0]); 等三行代码分别转换 X、Y、Z 轴的加速度数据。

在这里插入图片描述

● LIS2DW12 加速度计通常会有一个固定的位分辨率,比如 16 位(即输出值是一个 16 位的整数)。这意味着加速度计可以输出的不同值的总数是 2^16=65536。这些值均匀地分布在 -2g 到 +2g 的范围内。
● 因此,这个范围(4g 或者 4000 mg)被分成了 65536 个步长。
● 每个步长的大小是 4000 mg/65536≈0.061 mg/LSB
所以,函数中的乘法 ((float_t)lsb) * 0.061f 是将原始的整数值转换为以毫重力(mg)为单位的加速度值。这个转换对于将加速度计的原始读数转换为实际的物理测量值是必需的。

  /* Infinite loop */
  /* USER CODE BEGIN WHILE */
  while (1)
  {

    uint8_t reg;
    /* Read output only if new value is available */
    lis2dw12_flag_data_ready_get(&dev_ctx, &reg);

    if (reg) {
      /* Read acceleration data */
      memset(data_raw_acceleration, 0x00, 3 * sizeof(int16_t));
      lis2dw12_acceleration_raw_get(&dev_ctx, data_raw_acceleration);
      //acceleration_mg[0] = lis2dw12_from_fs8_lp1_to_mg(data_raw_acceleration[0]);
      //acceleration_mg[1] = lis2dw12_from_fs8_lp1_to_mg(data_raw_acceleration[1]);
      //acceleration_mg[2] = lis2dw12_from_fs8_lp1_to_mg(data_raw_acceleration[2]);
      acceleration_mg[0] = lis2dw12_from_fs2_to_mg(
                             data_raw_acceleration[0]);
      acceleration_mg[1] = lis2dw12_from_fs2_to_mg(
                             data_raw_acceleration[1]);
      acceleration_mg[2] = lis2dw12_from_fs2_to_mg(
                             data_raw_acceleration[2]);
      printf("Acceleration [mg]:X=%4.2f\tY=%4.2f\tZ=%4.2f\r\n",acceleration_mg[0], acceleration_mg[1], acceleration_mg[2]);
    }
HAL_Delay(100);

    /* USER CODE END WHILE */

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

演示

在这里插入图片描述

  • 4
    点赞
  • 11
    收藏
    觉得还不错? 一键收藏
  • 打赏
    打赏
  • 3
    评论
以下是一个基于 LIS2DH12 三轴加速度传感器的算法来判断状态的C代码: ```c #include <stdio.h> #include <stdlib.h> #include <unistd.h> #include <stdbool.h> #include <wiringPiI2C.h> #define ACCEL_ADDR 0x18 #define ACCEL_CTRL_REG1 0x20 #define ACCEL_CTRL_REG4 0x23 #define ACCEL_X_AXIS 0x28 #define ACCEL_Y_AXIS 0x2A #define ACCEL_Z_AXIS 0x2C #define THRESHOLD 1.0 // 加速度变化阈值 #define SAMPLE_RATE 100 // 采样率(Hz) #define WINDOW_SIZE 10 // 窗口大小(个样本) enum State { IDLE, MOVING, FALLING }; int main(void) { int fd = wiringPiI2CSetup(ACCEL_ADDR); if(fd == -1) { printf("Failed to initialize I2C device.\n"); exit(1); } // 配置传感器 wiringPiI2CWriteReg8(fd, ACCEL_CTRL_REG1, 0x77); // 打开传感器并设置采样率 wiringPiI2CWriteReg8(fd, ACCEL_CTRL_REG4, 0x08); // 设置测量范围为 +/- 8g // 初始化前 WINDOW_SIZE 个样本的加速度值 float prev_accel_x[WINDOW_SIZE]; float prev_accel_y[WINDOW_SIZE]; float prev_accel_z[WINDOW_SIZE]; for(int i = 0; i < WINDOW_SIZE; i++) { int x = wiringPiI2CReadReg16(fd, ACCEL_X_AXIS); int y = wiringPiI2CReadReg16(fd, ACCEL_Y_AXIS); int z = wiringPiI2CReadReg16(fd, ACCEL_Z_AXIS); // 将读取到的原始数据转换为实际加速度值 prev_accel_x[i] = (float)x / 1024.0; prev_accel_y[i] = (float)y / 1024.0; prev_accel_z[i] = (float)z / 1024.0; usleep(1000000 / SAMPLE_RATE); // 等待一段时间,以达到采样率 } // 初始化状态 enum State state = IDLE; while(1) { // 读取最新的加速度值 int x = wiringPiI2CReadReg16(fd, ACCEL_X_AXIS); int y = wiringPiI2CReadReg16(fd, ACCEL_Y_AXIS); int z = wiringPiI2CReadReg16(fd, ACCEL_Z_AXIS); // 将读取到的原始数据转换为实际加速度值 float accel_x = (float)x / 1024.0; float accel_y = (float)y / 1024.0; float accel_z = (float)z / 1024.0; // 计算加速度变化值 float delta_accel_x = 0; float delta_accel_y = 0; float delta_accel_z = 0; for(int i = 0; i < WINDOW_SIZE; i++) { delta_accel_x += abs(accel_x - prev_accel_x[i]); delta_accel_y += abs(accel_y - prev_accel_y[i]); delta_accel_z += abs(accel_z - prev_accel_z[i]); } delta_accel_x /= WINDOW_SIZE; delta_accel_y /= WINDOW_SIZE; delta_accel_z /= WINDOW_SIZE; // 根据加速度变化值判断状态 switch(state) { case IDLE: if(delta_accel_x > THRESHOLD || delta_accel_y > THRESHOLD || delta_accel_z > THRESHOLD) { state = MOVING; printf("State: MOVING\n"); } break; case MOVING: if(delta_accel_x > THRESHOLD || delta_accel_y > THRESHOLD || delta_accel_z > THRESHOLD) { state = MOVING; } else { state = FALLING; printf("State: FALLING\n"); } break; case FALLING: if(delta_accel_z > THRESHOLD) { state = IDLE; printf("State: IDLE\n"); } break; } // 更新前 WINDOW_SIZE 个样本的加速度值 for(int i = WINDOW_SIZE - 1; i > 0; i--) { prev_accel_x[i] = prev_accel_x[i - 1]; prev_accel_y[i] = prev_accel_y[i - 1]; prev_accel_z[i] = prev_accel_z[i - 1]; } prev_accel_x[0] = accel_x; prev_accel_y[0] = accel_y; prev_accel_z[0] = accel_z; // 等待一段时间,以达到采样率 usleep(1000000 / SAMPLE_RATE); } return 0; } ``` 该代码使用了和前面类似的方式来读取 LIS2DH12 三轴加速度传感器的数据,并根据加速度变化的情况来判断状态。具体地,根据阈值 THRESHOLD 来判断加速度是否变化,根据窗口大小 WINDOW_SIZE 来计算加速度变化值,然后根据加速度变化值的大小来判断状态。如果加速度变化超过阈值且当前状态为 IDLE,则进入 MOVING 状态;如果加速度变化超过阈值且当前状态为 MOVING,则保持 MOVING 状态;如果加速度变化没有超过阈值且当前状态为 MOVING,则进入 FALLING 状态;如果加速度变化超过阈值且当前状态为 FALLING,则保持 FALLING 状态;如果加速度在 Z 轴方向上超过阈值且当前状态为 FALLING,则回到 IDLE 状态。注意,需要根据具体的传感器型号和配置修改代码中的地址和寄存器值,以及阈值、采样率和窗口大小的大小。

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

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

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

打赏作者

记帖

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

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

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

打赏作者

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

抵扣说明:

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

余额充值