STM32 四轴无人机的设计——基于HCSR04超声波模块的距离检测与警报设计_无人机超声波测距 csdn

1、系列总述

从现在开始将会进入四轴无人机的制作，我是第一次制作四旋翼，从前没有接触过这个方面，手边的参考资料只有一本四轴的设计书和正点原子F405飞控的源码，所以代码逻辑设计方面肯定有所欠缺，大家可以积极留言讨论，共同进步。
进入正题，距离检测与报警，我的设想是将超声波测距模块安装在四旋翼的底部，虽然超声波精度不高，声波发射范围不可控，但是可以作为初学者，此模块可以完成定高，测距+报警功能已经满足了我的需求。

2.设计思路

依靠超声波模块测算空对地距离，在安全范围，无报警声，进入危险范围（我设定的<3m）蜂鸣器的报警频率与距离成正比，进入非常危险范围（<1m）蜂鸣器长鸣。

3、硬件设计

1. STM32F1开发板
2. HC_SR04超声波模块
3. 蜂鸣器

根据官方提供的数据可以看到，超声波驱动非常简单，只需要给出10us的高电平在Trip引脚，就可以让模块发出8个40KHz的脉冲，返回信号用高电平时间表示远近，并且从Echo引脚输出。所以这里就有两种设计方法，（1）直接通过对IO端口的操作，（2）通过TIM定时器的输入捕获功能，我这里使用的是第一种方法。第二种方法总会莫名其妙的无法接收到返回信号，所以为了四旋翼飞行的安全，我使用第一种方法。

4、软件设计

（1）测距模块
只需要两个IO引脚就可以完成操作，先使用引脚1输出15us的高电平，再使用引脚2开启输入模式，从引脚2接收到第一个高电平开始，开启定时器计时，等待引脚2变为低电平，结束计时，通过计算得出测量距离。
计算公式：距离（cm）=（定时器周期 × 溢出次数+定时器当前计时时间）× 34（cm/ms）/2
音速=34cm/ms = 340m/s
（2）警报模块
可以通过判断距离，小于3m时，将距离数据经过运算当做蜂鸣器的频率，可以做到距离越近，蜂鸣器频率越快，小于1m时，将不再判断距离，蜂鸣器设为长鸣模式。

5、代码示例

#define HCSR04_PORT     GPIOA
#define HCSR04_CLK      RCC_APB2Periph_GPIOA
#define HCSR04_TRIG     GPIO_Pin_5
#define HCSR04_ECHO     GPIO_Pin_6

/**  
  *  功能：超声波使用的引脚和定时器初始化 Trig-》PA5，Echo-》PA6
  *  入口参数：无
  *  返回值：无
  */
void hcsr04_Init(void)
{  
  
    GPIO_InitTypeDef GPIO_InitStructure;
	NVIC_InitTypeDef NVIC_InitStructure;
    TIM_TimeBaseInitTypeDef  TIM_TimeBaseStructure;     //生成用于定时器设置的结构体
	
    RCC_APB2PeriphClockCmd(HCSR04_CLK, ENABLE);
     
    GPIO_InitStructure.GPIO_Pin =HCSR04_TRIG;       //发送电平引脚
    GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
    GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;//推挽输出
    GPIO_Init(HCSR04_PORT, &GPIO_InitStructure);
    GPIO_ResetBits(HCSR04_PORT,HCSR04_TRIG);
     
    GPIO_InitStructure.GPIO_Pin = HCSR04_ECHO;     //返回电平引脚
    GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN_FLOATING;//浮空输入
    GPIO_Init(HCSR04_PORT, &GPIO_InitStructure);  
	GPIO_ResetBits(HCSR04_PORT,HCSR04_ECHO);    
				 
	//定时器初始化 使用基本定时器TIM6
	RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM6, ENABLE);   //使能对应RCC时钟
	//配置定时器基础结构体
	TIM_DeInit(TIM2);
	TIM_TimeBaseStructure.TIM_Period = (1000-1); //设置在下一个更新事件装入活动的自动重装载寄存器周期的值,计数到1000为1ms
	TIM_TimeBaseStructure.TIM_Prescaler =(72-1); //设置用来作为TIMx时钟频率除数的预分频值,1M的计数频率 1US计数
	TIM_TimeBaseStructure.TIM_ClockDivision=TIM_CKD_DIV1;//不分频
	TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;  //TIM向上计数模式
	TIM_TimeBaseInit(TIM6, &TIM_TimeBaseStructure); //根据TIM_TimeBaseInitStruct中指定的参数初始化TIMx的时间基数单位         
					
	TIM_ClearFlag(TIM6, TIM_FLAG_Update);   //清除更新中断，免得一打开中断立即产生中断
	TIM_ITConfig(TIM6,TIM_IT_Update,ENABLE);    //打开定时器更新中断
			
	NVIC_InitStructure.NVIC_IRQChannel = TIM6_IRQn;             //选择串口1中断
	NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 0;  //抢占式中断优先级设置为1
	NVIC_InitStructure.NVIC_IRQChannelSubPriority = 0;         //响应式中断优先级设置为1
	NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;        //使能中断
	NVIC_Init(&NVIC_InitStructure);
		
    TIM_Cmd(TIM6,DISABLE);     
}


