交互式多模型算法的遠程控制機器人設計

袁 鑄， 馬 林， 申一歌

（河南工業職業技術學院，河南南陽473000）

隨著網絡技術和機器人技術的發展，人們提出了各種遠程控制的理論方法，用以實現對機器人的遠程控制以滿足人們的某種要求。這不僅擴展了機器人的應用領域，同時通過遠程控制還可以使操作人員遠離機器人所處的危險作業環境，從而避免造成人身傷害。

機器人遠程控制按照不同的控制方法，大體上可以分為4類，即直接控制、監督控制、預測／預演顯示控制和事件智能控制模式等［1］。所謂事件智能控制模式，就是把事件驅動思想引入到機器人遠程控制領域。它能夠避免時延的影響，要求服務器端有更強的智能控制能力，是機器人遠程控制系統中目前較有前景的控制模式，但是這種控制方式技術還很不成熟，理論體系也沒有建立。

在目標跟蹤的過程中，如果每次都在整個圖像范圍內對目標進行搜索，必然會增大系統的計算量，影響系統的實時性［2］。為了提高算法的效率，減少計算量，人們常用濾波算法來預測目標的位置。在相對小的范圍內搜索目標，目前常用的算法是Kalman濾波算法，但是當目標運動狀態突然改變的時候，這種濾波算法很容易發散，導致跟蹤目標丟失［3］。為此，采用交互式多模型（Interacting Multiple Model，IMM）算法［4］來提高目標預測的精度。

本文基于事件智能控制理論，運用IMM算法建立了一個校園網內簡單的機器人遠程控制的目標跟蹤系統。

1 系統總體設計

本系統采用“B／S（瀏覽器／服務器）”模式實現，包括一個客戶機瀏覽器，一個服務器和機器人服務器。客戶機瀏覽器就是遠程控制端，操作界面選擇了可以嵌入到Web頁面中的ActiveX控件技術，實現控制指令和實時圖像的傳輸。Web服務器采用交互語言應用平臺（Interactive Speech Application Platform，ISAP）技術構建，實現一個交互的服務系統，對用戶的操作進行處理。機器人服務器實現目標識別跟蹤，根據估計目標的狀態，進行軌跡規劃，并通過機器人運動控制器控制機器人，與Web服務器安裝在同一臺電腦上。

用戶發出控制信息之后，機器人服務器經Web服務器把遠程攝像頭采集的圖像傳給用戶，同時執行本地跟蹤算法。在一幀幀的圖像中對目標進行識別，預測目標將要出現的位置和狀態，最終控制機器人完成打擊或抓取的任務。

1.1 B／S模式的實現

為實現基于Web的遠程控制，使用一個開發的ActvieX控件，將其嵌入到 Web服務器的頁面中，它負責用戶控制指令的傳輸以及視頻的顯示。

當用戶訪問服務器時，瀏覽器就會自動下載這個ActvieX控件，為用戶提供一個遠程控制的操作界面。當用戶登陸后，就進入控制界面。如果沒有其他用戶進行控制，系統就會把該用戶連接視頻時刻攝像頭采集的圖像保存下來，并發送至該用戶，等待其標定好需要跟蹤的目標區域后，用戶標定的坐標會以控制指令的形式發給Web服務器，同時開始接收實時視頻。Web服務器會把這些信息解釋后發給機器人服務器，其他登陸的用戶只能接收實時視頻，每次只允許一個用戶進行遠程控制。在機器人服務器端圖像的傳輸和控制指令的傳遞是分開的程序進程。控制指令的傳遞是一個封裝了指令參數的結構體，該結構體能進行自身數據的網絡字節順序與機器字節順序的轉換。

1.2 Web服務器端

通過編寫一個ISAP I服務器擴展程序來擴展互聯網信息服務（Internet Information Service，IIS）的Web服務器功能，為客戶端用戶提供遙控操作界面，并對注冊用戶信息進行管理。

在視頻傳輸方面，由于是在發送者和接收者之間實現一點對多點的網絡連接，故采用IP組播方式傳送圖像。IP組播的核心思想就是通過一個IP地址向一組主機發送數據，發送者僅僅向一個組地址發送信息，接收者只需加入到這個分組就可以接收信息，所有的接收者接收的是同一個數據流，組員是動態的，可以自愿隨時加入或退出［5－6］。

