水下航行器導(dǎo)航系統(tǒng)原理 課件 第4講 導(dǎo)航基礎(chǔ)(一)

導(dǎo)航基礎(chǔ)（一）HARBINENGINEERING

UNIVERSITY目錄/Contents010203坐標(biāo)系03方向余弦歐拉角慣性器件標(biāo)定01坐標(biāo)系導(dǎo)航的任務(wù)就是確定載體的運(yùn)動(dòng)參數(shù)，即確定載體在某個(gè)坐標(biāo)系的位置、速度以及姿態(tài)等。什么是運(yùn)動(dòng)物體的姿態(tài)？詞典:

指物體呈現(xiàn)的樣子。慣性技術(shù):

指載體坐標(biāo)系與參考坐標(biāo)系相對(duì)角位移關(guān)系。1.

坐標(biāo)系5常用坐標(biāo)系如下：慣性坐標(biāo)系i地球坐標(biāo)系e地理坐標(biāo)系t載體坐標(biāo)系b平臺(tái)坐標(biāo)系p1.

坐標(biāo)系慣性坐標(biāo)系（i）：相對(duì)恒星所確定的參考系稱為慣性空間，相對(duì)慣性空間靜止或作勻速直線運(yùn)動(dòng)的參考坐標(biāo)系。日心慣性坐標(biāo)系：原點(diǎn)取在日心。地心慣性坐標(biāo)系：原點(diǎn)取在地心，Z 軸與地球自轉(zhuǎn)軸一致，X、Y 軸在赤道平面內(nèi)，指向某個(gè)恒星,與Z構(gòu)成右手直角坐標(biāo)系。地心慣性坐標(biāo)系不參與地球的自轉(zhuǎn)運(yùn)動(dòng)，即其三根坐標(biāo)軸在慣性空間的方向保持不變。1.

坐標(biāo)系地球坐標(biāo)系（e）：原點(diǎn)取在地心，Z 軸沿極軸（地軸）e方向，Xe

軸在赤道平面與本初子午面的交線上，Ye

軸也在赤道平面內(nèi)并與Xe

、Ze

軸構(gòu)成右手直角坐標(biāo)系。地球坐標(biāo)系隨地球自轉(zhuǎn)而變化。RR

o

hxeyeez

極軸

ie本初子午面赤道平面1.

坐標(biāo)系地理坐標(biāo)系（t）原點(diǎn)位于運(yùn)載體所在的點(diǎn)，Xtt軸沿當(dāng)?shù)鼐暰€指東，Y

軸沿當(dāng)?shù)刈游缇€指北；

Z

軸垂直于tXt,Yt 軸構(gòu)成的平面，構(gòu)成右手直角坐標(biāo)系。其中Xt

、Yt

軸構(gòu)成的平面即為當(dāng)?shù)厮矫?。地理坐?biāo)系隨地球自轉(zhuǎn)、載體運(yùn)動(dòng)而變化。R

o

h極軸NExtytzt1.

坐標(biāo)系載體坐標(biāo)系（b）：載體坐標(biāo)系z(mì)b軸垂直于甲板，

yb軸沿載體縱軸，xb軸沿載體橫軸。載體姿態(tài)即為載體坐標(biāo)系相對(duì)于地理坐標(biāo)系角位移關(guān)系，對(duì)于船舶，可由橫搖角、縱搖角和航向角三個(gè)角度描述。1.

坐標(biāo)系平臺(tái)坐標(biāo)系（p）：在平臺(tái)式慣性導(dǎo)航系統(tǒng)里，慣性元件陀螺儀和加速度計(jì)安裝在與運(yùn)載體姿態(tài)運(yùn)動(dòng)相隔離的平臺(tái)上，原點(diǎn)在平臺(tái)質(zhì)心，zp軸垂直于平臺(tái)臺(tái)面，yp軸指向平臺(tái)北，

xp軸指向東。構(gòu)成右手坐標(biāo)系。平臺(tái)坐標(biāo)系和地理坐標(biāo)系一致么？1.

坐標(biāo)系02方向余弦問題：已知一個(gè)矢量在某個(gè)坐標(biāo)系下的表示，如何求其在其他坐標(biāo)系下的表示？方向余弦法（九參數(shù)法）歐拉角法（三參數(shù)法）四元數(shù)法（四參數(shù)法）2.

