盧曉紅 王文韜 司立坤 韓鵬卓 任宗金

(大連理工大學(xué)精密與特種加工教育部重點實驗室，遼寧 大連 116024)

未來復(fù)雜的服役環(huán)境要求自動化設(shè)備空間機械手必須具備精確的末端定位和空間姿態(tài)控制［1］，而機械手裝配間隙、承載變形等原因?qū)е缕淠┒藞?zhí)行器的位置與理論計算存在偏差，良好的運動學(xué)設(shè)計是解決上述問題的有效途徑，而對機械手的運動軌跡、空間位姿的測量是合理規(guī)劃、精確位姿控制及運動分析的必要手段。

目前對空間機械手的運動軌跡和位姿測量一般采用接觸式和非接觸式兩種方式。非接觸方式響應(yīng)速度快、測量過程簡單，大大提高了測量效率，而且不增加被測量設(shè)備的承載負(fù)擔(dān)，是目前較適合機械手位姿測量、復(fù)雜機構(gòu)構(gòu)件運動軌跡測量的方法。非接觸方法主要有基于攝像技術(shù)的圖像提取、雙目立體視覺法、激光跟蹤測量、激光三角測量、室內(nèi)GPS 等方法?；跀z像技術(shù)的雙目視覺測量方法用兩臺攝像機或照相機模擬人的雙眼，獲得有一定視差的兩幅圖像，計算機通過圖像處理，運用雙目視覺原理，就可以得到圖像中空間目標(biāo)的三維信息。如果將攝像機安裝在機械手的末端，在運動過程中觀測同一個固定目標(biāo)，通過計算攝像機坐標(biāo)系下固定目標(biāo)的變化，反求出末端執(zhí)行器的空間位置和姿態(tài)的變化［2-3］。Lau 等人提出的單站式5D 激光跟蹤干涉測量系統(tǒng)［4］，該系統(tǒng)可以測量目標(biāo)的X、Y、Z、俯仰角和偏擺角5 個自由度。奧地利維也納工業(yè)大學(xué)的J.P.Prenninger 等人建立了一種單站式6 -D 激光跟蹤測量系統(tǒng)［5］，用來實時動態(tài)地測量機器人關(guān)節(jié)末端運動的6 個自由度。清華大學(xué)的劉永東設(shè)計了三站激光跟蹤坐標(biāo)測量系統(tǒng)，實現(xiàn)了平面運動目標(biāo)坐標(biāo)的跟蹤測量［6］。日本的Seiji AOYAGI 等人利用超聲波測距的原理開發(fā)了一套超聲波位姿測量系統(tǒng)［7］，該系統(tǒng)利用多邊法測量空間三維坐標(biāo)。室內(nèi)GPS(indoor global positioning system，iGPS)的定位原理跟GPS 相同［8］，只是iGPS 的室內(nèi)標(biāo)定好的多個標(biāo)定裝置代替了GPS 的空間衛(wèi)星［9］，iGPS 接收裝置安裝在工業(yè)機器人的末端執(zhí)行器上，將末端的空間三維信息實時的傳遞給控制計算機。該測量裝置適合大空間的跟蹤測量，目前有應(yīng)用在飛機機體焊接上的報道。位置敏感探測器(PSD)通過收集其電極輸出的光電流就能連續(xù)地、實時地檢測出入射光斑的重心位置。PSD 入射光斑位置的模擬信號是從位于光電二極管表面電阻層邊緣的電極輸出的，這種非尋址的探測器的優(yōu)點是探測器和信號處理電路結(jié)構(gòu)簡單，且能實現(xiàn)連續(xù)的位置模擬信號輸出，而不存在測量盲區(qū)［10］。與CCD 相比，PSD 具有響應(yīng)速度快、感應(yīng)面連續(xù)、成本低、傳輸速度快等優(yōu)點，廣泛應(yīng)用在三維測量、角度姿態(tài)測量等領(lǐng)域。哈爾濱工業(yè)大學(xué)研制了用于空間飛行器對接的位置敏感器近程操作模擬器［11］，由PSD 為核心器件構(gòu)成的光電傳感系統(tǒng)在近程內(nèi)對放置在空間飛行器上的合作目標(biāo)的位置和姿態(tài)進(jìn)行高精度測量。由激光器與位置敏感探測器PSD 組成的傳感器被大量地用于機器人上，傳感器可測量撓性機械臂的除桿長方向外的5 個自由度誤差［12］。1993 年日本中京大學(xué)和松下共同研制了一種利用PSD 的三維視覺傳感器，用于機器人中獲取運動物體的三維形狀［13］。

