趙祚喜，馮 榮，朱裕昌，談 婷

(華南農(nóng)業(yè)大學(xué) 工程學(xué)院，廣東 廣州 510642)

1 引 言

在航空航天、機(jī)械制造、汽車裝配等領(lǐng)域，各種復(fù)雜零件的研制、生產(chǎn)和裝配、建模、仿真、分析，需要先進(jìn)的檢測(cè)技術(shù)和測(cè)量方法。對(duì)于越來越多需要進(jìn)行空間三維測(cè)量的工件，傳統(tǒng)的線、面檢測(cè)方法已不能滿足生產(chǎn)需要，因此坐標(biāo)測(cè)量技術(shù)將作為幾何量測(cè)的研究重點(diǎn)[1]。傳統(tǒng)的坐標(biāo)測(cè)量方法一般采用全站儀、三坐標(biāo)測(cè)量?jī)x、激光跟蹤儀等進(jìn)行三維關(guān)鍵點(diǎn)的測(cè)量，這些儀器每次只能測(cè)量很少的點(diǎn)，測(cè)量速度相當(dāng)慢[2-4]。由于基于計(jì)算機(jī)視覺的三維定位技術(shù)具有非接觸、無破壞以及高分辨率、測(cè)量效率高的優(yōu)點(diǎn)，已逐漸成為幾何量測(cè)技術(shù)的研究重點(diǎn)[5]。

3D視覺測(cè)量系統(tǒng)根據(jù)相機(jī)是否需要固定分為大致分為兩種測(cè)量模式：一種是攝像機(jī)固定式的三維測(cè)量，即攝像機(jī)固定，操作人員手持光筆，將光筆低端的測(cè)針接觸物體表面上的被測(cè)點(diǎn)，攝像機(jī)系統(tǒng)通過光筆上鑲嵌的多個(gè)光學(xué)特征點(diǎn)，求解出光筆的空間位姿參數(shù)，由于測(cè)針的幾何位置已知，被測(cè)點(diǎn)的三維坐標(biāo)即可被精確測(cè)量出來；另一種是攝像機(jī)移動(dòng)式的三維測(cè)量，事先在被測(cè)物體表面粘貼標(biāo)記點(diǎn)，利用手持式高分辨率數(shù)碼相機(jī)在多個(gè)位置對(duì)被測(cè)物體進(jìn)行拍攝，測(cè)量軟件對(duì)圖像自動(dòng)進(jìn)行處理并計(jì)算出標(biāo)記點(diǎn)的空間坐標(biāo)，實(shí)例是各種手持3D掃描儀。

在3D視覺定位領(lǐng)域的研究和應(yīng)用很多。趙永國[6]等在移動(dòng)機(jī)器人避障過程中為獲取障礙物在現(xiàn)實(shí)世界坐標(biāo)系下的三維坐標(biāo)，利用MATLAB與Triclops SDK數(shù)據(jù)庫，開發(fā)了一套基于雙目視覺的移動(dòng)機(jī)器人避障系統(tǒng)，實(shí)測(cè)數(shù)據(jù)表明該套系統(tǒng)具有不錯(cuò)的避障表現(xiàn)；解則曉[7]等為了對(duì)車間生產(chǎn)工件實(shí)現(xiàn)高精度、大尺寸的三維坐標(biāo)現(xiàn)場(chǎng)測(cè)量，設(shè)計(jì)了一套光筆測(cè)量系統(tǒng)，該系統(tǒng)由兩臺(tái)面陣CCD攝像機(jī)、光筆、支架及一臺(tái)筆記本電腦組成，通過試驗(yàn)測(cè)試了該系統(tǒng)在有效視場(chǎng)范圍內(nèi)的測(cè)量精度，基本滿足要求不太高的大尺寸現(xiàn)場(chǎng)測(cè)量；董英華[8]等為提高其研發(fā)的光筆式視覺坐標(biāo)測(cè)量系統(tǒng)的測(cè)量精度，采用改進(jìn)的Tsai標(biāo)定法實(shí)現(xiàn)攝像機(jī)的高精度標(biāo)定，通過數(shù)學(xué)平均思想提高了測(cè)頭中心的穩(wěn)定性及算法的收斂速度；孔筱芳[9]等提出一種雙目攝像機(jī)標(biāo)定及空間坐標(biāo)重建方法，采用了高精度GPS代替2D或3D靶標(biāo)，與傳統(tǒng)的3D靶標(biāo)標(biāo)定方法相比，其空間重建坐標(biāo)相對(duì)距離誤差從1.56%減少到0.52%，具有較高的空間坐標(biāo)重建精度，但GPS不便于安裝到被測(cè)物體表面點(diǎn)上，不滿足實(shí)際的應(yīng)用場(chǎng)景。

