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