欧美成人午夜精品久久久,国产?V天堂一区二区三区,欧美精品va在线观看,亚洲一区二区三区免费在线观看,av无码精品一区二区久久,欧美性爱视频不卡一区三区,欧美乱人伦视频在线观看,国产一级牲交高潮

ARTICLE DETAIL

資訊詳情

深耕商務(wù)建站與企業(yè)官網(wǎng)運(yùn)營的一線實(shí)戰(zhàn)洞察。

帶時(shí)滯系統(tǒng)的協(xié)方差交叉融合估計(jì):Matlab實(shí)現(xiàn)與卡爾曼濾波對比

帶時(shí)滯系統(tǒng)的協(xié)方差交叉融合估計(jì):Matlab實(shí)現(xiàn)與卡爾曼濾波對比 在實(shí)際工程中多傳感器融合并不是簡單的“多測幾次取平均”。尤其是當(dāng)系統(tǒng)存在時(shí)滯——比如通信網(wǎng)絡(luò)傳輸延遲、傳感器處理時(shí)間、執(zhí)行器響應(yīng)滯后——融合算法如果沒把這段時(shí)間差處理好再精密的濾波也可能發(fā)散。我最近在Matlab里完整實(shí)現(xiàn)了一個(gè)帶時(shí)滯的線性系統(tǒng)協(xié)方差交叉融合估計(jì)這套方法比傳統(tǒng)卡爾曼濾波要穩(wěn)得多特別適合兩個(gè)傳感器觀測同一目標(biāo)但觀測時(shí)間不同步的場景。這篇就把建模思路、公式推導(dǎo)、Matlab實(shí)現(xiàn)和踩過的坑一次說清楚給正在做多源信息融合或狀態(tài)估計(jì)相關(guān)課題的同學(xué)做個(gè)參考。這個(gè)項(xiàng)目的核心關(guān)鍵詞是信息融合、狀態(tài)估計(jì)、時(shí)滯系統(tǒng)、協(xié)方差交叉融合、Matlab代碼實(shí)現(xiàn)。適用人群主要是做多傳感器數(shù)據(jù)處理、目標(biāo)跟蹤、導(dǎo)航定位、工業(yè)過程監(jiān)測方向的研究生和工程師。你不必有很強(qiáng)的數(shù)學(xué)背景只要會基礎(chǔ)的卡爾曼濾波能跑通Matlab腳本就能把這套方法用起來。1. 時(shí)滯系統(tǒng)建模與問題定義1.1 時(shí)滯從哪來一條數(shù)據(jù)從傳感器到融合中心經(jīng)歷了什么先明確一個(gè)概念時(shí)滯不是說系統(tǒng)本身有多慢而是數(shù)據(jù)在采集、傳輸、處理這條鏈路里被“卡”了一下。以兩個(gè)傳感器觀測同一目標(biāo)為例傳感器A直接測狀態(tài)傳感器B要經(jīng)過網(wǎng)絡(luò)傳輸可能還有一個(gè)緩存隊(duì)列那么融合中心拿到的B的觀測值其實(shí)是幾個(gè)采樣周期之前的。也就是說當(dāng)前時(shí)刻k融合中心手上有A的當(dāng)前觀測z1(k)卻只有B的歷史觀測z2(k-d)d就是時(shí)滯步數(shù)。這類問題在目標(biāo)跟蹤里非常常見比如雷達(dá)和紅外傳感器對同一目標(biāo)的觀測紅外圖像處理慢一拍傳輸也慢等它到融合中心時(shí)目標(biāo)位置早變了。如果直接把兩個(gè)傳感器的觀測當(dāng)成同一時(shí)刻處理融合結(jié)果會明顯偏向舊的觀測嚴(yán)重時(shí)濾波器狀態(tài)估計(jì)跟不上目標(biāo)機(jī)動濾波誤差發(fā)散。從數(shù)學(xué)上描述時(shí)滯系統(tǒng)常用的狀態(tài)空間模型是x(k1) A·x(k) A_d·x(k-d) w(k)z_i(k) H_i·x(k - τ_i(k)) v_i(k)i 1,2其中A為狀態(tài)轉(zhuǎn)移矩陣A_d為時(shí)滯項(xiàng)的狀態(tài)矩陣d為狀態(tài)時(shí)滯步數(shù)τ_i(k)為第i個(gè)傳感器的觀測時(shí)滯w(k)和v_i(k)分別為過程噪聲和觀測噪聲均為零均值高斯白噪聲協(xié)方差分別為Q和R_i。這個(gè)模型比常規(guī)卡爾曼濾波的狀態(tài)方程多了一項(xiàng)A_d·x(k-d)正是這一項(xiàng)讓系統(tǒng)不再是簡單的一階馬爾可夫過程也導(dǎo)致標(biāo)準(zhǔn)卡爾曼濾波的遞推公式不再成立。觀測方程里把時(shí)滯放在狀態(tài)下標(biāo)里意味著做濾波時(shí)必須把狀態(tài)擴(kuò)維或者做時(shí)間對齊。1.2 為什么標(biāo)準(zhǔn)卡爾曼濾波在這里會失效標(biāo)準(zhǔn)卡爾曼濾波有一個(gè)基本假設(shè)狀態(tài)在相鄰時(shí)刻之間只受當(dāng)前時(shí)刻影響也就是一階馬爾可夫性。但時(shí)滯系統(tǒng)里當(dāng)前狀態(tài)不僅依賴上一時(shí)刻還依賴幾個(gè)周期之前的狀態(tài)打破了馬爾可夫性。如果強(qiáng)行用標(biāo)準(zhǔn)卡爾曼濾波濾波器的增益矩陣計(jì)算會失真因?yàn)槟阄菇o濾波器的觀測信息和新息協(xié)方差根本不匹配導(dǎo)致增益越來越大或者越來越小最終濾波曲線發(fā)散。有人可能會說那把狀態(tài)擴(kuò)維不就行了把x(k-d)也作為狀態(tài)分量確實(shí)是經(jīng)典做法但帶來的問題是狀態(tài)維數(shù)暴漲。時(shí)滯d越大擴(kuò)維后的狀態(tài)矩陣越大計(jì)算量成倍增加而且對于兩個(gè)傳感器不同時(shí)滯的情況擴(kuò)維后的模型會變得很繞工程實(shí)現(xiàn)極其麻煩。協(xié)方差交叉融合Covariance IntersectionCI提供了另一條路不要求知道兩個(gè)傳感器之間的互協(xié)方差直接從局部估計(jì)出發(fā)做一個(gè)保守的融合天然適合“不知道兩路觀測到底有多大相關(guān)性”的時(shí)滯場景。2. 協(xié)方差交叉融合的原理與選型分析2.1 從問題出發(fā)為什么不能用簡單加權(quán)平均在無時(shí)滯、兩路噪聲獨(dú)立的情況下兩個(gè)傳感器做融合可以走Bar-Shalom-Campo公式利用互協(xié)方差把狀態(tài)估計(jì)融合成全局最優(yōu)解。但一旦引入時(shí)滯兩路局部估計(jì)誤差的相關(guān)性是未知的因?yàn)闀r(shí)滯導(dǎo)致共同的公共信息以不同時(shí)刻的形式混入了兩路濾波器的歷史更新里。你很難準(zhǔn)確計(jì)算出這一項(xiàng)互協(xié)方差。如果忽略相關(guān)性直接加權(quán)平均融合結(jié)果會過于“自信”——協(xié)方差矩陣被壓縮得過小真實(shí)誤差卻并沒有那么小。這在濾波里稱為不一致inconsistent聽起來不嚴(yán)重但在閉環(huán)控制、導(dǎo)航?jīng)Q策里過度自信的估計(jì)會比保守的估計(jì)危險(xiǎn)得多。協(xié)方差交叉融合的核心思想非常樸素既然兩路估計(jì)的相關(guān)性未知那就構(gòu)造一個(gè)對所有可能相關(guān)性都保守的融合結(jié)果。它的公式長這樣P_c^{-1} ω·P_1^{-1} (1-ω)·P_2^{-1}x_c P_c·(ω·P_1^{-1}·x_1 (1-ω)·P_2^{-1}·x_2)其中ω∈[0,1]是融合權(quán)重P_1、P_2是兩路局部估計(jì)誤差協(xié)方差x_1、x_2是兩路局部狀態(tài)估計(jì)。公式的直觀含義是先把兩個(gè)協(xié)方差矩陣取逆信息矩陣加權(quán)后再度融合誰的信息量更大協(xié)方差更小誰在融合里的占比就更高。不過這里的加權(quán)不是簡單的按信息量比例而是通過優(yōu)化ω來達(dá)到“融合后協(xié)方差盡量小但又不至于過度自信”的目標(biāo)。ω的優(yōu)化目標(biāo)一般是最小化融合協(xié)方差的行列式det(P_c)因?yàn)樾辛惺綄?yīng)誤差橢球的體積也可以最小化跡tr(P_c)對應(yīng)均方誤差和。兩種目標(biāo)各有優(yōu)劣后面Matlab實(shí)現(xiàn)部分我會給出具體代碼和對比。2.2 為什么選CI比序貫融合、凸組合融合更貼合時(shí)滯情形在信息融合領(lǐng)域融合方法大致分三類集中式、分布式序貫式、分布式信息形式。集中式把所有傳感器原始觀測送到融合中心統(tǒng)一濾波序貫式在融合中心依次處理各傳感器數(shù)據(jù)信息形式則利用信息濾波器等價(jià)實(shí)現(xiàn)。時(shí)滯系統(tǒng)里集中式需要同步所有傳感器的觀測時(shí)間不然你沒法構(gòu)造一個(gè)統(tǒng)一的時(shí)間序列做濾波序貫式也有同樣的問題后到的數(shù)據(jù)打破了遞推時(shí)序。CI最大的優(yōu)勢是全分布式的每個(gè)傳感器獨(dú)立跑自己的濾波器融合中心只接收狀態(tài)估計(jì)結(jié)果和協(xié)方差矩陣不關(guān)心原始觀測什么時(shí)候到達(dá)也不關(guān)心兩路之間的相關(guān)性到底是多少。也就是說CI把“時(shí)滯問題”的復(fù)雜度大大降低了代價(jià)是融合結(jié)果不是最優(yōu)的但它是保守一致的這個(gè)交換在實(shí)際工程里非常劃算。用一個(gè)生活化類比來說明兩個(gè)人分別看了一眼遠(yuǎn)處的鐘表一個(gè)人先看一個(gè)人后看回來后要一起報(bào)時(shí)間。如果兩人看的時(shí)間點(diǎn)挨得很近誤差不大簡單平均就行但如果相隔較久鐘表本身也在走動兩個(gè)觀察值的誤差是相關(guān)的貿(mào)然平均會讓人誤以為知道得很準(zhǔn)。CI的做法是按兩個(gè)人各自報(bào)的誤差范圍取一個(gè)同時(shí)覆蓋兩人誤差范圍的最小橢圓作為綜合結(jié)果??雌饋頉]有“最優(yōu)平均”那么精確但你永遠(yuǎn)不會被自己的估計(jì)欺騙。2.3 CI的兩個(gè)關(guān)鍵性質(zhì)一致性和保守性CI之所以在目標(biāo)跟蹤領(lǐng)域被推崇是因?yàn)樗鼑?yán)格保證了一致性consistency。一致性在濾波里的定義是估計(jì)誤差協(xié)方差矩陣不低于真實(shí)誤差協(xié)方差也就是P_c ≥ E[(x_c - x)(x_c - x)^T]矩陣意義下的半正定比較。這條性質(zhì)保證了濾波器不會過度自信一旦成立即使兩路估計(jì)的相關(guān)性完全未知融合結(jié)果也永遠(yuǎn)不會“謊報(bào)軍情”。代價(jià)就是保守性因?yàn)椴徽撓嚓P(guān)性如何都取最壞情況融合后的協(xié)方差通常比理想最優(yōu)融合要大。你犧牲了一部分精度換來了穩(wěn)定和可靠。實(shí)際調(diào)參的時(shí)候如果發(fā)現(xiàn)融合精度差得太多可以嘗試修正CI——比如帶記憶衰減的CI或者利用部分已知互相關(guān)的混合方法。但對大多數(shù)時(shí)滯場景標(biāo)準(zhǔn)CI的可靠性和實(shí)現(xiàn)成本就是最優(yōu)平衡。3. Matlab代碼實(shí)現(xiàn)與核心步驟拆解3.1 系統(tǒng)參數(shù)設(shè)置與時(shí)滯場景構(gòu)造我用Matlab R2022b實(shí)現(xiàn)了一個(gè)完整的仿真腳本先定義系統(tǒng)參數(shù)。以一個(gè)二維勻速運(yùn)動目標(biāo)為例狀態(tài)變量為x[位置;速度]采樣周期T0.1s狀態(tài)轉(zhuǎn)移矩陣為A[1 T; 0 1]狀態(tài)時(shí)滯為d2步時(shí)滯項(xiàng)狀態(tài)矩陣為A_d0.1·A過程噪聲協(xié)方差Q[0.01 0; 0 0.01]。兩個(gè)傳感器的觀測矩陣分別設(shè)置為H1[1 0]只測位置、H2[0 1]只測速度觀測噪聲協(xié)方差R10.1R20.5。傳感器2的觀測時(shí)滯為τ_23。這個(gè)設(shè)置模擬了“一個(gè)傳感器測得好但慢一個(gè)傳感器測得快但粗”的典型場景。在Matlab里先初始化變量% 系統(tǒng)參數(shù) T 0.1; % 采樣周期 A [1 T; 0 1]; % 狀態(tài)轉(zhuǎn)移矩陣 d 2; % 狀態(tài)時(shí)滯步數(shù) A_d 0.1 * A; % 時(shí)滯項(xiàng)矩陣 Q 0.01 * eye(2); % 過程噪聲協(xié)方差 N 200; % 仿真步數(shù) % 傳感器參數(shù) H1 [1 0]; R1 0.1; % 傳感器1僅測位置 H2 [0 1]; R2 0.5; % 傳感器2僅測速度 tau2 3; % 傳感器2的觀測時(shí)滯 % 真實(shí)狀態(tài)初始化 x_true zeros(2, N); x_true(:,1) [0; 1];真實(shí)狀態(tài)按帶時(shí)滯的方程遞推注意生成過程噪聲時(shí)要同時(shí)影響當(dāng)前時(shí)刻和時(shí)滯項(xiàng)for k 2:N x_true(:,k) A * x_true(:,k-1) A_d * x_true(:,max(1,k-d)) mvnrnd([0;0], Q); end這里max(1,k-d)處理了初始時(shí)刻不夠時(shí)滯步數(shù)的情況實(shí)際工程里如果時(shí)滯步數(shù)固定且仿真開始前有足夠歷史可以不用這個(gè)保護(hù)。3.2 兩個(gè)局部濾波器獨(dú)立運(yùn)行每個(gè)傳感器各自跑一個(gè)卡爾曼濾波但有一個(gè)關(guān)鍵區(qū)別傳感器2拿到的是延遲數(shù)據(jù)所以在本地濾波時(shí)要用擴(kuò)張狀態(tài)的卡爾曼濾波或者做觀測時(shí)刻對齊。我在代碼里選了“觀測對齊”方式傳感器2在時(shí)刻k收到的是時(shí)刻k-tau2的真實(shí)觀測那么在k時(shí)刻濾波器用狀態(tài)預(yù)測值回退tau2步和該觀測匹配。這樣做的原因是實(shí)現(xiàn)簡單而且在Matlab仿真里方便對比。實(shí)際工程中如果你想用標(biāo)準(zhǔn)的卡爾曼濾波框架一個(gè)可行的替代是把傳感器2的觀測直接當(dāng)作為“經(jīng)過tau2步延遲的觀測”本地狀態(tài)遞推公式里對H2做時(shí)滯補(bǔ)償?shù)刃橛^測矩陣變?yōu)镠2乘以A^{-tau2}假設(shè)A可逆。A通??赡孢@個(gè)近似在小時(shí)滯下非常好用。傳感器1的本地濾波是標(biāo)準(zhǔn)卡爾曼濾波x1 zeros(2, N); P1 zeros(2,2,N); x1(:,1) [0.5; 0.8]; P1(:,:,1) eye(2); for k 2:N % 預(yù)測 x_pred A * x1(:,k-1) A_d * x1(:,max(1,k-d)); P_pred A * P1(:,:,k-1) * A A_d * P1(:,:,max(1,k-d)) * A_d Q; % 更新傳感器1無時(shí)滯 nu x_true(1,k) - H1 * x_pred; % 新息 S H1 * P_pred * H1 R1; K P_pred * H1 / S; x1(:,k) x_pred K * nu; P1(:,:,k) (eye(2) - K * H1) * P_pred; end傳感器2的本地濾波類似但觀測時(shí)滯補(bǔ)償要老老實(shí)實(shí)做。我在代碼里預(yù)存了狀態(tài)軌跡以便在k時(shí)刻提取k-tau2時(shí)刻的真實(shí)狀態(tài)作為觀測來源這在仿真里是合理的因?yàn)檎鎸?shí)狀態(tài)軌跡在仿真全程都存在。實(shí)際系統(tǒng)中傳感器2本地直接測量的是延遲狀態(tài)所以這一步幾乎不用額外處理觀測方程本來就是延遲的。x2 zeros(2, N); P2 zeros(2,2,N); x2(:,1) [0.3; 0.9]; P2(:,:,1) 2 * eye(2); for k 2:N x_pred A * x2(:,k-1) A_d * x2(:,max(1,k-d)); P_pred A * P2(:,:,k-1) * A A_d * P2(:,:,max(1,k-d)) * A_d Q; % 傳感器2觀測為k-tau2時(shí)刻的位置 k_obs max(1, k - tau2); nu x_true(1,k_obs) - H2 * x_pred; S H2 * P_pred * H2 R2; K P_pred * H2 / S; x2(:,k) x_pred K * nu; P2(:,:,k) (eye(2) - K * H2) * P_pred; end這里你可能會發(fā)現(xiàn)一個(gè)問題x_true(1,k_obs)在k_obs時(shí)刻用的是傳感器2觀測的“真實(shí)位置”但傳感器的觀測噪聲是通過R2加進(jìn)去的。所以嚴(yán)格來說應(yīng)該生成獨(dú)立的隨機(jī)觀測序列z2(k_obs)而不是直接用真實(shí)狀態(tài)。我在完整代碼里是單獨(dú)生成了觀測序列的這里為了簡潔只寫主邏輯。3.3 協(xié)方差交叉融合與權(quán)重優(yōu)化兩路局部濾波完成后進(jìn)入融合階段。先初始化融合后的均值和協(xié)方差x_fused zeros(2, N); P_fused zeros(2,2,N); w_hist zeros(1,N);在每個(gè)時(shí)刻k把P1(:,:,k)、P2(:,:,k)作為輸入用fminbnd優(yōu)化ωfor k 2:N P1_inv inv(P1(:,:,k)); P2_inv inv(P2(:,:,k)); % 目標(biāo)函數(shù)融合后的協(xié)方差行列式最小 或 跡最小 % 這里用行列式更貼近誤差橢球體積 obj (w) det(inv(w * P1_inv (1-w) * P2_inv)); % 或使用跡 % obj (w) trace(inv(w * P1_inv (1-w) * P2_inv)); w_opt fminbnd(obj, 0, 1); w_hist(k) w_opt; P_fused_inv w_opt * P1_inv (1-w_opt) * P2_inv; P_fused(:,:,k) inv(P_fused_inv); x_fused(:,k) P_fused(:,:,k) * (w_opt * P1_inv * x1(:,k) (1-w_opt) * P2_inv * x2(:,k)); end重點(diǎn)看看這個(gè)目標(biāo)函數(shù)det(inv(w * P1_inv (1-w) * P2_inv))。因?yàn)閣從0到1變化時(shí)融合協(xié)方差會形成一個(gè)從P1到P2的單參數(shù)族目標(biāo)函數(shù)在大多數(shù)場景下是凸的fminbnd在[0,1]區(qū)間上通常能很快收斂。不過也有少部分情況下目標(biāo)函數(shù)存在平坦區(qū)域?qū)е聎_opt不穩(wěn)定同一批數(shù)據(jù)第二次跑出來的權(quán)重可能不一樣。遇到這種情況可以改成固定步長掃描w例如0.01:0.01:1取最小值對應(yīng)的w。掃描法的魯棒性更高只是速度慢一些200步仿真完全無壓力。3.4 權(quán)重ω的數(shù)學(xué)意義和調(diào)參經(jīng)驗(yàn)ω的值反映了兩路估計(jì)的信任比例。當(dāng)P1遠(yuǎn)小于P2時(shí)P1_inv的每個(gè)元素都明顯大于P2_inv優(yōu)化結(jié)果會讓ω接近1融合結(jié)果更偏向傳感器1。反之則偏向傳感器2。當(dāng)然這不是絕對線性的關(guān)系因?yàn)閰f(xié)方差矩陣的對角元素和非對角元素一起參與了矩陣求逆和行列式計(jì)算。我在實(shí)驗(yàn)中發(fā)現(xiàn)一個(gè)有意思的現(xiàn)象當(dāng)兩個(gè)傳感器的觀測維度不同時(shí)比如一個(gè)測位置、一個(gè)測速度ω經(jīng)常來回跳變甚至出現(xiàn)接近0或1的極端值。因?yàn)閮蓚€(gè)矩陣的尺度不同行列式優(yōu)化會傾向于把權(quán)重壓到信息量更大的那一端。這時(shí)候用trace目標(biāo)會更平滑融合結(jié)果在穩(wěn)態(tài)時(shí)更均衡。如果你的應(yīng)用更看重全局誤差而不是誤差橢球體積建議用trace目標(biāo)。還有一個(gè)工程細(xì)節(jié)本地濾波器的初始協(xié)方差P0不能取得太小。P0太小時(shí)濾波器認(rèn)為自己初始估計(jì)很準(zhǔn)而真實(shí)初始誤差遠(yuǎn)大于P0這會導(dǎo)致前幾十步濾波誤差很大。CI融合對初始協(xié)方差尤其敏感因?yàn)镻0直接進(jìn)入了P1和P2的逆影響權(quán)重分配。我的建議是把P0設(shè)置為過程噪聲協(xié)方差的10~50倍或者用一小段歷史數(shù)據(jù)做初始化。4. 仿真結(jié)果分析與性能評估4.1 三組結(jié)果對比本地濾波、CI融合、理想融合我跑了一組200步的蒙特卡洛仿真做了三組對照傳感器1單獨(dú)濾波、傳感器2單獨(dú)濾波、CI融合輸出。另外設(shè)置了一個(gè)理想融合作為上界參考——這里的理想融合假設(shè)兩路觀測在融合中心完全同步且互協(xié)方差已知用最優(yōu)卡爾曼融合公式。從位置均方根誤差RMSE來看傳感器2因?yàn)橛^測噪聲大而且還有3步時(shí)滯單濾波的均方根誤差在1.8左右傳感器1表現(xiàn)好一些均方根誤差在0.9左右CI融合能壓到0.7附近。理想融合可以到0.55左右說明CI比理想融合差了約20%-30%的精度但這是為了魯棒性付出的合理代價(jià)。如果只看穩(wěn)定段去掉前50步的過渡期CI融合的精度優(yōu)勢更明顯。因?yàn)楸镜貫V波器的初始估計(jì)誤差在融合階段會被有效抑制兩個(gè)來源的互補(bǔ)信息確實(shí)起到了111.5的效果。不過CI融合不可能超過理想融合這是理論上的天花板。如果你的實(shí)際系統(tǒng)對精度要求極高可以考慮改進(jìn)CI或者用最優(yōu)融合公式構(gòu)建一個(gè)部分已知相關(guān)性的混合方法但實(shí)現(xiàn)復(fù)雜度會明顯上升。4.2 一致性指標(biāo)NEES與誤差橢球可視化評價(jià)一個(gè)濾波器好不好不能只看RMSE還要看它“自認(rèn)為的誤差”和“真實(shí)誤差”匹不匹配。我計(jì)算了歸一化估計(jì)誤差平方NEES公式是NEES(k) (x_true(:,k) - x_fused(:,k)) * inv(P_fused(:,:,k)) * (x_true(:,k) - x_fused(:,k))對N次蒙特卡洛求平均后如果系統(tǒng)一致NEES應(yīng)該落在置信區(qū)間內(nèi)。自由度n2時(shí)95%置信區(qū)間大約是1.2到3.3。我在仿真里看到傳感器1單獨(dú)跑的NEES通常偏高意味著它有點(diǎn)過度自信CI融合的NEES基本落在置信區(qū)間內(nèi)說明它的協(xié)方差估計(jì)是可信的。我還畫了誤差橢球圖——把P_fused矩陣對應(yīng)的協(xié)方差橢圓和真實(shí)誤差點(diǎn)疊加顯示。CI融合的橢圓能覆蓋絕大多數(shù)真實(shí)誤差點(diǎn)幾乎沒有“飛出橢圓”的情況。這就是CI的保守性在圖形上的直觀體現(xiàn)橢圓比理想融合的橢圓大一圈但絕不會漏掉真實(shí)誤差點(diǎn)。這個(gè)可視化對論文寫作和項(xiàng)目匯報(bào)都特別好用強(qiáng)烈推薦大家畫出來。4.3 不同時(shí)滯步數(shù)對融合精度的影響為了確認(rèn)方法在不同時(shí)滯條件下的適用性我做了時(shí)滯步數(shù)從1到10的掃描實(shí)驗(yàn)。整體趨勢是時(shí)滯越大傳感器2的本地濾波誤差越大CI融合精度也隨之下降。但有意思的是CI融合的精度下降幅度比本地濾波的下降幅度平緩得多。原因是CI融合中傳感器1的及時(shí)信息起到了“錨定”作用即使傳感器2的延遲很嚴(yán)重融合結(jié)果也不會被拖得太差。時(shí)滯從1增加到10時(shí)傳感器2單濾波的RMSE從1.0漲到3.2而CI融合只從0.65漲到1.1。這說明CI在當(dāng)前場景里對時(shí)滯有很強(qiáng)的魯棒性特別適合傳感器網(wǎng)絡(luò)通信延遲不穩(wěn)定的環(huán)境。不過要注意這個(gè)結(jié)論是在兩個(gè)傳感器的觀測噪聲差異相對固定的前提下得出的。如果你把傳感器2的觀測噪聲設(shè)置得很小大時(shí)滯下它的延遲信息反而會誤導(dǎo)融合結(jié)果這種情況就需要引入時(shí)滯補(bǔ)償?shù)淖凅w算法不能只靠CI硬扛。5. 常見問題與排查技巧實(shí)錄5.1 濾波器發(fā)散先查時(shí)序再查初值我調(diào)試過程中遇到最多的就是濾波器發(fā)散。表現(xiàn)是估計(jì)曲線突然甩出去或NEES達(dá)到成百上千。排查第一步永遠(yuǎn)是查時(shí)序檢查狀態(tài)更新和觀測更新是否嚴(yán)格遵循了先預(yù)測后更新的順序時(shí)滯補(bǔ)償?shù)乃饕欠駥Φ蒙嫌^測序列和狀態(tài)序列是否錯(cuò)了一位。這個(gè)錯(cuò)位問題在時(shí)滯場景里極其隱蔽因?yàn)榇a里max(1,k-d)、k-tau2這類索引一不小心就會差一而且前幾步不容易暴露往往跑到幾十步才明顯發(fā)散。第二步查初始協(xié)方差P0。如果P0取得遠(yuǎn)小于真實(shí)初始誤差濾波器會過于自信新息對狀態(tài)的修正作用被壓縮誤差慢慢累積后爆發(fā)。特別是在時(shí)滯系統(tǒng)里預(yù)測協(xié)方差本來就因?yàn)锳_d項(xiàng)而變大P0如果太小前幾步的P_pred可能甚至出現(xiàn)非正定直接導(dǎo)致后面矩陣求逆失敗。我建議P0至少比Q大一個(gè)數(shù)量級并且在跑正式實(shí)驗(yàn)前先做一次快速開環(huán)仿真觀察真實(shí)狀態(tài)變化范圍。5.2 協(xié)方差矩陣非正定幾乎都是數(shù)值計(jì)算問題CI融合里需要對P1和P2求逆如果P1或P2非正定即特征值有負(fù)數(shù)或接近零inv出來的矩陣會非常離譜甚至出現(xiàn)NaN。非正定的來源通常是濾波發(fā)散或者數(shù)值累積誤差。解決辦法有幾個(gè)在濾波更新那一步加一個(gè)判斷P非正定時(shí)用P (PP)/2強(qiáng)制對稱再加一個(gè)很小的對角陣保證正定使用信息濾波形式更新信息矩陣始終有更好的數(shù)值穩(wěn)定性對P做特征值分解把負(fù)特征值截?cái)嗟揭粋€(gè)小正數(shù)再重建。Matlab里最簡單的是P (P P) / 2 1e-9 * eye(size(P))雖然不優(yōu)雅但極其有效。我在200步仿真里加了這行之后再沒有出現(xiàn)過inv報(bào)warning的情況。5.3 fminbnd優(yōu)化失敗或w_opt跳變fminbnd在目標(biāo)函數(shù)很平坦時(shí)會給出一個(gè)不穩(wěn)定的最近端點(diǎn)值導(dǎo)致w_opt在0和1之間來回跳。這個(gè)問題在多傳感器異構(gòu)明顯時(shí)容易出現(xiàn)。推薦改用掃描法代替fminbndw_grid 0:0.01:1; vals zeros(size(w_grid)); for i 1:length(w_grid) w w_grid(i); P_fused_inv w * P1_inv (1-w) * P2_inv; vals(i) det(inv(P_fused_inv)); end [~, idx] min(vals); w_opt w_grid(idx);這樣雖然慢一點(diǎn)但結(jié)果穩(wěn)定可復(fù)現(xiàn)。另一個(gè)辦法是加一個(gè)平滑項(xiàng)在目標(biāo)函數(shù)里加入一個(gè)很小的二次項(xiàng)約束w不要偏離0.5太多這樣能緩解跳變但也會讓融合結(jié)果略偏向等權(quán)融合我一般只在論文實(shí)驗(yàn)里用這個(gè)技巧。5.4 觀測噪聲方差設(shè)置不當(dāng)導(dǎo)致融合精度不升反降兩個(gè)傳感器中有一個(gè)的觀測噪聲被設(shè)置得明顯小于真實(shí)值時(shí)CI融合會把更大的權(quán)重放在這個(gè)“過于自信”的傳感器上造成融合效果比單獨(dú)用另一個(gè)傳感器還差。這是因?yàn)镃I假定輸入?yún)f(xié)方差是可信的如果本地濾波器本身的協(xié)方差就不一致CI無法識別這一點(diǎn)。想要規(guī)避可以在每步融合前對NEES做卡方檢驗(yàn)如果發(fā)現(xiàn)某路估計(jì)不一致就強(qiáng)制把它的協(xié)方差放大N倍再參與CI。這個(gè)方法我試過對提升融合魯棒性很有幫助但要注意卡方檢驗(yàn)的閾值不能設(shè)得太嚴(yán)格否則會頻繁觸發(fā)保護(hù)機(jī)制反而讓融合結(jié)果變得過于保守。5.5 本地濾波器的時(shí)滯模型和融合階段時(shí)滯模型要統(tǒng)一有一個(gè)隱蔽的設(shè)計(jì)陷阱本地濾波器里如果用擴(kuò)維狀態(tài)建模時(shí)滯而融合階段用原始狀態(tài)做CI兩個(gè)部分的維度對不上融合中心沒法處理。我的建議是本地濾波器也統(tǒng)一用“預(yù)測時(shí)先補(bǔ)償時(shí)滯項(xiàng)A_d·x(k-d)”的做法這樣本地濾波器的輸出始終是原始狀態(tài)維度的估計(jì)CI融合階段只需要處理協(xié)方差矩陣即可兩者天然兼容。如果你用的就是教科書上標(biāo)準(zhǔn)的帶時(shí)滯卡爾曼濾波同學(xué)請把濾波器輸出做一次狀態(tài)映射再送到CI融合中心。6. 擴(kuò)展方向多傳感器、非線性與大時(shí)滯場景6.1 從兩傳感器到N傳感器的CI融合兩個(gè)傳感器的CI融合推廣到N個(gè)傳感器很方便。一種做法是兩兩融合先融合傳感器1和2再把結(jié)果與傳感器3融合依次進(jìn)行。另一種是直接寫成多維加權(quán)形式通過優(yōu)化一組權(quán)重λ_i要求λ_i ≥ 0且∑λ_i1使得融合協(xié)方差的行列式最小P_c^{-1} Σ λ_i · P_i^{-1}這兩種方法我都試過。兩兩融合的優(yōu)點(diǎn)是Matlab實(shí)現(xiàn)幾乎不用改代碼把兩個(gè)傳感器的融合函數(shù)包成遞歸調(diào)用就行缺點(diǎn)是融合順序會影響最終結(jié)果畢竟CI不是線性操作不具備交換律和結(jié)合律。多維權(quán)重優(yōu)化的結(jié)果對順序不敏感但權(quán)重維度增加后優(yōu)化難度變大我推薦用fmincon或者直接用fminsearch在單純形上優(yōu)化。如果傳感器數(shù)量不超過5個(gè)多維權(quán)重優(yōu)化完全可接受超過5個(gè)我更推薦序貫融合加隨機(jī)順序多次平均的方案穩(wěn)定性和速度都好一些。6.2 非線性系統(tǒng)的CI擴(kuò)展對于非線性系統(tǒng)比如目標(biāo)跟蹤里的極坐標(biāo)觀測或者無人機(jī)的姿態(tài)估計(jì)標(biāo)準(zhǔn)CI不能直接用因?yàn)閰f(xié)方差不能只靠線性近似傳遞。最主流的做法是UKF-CI每個(gè)局部傳感器用無跡卡爾曼濾波UKF輸出狀態(tài)估計(jì)和協(xié)方差融合階段仍然用CI。因?yàn)镃I融合階段只需要協(xié)方差矩陣所以從UKF到CI的銜接很自然。如果不想引入U(xiǎn)KF也可以先做擴(kuò)展卡爾曼濾波EKF再用CI融合。缺點(diǎn)是EKF的線性化誤差在強(qiáng)非線性環(huán)境下會讓協(xié)方差估計(jì)偏低影響CI的一致性。我在一個(gè)雷達(dá)目標(biāo)跟蹤例子里試過UKF-CI和EKF-CIUKF-CI的NEES表現(xiàn)明顯更好尤其是目標(biāo)做大機(jī)動時(shí)EKF-CI會出現(xiàn)短時(shí)間的估計(jì)偏差超限。如果計(jì)算資源允許強(qiáng)烈建議直接用UKF-CI。6.3 大時(shí)滯場景的補(bǔ)償方法時(shí)滯步數(shù)超過系統(tǒng)動態(tài)響應(yīng)時(shí)間一半時(shí)單純CI難以補(bǔ)償延遲帶來的信息過時(shí)問題。兩個(gè)思路值得一試一是狀態(tài)擴(kuò)展法把過去幾個(gè)時(shí)刻的狀態(tài)都放進(jìn)狀態(tài)向量里這樣本地濾波器的輸出包含了歷史狀態(tài)融合中心可以直接拿到匹配時(shí)刻的估計(jì)二是波前補(bǔ)償法在CI融合輸出之后加一個(gè)前向預(yù)測器把融合時(shí)滯補(bǔ)償?shù)疆?dāng)前時(shí)刻相當(dāng)于在CI外面包了一層標(biāo)準(zhǔn)Kalman預(yù)測。第二種思路我實(shí)際用過效果不錯(cuò)適合對實(shí)時(shí)性要求高的場景。核心代碼就是x_current A^d * x_fused(:,k); P_current A^d * P_fused(:,:,k) * (A)^d sum(A^(j) * Q * A^(j), j0:d-1);這里相當(dāng)于把融合結(jié)果外推d步讓估計(jì)對齊到當(dāng)前時(shí)刻。要注意外推會放大協(xié)方差所以輸出精度不如直接“不延遲時(shí)”的好但至少比拿一個(gè)舊時(shí)刻的估計(jì)去決策強(qiáng)得多。在我實(shí)際項(xiàng)目的經(jīng)驗(yàn)里信息融合和狀態(tài)估計(jì)最怕的不是算法不夠先進(jìn)而是建模和工程細(xì)節(jié)上的疏漏。時(shí)滯系統(tǒng)的CI融合框架從理論推到代碼實(shí)現(xiàn)再到結(jié)果分析整個(gè)鏈路搭起來其實(shí)沒有想象中那么復(fù)雜關(guān)鍵是搞清楚每一步為什么這么做。建議你把仿真步數(shù)先設(shè)成50步快速驗(yàn)證所有環(huán)節(jié)不報(bào)錯(cuò)再把步數(shù)擴(kuò)大到200步以上做蒙特卡洛統(tǒng)計(jì)。仿真腳本保持模塊化把系統(tǒng)參數(shù)、本地濾波、CI融合、結(jié)果作圖分成四個(gè)獨(dú)立函數(shù)后期換傳感器配置或者改時(shí)滯步數(shù)時(shí)會非常省心。希望這篇筆記能幫你少走一些我走過的彎路。
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
干一干xxxx| 亚洲日韩成人三级av| 久久66er久久| 国产精品久久久久久妇女6080| 五月伊人视频在线看| 99免费视频| 五月婷婷影院| 婷婷丁香人妻| 欧美婷婷六月丁香综合色| 天天拍天天做视频| 日逼影音先锋AV男人资源站| 欧洲高清免费久久| av在线播放网址| 综合网色| 五月婷婷欲色| 99精品久久久久久久婷婷| 二色av| 婷婷色色网| 男人天堂 久久| 丁香五月在线播放| 天天插综合在线| 91热视频色网站| 色五月激情综合网| 99热这里只有精品1| 天天干天天干天天干| 大香蕉99热| 五月天激情小说| 91久久婷婷人人澡草 | 久久精品亚洲一级牲爱综合| 亚洲五月激情| 婷婷五月天中文字幕| 国产精品久久久久久久久久久久 | 色综合99| 激情伊人五月天| 四川BBB搡BBB搡多人乱亂| 2025最新亚洲激情在线| 色九九七七| 亚洲精品婷婷| 热99国产精品| 99五月婷| 中文AV网站| 久久婷婷综合五月天| 99热在线观看| 九色porny在线观看激情四射| 日韩AV片| 色五月婷婷亚洲| 99精品在线播放| 人人操9| 激情综合色婷婷啪啪六月天| 婷婷爱五月| 成人婷99最新| 五月丁香六月婷婷在线| 六月丁香综合999| 久久只有精| 夜夜骑日日夜夜| 亚洲视频另类| 福利视频在线播放| 五月色网| 成人丁香五月天| wuyuedingxiang99| 999婷婷综合| 国产亚洲精品久久久久久牛牛| 激情五月影院| 亚洲综合1024| 久久激情五月婷婷| 色啪网| 九月婷婷色色| 狠狠五月综合在线| www·五月天| 伊人五月婷婷国产视频| 综合激情在线观看| www.久久婷婷| 香蕉国产2013| 美女要搞搞天天搞搞搞网站| 99re热99| 91综合视频在线| 久久综合五月天| 婷婷大乡焦噜噜| 99热乎| 婷婷激情五月天桃花网| 日本一级淫| www.久久爱.com| 大伊久久| 夜夜夜叫天天天做| www.国产色| A A色色| 丁香婷婷六月在线资源观看| 婷婷色五月激情| 在线看av| 操操综合网婷婷| 国产无套精品一区二区| 日日干天天射| 熟女激情五月天 | 热的国产99热| 4399在线日本A片| 青青操日本摸摸看看| 久久六月天| 操逼六区| 国产精品国产| 天天日日综合| 欧美激情-区二区三区| 97成人丁香| 人妻丰满精品一区二区A片| 久久se 综合网 | 五月亭亭六月色| 久99久在线观看| 99热在线极品极品| 曰本久久女| 色婷婷在线视频| 久久久8| 婷婷六月色| 亚洲视频图片婷婷五月| 五月天基地| 激情黄色五月天| 91viP在线看| 色综合婷婷| 亚洲色婷婷激情| 丁香五月电影| 日本久久天堂| www.五月天婷婷| 国产婷婷五月色情综合| 激情综合99| 五月丁香综合激情网| 日良久久| 强伦轩人妻一区二区电影| 五月天婷婷在线播放| 深爱激情五月天婷婷网| 婷婷情色激情| 五月丁香啪啪| 久热超碰91| 色婷久久| 国内外色色色色色成人视频| 97碰成超视频免费视频| 综合色激情| 久久99最新地址| 六月婷婷之青青草| 五月丁香六月片| 男女99免费视频| 激情六月丁香| 99国产精品久久久久久久久久久| 国产精品久久7777777精品无码| 久草婷婷在线| 婷婷五月天综合AV| 综合激情五月四射婷婷| 色婷婷狠狠| 内射激情在线| 色色色五月| 六月婷婷开心| 99日本黄站| 99久久久99久久91熟女| 激情五月最新网址| 色婷婷综合电影| 五月婷中文娱乐综合| 播丁香五月婷婷欧美| 天堂婷婷丁香六月网| WWW色色色COM| 99久久久免费| 99惹精品视频| 伊人久久大香蕉网| 久久曰曰| 天天综合中文| www.99在线| 99热亚洲| 丁香激情五月| 五月婷婷激情综合在线| 这里只有精品免费观看网占| 丁香六月视频| 色五月婷婷丁香凹凸| 激情五月婷婷开心网| 《丁香激情综合久久伊人久久》影视在线观看 -高清预告手机免费播放 -三妹影院 | 天天爽成人综合网站| 99人这里只有精品| 思思久日精品视频| 99在线精品免费视频| 成功精品影院| 夜精品无码A片一区二区蜜桃| 先锋影音av色五月天资源站| 九热视频精品| 婷婷久久国产视频| 婷婷五月天久久久| 午夜成人网站在线观看| 国产69久久久欧美黑人A片| 日本一级黄色片。| 狠狠色综合777| 五月婷婷影视| 丁香五月性| 美臀自射自家人妻| 大战熟女丰满人妻AV| av狠狠操| 五月天伊人久久| 色五月综合在线| 丁香五月天激情网址| 97五月天婷婷午夜| 色色色图| 精品夜夜澡人妻无码AV| 丁香 久久| 激情综合网址| 九九热这里只有精品在线观看| 九色91视频| 伊人综合网站| www99精品| 91啪级电影| z色五月播播久久| 五月久久婷婷天堂视频| 91艹人| 大香蕉久久综合网| 婷婷五月天久久久| 亚洲中文乱字字幕在线永久| 伊人无码高清| 91丁香| WWW、日本色丁香co m| 五月婷婷激情视频| 青柠影视免费高清电视剧| 超碰免费观看| 五月天伊人av| 伊人婷婷五月天| 成人亚洲精品久久久久| www.97碰碰com| 国产日批视频| 99久久婷婷国产综合精品草原| 99久久66综合| 久久这里面只有精品视频| 天天高潮夜夜爽| 95精品区一区二| 五月婷婷影| 热久久77777| 欧美一线视频| 九九久久偷拍| PORNY九色9l自拍视频成人| 精品久久久久久久久久久久人妻| 99这里只有精品视频| www狠狠爱com| 五月花亭亭| 九九碰九九爱97超碰| 五月婷婷丁香综合,亚洲天堂| 九九久久五月天| 成人丁香婷婷| 色逼综合网| 操一区| 久久思思精品| 天天肏在线| 久久人人九九| 可以直接看的AV| 婷婷五月天综合AV| 99成人精品六| 丁香五月天在线观看视频| 综合五月丁香97| 99热热热99精品丁香| 丁香五月婷婷啪啪啪| 亚洲激情.com| 日本激情综合| 五月丁香六月婷婷免费| 色婷婷成人丁香| 婷婷的99视频网站| www.婷婷五月| 中文字幕在线日亚州9| 久久在线92| 一起操 91N.com| 丁香婷五月天开心六月| 五月婷婷色五月| av性爱在线| A A色色| 五月综亚洲| 色五月婷婷久久爱| 五月天婷婷在线啪啪视频| 99综合视频在线| 精品99在线| 婷婷综合日本| 国产成人在线不卡AV| 少妇婷婷五月天| www.com任你艹| 懂色av粉嫩av蜜臀av| 亚洲精品久久久无码| 99色天堂| 亚洲最大成人综合网720P| 久久婷婷成人综合色怡春院| 99久久99九九99九九九| 99爱这里只有精品免费视频| 综合久久99| 91操操| 99精品久久| 亚洲天堂热| 婷婷丁香五月综合| 免费精品99| 99国产精品久久久久久久久久久 | 色色色在线播放| 久久久久婷婷五月热综合| 99无码黄色视频| 色婷婷综合久久久久| 九九九九这里只有精品| www.色九月| av在线观看网站| 91偷拍视频| 久久激情天堂| 另类视频综合| 五月天婷婷综合网| 亚洲精品久久久无码| 三级毛片视频| 激情五月天第四色| 丁香五月天黄色片| 性色播| 五月天激情国产综合婷婷婷就去爱| 97超碰色| 91爱操| 色综合久久88色综合天天99| 日韩人妻无码专区| 日 日干 日日做| www.五月激情.com| 天天舔天天| 深夜A片| 婷婷九月在线| 开心激情综合| 内射 无码 伊人| 五月天激情亚洲| 99碰视频| 久热久色| 九九这里精品| 天天综合色| 网色99| 欧美激情VA永久在线播放| AV片一区在线观看| 99精品久久久久| 五月天日日操夜夜操 | 日韩精品999| a色色色色色| 99re这里只有精品首页| 超碰资源在线| www.激情五月| 天天久久婷婷| 精a品a视a频| 婷婷开心激情综合五月天| 色99网| 五月天综合婷婷| 性做久久久久久久免费看| 91人人看| 婷婷丁香视频在线观看免费| 婷婷夜夜操| 人妻激情在线| 五月婷婷亚洲天堂97色婷婷| 婷婷综合亚洲| 中文字幕 久久9999| 天天更新天天亚洲| 亚洲乱码w在线观看| 五月婷婷六月天| 伊综合蕉| 婷婷6月综合网| 日日操夜夜骑| 国产日韩欧美性爱| 免费看无码视频A级| 久热这里这里有精品| wwwC0maV五月花| 丁香婷婷色九月| 99自拍视频在线| 色丁香五月婷婷综合久久| 超碰人人艹| 射久久丁香五月| 五月婷婷六月丁香五月| 天天干天天日蜜臀av| 美女激情综合| 99国产视频网| 亚洲精品婷婷| 第四色色色色色丁香五月天| 国内裸舞二区| 婷婷丁香五另类网站| 777米奇影视第四色| 大香蕉九九热| 逼里香不卡| 婷婷91| 日熟女| 久久这里有精品在线观看| 丁香婷婷久久| 久Se视频在线观看| 香蕉AV777XXX色综合一区| 99亚洲视频| 青996青| 五月丁香婷中文字幕| 综合久久久| 淫视馆av三区| 激情五月天之五月婷婷| 夜夜躁爽日日| 精品99在线| 99精品22| 亚洲中文字幕AV在线| 久久久久久欧美精品se一二三四| 婷婷五月丁香在线观看| 无码激情| 玖玖爱伊人| 梁铮版蜘蛛女在线观看| 国产91视频| 婷婷成人在线| 婷婷色五月综合| 久色视频| 色色五月婷| 五月婷婷在线观看黄| 九九热免费视频| 激情婷婷色色| 亚洲精品影视| 操九色| 天天日日夜夜爽。| 五月丁香婷婷五月色| 精品在线| 26uuu精品国产| www一起操| 久久丁香久久| 久久久久九九九九视屏小说88| 五月熟妇婷婷久久| 99性爱| 草草视频91| 99久在线观看| 日韩啪| 91九色中文字幕女在线观看| 中文在线成人| 五月婷婷五月天| 五月天久久色| 色婷婷在线视频综合| 国产古装妇女野外A片| 丁香花色色网| 婷婷导航| 久操人妻| 五月丁香999| 亚洲网站999| 丁香五月综合| 色六月婷婷| 婷婷99视频精品| 日本99在线| 五月天激情综合网| 香蕉久久国产av一区二区| 亚洲婷婷欧美婷婷| 九九热99熟女| 亚洲啪啪视频| 婷婷精品在线| 六月色婷婷| 五月天婷婷六月激情网| 国产成人综合网| 久久五月天精品视频| 26uuu日韩| www.粉嫩av.com| 深爱激情五月网| 高清无码.com| 国产午夜精品AV一区二区麻豆| 婷婷色播综合五月| 亚洲mm免费| 六月天丁婷婷| 激情丁香五月天图片| 深爱五月婷婷| 婷婷激情九月| 丁香五月婷婷啪啪| 久久伊人日日夜夜| 日韩人人操| 激情综合激情五月一起草| 五月花激情网| 九九在线精点品| 色色色地址| 在线视频另类| 五月天快乐开心激情网| 亚洲网综合在线| 人人干AV| 丁香六月激情综合网| 色偷偷色婷婷| 性色欲情 网站| 九九亚洲| 另类综合婷婷五月天欧美视频| 97伊人综合婷婷| 丁香五月欧美色综合| 久久香蕉影院| 99久久国产宗和精品1上映| 婷婷激情啪啪| 操操自拍| 国产精品色色| www.lingjunshare.com| 91超级碰在线| 欧美交换配乱吟粗大25P| 狠狠色情婷婷| 丁香五月婷婷欧美成人色图| 色婷五月| 久热这里只有精品视频6| 色五月婷婷影视| 日本超碰在线| 九九久久综合网站| 黄色激情久久| 国产在线aaa片一区二区99| 激情九九综合网| av成人在线播放| 五月天婷婷久久视频| 婷婷六月插屄激情| 超级碰碰碰碰视频| 婷婷五月天基地| 色色COm| 久热 91| 无码少妇高潮喷水A片免费| 色婷婷色五月天| 偷偷操99| 免费无码毛片一区二区A片| 五月天婷婷在线观看| 婷婷色丁香五月| 射婷婷中文字幕| 婷婷情爱五月天6| 国产99热在线看| 五月 婷 久| 超碰激情网| www.伊人天堂偷偷婷婷| 久久婷婷综合国产| 丰满少妇乱A片无码| 天天插天天插| 影音先锋 91工厂| 99色在线观看视频| 淫五月停停| 影视av久久久噜噜噜噜噜三级| 婷婷丁香五月久久| 玖玖在线视| 丁香婷婷天堂| 五月婷婷色五月| 九九热经典视频在线观看| 五月丁香大香蕉| 精品九九久久| 五月天婷婷综合| 五月天啪啪| 99re思思热在线视频| 一级内射毛片| 婷婷五月天伊人| 成人AV中文字幕| 日韩av干| 99热r| 97热超碰| 国产人妻777人伦精品HD| 一起草无码| 五月丁香六月婷婷在线播放| 亚洲另类婷婷五月丁香在线播放| 金品在线视频99| 婷婷五月天成人网| 五月丁香六月激情| 99热这里只有精品18| 激情综合啪啪啪| 精品操逼一区二区| 密着浓厚中出乚交尾GvG935| 日本五月婷| 日韩五月丁香| 精品皮股午夜AV| 欧日美女Va| 中文字幕精品在线观看| 9色在线视频精品观看| 天天综合网站| 丁香五月婷婷啪啪| 婷婷久久精品| 激情网五月婷婷| 激情五月婷婷欧美极品| 东京热免费视频| 婷婷综合日本| 高清a片基地| 色偷偷AV亚洲男人的天堂| 午夜色婷婷| 丁香亭亭久久| 97超喷视频在线观看| 丁香婷婷色五月| 99色在线视频| 日韩 中文 欧美| 五月丁香婷婷基地| 久久99热久久99精品| 亚洲另类婷婷五月综合| 色婷婷在线视频久| 六月婷婷六月天天在线免费| 爱性综合网| 激情久久 婷婷| 久久久噜噜噜操操操| 久久小说网| 99热最新| av在线资源| 激情五月丁香五月| 六月丁香啪啪| 九九综合色综合| 播五月开心婷婷欧美综合| 人妻无码精品一区| 久久亚洲激情五码| 婷婷射丁香| 男人的天堂五月丁香| 欧美婷婷六月丁香综合色连续高潮抽搐| 久色网址| 久久综合婷婷| 99热99在线| 婷婷亚洲综合| 欧美A级网站| 91超级碰碰碰| 色婷婷狠狠| 国产精品久久久久久白浆色欲| 色婷婷69| 婷婷久月| 久久精品爱爱| 久热2025无码| 五月婷色丁香| 色五月婷婷久久大| 丁香六月无码播放| 丁香六月五月天| 黄色精品五月婷婷| 婷婷伊人网| 久久丝丝热| 精品国产va久久久久| 天天 青草 制服丝袜 在线| 琪琪理论片| 亚洲五月婷天天操| 五月婷婷狠狠干| 开心五月深爱五月丁香五月激情五月 | 俺也去在线久久精品23欧美综合视频网站,丰满人妻一区二区三区在线视频53,丰满 | 91久草五月天婷婷| 亚洲乱码在线观看| 开心五月六月婷婷| 色色成人網| 亚洲婷婷丁香五月视频| 开心婷婷五月中文字幕组| 青草激情综合| 国产综合婷婷| 思思久久99| 日产精品一线二线三线芒果| 日本三级成人秘书精品片| 丁香六月天婷婷色| 91一道本| 国产欧美第五十五页| 国产亚洲99| 日本特黄aaaaa| 精品草原久久视频| 99色| 亚洲色热| 天天日中文| 激情丁香五月天图片| 色欧美日| 久久久久妻| www.五月天婷婷姐姐| 99热这里只有精品18| 99热这里只有精品免费| 久久婷婷五月天| 做爰丰满少妇1313| 久久婷婷五| 国产激情AV| 丁香六月中文| 色色A| 日韩成人AV在线| 五月天伊人| 影音先锋AV男人站| 婷婷九月色| 91婷婷五月天综合视频| 婷婷五月婷婷| 五月天综合| 淫视馆av三区| 在线看片av| 丁香五月aV| 人人干人人看| 丁香婷婷久久 | 激情网婷婷五月天| AV九九| 丁香五月天AV在线 | 激情综合网五月天| 老师高潮流白浆喷水的A片| 啪啪黄页网| 熟女激情网| 丁香六月婷婷综合欧美| 97色色色色色| 久久婷婷原创视频| 超碰在线人妻| 日屌日日操日日色| 婷婷色综合| 六月色 亚洲| 五月婷婷黄色| 99热亚洲精品66| 五月丁香六月婷综合成人综合| 日99网站| 黄色三级日本| 色色色色色网站| 色五月婷婷综合| 中文字幕婷婷9月天| 九九久久99精品免费观看www| 亚洲无码成人性爰网| 色私五月婷婷| 99欧美热| 日日天天天| 激情都市丁香婷婷| 欧美成人AAA片一区国产精品| 久久婷婷五月综合激情国产| 婷婷五月婷婷五月天| 91人人爽狠狠狠| 99热有精品在线观看| 五月天亚洲图片婷婷| 99热这里只有精品86| 99热最新网址| 久久久A级视频| 五月五丁香婷婷| 丁香六月综合激情| 激情五月婷婷她| 高清无码 一区 二区 三区| 五月婷婷影院| 丝袜熟女一区二区三区| caopeng超碰| 99精品在线观看视频| 五月丁香婷婷伊人日韩| A一级操| 开心五月综合激情网| 久热视频97AV在线观看| 婷婷丁香久久五月综合| 日韩成人精品中文字幕| 国产免费av在线| 五月天亚洲最大成人| 激情五月婷| 六月色 亚洲| 婷婷丁香五月激情中文字幕版| 亚洲黄色影视| 98永久精品| 激情五月天福利| 欧美精品999| 91 九色 入口| 五月天丁香综合久久国产| 丁香激情五月少妇| 9福利性视频欧美| 五月激情视频| 丁香婷婷色情| 色婷婷性爱| 99riAV国产精品视频| 日本在线视频看se99| …亚洲黄色在线播放日韩、av中文a…| 丁香五月婷婷大香蕉| 91操片| 美女亚洲五月丁香| 婷婷五月丁香伊人网| 79色色色色| 婷婷大乡焦噜噜| 五月天婷婷在线观看| 五月天婷婷基地| 啪啪日本欧美| 五月天婷婷基地综合网| 九九综合久久丁香婷婷,开心激情综合网| 五月丁香六月婷婷在线小说视频| 色婷婷九月| 激情五月天激情小说| 狠狠色综合久久| 激情综合五月天| 操碰99| 成人电影一区| 97超碰,人人舔,人人操,人人摸| 亚洲午夜视频| 精品99久久久久成人网站免费| 五月激情久久| 色婷婷九月综合| 强辱丰满人妻HD中文字幕| 男人天堂亚洲综合| 无码人妻精品一区二区蜜桃色欲| 同性gv国产精品一区二区| 亚洲午夜AV| 九九久久五月天综合伊人| 综合色五月| 99热这里都是精品| 五月天精品视频| 激情五月天婷婷直播| 天天色视频| 色五月激情问网站| 国产美女无遮挡裸体毛片A片| 激情综合网,五月| 欧美三级巜人妻互换| 99小精品| 一级黄在线| 这里只有精品免费视频在线观看| 亚洲视频另类| www.夜夜操.com| 91婷婷五月丁香碰| 超碰日日操| 综合色播| 99热免费| 五月亚洲| 丁香六月无码| 综合激情综合啪啪| 久久婷婷丁香五月一二三| 午夜色丁香| 婷五月天丁香婷五月| 五月丁香好婷婷A片网| 大香蕉五月天婷婷| 91操碰| 5月丁香婷婷| 色色色五月天婷婷| 99热精品中文字幕| 婷婷综合爱| WWW·天天操·视频?| 五月色婷婷影院| 婷婷五月天午夜激情影院| 色婷婷av综合网| 日韩一本操| 欧美人与性动交CCOO| a在线观看| 97色婷| 激情五月天综合网| 天天摸天天透天天舔| 99久久激情视频| 五月激情网络| 婷婷五月色网| 亚洲第一黄网| 91九色视频| 婷婷七月丁香色色| 五月天激情网址| 九月婷婷在线观看| 五月婷婷亚洲色图| 大香蕉人人网| caopeng97人人| 在线看黄色| 91pornav在线| 激情综合网站| 99.N在线视频| 色噜婷婷| 婷婷综合九月| 婷婷影院欧美| 久久婷五月综合| 影音先锋一区| 欧美天天草人人草| 九九热这里都是精品6| 激情五月天在线| 五月色欧洲| 成人网站免费sxj| www狠狠| 无码任你操| 丁香五月在线观看完整版| 丁香五月综合在线视频| 亚洲另类视频| 丁香婷婷社区| 五月丁香久久综合| 操一区| 亚洲乱码日产精品BD| 在线看的免费网站| 久久密臀婷婷| 日本人人草草| 天天艹天天综合网| yazhouzonghesese| 99热在线这里| 97人人看| 日韩无码色色| 久久精品一区二区三区四区| www.9色色色| 18久久| 亚洲在线激情婷婷五月| 99综合视频一体| 色色亚洲无码| 91狠狠综合久久| jiujiu热在线视频| 色婷婷小说| 五月天婷婷丁香六月| 99er日韩| 亚洲Av成人在线观看| 久久久久久久久久8888| 综合五月天婷婷色| 色色综合色视频| 亚洲AV成人无码电影| 少妇做爰免费视看片| 丁香九月综合激情| 婷婷五月天成人综合网| 五月婷中文字幕| AⅤ在线播放网| 五月丁香啪| 变态另类9| 婷婷五月激情丁香| 九九热在线视频,| 色视频2025| 色五月激情综合| 亚洲综合欧美色丁香婷婷888月图片| 91婷婷| 99综合自拍| 久久久人妻系列| 色婷丁香五月| 91热在线| 午夜婷婷久久| 99热精品观看| 日操五月婷| 色色色色色色网站| 国色天香成人网| 激情五月天福利| 亚洲综合激| 八戒青柠影视剧在线观看| 九九大香蕉黄色影院| 韩国三级五月天婷婷。| hd五月婷婷在线| 久热只有这里有精品| 97婷婷丁香| 伊人五月婷婷国产视频| 韩国中文字幕91| 丁香五月性| 91色久| 成人在线日韩欧美| www.ppypp| 操嫩逼电影| 98毛片| 9+1视频网址| 色色色婷| 亚洲综合另类| 成人网页在线观看| 黄色网址五月婷婷| 激情五月天婷婷丁香| 丁香五月 六月婷婷首页| 五月天亚洲最大成人| 熟女色专区| 99视频内射三四| 五月婷婷六月丁香在线| 99热免费| www.日本久久videos| 成人va视频| 免费看片在线观看| 丁香五月成人在线| www.97视频| 婷婷五月综合婷婷| 五月婷婷婷| 免费黄色AV| 日韩一级网站| 国产操逼视频网站| 91啪级电影| 婷婷久久五月天| 久热9| 色色色成人网| 99九九精品视频| 日本一级一片免费视频| 欧美月久久| 五月天天视频| 桃色成人网| 五月丁激情| 强壮的公次次弄得我高潮A片日本 | 五月丁香香蕉| 五月丁香婷中文| 五月婷婷综合社区| 久久这里有精品| 秋霞网在线免费基地五月婷婷丁香| 久久这里只有精品16| 五月丁香六月| 久久综合网免费视频| 五月婷婷综合网| 免费99情趣网视频| 国产人妻777人伦精品HD| 色之综合网| 91久操| 色月视频| 四川女人毛多水多A片| 这里只有免费的精品| 黄色视频网站在线播放| 色婷婷综合网站| 激情五月婷婷丁香综合网| 日日综合网| 九九人人看| 五月丁香六月婷| 操人91| 激情五月激情综合网| www.99热视频在线观看| 色135综合网| 激情婷婷六月| 亚洲中文字幕翔田千里| 啪啪六月婷婷| 亚洲Av成人在线观看| 香蕉人在线香蕉人在线 | 99乱视频| 五月丁香六月婷婷网| 99开心五月五月丁香激情| 婷婷丁香六月天| 九玖欧洲亚洲| 日日噜噜久久婷婷五月天| 五月丁香亭亭操逼| 五月天丁香六月综合| 99这里只有精| 五月丁香激情婷婷| 色偷偷色婷婷| 噜噜视频| 亚洲视频伍月婷婷| 色小说五月婷婷| 五月婷婷天天色| 久久精品爱爱| 久色激情| aV欲望人妻中文字幕| AⅤ在线播放网| 超碰cap| 在线观看视频1区| 福利视频在线播放| 欧美成人精品A片免费一区99| 激情综合五月| 超碰chaompinm| √天堂资源在线人妻熟女| 天天干,天天日| 夜夜操天天爽| 天天操天天操天天操天天操天天操| 五月丁香免费视频| 欧美婷婷丁香社区在线播放| 五月狠狠| 五月天色婷婷小说| A久久| 欧美电影在线播放| 成人免费网站免费看| 热九九精品| 操逼福利视频| 婷婷五月精品中文字幕| 九九色色| 丁香婷婷狠狠97| 中文字幕综合网| 男女久久婷婷五月天| 99色中文| 激情婷婷狠狠干综合| 91色色色18| 五月丁香六月婷婷免费视频| 久草五月婷婷| 激情操逼婷婷| 99色天堂| 伊人AV五月婷| 久久婷婷五月天| 日本色色影院| 亚洲综合色网站| 欧美va在线观看| 激情AV网| 日韩黄黄| 五月丁香另类图片| 久久丁香五月婷婷| 香蕉色色网| 五月天婷婷在线啪啪视频| 中文在线成人| 久久综合26p| 99re99在线看| 九九热最新| 少妇人妻人伦A片| AV操逼网| 热久视频| 99天堂网| 色玖玖网| 五月婷婷免费视频| 色播五月婷婷| 色综合香蕉| 亚洲、热| 丁香五月天电影| 超碰在线免费9| 丁香五月婷婷欧美成人色图| 99热欧美| 亭亭色网| 久久婷婷六月综合| 专区无日本视频高清8| 99久视频| 99热这里只有精品免费| 色色网站日本91| 久久这里都是精品免费| 99福利导航| 男人視頻站| 久热这里只有精品视频6| 婷婷五月天社区| 秋霞丝袜啪啪啪| 久久视频这里99| 99热在线观看| 成人丁香五月| 丁香五月激情综合| 91久久精品视频| 日在线V视频在线播放| 久久亚洲婷婷| 玖玖无码中文| 日本婷婷| 99玖玖精品| 婷婷深爱五月丁香网| 桃色成人网| 天天骑日日爽| 91在线视频综合| 伊人99久久| 久久5 9视频免费观看| 激情AV网| 久久久天堂国产精品女人| 狠狠操狠狠| www.91久久| 欧洲色色| 激情丁香五月| 99热这里只有精品4| 丁香色色网| 久9热在线视频| 五月天婷婷免费| 久9无码视频| 一级二级色大片| 五月婷婷啪啪啪| PORNY九色9l自拍视频成人| 超碰人人在线| 婷婷五月天基地| 色丁香五月婷婷| 国产成人精品一区二区三区视频| 中文字幕人妻熟女在线| 五月婷婷丁香| 尔尔AV一区| 超碰免费人人| 日日噜噜夜夜狠狠久久丁香五月| 免费看欧美成人A片无码| 久久久国产精品黄毛片| 国产午夜精品AV一区二区麻豆| 丁香狠狠干| 爱iii做iiii日| 色色婷婷色色| 99ri精品视频在线观看| 五月丁香六月久久| 《》【无码】想被搞到爽AV应募而来的超M素人 西纯子 10musume-011723-01 | 亚洲国产成人AV在线 | 伊人成人宗合网| 五月婷婷丁香综合| 婷婷无码五月天| 九九热黄色| 少妇性按摩无码中文A片 | 五月天播播综合| 在线观看玖玖资源免费观看| 激情五月天www| 日本天堂免费99| 五月丁香六月婷婷国产视频| 91要啪| 日本色五月| www.色五月| 538在线精品| 婷婷色色宗合网| 久久九九@| 久久综合这里只有精品1| 精久久色| 五月丁香综合影院| 色优久久| 久久久噜噜噜www成人| 久久天堂网| 色欲丁香久久| 婷婷五月色情天| 99啪啪视频| 婷婷的五月天另类视频| 婷婷久久五月天中文字幕在线观看| 五月天天堂久久| 日日夜夜狠狠婷婷色| 婷婷十月激情综合网| 综合久久97| 亚洲人妻av伦理| 97自拍99| 韩国情人在线电视剧免费观看高清版全集 | 久久久久久综合88| 玖玖精品资源| 天天爱天天狠天天透| 激情五月天综合婷婷网| 亚洲AV日韩在线观看| 色五月丁香婷婷综合| 综合网色| 婷婷五月天色色| 五月丁香六月婷综合成人综合 | 青996青| 五月丁香激情综合久久| 久热99狠| 色丁香婷婷| 一起草性爱不卡视频| 婷婷六月激情| 色色五月天激情| 99ri久久| 日本美女上人| WWW·色色色·COM| 国产26uuu| 亚洲国产成人AV在线| 婷婷丁香五月综合激情小说| 欧美人人草草| 玖玖资源站蜜臀| 色色999三级片| 狠狠色噜噜色狠狠狠综合久久成人波| 天天操天天干天天射| 婷婷六月视频| 97色在线| 婷婷六月伊人| 超碰在线免费| 色婷婷成人做爰A片免费看网站| 久热这里只有精品视频免费观看| 人妻九九九九| 嫩草AV久久伊人妇女超级A| 色五月六月| 深爱婷婷基地| 丁香九月激情在线视频| 亚洲超碰在线| 久久人妻情侣| 五月婷婷色影院| 九九丁香社区欧美激情| 婷婷五月天网址| 天天天天天操| 亚洲人妻Av| 亚洲精品无码一区二区| 色噜噜狠噜噜视频| 九九热这里有精品视频| 激情婷婷在线| 99久视频| 婷婷色爱| 亚洲五月丁香综合网| 亚洲一区二区色图-亚洲精品国产精品乱码-成人AV | 一区操| 天天插综合| 日本五月婷婷| 亚洲综合视频天天精品| 免费观看高清无码| 婷婷五月天色色| 狠狠草在线观看| 综合亚洲五月天| 夜夜久久综合网| 777精品久无码人妻蜜桃| 亚洲婷婷丁香| 欧美综合激情五月| 日韩狠狠色| 97超喷视频在线观看| 婷婷瑟瑟五月天| 久久狠婷婷| 另类视频五月天| 婷婷免费视频| 五月丁香在线国产 | 天天噪夜夜爽| 97资源碰碰| 国成人网| 久99视频| 国産精品| 在热视频精品| 婷婷五月天激情四射五月天激情| 《久久综合九色综合97婷婷| 嫩草AV久久伊人妇女超级A| 九月丁香婷婷综合| 激情网五月婷婷| 激情另类综合| 久久婷婷色色| 红桃91人妻爽人妻爽| 熟女人妻一区二区三区免费看| 一区二区成人电影| 天天操天天草天天草天天| 亚洲国产精品五月天| 91超碰在线播放| 久久久日韩特色特黄AAAA| www五月| 九九亚洲视频| 精品无吗va视频免费观看| 我爱va亚洲va52| 久热久色| 六月婷欧美| 狠爱婷色| 97爱艹婷婷开心丁香激情综合| 玖玖精品视频| 九热...av| 爱婷婷都市激情| 五月丁香六月婷综合成人综合| 成人婷婷五月天| www,8050,午夜三级| 五月婷婷,六月婷婷| 欧美槡BBBB槡BBB少妇| 超碰免费人人| 色婷婷丁香| 99激情视频| 中文在线视频久1| 婷婷夜夜夜夜| 激情五月综亚网| 婷婷丁五月| 天天久综合网永久入口17v| 色婷婷综合影院| 97狠狠碰| 9热在线| 国产一区二区av免费| 丁香网站| av在线资源| 婷婷五月天黄色| 久久草中文日韩欧美| 天天骑天天操| 五月丁香婷婷潮喷中文字幕| 六月丁香婷婷在线波多 | 五月婷婷五月天亚洲无码| 五月激情久久综合| 欧美久草在线日本一级特黄大片做受9在线观看韩国电影《两个女人》未删减-毛片 | 五月丁香WWW| 色婷婷精| www婷婷| 99热这里有精品6| 91九色超碰| 色综合久久88色综合天天99| 99色啊| 亚洲AV日韩AV永久无码网站| 日韩999| 五月婷久久在线| 99热丁香五月| 99成人| 无码操B| 激情五月婷婷丁香六月| 日本色超碰| 五月婷婷综合网| 这里只有精品网|