國內(nèi)外一些公司已開發(fā)出成熟的3D測(cè)量產(chǎn)品，國外的有挪威Metronor公司的SOLO系統(tǒng)、美國GSI公司的V-STARS系統(tǒng)和Aicon公司的ProCam系統(tǒng)等[10]，國內(nèi)的有北京天遠(yuǎn)三維科技公司的DigiMetric三維攝影測(cè)量系統(tǒng)和Robot動(dòng)作捕捉系統(tǒng)等。SOLO系統(tǒng)主要由相機(jī)、測(cè)量光筆及測(cè)針、筆記本電腦及測(cè)量軟件組成，該系統(tǒng)可實(shí)現(xiàn)30 m的范圍測(cè)量，長(zhǎng)度測(cè)量精度為25 μm，還可以測(cè)量600 mm深度的隱藏點(diǎn)[11]；V-STARS/S系統(tǒng)由1套測(cè)量型數(shù)碼相機(jī)、1臺(tái)筆記本電腦(含系統(tǒng)軟件)、1根基準(zhǔn)尺、1根定向棒、1組人工特征標(biāo)志點(diǎn)組成，10 m范圍的坐標(biāo)測(cè)量精度達(dá)到0.044 mm[12]；DigiMetric三維攝影測(cè)量系統(tǒng)是在被測(cè)物體表面粘貼若干標(biāo)記點(diǎn)，利用手持式高分辨率數(shù)碼相機(jī)在多個(gè)位置對(duì)被測(cè)物體進(jìn)行拍攝，將拍攝所得圖像導(dǎo)入到計(jì)算機(jī)中，DigiMetric測(cè)量系統(tǒng)軟件對(duì)圖像自動(dòng)進(jìn)行處理并計(jì)算出標(biāo)記點(diǎn)的三維坐標(biāo)，具有測(cè)量環(huán)境不受限制，測(cè)量范圍不受限制，操作簡(jiǎn)單方便等優(yōu)點(diǎn)，坐標(biāo)測(cè)量精度≤0.1 mm/4 m。

以上的方法往往需要昂貴的儀器、專門的設(shè)備因而應(yīng)用受到限制，例如能同時(shí)定位的點(diǎn)數(shù)、二次開發(fā)能力等的限制，難以在一般的實(shí)驗(yàn)室推廣使用。本文提出一種不需要昂貴儀器的物體點(diǎn)世界坐標(biāo)系3D定位方法。該方法基于直接線性變換(Direct Linear Transformation，DLT)的物體上點(diǎn)的世界坐標(biāo)系下的三維定位方法， 適用于單臺(tái)相機(jī)移動(dòng)獲取的多視圖實(shí)現(xiàn)的靜態(tài)結(jié)構(gòu)體點(diǎn)的定位，也適合于多臺(tái)相機(jī)同時(shí)拍攝獲取的機(jī)器上點(diǎn)的三維動(dòng)態(tài)定位。根據(jù)空間幾何線-線交會(huì)原理，利用最小二乘法實(shí)現(xiàn)空間點(diǎn)的世界坐標(biāo)測(cè)量，與傳統(tǒng)的測(cè)量法相比，該方法能夠?qū)崿F(xiàn)任意個(gè)點(diǎn)的3D世界坐標(biāo)測(cè)量，而且相機(jī)位置可移動(dòng)，使用方便。

2 基于DLT方法的相機(jī)標(biāo)定及物理點(diǎn)多視圖3D定位原理分析

2.1 DLT相機(jī)標(biāo)定

圖1 小孔成像模型示意圖

