導(dǎo)航原理_慣性導(dǎo)航_休拉調(diào)諧

1、精選ppt 4.2 慣性導(dǎo)航的基本原理和分類慣性導(dǎo)航的基本原理和分類慣性導(dǎo)航是一種自主式的導(dǎo)航方法。它完全依慣性導(dǎo)航是一種自主式的導(dǎo)航方法。它完全依靠機載設(shè)備自主地完成導(dǎo)航任務(wù)，和外界不發(fā)生任何靠機載設(shè)備自主地完成導(dǎo)航任務(wù)，和外界不發(fā)生任何光、電聯(lián)系。因此隱蔽性好，工作不受環(huán)境條件的限光、電聯(lián)系。因此隱蔽性好，工作不受環(huán)境條件的限制。這一獨特優(yōu)點，使其成為航天、航空和航海領(lǐng)域制。這一獨特優(yōu)點，使其成為航天、航空和航海領(lǐng)域中的一種廣泛使用的主要導(dǎo)航方法。中的一種廣泛使用的主要導(dǎo)航方法。慣性導(dǎo)航的基本工作原理是以牛頓力學(xué)定律為基礎(chǔ)，慣性導(dǎo)航的基本工作原理是以牛頓力學(xué)定律為基礎(chǔ)，利用一組加速度計連續(xù)

2、地進行測量，而后從中提取運利用一組加速度計連續(xù)地進行測量，而后從中提取運動載體相對某一選定的導(dǎo)航坐標系動載體相對某一選定的導(dǎo)航坐標系(可以是人工建立的可以是人工建立的物理平臺，也可以是計算機存儲的物理平臺，也可以是計算機存儲的“數(shù)學(xué)平臺數(shù)學(xué)平臺”)的加的加速度信息；速度信息；精選ppt圖圖4.2 平面慣性導(dǎo)航原理圖平面慣性導(dǎo)航原理圖通過一次積分運算通過一次積分運算(載體初始速度己知載體初始速度己知)便得到載體相對便得到載體相對導(dǎo)航坐標系的即時速度信息；再通過一次積分運算導(dǎo)航坐標系的即時速度信息；再通過一次積分運算(載體載體初始位置已知初始位置已知)得到載體相對導(dǎo)航坐標系的即時位置信息。得到載體

3、相對導(dǎo)航坐標系的即時位置信息。對于地表附近的運動載體，例如飛機，如果選取當?shù)氐貙τ诘乇砀浇倪\動載體，例如飛機，如果選取當?shù)氐乩碜鴺讼底鳛閷?dǎo)航坐標系，則上述速度信息的水平分量理坐標系作為導(dǎo)航坐標系，則上述速度信息的水平分量就是飛機的地速就是飛機的地速 ，上述的位置信息將換算為飛機所在，上述的位置信息將換算為飛機所在處的經(jīng)度處的經(jīng)度 、緯度、緯度L以及高度以及高度h。精選ppt慣導(dǎo)系統(tǒng)工作原理的數(shù)學(xué)描述如下：慣導(dǎo)系統(tǒng)工作原理的數(shù)學(xué)描述如下： 設(shè)一飛行器以一定的加速度設(shè)一飛行器以一定的加速度a 運動，其初始速度運動，其初始速度為為V(t0)。其速度可以表示為：。其速度可以表示為： 飛行器的瞬時位置

4、可表示為：飛行器的瞬時位置可表示為：式中，式中， 為飛機的初始位置向量。為飛機的初始位置向量。kttkdttatvtv0)()()(0kttkdttvtrtr0)()()(0)(0tr若在載體運動過程中，利用陀螺使平臺始終若在載體運動過程中，利用陀螺使平臺始終跟蹤當?shù)厮矫妫齻€軸始終指向東、北、跟蹤當?shù)厮矫?，三個軸始終指向東、北、天方向。在這三個軸上分別安裝上加速度計天方向。在這三個軸上分別安裝上加速度計測量東加速度測量東加速度 ae 、北向加速度、北向加速度an、天向加、天向加速度速度au。將這三個方向上的加速度分量進行將這三個方向上的加速度分量進行積分，便可得到載體沿三個方向的速度分量