目前主流的運動軌跡和位姿測量手段是基于CCD 的多目視覺法和基于PSD 的光源陣列法。CCD攝像機傳輸?shù)氖菆D像信息，其測量精度很大程度上依賴高像素的照片，而高像素必定會影響相機的傳輸幀頻，所以基于CCD 的測量在精度和響應(yīng)速度上是矛盾的。與之相比，PSD 則不存在這樣的問題，PSD 是依靠輸出的電流或電壓來計算目標(biāo)光斑的位置，可以達(dá)到幾十千赫的傳輸速度而不影響數(shù)據(jù)的精度。近年來，對PSD 器件的研究有很大進(jìn)展，PSD 器件的線性度和穩(wěn)定度也有很大改善［14］。PSD 器件自身的分辨率可達(dá)1 μm，陸軍等用包括激光發(fā)射器、激光供電電源、PSD 器件等組成的PSD 位置測量系統(tǒng)進(jìn)行二維測量，其平均控制誤差為50 μm［15］。因此，在相同成本下，使用PSD 光源陣列法進(jìn)行運動軌跡和位姿測量的應(yīng)用具有較好的前景。

在實際應(yīng)用中，很多的機械設(shè)備的移動速度都很快，加工中心的自動換刀機械手一次動作一般在2～5 s，而且是在三維空間內(nèi)運動，運動空間受限，無法安裝激光發(fā)射器。天津大學(xué)李興達(dá)進(jìn)行了基于PSD 的光點空間位置測量技術(shù)研究，距離12 m 處X 方向最大絕對誤差為29 mm［16］。根據(jù)對PSD 相應(yīng)光譜的研究和分析，發(fā)現(xiàn)近紅外區(qū)是PSD 最敏感的范圍，大約在900 nm，這就要求被測標(biāo)靶光源的主要光譜分布也在這個區(qū)域。為了減少對被測量的自動化設(shè)備的負(fù)載及機械動作的影響，光源必須能夠?qū)崿F(xiàn)恒流驅(qū)動和無線控制。本文針對基于雙PSD 實現(xiàn)空間點三維運動軌跡和位姿檢測方面的關(guān)鍵技術(shù)展開研究，探索一種以大功率紅外LED 為目標(biāo)光源的非接觸式三維位姿檢測方法，解決有限空間內(nèi)，復(fù)雜機構(gòu)上點目標(biāo)的運動軌跡實時在線測量、機器人末端執(zhí)行器的空間位置及姿態(tài)的快速測量問題。

1 基于PSD 的運動軌跡和位姿測量原理

1.1 PSD 工作原理

二維枕型PSD 結(jié)構(gòu)如圖1 所示，二維枕型PSD 以感應(yīng)面中心點為參考坐標(biāo)系原點，入射光斑A 點的坐標(biāo)值與4 個電極上的電流滿足式(1)和式(2)。

式中:L 為光敏感面長度。從式(1)和式(2)可以看出，通過二維PSD 的4 個電極上的電流值就可以求解出入射光點在PSD 感光面上的平面位置信息。同理，利用2 個PSD 設(shè)備，就可以得到目標(biāo)光源的三維位置信息。

1.2 基于PSD 的機械手運動軌跡測量裝置的工作原理

使用單個PSD 的投影是基于針孔相機的線性映射關(guān)系。本文通過4 個坐標(biāo)系統(tǒng)(如圖2 所示)的定義及相互轉(zhuǎn)換關(guān)系解釋映射關(guān)系。

