• <tr id="yyy80"></tr>
  • <sup id="yyy80"></sup>
  • <tfoot id="yyy80"><noscript id="yyy80"></noscript></tfoot>
  • 99热精品在线国产_美女午夜性视频免费_国产精品国产高清国产av_av欧美777_自拍偷自拍亚洲精品老妇_亚洲熟女精品中文字幕_www日本黄色视频网_国产精品野战在线观看 ?

    任意姿態(tài)下矢量物理量的測(cè)量數(shù)據(jù)修正計(jì)算方法探討

    2019-05-08 08:05:52程國(guó)勝
    數(shù)字海洋與水下攻防 2019年1期
    關(guān)鍵詞:歐拉角轉(zhuǎn)角矢量

    程國(guó)勝

    (中國(guó)船舶重工集團(tuán)公司第七一〇研究所,湖北 宜昌 443003)

    0 引言

    對(duì)矢量物理量的測(cè)量,如水中目標(biāo)的磁場(chǎng)、電場(chǎng)等目標(biāo)特性的測(cè)量,要求測(cè)量出該物理量在確定的正交坐標(biāo)系(通常為當(dāng)?shù)厮阶鴺?biāo)系或者導(dǎo)航坐標(biāo)系)中的3個(gè)方向分量,而在測(cè)量實(shí)施中,測(cè)量傳感器或其安裝平臺(tái)的姿態(tài)角往往是隨機(jī)但可以測(cè)量的。因此,在測(cè)量數(shù)據(jù)的處理中,需要對(duì)在任意姿態(tài)下測(cè)量的矢量物理量數(shù)據(jù)進(jìn)行修正,即對(duì)測(cè)量的矢量結(jié)果在不同坐標(biāo)系之間進(jìn)行轉(zhuǎn)換。在大多數(shù)現(xiàn)有文獻(xiàn)和工程實(shí)踐中,修正算法都是直接引用歐拉角旋轉(zhuǎn)變換公式[1-3]。但是仔細(xì)分析,歐拉角旋轉(zhuǎn)變換公式是基于有先后次序的繞坐標(biāo)軸的旋轉(zhuǎn)變換,而實(shí)際測(cè)量的姿態(tài)角,有陀螺儀測(cè)量、慣導(dǎo)系統(tǒng)測(cè)量、傾斜儀測(cè)量、磁場(chǎng)傳感器測(cè)量以及多傳感器組合測(cè)量,測(cè)量傳感器或設(shè)備輸出的姿態(tài)角有不同的定義,與旋轉(zhuǎn)歐拉角的定義不一定完全一致。因此,直接引用歐拉角旋轉(zhuǎn)變換公式進(jìn)行修正計(jì)算,可能存在原理性誤差。在運(yùn)動(dòng)載體中的矢量測(cè)量以及導(dǎo)航定位中的坐標(biāo)旋轉(zhuǎn)變換中也都存在類似的問(wèn)題。

    本文對(duì)姿態(tài)角定義和傳感器測(cè)量原理進(jìn)行分析,推導(dǎo)姿態(tài)角與旋轉(zhuǎn)歐拉角的關(guān)系,進(jìn)而推導(dǎo)出利用可測(cè)量的姿態(tài)角進(jìn)行坐標(biāo)變換修正的坐標(biāo)轉(zhuǎn)換矩陣。

    1 坐標(biāo)系及歐拉旋轉(zhuǎn)變換

    1.1 常用坐標(biāo)系

    在導(dǎo)航和矢量測(cè)量中常用的有以下5種正交右手坐標(biāo)系[4]:

    1)地心慣性坐標(biāo)系OIXIYIZI,簡(jiǎn)記為I坐標(biāo)系;

    2)地心地球固定坐標(biāo)系OEXEYEZE,簡(jiǎn)記為E坐標(biāo)系;

    3)導(dǎo)航坐標(biāo)系ONXNYNZN,簡(jiǎn)記為N坐標(biāo)系,主要用于確定載體相對(duì)于東、北和天方向的速度和位置;

    4)當(dāng)?shù)厮阶鴺?biāo)系OLXLYLZL,簡(jiǎn)記為L(zhǎng)坐標(biāo)系,主要用于確定載體相對(duì)于北、東和地方向的姿態(tài);

    5)載體坐標(biāo)系OBXBYBZB,簡(jiǎn)記為B坐標(biāo)系,主要用于描述載體的姿態(tài)(通常為俯仰角、橫滾角和偏航角)。

    導(dǎo)航應(yīng)用中的測(cè)量計(jì)算如姿態(tài)、位置、速度、加速度、角速度等參數(shù),常常需要在這些不同坐標(biāo)系之間進(jìn)行平移和旋轉(zhuǎn)變換計(jì)算,而一般矢量物理量的測(cè)量中,最常用到的是其中的B坐標(biāo)系以及N和L坐標(biāo)系間的變換計(jì)算。

    1.2 歐拉角

    如圖1(a)所示,固定坐標(biāo)系OXgYgZg(通常為L(zhǎng)坐標(biāo)系)和載體坐標(biāo)系OXYZ有共同原點(diǎn),ON為OXgYg平面和OXY平面的相交線,ON與平面ZgOZ垂直,稱為節(jié)線。

    由坐標(biāo)系OXgYgZg到OXYZ的轉(zhuǎn)換步驟為:以軸OZg和OZ為基本軸,其垂直面OXgYg和OXY為基本平面。首先,在坐標(biāo)系OXgYgZg中繞OZg軸逆時(shí)針?lè)较?從OZg軸正向看)旋轉(zhuǎn)角度α,OXg軸到達(dá)ON;再繞ON軸逆時(shí)針旋轉(zhuǎn)角度β,OZg軸到達(dá)OZ;最后繞OZ軸逆時(shí)針旋轉(zhuǎn)角度γ,ON軸到達(dá)OX,得到坐標(biāo)系OXYZ。這種定義對(duì)應(yīng)的3個(gè)角度(α,β,γ)稱為歐拉角,其名稱來(lái)源于天文學(xué),最早由歐拉在1776年提出,其中β稱為章動(dòng)角,α稱為進(jìn)動(dòng)角,γ稱為自轉(zhuǎn)角[5]。

    圖1 兩種不同順序歐拉角定義示意圖Fig.1 Schematic diagram of definition of Euler angles in 2 different orders

    實(shí)際上,對(duì)歐拉角的名稱、符號(hào)以及旋轉(zhuǎn)順序并沒(méi)有統(tǒng)一的規(guī)定,使用時(shí)必須先明確定義。圖2(a)是按照Z(yǔ)軸-X軸-Z軸依次旋轉(zhuǎn)的順序,稱為ZXZ順序,也稱為313順序,或者按照中間字母X區(qū)分稱為X順規(guī)(實(shí)際上X順規(guī)有4種不同形式);對(duì)應(yīng)定義的歐拉角可以稱為Z-X-Z順序歐拉角。合乎規(guī)則的順規(guī)共有12種,分別是:ZXZ,ZXY,YXZ,YXY,XYX,XYZ,ZYX,ZYZ,XZX,XZY,YZX,YZY。歐拉角及其旋轉(zhuǎn)變換作為一種純粹的數(shù)學(xué)概念,12種合乎規(guī)則的順規(guī)都是可用的,不同順規(guī)對(duì)應(yīng)不同的歐拉角和不同的旋轉(zhuǎn)變換矩陣。

    1.3 歐拉角旋轉(zhuǎn)變換

    在慣性導(dǎo)航等運(yùn)動(dòng)分析中,常常使用Z-Y-X順序定義歐拉角,實(shí)際上不同的旋轉(zhuǎn)順序?qū)?yīng)不同的旋轉(zhuǎn)變換矩陣和旋轉(zhuǎn)結(jié)果,一種旋轉(zhuǎn)結(jié)果可以對(duì)應(yīng)許多組不同的旋轉(zhuǎn)歐拉角。為了與常用的姿態(tài)角定義和測(cè)量計(jì)算方法一致,這里選擇Z-Y-X順序歐拉角(ψ,θ,φ)對(duì)歐拉角旋轉(zhuǎn)變換進(jìn)行分析。

    如圖1(b)所示,固定坐標(biāo)系OXgYgZg(一般是L坐標(biāo)系中的NED坐標(biāo)系)和載體坐標(biāo)系OXBYBZB有共同原點(diǎn)O,OXgYgZg依次經(jīng)過(guò)Z、Y、X軸3次連續(xù)旋轉(zhuǎn),得到OXBYBZB,具體旋轉(zhuǎn)過(guò)程及其坐標(biāo)變換如下:

    首先,坐標(biāo)系繞Z軸旋轉(zhuǎn),旋轉(zhuǎn)角度ψ為正(沿Z軸正方向看,逆時(shí)針?lè)较蛐D(zhuǎn)ψ角度定義為正角度,下同),由OXgYgZg旋轉(zhuǎn)到OX1Y1Z1,此時(shí)OZ1軸與OZg軸重合;

    第二步,坐標(biāo)系繞Y軸旋轉(zhuǎn)正角度θ,由OX1Y1Z1旋轉(zhuǎn)到OX2Y2Z2,此時(shí)OY1軸與OY2軸重合;

    第三步,坐標(biāo)系繞X軸旋轉(zhuǎn)正角度φ,由OX2Y2Z2旋轉(zhuǎn)到OXBYBZB。

    在上述每一步變換中,按照同一矢量在2個(gè)不同坐標(biāo)系中的正交分解進(jìn)行計(jì)算,求解同一矢量在不同坐標(biāo)系中的量值關(guān)系,最后得到:

    式中:Xg=[xg,yg,zg]T和XB=[xB,yB,zB]T分別是同一矢量X在OXgYgZg和OXBYBZB坐標(biāo)系中的3個(gè)正交分量;是由OXgYgZg旋轉(zhuǎn)到OXBYBZB的方向余弦矩陣;CgB是由OXBYBZB旋轉(zhuǎn)到OXgYgZg的方向余弦矩陣,它們是互逆的正交矩陣,因此,

    方向余弦矩陣的具體表達(dá)式如下:

    應(yīng)用到矢量物理量的測(cè)量變換中,姿態(tài)測(cè)量傳感器固定在載體坐標(biāo)系中,該坐標(biāo)系從固定坐標(biāo)系OXgYgZg以Z-Y-X順序經(jīng)歐拉角(ψ,θ,φ)旋轉(zhuǎn)到OXBYBZB,在載體坐標(biāo)系OXBYBZB中的測(cè)量結(jié)果為XB。如果姿態(tài)測(cè)量傳感器測(cè)量得到的角度值是前述歐拉角(ψ,θ,φ),使用上面的公式,對(duì)在載體坐標(biāo)系中的傳感器測(cè)量值XB進(jìn)行修正,可以求出所測(cè)量的矢量值在固定坐標(biāo)系OXgYgZg中的3個(gè)分量,即求出Xg。

    1.4 無(wú)限小角度轉(zhuǎn)動(dòng)

    在上述Z-Y-X順序歐拉旋轉(zhuǎn)中,如果轉(zhuǎn)動(dòng)歐拉角(ψ,θ,φ)為無(wú)限小角度值,則在以歐拉角形式表示的方向余弦矩陣中有以下近似:

    忽略二階及以上乘積項(xiàng)如sinθsinφ、sinψsinφ、sinψsinθsinφ等小角度乘積項(xiàng),則方向余弦矩陣可以近似簡(jiǎn)化為

    可以看出,當(dāng)轉(zhuǎn)動(dòng)歐拉角為無(wú)限小角度值時(shí),以歐拉角形式表示的方向余弦矩陣均為對(duì)稱矩陣,矩陣乘法的順序不影響乘法結(jié)果。也就是說(shuō),當(dāng)轉(zhuǎn)動(dòng)歐拉角為無(wú)限小角度值時(shí),將轉(zhuǎn)動(dòng)分解為3次連續(xù)歐拉旋轉(zhuǎn),結(jié)果與旋轉(zhuǎn)順序無(wú)關(guān)。在慣性導(dǎo)航等設(shè)備的應(yīng)用中,設(shè)備測(cè)量載體的姿態(tài)角度時(shí),量化速率比較高,相當(dāng)于每次疊加計(jì)算所對(duì)應(yīng)的轉(zhuǎn)動(dòng)角度均為無(wú)限小角度,可以采用上述對(duì)稱矩陣形式的方向余弦矩陣進(jìn)行近似求解,大大簡(jiǎn)化求解過(guò)程,提高計(jì)算速度[5]。

    2 姿態(tài)角及其坐標(biāo)變換

    2.1 姿態(tài)角

    姿態(tài)角也是一組能夠完整表述剛體相對(duì)于參照坐標(biāo)系轉(zhuǎn)動(dòng)位置的參量,包括偏航角、俯仰角和滾轉(zhuǎn)角,其中的俯仰角和滾轉(zhuǎn)角通常為傾斜角。姿態(tài)角的參照固定坐標(biāo)系通常為L(zhǎng)坐標(biāo)系中的北東地(NED)坐標(biāo)系[6]。

    圖2 載體姿態(tài)角定義示意圖Fig.2 Schematic diagram of definition of carrier's attitude

    按歐拉角定義方法來(lái)定義固定坐標(biāo)系和載體坐標(biāo)系,在載體坐標(biāo)系OXYZ中,OX軸相對(duì)于固定坐標(biāo)系OgXgYgZg的水平面以及OgXg(正北方向)、OY軸相對(duì)于OgXgYgZg的水平面,存在3個(gè)偏角,它們反映了載體的姿態(tài),稱為載體的姿態(tài)角,通常用(ψ,θ,φ)表示,參見(jiàn)圖2,具體定義如下。

    偏航角ψ:載體坐標(biāo)系X軸在水平面上投影與固定坐標(biāo)系Xg軸之間的夾角,由載體X軸的投影線逆時(shí)針轉(zhuǎn)至Xg軸時(shí),偏航角為正,即機(jī)頭右偏航為正,反之為負(fù)。偏航角通常也稱為方位角或航向角。

    俯仰角θ:載體坐標(biāo)系X軸與水平面的夾角。當(dāng)X軸的正半軸位于過(guò)坐標(biāo)原點(diǎn)的水平面之上(抬頭)時(shí),俯仰角為正,否則為負(fù)。

    滾轉(zhuǎn)角φ:有2種定義,第一種定義為載體坐標(biāo)系Z軸與包含載體X軸的鉛垂面間的夾角,用φz表示,第二種定義為載體坐標(biāo)系Y軸與水平面的夾角,用φy表示;載體向右滾為正,反之為負(fù)。滾轉(zhuǎn)角的兩種定義在實(shí)際工程計(jì)算中都有人使用。

    旋轉(zhuǎn)歐拉角主要是一種數(shù)學(xué)上的概念,姿態(tài)角的定義更具物理意義,容易通過(guò)測(cè)角傳感器測(cè)量得到。但是,由于各種測(cè)角傳感器的原理各異,具體使用時(shí),需要明確傳感器輸出角度值的物理意義,以及滾轉(zhuǎn)角的具體定義,準(zhǔn)確使用姿態(tài)修正變換公式。

    2.2 姿態(tài)角坐標(biāo)變換中的問(wèn)題

    前面的歐拉旋轉(zhuǎn)變換公式是基于3個(gè)歐拉角及其旋轉(zhuǎn)順序推導(dǎo)的,不同的旋轉(zhuǎn)順序?qū)?yīng)不同的變換系數(shù)矩陣,它表明即使是相同的旋轉(zhuǎn)角度,不同的旋轉(zhuǎn)順序?qū)?yīng)的最終旋轉(zhuǎn)結(jié)果也是不同的。

    從歐拉角和姿態(tài)角的定義看,歐拉角和姿態(tài)角是不同的角度,因此,在矢量物理量測(cè)量及其坐標(biāo)變換修正中,應(yīng)仔細(xì)考慮角度測(cè)量傳感器所測(cè)量角度的實(shí)際物理意義;否則直接將姿態(tài)角測(cè)量值當(dāng)作旋轉(zhuǎn)歐拉角,應(yīng)用前述歐拉角旋轉(zhuǎn)變換公式(1)和(2)進(jìn)行坐標(biāo)變換修正計(jì)算,可能存在原理性誤差。

    在實(shí)際工程應(yīng)用中,角度測(cè)量傳感器一般都是基于載體坐標(biāo)系的,通過(guò)與載體固定連接,實(shí)時(shí)測(cè)量載體的姿態(tài)角度。各種不同的姿態(tài)角度測(cè)量傳感器,往往原理不同,性能特點(diǎn)各異,適用的環(huán)境條件各不一樣。常用的測(cè)角傳感器有加速度計(jì)、磁力計(jì)、陀螺儀以及以陀螺儀為核心的慣導(dǎo)系統(tǒng)(包括平臺(tái)式慣導(dǎo)系統(tǒng)和捷聯(lián)慣導(dǎo)系統(tǒng))等。

    2.3 由加速度計(jì)求解傾斜角

    加速度計(jì)也稱重力感應(yīng)器或力感應(yīng)器,主要是通過(guò)測(cè)量組件在某個(gè)軸向的受力情況來(lái)計(jì)算軸向加速度的大小和方向。由于重力加速度只是地表垂直方向加速度,因此,借助三軸加速度計(jì)可以測(cè)得一個(gè)固定平臺(tái)相對(duì)地球表面的運(yùn)動(dòng)方向[7]。

    通常加速度計(jì)的測(cè)量值包含了重力加速度和其它受力運(yùn)動(dòng)產(chǎn)生的加速度,而在靜態(tài)、勻速運(yùn)動(dòng)或接近勻速運(yùn)動(dòng)的低速(即維持慣性)條件下,可以認(rèn)為或近似認(rèn)為只有重力而無(wú)其它作用力,測(cè)量的三軸加速度值認(rèn)為是重力加速度產(chǎn)生的,由三軸加速度測(cè)量值可以求解載體的傾斜角度(姿態(tài)角中的2個(gè)量)。

    實(shí)際上,以下2種求解過(guò)程是互為逆運(yùn)算關(guān)系:1)已知固定坐標(biāo)系下重力加速度的3個(gè)分量,通過(guò)加速度計(jì)測(cè)量載體坐標(biāo)系下的重力加速度,求解載體的傾斜角度;2)已知或者測(cè)量獲得載體坐標(biāo)系的傾斜角度,通過(guò)測(cè)量載體坐標(biāo)系下的重力加速度的3個(gè)分量,求解固定坐標(biāo)系下的重力加速度值。

    圖3 加速度計(jì)測(cè)量計(jì)算姿態(tài)角的原理示意圖Fig.3 Principle diagram of measuring attitude angles by accelerometer

    下面來(lái)推導(dǎo)由加速度計(jì)求解傾斜角度的具體求解過(guò)程。

    如圖3所示,OXgYgZg為固定坐標(biāo)系,OXYZ為載體坐標(biāo)系,三分量加速度計(jì)固聯(lián)在載體坐標(biāo)系的坐標(biāo)軸上。圖中將水平面OXgYg旋轉(zhuǎn)到了鉛錘面上。

    在OXgYgZg坐標(biāo)系中,重力加速度的值為G=[Gx,Gy,Gz]T=[0,0,g]T,g為重力加速度常數(shù);在OXYZ坐標(biāo)系中,加速度計(jì)的測(cè)量值為g=[gx,gy,gz]T。

    我們假定由坐標(biāo)系OXgYgZg到坐標(biāo)系OXYZ是經(jīng)過(guò)Y-Z順序2個(gè)歐拉旋轉(zhuǎn)實(shí)現(xiàn)的,旋轉(zhuǎn)的具體步驟:

    1)在OXgYgZg坐標(biāo)系內(nèi),繞OYg軸(順螺旋方向,即逆時(shí)針?lè)较?旋轉(zhuǎn)θ角,即OXg軸和OZg軸均在OXgZg平面內(nèi)旋轉(zhuǎn)了θ角度,得到坐標(biāo)系OX′Y′Z′,其中Y′與Yg重合;

    2)在OX′Y′Z′坐標(biāo)系內(nèi),繞OX′軸(順螺旋方向,即逆時(shí)針?lè)较?旋轉(zhuǎn)φ角,即OY′軸和OZ′軸均在OY′Z′平面內(nèi)旋轉(zhuǎn)了φ角度,得到坐標(biāo)系OXYZ,其中X與X′重合。

    至此,可以得到以下一些關(guān)系:

    1)OX軸在OXgZg平面內(nèi),因此θ等于OX軸與水平面OXgYg的夾角,即目標(biāo)的俯仰角;

    2)OY′與OYg重合,OYg⊥OXgZg平面,因此平面OY′Z′⊥OXgZg平面(即鉛錘面),OZ′為相交線;OY′、OY、OZ′、OZ在同一平面OY′Z′內(nèi),OY和OZ在OXgZg平面上的投影均為OZ′;因此,OZ軸與鉛錘面OXgZg的夾角等于φ,也就是滾轉(zhuǎn)角的第一種定義值φz=φ;

    3)假設(shè)OY軸在水平面OXgYg上的投影為OP,OY與水平面OXgYg的夾角即為滾轉(zhuǎn)角的第二種定義值φy。用φy和φ兩個(gè)角度分別計(jì)算OY軸上的單位矢量在OZg上的投影分量,則有:sinφy=sinφcosθ。

    根據(jù)以上關(guān)系,重力加速度在OXgYgZg坐標(biāo)系中的值G=[Gx,Gy,Gz]T=[0,0,g]T與加速度計(jì)的測(cè)量值g=[gx,gy,gz]T之間,滿足歐拉角旋轉(zhuǎn)變換關(guān)系,即:

    由Gx=0和Gy=0可以得到:

    由上式推導(dǎo)出:

    所以,由加速度計(jì)求解傾斜角的計(jì)算方法:

    1)在載體坐標(biāo)系中測(cè)量3個(gè)正交加速度計(jì)的值gx,gy,gz;

    2)用上述2個(gè)式(4)和式(5)求解出θ和φ;

    3)俯仰角為θ;

    4)滾轉(zhuǎn)角φ的第一種定義值為φz=φ,第二種定義值φy由關(guān)系式sinφy=sinφcosθ求解;

    由加速度計(jì)求解傾斜角適用于靜止、勻速或近似勻速運(yùn)動(dòng)的條件。在不考慮偏航角的情況下,可以通過(guò)測(cè)量?jī)A斜角對(duì)矢量測(cè)量值進(jìn)行傾斜修正。

    假設(shè)在載體坐標(biāo)系下測(cè)量得到的矢量值為X=[x,y,z]T,載體坐標(biāo)系的傾斜角(θ,φ)由傳感器測(cè)量得到,則將X轉(zhuǎn)換到固定坐標(biāo)系下的值為Xg=[xg,yg,zg]T,按照公式(3),得到:

    式中:θ為俯仰角測(cè)量值;滾轉(zhuǎn)角φ的傳感器測(cè)量值如果為第一種定義φz,則φ=φz,為第二種定義φy時(shí),則由sinφ=sinφy/cosθ計(jì)算得出φ。

    2.4 由磁力計(jì)求解偏航角

    磁力計(jì)也稱為磁感器,可用于測(cè)試磁場(chǎng)強(qiáng)度和方向,原理類似指南針。

    在地球表面,地磁場(chǎng)始終是沿著磁感應(yīng)線(地磁場(chǎng)的磁力線)指向北的,某點(diǎn)的磁場(chǎng)強(qiáng)度方向?yàn)榇鸥袘?yīng)線在該點(diǎn)的切線方向,它在北向和垂直方向有相應(yīng)的分量,在東西方向的分量為0。因此,在固定坐標(biāo)系下,地磁場(chǎng)矢量可以表示為Mg=[Mxg,Myg,Mzg]T=[Mxg,0,Mzg]T,即Myg=0。如圖4所示,地磁場(chǎng)強(qiáng)度總量為Mg,其北向分量為Mxg=Mgcosδ,垂直分量為Mzg=Mgsinδ,東向分量為Myg=0。

    圖4 地磁場(chǎng)及其三分量指向示意圖Fig.4 Schematic diagram of geomagnetic field and its tricomponent

    由此可以看出,在載體目標(biāo)上安裝三軸磁力計(jì),測(cè)量出三軸地磁場(chǎng)強(qiáng)度M=[Mx,My,Mz]T,就可以計(jì)算出載體坐標(biāo)系的方位角(即偏航角)ψM。當(dāng)然,實(shí)際上地球的地理北極和地磁南極并不重合,有一定的夾角,稱為磁偏角Δψ。根據(jù)經(jīng)緯度可以查詢到該磁偏角Δψ的大小。固定坐標(biāo)系的北向指向地理北極,磁力計(jì)求得的北向指向地磁南極,因此,用磁力計(jì)求解的方位角ψM需要進(jìn)行磁偏角Δψ修正,才能得到地理方位,即真正的偏航角ψ[8]。

    和加速度計(jì)的測(cè)量一樣,通常情況下,安裝磁力計(jì)的載體坐標(biāo)系也是處于運(yùn)動(dòng)狀態(tài),具有一定的傾斜角,因此,利用磁力計(jì)測(cè)量值求解方位時(shí),也需要進(jìn)行傾斜修正。

    下面來(lái)推導(dǎo)由磁力計(jì)求解偏航角的具體求解過(guò)程。

    假設(shè)在載體坐標(biāo)系下測(cè)量得到的地磁場(chǎng)為M=[Mx,My,Mz]T,載體坐標(biāo)系的傾斜角(θ,φ)通過(guò)加速度計(jì)求解得到,按照公式(6),可以將地磁場(chǎng)測(cè)量值M=[Mx,My,Mz]T進(jìn)行傾斜修正,得到相對(duì)于固定坐標(biāo)系OXgYgZg僅有偏航角ψM而無(wú)傾斜角的坐標(biāo)系下的值Mp=[Mxp,Myp,Mzp]T:

    而Mp=[Mxp,Myp,Mzp]T是由地磁場(chǎng)在固定坐標(biāo)系下的值Mg=[Mx,0,Mzg]T經(jīng)過(guò)旋轉(zhuǎn)偏航角ψM得到的,而且,這個(gè)偏航角的旋轉(zhuǎn)在傾斜之前或之后,結(jié)果都是一樣的。因此有:

    式中:θ為俯仰角測(cè)量值,φ=φz(當(dāng)滾轉(zhuǎn)角測(cè)量值為第一種定義值φz時(shí))或者由計(jì)算式sinφ=sinψy/cosθ計(jì)算得到(當(dāng)滾轉(zhuǎn)角測(cè)量值為第二種定義值φy時(shí))。

    再考慮磁偏角Δψ的修正,相對(duì)于固定坐標(biāo)系的偏航角為:ψ=ψM+Δψ。

    所以,通過(guò)測(cè)量或測(cè)量計(jì)算得到載體坐標(biāo)系的傾斜角(θ,φ),以及載體坐標(biāo)系下地磁場(chǎng)的值M=[Mx,My,Mz]T,可以求解偏航角ψM,再進(jìn)行磁偏角Δψ修正,就可以求得相對(duì)于固定坐標(biāo)系的偏航角ψ。最終得到載體的姿態(tài)角(ψ,θ,φ)。

    2.5 姿態(tài)角的坐標(biāo)變換計(jì)算

    綜合前面的分析,在載體坐標(biāo)系下測(cè)量某一矢量物理量時(shí),同步測(cè)量載體的姿態(tài)角,通過(guò)姿態(tài)角的坐標(biāo)變換,將載體坐標(biāo)系下的矢量測(cè)量結(jié)果變換到固定坐標(biāo)系。而姿態(tài)角與旋轉(zhuǎn)歐拉角在定義上是有區(qū)別的。因此,在姿態(tài)角的測(cè)量以及角度計(jì)算中,要明確角度輸出值的定義,特別是滾轉(zhuǎn)角的輸出值所對(duì)應(yīng)的定義,引用合適的變換矩陣,而不能簡(jiǎn)單直接地引用歐拉角旋轉(zhuǎn)變換公式。

    一組姿態(tài)角對(duì)應(yīng)一種旋轉(zhuǎn)結(jié)果,但一種旋轉(zhuǎn)結(jié)果可以對(duì)應(yīng)多組旋轉(zhuǎn)歐拉角。下面以Z-Y-X旋轉(zhuǎn)順序?yàn)槔?在前述傾斜角修正和偏航角修正算法的基礎(chǔ)上,推導(dǎo)姿態(tài)角與Z-Y-X順序歐拉角之間的關(guān)系。

    圖5為姿態(tài)角與Z-Y-X順序歐拉旋轉(zhuǎn)角的關(guān)系示意圖。圖中的旋轉(zhuǎn)步驟如下:

    1)固定坐標(biāo)系為OXgYgZg,一般是L坐標(biāo)系(其中的NED坐標(biāo)系)。在坐標(biāo)系為OXgYgZg內(nèi),繞OZg軸(順螺旋方向,即逆時(shí)針?lè)较?旋轉(zhuǎn)ψ角,即OXg軸和OYg軸均在OXgYg平面(通常為水平面)內(nèi)旋轉(zhuǎn)了ψ角度,得到坐標(biāo)系OX1Y1Z1,其中OZ1軸與OZg軸重合,OX1軸和OY1軸均在OXgYg平面內(nèi);

    2)在OX1Y1Z1坐標(biāo)系內(nèi),繞OY1軸(順螺旋方向,即逆時(shí)針?lè)较?旋轉(zhuǎn)θ角,即OX1軸和OZ1軸均在鉛錘面OX1Zg內(nèi)旋轉(zhuǎn)了θ角度,得到坐標(biāo)系OX2Y2Z2,其中OY2軸與OY1軸重合,OX2軸和OZ2軸均在鉛錘面OX1Zg內(nèi),OX2軸在水平面OXgYg上的投影為OX1軸;

    3)在OX2Y2Z2坐標(biāo)系內(nèi),繞OX2軸(順螺旋方向,即逆時(shí)針?lè)较?旋轉(zhuǎn)φ角,得到坐標(biāo)系OX3Y3Z3,其中OX3軸在與OX2軸重合,OZ3軸在鉛錘面OX1Zg上的投影為OZ2軸,OZ3軸與鉛錘面OX1Zg的夾角即是滾轉(zhuǎn)角的第一種定義,記為φz,顯然有φz=φ;而OY3軸與水平面OXgYg的夾角記為φy。

    圖5 姿態(tài)角與Z-Y-X順序歐拉旋轉(zhuǎn)角的關(guān)系示意圖Fig.5 Schematic diagram of relation between attitude angles and Z-Y-X order

    從坐標(biāo)系OXgYgZg到OX3Y3Z3,根據(jù)姿態(tài)角的定義得到:ψ為偏航角,θ為俯仰角,φ為橫滾角第一種定義值,即φz=φ,下面來(lái)推導(dǎo)滾轉(zhuǎn)角第二種定義值φy的表達(dá)式。

    假設(shè)OY3軸上有一個(gè)單位矢量uy3,在坐標(biāo)系OXgYgZg上進(jìn)行正交分解,它在OZg軸上的分量為sinψy;

    如果在坐標(biāo)系OX2Y2Z2上對(duì)uy3進(jìn)行正交分解,它在OZ2軸上的分量為sinψy,在OY2軸上的分量為cosφ,在OX2軸上的分量為0;OY2軸上的分量為cosφ在坐標(biāo)系OXgYgZg上進(jìn)行正交分解,由于OY2在水平面OXgYg上,因此cosφ在OZg軸上分量為0;OZ2軸上的分量為sinφ在坐標(biāo)系OXgYgZg上進(jìn)行正交分解,它在OZg軸上分量為sinψcosθ。

    OY3軸上的單位矢量uy3,用兩種不同的正交分解方法求解在OZg軸上的分量,結(jié)果應(yīng)該相等,因此有:sinψy=sinψcosθ。

    由此得出姿態(tài)角與Z-Y-X順序歐拉角的關(guān)系為:歐拉角ψ等于偏航角;歐拉角θ等于俯仰角;歐拉角φ與2種定義橫滾角的關(guān)系:φz=φ,sinψy=sinψcosθ。

    因此,矢量物理量的姿態(tài)變換計(jì)算方法:假設(shè)載體坐標(biāo)系下的矢量測(cè)量值為X=[x,y,z]T,載體坐標(biāo)系的姿態(tài)角測(cè)量值為(ψ,θ,φ),則矢量X在固定坐標(biāo)系下的修正結(jié)果Xg=[xg,yg,zg]T為

    式中:ψ為偏航角測(cè)量值,如果偏航角是通過(guò)磁力計(jì)測(cè)量的,需要進(jìn)行磁偏角Δψ修正;θ為俯仰角測(cè)量值;當(dāng)滾轉(zhuǎn)角的測(cè)量值為第一種定義值φz時(shí),φ=φz;當(dāng)滾轉(zhuǎn)角測(cè)量值為第二種定義值φy時(shí),由計(jì)算式sinφ=sinφy/cosθ計(jì)算得到φ。

    姿態(tài)角的取值范圍為:ψ,φ∈[-π,π],θ∈[-π/2,π/2]。

    2.6 陀螺儀和慣導(dǎo)系統(tǒng)測(cè)量姿態(tài)角的比較

    陀螺儀也稱作地感器,由陀螺構(gòu)成的慣導(dǎo)系統(tǒng),無(wú)論是傳統(tǒng)的機(jī)械轉(zhuǎn)子陀螺平臺(tái)式慣導(dǎo)系統(tǒng),還是新型光纖陀螺捷聯(lián)慣導(dǎo)系統(tǒng),都可以求解運(yùn)動(dòng)目標(biāo)的瞬時(shí)速度、位置以及姿態(tài)角度[4,8]。

    在傳統(tǒng)的機(jī)械轉(zhuǎn)子陀螺和平臺(tái)式慣導(dǎo)系統(tǒng)中,經(jīng)過(guò)初始對(duì)準(zhǔn)后,輸出的傾斜角是載體坐標(biāo)系x、y軸相對(duì)于基準(zhǔn)水平面的角度,而偏航角則是相對(duì)于正北方向的。俯仰角和偏航角與姿態(tài)角中的定義完全一致,滾轉(zhuǎn)角則與姿態(tài)角中的第二種定義一致,使用變換計(jì)算式(10)時(shí),由計(jì)算得到φ。

    而在捷聯(lián)慣導(dǎo)系統(tǒng)中,使用虛擬的數(shù)學(xué)平臺(tái)代替了物理平臺(tái),陀螺測(cè)量的是載體相對(duì)于慣性坐標(biāo)系的轉(zhuǎn)動(dòng)角速度,然后通過(guò)計(jì)算得到載體的姿態(tài)角,具體計(jì)算過(guò)程為

    1)陀螺儀測(cè)量,運(yùn)用地球參數(shù)和位置參數(shù)計(jì)算;

    3)用姿態(tài)四元數(shù)的元素表示姿態(tài)矩陣;

    4)根據(jù)余弦矩陣和歐拉角定義,用歐拉角表示的姿態(tài)矩陣形式求解歐拉角(ψ,θ,φ)。

    由上述導(dǎo)航解算原理可知,捷聯(lián)慣導(dǎo)系統(tǒng)實(shí)際給出的是Z-Y-X順序歐拉角,其中偏航角輸出已經(jīng)修正為正北航向,俯仰角和滾轉(zhuǎn)角經(jīng)過(guò)象限修正為歐拉角真值,滾轉(zhuǎn)角等同于姿態(tài)角中的第一種定義φz。坐標(biāo)修正變換可以直接使用變換計(jì)算式(10),其中φ=φz。

    3 結(jié)束語(yǔ)

    在實(shí)施任意姿態(tài)(也就是載體坐標(biāo)系)下矢量物理量的測(cè)量時(shí),一般需要同步測(cè)量載體的姿態(tài)角,然后通過(guò)坐標(biāo)變換公式對(duì)矢量測(cè)量值進(jìn)行修正,求解出固定坐標(biāo)系下的矢量值。

    以測(cè)量水面艦船目標(biāo)的磁場(chǎng)為例,測(cè)量時(shí),目標(biāo)在水面上,測(cè)量傳感器沉底布放,傳感器的姿態(tài)(包括方位)與確定的固定坐標(biāo)系不平行,即存在一個(gè)傳感器坐標(biāo)系,其姿態(tài)角可以測(cè)量,因此,對(duì)傳感器的測(cè)量結(jié)果,應(yīng)該進(jìn)行姿態(tài)角變換修正。

    很多文獻(xiàn)和工程實(shí)踐中,無(wú)論是基于陀螺測(cè)量的姿態(tài)角還是其它傳感器測(cè)量的傾斜角,往往直接引用旋轉(zhuǎn)歐拉角坐標(biāo)變換公式,進(jìn)行測(cè)量數(shù)據(jù)修正和坐標(biāo)變換計(jì)算。從前面的分析可以看出,各種不同的傳感器測(cè)量的姿態(tài)角,其輸出值所代表的物理意義不一定完全相同,特別是滾轉(zhuǎn)角存在兩種不同的定義,如果傳感器的滾轉(zhuǎn)角輸出值物理意義不同于歐拉角定義,直接引用旋轉(zhuǎn)歐拉角坐標(biāo)變換公式,就會(huì)產(chǎn)生原理性誤差。

    正確的做法是:分析姿態(tài)角傳感器的工作原理,明確姿態(tài)角測(cè)量值的定義,確定姿態(tài)角測(cè)量值與某種歐拉角(通常采用Z-Y-X順序歐拉角)的數(shù)值關(guān)系,再引用歐拉角修正變換計(jì)算式。

    如果滾轉(zhuǎn)角輸出值對(duì)應(yīng)第一種定義,即載體坐標(biāo)系Z軸與包含載體X軸的鉛垂面間的夾角,則與旋轉(zhuǎn)歐拉角定義一致,可以直接引用旋轉(zhuǎn)歐拉角坐標(biāo)變換公式;如果滾轉(zhuǎn)角輸出值對(duì)應(yīng)第二種定義,即載體坐標(biāo)系Y軸與水平面的夾角,則與旋轉(zhuǎn)歐拉角定義不一致,不能直接引用旋轉(zhuǎn)歐拉角坐標(biāo)變換公式。

    另外,在工程應(yīng)用中,通常在靜態(tài)或接近靜態(tài)條件下,使用低成本的傾斜儀測(cè)量?jī)A斜角,使用磁方位儀測(cè)量方位角,滾轉(zhuǎn)角測(cè)量值為第二種定義值,在坐標(biāo)變換修正計(jì)算中應(yīng)用前述公式(10)時(shí),由計(jì)算φ。在運(yùn)動(dòng)狀態(tài)下,一般使用陀螺儀或基于陀螺儀的慣導(dǎo)系統(tǒng)測(cè)量姿態(tài)角。如果是傳統(tǒng)的機(jī)械轉(zhuǎn)子陀螺或者平臺(tái)式慣導(dǎo)系統(tǒng),姿態(tài)角測(cè)量值與傾斜儀+磁方位儀相同,滾轉(zhuǎn)角測(cè)量值為第二種定義值,坐標(biāo)變換修正計(jì)算中應(yīng)用前述公式(10)時(shí),由計(jì)算φ;現(xiàn)在更廣泛使用的是光纖陀螺捷聯(lián)慣導(dǎo)系統(tǒng),姿態(tài)角測(cè)量值一般為Z-Y-X順序歐拉角,滾轉(zhuǎn)角測(cè)量值為第一種定義值φz,在坐標(biāo)變換修正計(jì)算中應(yīng)用前述公式(10)時(shí),φ=φz。

    猜你喜歡
    歐拉角轉(zhuǎn)角矢量
    玩轉(zhuǎn)角的平分線
    矢量三角形法的應(yīng)用
    三次“轉(zhuǎn)角”遇到愛(ài)
    解放軍健康(2017年5期)2017-08-01 06:27:42
    從CATIA位置矩陣求解歐拉角的計(jì)算方法分析
    科技視界(2017年6期)2017-07-01 08:33:34
    一種基于EGI和標(biāo)準(zhǔn)人臉模板的三維人臉點(diǎn)云拼合算法
    永春堂贏在轉(zhuǎn)角
    基于矢量最優(yōu)估計(jì)的穩(wěn)健測(cè)向方法
    三角形法則在動(dòng)態(tài)平衡問(wèn)題中的應(yīng)用
    下一個(gè)轉(zhuǎn)角:邁出去 開(kāi)啟“智”造時(shí)代
    大姿態(tài)角入水時(shí)的魚雷半實(shí)物仿真方法研究
    国产日韩欧美亚洲二区| 亚洲av片天天在线观看| 日日爽夜夜爽网站| 久久青草综合色| 国精品久久久久久国模美| 欧美日韩国产mv在线观看视频| 欧美 亚洲 国产 日韩一| 岛国在线观看网站| 又紧又爽又黄一区二区| 国产精品久久久久久精品古装| 999久久久国产精品视频| 亚洲欧美激情在线| 久久久久久久国产电影| 亚洲精品国产精品久久久不卡| 99国产精品一区二区蜜桃av | 日韩三级视频一区二区三区| 波多野结衣一区麻豆| 国产精品 欧美亚洲| 午夜福利影视在线免费观看| 久久精品国产a三级三级三级| 欧美日本中文国产一区发布| 最黄视频免费看| 亚洲av电影在线观看一区二区三区| 五月天丁香电影| 精品人妻一区二区三区麻豆| 最近中文字幕2019免费版| 麻豆国产av国片精品| 欧美大码av| 下体分泌物呈黄色| 两个人免费观看高清视频| 男女之事视频高清在线观看| 老司机福利观看| 高清欧美精品videossex| 男人舔女人的私密视频| 国产精品一区二区在线观看99| av福利片在线| 亚洲精品av麻豆狂野| 婷婷色av中文字幕| 国产亚洲欧美在线一区二区| 日韩一卡2卡3卡4卡2021年| 久久人人爽av亚洲精品天堂| 亚洲国产欧美日韩在线播放| www.av在线官网国产| 国产欧美日韩一区二区精品| 人人妻人人添人人爽欧美一区卜| 纯流量卡能插随身wifi吗| 日本黄色日本黄色录像| 国产成人av教育| 啦啦啦中文免费视频观看日本| 热re99久久精品国产66热6| 亚洲成人国产一区在线观看| 亚洲精品久久久久久婷婷小说| av一本久久久久| 国产精品免费视频内射| 久热这里只有精品99| 欧美精品一区二区大全| 久久影院123| 九色亚洲精品在线播放| 国产精品久久久人人做人人爽| av网站免费在线观看视频| 高清av免费在线| 亚洲一区中文字幕在线| 美女中出高潮动态图| 国产成人精品久久二区二区91| 午夜激情久久久久久久| av不卡在线播放| 精品亚洲成国产av| 久久免费观看电影| 日本猛色少妇xxxxx猛交久久| 成年人午夜在线观看视频| 男人添女人高潮全过程视频| 亚洲一区二区三区欧美精品| 色婷婷av一区二区三区视频| 老司机福利观看| 18禁裸乳无遮挡动漫免费视频| 两人在一起打扑克的视频| 脱女人内裤的视频| 丁香六月天网| 国产精品 国内视频| 亚洲精品国产一区二区精华液| 欧美激情久久久久久爽电影 | 97在线人人人人妻| 性色av乱码一区二区三区2| 国产男人的电影天堂91| 午夜两性在线视频| 亚洲久久久国产精品| 国产色视频综合| 久久青草综合色| 久久人人97超碰香蕉20202| 日韩视频一区二区在线观看| 国产精品免费大片| 欧美日韩黄片免| 亚洲精品粉嫩美女一区| 日本vs欧美在线观看视频| 又黄又粗又硬又大视频| 久久精品aⅴ一区二区三区四区| 纵有疾风起免费观看全集完整版| 伦理电影免费视频| 成人av一区二区三区在线看 | 亚洲精品国产av成人精品| 少妇精品久久久久久久| 亚洲精华国产精华精| 人妻久久中文字幕网| 久久久久网色| 99精品欧美一区二区三区四区| 久9热在线精品视频| 午夜福利视频精品| 在线观看免费视频网站a站| 亚洲国产欧美一区二区综合| 亚洲 欧美一区二区三区| 丝瓜视频免费看黄片| 久久人妻福利社区极品人妻图片| 丰满人妻熟妇乱又伦精品不卡| 天堂俺去俺来也www色官网| 日韩,欧美,国产一区二区三区| 日本一区二区免费在线视频| 欧美性长视频在线观看| 少妇被粗大的猛进出69影院| 日本精品一区二区三区蜜桃| 午夜老司机福利片| 欧美日韩精品网址| 高清视频免费观看一区二区| 十分钟在线观看高清视频www| 男人爽女人下面视频在线观看| 欧美变态另类bdsm刘玥| 18禁黄网站禁片午夜丰满| 91精品伊人久久大香线蕉| 精品亚洲成a人片在线观看| 日韩欧美免费精品| www.熟女人妻精品国产| 男人舔女人的私密视频| 国产精品 国内视频| 亚洲国产精品一区三区| videos熟女内射| 久久99一区二区三区| 成人影院久久| 午夜免费成人在线视频| 亚洲黑人精品在线| 日日爽夜夜爽网站| 青春草视频在线免费观看| 亚洲精品久久久久久婷婷小说| 一区二区三区四区激情视频| 嫩草影视91久久| 免费女性裸体啪啪无遮挡网站| 亚洲免费av在线视频| 精品高清国产在线一区| h视频一区二区三区| 桃红色精品国产亚洲av| 日日摸夜夜添夜夜添小说| 新久久久久国产一级毛片| 男女下面插进去视频免费观看| 久久国产精品人妻蜜桃| 丁香六月天网| 制服诱惑二区| 91九色精品人成在线观看| 欧美在线黄色| 欧美日韩一级在线毛片| 亚洲午夜精品一区,二区,三区| 欧美老熟妇乱子伦牲交| 亚洲精品乱久久久久久| 国产成人欧美| 交换朋友夫妻互换小说| xxxhd国产人妻xxx| 精品视频人人做人人爽| 国产国语露脸激情在线看| 欧美人与性动交α欧美软件| 欧美在线黄色| 亚洲成av片中文字幕在线观看| 国产免费一区二区三区四区乱码| 亚洲专区字幕在线| 婷婷成人精品国产| 亚洲专区中文字幕在线| 男女无遮挡免费网站观看| 亚洲av日韩在线播放| 国产欧美日韩一区二区精品| 正在播放国产对白刺激| 一二三四在线观看免费中文在| 久久久欧美国产精品| 久久天躁狠狠躁夜夜2o2o| 国产成人欧美在线观看 | 欧美老熟妇乱子伦牲交| 1024视频免费在线观看| 亚洲综合色网址| 91九色精品人成在线观看| 久久人人97超碰香蕉20202| 日韩,欧美,国产一区二区三区| 国产av又大| 青春草亚洲视频在线观看| 久久久久国产精品人妻一区二区| 久久精品熟女亚洲av麻豆精品| 狠狠狠狠99中文字幕| 成人三级做爰电影| 欧美人与性动交α欧美软件| 久久久国产欧美日韩av| 精品国产一区二区三区久久久樱花| 在线av久久热| 精品国产超薄肉色丝袜足j| 99国产综合亚洲精品| 伦理电影免费视频| 国产又爽黄色视频| 国产麻豆69| 欧美精品亚洲一区二区| 丝袜美腿诱惑在线| 亚洲色图综合在线观看| 少妇被粗大的猛进出69影院| 99久久精品国产亚洲精品| 一级a爱视频在线免费观看| 日本黄色日本黄色录像| 亚洲欧洲精品一区二区精品久久久| 99久久人妻综合| 最近最新免费中文字幕在线| 美国免费a级毛片| 久久中文看片网| 国产区一区二久久| 在线亚洲精品国产二区图片欧美| 麻豆av在线久日| 免费一级毛片在线播放高清视频 | 中国美女看黄片| av在线播放精品| 成年动漫av网址| 女警被强在线播放| 国产精品免费视频内射| 最近最新中文字幕大全免费视频| 国产免费一区二区三区四区乱码| 亚洲精品美女久久av网站| 中文精品一卡2卡3卡4更新| 美女视频免费永久观看网站| 久久久久国内视频| 欧美国产精品va在线观看不卡| www.999成人在线观看| av网站在线播放免费| 三上悠亚av全集在线观看| 亚洲精华国产精华精| 色播在线永久视频| www.999成人在线观看| 2018国产大陆天天弄谢| 无遮挡黄片免费观看| 麻豆国产av国片精品| a 毛片基地| 色94色欧美一区二区| 正在播放国产对白刺激| 在线观看免费视频网站a站| 国产一区二区在线观看av| 日韩中文字幕欧美一区二区| 伊人亚洲综合成人网| 精品国产国语对白av| 一本一本久久a久久精品综合妖精| 少妇的丰满在线观看| 免费在线观看影片大全网站| 亚洲一区二区三区欧美精品| 一本综合久久免费| 久久久国产精品麻豆| 国产高清国产精品国产三级| 国产又爽黄色视频| 在线av久久热| 久久人人97超碰香蕉20202| 国产成人影院久久av| 亚洲va日本ⅴa欧美va伊人久久 | 啦啦啦中文免费视频观看日本| 午夜免费观看性视频| 国产精品秋霞免费鲁丝片| 麻豆乱淫一区二区| av网站免费在线观看视频| 99九九在线精品视频| 十八禁人妻一区二区| 国产成+人综合+亚洲专区| 十八禁网站网址无遮挡| 欧美国产精品一级二级三级| 久久国产精品男人的天堂亚洲| 久久精品久久久久久噜噜老黄| 国产精品久久久久久精品电影小说| 91成年电影在线观看| 91老司机精品| 欧美黄色片欧美黄色片| 正在播放国产对白刺激| 人妻 亚洲 视频| 亚洲精品乱久久久久久| 欧美+亚洲+日韩+国产| 国产精品成人在线| 日韩一区二区三区影片| 伊人亚洲综合成人网| 国产亚洲精品一区二区www | 成年人免费黄色播放视频| svipshipincom国产片| 91成人精品电影| 99热国产这里只有精品6| 亚洲欧美激情在线| 18在线观看网站| 亚洲专区字幕在线| 俄罗斯特黄特色一大片| 午夜日韩欧美国产| av有码第一页| 免费一级毛片在线播放高清视频 | 69精品国产乱码久久久| 蜜桃国产av成人99| 国产黄色免费在线视频| 欧美精品啪啪一区二区三区 | 亚洲欧美日韩高清在线视频 | 黄片大片在线免费观看| 亚洲欧美日韩另类电影网站| 亚洲精品日韩在线中文字幕| 国产精品99久久99久久久不卡| 日韩欧美免费精品| 亚洲欧美清纯卡通| 免费观看人在逋| 亚洲国产欧美网| 欧美日本中文国产一区发布| 免费在线观看日本一区| 日本黄色日本黄色录像| av在线播放精品| 一本一本久久a久久精品综合妖精| 黑人猛操日本美女一级片| 国产xxxxx性猛交| e午夜精品久久久久久久| 亚洲精品国产av蜜桃| 欧美成狂野欧美在线观看| 少妇 在线观看| 精品福利永久在线观看| 男人爽女人下面视频在线观看| 免费观看人在逋| 黑人操中国人逼视频| 岛国毛片在线播放| 一级毛片精品| 国产在线免费精品| 午夜福利视频精品| 国产精品一区二区在线观看99| 亚洲 欧美一区二区三区| 美女高潮喷水抽搐中文字幕| 国产高清videossex| 天天影视国产精品| 亚洲第一欧美日韩一区二区三区 | 男女无遮挡免费网站观看| 国产区一区二久久| 丁香六月天网| 久久久久久亚洲精品国产蜜桃av| 丝袜喷水一区| 777米奇影视久久| 国产野战对白在线观看| 亚洲国产av影院在线观看| 亚洲精品在线美女| 一区二区三区精品91| 老司机在亚洲福利影院| a级毛片在线看网站| 丝袜脚勾引网站| 亚洲精品中文字幕一二三四区 | 一个人免费看片子| 中文字幕色久视频| tube8黄色片| 首页视频小说图片口味搜索| 女人高潮潮喷娇喘18禁视频| 一本—道久久a久久精品蜜桃钙片| 人人妻,人人澡人人爽秒播| 一区二区av电影网| 精品亚洲乱码少妇综合久久| 国产精品亚洲av一区麻豆| 女人高潮潮喷娇喘18禁视频| 各种免费的搞黄视频| 波多野结衣av一区二区av| 欧美黄色淫秽网站| 丁香六月天网| 成人三级做爰电影| 人妻 亚洲 视频| 欧美少妇被猛烈插入视频| 国产精品香港三级国产av潘金莲| 欧美另类一区| 国产一卡二卡三卡精品| 青青草视频在线视频观看| 午夜福利,免费看| 天堂8中文在线网| 一本一本久久a久久精品综合妖精| 精品第一国产精品| 日韩,欧美,国产一区二区三区| 啦啦啦中文免费视频观看日本| 国产在线视频一区二区| 久久国产亚洲av麻豆专区| 日韩熟女老妇一区二区性免费视频| 91精品国产国语对白视频| 90打野战视频偷拍视频| 国产在视频线精品| 国产亚洲精品久久久久5区| 无限看片的www在线观看| 国内毛片毛片毛片毛片毛片| 久久精品亚洲熟妇少妇任你| 中亚洲国语对白在线视频| 日韩 亚洲 欧美在线| 午夜福利在线观看吧| 黑人巨大精品欧美一区二区mp4| 这个男人来自地球电影免费观看| 欧美日韩黄片免| 久久香蕉激情| 亚洲伊人色综图| 夜夜夜夜夜久久久久| 亚洲成人免费av在线播放| 成人国产av品久久久| 精品乱码久久久久久99久播| 亚洲 欧美一区二区三区| 亚洲精品国产精品久久久不卡| 国产免费视频播放在线视频| 欧美激情高清一区二区三区| 欧美日韩精品网址| 在线观看免费日韩欧美大片| 亚洲精品国产av蜜桃| 日韩制服骚丝袜av| 国产在线观看jvid| 法律面前人人平等表现在哪些方面 | 中文字幕人妻丝袜一区二区| 91精品国产国语对白视频| 亚洲人成77777在线视频| 精品卡一卡二卡四卡免费| 日韩欧美免费精品| 777久久人妻少妇嫩草av网站| 最近最新免费中文字幕在线| 一二三四在线观看免费中文在| 欧美亚洲 丝袜 人妻 在线| 不卡一级毛片| 欧美日韩福利视频一区二区| 国产野战对白在线观看| 777久久人妻少妇嫩草av网站| 在线看a的网站| 亚洲精品一卡2卡三卡4卡5卡 | 50天的宝宝边吃奶边哭怎么回事| kizo精华| 亚洲精品久久午夜乱码| 91成年电影在线观看| 夜夜骑夜夜射夜夜干| 永久免费av网站大全| 一级黄色大片毛片| 美女主播在线视频| 亚洲成人免费av在线播放| 午夜激情久久久久久久| 黄片小视频在线播放| av国产精品久久久久影院| 久久女婷五月综合色啪小说| 色婷婷久久久亚洲欧美| 欧美亚洲 丝袜 人妻 在线| 飞空精品影院首页| 久久久久久亚洲精品国产蜜桃av| 午夜福利乱码中文字幕| 午夜免费鲁丝| 俄罗斯特黄特色一大片| 777久久人妻少妇嫩草av网站| 一区二区三区精品91| 亚洲国产成人一精品久久久| 久久久久久亚洲精品国产蜜桃av| 亚洲自偷自拍图片 自拍| 精品少妇黑人巨大在线播放| av国产精品久久久久影院| 欧美精品一区二区大全| 精品国产一区二区久久| 少妇精品久久久久久久| 黑人猛操日本美女一级片| 高清视频免费观看一区二区| 看免费av毛片| 岛国毛片在线播放| 午夜福利影视在线免费观看| 男女边摸边吃奶| 妹子高潮喷水视频| 国产精品秋霞免费鲁丝片| 午夜影院在线不卡| 成人18禁高潮啪啪吃奶动态图| 久久久久精品人妻al黑| 一本综合久久免费| 麻豆av在线久日| 久久久久久免费高清国产稀缺| 亚洲天堂av无毛| 嫩草影视91久久| 夜夜夜夜夜久久久久| 久久亚洲精品不卡| 久久热在线av| 大陆偷拍与自拍| 91精品伊人久久大香线蕉| 黑丝袜美女国产一区| 女性被躁到高潮视频| 欧美在线一区亚洲| 丝袜在线中文字幕| 精品久久久久久电影网| 国产主播在线观看一区二区| 成人影院久久| 国产精品一区二区在线观看99| 亚洲一区中文字幕在线| 两性夫妻黄色片| 午夜免费成人在线视频| 黑人猛操日本美女一级片| 欧美日本中文国产一区发布| av不卡在线播放| 桃红色精品国产亚洲av| 精品人妻1区二区| 午夜久久久在线观看| 十八禁网站免费在线| 国产亚洲精品一区二区www | 91成年电影在线观看| 男人爽女人下面视频在线观看| 欧美成狂野欧美在线观看| 精品人妻一区二区三区麻豆| 精品一区在线观看国产| 成人亚洲精品一区在线观看| 欧美日韩精品网址| 免费在线观看黄色视频的| 国产又爽黄色视频| 色视频在线一区二区三区| 久久人妻福利社区极品人妻图片| 麻豆乱淫一区二区| 操美女的视频在线观看| 亚洲精品一二三| 丝袜美足系列| 欧美精品一区二区大全| 中文字幕制服av| 老司机福利观看| 精品少妇黑人巨大在线播放| 不卡av一区二区三区| 成人手机av| 十八禁高潮呻吟视频| 久久久久精品国产欧美久久久 | 亚洲情色 制服丝袜| 99精国产麻豆久久婷婷| 亚洲精品第二区| 国产麻豆69| 国产免费av片在线观看野外av| 亚洲精品av麻豆狂野| 成年美女黄网站色视频大全免费| 一区二区三区激情视频| 在线av久久热| 欧美黑人欧美精品刺激| 国产成+人综合+亚洲专区| 桃红色精品国产亚洲av| 午夜福利视频在线观看免费| 两个人看的免费小视频| 狠狠婷婷综合久久久久久88av| 国产精品国产三级国产专区5o| 精品国产一区二区久久| 他把我摸到了高潮在线观看 | 午夜免费成人在线视频| 国产高清国产精品国产三级| 99精国产麻豆久久婷婷| 国产精品一二三区在线看| 久久久久久亚洲精品国产蜜桃av| 欧美黄色片欧美黄色片| 亚洲自偷自拍图片 自拍| 欧美成狂野欧美在线观看| 国产一区有黄有色的免费视频| 精品第一国产精品| 免费观看av网站的网址| 老汉色∧v一级毛片| 国产男人的电影天堂91| 国产在线免费精品| 九色亚洲精品在线播放| 日韩一卡2卡3卡4卡2021年| 欧美午夜高清在线| 一本久久精品| 欧美精品一区二区免费开放| 少妇精品久久久久久久| 免费在线观看日本一区| 亚洲av欧美aⅴ国产| 伊人久久大香线蕉亚洲五| 久久久精品94久久精品| 老司机影院毛片| 亚洲中文字幕日韩| 各种免费的搞黄视频| 十八禁网站网址无遮挡| 手机成人av网站| 18禁黄网站禁片午夜丰满| 欧美黑人精品巨大| 精品高清国产在线一区| 国产成人影院久久av| 免费黄频网站在线观看国产| 一级毛片女人18水好多| 69av精品久久久久久 | 欧美日韩中文字幕国产精品一区二区三区 | 丝袜美足系列| 十八禁人妻一区二区| 天天躁狠狠躁夜夜躁狠狠躁| 亚洲欧美日韩高清在线视频 | 国产精品 欧美亚洲| 久久女婷五月综合色啪小说| 亚洲三区欧美一区| 一本—道久久a久久精品蜜桃钙片| 99国产精品免费福利视频| 久久久久网色| 日本wwww免费看| 国产伦理片在线播放av一区| 两性午夜刺激爽爽歪歪视频在线观看 | 少妇 在线观看| 最新在线观看一区二区三区| 在线精品无人区一区二区三| 丝袜脚勾引网站| 99热网站在线观看| www.999成人在线观看| 老司机在亚洲福利影院| 亚洲av男天堂| 中文字幕人妻丝袜一区二区| 下体分泌物呈黄色| 色婷婷av一区二区三区视频| 欧美黄色片欧美黄色片| 亚洲国产精品成人久久小说| 菩萨蛮人人尽说江南好唐韦庄| 亚洲第一青青草原| 久久久久网色| bbb黄色大片| 另类亚洲欧美激情| 人妻人人澡人人爽人人| 国产熟女午夜一区二区三区| 一区二区日韩欧美中文字幕| 精品国产国语对白av| 免费人妻精品一区二区三区视频| 欧美97在线视频| 精品高清国产在线一区| 国产黄频视频在线观看| 日韩精品免费视频一区二区三区| 国产免费一区二区三区四区乱码| 香蕉国产在线看| 国产av一区二区精品久久| 我要看黄色一级片免费的| 美女主播在线视频| 久久久欧美国产精品| 欧美国产精品va在线观看不卡|