基矩陣

基矩陣

現在我們用矩陣形式寫出基向量和基,這樣的矩陣我們叫它基矩陣。

空間坐標系的基和基矩陣

基矩陣 基矩陣

在3-D空間中,我們用空間坐標系來規範物體的位置,空間坐標系由3個相互垂直的坐標軸組成,我們就把它們作為我們觀察3-D空間的基礎,空間中物體的位置可以通過它們來衡量。當我們把這3個坐標軸上單位長度的向量記為3個相互正交的單位向量 i,j,k,空間中每一個點的位置都可以被這3個向量線性表出,如P<1,-2,3>這個點可以表為i-2j+3k。我們把這3個正交的單位向量稱為空間坐標系的基,它們單位長度為1且正交,所以可以成為標準正交基。三個向量叫做基向量。現在我們用矩陣形式寫出基向量和基。

i = | 1 0 0 |

j = | 0 1 0 |

k = | 0 0 1 |

B = | i | | 1 0 0 |

| j | | 0 1 0 |

| k | | 0 0 1 |

這樣的矩陣我們叫它 基矩陣。有了基矩陣,我們就可以把空間坐標系中的一個向量寫成坐標乘上基矩陣的形式,比如上面的向量P可以寫成:

P = C x B=> | 1 0 0 | | 1 -2 3 | = | 1 -2 3 | x | 0 1 0 | | 0 0 1 |

這樣的話,空間坐標系下的同一個向量在不同的基下的坐標是不同的。

局部坐標系和局部坐標

和空間坐標系(也可以叫做全局坐標系或者世界坐標系)並存的稱為局部坐標系(也叫坐標架——coordinate frame),它有自己的基,這些基向量把空間坐標系作為參考系。比如

| x'| | -1 0 0 | B' = | y'| = | 0 1 0 | | z'| | 0 0 -1 | | x''| | 2^½ /2 0 2^½ /2 |

B'' = | y''| = | 0 -1 0 |

| z''| | -(2^½) /2 0 2^½ /2 |就是兩個局部坐標系的基,如圖:

現在我們可以把上面那個空間坐標中的向量P|1 -2 3|(以後都用矩陣表示)表示在不同的基下,我把它寫成一個大長串的式子: | x' | | x''| P = | Px' Py' Pz' | x | y' | = | Px'' Py'' Pz'' | x | y''|

| z' | | z''|

這裡| Px' Py' Pz'|是P在B'下的坐標,| Px'' Py'' Pz''|是P在B''下的坐標,我把它寫的具體點吧:

| -1 0 0 | | 2^½ /2 0 2^½ /2| | 1 -2 3 | = | -1 -2 -3 | x | 0 1 0 | = | 2*2^½ -2 2^½ | x | 0 -1 0 |

| 0 0 -1 | | -(2^½) /2 0 2^½ /2|

這就是說,在空間坐標系下面的向量| 1 -2 3 |在基B'下的坐標為|-1 -2 -3|,在B''下的坐標為| 2*2^½ -2 2^½ |。當然空間坐標系也有自己的基B|i j k|^T(因為是列向量,所以寫成行向量的轉置),但我們現在是拿它當作一個參考系。

在研究了局部坐標系之後,我現在要分析兩個套用它們的例子,先來看

空間坐標系中一個點圍繞任一軸的鏇轉

上一篇討論3-D空間鏇轉的時候說到有一個高檔的方法做3-D空間任意軸鏇轉,現在我們的知識儲備已經足夠理解這個方法了(Quake引擎使用的就是這個方法)。

如上所示,空間坐標系中的一個局部坐標系xyz中有一個向量a(2,5,3)和一個點p(8,4,2)現在我要讓p點圍繞a向量鏇轉60度,得到p’點,該如何做呢?從目前掌握的鏇轉知識來看,我們有兩個理論基礎:

1)在一個坐標系中的一個點,如果要它圍繞該坐標系中一個坐標軸鏇轉,就給它的坐標值乘相應的鏇轉矩陣,如

[cosA -sinA 0 ][sinA cosA 0 ][0 0 1 ]

等等。

2)我們已經學習了局部坐標系的理論了,知道空間中一個點在不同的坐標系中的坐標不同。利用這一點,我們可以很方便的讓一個點或者向量在不同的坐標系之間轉換。

我們聯繫這兩個理論根據,得出我們的思路:

1構造另一個局部坐標系abc,使得a成為該坐標系的一個坐標軸。

2 把p的坐標變換到abc中,得到p’,用鏇轉公式讓p’圍繞已經成為坐標軸的a鏇轉,得到p’’。

