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

ARTICLE DETAIL

資訊詳情

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

數(shù)學(xué)建模實(shí)戰(zhàn):純方位無源定位原理與無人機(jī)協(xié)同定位算法解析

數(shù)學(xué)建模實(shí)戰(zhàn):純方位無源定位原理與無人機(jī)協(xié)同定位算法解析 1. 從“純方位無源定位”說起一個(gè)經(jīng)典的數(shù)學(xué)建模難題去年帶學(xué)生打數(shù)模B題“無人機(jī)遂行編隊(duì)飛行中的純方位無源定位”一出來我們團(tuán)隊(duì)就意識(shí)到這絕對(duì)是個(gè)硬骨頭。它不像一些優(yōu)化題有現(xiàn)成的算法庫(kù)可以調(diào)包也不像一些數(shù)據(jù)分析題可以靠統(tǒng)計(jì)模型和可視化出彩。這道題的核心是把一個(gè)經(jīng)典的軍事或偵察領(lǐng)域的“無源定位”問題抽象成了一個(gè)純粹的、優(yōu)美的數(shù)學(xué)問題然后要求你用編程去求解。很多隊(duì)伍看到“無人機(jī)”、“編隊(duì)”這些詞可能會(huì)去查路徑規(guī)劃、協(xié)同控制的文獻(xiàn)但實(shí)際上這道題的靈魂在于“純方位”和“無源”這兩個(gè)詞?!盁o源”意味著被動(dòng)接收不主動(dòng)發(fā)射信號(hào)就像潛艇只靠聽聲吶來判斷敵艦位置或者像我們只通過聽聲音來判斷聲源方向。“純方位”則意味著你獲得的信息只有方向角比如方位角、俯仰角而沒有距離信息。想象一下你在茫茫大海上只知道遠(yuǎn)處有一艘船在你的東北方向但不知道它離你有多遠(yuǎn)這就是一個(gè)“純方位”信息。單個(gè)觀測(cè)點(diǎn)僅憑一個(gè)方向是無法確定目標(biāo)位置的因?yàn)槟繕?biāo)可能在這條方向線上的任何一點(diǎn)。這就是問題的第一個(gè)難點(diǎn)信息不足解不唯一。那么如何解決呢這就是數(shù)學(xué)建模的魅力所在。當(dāng)你有多個(gè)觀測(cè)點(diǎn)多架無人機(jī)從不同位置對(duì)同一個(gè)目標(biāo)進(jìn)行“純方位”觀測(cè)時(shí)這些方向線就會(huì)在空間中相交或最接近相交。理論上兩條方向線的交點(diǎn)就是目標(biāo)的位置。但現(xiàn)實(shí)中測(cè)量總有誤差這些方向線往往不會(huì)精確交于一點(diǎn)而是會(huì)形成一個(gè)誤差區(qū)域。此時(shí)問題就轉(zhuǎn)化為如何根據(jù)多條帶有噪聲的方向線最優(yōu)地估計(jì)出目標(biāo)的位置這本質(zhì)上是一個(gè)非線性優(yōu)化問題或者更具體地說是一個(gè)“多點(diǎn)交叉定位”問題。無人機(jī)編隊(duì)飛行的場(chǎng)景則為這個(gè)問題增加了動(dòng)態(tài)和約束的維度。無人機(jī)不是靜止的觀測(cè)站它們自身也在按一定隊(duì)形比如錐形運(yùn)動(dòng)。它們對(duì)未知位置信號(hào)源的觀測(cè)是在運(yùn)動(dòng)過程中連續(xù)進(jìn)行的。這帶來了兩個(gè)層面的挑戰(zhàn)一是幾何層面如何利用運(yùn)動(dòng)帶來的觀測(cè)角度變化改善定位精度這類似于三角測(cè)量中基線越長(zhǎng)精度越高二是計(jì)算層面如何設(shè)計(jì)算法能夠處理時(shí)序上的觀測(cè)數(shù)據(jù)并可能預(yù)測(cè)目標(biāo)的運(yùn)動(dòng)狀態(tài)。題目要求保持編隊(duì)隊(duì)形意味著無人機(jī)之間的相對(duì)位置是受約束的這個(gè)約束條件在建模時(shí)可能成為簡(jiǎn)化問題的關(guān)鍵也可能成為優(yōu)化算法需要滿足的邊界條件。所以面對(duì)這道題解題的脈絡(luò)應(yīng)該是清晰的首先深入理解“純方位無源定位”的幾何與數(shù)學(xué)模型其次針對(duì)靜態(tài)或動(dòng)態(tài)目標(biāo)設(shè)計(jì)相應(yīng)的狀態(tài)估計(jì)或優(yōu)化算法然后將無人機(jī)編隊(duì)運(yùn)動(dòng)的約束融入算法之中最后通過編程題目附Python代碼說明實(shí)現(xiàn)是重要評(píng)分點(diǎn)進(jìn)行仿真驗(yàn)證分析算法的精度、收斂性和魯棒性。接下來我就結(jié)合我們當(dāng)時(shí)的解題思路和后續(xù)的反思拆解一下其中的核心環(huán)節(jié)、易錯(cuò)點(diǎn)以及代碼實(shí)現(xiàn)上的技巧。2. 問題拆解從幾何原理到數(shù)學(xué)模型拿到這種問題切忌一上來就找算法、寫代碼。第一步必須是問題拆解和數(shù)學(xué)建模把物理世界的問題翻譯成數(shù)學(xué)語(yǔ)言。我們把它分成了幾個(gè)層次來思考。2.1 核心幾何模型兩條直線確定一個(gè)點(diǎn)在最理想的無噪聲情況下假設(shè)我們有兩個(gè)觀測(cè)站無人機(jī)U1和U2坐標(biāo)分別為(x1, y1, z1)和(x2, y2, z2)。它們探測(cè)到一個(gè)信號(hào)源T測(cè)得的方位角例如以正北為0度順時(shí)針增大分別為α1和α2。這里我們先考慮二維平面情況簡(jiǎn)化問題。對(duì)于觀測(cè)站U1目標(biāo)T必然位于一條射線上(x, y) (x1 r1 * sin(α1), y1 r1 * cos(α1))其中r1 0是未知的距離。同理對(duì)于U2目標(biāo)位于(x, y) (x2 r2 * sin(α2), y2 r2 * cos(α2))。兩條射線的交點(diǎn)即為目標(biāo)T。求解兩個(gè)方程即可得到T的坐標(biāo)(x, y)。這是初中幾何的知識(shí)。但一旦引入測(cè)量誤差α1和α2就變成了α1Δ1和α2Δ2兩條射線很可能不再相交。此時(shí)我們就需要尋找一個(gè)點(diǎn)T(x, y)使得它到兩條射線的“距離”之和最小。這個(gè)“距離”可以定義為該點(diǎn)到每條射線所在直線的垂直距離但更常見的做法是考慮角度殘差。我們可以定義目標(biāo)函數(shù)為F(x, y) [atan2(y-y1, x-x1) - α1]^2 [atan2(y-y2, x-x2) - α2]^2。通過最小化F(x, y)來估計(jì)T。這就把一個(gè)幾何問題轉(zhuǎn)化成了一個(gè)非線性最小二乘優(yōu)化問題。注意這里有一個(gè)關(guān)鍵細(xì)節(jié)。atan2函數(shù)的值域是(-π, π]而方位角測(cè)量值通常是[0, 2π)。在計(jì)算角度差時(shí)必須處理角度環(huán)繞問題例如359度與1度的差應(yīng)該是2度而不是358度。一個(gè)穩(wěn)妥的做法是delta abs(measured - calculated);delta min(delta, 2*pi - delta)。忽略這一點(diǎn)優(yōu)化算法很容易陷入局部最優(yōu)或無法收斂。2.2 從二維到三維俯仰角的引入題目中的“純方位”在三維空間中通常包含兩個(gè)角方位角azimuth和俯仰角elevation。俯仰角定義了目標(biāo)與觀測(cè)站連線與當(dāng)?shù)厮矫娴膴A角。這樣觀測(cè)方程就變成了方位角φ_i atan2(y_t - y_i, x_t - x_i)俯仰角θ_i atan2(z_t - z_i, sqrt((x_t - x_i)^2 (y_t - y_i)^2))此時(shí)每個(gè)觀測(cè)站提供兩個(gè)約束方程但未知數(shù)仍然是目標(biāo)的三維坐標(biāo)(x_t, y_t, z_t)。理論上兩個(gè)觀測(cè)站提供4個(gè)方程就可以求解3個(gè)未知數(shù)是超定的有利于抗噪聲。目標(biāo)函數(shù)相應(yīng)地變?yōu)樽钚』轿唤呛透┭鼋菤埐畹钠椒胶汀?.3 動(dòng)態(tài)場(chǎng)景與濾波思想如果目標(biāo)是移動(dòng)的題目未明確但編隊(duì)飛行中定位靜態(tài)或動(dòng)態(tài)信號(hào)源是常見場(chǎng)景問題就升級(jí)為“跟蹤”而不僅僅是“定位”。這時(shí)我們不僅關(guān)心當(dāng)前時(shí)刻的位置還關(guān)心目標(biāo)的運(yùn)動(dòng)狀態(tài)速度、加速度。觀測(cè)數(shù)據(jù)是隨時(shí)間序列到來的。一個(gè)自然而強(qiáng)大的工具就是卡爾曼濾波器Kalman Filter, KF或其非線性變種如擴(kuò)展卡爾曼濾波器EKF、無跡卡爾曼濾波器UKF。我們需要建立目標(biāo)的運(yùn)動(dòng)模型例如勻速直線運(yùn)動(dòng)CV模型、勻加速運(yùn)動(dòng)CA模型和觀測(cè)模型即上一節(jié)的幾何關(guān)系。運(yùn)動(dòng)模型用于預(yù)測(cè)目標(biāo)下一時(shí)刻的狀態(tài)觀測(cè)模型則用新的方位/俯仰角測(cè)量值來修正預(yù)測(cè)。對(duì)于“純方位”觀測(cè)觀測(cè)模型是非線性的atan2和sqrt函數(shù)所以通常使用EKF或UKF。EKF通過對(duì)非線性函數(shù)進(jìn)行一階泰勒展開來線性化實(shí)現(xiàn)簡(jiǎn)單但強(qiáng)非線性時(shí)誤差大。UKF采用一組精心選取的采樣點(diǎn)Sigma點(diǎn)來近似狀態(tài)分布精度更高但計(jì)算量稍大。在數(shù)模競(jìng)賽中如果時(shí)間緊張實(shí)現(xiàn)一個(gè)EKF是性價(jià)比很高的選擇。如果追求精度可以嘗試UKF。2.4 編隊(duì)約束的利用題目背景是無人機(jī)遂行編隊(duì)飛行。這意味著無人機(jī)之間的相對(duì)位置關(guān)系是已知的或者滿足某種幾何約束如保持固定的相對(duì)距離和角度構(gòu)成一個(gè)錐形隊(duì)形。這個(gè)約束非常寶貴。第一種利用方式簡(jiǎn)化問題。如果我們假設(shè)編隊(duì)是剛性的那么整個(gè)編隊(duì)可以看作一個(gè)整體在運(yùn)動(dòng)。在定位外部靜態(tài)信號(hào)源時(shí)我們可以將編隊(duì)的幾何中心或某一架領(lǐng)航無人機(jī)作為參考點(diǎn)。其他無人機(jī)相對(duì)于該參考點(diǎn)的位置是已知的。這樣所有無人機(jī)對(duì)信號(hào)源的觀測(cè)可以等價(jià)地轉(zhuǎn)換到參考點(diǎn)處的“虛擬觀測(cè)”。不過這種轉(zhuǎn)換需要謹(jǐn)慎因?yàn)榉轿唤切畔⒃谧鴺?biāo)變換下并非線性不變。第二種利用方式作為優(yōu)化約束。在構(gòu)建優(yōu)化模型估計(jì)目標(biāo)位置時(shí)可以將無人機(jī)必須保持編隊(duì)隊(duì)形作為約束條件。例如在估計(jì)目標(biāo)位置的同時(shí)還需要保證無人機(jī)在調(diào)整位置以獲取更好觀測(cè)角度時(shí)彼此間的距離保持在某個(gè)范圍內(nèi)。這會(huì)使問題變成一個(gè)帶約束的非線性優(yōu)化問題復(fù)雜度陡增。在數(shù)模競(jìng)賽有限的時(shí)間內(nèi)除非有很好的簡(jiǎn)化技巧否則不建議走這條復(fù)雜的路。更務(wù)實(shí)的思路是先假設(shè)編隊(duì)按預(yù)定軌跡飛行在此過程中采集數(shù)據(jù)專注于解決定位算法本身。3. 算法選型與核心步驟實(shí)現(xiàn)理論清晰后就需要選擇具體的算法并實(shí)現(xiàn)。題目附了Python代碼我們這里討論其核心邏輯和可能的不同實(shí)現(xiàn)路徑。3.1 靜態(tài)目標(biāo)定位非線性最小二乘法對(duì)于靜態(tài)目標(biāo)最直接的方法是批處理Batch Processing所有時(shí)刻的觀測(cè)數(shù)據(jù)用一個(gè)非線性最小二乘優(yōu)化一次性估計(jì)目標(biāo)位置。scipy.optimize模塊中的least_squares或minimize函數(shù)是利器。步驟數(shù)據(jù)準(zhǔn)備假設(shè)有M架無人機(jī)在N個(gè)時(shí)刻進(jìn)行了觀測(cè)。每個(gè)觀測(cè)是一個(gè)三元組(無人機(jī)ID, 時(shí)間戳, 方位角 俯仰角)。同時(shí)我們需要知道每個(gè)無人機(jī)在每個(gè)時(shí)刻的精確位置(x, y, z)。這通常由編隊(duì)飛行控制系統(tǒng)給出或根據(jù)隊(duì)形推算。定義殘差函數(shù)這是最關(guān)鍵的一步。函數(shù)輸入是待估計(jì)的目標(biāo)位置p [x, y, z]輸出是所有觀測(cè)殘差組成的數(shù)組。def residuals(p, observations, drone_positions): # p: 目標(biāo)猜測(cè)位置 [x, y, z] # observations: 列表每個(gè)元素為 (drone_idx, azimuth, elevation) # drone_positions: 字典或列表 drone_idx - 該時(shí)刻該無人機(jī)的位置 (x, y, z) res [] for drone_idx, az_meas, el_meas in observations: drone_pos drone_positions[drone_idx] dx, dy, dz p[0] - drone_pos[0], p[1] - drone_pos[1], p[2] - drone_pos[2] # 計(jì)算理論方位角和俯仰角 az_calc np.arctan2(dy, dx) # 注意atan2(y, x)的順序這里與方位角定義對(duì)應(yīng) el_calc np.arctan2(dz, np.sqrt(dx*dx dy*dy)) # 處理角度環(huán)繞計(jì)算殘差 az_error angle_diff(az_meas, az_calc) el_error angle_diff(el_meas, el_calc) res.extend([az_error, el_error]) # 將兩個(gè)殘差都加入 return np.array(res) def angle_diff(a, b): # 計(jì)算兩個(gè)角度之間的最小差值考慮2π環(huán)繞 diff a - b return np.arctan2(np.sin(diff), np.cos(diff)) # 巧妙利用三角函數(shù)等價(jià)于 diff (diff pi) % (2*pi) - pi調(diào)用優(yōu)化器使用least_squares優(yōu)化殘差平方和。from scipy.optimize import least_squares # 初始猜測(cè)很重要可以取所有無人機(jī)位置的中心或者用前兩個(gè)觀測(cè)站粗略交會(huì)得到一個(gè)初始點(diǎn) initial_guess np.mean(list(drone_positions.values()), axis0) # 簡(jiǎn)單取均值 result least_squares(residuals, initial_guess, args(observations, drone_positions), methodlm) # Levenberg-Marquardt算法 estimated_position result.x結(jié)果評(píng)估檢查result.cost最終殘差平方和和result.optimality優(yōu)化條件來判斷求解質(zhì)量。也可以計(jì)算定位誤差的幾何稀釋精度GDOP理論下界Cramer-Rao Lower Bound, CRLB作為參考。實(shí)操心得初始猜測(cè)值initial_guess對(duì)非線性優(yōu)化至關(guān)重要。一個(gè)糟糕的初值可能導(dǎo)致算法收斂到局部最優(yōu)甚至發(fā)散。除了用無人機(jī)位置均值一個(gè)更穩(wěn)健的方法是隨機(jī)選取兩架無人機(jī)在不同時(shí)刻的觀測(cè)用無噪聲情況下的幾何交會(huì)公式計(jì)算出一個(gè)粗略解多算幾次取平均作為初值。此外least_squares的method參數(shù)可以選擇‘trf’信賴域反射法或‘lm’列文伯格-馬夸爾特法。對(duì)于中小規(guī)模問題‘lm’通常很快但它不能處理邊界約束。如果知道目標(biāo)可能位于某個(gè)區(qū)域如地面以上可以使用‘trf’并添加bounds參數(shù)。3.2 動(dòng)態(tài)目標(biāo)跟蹤擴(kuò)展卡爾曼濾波器EKF實(shí)現(xiàn)如果目標(biāo)是運(yùn)動(dòng)的EKF是一個(gè)標(biāo)準(zhǔn)且有效的選擇。我們需要定義狀態(tài)向量、運(yùn)動(dòng)模型和觀測(cè)模型。狀態(tài)向量通常包含位置和速度例如X [x, y, z, vx, vy, vz]^T。運(yùn)動(dòng)模型狀態(tài)轉(zhuǎn)移模型假設(shè)目標(biāo)勻速運(yùn)動(dòng)CV模型。X_{k|k-1} F * X_{k-1|k-1} w_k其中狀態(tài)轉(zhuǎn)移矩陣F [[I, Δt*I], [0, I]]I是3x3單位矩陣Δt是時(shí)間間隔。w_k是過程噪聲服從零均值高斯分布協(xié)方差為Q。Q矩陣體現(xiàn)了我們對(duì)模型不確定性的認(rèn)知通常根據(jù)目標(biāo)可能的最大加速度來設(shè)置。觀測(cè)模型即前面提到的方位角和俯仰角計(jì)算函數(shù)h(X)它是一個(gè)非線性函數(shù)。Z_k h(X_{k|k-1}) v_k其中v_k是觀測(cè)噪聲協(xié)方差為R。R由傳感器的測(cè)量精度決定例如方位角標(biāo)準(zhǔn)差為0.5度。EKF核心步驟預(yù)測(cè)狀態(tài)預(yù)測(cè)X_{k|k-1} F * X_{k-1|k-1}誤差協(xié)方差預(yù)測(cè)P_{k|k-1} F * P_{k-1|k-1} * F^T Q更新計(jì)算觀測(cè)殘差y_k Z_k - h(X_{k|k-1})計(jì)算觀測(cè)矩陣HH是觀測(cè)函數(shù)h在預(yù)測(cè)狀態(tài)X_{k|k-1}處的雅可比矩陣。這是EKF線性化的關(guān)鍵。# 計(jì)算H矩陣的示例代碼片段 dx, dy, dz x_pred - x_drone, y_pred - y_drone, z_pred - z_drone rho2 dx*dx dy*dy rho np.sqrt(rho2) r np.sqrt(rho2 dz*dz) # 對(duì)方位角az atan2(dy, dx)求偏導(dǎo) daz_dx -dy / rho2 daz_dy dx / rho2 daz_dz 0.0 # 對(duì)俯仰角el atan2(dz, rho)求偏導(dǎo) del_dx - (dx * dz) / (r * r * rho) del_dy - (dy * dz) / (r * r * rho) del_dz rho / (r * r) # H矩陣中對(duì)應(yīng)位置狀態(tài)的偏導(dǎo)速度狀態(tài)的偏導(dǎo)為0 H np.array([[daz_dx, daz_dy, daz_dz, 0, 0, 0], [del_dx, del_dy, del_dz, 0, 0, 0]])計(jì)算卡爾曼增益K_k P_{k|k-1} * H^T * (H * P_{k|k-1} * H^T R)^{-1}更新狀態(tài)估計(jì)X_{k|k} X_{k|k-1} K_k * y_k更新誤差協(xié)方差P_{k|k} (I - K_k * H) * P_{k|k-1}實(shí)現(xiàn)要點(diǎn)數(shù)據(jù)關(guān)聯(lián)在多目標(biāo)場(chǎng)景下需要解決哪個(gè)觀測(cè)來自哪個(gè)目標(biāo)的問題。本題是單目標(biāo)此問題不存在。濾波器初始化EKF需要初始狀態(tài)X0和初始協(xié)方差P0。X0可以用前幾個(gè)時(shí)刻的觀測(cè)通過靜態(tài)定位方法粗略估計(jì)。P0可以設(shè)為一個(gè)較大的對(duì)角矩陣表示初始不確定性很大。R和Q的調(diào)參這兩個(gè)噪聲協(xié)方差矩陣是濾波器的“旋鈕”。R相對(duì)容易根據(jù)傳感器說明書設(shè)定。Q的調(diào)節(jié)更藝術(shù)一些Q越大濾波器越信任新觀測(cè)響應(yīng)更快但可能更震蕩Q越小濾波器越信任模型更平滑但可能滯后。需要在仿真中根據(jù)目標(biāo)機(jī)動(dòng)性進(jìn)行調(diào)整。3.3 編隊(duì)飛行軌跡與觀測(cè)數(shù)據(jù)的生成為了測(cè)試算法我們需要模擬生成無人機(jī)編隊(duì)的飛行軌跡和對(duì)應(yīng)的觀測(cè)數(shù)據(jù)。這是驗(yàn)證算法是否work的第一步。生成編隊(duì)軌跡假設(shè)一個(gè)參考點(diǎn)編隊(duì)中心沿預(yù)定路徑如直線、曲線運(yùn)動(dòng)。根據(jù)錐形編隊(duì)的幾何描述計(jì)算出每架無人機(jī)相對(duì)于編隊(duì)中心的位置偏移量。將偏移量加到編隊(duì)中心的軌跡上得到每架無人機(jī)自身的軌跡pos_i(t)。生成觀測(cè)數(shù)據(jù)帶噪聲假設(shè)目標(biāo)真實(shí)軌跡為target_pos(t)。對(duì)于每個(gè)時(shí)刻t和每架無人機(jī)i根據(jù)target_pos(t)和pos_i(t)計(jì)算真實(shí)的方位角az_true和俯仰角el_true。加入高斯白噪聲模擬測(cè)量誤差az_meas az_true np.random.normal(0, sigma_az)el_meas同理。注意角度噪聲的標(biāo)準(zhǔn)差sigma應(yīng)以弧度為單位。將(t, i, az_meas, el_meas)存儲(chǔ)為觀測(cè)數(shù)據(jù)集。踩坑提醒在模擬觀測(cè)時(shí)務(wù)必注意角度值的范圍。atan2輸出的方位角范圍是(-π, π]而你的觀測(cè)模型和殘差計(jì)算函數(shù)必須保持一致。添加噪聲后角度值可能超出(-π, π]需要規(guī)整到該區(qū)間內(nèi)??梢允褂胣p.mod(angle np.pi, 2*np.pi) - np.pi。4. 精度分析、優(yōu)化與常見問題排查算法跑通只是第一步更重要的是分析其性能并思考如何優(yōu)化。在數(shù)模論文中這一部分是體現(xiàn)思考深度的關(guān)鍵。4.1 精度評(píng)價(jià)與幾何稀釋精度GDOP定位精度不僅取決于測(cè)量噪聲還與觀測(cè)幾何密切相關(guān)。這個(gè)概念就是幾何稀釋精度。直觀理解如果多架無人機(jī)和信號(hào)源幾乎在一條直線上那么方向線的交叉角度很小定位誤差就會(huì)被放大。反之如果無人機(jī)圍繞信號(hào)源分布方向線交叉角度大定位精度就高。GDOP可以通過Fisher信息矩陣FIM的逆即CRLB矩陣來計(jì)算。對(duì)于純方位定位給定目標(biāo)位置和無人機(jī)位置可以推導(dǎo)出方位角和俯仰角測(cè)量對(duì)目標(biāo)位置估計(jì)的CRLB。CRLB的跡trace的平方根給出了位置估計(jì)誤差標(biāo)準(zhǔn)差的理論下界。我們可以繪制GDOP等高線圖直觀展示在任務(wù)區(qū)域內(nèi)哪些位置的定位精度天生就好哪些位置就差。這能為編隊(duì)路徑規(guī)劃提供指導(dǎo)讓編隊(duì)盡可能飛經(jīng)GDOP低的區(qū)域以提高定位精度。在仿真中我們可以將算法估計(jì)位置的標(biāo)準(zhǔn)差與CRLB下界進(jìn)行比較。如果算法性能接近CRLB說明它已經(jīng)是最優(yōu)/準(zhǔn)最優(yōu)估計(jì)器了。如果差距較大說明算法還有優(yōu)化空間或者觀測(cè)幾何太差GDOP太大。4.2 算法優(yōu)化與改進(jìn)思路初始值魯棒性優(yōu)化如前所述非線性優(yōu)化對(duì)初值敏感??梢圆捎枚嗥瘘c(diǎn)初始化策略隨機(jī)生成多個(gè)初始猜測(cè)點(diǎn)分別進(jìn)行優(yōu)化選擇最終殘差最小的解作為輸出。雖然計(jì)算量增加但大大提高了找到全局最優(yōu)解的概率??挂爸堤幚韺?shí)際測(cè)量中可能存在粗大誤差野值??梢栽谧钚《酥胁捎敏敯魮p失函數(shù)如Huber損失或Cauchy損失代替平方損失。scipy.optimize.least_squares可以通過loss參數(shù)指定這些魯棒函數(shù)。利用時(shí)序信息的批處理優(yōu)化對(duì)于靜態(tài)目標(biāo)我們使用了所有時(shí)刻的觀測(cè)數(shù)據(jù)進(jìn)行批處理優(yōu)化。對(duì)于慢動(dòng)或勻速運(yùn)動(dòng)的目標(biāo)可以假設(shè)其在短時(shí)間內(nèi)位置變化不大采用滑動(dòng)窗口批處理。例如始終使用最近10秒的數(shù)據(jù)進(jìn)行優(yōu)化實(shí)現(xiàn)“準(zhǔn)實(shí)時(shí)”定位同時(shí)平滑噪聲。更高級(jí)的濾波算法如果EKF性能不滿足要求特別是在強(qiáng)非線性或非高斯噪聲下可以考慮無跡卡爾曼濾波器UKF或粒子濾波器PF。UKF精度通常優(yōu)于EKF實(shí)現(xiàn)也不復(fù)雜。PF則適用于任何非線性非高斯模型但計(jì)算成本最高。在數(shù)模競(jìng)賽中實(shí)現(xiàn)UKF是一個(gè)很大的亮點(diǎn)。融合其他微弱信息題目是“純方位”但現(xiàn)實(shí)中可能有一些先驗(yàn)信息。例如信號(hào)源可能在地面z0或者高度在一定范圍內(nèi)。將這些信息作為約束條件加入優(yōu)化或?yàn)V波過程例如使用狀態(tài)約束卡爾曼濾波可以顯著提高精度和穩(wěn)定性。4.3 仿真調(diào)試與問題排查指南在實(shí)現(xiàn)算法時(shí)一定會(huì)遇到各種問題。以下是一些常見的坑和排查思路問題優(yōu)化算法不收斂或者收斂到一個(gè)明顯錯(cuò)誤的位置。排查1檢查殘差函數(shù)是否正確。最有效的方法是進(jìn)行梯度檢查。在初始猜測(cè)點(diǎn)附近手動(dòng)微調(diào)某個(gè)坐標(biāo)計(jì)算殘差的變化與優(yōu)化器計(jì)算的數(shù)值梯度進(jìn)行對(duì)比。如果差異巨大說明殘差函數(shù)或梯度計(jì)算有誤。least_squares設(shè)置jac2-point或3-point可以讓庫(kù)自動(dòng)計(jì)算數(shù)值梯度先確保它能收斂再考慮實(shí)現(xiàn)解析雅可比矩陣提升速度。排查2檢查角度處理和單位。確保所有角度計(jì)算都使用弧度制并且正確處理了atan2的參數(shù)順序和角度環(huán)繞。這是最容易出錯(cuò)的地方。排查3嘗試不同的初始值。如果初始值離真實(shí)解太遠(yuǎn)優(yōu)化可能失敗。嘗試使用更合理的初始猜測(cè)方法。排查4縮放問題。如果坐標(biāo)值非常大如經(jīng)緯度而角度殘差非常小弧度可能導(dǎo)致數(shù)值問題??梢钥紤]對(duì)坐標(biāo)進(jìn)行歸一化處理減去均值除以尺度。問題EKF發(fā)散估計(jì)誤差越來越大。排查1檢查雅可比矩陣H的計(jì)算。這是EKF中最容易出錯(cuò)的部分。使用復(fù)數(shù)步長(zhǎng)法或中心差分法對(duì)H矩陣進(jìn)行數(shù)值驗(yàn)證確保其解析形式正確。排查2調(diào)整噪聲協(xié)方差Q和R。Q太小會(huì)導(dǎo)致濾波器“僵化”無法跟上目標(biāo)機(jī)動(dòng)Q太大會(huì)使濾波器過于信任噪聲大的觀測(cè)。通常需要反復(fù)調(diào)試??梢試L試將R稍微設(shè)大一點(diǎn)增加濾波器對(duì)模型的信任。排查3檢查觀測(cè)數(shù)據(jù)的時(shí)間同步。確保每個(gè)觀測(cè)數(shù)據(jù)的時(shí)間戳與濾波器更新時(shí)刻對(duì)齊。時(shí)間不同步會(huì)引入額外的模型誤差。排查4檢查過程模型是否合理。如果目標(biāo)在做高機(jī)動(dòng)如頻繁轉(zhuǎn)彎勻速CV模型就不合適了需要考慮勻加速CA模型或交互式多模型IMM。問題定位誤差在某些區(qū)域特別大。分析這很可能是GDOP大的區(qū)域。計(jì)算并繪制該區(qū)域的GDOP圖。如果誤差分布與GDOP等高線吻合說明算法本身沒問題是觀測(cè)幾何導(dǎo)致的固有精度限制。這時(shí)改進(jìn)的思路就不是優(yōu)化算法而是優(yōu)化編隊(duì)路徑或隊(duì)形讓無人機(jī)在定位時(shí)能形成更好的幾何構(gòu)型。5. 代碼實(shí)現(xiàn)的結(jié)構(gòu)化與可視化呈現(xiàn)一篇優(yōu)秀的數(shù)模論文離不開清晰、可復(fù)現(xiàn)的代碼和直觀的可視化。附帶的Python代碼不應(yīng)是腳本的堆砌而應(yīng)有良好的結(jié)構(gòu)。5.1 建議的代碼模塊結(jié)構(gòu)# 1. 參數(shù)定義與配置模塊 (config.py) import numpy as np # 定義常量無人機(jī)數(shù)量、編隊(duì)參數(shù)、傳感器噪聲標(biāo)準(zhǔn)差(sigma_az, sigma_el)、目標(biāo)軌跡參數(shù)等。 # 2. 數(shù)據(jù)生成模塊 (data_generator.py) def generate_drone_trajectory(formation_typecone, ...): # 根據(jù)編隊(duì)類型和中心軌跡生成所有無人機(jī)的時(shí)空位置 return drone_positions_dict # 格式 {time: {drone_id: [x,y,z]}} def generate_measurements(drone_positions, target_trajectory, sigma_az, sigma_el): # 根據(jù)無人機(jī)位置和目標(biāo)真值生成帶噪聲的觀測(cè)數(shù)據(jù) return measurements_list # 格式 [(time, drone_id, az_meas, el_meas), ...] # 3. 核心算法模塊 (algorithms.py) class StaticLocator: def __init__(self, methodlm): self.method method def locate(self, measurements, drone_positions, initial_guess): # 實(shí)現(xiàn)靜態(tài)批處理最小二乘定位 pass class EKFTracker: def __init__(self, initial_state, initial_covariance, Q, R): self.x initial_state self.P initial_covariance self.Q Q self.R R def predict(self, dt): # 預(yù)測(cè)步驟 pass def update(self, z, drone_pos): # 更新步驟z為當(dāng)前觀測(cè)[az, el] drone_pos為當(dāng)前無人機(jī)位置 pass # 4. 評(píng)估與工具模塊 (utils.py) def calculate_crlb(target_pos, drone_positions, sigma_az, sigma_el): # 計(jì)算給定場(chǎng)景下的CRLB下界 pass def angle_diff(a, b): # 計(jì)算最小角度差 pass def compute_gdop_grid(area_grid, drone_positions, sigma_az, sigma_el): # 計(jì)算一個(gè)區(qū)域網(wǎng)格內(nèi)各點(diǎn)的GDOP值 pass # 5. 主程序與可視化模塊 (main.py) import matplotlib.pyplot as plt from mpl_toolkits.mplot3d import Axes3D # 生成數(shù)據(jù) # 運(yùn)行定位/跟蹤算法 # 繪制結(jié)果對(duì)比圖目標(biāo)真實(shí)軌跡 vs 估計(jì)軌跡 # 繪制誤差隨時(shí)間變化曲線 # 繪制GDOP等高線圖 # 繪制無人機(jī)與目標(biāo)在關(guān)鍵時(shí)刻的幾何關(guān)系三維圖5.2 關(guān)鍵可視化圖表在論文中以下圖表非常有力軌跡對(duì)比圖在二維平面或三維空間中繪制目標(biāo)真實(shí)軌跡、算法估計(jì)軌跡以及各無人機(jī)飛行軌跡。用不同顏色和線型區(qū)分。誤差分析圖位置誤差模值隨時(shí)間變化曲線。將誤差與CRLB下界繪制在同一張圖上直觀顯示算法性能接近理論極限的程度。GDOP分析圖用等高線或熱力圖展示任務(wù)區(qū)域的GDOP分布并在圖上疊加編隊(duì)的飛行路徑??梢郧逦f明為什么在某些路段定位誤差大。幾何關(guān)系快照?qǐng)D選取幾個(gè)典型時(shí)刻如GDOP最小和最大的時(shí)刻繪制此時(shí)無人機(jī)位置散點(diǎn)、目標(biāo)真實(shí)位置星號(hào)、目標(biāo)估計(jì)位置圓圈以及從無人機(jī)指向目標(biāo)的方位射線。這張圖能最直觀地解釋定位精度好壞的幾何原因。濾波器性能圖對(duì)于EKF可以繪制狀態(tài)估計(jì)的協(xié)方差橢圓在二維平面上隨時(shí)間的變化展示濾波器不確定性的收斂過程。5.3 性能指標(biāo)量化除了圖表需要用數(shù)字說話平均定位誤差整個(gè)任務(wù)期間估計(jì)位置與真實(shí)位置歐氏距離的平均值。均方根誤差RMSE誤差平方平均后再開方對(duì)大的誤差更敏感。最大誤差最差情況下的表現(xiàn)。收斂時(shí)間對(duì)于濾波器從開始到誤差穩(wěn)定在某個(gè)閾值內(nèi)所需的時(shí)間。算法運(yùn)行時(shí)間在指定硬件上的計(jì)算耗時(shí)評(píng)估算法的實(shí)時(shí)性潛力。通過以上結(jié)構(gòu)化、可視化和量化的分析你的數(shù)模論文就能從單純的“實(shí)現(xiàn)了一個(gè)算法”提升到“深入理解了問題本質(zhì)系統(tǒng)評(píng)估了算法性能并提出了有價(jià)值的見解”的層次。這道B題考察的正是這種從問題抽象、模型建立、算法實(shí)現(xiàn)到全面分析的綜合能力。希望這份基于實(shí)戰(zhàn)經(jīng)驗(yàn)的拆解能為你提供一條清晰的攻關(guān)路徑。
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
色狠狠综合| 婷婷瑟五月天久久综合| 久99热| 亚洲视频码| 色色网五月激情| 激情九月婷婷九月| er99免费视频在线| 操碰99在线视频观看| 久久开心五月婷婷| 中文AV网站| 人人舔天天| 中文字幕婷婷9月天| 国产综合81p| 97婷婷丁香五月| 久久6这里只有精品| www.maotanji.com| 99热黄| 色综合婷婷| 色综合狠狠色| 青青操丝袜美腿| 丁香午夜天| 成人网站av免费网站推荐| 五月丁香激情四射| 在线视频激情网站| 五月丁香激情综合网| 国内自拍1区| 午夜福利成人AV91| 色婷婷五月在线| 日韩综合久久| 色综合播放| 性色做爰片在线观看WW| 婷婷五月天在线观看免费| www色婷婷com| 色婷婷九月| 五月丁香婷婷激情在线| www.综合久久| 99综合网| 九九综合久久| 桃色五月婷婷| 精品动漫 无码av| 五月天丁香婷| 久热这里只有精品在线观看 | 第九色区av天堂| 思思热在线精品视频网站| 五月婷丁香久久综合| 草综合14| site:jszngf.com| 亚洲乱码日产精品BD| 五月开心激情网| 欧美日韩成人高清在线| 日本欧美成人片AAAA| 久久思思热视频| 欧美VA视频| 九九精品热| 婷婷大美在线| AV网站免费在线| 国产人妻777人伦精品HD| 午夜做爱影院| 婷婷五月天激情综合婷婷五月天激情综合| 操人精品| 激情四射亚洲| 婷婷九九色| 色情五月天视频网| 婷婷五月天毛片| 激情五月天色色| 婷婷五亚洲| 超碰在线人人| 久久人五月| 丁香五月婷婷啪啪| 97视频.干com| 九九亚洲视频| 五月丁香六月婷婷亚洲激情综合| 一起草性爱不卡视频| 色播五月丁香综合| 五月丁香综合| 小色小蛇伊人婷婷色香五月| 狠狠爱青青草| 激情第四色| 丁香五月婷中字幕| 九九视频免费| 久超超碰| 亚洲色图81p| 婷婷五月激情综合| 婷婷丁香六月天| 五月天成人在线精品| 人妻在线观看视频| 日本天天色| 亚洲第一色色色色| 99re免费精品视频| 色在线99| 五月天婷婷操逼视频| 久久精品日| 99热欧美在线观看| 99碰网站| 99re这里只有| mmm1717.6dbm人人爱人人操| 色婷婷91激情小说| 久碰综合| 丁香婷婷六月在线资源观看| 婷婷色五月亚洲| 五月天婷婷色色网| 婷婷成人在线| 激情网色五月| 激情综合五月丁香六月婷婷| 开心色色五月天综合| 99热超碰| 婷婷五月天播播| 欧美综合在线五月天色婷婷| 国产日日夜夜操| 超碰人人操在线| 9精品一区| 亚洲V国产V欧美V久久久久久| 超碰色综合| 99er精品视频| 亚洲婷婷免费| 欧美在线操| 丁香五月天无码AV| 午夜免费试看| 性爱激情小说AV五月丁香花| 国产五月视频| 99色色| 亚洲热视频| 1024日韩| WWW五月婷婷| 色婷婷五月天| 亚洲天堂久久| 婷婷丁香色五月| 婷婷五月天com| 日本五月婷婷| RenRenSe在线视频网站| 丁香五月777| 91dy.av| 国产超碰在线| 五月婷婷影院| 香蕉久久国产AV一区二区| 大香蕉网站,大香蕉综合| 激情五月婷婷视频一区二区三区| 天天摸天天透天天舔| 天天做天天爱天天玩夜夜爽 | 五月丁香色婷婷色| 超碰91av| 久思思热视频在线观看| 五月婷婷偷| 久久这里精彩免费在线观看| 丁香五月aV| 婷婷六月网| 亚洲久久婷婷丁香五月天| 人人操Av| 性天天中文网| 丁香五月六月综合欧美| 99热18| 一级性爱视频| 97色伦另类图片小说视频| 思思热闹这里只有精品| 99er在线观看| 激情五月天天狠狠久久| 91精品丝袜久久久久久| 啪啪91| 久热只有精品| 人操综合| 久碰婷婷视频| 五月色欧洲| 这里只有精品免费视频在线观看 | 五月婷婷久久开心网| 狠狠五月丁香色婷| 噜噜噜噜综合在线| 人妻激情在线| 极品人妻VIDEOSSS人妻| 碰人人97| 久久色区| 五月激情基地| 亚洲人妻Av| 99婷婷| 色婷婷久久| 九月丁香久久网| 一起操 91N.com| 97在线/亚洲| 99色在线观看免费| 五月丁香六月花| 热99在线| www.久久| 97婷婷狠狠久久综合9色| 久久婷婷色情7777网站| 99在线视频精品| 噜噜色噜噜网| 色色色热| 丁香久月| 甈吧vv| 国产精品VA在线| 97碰碰人人| 免费观看18视频网站| 欧美色图片88| 激情五婷网| 亚洲综合激情五月久久| 亚洲Av成人在线观看| 日韩人妻无码精品| 五月色色激情网| 久久久免费精彩视频| 日韩三及成人AV片| 五月婷婷色色色| 激情六月丁| 欧美黄色韩日网| 九九热短视频在线观看 | 亚洲激情丁香五月基地| 婷婷久久综合久色| 激情综合色婷婷啪啪六月天| 婷婷五月视频| www激情| 亚洲精品另类| 无码操B| 可以看的av网站| 色婷婷成人做爰A片免费看网站 | 超级久久久| 国产精品久久..4399| 天天色伊人| 开心色五月天久久久久久久| 五月丁香偷拍| 丁香五月激情网| 五月丁香六月合| 激情五月天色色网| 极品九九九九九九| 色婷婷九月综合| 99热精品在线观看| 天天操精品| 人人色性网| 91久久电影| 日韩成人中文| 激情99。| 色婷婷五月综合| 国产综合丁香五月天| 色综合久久88色综合天天人守婷| www.精品99| 久久ri精品视频| 99这里有精品久久97| 丰满熟女人妻一区二区三| 五月丁香影视| 99久热在线精品| 天天爱天天狠天天透| 黄色中文字目| 东北婷婷五月天| 99热网站| 婷婷97碰碰| 开心色五月天久久久久久久| 婷婷五月天丁香综合网| 欧美va亚洲va在线播放| 狠狠狠狠狠狠| 丁香五月婷婷婷婷欧美综合| 国产成人99久久亚洲综合精品| 欧在线一区| 日韩欧美一区二区三区四区| 色欲色香综合网| www久久久久久| 亚洲国产色色| 色爱爱综合网| 黄色AAAAA| 香蕉婷婷五月| A久网| 精品久久99码| 狠狠操.com| 91操操| 欧美丁香五月97色| 九色视频91| 一区二区三区四区牛| 日本色噜| 亚洲AV免费在线| 91啪啪| 超碰人妻在线| 综合激情伊人影视在线| 国产成人+综合亚洲+天堂| 日本久久天堂| 九九热AV| 天天做综合网色综合| 久久AAAA片一区二区| WWW.夜夜操.com| 九月丁香| 99热 免费| 久久久久久久久久8888| 337p午夜影院| 色色色色色色色五月| 99热精国产这里只有精品| 日韩操人| 狠狠爱综合网| 国产精品久久久久久亚洲毛片| 九九热这里只有精品7| 丁香五月婷婷啪啪啪| 黄色五月婷婷| 亚洲激情av| 色欲色天天香综合| 激情五月综合网| 91dy.av| 爱超碰性| 激情六月丁| 97色操| 大香蕉啪啪| 五月婷视频久久| 99热| 中文字幕 久久9999| 天天激情站| 激情五婷网| 日本专区久久| 婷婷五月天成人网| 婷婷五月天亚洲综合网| 97丁香五月| 大香蕉九九| 思思久久99热| 九九九九热99超碰| 国产免费一区二区三州老师F1F1| 婷婷五月丁香影院| 久久久潮喷-久久久九九-成人AV| 97碰| 婷婷五月天伊人网在线观看视频| 色婷成人狠干| 亚洲色综合| 九九热这里只有精品9| 丁香六月亚洲| 天天干夜夜谢| 亚洲丁香五月| 亚洲成人一区| 丁香五月婷婷av影院| 538在线精品| 色婷视频| 欧美熟女视频 色婷婷| 九九成人视频| 久婷婷久草| 色婷婷色五月综合| 噼里啪啦在线观看免费完整版视频 | 成人综合视频在线| 五月婷丁香久久久| 激情九月天天天天婷婷| 日本精品人妻无码77777| 丁香五月六月综合欧美| 在线五月色播| 丁香狠狠色婷婷| 天天插天天干| 色五月亚洲| 天天五月香欧美| 亚洲正能量欧美| 九九热在线视频| 五月天婷婷激情| 综合色久| 五月婷婷色色爱| 丁香五月婷婷综合激情啪啪啪| 超碰AV成人| 97caop| 91超级碰碰碰| 天天搞夜夜叫| WWW.婷婷五月天.COM| 另类丁香五月天区图| 婷婷五月天Av| 久久久jd| 香蕉久久五月| 亚洲成人免费在线| 丁香五月天.com| 丁香五月天婷婷久久综合| 99久久精彩视频| 六月婷婷综合| 激情五月色婷婷| 岛国av网| aaaaa黄色| 六月色婷婷综合影视| 五月天激情小说网| 99亚洲精品| 26uuu国产精品| 91九色国产在线| 成人免费超碰| 98国产精品综合一区二区三区| av色婷婷| 天天做天天爱天天爽| 内射激情在线| 国产色色网站网址| 久久五月天激情美女| 五月花激情网| 五月天婷婷激情六月久久| 天天天天干| 精品人妻久久久久| 六月丁香激情综合| 夜夜天天久久婷婷| 天天弄天天爽| 亚洲欧洲另类| 97碰超级人人看| 永久热91| 热996精品在线观看| 中字幕视频在线永久在线观看免费| 97操操操| 97人人看| 天天综合五月天| 国产婷婷五月天| 亚洲精| 婷婷久久综合久| 操日视频| 婷婷六月视频| www.久久99热地址发布| 色蜜婷婷| 91av无码| 色婷婷色和| 久久99人人| 国产看真人毛片爱做A片| 色五月琪琪| 日本狠狠干| 天天爽夜爽| se99视频| 五月婷婷综合精品| 久久色五月天综合网| 欧美色小说婷婷| 熟女五月天久久综合| 久久无码激情视频| av 一区三区四区| 99久久99视频只有精品| 九九视频网| 色婷婷黄色网络| 开心五月婷婷激情| 狠狠草天天草| 婷婷 激情 五月| 狠狠夜夜五月丁香| 天天综合天天做天天综合| 99热香港| 新激情五月天色播| 久久色五月天激情小说| 五月婷婷开心五月| 日本色爽| 成人AV在线电影| 超碰av在线| 久久只有18视频| 99久热| 激情综合亚洲| 久久婷婷综合五月| 丁香婷婷婷婷十二月在线观看视频| 男女啪啪视频久 9| 狠狠久久婷婷| av网址在线| 中文字幕在线免费观看视频| 秋霞午夜理论| 人人人操B超碰| 99热无码| 国产免费AV网站| 性生活久久朋友人妻| 国产婷婷五月色情综合| 情婷婷五月天在线| 激情播丁香| 久青操| 五月丁香六月婷综合成人综合 | 国产伊人五月天| 色婷婷裸体色性在线| 亚洲综合无码| 婷婷无五月无码视频| 欧美色宗和激情| 欧美婷婷色五月| 婷婷色综合| 久久天堂加勒比| www.狠狠干| 99在线精品观看99| 日本丰满久久| 青青操绿aaa一区日v| 丁香综合婷婷五月天| 久在线88综合| 他改变了拜占庭| 婷婷操婷婷干婷婷射| 激情五月婷婷| 99热网站| 激情中文在线| 日韩在线观看亚洲| 偷拍99在线视频观看| 丁香六月婷婷综合激情欧美| 热99在线精品| 丁香五月婷婷高清| 中文aV网| 成人精品视频99在线观看免费| 成人 视频免费观看网站| 婷婷综合精品视频97| 亚洲V国产V欧美V久久久久久| 五月总合激情网| 色色婷| 色久影院| 激情床戏| 色综合com| 丁香五月影院| 91五月天| 久热只有精品| 91久久久久久| 激情婷婷五月天| 中文字幕成| 色婷婷精品视频| 99热色婷婷| 五月丁香六月婷婷激情网| 久色大香蕉| 成人精品99| 人妻操日日| 99无码视频| 最新无毒无码AV| 丁香五月成人论坛| 日本熟妇乱妇熟色A片蜜桃| 久久久久久久久久久44| 五月丁香六月日逼| 日本色色色| 久久综合99综合| 久99视频| 五月天综合网| 91狼友视频在线观看| 五月天婷婷色| 538在线精品| 亚洲精品又粗又大又爽A片 | 另类精品视频在线观看| 丁香激情婷婷网| 色丁香五月婷婷| 亚洲午夜一区二区| 激情小说 五月天| 996er热| 91 原创 在线 九色| 开心五月丁香啪| 开心五月深爱五月| 玖玖婷婷综合| 婷婷五月丁香综合激情| 中文中文在线| 六月丁香av| 夜夜综合色| 婷婷伊人五月天| 可以免费看av网站| 色五月成人| AV无码免费| 97热这里只有精品| 日本91在线播放| 五月婷婷影视| 国产看真人毛片爱做A片| 四色综合网| 狠狠爱综合| 91视频精品99| 国产激情在线| 欧美色碰| 五月婷婷色播| 伊人大香蕉在线视频| 婷婷色色欧美| 丁香婷婷老司机久操| 深爱五月天 开心网| 午夜少妇在线观看视频| 色狠狠综合| 九九色影院| 五月天激情亚洲| 1024操逼视频| 另类 在线| 丁香五月色网| 亚洲操逼片| 久久五月网| 丁香六月在线| 欧美在线视频99| 第五色婷婷| 亚洲性受XXXX五月丁香| 日韩婷婷| 99在线视频在线观看| 97人人操人人插| 99亚洲日韩| 九热精品| 五月丁香怕怕综合| 久久久亚洲精品一区二区三区浴池| 538午夜激情| 国产成人精品一区二三区熟女在线| 亚洲激情网站| 九九热精品| 人人干av| 91美女艹逼网站| 五月天婷婷7米| 五月天婷五月天综合网小说首页-五月天激激婷婷大综合,婷婷亚洲综合五月天小说 | 就爱射中文字幕资源网| 人妻AV在线| 六月婷婷七月丁香| 久xxxx| 操逼视频网址| 美女婷婷激情亚洲| 成人免费120分钟啪啪| 9l视频自拍9l九色成人| 国产在这里只有精品| 影音先锋色婷婷| 久久天天| www.夜夜操.com| 色五月影视| 欧洲高清免费久久| 艾小青av| 能直接看的AV网站| www五月天激情com| 国产精品久久久60086| 色婷婷丁香五月天在线视频 | 99re思思热久久| 大香蕉久热| 丁香五月六月婷婷综合| 五月婷婷婷丁香播| 亚洲人成色A777777在线观看| 天天操婷婷| 婷婷五月天开心激情网| 国产五月天欧美色| 日日操夜夜爽| 少妇性按摩无码中文A片| 婷婷丁香五月天激情| 五月久视频| 婷婷香五月| 五月激情网综合| 97婷婷五月天| 亚洲另类日本| 色婷操逼| 伊久久婷婷| 久久伊人婷婷| 天天干狠狠| 囯产精品久久欠久久久久久九大| 99热色无码| 五月婷婷深深爱| 精品怡红九九九| 久久在线大香蕉| 激情综合五月天| 性99网站| 91欧美| 亚洲亚洲人成综合网络| www.操.com| 日韩欧美一区二区三区四区| 丁香五月婷婷综合激情啪啪啪啪啪啪啪| 色婷婷综合影院| 青青草搞屄视频网站| AV六月丁香| 天天日天天色| 99国产小视频| 国产婷婷色五月| 操逼电影免费看| 91欧美日韩综合| 婷婷丁香成人在线视频| 成人免费超碰| 激情五月综合| 99热国产免费| 26uuuu精品一区二区| 激情九月天天天天婷婷| 91久久精品国产91性色TV| 欧美性爱中文字幕| 特级片神马电影| 另类视频一区| 性爱七区| 国产成人精品一区二区三区视频| 丁香五月网址| 99热这里只有免费精品| 99re久热只有精品6在线直播| 七七色色综合| 大香蕉在线99热| 高清无码入口| 丝袜激情网| 淫水导航| 日韩无码一区二区三区四区| 丁香久久五月婷综合| 成人免费黄色短视频| 丁香五月天啪啪| 无码操B| 五月婷婷之六月丁香| 秋霞性爱AV| 欧美日韩国产一区二区| 东京热五月婷婷| 狠狠色狠狠操| 亚洲婷婷91丁香| 久久一二三视频| 中海油常州环保涂料有限公司| 狠狠干在线| 成片免费观看视频大全| 91人人操人人| 99国产精品久久久久久久久久久| 久久久久思思热| 天天拍夜夜爽日日| 五月天婷婷三级黄| 亚洲人妻AV| 91九色精品| 婷婷五月天渟渟| 99热免费18| 99热精品观看| 国产乱妇乱子伦| 五月在线婷色| WWW·色色色·COM| 啪啪91| 丁香六月啪啪| 久久机热/这里只有精品| 婷婷五月色情天| 婷婷五月天精品| 婷婷97碰碰| 丁香五月婷婷深爱综合激情 | 丁香婷婷综合喷| 色一情一乱一乱一区91| 久久 视频这里只有精总| 另类专区在线观看| 六月婷婷五月天| 色久五月天| 五月婷婷色激情| 99色免费视频| 伊人玖玖婷婷| 欧美日韩国产成人在线| 超黄亚洲瑟瑟网站| 久久婷婷成人综合色怡春院| 99热这里有精品| 婷婷久久五月天丁香| 97好吊操| 五月天com| 久久一操| 亚洲性色XXXXX| 26uuu日韩| 色五月婷婷自拍| 色狠狠色噜噜噜a天堂一区| 欧美在线干| 国内在线99视频| 五月丁香婷中文字幕 | 五月丁香花成人社区| 国产ava| 91精品久久久久久综合五月天| 日本天天色| 午夜成人天堂久久无码日韩久久| 欧美色爱五月天| www。五月天。com| 五月噜噜| 国产精品久久7777777精品无码| 五月丁香激情婷婷| 精品人妻伦一二三区久久| 久 久9 9 热 视 频| 91日韩在线| 性欧美日本| 五月婷婷丁香五月| 久操大屁股女人av| 亚洲色婷婷五月| 日韩黄色中文字幕| 深爱激情四射| 色婷婷丁香五月| 色综合色综合网| 五月丁香啪啪啪啪| 色五月aV| 色视频五月天| 九九亚洲视频| 国产精品久久久爽爽爽麻豆色哟哟| 激情五月婷婷视频| 五月婷激情影院| 欧洲激情网站| 淫荡综合网| 欧洲一区二区| 六月丁香婷| 99欧美热| 五月婷婷欧美| 丁香欧美| 精品久久人妻| Se.婷婷五月天| 婷婷五月色天| 色色亚洲无码| 北京熟妇搡BBBB搡BBBB| 亚洲激情高潮| 69超碰在线| 99热只有国产在线精品| 人人摸人人搞| 久久人人做人人妻人人玩精品va| 日韩久综合| 亚洲综合婷婷五月| 九九一综合精品| 国产一级片| 六月丁香婷婷色综合| 日本熟妇乱妇熟色A片蜜桃| 色综合色欲综合天天免费| 亚洲国产精品VA在线看黑人| 99热日本| 蜜臀av 粉嫩av 懂色av| 色婷婷六月丁香综合欲精品| 久久九⑨| 天天爽天天摸人妻综合网| 991自拍视频| 色色色综合色| 9人人操人人看| 五月天色色网站| 久久九九视频网站| 国产3p露脸普通话对白| 五月婷婷欲色| Www.Av网9| 伊人玖玖婷婷| 天天爽人人综合免费7799| jiZZdr| 秋霞簧片| 丁香五月综合激情久久潮喷| 婷婷五月丁香五月综合网| 91日日日| 日本三级第一页| 99爱视频精品| 天天摸天天舔| 国产午夜精品一区二区三区四区| 色婷婷女优有码五月亭| 激情色播| 五月天精品视频| 婷婷激情六月中文| 黄色AAAAAAA| 综合XX网| 九月丁香| 99久久国产宗和精品1上映| 激情五月天电影| 天堂资源欧日浪女在线播放| 色就是色婷婷五月亚洲激情| 伊人激情影院| 久久久久久久久月丁| 永久的网站AAAA | 丁香五月综合网| 精品九九在线观看| 99啪啪视频| 91丨九色熟女丨首页| 六月婷婷影院| 操操啪| 久热中文字幕| 色噜噜狠狠色综无码久久合欧美| 淫视馆av三区| 丁香六月av| 久久伊人五月天| 丁香五月天堂亚洲社区| 婷婷射图五月天| 色婷婷在线影院| av人人干| 日日干日日s| 97爱艹婷婷开心丁香激情综合| 开心五月天激情网站| 99在线视频资源| 国产小精品| 九九无码视屏| 丁香五月婷婷激情四射深爱激情| 久久草大香蕉| 亚洲操逼片| 午夜丁香综合婷婷| 婷婷五月天激情开心网| av在线免费播放| AV网在线| 91操片| 六月香五月婷| 日韩AV在线免费观看| 色婷婷电影网| 五月天综合| 综合97五月| 午夜激情久久| 日韩一级片| 六月丁香五月天| 色五月xxx| 2015WWW永久免费观看播放| 精品色色| 五月婷婷亚洲色视频| 激情五月深爱五月| 丁香九月激情久久| 日日干日日| 六月丁香色色| 日日日影院| 成人五月天丁香婷| 狠狠操狠狠色| 色五月婷婷丁香五月| 丁香五月区| 五月天丁香综合| 丁香五月激情五月| 高清成人综合| 色婷婷狠| 久99热| 99热自拍| 日韩啪啪网| 亚洲在线网站| 欧美色五月| 丁香五月婷婷亚洲综合精品| 这里只有精品免费观看网占| 亚洲婷婷丁香五月在线| 婷婷七月丁香色色| 97大香蕉五月天| 欧美色婷婷| 五月丁香直播| 高清无码网址| 99性感视频| 成人 九九九九| 人妻少妇色综合| 国产免费AV在线| 色色日本| 五月开心婷婷| 丁香五月婷婷总啪啪| 天天摸天天做天天爱天天爽| 操人久久| 午夜天堂啪啪| 伊人午夜综合色啪| 久热婷婷在线视频| 激情五月综合网| 一本久久亚洲五月婷婷| 亚洲人操亚洲人| 99色综合| 婷婷丁香九月| 婷婷激情六月视频| 开心五月深爱婷婷| 五月丁香色婷婷综合| 久热2025无码| 九九精品在线视频观看| 99久久精彩视频| 丁香婷婷影院| 亚洲成av人影院| 思思热视频在线| 久久综合丁香| WWW.桔色成人.COM| 六月婷婷在线| 玖玖婷婷五月天| 天天日天天久久青青| 色五月综合婷婷| 九九干视频| 丁香五月激情网| 伊人狠狠操| 97色欧美| 国产毛片精品一区二区色欲黄A片| 成人性爱无码| 五月天激情网址| 深爱激情五月网| 日本欧美国产| 五月天丁香综合| www.minyis.com【JT】实力收量可预付QQ2101460746 | av在线资源| 玖玖热视频| 久久99热这里只有| 大香人妻| 久久婷婷成人综合色怡春院| 色情五月天婷婷| 国产99久久久| www...com黄在线观看| 国产成人综合网| 婷婷五月噜噜| 婷婷综合网| 综合久久十| 国产成人网站在线观看| www色五月天| 久久六月天| 操逼综合激情网| 久久这里只有精品热在99| 天天色综网| 99丁香五月婷| 五月天婷综合| 国产免费一区二区三州老师F1…… | www.夜夜| 天天日天天干天天操| 琪琪秋霞| 欧美日本黄色| 一本到不卡高清DVD| 色情五月综合婷婷| 色色网站| 精品99网站| 99re免费精品视频| 国产毛片精品一区二区色欲黄A片| 九九热re99re6在线精品| 五月婷婷综合色啪首页| 色色色色欧洲| 久草丁香婷婷五月天婷| 天天揷综合网| 操骚货在线| www.婷婷五月| 六月婷婷影院| 色五月xxx| 91成人电影| 综合久久五| 美日韩成人| 激情久久五月天| 色色色天堂网| 少妇大叫太大太粗太爽了A片 | 在线婷婷| 一夜福利不卡| 色999;丁香五月| 嫩草乱码一区三区四区| 丁香五月六月婷婷殴美综合| www.久久99热地址发布| 日日操日日撸| 图片区 小说区 区 亚洲五月| 丁香五月激情图片婷婷| 综合网网欲色| 日本久久综合| 色色色色色日韩午夜激情| 99精品综合视频| 婷婷五月天欧美| 思思精品久久艹| 深夜婷婷五月丁香| 日日噜噜夜夜狠狠久久丁香六月| 中文字幕婷婷| 激情综合婷婷| 日本成人噜噜噜| 久久一热| 伊人高清无码| 婷丁香五月天| 色五月婷婷天天干| 99re这里有精品手机在线| 五月综合激情网| 狠狠狠狠狠干| 久久九九热38| xxxx久| 婷婷区日本| 99热6精品| 亚洲激情综合| 日韩乱轮AV| 国产综合视频婷婷| 五月丁香视频在线观看| 婷婷五月天激情开心网| 99热都是精品| 色噜婷婷| 婷婷在线视频| 综合五月亭亭9| 99视频| 狠狠色婷婷777| 色婷婷av综合网| 成人五月丁香社区| 天天成人丁香美女AV| 秋霞av不能| 五日激情综合| 激情婷婷六月| 丁香五月冃欧美| 蜜臀嫩草| 色色色.COM| http://www.sd-xiangsu.com/| 狠狠色综合五月| 婷婷五月天男人影院色色网| aaa日韩| 色 色 色综合com| 日本婷色| 九九精品免费| 丁香六月综合激情| 五月久久| 激情q青青草在线婷婷| 噜噜视频| 九九色综合| 一级韩国产精品毛| 五月婷婷新网站| 色婷婷小说| 九九热最新| 成人在线网站| 色 五月婷婷基地| 就要去操亚洲成人精品五月天丁香婷婷| 亚洲俩性性爱图片久久第六页| 深爱开心激情网| www、色色色| 婷婷激情五月| 人妻中文在线| 中文字幕网伦射乱中文| 五月天婷婷色播综合在线| 99re视频在线精品| 亚洲情色一区| 色色色色热热| 婷婷综合伊人丁香| 中文AV网| 久九色| 性爱综合网| 久久免费少妇高潮99精品| 97超碰欧美中文字幕| www.色五月.com| 成人婷99最新| 中文字幕在线免费观看视频| 综合综合色色| 第四色五月天| 国模九区| 碰97久久| 精品五月天| 少妇人妻丰满做爰XXX| 成人在线不卡| 26uuu国产| 九九久久玖玖爱| 狠狠干总合| 天天草天天爽| 色99日韩| 五月天偷拍| 色色五月婷婷狠狠| 中文字幕在线不卡视频| 免费观看2018www黄色操逼网站| 五月婷婷色色| 色色综合色视频| 伊人深爱综合| 99视频| 一本大道嫩草AV无码专区| 五月丁香婷中文| 午夜婷婷久久 | 天天做天天爱天天玩| 日韩小视频在线99| 思思久久96热在精品国产,| 日本三级中国三级99人妇网站| 色婷婷97| 久久婷丁香五月| 97婷婷狠狠久久综合9色| 五月丁香在线看| 天天干在线播放| tingtingzonghewang| av中文在线| 色婷婷黄色网络| 色爱综合网| 狠狠色噜噜狠狠狠狠综合| 欧美色频| 五月天婷婷色色网| 五月婷婷成人| 碰碰碰97免费精彩视频| 九九无码视屏| 欧美特大片黄| 久久99热 这里有精品| 无码人妻少妇色欲AV一区二区| 欧美色图天堂网| 天天操无码| 五月丁香激情综合六月涩涩爱| 激情綜合W W W,激情五月天| 欧美日本韩国亚洲| 天天操夜夜玩!| 最新高清无码专区| 另类小说五月天综合| 国外亚洲成AV人片在线观看| 狠狠色丁香99| 久久机热/这里只有精品| 六月激情网| 婷婷丁香九月| 丁香五月六月婷婷怡红院| 色五月婷婷网| WWW99热| 婷婷五月av| 狠狠精品干练久久久无码中文字幕 | 大香蕉精品视频| 五月天社区| 亚洲综合在线伊人婷| 狠狠干狠狠干| 婷婷5月天激情综合| 涩涩五月天| 我要色综合五月婷婷| 日韩av手机在线观看| 久久久99精品| 无码碰碰| 91精品综合久久久久久五月丁香| 嫩草AV久久伊人妇女超级A| 99在线视频喷水| 色婷五月丁香久亚洲| 日日天天干| 欧美日比视频| 婷婷丁香在线播放| 色婷网站| WWW.久久久久久久| 热99在线| 超碰免费电影| 色五月婷婷婷婷| www.天天干| 轮奸综合网| 日韩AV大全| 庭庭久久内射| 1024操逼视频| 九九激情视频| 快色t v在线入口| 天天揷综合网| 五月婷婷久久综合| 久热综合| 狼友超碰| 97性视频| 久久男人网婷婷| 五月丁香婷爱在线| 91艹人| 三级三久久线久久99久目本WW| 五月激情五月丁香| 激情涩播| 九月婷婷色色| 97色色-99久久| 五月婷婷亚洲天堂97色婷婷| 亚洲成人五月天| 91久久| 天天爽天天| 亚洲热久久| 久久久91精品| 色婷婷精品视频| 婷婷色五月激情| 99热最新国内| 人人色性网| 色欧洲| 丁香六月天AV| 五月天丁香网| 久热这里这里有精品| 99精品成人无码A片观看金桔| 天天狠狠婷婷在线| 国产性爱亚洲是图| 九九干视频| 欧美性生交XXXXX无码小说| 丁香网五月天激情| 日韩综合久久| 亚洲av| 精品网站:999WWW| va婷婷在线| 五月丁香激情啪啪网| 尔尔AV一区| 天天爽人人爽| 99亚洲视频| 亚洲字幕AV一区二区三区四区 | 五月丁香精品| 日比网免费国产| 国产综合婷婷| 美女100%露全身无挡网站| 五月丁香成年黄色| 婷婷色色五月| 五月婷婷六月激情| 丁香伊人综合| 91久久综合| 久久久国产精品黄毛片| 五月婷视频| 日本五月丁香| 亚洲成Av人片乱码色第1集| 亚洲五月婷婷| 五月天婷婷综合免费| 色一区高清| 狠狠狠狠青草| 久久婷婷五月| 99热这里只有精品免费观看| 色很很96| 亚洲AV永久无码影院黑人| 天天日夜夜| 五月天综合影院| 深爱激情中文五月天av| 亚洲精品中文字幕成人片| 99亚洲色| 91久久色| 五月天激情久久| 天天爽天天透天天爱| 狠爱婷色| 182TV大香蕉| 婷婷五六月丁香| 婷婷丁香社区| 六月丁香久久| 影音先锋噜一噜| 少妇人妻人伦A片| 狠狠狠五月婷婷六月丁香| 人人干女人| 日本美女97在线视频| 日本久久天堂| 日本久久人| 天天免费日日夜夜夜夜| 亚洲激情亚洲激情| 97热九九| 97在线日韩| 国产又粗又大又爽又黄| 久久九九综合| 九九视频在线| 五月天激情小说婷婷基地| 亚洲精品乱码久久久久久按摩观| 九九99在线| 玖玖色综合色| 少妇人妻人伦A片| 丁香五月婷婷啪啪啪| 色丁香五月婷婷综合久久| 九九re精品视频在线观看| 密桃激情五月天综合网| 久久五月天婷婷| 免费播放片大片| 日本五月婷婷| 思思热热久久| 欧美色色色色色色色色色色影视| 97精品在线| www.99久久久久99| www九九免费视频| 色婷婷久久综合中文久久一本| 99色 | 丁香六月婷婷综合啪啪| 成人网址在线观看| 五月婷六月丁| 啪啪激情网| 日韩操啪| 丁香九月激情| 俺去也五月天| 欧美久久五月婷婷| 狠狠久久婷五月| 99热亚洲只有色| 在线观看中文字幕| 婷婷久久综合久色| 五月色丁香综合| 偷拍九九五月丁香婷婷| 亚洲精品久久久久久久久久吃药| 五月激情小说网| 亚洲综合婷婷| 五月激情网五月综合网| 天天摸.天天mo| 99久久66| 色噜噜狠狠色综| 激情婷婷九月| 97午夜一区二区| 欧美久久九九| 五月综合激情网| 岛国AAAV| AV网在线| 欧美婷婷色| 秋霞少妇AV网站| 波多野结衣不卡AV|