(1)世界坐標(biāo)系:根據(jù)被測工件所在的自然環(huán)境選定的絕對坐標(biāo)系;(2)鏡頭坐標(biāo)系:以透鏡中心OL為坐標(biāo)原點，透鏡光軸為ZL軸，XL、YL軸與PSD 坐標(biāo)系的XS、YS軸平行;(3)圖像坐標(biāo)系:圖像平面為PSD 理想的投影平面，原點O2為光軸與投影平面的交點，Xz、Yz軸與鏡頭坐標(biāo)系的XL、YL軸平行，方向相反;(4)PSD 坐標(biāo)系:其XSOSYS平面與圖像的XZOIYZ平面共面，原點為PSD 傳感器的物理中心，XS、YS軸與圖像坐標(biāo)系的XI、YZ軸方向相同，坐標(biāo)原點相差一個偏移量。

鏡頭坐標(biāo)系是世界坐標(biāo)系經(jīng)過旋轉(zhuǎn)、平移的組合變換得到的，設(shè)旋轉(zhuǎn)矩陣為R，平移矩陣為T。設(shè)空間P 點在世界坐標(biāo)系下的坐標(biāo)為(XW，YW，ZW)。P 點在世界坐標(biāo)系中的坐標(biāo)XwYwZw與PSD 坐標(biāo)系中映射的二維坐標(biāo)值(u，v)之間的對應(yīng)關(guān)系如式(3)所示。

在計算機視覺中將相機的參數(shù)分為兩大類，即內(nèi)參數(shù)和外參數(shù)。內(nèi)參數(shù)是相機與焦距及感應(yīng)屏上像元分布有關(guān)。式(3)中A 稱為相機的內(nèi)參數(shù)矩陣。外參數(shù)是指相機在世界坐標(biāo)系中的方位，可以通過R 和T獲得，故稱［R T］為外參數(shù)矩陣。

式(3)實質(zhì)是空間一個光源點P 在世界坐標(biāo)系中的三維坐標(biāo)值(XWYWZW)與其透過工業(yè)鏡頭的光斑點在PSD 坐標(biāo)系中的二維坐標(biāo)值(u，v)之間的映射關(guān)系，可將此過程簡化為式(4)。

式中:k 為比例系數(shù)，其與相機到標(biāo)定板之間的距離成正比;M 為光敏設(shè)備的映射矩陣。將式(4)中的比例系數(shù)k 消掉，得到式(5)。

所研發(fā)的基于PSD 的測量裝置是通過2 套PSD以固定的相對位置組合形成，左右PSD 傳感器同時探測空間同一個目標(biāo)光源，兩PSD 輸出值與空間坐標(biāo)可表示為式(6)。

通過最小二乘法求解式(6)，得到目標(biāo)光源中心在世界坐標(biāo)系下的坐標(biāo)值。即為PSD 位置測量工作原理。

2 基于雙PSD 的運動軌跡跟蹤測量系統(tǒng)研發(fā)

2.1 系統(tǒng)硬件搭建

所研發(fā)的基于雙PSD 的機械手運動軌跡測量裝置是由2 個PSD 模塊(日本濱松光子學(xué)株式會社生產(chǎn)的C10443 -03 型枕型PSD，其有效感應(yīng)面積為12 mm×12 mm，分辨率為1.4 μm，敏感光譜范圍為320～1060 nm，光譜峰值對應(yīng)波長為920 nm，最大光功率為167 μW，光靈敏度為60 mV/μW)、工業(yè)鏡頭及連接支架以固定的空間夾角組合而成，主要用于測量目標(biāo)光源的空間位置，如圖3 所示。

2.2 信號采集與傳輸