方向余弦方向余弦定義設(shè)取直角坐標(biāo)系OXYZ，沿各坐標(biāo)軸的單位矢量分別為i、j、k；設(shè)過原點(diǎn)有一矢量R，它在各坐標(biāo)軸上的投影分別為Rx，Ry，Rz。矢量R的投影表示為??=??????+

??????+????k投影Rx，Ry，Rz分別表示為??

?

?????? ???,

?? ,??

?

?????? ???,

?? ,

??

?

?????? ???,

??其中?????? ???,

?? ,

?????? ???,

?? ,

?????? ???,

?? 是矢量R與坐標(biāo)軸X,

Y,

Z正向之間夾角的余弦，稱為方向余弦。XYZORR

xR

zR

yijk2.

方向余弦坐標(biāo)系各坐標(biāo)軸方向余弦直角坐標(biāo)系Oxryrzr與載體固連（簡(jiǎn)稱r系）Ox0y0z0為參考坐標(biāo)系（簡(jiǎn)稱0系）要確定載體在空間的角位置，只要確定載體坐標(biāo)系在參考坐標(biāo)系的角位置即可。而要做到這一點(diǎn)，只需要知道xr、yr、zr這三個(gè)軸的九個(gè)方向余弦。Z0X

00YZrX

rYrRj0k0irrjkri02.

方向余弦Cr00r或

C

來表示，即

23

21 220

C

C

C

C11 C12 C13

C

r

32

2212

C

C

CC21 C31

C11C

0r方向余弦矩陣把上述九個(gè)方向余弦組成一個(gè)3*3階矩陣，用Cr0

C31 C32 C33

則稱這種矩陣為方向余弦矩陣。其中

C13 C23 C33

為0系到r系的方向余弦矩陣，為r系到0系的方向余弦矩陣。0rC2.

方向余弦基于方向余弦的坐標(biāo)變換設(shè)過坐標(biāo)原點(diǎn)O有一矢量R，矢量端點(diǎn)為M?，F(xiàn)直接用Xr,

Yr,

Zr代表R在剛體坐標(biāo)系OXrYrZr上的投影，并直接用X0、Y0、Z0代表R在參考坐標(biāo)系OX0Y0Z0上的投影，矢

量

R

在

剛

體

坐

標(biāo)

系

和

參

考

坐

標(biāo)

系OX0Y0Z0中可分別表示為：??=??0????+??0????+

??0??????=????????+????????+

????????Z0X

00YZrX

rYrRk0irjrj0kri02.

方向余弦基于方向余弦的坐標(biāo)變換如果用方向余弦表示R在剛體坐標(biāo)系OXrYrZr上的投影，則有:????=??0

?cos ????,

??0?????=??0

?

cos ????,

??0????=??0

?

cos ????,

??0+??0

?

cos ????,

??0+??0

?

cos ????,

??0+??0

?

cos ????,

??0Z0X

00YZrX

r+??0

?

cos ????,

??0+??0

?

cos ????,

??0+??0

?

cos ????,

??0YrRj0k0rirjkri02.

方向余弦寫成矩陣形式：????????????=??11??21??31??12??22??32??13??23??33???0??0??00=????

???0??0??0按照類似的方法，R在參考坐標(biāo)系OX0Y0Z0上的投影可表示為：??0??0??0??11??21??31??12??22??32??13??23??33= ???????????????=??0

?????????????對(duì)于任意一個(gè)確定矢量，利用方向余弦矩陣就可以在兩個(gè)坐標(biāo)系之間進(jìn)行坐標(biāo)變換。因此方向余弦矩陣又稱為坐標(biāo)變換矩陣。2.

方向余弦方向余弦矩陣性質(zhì)根據(jù)方向余弦矩陣的正交性質(zhì)，方向余弦矩陣具有如下性質(zhì)：（1）兩個(gè)方向余弦矩陣互為轉(zhuǎn)置矩陣0 ??????

??

??0

???? 0=

??0 =

????（2）兩個(gè)方向余弦矩陣互為逆矩陣???? ?1=

??0 ??0 ?1=

????0 ?? ?? 0（3）各個(gè)方向余弦矩陣的轉(zhuǎn)置矩陣與逆矩陣相等=0 0????

??

????

?1=?? ????0

??

??0

?1????

????

??0 0=

????

????

?1=I0 02.

方向余弦方向余弦間關(guān)系式11??2121321??222+

??223+

??2??231

32

33+

??2 +

??2+

??2 +

??2 =

1=

1=

1??11??21+??12??22+??13??23=

0??21??31+??22??32+??23??33=

