除塵競賽機器人及其控制策略研究
2.2 電子指南針
電子指南針是除塵機器人設(shè)計的關(guān)鍵部件,角度信息的處理直接關(guān)系到能否對機器人的轉(zhuǎn)向進行精確控制。電子指南針的設(shè)計結(jié)構(gòu)如圖4所示。本文引用地址:http://m.butianyuan.cn/article/160450.htm
HMC1022作為新一代磁傳感器,具有靈敏度高(0.1°)、響應(yīng)時間快(1μs)、輸出頻率高(1 000 Hz)、體積小及固態(tài)封裝等優(yōu)點,電路中IRF7105為HMC1022磁阻芯片提供置位/復(fù)位脈沖,HMC1022磁阻傳感器根據(jù)地磁場的施加方向,產(chǎn)生兩路差分模擬信號,經(jīng)過兩路AD620放大電路進行差分放大,得到兩路模擬電壓AD0和AD1,經(jīng)過微控制器LPC938的10位高精度A/D轉(zhuǎn)換后獲得數(shù)字信號,再進行數(shù)字濾波后計算出機器人的角度值,最后將其角度值通過UART串口傳送給MSP430F5418主控制器。UART串口協(xié)議由起始字(0x24),角度值高8位,角度值低8為,結(jié)束同步字(0x55)組成。
3 軟件設(shè)計
軟件是機器人系統(tǒng)的靈魂,軟件的好壞直接關(guān)系到機器人能否穩(wěn)定的工作,除塵競賽軟件的設(shè)計要充分考慮到場地的具體環(huán)境,采取有效地路徑規(guī)劃。江蘇省機器人大賽除塵比賽的場地模型如圖5所示。
評論