3把p’’再變換回坐標系xyz,得到p’’’,則p’’’就是p圍繞a鏇轉後的點。

下面我們逐步說明。

基矩陣 基矩陣

首先我們構造abc,我們有無數種方法構造,因為只要保證b、c之間以及他們和a之間都正交就可以了,但我們只要一個。根據上圖,我們首先產生一個和a正交的b。這可以通過向量的叉乘來完成:我們取另一個向量v(顯然,這個向量是不能和a共線的任何非零向量),讓它和a決定一個平面x,然後讓v叉乘a得到一個垂直於x的向量b,因為b垂直於x,而a在平面x上,因此b一定垂直於a,然後用a叉乘b得到c,最後單位化a、b、c,這樣就得到了局部坐標系abc。

然後我們把p點變換到abc坐標系中,得到p’,即p’就是p在abc中的坐標:

|a b c| * p’= |x y z| * p

p’ = |a b c|^-1 * |x y z| * p

|ax bx cx| |1 0 0| |px|

p’ = |ay by cy| ^-1 * |0 1 0| * |py|

|az bz cz| |0 0 1| |pz|

注意這裡|a b c|^-1即矩陣|a b c|的逆矩陣,因為a、b、c是三個正交向量,並且是單位向量,因此|a b c|是一個正交矩陣,正交矩陣的轉置和逆相等,這是它的一個特性,因此上面的公式就可以寫成:

|ax ay az| |1 0 0| |px|

p’ = |bx by bz| * |0 1 0| * |py|

|cx cy cz| |0 0 1| |pz|

這個時候p’就是p在abc坐標系下的坐標了。此時a已經是一個坐標軸了,我們可以用鏇轉矩陣來做。

p’’ = RotMatrix * p’

[1 0 0] |p’x|p’’ = [0 cos60 -sin60] * |p’y| [0 sin60 cos60] |p’z|

最後,我們把p’’再次變換回xyz坐標系,得到最終的p’’’

|a b c| * p’’ = |x y z| * p’’’

p’’’ = |x y z|^-1 * |a b c| * p’’

p’’’ = |a b c| * p’’

最後

p’’’ = |a b c| * RotMatrix * |a b c|^T * p = M * p

這樣就得到了xyz坐標系中點p圍繞a鏇轉60度後的點。

最後,我用Quake3引擎的相應函式(來自idSoftware ——quake3-1[1].32b-source——mathlib.c)來完成對這個算法的說明:

/*

===============

RotatePointAroundVector

dst是一個float[3],也就是p’’’

dir相當於a,point就是p,degrees是鏇轉度數

===============

*/

void RotatePointAroundVector( vec3_t dst, const vec3_t dir, const vec3_t point,

float degrees ) {

float m[3][3];

float im[3][3];

float zrot[3][3];

float tmpmat[3][3];

float rot[3][3];

int i;

vec3_t vr, vup, vf;

float rad;

vf[0] = dir[0];

vf[1] = dir[1];

vf[2] = dir[2];

// 首先通過dir得到一個和它垂直的vr

// PerpendicularVector()函式用於構造和dir垂直的向量

// 也就是我們上面的第1步

PerpendicularVector( vr, dir );

// 通過cross multiply得到vup

// 現在已經構造出坐標軸向量vr, vup, vf

CrossProduct( vr, vf, vup );

// 把這三個單位向量放入矩陣中

m[0][0] = vr[0];

m[1][0] = vr[1];

m[2][0] = vr[2];

m[0][1] = vup[0];

m[1][1] = vup[1];

m[2][1] = vup[2];

m[0][2] = vf[0];

m[1][2] = vf[1];

m[2][2] = vf[2];

// 產生轉置矩陣im

memcpy( im, m, sizeof( im ) );

im[0][1] = m[1][0];

im[0][2] = m[2][0];

im[1][0] = m[0][1];

im[1][2] = m[2][1];

im[2][0] = m[0][2];

im[2][1] = m[1][2];

// 構造鏇轉矩陣zrot

memset( zrot, 0, sizeof( zrot ) );

zrot[0][0] = zrot[1][1] = zrot[2][2] = 1.0F;

rad = DEG2RAD( degrees );

zrot[0][0] = cos( rad );

zrot[0][1] = sin( rad );

zrot[1][0] = -sin( rad );

zrot[1][1] = cos( rad );

// 開始構造變換矩陣M

// tmpmat = m * zrot

MatrixMultiply( m, zrot, tmpmat );

// rot = m * zrot * im

MatrixMultiply( tmpmat, im, rot );

// 則 rot = m * zrot * im 和我們上面推出的

// M = |a b c| * RotMatrix * |a b c|^T 一致

// 變換point這個點

// p’’’ = M * p

for ( i = 0; i < 3; i++ ) {

dst[i] = rot[i][0] * point[0] + rot[i][1] * point[1] + rot[i][2] * point[2];

}

}