PSD 測量裝置的信號傳輸和數(shù)據(jù)采集如圖4 所示。C10443 -03 型PSD模塊作為傳感器檢測目標(biāo)光源的光信號，在PSD 內(nèi)部實現(xiàn)光信號到位置信號的轉(zhuǎn)換，在反偏電壓的驅(qū)動下，PSD 將位置信號以電壓量輸出。C10460 型信號處理器給PSD 模塊提供反偏電壓，同時將PSD 模塊輸出的電壓量調(diào)整為與光斑位置以1 mm/V 比例對應(yīng)。NI 9215 模擬電壓采集卡采集C10460 型信號處理器輸出的電壓信號，并以最高100 kHz 的采樣頻率對電壓信號采用后傳送給工控機進(jìn)行計算。

PSD 測量裝置的測量目標(biāo)是一個穩(wěn)定的散射點光源，要想測量機械手的角位移和軸向位移，必須將被測目標(biāo)光源放置在機械手臂上。由于ATC 的復(fù)雜結(jié)構(gòu)和特殊的運動過程，所以，目標(biāo)光源必須進(jìn)行恒流驅(qū)動和無線控制。圖5 為目標(biāo)光源的無線控制和恒流驅(qū)動流程圖。為了能夠提供足夠的光功率，目標(biāo)光源選擇電光轉(zhuǎn)換效率高的大功率LED 點光源。使用鋰電池和恒流驅(qū)動電路給LED 供電，保證了光源的穩(wěn)定性和使用壽命。驅(qū)動電路的工作狀態(tài)由無線數(shù)字傳輸模塊控制。大容量鋰電池組為恒流驅(qū)動電路和無線數(shù)字傳輸模塊提供電源。為了便于在機械手臂上安裝使用，將鋰電池組、無線數(shù)字傳輸模塊、恒流驅(qū)動電路和LED 光源封裝在一起，構(gòu)成目標(biāo)光源模塊，并配備強磁座。在工控機端是光源控制模塊，計算機通過NI 9401 數(shù)字量采集卡向另一塊無線數(shù)字傳輸模塊發(fā)送控制命令，兩個無線數(shù)字傳輸模塊通過無線通訊協(xié)議相互通信。這種光源控制和驅(qū)動方式具有響應(yīng)速度快、狀態(tài)切換過程時間短、光源穩(wěn)定性好及續(xù)航時間長等優(yōu)點。

2.3 系統(tǒng)的標(biāo)定

PSD 在實際使用前要進(jìn)行標(biāo)定。視覺測量設(shè)備的標(biāo)定方法很多，例如使用二維標(biāo)定板的張氏標(biāo)定法。PSD 測量裝置是用于測量目標(biāo)光源的三維坐標(biāo)值，考慮到點光源很難形成精度較高的平面標(biāo)定模板，所以我們采用三維立體標(biāo)定法來標(biāo)定PSD。

根據(jù)式(6)，線性投影模型的映射模型可以表示為式(7):

式(7)實質(zhì)上是3 個相關(guān)的方程，將第3 個方程代入前兩個得到式(8):

式中:(XW，YW，ZW)表示目標(biāo)光源中心在世界坐標(biāo)系中的三維坐標(biāo);(u，v)表示目標(biāo)光源中心映射在PSD感應(yīng)屏上的光斑在PSD 坐標(biāo)系下的坐標(biāo)值，mi是投影矩陣M 的元素。在三維標(biāo)定中，目標(biāo)光源的每個測量位置的三維坐標(biāo)都與投影光斑在PSD 坐標(biāo)系上的一對二維坐標(biāo)值形成兩個線性方程。當(dāng)標(biāo)定實驗選擇n個測量位置時，就形成2n 個關(guān)于投影矩陣M 的方程組(9):