5、積分，便可得到載體沿三個方向的速度分量為：為：精選pptkkkttuuuttnnntteeedtatvvdtatvvdtatvv000)()()(000 載體在地球上的位置，可用經(jīng)、緯度和高程表示，載體在地球上的位置，可用經(jīng)、緯度和高程表示，通過對速度積分得到，即：通過對速度積分得到，即：kkkttttttdthhhdtLLLdt000000精選ppt式中，式中， 為載體的初始位置；為載體的初始位置； 分別表示經(jīng)、分別表示經(jīng)、緯度和高程的時間變化率，則載體的位置可由運動速度緯度和高程的時間變化率，則載體的位置可由運動速度計算，即計算，即 0h00Lh0LuMnNevhhRvLLhRvcos)(

6、式中，式中，RM、RN分別表示地球子午圈、卯酉圈的曲率半徑，分別表示地球子午圈、卯酉圈的曲率半徑，初始位置初始位置 應(yīng)事先給出并輸入慣導(dǎo)系統(tǒng)應(yīng)事先給出并輸入慣導(dǎo)系統(tǒng) 。0h00L借助于已知導(dǎo)航坐標系，通過測量或計算，還借助于已知導(dǎo)航坐標系，通過測量或計算，還可得到載體相對當?shù)氐仄阶鴺讼档淖藨B(tài)信息，可得到載體相對當?shù)氐仄阶鴺讼档淖藨B(tài)信息，即航向角、俯仰角和傾斜角。于是，通過慣性即航向角、俯仰角和傾斜角。于是，通過慣性導(dǎo)航系統(tǒng)的工作，可即時地提供全部導(dǎo)航參數(shù)。導(dǎo)航系統(tǒng)的工作，可即時地提供全部導(dǎo)航參數(shù)。精選ppt圖圖4.2 平臺式慣導(dǎo)系統(tǒng)原理示意圖平臺式慣導(dǎo)系統(tǒng)原理示意圖慣導(dǎo)系統(tǒng)的分類：（按結(jié)構(gòu)）慣

7、導(dǎo)系統(tǒng)的分類：（按結(jié)構(gòu)）（SINS）精選ppt圖圖4.3 捷聯(lián)式慣導(dǎo)系統(tǒng)原理示意圖捷聯(lián)式慣導(dǎo)系統(tǒng)原理示意圖精選ppt 4.3 休拉休拉(舒拉、舒勒舒拉、舒勒)調(diào)諧調(diào)諧4.3.1 休拉調(diào)諧原理休拉調(diào)諧原理 在運載體上確定出地垂線后即可確定出運載體在運載體上確定出地垂線后即可確定出運載體的姿態(tài)。因此在導(dǎo)航系統(tǒng)中確定地垂線是一項的姿態(tài)。因此在導(dǎo)航系統(tǒng)中確定地垂線是一項重要的技術(shù)。重要的技術(shù)。在靜止或勻速直線運動條件下，地垂線可用單擺在靜止或勻速直線運動條件下，地垂線可用單擺等簡單方法確定出來。當運載體具有加速度時，等簡單方法確定出來。當運載體具有加速度時，單擺不能正確指示地垂線，而且加速度越大，單單

8、擺不能正確指示地垂線，而且加速度越大，單擺偏離地垂線越嚴重。擺偏離地垂線越嚴重。 德國科學(xué)家休拉發(fā)現(xiàn)當單擺的無阻尼振蕩德國科學(xué)家休拉發(fā)現(xiàn)當單擺的無阻尼振蕩周期為周期為84.4分鐘時，指示垂線的精度不受分鐘時，指示垂線的精度不受加速度的影響。加速度的影響。1923年休拉發(fā)表了論文闡年休拉發(fā)表了論文闡述這一原理，即休拉調(diào)諧原理。述這一原理，即休拉調(diào)諧原理。精選ppt飛機在飛機在0時刻處于水平勻速直線運動狀態(tài)，這時擺處于垂時刻處于水平勻速直線運動狀態(tài)，這時擺處于垂線位置（線位置（OA），），0時刻以后以加速度時刻以后以加速度a作水平直線加速運作水平直線加速運動，經(jīng)過動，經(jīng)過t時刻后到達時刻后到達B點

