驱动LSM6DS3TR-C实现高效运动检测与数据采集(12)----加速度校准

138 篇文章 59 订阅
94 篇文章 3 订阅


驱动LSM6DS3TR-C实现高效运动检测与数据采集.12–加速度校准)

概述

MotionAC 是 STMicroelectronics 提供的一款用于加速度计校准的中间件库。该库可以实时计算加速度计的偏移和比例因子,并对传感器数据进行补偿,从而提高测量精度。
MotionAC 库通过获取加速度计的数据,计算出偏移和比例因子校准参数,并应用这些参数对原始数据进行校正。校准可以在动态和静态两种模式下进行。

需要样片的可以加群申请:615061293 。

在这里插入图片描述

视频教学

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

驱动LSM6DS3TR-C实现高效运动检测与数据采集(12)----加速度校准

样品申请

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

源码下载

硬件准备

首先需要准备一个开发板,这里我准备的是自己绘制的开发板,需要的可以进行申请。
主控为STM32H503CB,陀螺仪为LSM6DS3TR-C,磁力计为LIS2MDL。在这里插入图片描述

校准过程

2.2.6 节详细描述了如何使用 MotionAC 库进行加速度计的校准过程。该过程通过正常运动或特定姿态的设备来确定偏移和比例因子补偿,以提高加速度计的测量精度。
初始位置:
● 将设备稳固地握在起始位置(位置1)。
旋转设备:
● 轻轻地将设备沿 YZ 平面旋转 180°,使设备翻转到其背面(位置4)。
● 然后再沿 XZ 平面顺时针旋转 180°,使设备返回到起始位置(位置1)。
平滑路径:
● 试图沿平滑路径和恒定速度旋转设备。
六点校准:
● 也可以执行标准的六点校准,将模块静止在六个不同方向(+X, -X, +Y, -Y, +Z, -Z)上。

在这里插入图片描述

开启CRC

在这里插入图片描述

串口设置

设置串口速率为2000000。
在这里插入图片描述

开启X-CUBE-MEMS1

通过使用 MotionAC 库,可以有效地对加速度计进行校准,确保测量数据的准确性。

在这里插入图片描述

速率选择

MotionAC 支持从20 Hz到100 Hz的更新频率。

在这里插入图片描述

AccelerometerCalibration

该应用程序展示了如何使用由 STMicroelectronics 开发的 MotionAC 中间件库与 X-NUCLEO-IKS01A3 扩展板和 STM32 Nucleo 板上的 LSM6DSO 组件进行加速度计校准。应用程序启动后,用户可以使用由 STMicroelectronics 开发的 Unicleo-GUI 应用程序查看数据。

在这里插入图片描述

变量定义

float acceleration_mg[3];
static MAC_knobs_t Knobs;

MotionAC文件

主要包含app_mems_motionac.c和app_mems_motionac.h,这两个文件是用于配置和实现加速度计校准功能的头文件和源文件。它们使用了 MotionAC 库,提供了必要的函数接口和实现来初始化、更新、获取校准参数和应用校准补偿。

MX_AccelerometerCalibration_Init

MX_AccelerometerCalibration_Init 该函数初始化了加速度计校准功能。以下是其具体流程和每个步骤的详细解释:

  1. 调用 MotionAC_manager_init(MAC_DISABLE_LIB) 禁用 MotionAC 库。
  2. 调用 MotionAC_manager_init(MAC_ENABLE_LIB) 启用 MotionAC 库。
    1和2主要使用MotionAC_Initialize 函数用于初始化 MotionAC 引擎,根据传入的参数决定启用或禁用加速度计校准库。此函数是 MotionAC 库的核心初始化函数,通过设置内部状态和参数来准备校准功能。

在这里插入图片描述

  1. 调用 MotionAC_GetKnobs(&Knobs) 获取当前的校准设置。
  2. 调用 MotionAC_SetKnobs(&Knobs) 将这些新的设置应用到库中。
  3. 调用 MotionAC_manager_get_version(LibVersion, &LibVersionLen) 获取 MotionAC 库的版本信息。

AC_Data_Handler

AC_Data_Handler 函数的主要功能是处理加速度计数据,通过 MotionAC 库进行校准,获取并应用校准参数,最终输出校准后的加速度数据和校准质量信息。

  1. MotionAC_manager_update 函数用于更新加速度计数据,并运行加速度计的校准算法。这一过程包括接收新的加速度计数据,执行校准计算,确定是否需要更新校准参数,并返回校准状态。
    1中主要执行MotionAC_Update 函数用于运行加速度计校准算法。它接收输入的加速度计数据和时间戳,计算校准参数,并返回当前样本是否完成校准。

在这里插入图片描述

  1. MotionAC_manager_get_params 函数用于获取加速度计的校准参数,包括偏移值(Offset)和比例因子(Scale Factor)矩阵。这些参数是由校准算法计算得到的,用于对原始加速度计数据进行校正。
    2中主要执行MotionAC_GetCalParams 函数用于检索加速度计的校准系数,包括偏移和比例因子补偿参数,以及校准质量因子。该函数将这些参数填充到传入的输出结构体中,以便调用者使用这些参数进行校准数据处理。
    ● MAC_CALQSTATUSUNKNOWN = 0:校准参数的准确性未知。
    ● MAC_CALQSTATUSPOOR = 1:校准参数的准确性较差,不可信。
    ● MAC_CALQSTATUSOK = 2:校准参数的准确性尚可。
    ● MAC_CALQSTATUSGOOD = 3:校准参数的准确性良好。