u16 msHcCount = 0;//ms计数
/**  
  *  功能：打开定时器，关闭定时器，发送Trig测距信号
  *  入口参数：
  *  返回值：
  */
static void Open_Timer_ForHc(void)        //打开定时器
{
	TIM_SetCounter(TIM6,0);//清除计数
	msHcCount = 0;
	TIM_Cmd(TIM6, ENABLE);  //使能TIMx外设
}

static void Close_Timer_ForHc(void)        //关闭定时器
{
	TIM_Cmd(TIM6, DISABLE);  //使能TIMx外设
}

static void Send_Trig_Signal(void)
{
	PAout(5)=1;
	delay_us(15);
	PAout(5)=0;
}

/**  
  *  功能：获取定时器时间
  *  入口参数：无
  *  返回值：无
  */

u32 Get_Echo_Timer(void)
{
	u32 t = 0;
	t = msHcCount*1000;//得到MS
	t += TIM_GetCounter(TIM6);//得到US
	TIM6->CNT = 0;  //将TIM6计数寄存器的计数值清零
	delay_ms(50);
	return t;
}

/**  
  *  功能：定时器6中断服务程序，保存超声波返回波时间在msHcCount中
  *  入口参数：无
  *  返回值：无
  */
void TIM6_IRQHandler(void)   //TIM6中断
{
        if (TIM_GetITStatus(TIM6, TIM_IT_Update) != RESET)  //检查TIM6更新中断发生与否
        {
                TIM_ClearITPendingBit(TIM6, TIM_IT_Update  );  //清除TIMx更新中断标志 
                msHcCount++;
        }
}

/**  
  *  功能：一次获取超声波测距数据 两次测距之间需要相隔一段时间，
  *		   隔断回响信号，为了消除余震的影响，取五次数据的平均值进行加权滤波。
  *  入口参数：无
  *  返回值：lengthTemp 滤波后的距离
  */

u32 Hcsr04_Get_Length(void )
{
        u32 time = 0;
        int i = 0;
        float lengthTemp = 0;
        float sum = 0;
        while(i!=5)
        {
			Send_Trig_Signal();
			while(GPIO_ReadInputDataBit(HCSR04_PORT,HCSR04_ECHO) == 0);      //等待接收口高电平输出
			Open_Timer_ForHc();        //打开定时器
			i = i + 1;
			while(GPIO_ReadInputDataBit(HCSR04_PORT,HCSR04_ECHO) == 1);
			Close_Timer_ForHc();        //关闭定时器
			time = Get_Echo_Timer();     //获取时间,分辨率为1US
			lengthTemp = ((float)time/58.0);//cm
			sum = lengthTemp + sum ;        
		}
        lengthTemp = sum/5.0;
		lengthTemp = lengthTemp*1000; 
        return (u32)lengthTemp;
}
/**  
  *  功能：超声波测距+蜂鸣器报警函数，成品函数（2021年2月9日17:12:07）
  *  入口参数：
  *  返回值：
  */
void Hcsr04_Data_Handle(u32 length)
{
	u16 a,b;
	a = length/1000;
	b = length%1000;
	if(a<100)//距离小于100cm，非常危险
		BEEP=1;
	else if(a<300)//距离小于300cm，即将碰撞
		BEEP_Flash(a);
	//LCD显示
	POINT_COLOR=BLUE;
	LCD_ShowString(30,150,200,16,16,"Distance is 000.000 CM");
	POINT_COLOR=RED;	
	LCD_ShowNum(30+96,150,a,3,16);
	LCD_ShowNum(30+128,150,b,3,16);
	
}
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159

这样我们可以在主函数中直接调用两个函数的复合形式，就可以实现距离检测和报警功能。

//mian.c
Hcsr04_Data_Handle(Hcsr04_Get_Length());
1
2

6、实验效果

测量拍摄手机的距离，数据正确。