相機(jī)標(biāo)定的基本方法是通過環(huán)境(有專門的幾何形狀已知的標(biāo)定對(duì)象或無專門的標(biāo)定對(duì)象)來確定相機(jī)幾何參數(shù)的過程，是計(jì)算機(jī)3D視覺應(yīng)用的首要步驟，按照使用的標(biāo)定對(duì)象的不同可分為3D，2D，1D及無標(biāo)定對(duì)象[13]。DLT標(biāo)定方法是一種基于3D標(biāo)定對(duì)象的相機(jī)標(biāo)定方法，即將標(biāo)定對(duì)象上每一個(gè)已知控制點(diǎn)(3D世界坐標(biāo)已知)和相機(jī)圖片上的對(duì)應(yīng)的成像點(diǎn)(圖像坐標(biāo)系下2D像素坐標(biāo)已知)建立線性模型(式(2))，將相機(jī)內(nèi)外參、幾何失真參數(shù)視為未知數(shù)，設(shè)置多個(gè)控制點(diǎn)使所列的方程數(shù)不小于未知數(shù)數(shù)量，再利用最小二乘法實(shí)現(xiàn)這些參數(shù)的線性估計(jì)(不使用旋轉(zhuǎn)矩陣各個(gè)元素之間的非線性約束)，原理簡(jiǎn)單計(jì)算工作量小[13-14]。本章有關(guān)DLT方法參考了文獻(xiàn)如下[15]，DLT相機(jī)標(biāo)定方法的完整介紹[16]。圖1為小孔成像模型示意圖，在相機(jī)標(biāo)定過程中涉及4個(gè)坐標(biāo)系及3次坐標(biāo)轉(zhuǎn)換，分別為世界坐標(biāo)系W到相機(jī)坐標(biāo)系C的轉(zhuǎn)換①，相機(jī)坐標(biāo)系C到圖像坐標(biāo)系I的轉(zhuǎn)換②，圖像坐標(biāo)系I到像素坐標(biāo)系S的轉(zhuǎn)換③，最終得到像素坐標(biāo)系S和世界坐標(biāo)系W間的線性變換關(guān)系[17-18]如式(1)所示：

(1)

其中，(ui,vi,1)T為各成像點(diǎn)的像素齊次坐標(biāo)，b為相機(jī)焦距，ku，kv分別為單個(gè)像素在u和v方向上的真實(shí)尺寸，(u0,v0)為焦點(diǎn)的像素坐標(biāo)，rij(i,j=1,2,3)為世界坐標(biāo)系至相機(jī)坐標(biāo)系之間旋轉(zhuǎn)矩陣R中的元素，(xwi,ywi,zwi) (i=1, 2，…，N)為各標(biāo)定點(diǎn)的3D世界坐標(biāo)，(x0,y0,z0)為平移矩陣T，表示相機(jī)坐標(biāo)系原點(diǎn)oc在世界坐標(biāo)系下的坐標(biāo)，zci(i=1, 2…N)為各標(biāo)定點(diǎn)在相機(jī)坐標(biāo)系Z方向上的坐標(biāo)。

將式(1)展開得式(2)：

ui-u0=

vi-v0=

(2)

將式(2)整理為如下式(3)，使得式(3)中像素坐標(biāo)(ui,vi)值只取決于標(biāo)定點(diǎn)的世界坐標(biāo)(xwi,ywi,zwi) (i=1, 2，…，N)及11個(gè)包括相機(jī)內(nèi)外參數(shù)的常數(shù)參數(shù)Lk(k=1, 2，…，11)。

(3)

參數(shù)L1～L11可用內(nèi)外參數(shù)表示為如式(4)：

(4)

其中：bu=b/ku，bv=b/kv，D=-(x0r31+y0r32+z0r33)。

將式(3)寫成矩陣形式：

(5)

相機(jī)標(biāo)定中，需要設(shè)置N(N≥6)個(gè)已知三維坐標(biāo)的控制點(diǎn)，故式(5)中含有2N個(gè)線性方程，令:

(6)

則式(6)可表示為求解非齊次線性方程組的矩陣形式Ax=b，采用最小二乘法可求解出未知量x，即：

x=(ATA)-1ATb.

(7)

包含內(nèi)外參數(shù)的Lk(k=1, 2,…,11)求解出后，需要通過式(4)來求解16個(gè)內(nèi)外參數(shù)，包括4個(gè)內(nèi)參數(shù)bu,bv,u0,v0和12個(gè)外參數(shù)rij(i,j=1,2,3)，T=[x0y0z0]T，其中外參數(shù)rij(i,j=1,2,3)形成的矩陣R3×3為正交旋轉(zhuǎn)矩陣。這樣就完成了相機(jī)的內(nèi)外參數(shù)DLT法的標(biāo)定。顯然如果是多臺(tái)相機(jī)實(shí)現(xiàn)多視圖測(cè)量，則每臺(tái)相機(jī)要經(jīng)過上述步驟實(shí)現(xiàn)標(biāo)定；如果是單臺(tái)相機(jī)移動(dòng)位置實(shí)現(xiàn)的多視圖測(cè)量，則沒移動(dòng)一個(gè)位置均要按上述方法標(biāo)定一次。

