陀螺仪LSM6DSOW开发(2)----上报匿名上位机实现可视化

记帖

已于 2024-10-11 09:42:24 修改

阅读量1.4w

点赞数 21

分类专栏：单片机传感器 stm32cube 文章标签： stm32cubemx LSM6DSOW 陀螺仪匿名上位机欧拉角角速度 mems

于 2024-07-23 09:10:40 首次发布

本文链接：https://blog.csdn.net/qq_24312945/article/details/140625660

版权

单片机同时被 3 个专栏收录

309 篇文章

订阅专栏

stm32cube

188 篇文章

订阅专栏

传感器

135 篇文章

订阅专栏

陀螺仪LSM6DSOW开发.2--上报匿名上位机实现可视化

概述
视频教学
样品申请
源码下载
硬件准备
参考坐标系
加速度计工作方式
上位机通讯
加速度演示
加速度曲线显示
陀螺仪工作方式
上报源码
演示

概述

本文档详细介绍了如何使用匿名助手的上位机实现加速度计和陀螺仪数据的可视化显示。内容涵盖了加速度计和陀螺仪的工作原理、上位机通信协议、数据处理流程以及具体的代码实现。通过本文档，读者可以了解如何通过串口通讯协议将传感器数据发送到上位机，并进行实时的曲线显示和数据分析。

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

在这里插入图片描述

视频教学

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

陀螺仪LSM6DSOW开发(2)----上报匿名上位机实现可视化

样品申请

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

源码下载

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

硬件准备

首先需要准备一个开发板，这里我准备的是自己绘制的开发板，需要的可以进行申请。
主控为STM32H503CB，陀螺仪为LSM6DSOW，磁力计为LIS2MDL。

在这里插入图片描述

参考坐标系

在这里插入图片描述

加速度计工作方式

假设立方体在外太空，那里的一切都是失重的，球会简单地漂浮在立方体的中心。

在这里插入图片描述

现在，假设每面墙代表一个特定的轴。
如果我们突然以 1g 的加速度向左移动盒子（单个 G 力 1g 相当于重力加速度 9.8 m/s 2），球无疑会撞到墙壁 X。如果我们测量球对墙壁施加的力X，我们可以得到沿X轴的输出值为1g。

在这里插入图片描述

让我们看看当我们把那个立方体放在地球上时会发生什么。球将简单地落在墙 Z 上，施加 1g 的力，如下图所示：

在这里插入图片描述

在这种情况下，盒子没有移动，但我们仍然在 Z 轴上得到 1g 的读数。这是因为重力（实际上是加速度的一种形式）以 1g 的力向下拉球。
虽然此模型并不完全代表真实世界的加速度计传感器是如何构建的，但它通常有助于理解为什么加速度计的输出信号通常以 ±g 为单位指定，或者为什么加速度计在静止时在 z 轴上读数为 1g，或者您可以在不同方向上获得什么样的加速度计读数。

上位机通讯

这里使用的是匿名助手的上位机
https://gitee.com/anotc/AnoAssistant
有专门的通讯协议

在这里插入图片描述

串口通讯协议格式如下所示，需要注意传输为小端模式传输。
在这里插入图片描述

对应的源地址和目标地址分别为0xFD和0xFE。

在这里插入图片描述

我们只需要上报加速度和陀螺仪数据，所以功能码为0x01，数据长度为0x0D，需要主要为小端模式传输。

在这里插入图片描述

加速度演示

实测移动模块分别为X、Y、Z轴向下，可以看见数值基本上为1000mg。

在这里插入图片描述

加速度曲线显示

设置数据列表->添加波形，可以添加加速度或者角速度曲线
在这里插入图片描述

可以通过右下角设置具体显示。
在这里插入图片描述

陀螺仪工作方式

加速度计测量线性加速度，而陀螺仪测量角旋转。为此，他们测量了科里奥利效应产生的力。
陀螺仪是一种运动传感器，能够感测物体在一轴或多轴上的旋转角速度。它能够精确地感测自由空间中复杂的移动动作，因此成为追踪物体移动方位和旋转动作的必要设备。与加速计和电子罗盘不同，陀螺仪不需要依赖外部力量（如重力或磁场），可以自主地发挥其功能。因此，从理论上讲，只使用陀螺仪就可以完成姿态导航的任务。

在这里插入图片描述

陀螺仪的每个通道检测一个轴的旋转。也就是说陀螺仪通过测量自身的旋转状态，判断出设备当前运动状态，是向前、向后、向上、向下、向左还是向右呢，是加速（角速度）还是减速（角速度）呢，都可以实现，但是要判断出设备的方位（东西南北），陀螺仪就没有办法。

在这里插入图片描述

MEMS陀螺仪主要利用科里奥利力（旋转物体在有径向运动时所受到的切向力）原理，公开的微机械陀螺仪均采用振动物体传感角速度的概念，利用振动来诱导和探测科里奥利力。
MEMS陀螺仪的核心是一个微加工机械单元，在设计上按照一个音叉机制共振运动，通过科里奥利力原理把角速率转换成一个特定感测结构的位移。

在这里插入图片描述

两个相同的质量块以方向相反的做水平震荡。当外部施加一个角速率，就会出现一个科氏力，力的方向垂直于质量运动方向，如垂直方向箭头所示。产生的科氏力使感测质量发生位移，位移大小与所施加的角速率大小成正比，科氏力引起的电容变化即可计算出角速率大小。
科里奥利效应指出，当质量 (m) 以速度 (v) 沿特定方向移动并施加外部角速率 (Ω)（红色箭头）时，科里奥利效应会产生一个力（黄色箭头），导致质量垂直移动。该位移的值与应用的角速率直接相关。