1.3 圖像采集和傳輸

在遠程控制中圖像的傳輸主要包括：圖像采集、圖像壓縮、圖像傳輸、圖像解碼和圖像顯示等幾個過程，其組成框架如圖1所示。

圖1 圖像傳輸組成框架

本系統通過一個安裝在機器人本體上方的固定USB攝像頭，使查看畫面的范圍比機器人本體所能到達的范圍稍大，這樣便于遠程觀測到機器人周邊環境。圖像采集有2個用途：① 把機器人執行跟蹤的過程傳給過程控制的用戶以及觀看的用戶；② 用于機器人服務器進行目標的識別跟蹤。

采集到的原始圖像是不適合直接用來網絡傳輸的，因為一般原始圖像的數據量是龐大的，如果直接用來網絡傳輸，將會占用大量的網絡帶寬。為了提高網絡傳輸的效率，加快網絡傳輸的速度，需要對原始圖像進行壓縮處理，去除圖像的冗余數據。圖像傳輸中圖像壓縮所采用的一般有靜態壓縮和動態壓縮兩種方式。靜態壓縮是對每一幀圖像進行獨立壓縮，不考慮前后兩幀圖像之間的關系。動態壓縮是對運動圖像序列進行壓縮，它不只是單獨針對一幀圖像，還考慮幀與幀之間的相互關系，但算法復雜。本系統采用了靜態的JPEG壓縮。為了保持數據的完整性，用于圖像處理采用了24位BMP格式。由于采用的是IP組播實現圖像的一對多傳輸，故采用的是用戶數據報協議（User Datagram Protol，UDP）協議［7］。

圖像解壓縮是圖像壓縮的逆過程，即將壓縮的圖像數據進行解碼，重現出圖像的原始內容，以顯示給遠程用戶。解壓縮方式是與壓縮方式相對應的。遠程用戶端將圖像解壓后，顯示給用戶。

由于本系統是一個簡單的基于事件的遠程控制系統，所以對圖像的實時性要求并不是太高，不需要用戶在對圖像的觀看過程中根據圖像的狀態對機器人發送控制指令，所要做的就是觀察遠程機器人是怎樣執行跟蹤的過程。

2 機器人對標定目標的跟蹤

本系統一個重要的特點就是用戶把控制信息發送過去之后，執行過程就不需要用戶進行干預，而是由機器人服務器去自主完成跟蹤，這就需要機器人服務器有強大的跟蹤能力，故引入IMM算法，提高對目標未來運動狀態的預測能力。

2.1 IMM 算法

假定目標有r種運動狀態，如勻速運動、勻加速運動等，每種運動狀態對應一種模型，即有r種運動模型，記為M1，M2，…，Mr。根據不同的運動狀態建立不同的模型濾波器，各模型濾波器通過估計狀態的組合實現交互作用，其輸出結果之間用馬爾可夫鏈進行切換，實現機動目標的混合狀態估計，即目標的運動狀態預測，這一算法稱為IMM算法。IMM算法是一種遞推的算法結構，其每一個循環過程大體上分為4步：輸入交互、各濾波器并行濾波、模型概率更新和輸出交互。

2.1.1 輸入交互

預測模型概率：

式中，Mj為系統模型；Zk－1為量測序列；pij為從模型i轉移到模型j的轉移概率。在k時刻

式中，Mi（k）為目標模型Mi發生的后驗概率。

濾波器初始狀態輸入：

濾波器初始協方差輸入：

2.1.2 各濾波器并行濾波

把式（3）和（4）的估計作為與模型Mj相匹配的濾波器的輸入，并對各濾波器分別進行卡爾曼濾波，得到各自的估計狀態X＾j（k／k）和協方差矩陣Pj（k／k）。

2.1.3 模型概率更新

在每一個模型完成上一步更新之后，利用似然函數Λj（k）計算新的模型概率μj（k），其中似然函數Λj（k）由2.1.2節中卡爾曼濾波中得到的測量殘差υj和殘差協方差Sj更新量計算得出：

模型概率μj（k）更新由貝葉斯定理給出：

2.1.4 輸出交互

在計算出各模型的后驗概率之后，就可以對各濾波器的狀態估計進行概率加權求和，得到最終的狀態估計和協方差：

2.2 IMM算法在目標跟蹤中的應用