2.2 物理點(diǎn)的多視圖3D定位

如前所述，多視圖包括單臺(tái)相機(jī)移動(dòng)位置拍攝同一個(gè)場(chǎng)景得到多視圖，也指多臺(tái)相機(jī)同時(shí)拍攝獲取多視圖。前者適合靜態(tài)測(cè)量場(chǎng)合后者適合于動(dòng)態(tài)測(cè)量場(chǎng)合。圖2為物理點(diǎn)的多視圖的3D定位(坐標(biāo)重建)系統(tǒng)結(jié)構(gòu)和原理示意圖。

圖2 多視圖的坐標(biāo)重建示意圖

對(duì)于每個(gè)視圖下的相機(jī)而言，如果光心和像點(diǎn)已知，可唯一確定過測(cè)量點(diǎn)的一條直線，依據(jù)空間幾何線-線交會(huì)原理，可以對(duì)測(cè)量點(diǎn)進(jìn)行交會(huì)定位，由于鏡頭畸變、像素坐標(biāo)提取精度、標(biāo)定點(diǎn)坐標(biāo)誤差的存在，使得相機(jī)多角度確定的各條直線異面，不會(huì)相交于同一測(cè)量點(diǎn)，因此本文通過最小二乘法來求解被測(cè)目標(biāo)點(diǎn)的空間坐標(biāo)，假設(shè)空間中任意一點(diǎn)P(xw，yw，zw)在相機(jī)3個(gè)視圖中對(duì)應(yīng)的成像點(diǎn)分別為p1(u1，v1)，p2(u2，v2)和p3(u3，v3)，3個(gè)視圖對(duì)應(yīng)的相機(jī)參數(shù)Li(i=1，2，…，11)可由式(7)求解得出，由式(3)，可得到如下方程：

(8)

單個(gè)視圖可列出2個(gè)線性方程，則3個(gè)視圖可列出關(guān)于(xw，yw，zw)的6個(gè)線性方程，轉(zhuǎn)換為矩陣形式，有：

(9)

采用最小二乘法x=(ATA)-1ATb即可求解出被測(cè)點(diǎn)P的坐標(biāo)(xw，yw，zw)。

為評(píng)價(jià)定位結(jié)果提出以下評(píng)價(jià)指標(biāo)。將獲得的空間重建點(diǎn)P(xw，yw，zw)與其在世界坐標(biāo)系下3D坐標(biāo)真值(xq，yq，zq)進(jìn)行比較，得到空間點(diǎn)P重建坐標(biāo)在X,Y,Z方向上的誤差dX,dY,dZ，有：

(10)

由式(11)可得空間重建坐標(biāo)相對(duì)距離誤差為：

(11)

2.3 DLT多視圖物理點(diǎn)3D定位基本步驟

本文提出的DLT多視圖物理點(diǎn)世界坐標(biāo)系3D定位的基本步驟總結(jié)如下：

(1)建立世界坐標(biāo)系下的3D標(biāo)定對(duì)象：即確定不少于6個(gè)不在同一個(gè)平面的控制點(diǎn)并確定世界坐標(biāo)系下的3D坐標(biāo)?？刂泣c(diǎn)包絡(luò)體積盡量覆蓋待測(cè)點(diǎn)的運(yùn)動(dòng)范圍，控制點(diǎn)數(shù)盡量多且盡量在包絡(luò)體積中均布；

(2)DLT方法完成相機(jī)標(biāo)定得到L參數(shù)(式(7))及相機(jī)內(nèi)外參數(shù)(式(4))。多臺(tái)相機(jī)則每臺(tái)相機(jī)要標(biāo)定，如果是單臺(tái)相機(jī)則沒移動(dòng)一個(gè)位置均要標(biāo)定。見2.1節(jié)；

