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

    考慮測量零偏的半掛車輛側(cè)向速度校正估算方法

    2024-06-20 04:22:13張志達
    汽車工程師 2024年6期

    【摘要】為準確估算自動駕駛半掛車輛的牽引車側(cè)向速度,提出了一種考慮傳感器測量零偏的校正估算方法。在三自由度車輛動力學模型的基礎(chǔ)上,將前輪轉(zhuǎn)角、橫擺角速度零偏和側(cè)向加速度零偏等擴圍到狀態(tài)變量中,建立了測量零偏估計模型,考慮到動力學模型失配的影響,設(shè)計了基于運動學模型的反饋校正機制,對側(cè)向速度和橫擺角速度的估計結(jié)果進行反饋調(diào)節(jié),利用平方根容積卡爾曼濾波算法實現(xiàn)該方法,并分析了估計器的可觀性,最后,基于TruckSim與MATLAB/Simulink聯(lián)合仿真平臺進行了驗證,結(jié)果表明:該方法不僅可以消除測量零偏的影響,還具有良好的收斂速度,性能明顯優(yōu)于未考慮測量零偏和僅考慮測量零偏的估算方法。

    關(guān)鍵詞:半掛車輛 側(cè)向速度估算 測量零偏 反饋校正 平方根容積卡爾曼濾波

    中圖分類號:U461.91? ?文獻標志碼:A? ?DOI: 10.20104/j.cnki.1674-6546.20240121

    Lateral Velocity Correction Estimation for Semi-Trailer Vehicles Considering Measurement Bias

    Zhang Zhida

    (Shanghai UTOPILOT Technology Company Ltd., Shanghai 200438)

    【Abstract】A correction estimation method considering sensor measurement bias was proposed to accurately estimate the lateral velocity of the tractor in autonomous semi-trailer vehicles. Based on the three-degree-of-freedom vehicle dynamics model, the measurement bias estimation model was established by expanding the front wheel angle, yaw rate bias, and lateral acceleration bias into the state variables. Taking into account the impact of dynamic model mismatch, a feedback correction mechanism based on the kinematic model was designed to adjust the estimation results of lateral velocity and yaw rate through feedback. The proposed method was implemented using the square-root cubature Kalman filter algorithm, and the observability of the estimator was analyzed. This method was verified on the joint simulation platform of TruckSim and MATLAB/Simulink. The results show that the proposed method not only eliminates the influence of measurement bias but also exhibits good convergence speed. Its performance is significantly better than estimation methods that do not consider measurement bias or only consider measurement bias.

    Key words: Semi-trailer, Lateral velocity estimation, Measurement bias, Feedback correction, Square-root cubature Kalman filter

    【引用格式】張志達. 考慮測量零偏的半掛車輛側(cè)向速度校正估算方法[J]. 汽車工程師, 2024(6): 14-21.

    ZHANG Z D. Lateral Velocity Correction Estimation for Semi-Trailer Vehicles Considering Measurement Bias[J]. Automotive Engineer, 2024(6): 14-21.

    1 前言

    準確獲取車輛狀態(tài)是自動駕駛汽車有效決策和精準控制的前提。受成本和技術(shù)限制,并非所有車輛狀態(tài)都能夠被直接、精確地測量,因此,需要借助慣性測量單元(Inertial Measurement Unit,IMU)和全球定位系統(tǒng)(Global Positioning System,GPS)等對車輛的側(cè)向速度、側(cè)偏角或橫擺角速度等狀態(tài)變量進行實時估算[1-2]。

    目前,車輛狀態(tài)估算主要通過車輛的運動學模型、動力學模型結(jié)合卡爾曼濾波(Kalman Filter,KF)系列算法、遞歸最小二乘法(Recursive Least Squares,RLS)等進行[3]?;谶\動學模型的估算方法對車輛參數(shù)、路面附著系數(shù)和行駛工況等具有良好的魯棒性,但對傳感器偏差、數(shù)據(jù)漂移和校準精度等造成的測量誤差非常敏感[4-5]。Selmanaj等[6]基于縱、橫向二自由度運動學模型設(shè)計縱向速度和側(cè)向速度觀測器,進而估算了車輛側(cè)偏角。李小雨等[7]基于三自由度車輛模型和擴展卡爾曼濾波(Extended Kalman Filter,EKF)算法提出了一種結(jié)合運動學模型和幾何方法的質(zhì)心側(cè)偏角估算方法。該方法可以提高估計精度,但需要提前獲取路面附著系數(shù)。為消除基于純運動學模型造成的積分偏差,Rezaeian等[8]利用基于LuGre輪胎模型得到的輪胎側(cè)偏角計算側(cè)向速度,并與基于運動學模型估計的側(cè)向速度進行加權(quán),然而,該方法中前、后輪胎側(cè)偏角的計算也需要路面附著系數(shù)。事實上,路面附著系數(shù)的測量和估算成本遠高于側(cè)向速度和質(zhì)心側(cè)偏角[9]。

    基于動力學模型的車輛狀態(tài)估算方法主要依賴于受作用力和扭矩激勵的車輛模型和輪胎模型,采用的算法與基于運動學模型的方法基本一致。該方法受車輛和輪胎參數(shù)的影響較大,部分方案也需要提前獲知路面附著系數(shù)。耿國慶等[10]提出了一種基于二自由度動力學模型和噪聲自適應EKF算法的車輛狀態(tài)估算方法。Reina等[11]在假設(shè)縱向速度恒定的情況下,結(jié)合二自由度車輛模型和EKF算法,設(shè)計了用于識別質(zhì)心側(cè)偏角等狀態(tài)的估計器,該研究與文獻[10]類似,都將輪胎模型考慮為線性,僅適用于車輛轉(zhuǎn)向幅度較小的工況。Amin等[12]結(jié)合三自由度車輛動力學模型和LuGre輪胎模型,提出了一種基于約束無跡卡爾曼濾波(Constrained Unscented Kalman Filter,CUKF)算法的半掛車輛側(cè)向速度估算方法,由于利用了LuGre輪胎模型,需要提前獲知路面附著系數(shù)。另外,Piyabongkarn等[13]結(jié)合動力學模型和運動學模型設(shè)計了一種基于頻率加權(quán)的車輛質(zhì)心側(cè)偏角估算方法,在低頻轉(zhuǎn)向時采用動力學模型的估算結(jié)果,在高頻轉(zhuǎn)向時采用運動學模型的估算結(jié)果。然而,以上研究均未綜合考慮測量零偏和參數(shù)時變的影響。

    鑒于此,本文提出一種考慮傳感器測量零偏的半掛車輛側(cè)向速度校正估算方法?;谌杂啥溶囕v動力學模型,將前輪轉(zhuǎn)角、橫擺角速度零偏和側(cè)向加速度零偏等擴圍到估計器的狀態(tài)變量中,建立測量零偏估算模型。針對參數(shù)時變造成的動力學模型失配,設(shè)計基于運動學模型的反饋校正機制,對側(cè)向速度和橫擺角速度的估算結(jié)果進行實時調(diào)節(jié)。最后,利用平方根容積卡爾曼濾波(Square-root Cubature Kalman Filter,SCKF)算法實現(xiàn)該方法,分析估計器的可觀性,并基于TruckSim和MATLAB/Simulink聯(lián)合仿真平臺,選取不同輸入和測量零偏工況測試該估算方法的有效性。

    2 半掛車輛動力學模型

    忽略路面坡度的影響,假設(shè)車輛僅做平面運動,建立考慮半掛車輛橫向運動、橫擺運動和折疊運動的三自由度動力學模型,如圖1所示。其中:m1、m2分別為牽引車、掛車的質(zhì)量,Iz1、Iz2分別為牽引車、掛車的橫擺轉(zhuǎn)動慣量,a1、b1分別為牽引車前、后軸至其質(zhì)心的距離,c、a2分別為鉸接點至牽引車質(zhì)心、掛車質(zhì)心的距離,b2為掛車后軸至其質(zhì)心的距離,F(xiàn)yf、Fyr分別為牽引車前、后軸輪胎側(cè)向力,F(xiàn)yt為掛車后軸輪胎側(cè)向力,δf為牽引車的前輪轉(zhuǎn)角,vx1、vx2分別為牽引車、掛車的縱向速度,vy1、vy2分別為牽引車、掛車的側(cè)向速度,v1、v2分別為牽引車、掛車的速度矢量和,γ1、β1分別為牽引車的橫擺角速度、質(zhì)心側(cè)偏角,γ2、β2分別為掛車的橫擺角速度、質(zhì)心側(cè)偏角,θ為牽引車與掛車的相對角度,即折疊角。當折疊角較小時,可以認為vx1=vx2=vx,其中vx為縱向速度。

    半掛車輛系統(tǒng)的動力學方程如下:

    m1ay1=Fyf+Fyr-Fyh (1)

    [Iz1γ1=a1Fyf+b1Fyr-cFyh] (2)

    m2ay2=Fyt+Fyh (3)

    [Iz2γ2=a2Fyh-b2Fyt] (4)

    式中:[ay1=vy1+vxγ1]、[ay2=vy2+vxγ2]分別為牽引車、掛車的側(cè)向加速度,F(xiàn)yh為鉸接點處的相互作用力。

    在鉸接點處,有如下耦合關(guān)系[12]:

    [γ2=γ1+θ] (5)

    [νy2=νy1-(a2+c)γ1-a2θ-νxθ] (6)

    消除耦合項后可得:

    [Iz1γ1+m1cνy1=-m1cνxγ1+a1Fyf-b1Fyr+c(Fyf+Fyr)](7)

    [(m1+m2)νy1-m2(a2+c)γ1-m2a2θ=][-(m1+m2)νxγ1+Fyf+Fyr+Fyt] (8)

    [Iz2(γ1+θ)+m1a2νy1=-m1a2νxγ1+a2(Fyf+Fyr)-b2Fyt]

    (9)

    利用線性輪胎模型描述牽引車前、后軸和掛車后軸的輪胎力Fyi=kiαi, i=f,r,t。其中:ki為各輪胎側(cè)偏剛度,αi為各輪胎側(cè)偏角,f、r、t分別表示牽引車前軸、牽引車后軸、掛車后軸。根據(jù)圖1的坐標系定義,牽引車前、后輪胎和掛車后輪胎的側(cè)偏角分別為:

    αf[ =δf-νy1+a1γ1νx] (10)

    αr[ =b1γ1-νy1νx] (11)

    αt=[θ-νy1-(a2+b2+c)γ1-(a2+b2)θνx] (12)

    綜上,半掛車輛動力學模型的微分方程為:

    [Mx+Gx=Fδf] (13)

    式中:x=[νy1γ1θθ]為狀態(tài)變量,M=[m1cm1+m2m1a20-Iz1m2(a2+c)Iz200-m2a2Iz20? 0001]為[x]的系數(shù)矩陣,G為x的系數(shù)矩陣,F(xiàn)=[(a1+c)kfkfa2kf0]為δf的系數(shù)矩陣。

    其中,x的系數(shù)矩陣G的表達式為:

    經(jīng)過整理,可得半掛車輛動力學模型的狀態(tài)空間方程為:

    [x]=Ax+Bδf (15)

    式中:A=-M-1G為狀態(tài)轉(zhuǎn)移矩陣,B=M-1F為控制矩陣。

    3 側(cè)向速度估計器設(shè)計

    3.1 考慮測量零偏的估計模型

    受成本和技術(shù)限制,并非所有車輛狀態(tài)都能夠被直接測量。部分車輛狀態(tài)參數(shù)隨時間或工況變化,增加了車輛模型的不確定性。因此,基于估計算法的虛擬觀測器成為獲取某些車輛狀態(tài)的重要手段。然而,由于模型具有非完整性,如參數(shù)時變、未建模部分和外界擾動等,通常會引入模型失配問題。鑒于此,本文在估計牽引車側(cè)向速度時,考慮橫擺角速度和側(cè)向加速度的零偏,以降低模型非完整性的影響。所采用的測量變量為橫擺角速度、側(cè)向加速度和前輪轉(zhuǎn)角等易于獲取的狀態(tài)。結(jié)合車輛動力學模型和運動學模型,定義狀態(tài)轉(zhuǎn)移方程為:

    [xk=f(xk-1,uk-1)+wk-1] (16)

    式中:[xk=(vyk,γk,θk,vyk,γk,θk,ayk,δfk,dγk,dayk)T]為估計器在離散時間k時刻的狀態(tài)變量,[uk-1]為控制變量,f( )為狀態(tài)轉(zhuǎn)移方程,wk-1為過程噪聲,dγk、dayk分別為橫擺角速度零偏、側(cè)向加速度零偏。

    為便于后續(xù)說明,定義vy=vy1,γ=γ1。其中,狀態(tài)轉(zhuǎn)移方程的表達式為:

    式中:T為離散時間步長。

    定義側(cè)向速度估計器的測量方程為:

    [zk=h(xk)+vk] (18)

    其中:

    [h1:γmk=γk+dγk-1h2:aymk=ayk+dayk-1h3:δfmk=δfk] (19)

    式中:zk=[γmk,aymk,δfmk]T為k時刻的測量變量;h( )為測量方程;υk為測量噪聲;γmk為橫擺角速度測量值;aymk為側(cè)向加速度測量值;δfmk為前輪轉(zhuǎn)角測量值,由轉(zhuǎn)向盤轉(zhuǎn)角轉(zhuǎn)換獲取。

    3.2 基于運動學模型的反饋校正

    當半掛車輛行駛工況復雜多變時,不確定的工作環(huán)境可能會導致動力學模型的失配,從而造成估算結(jié)果出現(xiàn)誤差。為進一步降低模型非完整性的影響,在消除傳感器測量零偏的基礎(chǔ)上引入基于運動學模型的反饋校正,該反饋校正為基于狀態(tài)變量之間運動學關(guān)系以及估算值與測量值之間偏差引入的閉環(huán)調(diào)節(jié),包括側(cè)向速度反饋調(diào)節(jié)和橫擺角速度反饋調(diào)節(jié)。

    側(cè)向速度反饋調(diào)節(jié)是利用估算的側(cè)向速度與運動學積分得到的側(cè)向速度之間的偏差補償側(cè)向速度項。其中,側(cè)向速度偏差為:

    [Δνy=νy-0t(aym-day)-νx(γm-dy)] (20)

    式中:[vy]為側(cè)向速度估算結(jié)果, t為估算時間。

    橫擺角速度反饋調(diào)節(jié)是利用估算的橫擺角速度與測量的橫擺角速度之間的偏差補償橫擺角速度項。其中,橫擺角速度偏差為:

    [Δγ=γ-(γm-dγ)] (21)

    因此,引入反饋校正后,式(17)的前2項可換算為:

    [νyk=νyk-1+νyk-1T-kvyΔvyk-1] (22)

    [γk=γk-1+γk-1T-kγΔγk-1] (23)

    式中:kvy為側(cè)向速度項的調(diào)節(jié)增益,kγ為橫擺角速度項的調(diào)節(jié)增益。

    3.3 SCKF估計算法

    鑒于SCKF算法在估計精度和數(shù)值穩(wěn)定性方面的優(yōu)勢,選取該算法估算半掛車輛的側(cè)向速度。標準SCKF算法的實現(xiàn)過程如下[14]:

    a. 初始化。給定狀態(tài)初始值[x0|0],計算誤差協(xié)方差矩陣平方根因子的初始值[S0|0=P0|0],其中P0|0為誤差協(xié)方差矩陣。

    b. 時間更新。計算狀態(tài)容積點并基于狀態(tài)轉(zhuǎn)移方程傳遞:

    [xik-1k-1=xk-1k-1+Sk-1k-1ξi, i=1,2,…,2nxi*kk-1=f(xik-1k-1,uk-1)] (24)

    式中:ξi為容積點權(quán)重矩陣[[nIn,-nIn]]的第i列,In為n×n的單位矩陣,n為狀態(tài)變量的維數(shù)。

    計算狀態(tài)變量的預測值及其誤差協(xié)方差矩陣的平方根因子:

    [xkk-1=12ni=12nxi*kk-1Skk-1=qr([Xi*kk-1,Qk-1])] (25)

    式中:Qk-1為過程噪聲協(xié)方差,[X*kk-1=12n[x1*kk-1-xkk-1,x2*kk-1-xkk-1,…,x2n*kk-1-xkk-1]]為加權(quán)中心矩。

    c. 測量更新。更新狀態(tài)容積點并基于測量方程傳遞:

    [xikk-1=xkk-1+Skk-1ξizikk-1=h(xikk-1)] (26)

    計算測量變量的預測值及其新息協(xié)方差矩陣的平方根因子:

    [zkk-1=12ni=12nzikk-1Szzkk-1=qr([Zkk-1,Rk])] (27)

    式中:Rk為測量噪聲協(xié)方差,[Zkk-1=12n[z1kk-1-z1kk-1,z2kk-1-zkk-1,…,z2nkk-1-zkk-1]]為加權(quán)中心矩。

    測量變量的協(xié)方差矩陣和互協(xié)方差矩陣分別為:

    [Pzzkk-1=Szzkk-1(Szzkk-1)TPxzkk-1=Xkk-1ZTkk-1] (28)

    式中:[Xkk-1=12n[x1kk-1-x1kk-1,x2kk-1-xkk-1,…,x2nkk-1-xkk-1]]為加權(quán)中心矩。

    卡爾曼濾波增益矩陣為:

    Kk=[Pxzkk-1(Pzzkk-1)-1] (29)

    更新狀態(tài)變量估算值和誤差協(xié)方差矩陣的平方根因子為:

    [xkk=xkk-1+Kk(zk-zkk-1)Skk=qr([xkk-1Kkzk-zkk-1,KkRk])] (30)

    3.4 可觀性分析

    在編程實現(xiàn)估計器前,需驗證其可觀測性,這決定了是否可以從系統(tǒng)的輸入和外部輸出信息中正確推導出內(nèi)部狀態(tài)。對于非線性估計器而言,通常主要關(guān)注其在當前狀態(tài)的局部可觀性,即利用離散線性時不變系統(tǒng)可觀性矩陣的秩來判斷非線性系統(tǒng)的局部可觀測性:

    OLTI=[Hk HkFk … HkFk(n-1)T] (31)

    式中:OLTI為線性時不變系統(tǒng)可觀性矩陣,若OLTI滿秩,則非線性系統(tǒng)局部可觀;Fk、Hk分別為k時刻的狀態(tài)轉(zhuǎn)移矩陣、測量矩陣,即f( )和h( )的雅克比矩陣。

    Fk、Hk的表達式分別為:

    [Hk=010000001000000010010000000100] (33)

    利用MATLAB的Rank函數(shù)求解估計器可觀性矩陣OLTI的秩,輸出結(jié)果為10,證明所設(shè)計的估計器是局部可觀的。

    4 仿真驗證

    為驗證所提出的考慮測量零偏的半掛車輛側(cè)向速度校正估算方法的效果,基于TruckSim和MATLAB/Simulink在正弦輸入和階躍輸入2種工況下開展聯(lián)合仿真。其中,半掛車輛模型的主要參數(shù)為:m1=8 036 kg,Iz1=4.87×104 kg·m2,m2=22 570 kg,Iz2=3.94×105 kg·m2,a1=1.6 m,b1=2.05 m,a2=5.4 m,b2=3.4 m,c=1.5 m,kf=3.70×105 N/rad,kr=9.37×105 N/rad,kt=1.33×106 N/rad。分別在不考慮測量零偏和反饋校正、僅考慮測量零偏、同時考慮測量零偏和反饋校正的條件下開展估算,結(jié)果分別記作SCKF估計1、SCKF估計2、SCKF估計3。本文僅關(guān)注如何消除測量零偏,噪聲異常的處理采用前期研究的方法[9,15]。

    4.1 正弦輸入工況

    在正弦輸入仿真工況中,設(shè)置車速vx=80 km/h,前輪轉(zhuǎn)角δf輸入如圖2所示,周期為6 s。同時,設(shè)置側(cè)向加速度零偏為0.2 m/s2,用于模擬傳感器單一測量信號存在的零偏。

    為評估所提出的考慮測量零偏校正估計方法的性能,選取側(cè)向速度、側(cè)向加速度、橫擺角速度、側(cè)向加速度零偏和橫擺角速度零偏的估算結(jié)果作為對比指標。正弦輸入工況下,側(cè)向速度、側(cè)向加速度和橫擺角速度的估算結(jié)果如圖3所示。由圖3a可知,SCKF估計2和SCKF估計3可以準確估算出半掛車輛的側(cè)向速度,而SCKF估計1的估算結(jié)果存在明顯偏差。這是因為SCKF估計2和SCKF估計3在設(shè)計估計器時均考慮了傳感器的測量零偏。同時,觀察圖3a可以發(fā)現(xiàn),考慮反饋校正的SCKF估計3的側(cè)向速度估算結(jié)果收斂速度和精度均優(yōu)于SCKF估計2。圖3b和圖3c同樣表明,SCKF估計3的估算結(jié)果更準確。由于未考慮測量零偏,SCKF估計1的側(cè)向加速度估算值依然存在0.2 m/s2的偏差。因為估算模型中考慮了測量零偏,SCKF估計2和SCKF估計3的橫擺角速度估算結(jié)果也需要一定的收斂時間。

    圖4所示為正弦輸入工況下側(cè)向加速度零偏和橫擺角速度零偏的估算結(jié)果。由圖4a和圖4b可知,SCKF估計2和SCKF估計3均能較為準確地估算出側(cè)向加速度和橫擺角速度的測量零偏。由于SCKF估計3同時考慮了基于運動學模型的反饋校正,其收斂速度更快、估算精度更高,圖4a的前2 s更為明顯。因此,考慮測量零偏的半掛車輛側(cè)向速度校正估算方法不僅能夠估算出傳感器的測量零偏,還可以有效提高估算結(jié)果的收斂速度。

    4.2 階躍輸入工況

    為進一步驗證SCKF估計3對行駛工況和測量零偏的適應性,進行同時考慮多個測量零偏的階躍輸入工況仿真分析。設(shè)置車速vx=70 km/h,前輪轉(zhuǎn)角δf輸入如圖5所示。同時,設(shè)置側(cè)向加速度零偏和橫擺角速度零偏分別為0.2 m/s2和0.04 rad/s,用于模擬傳感器多個測量信號存在的零偏。

    階躍輸入工況下,側(cè)向速度、側(cè)向加速度和橫擺角速度的估算結(jié)果如圖6所示。由圖6a可知,SCKF估計2和SCKF估計3同樣可以準確估算出半掛車輛的側(cè)向速度。然而,SCKF估計1的估算結(jié)果不僅存在明顯的偏差,且收斂速度較慢。由圖6a可知,SCKF估計3的側(cè)向速度估算效果明顯優(yōu)于SCKF估計1和SCKF估計2。由圖6b和圖6c可知,SCKF估計2和SCKF估計3能夠有效消除側(cè)向加速度和橫擺角速度估算結(jié)果的測量零偏,由于SCKF估計1沒有考慮測量零偏,估算結(jié)果依然與其測量值一致。由圖6中的估算結(jié)果可知,SCKF估計3的整體性能最優(yōu)。

    圖7所示為階躍輸入工況下側(cè)向加速度零偏和橫擺角速度零偏的估算結(jié)果。該工況下的SCKF估計2和SCKF估計3均能較為準確地估算出側(cè)向加速度和橫擺角速度的測量零偏,且對測量零偏的差異均有較好的適應性。但由圖7a和圖7b中前2 s數(shù)據(jù)可知,SCKF估計3的收斂速度和精度更好。

    通過對比不同輸入工況和測量零偏的仿真結(jié)果可知,SCKF估計3可準確估算出半掛車輛的側(cè)向速度,消除側(cè)向加速度和橫擺角速度的測量零偏,整體效果,尤其是收斂速度均優(yōu)于SCKF估計2。

    5 結(jié)束語

    本文針對自動駕駛半掛車輛側(cè)向速度估算中的傳感器測量零偏問題,提出了一種結(jié)合動力學模型和運動學模型的反饋校正估算方法。在SCKF算法框架下,利用基于車輛動力學的估算模型消除側(cè)向加速度和橫擺角速度測量零偏的影響。為避免動力學模型失配的影響,基于狀態(tài)變量之間的運動學關(guān)系,反饋調(diào)節(jié)了側(cè)向速度和橫擺角速度的估算結(jié)果。

    TruckSim和MATLAB/Simulink聯(lián)合仿真結(jié)果表明,該方法能夠準確估算出半掛車輛的側(cè)向速度,消除側(cè)向加速度和橫擺角速度的測量零偏,其整體性能,尤其是收斂速度,明顯優(yōu)于不考慮測量零偏和僅考慮測量零偏的估計方法。

    參考文獻

    [1]? ?SINGH K B, ARAT M A, TAHERI S. Literature Review and Fundamental Approaches for Vehicle and Tire State Estimation[J]. Vehicle System Dynamics, 2019, 57(11): 1643-1665.

    [2]? ?JIN X J, YIN G D, CHEN N. Advanced Estimation Techniques for Vehicle System Dynamic State: A Survey[J]. Sensors, 2019, 19(19): 4289.

    [3]? ?LIU W, XIA X, XIONG L, et al. Automated Vehicle Sideslip Angle Estimation Considering Signal Measurement Characteristic[J]. IEEE Sensors Journal, 2021, 21(19): 21675-21687.

    [4]? ?WANG Z P, WU J Y, ZHANG L, et al. Vehicle Sideslip Angle Estimation for a Four-Wheel-Independent-Drive Electric Vehicle Based on a Hybrid Estimator and a Moving Polynomial Kalman Smoother[J]. Proceedings of the Institution of Mechanical Engineers, Part K Journal of Multi-Body Dynamics, 2019, 233(1): 125-140.

    [5]? ?張志達. 基于車路狀態(tài)估計的智能汽車運動決策與控制方法研究[D]. 重慶: 重慶大學, 2021.

    ZHANG Z D. Research on Motion Decision and Control of Intelligent Vehicle Based on Vehicle-Road State Estimation[D]. Chongqing: Chongqing University, 2021.

    [6]? ?SELMANAJ D, CORNO M, PANZANI G, et al. Vehicle Sideslip Estimation: A Kinematic Based Approach[J]. Control Engineering Practice, 2017, 67(10): 1-12.

    [7]? ?李小雨, 許男, 郭孔輝. 基于運動學方法和運動幾何方法融合的質(zhì)心側(cè)偏角估計[J]. 機械工程學報, 2020, 56(2): 121-129.

    LI X Y, XU N, GUO K H. Vehicle Sideslip Angle Estimation Based on Fusion of Kinematic Method and Kinematic-Geometry Method[J]. Journal of Mechanical Engineering, 2020, 56(2): 121-129.

    [8]? REZAEIAN A, KHAJEPOUR A, MELEK W, et al. Simultaneous Vehicle Real-Time Longitudinal and Lateral Velocity Estimation[J]. IEEE Transactions on Vehicular Technology, 2017, 66(3): 1950-1962.

    [9]? ZHANG Z D, ZHNEG L, WU H, et al. An Estimation Scheme of Road Friction Coefficient Based on Novel Tyre Model and Improved SCKF[J]. Vehicle System Dynamics, 2022, 60(8): 2775-2804.

    [10] 耿國慶, 韋斌源, 江浩斌, 等. 基于NA-EKF的分布式驅(qū)動電動汽車行駛狀態(tài)估計研究 [J]. 汽車工程, 2018, 40(7): 770-776.

    GENG G Q, WEI B Y, JIANG H B, et al. A Research on Driving State Estimation for Distributed Drive Electric Vehicle Based on NA-EKF[J]. Automotive Engineering, 2018, 40(7): 770-776.

    [11] REINA G, MESSINA A. Vehicle Dynamics Estimation Via Augmented Extended Kalman Filtering[J]. Measurement, 2018, 133: 383-395.

    [12] AMIN H K, AMIR K, BARIS F. Vehicle-Trailer Lateral Velocity Estimation using Constrained Unscented Transformation[J]. Vehicle System Dynamics, 2022, 60(3): 1048-1075.

    [13] PIYABONGKARN D, RAJAMANI R, GROGG J A, et al. Development and Experimental Evaluation of a Slip Angle Estimator for Vehicle Stability Control[J]. IEEE Transactions on Control Systems Technology, 2009, 17(1): 78-88.

    [14] ZHANG Z D, ZHENG L, LI Y N, et al. Cooperative Strategy of Trajectory Tracking and Stability Control for 4WID Autonomous Vehicles under Extreme Conditions[J]. IEEE Transactions on Vehicular Technology, 2023, 72(3): 3105-3118.

    [15] 張志達, 鄭玲, 李以農(nóng), 等. 基于魯棒自適應SCKF的智能汽車目標狀態(tài)跟蹤研究[J]. 機械工程學報, 2021, 57(20): 181-193.

    ZHANG Z D, ZHENG L, LI Y N, et al. Research on Intelligent Vehicle Target State Tracking Based on Robust Adaptive SCKF[J]. Journal of Mechanical Engineering, 2021, 57(20): 181-193.

    (責任編輯 弦 歌)

    修改稿收到日期為2024年5月8日。

    色网站视频免费| 我要看日韩黄色一级片| 亚洲第一区二区三区不卡| 最近最新中文字幕大全电影3| 亚洲国产色片| 国产成人免费无遮挡视频| 男女边吃奶边做爰视频| 亚洲欧美成人综合另类久久久| 国产精品一区二区性色av| 国产精品久久久久久久电影| h日本视频在线播放| 天天一区二区日本电影三级| 成人综合一区亚洲| 久久精品国产a三级三级三级| 最近的中文字幕免费完整| 国产在视频线精品| 亚洲综合精品二区| 一级毛片我不卡| 性插视频无遮挡在线免费观看| 中国国产av一级| 97超视频在线观看视频| 99热网站在线观看| 一区二区av电影网| 免费观看在线日韩| 一个人看视频在线观看www免费| 日本熟妇午夜| 亚洲精品一二三| 国产成人精品一,二区| 狂野欧美激情性bbbbbb| 欧美性猛交╳xxx乱大交人| 久久ye,这里只有精品| 九九久久精品国产亚洲av麻豆| 欧美区成人在线视频| 国产在线男女| 亚洲在线观看片| 99热这里只有精品一区| 亚洲欧美清纯卡通| 嫩草影院新地址| 激情 狠狠 欧美| 免费播放大片免费观看视频在线观看| 日本黄大片高清| 欧美精品一区二区大全| 欧美高清成人免费视频www| 午夜精品一区二区三区免费看| 精品一区在线观看国产| 看非洲黑人一级黄片| 欧美三级亚洲精品| 伦精品一区二区三区| 中文在线观看免费www的网站| 欧美xxxx性猛交bbbb| 91久久精品国产一区二区成人| 777米奇影视久久| 少妇被粗大猛烈的视频| 日本免费在线观看一区| 日韩成人伦理影院| 国产伦在线观看视频一区| 成年女人在线观看亚洲视频 | 精品视频人人做人人爽| 国产成人精品一,二区| 亚洲在线观看片| 成人欧美大片| 人人妻人人爽人人添夜夜欢视频 | 久久99蜜桃精品久久| 在线观看一区二区三区| 亚洲欧美成人综合另类久久久| 久久99蜜桃精品久久| 熟女电影av网| 久久鲁丝午夜福利片| 熟女av电影| 久热这里只有精品99| 国产成人a区在线观看| 观看免费一级毛片| 中文字幕制服av| 女人被狂操c到高潮| 亚洲最大成人手机在线| 午夜福利视频精品| 嫩草影院精品99| 日本猛色少妇xxxxx猛交久久| 亚洲欧洲国产日韩| 日韩中字成人| 国产亚洲5aaaaa淫片| freevideosex欧美| 男人舔奶头视频| 91午夜精品亚洲一区二区三区| 精品人妻偷拍中文字幕| 久久热精品热| 欧美精品一区二区大全| 亚洲激情五月婷婷啪啪| 国产永久视频网站| 纵有疾风起免费观看全集完整版| 国产高潮美女av| 两个人的视频大全免费| 日本-黄色视频高清免费观看| 波野结衣二区三区在线| av.在线天堂| 纵有疾风起免费观看全集完整版| 日韩人妻高清精品专区| 91久久精品电影网| 日韩一本色道免费dvd| 亚洲真实伦在线观看| 国产 一区精品| 久久久久精品久久久久真实原创| 日韩大片免费观看网站| 黑人高潮一二区| av一本久久久久| 校园人妻丝袜中文字幕| 色视频在线一区二区三区| av在线播放精品| 男女国产视频网站| 校园人妻丝袜中文字幕| 啦啦啦中文免费视频观看日本| 欧美日韩视频高清一区二区三区二| 我要看日韩黄色一级片| 欧美另类一区| 麻豆国产97在线/欧美| 青春草亚洲视频在线观看| 亚洲最大成人av| 精品久久久久久久久av| 国产av不卡久久| 国产成人精品婷婷| 一本色道久久久久久精品综合| av免费在线看不卡| 黑人高潮一二区| 国产精品一及| 一本色道久久久久久精品综合| 日韩大片免费观看网站| 七月丁香在线播放| 欧美bdsm另类| 国产精品av视频在线免费观看| 91aial.com中文字幕在线观看| 免费观看av网站的网址| 亚洲成人av在线免费| 欧美日韩一区二区视频在线观看视频在线 | 熟女av电影| 久久这里有精品视频免费| 中文字幕久久专区| 日本熟妇午夜| 午夜日本视频在线| 看非洲黑人一级黄片| 国产视频首页在线观看| 美女cb高潮喷水在线观看| 51国产日韩欧美| 久久精品国产a三级三级三级| 赤兔流量卡办理| 波野结衣二区三区在线| 亚洲一区二区三区欧美精品 | 蜜桃亚洲精品一区二区三区| 伊人久久国产一区二区| 亚洲欧美中文字幕日韩二区| 少妇 在线观看| 中文在线观看免费www的网站| 精品一区二区三卡| 91精品一卡2卡3卡4卡| 久久女婷五月综合色啪小说 | 日本与韩国留学比较| 少妇人妻 视频| 亚洲精品国产色婷婷电影| 少妇猛男粗大的猛烈进出视频 | 精品国产一区二区三区久久久樱花 | 大片免费播放器 马上看| 99热这里只有是精品在线观看| 久久久a久久爽久久v久久| 中文资源天堂在线| 亚洲欧美精品自产自拍| 免费高清在线观看视频在线观看| 最近最新中文字幕免费大全7| 久久ye,这里只有精品| 久久97久久精品| 国产中年淑女户外野战色| 欧美成人午夜免费资源| 天堂网av新在线| 十八禁网站网址无遮挡 | 春色校园在线视频观看| 国产v大片淫在线免费观看| 国产欧美日韩精品一区二区| 成年版毛片免费区| 91久久精品电影网| 精品人妻视频免费看| 久久久久久伊人网av| 丰满乱子伦码专区| 欧美xxxx性猛交bbbb| 别揉我奶头 嗯啊视频| 日韩,欧美,国产一区二区三区| 全区人妻精品视频| 一区二区三区精品91| 午夜激情久久久久久久| 一区二区三区免费毛片| 狂野欧美白嫩少妇大欣赏| 国产日韩欧美亚洲二区| 伦理电影大哥的女人| 日产精品乱码卡一卡2卡三| 日韩三级伦理在线观看| 久久6这里有精品| 午夜激情福利司机影院| 精品久久久噜噜| 亚洲成人av在线免费| 2021天堂中文幕一二区在线观| 国产国拍精品亚洲av在线观看| av卡一久久| 亚洲精品456在线播放app| 精品视频人人做人人爽| 国产av码专区亚洲av| 2021天堂中文幕一二区在线观| 麻豆国产97在线/欧美| 插阴视频在线观看视频| 久久精品国产鲁丝片午夜精品| 一个人看视频在线观看www免费| 制服丝袜香蕉在线| 亚洲精品色激情综合| 成人漫画全彩无遮挡| 国语对白做爰xxxⅹ性视频网站| 国产亚洲一区二区精品| 高清在线视频一区二区三区| 欧美激情国产日韩精品一区| 日韩欧美精品v在线| 国产亚洲最大av| 在现免费观看毛片| 啦啦啦啦在线视频资源| 亚洲人成网站高清观看| 日韩国内少妇激情av| 中文字幕av成人在线电影| 久久精品久久久久久噜噜老黄| 亚州av有码| 女人十人毛片免费观看3o分钟| 在线 av 中文字幕| 国产爽快片一区二区三区| 国产成人a区在线观看| 亚洲欧美成人精品一区二区| 插逼视频在线观看| 亚洲怡红院男人天堂| 欧美成人a在线观看| 丝瓜视频免费看黄片| 免费看不卡的av| 看十八女毛片水多多多| 大陆偷拍与自拍| av免费观看日本| 九色成人免费人妻av| 午夜老司机福利剧场| 直男gayav资源| 欧美高清成人免费视频www| 网址你懂的国产日韩在线| 免费观看av网站的网址| 又大又黄又爽视频免费| 欧美成人a在线观看| 丝瓜视频免费看黄片| 精品酒店卫生间| av网站免费在线观看视频| 国产成人91sexporn| 国产黄片视频在线免费观看| 国产乱来视频区| 亚洲无线观看免费| 中文天堂在线官网| 免费av毛片视频| 色视频在线一区二区三区| 免费观看的影片在线观看| 又爽又黄无遮挡网站| 精品一区二区三卡| 色综合色国产| 国产黄频视频在线观看| 国产男人的电影天堂91| 少妇丰满av| 日本猛色少妇xxxxx猛交久久| 大片免费播放器 马上看| 蜜桃亚洲精品一区二区三区| 欧美一级a爱片免费观看看| 人妻制服诱惑在线中文字幕| 日日啪夜夜撸| xxx大片免费视频| 国产精品熟女久久久久浪| 亚洲av中文字字幕乱码综合| h日本视频在线播放| 国产精品无大码| 69人妻影院| 直男gayav资源| 亚洲成色77777| 亚洲av成人精品一二三区| 色视频在线一区二区三区| 久久精品久久久久久久性| 内射极品少妇av片p| 亚洲真实伦在线观看| 亚洲国产欧美人成| 下体分泌物呈黄色| 国产伦精品一区二区三区四那| 亚洲精品aⅴ在线观看| 中国国产av一级| 韩国av在线不卡| 免费av观看视频| 国产真实伦视频高清在线观看| av一本久久久久| 亚洲av不卡在线观看| 永久网站在线| 搡老乐熟女国产| 亚洲精品国产av蜜桃| 精品国产露脸久久av麻豆| 久久久成人免费电影| 色播亚洲综合网| 晚上一个人看的免费电影| 丝瓜视频免费看黄片| 麻豆成人av视频| 一级毛片久久久久久久久女| 一二三四中文在线观看免费高清| 国产片特级美女逼逼视频| 午夜精品国产一区二区电影 | 男人和女人高潮做爰伦理| 在线观看三级黄色| 国精品久久久久久国模美| 麻豆乱淫一区二区| videos熟女内射| 伊人久久精品亚洲午夜| 国产精品偷伦视频观看了| 亚洲av福利一区| 乱系列少妇在线播放| 成人欧美大片| 国内少妇人妻偷人精品xxx网站| 亚洲自拍偷在线| 深夜a级毛片| 色哟哟·www| 一级毛片我不卡| 国产久久久一区二区三区| 成人一区二区视频在线观看| 精品酒店卫生间| 亚洲天堂av无毛| 听说在线观看完整版免费高清| 国产亚洲精品久久久com| 青春草视频在线免费观看| 人妻夜夜爽99麻豆av| 爱豆传媒免费全集在线观看| 啦啦啦中文免费视频观看日本| 最后的刺客免费高清国语| 精品久久久噜噜| 日本免费在线观看一区| 国产永久视频网站| av免费在线看不卡| 亚洲av一区综合| 亚洲欧美日韩另类电影网站 | 看非洲黑人一级黄片| 日韩av免费高清视频| 国产精品久久久久久av不卡| 亚洲国产精品国产精品| 国产伦在线观看视频一区| av国产免费在线观看| 天美传媒精品一区二区| av女优亚洲男人天堂| 久热这里只有精品99| 亚洲激情五月婷婷啪啪| 偷拍熟女少妇极品色| 最近的中文字幕免费完整| av线在线观看网站| 九草在线视频观看| 男女啪啪激烈高潮av片| 中文字幕av成人在线电影| 一级毛片久久久久久久久女| 亚洲国产精品成人久久小说| 亚洲精品乱码久久久v下载方式| 欧美日本视频| 一区二区三区精品91| 大片电影免费在线观看免费| 在线观看美女被高潮喷水网站| 色视频www国产| 亚洲av免费高清在线观看| 免费人成在线观看视频色| 成人毛片60女人毛片免费| 久久久久久国产a免费观看| 国产免费视频播放在线视频| 免费黄频网站在线观看国产| 久久精品人妻少妇| 黄色怎么调成土黄色| 99热这里只有精品一区| 国产精品久久久久久久电影| 日韩不卡一区二区三区视频在线| 能在线免费看毛片的网站| 男人添女人高潮全过程视频| 免费观看av网站的网址| 有码 亚洲区| 国产免费一区二区三区四区乱码| 高清在线视频一区二区三区| 大香蕉久久网| 国产成人免费观看mmmm| 亚洲精品久久午夜乱码| 成人国产av品久久久| 亚洲av二区三区四区| 免费观看av网站的网址| 精品久久久久久电影网| 免费观看无遮挡的男女| 一级毛片久久久久久久久女| 亚洲成人久久爱视频| 香蕉精品网在线| 国产亚洲av片在线观看秒播厂| 1000部很黄的大片| 亚洲欧洲日产国产| 欧美成人午夜免费资源| 中文字幕av成人在线电影| 午夜亚洲福利在线播放| 免费看日本二区| 欧美人与善性xxx| 日韩人妻高清精品专区| 丰满人妻一区二区三区视频av| 99久国产av精品国产电影| 久久久a久久爽久久v久久| 纵有疾风起免费观看全集完整版| 色吧在线观看| 欧美日韩国产mv在线观看视频 | 91精品伊人久久大香线蕉| 国产精品久久久久久精品古装| 国产成人freesex在线| 日韩中字成人| 好男人在线观看高清免费视频| 最近最新中文字幕大全电影3| 国产伦在线观看视频一区| 国产一区二区在线观看日韩| 欧美一区二区亚洲| 成人鲁丝片一二三区免费| 18+在线观看网站| 亚洲精品亚洲一区二区| 一级毛片久久久久久久久女| 女人被狂操c到高潮| 女人久久www免费人成看片| 免费高清在线观看视频在线观看| 久久ye,这里只有精品| 啦啦啦啦在线视频资源| 91狼人影院| 久久久午夜欧美精品| 啦啦啦中文免费视频观看日本| 亚洲av在线观看美女高潮| 国产精品一区二区性色av| xxx大片免费视频| 久久国内精品自在自线图片| 97超碰精品成人国产| 国产精品国产三级专区第一集| 日本爱情动作片www.在线观看| 久热久热在线精品观看| 大陆偷拍与自拍| 日韩大片免费观看网站| 毛片女人毛片| 人人妻人人爽人人添夜夜欢视频 | 久久久久久久久久久免费av| 成人国产麻豆网| 日日摸夜夜添夜夜爱| 又黄又爽又刺激的免费视频.| 夜夜看夜夜爽夜夜摸| 97在线视频观看| 久久精品国产亚洲网站| 国产成人freesex在线| 少妇人妻 视频| 啦啦啦中文免费视频观看日本| 国产精品国产三级国产专区5o| 国产精品人妻久久久久久| 精华霜和精华液先用哪个| 欧美zozozo另类| 老师上课跳d突然被开到最大视频| 三级国产精品欧美在线观看| 日韩av免费高清视频| 久久精品国产鲁丝片午夜精品| 一个人看的www免费观看视频| 麻豆国产97在线/欧美| 午夜福利视频1000在线观看| 欧美潮喷喷水| 日本黄大片高清| 我要看日韩黄色一级片| 成人亚洲精品av一区二区| 在线观看av片永久免费下载| av在线天堂中文字幕| 尤物成人国产欧美一区二区三区| 国产有黄有色有爽视频| 九色成人免费人妻av| av在线app专区| 免费看a级黄色片| 校园人妻丝袜中文字幕| 国产日韩欧美亚洲二区| 国产av码专区亚洲av| 国产黄a三级三级三级人| 亚洲人与动物交配视频| 亚洲图色成人| 欧美三级亚洲精品| 久久久久久久精品精品| 精品久久久噜噜| 自拍偷自拍亚洲精品老妇| 一区二区av电影网| 日韩亚洲欧美综合| 熟女av电影| 又粗又硬又长又爽又黄的视频| 嘟嘟电影网在线观看| 在线天堂最新版资源| 观看美女的网站| 久久久久久久久久久丰满| 中文天堂在线官网| 在线观看美女被高潮喷水网站| 99久久人妻综合| 国产极品天堂在线| 最后的刺客免费高清国语| 亚洲国产日韩一区二区| 日韩三级伦理在线观看| 精品99又大又爽又粗少妇毛片| 男人舔奶头视频| 中文乱码字字幕精品一区二区三区| 亚洲无线观看免费| 国产亚洲91精品色在线| 少妇 在线观看| 久久久精品免费免费高清| 26uuu在线亚洲综合色| 亚洲欧美中文字幕日韩二区| 国产精品一区二区三区四区免费观看| 大码成人一级视频| 熟妇人妻不卡中文字幕| 亚洲精品aⅴ在线观看| 性色avwww在线观看| 久久久欧美国产精品| 国产伦精品一区二区三区视频9| 大香蕉97超碰在线| 伦精品一区二区三区| 麻豆国产97在线/欧美| 免费看日本二区| 久久99精品国语久久久| 婷婷色综合www| 内射极品少妇av片p| 高清日韩中文字幕在线| av黄色大香蕉| 婷婷色综合大香蕉| 日韩成人av中文字幕在线观看| 欧美老熟妇乱子伦牲交| 日韩不卡一区二区三区视频在线| 久久精品国产亚洲网站| 99久久九九国产精品国产免费| 舔av片在线| 日韩视频在线欧美| 日韩大片免费观看网站| 国产精品久久久久久精品古装| 亚洲真实伦在线观看| 午夜老司机福利剧场| 三级经典国产精品| 舔av片在线| 赤兔流量卡办理| 久久久成人免费电影| 国产爽快片一区二区三区| 1000部很黄的大片| 春色校园在线视频观看| 岛国毛片在线播放| 亚洲av一区综合| 国产在线男女| 一级毛片电影观看| 晚上一个人看的免费电影| 亚洲欧美精品专区久久| 美女cb高潮喷水在线观看| 久久久久久久久久人人人人人人| 国产成人精品婷婷| 亚洲人成网站高清观看| 日本色播在线视频| 亚洲四区av| 插逼视频在线观看| 日本av手机在线免费观看| 国产毛片在线视频| 国产成人免费观看mmmm| 精品99又大又爽又粗少妇毛片| 欧美xxⅹ黑人| 国模一区二区三区四区视频| 亚洲国产精品999| a级毛片免费高清观看在线播放| 中文字幕制服av| 亚洲天堂av无毛| 乱系列少妇在线播放| 成人亚洲欧美一区二区av| 亚洲色图综合在线观看| 日韩,欧美,国产一区二区三区| 听说在线观看完整版免费高清| 亚洲精华国产精华液的使用体验| 国产精品国产三级国产av玫瑰| 亚洲av成人精品一区久久| av国产免费在线观看| 99热全是精品| 国产精品福利在线免费观看| 国产黄色视频一区二区在线观看| 在线观看av片永久免费下载| 在线免费观看不下载黄p国产| 欧美精品人与动牲交sv欧美| 久久精品夜色国产| av.在线天堂| 亚洲人与动物交配视频| 91午夜精品亚洲一区二区三区| 国产69精品久久久久777片| av播播在线观看一区| 久久久久久久国产电影| 精品国产三级普通话版| 最后的刺客免费高清国语| 精品少妇黑人巨大在线播放| 狂野欧美激情性xxxx在线观看| 人人妻人人看人人澡| 中文精品一卡2卡3卡4更新| 日韩视频在线欧美| 中国三级夫妇交换| 久久久久久久亚洲中文字幕| 精品国产乱码久久久久久小说| 建设人人有责人人尽责人人享有的 | 日韩一区二区视频免费看| 亚洲综合色惰| videos熟女内射| 看非洲黑人一级黄片| 高清毛片免费看| 精品国产乱码久久久久久小说| 欧美高清性xxxxhd video| 精品久久久久久久久亚洲| 高清毛片免费看| 黄片wwwwww| 熟妇人妻不卡中文字幕| 欧美日韩在线观看h| 欧美日韩亚洲高清精品| 91午夜精品亚洲一区二区三区| 麻豆成人午夜福利视频| av天堂中文字幕网| 一个人观看的视频www高清免费观看| 国产在线男女| 美女国产视频在线观看| 九九爱精品视频在线观看| 2022亚洲国产成人精品| 秋霞在线观看毛片| 日韩欧美 国产精品|