這個是超聲波測距的代碼，可以添加stm32程序中，并且有測距的組件就可以使用了。
還附加有原理講解圖文word
HC-SR04超聲波測距模塊可提供2cm-400cm的非接觸式距離感測功能，測距精度可達(dá)高到3mm；模塊包括超聲波發(fā)射器、接收器與控制電路。像智能小車的測距以及轉(zhuǎn)向，或是一些項(xiàng)目中，常常會用到。智能小車測距可以及時發(fā)現(xiàn)前方的障礙物，使智能小車可以及時轉(zhuǎn)向，避開障礙物。 HC-SR04基本工作原理： (1)采用IO口TRIG觸發(fā)測距，給最少10us的高電平信呈。 (2)模塊自動發(fā)送8個40khz的方波，自動檢測是否有信號返回； (3)有信號返回， 通過IO口ECHO輸出一個高電平， 高電平持續(xù)的時間就是超聲波從發(fā)射到返回的時間。 測試距離=(高電平時間*聲速(340M/S))/2。 程序編寫思路是：1、配置好使用到的GPIO以及定時器； 2、給模塊TRIG端口發(fā)送大于10us的高電平信號，當(dāng)收、收到ECHO回響信號是，打開定時器開始定時； 3、當(dāng)回響信號消失，關(guān)閉定時器； 4、通過定時器定時時間來確定距離。 先由觸發(fā)信號啟動HC-RS04測距模塊，也就是說，主機(jī)要先發(fā)送至少10us的高電平，觸發(fā)HC-RS04,模塊內(nèi)部發(fā)出信號是傳感器自動回應(yīng)的，我們不用去管它。輸出回響信號是我們需要關(guān)注的。信號輸出的高電平就是超聲波發(fā)出到重新返回接收所用的時間。用定時器，可以把這段時間記錄下來，算出距離，結(jié)果要除于2，因?yàn)榭倳r間是發(fā)送和接收的時間總和。 
單片機(jī)源程序如下:
- #include "cs.h"
- #include "stm32f10x.h"
- #include "delay.h"
- #include "usart.h"
- /*記錄定時器溢出次數(shù)*/
- uint overcount=0;
- /*設(shè)置中斷優(yōu)先級*/
- void NVIC_Config(void)
- {
- NVIC_InitTypeDef NVIC_InitStructer;
-
- NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);
-
- NVIC_InitStructer.NVIC_IRQChannelPreemptionPriority=0;
- NVIC_InitStructer.NVIC_IRQChannelSubPriority=0;
- NVIC_InitStructer.NVIC_IRQChannel=TIM2_IRQn;
- NVIC_InitStructer.NVIC_IRQChannelCmd=ENABLE;
-
- NVIC_Init(&NVIC_InitStructer);
- }
- /*初始化模塊的GPIO以及初始化定時器TIM2*/
- void CH_SR04_Init(void)
- {
- GPIO_InitTypeDef GPIO_InitStructer;
- TIM_TimeBaseInitTypeDef TIM_TimeBaseInitStructer;
-
- RCC_APB2PeriphClockCmd( RCC_APB2Periph_GPIOB, ENABLE);
- RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM2, ENABLE);
-
- /*TRIG觸發(fā)信號*/
- GPIO_InitStructer.GPIO_Speed=GPIO_Speed_50MHz;
- GPIO_InitStructer.GPIO_Mode=GPIO_Mode_Out_PP;
- GPIO_InitStructer.GPIO_Pin=GPIO_Pin_8;
- GPIO_Init(GPIOB, &GPIO_InitStructer);
-
- /*ECOH回響信號*/
- GPIO_InitStructer.GPIO_Mode=GPIO_Mode_IN_FLOATING;
- GPIO_InitStructer.GPIO_Pin=GPIO_Pin_9;
- GPIO_Init(GPIOB, & GPIO_InitStructer);
-
- /*定時器TIM2初始化*/
- TIM_DeInit(TIM2);
- TIM_TimeBaseInitStructer.TIM_Period=999;//定時周期為1000
- TIM_TimeBaseInitStructer.TIM_Prescaler=71; //分頻系數(shù)72
- TIM_TimeBaseInitStructer.TIM_ClockDivision=TIM_CKD_DIV1;//不分頻
- TIM_TimeBaseInitStructer.TIM_CounterMode=TIM_CounterMode_Up;
- TIM_TimeBaseInit(TIM2,&TIM_TimeBaseInitStructer);
-
- TIM_ITConfig(TIM2,TIM_IT_Update,ENABLE);//開啟更新中斷
- NVIC_Config();
- TIM_Cmd(TIM2,DISABLE);//關(guān)閉定時器使能
-
- }
- float Senor_Using(void)
- {
- float length=0,sum=0;
- u16 tim;
- uint i=0;
- /*測5次數(shù)據(jù)計(jì)算一次平均值*/
- while(i!=5)
- {
- PBout(8)=1; //拉高信號，作為觸發(fā)信號
- delay_us(20); //高電平信號超過10us
- PBout(8)=0;
- /*等待回響信號*/
- while(GPIO_ReadInputDataBit(GPIOB,GPIO_Pin_9)==RESET);
- TIM_Cmd(TIM2,ENABLE);//回響信號到來，開啟定時器計(jì)數(shù)
-
- i+=1; //每收到一次回響信號+1，收到5次就計(jì)算均值
- while(GPIO_ReadInputDataBit(GPIOB,GPIO_Pin_9)==SET);//回響信號消失
- TIM_Cmd(TIM2,DISABLE);//關(guān)閉定時器
-
- tim=TIM_GetCounter(TIM2);//獲取計(jì)TIM2數(shù)寄存器中的計(jì)數(shù)值，一邊計(jì)算回響信號時間
-
- length=(tim+overcount*1000)/58.0;//通過回響信號計(jì)算距離
-
- sum=length+sum;
- TIM2->CNT=0; //將TIM2計(jì)數(shù)寄存器的計(jì)數(shù)值清零
- overcount=0; //中斷溢出次數(shù)清零
- delay_ms(100);
- }
- length=sum/5;
- return length;//距離作為函數(shù)返回值
- }
- void TIM2_IRQHandler(void) //中斷，當(dāng)回響信號很長是，計(jì)數(shù)值溢出后重復(fù)計(jì)數(shù)，用中斷來保存溢出次數(shù)
- {
- if(TIM_GetITStatus(TIM2,TIM_IT_Update)!=RESET)
- {
- TIM_ClearITPendingBit(TIM2,TIM_IT_Update);//清除中斷標(biāo)志
- overcount++;
-
- }
- }
超聲波測距.7z
(676.27 KB, 下載次數(shù): 493)
2020-5-7 17:44 上傳
點(diǎn)擊文件名下載附件
| 
[復(fù)制鏈接]
