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