stm32利用TOFSense模块测距教程

最新推荐文章于 2025-03-09 10:03:02 发布
最新推荐文章于 2025-03-09 10:03:02 发布
阅读量4.5k 收藏 76
点赞数 11
文章标签： stm32 单片机 嵌入式
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/weixin_51426754/article/details/119282934
版权

stm32利用TOFSense模块测距教程

TOFSense是什么

简单来讲，TOFSense就是一个激光测距模块，它前面那个小小的黑框框就是它测距的地方即发射激光的地方。它有两种通讯方式：串口和can总线，有两种工作模式：主动输出和查询输出。本文将基于stm32介绍它的串口主动输出模式。

编写程序的准备

官网有两份关于它的资料，一份是数据手册，主要介绍产品本身特性及数据，如典型规格、机械尺寸、配置与功能、典型数据表现及通信协议等；一份是用户手册，主要用于指导用户上手操作，含括了通过NAssistant配置模块的示例教程、协议解析示例等方面。如果只是想快速上手并利用它测距的话，直接看用户手册的部分即可。既然知道了它是串口通信，那么我们只需要知道它的数据帧的格式，然后编写相应的数据解析程序即可。

翻阅手册得知其数据帧的格式如下：

由上图可见，TOFSense在使用串口通信时，发的一个数据帧是16个字节。其中第一个字节是帧头，固定为0x57，而最后一个字节是帧尾，也是整个数据的校验和，其值为前面所有字节相加。而其中有效的距离数据为8、9、10三个字节的数据，其他的数据如果不用刻意忽略。这里我们得到的只是距离值的协议表示即16进制的数据，该怎么计算实际的距离值呢？手册里面还有一段话：

知道了这些，我们便可以编写串口的接收程序了。

程序源码

这里我使用的是正点原子的stm32f1核心板，用串口2接收TOFSense传来的数据，并利用串口1发给电脑在电脑的串口助手显示。如果使用其他f1的板子，程序基本是不用修改的；如果使用其他的串口，改串口的初始化程序为对应的端口即引脚即可。我这里基本把所有的程序代码都贴出来了，直接拿来用即可。

usart.h的编写：

#ifndef __USART_H
#define __USART_H
#include "stdio.h"	
#include "sys.h" 

#define USART_REC_LEN  			200  	//定义最大接收字节数 200
#define EN_USART1_RX 			1		//使能（1）/禁止（0）串口1接收
#define EN_USART2_RX      1   //使能（1）/禁止（0）串口2接收
	  	
extern u8  USART_RX_BUF[USART_REC_LEN]; //串口1接收缓冲,最大USART_REC_LEN个字节.末字节为换行符 
extern u16 USART_RX_STA;         		//串口1接收状态标记	

extern u8 USART_RX_BUF[USART_REC_LEN]; //串口2接收缓冲,最大USART_REC_LEN个字节
extern u16 USART2_RX_STA;     //串口2接收状态标记

extern u32 Active_Distance;  

//如果想串口中断接收，请不要注释以下宏定义
void uart_init(u32 bound);
void uart2_init(u32 bound);
#endif

usart.c的编写：

#include "sys.h"
#include "usart.h"	  
 
//如果使用ucos,则包括下面的头文件即可.
#if SYSTEM_SUPPORT_OS
#include "includes.h"					//ucos 使用	  
#endif

//加入以下代码,支持printf函数,而不需要选择use MicroLIB	  
#if 1
#pragma import(__use_no_semihosting)             
//标准库需要的支持函数                 
struct __FILE 
{ 
	int handle; 

}; 

FILE __stdout;       
//定义_sys_exit()以避免使用半主机模式    
void _sys_exit(int x) 
{ 
	x = x; 
} 
//重定义fputc函数 
int fputc(int ch, FILE *f)
{      
	while((USART1->SR&0X40)==0);//循环发送,直到发送完毕   
    USART1->DR = (u8) ch;      
	return ch;
}
#endif 

 
#if EN_USART1_RX   //如果使能了串口1接收
//串口1中断服务程序
//注意,读取USARTx->SR能避免莫名其妙的错误   	
u8 USART_RX_BUF[USART_REC_LEN];     //串口1接收缓冲,最大USART_REC_LEN个字节.
//接收状态
//bit15，	接收完成标志
//bit14，	接收到0x0d
//bit13~0，	接收到的有效字节数目
u16 USART_RX_STA=0;       //串口1接收状态标记	  
  
