硬件模块应用之超声波测距模块SRF05应用

直接上代码,原理不做多解释了,基本原理就是利用发射一段脉冲出去,然后计算脉冲在空中的来回时间间接测出距离,不同模块的测距范围不一样,本文使用的模块范围在2cm~450cm左右,其他的都在代码里,暂时还没做过多的测试。

SRF05.c

// 超声波测距模块:HY-SRF05
// 精度:3mm→17.6us     62.5us→10.6mm
// 最小测距:2cm→117.6us
// 最大测距:4.5m→26.47ms
// Trig脚触发发射8个40khz的方波,
// us/58=cm或us/148=inch
// 或者距离=高电平时间*声速(340m/s)/2
// 周期60ms

#include "SRF005.h"

sbit Pin_trigger = P3^2;
sbit Pin_echo = P3^4;
static unsigned int EchoTmCount;
static unsigned int setRchoTmDelay;
static unsigned int EchoTmCountBackUp;
/*
	33MHz--0.03us
	不确定的需要用逻辑分析仪或示波器抓取,
	确保>10us
*/
static void SRF005_delay10us()
{
	int i=0;
	for(i=0; i<1*100/3; i++){	//~14us
	}
}
/*
	触发信号,10us以上的高电平信号
*/
void SRF005_trigger(void)
{
	Pin_trigger = 1;
	SRF005_delay10us();
	Pin_trigger = 0;
	
	EchoTmCount = 0;	//计数清零重新开始

	setRchoTmDelay = 85/2;	//85ms后再去读echo的高电平时间
}
/*
	echo高电平时间计时,放在周期为62,5us的定时器中
*/
void SRF005_EchoCountTm(void)
{
	if(Pin_echo){
		EchoTmCount++;
	}
}
/*
	初始化超声波模块
*/
void Initialize_SRF005(void)
{
    GPIO_InitTypeDef GPIOinitStruct;

    //触发脚
    GPIOinitStruct.Mode = GPIO_PullUp;  //
    GPIOinitStruct.Pin = GPIO_Pin_2 | GPIO_Pin_4;
    GPIO_Inilize(GPIO_P3,&GPIOinitStruct);	
	Pin_trigger = 0;
}
/*
	获取超声波测距距离,返回长度,单位cm
*/
unsigned int getEchoTm(void)
{
	return (unsigned long)EchoTmCountBackUp*625/580;	//us/58=cm
}
/*
	获取echo高电平时间计数,延时时间到再赋值
	放在2ms计时
*/
void setRchoTm(void)
{
	if(setRchoTmDelay){
		setRchoTmDelay--;
		if(setRchoTmDelay == 0){
			EchoTmCountBackUp = EchoTmCount;
		}
	}
}

SRF05.h

#ifndef _SRF005_H
#define _SRF005_H

#include "stc15w.h"
#include "intrins.h"
#include "GPIO.h"

void SRF005_trigger(void);
void Initialize_SRF005(void);
void SRF005_EchoCountTm(void);
unsigned int getEchoTm(void);
void setRchoTm(void);
#endif

猜你喜欢

转载自blog.csdn.net/LinQiPing233/article/details/83999625