欧美成人午夜精品久久久,国产?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
返回資訊列表
色婷婷精品视频| 色婷婷六月开心中文字| 99资源人人| 五月丁香 啪啪| 五月天婷婷一起草| 黄色成人AV在线| 色色色热| 一级二级香港秋霞欧美欧美秋霞| 色天天综合天天综合频道。| 久操97| 五月天综合网| 久婷婷| 狠狠色无码| 天天色图| 《丁香激情综合久久伊人久久》影视在线观看 -高清预告手机免费播放 -三妹影院 | 性做爰1一7伦| www.色婷婷| 色久综合天天做视频| 久久精品综合色| 一本道在线电影| 五月丁香综合影院| 99爱在线免费视频| 无码网站视频| 狠狠色综合网站| 久久综合干| 中文不卡av| 色五月激情五月| 无人精品在线视频| 婷婷开心激情综合五月天| 超碰97干| 亚洲综合无码| 99人人干人人| 亚洲人妻电影| 久久人五月| 国产精产国品一二三在观看| 欧美激情综合色综合啪啪五月| www.9797国产| 久久久久网站| 99福利导航| 色婷婷丁香香香蕉视频| 亚洲综合婷婷六月丁香五月| 伊人AV五月婷| 激情 婷婷 插| 五月丁香黄色| 日韩在线aaa| www色婷婷久久综合久色| 中文字幕av亚洲| 日美三级| 五月丁香综合中文| 夜夜久久综合网| 91高潮喷水久久久久久久久| 国产综合A片| 欧美A级成人婬片免费看理论| 天天色天天日| 国产99久久久国产精品免费看| 麻豆雪千夏| 激情婷婷啪啪| 婷婷色综合| 97色色在线视频| 五月天六月婷婷电影| 丁香五月综合图片在线观看| 五月天婷a| www..com色爱| 婷婷中文字暮| 丁香五月激情网| 久久人妻视频| 日本一级黄色电影| 色色色欧美| 成人在线99| www.五月天婷婷| 久激情网| 婷婷五月天在线观看| 99这里只有精品| 色五月婷婷基地| www.夜夜操.com| 可以免费观看的av| 久久久国产精品黄毛片| 五月丁香综合精品欧美| 99偷拍视频在线日本| 日本久碰| 久久久999精品| 丁香五月激情棕合| 久色姿源| 久久五月综合| 日本一级一级一级一级| 99久久9| 最近中文字幕大全免费版在线 | www.五月天婷婷| 日韩视频女神99| 丁香婷婷五月综合影院| 久久aaa| 开心五月丁香啪| 激情六月一二| 99精品视频免费观看| 成人精品视频99在线观看免费 | 色综合色综合网| 丁香六月激情综合啪啪| 久色网址| 97碰碰草| 激情五月天色| 婷婷五月天激情电影小说| 五月天激情综合网| 婷婷五月天com| 婷婷五月天com| 久久激情五月天| 99热在线精品播放| 亚洲综合色婷婷文学| 色婷婷激情五月天| 亚洲99在线视频| 日本丁香五月| 影音先锋男人女人| 99热91| 夜夜夜夜做天天天做无码视频| 久久视频这里99| 99热老网站| 国产亚洲精品AAAAAAA片| 婷婷五月,综合伊人| 激情丁香久久久久久| 热99国产精品| 噜噜国产| 婷婷五月丁香青青草在线| 日韩情色在线观看| 欧美内射AAAAAAXXXXX| 久久丁香网| 成人一级片| 五月婷婷丁香大陆免费| 久久伊人五月天| 99在线免费观看| 丁香五月ⅤA久久久| www.99婷婷| 国产精品久久7777777精品无码| 99狠狠色| 99五月婷| 老司机伊人| 91性高潮久久久久久久久| 五月婷中文娱乐综合| 丁香婷婷六月婷婷六月婷婷六月婷婷 | 99在线精品免费视频| 日本三级色| 66久久视频在线| www,超碰| 婷婷五月a| 五月色情婷婷开心五月天| 饮料下药迷倒漂亮女同事强干| 亚洲国产精品SUV| 久久丁香五月| 婷婷八月丁香激情综合| 亚洲啪啪精品| 五月天婷婷人妻| 99热精品在线观看| 婷婷五月天激情四射五月天激情| 婷婷五月天久久| 最新婷婷五月丁香| 激情综合另类| 丁香五月婷婷图片综合| 五月天综合区| 欧美成人猛片AAAAAAA| 综合久久综合| 91丨九色丨高潮丰满日本| 就爱日五月天| 欧美激情综合色丁香婷婷五月天 | 久久婷婷五月| 视频久久9| 婷婷射图五月天| 激情综合五| av网址在线| 久久这里只有精品热在99| 青柠影视免费高清电视剧| 五月丁香婷婷色| 97碰碰在线看视频免费| 久9久9久9久9久9久9| 激情五月丁香亭亭 | 国产原创视频91九色| 思思99热这里只有精品6| 婷婷深爱五月天| 91偷拍视频| 色五月婷婷亚洲最大| 久操乱| 婷婷激情五月综合在线视频| 丁香五月 性爱| 色色综合视频| 久久99日本精品视频免费观看| 五月天色在线| av免费在线观看0| 丁香五月婷婷乱| 国产真实乱了老女人视频| 激情校园 亚洲| AA片在线观看视频在线播放 | 呦呦v线| 天天日天天爽| 五月婷婷开心六月激情小说| 91窝窝| 久久A热| 最近韩国日本免费高清观看| 五月丁香久久久| 天天激情站| 色婷婷激情视频| 雪千夏麻豆| 蜜桃五月天色| 狠狠色丁香久久| 91婷婷丁香五月| 99re热在线视频| 婷婷五月天久久| 色网站99| 丁香婷婷综合影院| 国产精品久久..4399| 欧美婷婷日本| 综合AV网| 五月天激情啪啪| 99热青青草| 天天舔天天爽| 久热A| 爱iii做iiii日日| www.操.com| 色婷婷免费观看| 五月天社区| 噜色精品| 婷婷天堂综合网| 五月天精品| 九九久久99精品免费观看www| 五月天综合网| 久久久精品人妻| 婷婷丁香亚洲色综合91| 777精品久无码人妻蜜桃| 西瓜美女a片| 色九综合| 熟女人妻一区二区三区免费看| 就爱射中文字幕资源网| 97综合在线| 国产精品18久久久| 久久婷婷五月综合啪| 91狠狠综合久久| 99在线精品免费视频| 五月天涩涩| 97人人操人人| 五月丁香综合久久夜夜| 五月天婷婷基地| 亚州性爱99| av色婷婷| 激情五月天.色网| 影音先锋一区| 丁香五月婷婷色| 成人婷99最新| 1024久婷| 白人荫道BBWBBB大荫道| 亚洲天天操| 亚洲色爽| 91人妻PORNY九色大屁股| 1000部毛片A片免费观看| 天天日夜夜曹| 五月丁香久久久| 久久久大香蕉| 九九综合88| 久热只有精品| 婷婷久久五月天丁香| 色情激情五月| 凹凸7777操操操| 久九九热| 亚洲天堂AV综合网| 久久久天堂国产精品女人| 99热99精品| 天天狠狠色噜噜| 色久九| 玖玖玖婷婷婷| 天天干在线播放| 超碰在线中文字幕| 丁香五月天激情免费在线观看AV777| 日日日,com| 亚洲无码黄色| 色色网91| 琪琪狠狠干| 中文字幕无码人妻少妇免费视频| 激情五月丁香五月| 色欲婷婷五月天| 自拍盗摄 另类| 情欲综合网| 亭亭色色五月天| www.五月婷| 黄色中文字目| 玖玖在线视频| 中国AV性爱观看| 五月伊人网| A级毛片高清免费不卡播放谢谢谢谢| 99热这里只有精品 搜| 婷婷五月丁香五月基地| 激情婷婷啪啪| 成片免费播放| 99色性爰网络| 丁香五月婷婷日本| 热99在线| 婷婷午夜综合| 无码橾| 青青草99re| 8050一级网| 色爆五月| 操草草草| www91久久| 超级碰碰视频无码| 狠狠色狠狠爱| 97丁香五月| 小色小蛇伊人婷婷色香五月| 先锋资源91| 久久久精品99| 亚洲天99| 五月丁香综合激情| 免费九九热| 婷婷丁香在线| 六月丁香啪| 丁香丁香激情网| 丁香五月香蕉在线| www.色婷婷。com| 婷婷爱综合| 亚洲 日韩色色| 丁香六月AV| 九九爱这里只有精品| 黄桃AV无码免费一区二区三区| 婷香五月激情视频| 国产又色又爽又黄又免费| 六月成人网| 久久在线视频免费观看| www.9色色色| 91 久热| 久久青青日本视频| 五月丁香婷中文| 婷婷色五月激情| 五月久久五月激情| 黄色99网| 色婷婷亚洲五月天| 亚洲热综合| 久久婷婷五月综合啪| 婷婷五月色| 五月丁香免费视频| 天天色视频| 国产人妻人伦精品一区二区| 男同色五月开心五月激情五月| 亚洲永远av在线播放| 激情色情五月天| 综合色网站| 啪啪啪大香蕉| SESE无码AV| 99久热这里只有精品| 亚洲婷婷久久综合| 国产精产国品一二三在观看| 久久久A级视频| 一级精品999WWW| av 一区三区四区| 狠狠色丁香婷婷综合久久97AV| 五月婷婷无码专区| 9久久久久| 深爱激情五月天| 色啪久 | 亚洲小说五月婷婷| 26uuu亚洲欧美| 热99在线精品| 97超碰,人人舔,人人操,人人摸 | 丁香影院五月综合| 五月天啪啪| 天天综合五月| 超碰人人色| 五月激情啪啪| 婷婷九月狠狠色| 免费的日逼视频| 色婷婷六月丁香综合欲精品| 国产67194| 国产99久9在线+|+传媒| 婷婷五月激情热播| 丁香五月婷婷亚洲色图| 久久免费少妇高潮99精品| 9l视频自拍9l九色9l成人| 79精品在线视频| 桔色成人在线| 少妇激情五月天| 91919191919久久成人视频| 91热视频色网站| 婷婷五月天美女| 五月丁香六月婷婷网| 五月婷在线| 丁香九色不卡aaa| 丁香六月AV| 色欲一区二区三区精品A片| 久久九九热视频| seav天堂| 五月在线婷色| 大香蕉五月天| 91pornav在线| 久久性爱视频这里只有精品| 天天日日夜夜| 激情综合网五月在线播放| 五月丁查人人| 成人五月丁香花| 婷婷丁香五月亚洲欧美| 五月婷中文字幕| 中文字幕丰满乱孑伦无码专区| 五月天亚洲图片婷婷| 丁香五月天在线| 丁香激情五月天| 丁香六月成人网| 天天舔天天| 五月婷婷六月天| 美欧成人视频| 99久久综合| 国产一二区爆乳_1国产日韩一区二区三-成人AV| 啪啪东京热| 五月色导航| 99热地址| 99色这里| 婷婷五月天视频| 青青草色在线视频观看| 99热新网址| 久热天堂| 免费观看的婷婷五月视频在线| 成人在线观看国产| 色五月婷婷五月久久| 狠狠操狠狠插| ri电影在线| 激情五月综合婷婷| a色色片| 欧美六月| 人人性久久| 久久激情五月婷婷| 久热精品在看| 色九月婷婷丁香| 日韩免费99| 香蕉AV777XXX色综合一区| 日韩在线观看网址| 337午夜福利| 狠狠色综合网| 婷婷亚洲激情在线观看视频| 玖玖婷婷免费| 五月婷婷日| 91操在线视频| 婷婷视频网| 六月色色| 婷婷五月天伊人| 九九热九九| 人人摸人人干| 女力报到正好爱上你| 5Www色5夜| 五月色亚洲| 婷婷九月丁香天堂丁香天堂| 激情五月丁香五月| 五月婷婷中文网| 嫩草视频。| 中文成人在线| 国产99美少妇| 五月丁香A∨在线| 婷婷五月丁香超碰| 久久亚洲精品成人无码网站导航| wwww.9免费视频| 日日干日日| 一起草AV| 影音先锋五月天婷婷丁香在线观看| 色婷婷久久综合中文久久一本| 97性视频| 国产精品美女久久久久AV超清| 婷婷激情五月色综合| 欧美日韩成人在线观看| 欧美叉叉叉BBB网站| 天天五月天综合网址| 婷婷五月香蕉| 99在线资源视频| 婷婷丁香色情| 精品人妻久久久久久久| 玖玖无码中文| 涩丁香91| 色婷婷亚洲婷婷| 播五月丁香六月| 亚洲熟女色| 欧美私人家庭影院| 丁香五月六月综合激情| 草AV9999| 精品久热| 九九色天堂| 五月婷婷激情综合| 五月激情婷婷国产精品久久久久久| 色婷婷香蕉| 色五月天婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷 | 少妇综合网| 国产VA亚洲VA96| 天天干,天天舔| 国产在线视频1234| 99久久国产宗和精品1上映| 色爱综合网| 久久五月丁香综合17C| 中文字幕日韩成人| 91热在线观看视频| 99热免费| 99久在线精品99re8| 婷婷五月AV| 色婷婷狠狠爱| 婷婷九月狠狠色| 国外亚洲成AV人片在线观看| 色色色综合网| 久99久99精品免| 色狠狠综合网| 六月五月丁香五月欧美| 久久看婷婷| 天天射天天操天天干| 成人在线99| 成人视频在线免费播放| 久久小片| 久久丁香五月婷婷| 五月婷婷色播网| 丁香五月影视| 亚洲操操| 五月天社区婷婷丁香社区| 九热视频这里只有精品| 色婷婷丁香五月在线| 超碰操网| 五月丁香亭亭操逼| 超碰在线综合| 五月亭大香蕉| 操操日韩| 麻豆精品| 九九热91| 久啪欧美| 97艹| 99资源在线| 久热99中文字幕| 日日做A爰片久久毛片A片英语| 婷婷六月丁| 激情六月婷婷| 99啪| 婷婷五月天激情网| 九月色婷婷| 五月天天综合| 久久人人超| 亚洲性爱电影| 亚洲国产成人在线| 啪啪激情综合| 日本一级一级一级一级| 久久久性爱视频| 丁香五月婷婷影院| 能看的av| 六月丁香深深爱| 黄色大片又大粗又爽| 亚洲综合五月天婷婷丁香| 久综合九| 久操大香蕉| 99视频自拍| 久热九九| 亚洲色婷婷婷婷人人爽| 天天综合网亚洲综合网| 99视频这里有精品免费观看| 日韩无码色色| www.henhenl| 色九月婷婷综合| www..999热久| 九九这里只有精品| 极品人妻VIDEOSSS人妻| 在线超碰免费| 婷婷成人AV| 9精品在线| 99精品在线| 丁香五月在线伊人| www色中色综合| 日日日天天干| 午夜丁香综合婷婷| 来吧亚洲综合网| 极品少妇高潮啪啪AV无码| 日本不卡高字幕在线2019| 91久久国产自产拍夜夜91久久精品文字>91麻豆精品国产 | av第一二区| 欧美在线操| 色 免费网站视频| 九九视频精品这里只有| 九九精品在线观看视频6| 深爱激情综合| 操骚货在线| www.色五月| 97超碰9久热婷婷热| 国产九九一区二区三区| 激情网五夜婷婷| 日日夜夜噜噜爽爽| 操97免费超级视频| 俺也去色| 日本97久久久精品| 日本本土色网第一区| 精品成人无码A片观看香草视频| 五月叮香啪| 丁香五月天堂网| 国产在线aaa片一区二区99| Caoub青青超碰| 91黄址| 婷婷激情综合色五月久久,色婷婷丁香花,丁香婷婷五月情天,久久婷婷五月综合色 | 色婷婷狠狠久久综合五月 | 国产特级毛片AAAAAAA高清| 人五月天婷婷喷水| 色综合久| 色J香五月天| 超碰91在线| 婷婷五月丁香综合亚洲| 五月天色综合| 在热视频精品| 开心五月深爱五月| 日韩情色在线观看| jiujiu无码五区| 最新va在线播放| 五月婷婷大香蕉| 色情五月天导航| 色婷婷久久综合久色| 五月丁香六月婷婷久久| 五月丁香| 梁铮版《蜘蛛女侠》在线| 九九成人视频| 丁香久久久| 色综合久久伊伊婷婷五月| 五月婷婷丁香六月| 97超碰婷婷五月天| 噜噜噜狠狠色综合| 色婷婷视频在线| 狠狠狠婷婷五月综合| www99xxxx五月丁| 色香蕉影院| 婷婷中文字幕| 婷婷五月天日日日干干干| 久久婷婷色综合| 亚洲狠9| 天天综合在线网| 99re思思久久| 思思热热久久| AV九九| 91啪啪| 91久久九色| 久热中文字幕在线线观看| 丁香六月在线| 久久伦乱| 丁香五月婷婷俺也要去| 欧美三级欧美一级| 大香蕉娱乐| 婷婷色情 | www色五月| 激情五月丁香婷婷| 婷婷丁香综合| 成人网丁香五月| 丁香五月婷婷啪啪| 夫妇交换刺激做爰| 久久伊人婷婷| 色婷婷激情四射视频| 另类亚洲电影| 99成人精品视频| 色香蕉精品五夜婷| 蜜桃婷婷丁香五月天狠狠久久综合| 久热婷婷| 色婷婷基地| 伊人久久大香网| 丁香婷婷性久久| 99热这里只有精品青草| 亚洲另类AV| 婷婷综合精品视频97| 97操碰人免费| 天天撸天天干天天插| 婷婷六月激情综合| 六月狠狠综合| 丁香五月婷婷国产在线| 日日爱激情| 怡春院天天干| 五月激情婷婷国产精品久久久久久 | av在线免费网站| AA丁香综合激情| 色射7856五月天激情四射| 五月婷婷六月少妇激情| 99资源人人| 可以看的av| 久久精品系列| 色欲丁香| 色婷婷色五月另类综合| 青青草免费公开视频| 久久五月丁香六月婷| av国产精品| 日韩乱玛久久| 亚洲成人中文字幕| 色婷婷五月综合在线| 五月天丁香综合| av狠狠操| 深爱开心五月天| 婷婷5月久久综合网站| 婷婷五月天日本无码| 99精品久| 狠狠爱婷婷爱| 888精品福利地址| 少妇伦子伦精品无吗| 天天影视色综合网| 五月婷婷导航| 99热在这里只有精品| 久久亚洲网| 婷婷五月丁香青青草在线| 婷婷五月天在线综合| 五月婷婷导航| 日韩无码专区| 婷婷五月天免费视频在线观看| 色综合av超碰| 婷香五月激情视频| 激情色情五月天| 九九九九九九综合| 丁香五月天综合| 99色在线观看| 大香蕉久热| 拍真实国产伦偷精品| 丁香美女主播视频在线观看 | 婷婷色色综合| 婷婷五月丁香五月| bbwcuckold精品熟妇| 丁香操逼| 欧美内射AA| 激情五月com| 67194中文字幕| 亚洲乱码日产精品BD在线观看| 九九热这里只有精品在线观看| 激情综合在线观看| www,奇米影视| 99操视频| 思思国产99| 26uuu青青| 欧美人人草草| 天天操天天干天天日| 色永久| 丁香婷婷人妻| 久草丁香婷婷五月天婷| 无码激情AAAAA片-区区| 激情 婷婷| 五月丁香怕怕综合| 五月天影院婷婷在线观看| 五月天激情婷婷久久| 日韩欧洲亚洲| 国产免费性爱| 182TV亚洲| 99热99思午夜精品| www.99热这里精品| 激情小说婷婷| 97超碰色| 色婷婷WWW| 99精品22| 人妻操逼视频| 99超级超级超级碰| 欧美婷婷六月丁香综合色| 亚洲另类久久| 亚洲操人| 色亭亭九月| 免费黄色视频网址| 五月丁香龟婷婷| 激情五月综合网| 亚洲AV成人无码精品| 久激情网| 亚洲五月色| 人人爱人人草| 五月婷婷六月丁香首页| 久久婷五月综合色| 激情婷婷久久| 久久五月天婷婷| 九九热这里只有精品556| 久久大香蕉视频| 超碰激情五月| 97久久超碰| 五月天综合激情网| 激情第四色| 日韩十国产极品久久| 噜噜在线| 五月伊人网| 五月天激情网图片| 五月婷婷丁香俺日污视频| WWW.夜夜| 五月四色色| 激情五月综合色婷婷| 五月丁香久久网| 97人人干| 成久综合视频| 成人短视频在线观看| 色婷婷免费观看| www.婷婷,com| 97色图片中文字幕视频在线观看 | 亚洲情欲| 欧美丁香婷婷五月| 国产午夜一区二区三区| 狠狠香蕉| 亚洲中文字幕AV| 色婷天天| 天天搡日日搡aaaaⅩ| 亚洲av日韩无码| 91视频精品99| Av九九| 99久久久久久| 五月色婷| 五月激情影视| 亚洲精品无码一区二区| 成人精品视频99在线观看免费| 9999久久久久| 99精品偷自拍| 伊人香大香蕉视频| Caoub青青超碰 | 六月久久狠狠| 五月天网站亭亭| 亚洲综合五月| 丁香色综合| 99欧美| 成功精品影院| 色狠狠色综合久久久绯色aⅴ影视| 日本不卡高字幕在线2019| 嫩草AV久久伊人妇女超级A| 超碰成人黄色网| 色五月激情问网站| 日本WWW九九九| 久久九区| 亚洲婷婷开心五月| 丁香五月综合亚洲| 九九视频在线| www.色婷婷| 国产激情久久| 亚洲操女| 色情五月天。| 婷婷久久欧美| 色狠狠色狠狠| 五月婷婷五月色| 男女99免费视频| 操91| 啪啪九九色| 在线观看亚洲视频影院| site:901-07.com| 甈吧vv| 日日爽夜夜爽| 丁香五月在线播放| 极品人妻VIDEOSSS人妻| 丁香六月婷婷综合| www.av视频xx999.com| 激情五月婷婷| 久久99热这里| 国产精品18久久久| 天天操天天谢| 狠狠爱丁香婷| 色综合久久五月天| 丁香五月综合激情性爱| 丁香婷婷六月天| 久久三级视频| 婷婷色网| 丁香五月在线观看综合| 色色六月| 激情五月天婷婷在线网址发给我| 另类亚洲视频| 91啪啪视频| 五月丁香色色综合| 99久久国产宗和精品1上映| 天天干天天色天天干| 黄色激情久久| 五月丁香六月停停| 五月亭亭六月天| 激情五月天色婷婷综合| 丁香五月婷婷亚洲综合精品| 天搞天天天天天| 五月丁香婷婷啪啪| 亚洲激情精品| 五月丁香免费看| av五月丁香婷婷网| 欧洲亚洲免费视频9| 欧美精品18| 中文字幕无码人妻少妇免费视频| 亚洲熟女乱色综合亚洲网站| www.爱操com.| 久久性爱视频| 99re免费视频| 天天在线久久综合| 4399亚洲视频| 五月天堂六月丁香亚州中文字幕久久| 亚洲国产精品五月天| 欧美色性色好| 五月天sesese| 亚洲日本激情| 99热爱爱干干日| 9久热视频| 五月天a婷婷伊人| 亚洲综合九九| 久久香蕉婷婷| 另类综合国产| www久| 婷婷爱爱蜜臀天天操| 思思久久青草热| 亚洲综合色婷婷| 啪啪丁香五月| 亚洲色爱综合| 香蕉久操| 激情婷婷综合| 亚洲精品大片| 五月综合丁香婷婷| 五月丁香在线观看| 99在线视频观看| 成人婷婷五月天| 久久机热/这里只有精品| 亚洲99在线| 五月天婷婷影院影院观看| 欧美色片中文字幕久久久久| 亚洲综合视频天天精品| 色综合色五月| 婷婷久久性爱| 色五婷婷在线视频| 激情五月婷色| 玖玖福利视频资源| 成人国产欧美大片一区| 亚洲欧洲99| 26uuu欧美日本| 日韩啪啪视频| 久久综合网桃花| 国产玖玖资源| 大香蕉福利导航| 激情五月婷婷在线区| 99久视频| 第2色五月婷| 亚洲激情另类| 婷婷在线观看五月天在线视频| a在线观看| 日韩性视频| 亚洲 视频 导航 一区| 无码动漫av| 五月丁香综合影院| 婷婷五月丁香欧洲| 婷婷激情五月| 91婷婷搞| 97久久超碰| 91狠狠综合久久| 99热国产这里只有精品| 人妻狠狠操| 欧美性爱五月天| 久久这里在精品视频| 丁香六月婷婷久久综合| xx色综合| 青草视频在线观看视频| 开心五月丁香啪| 中文超碰视在线| www.国产色| av在线免费网站 | 好吊丝aV| 婷婷的五月天另类视频| 久久精品66| 色综合久久无码| 日日夜夜狠狠| 久久综合五月天| 热99在线| 婷婷 激情 五月| 级人人91| 激情第四色| 久久久91| 国产精产国品一二三在观看 | 五月丁香成人网| 亚洲爱爱无码婷婷色五月| 婷婷D区| 色色射| 99色视频在线观看最新| 婷婷五月天成人| 玖操97| 国产操逼网站| 99热日韩| 色婷婷五月天激情久久| 丁香八月综合激情| 91青娱乐青青草| 日韩色色小视频| 屁股翘好撅高迎合跪趴| 久机视频这只有精品| 欧美日本黄色| 六月丁香五月婷婷| 久热视频这里只有精品| 久婷婷婷| 国产AV一区二区三区最新精品 | xxxx久| 5月丁香婷婷| 日美三级| www超碰| 天天综合亚洲综合| 中文字幕成| 99性爱视频| 日本婷婷色日| 开心久久xxx色| 影音先锋五月天婷婷丁香在线观看| 久久五月天色婷婷| 丁香五月第九色| 操逼国产91| 五月丁香网站| 婷婷五月天在线视频网站| 久久久久久天天日天天爱| 超级碰 久久9| 另类图片五月天| 九九热只有精品| 激情五月天噢美| 五月丁香六月婷婷激情四射| 色无码| 亚洲精品激情| 亚洲激情网站无码| 99er热精品视频| AA片在线观看视频在线播放| 六月婷婷激情| 五月丁香狠狠爱婷婷综合| 九九色之九九色之88| 色爆五月| AA丁香综合激情| 日韩AV大全| 久久久色婷婷五月天| 九九激情视频| 亚洲亚洲人成综合网络| 日本综合色色| 激情www| 伊人在线婷婷草| 成人 在线 日韩| 东京热人妻一区二区三区在线| 五月婷婷六月色| 涩综合网| 婷婷成人五月天成人文学小说| bbwcuckold精品熟妇| 五月丁香自拍| 69久久久| 中文字幕 中文字幕明步| 婷婷综合网站| 丁香婷婷六月男男| 婷婷香五月综合激情| 五月丁香综合啪啪啪啪啪| www久久艹| 国产三级在线播放| 五月网站| 五月天精品| 亚洲成人免费在线| 狠狠干在线| 99精色| 婷婷涩五月天综合| 日韩抽插操逼| 丁香色五月婷婷17C| 丁香五婷婷| 中文字幕婷婷在线| 亚洲182在线观看| 成人无码髙潮喷水A片| 丁香五月综合| 96精品久久久久久久久| 综合久久99| 79色色色色| 婷婷五月天a| 岛国av网| 99热国产国产| 婷婷久久综合| www.五月婷婷| 97碰人人操| 激情久久丁香| 中文字幕婷婷在线| 影院久久久| 色呦呦在线| 久久久宗合视频88| 婷婷五月天97干| 国产精品久久久爽爽爽麻豆色哟哟| 色偷偷五月天| 播播网色播播| 激情综合网五月| 99热在线看| 婷婷色五月天在线观看| 亚洲精品视频在线| 婷婷99狠狠| 99久久婷婷国产综合精品草原| 五月婷婷六月天| 亚州色婷婷| 日韩九九| 午夜大香蕉| 亚洲视频在线观看| 精品成人无码A片观看香草视频| 五月婷婷影院| 欧美色男人网站| 99精品丁香五月| 婷婷伊人综合| 亚洲AV永久无码影院黑人| 99视频在线观看视频| www.99热这里精品 | 超碰人妻公开在线| 九月丁香久久网| 嘿嘿视频免费看9| 月色色综合婷婷网| 九九大香视频| 国产成人+综合亚洲+天堂| 四月婷婷五月色综合| 激情深爱综合| 激情久久五月网| 五月丁香激情欧洲啪啪| 五月丁香婷婷六月| 先锋资源91| 九九免费视频| 国产一区二区三区影院| 99五月香婷婷丁香在线视频| 超碰一区二区| 欧美大道不卡| 国产亚洲色婷婷久久99精品91| 六月丁香成人| 日日操,夜夜撸| 色五月人妻| 91性高潮久久久久久久久| 99熟女| 五月婷婷 婷婷五月 一区二区 久久久| 伊人在线大香蕉网| 日韩成人电影在线播放| sesesesezonghe| 人妻操在线看| 99热在线观看| 欧美性爱五月天| 碰99在线| 日本天堂爱爱| 热的国产,热的综合,热的有码| 丁香激情婷婷网| 国产成人高清| 99热久久这里只有精品| 91丁香婷婷综合久久欧美| 91碰超| 538久久| av人人干| 狠狠操狠狠| 丁香五月天影院| 五月丁香无码| 99在线视频在线观看| 五月天色婷婷综合| 五月丁香六月激情| 婷婷狠狠干| 色色丁香婷婷综合| 狠狠色狠狠色综合日日91| 婷婷丁香五月激情密臀av| 五月丁香综合网| 色色丁香五月天社区| 色五月综合婷婷久久综合婷婷久久综合婷婷久久综合婷婷久久 | 激情五月综合婷婷| 婷婷五月天综合久久日美女| 婷婷伊人久久| 国内精品玖玖| 91日韩在线| 淫视馆av三区| 怡红院 久久| 毛片毛片毛片毛片| 色九月| 新男人天堂人妻| 狠狠看狠狠| 天天舔天天爽| 国产乱子轮XXX农村| 久久婷婷国产| 夜夜做夜夜愛| 色99色| 久久大香蕉伊人| 五月婷婷六月激情在线| 亚洲综合视频网| 热久久999| 欧美天天爽| 丁香五月天堂网| 欧美私人家庭影院| 激情综合色网| 直接看的av| 五月婷婷爽爽爽| 激情小说五月天| 99热这里只有精品在线| 免费看欧美成人A片无码| 五月丁香婷草| 五月婷婷丁香在线| AA片在线观看视频在线播放| 日韩久热| 五月婷婷激情综合网| 欧类av怡春院| 欧美A级网站| 丁香五月成人| 欧美日韩色色| 深爱激情AV| 超碰狠狠操| 极品另类| 亚洲激情97五月天| 无码免费人妻A片AAA毛片西瓜| 伊人久久五月天| 91久久电影| 综合久久综合综合| 丁香丝袜五月| 久久精品在线| 成人在线日韩| 色在线99| 日日干天天爽| 中文字幕成人版| 丁香五月天婷婷中文| 思思久久精品| 国产成人av在线| 国产成人高清| 正宗黄色毛片| 精品久久久久久久人妻| 婷婷成人基地| 亚洲丁香婷婷五月天综合色| 美女婷婷六月色| 婷婷色成人| 北条麻妃九九九国产精品视频| 五月天婷婷一起草| 无码任你操| 色~性~乱~伦~噜| 国产激情在线| 日韩久综合| 综合噜噜| 五月婷免费视频| 色五月婷婷五月天激情综合| 亚洲天堂色| 五月丁香六月婷婷久久久综合| 777精品久无码人妻蜜桃| 亚洲精品乱码久久久久久综合| 六月激情网| 密黄站| a在线观看| 激情综合5月| 婷婷丁香五月综合| WWW丁香五月| 五月丁香婷婷色| 亚州激情在线视频| 久久精品99国产精品日本| 激情五月综亚网| 久久caop| 五月激情黄色小说| www.第四色99| 婷婷五月天在线综合| 五月天婷婷丁香人人操91| 99热在这里只有精品| 91岛国片| 久综合| 91啪啪视频| 婷婷丁香六月| 九月婷婷综合八月丁香在线观看| 青青青在线视频国产| 人妻熟妇六区| 伊人99久久| 天天干电影| 五月丁香无码| 九色视频91| 九九视频精品在线免费| 国成人网| 色噜噜狠噜噜视频| 五月丁香色| 久草五月| 性色99| 草榴视频网| 激情五月婷婷综合| 久色成人| 91丁香色五月| 久久伊人9| 欧美va亚洲va| 牛牛澡牛牛爽| 天天色视频| 99久久久免费| 99在线精品免费视频| 天天搞天天色综合| 99碰| 色婷婷基地| 淫荡工a| 五月激情射| 九九视频在线观看| 人人干AV| 大香蕉九九操| 色99视频| 丁香六月激情网C0W| 国产成人AV在线播放| www.天天干| www.五月瑟| 啊V视频在线观看| 久久在线视频免费观看| 天天干夜晚夜操| 天天爽夜夜爽夜夜爽精品| 婷婷五月天VI| 午夜爱爱网站| 深爱激情AV| 91视频人人做97| AV九九| 久久婷婷六月综合综合色| 色噜噜狠狠色综合无码久久欧美| 亚洲三A| 激情五月婷| 天天粽合合合合| 欧美日韩国产一区二区| www.超碰| 色五月五月天色婷婷色五月| 五月激情婷婷图片基地| www.玖玖婷婷在线|