本文利用高精度的三坐標(biāo)測量機對PSD 測量裝置進(jìn)行三維標(biāo)定。目標(biāo)光源采用5 W 大功率LED 燈珠，光源波長為650 nm，采用恒流電路驅(qū)動，將光源放置在三坐標(biāo)測量立柱上，調(diào)節(jié)PSD 測量裝置的位置，保證其測量視野覆蓋預(yù)設(shè)的三坐標(biāo)機的活動范圍，PSD 輸出的信號經(jīng)過PSD 信號處理器、電壓數(shù)據(jù)采集卡，傳輸?shù)焦た貦C，通過PSD 測量裝置標(biāo)定程序控制標(biāo)定過程和記錄實驗數(shù)據(jù)。實驗過程在250 mm×250 mm×170 mm 的三維空間內(nèi)進(jìn)行標(biāo)定，總共平均選取了108 個測量位置點進(jìn)行標(biāo)定。將PSD 的測量坐標(biāo)作為輸入函數(shù)，三坐標(biāo)測量機的空間坐標(biāo)為輸出函數(shù)，用最小二乘法擬合。然后，在整個測量空間內(nèi)再隨機取27 個位置點，通過對比系統(tǒng)測量數(shù)據(jù)與三坐標(biāo)輸出的真實位置數(shù)據(jù)進(jìn)行對比，對系統(tǒng)誤差進(jìn)行評定。

將108 個測量位置光源的三維坐標(biāo)和PSD 輸出的二維坐標(biāo)代入式(9)，通過求解方程及優(yōu)化參數(shù)得到兩個PSD 設(shè)備的坐標(biāo)轉(zhuǎn)換矩陣Ml和Mr:

PSD 測量裝置標(biāo)定完成之后，就可以進(jìn)行目標(biāo)光源三維坐標(biāo)測量。將標(biāo)定實驗得到的轉(zhuǎn)換矩陣ML和Mr代入式(6)中，計算出目標(biāo)光源的三維坐標(biāo)值。

最后，通過27 組實驗數(shù)據(jù)，驗證計算得到所搭建的雙PSD 測量系統(tǒng)誤差絕對值最大值為9.0438 mm;誤差絕對值平均值為3.8008 mm。

3 加工中心ATC 角位移和軸向位移測試試驗

在機械手角位移和軸向位移測試中，為了直觀地顯示出機械手實時的角位移和軸向位移變化，建立一個機械手坐標(biāo)系(如圖6 所示)，旋轉(zhuǎn)軸線為Z 軸，旋轉(zhuǎn)平面為XOY 平面，機械手抓刀位置為角度計算零點，此時手臂所指方向為與X 軸平行。

ATC 機械手角位移測量結(jié)果，如圖7 所示。從凸輪方向觀測機械手，其角位移逆時針增長。機械手在刀庫方向的抓刀位置為角位移的0°，待機時所處的位置為90°。從角位移圖中可以看出，機械手的角位移輸出曲線整體平穩(wěn)，機械手的原始啟動位置與抓刀位置之間的角位移并非90°，偏差在8°左右，這可能是裝配誤差造成的。

ATC 機械手軸向位移的測量結(jié)果，如圖8 所示。機械手待機時所處的位置為軸向位移零點，沿旋轉(zhuǎn)軸向錐齒輪副方向增長。從軸向位移圖上可以看出，機械手在換刀過程中的抖動特別明顯，特別是在機械手臂旋轉(zhuǎn)的過程中，在軸向的竄動很大，同時“抓刀”和“回位”動作比“換刀”動作抖動明顯。結(jié)合角位移和軸向位移可以看出，在“換刀”過程中，機械手臂存在軸向移動現(xiàn)象，使軸向位移峰值段呈現(xiàn)上升趨勢。

另外，從兩幅測量圖中可以看出機械手一個換刀動作用時為2.806 s，由此可見，該種方法還可以測量ATC 的換刀時間。

4 結(jié)語