在这里插入图片描述

  1. MotionAC_manager_compensate 函数用于对原始加速度计数据进行补偿,即应用先前计算得到的校准参数(偏移值和比例因子矩阵)来校正加速度计数据。这个过程是为了消除加速度计在测量中的系统误差,提高数据的准确性。

初始化定义

  /* USER CODE BEGIN 2 */
	printf("HELLO!\n");
  HAL_GPIO_WritePin(CS1_GPIO_Port, CS1_Pin, GPIO_PIN_SET);
  HAL_GPIO_WritePin(SA0_GPIO_Port, SA0_Pin, GPIO_PIN_RESET);
  HAL_GPIO_WritePin(CS2_GPIO_Port, CS2_Pin, GPIO_PIN_SET);
	HAL_Delay(100);

	
  /* Initialize mems driver interface */
  stmdev_ctx_t dev_ctx;
  dev_ctx.write_reg = platform_write;
  dev_ctx.read_reg = platform_read;
  dev_ctx.mdelay = platform_delay;
  dev_ctx.handle = &SENSOR_BUS;
  /* Init test platform */
//  platform_init();
  /* Wait sensor boot time */
  platform_delay(BOOT_TIME);
  /* Check device ID */
  whoamI = 0;
  lsm6ds3tr_c_device_id_get(&dev_ctx, &whoamI);
	printf("LSM6DS3TR-C_ID=0x%x,whoamI=0x%x",LSM6DS3TR_C_ID,whoamI);
  if ( whoamI != LSM6DS3TR_C_ID )
    while (1); /*manage here device not found */

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

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



  /* Enable Block Data Update */
  lsm6ds3tr_c_block_data_update_set(&dev_ctx, PROPERTY_ENABLE);
  /* Set Output Data Rate */
  lsm6ds3tr_c_xl_data_rate_set(&dev_ctx, LSM6DS3TR_C_XL_ODR_52Hz);
  lsm6ds3tr_c_gy_data_rate_set(&dev_ctx, LSM6DS3TR_C_GY_ODR_52Hz);
  /* Set full scale */
  lsm6ds3tr_c_xl_full_scale_set(&dev_ctx, LSM6DS3TR_C_2g);
  lsm6ds3tr_c_gy_full_scale_set(&dev_ctx, LSM6DS3TR_C_2000dps);
  /* Configure filtering chain(No aux interface) */
  /* Accelerometer - analog filter */
//  lsm6ds3tr_c_xl_filter_analog_set(&dev_ctx,
//                                   LSM6DS3TR_C_XL_ANA_BW_400Hz);
  /* Accelerometer - LPF1 path ( LPF2 not used )*/
  //lsm6ds3tr_c_xl_lp1_bandwidth_set(&dev_ctx, LSM6DS3TR_C_XL_LP1_ODR_DIV_4);
  /* Accelerometer - LPF1 + LPF2 path */
//  lsm6ds3tr_c_xl_lp2_bandwidth_set(&dev_ctx,
//                                   LSM6DS3TR_C_XL_LOW_NOISE_LP_ODR_DIV_100);
  /* Accelerometer - High Pass / Slope path */
  //lsm6ds3tr_c_xl_reference_mode_set(&dev_ctx, PROPERTY_DISABLE);
  //lsm6ds3tr_c_xl_hp_bandwidth_set(&dev_ctx, LSM6DS3TR_C_XL_HP_ODR_DIV_100);
  /* Gyroscope - filtering chain */
//  lsm6ds3tr_c_gy_band_pass_set(&dev_ctx,
//                               LSM6DS3TR_C_HP_260mHz_LP1_STRONG);



	MX_AccelerometerCalibration_Init();
  /* USER CODE END 2 */

六位置法的标定方案

本文在校准三轴加速度计时使用六位置校准法,该方法使用地球的重力力加速度在静态下校准三轴加速度传感器,具体的校准过程如下图所示。具体校准过程如下:

  1. 将传感器的Y轴垂直水平面向下;
  2. 以X轴为基准轴,绕其逆旋转90°,使乙轴垂直水平面向上
  3. 以Y轴为基准轴,绕其逆旋转90°,使X轴垂直水平面向下
  4. 以Y轴为基准轴,绕其逆时针旋转90°使2轴垂直水平面向下
  5. 绕Y轴逆时针旋转909、使X轴垂直水平面向上
  6. 绕Z轴顺时针旋转90°、使Y轴垂直水平面向上

在这里插入图片描述

在没有精密设备的情况下。这种方法基本上是在试图找到每个轴的偏移(zero-g offset)和灵敏度(scale factor)。这种方法通常称为静态校准方法,因为它不需要动态输入,只需将设备置于静态的已知方向即可。