void uart_init(u32 bound)
{
	//GPIO端口设置
	GPIO_InitTypeDef GPIO_InitStructure;
	USART_InitTypeDef USART_InitStructure;
	NVIC_InitTypeDef NVIC_InitStructure;

	RCC_APB2PeriphClockCmd(RCC_APB2Periph_USART1|RCC_APB2Periph_GPIOA, ENABLE);	//使能USART1，GPIOA时钟

	//USART1_TX   GPIOA.9
	GPIO_InitStructure.GPIO_Pin = GPIO_Pin_9; //PA.9
	GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
	GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;	//复用推挽输出
	GPIO_Init(GPIOA, &GPIO_InitStructure);//初始化GPIOA.9

	//USART1_RX	  GPIOA.10初始化
	GPIO_InitStructure.GPIO_Pin = GPIO_Pin_10;//PA10
	GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN_FLOATING;//浮空输入
	GPIO_Init(GPIOA, &GPIO_InitStructure);//初始化GPIOA.10  

	//Usart1 NVIC 配置
	NVIC_InitStructure.NVIC_IRQChannel = USART1_IRQn;
	NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority=3 ;//抢占优先级3
	NVIC_InitStructure.NVIC_IRQChannelSubPriority = 3;		//子优先级3
	NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;			//IRQ通道使能
	NVIC_Init(&NVIC_InitStructure);	//根据指定的参数初始化VIC寄存器

	//USART 初始化设置

	USART_InitStructure.USART_BaudRate = bound;//串口波特率
	USART_InitStructure.USART_WordLength = USART_WordLength_8b;//字长为8位数据格式
	USART_InitStructure.USART_StopBits = USART_StopBits_1;//一个停止位
	USART_InitStructure.USART_Parity = USART_Parity_No;//无奇偶校验位
	USART_InitStructure.USART_HardwareFlowControl = USART_HardwareFlowControl_None;//无硬件数据流控制
	USART_InitStructure.USART_Mode = USART_Mode_Rx | USART_Mode_Tx;	//收发模式

  USART_Init(USART1, &USART_InitStructure); //初始化串口1
  USART_ITConfig(USART1, USART_IT_RXNE, ENABLE);//开启串口接受中断
  USART_Cmd(USART1, ENABLE);                    //使能串口1 

}

void USART1_IRQHandler(void)                	//串口1中断服务程序
{
	u8 Res;
#if SYSTEM_SUPPORT_OS 		//如果SYSTEM_SUPPORT_OS为真，则需要支持OS.
	OSIntEnter();    
#endif
	if(USART_GetITStatus(USART1, USART_IT_RXNE) != RESET)  //接收中断(接收到的数据必须是0x0d 0x0a结尾)
		{
		Res =USART_ReceiveData(USART1);	//读取接收到的数据
		
		if((USART_RX_STA&0x8000)==0)//接收未完成
			{
			if(USART_RX_STA&0x4000)//接收到了0x0d
				{
				if(Res!=0x0a)USART_RX_STA=0;//接收错误,重新开始
				else USART_RX_STA|=0x8000;	//接收完成了 
				}
			else //还没收到0X0D
				{	
				if(Res==0x0d)USART_RX_STA|=0x4000;
				else
					{
					USART_RX_BUF[USART_RX_STA&0X3FFF]=Res ;
					USART_RX_STA++;
					if(USART_RX_STA>(USART_REC_LEN-1))USART_RX_STA=0;//接收数据错误,重新开始接收	  
					}		 
				}
			}   		 
     } 	
#if SYSTEM_SUPPORT_OS 	//如果SYSTEM_SUPPORT_OS为真，则需要支持OS.
	OSIntExit();  											 
#endif
} 
#endif

#if EN_USART2_RX //如果使能了串口2接收

