基于STM32控制的聲音導引系統
3.1 移動(dòng)聲音模塊
本模塊主要實(shí)現移動(dòng)聲音控制器的功能。利用延時(shí)的方法產(chǎn)生高低電平來(lái)驅動(dòng)蜂鳴器產(chǎn)生聲源。通過(guò)SPI串口和NEC的從控芯片進(jìn)行通信,發(fā)送命令進(jìn)而來(lái)控制電機的運行狀態(tài)。通過(guò)無(wú)線(xiàn)模塊接收的信息先暫存在SPI的緩沖區中,以備控制命令及時(shí)發(fā)送。發(fā)送的控制命令有前進(jìn)、后退、左轉、右轉和停止信號。移動(dòng)聲音模塊控制流程如圖5所示。本文引用地址:http://dyxdggzs.com/article/172987.htm
3.2 聲音接收模塊
本模塊的功能主要是循環(huán)接收傳感器的信息,根據3個(gè)接收器傳回聲音的順序不同,來(lái)判斷移動(dòng)聲音的位置和運行狀態(tài),進(jìn)而將前進(jìn)、后退、左轉和右轉控制命令發(fā)送給移動(dòng)聲源。由于該控制器的采樣頻率要高,因此把主控制器的時(shí)鐘頻率通過(guò)PLL調到最大72 MHz。聲音接收模塊控制流程如圖6所示。
4 系統測試
測試儀器包括:100 MHz數字示波器,數字萬(wàn)用表(型號VICTOR-VC890D),STM32單片機開(kāi)發(fā)板,秒表,卷尺。
用示波器觀(guān)測單片機、MMC-1芯片的輸入/輸出引腳信號波形,用數字萬(wàn)用表檢查元件有無(wú)虛焊,從而確定對電機的驅動(dòng)情況。
用秒表、卷尺測試小車(chē)運動(dòng)的平均速度,并量取定位誤差。假設小車(chē)初始位置為S0,小車(chē)停止位置為S且SS0與間夾角為α,全程運動(dòng)時(shí)間為t,S與0x線(xiàn)間距離為d,則小車(chē)平均速度為SS0·tan(α/t)。
測試數據如表1所列。
結語(yǔ)
可移動(dòng)聲源開(kāi)始運動(dòng)并發(fā)出聲音,3個(gè)聲音接收器收到來(lái)自可移動(dòng)聲源的聲音信號后,立即發(fā)出各自載波頻率的反饋信號給可移動(dòng)聲源??梢苿?dòng)聲源根據接收到的不同信號頻率判斷反饋信號的源頭,從而由MCU發(fā)出相應控制信號(前進(jìn)、倒退和轉彎),導引可移動(dòng)聲源在定位誤差的范圍內。
評論