主函数

  /* Infinite loop */
  /* USER CODE BEGIN WHILE */
  while (1)
  {
    /* Read output only if new value is available */
    lsm6ds3tr_c_reg_t reg;
    lsm6ds3tr_c_status_reg_get(&dev_ctx, &reg.status_reg);

    if (reg.status_reg.xlda) {
      /* Read magnetic field data */
      memset(data_raw_acceleration, 0x00, 3 * sizeof(int16_t));
      lsm6ds3tr_c_acceleration_raw_get(&dev_ctx,
                                       data_raw_acceleration);
      acceleration_mg[0] = lsm6ds3tr_c_from_fs2g_to_mg(
                             data_raw_acceleration[0]);
      acceleration_mg[1] = lsm6ds3tr_c_from_fs2g_to_mg(
                             data_raw_acceleration[1]);
      acceleration_mg[2] = lsm6ds3tr_c_from_fs2g_to_mg(
                             data_raw_acceleration[2]);
      printf("Acceleration [mg]:%4.2f\t%4.2f\t%4.2f\r\n",
              acceleration_mg[0], acceleration_mg[1], acceleration_mg[2]);
			AC_Data_Handler();
    }

//    if (reg.status_reg.gda) {
//      /* Read magnetic field data */
//      memset(data_raw_angular_rate, 0x00, 3 * sizeof(int16_t));
//      lsm6ds3tr_c_angular_rate_raw_get(&dev_ctx,
//                                       data_raw_angular_rate);
//      angular_rate_mdps[0] = lsm6ds3tr_c_from_fs2000dps_to_mdps(
//                               data_raw_angular_rate[0]);
//      angular_rate_mdps[1] = lsm6ds3tr_c_from_fs2000dps_to_mdps(
//                               data_raw_angular_rate[1]);
//      angular_rate_mdps[2] = lsm6ds3tr_c_from_fs2000dps_to_mdps(
//                               data_raw_angular_rate[2]);
//      printf("Angular rate [mdps]:%4.2f\t%4.2f\t%4.2f\r\n",
//              angular_rate_mdps[0], angular_rate_mdps[1], angular_rate_mdps[2]);
//    }

//    if (reg.status_reg.tda) {
//      /* Read temperature data */
//      memset(&data_raw_temperature, 0x00, sizeof(int16_t));
//      lsm6ds3tr_c_temperature_raw_get(&dev_ctx, &data_raw_temperature);
//      temperature_degC = lsm6ds3tr_c_from_lsb_to_celsius(
//                           data_raw_temperature );
//      printf("Temperature [degC]:%6.2f\r\n",
//              temperature_degC );

//    }
		
		
    /* USER CODE END WHILE */

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

演示

在未执行六位置校准法时,Calibration不为3。

在这里插入图片描述

X轴向下。

在这里插入图片描述

X轴向上。

在这里插入图片描述

Y轴向下。

在这里插入图片描述

Y轴向上。

在这里插入图片描述
Z轴向下。
在这里插入图片描述

Z轴向上。

在这里插入图片描述

校准完毕Calibration=3

在这里插入图片描述

  • 8
    点赞
  • 20
    收藏
    觉得还不错? 一键收藏
  • 打赏
    打赏
  • 0
    评论
LSM6DS3TR-C是一种集成了加速度计和陀螺仪功能的传感器芯片,可以用于实现运动检测数据采集。为了实现高效运动检测,我们可以采取以下措施: 首先,我们需要配置传感器的寄存器以适应我们的要求。我们可以使用芯片手册提供的配置寄存器的详细信息来设置传感器的采样率、灵敏度等参数。通过设置适当的参数,我们可以提高运动检测的准确性和灵敏度。 其次,为了高效地进行数据采集,我们可以使用中断机制来触发数据采集的操作。传感器芯片支持外部中断引脚,我们可以将其连接到微控制器或处理器的中断引脚上。当传感器检测运动或达到预设的数据阈值时,会触发中断,然后我们的程序可以立即进行相应的数据采集操作,而无需轮询传感器。 此外,我们还可以利用传感器芯片提供的FIFO(First In First Out)缓冲区来存储传感器数据。FIFO缓冲区可以在传感器运动数据的采样过程中,按先进先出的原则存储数据。这样,我们可以在传感器检测运动后立即进行数据采集,并且可以在适当的时候通过读取FIFO缓冲区中的数据来进行后续的处理和分析。 最后,为了实现高效数据采集和处理,我们可以利用传感器芯片提供的SPI或I2C接口与微控制器或处理器进行通信。通过使用这些接口,我们可以快速地将传感器数据传输到微控制器或处理器,并进行实时的数据处理和分析。 综上所述,驱动LSM6DS3TR-C实现高效运动检测数据采集的关键在于合理配置传感器参数、利用中断机制触发数据采集、利用FIFO缓冲区存储数据以及利用SPI或I2C接口进行高速数据传输和处理。通过这些措施,我们可以有效地实现高效运动检测数据采集的功能。
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

打赏作者

记帖

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

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

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

打赏作者

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

抵扣说明:

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

余额充值