世界空間到相機空間的變換

空間坐標系XYZ,相機坐標系UVN。這時候相機空間的基(以下簡稱相機)在空間坐標系中圍繞各個坐標軸鏇轉了一定角度<a,b,c>,然後移動了<x,y,z>。對於模型我們可以看作相對於相機的逆運動,即模型鏇轉了一定角度<-a,-b,-c>,然後移動了<-x,-y,-z>,可以把相機和物體的運動看成兩個互逆的變換。這樣,可以通過對相機的變換矩陣求逆來得到模型的變換矩陣。下面來具體看一下,如何得到相機變換矩陣,並且求得它的逆矩陣。

首先聲明一下,對於一個模型的變換,我們可以給模型矩陣左乘變換矩陣:

M x P = P'

| A B C D | | x | | Ax + By + Cz + D |

| E F G H | | y | | Ex + Fy + Gz + H | x = | I J K L | | z | | Ix + Jy + Kz + L |

| M N O P | | 1 | | Mx + Ny + Oz + P |

也可以右乘變換矩陣:

P^T x M^T = P'^T

| A E I M |

| B F J N || x y z 1| x = |Ax+By+Cz+D Ex+Fy+Gz+H Ix+Jy+Kz+L Mx+Ny+Oz+P| | C G K O |

| D H L P |

可以看出兩種變換方式是一個轉置關係,結果只是形式上的不同,但這裡我們使用後者,即右乘變換矩陣,因為比較普遍。

很顯然,相機的變換可以分成兩個階段:鏇轉和平移。我們先來看鏇轉。

基矩陣 基矩陣

在空間坐標系中,相機鏇轉之前世界坐標系xyz和相機坐標系u0v0n0的各個軸向量的方向相同,有關係: | u0 | | x |P = |Pu0 Pv0 Pn0| x | v0 | = |Px Py Pz| x | y |

| n0 | | z |

這裡P是空間坐標系中的一個向量。|u0 v0 n0|^T是相機基矩陣,|Pu0 Pv0 Pn0|是P在相機基矩陣下的坐標。|x y z|^T是世界基矩陣,|Px Py Pz|是P在它下面的坐標。有Pu0 = Px, Pv0 =Py, Pn0 = Pz。

相機和向量P都鏇轉之後,有關係: | u | | x |P' = |Pu0 Pv0 Pn0| x | v | = |Px' Py' Pz'| x | y |

| n | | z |

P'是P同相機一起鏇轉後的向量。|u v n|^T是相機鏇轉後的基矩陣,|Pu0 Pv0 Pn0|是P'在它下面的坐標,因為P是和相機一起鏇轉的,所以坐標不變。|x y z|^T仍為世界基矩陣,|Px' Py' Pz'|是P'在它下面的坐標。

現在看

| u | | x ||Pu0 Pv0 Pn0| x | v | = |Px' Py' Pz'| x | y |

| n | | z |

因為|x y z|^T為一個單位陣,且Pu0 = Px, Pv0 =Py, Pn0 = Pz。 所以得到

| u | |Px Py Pz| x | v | = |Px' Py' Pz'|

| n |

即|Px Py Pz|和相機一起鏇轉後變成|Px' Py' Pz'|,即P x R = P',而鏇轉變換矩陣R就是:

| u |

| v |

| n |

寫成標準4x4矩陣:

| ux uy uz 0|

| vx vy vz 0|

| nx ny nz 0|

| 0 0 0 1|

平移矩陣T很簡單:

| 1 0 0 0 |

| 0 1 0 0 |

| 0 0 1 0 |

| x y z 1 |

則相機矩陣就是:

| ux uy uz 0 | | 1 0 0 0 | | vx vy vz 0 | | 0 1 0 0 |C = R x T = x | nx ny nz 0 |1 | | x y z 1 |

它的逆矩陣,即相機的逆變換矩陣為

| 1 0 0 0 | | ux vx nx 0 | | ux vx nx 0 | | 0 1 0 0 | | uy vy ny 0 | | uy vy ny 0 |C^-1 = T^-1 x R^-1 = x = | 0 0 1 0 | | uz nz nz 0 | | uz vz nz 0 | | -x -y -z 1 | | 0 0 0 1 | |-T.u -T.v -T.n 1 |

相關詞條

相關搜尋

熱門詞條

聯絡我們