摘 要：在機械手執行任務的過程中，控制機械手定位到目標位置是一個非常關鍵的問題。本文提出了一種基于雙目立體視覺的機械手自動定位系統設計方法，由雙目立體視覺系統根據目標物的二維圖像計算出目標物的三維坐標，然后根據此三維坐標去控制機械手自動運動到目標位置。實驗表明該系統能提高排爆機器人機械手的易操作性，大大提高了機械手的性能。
關鍵詞：雙目立體視覺，標定，運動控制

機器人技術是涉及機械學、傳感器技術、驅動技術、控制技術、通信技術和計算機技術的一門綜合性高新技術， 既是光機電一體化的重要基礎， 又是光機電一體化技術的典型代表， 它是多學科科技革命的必然結果。 近年來， 隨著機器人研究的不斷發展， 機器人技術開始源源不斷地向人類活動的各個領域滲透， 結合這些領域的應用特點， 各種各樣的具有不同功能的機器人被研制出來，并且在不同的應用領域都得到了廣泛的應用。例如，美國Wolstenholme 機器公司生產的MR5和MR7排爆機器人，能用于戶內及戶外環境、適應各種地形活動，完成排爆功能，已被美國軍方廣泛使用。 排爆機器人是特種機器人的一種，主要用于在事發現場排除處理爆炸物及其他危險物品。 排爆機器人的多功能機械手，作為排爆機器人的完成抓取任務的主要執行器，應能完成包括抓取爆炸物在內的一系列任務，對于排爆機器人來講尤為重要。 排爆是一個充滿變化而復雜的過程，在排爆機器人執行任務的過程中， 最關鍵的一步就是控制機器人的多功能機械手去抓取目標物，即控制機械手精確的定位到目標物位置，完成抓取動作。 目前世界上已投入使用的排爆機器人，在工作方式上， 都需要一個經驗豐富的操作員，對機械手進行遠程手動控制，達到機械手精確定位的目的。這種工作方式，一方面對操作員的要求非常高，另一方面，手動控制也很難達到很高的精度。因此，若能通過計算機視覺技術實現機械手的自動精確定位，而不需要去手動控制機械手的各個關節，將會在很大程度上提高排爆機器人的性能。

本文詳細描述了基于雙目立體視覺的排爆機器人的多功能機械手自動定位系統的設計。

該系統首先由雙目立體視覺技術計算出目標物在視覺坐標系中的三維坐標， 并將該坐標轉換到機器人坐標系， 然后根據該坐標控制機械手實現自動定位。本文對該機器人的系統結構和雙目立體視覺子系統進行了詳細的描述。最后進行了實際的抓取實驗，取得了良好的實驗效果。

1、系統結構

該排爆機器人的主要功能部件為一輛能被遠程操控的運動小車和一個多關節多功能機械手。該機器人的裝配示意圖見圖1所示。

圖1 系統裝配示意圖
在排爆機器人執行任務的過程中，該小車將會被遙控到危險物所在的環境中，使危險目標物處于機械手的工作空間中，機械手便可以開始工作，完成抓取目標的任務。該機械手的設計仿照人類手臂的構造，總共有六個自由度，包括腰旋轉關節，肩轉動關節，肘轉動關節，腕轉動關節，手爪旋轉關節與手爪開閉關節。這種多自由度的設計使得機械手具有較大的靈活度，以適應復雜的工作環境的要求。

兩個攝像頭被安裝在機械手小臂上，用來充當雙目立體視覺系統的雙目。為實現機械手目標自動定位的功能，除了在現場工作的該機器人本體之外，還需要一臺不在現場的后臺計算機進行支持。兩攝像頭將攝取的目標物的圖像傳遞到后臺計算機，后臺計算機上的立體視覺子系統通過該兩幅二維圖像，計算出目標物在攝像頭坐標系中的三維坐標，將其轉換為在機器人坐標系中的三維坐標，并將其傳給機器人本體上的嵌入式計算機，并由該嵌入式計算機完成手臂的運動控制，控制手臂運動到目標物位置，從而實現自動目標定位的功能。系統結構如圖2所示。


圖2 系統裝配示意圖
2、雙目立體視覺子系統

雙目立體視覺是指用兩臺性能相當、位置固定的CCD攝像機， 獲取同一景物的兩幅圖像，通過兩個攝像頭所獲取的二維圖像，來計算出景物的三維信息。在原理上比較類似人類的雙目視覺。組建一個完整的雙目立體視覺系統一般需要經過攝像機標定，圖像匹配，深度計算等步驟。

2.1 攝像機標定

在攝像機成像過程中，物體成像在圖像上的位置與空間中該物體表面相應點的幾何位置有關，這些位置的相互關系，由攝像槍成像幾何模型所決定，該幾何模型的參數稱為攝像機參數。這些參數必須由試驗和計算決定，試驗和計算的過程稱為攝像槍標定。一般，攝像機的成像模型可用以下函數關系來描述：


其中Ileft，Iright， 分別為目標的左，右圖像坐標，Cleft，Cright則為目標分別在左攝像機坐標系和右攝像機坐標系中的三維坐標，而函數Hleft與Hright則代表了左攝像機和右攝像機的成像模型。利用張氏平面法可以方便的對Hleft與Hright進行估計。

在分別對左右攝像頭進行標定后，還需對該雙目立體視覺系統進行立體標定，目標是得到兩攝像頭之間的相對位置關系，由旋轉矩陣R和平移矩陣T來描述。


若得到多個空間點的Cleft，Cright數據，則可以通過最小二乘法得到旋轉矩陣R和平移矩陣T的估計值。

該雙目立體視覺系統標定結果如圖3所示。


圖3 標定結果
2.2 深度計算

當進行了單攝像頭標定和立體標定之后，該雙目立體視覺系統的模型被建立起來，兩攝像頭的二維圖像坐標與空間三維坐標之間有以下關系：


若得到空間任一點分別在兩攝像頭成像中的圖像坐標Ileft，Iright，則可以通過解上述方程得到該空間點在左攝像機坐標系中的三維坐標Cleft，同理，也可得到其在右攝像機坐標系中的三維坐標Cright。同一點的兩圖像坐標則由圖像匹配過程獲得。

3、嵌入式控制子系統

位于機器人本體上的嵌入式計算機用于對機械手進行控制。包括手臂的整體運動規劃與各關節直流電機的位置控制。當嵌入式計算機收到后臺計算機發來的目標物的三維坐標后，便會根據該三維坐標對手臂各關節的運動進行規劃，并實施底層的電機位置控制。如圖4所示。