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

    UKF位姿估計的超靜平臺耦合模型參數(shù)辨識

    2018-01-04 02:57:41張科備王大軼王有懿
    宇航學(xué)報 2017年12期
    關(guān)鍵詞:加速度計位姿角速度

    張科備,王大軼,王有懿

    (1.北京控制工程研究所,北京 100190;2. 北京空間飛行器總體設(shè)計部,北京 100190)

    UKF位姿估計的超靜平臺耦合模型參數(shù)辨識

    張科備1,王大軼2,王有懿1

    (1.北京控制工程研究所,北京 100190;2. 北京空間飛行器總體設(shè)計部,北京 100190)

    針對載荷無陀螺時辨識超靜平臺耦合動力學(xué)參數(shù)存在位姿確定問題,設(shè)計了一種基于Schur分解以及無跡卡爾曼濾波(UKF)的位姿確定及參數(shù)辨識方法。首先,建立加速度計和姿態(tài)敏感器組成的測量系統(tǒng)狀態(tài)模型和觀測模型,并給出測量系統(tǒng)的可觀性分析。然后,給出基于UKF的載荷位姿確定方法;在UKF中引入姿態(tài)修正信息,從而提高載荷角速度估計精度,實(shí)現(xiàn)載荷廣義位移、廣義速度、廣義加速度的準(zhǔn)確估計。通過Schur分解實(shí)現(xiàn)超靜平臺動力學(xué)模型解耦及辨識模型中動力學(xué)參數(shù)顯式表達(dá)。以濾波器估計載荷位姿信息為依據(jù),采用最小二乘法辨識動力學(xué)參數(shù)。仿真結(jié)果表明UKF能夠準(zhǔn)確估計載荷角速度以及超靜平臺支桿剛度系數(shù),辨識誤差優(yōu)于百分之一。

    Stewart超靜平臺;位姿確定;無跡卡爾曼濾波(UKF) ;參數(shù)辨識

    0 引 言

    空間觀測等航天任務(wù)要求載荷實(shí)現(xiàn)毫角秒級的指向精度和極高的姿態(tài)穩(wěn)定度[1]。而精密跟瞄Stewart平臺具有高性能隔振、高精度指向和高穩(wěn)定控制等優(yōu)點(diǎn),使得Stewart超靜平臺成為實(shí)現(xiàn)這類航天任務(wù)必不可少的一環(huán)[2-3]。Stewart超靜平臺準(zhǔn)確的動力學(xué)參數(shù)是實(shí)現(xiàn)載荷高精度指向控制的可靠保障。同時,Stewart平臺屬于多通道耦合系統(tǒng),準(zhǔn)確的運(yùn)動學(xué)參數(shù)有利于通道解耦以及控制器設(shè)計。然而,結(jié)構(gòu)形變、安裝偏差等因素造就了系統(tǒng)動力學(xué)參數(shù)實(shí)際值與理論值相差較大,這直接影響了Stewart超靜平臺控制性能。因此,辨識Stewart超靜平臺耦合模型動力學(xué)參數(shù)是實(shí)現(xiàn)其高精度指向控制必要前提。

    獲取超靜平臺載荷位姿信息是辨識動力學(xué)參數(shù)首要解決的問題。文獻(xiàn)[4-5]提出采用計算機(jī)視覺圖像處理算法獲取Stewart超靜平臺的位移和姿態(tài)信息。這種信息獲取方法僅適用于Stewart平臺位移和姿態(tài)估計精度要求較低的場合。而應(yīng)用于天文觀測等航天任務(wù)的精密跟瞄Stewart平臺,其要求運(yùn)動范圍小精度高,此時采用視覺測量獲取載荷位姿具有以下局限性:1)很難獲得攝像機(jī)坐標(biāo)系與平臺基坐標(biāo)系之間的廣義轉(zhuǎn)移矩陣,2)無法精確實(shí)現(xiàn)攝像機(jī)坐標(biāo)系位姿向基坐標(biāo)系位姿轉(zhuǎn)化[4]。文獻(xiàn)[6]提出一種基于加速度測量的兩剛體間相對姿態(tài)信息估計方法。該方法在僅有加速度可觀測時,采用非線性Kalman濾波實(shí)現(xiàn)剛體間相對角速度和角加速度的估計。由于缺乏姿態(tài)測量信息,該方法無法對估計的角速度偏差進(jìn)行修正,造成角速度及積分獲得的姿態(tài)估計誤差較大。文獻(xiàn)[7]在研究火星進(jìn)入過程中平動測量受限時,采用擴(kuò)展Kalman濾波(EKF)估計加速度計零偏以及載荷的平動位移、速度信息。該算法需要精確獲得航天器姿態(tài)和角速度信息以及迭代估計過程中的各個零偏之間協(xié)方差信息。

    設(shè)計解耦方法是Stewart超靜平臺參數(shù)辨識另一個需要解決的問題。Stewart超靜平臺屬于多輸入多輸出(MIMO)系統(tǒng),平臺各通道之間耦合特性復(fù)雜,不利于超靜平臺控制器設(shè)計。通過模型解耦實(shí)現(xiàn)多輸入多輸出系統(tǒng)轉(zhuǎn)變?yōu)閱屋斎雴屋敵?SISO)系統(tǒng),將極大的簡化控制器的設(shè)計。文獻(xiàn)[8-10]針對Stewart平臺高耦合動力學(xué)模型,提出了一種基于關(guān)節(jié)空間質(zhì)量-慣量解耦法,實(shí)現(xiàn)了Stewart平臺MIMO模型到SISO模型的轉(zhuǎn)換。同時采用最小方差約束和對稱正定法辨識解耦模型動力學(xué)參數(shù),從而提高Stewart平臺載荷控制性能。文獻(xiàn)[11-12]采用矩陣分解方法將Stewart超靜平臺由高度耦合的復(fù)雜多輸入多輸出系統(tǒng)變?yōu)槎鄠€相對簡單的單輸入單輸出系統(tǒng),從而簡化了控制器的設(shè)計。

    本文針對辨識Stewart超靜平臺耦合動力學(xué)參數(shù)需要解決的兩個問題,設(shè)計了1)基于UKF的載荷位姿估計方法,實(shí)現(xiàn)了Stewart超靜平臺載荷廣義位移、廣義速度、廣義加速度信息準(zhǔn)確估計;2)基于Schur分解的動力學(xué)模型解耦方法,實(shí)現(xiàn)辨識模型中超靜平臺動力學(xué)參數(shù)顯式表達(dá)。并將該方法應(yīng)用到Stewart超靜平臺的動力學(xué)參數(shù)辨識中,仿真結(jié)果表明該方法正確可行。

    1 問題的提出

    1.1 辨識模型描述

    針對Stewart超靜平臺動力學(xué)建模問題,國內(nèi)外學(xué)者采用牛頓-歐拉法[13]、Kane[14]等方法給出了考慮不同因素的動力學(xué)模型。這些動力學(xué)模型都可采用多輸入多輸出的二階系統(tǒng)進(jìn)行描述。而工程實(shí)際中主要關(guān)心影響Stewart平臺頻率特性的剛度、阻尼等動力學(xué)參數(shù)。因此本文只考慮Stewart平臺剛度和阻尼等因素進(jìn)行動力學(xué)建模,系統(tǒng)描述為:

    (1)

    式中:M=diag(mp,mp,mp,Ix,Iy,Iz,),mp為載荷的質(zhì)量;Ix,Iy,Iz為載荷三軸主慣量;Ms為Stewart平臺支桿質(zhì)量參數(shù)陣,為對稱正定矩陣。Jp為Stewart支桿對載荷質(zhì)心作用力的雅克比矩陣;f為Stewart平臺六個支桿驅(qū)動力;xp=[r,θ]為載荷的廣義位移,r為載荷平動位移,θ為載荷姿態(tài)。fu為Stewart平臺載荷受到來自星體平臺干擾力;Cpp和Kpp分別為系統(tǒng)合成阻尼和剛度陣,定義為:

    (2)

    式中,C0=diag(c1,…,c6),K0=diag(k1,…,k6),ci、ki(i=1,2,…,6)分別為Stewart平臺第i個支桿的阻尼和剛度系數(shù)。

    (3)

    式中,Jb為Stewart支桿對星體平臺質(zhì)心作用力的雅克比矩陣;xb為星體平臺廣義位移;Fd為載荷受到廣義外作用力;Fc包含所有的科氏項;G包含所有的重力項。

    對式(1)中的Stewart平臺動力學(xué)參數(shù)辨識,需要解決兩個問題。第一:載荷位姿信息確定方法。準(zhǔn)確辨識式(1)的動力學(xué)參數(shù),需要獲取載荷廣義位移、廣義速度、廣義加速度信息。加速度計能夠測量系統(tǒng)的加速度,同時能夠反映載荷的角速度信息。而且與陀螺相比,加速度計體積小、測量精度高,更適合Stewart平臺這種小范圍運(yùn)動系統(tǒng)的測量。因此,有必要研究基于加速度測量的載荷位姿估計方法。第二:Stewart平臺耦合模型解耦方法。由式(1)可知,Stewart平臺載荷的位姿信息由六個支桿剛度和阻尼共同作用產(chǎn)生。因此,辨識動力學(xué)參數(shù)需要設(shè)計解耦方法,將耦合MIMO模型轉(zhuǎn)變?yōu)镾ISO模型進(jìn)行辨識。

    1.2 測量系統(tǒng)描述

    Stewart超靜平臺測量系統(tǒng)包括三個三軸加速度計A1、A2、A3和姿態(tài)敏感器。加速度計用于測量Stewart超靜平臺載荷平動信息。姿態(tài)敏感器測量Stewart超靜平臺載荷姿態(tài)。如圖1所示,三個加速度計呈立體幾何安裝,三個加速度計測點(diǎn)在Stewart下平面坐標(biāo)系Ob-XYZ(原點(diǎn)為下平面中心點(diǎn)Ob)的矢量距為ri(i=1,2,3)。

    考慮Stewart平臺載荷面安裝i個三軸加速度計,則第i個三軸加速度計測量模型為:

    (4)

    式中,hi為第i個加速度計的三軸測量輸出,Tib為Stewart平臺載荷坐標(biāo)系到第i個加速度計本體坐標(biāo)系的方向余弦陣,α=[αx,αy,αz]T為載荷的x,y,z方向的平動加速度,ω=[ωx,ωy,ωz]T為載荷三軸角速度;=[x,y,z]T為載荷三軸角加速度;ηi=[ηix,ηiy,ηiz]T為第i個加速度計的測量噪聲,為均值為0,方差σu的高斯白噪聲;ω×為ω的反對稱陣,定義為:

    (5)

    2 系統(tǒng)測量模型

    2.1 觀測系統(tǒng)建模

    (6)

    式中,I3×3為3×3的單位陣。

    取三個加速度計測點(diǎn)矢量距分別為r1=[1,0,1],r2=[0,1,1],r3=[1,1,0]時,且方向余弦陣Ti=I3,則由式(4)知,由加速度計組成的測量系統(tǒng)的觀測方程為:

    (7)

    考慮加速度計安裝偏差,以及采用加速度計估計載荷角速度存在偏差等因素,需要在采用UKF估計載荷位姿信息基礎(chǔ)上,采用序貫估計方法,引入姿態(tài)修正UKF估計載荷角速度偏差,提高載荷角速度收斂速度和估計精度。載荷角速度等效偏差參數(shù)估計及載荷角速度修正方法如下:

    載荷運(yùn)動學(xué)模型為:

    (8)

    (9)

    δx=A2δx+B2u2

    (10)

    當(dāng)采樣時間為ΔT時,對測量系統(tǒng)式(6)、式(7) 的連續(xù)模型進(jìn)行離散化,從而方便濾波器設(shè)計。式(6)的測量系統(tǒng)離散化狀態(tài)方程為:

    x(k+1)=Φ1x(k)+Γ1u1

    (11)

    式(7)測量系統(tǒng)離散觀測方程為:

    h(x(k-1))=[h1(x(k-1)) …h(huán)9(x(k-1))]T

    (12)

    式(10)誤差狀態(tài)方程離散形式為:

    δx=Φ2δx+Γ2u2

    (13)

    測量系統(tǒng)離散模型的狀態(tài)轉(zhuǎn)移陣和輸入陣定義為:

    2.2 系統(tǒng)可觀性分析

    由系統(tǒng)可觀性定義可知,如果系統(tǒng)可觀測,則系統(tǒng)的狀態(tài)能夠通過有限觀測量和輸入量唯一確定。對于線性系統(tǒng)來說,系統(tǒng)可觀為全局可觀,系統(tǒng)中每個狀態(tài)量都可以唯一確定。而離散系統(tǒng)式(11)中狀態(tài)方程為線性模型,觀測方程為非線性模型。對于非線性模型,需要構(gòu)建可觀性空間。通過可觀性空間的秩準(zhǔn)則進(jìn)行可觀性分析。采用李導(dǎo)數(shù)的方法構(gòu)建系統(tǒng)的可觀性空間為[6][15]:

    (14)

    通過可觀性空間O對狀態(tài)x求導(dǎo),構(gòu)建可觀性矩陣為:

    (15)

    通過判斷可觀性矩陣OM的秩分析系統(tǒng)的可觀性。記:

    (16)

    式(16)中的子矩陣為:

    對式(16)中OM1的每列分析可知,對于任意狀態(tài)量x(x≠0),矩陣OM1每一列是線性無關(guān)矢量,即rank(OM1)=9;

    (17)

    (18)

    由式(16)、式(17)和式(18)可知,對于任意狀態(tài)量x(x≠0),構(gòu)成觀測矩陣OM的每一列為線性無關(guān)矢量,即rank(OM)=9。表明采用三個加速度計和姿態(tài)敏感器組成的測量系統(tǒng)能夠?qū)崿F(xiàn)Stewart超靜平臺載荷的平動和轉(zhuǎn)動信息全觀測。

    2.3 基于UKF載荷位姿估計方法

    無跡Kalman濾波摒棄了對非線性函數(shù)線性化的做法,采用無跡變換(UT)處理系統(tǒng)均值和協(xié)方差的非線性傳遞問題,沒有忽略高階項的誤差,因此,UKF與EKF相比,估計精度更高。針對式(11)和式(13)的載荷位姿確定系統(tǒng),文中采用UKF估計Stewart超靜平臺載荷平動和轉(zhuǎn)動信息。如圖2所示,采用序貫估計方法實(shí)現(xiàn)載荷的廣義位移、廣義速度和廣義加速度準(zhǔn)確估計。其中,第1-3步為標(biāo)準(zhǔn)的UKF估計過程。圖2右側(cè)中第4步采用姿態(tài)信息修正UKF估計載荷角速度偏差參數(shù),進(jìn)一步提高載荷姿態(tài)和角速度估計精度。

    (19)

    式中,qm為姿態(tài)敏感器測量的載荷姿態(tài)。Δqv為誤差四元素Δq的矢量部分。誤差系統(tǒng)的觀測陣H2=[I3×303×3]。

    3 動力學(xué)參數(shù)辨識

    Stewart超靜平臺控制器帶寬設(shè)計與自身剛度、阻尼等系數(shù)息息相關(guān)。Stewart超靜平臺支桿剛度、阻尼系數(shù)等受到熱變形、外接線纜等的附加剛度等因素影響,使得Stewart超靜平臺支桿剛度、阻尼系數(shù)理論值與實(shí)際值差別較大。因此,辨識Stewart超靜平臺剛度、阻尼系數(shù)等動力學(xué)參數(shù),有利于提高Stewart超靜平臺控制器性能。

    為準(zhǔn)確辨識動力學(xué)參數(shù),需要獲取載荷廣義位移、速度、加速度信息。通過上節(jié)的UKF實(shí)現(xiàn)Stewart載荷平動加速度α,載荷姿態(tài)θ、角速度ω、角加速度的估計。通過對平臺加速度α的積分,可得到平動速度v以及平動位移r。則,式(1)中的模型中廣義加速度、廣義速度、廣義位移都可由UKF估計得到。Stewart超靜平臺動力學(xué)模型(1)中的剛度、阻尼等動力學(xué)參數(shù)與載荷位姿存在相互耦合,需要對動力學(xué)模型(1)進(jìn)行解耦。令則動力學(xué)模型(1)改寫為:

    (20)

    (21)

    由上式可知,Mp為對稱矩陣。采用Schur分解方法對Mp分解,則有:

    Mp=V·u·VT

    (22)

    其中,V為單位正交陣,且滿足VVT=VTV=I3。U為對角陣。由式(2)可知,剛度和阻尼矩陣K0,C0為對角陣。則式(20)中的矩陣Mp,K0,C0經(jīng)過Schur分解可以轉(zhuǎn)換為相互獨(dú)立的對角陣。其中,VTMpV=u,VTK0V=K0,VTC0V=C0。

    定義解耦模型中新的輸入輸出如下:

    (23)

    將上式(23)代入式(20),則原系統(tǒng)的耦合動力學(xué)模型可轉(zhuǎn)換為:

    (24)

    顯然,上式中u=diag(u1,…,u6),K0,C0都為對角陣。即采用Schur分解進(jìn)行模型解耦,原動力學(xué)模型式(1)轉(zhuǎn)換為SISO時不變系統(tǒng)。從而實(shí)現(xiàn)辨識模型中動力學(xué)參數(shù)顯示表達(dá)。

    定義辨識模型中狀態(tài)量為Θ=[u1,…,u6,c1,…,c6,k1,…,k6],將上述SISO模型式(24)改寫為:

    (25)

    通過Schur方法解耦,式(25)實(shí)現(xiàn)了辨識Stewart平臺剛度、阻尼等動力學(xué)參數(shù)的顯式表達(dá),采用遞推最小二乘法,進(jìn)行動力學(xué)參數(shù)辨識。

    4 仿真校驗

    為了驗證基于UKF的Stewart平臺的姿態(tài)、角速度、角加速度估計的正確性,進(jìn)行采用加速度計結(jié)合姿態(tài)敏感器測量信息的載荷位姿估計數(shù)學(xué)仿真。仿真參數(shù)見表1。在0-10 s進(jìn)行Stewart超靜平臺載荷穩(wěn)態(tài)控制。在10 s以后進(jìn)行Stewart超靜平臺載荷沿x軸的姿態(tài)小角度機(jī)動和x方向的平動位移機(jī)動。在載荷同時具有平動和轉(zhuǎn)動機(jī)動模式下,以載荷平動加速度、姿態(tài)角速度等估計誤差為指標(biāo),校驗UKF估計的正確性。

    表1 仿真參數(shù)Table 1 Simulation parameters

    采用上述UKF估計器能夠?qū)崿F(xiàn)Stewart超靜平臺載荷平動信息(包括加速度、速度、位移)和姿態(tài)信息(包括姿態(tài)角加速度、角速度、角位移)準(zhǔn)確估計。采用最小二乘法進(jìn)行Stewart平臺動力學(xué)參數(shù)辨識。其中,Stewart平臺支桿剛度系數(shù)直接關(guān)系著平臺的結(jié)構(gòu)頻率,因此,辨識參數(shù)中主要以剛度系數(shù)為主。圖7給出了Stewart平臺6個支桿剛度辨識誤差百分比仿真結(jié)果。由圖可知,六個支桿的剛度辨識誤差小于0.01。

    5 結(jié) 論

    針對辨識Stewart超靜平臺耦合動力學(xué)參數(shù)需要獲取載荷廣義位移、速度、加速度信息的問題,文中提出了一種基于加速度計結(jié)合姿態(tài)敏感器估計載荷位姿的方法。在建立測量系統(tǒng)狀態(tài)模型和觀測模型的基礎(chǔ)上,采用UKF估計載荷平動加速度、角加速度、角速度、姿態(tài)信息。其載荷角速度估計誤差優(yōu)于0.005(°/s)。以UKF估計的載荷位姿信息為依據(jù),采用最小二乘辨識超靜平臺耦合模型動力學(xué)參數(shù),其六個支桿的剛度系數(shù)辨識誤差小于0.01。

    [1] Bronowicki A J. Vibration isolator for large space telescopes [J]. Journal of Spacecraft and Rockets, 2006, 43(01): 45-43.

    [2] 徐高楠, 黃海, 李偉鵬, 等. 空間撓性結(jié)構(gòu)的Stewart超靜平臺主動基座振動控制[J]. 宇航學(xué)報, 2015, 36(4): 439-445. [Xu Gao-nan, Huang Hai, Li Wei-peng, et al. Active vibration control of space flexible structure using Stewart platform as active base [J]. Journal of Astronautics, 2015, 36(4): 439-455.]

    [3] 王萍萍, 劉磊. 柔性航天器高精度隔振與定向研究[J]. 宇航學(xué)報, 2012, 23(09): 1195-1202. [Wang Ping-ping, Liu Lei. Research on high accuracy pointing of flexible spacecraft with Stewart platform [J]. Journal of Astronautics, 2012, 23(09): 1195-1202.]

    [4] 馬瑾, 張國峰, 戴樹嶺, 等. 相對視覺位姿的Stewart超靜平臺運(yùn)動學(xué)參數(shù)標(biāo)定[J]. 系統(tǒng)仿真學(xué)報, 2016, 28(9): 2267-2274. [Ma Jin, Zhang Guo-feng, Dai Shuling, et al. Kinematic calibration of Stewart platform based on relative visual pose [J]. Journal of System Simulation, 2016, 28(9): 2267-2274.]

    [5] Chevailer A, Copot C, Ionescu C M. Automatic calibration with robust control of a six DOF mechatronic system [J]. Mechatronics, 2016, 35:102-108.

    [6] Schopp P, Graf H, Maurer M, et al. Observing relative motion with three accelerometer triads [J]. IEEE Transactions on Instrumentation and Measurement, 2014, 63(12): 3137-3151.

    [7] Yu Z S,Crassidis J C. Accelerometer bias calibration using attitude and angular velocity information [J]. Journal of Guidance, Control, and Dynamic, 2016, 39(04): 741-753.

    [8] Chen Y,McInroy, J E. Decoupled control of flexure-jointed hexapods using estimated joint-space mass-inertia matrix [J]. IEEE Transaction on Control Systems Technology, 2004, 12(3): 413-421.

    [9] McInroy, J E. Modeling and design of flexure jointed Stewart platform for control purposes [J]. IEEE/ASME Transaction on mechatronics, 2002, 7(1): 95-99.

    [10] Mcinroy J E, Hamann J C. Design and control of flexure jointed hexapods [J]. IEEE Transactions on robotics and automation, 2000, 16(4): 372-381.

    [11] 王有懿, 湯亮, 何英姿. 一種超靜平動主動指向容錯控制方法[J]. 宇航學(xué)報, 2016, 37(12): 1457-1465. [Wang You-yi, Tang Liang, He Yin-zhi . Fault-tolerant control method for active pointing of ultra-quiet platform [J]. Journal of Astronautics, 2016, 37(12), 1457-1465.]

    [12] 王曉雷, 楊慶俊, 鄭鋼鐵. 八作動器隔振平臺的通道耦合分析及解耦控制[J]. 宇航學(xué)報, 2007, 28(04): 245-249. [Wang Xiao-lei, Yang Qin-jun, Zheng Gang-tie. Decoupling analysis and decoupling control of vibration isolation platform with eight actuators [J]. Journal of Astronautics, 2007, 28(04), 245-249.]

    [13] 劉磊, 王萍萍, 孔憲仁, 等. Stewart 平臺動力學(xué)建模及魯棒主動隔振控制[J]. 宇航學(xué)報, 2011, 32(06): 1231-1238. [Liu Lei, Wang Ping-ping, Kong Xian-ren. Dynamics modeling and robust active isolation control of Stewart platform [J]. Journal of Astronautics, 2011, 32(06): 1231-1238.]

    [14] Yang J F,Xu Z B, Wu Q W, et al. Dynamics modeling and control of a 6-dof micro-vibration simulator. Mechanism and Machine Theory, 2016, 104: 350-369.

    [15] Ning X L, Wang F, Fang J C. Implicit UKF and its observability analysis of satellite stellar refraction navigation [J]. Aerospace Science and Technology, 2016, 54: 49-58

    ParameterIdentificationforUltraquietPlatformCouplingModelBasedonUKF

    ZHANG Ke-bei1, WANG Da-yi2, WANG You-yi1

    (1. Beijing Institute of Control Engineering, Beijing 100190, China; 2. Beijing Institute of Spacecraft Engineering, Beijing 100190, China)

    A method based on Schur decomposition and unscented Kalman filter (UKF) is designed to identify the parameters of the Stewart coupling model. The state model, measurement model and observability are given. The UKF is adopted to determine the payload position and attitude. The attitude measurements are used in the UKF to correct the angular velocity error so that the estimation accuracy and convergence speed of the angular velocity can be improved. The payload generalized displacement, generalized velocity and generalized acceleration should be obtained. The parameter decoupling method is designed and the least squares method is used to identify the dynamics parameters. Numerical simulations results indicate that the angular velocity is estimated accurately by the UKF and the stiffness identification errors of the Stewart six struts are less than 0.01.

    Stewart ultraquiet platform; Position and attitude determination; Unscented Kalman filter (UKF); Parameter identification

    2017- 06- 15;

    2017- 09- 25

    國家杰出青年科學(xué)基金(61525301);國家自然科學(xué)基金重大項目課題(61690215)

    TB535

    A

    1000-1328(2017)12- 1289- 08

    10.3873/j.issn.1000- 1328.2017.12.005

    張科備(1985-),男,博士生,主要從事航天器姿態(tài)高精高穩(wěn)控制。

    通信地址:北京市中關(guān)村南三街北京控制工程研究所(100190)

    E-mail:zhangkb.2008@163.com

    猜你喜歡
    加速度計位姿角速度
    基于加速度計的起重機(jī)制動下滑量測量
    圓周運(yùn)動角速度測量方法賞析
    基于遺傳算法的加速度計免轉(zhuǎn)臺標(biāo)定方法
    常溫下硅微諧振加速度計零偏穩(wěn)定性的提高
    基于共面直線迭代加權(quán)最小二乘的相機(jī)位姿估計
    基于CAD模型的單目六自由度位姿測量
    小型四旋翼飛行器位姿建模及其仿真
    半捷聯(lián)雷達(dá)導(dǎo)引頭視線角速度提取
    基于構(gòu)架點(diǎn)頭角速度的軌道垂向長波不平順在線檢測
    四加速度計組合的測試方法研究
    热99re8久久精品国产| 免费看a级黄色片| 亚洲av成人不卡在线观看播放网| 最新中文字幕久久久久| 免费电影在线观看免费观看| 琪琪午夜伦伦电影理论片6080| 听说在线观看完整版免费高清| 国内毛片毛片毛片毛片毛片| 欧美在线一区亚洲| 精品欧美国产一区二区三| 欧美色欧美亚洲另类二区| 特大巨黑吊av在线直播| 午夜精品一区二区三区免费看| 久久精品国产综合久久久| 成年版毛片免费区| 午夜免费成人在线视频| 97超视频在线观看视频| 免费大片18禁| 日韩亚洲欧美综合| 中出人妻视频一区二区| av专区在线播放| 国产精品乱码一区二三区的特点| 三级国产精品欧美在线观看| 在线视频色国产色| 黄片小视频在线播放| 一个人免费在线观看的高清视频| 国模一区二区三区四区视频| 国产亚洲欧美98| 一卡2卡三卡四卡精品乱码亚洲| 午夜精品一区二区三区免费看| 搞女人的毛片| 国产乱人视频| 久久精品国产亚洲av香蕉五月| 老汉色av国产亚洲站长工具| 成人无遮挡网站| 亚洲av免费高清在线观看| 亚洲成a人片在线一区二区| 中出人妻视频一区二区| 在线播放无遮挡| 免费看日本二区| 真实男女啪啪啪动态图| 成人国产综合亚洲| 最好的美女福利视频网| 日韩欧美三级三区| 69人妻影院| 亚洲精品久久国产高清桃花| 成人av在线播放网站| 婷婷丁香在线五月| 日韩欧美在线乱码| 1000部很黄的大片| 亚洲,欧美精品.| 深爱激情五月婷婷| 嫩草影院入口| 亚洲人成伊人成综合网2020| 国产色爽女视频免费观看| 中文资源天堂在线| 全区人妻精品视频| 欧美bdsm另类| 欧美性猛交╳xxx乱大交人| 在线观看午夜福利视频| 欧美中文日本在线观看视频| 中文字幕久久专区| 亚洲av五月六月丁香网| av国产免费在线观看| 欧美黑人欧美精品刺激| 啪啪无遮挡十八禁网站| e午夜精品久久久久久久| 最新美女视频免费是黄的| 亚洲一区二区三区不卡视频| 91字幕亚洲| 久久精品国产亚洲av香蕉五月| 淫秽高清视频在线观看| 午夜老司机福利剧场| 桃色一区二区三区在线观看| 日日摸夜夜添夜夜添小说| 欧美日韩精品网址| 亚洲精品日韩av片在线观看 | 波多野结衣高清无吗| www.色视频.com| 最近视频中文字幕2019在线8| 亚洲无线在线观看| 叶爱在线成人免费视频播放| 国产精品美女特级片免费视频播放器| 亚洲成av人片免费观看| 国产av一区在线观看免费| 久久精品国产综合久久久| av福利片在线观看| 国产伦一二天堂av在线观看| 国产亚洲精品一区二区www| 国产精品99久久久久久久久| 观看免费一级毛片| 高清在线国产一区| www.熟女人妻精品国产| 国产精品久久电影中文字幕| 色av中文字幕| 免费在线观看亚洲国产| 1024手机看黄色片| 给我免费播放毛片高清在线观看| 男女视频在线观看网站免费| 亚洲国产精品成人综合色| 国产成年人精品一区二区| 亚洲av美国av| 国产成年人精品一区二区| 十八禁网站免费在线| 国产一区二区在线观看日韩 | 亚洲美女视频黄频| 国产精品三级大全| 日韩欧美精品免费久久 | 国内久久婷婷六月综合欲色啪| 精品久久久久久久人妻蜜臀av| 在线a可以看的网站| 国产真实伦视频高清在线观看 | 最近在线观看免费完整版| 色av中文字幕| 成人国产综合亚洲| 久久精品夜夜夜夜夜久久蜜豆| 美女高潮喷水抽搐中文字幕| 国产成人影院久久av| 欧美日韩亚洲国产一区二区在线观看| 久久精品国产亚洲av涩爱 | 99久久成人亚洲精品观看| 一本综合久久免费| 日韩成人在线观看一区二区三区| 最近视频中文字幕2019在线8| 久久久国产成人免费| 丰满人妻熟妇乱又伦精品不卡| 欧美精品啪啪一区二区三区| 亚洲国产精品999在线| 琪琪午夜伦伦电影理论片6080| 久久性视频一级片| 午夜日韩欧美国产| 少妇丰满av| 在线观看午夜福利视频| 久久国产精品人妻蜜桃| 97碰自拍视频| 两个人视频免费观看高清| 99热这里只有精品一区| 国产一区二区三区视频了| 久久久成人免费电影| 高清毛片免费观看视频网站| 亚洲av中文字字幕乱码综合| 国产av在哪里看| 亚洲国产精品久久男人天堂| 国产乱人伦免费视频| 国产午夜精品久久久久久一区二区三区 | 午夜两性在线视频| 欧美av亚洲av综合av国产av| 亚洲av一区综合| 18禁黄网站禁片午夜丰满| 国产色爽女视频免费观看| 亚洲色图av天堂| 亚洲欧美日韩无卡精品| 99国产综合亚洲精品| 1024手机看黄色片| 一级毛片女人18水好多| 成人特级黄色片久久久久久久| 在线视频色国产色| 91在线精品国自产拍蜜月 | 激情在线观看视频在线高清| avwww免费| 日本a在线网址| 欧美色欧美亚洲另类二区| 亚洲av中文字字幕乱码综合| 日韩精品青青久久久久久| 哪里可以看免费的av片| 毛片女人毛片| 国产在视频线在精品| 亚洲av五月六月丁香网| 国产精品av视频在线免费观看| 97超视频在线观看视频| 免费电影在线观看免费观看| 可以在线观看毛片的网站| 天堂影院成人在线观看| 亚洲不卡免费看| 成年女人毛片免费观看观看9| 久久国产精品人妻蜜桃| 久久九九热精品免费| 成人午夜高清在线视频| 嫩草影院入口| 日韩欧美精品免费久久 | 成人特级黄色片久久久久久久| 国内精品美女久久久久久| 国产精品综合久久久久久久免费| 国产男靠女视频免费网站| 少妇高潮的动态图| 少妇的逼水好多| 天堂影院成人在线观看| 欧美另类亚洲清纯唯美| 成年人黄色毛片网站| 亚洲国产色片| 亚洲最大成人手机在线| 国产中年淑女户外野战色| 免费在线观看成人毛片| 亚洲人与动物交配视频| 日韩高清综合在线| 久久久色成人| 国产亚洲精品久久久com| 久久久久性生活片| 老师上课跳d突然被开到最大视频 久久午夜综合久久蜜桃 | 亚洲成a人片在线一区二区| 国产视频内射| 国产av麻豆久久久久久久| 亚洲最大成人中文| 国产高清三级在线| 99久久成人亚洲精品观看| 国产久久久一区二区三区| 欧美日韩亚洲国产一区二区在线观看| 老司机午夜十八禁免费视频| 99在线视频只有这里精品首页| 午夜亚洲福利在线播放| 亚洲黑人精品在线| 99国产精品一区二区蜜桃av| 青草久久国产| 国产成人aa在线观看| 国产成人av教育| 级片在线观看| 亚洲成人精品中文字幕电影| 丝袜美腿在线中文| 日本a在线网址| 韩国av一区二区三区四区| 国产美女午夜福利| 亚洲人与动物交配视频| 久久6这里有精品| 18禁美女被吸乳视频| 舔av片在线| 免费人成视频x8x8入口观看| 国产精品 国内视频| 亚洲精华国产精华精| 51午夜福利影视在线观看| 国模一区二区三区四区视频| 嫁个100分男人电影在线观看| 国产亚洲精品久久久com| 女人十人毛片免费观看3o分钟| 亚洲av二区三区四区| 老司机福利观看| 日韩欧美三级三区| 亚洲中文字幕日韩| 999久久久精品免费观看国产| 亚洲精品美女久久久久99蜜臀| 国产美女午夜福利| 国产精品乱码一区二三区的特点| 国内揄拍国产精品人妻在线| 亚洲五月婷婷丁香| 日日摸夜夜添夜夜添小说| 久久欧美精品欧美久久欧美| 日日干狠狠操夜夜爽| 精品99又大又爽又粗少妇毛片 | 精品久久久久久久毛片微露脸| 亚洲人与动物交配视频| 757午夜福利合集在线观看| 国产精品99久久99久久久不卡| 人妻久久中文字幕网| 国产av在哪里看| 美女被艹到高潮喷水动态| 两个人视频免费观看高清| 成人特级av手机在线观看| 亚洲人成伊人成综合网2020| 搞女人的毛片| av在线蜜桃| 亚洲精品456在线播放app | 国产精品一区二区三区四区免费观看 | 噜噜噜噜噜久久久久久91| 三级毛片av免费| 国产欧美日韩精品一区二区| 女人高潮潮喷娇喘18禁视频| 亚洲黑人精品在线| 免费人成在线观看视频色| 日韩精品青青久久久久久| 久久久久久久久久黄片| 免费在线观看亚洲国产| 成年版毛片免费区| 久久久久久国产a免费观看| 成年免费大片在线观看| 国内精品一区二区在线观看| 五月玫瑰六月丁香| 成年女人毛片免费观看观看9| av福利片在线观看| 国产亚洲欧美在线一区二区| 最新在线观看一区二区三区| 国产精品1区2区在线观看.| 99精品欧美一区二区三区四区| 日日干狠狠操夜夜爽| 天堂影院成人在线观看| 亚洲精品在线观看二区| 亚洲国产精品成人综合色| 久久人妻av系列| 好男人电影高清在线观看| 欧美午夜高清在线| 色综合欧美亚洲国产小说| 欧美+亚洲+日韩+国产| 免费看十八禁软件| 成熟少妇高潮喷水视频| 国产色爽女视频免费观看| e午夜精品久久久久久久| 国内久久婷婷六月综合欲色啪| 国产精品98久久久久久宅男小说| 亚洲狠狠婷婷综合久久图片| 亚洲人成网站高清观看| 日韩欧美一区二区三区在线观看| 桃色一区二区三区在线观看| 国产精品综合久久久久久久免费| 美女cb高潮喷水在线观看| 小蜜桃在线观看免费完整版高清| 3wmmmm亚洲av在线观看| 天天躁日日操中文字幕| 脱女人内裤的视频| 久久精品国产清高在天天线| 法律面前人人平等表现在哪些方面| 亚洲精品一卡2卡三卡4卡5卡| 亚洲av电影在线进入| 国产在线精品亚洲第一网站| 欧美av亚洲av综合av国产av| 成年免费大片在线观看| 精品不卡国产一区二区三区| 男女视频在线观看网站免费| 观看免费一级毛片| 欧美午夜高清在线| 亚洲久久久久久中文字幕| 精品国产亚洲在线| 免费看十八禁软件| 又黄又粗又硬又大视频| 噜噜噜噜噜久久久久久91| 性欧美人与动物交配| 国产高潮美女av| 一区福利在线观看| 美女 人体艺术 gogo| 精品国产超薄肉色丝袜足j| 丰满乱子伦码专区| 人人妻人人看人人澡| www日本黄色视频网| 成年免费大片在线观看| 老司机在亚洲福利影院| 女人十人毛片免费观看3o分钟| av专区在线播放| 最新中文字幕久久久久| 久久草成人影院| 国产午夜福利久久久久久| 嫩草影院入口| 在线播放无遮挡| 丰满乱子伦码专区| www.熟女人妻精品国产| 欧美午夜高清在线| 午夜福利视频1000在线观看| 久久国产精品影院| 中国美女看黄片| 亚洲午夜理论影院| 国产精品三级大全| 中文字幕人妻熟人妻熟丝袜美 | av在线天堂中文字幕| 人妻丰满熟妇av一区二区三区| 欧美+亚洲+日韩+国产| 国产真实乱freesex| 久久精品国产亚洲av涩爱 | 亚洲狠狠婷婷综合久久图片| 一区二区三区国产精品乱码| 久久这里只有精品中国| 尤物成人国产欧美一区二区三区| 91久久精品电影网| av女优亚洲男人天堂| 真人做人爱边吃奶动态| 午夜免费观看网址| 国产又黄又爽又无遮挡在线| 亚洲自拍偷在线| 最新在线观看一区二区三区| 熟妇人妻久久中文字幕3abv| 国产伦人伦偷精品视频| 在线国产一区二区在线| 日韩欧美三级三区| 国产精品一区二区免费欧美| 午夜a级毛片| 老司机午夜福利在线观看视频| 全区人妻精品视频| 日韩亚洲欧美综合| 国产成人av激情在线播放| 美女黄网站色视频| 午夜激情福利司机影院| 精品国产亚洲在线| 99精品久久久久人妻精品| 成人高潮视频无遮挡免费网站| 欧美日韩乱码在线| 真实男女啪啪啪动态图| 深夜精品福利| 97超级碰碰碰精品色视频在线观看| av天堂中文字幕网| 嫩草影院入口| 两性午夜刺激爽爽歪歪视频在线观看| 51午夜福利影视在线观看| 国产探花在线观看一区二区| 久久久国产精品麻豆| 人妻久久中文字幕网| 12—13女人毛片做爰片一| 1024手机看黄色片| 精品不卡国产一区二区三区| 欧美成狂野欧美在线观看| 成人鲁丝片一二三区免费| 久久人人精品亚洲av| 一级黄片播放器| 国产精品乱码一区二三区的特点| 男女视频在线观看网站免费| 午夜两性在线视频| 亚洲国产精品成人综合色| 国语自产精品视频在线第100页| www.999成人在线观看| 精品午夜福利视频在线观看一区| 一a级毛片在线观看| 女警被强在线播放| av天堂在线播放| 久久午夜亚洲精品久久| 日韩免费av在线播放| 性色av乱码一区二区三区2| 内射极品少妇av片p| 国内毛片毛片毛片毛片毛片| 91九色精品人成在线观看| 制服丝袜大香蕉在线| 国产探花在线观看一区二区| 中文字幕熟女人妻在线| 九色国产91popny在线| 亚洲熟妇中文字幕五十中出| 国产单亲对白刺激| 国产一区二区三区视频了| 欧美色视频一区免费| 在线观看免费视频日本深夜| 一本一本综合久久| 在线天堂最新版资源| 精品欧美国产一区二区三| 日韩精品中文字幕看吧| 欧美激情在线99| 高清在线国产一区| 久久精品影院6| 成年女人毛片免费观看观看9| 日韩欧美国产一区二区入口| 国产69精品久久久久777片| 国产爱豆传媒在线观看| 老司机午夜十八禁免费视频| 精品国产超薄肉色丝袜足j| 露出奶头的视频| 国产在视频线在精品| www日本黄色视频网| av女优亚洲男人天堂| 一级毛片女人18水好多| 看免费av毛片| 欧美大码av| 最新中文字幕久久久久| 啪啪无遮挡十八禁网站| 校园春色视频在线观看| 色哟哟哟哟哟哟| 亚洲,欧美精品.| 久久久精品欧美日韩精品| 99久久精品国产亚洲精品| 在线播放无遮挡| 女同久久另类99精品国产91| 久久久久久久久大av| 深爱激情五月婷婷| 亚洲第一欧美日韩一区二区三区| 老熟妇乱子伦视频在线观看| 国产一区在线观看成人免费| 91在线精品国自产拍蜜月 | 中文字幕av在线有码专区| 97碰自拍视频| 免费搜索国产男女视频| 欧美国产日韩亚洲一区| 免费看a级黄色片| 精品久久久久久久毛片微露脸| 国产高清videossex| 深夜精品福利| 久久久久精品国产欧美久久久| 久久久久久久久久黄片| 国产v大片淫在线免费观看| 亚洲成人精品中文字幕电影| 亚洲不卡免费看| 欧美在线黄色| 制服人妻中文乱码| 国产精品影院久久| 久久草成人影院| 国产精品香港三级国产av潘金莲| 国产精品久久久久久久久免 | 国产一级毛片七仙女欲春2| 欧美成人a在线观看| 成年女人看的毛片在线观看| 免费看十八禁软件| 又粗又爽又猛毛片免费看| 黄片大片在线免费观看| 又粗又爽又猛毛片免费看| 美女cb高潮喷水在线观看| 国产一级毛片七仙女欲春2| aaaaa片日本免费| 1000部很黄的大片| 少妇的丰满在线观看| 身体一侧抽搐| 一级作爱视频免费观看| 精品电影一区二区在线| 三级毛片av免费| 丁香欧美五月| 国产单亲对白刺激| 久久久久久久久久黄片| 级片在线观看| or卡值多少钱| 黄色日韩在线| 欧美成人a在线观看| 12—13女人毛片做爰片一| 真人一进一出gif抽搐免费| 精品人妻1区二区| 亚洲aⅴ乱码一区二区在线播放| 在线a可以看的网站| 成人av在线播放网站| 在线观看av片永久免费下载| 亚洲第一欧美日韩一区二区三区| 国产一区二区在线观看日韩 | 国内精品美女久久久久久| 国产中年淑女户外野战色| 欧美日韩黄片免| 欧美黄色淫秽网站| 国产高清激情床上av| 亚洲av不卡在线观看| 亚洲成人中文字幕在线播放| 亚洲精品久久国产高清桃花| 欧美区成人在线视频| 桃红色精品国产亚洲av| 成年女人看的毛片在线观看| a在线观看视频网站| av天堂在线播放| 国产av一区在线观看免费| 久久中文看片网| 91九色精品人成在线观看| 精品久久久久久久末码| 小说图片视频综合网站| 97超级碰碰碰精品色视频在线观看| 国产av在哪里看| 精品人妻一区二区三区麻豆 | a在线观看视频网站| 在线十欧美十亚洲十日本专区| 嫩草影院入口| 国产精品久久久久久亚洲av鲁大| 99久久精品国产亚洲精品| 高清日韩中文字幕在线| netflix在线观看网站| 欧美性猛交╳xxx乱大交人| 女同久久另类99精品国产91| 免费观看的影片在线观看| 日韩欧美精品v在线| 国产 一区 欧美 日韩| 88av欧美| 国产精品乱码一区二三区的特点| 观看美女的网站| 亚洲中文字幕日韩| 日本撒尿小便嘘嘘汇集6| 最好的美女福利视频网| 真实男女啪啪啪动态图| 在线免费观看的www视频| 在线国产一区二区在线| 99riav亚洲国产免费| 亚洲精品在线美女| 首页视频小说图片口味搜索| 日韩成人在线观看一区二区三区| 亚洲欧美日韩高清在线视频| 51午夜福利影视在线观看| 少妇高潮的动态图| 热99re8久久精品国产| 欧美bdsm另类| 日韩有码中文字幕| 在线天堂最新版资源| 亚洲欧美日韩东京热| av天堂中文字幕网| 久久精品国产亚洲av香蕉五月| 婷婷丁香在线五月| 国产三级在线视频| 69av精品久久久久久| 黑人欧美特级aaaaaa片| 女人高潮潮喷娇喘18禁视频| 禁无遮挡网站| 女同久久另类99精品国产91| 黄色视频,在线免费观看| 在线播放无遮挡| 最近视频中文字幕2019在线8| 精品一区二区三区av网在线观看| av天堂在线播放| 欧美色欧美亚洲另类二区| 嫩草影视91久久| 亚洲精品影视一区二区三区av| 一个人看的www免费观看视频| a级毛片a级免费在线| 色综合婷婷激情| 哪里可以看免费的av片| 国产精品电影一区二区三区| 丰满的人妻完整版| 成人18禁在线播放| 无遮挡黄片免费观看| 成年女人毛片免费观看观看9| 动漫黄色视频在线观看| 色播亚洲综合网| 99久久久亚洲精品蜜臀av| 色尼玛亚洲综合影院| 男女床上黄色一级片免费看| 激情在线观看视频在线高清| 母亲3免费完整高清在线观看| 中文字幕av在线有码专区| 午夜免费男女啪啪视频观看 | 亚洲av成人不卡在线观看播放网| 夜夜爽天天搞| 真人做人爱边吃奶动态| 国产成人系列免费观看| 少妇人妻精品综合一区二区 | 国产成+人综合+亚洲专区| 两个人的视频大全免费| 日本一二三区视频观看| 中文字幕高清在线视频| 五月玫瑰六月丁香| 亚洲avbb在线观看| 久久精品夜夜夜夜夜久久蜜豆| 亚洲成人久久爱视频| 大型黄色视频在线免费观看| 丝袜美腿在线中文| 午夜日韩欧美国产| 欧美成人性av电影在线观看| 日韩国内少妇激情av|