u8 USART2_RX_BUF[USART_REC_LEN];     //串口2接收缓冲,最大USART_REC_LEN个字节.
u16 USART2_RX_STA=0;       //串口2接收状态标记
u32 Active_Distance;  //定义主动输出距离，单位mm

void uart2_init(u32 bound)
{
	//GPIO端口设置
	GPIO_InitTypeDef GPIO_InitStructure;
	USART_InitTypeDef USART_InitStructure;
	NVIC_InitTypeDef NVIC_InitStructure;

	RCC_APB1PeriphClockCmd(RCC_APB1Periph_USART2|RCC_APB2Periph_GPIOA, ENABLE);	//使能USART2，GPIOA时钟

	//USART2_TX   GPIOA.2
	GPIO_InitStructure.GPIO_Pin = GPIO_Pin_2; //PA.2
	GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
	GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;	//复用推挽输出
	GPIO_Init(GPIOA, &GPIO_InitStructure);//初始化GPIOA.2

	//USART2_RX	  GPIOA.3初始化
	GPIO_InitStructure.GPIO_Pin = GPIO_Pin_3;//PA3
	GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN_FLOATING;//浮空输入
	GPIO_Init(GPIOA, &GPIO_InitStructure);//初始化GPIOA.3  

	//Usart2 NVIC 配置
	NVIC_InitStructure.NVIC_IRQChannel = USART2_IRQn;
	NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority=2 ;//抢占优先级3
	NVIC_InitStructure.NVIC_IRQChannelSubPriority = 2;		//子优先级3
	NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;			//IRQ通道使能
	NVIC_Init(&NVIC_InitStructure);	//根据指定的参数初始化VIC寄存器

	//USART 初始化设置

	USART_InitStructure.USART_BaudRate = bound;//串口波特率
	USART_InitStructure.USART_WordLength = USART_WordLength_8b;//字长为8位数据格式
	USART_InitStructure.USART_StopBits = USART_StopBits_1;//一个停止位
	USART_InitStructure.USART_Parity = USART_Parity_No;//无奇偶校验位
	USART_InitStructure.USART_HardwareFlowControl = USART_HardwareFlowControl_None;//无硬件数据流控制
	USART_InitStructure.USART_Mode = USART_Mode_Rx | USART_Mode_Tx;	//收发模式

  USART_Init(USART2, &USART_InitStructure); //初始化串口2
  USART_ITConfig(USART2, USART_IT_RXNE, ENABLE);//开启串口接受中断
  USART_Cmd(USART2, ENABLE);                    //使能串口2

}

void USART2_IRQHandler(void)
{
	static u8 count = 0;
	u16 check_sum = 0; //定义校验和
	u8 i;
	static u8 flag = 0; //定义数据帧开始标志
	if(USART_GetITStatus(USART2,USART_IT_RXNE)!=RESET) //串口2接收中断
	{
		if(USART_ReceiveData(USART2) == 0x57) flag = 1;
		if(flag)
		{
			USART2_RX_BUF[count++] = USART_ReceiveData(USART2);
			
			if(count==16) //接收到一帧数据即16个字节
			{
				if(USART2_RX_BUF[0]==0x57)
				{
					for(i=0;i<15;i++)
					{
						check_sum = check_sum + USART2_RX_BUF[i];  //
					}
				}
				if((check_sum&0x00ff)==USART2_RX_BUF[15])  //判断校验和是否满足即数据的有效性
				{
					//协议帧中的数据是小端模式存储的,必须先恢复成16进制数据再换算成10进制
					Active_Distance = (USART2_RX_BUF[10] <<16| USART2_RX_BUF[9]<<8|USART2_RX_BUF[8]);  //除以1000即是m
				}
				count = 0;
				flag = 0;
			}
			
		}
	}
}

#endif

main.c的编写：

#include "sys.h"
#include "delay.h"
#include "usart.h"
 

int main(void)
{		
	 
	NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);//设置中断优先级分组为组2：2位抢占优先级，2位响应优先级
	delay_init();	    	 //延时函数初始化	  
	uart_init(115200);	 //串口初始化为115200
	uart2_init(921600);  //串口2初始化为921600
	printf("TOFSense开始测距，模式为主动输出模式\r\n");
  while(1)
	{
		//每200ms显示一次距离
		printf("测得的距离为：%d",Active_Distance);
		printf("mm\r\n");
		delay_ms(200);
	}	 
}