機械手的運動是旋轉(zhuǎn)運動和直線運動的合成，利用非接觸式測量儀器對機械手的空間運動進(jìn)行測量，最后分解為角位移和軸向位移是一種有效的測量方法。非接觸式測量設(shè)備安裝方便、不干擾被測量機構(gòu)的正常運行，移植性強，適合機械手的角位移和軸向位移測量。目前，利用雙PSD 系統(tǒng)進(jìn)行空間點的非接觸軌跡測量方面，國內(nèi)處于起步階段，大多采用激光作為目標(biāo)光源。在工程實際中，很多機械手在三維空間內(nèi)運動，受限于運動空間，無法安裝激光發(fā)射器。近紅外區(qū)是PSD 最敏感的范圍，大約在900 nm，因此，能夠?qū)崿F(xiàn)恒流驅(qū)動和無線控制的大功率紅外LED 可以作為目標(biāo)光靶，其不會對待測機械臂產(chǎn)生影響。本文探索了一種以LED 光源為目標(biāo)光源的基于雙PSD 的空間點三維運動軌跡跟蹤測量系統(tǒng)，測量誤差絕對值最大值為9.0438 mm。本文所做研究為解決有限空間內(nèi)，復(fù)雜機構(gòu)上點目標(biāo)的運動軌跡實時在線測量、機器人末端執(zhí)行器的空間位置及姿態(tài)的快速測量問題探索了一條可行之路。提高雙PSD 系統(tǒng)測量精度對于雙PSD 測量系統(tǒng)在機械手運動軌跡跟蹤測量的應(yīng)用方面是重中之重，亟待進(jìn)行深入研究。

［1］Zhang Liping，Ma Shugen，Li Bin，et al.Two-dimensional PSD based automatic docking of self-reconfiguration modular exploration robot system［J］.Chinese Journal of Scientific Instrument，2007，28(7):1198-1204.

［2］Jing Yuan，Yu S L.End -effector position -orientation measurement［J］.IEEE Transactions on Robotics and Automation，1999，15(3):592 -595.

［3］歲波，都東，陳強，等.基于雙目視覺的工業(yè)機器人運動軌跡準(zhǔn)確度檢測［J］.機械工程學(xué)報，2003，39(5):87 -91.

［4］Lau K，Hocken R，Haynes L.Robot performance measurements using automatic laser tracking techniques［J］.Robotics and Computer -Integrated Manufacturing，1985，2(3 -4):227 -236.

［5］Spiess S，Vincze M，Ayromlou M.On the calibration of a 6 -D laser tracking system for dynamic robot measurements［J］.IEEE Transactions on Instrumentation and Measurement，1998，47(1):270 -274.

［6］劉永東，王佳，胡朝暉，等.距離法運動目標(biāo)激光跟蹤測量系統(tǒng)的研究［J］.光學(xué)儀器.2001，23(3):12 -16.

［7］Hsiao H，Keyserling W M.A three -dimensional ultrasonic system for posture measurement［J］.Ergonomics，1990，33(9):1089 -1114.

［8］吳曉峰，張國雄.室內(nèi)GPS 測量系統(tǒng)及其在飛機裝配中應(yīng)用［J］.航空精密制造技術(shù).2006，42(5):1 -5.

［9］Schmitt Robert，Sch?nberg，Alexander，Damm，Bj?rn.Indoor -gps based robots as a key technology for versatile production［C］.Joint 41st International Symposium on Robotics and 6th German Conference on Robotics 2010，ISR/ROBOTIK 2010，1:199 -205.

［10］林永濤.PSD 綜合性能檢測系統(tǒng)的研制［D］.杭州:浙江大學(xué).2012.

［11］蔡喜平，趙遠(yuǎn)，戴永江，等.空間飛行器對接的PSD 近程操作模擬器［J］.光電工程，1996，23(6):30 -33.

［12］鄧敢，朱建，王興松.撓性臂撓性偏差及其末端位移的測量［J］.機器人技術(shù)與應(yīng)用，1999(6):24 -26.

［13］張曉芳，王寶光，蔣誠志.位置探測器PSD 應(yīng)用于三維坐標(biāo)測量的理論研究［J］.光學(xué)技術(shù)，2001，27(4):362 -364，366.

［14］蔣麗雁，李立群.基于PSD 的激光微位移測量系統(tǒng)［J］.工具技術(shù)，2013(4):70 -72.

［15］陸軍，宋景豪，劉永.基于視覺和PSD 的高精度機械手伺服控制［C］.第三十二屆中國控制會議論文集(D 卷)，2013(7):5650 -5655.

［16］李興達(dá).基于PSD 的光點空間位置測量技術(shù)研究［D］.天津:天津大學(xué)，2012.