9、，由于加速度點，由于加速度a的作用，擺偏離的作用，擺偏離垂線垂線O，偏差角為，偏差角為 。 ba 為擺的角位移，為擺的角位移， 為為地垂線的角位移。地垂線的角位移。 ab根據(jù)動量矩定理，單擺的運根據(jù)動量矩定理，單擺的運動方程為動方程為cossinmalmglJa （1）由式（由式（1）可知）可知 ba （2）（3）精選ppt 其中，其中， 是由飛機運動引起的地垂線的是由飛機運動引起的地垂線的角加速度角加速度b Rab （4）將式（將式（4）（）（3）代入（）代入（2），得），得 cossinmalmglRJaJ （5）1cos sin假設(shè)垂線偏差角假設(shè)垂線偏差角很小，則有很小，則有則式（則式（

10、5）可簡化為）可簡化為aRJmlJmgl)1( （6）當當 時，垂線偏差角與加速時，垂線偏差角與加速度無關(guān)，而只與垂線偏差角的初值有關(guān)。度無關(guān)，而只與垂線偏差角的初值有關(guān)。 01RJml精選ppt垂線偏差角垂線偏差角的解析解為的解析解為 tttssssin)0(cos)0()(（7） Rgs)0()0(和其中其中 稱為休拉頻率，稱為休拉頻率， 為擺的初始偏差角為擺的初始偏差角和偏差角變化率初值。和偏差角變化率初值。根據(jù)休拉頻率，可以計算出對應(yīng)角頻率根據(jù)休拉頻率，可以計算出對應(yīng)角頻率 的振蕩周期：的振蕩周期： Rgsmin4 .8481. 96371000222gRTss（8） 稱為稱為地球上的

11、地球上的休拉周期。休拉周期。 0)0(0)0(和從式從式7可以看出，如果，可以看出，如果， 則不論則不論運載體的運動狀態(tài)如何，擺都能正確指示地垂線，運載體的運動狀態(tài)如何，擺都能正確指示地垂線，這種擺稱為休拉擺。實現(xiàn)休拉擺的條件（這種擺稱為休拉擺。實現(xiàn)休拉擺的條件（8）稱）稱為休拉調(diào)諧條件。為休拉調(diào)諧條件。 精選ppt休拉擺工程實現(xiàn)上的困難休拉擺工程實現(xiàn)上的困難 若用單擺來實現(xiàn)，則根據(jù)單擺的振蕩周期計算若用單擺來實現(xiàn)，則根據(jù)單擺的振蕩周期計算公式公式 ，單擺的擺長應(yīng)該等于地球半徑，單擺的擺長應(yīng)該等于地球半徑R才能成為休拉擺，實現(xiàn)困難。才能成為休拉擺，實現(xiàn)困難。 若用物理擺來實現(xiàn)，則物理擺實現(xiàn)休拉

12、調(diào)諧的若用物理擺來實現(xiàn)，則物理擺實現(xiàn)休拉調(diào)諧的條件是條件是 。 即即 ，由于，由于R是地球半徑，所以是地球半徑，所以l很小，很小，不易實現(xiàn)，為了使不易實現(xiàn)，為了使l盡量大，必須在擺的質(zhì)量盡量大，必須在擺的質(zhì)量m一定的條件下轉(zhuǎn)動慣量一定的條件下轉(zhuǎn)動慣量J最大。根據(jù)這些限制條最大。根據(jù)這些限制條件進行了計算：物理擺設(shè)計成環(huán)狀是最佳方案，件進行了計算：物理擺設(shè)計成環(huán)狀是最佳方案，假設(shè)環(huán)半徑假設(shè)環(huán)半徑r=0.5m，環(huán)的質(zhì)量全部集中在，環(huán)的質(zhì)量全部集中在 圓周上，可計算出圓周上，可計算出glTp201RJmlmRJl mmRmrmRJl04. 02精選ppt4.3.2單軸慣導(dǎo)系統(tǒng)和休拉調(diào)諧的實現(xiàn)單軸慣導(dǎo)

13、系統(tǒng)和休拉調(diào)諧的實現(xiàn) 以沿子午面飛行的單軸慣導(dǎo)系統(tǒng)為例，以沿子午面飛行的單軸慣導(dǎo)系統(tǒng)為例， 為北向加速度，由北向加速度計為北向加速度，由北向加速度計AN測量，測量，加速度計的標度因數(shù)為加速度計的標度因數(shù)為Ka，測得的加速，測得的加速度輸出到積分器。積分器的標度因數(shù)是度輸出到積分器。積分器的標度因數(shù)是Ku，對加速度進行一次積分運算，得到，對加速度進行一次積分運算，得到北向速度北向速度VN，經(jīng)過一個計算環(huán)節(jié)可以求，經(jīng)過一個計算環(huán)節(jié)可以求出地垂線的旋轉(zhuǎn)角速度出地垂線的旋轉(zhuǎn)角速度 ，作為指，作為指令角速度信號輸入到（東向）陀螺力矩令角速度信號輸入到（東向）陀螺力矩器。器。NaRVN精選ppt 力矩器的

14、標度因數(shù)為力矩器的標度因數(shù)為Km，它的輸出用，它的輸出用以操縱平臺的修正回路。陀螺以及平臺以操縱平臺的修正回路。陀螺以及平臺的整個特性可簡化為的整個特性可簡化為1/HS的環(huán)節(jié)。修的環(huán)節(jié)。修正回路帶動平臺轉(zhuǎn)動正回路帶動平臺轉(zhuǎn)動 角，地垂線改角，地垂線改變的角度為變的角度為 ，于是誤差，于是誤差角角 。 為平臺偏離地垂線的為平臺偏離地垂線的角度。由于誤差角的存在，則加速度計角度。由于誤差角的存在，則加速度計還敏感一個與重力加速度還敏感一個與重力加速度 的分量相的分量相反的加速度反的加速度 。 21RsaNbbagga精選ppt 圖圖1慣導(dǎo)平臺單軸水平回路簡化框圖慣導(dǎo)平臺單軸水平回路簡化框圖精選pp

15、t下面對圖下面對圖1方塊圖進行化簡，得到圖方塊圖進行化簡，得到圖2。圖圖2精選ppt由圖由圖3，可以求出，可以求出X(s)、Y(s)、)(s的表達式：的表達式：圖圖3RHKKKgsRHKKKaRHKKKgsasXmuamuaNmuaN)()()(RHKKKgsRRHKKKaRasXsYmuamuaNN)()1()()(2)()(ssYs 精選pptRHKKKgsRHKKKaRHKKKgsasXmuamuaNmuaN)()()(RHKKKgsRRHKKKaRasXsYmuamuaNN)()1()()(2)()(ssYs 圖圖4 01RRHKKKmua1HKKKmuaNa當當時，即時，即，平臺偏離

16、地垂，平臺偏離地垂與加速度與加速度無關(guān)。無關(guān)。 線的角度線的角度精選ppt圖5 RgssRgss2220/1/1/10)(由圖由圖5得得即即 0)()(2sRgs對應(yīng)的時域微分方程為對應(yīng)的時域微分方程為0)()(tRgt tttssssin)0(cos)0()(精選ppt)0()0(Rgsmin4 .8422gRTss其中，其中，和和為平臺偏離地垂線角度及其變化率為平臺偏離地垂線角度及其變化率，對應(yīng)的周期為，對應(yīng)的周期為的初值，角頻率的初值，角頻率上述分析說明：設(shè)計單軸慣性平臺時，只要滿足上述分析說明：設(shè)計單軸慣性平臺時，只要滿足1HKKKmua的條件，就可以使平臺具有的條件，就可以使平臺具有

17、84.4分鐘的振蕩周期，分鐘的振蕩周期，從而實現(xiàn)休拉調(diào)諧。從而實現(xiàn)休拉調(diào)諧。精選ppt4.4 慣導(dǎo)基本方程慣導(dǎo)基本方程比力方程比力方程不論是平臺慣導(dǎo)系統(tǒng)還是捷聯(lián)慣導(dǎo)系統(tǒng)，都要遵循共同不論是平臺慣導(dǎo)系統(tǒng)還是捷聯(lián)慣導(dǎo)系統(tǒng)，都要遵循共同的慣導(dǎo)基本方程，本節(jié)就來推導(dǎo)慣導(dǎo)基本方程。的慣導(dǎo)基本方程，本節(jié)就來推導(dǎo)慣導(dǎo)基本方程。 載體相對地球運動，地球又相對慣性空間運動，因此，載體相對地球運動，地球又相對慣性空間運動，因此，對地球而言，載體的慣性加速度包含了相對加速度和對地球而言，載體的慣性加速度包含了相對加速度和哥氏加速度等。若要求得載體相對地球的運動，就要哥氏加速度等。若要求得載體相對地球的運動，就要確定

18、這些加速度之間的關(guān)系。確定這些加速度之間的關(guān)系。設(shè)載體在地心慣性坐標系中的位置矢量為設(shè)載體在地心慣性坐標系中的位置矢量為R，則利用矢，則利用矢量的相對導(dǎo)數(shù)和絕對導(dǎo)數(shù)的關(guān)系，載體位置矢量量的相對導(dǎo)數(shù)和絕對導(dǎo)數(shù)的關(guān)系，載體位置矢量R在地在地心慣性坐標中的導(dǎo)數(shù)可表達為心慣性坐標中的導(dǎo)數(shù)可表達為RRRieeidtddtd精選ppt上式可改寫為上式可改寫為地球自轉(zhuǎn)產(chǎn)生的牽連速度地球自轉(zhuǎn)產(chǎn)生的牽連速度epVedtdR運載體相對地球的運動速度，簡稱地速，運載體相對地球的運動速度，簡稱地速，記作記作 ie是地球坐標系相對慣性坐標系的角速度，即地是地球坐標系相對慣性坐標系的角速度，即地球自轉(zhuǎn)角速度，下標球自轉(zhuǎn)角

19、速度，下標“ie”表示表示“地球坐標系相對地球坐標系相對慣性坐標系慣性坐標系”的意思。的意思。RieRRieepiVdtd對上式再次求絕對變率，得對上式再次求絕對變率，得 精選pptiieiepidtddtdVdtd| )(22RR由于地球自轉(zhuǎn)角速率可近似地認為是常量，則由于地球自轉(zhuǎn)角速率可近似地認為是常量，則0| iiedtd所以上式可簡化為所以上式可簡化為)()()(|22RVVRVVRVVRVRieieepieepippepieieepieiepieepieiepiieiepiVdtddtddtddtddtddtdepieip，代入上式，得，代入上式，得精選ppt)()2(22RVVRi

20、eieepepiepepidtddtd我們來看一下上式等號左邊，等號左邊表示的是運載我們來看一下上式等號左邊，等號左邊表示的是運載體相對慣性坐標系的絕對加速度，怎么表示這個絕對體相對慣性坐標系的絕對加速度，怎么表示這個絕對加速度呢？加速度呢？設(shè)運載體上加速度計質(zhì)量塊的質(zhì)量為設(shè)運載體上加速度計質(zhì)量塊的質(zhì)量為m，質(zhì)量，質(zhì)量m受到的力受到的力有非引力外力有非引力外力F和地球引力和地球引力mG（當然也包括其他星球的引（當然也包括其他星球的引力，只是量級非常小，忽略不計），力，只是量級非常小，忽略不計），G為引力加速度。根為引力加速度。根據(jù)牛頓第二定律有：據(jù)牛頓第二定律有：idtdmm22RGFGfRi

21、dtd22mFf 其中其中是單位質(zhì)量上作用的非引力外力，是單位質(zhì)量上作用的非引力外力，稱為比力（稱為比力（specific force）。）。 精選ppt)()2(RVVGfieieepepiepepdtd變換得變換得 )()2(RGVfVieieepepiepepdtd來看一下上式等號右邊最后兩項，是重力加速度來看一下上式等號右邊最后兩項，是重力加速度g，gVfVepepieep)2(此式即為慣導(dǎo)基本方程，也稱為比力方程此式即為慣導(dǎo)基本方程，也稱為比力方程 PgG圖4-3重力矢量圖OZ()ieiegGR上式改寫為上式改寫為精選pptgVfVepepieep)2(比力方程的說明：比力方程的說明

22、： 是進行導(dǎo)航計算需要獲得的載體是進行導(dǎo)航計算需要獲得的載體（平臺系）相對地球的加速度向量；（平臺系）相對地球的加速度向量；f為加速度計所測量為加速度計所測量的比力向量，比力方程說明只有當加速度計的測量值的比力向量，比力方程說明只有當加速度計的測量值f消消除掉了有害加速度之后，才能積分獲得地速。（有害加速除掉了有害加速度之后，才能積分獲得地速。（有害加速度度 是由地球自轉(zhuǎn)和載體相對地球運動而產(chǎn)是由地球自轉(zhuǎn)和載體相對地球運動而產(chǎn)生的加速度，為計算生的加速度，為計算 需要把它從需要把它從f中消除掉，因此稱中消除掉，因此稱為有害加速度。為有害加速度。g為重力加速度向量）為重力加速度向量）epVepe

23、pieV)2(epV（4-4-1）式（式（4-4-1）表示的是比力方程的向量形式，也可以寫）表示的是比力方程的向量形式，也可以寫成沿平臺坐標系的投影形式。平臺坐標系的取法不同，成沿平臺坐標系的投影形式。平臺坐標系的取法不同，投影的形式也不同，我們先確定平臺坐標系的投影的形式也不同，我們先確定平臺坐標系的ozp軸的方軸的方向，向，oxp、oyp軸的方向確定在后面再討論。軸的方向確定在后面再討論。ozp軸的正方軸的正方向選為重力加速度的反方向，即指向天。向選為重力加速度的反方向，即指向天。精選ppt根據(jù)矢量叉乘的公式，可以把慣導(dǎo)基本方程寫成如下根據(jù)矢量叉乘的公式，可以把慣導(dǎo)基本方程寫成如下的矩陣形

24、式：的矩陣形式：gVVVfffVVVpzpypxpepxpiexpepypieypepxpiexpepzpiezpepypieypepzpiezpzpypxpzpypx0002)2()2(022)2(0精選ppt 4.5 慣性高度通道的穩(wěn)定性分析慣性高度通道的穩(wěn)定性分析 根據(jù)比力方程的矩陣形式，可以求出高度通道的根據(jù)比力方程的矩陣形式，可以求出高度通道的表達式：表達式：gVVfVpypepxpiexpxpepypieypzpz)2()2(令令 pypepxpiexpxpepypieypzVVa)2()2(上式簡化為上式簡化為 gafVpzpzpz重力加速度與高度的關(guān)系式為重力加速度與高度的關(guān)系式為 )21 ()1 (020RhgRhgg根據(jù)上面兩個式子，可以畫出慣性高度通道根據(jù)上面兩個式子，可以畫出慣性高度通道的方塊圖。的方塊圖。精選ppt由圖得由圖得RgsRgsssfshpz0202221) 1(2111)()(精選ppt0202RgsRgs02特征方程為特征方程為特征根為特征根為所以高度通道是不穩(wěn)定的。所以高度通道是不穩(wěn)定的。zz我們來計算一下高度通道的不穩(wěn)定情況：假設(shè)加速度計我們來計算一下高度通道的不穩(wěn)定情況：假設(shè)加速度計測量誤差為零位