运行效果

需要注意一下，官方文档里面说的很清楚：

在短距模式下超量程时， 距离输出固定值-0.01， 十六进制 0xFFFFF6。
在中距模式下超量程时， 距离输出 1~2m 随机跳变。 此时可参考信号强度与距离状态进行判断。
在长距模式下超量程时， 数据输出 1~2m 随机跳变。 此时可参考信号强度与距离状态进行判断。

因此不要测太远的距离以免超出量程。此外我发现当把障碍物贴上去时测得的距离并不是0，这与市面上绝大多数的激光测距模块也是一致的，即它的测量是有一个上下限范围的，注意在范围内使用。

注

TOFSense默认的串口波特率是961200，如果需要修改，需要去官网下载配套的上位机，并利用USB-TTL模块连接TOFSense到电脑后打开上位机的配置界面修改，在此界面也可以很直观地看到数据及状态的信息。

官网地址：https://www.nooploop.com

清愁qc
关注
stm32测试TOFSense距离
11-20
stm32f103c8测试TOFSense距离，主要采用DMA传输数据。
激光测距模块简易测量(STM32F429).rar
09-09
STM32F429通过矩阵键盘控制激光测距模块，尚有诸多不足，欢迎各位大佬批评指教
【STM32实战项目】基于STM32的双路激光测距系统
最新发布
qq_45217381的博客
03-09 1113
本文介绍了基于STM32的双路激光测距系统设计，主要涉及到硬件选型和程序设计，给出了程序设计思路和业务函数设计。
【STM32训练—TOF激光测距模块】第一篇、STM32驱动TOF10120测量距离
热门推荐
大屁桃的博客
06-02 2万+
STM32调试TOF10120激光测距
TOF Sense激光测距模块的使用(stm32)
weixin_43889141的博客
02-01 8256
TOF Sense激光测距模块的使用(stm32) 2020年电子设计竞赛F题中用到了激光测距模块。我使用的是Tof-sense,其他的产品也是大同小异的，如下图： 该模块使用方式非常简单，与stm32有两种通信方式，一种是can,另一种是串口通信，这里采用串口通信，模块 的 TXD 连接stm32的 RXD，模块 的 RXD 连接stm32的 TXD。数据格式如下： 协议由 Frame Header（帧头）、Function Mark（功能字）、Data（数据）、Sum Check（校验和）组成。其中
STM32F103驱动VL53L0X激光测距模块
优信电子的博客
07-13 1万+
TOF 是飞行时间（Tlme of Flight）技术的缩写，即传感器发出经过调制的近红外光，遇到物体后反射，传感器通过计算光线发射和反射时间差或相位差，来换算被测量物体的距离。VL53L0X是新一代飞行时间（ToF）激光测距模块，无论目标反射率如何，都能提供精确的距离测量。它可以测量2m的绝对距离，为测距性能等级设定了新的基准。VL53L0X集成了一个领先的SPAD阵列（单光子雪崩二极管），并内嵌ST的第二代FlightSense™专利技术。
STM32F103实现激光测距传感器测距WT-VL53L0 L1
XiaoCaiDaYong的博客
10-28 7463
STM32F103实现激光测距传感器测距WT-VL53L0 L1
stm32 hal库 激光测距模块ToF 串口版本
08-01
在“STM32 HAL库 激光测距模块ToF 串口版本”这个项目中，我们将讨论如何利用HAL库与基于飞行时间（Time-of-Flight, ToF）原理的激光测距模块通过串行通信接口进行交互。 首先，ToF激光测距模块是利用光脉冲从发射...
STM32实现激光测距传感器测距WT-VL53L0 L1（标准库与HAL库实现）
10-28
STM32F103实现激光测距传感器测距WT-VL53L0 L1（标准库与HAL库实现） https://blog.csdn.net/XiaoCaiDaYong/article/details/127575373?spm=1001.2014.3001.5502
STM32超声波测距代码-HC-SR04.zip
10-06
这是基于STM32的超声波传感器测距小项目的硬件部分代码，采用UART传输，通过蓝牙传输至手机，在手机上使用app可获取数据。该项目的原理与介绍在博客https://blog.csdn.net/qq_36999901/article/details/87554277有...
stm32多路超声波模块测距（多路定时器输入捕获）
05-01
在本项目中，"stm32多路超声波模块测距（多路定时器输入捕获）"，我们将探讨如何使用STM32的硬件资源实现多通道超声波测距功能，主要依赖于STM32的定时器输入捕获功能。 超声波测距的基本原理是利用超声波发射和...
激光测距模块tof10120基于stm32f103开发板实现
10-27
tof10120激光模块最大的优势在于测距远、操作简单，程序中仅仅需要通过单片机给模块串口发送命令字符串，模块就可以向单片机发送回距离数据。如果发送自动测距的字符串命令，则模块会按照一定频率自动回送数据，相关物理量都可以通过命令字符串设置。仅需要串口就可以实现。
基于STM32的短距离激光测距仪设计.pdf
06-27
基于STM32的短距离激光测距仪设计.pdf
STM32_vl53l0x 激光 测距
09-14
一些说明： 1、从官方程序修改得到，在stm32105vc上测试ok，具体源码可从st官网获得。 2、采用i2c方式，pin配置文件在vl53l0x\platform\inc\stm32_i2c.h中配置。
激光测距模块tof10120基于stm32f103开发板实现 3串口操作（串口1用于和上位机通信，串口2，3可用来连接激光模块）
10-28
上次的程序由于串口2USART2.c文件里串口2中断函数对数据的处理中没有对0x0a和0x0D进行判断，因此只有串口一是可以正常用的，这次的程序我对串口2中断函数进行了修改，完全按照串口一的处理，同时保留了u2_printf函数可用于和单片机向测距模块传送字符串；另外按照相同的模式，扩展了串口三，也是串口一中断的方法，扩展了u3_printf函数。 因此可以用三个串口中任何一个使单片机与上位机通信，另外两个各接一个激光测距模块，可以同时监控两个测距模块，实际做小车等机器人时，三个串口都可以接激光测距模块，这样可以同时搞三个，如果还想扩展，可以按照相同方法加入新的串口。程序完全自己写的，也是在网上没找到stm32的实现例程，淘宝卖家说只有用Arduino的程序，所以就自己写了，希望用这个模块的人都能看到。
基于STM32的激光测距系统设计
qq_58404700的博客
02-16 3822
本文设计了一种基于STM32微控制器的激光测距系统，通过合理的硬件设计和软件编程，实现了对目标物体距离的快速、准确测量。激光测距技术，利用激光的高方向性、单色性和相干性，通过测量激光脉冲从发射到接收的时间差，来计算目标与测距系统之间的距离。本文旨在设计一种基于STM32微控制器的激光测距系统，通过激光发射与接收技术，结合STM32的卓越性能，实现准确、高效的距离测量。通过STM32的ADC功能，将模拟信号转换为数字信号，并利用数字信号处理算法，如滤波、放大等，提高信号质量，减小噪声干扰。
STM32传感器模块编程实践(九) VL53L0X激光红外测距传感器简介及驱动源码
光子物联
10-20 5241
VL53L0X在激光自动对焦，测距和接近检测，深度映射和AR/VR中有广泛的应用，本文介绍了VL53L0X传感器，以及使用STM32单片机驱动传感器进行距离检测
精准测距，轻松实现：STM32驱动TOF10120激光测距模块
gitblog_09702的博客
09-05 737
精准测距，轻松实现：STM32驱动TOF10120激光测距模块 ToF_Project_I2C_dpt_2022_5_27.zip项目地址:https://gitcode.com/open-source-toolkit/05b78 项目介绍 在现代自动化和机器人技术中，精准的距离测量是至关重要的。为了满足这一需求，我们推出了一个开源项目——STM32驱动TOF10120激光测距模块的完整代码。该...
评论 16
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

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

抵扣说明：

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

余额充值