基于STM32的家庭服務機器人系統(tǒng)設計
3.1.2 傳感器模塊
本文引用地址:http://www.ex-cimer.com/article/279227.htm傳感器模塊由傳感器和相應的信號調理電路組成。輪式機器人使用的傳感器包括紅外傳感器、電子羅盤和RFID讀卡器。根據輪式機器人移動過程中檢測障礙物距離的精度要求,紅外傳感器采用的型號為Sharp GP2D12,分別安裝在機器人前方、左前方、右前方、左側和右側五個位置。電子羅盤采用GY-80九軸模塊中的HMC5883L三軸電子羅盤,可以在復雜環(huán)境下測得準確方位值,抗磁電干擾能力較強。RFID讀卡器采用Parallax公司的低頻段28140讀卡器,可讀取125kHz標簽。
3.1.3 射頻模塊
射頻模塊是設備之間通信的主要模塊,負責整個網絡的數據傳輸工作。射頻模塊采用基于ZigBee技術的XBee無線傳輸模塊,該模塊覆蓋面積大且易于配置,是機器人通訊組網的不錯選擇。
XBee協調器由XBee無線模塊和XBee USB適配板組成。XBee USB適配板是專門為XBee無線模塊配套設計,通過使用該模塊,可以在PC機使用配套的X-CTU軟件對XBee無線模塊進行配置及串口通訊監(jiān)控。XBee協調器通過USB線與上位機連接通信。
3.1.4 舵機模塊
舵機模塊分為機械臂舵機和移動輪舵機,機械臂由角度舵機和金屬桿件組成。五個角度舵機構成五自由度機械臂,尺寸大小與搭建智能家居環(huán)境匹配,為保證機械臂動作精度,采用HS-322HD角度舵機。移動輪舵機使用Parallax連續(xù)旋轉舵機。
3.1.5 電源模塊
根據各個組成部分工作的場合和特點的不同,采用不同的供電模式,輪式機器人采用電池供電的模式,而XBee協調器則要一直保持工作狀態(tài),所以采用上位機USB供電的模式。電源模塊與主板相連,而主板留有接口給傳感器模塊、射頻模塊和舵機模塊,通過接口給傳感器模塊、射頻模塊和舵機模塊進行供電。由于RFID讀卡器對電流要求較高,因此主板和RFID讀卡器分開使用雙電源供電。
3.2 機器人軟件設計
3.2.1驅動控制設計
驅動控制設計包括各個模塊的初始化、模塊之間的通信和上位機軟件設計。該文采用與STM32F103VCT6配套的MDK-ARM作為開發(fā)環(huán)境,完成各個模塊初始化和通信,上位機軟件采用VC++開發(fā)。具體的各個模塊軟件實現的功能及工作流程在系統(tǒng)的工作原理和流程中已經介紹,這里不再敘述。
3.2.2 路徑規(guī)劃
路徑規(guī)劃主要可分為全局路徑規(guī)劃和局部路徑規(guī)劃,前者是指在環(huán)境信息完全已知的情況下,機器人規(guī)劃一條從初始位置到目標位置的無碰撞最優(yōu)路徑;后者由于環(huán)境信息是未知的[5],需考慮局部的特定情況來進行路徑調整。
機器人移動過程中利用電子羅盤進行姿態(tài)調整,即調整前進方向,努力尋找一條最快捷的路徑到達目標位置。機器人姿態(tài)調整主要取決于當前位置和前一位置與目標位置的距離,包括橫向距離和縱向距離。若當前位置與目標位置的橫向距離和縱向距離分別小于或者等于前一位置與目標位置的橫向距離和縱向距離,表明機器人與目標位置的距離在逐漸縮小,機器人在朝目標位置前進,否則就說明機器人沒有按預期的軌跡前進,需要再次進行姿態(tài)調整。姿態(tài)調整示意圖如圖2所示。
局部路徑規(guī)劃包括避障處理、振蕩位置分析、房門位置搜索和過房門策略分析。在機器人移動過程中,需要不斷探測周圍環(huán)境,從而更好地決定下一步動作。五個紅外傳感器數據使機器人時刻掌握周圍環(huán)境,避障處理要求機器人合理避開障礙物,向目標位置移動。
振蕩位置指的是機器人不能順利通過某一位置,而在這一點附近反復來回走動。如果起始位置和目標位置分別在兩個房間,在全局路徑規(guī)劃思想的指導下,機器人會在兩間房的公用墻邊不斷徘徊。振蕩位置分析示意圖如圖3所示。
當機器人到達振蕩位置時,需要調整路徑規(guī)劃策略,此時放棄全局路徑規(guī)劃策略,選擇直接以公用墻為基準墻搜索房門。沿墻走算法的基本規(guī)則是:當機器人不斷靠近墻面時需要調整兩輪速差使機器人朝偏離墻面的方向前進;當機器人不斷遠離墻面時,則需要調整兩輪速差,使機器人朝靠近墻面的方向前進。綜合調整的結果是機器人的前進軌跡是以基準線為軸的類正弦曲線,沿墻走軌跡如圖4所示。
過房門是機器人完成任務必不可少的一個環(huán)節(jié),怎樣確保機器人順利穿過房門是任務成功的關鍵。機器人準備過房門時并不是正對房門,可能向左側或者右側不同程度的傾斜。根據傾斜程度的劃分,機器人檢測相對應的紅外傳感器距離值,不斷調整機器人姿態(tài),使機器人正對房門并順利通過。
4 結束語
本文設計的家庭服務機器人系統(tǒng),為智能家居環(huán)境服務對象的需求任務提出了詳細可行的解決方案。整個系統(tǒng)應用了基于XBee模塊的主流無線通信技術,以保證數據的傳輸速率。此外,對輪式機器人的模塊化設計具有結構簡單和性能穩(wěn)定等特點,大大提高了家庭服務機器人的可靠性,并且降低了系統(tǒng)的硬件成本。自主決策過程中的路徑規(guī)劃,使得機器人能夠快速沿著最合適的路線移動??傊撛O計系統(tǒng)對家庭服務機器人相關問題的解決提供了可借鑒的方法。
參考文獻:
[1]郭芙琴.家政服務機器人技術的發(fā)展與應用[J].科技創(chuàng)新導報,2012(24):24-25
[2]楊士元.數字家庭網絡技術及應用[M].北京:電子工業(yè)出版社,2002
[3]李皓. 基于ZigBee的無線網絡技術及應用[J].信息技術,2008(1): 12-14
[4]應鵬,宮晨.開放式多傳感器移動機器人硬件系統(tǒng)設計[J].機床與液壓,2009,37(7):137-140
[5]李強.家庭服務機器人路徑規(guī)劃研究[D].包頭:內蒙古科技大學,2012
評論