(3)測(cè)量待定位物理點(diǎn)對(duì)應(yīng)的圖像點(diǎn)的像素坐標(biāo)，利用上面2)標(biāo)定求得的各相機(jī)(或同一相機(jī)不同位置)的L參數(shù)，由式(9)求得這些點(diǎn)的世界坐標(biāo)系的3D坐標(biāo)。見2.2節(jié)；

(4)如果是多相機(jī)實(shí)現(xiàn)的多視圖物理點(diǎn)位置的連續(xù)動(dòng)態(tài)測(cè)量，假定相機(jī)位置不動(dòng)則返回(3)繼續(xù)執(zhí)行直至任務(wù)完成；否則返回(2)(即重新標(biāo)定)繼續(xù)執(zhí)行至任務(wù)完成。

3 試驗(yàn)設(shè)計(jì)與數(shù)據(jù)分析

3.1 試驗(yàn)設(shè)備

進(jìn)行了單相機(jī)移動(dòng)位置實(shí)現(xiàn)的多視圖多個(gè)物理點(diǎn)靜態(tài)定位試驗(yàn)并與真實(shí)結(jié)果(全站儀測(cè)量得到)進(jìn)行了比較驗(yàn)證。實(shí)驗(yàn)采用美國Vision Research 公司產(chǎn)的Phantom M310高速相機(jī)進(jìn)行圖像采集，傳感器尺寸為25.6×16.0 mm，分辨率為1 280×800，對(duì)應(yīng)像素大小20 μm×20 μm，鏡頭焦距24～85 mm可調(diào)，拍攝速率采用1 000 frame/s，光圈值為f/2.8；采用瑞典Image Systems公司的TEMA運(yùn)動(dòng)分析軟件測(cè)量圖像中標(biāo)定點(diǎn)及被測(cè)點(diǎn)的像素坐標(biāo)，在這里拍攝的是靜態(tài)場(chǎng)景，故只需截取視頻中的1幀圖像導(dǎo)入TEMA軟件中進(jìn)行處理；采用科利達(dá)公司產(chǎn)的KTS-462LL全站儀對(duì)目標(biāo)點(diǎn)的三維坐標(biāo)進(jìn)行測(cè)量，該儀器的測(cè)距精度為2+2ppm×5 km，即測(cè)量距離為5 km的誤差為12 mm，試驗(yàn)在1PJ-3.0型水田平地機(jī)上進(jìn)行，圖3為水田平地機(jī)的結(jié)構(gòu)示意圖。

圖3 水田平地機(jī)結(jié)構(gòu)示意圖

水田平地機(jī)包括機(jī)械系統(tǒng)、液壓系統(tǒng)、高程控制系統(tǒng)和水平控制系統(tǒng)四大部分，采用乘坐式井關(guān)PG6插秧機(jī)的為動(dòng)力[19-20]，以三點(diǎn)懸掛方式與平地機(jī)相連，三條平行連桿一端與插秧機(jī)底盤旋轉(zhuǎn)鉸鏈連接(鉸接)，另一端與安裝臺(tái)鉸接，安裝臺(tái)下端有另一個(gè)鉸鏈與平地鏟中間連接。安裝臺(tái)與平地鏟之間安裝有雙作用油缸驅(qū)使二者之間相對(duì)轉(zhuǎn)動(dòng)實(shí)現(xiàn)平地作業(yè)中平地鏟處于調(diào)平狀態(tài)。

3.2 試驗(yàn)步驟及方法

按照2.3節(jié)所述的基本步驟，進(jìn)行如下操作。由于試驗(yàn)涉及到驗(yàn)證，故具體步驟稍有區(qū)別。

(1)設(shè)定世界坐標(biāo)系，設(shè)定控制點(diǎn)及待測(cè)點(diǎn)

圖4為試驗(yàn)平臺(tái)及試驗(yàn)布置示意圖，先將圖4(b)中的平地鏟置于水平地面，在測(cè)臺(tái)架1上建立世界坐標(biāo)系ow-xwywzw，在平地鏟上粘貼如圖所示的不共面的10個(gè)十字架形狀(對(duì)角象限分別為白色和黑色)的控制點(diǎn)(像寶馬汽車標(biāo)志，標(biāo)志點(diǎn)指該十字的交點(diǎn))，記錄下各標(biāo)定點(diǎn)在坐標(biāo)系ow-xwywzw下的三維坐標(biāo)，在平地鏟上另外粘貼20個(gè)標(biāo)記點(diǎn)作為待測(cè)點(diǎn)。一般世界坐標(biāo)系是靜止的，控制點(diǎn)宜設(shè)置在靜止的物體上，而這里是靜態(tài)試驗(yàn)，控制點(diǎn)和待測(cè)點(diǎn)均位于同一剛體(平地鏟，水平靜置)不會(huì)造成問題。

