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