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

ARTICLE DETAIL

資訊詳情

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

MATLAB實現(xiàn)PDR行人航位推算:無GPS室內(nèi)定位實戰(zhàn)

MATLAB實現(xiàn)PDR行人航位推算:無GPS室內(nèi)定位實戰(zhàn) 簡介本資源是一套完整的行人航位推算PDR算法MATLAB實現(xiàn)方案面向?qū)Ш蕉ㄎ?、慣性傳感、智能穿戴及室內(nèi)定位方向的本科生、研究生與算法工程師用于理解并復(fù)現(xiàn)基于加速度計與陀螺儀數(shù)據(jù)的步態(tài)檢測、步長估計與航向解算全流程。壓縮包共10個文件含7個核心MATLAB腳本如pdr_main.m主程序、sync_acce_mag.m多傳感器同步模塊、step_length.m步長建模函數(shù)、2個實測Excel采集數(shù)據(jù)含時間戳對齊的加速度與磁力計原始記錄以及1個備份ASV文件整體3.72MB輕量易部署。已有3909人學(xué)習(xí)下載資源開箱即用——運行pdr_main.m即可可視化軌跡推算結(jié)果配套代碼結(jié)構(gòu)清晰涵蓋數(shù)據(jù)預(yù)處理、坐標轉(zhuǎn)換llh2enu、頭部方向校準cal_head_acce及運動學(xué)建模等關(guān)鍵環(huán)節(jié)是深入理解PDR原理與工程落地的理想實踐素材。1. 一個沒GPS信號的地下停車場如何靠手機傳感器把人“算”出來你有沒有試過開車進大型地下車庫后手機地圖直接變“迷路模式”定位點原地打轉(zhuǎn)、路線箭頭亂指、甚至干脆消失——不是手機壞了是GPS信號被鋼筋混凝土徹底掐斷了。這時候如果系統(tǒng)能靠手機自帶的加速度計和陀螺儀不依賴任何外部基站或衛(wèi)星僅憑人走路時的微小動作變化就實時推算出人在車庫里的精確位置和朝向你會不會覺得有點玄學(xué)PDRPedestrian Dead Reckoning行人航位推算就是干這個的。它不追求厘米級測繪精度但能在GPS失效的典型封閉場景如商場B2層、地鐵站臺、工廠車間、醫(yī)院走廊里提供連續(xù)、低延遲、可工程落地的位置增量估計。本項目是一份完整可運行的 MATLAB 實現(xiàn)覆蓋從原始傳感器數(shù)據(jù)預(yù)處理、步態(tài)檢測、步長估計、航向解算到軌跡積分的全鏈路代碼結(jié)構(gòu)清晰、注釋密集、參數(shù)可調(diào)特別適合算法驗證、教學(xué)演示或嵌入式端算法原型移植。如果你正卡在“無GNSS環(huán)境下的室內(nèi)定位第一公里”這份代碼不是玩具而是能立刻跑通、看到軌跡線在圖上動起來的生產(chǎn)級參考實現(xiàn)。2. 技術(shù)棧與架構(gòu)設(shè)計為什么用MATLAB而不是Python或CPDR不是新概念但真正能從論文公式落到可調(diào)試、可復(fù)現(xiàn)、可改參的代碼中間隔著三道墻傳感器噪聲建模的合理性、狀態(tài)更新邏輯的時序嚴謹性、以及可視化反饋對調(diào)試效率的決定性影響。本項目選擇 MATLAB 并非懷舊而是基于四個硬性工程判斷第一MATLAB 的 Signal Processing Toolbox 對加速度信號的濾波如bandpass、峰值檢測findpeaks和頻譜分析pwelch封裝成熟一行代碼就能替代 Python 中手動調(diào)參的scipy.signal.filtfiltscipy.signal.find_peaks組合避免初學(xué)者在預(yù)處理階段就陷入“為什么峰沒檢出來”的玄學(xué)排查第二其quaternion類原生支持四元數(shù)旋轉(zhuǎn)運算航向解算中繞重力軸的旋轉(zhuǎn)矩陣推導(dǎo)、IMU姿態(tài)更新等操作用quatmultiply和eulerd可讀性遠超手寫np.array矩陣乘法第三animatedline和plot3的實時繪圖性能在桌面端足夠支撐 50Hz 軌跡刷新比 Matplotlib 的FuncAnimation更少出現(xiàn)卡頓丟幀第四所有模塊均采用函數(shù)式封裝非面向?qū)ο竺總€.m文件只做一件事比如detectSteps.m專責步態(tài)檢測estimateStepLength.m只輸出步長這種“單職責輸入輸出明確”的設(shè)計讓二次開發(fā)時替換某模塊例如把經(jīng)驗公式步長換成LSTM回歸模型時只需保證接口一致完全不影響其他流程。整個系統(tǒng)按數(shù)據(jù)流分為五層嚴格遵循“采樣→濾波→檢測→建?!e分”順序數(shù)據(jù)輸入層支持加載.mat格式真值數(shù)據(jù)含acc_x,acc_y,acc_z,gyro_x,gyro_y,gyro_z,timestamp字段或 CSV需列名匹配內(nèi)置loadSensorData.m自動識別格式并歸一化時間戳預(yù)處理層由preprocessIMU.m統(tǒng)一完成零偏校準靜態(tài)段均值補償、重力分離高通濾波去g、坐標系對齊將手機坐標系旋轉(zhuǎn)至本地東北天ENU步態(tài)層detectSteps.m基于加速度模值norm(acc)的帶通濾波自適應(yīng)閾值峰值檢測輸出每一步的觸發(fā)時刻和峰值強度運動建模層包含兩個核心函數(shù)——estimateStepLength.m采用經(jīng)典Weinberg模型步長 ∝ 峰值加速度^0.25 × 步頻^0.5estimateHeading.m則融合陀螺儀角速度積分與磁力計若提供進行互補濾波輸出每一步的航向角變化量軌跡層integrateTrajectory.m接收步長序列和航向序列以初始位置為原點逐次執(zhí)行x step * cos(heading),y step * sin(heading)生成二維軌跡數(shù)組并支持疊加真值路徑對比。提示該架構(gòu)刻意回避了卡爾曼濾波KF或粒子濾波PF等高級狀態(tài)估計算法。這不是能力不足而是設(shè)計取舍——對于教學(xué)和快速驗證確定性模型更易理解誤差來源比如發(fā)現(xiàn)步長估計算錯直接看estimateStepLength.m的冪律系數(shù)即可而KF/PF需要協(xié)方差矩陣調(diào)參、過程噪聲建模新手極易陷入“調(diào)了一周參數(shù)軌跡還是發(fā)散”的絕望循環(huán)。本項目把復(fù)雜度控制在“改一個參數(shù)就能看到效果變化”的范圍內(nèi)。2.1 數(shù)據(jù)預(yù)處理重力分離與坐標系對齊的物理意義PDR最大的坑不在算法而在原始數(shù)據(jù)本身。手機IMU輸出的是設(shè)備坐標系Phone Frame下的加速度包含兩部分運動加速度我們想要的和重力分量恒定約9.8 m/s2但方向隨手機朝向變化。若不分離后續(xù)步態(tài)檢測會把人靜止持機時的重力波動誤判為邁步。preprocessIMU.m的核心就是解決這個問題function [acc_motion, gyro_corrected] preprocessIMU(acc_raw, gyro_raw, Ts) % acc_raw: N×3 matrix, columns are [ax, ay, az] in phone frame % Ts: sampling period (seconds) % Step 1: Static bias estimation from first 2 seconds static_len floor(2 / Ts); acc_bias mean(acc_raw(1:static_len, :), 1); % estimate bias as mean of static segment % Step 2: Remove bias acc_debiased acc_raw - repmat(acc_bias, size(acc_raw,1), 1); % Step 3: High-pass filter to remove gravity component % Use 1st-order IIR high-pass: y[n] alpha*(y[n-1] x[n] - x[n-1]) alpha 0.8; % cutoff ~0.5 Hz, adjustable acc_motion zeros(size(acc_debiased)); acc_motion(1, :) acc_debiased(1, :); for n 2:size(acc_debiased,1) acc_motion(n, :) alpha * (acc_motion(n-1, :) acc_debiased(n, :) - acc_debiased(n-1, :)); end % Step 4: Align to local ENU frame using known initial orientation % Here we assume initial phone pose is known (e.g., from calibration app) % Rotation matrix R_phone_to_enu is precomputed and passed in % For demo, we use identity (phone z-up matches world z-up) R_phone_to_enu eye(3); acc_motion acc_motion * R_phone_to_enu; % transpose because MATLAB uses row vectors gyro_corrected gyro_raw * R_phone_to_enu; end這段代碼的關(guān)鍵參數(shù)和邏輯說明如下static_len取前2秒數(shù)據(jù)估計零偏這是行業(yè)通用做法。實際部署時可改為檢測靜止段加速度模值 0.1g 持續(xù)1秒以上再計算但本項目為簡化固定首段alpha 0.8一階IIR高通濾波器系數(shù)對應(yīng)截止頻率約0.5 Hz。這個值必須大于人體步行頻率0.5–2 Hz否則會濾掉有效步態(tài)信號但也不能太大如0.99否則重力殘留嚴重。我一般會先用freqz查看幅頻響應(yīng)確保0.1 Hz處衰減 40 dBR_phone_to_enu坐標系轉(zhuǎn)換矩陣。真實場景中手機初始朝向未知需用磁力計加速度計融合解算初始姿態(tài)即“手機指南針校準”本項目為降低門檻假設(shè)已知并設(shè)為單位陣。若你有磁力計數(shù)據(jù)可調(diào)用ecompass函數(shù)生成該矩陣最后一行* R_phone_to_enu是MATLAB矩陣乘法規(guī)則所致當向量表示為行向量時坐標變換應(yīng)為v_enu v_phone * R這點極易寫反導(dǎo)致軌跡整體旋轉(zhuǎn)。2.2 步態(tài)檢測為什么用加速度模值而非單軸信號很多初學(xué)者會直接對acc_y手機豎直軸做峰值檢測結(jié)果發(fā)現(xiàn)人側(cè)身走路時檢不出步。根本原因是手機在口袋/手中姿態(tài)千變?nèi)f化單軸無法表征整體運動強度。正確做法是計算三維加速度模值a_norm sqrt(ax2 ay2 az2)它表征設(shè)備整體受力大小無論手機怎么拿邁步瞬間身體質(zhì)心加速都會引起模值突增。detectSteps.m的實現(xiàn)如下function [step_times, step_peaks] detectSteps(acc_norm, timestamps, Fs) % acc_norm: N×1 vector of acceleration magnitude % timestamps: N×1 vector of time stamps % Fs: sampling frequency (Hz) % Step 1: Bandpass filter to enhance gait frequency band (0.5-3 Hz) [b, a] butter(2, [0.5 3]/(Fs/2), bandpass); acc_filtered filtfilt(b, a, acc_norm); % Step 2: Adaptive threshold based on local RMS window_len round(1.5 * Fs); % 1.5-second sliding window rms_local zeros(size(acc_filtered)); for i 1:length(acc_filtered) start_idx max(1, i - window_len/2); end_idx min(length(acc_filtered), i window_len/2); rms_local(i) rms(acc_filtered(start_idx:end_idx)); end threshold 1.2 * rms_local; % threshold 1.2 × local RMS % Step 3: Find peaks above threshold with minimum distance min_step_interval round(0.6 * Fs); % min 0.6s between steps (typical walking cadence) [pks, locs] findpeaks(acc_filtered, ... MinPeakHeight, threshold, ... MinPeakDistance, min_step_interval, ... Threshold, 0.05); % ignore small fluctuations step_times timestamps(locs); step_peaks pks; end關(guān)鍵參數(shù)解釋butter(2, [0.5 3]/(Fs/2), bandpass)二階巴特沃斯帶通濾波器強制將信號能量約束在步行主頻帶0.5–3 Hz。低于0.5 Hz是身體晃動等低頻干擾高于3 Hz是敲擊、抖動等高頻噪聲window_len round(1.5 * Fs)1.5秒滑動窗計算局部RMS用于生成自適應(yīng)閾值。固定閾值如threshold 1.5在不同人、不同手機型號下完全失效——老人步幅小、加速度峰值可能僅0.8g而年輕人跑步可達3gmin_step_interval round(0.6 * Fs)最小步間間隔對應(yīng)最大步頻100步/分鐘 ≈ 1.67 Hz → 0.6秒/步。這個值必須設(shè)否則findpeaks會把一個大步的多個局部峰都算成獨立步導(dǎo)致軌跡“碎步化”。注意findpeaks的Threshold參數(shù)注意不是MinPeakHeight是指峰頂與鄰近谷底的最小垂直距離用于過濾“矮胖峰”。我曾因漏設(shè)此項在光滑地磚上行走時把加速度波形的多個小起伏全當步態(tài)軌跡變成鋸齒狀——血淚經(jīng)驗是Threshold值設(shè)為0.03–0.08單位g通常安全。2.3 步長與航向建模經(jīng)驗公式為何仍是工業(yè)界首選學(xué)術(shù)論文熱衷用深度學(xué)習(xí)擬合步長但工程落地時Weinberg模型2002年提出仍被大量商用PDR引擎采用原因就一個魯棒性。LSTM模型在訓(xùn)練集上RMSE0.05m但換個人、換手機、換走路姿勢誤差立刻跳到0.3m而Weinberg公式step_length k * (a_peak)^0.25 * (f_step)^0.5其中k≈0.25單位m·s^0.5/g^0.25對人群泛化性極強。estimateStepLength.m實現(xiàn)簡潔function step_lengths estimateStepLength(step_peaks, step_times, k_factor) % step_peaks: vector of peak acceleration magnitudes (g) % step_times: vector of step timestamps (s) % k_factor: empirical coefficient, default 0.25 if nargin 3, k_factor 0.25; end % Calculate step frequency (Hz) from time intervals step_intervals diff(step_times); step_freqs 1 ./ step_intervals; % Hz % Weinberg model: L k * a_peak^0.25 * f^0.5 step_lengths k_factor * (step_peaks(1:end-1)).^0.25 .* sqrt(step_freqs); % Clamp unreasonable values (e.g., due to mis-detection) step_lengths(step_lengths 0.3) 0.3; % min step length 30cm step_lengths(step_lengths 1.2) 1.2; % max step length 120cm end這里有兩個易錯點必須強調(diào)step_peaks(1:end-1)因為step_freqs是由diff(step_times)計算的長度比step_peaks少1所以步長序列長度必須與之對齊。若直接用step_peaks全量會導(dǎo)致維度不匹配報錯clamp操作不是可選項而是必選項。步態(tài)檢測誤觸發(fā)如手機碰褲兜會產(chǎn)生虛假高峰值5g代入公式得step_length 2m積分后軌跡直接飛出屏幕。硬限幅是最簡單有效的防御。航向估計estimateHeading.m同樣采用務(wù)實策略純陀螺儀積分integrateGyro.m提供高帶寬但漂移大磁力計方位getMagHeading.m提供絕對參考但易受鐵磁干擾。二者用一階互補濾波融合function headings estimateHeading(gyro_z, mag_heading, alpha) % gyro_z: angular velocity around phone z-axis (rad/s) % mag_heading: magnetic heading (rad), from magnetometer % alpha: weight for gyro integration (0.95~0.995), higher more gyro trust if nargin 3, alpha 0.98; end % Integrate gyro to get relative heading change dt mean(diff(timestamps)); % assume uniform sampling dtheta_gyro cumsum(gyro_z) * dt; % Complementary filter: heading alpha * (prev_heading dtheta_gyro) (1-alpha) * mag_heading headings zeros(size(mag_heading)); headings(1) mag_heading(1); % initialize with mag for i 2:length(mag_heading) headings(i) alpha * (headings(i-1) (gyro_z(i)*dt)) (1-alpha) * mag_heading(i); end endalpha 0.98意味著98%信任陀螺儀的短時精度2%引入磁力計修正長期漂移。這個值需實測調(diào)整在開闊地走直線10米若軌跡明顯彎曲說明alpha過大陀螺漂移未被抑制若軌跡在門口反復(fù)橫跳說明alpha過小磁力計噪聲被過度放大。3. 運行指南從零開始跑通軌跡圖的六步實操別被“MATLAB”嚇住——只要你有正版或教育版MATLAB R2018a及以上無需任何額外工具箱Signal Processing Toolbox 是基礎(chǔ)包R2018a起已內(nèi)置5分鐘內(nèi)就能看到軌跡動起來。以下是經(jīng)過12次重裝環(huán)境驗證的傻瓜式步驟每步附失敗現(xiàn)象和定位方法。3.1 環(huán)境準備確認MATLAB版本與路徑設(shè)置首先打開MATLAB執(zhí)行以下命令檢查基礎(chǔ)環(huán)境 ver which butter which findpeaksver輸出中必須包含Signal Processing Toolbox版本號不限which butter應(yīng)返回類似C:\Program Files\MATLAB\R2021b\toolbox\signal\signal\butter.m的路徑which findpeaks同理應(yīng)在signal目錄下。提示若提示Undefined function butter說明你的MATLAB安裝時未勾選Signal Processing Toolbox。請重新運行安裝程序勾選該組件并修復(fù)安裝。不要嘗試用pkg install安裝Octave版語法不兼容。然后將下載的項目文件夾假設(shè)解壓到D:\pdr_matlab添加到MATLAB路徑 addpath(D:\pdr_matlab); savepath; % 保存路徑下次啟動自動加載savepath很關(guān)鍵否則重啟MATLAB后又要重復(fù)addpath。3.2 數(shù)據(jù)加載兩種方式任選其一項目自帶兩套數(shù)據(jù)data/sample_walk.mat模擬數(shù)據(jù)含真值和data/real_walk.csv某開發(fā)者實采的手機傳感器數(shù)據(jù)。推薦新手從.mat開始 data load(D:\pdr_matlab\data\sample_walk.mat); acc data.acc; % 1000×3 matrix gyro data.gyro; % 1000×3 matrix ts data.timestamp; % 1000×1 vector gt_pos data.gt_pos; % 1000×2, ground truth [x,y]若用CSV如real_walk.csv需確保列名為time,acc_x,acc_y,acc_z,gyro_x,gyro_y,gyro_z然后調(diào)用 data_csv readtable(D:\pdr_matlab\data\real_walk.csv); acc [data_csv.acc_x, data_csv.acc_y, data_csv.acc_z]; gyro [data_csv.gyro_x, data_csv.gyro_y, data_csv.gyro_z]; ts data_csv.time;注意CSV時間列若為字符串如2023-01-01 10:00:00.123需先用datetime轉(zhuǎn)換再datenum得到數(shù)值時間戳否則diff(ts)會出錯。本項目loadSensorData.m已內(nèi)置此邏輯直接調(diào)用更安全 [acc, gyro, ts] loadSensorData(D:\pdr_matlab\data\real_walk.csv);3.3 執(zhí)行主流程runPDR.m一鍵啟動項目根目錄下有runPDR.m這是整合所有模塊的入口腳本。打開它修改前三行參數(shù)%% User Configuration data_path D:\pdr_matlab\data\sample_walk.mat; % 修改為你自己的路徑 Fs 100; % sampling frequency (Hz), must match your data init_pos [0, 0]; % initial position [x, y] in meters保存后在命令行運行 runPDR成功時MATLAB會依次彈出三個窗口Figure 1原始加速度三軸波形 模值曲線Figure 2步態(tài)檢測結(jié)果紅點標出每一步觸發(fā)時刻Figure 3藍色為PDR估算軌跡紅色為真值軌跡若有綠色為起點。若卡在某一步看命令行最后幾行報錯。最常見的是Error using diff: Matrix dimensions must agree→ 檢查ts是否為列向量N×1若為行向量加轉(zhuǎn)置ts ts(:);Index exceeds matrix dimensions→step_peaks長度與step_times不匹配回到detectSteps.m檢查step_peaks(1:end-1)是否寫錯圖形空白 → 檢查init_pos是否為[0,0]若為[0 0]空格分隔MATLAB會解析為1×2向量沒問題但若誤寫為[0,0,0]三維integrateTrajectory.m會因維度不匹配退出。3.4 結(jié)果解讀如何判斷PDR是否“跑對了”不要只盯著最終軌跡重合度PDR是累積誤差系統(tǒng)需分層驗證層級驗證方法正常現(xiàn)象異常表現(xiàn)步態(tài)層查看 Figure 2 的紅點密度紅點間距均勻約0.6–1.0秒一個與人步行節(jié)奏一致紅點扎堆檢測過敏感或稀疏漏檢或集中在某一段濾波參數(shù)錯步長層disp(mean(step_lengths))均值在0.5–0.8米成人正常步長均值0.3m閾值太嚴或1.0m峰值檢測誤觸航向?qū)幼咧本€時看 Figure 3 軌跡曲率藍色線接近直線無明顯螺旋或S彎藍色線持續(xù)右偏/左偏陀螺零偏未校準或劇烈抖動磁力計干擾軌跡層rms(gt_pos - est_pos)若有真值10米行走誤差1.5米典型PDR精度誤差3米說明某層模型崩了需回溯前3層提示沒有真值數(shù)據(jù)時用“閉環(huán)測試”——讓人沿矩形路徑走一圈回到起點PDR終點與起點距離即為累積漂移。優(yōu)質(zhì)PDR在10米邊長矩形中閉合誤差應(yīng)1米。3.5 可視化增強添加動態(tài)軌跡與誤差曲線runPDR.m默認只畫最終軌跡。想看“算法怎么一步步算出位置”需啟用動畫模式。找到runPDR.m中這一段% Optional: Enable real-time animation animate_flag false; % change to true if animate_flag h_anim animatedline(Color,b,LineWidth,2); axis equal; hold on; xlabel(X (m)); ylabel(Y (m)); title(PDR Trajectory Animation); end將animate_flag false改為true再次運行runPDR。你會看到藍色軌跡線從原點開始隨著每一步計算實時延伸像一支筆在紙上畫線——這種即時反饋對理解算法時序至關(guān)重要。還想量化誤差演化在runPDR.m結(jié)尾添加% Plot error vs step count if exist(gt_pos,var) size(gt_pos,1)size(est_pos,1) errors sqrt(sum((gt_pos - est_pos).^2,2)); figure; plot(errors, r-o, MarkerSize, 3); xlabel(Step Number); ylabel(Position Error (m)); title(Cumulative Position Error over Steps); grid on; end這會生成一張誤差增長曲線圖。理想情況下誤差應(yīng)近似線性增長每步引入固定漂移斜率越小越好。若曲線突然上翹說明某步航向估計崩了如手機被快速旋轉(zhuǎn)。3.6 常見問題排查5條血淚踩坑記錄PDR調(diào)試是典型的“牽一發(fā)而動全身”下面5條是我在某高校實驗室?guī)?7個學(xué)生調(diào)試時高頻出現(xiàn)且必須立刻解決的問題現(xiàn)象Figure 2 步態(tài)檢測圖中紅點全部擠在開頭1秒內(nèi)后面一片空白原因acc_norm輸入錯誤傳入了未濾波的原始加速度含重力導(dǎo)致模值恒為~9.8gfindpeaks在靜態(tài)段就觸發(fā)一堆偽峰后續(xù)因MinPeakDistance限制再也檢不出新步解決確認detectSteps的第一個輸入是preprocessIMU輸出的acc_motion而非acc_raw。在runPDR.m中打印max(acc_norm)若接近9.8則源頭錯了?,F(xiàn)象軌跡圖Figure 3顯示為一條垂直向上直線x恒為0y持續(xù)增大原因航向角headings全為pi/290度即所有步長都沿y軸正向累加。根源是estimateHeading.m中mag_heading全為NaN磁力計數(shù)據(jù)缺失或格式錯而alpha0.98導(dǎo)致陀螺儀積分從初始0開始一直累加正角速度解決檢查estimateHeading輸入的mag_heading是否為有效數(shù)值向量。若無磁力計將alpha臨時降為0.5強制更多依賴磁力計此時會報錯提示你補數(shù)據(jù)或改用純陀螺儀模式刪掉磁力計融合僅用cumsum(gyro_z)*dt?,F(xiàn)象運行runPDR后MATLAB卡死風(fēng)扇狂轉(zhuǎn)10分鐘后才報Out of memory原因sample_walk.mat是10萬點數(shù)據(jù)但runPDR.m中Fs100寫成了Fs1000導(dǎo)致min_step_interval round(0.6*1000)600findpeaks在10萬點中搜索間隔600的峰算法復(fù)雜度爆炸解決核對數(shù)據(jù)實際采樣率。用mean(diff(ts))計算真實Ts再算Fs1/Ts。本項目sample_walk.mat實際Ts0.01s→Fs100絕不能寫錯。現(xiàn)象軌跡圖中藍色線呈完美圓形半徑約5米繞圈不止原因陀螺儀零偏未校準gyro_z存在恒定偏置如0.02 rad/s積分后航向角線性增長cos/sin函數(shù)將其映射為圓周運動解決在preprocessIMU.m中acc_bias估計后同樣對gyro_raw做靜態(tài)段均值補償gyro_bias mean(gyro_raw(1:static_len, :), 1); gyro_debiased gyro_raw - repmat(gyro_bias, size(gyro_raw,1), 1);。務(wù)必對陀螺儀也做零偏校準現(xiàn)象runPDR運行無報錯但 Figure 3 為空白命令行最后顯示est_pos []原因detectSteps未檢出任何步態(tài)返回空數(shù)組[]導(dǎo)致后續(xù)estimateStepLength輸入為空integrateTrajectory無法執(zhí)行解決在runPDR.m中step_times后加disp([Detected , num2str(length(step_times)), steps]);。若輸出Detected 0 steps立即檢查detectSteps.m的acc_filtered波形——用plot(acc_filtered)看是否全為平直線濾波器把信號全濾沒了調(diào)大butter的帶寬或換ellip橢圓濾波器。4. 核心模塊代碼逐行精讀integrateTrajectory.m的數(shù)學(xué)本質(zhì)PDR的“推算”二字核心就落在integrateTrajectory.m這不到20行的函數(shù)里。它表面是簡單的三角函數(shù)累加背后卻是剛體運動學(xué)、數(shù)值積分誤差、以及坐標系變換的集中體現(xiàn)。逐行拆解不僅為了改代碼更是為了建立對PDR誤差源的直覺。function [trajectory_x, trajectory_y] integrateTrajectory(step_lengths, headings, init_pos) % step_lengths: vector of step lengths (m), length N % headings: vector of heading angles (rad), length N % init_pos: [x0, y0], initial position N length(step_lengths); if N 0 trajectory_x init_pos(1); trajectory_y init_pos(2); return; end % Pre-allocate output arrays trajectory_x zeros(1, N1); trajectory_y zeros(1, N1); trajectory_x(1) init_pos(1); trajectory_y(1) init_pos(2); % Integrate each step for i 1:N % Convert heading from global frame to local displacement % Note: headings are defined as angle from East (x-axis) counter-clockwise dx step_lengths(i) * cos(headings(i)); dy step_lengths(i) * sin(headings(i)); trajectory_x(i1) trajectory_x(i) dx; trajectory_y(i1) trajectory_y(i) dy; end end第1–3行函數(shù)簽名與輸入契約step_lengths和headings必須等長且headings(i)對應(yīng)step_lengths(i)這一步的航向。這是整個PDR鏈路的“接口協(xié)議”任何上游模塊如estimateHeading若輸出長度不匹配此處必崩。因此estimateStepLength.m中step_lengths ... step_peaks(1:end-1)的截斷操作就是為了對齊step_freqs由diff(step_times)生成從而與headings長度一致。第7–10行空輸入防御if N 0分支不是擺設(shè)。當傳感器數(shù)據(jù)全為零、或步態(tài)檢測完全失效時step_lengths []length([])返回0。此時直接返回初始位置避免后續(xù)循環(huán)報錯。這是工程代碼的底線思維——永遠假設(shè)上游會出錯。第13–16行預(yù)分配與初始化trajectory_x zeros(1, N1)預(yù)分配內(nèi)存因為軌跡點數(shù) 步數(shù) 1含起點。若用trajectory_x [init_pos(1)]然后循環(huán)trajectory_x [trajectory_x, new_x]MATLAB每次都要重新分配數(shù)組內(nèi)存1000步耗時從0.01秒飆升到2秒。這是MATLAB性能優(yōu)化的黃金法則。第19–24行核心積分邏輯dx step_lengths(i) * cos(headings(i))這行是歐氏幾何的直接應(yīng)用在平面直角坐標系中一個長度為L、與x軸夾角為θ的向量其x分量為L·cosθy分量為L·sinθ。這里的headings(i)定義為“從正東方向x軸逆時針旋轉(zhuǎn)的角度”符合地理坐標系慣例0°東90°北所以cos對應(yīng)xsin對應(yīng)y。注意若你的航向定義為“從北順時針”如某些導(dǎo)航系統(tǒng)則需改為dx step_lengths(i) * sin(headings(i))dy step_lengths(i) * cos(headings(i))。本項目統(tǒng)一采用“東為0°逆時針”所有模塊包括estimateHeading都遵守此約定這是避免坐標系混亂的唯一辦法。誤差放大機制這段代碼本身無誤差但它是誤差的“放大器”。假設(shè)第i步航向估計有Δθ弧度誤差則x方向引入的位移誤差為step_lengths(i) * sin(Δθ) ≈ step_lengths(i) * Δθ小角度近似。若Δθ 0.1 rad約5.7°步長0.6m則單步x誤差達0.06m100步后即使誤差不相關(guān)均方根誤差也達0.06 * sqrt(100) 0.6m。這就是為什么航向精度比步長精度更重要——步長誤差是標量累加航向誤差是矢量旋轉(zhuǎn)會隨步數(shù)平方根增長。5. 二次開發(fā)實戰(zhàn)將Weinberg步長模型替換為LSTM回歸器當你跑通基礎(chǔ)PDR下一步必然是提升精度。Weinberg模型雖魯棒但理論上限約0.8m/10m10米行走誤差0.8米。而LSTM能學(xué)習(xí)加速度波形的時序模式將誤差壓到本文還有配套的精品資源點擊獲取
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
偷拍五月丁香| 久9热| 色五月婷婷久久| 欧美人人女女精品综合五月天| 人妻精品久久久久久| 五月婷婷色色爱| 亚洲综合婷婷五月| 色婷婷亚洲综合网站| 久久五月激情| 色播五月综合网| 久草热在线视频| 色综合色色色色| 综合色播| 99,色| 久久久久久欧美精品se一二三四| 色黑鬼导航| 精品一二三区久久AAA片| 成人午夜无码视频| http:色情日本com| 噜噜精品| 91中文在线| 色五月激情五月| 6080av| 五月婷婷六月激情| 人人视频色| 亚洲成人av在线观看| 99亚洲无码| 青青草99re| 五月天婷婷激情综合| 色色色色色五月| 99热精品在线| 狠狠久久婷五月综合色| 182tv992tv人之初午夜免费观看| 日韩狠狠色| 久青操| 激情丁香社区| 黄页大全十八禁| 乱乱av| 丁香六月婷婷一区二区三区| 色色五月天丁香婷婷| 色区久久| 丁香五月开心五月激情| 五月婷婷激情日本| 亚洲日韩一页精品发布| 五月天久久网站| 超碰三级片| 99热在线播放| 99热12| 久久综合播放| 国产黄大片在线观看画质优化| 丁香 婷婷 亚洲 熟女| 五月 激情视频| 99啪啪| 第四色色六月色综合| 天天色综合网吨吧| 色欲人妻综合aaaaaaaa网| 丁香六月激情| 五月丁香六月婷婷色情| 婷婷美女精品视频| 91精品91久久久中77777久久玖玖九九| 亚洲1区| 色久播播| 人妻中文字幕精品| 91色色色| 情婷婷五月天| 婷婷五月天网址| 久久人人做人人妻人人玩精品va| 青草五月天| 九月丁香婷婷| 超碰在线观看成人视| 亚洲无码色色| 激情五月婷婷丁香| 色视五月天婷婷| 99网99热| 天天天久久久| 色综合久久综合中文综合网| 色五月美女| 国产成人av在线播放| 69午夜成人影片| 九色无码| 婷婷五月丁香综合瑟瑟| 91人人人人人| 国产精品电影网| 桃色激情婷婷伊人网| 欧美日韩婷婷五月天| 六月综合婷婷开心伊人| 五月天激情.com| 翔田千里 50岁 无码| 182.t午在线观看| 狠狠五月天| 五月婷婷激情| 强伦轩人妻一区二区电影| 六月婷婷激情图片| 色色丁香婷婷综合| 色色色地址| 久久久GOGO无码啪啪艺术| 婷婷色激情五月天| 丁香五月欧美色综合| 久久丝丝热| 十区av| 免费看欧美成人A片无码| 丁香五月天婷婷激情| 国产五月婷| 欧美在线视频99| 97操男人的天堂| 大伊香蕉精品视频在线| 日产精品久久久久久久蜜臀 | 久/久精品99看9| va婷婷| 五月香蕉婷婷| 狠狠操天天操综合| 99热这里只有精品13| 97人人干| 99在线观看亚洲| 9|无码久久久久久| 欧美日韩99| 色综合久久中文| 97超碰色| 欧美日韩五月婷婷| 非洲一级AV| 久久婷婷东京热大香樵| 99久久精彩视频| 一区无码| 久久一级片| 91九色在线观看免费| 色婷青青| wwww.9免费视频| 久久婷婷六月综合国际| 午夜丁香久久久久久| 韩日另类| 97干资源在线观看| 超色欲天天| 婷婷影院欧美| 色婷婷亚洲在线观看| 91色综合久久| 色欧美日| www.久9| 五月婷中文娱乐综合| AV在线二十六页| 婷婷五月天av小说| 五月亭亭色| 丁香花婷婷五月天| 香蕉狠狠爱视频| 婷婷五月丁香五月综合网| 五月天色婷婷激情| 久久狼人天堂| 开心激情婷婷| 欧美成人AAA片一区国产精品| 免费看欧美成人A片无码| 亚洲国产精品二二三三区| 天天碰夜夜操| 人操人| www,色综合| 欧美色97| 五月丁香综合激情在线观看| 五月丁香少妇网| 五月天激情网页| 青青草99热久久精品国| 激情小说婷婷五月| 亭亭五月丁香五月天激情| 五月天丁香成人| 久婷婷婷| 九月丁香| 中文字幕高清av| 亚洲第二AV| 正宗黄色毛片| 激情深爱综合| 丁香婷婷六月天| 久久成人天| 丁香色综合| 天天干天天日天天操| 久久久久亚洲AV成人无码电影| 天天噜日日噜综合无码| anquye伊人| 天天爽夜夜爽夜夜爽精| 五月播播| 激情五月天网| www.91AV.com| 色久播播| 婷婷丁香小说| 超碰在线人妻| 亚洲成人AV在线| 国产成人av在线播放| 色婷婷影院| 激情五月天啪啪| 丁香婷婷激情网站| 婷婷狠狠操| 日本一級黃色一級片| 97国产精品女人碰碰| 性生活视频98791| 大香蕉人妻| 大香网伊人久久综合| 日本色婷婷五月天成人电影| 五月丁香六月玩女人| 激情五月天婷婷五月天| 激情婷婷五月综合| 久久国产性爱A V| 五月开心激情网| 超碰com| 五月丁香婷婷色| 色婷婷人人| 丁香五月亚洲AV| 久色五月| 五月天另类激情在线| 久久婷综| 99'无码| 丁香五月综合久久| 性色播| 五月天欧美激情| 国产婷婷五月色情综合| 国产av天堂| 色婷婷综合电影| 天天弄天天爽| 色色色在线观看| 538在线精品| 伊人干综合| 亚洲综合色棒| 免费无码毛片一区二区A片| 亚州综合色| 五月丁香在线精品| 五月天国产| 五月天色色色色色| 五月天狠狠干| 禁欲电影完整版在线播放| 丁香婷婷婷五月综合色情| oumeisesewang| 激情图片婷婷| 午夜九九九九九九九九九九九九九| 日本情色一区二区| 激情第四色| 天天操天爱综合| 色婷婷AV在线| 五月丁香婷婷五月色| 五月天婷婷综合免费| 激情综合无码| 91久草五月天婷婷| 成人无码精品1区2区3区免费看| 日屌日日操日日色| 色情·com| 97精品综合久久内射| 色色五月丁香婷婷| 天天日天天爱天天噪| 五月婷网| 99视频在线啪| 婷婷中文字幕欧美| 亚洲九区| 九九热10| 性爱视频99| 99精品视频免费在线播放| 九九精品9| 午夜免费试看| 噜噜在线| 天天干天天爽天天爽| 色综合网址| 中文字幕操比影片| 激情深爱五月天| 六月婷婷开心| 99久久婷婷五月天| 五月激情五月丁香| 九色视频91疯狂| 99ER热精品视频| 在线观看的av| 久色五月丁香视频| 亚洲色色香蕉| VA婷婷亚洲| 99精品激情| 五月婷婷丁香91| 人妻av在线| 五月婷婷亚洲| 五月天激情婷婷久久| 丁香五月天色| 婷婷偷拍网| 色色婷婷丁香五月天| 久久99最新地址| 91精品综合久久久久久五月丁香| 狼人婷婷久久| 久久综合中文字幕| 99热亚洲| 久色激情| 日本人人xxx| 26uuu国产精品| 五月婷婷激情综合在线| 91婷婷丁香五月天免费视频网站| 日本色久| 91操在线| 97久操| 4399无码视频二区| 大香伊人久色| 99欧美精品99日本精品| 丁香六月在线综合| 激情6月| 国产做A爰片毛片A片美国| 久色资源| 久久伊人五月天| 大香蕉久久| 久久女人天堂| 五月丁香| 婷婷五月天伊人| 天天日天天干天天操| 91黄址| 久久美女五月天| 中文字幕婷婷五月天在线观看| 五月天婷婷丁香视频| 电影蜘蛛女| 久久精品爱爱| 五月视频日本免费观看| 99亚洲欧洲| 六月丁婷婷| 人人草公开操| 婷婷激情五月天综合| 丁香五月电影| 亚洲婷婷五月草久| 丁香欧美| 狠狠做深爱婷婷久久综合一区| 丁香网五月天激情| 色五月婷婷九月| 美女丁香五婷婷| 99精品热| 在线日韩视频| 成人精品视频99在线观看免费 | 婷婷操无码| 停婷丁五月在线| 九九色综合| 怡红院AV亚洲一区二区三区H| 婷婷色正月| 玖玖爱资源站| 色婷婷五月天| 欧美三日本三级少妇三99| 激情六月丁香综合| 婷婷欧美激情| 国产欧美精品AAAAAA片| 久9热视频| 亚洲久久视频| 亚洲成人无码网站| 97夫妻超碰| www.99情趣网| 怡红院院在线导航网| 成片免费观看大全| 日产精品久久久久久久蜜臀 | 天堂AV三级| 婷婷色色网站| 婷婷五月色播放| 五月婷婷激清网| 欧美久久网| 久久久国产精品黄毛片| 五月香婷婷| 六月婷五月丁香| 五月婷免费视频| 99九九精品| 五月六月婷| 欧洲精品欧洲情| www.色欲丁香婷婷| 九九成人| 五月丁香六月激情| 丁香月五月天婷婷久久| 五月丁香婷婷综合视频| 国产在线aaa片一区二区99| 久久综合丁香激情五月| www.狠狠操.con| 99久久99视频| 九一牛视频探花| 五月丁香网站| 亚洲精品无码久久| 天天噜噜| 色欲五月婷婷| 99在线免费视| 九九视频网| 蜜桃婷婷狠狠久久| 亚洲综合在线网站| AV变态另类一区二区| 久久伊人大香蕉| 丁香婷婷色色| 亚洲成人五月| 人妻久久久久久久久久| 亚洲激情丁香五月基地| 丁香在线视频| 久久久婷| 五月丁香婷婷中文| www.五月天婷婷| 久久成人天| 人妻爽爽爽久久久久久久久| 影音先锋色婷婷| 99热久久日本| www.一起草av| 97成人在线视频| 丁香五月花| 99免费在线视频| 亚洲五月婷婷| 久久精品这里只有精品免费首页| 婷婷激情社区| 热久精品| 大香蕉啪啪啪| 欧亚成人A片一区二区| 婷婷色色五月| 国产AV一区二区三区最新精品| AVDV久久| 天天插天天干| 国产精产国品一二三在观看| 超碰在线50| 欧美日本免费一道免费视频 | 亚洲欧美999| 五月婷婷自拍视频| 五区毛片七区毛片| www夜夜操comwww| 色丁香六月| 五月天激情久色| 色插综合网| 综合五月亭亭9| 激情五月天之六月婷婷| 激情五月天色爱| 久久这里都是精品视频| 亚洲一区二区色图-亚洲精品国产精品乱码-成人AV | 十区av| 欧美五月婷婷综合| 欧美情色电影一区二区| 人人操9| 嫩草AV久久伊人妇女超级A| 色色激情| 五月开心播播网| 国外亚洲成AV人片在线观看| 亚州欧美黄色电影| 久久婷婷草| 九九视屏| 大天天伊人| 久久丝袜婷婷| 国产99热| 狠狠干激情五月| 俺去也在线官网| 日日夜夜爽爽| 激情五月六月丁香| 国产精品久久久海的味道| 五月丁香婷婷综合| 亚洲人妻av| 五月天大香蕉| 久久九九热38| 九九精品热播| 久久99久久99精品免视看婷婷| 337p午夜影院| 狠狠CAO日日穞夜夜穞AV| 情欲禁地| 丁香五月天亚洲综合| 日韩激情网站| 玖玖婷婷色五月| 亚洲sesesese| 亚洲看av的网站| 久久视频这里99| 91porn一起草| 色色操| 欧美美女国产日韩一区二区久 | 人人性久久| 66精品国产成人| 婷婷五月免费观看| 九九婷婷网五月天| 5月丁香啪啪啪| Blackedraw视频一区二区| 9精品国产在热久久| 丁香五月天.com| 五月婷婷激情综合在线| 六月丁香激情网| 激情综合五月天| 国产99久久久国产精品免费看 | www.五月丁香av| 五月婷婷中文字幕AV| 五月天激情网图片| 天天透天天干| 色色色99韩| 天天做天天摸| 五月丁香啪啪啪| 九九精品碰| 亚洲精久久| 99免费热视频| 久久免费精彩视频| 人妻激情网| 激情文学天天| 久操97| 丁香网站| 91综合在线视频| 夜夜噜夜夜奇| 亚洲成人网在线观看| 婷婷色情 | 久操福利| 婷婷色情五月| 丁香五月色情| 久久精品五月| 综合五月激情| 久久婷综合| 五月花激情网| 色婷婷丁香特级性爱视频| 久久99综合网| 九月色婷婷综合亚洲| site:xiongshengzz.com| 婷婷丁香人妻天天| 色婷婷成人做爰A片免费看网站| 婷婷丁香五月天影院 | 丁香五月综合网亚洲综合欧美狠狠| www久久99com| 蜘蛛女侠2003满天星免费观看| 人妻中文在线| 亚洲成人一区| nvrentiantang av| 婷婷五月天淫荡| 这里只有精品偷拍| 99久久www| 久久丁香综合香蕉| 婷婷涩涩网| 超碰人人在线| 久久加勒比| 六月丁香激情最新更新| 色9999日韩国产| 久久久久久久久久久97| 激情五月天激情综合网| 九月婷婷在线视频| 日日干夜夜撸夜夜骑 | 五月天色狠狠| 久操婷婷| 中文字幕在线免费| 日本高清久| 99视频日韩| 久久99久久99精品免观看软件| 久久精品这里只有精品免费首页| 99精品一二三四视频| 开心五月婷婷婷美女| 激情小说色五月| 五月激情丁香久久综合网| 夜夜 操无码| 伊人网啪啪| 五月丁香六月综合激情无码软件亮点 | 中文资源在线a| 色综合色婷色基地| 婷婷成人五月天成人文学| 91九色超碰| 婷婷瑟五月天久久综合| 日韩成人电影AV| 黄色大片又大粗又爽| 久久综合五月天| 玖玖在线| 五月天激情网址| 五月激情六月宗合| 91人人妻人人操人人爽| 99re99热| 9久精品视频| 久久婷婷影院| 色婷婷丁香五月| 影音先锋男人AV资源站| 六月婷婷AV| 久久这里只有精品视频26| 亚洲乱码日产精品BD| 亚洲第一色网站| 久久婷婷热| 极骚大香蕉伊人| 欧美怡红院黄站| 开心五月婷婷在线视频免费观看| 99精品视频在线观看| 丁香五月丐人妻| 色五月综合网| 欧美噜一噜| 国产免费性爱| 国产精品婷婷午夜在线观看| 99在线播放| 激情五月综合婷婷| 九九色大香蕉| 五月丁香六月综合激情| 爱之国产色情综合| www.97视频| 丁香五月婷在线观看| 亚洲电影中文字幕| 六月色婷婷| 在线视频另类| 91久久久久久久| 五月香蕉婷婷| 久久久色情| 九九热最新| 伊人狠狠丁香婷婷综合尤物| 五月综亚洲| 国产精品第一国产精品| 四色AVwww| 亚洲婷婷婷| 久久激情综合| 少妇激情五月婷婷| 五月天伊人久久| 五月丁香婷婷色色色| 五月婷婷综合激情网| 亚洲日韩一页精品发布| 亚洲丁香网| 狠狠九九婷婷韩| 欧美va在线| 天天色综合色| 天天网曰日曰夜夜综合永久免费| 九月丁香婷婷| 激情二色月| 六月婷婷AV| 丁香六月激情综合| 婷婷五月伦理| 五月丁香久| 人妻内射一区二区在线视频| 99爱这里只有精品免费视频| 99黄色性生活| 人妻视频一区而且二区| 激情综合在线观看| 婷婷五月天无码熟女| 99玖玖精品| 在线不卡视频| 久久亚洲婷婷| 2015好吊操| 天天插操| 综合色色婷婷| 久久人妻伦理| 色五月婷婷狠狠撸| 大香久久伊人网| 九九亚洲视频| 丁香五月婷婷在线| 五月激情婷婷开心五月| 免费国产视频| 婷婷婷婷婷婷婷婷婷婷丁香| 久久久大香蕉| 99热久久这里只有精品2010| 秋霞免费三级片| 高清资源站日A美A欧亚…| 中文字幕,综合,91| 久久午夜理论| 吊色AV男人的天堂| www天堂99| 婷婷五月成人| 97五月天| 五月丁香色婷婷综合| 久9久9久9久9久9久9| 国产一级黄色影片,| 天天色播| 丁香五月在线观看| 五月激情综合激情五月| 激情综合网五月| 久久婷婷五月综合色欧美| 婷婷激情五月| 日本97人人| 激情综合五月婷婷| 天天操夜夜爽| 综合丁香婷婷五月天| 亚州色综合| 狠狠久久婷五月综合色| 丁香五月欧美| 五月 激情视频| 婷婷伊人久久综合| 第四色色六月色综合| 天堂久久性| 玖玖婷婷免费| 精品亚洲国产成人A片在线鸭王| www.久久av.com| 欧美色骚婷婷五月天| www.久久久久久久| 亚洲无码AV片| 婷婷五月五月丁香| 最近中文字幕在线中文视频| www.狠狠操| 丁香九月综合激情| 五月天婷婷涩涩| 色色婷婷综合| 99精品偷自拍| 国产这里只有精品| 婷婷久久亚洲| 九九热精品99| 99热成人在线观看| 婷婷五月天在婷| 色七色九九| 九色1区视频在线| 色视频色综合91| 色情成人五月天| 欧美成人A片AAA片在线播放| 亚欧州精品视频| 婷婷五月综合视频免费播放| 9这里只有精品| 九九蜜臀精品| 色五月丁香六月资源站| 亚洲国产成人综合| 超碰女人天堂| 久久大香蕉伊人| 爱iii做iiii日日| 国产成人综合电影| 久9热视频在线| 久久婷婷七月丁香| 人妻日日日| 青青草婷婷五月天| 欧美 色婷婷| 久久久GOGO无码啪啪艺术 | 久久久er热| 五月婷婷激情刺激| Xx色综合| 激情五月天在线| 激情99热| 欧洲日韩一区二区三区| 婷婷丁香六月五月天| 亚洲小视频免费播放| 97操在线视频| 久久精品性爱视频,| 五月婷五月婷伊人伊人五月婷| 激情五月天综合网| 亚洲视频二区| 久久婷婷伊人| 天天肏屄夜夜爽| 乱女乱妇熟女熟妇综合网站| 色婷婷丁香五月观看| 丁香婷婷五月天色播| 91操操操| 婷婷六月激情在线视频| 五月丁香影院| www.超碰在线| 久久天天| 真实的国产乱XXXX在线91| 欧美五月婷婷综合| 玖玖99免费视频| 大香蕉精品视频| 五月天另类小说亚洲| 五月丁香婷婷国产精品综合| 久久草婷婷丁香网站| 99爱免费视频| 激情五月丁香婷婷| 色欲天天综合网| 五月婷婷开心网| 熟女人妻视频| 色护士综合| 五月婷啪| 丁香五月婷婷动漫视频| www.henhengan| 综合激情在线| 67194国产| 五月精品99综合| 婷婷va| 日韩综合网络男女香蕉a片| 五月天婷婷黄色视频| 丁香久久AV| 视色综合| 色婷婷综合亚洲| 婷婷五月丁香五月| 色色色五月天激情资源| 久久与婷婷| 久操热线| 丁香五月激情网| 99日热在线视频| 亚卅毛片| 色综合网址| 五月婷婷综合网在线播放| 夜夜做夜夜愛| 久久se 综合网| 丁香婷婷基地| 激情五月丁香五月综合| 婷婷九色| 天天摸夜夜爽天天做| 九九99精品视频在线观看| 丁香婷婷成人在线播放| 色爱99| 五月丁香综合激情| 五月婷婷之综合激情在线| 99热9999| 武汉美女啪啪视频免费一级片 | 99re视频在线| 亚洲色精彩| 天天艹天天色| 九九AV在线| WwW色婷婷| 97啪啪| 影音先锋人妻出差| 激情深爱五月天| 丁香伊人五月色婷婷五十路 | 日韩成人精品中文字幕| 婷婷久久18| 婷婷五月天激情四射五月天激情| 婷婷草| 久久久人妻| 五月丁香激情啪啪网| 日韩婷婷五月| 六月婷婷色| BBWCUCKOLD精品熟妇| 九九色综合网| 色狠狠色噜噜AV天堂五区消防| 91九色精品熟女内射| 碰碰操91| 九九热这里只有精品9| 久9久9久9久9久9久9| 五月天婷婷Av| 亚洲视频在线观看99| 久久hd| www,setingting| 久久黄色免费视频| 欧美丁香五月97色| 色五月婷婷伊人| www激情网| 综合激情网五月激情| 久久婷婷丁香| 久热精彩视频98| www.25五月婷婷| 综合网啪啪| 丁香六月亚洲| 99re26视频| 99精在线| 久久久18| 婷婷五月综合啪| 青青草青青草五月天| 欧洲99视频在线| 久久香蕉丁香| 婷婷丁香五月基地| 亚洲无码成人性爰网| 996er热| 五月婷婷亚洲色图| 色色综合网络| 色色色com| 我爱va亚洲va52| 五月丁香婷婷啪啪| 淫视馆aV二区一区| 96精品久久久久久久久| 亚洲免费视频网站| www激情婷婷com| 婷婷五月天久草在线| 婷婷欧美综合| 超碰com| 97久久五月丁香婷婷| 色婷婷亚洲六月婷婷中文字幕| W色综合| 青青福利网| 99精品偷自拍| www,五月丁,com| 内射人妻视频国内| 三区激情四射av| 996er热| www.狠狠| 综合激情在线| 五月婷婷丁香大陆免费| 激情综合激情五月一起草| 伊人九九68| 丁香五月综合图片在线观看| 中文字幕日产A片在线看| 欧美色狠婷久| 久久婷婷色| 久操b网| 婷婷久久综合| 久久伊人大香蕉| 91凹凸在线| 东京热伊人| 久久久久久久久久8888| 欧美99| 丁香五月天激情综合| 思思99精品视频在线观看| 欧美婷婷| 五月婷婷婷自由综合| 久9综合| 婷婷六月情| 99亚州综合精品成人网| 婷婷五月激情五月丁香五月| 狠狠色噜噜狠狠狠888| 成人AV网站在线| 激情婷婷五月天| 亚洲色图五月丁香| 91人人网| 婷婷激情五月天网站| 人妻少妇色综合| 午夜电影网VA内射| 丁香桃色网| 97色婷婷| tingting五月天亚洲| 五月香婷婷| 天天色色婷婷| 婷婷五月综合色小姐小说| 无码人妻一区| av第一二区| www、色色色| 综合久久高清| 五月激情婷婷丁香| 思思视频精品| 综合 激情 婷婷| 很很干天天干| 久久9精品视频| 深爱五月激情五月| caop在线| 操b视频在线观看一区二区| 噜噜色婷婷| 色婷婷伊人| 色色无码| 无码网站视频| 91精品91久久久中77777久久玖玖九九| 我爱大香蕉| 性婷婷| 99九九精品视频推荐| 九九这里有精品| 色玖玖综合网| 丰满少妇猛烈A片免费看观看| 天天擼久久擼在线| 99男人天堂| 91操碰| av 一区三区四区| 雪千夏麻豆| 久久久婷婷婷| 婷婷激情区| 99热很操老逼| 婷婷狠狠干| 狠狠插狠狠| 九九亚洲综合| 欧美亚洲色色色色| 久热超碰91| 婷婷五月天 偷拍| 色综合久久8| 天天弄天天爽| 91九色偷拍| 亚洲不卡| 啪啪干伊人婷婷| 99热欧美精品| 久久久99精品免费观看| 丁香五月婷婷AV在线| 激情五月深爱五月| Av在线不卡一区| 九九久久网| 第四色婷婷丁香五月| 伊人五月天综合网| 亚洲成AV人片在线观看| 婷婷久热| 激情网站综合五月天| 99人妻碰碰碰久久久久视| AA片在线观看视频在线播放| 六月婷婷啪啪| 婷婷六月视频| 五月天天丁香婷婷在线中| 色五月婷婷激情基地| 欧美S码亚洲码精品M码| 99人人干| 99精吕视频在线观看了| 五月天激情在线视频| 日本丁香久在线| 91人人人人人| 五月丁香香蕉| 五月丁香六月综合情在线观看| 亚洲激情综| 国产精品婷婷午夜在线观看| www超碰| 七月激情六月婷婷综合在线播放| 亚洲精品字幕在线观看| 超碰chaompinm| 色五月丁香网| 天干天天干天天天天天| 五月婷婷影| 亚洲无码影片| 五月丁香大香蕉| 激情综合色图| 婷婷丁香激情综合色情| 午夜美女人啪最红院| 99久久婷婷五月综合| 色婷婷影视99| 欧美成人AAA片一区国产精品| 天天干天天操天天拍| 婷婷深爱五月天| 五月天成人在线播放丁香| 色五月综合婷婷久久综合婷婷久久综合婷婷久久综合婷婷久久 | 色护士综合| 日日夜夜天天| 五月天另类激情在线| 丁香 久久| 色五月婷婷激情| 96性爱视频| 99热这里只有精品国产免费| 99热综合| 可以直接看的av| 超91热| 六月激情婷婷| 五月天丁香成人| 开心五月网 | 影音先锋 婷婷| 欧美激情五月天婷婷| 欧美大香蕉视频| 综合网狠狠| 五月综合激情图片| 五月婷婷伊| 五月天色小说| 拍真实国产伦偷精品| 成人日韩欧美| 婷婷五月成人| 91久久久久久久久18| 亚洲成人在线播放| 高清无码视频网址| 操一区| www.黄色片-久久成人国产精品在线播放-999AV | 大香网伊人久久综合| 成人婷婷| 国产免费一区二区三区三州老师F1F1.CC | 五月丁香激情婷婷综合字幕| 五月六月丁香婷婷在线观看| 亚洲av网站| 日本色婷婷| 超碰91在线| 色伊人婷婷| 生活片五区| 伊人狠狠丁香婷婷综合尤物| 久久性刺激| 一逼色综合| 97丁香婷婷| 26uuu欧美日韩| 色色无码日韩| 色五月婷婷 成人| 丁香五月婷婷久久久| 99色精品| 五月天婷婷久色| 99热成人精品| 99r久久这里只有精品| 久热只有这里有精品| 九九黄色网| 天天干,天天舔| 月婷婷亚洲| 久久久久久草黄色片AV在线观看| 99久久黄色顶级视频| 婷婷久久五月天亚洲欧美国产日韩在线观看 | 少妇人妻人伦A片| 97碰碰在线观看视频| 久草狼人| 丁香五月性| 色丁香久久| 久久无码成人| 丰滿爆乳一区二区三区| 天花AV无码| 久久五月婷婷丁香| 综合网色| 伊人综合网4| 婷婷中文字暮| 玖玖婷婷色五月| 激情综合色图| 久久这有这里精品| 久久久久人无码人妻| 亚洲婷婷激情五月天| 人人摸人人摸| 女婷久久| 欧美操人| 日韩久操婷婷| 久99精品视频| 99ri国产| 婷婷五月开心中文字幕在线| 伊人啪啪网| 免费黄色视频网址| 欧洲色区| 欧美日韩国产一区二区| 日本一道久久| 五月亭亭激情综合| 色五月丁香五月天| 色综合九九色综合88| 久久综合激情| 丁香五月成人自拍| 91岛国片| 人人色人人摸人人看| 99热只有这里才是精品| 免费AV在线| 亚洲妇女熟BBW| 婷婷六月久久| 韩日在线熟女| 激情五月六月丁香| 日本色天堂| 久久精品国产一区二区三区四区| 久久99网| 91无码视频| 亚洲天堂AAA| 色五月 五月婷婷| 六月丁香久久| a毛片二逼wwwwwwwwww| 色情丁香五月婷婷精品| 丁香五月丁香伊人| WWW免费视频碰碰碰碰| 成人无码精品1区2区3区免费看| 色情开心五月| 久久er+| 综合色影院| 少妇被躁爽到高潮无码文| 九月婷婷激情| 五月亭亭六月激情| 激情图片婷婷丁香五月| 激情久久综合| 五月婷婷久久大片| 99在线精品观看99| 狠狠色噜噜狠狠| 久久国产色| 精品九九久久| 婷婷五月深深的爱| 久久久久这里只有精品| 久久人妻熟女一区二区| 99九九玖玖| 激情网开心网| 婷婷五月激情丁香| 99久久高清视频| 久久五月激情网| 九九热视频99| 91色五月在线观看| 天天爱天天日| 99九九视频| 丁香,开心成人,久久| 玖玖综合色| 婷婷五月天在线综合| 91精品久久久久久77777| 婷婷丁香综合在线| 色噜噜狠狠色综合日日免费| 婷婷综合网站| 在线91日韩| hd五月婷婷在线| 五月丁香六月婷婷网| 青青草Avb在线| 伊人五月人妻精品| 99久久激情视频| wWW九九在线播放| 五月婷婷综合潮喷| 99国产精品久久久久久久久久久| 日本久久视频| 午夜激情五月天| 99原创自拍视频在线观看| 美日韩成人| 亚洲综合视频网| 久久超级碰视频| 色播婷婷五月天| 国产成人精品一区二三区熟女在线 | 丁香五月开心七月| 天天开心婷婷丁香五月| 婷婷午夜综合| 大香蕉婷婷婷| 夜夜夜夜操| 天天爱天天爽| 日韩影院三级| 五月丁香激情婷婷| 久啪欧美| 丁香六月婷婷综合啪啪| 丁香花大香蕉婷婷综合| caopeng超碰| 天天日天天插| 九九五月天| 丁香婷婷色九月| 久热亚洲| 夜夜骑天天操| 99久久久精品| 亚洲一区二区无码蜜乳av| 中文字幕乱码亚洲精品一区| 极品色丁香| 婷婷在线免费| 天天射综合网站| 91干视频| 色五月五月婷婷| 久久狼人天堂| 国产婷婷综合在线免费视频| 午夜丁香综合婷婷| 大香蕉狠狠爱主页| www.com亚洲网站在线免费| 26uuu另类亚洲欧美日本一| 91人久| 色婷婷色五月丁香| 免费无码毛片一区二区A片| 密臀久久| 最近韩国日本免费高清观看| 亚州精品色情在线观看| 极品人妻VIDEOSSS人妻| 这里只有精9| 欧美性猛交99久久久久99按摩| 天天操天天操| 成人.在线日韩| 这里只精品热在线18| www.第四色99| 九九视频这里有精品| 极品少妇婷婷五月| 欧美成人色婷婷| 888久久久| 五月天六月色| 97久人人| 五月丁香 啪啪| 色欲色天天香综合| 婷婷欧美| 婷婷成人五月天一区| 伊人久久婷婷| www.色婷婷.com| 亚洲丁香婷婷| 天天做天天爱天天综合| 丁香婷婷五月综合| 9l视频自拍9l九色9l成人| 91精品久久久久久久| 亚洲高清在线| oVV4WIB3vFi8D| 欧在线一区| 色五月激情网| 欧美在线97| 婷婷五月天av| 天天色天天爽| 欧美综合激情| 成人丁香婷婷| 任你操精品免费| 97色色色| 99热久久这里只有精品| 五月停性愛| h在线看免费版在线看| 亚洲成人AV在线观看| 婷婷五月影院| 99在线观看精彩视频| www.色综合| 深爱五月亚洲| 五月丁香综合影院| 夜夜撸日日操| 五月丁香久久激情网| 久久婷婷激情四射五月天| 中文字幕在线免费观看视频| 色五月综合婷婷久久综合婷婷久久综合婷婷久久综合婷婷久久 | 99热国产免费| 亚洲丁香五月美女| 在线观看欧美3区| www.婷婷五月| 激情久久四色| 久综合4| 久热99热| AV九九| 婷婷五月性感| 99热在线观看精品| 777久久综合视频| 六月丁香婷婷综合影院| 99这里只有精| 99热777| 9人人操人人看| 久久五月婷6 9| 五月天综合| 天天激情综合| 国产4P视频精品五区| 国产激情综合五月久久| 日夜夜久久| 91超碰人人操| 久久五月天激情| 99九九综合久久九九| 久久综合热17c| 9 1大香蕉| 99热久| 天天干天天干天天| 亚洲色色爱| 色www.con| 一级操逼大片| 久9视频免费播放| 色五月五月丁香| 91AV婷婷| 激情网婷婷婷| 六月丁香停| 日韩限制级大尺度黑料泄密大尺度视频一区二区在线观看 | 五月婷婷丁香六月| 亚洲五月婷婷在线| 无码A片一区二区免费| 国产精品18久久久| 色色色色网| 激情丁香五月婷| 婷婷五月中文字幕| 91精品久久久久久综合五月天| 日本激情五月| 丁香婷婷六月激情文学 | 日本大人久久| 九九碰九九爱97超碰| 九九热思思| 五月在在观看| 九热...av| 五月婷视频在线观看| 国产FREESEXVIDEOS性中国| 日本色综合| 综合综合网| 丁香婷婷五月天校园春色| 久久大香免费| 一本色综合色| 能看的AV| 激情五月婷黄版| 激情婷婷五月天日本系列| 天天综合情| 婷婷综合天堂| 中文字幕无码AV| 久久女婷| 色色狼人综合| 性色视频| 天天爽综合| 丁香五月天婷婷久久综合| 99精品自拍| 91丨九色丨白浆|