本文采用基于特征差異的彩色目標識別方法［8］識別目標。在應用IMM算法時，設定運動目標具有勻速運動和勻加速運動兩種狀態，每種運動狀態對應一種模型，即有兩種運動模型。用于模型切換的馬爾可夫過程的轉移概率矩陣：

對于一個具有高斯噪聲的離散時間跟蹤系統，設采樣周期為T，其離散化后的運動和量測的數學模型可用以下狀態方程描述：

故，可以使用IMM算法估計出目標當前的狀態，并根據濾波殘差序列的統計特性［2］，構造目標下一時刻的矩形預測門。

3 實驗結果

本系統由校園網內的計算機做為遠程端，一個PentiumIV計算機作為機器人服務器和Web服務器，并與微型CCD攝像頭和機器人運動控制器相連，加上控制對象機器人本體和一個需要跟蹤的運動目標組成。其中，從攝像頭采集的圖像為320×240的分辨率，10幀／s。機器人為一個GRB—400型SKARA機器人，有一個固定的多關節機械手，具有4個自由度。

在坐標系選取上，以機器人工作臺坐標作為基準，其遠程控制的操作界面如圖2所示。

圖2 機器人遠程控制操作界面

當遠程標定目標后，機器人跟蹤目標的圖像就實時傳送過來，由于是在校園網內進行實驗，采用靜態壓縮，丟幀現象也明顯，所以圖像依然很流暢。

在機器人服務器端，可獲得目標的位置信息。從用戶登陸時保存的那幀圖像中找到目標，用顏色特征集法提取目標的特征，然后開始順序選取前3幀圖像，確定目標的起始速度、加速度。以后處理每一幀圖片時，都先由IMM濾波算法給出目標的預測位置，在以此為中心的一定區域內構造預測門，在該范圍內進行搜索，與特征值有最大相似度矩形的位置就認定為目標位置。同時，IMM算法能給出運動目標的狀態估計，經過軌跡規劃，由運動控制器控制機器人實時跟蹤目標。實驗取得了預期的效果，機器人跟蹤上了目標，并且圖像也回傳給登陸用戶。

4 結 語

本系統實現了在遠程標定跟蹤目標位置，通過Web服務器把信息發送給機器人服務器，驅動機器人進行目標跟蹤，并進行打擊，同時把視頻回傳給登陸用戶。引入IMM濾波算法，通過對連續的圖像中運動目標位置的預測，由原來的全局搜索改為局部搜索，極大地縮小了搜索空間，提高了跟蹤的效率；通過對目標運動狀態的估計，能快速準確的控制機器人跟蹤上目標。同時，采用了IP組播方式實現一對多的視頻傳輸。本文只是一個簡單的遠程智能事件控制機器人自主跟蹤遠程標定的目標系統，可實現遠程控制的功能，當控制信息發送以后，網絡時延等對于系統的影響就變得不再明顯。系統加強了機器人服務器端的執行能力，遠程控制端在傳出跟蹤信息后就不再控制，只是觀看，所以本系統暫時對圖像的傳輸質量沒什么控制，在校園網內圖像流暢，但是若在互聯網上圖像就可能不夠流暢。

［1］劉振寶，辛洪兵，王文靜.網絡機器人技術及其控制系統的研究狀況［J］.北京工商大學學報：自然科學版，2006，（5）：32－36.

［2］陳東炎，張 玘，王艷玲，等.圖像跟蹤系統中機動目標預測的實現［J］.應用光學，2007（1）：33－37，57.

［3］蘇建峰，吳海濤，邊玉敬.自適應濾波技術的研究［J］.飛行器測控學報，2006（2）：71－74.

［4］李 輝，趙 敏，張 安，等.交互式多模型算法在機動目標跟蹤中的應用［J］.彈箭與制導學報，2005，25（3）：234－237.

［5］陸其明.DirectShow實務精選［M］.北京：科學出版社，2004.

［6］董興娥，遲學芬，周仁貴，等.基于IP組播視頻會議系統的研究與實現［J］.吉林大學學報：信息科學版，2007（7）：385－390.

［7］陳 洋，陸宇平.機器人實時遠程控制系統及其開發庫的設計與實現［J］.電子技術應用，2006（2）：7－11.

［8］屠文柯，閻保定，楊海濤.基于影射·特征·知識的辨識復雜彩色目標的方法［J］.計算機工程與應用，2005（25）：54－56.