除塵競賽機器人及其控制策略研究
加入技術(shù)交流群
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所示。
評論