0??31??11+??32??12+??33??33=

0??11??21??31??12??22??32??13??23??33??11??12??13??21??22??23??31??32??33= 01 0 01 00 0 1九個(gè)方向余弦之間存在六個(gè)約束條件，因而實(shí)際上有三個(gè)方向余弦是獨(dú)立的。通常采用三個(gè)獨(dú)立的轉(zhuǎn)角即歐拉角來求出九個(gè)方向余弦的數(shù)值，這樣便能唯一的確定兩個(gè)坐標(biāo)系之間的相對(duì)角位置。2.

方向余弦03歐拉角剛體坐標(biāo)系相對(duì)參考坐標(biāo)系的角位置，可以用三次獨(dú)立轉(zhuǎn)動(dòng)的三個(gè)轉(zhuǎn)角來表示，這就是歐拉法，三個(gè)獨(dú)立的轉(zhuǎn)角稱為歐拉角。第一次旋轉(zhuǎn)可繞任一軸進(jìn)行第二次旋轉(zhuǎn)繞其余兩軸中任一軸第三次旋轉(zhuǎn)繞除第二次外任一軸3.

歐拉角繞

????正向??繞

??0正向 繞

????正向?? ????0??0??0?????????????????

??????????????????????????????????????=??0?cos??+??0?sin

??????=

??0

? ?sin

?? +??0?cos

??????=

??00x0yxaay

ayy01.

繞Z軸z0(za

)

x0

xa

????????????0=????

???0??0??0=cos

???sin

??0sin

?? 0cos

?? 00 1???0??0??0將三維旋轉(zhuǎn)表示為二維旋轉(zhuǎn)更容易確定坐標(biāo)軸之間的方向余弦角3.

歐拉角??=????

?????????????=cos

?? 0 ?sin

??0 1 0sin

?? 0 cos

???????????????2.

繞Y軸za

bz

ax????xb

???????????? =?????cos????????sin

?????? =

???????? =?????cos??+?????sin

??3.

歐拉角??????????????=????

?????????????=cos

??sin

??0?sin

??cos

??0001?????????????xbbyrx3.

繞Z軸yr

???? =?????cos??+?????sin

??????=????

??sin

??+?????cos

??????=

??03.

歐拉角????????????=

???? ??????????

??? ?? 0??0??0??00=????

???0??0??0綜合三次旋轉(zhuǎn)：???? =

???? ??????

????0 ?? ?? 0cos??cos??cos???

sin??sin??cos??cos??sin??+

sin??cos???cos??sin??=?sin??cos??cos???

cos??sin??sin???????????sin??cos??sin??+

cos??cos??sin??sin??sin??sin??cos??3.

歐拉角歐拉角與姿態(tài)載體坐標(biāo)系oxbybzb與導(dǎo)航坐標(biāo)系oxnynzn之間的關(guān)系，可以用三個(gè)轉(zhuǎn)動(dòng)歐拉角來表示，對(duì)于船舶，定義如下：oxnyn

zn

oxbyb

zbox1

y1z1繞ox1

繞oy2

ox2y2z2繞

ozn航向角縱搖角橫搖角3.

歐拉角04慣性器件標(biāo)定4.

慣性器件標(biāo)定安裝誤差示意圖陀螺儀、加速度計(jì)的輸出是什么？以陀螺儀為例：1、單位是什么？標(biāo)度因數(shù)2、是否表征載體系？安裝誤差3、測(cè)量是否準(zhǔn)確？零偏、標(biāo)度因數(shù)誤差

Gx

zx

Gz

g gzygyxgxygxzgzx

Gy

gzyyzg ggxzgzygyzgyxgxyg

bz

by

bx

cos

cos

yxsin

cos

sin

cos

sin

cos

cos

xzsin

sin

cos

cos

cos

sin

Gz

Gx

gyxgxyzx

Gy

gxzgzygyz

bz

by

bx

11

g

1

小角度4.

慣性器件標(biāo)定

Gy

gygy

D

Kgx

Ngx

0y

D0

x

0

Ngz

0

N

0Kgz

Gz

D0z

K 0

0 0

Gx

標(biāo)度因數(shù)：輸出量與輸入量的比值零偏：輸入量為0時(shí)的輸出量

gygyGy

D

N

0y

0 1/

K 00 0 1/

K

gz

N

gz

D0

z

0

Ngx

D0x

1/

K

gx

0

Gz

Gx

移項(xiàng)

b