圖4 試驗(yàn)平臺(tái)及現(xiàn)場(chǎng)布置示意圖(平地機(jī)測(cè)試臺(tái)上的寶馬點(diǎn)為標(biāo)定點(diǎn)；平地鏟上的寶馬點(diǎn)為待測(cè)點(diǎn))

Fig.4 Test platform and sketch map of the test site(BMW points on test setup for leveler are calibration points; BMW points on land-leveling plow are measured points)

(2)DLT方法完成相機(jī)標(biāo)定得到L參數(shù)

調(diào)整相機(jī)的位置及焦距，使得標(biāo)定點(diǎn)及待測(cè)點(diǎn)在視場(chǎng)中清晰可見，采集此視圖1下的圖像，記為I1，按相同方法采集視圖2和視圖3下的圖像，記為I2和I3；TEMA軟件完成圖像標(biāo)記點(diǎn)的跟蹤識(shí)別和像素坐標(biāo)的讀取，并按2.1節(jié)方法完成各位置下的相機(jī)標(biāo)定。

(3)測(cè)量各待定位物理點(diǎn)對(duì)應(yīng)的圖像點(diǎn)的像素坐標(biāo)；

(4)結(jié)果驗(yàn)證。采用全站儀測(cè)量待測(cè)點(diǎn)的世界坐標(biāo)作為世界坐標(biāo)系真實(shí)3D位置：

①建立全站儀坐標(biāo)系oq-xqyqzq

將全站儀架設(shè)到適宜位置，手動(dòng)調(diào)平，建立以全站儀激光發(fā)射中心oq為坐標(biāo)原點(diǎn)，坐標(biāo)軸方向與世界坐標(biāo)系坐標(biāo)軸方向一致的全站儀坐標(biāo)系oq-xqyqzq；

②全站儀測(cè)量待測(cè)點(diǎn)坐標(biāo)

測(cè)量得到這些點(diǎn)在全站儀坐標(biāo)系oq-xqyqzq下的三維坐標(biāo)，然后將所有的被測(cè)點(diǎn)坐標(biāo)與測(cè)得的世界坐標(biāo)系原點(diǎn)坐標(biāo)相減，即可將所有被測(cè)點(diǎn)在全站儀坐標(biāo)系下的坐標(biāo)轉(zhuǎn)換到世界坐標(biāo)系下。

3.3 試驗(yàn)數(shù)據(jù)分析

本實(shí)驗(yàn)利用測(cè)試臺(tái)架(平地鏟)上粘貼的10個(gè)標(biāo)定點(diǎn)的空間坐標(biāo)及各標(biāo)定點(diǎn)在圖像Ij(j=1，2，3)的像素坐標(biāo)，通過最小二乘法及高斯-牛頓迭代法完成各視圖下的相機(jī)標(biāo)定，然后根據(jù)空間幾何線-線交會(huì)原理，利用最小二乘法實(shí)現(xiàn)被測(cè)點(diǎn)的世界坐標(biāo)測(cè)量，表1為部分標(biāo)定點(diǎn)Pi(i=1,2,…，10)的世界坐標(biāo)及在圖像Ij(j=1，2，3)中的像素坐標(biāo)信息，表2為部分被測(cè)點(diǎn)Qn(n=1,2,…，20)在圖像Ij(j=1，2，3)中的像素坐標(biāo)信息。表3為求得的各視圖參數(shù)Lk(i=1，2，…，11)，表4為利用高斯-牛頓迭代法求得的各視圖相機(jī)內(nèi)外參數(shù)，試驗(yàn)采用的各視圖相機(jī)分辨率均為1 280×800，則像平面中焦點(diǎn)O的理想像素坐標(biāo)為(640，400)，從表4可以看出，3個(gè)視圖的相機(jī)標(biāo)定結(jié)果中，焦點(diǎn)橫坐標(biāo)最大偏差為65.28 pixel，焦點(diǎn)縱最大偏差為63.36 pixel，這與標(biāo)定過程中各標(biāo)定點(diǎn)空間坐標(biāo)測(cè)量誤差及對(duì)應(yīng)的像素坐標(biāo)提取誤差有關(guān)。

