VL53L8CX小板开发(5)----运动阈值检测

概述

本章目的是展示如何充分利用VL53L8CX传感器的高级特性,通过结合运动指示器和阈值检测功能,实现对特定场景的精确监控。首先,程序通过特定的配置,确保了传感器能够在特定的分辨率下工作,同时还可调整用于检测运动的最小和最大距离。其次,一旦在传感器的视野中检测到运动,并且该运动的强度超出了预先设置的阈值,那么这种情况将被认为是一个有效的运动事件。最后,该程序不仅会捕获这些事件,还会详细地显示相关的数据,如运动发生在哪个区域,以及运动的强度如何。这种结合使用多种功能的方法,使得VL53L8CX传感器在各种应用场景中都能提供高效、准确的运动检测结果。
最近在弄ST的课程,需要样片的可以加群申请:615061293 。在这里插入图片描述

视频教学

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

VL53L8CX小板开发(5)----运动阈值检测

样品申请

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

在这里插入图片描述

源码下载

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

硬件准备

首先需要准备一个开发板,这里我准备的是自己绘制的开发板,需要的可以进行申请。
主控为STM32H503CBT6,TOF为VL53L8CX
在这里插入图片描述

生成STM32CUBEMX

用STM32CUBEMX生成例程,这里使用MCU为STM32H503CB。
配置时钟树,配置时钟为250M。
在这里插入图片描述

串口配置

查看原理图,PA9和PA10设置为开发板的串口。

在这里插入图片描述
配置串口,速率为921600。

在这里插入图片描述

IIC配置

在这个应用中,VL53L8CX模块通过I2C(IIC)接口与主控器通信。具体来说,VL53L8CX模块的I2C引脚连接到主控器的PB6和PB7两个IO口。

在这里插入图片描述
在这里插入图片描述

配置IIC为快速模式,速度为400k。

在这里插入图片描述

LPn 设置

若进行IIC通讯,LPn设置为高电平状态。

在这里插入图片描述

这里对应管脚为PB0。

在这里插入图片描述

在这里插入图片描述
在这里插入图片描述

INT设置

自主模式可以通过获取INT管脚进行判断数据是否准备好。

在这里插入图片描述
在这里插入图片描述

配置PB1为输入模式。

在这里插入图片描述

X-CUBE-TOF1

本节介绍在不需要使用样例应用时如何使用STM32CubeMX将X-CUBE-TOF1软件包添加到项目中。有了这样的设置,就只配置了驱动层。

在这里插入图片描述

堆栈设置

在这里插入图片描述

若无法正常运行需要修改优化等级。

在这里插入图片描述

串口重定向

打开魔术棒,勾选MicroLIB
在这里插入图片描述

代码配置

在custom_ranging_sensor.c代码中,有IO口驱动VL53L8CX进行复位的代码,由于没有配置对应的IO,所以需要注释掉。

在这里插入图片描述

检测流程

  1. 初始化变量:
    ○ 创建相关变量,如状态(status)、运动配置(motion_config)、设备对象(pL5obj)和结果数据(Results)。
  2. 配置运动指示器:
    ○ 使用8x8的分辨率初始化运动指示器。
    ○ 设置用于检测运动的最小和最大距离(在这里,是设置为1000mm到2000mm)。
    ○ 如果用户需要改变分辨率,他也需要更新运动指示器的分辨率(代码中此部分被注释掉了)。
  3. 设备配置:
    ○ 设置设备的分辨率为8x8。
    ○ 将设备设置为自主测距模式。
    ○ 设置测距频率为2Hz。
    ○ 设置集成时间为10ms以降低功耗。
  4. 配置检测阈值:
    ○ 对于8x8的分辨率,我们希望每个区域有一个阈值。
    ○ 初始化阈值数组。
    ○ 为所有64个区域设置阈值,当运动指示器的值超过44时,将其视为运动。
    ○ 将阈值数组发送到传感器。
    ○ 启用检测阈值。
  5. 开始测距:
    ○ 启动传感器的测距功能。
    ○ 输出消息,等待在1m到2m之间的视野中有运动发生。
  6. 无限循环监测:
    ○ 不断检查数据是否准备好。
    ○ 如果数据准备好或者某个特定的GPIO引脚被按下,获取测距数据。
    ○ 因为传感器默认设置为8x8模式,所以有64个区域要打印。但这个例子中,只打印首个区域的数据。
    ○ 如果某个区域的运动指示器的值大于或等于44,打印该区域有运动发生的消息。
    通过上述流程,该程序能够检测并显示在预定距离范围内、运动强度超过预定阈值的运动情况。

TOF代码配置

在main.c中添加对应头文件。

/* USER CODE BEGIN Includes */
#include "stdio.h"

#include "custom_ranging_sensor.h"
#include "vl53l8cx_plugin_motion_indicator.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 */

