點(diǎn)擊下方卡片，關(guān)注“新機(jī)器視覺”公眾號

重磅干貨，第一時間送達(dá)

　機(jī)器人視覺是一種處理問題的研究手段。經(jīng)過長時間的發(fā)展，機(jī)器人視覺在定位，識別，檢測等多個方面發(fā)展出來各種方法。其以常見的相機(jī)作為工具，以圖像作為處理媒介，獲取環(huán)境信息。

1、相機(jī)模型

　　相機(jī)是機(jī)器人視覺的主要武器，也是機(jī)器人視覺和環(huán)境進(jìn)行通信的媒介。相機(jī)的數(shù)學(xué)模型為小孔模型，其核心在于相似三角形的求解。其中有三個值得關(guān)注的地方：

1.1　　1/f = 1/a + 1/b 

　　焦距等于物距加上像距。此為成像定理，滿足此條件時才能成清晰的像。

1.2　　X  = x * f/Z

　　如果連續(xù)改變焦距f ，并同時移動相機(jī)改變Z，則可以使得物體x在圖像上所占像素數(shù)目不變(X)。此為DollyZoom原理。如果某個物體在該物體后方(更大的Z)，可利用此原理任意調(diào)整兩個物體在相片上的比例。

1.3    焦距越長，則視場越小，可以將遠(yuǎn)處的物體拍清晰。同時相片會有更大的景深。

2、消失點(diǎn)

　　消失點(diǎn)是相片中特有的。此點(diǎn)在相片中不直接存在，在現(xiàn)實中直接不存在。由于射影變換，相片中原本平行的線會有相交的趨勢。如果求的平行直線在圖像中的交點(diǎn)，則該點(diǎn)對應(yīng)現(xiàn)實中無窮遠(yuǎn)出的一點(diǎn)。該點(diǎn)的圖像坐標(biāo)為[X1 X1 1]。此點(diǎn)成為消失點(diǎn)。相機(jī)光心與消失點(diǎn)的連線指向消失點(diǎn)在攝像機(jī)坐標(biāo)系中的方向。

　　　此外，同一平面上各個方向的消失點(diǎn)，會在圖像中組成一條直線，稱為水平線。該原理可以用于測量站在地上的人的高度。值得注意的是只有相機(jī)水平時，horizen的高度才是camera Height.

2.1 位姿估計

　　如果我們能獲得一幅圖中的2個消失點(diǎn)。且這2個消失點(diǎn)所對應(yīng)的方向是相互垂直的（網(wǎng)格），那么我們就可以估計出相機(jī)相對于此圖像的姿態(tài)（靶標(biāo)位姿估計）。 在獲得相機(jī)相對于靶標(biāo)的旋轉(zhuǎn)向量后，如果相機(jī)內(nèi)部參數(shù)已知，且已知射影變換矩陣，則可計算相機(jī)相對于靶標(biāo)的距離，那么可以估計機(jī)器人的位置。H = K^-1*(H射影矩陣)

2.2 點(diǎn)線對偶

　　p1×p2 = L12

　　L12×L23 = p2

3、射影變換

　　射影變化是空間中平面--->平面的一種變換。對齊次坐標(biāo)，任意可逆矩陣H均表達(dá)了射影變換。簡而言之，可以表達(dá)為A = HB ，其中AB是[X Y 1]形式的其次坐標(biāo)。射影變換的一大作用就是將某一形狀投射成其他形狀。比如，制作相片中的廣告牌，或者比賽轉(zhuǎn)播中的廣告牌，或者游泳比賽運(yùn)動員到達(dá)后那個biu的一下出現(xiàn)的國旗。射影變換也是增強(qiáng)現(xiàn)實技術(shù)的基礎(chǔ)。

　　射影變換的核心在于H的求取。普通的求解方法見機(jī)器視覺教材。

　　假設(shè)平面相片的四個點(diǎn)分別是A(0,0,1),B(0,1,1),C(1,1,1),D(1,0,1)。顯然，這四個點(diǎn)需要投射到四個我們已知像素位坐標(biāo)的圖像區(qū)域中。此外，我們還可以依據(jù)像素位置計算兩個有趣的點(diǎn)，V1(x1, y1, z1)，V2(x2,y2,z2)。這兩個點(diǎn)都是圖像點(diǎn)。他們對應(yīng)的實際坐標(biāo)假設(shè)是(0,1,0),(1,0,0)。那么我們就有三個很有趣的實際點(diǎn)了。分別是(1,0,0),(0,1,0),(0,0,1).恰好是一個Identity Matrix。這三個實際坐標(biāo)經(jīng)過射影變換會得到像素坐標(biāo)。像素坐標(biāo)又是已知的。那么H的第一列就應(yīng)該對應(yīng)beta*V2,第二列應(yīng)該對應(yīng)alpha*V1。第三列應(yīng)該對應(yīng)gama*【A的像素坐標(biāo)】。alpha beta gama是常數(shù)。【射影變化后的坐標(biāo)應(yīng)為常數(shù)乘以其次坐標(biāo)】。

　　如果能解得alpha beta gama，那么我們就獲得了射影變換矩陣。顯然把C點(diǎn)的像素坐標(biāo)帶入方程，我們則有3個方程，4個未知數(shù)（引入了一個lamda）。但是lamda并不影響，除過去后我們只要把a(bǔ)lpha/lamda,beta/lamda,gama/lamda當(dāng)作未知數(shù)即可解除射影矩陣。

　　所以，射影變換矩陣的第一列代表消失點(diǎn)V1,第二列代表消失點(diǎn)V2，第一列與第二列的叉乘，代表水平線方程（點(diǎn)線對偶）。

文章來源：博客園