在这里插入图片描述

上报源码

  /* 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);
	
	
  stmdev_ctx_t dev_ctx;
  /* Initialize mems driver interface */
  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 */
  lsm6dso_device_id_get(&dev_ctx, &whoamI);
	printf("LSM6DSO_ID=0x%x,whoamI=0x%x",LSM6DSO_ID,whoamI);
  if (whoamI != LSM6DSO_ID)
    while (1);

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

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

  /* Disable I3C interface */
  lsm6dso_i3c_disable_set(&dev_ctx, LSM6DSO_I3C_DISABLE);
  /* Enable Block Data Update */
  lsm6dso_block_data_update_set(&dev_ctx, PROPERTY_ENABLE);
  /* Set Output Data Rate */
  lsm6dso_xl_data_rate_set(&dev_ctx, LSM6DSO_XL_ODR_52Hz);
  lsm6dso_gy_data_rate_set(&dev_ctx, LSM6DSO_GY_ODR_52Hz);
  /* Set full scale */
  lsm6dso_xl_full_scale_set(&dev_ctx, LSM6DSO_2g);
  lsm6dso_gy_full_scale_set(&dev_ctx, LSM6DSO_2000dps);
  /* Configure filtering chain(No aux interface)
   * Accelerometer - LPF1 + LPF2 path
   */
  lsm6dso_xl_hp_path_on_out_set(&dev_ctx, LSM6DSO_LP_ODR_DIV_100);
  lsm6dso_xl_filter_lp2_set(&dev_ctx, PROPERTY_ENABLE);
	
	
	int16_t	acc_int16[3]	={0,0,0};
	int16_t	gyr_int16[3]		={0,0,0};	
	float acc[3] = {0};
	float gyr[3] = {0};
	uint8_t data[21]={0};
	data[0]=0xAB;//帧头
	data[1]=0xFD;//源地址
	data[2]=0xFE;//目标地址		
	data[3]=0x01;//功能码ID	
	data[4]=0x0D;//数据长度LEN
	data[5]=0x00;//数据长度LEN 13

uint8_t sumcheck = 0;
uint8_t addcheck = 0;	
	
  /* USER CODE END 2 */
    /* Infinite loop */
  /* USER CODE BEGIN WHILE */
  while (1)
  {
		
    uint8_t reg;
    /* Read output only if new xl value is available */
    lsm6dso_xl_flag_data_ready_get(&dev_ctx, &reg);

    if (reg) {
      /* Read acceleration field data */
      memset(data_raw_acceleration, 0x00, 3 * sizeof(int16_t));
      lsm6dso_acceleration_raw_get(&dev_ctx, data_raw_acceleration);
      acceleration_mg[0] =
        lsm6dso_from_fs2_to_mg(data_raw_acceleration[0]);
      acceleration_mg[1] =
        lsm6dso_from_fs2_to_mg(data_raw_acceleration[1]);
      acceleration_mg[2] =
        lsm6dso_from_fs2_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]);
		//匿名上位机
		acc_int16[0]=(int16_t)(acceleration_mg[0]);
		acc_int16[1]=(int16_t)(acceleration_mg[1]);		
		acc_int16[2]=(int16_t)(acceleration_mg[2]);	
    }

    lsm6dso_gy_flag_data_ready_get(&dev_ctx, &reg);

    if (reg) {
      /* Read angular rate field data */
      memset(data_raw_angular_rate, 0x00, 3 * sizeof(int16_t));
      lsm6dso_angular_rate_raw_get(&dev_ctx, data_raw_angular_rate);
      angular_rate_mdps[0] =
        lsm6dso_from_fs2000_to_mdps(data_raw_angular_rate[0]);
      angular_rate_mdps[1] =
        lsm6dso_from_fs2000_to_mdps(data_raw_angular_rate[1]);
      angular_rate_mdps[2] =
        lsm6dso_from_fs2000_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]);
		gyr_int16[0]=(int16_t)(angular_rate_mdps[0]/1000);		
		gyr_int16[1]=(int16_t)(angular_rate_mdps[1]/1000);	
		gyr_int16[2]=(int16_t)(angular_rate_mdps[2]/1000);	
    }

//    lsm6dso_temp_flag_data_ready_get(&dev_ctx, &reg);

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

//    }		



		data[7]=acc_int16[0]>>8;//ACC_X
		data[6]=acc_int16[0];
		data[9]=acc_int16[1]>>8;//ACC_Y
		data[8]=acc_int16[1];
		data[11]=acc_int16[2]>>8;//ACC_Z
		data[10]=acc_int16[2];
		
		data[13]=gyr_int16[0]>>8;//GYR_X 
		data[12]=gyr_int16[0];		
		data[15]=gyr_int16[1]>>8;//GYR_Y 
		data[14]=gyr_int16[1];			
		data[17]=gyr_int16[2]>>8;//GYR_Z 
		data[16]=gyr_int16[2];	
		
		data[18]=0;	

sumcheck = 0;
addcheck = 0;
for(uint16_t i=0; i < 19; i++)
{
sumcheck += data[i]; //从帧头开始，对每一字节进行求和，直到 DATA 区结束
addcheck += sumcheck; //每一字节的求和操作，进行一次 sumcheck 的累加
}
data[19]=sumcheck;
data[20]=addcheck;
      
	HAL_UART_Transmit(&huart1 , (uint8_t *)&data, 21, 0xFFFF);


HAL_Delay(10);




		
    /* USER CODE END WHILE */

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