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

ARTICLE DETAIL

資訊詳情

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

Pico手柄+MuJoCo遙操作實戰(zhàn):從坐標(biāo)轉(zhuǎn)換到逆運(yùn)動學(xué)全解析

Pico手柄+MuJoCo遙操作實戰(zhàn):從坐標(biāo)轉(zhuǎn)換到逆運(yùn)動學(xué)全解析 1. 為什么選擇Pico手柄來做Mujoco遙操作先說項目背景。我最近在做一套基于Mujoco的機(jī)器人仿真遙操作系統(tǒng)目標(biāo)很直接戴上Pico VR頭顯雙手各拿一支手柄在現(xiàn)實空間中自然移動手臂仿真環(huán)境里的機(jī)械臂末端就跟著我的手走。聽起來像是一個標(biāo)準(zhǔn)玩法但真正跑起來之后我才意識到整個鏈路里最花時間的不是環(huán)境搭建、不是手柄協(xié)議而是坐標(biāo)系轉(zhuǎn)換。先聊聊方案選型。目前做仿真遙操作主流輸入設(shè)備無非這么幾類輸入設(shè)備自由度成本上手難度適用場景鍵盤 鼠標(biāo)低極低低快速調(diào)試、離散點(diǎn)位控制SpaceMouse 3D鼠標(biāo)中中等中連續(xù)軌跡拖拽、示教數(shù)據(jù)手套高很高高靈巧手操作、精細(xì)抓取VR手柄Pico/Quest高較低中全身位姿映射、沉浸式遙操作我最終選了Pico手柄理由其實很樸素它自帶完整的6DoF六自由度追蹤位置三自由度、姿態(tài)三自由度一套拿到手就能用內(nèi)部有IMU和光學(xué)追蹤融合幾十毫秒內(nèi)能給出穩(wěn)定的手柄位姿不需要額外搭動捕系統(tǒng)。對比SpaceMouse那種搖桿式的輸入VR手柄最大的優(yōu)勢是你不需要學(xué)習(xí)映射邏輯——手怎么動機(jī)械臂末端就怎么動操作直覺幾乎為零門檻。對比數(shù)據(jù)手套成本又友好太多Pico Neo 3或Pico 4的一對手柄在閑魚或促銷時幾百塊就能收到而一套商用數(shù)據(jù)手套動輒上萬。實測下來對于末端位姿連續(xù)控制這個需求VR手柄是性價比最高的方案。順帶提一句我為什么沒有用WebXR或者瀏覽器方案。雖然Pico瀏覽器支持WebXR串流延遲和幀率穩(wěn)定性在復(fù)雜場景下不夠可靠遙操作最怕的就是手柄位姿抖動或者延遲突刺一旦出現(xiàn)機(jī)械臂在仿真里就是一頓亂甩。所以我選擇了更穩(wěn)的PC端鏈路Pico串流 - OpenVR/OpenXR運(yùn)行時 - Python - Mujoco。整套架構(gòu)從硬件到仿真每一環(huán)都能拿到確定的位姿數(shù)據(jù)和控制頻率排錯也方便。整個項目的技術(shù)鏈路如下Pico手柄物理位姿 ↓ 無線串流 PC端OpenVR運(yùn)行時SteamVR ↓ Python openvr庫 6DoF位姿矩陣OpenVR世界坐標(biāo)系Y-up ↓ 坐標(biāo)轉(zhuǎn)換Y-up → Z-up縮放偏置 Mujoco世界坐標(biāo)系下的目標(biāo)末端位姿 ↓ 逆運(yùn)動學(xué)求解 機(jī)械臂各關(guān)節(jié)角目標(biāo)值 ↓ Mujoco物理步進(jìn) 仿真機(jī)械臂末端跟隨手柄運(yùn)動這篇文章的重點(diǎn)放在坐標(biāo)轉(zhuǎn)換上因為這是我實際花費(fèi)時間最多、也最容易被后續(xù)項目復(fù)用的一段經(jīng)驗。但為了讓整個流程完整可跑我會把環(huán)境搭建、手柄數(shù)據(jù)讀取、控制環(huán)代碼一并講清楚。2. Mujoco仿真環(huán)境搭建從空環(huán)境到可動機(jī)械臂2.1 Windows 11上安裝Mujoco的完整步驟Mujoco目前已經(jīng)更新到3.x版本Python包安裝非常簡單本質(zhì)就是一條pip命令pip install mujoco它會自動安裝預(yù)編譯的wheel包里面已經(jīng)帶了物理引擎本體和離屏渲染器不需要自己編譯C代碼。但很多人在這一步就卡住了因為安裝完跑一個簡單demo會報glfw相關(guān)錯誤或者窗口閃退。原因通常是Windows 11缺少Visual C運(yùn)行庫或者顯卡驅(qū)動太老。建議先把這兩件套補(bǔ)上安裝Microsoft Visual C Redistributablex64版本這是Mujoco在Windows上跑起來的硬性依賴。去NVIDIA或AMD官網(wǎng)更新顯卡驅(qū)動Mujoco 3.x的渲染后端對OpenGL版本有要求老驅(qū)動會直接報錯。裝完后跑一下官方自帶的demo驗證環(huán)境import mujoco import mujoco.viewer xml mujoco modeltest_scene worldbody light pos0 0 2 directionaltrue/ geom typeplane size1 1 0.1/ body pos0 0 0.1 freejoint/ geom typesphere size0.1 rgba1 0 0 1/ /body /worldbody /mujoco model mujoco.MjModel.from_xml_string(xml) data mujoco.MjData(model) with mujoco.viewer.launch_passive(model, data) as viewer: for _ in range(1000): mujoco.mj_step(model, data) viewer.sync()如果能看到一個紅色小球自由落體并停在平面上環(huán)境就算通了。2.2 幾個高頻安裝問題的排查鏈路結(jié)合熱搜詞里大家都在搜的Mujoco安裝常見問題我把幾個真實出現(xiàn)過的坑和排查步驟整理出來第一個坑ImportError: DLL load failed while importing mujoco這個問題幾乎都出在mujoco.dll找不到依賴庫上。排查順序打開cmd輸入where python確認(rèn)當(dāng)前Python環(huán)境。確認(rèn)pip list里有mujoco且版本在2.3以上。運(yùn)行python -c import mujoco看具體報錯。如果依賴缺失重裝VC運(yùn)行庫重啟終端再試。第二個坑渲染窗口初始化失敗報GLFW error這個大概率是環(huán)境變量問題。Mujoco在Windows下會嘗試加載GLFW和OpenGL如果系統(tǒng)里裝了多個OpenGL驅(qū)動或者缺少M(fèi)ESA環(huán)境就會初始化失敗。我在Windows 11上遇到過一次最后是卸載了機(jī)器上殘留的舊版OpenGL驅(qū)動再重裝顯卡驅(qū)動解決的。如果你用的是虛擬機(jī)或遠(yuǎn)程桌面建議直接放棄GUI viewer改用mujoco.Renderer做離屏渲染再把圖像傳回來顯示。第三個坑加載自己訓(xùn)練的MJCF模型時報Unknown function in ...這通常是Mujoco版本升級后XML里的舊字段不再被支持。比如某些網(wǎng)頁上的教程還在用default class...而新版語法已經(jīng)變了。遇到這種問題不要慌直接去官方mujoco_menagerie倉庫找對應(yīng)機(jī)器人的最新MJCF文件比自己手寫XML省事得多。我用的是Franka Panda機(jī)械臂直接從官方模型庫里拉的模型。2.3 MJCF模型的加載與基本控制接口我這邊用的機(jī)械臂模型是Franka PandaMujoco官方mujoco_menagerie里就有。加載方式import mujoco model mujoco.MjModel.from_xml_path(path/to/franka_emika_panda/scene.xml) data mujoco.MjData(model) # 查看關(guān)節(jié)列表 for i in range(model.nu): print(model.actuator_names[i])Mujoco里的控制邏輯很簡單data.ctrl是一個數(shù)組每個元素對應(yīng)一個執(zhí)行器關(guān)節(jié)電機(jī)的目標(biāo)值。你設(shè)置了ctrl然后調(diào)用mujoco.mj_step(model, data)仿真就推進(jìn)一個物理步。后面做遙操作本質(zhì)上就是不斷把手柄解算出的關(guān)節(jié)目標(biāo)灌進(jìn)data.ctrl然后步進(jìn)仿真。需要記住的一個點(diǎn)Mujoco里運(yùn)動學(xué)計算依賴data.qpos廣義坐標(biāo)和data.qvel廣義速度而控制接口是data.ctrl。你做逆運(yùn)動學(xué)時通常是給一個期望末端位姿通過IK求出期望關(guān)節(jié)角然后設(shè)置到ctrl上。如果機(jī)械臂沒有PD控制器直接設(shè)置ctrl會導(dǎo)致關(guān)節(jié)位置是開環(huán)的機(jī)械臂不會乖乖停在目標(biāo)位置。所以MJCF模型里自帶的motor執(zhí)行器通常需要配合一個簡單的關(guān)節(jié)PD控制器或者用官方模型里已經(jīng)配好的position執(zhí)行器。3. Pico手柄數(shù)據(jù)讀取從硬件到Python的完整鏈路3.1 通信方案為什么走OpenVR而不是走Pico原生SDKPico手柄要拿到PC上現(xiàn)在主流有幾條路Pico自家SDK、OpenXR、OpenVRSteamVR。我最后用的是Pico串流助手 SteamVR Python openvr庫的組合。原因有幾個Pico串流助手是官方工具穩(wěn)定性和壓縮延遲控制得不錯。手柄位姿的精度很大程度依賴追蹤算法Pico的inside-out追蹤在手部快速移動時偶爾會有抖動但串流鏈路本身不會丟數(shù)據(jù)。OpenVR是PC端VR生態(tài)的事實標(biāo)準(zhǔn)。不管手柄是Pico還是Quest插上SteamVR都能被統(tǒng)一抽象為左右控制器設(shè)備接口固定Python有現(xiàn)成的openvr綁定不用自己寫底層USB協(xié)議。OpenXR雖然更現(xiàn)代但Python綁定少調(diào)試工具也少。如果只是做研究驗證OpenVR這條路更省事。3.2 通過openvr讀取手柄6DoF位姿安裝依賴pip install openvr讀取手柄位姿的完整邏輯如下import openvr import numpy as np # 初始化OpenVR openvr.VR_Init() poses None def get_controller_pose(): # 獲取所有設(shè)備的位姿 poses, _ openvr.VRCompositor().waitGetPoses() left_pose None right_pose None for device_index in range(openvr.k_unMaxTrackedDeviceCount): device_class openvr.VRSystem().getTrackedDeviceClass(device_index) if device_class openvr.TrackedDeviceClass_Controller: # 判斷左右手 role openvr.VRSystem().getControllerRoleForTrackedDeviceIndex(device_index) pose poses[device_index] # 位姿矩陣是3x4行主序 mat np.array(pose.mDeviceToAbsoluteTracking).reshape(3, 4) if role openvr.TrackedControllerRole_LeftHand: left_pose mat elif role openvr.TrackedControllerRole_RightHand: right_pose mat return left_pose, right_pose這里拿到的mat是3x4矩陣前三列是旋轉(zhuǎn)矩陣相對于OpenVR的世界坐標(biāo)系最后一列是位置。注意OpenVR的世界坐標(biāo)系是Y-up的右手坐標(biāo)系這一點(diǎn)非常關(guān)鍵后面坐標(biāo)轉(zhuǎn)換全靠它。3.3 數(shù)據(jù)形態(tài)與頻率說明OpenVR的數(shù)據(jù)刷新率通常跟頭顯的追蹤頻率一致Pico在串流SteamVR模式下一般是60Hz或者90Hz。對于遙操作來說這個頻率足夠了。但要注意waitGetPoses是阻塞式的如果串流畫面掉幀這個函數(shù)也會跟著掉幀。所以我在代碼里用的是getDeviceToAbsoluteTrackingPose配合一個獨(dú)立線程來讀數(shù)據(jù)避免畫面掉幀影響控制。還有一個容易忽略的點(diǎn)剛拿到手柄位姿時不要直接當(dāng)世界坐標(biāo)用。雙手拿手柄站在不同位置手柄位姿差異很大。遙操作時通常要定義一個初始零點(diǎn)——比如按下扳機(jī)鍵的瞬間記錄當(dāng)前手柄位姿作為參考基準(zhǔn)之后的手柄相對運(yùn)動都相對于這個零點(diǎn)來計算。這樣操作者不管站在哪里都能以一個舒服的姿勢開始控制。reference_pose None def on_trigger_pressed(): global reference_pose left, right get_controller_pose() reference_pose left # 比如以左手為基準(zhǔn)這個相對位姿的思路后面會反復(fù)用到也是避免操作者手酸的關(guān)鍵。4. 坐標(biāo)轉(zhuǎn)換這個項目真正的攔路虎4.1 為什么非轉(zhuǎn)不可回到標(biāo)題里的坐標(biāo)轉(zhuǎn)換。很多人覺得Mujoco環(huán)境搭好、手柄數(shù)據(jù)能讀到了接下來不就是把手柄位置賦給機(jī)械臂末端嗎其實根本不是。原因有三層坐標(biāo)系軸方向不同。OpenVR世界坐標(biāo)系是Y-upY軸朝上而Mujoco里常見的機(jī)械臂模型約定Z軸朝上機(jī)器人學(xué)慣例也貼合重力方向。如果直接把OpenVR的位置塞給Mujoco你會發(fā)現(xiàn)手柄往上抬機(jī)械臂往屏幕里走完全錯亂。物理尺寸映射需要縮放?,F(xiàn)實中你手臂的移動范圍可能只有0.5米左右但仿真里的機(jī)械臂工作空間可能是1米、2米。你需要一個比例因子把真實操作空間映射到仿真工作空間。初始對齊問題。手柄在世界坐標(biāo)系里的原點(diǎn)和Mujoco世界坐標(biāo)系里的機(jī)械臂基座原點(diǎn)并不重合。必須定義一個偏移讓手柄移動到某個區(qū)域時機(jī)械臂末端正好在初始位置。4.2 Y-up到Z-up的旋轉(zhuǎn)映射這是坐標(biāo)轉(zhuǎn)換的第一步。我需要一個旋轉(zhuǎn)矩陣把OpenVR的Y-up坐標(biāo)變成Mujoco的Z-up坐標(biāo)。繞X軸旋轉(zhuǎn)-90度即可實現(xiàn)Y-up到Z-up的映射。旋轉(zhuǎn)矩陣R [1 0 0] [0 0 1] [0 -1 0]驗證一下OpenVR坐標(biāo)系中的Y軸單位向量(0, 1, 0)左乘R得到(0, 0, -1)。這表示OpenVR中的向上在Mujoco中變成了-Z方向等等不對應(yīng)該驗證實際上OpenVR的向上是YMujoco的向上是Z。繞X軸旋轉(zhuǎn)-90度Y軸單位向量 (0,1,0) → 旋轉(zhuǎn)-90°繞X軸Y → -Z還是 Z繞X軸旋轉(zhuǎn)角度θ標(biāo)準(zhǔn)矩陣[1 0 0] [0 cosθ -sinθ] [0 sinθ cosθ]θ -90°時cos 0, sin -1[1 0 0] [0 0 1] [0 -1 0](0,1,0) → (0, 0, -1)。所以O(shè)penVR的Y映射到Mujoco的-Z。這不對我想要的應(yīng)該是Y→Z。那應(yīng)該用繞X軸旋轉(zhuǎn)90度[1 0 0] [0 0 -1] [0 1 0](0,1,0) → (0, 0, 1)即Y → Z。好這個才對。所以正確的旋轉(zhuǎn)矩陣應(yīng)該是繞X軸旋轉(zhuǎn)**90度**R [1 0 0] [0 0 -1] [0 1 0]同時-Z軸會映射到Y(jié)。通常OpenVR的-Z是朝向屏幕內(nèi)側(cè)或者說用戶前方映射到Mujoco的Y這通常沒什么問題因為機(jī)器人正面朝向可以人為約定。四元數(shù)的轉(zhuǎn)換也可以用同樣的思路但更穩(wěn)妥的做法是把OpenVR給的旋轉(zhuǎn)矩陣左乘R得到新的旋轉(zhuǎn)矩陣再轉(zhuǎn)成四元數(shù)。不要試圖在四元數(shù)層面直接變換容易在wxyz/xyzw的順序上翻車。def yup_to_zup(mat_3x4): R_yup mat_3x4[:, :3] # 3x3旋轉(zhuǎn)矩陣 t_yup mat_3x4[:, 3] # 位置向量 R_convert np.array([ [1, 0, 0], [0, 0, -1], [0, 1, 0] ]) R_zup R_convert R_yup t_zup R_convert t_yup mat_zup np.hstack([R_zup, t_zup.reshape(-1, 1)]) return mat_zup這一步做完手柄的手勢方向已經(jīng)和Mujoco對齊了但位置還是OpenVR原點(diǎn)下的絕對位置需要繼續(xù)平移和縮放。4.3 位置偏移與操作空間縮放接下來處理位置。假設(shè)操作者在初始化時按下扳機(jī)記錄一個參考位姿mat_ref_zup。之后每一幀的手柄位姿mat_cur_zup計算相對位移delta_pos mat_cur_zup[:, 3] - mat_ref_zup[:, 3]這個delta_pos就是操作者手部相對于初始位置的空間位移。然后乘一個縮放因子scale 0.6 # 根據(jù)實際工作空間調(diào)整 target_pos base_pos scale * delta_pos其中base_pos是Mujoco中機(jī)械臂末端的期望初始位置。你可以根據(jù)機(jī)械臂的零位姿態(tài)算出來比如Franka Panda的末端默認(rèn)在基座前方約0.5米處那么base_pos就設(shè)成(0.3, 0.0, 0.5)之類的值??s放因子的選擇有講究。值太大手柄微動一下機(jī)械臂就飛出工作空間值太小手部大幅移動機(jī)械臂才挪一點(diǎn)點(diǎn)操作很遲鈍。我這邊實測的經(jīng)驗是對于Franka Panda這種臂長1米左右的操作臂縮放0.5到0.8比較合適。對于小型的桌面機(jī)械臂工作空間20厘米量級縮放0.1到0.2。如果希望精細(xì)操作可以在手柄上某個觸摸板上加一個變速檔按住觸摸板時縮放系數(shù)降到原來的1/5做微調(diào)。4.4 四元數(shù)順序的坑Mujoco的wxyz與常見庫的xyzw這是整個坐標(biāo)轉(zhuǎn)換過程中最容易陰溝翻船的地方。Mujoco內(nèi)部使用四元數(shù)表示姿態(tài)時順序是w, x, y, z也就是實部在前。而很多庫比如scipy的Rotation.from_quat默認(rèn)接受x, y, z, w。如果你從OpenVR拿到的旋轉(zhuǎn)矩陣轉(zhuǎn)四元數(shù)默認(rèn)轉(zhuǎn)了xyzw順序直接塞給Mujoco的qpos機(jī)械臂的姿態(tài)會完全亂掉。我在寫代碼時統(tǒng)一封裝了一個轉(zhuǎn)換函數(shù)from scipy.spatial.transform import Rotation as R def mat_to_mujoco_quat(mat_3x4): # 輸入: 經(jīng)過yup_to_zup轉(zhuǎn)換后的3x4矩陣 rot_matrix mat_3x4[:, :3] quat_xyzw R.from_matrix(rot_matrix).as_quat() # 拿到xyzw quat_wxyz np.roll(quat_xyzw, 1) # 移到wxyz return quat_wxyz這個坑我必須強(qiáng)調(diào)凡是涉及四元數(shù)和Mujoco交互的統(tǒng)一走這一個函數(shù)別在調(diào)用處再自己轉(zhuǎn)一次。我剛開始時就是沒注意在IK解算里用scipy轉(zhuǎn)了一次又在賦值給qpos前用Mujoco的內(nèi)部函數(shù)轉(zhuǎn)了一次兩次轉(zhuǎn)換互相抵消姿態(tài)穩(wěn)定地偏了180度排查了整整一個晚上。5. 從手柄末端位姿到機(jī)械臂關(guān)節(jié)角完整控制環(huán)5.1 控制頻率與數(shù)據(jù)流設(shè)計手柄數(shù)據(jù)是60~90HzMujoco物理步進(jìn)可以跑得非??煳疫@里設(shè)定的是200Hz步進(jìn)。兩者頻率不一致不能每讀一次手柄就步進(jìn)一步也不能每個控制周期都去讀手柄否則控制會抖。我的做法是開兩個線程讀取線程以O(shè)penVR的頻率不斷更新當(dāng)前目標(biāo)末端位姿這個共享變量??刂凭€程以200Hz頻率運(yùn)行從共享變量里拿最新的目標(biāo)位姿做IK設(shè)置關(guān)節(jié)目標(biāo)步進(jìn)仿真。這兩個線程之間用threading.Lock保護(hù)共享變量避免讀到半寫狀態(tài)。5.2 末端位姿平滑低通濾波是必須的手柄追蹤在快速移動時會有微小的抖動直接用于控制會讓機(jī)械臂末端出現(xiàn)高頻顫振。解決方案是一個簡單的一階低通濾波alpha 0.3 smoothed_pos alpha * target_pos (1 - alpha) * smoothed_pos姿態(tài)也可以用球面線性插值slerp做平滑但我在實際項目中只對位置做了低通姿態(tài)平滑用了更簡單的nlerp歸一化線性插值效果夠用計算還便宜。注意alpha值不要太小否則滯后感明顯操作者會覺得跟不上手。我實測0.2到0.4是比較舒服的區(qū)間。5.3 逆運(yùn)動學(xué)求解阻尼最小二乘法從末端位姿求關(guān)節(jié)角最常用的方法是基于雅可比矩陣的數(shù)值迭代。Mujoco自帶mj_jac接口可以拿到雅可比矩陣所以我直接在控制循環(huán)里做阻尼最小二乘IKimport mujoco def ik_solve(model, data, target_pos, target_quat_wxyz, init_q, max_iter30): # 把當(dāng)前關(guān)節(jié)角作為初始猜測 data.qpos[:7] init_q mujoco.mj_forward(model, data) # 找到末端body的id ee_body_id mujoco.mj_name2id(model, mujoco.mjtObj.mjOBJ_BODY, ee_link) for _ in range(max_iter): # 當(dāng)前末端位姿 cur_pos data.body(ee_body_id).xpos cur_quat data.body(ee_body_id).xquat # 位置誤差 pos_err target_pos - cur_pos # 姿態(tài)誤差四元數(shù)轉(zhuǎn)旋轉(zhuǎn)向量 err_quat quat_error(cur_quat, target_quat_wxyz) rot_err quat_to_rotvec(err_quat) err np.hstack([pos_err, rot_err]) # 6維誤差向量 if np.linalg.norm(err) 1e-4: break # 雅可比矩陣3xN位置 3xN姿態(tài) jacp np.zeros((3, model.nv)) jacr np.zeros((3, model.nv)) mujoco.mj_jac(model, data, jacp, jacr, target_pos, ee_body_id) J np.vstack([jacp[:3, :7], jacr[:3, :7]]) # 阻尼最小二乘 lambda_reg 0.05 dq J.T np.linalg.solve(J J.T lambda_reg**2 * np.eye(6), err) data.qpos[:7] dq # 關(guān)節(jié)限位 data.qpos[:7] np.clip(data.qpos[:7], model.jnt_range[:, 0], model.jnt_range[:, 1]) mujoco.mj_forward(model, data) return data.qpos[:7].copy()這個IK不是全局最優(yōu)解但對連續(xù)控制場景足夠。每次迭代時以上一幀的關(guān)節(jié)角為初始值收斂非??焱ǔ?到5次迭代就到達(dá)目標(biāo)精度。阻尼系數(shù)lambda_reg不能去掉否則在奇異位型附近雅可比矩陣奇異解會爆炸。5.4 完整控制循環(huán)的代碼骨架把所有環(huán)節(jié)串起來主控循環(huán)如下def control_loop(): while running: with lock: target_pos smoothed_target_pos target_quat smoothed_target_quat # IK求解 q_target ik_solve(model, data, target_pos, target_quat, current_q) # 或者直接用關(guān)節(jié)PD設(shè)置目標(biāo)位置 data.ctrl[:7] q_target # 步進(jìn)仿真 mujoco.mj_step(model, data) # 更新平滑后的目標(biāo) update_smoothed_target()有一點(diǎn)需要提醒data.ctrl設(shè)置的是關(guān)節(jié)電機(jī)的目標(biāo)值如果你的MJCF模型里是純力矩電機(jī)這種開環(huán)控制會有靜態(tài)誤差。最省事的做法是在MJCF里給每個關(guān)節(jié)配一個position執(zhí)行器Mujoco內(nèi)置的position actuator會自動做關(guān)節(jié)PD控制量直接就是期望關(guān)節(jié)角省去自己調(diào)PD參數(shù)的麻煩。6. 實測效果與高頻踩坑記錄6.1 坐標(biāo)轉(zhuǎn)換沒做好時的典型病征這部分是我最想分享的因為踩坑時的現(xiàn)象和最終原因之間往往隔著一層窗戶紙。我把幾個典型表現(xiàn)列出來如果你也在調(diào)同類系統(tǒng)可以對照排查病征一手柄往右動機(jī)械臂往左動。這說明坐標(biāo)系發(fā)生了鏡像通常是繞某個軸的旋轉(zhuǎn)方向反了。檢查你自己的轉(zhuǎn)換矩陣看看是不是把繞X軸的90度和-90度搞反了。病征二手柄往上抬機(jī)械臂沿著水平方向亂飛。這是典型的Y-up/Z-up沒轉(zhuǎn)換OpenVR的Y軸位移被當(dāng)成了Mujoco的X或Z軸位移。我之前第一次跑起來就是這個現(xiàn)象整個機(jī)械臂像喝醉了一樣在水平面上亂竄。病征三機(jī)械臂末端位置對但姿態(tài)完全是擰的。姿態(tài)問題優(yōu)先檢查四元數(shù)順序。Mujoco要wxyzscipy給xyzw差一個np.roll就天翻地覆。另外檢查旋轉(zhuǎn)矩陣左乘的順序是R_convert R_hand還是R_hand R_convert這個順序錯了姿態(tài)同樣會擰。病征四一切正常但機(jī)械臂運(yùn)動有可感知的延遲和拖尾感。這種多半是平滑系數(shù)設(shè)得太小低通濾波滯后嚴(yán)重。把a(bǔ)lpha調(diào)大到0.3以上再看看是不是IK迭代次數(shù)太少導(dǎo)致每幀只能走一部分。還有一種可能是控制線程頻率太低試著手柄讀取線程頻率對齊。6.2 幾個容易被忽略的細(xì)節(jié)手柄丟失追蹤的容錯處理。Pico手柄快速甩動或者被身體擋住時追蹤會瞬間丟失OpenVR會返回上一次有效的位姿或者一個無效的pose。如果不做處理機(jī)械臂會突然停在原地然后等手柄恢復(fù)后猛跳一下。我的做法是拿到一幀位姿后檢查旋轉(zhuǎn)矩陣是否包含NaN以及位置是否發(fā)生突變位移超過5厘米就認(rèn)為是異常幀異常幀直接丟棄用上一幀值頂替。初始參考位姿的坐標(biāo)系基準(zhǔn)。記錄初始化基準(zhǔn)時建議讓操作者把雙手放在一個舒適的自然位置然后按下扳機(jī)。如果操作者身高不同、站位不同都要重新校準(zhǔn)。我寫了個簡單邏輯每次按下手柄的A鍵都重新記錄參考位姿方便隨時重新對齊。Mujoco的mj_forward和mj_step混用問題。在IK循環(huán)里必須調(diào)用mj_forward而不是mj_step因為mj_step會推進(jìn)動力學(xué)并修改速度不適合作為純運(yùn)動學(xué)校準(zhǔn)。在主控制循環(huán)里才用mj_step。如果你把IK里的mj_forward換成了mj_step會看到機(jī)械臂抖得非常厲害因為每幀都在改變速度而不是位置。渲染線程和控制線程的同步。如果用了mujoco.viewerviewer的sync()頻率必須配合渲染幀率不要每個控制循環(huán)都sync一次否則窗口會變成PPT。在實際項目中我讓viewer在獨(dú)立線程里以30Hz左右同步控制線程不關(guān)心viewer是否卡頓。6.3 性能與實際操作體驗整個鏈路跑通后我測試了勻速拖拽和快速抓取兩種典型操作。平穩(wěn)拖拽時機(jī)械臂末端和手柄目標(biāo)位置的位置誤差大概在毫米級主要來自IK迭代精度姿態(tài)誤差在1度以內(nèi)操作手感是指哪打哪??焖偎訒r會有輕微的超調(diào)和回落這是低通濾波本身的特性但整體可控。一個意外的收獲是這套方案不僅可以控制單臂我后來擴(kuò)展成了雙臂遙操作——左手手柄控制左臂右手手柄控制右臂坐標(biāo)轉(zhuǎn)換邏輯完全復(fù)用。只要把兩個手柄的位置分別映射到兩條機(jī)械臂的期望末端位姿即可。如果你也需要做雙臂協(xié)作類的仿真驗證這個擴(kuò)展路徑幾乎沒有額外成本。6.4 再分享一個調(diào)試小技巧最后聊一個很實用的調(diào)試方法。當(dāng)你的機(jī)械臂行為完全不符合預(yù)期時不要先在Mujoco里看結(jié)果而是把目標(biāo)末端位姿和IK輸出的關(guān)節(jié)角打印出來再用Mujoco的官方查看器單獨(dú)回放。這樣可以快速定位問題出在坐標(biāo)轉(zhuǎn)換還是IK。我寫了一個簡單的數(shù)據(jù)記錄模塊把每一幀的目標(biāo)位置、目標(biāo)四元數(shù)、IK結(jié)果關(guān)節(jié)角都寫入CSV之后用腳本離線分析。很多時候機(jī)械臂發(fā)瘋的原因是手柄數(shù)據(jù)本身就包含了異常跳變而不是你的控制代碼出了問題。這套仿真遙操作 坐標(biāo)轉(zhuǎn)換的方案從實際效果來看已經(jīng)很成熟了。如果你要復(fù)現(xiàn)這個項目我建議把重點(diǎn)放在坐標(biāo)轉(zhuǎn)換和IK的調(diào)試上這兩個環(huán)節(jié)一旦打通整個系統(tǒng)就像打通了任督二脈剩下的就是按需求調(diào)整參數(shù)。
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
玖玖爱导航| 青青.com| 免费无码毛片一区二区A片| 热99这就是精品视频| 五月激情啪啪| 中文字幕97超级碰| 色噜噜五月丁香婷婷| 五月丁香综合激情| 久久这里都是精品| 婷婷久久五月天亚洲欧美国产日韩在线观看| 五月天激情国产综合婷婷婷| 色婷婷欧美| 影音先锋 婷婷| 五月天婷婷丁香花| 中文久久婷婷| 成人色图情色成人网 www.5b5b5bcom 五月天 | 九九色精品| AV天堂婷婷五月天| 久久婷婷五月综合色播| 亚洲色激婷| 丁香五月天啪啪| 婷婷五月偷拍| 久久99久久99精品免观看软件| 五月丁香综合| 色综合久久久久| 91热手机在线| 久久日韩婷婷五月| 欧美日韩国产一区二区| 五月婷婷九九热| 久操乱| 婷婷五月情| 婷婷综合五月| 99狠狠操一| 国产,欧美,日韩,性爱| 六月激情婷婷综合| 五月丁香婷婷激情在线| 狠狠色 综合色区| 丁香五月天天| 婷婷综合成人五月天| 激情婷婷| 26uuu四色| 久操热| 99久久精品国产色欲| 婷婷日日夜夜| 婷婷五月丁香六月综合网| 丁香花五月天社区| 九九色院| 色99在线| 激情网狠狠干| 天天天操天天天日| 亚洲午夜电影| 五月婷婷六月丁香综合在线| 日日干日日| 激情五月天网| 婷婷碰碰| www,av好吊操| 婷婷色5月激情网| 人妻精品久久久久久久| 这里只有精品视频免费在线观看| 91视频精品99| 天天干天天干天天| 欧美日本免费一道免费视频| 综合激情九月婷婷,激情综合婷婷中文字| 丁香五月婷婷免费视频| 另类丁香综合| 91九九| 五月丁香日本一抹本| 女人露出p毛视频www网站| 日韩无码专区| 久热最新视频| 婷婷六月色开| 99er这里只有精品视频| 天天综合干| 六月丁香深深爱| 激情五月婷婷在线区| 亚洲色域网| 开心五月婷婷在线| 先锋资源91| 久久东京热婷婷五月| 五月婷婷五月天| 久久激情五月婷婷| 九久九精品| www.丁香六月婷婷久久天堂影院.con| 婷婷婷久久| 综合网啪| 97深爱伊人综合| 婷婷丁香色无五月| 天天插天天干| 99色五月| 五月婷婷丁香五月婷婷| 99性视频| 第四色网婷婷| 26uuu另类| 婷婷五月天美女21p| 久久久婷婷婷| 色婷婷五月成人网| 26UUU在线观看| 天天摸天天透天天舔| 深夜男女福利刺激影院一区完整| 久久精品小视频| 日日夜夜久| 中文字幕在线资源| 综合超碰熟| 丁香综合婷婷开心激情网| 日日操日日干| 99碰碰| 日本偷拍九九九| 91色噜噜狠狠狠狠色综合| 六月五月丁香五月欧美| 欧美色久| 婷婷丁香五月基地| 丁香五月在线观看完整版| 久久久大香蕉| 婷婷 伊人 久久| 99re思思精品视频在线观看| 伊人久久婷| 婷婷丁香激情| 九九综合| 97碰超级人人看| 亚洲综合婷婷五月| 狠狠穞A片一區二區三區| 色婷婷成人色网| 日本一毛片| 五月丁香天堂网婷婷| 国产精品国产| 亚洲成人精品三区| 操逼在线视频| 26uuuavcom| 少妇人妻人伦A片| 婷婷五月天激情四射| www.99热在线| 亚洲视频伍月婷婷| 激情6月| 开心五月综合激情网| 超碰精品手机在线| 五月丁香久久| 一区二区中文字幕| 激情婷婷六月天| www.一起草av| 婷婷精品综合| 伊久大香蕉| AV色五月婷婷| 五月天成人小说| 99网| 色五月xxx| av网址在线| 久久久久久久久久久月丁| 狠色狠色综合久久| 久热久re| 五月丁香色婷婷色| 九九aV| 99福利导航| 六月丁香成人| 超碰在线观看9| 99热欧美精品| 色婷婷久久| 婷婷色情网| 热99精品视频| 婷婷伊人綜合中文字幕| 精品无码色| 丰满人妻一区二区三区| 婷婷五月天色网久| 五月天婷婷色色首页| 婷婷色五月色| 精品久久9| 国产无人区大片| 99日精品视频| 内射爽无广熟女亚洲| 夜夜操夜夜爽| 操操熟女| 深爱五月激情| 中文字幕性爱丰满| 激情综合99| 操人久久| 久久婷婷色丁香| 超91热| 99热最新| 婷婷综合| 五月天色软件| 青青草原福利在线| 九色无码| 丁香六月婷婷色XXXXX| 97操视频| 亚洲乱码日产精品BD| 678五月丁香亚洲综合| 我要射综合| 免费观看全黄做爰的视频| 亚洲综合丁香五月| 欧美超碰亚洲| 91碰碰| 久久久人妻不卡| 精品人妻一区二区三区四区不卡在| AAA久久| 可以直接看的av| 色热久资源| 五月激情小说| 色五月婷婷五月天激情综合| 婷婷婷婷色| 停婷丁五月在线| 婷婷综合一二三| 9久热在线视频精品| 色婷婷19| 国产婷伊人| 色综合色综合网| 激情婷婷黄色五月| 色五月播五月| 婷婷五月18永久免费视频| 91久久国产综合久久| 欧美久久网| 日本99视频| 青青草大香| 外国碰视频网站97| 26uuu亚洲| 97干在线| 丁香久久综合| 在线成人av播放| 99热这| 六月五月婷婷| 精品人妻伦| 丁香花婷婷五月天| 久久日婷婷| 99热这| 五月婷婷丁香俺日污视频| 婷婷爱在线观看| 久婷婷久草| 色色色色综合| 97碰碰视频在线观看| 色爱终和网| 久热9| 高清 码 免费看片短视频| 91人人爱| 成人AV在线中文版| 亚洲V国产V欧美V久久久久久| 亚洲视频操| 九九色视频| 97婷婷丁香五月天激情图片| 伊人五月天日日夜夜久久久天天| 色色色婷婷五月天| 性视频久久| 亚洲 成人 电影av在线观看| 91人人人人人人人| 色婷婷AV久久| 91精选国| 久久一伦| 99久精品视频| 操操操91| 日本精品人妻无码77777| 天天日天天草| 丁香婷停五月激情综合深爱| 久热久色| 99在线免费视频| 97人碰人操| 婷婷丁香色五月| 狠狠色综合网站久久久久| 久久亚洲A| 久久久A级视频| 精品一二三区久久AAA片| 在线观看免费狠狠色丁香香综合| 激情性五月天免费小说视频| www好屌操| 大香蕉婷婷丁香天堂AV| 伊人网啪啪| 伊人久久丁香五月91| 久久婷婷五月| 超碰av在线| 色综合激情| 欧美黑人巨大猛烈cuckold| 日韩欧洲亚洲| 99热这里| 五月色丁香| 97色综合视频| 超级碰碰碰久久网站视频| 成人综合网站| 日本天天色| 五月久久婷婷| 五月激情六月丁香| 91狠狠色丁香婷婷综合久久精品| 亚洲丁香五月| 色噜噜97视频在线观看| 99热这里| 天堂久热| 国产免费AV在线| 成人短视频在线| 色噜噜狠狠色综合AV兰草影视| 激情五月天视频| 欧韩性爱| 五月婷天天搞视频| 婷婷五月无码| 一本狠婷婷综合| 无码动漫av| 丝袜人妻| 思思热再线视频| 久久久27操| 看逼中文字幕| 97综合视频在线| 午夜精品人妻无码一区二区三区| 欧美大片| a级毛片一区二区免费视频| 日韩AV在线影片| 成人无码精品1区2区3区免费看| 丁香网站| 99亚洲精品综合在线| 嫩BBB搡BBBB榛BBBB| 大香蕉九九| 婷婷五月影院| 国产精产国品一二三在观看| 亚洲岛国电影| 九九精品亚洲| 精品思思久久| 五月天婷婷中文字幕在线播放| 五月丁香好婷婷A片网| 五月天婷婷视频小说| 久久桃花网色婷婷| 91精品刘玥| 情色五月天 网站| 丁香五月婷综合| 丁香五月www| 久碰综合| 激情婷婷丁香五月天小说| 人妻性爱av网站| 韩日在线熟女| 天天操夜夜爽歪歪| 大香蕉久久久久| 丁香婷婷啪啪| 国产精品久久久久久久久久免费| 99久久終合| 97色女人在线| 亚洲成色综合网站免费观看| 亚洲va欧洲va国产va不卡| 噜噜国产| 大香蕉久| 五月综合激情图片| 97亚洲色 torrent magnet| 九九精品这里只有| 九九热最新| 欧美精品999| 超碰在线成人| 五月婷婷 自拍| 久久精品99久久久久久| 色噜噜狠狠色综合日日免费| 丁香五月婷老师| 大香蕉天堂| 久久6这里只有精品| 激情婷婷六月| 色天堂A| site:wpjngj.com| 亚洲性爱电影| 久99热在线观看| 婷婷香五月综合激情| 白人荫道BBWBBB大荫道| 久久网站观看免费欧洲国产| 亚洲超碰在线| 激情99热| 92久久精品一区二区| 久久er视频6| 五月天丁香成人社| 久久精典| 另类视频在线| 成人婷婷桔色| 日韩无码AV电影网站| 人人玩人人橾| 亚洲人妻av| 色综天天综合| 精品亚洲国产成AV人片传媒| 99视频精品8 | 婷婷久久五月丁香| 天天久久人人| 色婷婷在线视频| 五月婷婷丁香深深爱| 中文字幕 码精品视频网站| 99热在线观看精品| 婷婷五月天伊人| 色婷婷久久| 99久久激情视频| 五月天色综合| 亚洲一区先锋影音| 久久婷婷六月综合综合| 午夜九九九九九九九九九九九九九| 久久婷婷夜| 狼友超碰| 久久99激情| 欧美婷婷色| 久久免费视频62| 天天久久66xxx| 五月激激网w'w'w| 伊人婷婷五月天| www.刺激色网站www.| 欧洲激情五月天| 五月丁香婷婷啪啪| 日韩啪| 婷婷五月六月| 亚洲成人日韩无码精品| 欧洲亚洲欧洲99久久| 五月天婷婷无码| 182TV大香蕉| 九九热99热| 成人综合视频网址| 久久午夜理论| 国产精产国品一二三在观看| 深情六月婷婷综合久久| 五月婷婷丁香五月| 五月丁香日本一抹本| 9l视频自拍9l九色9l成人| 啪啪啪丁香五月| 激情久久五月网| 激情丁香五月婷婷| 综合激情网| 91Chinese在线| 国产精品大香蕉| 日本三级黄色大片| 精品久久艹| 久操无码| 狠狠操狠狠操AV| 久久99综合| 超碰AV在线| 嫩草视频在线观看| 婷婷99狠狠| www五月| 欧美99热| 91黄操| 久久婷婷综合五月| 另类小说五月天| 色婷五月天激情| 99久久久国产大片区| 欧美婷婷色五月网| 夜精品无码A片一区二区蜜桃| 99色色视频| 婷婷色五月天第7色| 久久丁香九| 色欲天天综合网| 日本成人噜噜噜| 综合久久丁香婷婷,五月婷婷六月丁香,开心激情综合网,六月丁香在线观看,婷婷丁 | 99er6免费视频热播| 亚洲色频| 色婷婷网大全在线| 日本天天操| 国产免费一区二区三区三州老师F1F1.CC | 精品视频99看在线视频| 91黄操| 国产操逼视频网站| 超碰天堂网| 六月婷婷色综合| 五月丁香色婷婷色| 99精彩视频在线观看| 成人做爰A片免费看网站找不到了 噼里啪啦在线观看免费完整版视频 | 五月天婷婷视频| 激情五月丁香色婷婷| 99操逼视频| 99热99思午夜精品| 69久久久| 丁香深五月婷婷| 色情婷婷| 国产激情综合五月久久| 99操视频| 噜噜在线| 中文字幕在线免费观看视频| 任你爽视频| 色婷婷av在线观看| 丁香花综合永久入口| 婷婷五月天视频免费在线观看| 丁香婷婷九月| 日逼影音先锋男人AV资源站| 天天搞天天色综合| 色五月丁香婷婷综合| 亚洲国产网站| 五月激情影院| 五月婷婷激情日本| 亚洲狠狠婷婷综合久久久| 亚洲电影中文字幕| 五月婷婷天| 可以免费看的av网站| 婷婷激情人妻| 欧美性生交xXxX久久久| 99久久综合网| 99热在线精品观看| 婷婷五月天成人娱乐| 色吧99| 天天天天天天操| 狠狠插日日干撸| 色欲一区二区三区精品A片| 色久激情在线| 五月天婷五月天综合网小说首页-五月天激激婷婷大综合,婷婷亚洲综合五月天小说 | 婷婷五月综合性爱| 俺去也婷婷| 亚洲色色香蕉| 丁香花五月天| 婷婷五月天AV| 婷婷综合九月| 亚洲日比视频| 无码少妇高潮喷水A片免费| 97色色色| 超碰激情网| 91丨九色|PRNY熟妇| 国产1区2区3区| 欧美性二区| 丁香五月婷婷六月婷| 三级大香蕉网| 丁香六月婷婷综合激情欧美| 天天插天天插| 久久人五月| 67194成I人在线观看线路1 | 天天操天天操天天操天天操天天操天天操| 五月花婷婷| 丁香五月天色婷婷| 99久久国产综合精品五月天喷水\| 久久丁香网| 人人干女人| 那里有AV网址| 啪啪六月婷婷| 午夜丁香| 日本专区久久| 五月天天天开心激情网| 激情中文在线| 亚洲综合色婷| 综合色99| 伊人超碰在线| 激情五月图| 亚洲热久久| 天干夜夜操| 99精品久久久久久| 婷婷久久婷婷色五月| www99热| 丁香五月六月综合激情| 日韩肏屄网| 丁香五月婷婷姐| 六月婷婷激情| 丁香六月成人| 开心激情色婷婷五月天| 婷婷月综合| 色五月婷婷在线观看第一页舔| 丁香六月啪啪啪| 2w在线视频| 久久久精品色| 五月丁香六月婷婷久久肏| 夜夜夜夜做天天天做无码视频| 极品另类| 99caobi| 欧美α√| 五月丁香欧美在线| 色情婷婷五月天| 天天做天天摸| 丁香五月伊人| 大香蕉婷婷久久| 久久综合丁香| 色婷婷五月天在线观看| 天堂无码人妻精品AV一区| 天天综合精品| 婷婷色色亚洲| 激情文学 综合 九月| 婷婷激情五月天激情小说| 婷婷激情五月天桃花网| 9超碰在线| 97极品在线| 内射综合网| 婷婷大香蕉| 亚洲精品V天堂中文字幕| 极品少妇XXXX精品少妇偷拍| 99天堂在线观看免费视频| 97婷婷五月| 丁香婷婷五月人体| 色琪琪一综合久久激情五月视频| 亚洲综合在线视频| 五月丁香亚洲五月| 婷婷五月综合网| 欧美在线97| 99精品综合| 亚洲九N| 字母不卡码人逼| 日本乱论99| 五月丁香综合激情| 色人五月婷婷| 久久久精品色| 久久久婷婷| 欧美日本免费一道免费视频| 丁香九月综合在线| 日本99视频| 热99视频| 九九久久玖玖爱| 天天插天天很| 日本波多野结衣视频| 五月天久久丁香| 亞洲自怕| 色五月丁香婷婷久草| 色婷六月| 日本久久99| 五月伊人综合| 久草丁香婷婷1024| 五月天com| 国产成人高清| 91狠狠综合久久久| 婷婷五月天亚洲丁香| 在线不卡的视频| 人人摸人人澡人人| 另类视频在线| 婷婷五月欧美综合| 99视频| 中文字幕视频在线播放| 无码中文一区二区三区| 超碰成人影视| 99热亚洲| 亚洲五月丁| 葵花AV在线| 五月天婷婷伊人| 思思热久久阴99| 丁香五月激情图片婷婷| 超碰97干| 五月婷婷熟女| 美欧成人视频| EEUSS鲁片一区二区三区| 日本色99| 欧美性生交XXXXX无码小说| 丁香婷婷视频一区二区| 大香蕉 伊人夜| 超碰在线国产| 婷婷在线免费| 日韩成人电影在线播放| WWW.国产| 五月婷婷亚洲| 99热www.| 99re青青草| 亚洲成人免费在线| 少妇达人正片在线播放_ikun_福利吧| 99激情网| 亚洲不卡123| 97婷婷狠狠| 深爱激情久久| 人人九色| 国产精品国产成人国产三级| 国产在线黄色| 成人精品视频99在线观看免费| 五月激情啪啪啪| 久久人妻伊人| 欧美丰满熟妇BBB久久久| 六月婷婷综合激情| 五月婷婷性| 婷婷视频在线| 国产99精品免费视频| 91欧美| 久久一级片| 婷婷丁香五月噜噜噜| 婷婷综合五月天| 国产免费一区二区在线A片视频| 色色色色色色五月婷婷| 亚洲综合婷婷六月丁香五月| 色欧美一级| 天天综合激情| 色综合色色| 丁香九月久久| 激情爱爱网站超大免费| 五月天之色情综合网| 五月天在线视频尤物视频在线看| 国产成人网| 久久五月丁香婷婷| 色色色婷婷五月| 99手机在线精品视频| 色色网五月激情| 热久综合| 五月婷婷我| 做爰丰满少妇1313| 九九视频热| 亚洲精品字幕在线观看| 亚洲成人电影aaaa| 精国产品一区二区三区A片| 爱爱色五月天| 狠狠综合网| 99色色热| 国产精品人人做人人爽人人添| 思思视频久久| 国产精品激情AV久久久青桔| 五月丁香va| 欧美叉叉叉BBB网站| 五月情四婷婷| 久久思思热视频| 婷婷五月激情四月综合 | 免费啪啪啪网站| 七七色综合| 夜夜嗨一区二区三区直播内容| 国产日韩欧美| 亚洲精品又粗又大又爽A片| 五月丁香成人网| 99亚洲天堂| 丁香 婷婷 亚洲 熟女| 亚洲国产成人裸舞| 狠狠操.COM| 亚洲色vA| 天天色综合网1| 午夜做爱影院| 色欲一区二区三区精品A片| 99热手机在线精品| 日本成人噜噜噜| 激情内射p| 99综合网| 九热精品| 九九碰九九爱97| 九九热九九| 日本黄色三级片内射| 七月婷婷色香综合网| 久久九九99.www| 超碰在线资源| 第五婷婷伊人丁香| 亚洲国产婷婷色五月| 亚洲激情综合| 69激情小说| 色青青五月| 综合亚洲五月天| 狠狠色丁香99| 丁香五月老师| 亚洲操操操| 五月丁香性爱| 亚洲愉拍99热成人精品| 婷婷五月丁香激情图片| 久久久WWW| WWW丁香五月| 五月天 另类图片| 中文av网站| 可以看的AV| 国产欧美熟妇另类久久久 | 婷婷影视久久| 成人免费高清在线播放| 亚洲成人色五月婷婷综合| 国产美女精品| 五月天com| 色婷婷基地| 亚洲欧洲美女在线观| 九九热视频99| 深爱激情69热| 天天搡日日搡aaaaⅩ| 农村熟妇高潮精品A片| 高清无码网址| 婷婷五月天少妇| 日本三日本三级少妇三级66| 久久丁香五月天| 人人爱人人添| 久久亚洲A| 99久高清视频| 色五月综合网| 久久综合五月天| 五月综合激情视频| 色情·com| 婷婷五月激情五月丁香五月| 琪琪布丁香社区激情五月天| 在线播放中文字幕| 狠狠综合网| 97深爱伊人综合| 婷婷九月色| 婷婷狠狠狠爱| 色欲AVV| 亚洲色综合| va亚洲中文在线| 99 这里只有精品| 欧美三级欧美一级| 日本三级毛片| 91在线观看九区| 思思热在线视频精品| 2017狠狠干| 开心五月网| 深爱激情网噜噜色| 五月开心六月婷婷在线播放网站| 五月激情婷婷综合| 久婷婷五月综合欧美| 色啪久| 国产欧美日韩综合精品一区二区| 日本三级黄色大片| 激情综合丁| 日日干综合| 天天激情5月天亚洲| 五月丁香激情四射| 久久婷婷东京热| 久热9热| 99re资源在线视频导航| 九九综合影音先锋| 天天做天天爱天天高潮| 超碰av在线| 超碰狠狠操| 久久xxxx| 日日噜狠狠| 天天日天天摸天天| 婷婷五月天丁香社区| 《久久综合九色综合97婷婷| 五月婷婷基地| ady狠狠入| 国产成人+亚洲+欧洲| 亚洲欧美成人在线观看| 亚洲精品五月| 免费色婷婷| 色综合综合色| 人人操婷婷| 五月天影院| AV在线二十六页| 亚洲综合在线丁香五月| 婷婷99狠狠躁天天久久久九九九| 国产4P视频精品五区| 99er这里只有精品| 久久国产高清| 黄色一级影片| 狼人婷婷久久| 色亚洲无码| 如何安全看伊人婷婷| 丁香六月婷婷缴情欧美| 狠狠色婷婷7| 五月综合777| 狠狠干青青草| 婷婷五月激情在线视频| 成人丁香五月| 影音先锋色婷婷| 99ri在线观看视频| 久久婷五月天| 熟妇内谢69XXXXXA片| 五月天婷婷狂暴白浆| 超碰cap| 婷婷五月天毛片| 久久99精品久久久久久三级| 五月伊人网| 伊人网欧美在线男人天堂五月丁香| 激情综合五月激情17| 激情开心五月婷婷| 99热这里只有免费精品| 人人色婷婷| www.99热这里只有精品| 五月激情综合网| 玖玖婷婷五月天毛片| 人人97操| 久久98| 蜜臀av无码久久久久久久久| 天天干天天叉| 蜜桃人妻无码AV天堂三区| www.99热这里只有精品| 国产SUV精品一区二区6| 婷婷五月综合中文字幕| 婷婷丁香五月色偷偷| 色色热99| 先锋男人99资源| 91热er| 久久性爱视频这里只有精品 | 99热在线这里| 亚州操人在线视频| 荫道BBWBBB高潮潮喷| 99碰在线视频| 操操碰| 婷婷五月天综合中文| 丁香五月婷婷在线| 91久热| 996re热精品视频| 伊人久久婷婷| 开心五月婷| 变态另类9| 无码日本精品XXXXXXXXX| 久九九热| 日韩人妻无码一区二区| 天天爽天天干| 色五月婷婷亚洲| 丁香六月综合| 大香蕉99热| 五月丁香青草综合啪啪| 欧美日韩99| 丁香婷婷AV| 婷婷月五天在线在线看| 亚洲va在线| 色人久久| 殴美日韩成人| 五月丁香六月情婷婷久久| 操逼巨乳91| www五月婷婷| 操久久网| 激情五月婷婷五月| 国产人妻777人伦精品HD| 丁香色成人| 色综合久久天天综合网| 一级性爱视频| AV免费在线网站| 五月丁香在线精品| 美国十月色婷婷在线观看| 99久久99综合| 丁香五月婷婷五月天在线| 免费观看的婷婷五月视频在线| 色五月激情五月| 五月天婷综合| 开心五月天激情网站| 激情综合网激情五月天| jiujiujiuwuyuetian| 天天天添天天操| 欧美激情五月天| 香蕉久久国产av一区二区| 欧洲第一久色| 欧美99热| 性色人人爽| 五月综合视频| 欧美男女婷婷| 日韩砖区| 久久九九色| 色婷婷伊人| 情趣视频66| 真实的国产乱XXXX在线91| 天天五月香欧美| 色综合九九| www.久久9| 99热九九热| W色综合| 久久只这里有精品| 狠狠插狠狠插| 青草网在线观看| www.9797国产| 五月婷婷草| 天天插天天日| 狠狠 久久| 中文乱子伦视频| 激情五月黄色| 国产热精品| 99热啪啪| 在线VA视频| 色婷婷亚洲精品天天综| 91碰碰碰| 人妻中文在线| 久热久| 日韩色色视频| 六月丁香五月婷婷| 久久五月婷婷电影| 亚洲欧美综合7777色婷婷| 久婷婷婷| 五月色婷婷中文字幕| 久热中文字幕| 丁香五月六月综合激情| 热五月婷婷| 夜夜谢天天干| 久综合九| 97久久视频| 色色五月丁香| 丁香色色网| 五月天激情站| 专区无日本视频高清8| 日本www五月婷婷| 日本一級黃色一級片| 五月激情另类| AV在线不卡播放| 久久99免费视频| 丁香五月婷婷激情中文| 激情五月天色播| 99久久玖玖| 亭亭五月色男人| 色五月婷婷av| 亚洲色啪| 丁香婷婷色五月天| 色色热日| 97色片| ww亚洲ww在线观看| 香蕉久久国产AV一区二区| 国产中文亚洲欧美日韩性交| 疯狂做受XXXX高潮A片动画| 综合五月天婷婷色| 1024你懂的欧美曰韩| 九九热10| 五月丁香猫咪久久婷婷综合视频激情四射网入口 | 综合婷婷| 无码 av电影| 色噜噜狠狠插综合| 色五月欧美| 久久99热这里只频精品6学生| 久久aaa| 欧美偷偷操| 综合啪啪| 3pAV| 四川女人毛多水多A片| 五月天婷婷在线播放| 91色综合| www.婷婷六月天| 丁香五月激情啪啪| 五月婷婷激情久久| 久久在线视频免费观看| 懂色AⅤ| 丁香玖玖| 亚洲无AV在线中文字幕| 99精品免费欧美小视频| 欧美在线干| 日本欧美成人片AAAA| 久久九九色| 婷婷五月天激情四射五月天激情| caop视频| 国产成人网站在线观看| 一本道综合网| 亚洲一区国产传媒| 无码 av电影| 丁香五月婷婷五月| 亚洲熟妇AV综合网五月丁香伊人 | 丁香五月影院| 婷婷五月 丁香六月| 色欧美日| 天天日天天色| 五月婷婷丁香啪啪| 亚洲第一色网站| 婷婷性爱综合| 色色色99| 天天日 天天草| 色欲Av五月天| 六月婷婷AV| 国自产拍偷拍精品啪啪一区二区| 久久婷婷综合五月天| 99热6这里只有精品6| 麻豆AV一区二区三区| 五月丁香无码| 亚洲aV写真天天综合网久久| 9l视频自拍9l九色成人| 久久婷婷五| 婷婷五月丁香基地| 99热97| 亚洲九九99精品视频在线播放| 激情性爱五月| 5Www色5夜| 色香蕉影院| 丁香色六月婷婷| 欧美α√| 无码天天操| 99成人网一区| 色色综合网。| 成人精品视频99在线观看免费| 超碰人人艹| 激情深爱综合网| 久久草婷婷丁香网站| 狼人婷婷综合| 色色色五月| www.色色色com| 99免费在线视频| 在线中文字幕av| 人人爱人人草| 俺去也在线www色官网| 精品一区二区三区四区五区六区介绍| 激情中文在线| 色五月中文字幕| 超级碰碰99| 三男玩一女三A片| 精品人妻伦一二三区久久| 超碰高清在线| 66色在线日韩| 久久ab| 五月天激情国产综合AV| 开心五月婷婷六月丁香| 97婷婷色| 超碰99在线观看| 日韩无码成人电影| 亚洲超级碰| 影音先锋91资源站| 伊人大香蕉在线视频| 五月婷婷久久爱| 91狼友视频在线观看| 99精品国产在热久久| 六月丁香五月婷婷| 91碰碰| 久久婷婷六月综合| 97色婷婷| 日日操日日撸| 婷婷中文在线| 九九色热| 亚洲AV免费在线| 五月丁香啪啪| 久久久久婷婷| 伊人婷婷五月天| 国产成人网| 国产精品久久久久久久久久免费| 99人人干| 性无码专区无码| 99精品无码| 我要射综合| 99亚洲无码| 色99热| 开心激情综合| www,com,五月色色| 婷婷五月天网| 久热 91| 丁香五月婷婷偷拍| 亚洲成人超碰| 另类小说五月天| 狠狠色婷婷7777久| 色五月婷婷基地| 蜜桃人妻无码AV天堂三区 | www.zbzhongsen.com| site:901-07.com| 五月丁香在线视频观看| 丁香桃色综合网| 久久99久久99精品免观看软件| 色久五月| 色综合色综合色综合色综合| 五月丁香六月激情视频| 中文AV在线播放| 桃色五月天| 白人荫道BBWBBB大荫道| 好吊兆人妻| 99精品女人天堂| 96精品久久久久久久久| 99亚色色色| 1995年关宝慧版蜘蛛女| 色综色五月天婷婷| 91久久电影| 婷婷久久五月丁香| 99热66| 亚洲精品**不卡在线播he| 欧美综合五月天婷婷tin| 一操久久| 久久久人妻人伦| 五月丁香婷婷久久| 五月在线| 婷婷五月成人| 99久久户外勾搭| A级毛片高清免费不卡播放谢谢谢谢| 激情丁香社区| 婷婷五月天Av| 婷婷五月六月| 久久538| 99精品国产乱码久久久人妻| 97在线干| 人人人操Av| 午夜无码精品色综合久久| 天天肏高清在线| 激情五月天色播| 99情色五月天| 九九精品网站| 色婷婷五月天小说| 九九热啪啪| 日韩综合成人| 日韩在线9| henhencao国产在线| 婷婷五月天六月丁香| 丁香啪啪| 中文字幕综合色| 婷婷成人网五月天| 开心激情播播五月天| 99人人干| 五月婷婷先锋| 丁香六月AV| 狠狠狠狠狠狠狠狠| www99热| 无码橾| 丁香五月亭亭六月综合激情网| 亚洲无码色| 99视频| 玖玖99免费视频| 亚洲婷婷五月天激情综合| 久热大香蕉| 久热99中文字幕| 天天插天天狠| 亚洲激情综合| 国产欧美熟妇另类久久久| 九月激情综合| 精品51XX| 九九色逼| 9视频1在线| 99精品在线下载| 99热人人| 色99视| 婷婷亚洲五月色综合| 亚洲另类婷婷综合| 热久91| 激情五月丁香在线观看直播| 色五月超碰| 99热黄| 五月婷婷中文网| 久久 天天| 久久久久久久久18久久| 色五月无码| 久久婷婷热| 97碰操| 五月婷六月丁香| 婷婷久久综合| 亚洲欧洲午夜成人精品av| 五月天精品综合| 熟女少妇内射日韩亚洲| 九热...av| EEUSS鲁片一区二区三区| 人人操婷婷| xx色综合| 亚洲最大视频| 色碰碰| 99er在线观看| 日韩啪啪网| av大香蕉| 精品激情| 99伊人性爱在线影院| 久久久久er热| 91日婷婷在线| 婷婷五月永远18免费久久久| 狠狠干婷婷| 色播综合| 国产性色蜜乳| 这里有精品| 狠狠干天天内射| 美国十月色婷婷在线观看| 大香蕉中文| 五月婷九月| 久久机热这里只有精品| 97很鲁在线视频| 九九热这里只有精品首页| 操97| 婷婷伊人久久| 久久久久9| 丁香五月婷婷综合精品素人| 天天舔天天摸| 久久久久98| 丁香色婷婷五月天| 色五月婷婷影视| 五月天激情国产综合婷婷| 国产偷人爽久久久久久老妇APP | 99九九在线视频| 日韩欧美一道四区中文字幕| 五月天影院| 丁香六月激情国产| 五月色影院| 91日婷婷在线| 色婷婷亚洲五月天| 任你日热视频| 色大综合| 青吴乐视频| 色五月激情五月天| 激情宗合 激情宗合| 色色a| 婷婷激情九月| 精品久久人妻| 九九综合精品| 亚洲精品色| 欧美熟女乱又伦| 五月综合激情网| 俺去啦综合网| 六月综合婷婷开心伊人 | 超级碰碰99| 五月天色区| 超碰99久久| 国内外色色色色色成人视频| 激情五月丁香婷婷夜夜操| 蜜臀AV在线观看| 五月天婷婷丁香六月| 色婷婷四色| 久久最新色| 99久久99视频只有精品| 爽tv | 五月天全国最大成人网| 91啦丨九色丨刺激中文| 丁香激情五月| 婷婷国产综合| 国产精品久久久久久妇女6080| 亚洲经典小视频| 91免费看片| 超碰AV在线| 九九热这里只有精品12| 91亚洲免费片| www.婷婷| 天插天啪天啪天啪| 久久网址99热| 99综合| 综合色色婷婷| 色私五月婷婷| 久久久这里有精品| 婷婷色色网| 欧美色图天堂网色| 成人va在线播放| 色五月丁香六月婷婷| 大香蕉天堂| 97在线观视频免费观看| 人人爱人人添| 日韩成人av在线| 欧美十二区| 亚洲第一黄网| 亚洲AV激情五月综合网| 日韩啪图| www.激情| 婷婷丁香五月天激情| 久久色情| 热婷婷av| 天天做天天爽| 五月丁香六月激情视频|