表1 部分標(biāo)定點(diǎn)的坐標(biāo)

表2 部分被測(cè)點(diǎn)的像素坐標(biāo)

表3 各視圖相機(jī)參數(shù)Lk求解結(jié)果

表4 各視圖相機(jī)內(nèi)外參數(shù)求解結(jié)果

分別利用全站儀與本文方法對(duì)平地鏟上20個(gè)被測(cè)點(diǎn)進(jìn)行測(cè)量，并計(jì)算各被測(cè)點(diǎn)在X,Y,Z方向上的誤差dX,dY,dZ，結(jié)果如圖5所示，其中藍(lán)色折線為被測(cè)點(diǎn)在世界坐標(biāo)系ow-xwywzw下的三維坐標(biāo)(由全站儀獲得)，綠色折線為相機(jī)測(cè)得的各被測(cè)點(diǎn)在X,Y,Z方向上的坐標(biāo)，紅色折線為相機(jī)測(cè)得的被測(cè)點(diǎn)坐標(biāo)相對(duì)于全站儀測(cè)得坐標(biāo)的誤差，表5為被測(cè)點(diǎn)在X,Y,Z方向上的平均誤差，從圖5可以看出(彩圖見期刊電子版)，相機(jī)測(cè)得被測(cè)點(diǎn)坐標(biāo)與全站儀測(cè)得的坐標(biāo)位置基本吻合，被測(cè)點(diǎn)坐標(biāo)在X,Y,Z方向上的絕對(duì)誤差均值為4.19 mm,3.97 mm,3.69 mm，空間相對(duì)距離誤差為0.81%。

表5 被測(cè)點(diǎn)在X,Y,Z方向上的平均誤差

Tab.5 Average error of measured points inX,Y, andZdirections

X方向Y方向Z方向Error相機(jī)測(cè)量0.004 20.004 00.003 70.008 1

圖5 被測(cè)點(diǎn)的世界坐標(biāo)在X,Y,Z方向的誤差

4 結(jié) 論

(1)本文提出的基于DLT的世界坐標(biāo)系多視圖3D定位方法，既適用于單臺(tái)相機(jī)移動(dòng)獲取的多視圖實(shí)現(xiàn)的靜態(tài)結(jié)構(gòu)體點(diǎn)的定位，也適合于多臺(tái)相機(jī)同時(shí)拍攝獲取的機(jī)器上點(diǎn)的三維動(dòng)態(tài)定位，能夠?qū)崿F(xiàn)任意多個(gè)物理點(diǎn)的世界坐標(biāo)測(cè)量，原理上測(cè)量結(jié)果不受相機(jī)位置影響。該方法不需要專門的儀器設(shè)備，對(duì)一般的結(jié)構(gòu)和機(jī)器系統(tǒng)的測(cè)繪、運(yùn)動(dòng)分析適用。

(2)在水田平地機(jī)上進(jìn)行了單相機(jī)移動(dòng)位置得到的多視圖多物理點(diǎn)靜態(tài)定位試驗(yàn)。驗(yàn)證采用本方多個(gè)目標(biāo)點(diǎn)進(jìn)行了世界坐標(biāo)測(cè)量，與全站儀的測(cè)量結(jié)果相比，該方法測(cè)得的坐標(biāo)在X,Y,Z方向的平均絕對(duì)誤差為4.19 mm,3.97 mm,3.69 mm，空間相對(duì)距離誤差為0.81%，滿足一般測(cè)量精度要求。

(3)為進(jìn)一步DLT相機(jī)標(biāo)定與物理點(diǎn)的3D定位的精度除了使用更多的控制點(diǎn)、更多的視圖等措施[15]外，還需要對(duì)相機(jī)的徑向和切向失真進(jìn)行校正，這可以在DLT標(biāo)定步驟中對(duì)失真參數(shù)進(jìn)行標(biāo)定，此時(shí)需要使用16個(gè)L參數(shù)，需要的不共面的控制點(diǎn)為8個(gè)[15]。此外Matlab有相機(jī)標(biāo)定工具箱，借助該工具箱可以驗(yàn)證本方法第2步得到的相機(jī)標(biāo)定結(jié)果。