基于單接收頭的超聲波多目標測距

4 系統軟件

系統軟件基本構架如下：

　　void main （）

　　{ cONfig （） ; EA = 1 ; While （1） {} ; }

　　void time0_inter （） interrupt 1 {}

　　void time1_inter （） interrupt 3 {}

　　void time2_inter （） interrupt 5 {}

　　void time3_inter （） interrupt 14 {}

　　void time4_inter （） interrupt 16 {}

　　void PCA_inter （） interrupt 9 {}

初始化程序config （） : I/ O 交叉開(kāi)關(guān)配置；使用外部時(shí)鐘，指定系統時(shí)鐘；time 0~4 中斷使能，其中time 0 溢出中斷發(fā)生，產(chǎn)生40 kHz 方波信號輸出；PLA 中斷開(kāi)啟。

中斷函數time0_inter （ ） :產(chǎn)生5 個(gè)40 kHz 方波信號輸出后關(guān)閉time0 中斷， TF0 = 0 ; PLA 溢出、邊緣捕捉中斷開(kāi)啟。

中斷函數PCA_inter （） :若是溢出中斷發(fā)生（30ms） ,則關(guān)閉PCA_inter （ ） 中斷，CF = 0 ,開(kāi)啟time0中斷；若是CCFn = 1 ,則記下定時(shí)器時(shí)間（與初值相減后代入標定式得距離） ,給定time n 計時(shí)初值并啟動(dòng)time n 溢出中斷（ 2 ms） , 關(guān)閉CCFn 中斷，CCFn = 0.

中斷函數time1 _inter （ ） ~ time4 _inter （ ） : 當time n 中斷發(fā)生則開(kāi)啟CCFn 中斷，關(guān)閉time n 中斷， TFn = 0.

5 結語(yǔ)

本文對單個(gè)接收頭在一次采樣時(shí)間（30 ms） 內測量多個(gè)目標進(jìn)行了嘗試，仿真并分析了接收信號波形，用0. 5 倍包絡(luò )峰值標定而用小閾值測量，在2個(gè)目標與接收頭距離之差大于30 cm 以上時(shí)能較精確測量出2 個(gè)目標，誤差不超過(guò)2 cm.

由于一次能在同一時(shí)刻測多個(gè)距離，增大了超聲波傳感器捕獲的信息量，移動(dòng)機器人裝配了該傳感器能在人員不是密集的動(dòng)態(tài)環(huán)境下根據4 面墻壁定位。