添加TOF初始化。
主要为配置运动指示器。

  /* USER CODE BEGIN 2 */

	uint8_t 				status, isReady, i;
	VL53L8CX_Motion_Configuration 	motion_config;	/* 运动配置 */
	VL53L8CX_Object_t *pL8obj = CUSTOM_RANGING_CompObj[CUSTOM_VL53L8CX];
	VL53L8CX_ResultsData 	Results;		/* 来自VL53L8CX的结果数据 */

	/*********************************/
	/*   配置运动指示器               */
	/*********************************/

	/* 使用4x4分辨率初始化运动指示器 */
	status = vl53l8cx_motion_indicator_init(&pL8obj->Dev, &motion_config, VL53L8CX_RESOLUTION_8X8);
	if(status)
	{
		printf("运动指示器初始化失败,状态码 : %u\n", status);
		return status;
	}

	/* (可选) 设置用于检测运动的最小和最大距离。注意距离的限制 */
	status = vl53l8cx_motion_indicator_set_distance_motion(&pL8obj->Dev, &motion_config, 1000, 2000);
	if(status)
	{
		printf("设置运动检测距离失败,状态码 : %u\n", status);
		return status;
	}

	/* 如果用户需要更改分辨率,则也需要更新运动指示器的分辨率(此部分已注释) */
	//status = vl53l5cx_set_resolution(&Dev, VL53L5CX_RESOLUTION_4X4);
	//status = vl53l5cx_motion_indicator_set_resolution(&Dev, &motion_config, VL53L5CX_RESOLUTION_4X4);

	/* 将设备设置为自主模式,并设置较小的集成时间以降低功耗 */
	status = vl53l8cx_set_resolution(&pL8obj->Dev, VL53L8CX_RESOLUTION_8X8);
	status = vl53l8cx_set_ranging_mode(&pL8obj->Dev, VL53L8CX_RANGING_MODE_AUTONOMOUS);
	status = vl53l8cx_set_ranging_frequency_hz(&pL8obj->Dev, 2);
	status = vl53l8cx_set_integration_time_ms(&pL8obj->Dev, 10);	
	

	/*********************************/
	/*   配置检测阈值                 */
	/*********************************/

	/* 对于8x8的分辨率,我们希望为每个区域设置一个阈值 */
	VL53L8CX_DetectionThresholds thresholds[VL53L8CX_NB_THRESHOLDS];

	/* 将所有阈值设置为0 */
	memset(&thresholds, 0, sizeof(thresholds));

	/* 为所有64个区域设置阈值 */
	for(i = 0; i < 64; i++){
		thresholds[i].zone_num = i;
		thresholds[i].measurement = VL53L8CX_MOTION_INDICATOR;
		thresholds[i].type = VL53L8CX_GREATER_THAN_MAX_CHECKER;
		thresholds[i].mathematic_operation = VL53L8CX_OPERATION_NONE;

		/* 示例值44,超过此值的运动将被认为是移动 */
		thresholds[i].param_low_thresh = 44;
		thresholds[i].param_high_thresh = 44;
	}

	/* 明确标记最后一个阈值。因为我们有64个检查器,所以最后一个是第63个 */
	thresholds[63].zone_num = VL53L8CX_LAST_THRESHOLD | thresholds[63].zone_num;

	/* 将阈值数组发送到传感器 */
	vl53l8cx_set_detection_thresholds(&pL8obj->Dev, thresholds);

	/* 启用检测阈值 */
	vl53l8cx_set_detection_thresholds_enable(&pL8obj->Dev, 1);	


	/* 开始测距 */
	status = vl53l8cx_start_ranging(&pL8obj->Dev);
	printf("等待在1m和2m之间的视场中发生的运动...\n");	
  /* USER CODE END 2 */

主程序

主程序来获取对应的isReady位状态来判定数据是否准备好或者判断INT的IO状态也可。

  /* Infinite loop */
  /* USER CODE BEGIN WHILE */
  while (1)
  {
	if(HAL_GPIO_ReadPin  ( GPIOA, GPIO_PIN_11) ==0)		
	{
		status = vl53l8cx_check_data_ready(&pL8obj->Dev, &isReady);			
		if(isReady)
		{
			/* 获取测距数据 */
			vl53l8cx_get_ranging_data(&pL8obj->Dev, &Results);

			/* 默认情况下,传感器设置为8x8模式,因此我们有64个区域的数据。
			   但在此示例中,只打印了第一个区域的数据 */
			for(i = 0; i < 64; i++)
			{
				if(Results.motion_indicator.motion[motion_config.map_id[i]] >= 44)
				{
					printf(" 在这个区域检测到运动 : %3d !\n", i);
				}
			}
			printf("\n");
		}		
	}
    /* USER CODE END WHILE */

//  MX_TOF_Process();
    /* USER CODE BEGIN 3 */
  }
  /* USER CODE END 3 */

演示结果

检测运动情况下运动强度如下所示。

在这里插入图片描述

内容概要:本文围绕可变桨叶四旋翼无人机的规范控制与点对点运动模拟展开,重点研究优化推力分配策略在翻转动作中的应用与性能比较。通过Matlab代码实现,构建了四旋翼动力学模型,并设计了多种控制算法以实现精确的姿态调整与轨迹跟踪。研究对比了不同推力分配方案在执行高机动性翻转动作时的稳定性、能耗效率与响应速度,旨在提升无人机在复杂飞行任务中的动态性能与控制精度。该仿真研究为无人机飞控系统的设计与优化提供了理论依据和技术支持。; 适合人群:具备一定自动控制理论基础和Matlab编程能力,从事无人机控制、飞行器动力学或机器人系统研究的科研人员及研究生。; 使用场景及目标:① 实现四旋翼无人机在三维空间中的精确点对点运动控制;② 对比分析不同推力分配策略在执行翻转等高难度动作时的控制效果与能耗表现,优化飞行性能;③ 为无人机自主飞行、特技飞行及复杂环境下的机动控制提供算法验证平台。; 阅读建议:此资源以Matlab仿真为核心,建议读者结合相关控制理论知识,深入理解代码实现细节,重点关注动力学建模、控制律设计与推力分配模块。在学习过程中,应动手调试参数,复现文中翻转动作的仿真结果,并尝试拓展至其他复杂飞行任务,以加深对无人机控制机理的理解。
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

打赏作者

记帖

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

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

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

打赏作者

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

抵扣说明:

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

余额充值