引言
目前,便攜式移動機器人全自主控制方式尚不成熟,其監控系統普遍采用人在環半自主控制方式設計。為滿足攜帶、系統小型化、嵌進式的結構特點,故設計便攜式移動機器人手持監控系統,并將其用于履帶結構便攜式移動機器人實驗平臺。
功能設計
手持監控系統對便攜式移動機器人起到監視與控制的全局性作用。手持監控系統可劃分為視頻圖像監視模塊、狀態信息監測模塊、遠控指令模塊、無線通訊模塊、數字與圖交互模塊、全局路徑規劃模塊六大功能模塊(見圖1)。
視頻圖像監視模塊對便攜式移動機器人所處環境進行視頻監視;狀態信息監測模塊對機器人自身狀態信息的監測;遠控指令模塊實現基本的運動指令編碼以及發送;無線通訊模塊實現運動指令、狀態信息、視頻信號等數據的無線傳輸;數字輿圖交互模塊實現環境地理信息的數字化顯示及人機交互功能;全局路徑規劃模塊實現點到點的最優路徑搜索功能。
硬件系統
手持監控系統的硬件系統可劃分為若干模塊,各個模塊實現自身相對獨立的功能。
硬件結構與接口
手持監控系統硬件系統采用基于嵌進式系統的PCI 總線的PC/104plus 總線結構,分為無線通訊、嵌進式圖像采集、中心處理、遠控器、液晶顯示等五大模塊。無線通訊模塊又劃分為無線數據傳輸和無線視頻傳輸模塊。無線數據傳輸模塊實現運動指令、狀態信息等窄帶數據無線傳輸;無線視頻傳輸模塊實現視頻圖像信號等寬帶數據無線傳輸。
硬件系統各模塊通過接口實現信息交換與數據共享。中心處理模塊通過PC/104plus 總線與嵌進式圖像采集模塊接口,實現模塊之間視頻圖像數據的傳輸。中心處理模塊與無線數據傳輸模塊及遠控器模塊通過串口連接。中心處理模塊通過TTL接口與液晶顯示模塊連接。嵌進式圖像采集模塊與無線視頻傳輸模塊通過RCA 接口實現復合視頻信號的傳輸(見圖2)。
硬件模塊實現
無線數據傳輸模塊采用微功率無線數據傳送單元實現。嵌進式圖像采集模塊采用PC/104plus總線結構的嵌進式圖像采集卡實現。中心處理模塊采用PC/104plus總線結構的單板機實現。遠控器模塊通過自行設計電路板實現按鍵掃描、指令編碼以及串口發送等功能。液晶顯示模塊采用小型彩色液晶屏實現。以上各硬件模塊實現符合手持設備小型化、便攜式的硬件要求。
軟件系統
手持監控系統的軟件系統選用Windows CE(WinCE)作為嵌進式操縱系統平臺,監控系統軟件包括:操縱系統定制、設備驅動程序開發、應用程序。應用程序又分為:鍵盤掃描模塊、串口通訊模塊、視頻處理模塊、數字輿圖模塊、路徑規劃模塊五大模塊(見圖3)。
操縱系統定制
操縱系統定制主要根據系統需要建立操縱系統平臺并對其進行相應的配置。通過平臺裁剪工具Platform Builder(簡稱PB)完成。
設備驅動程序開發
WinCE的驅動程序分為:本機設備驅動程序和流接口驅動程序[5]。本機設備是指集成到目標平臺的設備,其驅動程序由原設備制造商(OEM)提供。流接口驅動程序是指連接到WinCE平臺的外部設備驅動程序,由用戶自行開發。流接口驅動程序把外部設備看作文件系統的特殊文件,通過文件讀取函數間接地訪問外部設備。
嵌進式圖像采集卡驅動程序分為三部分:
?。?) 內核部分
實現中斷服務例程(ISR)。內核函數實現了物理中斷號與邏輯中斷標識之間的映射關系,并調用中斷服務例程,中斷服務例程在中斷發生后向內核返回中斷邏輯標識。
?。?) 驅動程序部分
實現WinCE 流接口驅動模型所需要的文件操縱接口函數,包括:采集卡初始化、數據讀取和采集卡句柄封閉。
?。?) 應用程序部分
通過調用設備注冊函數將嵌進式圖像采集卡中斷驅動程序加載到系統內存,并根據采集卡初始化參數設置修改WinCE系統注冊表文件。
應用程序設計
鍵盤掃描模塊及串口通訊模塊單片機程序在單片機集成開發環境uVision2下用C語言開發外,其余模塊均在EVC(Windows CE Embedded VisualC++)下開發。
?。?) 鍵盤掃描模塊
鍵盤掃描模塊主要實現單片機對薄膜鍵盤的按鍵識別及鍵值顯示功能。薄膜鍵盤屬于行列式非編碼鍵盤,按鍵的識別通常采用逐行掃描查詢法實現。程序采用軟件延時的方法處理抖動。鍵值顯示則通過單片機對液晶屏串行數據口編程實現。
?。?) 串口通訊模塊
串口通訊模塊主要實現單板機與單片機之間的串行數據通訊功能。該模塊包括單板機串口通訊程序、單片機串口通訊程序、串口通訊協議三部分。
?、?單板機串口通訊程序。由于WinCE不支持串口通訊控件的使用,所以EVC下的單板機串口通訊程序開發只能通過調用文件操縱函數實現。
?、?單片機串口通訊程序。單片機串口通訊程序設計必須根據通訊雙方約定設置串口工作方式及串口通訊波特率。
?、?串口通訊協議。串口數據包括:雙向通訊測試數據、下行指令數據、上行傳感數據,而傳感數據又劃分為:速度、加速度、位置、傾角等狀態信息。為了在串口通訊中正確分離和識別各種數據,通過對各種數據添加相應標志字節的方法編制串口通訊協議。
?。?) 視頻處理模塊
視頻處理模塊通過在EVC 下調用嵌進式圖像采集卡驅動函數實現視頻顯示與視頻控制功能。視頻顯示作為監控系統子窗口嵌進到軟件系統用戶界面。視頻顯示主要實現便攜式移動機器人平臺所處環境信息的實時視頻顯示與更新。視頻控制主要實現對視頻采集過程的控制,其中包括:視頻采集窗口尺寸設置、視頻源制式設置、視頻數據格式選擇及視頻數據存儲等。
WinCE不支持任何視頻加速驅動程序和底層函數,所以無法直接調用DirectX 函數,則WinCE設備上動態視頻的顯示與回放,必須開發新的設備無關位圖(DIB)快速顯示函數。采用從DGdiObject類派生的方法,使用CreateDIBSection函數創建DIB位圖,可以直接使用圖形設備接口(GDI)函數來操縱DIB 位圖,以有效進步位圖顯示速度。
?。?) 數字輿圖模塊
數字輿圖是地理信息系統(GIS)中的概念。數字輿圖模塊實現便攜式移動機器人平臺所處地理環境信息的數字化顯示,并在此基礎上實現對數字輿圖放大、縮小、周游、查找等交互操縱功能。
數字輿圖模塊通過在EVC下嵌進MapXMobile組件實現,并終極作為監控系統子窗口集成到軟件系統用戶界面。MapX Mobile是基于對象鏈接嵌進(OLE)技術的ActiveX控件,在EVC下設置該控件的屬性、方法及響應事件即可實現輿圖顯示與操縱功能。
應用程序通過MapX Mobile組件實現輿圖顯示與操縱,同時治理輿圖數據文件。并可以單獨在嵌進式設備上運行,也能和WinCE操縱系統兼容。MapX Mobile答應用戶把輿圖數據帶到自身所在的任何位置,實現了移動的GIS組件。
?。?) 路徑規劃模塊
路徑規劃模塊實現基于數字輿圖的點到點全局路徑規劃功能。該模塊是在數字輿圖模塊查找交互操縱功能的基礎上運用迪杰斯特拉(Dijkstra)算法實現最優路徑搜索。操縱者在數字輿圖上選取起始點和目標點,程序通過Dijkstra算法搜索得出兩點之間可以通行的最優路徑,并在數字輿圖上標識該最優路徑。
Dijkstra 算法是解決最短路徑題目的理論基礎。該算法適合于計算帶權有向圖中兩節點之間的最短路徑。將數字輿圖上的道路和地點抽象為有向圖的邊與節點,道路的長度作為有向圖邊的權值,從而實現數字輿圖到帶權有向圖的抽象(見圖4)?!?/p>
Dijkstra 算法步驟:
Step1:設集合S存放已求出最短路徑的終節點,初始狀態時,S集合只有源節點v0,即S={v0}。
Step2:令k=1,對于節點vk,計算v0到vk的間隔
代價函數:
Length(k)是v0和vk之間可達連接權值之和,假如v0和vk之間不可達,則間隔代價函數值無窮大。
Step3:取dist[k]值最小的節點序列保存在path[k]中,并添加vk到集合S中,即S={v0,vk}。且令k=k+1。
Step4:若vk即為目標節點,則算法結束;否則,跳轉至Step2。
則path[k]中即為源節點與目標節之間的最短路徑序列,最小dist[k]值即為源節點與目標節點之間的最短路徑間隔。
設計實例
該手持監控系統已應用到履帶結構便攜式移動機器人實驗平臺。在室外實驗場地測試取得較好的效果,測試過程中軟件系統用戶界面如圖5。用戶界面分為三部分:機器人自身狀態信息顯示、視頻圖像數據顯示、數字輿圖顯示。
結論
便攜式移動機器人手持監控系統在履帶結構便攜式移動機器人實驗平臺上通過測試。嵌進式硬件結構和嵌進式操縱系統的引進符合移動智能終端設備體積小、重量輕、實時性強、可靠性高的設計要求。
隨著高技術武器裝備研究的發展,便攜式移動機器人將越來越多地應用在軍事領域。手持監控系統作為便攜式移動機器人的子系統,逐步成為軍用機器人研究領域的重要課題之一。
評論