日韩精品一区二区三区在线视频放-无码中文字幕V?一区二区-成年片免费观看视频-国内少妇人妻丰满av-国产精品中文字幕免费观看-亚洲成人久久一区二区三区-国内少妇偷人精品视频无缓冲-一区二区国产精品日本一区二区三区在线网

ARTICLE DETAIL

資訊詳情

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

MATLAB實現(xiàn)六軸機器人運動學(xué)正逆解:從DH參數(shù)到工程驗證

MATLAB實現(xiàn)六軸機器人運動學(xué)正逆解:從DH參數(shù)到工程驗證 簡介面向機器人學(xué)學(xué)習(xí)者與工程師的六軸機器人運動學(xué)源碼資源包以UR5機器人為對象系統(tǒng)演示正運動學(xué)與逆運動學(xué)的MATLAB實現(xiàn)過程可解決六軸機械臂關(guān)節(jié)變量與末端位姿相互求解的常見需求。內(nèi)容涵蓋UR5機器人定義文件、由關(guān)節(jié)角度計算末端位置姿態(tài)的正解函數(shù)、由末端位姿反求關(guān)節(jié)角度的逆解函數(shù)以及用于驗證結(jié)果正確性的測試腳本同時附Robotics Toolbox源碼及安裝包便于深入理解D-H參數(shù)建模與運動學(xué)計算原理。整個資源包共961個文件容量約119.26MB以.m源碼為主線并包含STL模型、MLX交互式腳本、SLX仿真模型、PDF文檔等兼顧理論查閱與仿真實踐。已有10117人瀏覽學(xué)習(xí)適合機器人入門自學(xué)、課程設(shè)計參考或控制系統(tǒng)預(yù)研既可直接運行驗證也可基于源碼開展二次開發(fā)與算法改造。1. 為什么要用MATLAB啃下六軸機器人運動學(xué)這塊硬骨頭做機器人這行的人幾乎都繞不開運動學(xué)這道坎。無論是搞工業(yè)機械臂集成、做AGV復(fù)合機器人、還是研究協(xié)作臂的軌跡規(guī)劃正解和逆解永遠是一切上層算法的基礎(chǔ)。簡單說正運動學(xué)是給定六個關(guān)節(jié)角度算出末端執(zhí)行器在空間里的位姿逆運動學(xué)則是反過來——告訴你末端要到達某個位置、擺出某個姿態(tài)反推六個關(guān)節(jié)各自該轉(zhuǎn)多少度。我在實驗室?guī)н^不少學(xué)生也幫企業(yè)調(diào)過不少機械臂發(fā)現(xiàn)一個很有意思的現(xiàn)象很多人一上來就急著用ROS、用C、用各種機器人庫結(jié)果光是環(huán)境配置就勸退了一半人。而MATLAB其實是被嚴重低估的利器。它不需要你編譯、不需要你處理復(fù)雜的內(nèi)存管理矩陣運算天生就長在骨子里而機器人運動學(xué)的數(shù)學(xué)本質(zhì)恰恰就是齊次變換矩陣的連乘與矩陣方程的求解。用MATLAB來實現(xiàn)六軸機器人的正逆運動學(xué)求解代碼量少、調(diào)試直觀、還自帶可視化工具箱可以把機械臂的姿態(tài)一幀幀畫出來是理解算法原理最舒服的路徑。這篇內(nèi)容不是教科書式的理論推導(dǎo)而是我實際把一套完整的求解源碼從零寫出來、測試通過、并且在仿真環(huán)境里驗證過的全流程記錄。源碼包里包含正運動學(xué)求解函數(shù)、逆運動學(xué)解析解函數(shù)、關(guān)節(jié)角連續(xù)性處理、工作空間采樣驗證等模塊。適合三類人一是剛?cè)腴T機器人學(xué)、被DH參數(shù)和齊次變換矩陣搞得頭暈的學(xué)生二是需要在MATLAB里快速搭建運動學(xué)仿真驗證環(huán)境的工程師三是想自己動手寫一遍求解器、不想只調(diào)現(xiàn)成工具箱的硬核玩家。先說結(jié)論六軸機器人正解是閉式解屬于典型的套公式但細節(jié)多逆解可以通過解析法分離出前三個關(guān)節(jié)和后三個關(guān)節(jié)用幾何法和代數(shù)法配合求解得到最多8組解再根據(jù)關(guān)節(jié)限位和連續(xù)性挑一組最優(yōu)解。這套思路理解透了任何六軸構(gòu)型的機械臂你都能在三小時內(nèi)寫出自己的求解器。2. 機器人模型怎么建DH參數(shù)和齊次變換矩陣的實用理解2.1 四參數(shù)里的每一個到底在說什么上一節(jié)說過正解是套公式這個公式就是Denavit-Hartenberg參數(shù)簡稱DH參數(shù)。很多教材把DH參數(shù)講得特別玄乎什么坐標(biāo)系繞X軸旋轉(zhuǎn)、沿Z軸平移、連桿偏置初學(xué)者一上來就被繞暈。我用大白話翻譯一遍你就懂了。一個連桿從上一個關(guān)節(jié)坐標(biāo)系變換到下一個關(guān)節(jié)坐標(biāo)系只需要四次基本操作θ關(guān)節(jié)角繞當(dāng)前Z軸旋轉(zhuǎn)的角度d偏置沿當(dāng)前Z軸平移的距離a桿長沿新X軸平移的距離α扭轉(zhuǎn)角繞新X軸旋轉(zhuǎn)的角度為什么要這樣定義因為三維空間里從一個坐標(biāo)系到另一個坐標(biāo)系6個自由度需要6個參數(shù)但機器人關(guān)節(jié)結(jié)構(gòu)本身有約束——相鄰關(guān)節(jié)的軸線要么垂直要么平行所以4個參數(shù)就夠了。正是這個夠用的約束條件讓機器人運動學(xué)建模成為可能。我建議初學(xué)階段別急著去記矩陣相乘的最終表達式而是先在紙上畫出一個兩連桿機構(gòu)的坐標(biāo)變換過程。畫完一個連桿的坐標(biāo)變換再畫第二個你會發(fā)現(xiàn)規(guī)律非常清晰每個連桿的變換矩陣長一個樣只是四個參數(shù)值不同而已。這就是正運動學(xué)求解的天然循環(huán)結(jié)構(gòu)。2.2 一次典型的坐標(biāo)變換矩陣長什么樣比如某個連桿的DH參數(shù)是theta30度, d0.25, a0.4, alpha90度那它的變換矩陣用MATLAB寫出來就是function T dh_transform(theta, d, a, alpha) T [cos(theta), -sin(theta)*cos(alpha), sin(theta)*sin(alpha), a*cos(theta); sin(theta), cos(theta)*cos(alpha), -cos(theta)*sin(alpha), a*sin(theta); 0, sin(alpha), cos(alpha), d; 0, 0, 0, 1]; end這四個參數(shù)一個一個代進去后矩陣的最后一列就是當(dāng)前連桿末端在上一級坐標(biāo)系里的位置坐標(biāo)前3乘3的部分就是姿態(tài)。這個矩陣本身的信息量很大左上角是旋轉(zhuǎn)信息第四列上面三個數(shù)是位置信息最后一行永遠是[0 0 0 1]這個不變式是齊次變換矩陣能夠相乘的前提。我在教學(xué)的時候發(fā)現(xiàn)很多學(xué)生死記矩陣里的正負號一旦記混就全盤皆輸。我的建議是矩陣里最拗口的就是那兩個sin(theta)*sin(alpha)項你只要理解它們來自旋轉(zhuǎn)的疊加乘法就不會記錯。萬一忘了直接手推一次旋轉(zhuǎn)矩陣的乘積最多花兩分鐘比背公式靠譜得多。3. 正運動學(xué)求解從關(guān)節(jié)角到末端位姿的完整鏈路3.1 串聯(lián)機械臂的正解就是矩陣連乘六軸機器人的正運動學(xué)求解本質(zhì)上就是六個DH變換矩陣的逐級相乘。每個關(guān)節(jié)的變換矩陣把末端位置和姿態(tài)從前一關(guān)節(jié)坐標(biāo)系一步步傳遞到基座坐標(biāo)系。最終得到的變換矩陣T06 T01 * T12 * T23 * T34 * T45 * T56就是機械臂末端相對于基座坐標(biāo)系的完整位姿描述。初學(xué)者最常問的一個問題是為什么要用一個4乘4的矩陣來表示三維坐標(biāo)直接用3乘3矩陣不是更節(jié)省計算量嗎答案在于旋轉(zhuǎn)和平移必須在一個運算框架里統(tǒng)一處理。如果用3乘3矩陣旋轉(zhuǎn)和平移就得分開做兩次運算用4乘4的齊次矩陣旋轉(zhuǎn)加平移一次乘法搞定而且多次變換可以直接連乘成一個總矩陣這是串聯(lián)機器人最核心的計算模式。在實際工程中正解一般不會成為性能瓶頸。即使是在實時控制周期1毫秒的系統(tǒng)中六次4乘4矩陣乘法也就消耗幾微秒的CPU時間。真正考驗算法水平的是逆解。3.2 一份可以直接跑通的正解源碼下面這份源碼是我項目中實際使用的正運動學(xué)求解函數(shù)簡潔清晰適合照抄學(xué)習(xí)function T06 forward_kinematics(q, dh_params) % q: 1x6 關(guān)節(jié)角度向量單位弧度 % dh_params: 6x4 矩陣每行對應(yīng)一個關(guān)節(jié)的 [theta_offset, d, a, alpha] T06 eye(4); for i 1:6 theta q(i) dh_params(i, 1); T_i dh_transform(theta, dh_params(i, 2), dh_params(i,3), dh_params(i,4)); T06 T06 * T_i; end end為什么這里要單獨加一列theta_offset因為在很多實際機械臂中DH參數(shù)表里給的theta并不是直接等于關(guān)節(jié)編碼器讀數(shù)而是帶有一個初始零點偏移。這個偏移如果沒處理好很容易出現(xiàn)仿真里明明是對的真機上末端位置卻偏了一大截的問題。我舉個例子假設(shè)六軸機器人的第一個關(guān)節(jié)在DH參數(shù)表里的theta_offset是90度而編碼器零點位置恰好對應(yīng)機械臂完全展開的狀態(tài)。如果直接拿編碼器讀數(shù)去算正解末端位置會憑空旋轉(zhuǎn)90度看起來就像機械臂錯位了。加上偏移量后這個問題就消失了。用這組典型的六軸機器人DH參數(shù)測試一下% theta_offset, d, a, alpha dh [0, 0.34, 0, pi/2; 0, 0, 0.29, 0; 0, 0, 0.26, 0; 0, 0.24, 0, pi/2; 0, 0.24, 0, -pi/2; 0, 0.08, 0, 0]; q [0, -pi/4, pi/4, 0, pi/6, 0]; T06 forward_kinematics(q, dh)輸出結(jié)果是一個4乘4矩陣。你從里面可以直接讀出末端位置和末端姿態(tài)。用tform2trvec和tform2eul這兩個MATLAB內(nèi)置函數(shù)就可以把矩陣翻譯成人能看得懂的XYZ坐標(biāo)和歐拉角。3.3 驗證正解算得對不對正解代碼寫完后千萬別急著往下走先做三個基本驗證確定算出來的結(jié)果可靠再去寫逆解。我的驗證習(xí)慣是這樣的零位自檢把六個關(guān)節(jié)角全部置零算出的末端坐標(biāo)應(yīng)該和機械臂廠家數(shù)據(jù)手冊里的零位姿態(tài)坐標(biāo)一致。單關(guān)節(jié)旋轉(zhuǎn)測試只讓第一個關(guān)節(jié)從0轉(zhuǎn)到90度觀察末端位置的軌跡。如果第一個關(guān)節(jié)是腰部旋轉(zhuǎn)關(guān)節(jié)那末端應(yīng)該畫出一個圓弧且高度不變。隨機抽樣測試隨機生成200組關(guān)節(jié)角全部代入正解計算。如果有些位置點的坐標(biāo)超出機械臂工作空間范圍說明DH參數(shù)或代碼有誤。這三個驗證做完基本能確認正解代碼沒有低級錯誤。接下來就可以進入重頭戲——逆運動學(xué)了。4. 逆運動學(xué)求解解析解法的完整推導(dǎo)與代碼落地4.1 為什么說逆解是幾何直覺加代數(shù)技巧的混合體逆運動學(xué)的難點在于它是一個非線性方程組的求解問題。六軸機械臂的正運動學(xué)方程可以寫成T06 f(q1, q2, ..., q6)而逆運動學(xué)要求解的是q1...q6 f_inv(T06)。這個反函數(shù)通常無法直接寫出因為正解方程是三角函數(shù)的多重嵌套而三角函數(shù)天然具有多值性。在MATLAB里你可以直接調(diào)用內(nèi)置的數(shù)值求解器去暴力迭代比如fsolve。但我不推薦在實時控制或軌跡規(guī)劃場景里這么干原因有三數(shù)值迭代慢、容易陷入局部最優(yōu)、無法保證解在關(guān)節(jié)限位內(nèi)。真正常用的是解析解法——通過分析機械臂結(jié)構(gòu)把六個關(guān)節(jié)的求解拆分成獨立的小問題。六軸串聯(lián)機械臂的逆運動學(xué)解析解標(biāo)準(zhǔn)的處理思路是先求前三軸再求后三軸。為什么可以這樣分離因為后三個關(guān)節(jié)的軸線通常交于一點稱為腕心這個結(jié)構(gòu)設(shè)計幾乎是所有工業(yè)六軸機器人的通用構(gòu)型。腕心點的位置只由前三個關(guān)節(jié)決定與后三個關(guān)節(jié)無關(guān)。把末端的目標(biāo)位置先沿末端姿態(tài)反推一段距離得到腕心坐標(biāo)前三個關(guān)節(jié)就變成了一個三連桿到達指定位置的問題用幾何法就能解。后三個關(guān)節(jié)則是在前三個關(guān)節(jié)確定后反推姿態(tài)誤差用代數(shù)法解歐拉角。4.2 前三關(guān)節(jié)的幾何求法假設(shè)末端目標(biāo)位姿是T_desired其中位置部分是p_desired1乘3向量姿態(tài)部分是R_desired3乘3矩陣。末端執(zhí)行器坐標(biāo)系的原點到腕心的距離是d6也就是最后一個DH參數(shù)里的d值。那么腕心位置是% 把末端位置沿末端坐標(biāo)系Z軸負方向平移d6 p_wrist p_desired - d6 * R_desired * [0; 0; 1];拿到p_wrist之后前三個關(guān)節(jié)的求解就變成了經(jīng)典的平面兩連桿旋轉(zhuǎn)底座問題。以我的DH參數(shù)表為例關(guān)節(jié)1是繞基座Z軸旋轉(zhuǎn)q1 atan2(p_wrist_y, p_wrist_x)但要注意如果p_wrist_x和p_wrist_y都接近0說明腕心正好在基座正上方此時q1是退化狀態(tài)任意值都可以實際中取上一周期值即可。關(guān)節(jié)2和關(guān)節(jié)3可以把機械臂看作一個在垂直平面內(nèi)的二連桿機構(gòu)用余弦定理求解。設(shè)r sqrt(p_wrist_x^2 p_wrist_y^2)s p_wrist_z - d1則關(guān)節(jié)2和關(guān)節(jié)3的組合長度L sqrt(r^2 s^2)帶入余弦定理可得兩組解肘部向上和肘部向下。關(guān)節(jié)3的角度可以利用q2的表達反推。這段推導(dǎo)如果用文字描述容易看得云里霧里。我建議你直接畫一個側(cè)視圖基座在原點第一段桿長a2第二段桿長a3腕心在目標(biāo)點。這個圖的結(jié)構(gòu)跟人的上臂加前臂一模一樣肘關(guān)節(jié)可以朝上也可以朝下所以天然存在兩組解。再加上q1在部分構(gòu)型下可以加減180度前三關(guān)節(jié)會出現(xiàn)多組組合。4.3 后三關(guān)節(jié)的代數(shù)解法前三關(guān)節(jié)解出來后可以算出此時從基座到第4關(guān)節(jié)坐標(biāo)系的旋轉(zhuǎn)矩陣R03。目標(biāo)姿態(tài)是R_desired所以第4、5、6關(guān)節(jié)需要提供的旋轉(zhuǎn)是R36 R03 * R_desired;注意R36是一個3乘3旋轉(zhuǎn)矩陣它代表從第3關(guān)節(jié)坐標(biāo)系到末端坐標(biāo)系的姿態(tài)變換。對于大多數(shù)六軸機械臂第4、5、6關(guān)節(jié)在DH參數(shù)表里通常對應(yīng)繞Z軸、Y軸、Z軸的旋轉(zhuǎn)組合具體是哪種組合要看α參數(shù)。我用的這組DH參數(shù)中第4關(guān)節(jié)是繞Z軸第5關(guān)節(jié)是繞X軸第6關(guān)節(jié)是繞Z軸所以可以從R36的矩陣元素反解出三個關(guān)節(jié)角q5 atan2(sqrt(R36(3,1)^2 R36(3,2)^2), R36(3,3)); if abs(q5) 1e-6 % 奇異位形第4和第6關(guān)節(jié)軸線重合只能求和 q4 0; q6 atan2(-R36(1,2), R36(1,1)); else q4 atan2(R36(2,3), R36(1,3)); q6 atan2(R36(3,2), -R36(3,1)); end這里有一個非常關(guān)鍵的細節(jié)q5有正負兩個解對應(yīng)q5 ±acos(R36(3,3))。當(dāng)q5接近0時機械臂處于腕部奇異位形第4和第6關(guān)節(jié)無法單獨解出只能求它們的和或差。這不是代碼bug而是機構(gòu)本身的物理特性后續(xù)軌跡規(guī)劃時需要在算法層面繞開這個奇異區(qū)域。4.4 把多組解變一組可用解前三關(guān)節(jié)可能給出2到4組解后三關(guān)節(jié)又給出2組解組合起來最多8組解。8組解里有些關(guān)節(jié)角度超出限位有些雖然角度合法但會導(dǎo)致機械臂部件之間碰撞所以在實際工程中必須做篩選。我的篩選邏輯很簡單清晰按優(yōu)先級排序valid_solutions []; % 存儲關(guān)節(jié)限位內(nèi)且符合要求的解 for each_solution in all_solutions if all_within_joint_limits(each_solution) if collision_check(each_solution) false valid_solutions [valid_solutions; each_solution]; end end end % 選擇與當(dāng)前關(guān)節(jié)角最接近的解避免大幅度跳動 if ~isempty(valid_solutions) [~, idx] min(sum(abs(valid_solutions - current_q), 2)); best_q valid_solutions(idx, :); else error(當(dāng)前目標(biāo)位姿不可達或全部候選解均超出關(guān)節(jié)限位); end這里最實用的一招是最小關(guān)節(jié)位移優(yōu)先準(zhǔn)則。在軌跡規(guī)劃中上一周期的關(guān)節(jié)角是current_q這一周期目標(biāo)位姿算出了好幾組有效解選哪個選關(guān)節(jié)角變化總和最小的那組。因為實際電機有最大速度和加速度限制關(guān)節(jié)角跳變太大會導(dǎo)致軌跡不平滑嚴重時還會觸發(fā)驅(qū)動器過流報警。這一條經(jīng)驗我在現(xiàn)場調(diào)試時用了無數(shù)次非常管用。5. 逆解正確性和穩(wěn)定性的實測驗證5.1 用正解反驗證逆解的理論閉環(huán)逆解寫完之后最重要的一件事就是驗證它的正確性。理論上逆解和正解互為反函數(shù)所以驗證方法很簡單隨機生成一組關(guān)節(jié)角用正解算出末端位姿再用逆解求回關(guān)節(jié)角。如果兩個關(guān)節(jié)角誤差在極小范圍內(nèi)這組代碼就通了。我在實際驗證中寫了一個自動循環(huán)test_pass 0; test_total 1000; for i 1:test_total q_random rand(1,6) * [2*pi, 2*pi, 2*pi, 2*pi, 2*pi, 2*pi] - pi; % 限制隨機角度在合理范圍避開奇異位形 q_random q_random .* [1, 1, 1, 1, 1, 1]; T_target forward_kinematics(q_random, dh); q_solved inverse_kinematics(T_target, current_q, dh); T_check forward_kinematics(q_solved, dh); if norm(T_check - T_target) 1e-6 test_pass test_pass 1; end end fprintf(測試通過率: %.2f%%\n, test_pass/test_total*100);如果通過率低于99.9%就說明逆解代碼里有問題最常見的錯誤是三角函數(shù)分支寫反或者腕心偏置方向算錯。不過要特別注意一個例外當(dāng)隨機角度讓機械臂處于奇異位形附近時誤差會變大。所以在測試時要把奇異判定加進去奇異附近的樣本單獨標(biāo)注不計入通過率否則你永遠測不出100%的通過率還會白白浪費時間排查一個本就不存在的bug。5.2 末端連續(xù)軌跡追蹤測試驗證完單點逆解正確性你還應(yīng)該做一個更有說服力的測試——讓末端畫一個空間圓。具體做法是在笛卡爾空間生成圓軌跡上的100個目標(biāo)點依次調(diào)用逆解求解然后把每個目標(biāo)點的關(guān)節(jié)角序列連接起來用正解反算末端位置看看實際末端軌跡距離理想圓的半徑偏差有多大。這個測試能同時驗證三件事逆解的連續(xù)性、關(guān)節(jié)角平滑性、機械臂對連續(xù)軌跡的跟蹤能力。正常情況下軌跡偏差應(yīng)該控制在毫米級。如果偏差呈現(xiàn)鋸齒狀波動說明逆解在多組解之間來回切換沒有連續(xù)選擇同一組解分支。這個問題在工業(yè)機器人里特別致命——它會導(dǎo)致機械臂在運動過程中突然出現(xiàn)抽搐動作輕則影響加工質(zhì)量重則引發(fā)安全事故。我之前調(diào)試一個焊接機器人項目時就遇到過這個問題。六軸機械臂走到某個位置附近末端軌跡突然跳了一下焊點直接偏了3毫米。排查了很久才確認是逆解在兩組解之間切換導(dǎo)致的。解決方案就是在上一節(jié)提到的最小關(guān)節(jié)位移優(yōu)先基礎(chǔ)上再加一條分支連續(xù)性約束如果目標(biāo)點的候選解與上一周期解的距離超過某個閾值就強制忽略那組解。% 在篩選時增加連續(xù)性約束 if min_dist threshold best_q min_dist_solution; else warning(連續(xù)軌跡中檢測到解跳變嘗試其他分支); % 可以在這里加入人工勢場或者軌跡重規(guī)劃邏輯 end5.3 工作空間邊界上的逆解行為還有一個值得專門測試的場景——機械臂工作空間邊界。在邊界附近逆解通常會表現(xiàn)出兩種異常行為一是解的數(shù)量驟減八組解可能只剩一組二是解特別敏感目標(biāo)點稍微移動幾毫米關(guān)節(jié)角就劇烈變化。這兩種行為本質(zhì)上是機構(gòu)在邊界處的奇異現(xiàn)象不是什么可以修的bug。工程師要做的是在工作空間規(guī)劃階段就避開邊界。我習(xí)慣于先在MATLAB里用蒙特卡洛法畫一遍機械臂的工作空間point_cloud []; for i 1:3000 q_sample (rand(1,6) - 0.5) * 2 * [2*pi, 2*pi, 2*pi, 2*pi, 2*pi, 2*pi]; T_sample forward_kinematics(q_sample, dh); point_cloud [point_cloud; tform2trvec(T_sample)]; end scatter3(point_cloud(:,1), point_cloud(:,2), point_cloud(:,3), 2, point_cloud(:,3), filled);把工作空間點云圖畫出來之后你一眼就能看出哪些區(qū)域是邊界區(qū)哪些區(qū)域是核心區(qū)。軌跡規(guī)劃時把目標(biāo)點約束在核心區(qū)范圍內(nèi)逆解穩(wěn)定性會大幅提升。6. 把正逆解代碼組織成項目函數(shù)劃分與MATLAB工程實踐6.1 代碼目錄結(jié)構(gòu)怎么搭寫運動學(xué)求解器代碼組織得好不好直接決定你后面加軌跡規(guī)劃、動力學(xué)分析、可視化的時候會不會一團糟。我建議按下面的目錄結(jié)構(gòu)來組織一套干凈的MATLAB工程robot_kinematics/ ├── main_demo.m % 主腳本正逆解演示、可視化 ├── forward_kinematics.m % 正運動學(xué)求解 ├── inverse_kinematics.m % 逆運動學(xué)求解 ├── dh_transform.m % 單連桿DH變換矩陣 ├── joint_limits.m % 關(guān)節(jié)限位參數(shù) ├── check_workspace.m % 工作空間采樣繪制 ├── test_kinematics.m % 正逆解閉環(huán)驗證腳本 └── data/ └── dh_params.m % DH參數(shù)表返回6x4矩陣這個結(jié)構(gòu)的好處是每個函數(shù)只負責(zé)一件事main_demo.m只做編排data/dh_params.m用來集中管理機械臂型號參數(shù)。換一臺機器人只需要修改dh_params.m文件其它代碼幾乎不用動。我在實際項目中用這套結(jié)構(gòu)同時維護過三款不同品牌的六軸機械臂切換時只需要把參數(shù)表換掉正逆解代碼完全復(fù)用。6.2 一些用過的神秘坑第一坑MATLAB的atan2返回角度范圍是[-pi, pi]而很多機械臂控制系統(tǒng)要求關(guān)節(jié)角在[-2pi, 2pi]或者[0, 2pi]范圍內(nèi)。如果不做角度歸一化逆解輸出的關(guān)節(jié)角可能跟實際編碼器讀數(shù)相差一個2π的整數(shù)倍導(dǎo)致電機誤動作。我的做法是加一個角度包裝函數(shù)function q_wrapped wrap_to_pi(q) q_wrapped atan2(sin(q), cos(q)); end第二坑DH參數(shù)表里有些值是負的比如a的符號決定了連桿的偏置方向。很多初學(xué)者在搭建DH參數(shù)表時會把a的位置寫反導(dǎo)致末端位置鏡像看起來像是左手坐標(biāo)系的錯亂。正確的做法是在搭建完DH參數(shù)表后先用dh_transform畫一個單連桿的坐標(biāo)系人工檢查坐標(biāo)系指向是否和機械臂實體一致。第三坑不要在逆解函數(shù)里用inv(R)。旋轉(zhuǎn)矩陣是正交矩陣它的逆等于它的轉(zhuǎn)置。直接用transpose(R)比用inv(R)快得多而且數(shù)值穩(wěn)定性更好。這個細節(jié)在單次求解時感受不到差別但在循跡仿真幾萬個點時會明顯拖慢速度。6.3 進階能不能擴展到運動學(xué)和軌跡規(guī)劃有了穩(wěn)定的正逆解求解器往上可以接的東西非常多。比如雅可比矩陣它其實是正解矩陣對關(guān)節(jié)角求偏導(dǎo)用它可以做速度層面的映射關(guān)系——末端笛卡爾速度等于雅可比矩陣乘以關(guān)節(jié)角速度。在MATLAB里可以用jacobian符號函數(shù)或者數(shù)值差分法算出雅可比進而做奇異性分析和力的映射分析。再比如軌跡規(guī)劃笛卡爾空間的直線插值配合逆解就能實現(xiàn)直線運動關(guān)節(jié)空間的梯形速度規(guī)劃配合正解就能驗證關(guān)節(jié)運動是否超限。所有這些都可以在這套運動學(xué)求解器基礎(chǔ)上擴展不需要大改架構(gòu)。這也是我為什么堅持用函數(shù)化、模塊化的方式來組織代碼——為了后面擴展時不拆東墻補西墻。7. 總結(jié)與個人經(jīng)驗中的關(guān)鍵心得回頭梳理一遍整個實現(xiàn)過程最讓我想提醒后來者的一件事是正逆運動學(xué)看著是數(shù)學(xué)題實際是工程題。很多人在MATLAB里把正逆解跑通了覺得很興奮但一旦接到真機調(diào)試就會發(fā)現(xiàn)各種實際問題和理論不一致。關(guān)節(jié)限位、零點漂移、奇異位形、解跳變這些才是真正考驗工程能力的地方。我在自己項目的源碼里特意保留了一套完整的注釋和測試代碼方便后續(xù)接手的人快速理解每個函數(shù)的作用和邊界條件。尤其是inverse_kinematics.m這個函數(shù)我加了幾十行注釋專門說明每個解分支的來源和適用場景。這樣做的好處是即使過了三四個月自己回頭看代碼依然能在幾分鐘內(nèi)想起來當(dāng)初的設(shè)計意圖。另外一個特別受用的經(jīng)驗是在做逆解驗證時不要只測單點。把末端位姿連續(xù)變化、關(guān)節(jié)角連續(xù)變化、大量隨機點結(jié)合到一起測試才能暴露那些間歇性出現(xiàn)的穩(wěn)定性問題。我曾經(jīng)用這套方法在模擬仿真階段就暴露了一個關(guān)節(jié)角跳變問題省掉了后面真機調(diào)試的大量返工時間。這種把問題提前暴露在仿真里的做法是我強烈推薦的工作習(xí)慣。最后分享一個小技巧當(dāng)你把逆解結(jié)果用于軌跡規(guī)劃時可以在每個目標(biāo)點求解之前傳入上一時刻的關(guān)節(jié)角作為參考讓逆解自動偏向連續(xù)性更好的候選解。這個技巧看起來簡單但對于整個系統(tǒng)的運動平穩(wěn)性提升非常明顯建議你實際體驗一下。本文還有配套的精品資源點擊獲取
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
伊人久久综合影院精品久久久| 97超碰精品图片| 亚热日本熟女| 久久99九九九九6666免费观看软件| 国产精品成久久久久午夜午夜| 在线国产福利网址导航 | 99在线免费视频| 嗯嗯啊啊好疼| 中文字幕日韩电影人妻| 大香蕉欧美伊| 97超碰中文在线| 久久久免费的精品| 中文字幕色AV| www.色婷婷| 欧美淫乱视频| 天天日天天干天天整| 男人的天堂在线有码| 东北操逼| 琪琪精品免费一区二区三区| 四虎免费看黄| 黄色性爱网网| 日韩久射综合| 夜夜福利| 欧美日韩香蕉| 精国久久一区二区三区98| 人人人摸人人| 男人久久精品| 日韩性爱小视频在线观看| 99999这里都精品| 人妻81p| 免费人人搞97| 美女91| 思思热在线观看| 在线啊啊啊啊| 国产成人91一区二区三区| 欧美日韩天堂| 五月天玖玖资源站| 农村少妇久久久久久久| 伊人综合色网| 91美女视频在线免费观看| 欧美性色综合网| 亚洲有码 欧美精品| 日本美女性生活久久久久久久| 激情四射五月天| 欧美熟女妇同| 欧美毛片在线网| 亚洲日韩狠狠撸视频| 男人干美女| 51一区二区三区| 亚洲蜜桃V妇女| 欧美第一页| 中文字幕在线高清男人的天堂| 日韩一卡二卡三卡| 97一区二区三区视频| 亚州性9| 影音先锋国产精品| 久久精品福利影院| 日韩色香| 91肉片| 天天肏夜夜肏| 91成人无码| 欧美草草| 亚洲熟女少妇免费视频| 東南亚性呦成人伦理资源在线视频| 韩国毛片一区二区三区| 精品9999| 乱伦熟女专区| 日本999精品| 欧日a| 99热思思| 久久久国产av美女私房| 另类亚洲一区二区三区| 俺去啦俺来也久久综合| 97欧美超碰| 久久久性爱| 国语少妇精| 夜夜久久| 99激情| 干我久操| 60秒不遮不挡| 后入福利| 色老汉色| 久都青青视频| 免费精品福利在线观看| 女人被男人桶爽视频网站| 粉嫩av一区二区三区天美传媒 | 日本好吊色视频| 狠狠干狠狠干| 精品亚洲黄色片 国产精品导航一区二区 | 国产欧美伊人| 午夜无遮挡男女啪啪视频| 大但人体久久久久| 91成人在线| 国产精品一级片在线看| 草莓精品视频在线免费观看| 欧美97超碰| 91四海无码日韩欧美| 色色综合97| 日韩三四五区| 日韩乱码av| 日本网色| 午夜丁香| 婷婷五月天影院| 国产99久久99热这里只有精品15 | 麻豆天美国美国产| 五月天婷精品激情| {男男暴菊gay无套网站| 欧美性xxxxx狂欢| 欧美在线啊啊| 青青草密桃在线播放| 日韩久久艹| 精品女同一区| 免费AV中文网在线观看| 色性欧美| 欧美色吧综合| 91原创在线观看| 免费人成在线观看网站品爱网| 大香樵伊人网| 四虎AV在线观看| av在线免费一区二区| 国产乱伦亚洲| 免费一级精品啪啪视频| 91快色色色色色| 操屄日韩| 久久久中文| 日韩情色一区二区| 99无码狠狠久久| 欧美色图片| 97天天摸天天爽| 亚洲色图亚洲| 极品尤物自安慰| 亚洲无吗在线视频| 日韩一级成人毛片免费观看| 亚洲无码免费看| 香蕉99秘 一区精品蜜桃臀| 男人a天堂手机在线版| 3P丝袜熟女 色综合| 五月天综合网| 欧美综合综合| 91AV天美在线视频| 福利天堂| 97视频在线免费| 天天色天天干天天射| 亚洲精品819| 探花一区二区三| 亚洲男人天堂av| 深喉吞精| 伊人天天久久动态图| 九九九九热| 一级二级在线观看| 欧美精品99久久久**| 国产h片在线观看视频| 99视频内射三四| 伊人黄色片| 国产玖玖| 久草免费福利在线播放| 91精品老女人| 麻豆国产第一| 亚洲有码视频二区| 思思热免费在线视频| 不卡啪啪视频| 久久伊人青青草| 熟女一区二区三区四区| 亚洲啪啪视频免费| 美女黄页网站| 日韩av电影成人在线| 丝袜美腿制服人妻二区中文字幕 | 99re不伦| 精品成人女人久久| 97亚洲精品| 日韩亚洲精品一区二区| 青青伊人这里只有精品| 99久久久99久久91熟女| 密臀成人视频久久久| 思思热国产高清| 97无码视频在线播放| 呦女网站| 国产高清26uuu| 免费观看的av| 超碰社区97| 色婷婷国产精品一区在线观看| 蜜桃视频成a人v在线| 91人人看| 欧美色图综合| 亚洲欧洲小说图片视频| 欧美色图亚洲色| 国产情侣自拍在线播放| 91女优在线观看| 久久国产熟女影院| 伊人综合色网| 999综合网| 激情五月婷| 91熟女视频网| 高清无码国产亚洲| 欧美骚少妇| 性爱Av免费| 熟女欧美日韩综合婷婷| 91国产美女丝袜足交精品视频| 欧美激情亚洲| 极品五月天噜噜| 欧美亚洲首页| 日韩乱码Av| 国产色图乱伦| 中文一区二区婷婷视频| 超碰99在线| 亚洲丝袜色| 欧洲色综合| 啪一啪免费视频| 久操网在线| 日韩欧美aⅴ综合网站发布| 久久手机好看网站| 国产精品网址| 日日干夜夜欢| 操逼1区| 亚洲欧美精品久| 欧美一区二区三区另类精品| 精吧天堂| 黄片免费看黄片免费看| 97在线观看免费| 国产情色在线| 在线看免费无码AV天堂的| 亚洲一卡二卡在线免费| 久久国产精品91| 玖玖资源中文字幕制服丝袜| 亚欧美色| 午夜福利免费精品视频| 操b网站亚洲无码| 性交一区二区在线播放| 六月丁香啪啪| 日韩欧美麻豆| 精品妇女一区二区三区| 任你干在线视频| 亚洲欧美黄| 熟女丰满人妻一区| 人妻献身系列第54部| 久久久96| 一区二区视频你懂的| 久久精品 六十路 熟女 欧美| 中文字幕在线日亚州9| 盗摄女人妻在线| 91视频综合网| 97操97色| 91av一区二区在线观看| 春色综合免费| 亚洲无套久久嗯嗯| 久久毛卡| 97在线观| 亚洲啪啪啪啪视香蕉| 成视频在线观看免费看| 人妻另类 专区 欧美 制服| 98一区二区精品| WWW.操逼.COM| 精品无码一区二区人妻久久蜜桃| 五月婷婷六月天| 波多野结衣之双飞调教在线播放| 后入式五六区| 天天干一区二区| 国产多人在线观看视频| 亚洲熟女诱惑| 97天天在线| 91色综| 日韩欧美成人午夜福利| 男同专区一区二区三区在线| 欧美黑人极品高潮喷吹熟女黑人性暴力日韩在线欧美极品一区二区老师 | 亚洲日韩久久精品一区| 亚洲va综合va国产va中文| 精品无码久久久久久久杏吧| 97超色| 野狼激情网| 欧美日韩国产中文精品字幕自在自线 | 激情五月综合开心五月| 欧美97av| 亚洲熟久久| 青草青青久久久久久国产| 九九综合久久中文字幕| 男人天堂网站| 中国黄色特级精品一区二区三区片| 亚洲国产第一页综合视频| 四虎国产精品永久地址入口| 88xx成人精品视频| AV有码在线| 九七毛片九九毛片| 综合激情一一91| 色爱综合网| 国产亚洲精品美女久久久久久2021| 97精品在线视频| 久久精品高清无码一区| 精品久久九| 亚州成人A√| 日日日日日| 日韩乱伦视频| 亚洲少妇中文字幕网址| 欧美网站免费| 亚洲nv男人的天堂网| 亚洲超碰AV| 啊啊啊啊啊好大好舒服想要| 夜色五月天| 综合一区中亚洲国产成人综合精品| 国内精品久久人妻性色av| 国产后入| 大香蕉欧美| 国产强奸无码乱伦| 91春色| 搡老女人老91二区| 亚洲人妻爽爽爽| 九九五月天| 欧洲亚洲综合| 亚洲激情片| 东京热天堂网| 欧美大片91| 伊人AAA| 久久r精品| 丰满少妇人妻久久久久久| 另类小色呦| 太久视频| 亚洲av影院在线观看| 国产毛片久久久久久久| 一线黄色免费性爱片| 亚洲欧美999| 91在线丝袜| 天天在线91| 精品久久9| 亚洲91射| 中文字幕AV中出| 综合色好色| 屁股久久久久久久| 国产精品制服丝袜中文字幕日韩一区二区三区 | 国产农村一一级特黄毛片| 欧美大香蕉专区网| 另类专区在线观看| 天美传媒av 在线| 毛片17S| 天天综合网91入口| 激情情色五月天| 9美女超碰在线免费观看| 在线天堂999| 欧美久久九九| 热热色中文无码| 日本二三四区| 亚洲男人天堂手机版| 情色图区| 夜色91| 99re热| 欧美v亚洲v日韩v最新在线二区| 午夜精品久久999热蜜桃介男人用| 后入式999| julia高潮后不停追击中出| 伊人综合色网| 美女91色黄18| 久久这里只精品免费福利| 色哟哟-国产专区| 亚拍在线| 日日爱99| 欧美人妻久久精品二区三区| 青青草中文-久久青草精品一区二区三| 伊人影院在线理论播放| 大但人体久久久久| 很黄很色的视频在线观看| 色婷婷激情| 日韩ab网| 精品视频在线观看| 九久9精品| www.狠狠干.coom | 97香焦色区| 夜草欧美| 精品无码一区二区三区| A V少妇特黄三级| 天美传媒av一区二区| 欧美色女人| 日本久久精品| 日韩精品中文字幕二区| 另类欧美| 熟女高潮精品一区二区| 被窝影院午夜看片无码| 黑丝少妇| 中文字幕熟女人妻丝袜丝| 亚洲精品一二区| 久草资源在线视频官方总站日韩丝袜美腿| 三四中文字幕| 丁香六月激情综合| 91大香蕉伊人| 国产树林里野战在线看| 久草色在线观看| 欧美日韩免费性爱| 中文字幕十五区| 久久精品国产亚洲AV清纯| 五月天婷婷影院| 校园春色家庭伦理欧美激情| 亚洲一欧洲中文字幕在线| 欧美激情片一区二区| 日日摸日日碰夜夜爽视频| 欧美成人性爱视频在线播放| 丝袜六区| 免费看黄片现成| 久久黄黄| 欧美色狠| 大香蕉色网| 爱爱动态120秒| 人妻熟女一区二区三区视频| 日韩亚洲Av人人夜夜澡人人爽| 最新精品久久蜜桃| 国产宅男宅女在线观看| 亚洲自拍欧美色综合| se01国产在线视频| 欧美在线|亚洲| 日韩性爱再线视频| 欧美激情精品久久久| 免费作爱一级视频| 色与欲影视天天看综合网| 婷婷大香蕉| 欧综合网| 婷婷色香| a一区二区三区乱码在线| 激情视频一二三| 日韩高清黄片| 欧美在线视频播放| 国产欧美日韩在线不卡第一页| 国产精品3| 狠狠色婷婷777| 欲色综合| 九9热伊人| 麻豆国产96在线| 狠狠躁伊人中文字幕| 欧美丝袜中文字幕07在线| 99色色网| 100啪啪视频大全| 最新中文字幕av| 爽极品影院| 国产热av| 亚洲情色1区| 国产一级特黄大片处女| 加勒比av网| 亚洲丁香花色| 97无码视频在线播放| 丝袜亚洲91| 不卡啪啪视频| 亚州91| 夜夜操天天肏| 国产精品青草综合久久| 欧美 精品国产制服第一页| 大香蕉在线SuP| 婷婷亚洲综合| www.99中文字幕| 久日综合网| 96精品在线| 在线观看成人性爱免费小视频| 天天综合网亚洲综合网| 人人手机欧洲亚洲国产人妻| 999亚洲国产视频| 丰满少妇精品一区二区| 韩国轻伦国内自拍一区| 精品无码人妻一区二区免费蜜桃| 亚洲欧洲网站免费观看| 三级日韩一区二区三区| 亚洲丝袜色| 国产精品一区二区三区在线密挑| 裸体女人草逼视频播放一区,二区,三区,四区,五区 | 国产欧美一区二区| 久草这里只有精品| 久肏视频字幕| 永久免费av无码网站国产app| 欧美熟女丝袜| 小草三级久久观看| 熟女被操视频网址| 欧美熟妇视频| 亚洲强奸乱伦影视网| 亚洲无码 国产无码| 欧美日韩亚洲少妇寂寞影院正在播放| 91欧美长吊| 亚洲操逼网| 国产精品一区午夜福利| 国产一区二区三区白丝| 男人天堂网站| 久久精品操| 青青草日本中文字幕| 激情自拍 校园春色| japan日本高清乱xxxx| 欧美呦呦性爱| 97在线视频观看| 色九九久九九| 五十路成人在线视频二区三区| 日本不卡码黄色| 日韩专区数据列表-第3230页-精品国产一区二区三区香蕉 久久99熟女人妻中文字 | 91亚洲在线| 国产蜜臀在线| 日本黄页视频在线观看| 91电影色诱| AV一二区| 日本一本一区二区三区四区五区欧美日韩中文字幕 | 中文字幕人妻色偷偷久久皮| 9l视频自拍9l九色成人| 九月丁香| 大香蕉男女超碰精品在线| www.色婷婷色综合| 丁香六月激情| 美女尤物福利视频| 韩日男人的天堂| 一区麻豆 高清中文字幕| 成人熟女视频一区二区三区| 久久av网| 麻豆乱码久久精| 欧美久久草熟女| 韩国轻伦国内自拍一区| 很黄很污的免费网站| 日本一级黄色电影| 亚洲天堂色图| 欧美有码亚洲中文字幕一区二区三区四区| 亚洲综合码| 69精品人人人人| 亚洲资源网| 日本免费一区二区不卡| 九九九九九九九九九九九蜜桃| 视频二区熟女人妻| 日日骚一区二区三区| 九热久| 91 丝袜在线播放| 国产成久久综合片| 国产无马视频| 国产成人网| 欧美性夜| 亚洲电影中字一区二区| 国产精品呦一区二区三区| 自拍偷拍 日韩无码| 欧美一级色| 天天操av懂色| 亚洲91大片| 97资源亚洲| 精品无码一区二区三区| 久久综合资源一区二区| 99操| 韩国三级三级BD在线| 亚洲人精品午夜不卡| 亚洲中文字幕熟女少妇一区二区| 日韩成人性日韩成人性爱视频在线免费观看| 精品成人无码| 久久婷婷热| 九九成人精品| 色色97爱| 强奸乱伦大香蕉| 久久五月综合| 色婷婷淫色网| 日本一级真人黄色性爱视频| 风流老熟女一区二区三区l| 久碰视频| 男人把坤坤插入女人的下体 | 91撸色网 玖玖网 欧美| 四季av一区二区凹凸精品小说| 一级一性爱免费视频| 东京热男人的天堂精品| 操逼啊啊啊91| 国产精品粉嫩福利在线| 中国黑人三级片网站上区| 欧美色图片欧美色图| 亚洲欧美日韩免费观看| 国产男人又猛又粗又爽| 成人日韩中文字幕| 99精品九九九九九九| 97精品一区二区视频| 久久精品色欧美aⅴ一区二区| www鬼畜国产男人的天堂| 欧美成人国产精品| 欧美性生活免费网| 67194无码不卡| 婷婷丁香人妻| 口爆吞精在线观看| 少妇69中文| 免费视频97| 97国产成人精品免费视频| 白丝少妇一区二区| 麻豆国产精品午夜视频| 一区二区三区在线资源| 夜夜春夜夜操| 亚洲少妇中文字幕网址| 欧美亚洲激情一二三| 蜜乳成人AV| 中文久久久| 新婚人妻扶着粗大强行坐下| 精品九九九九九九九九九| 午夜精品久久一区二区| 看日韩美女二区三区免费操逼视频| 丰满少妇一区二区三区专区| 老熟妇91| 欧美色婷婷| 久久婷婷一区| 国内三级自拍小视频在线观看| 91扒丝袜综合在线| 亚洲熟妇一,二,三期| 另类图片五月天| 97资源站国产精品| 色五月婷婷色| 四虎免费在线观看| 97久久精品亚洲| 78超碰| 欧美中文字幕男人天堂久久精品 | 韩国国产欧美情侣视频在线| 欧美一级特黄淫片在线观看| 丝袜AV一区二区三区| 色婷网| 久9爱精品| 欧美色色色| 超碰诱惑| 久久久久久夜夜夜夜夜| 欧洲黄色网| 99xav| 国产女同视频在线播放| 伊人久久亚洲色欲综合网站| 久久香蕉综合一本到3atv| 亚洲情色综合网| 日韩人妻一区二区精品| 香蕉99秘 一区精品蜜桃臀| 中文字幕黑人大片| 中文乱码字字幕在线第5页| 96AV久久久| 国产专区第一页| 色九九九九九九| 99精品在线播放| 久操精品| 性久久| 熟妇一区,二区,三区。| caorenqi shipin| 亚洲欧美日韩免费观看| 日本黄色天堂| 日韩人妻少妇中文字幕| 色就色综合| 变态另类专区| 超AV色女| 大伊香蕉在线视频免费| 97在线看| 亚洲熟女乱色一区二区三区久久久| 成人性爱美曰韩| 91国内外在线| 久久久亚洲精品电影免费看| 日韩国产在线观看av| 清纯唯美亚洲另类| 欧美性爱一区二区三区四区| 欧美成人性爱视频大全| 国产精品对白自产拍| 婷婷五月天影院| 亚洲在饯| 人妻黑丝袜电影| 深爱五月婷婷| 成人麻豆av电影网站| 96精品久久久| 天天亚洲综合| 91操人视频| 操逼视频色| 俞拍久久国应视频| 精品无码人妻一区二区免费蜜桃| 亚洲 日本 一 二 三| 欧美色视频在线| 99后入| 亚洲骚女一区二区三区| 精品一二三区久久AAA片| 成人毛片免费| 日日夜夜骑| 色哟哟1区2区| 美女高潮视频91| 亚洲精品成人激情在线| 91色噜噜狠狠| 大香蕉伊人久久| 亚洲 日本 国产 综合| 大香蕉久久| 亚洲双插| 亚洲综合骚逼| av东京热男人的天堂| 亚洲无套久久嗯嗯| 欧美99热| 亚洲人妻AV| 性开放中文AV高清无码免费看| av黄图片在线观看| 易易A毛视频| 自拍第一页| 九九热精彩视频| 97超碰天天爱天天爱| 黄页大片在线观看| 97超级久久强资源| 大香蕉色十月| www.色五月| 中文字幕在线免费观看视频| 欧美刺激色黄片免费看| 凸凹视频在线观看| 欧美日本中字另类在线| 欧美91在线| 中文久久| 精品免费视频国产一区| 久九色| 国产乱子伦一区二区三区在线观看| 超碰人人干天天射| 欧美激情精品| 精品999一区二区| 97se亚洲综合自| 91少妇人妻| 久久免费少妇| 久久大黄片| 国产精品白丝在线播放| 在线啊啊啊啊| 亚洲码和欧洲精品激情系列| 第二页中文字幕| 嗯嗯啊啊操死我| 日韩 成人 有码| 裸体1区| 国产精品乱码久久久久久| 久久久久久裸体| 欧美在线综合| 少妇九九九九| 日日97| 超碰碰97资源站| 清纯唯美亚洲| 78m成人视线| 激情久久久| 日韩卡一卡二卡三在线| 国模艳艳啪啪一区| 免费毛片在线播放| 欧美视频在线第3页| 熟妇熟女亚洲天堂网| 少妇被玩视频二三区| 在线观看视频91| 国产91专区| 激情啪啪视频| 女生久久网| 白丝被操91| www.91理论| 国产久9| 亚洲综合色图欧美| 97超碰中文在线| 爽极品影院| 久久98| 欧美一区二区在线资源| 欧洲精品区| 欧美色性情| 日韩高清黄片| 丁香五月天堂网| 91大神电影天堂| 97精品97久久| TS人妖另类精品视频系列| 人妻中文字幕精品无码 | 欧美日韩不卡传媒| 伊人国产成人av网站| 日本午夜操逼| 久久天天摸| 在线情色电影 91大| 熟女人妻一区二区三区免费看 | 97人人夜| 国产 日韩 欧美高清| www.99热| 91 综合 色| 国产精品久久久吖| 美女被艹尤物视频| 久久超碰免费的| 丰满人妻一区二区三区免费| 精品欧美А∨无码黑人大荫蒂| 成人在线日韩| 另类欧美| 黄色片一区二区三区四区五区| 另类小说五月天| 超碰日韩美妻| 草莓精品视频在线免费观看| 91在线页| 97网色| 久久久久国产精品片区无码直播| 操逼精品视频| 国产精品懂色tv影视免费观看| 免费人成?大片在线播放| 亚洲日本激情| 国产日产精品久久快鸭的功能介绍| 久操九九九九| 91成人无码| 国产精品久久伊人| 综合九九| 中文字幕一区二区三区高清| 亚洲国产第一页综合视频| 久久久免费高清中文视频| 亚洲国产精品有声| 色妹子A V| 亚洲色人阁| 色色色综合网| 日韩欧视频| 五月丁香大香蕉| 九九热精品| 国产成人综合网| 综合网亚洲在线| 激情专区综合| 九九九九亚洲| 青青草日韩无码| 天天欧美| 亚洲中文字幕噜噜噜久久久| 狠狠爱夜夜| 久久久中文| 97亚洲精品超碰| 亚洲第一页色| 91成人无码| AV天堂丝袜| 91操熟女| 无码视频一区二区| 黄色AAAAAAAAAAA大片| 欧美久久人妻少妇一区二区| 国产偷拍自拍在线视频| 呻吟 欧美 日本 中出| 亚洲黄色a级片| 欧美在线大香999| 五月天婷婷综合网| 欧美日韩在线小说| 九九热超碰97亚洲最新香蕉 | 8x福利精品第一福利视频导航| 亚洲色图20p| 欧美一级美片在线观看免费| 粉嫩AV输入| 精品偷拍13p欧美dodk视频| 久久同城AV| 牛黄色久午久| 少妇激情一区二区三区视频| 久久精品一区二区三区不卡| 在线视频免费观看午夜| 精爱久久| 久久久久久精品免费看A级| 老司机福利社视频在线观看| 久久老子无码午夜伦不卡| 人妻精品一区二区| 亚州成人A√| 一级@啪啪视频| 亚欧操逼片在线观看| 91狠狠色丁香婷婷综合久久精品| 国产精品另类| 乱理日韩中文| 精品亚洲黄色片 国产精品导航一区二区 | 亚洲蜜臀懂色| 欧美成人性爱视频免费观看| av资源在线播放天堂| 97久久超碰国产精品| 亚洲熟妇自偷自拍另欧美| 亚洲激情在线观看一区| 欧美黑人日韩少妇色情| 色噜噜人妻丝袜a∨先锋影 | 欧美综合国产精品久久丁香| 国产又爽又黄| 国产400孕妇孕交群| 操我啊啊啊啊啊| 人人做人人妻人人夜视频| 亚洲黄色AV电影| 久久9精品视频| 亚洲日本激情| 亚洲欧美91| 日本超碰97日韩精品人妻| 综合久久欧美| 综合亚洲欧美精品日韩?v| 婷婷探花久久精品一区| 国产天天骚| 少妇厨房愉情理伦片bd在线观看| AV天黑人| 国产女同性恋视频| 人妻久久久久久| 啊啊啊不要啊啊受不了了视频在线 | 国产AV久久野战精品| 欧美性少妇| 夜夜嗨AV蜜臀av| 五月天色色色| 东北丰满熟女国产一区| 搡老女人老91二区| 日日噜噜夜夜久久亚洲一区二区 | 国产熟女无套内射| 97在线青| 久久9久9久99久9久9| 2020国产精品| 色嗨嗨在线| 亚洲国产精品无码AV久久久| 欧美亚洲特P| 91黑丝操| 四虎视频在线观看| 中文字幕一区二区三区人妻少妇在线| 国产成人无码高清| 日韩亚洲精品一区二区| 97狠狠| 天天碰久久入| 殴洲老熟女| av在线浏览| 成人免费福利在线观看| 中文字幕十五区| 小草精彩毛片| 91超级碰| av天堂手机版追回 | 噜噜噜亚洲精| 久久久久婷婷精品av电影| 色香阁在线| 婷婷五月天在线观看| 午夜福利成人免费视频| 女人喷水视频在线观看| 一个国产在线综合网站| 亚洲中文字幕精品一区| 天美传媒AV在线| 久久久一区二区三区麻豆| 韩日巨乳美女免费视频在线观看| 中文字幕第页| 大香蕉五月天婷婷| 国内毛片国产专区二| 日韩乱伦影音先锋| 日韩欧美国产一区二区三区四区| 日韩免费中文字幕视频| 中文一区二区三区影院| 九九九久久久| 日本一级真人黄色性爱视频| 99无码| 精品人妻av区天天看片| 人人妻人人爽一区二区三区| 视频二区美腿制服人妻欧美| 久久精品国产97欧美精品亚洲 | 国内偷拍精品一区二区| 91社区伊人| 日欧操屄| 亚洲一区操| 国产日产精品久久快鸭的功能介绍| 少妇厨房愉情理伦片bd在线观看| 日本精品一级二级三级| 国产在线视频二区| 欧美日韩亚洲一区二区在线观看| 国产92麻豆天美精品色欲5| 色爱三区| 欧美一级做a爰片免费视频| 九九aV| 五月天开心网| 九九久久99| 日日骚精品视频| 日韩在线观看AV| 9久久久久| 涩综合导航| 91丝袜美女视频| 一起草高清无码| 色五天伊人| 静品嫩模一区二区| 四虎影库国产精品免费| 国产传媒1234区| 成人资源中文字幕在线观看| 成人一二三区| 亚洲中字幕日本一区二区三区| 丁香六月激情| 亚洲Av无码成人精品国产| 亚洲 欧美都市激情| 国产高清不卡视频| 偷拍亚洲视频一区二区三区四区| 91高清欧美| 最新日本中文字幕| 婷婷丁香五月天综合东京热| 五月综合视频| 欧亚第一综合网| 97视频在线观看网站| 成人青青草原伊人| 中文字幕第9页萱萱影音先锋| 国产成人在线观看网址| 骚货 中文字幕 av| 欧洲亚洲少妇| 欧美色视频在线| 久久久婷| 欧洲精品一二三在线| 9Ⅰ超碰| 国产精品女生av| 国产精品久久成人免费| 九九aV| 久久曰曰| 中文字幕一区二区三区人妻不卡 | 国产精品久久久久久夜夜夜夜| 999综合网| 精品亚洲国产成人av网站| 五月天激情婷婷| 2026国产精品视频| 蜜臀在线视频| 97婷婷色| 任你干在线视频| 女人与公拘交酡2020视频| 性爱av在线免费观看| 日韩午夜国产| 国产精品乱码久久久久| 欧美日韩 强奸乱伦| 黑丝91视频| 欧美亚洲宗合色性图| 我要去看2个日本美女.com曹逼| 天美麻花大全视频| 97久久久精品| 人妻三级在线中文字幕| 综合色色婷婷| 97超碰精品成| 国产精品久久久久久久AV大片| 亚洲人妻一区二区三区| 亚洲清纯综合| 亚洲欧美电影| 国产18精品亚洲精品| 亚洲淫色网中文| 亚洲本色精品一区二区久久| 国产精品交换一区二区| 亚洲午夜蜜臀| 日韩国产欧美伦理在线| 日本不卡码黄色| 少妇综合网| 97人人干| 国产免费内射视频| 99热99色| 欧美刺激色黄片免费看| 亚洲九九爱| 操逼视频亚洲| www.AV有限公司一区| 青青青在线高清视频在线一二三四区| 亚洲精品乱码久久久久久蜜桃麻豆| 美女毛片999| 综合夜夜| 超碰调教97| 欧美综合网A| 色99色| 九色黄站| 中文字暮97| 日本国产欧美一区三区二区| 91xingse| 床戏久久久av一区二区麻豆| 五月天婷精品激情| 久久色一区二区| 日韩 欧美 视频 在线 一区| 97精品国产精品免费观看| 91痴汉| 久久五月综合| 91在线视频国产网站| 久久久影院| 精品美女久久久久| 夜夜久久| 强奸乱伦大香蕉| 91精品少妇搡搡搡| 超碰在线人妻| 91天堂| 99啪啪视频| 国产精品成久久久久午夜午夜| wwe 天天干.com| 日本性爱欧美性爱| 日韩精品系列| 在线99热| 福利视频香蕉免费一区二区在线| 欧美久久婷| 日韩美女操b| 国产天天噜一噜久久久| 久久婷婷五月天| 欧美亚洲| 精品久久久不卡一区二区| 欧美一区二区观看在线| 美女AV一区二区| 亚洲少妇综合在线播放| 中文字幕免费在线观看| 亚洲中文字幕噜噜噜久久久| 欧洲在线性爱视频| 裸体1区| 亚洲激情在线| 玖玖人人爱| 日韩 欧美 另类 人妻| 热G综合热G中文| 蜜臀久久99精品久久综合| 中文字幕第2页| 99久久com免费视频′| 95自拍视频在线观看| 欧美丝袜中文字幕07在线| 青青草密桃在线播放| 国产网红精品| 欧美在线天堂| 一区,二区,三区视频| av资源在线播放天堂| 放黄片放3级黄片没穿衣服| 久久动漫精品视频这里只有精品| 99热最新| 蜜乳AV一区| 大奶的诱惑| 岛国不卡超碰护士AV在线播放| 久久久蜜桃一区二区三区| 国产探花日韩援交| 玖玖爱视频网站| A男人的天堂| 天天躁日日躁AAAXX| 国产精品爆乳懂色蜜乳| 人妻少妇久久| 97超碰色屌| 国产 日韩 欧美 中文 另类,国产 欧美 另类 制服 变态,高清 日韩 欧美 中文,高 | 99热在线播放| 亚洲成人av电影在线| 亚洲欧美不卡线| 蜜桃传媒视频第一区入口在线看| 天美传媒国产原创中文字幕亚洲欧美另类| 91社操逼| 日韩在线电影| 91在线国产后入风骚翘臀美女素人| 欧美日日夜夜| 国产激情久久久| jizzjizz欧美| 国产精品成久久久久午夜午夜| 大香蕉草草| 亚洲精品久久一区二区三区蜜桃臀| 性感女人网页在线观看视频| 国产日韩欧美三级片| 成人性爱av| 爱欲AV| 91狠狠综合久久| 九月丁香综合网| 久久春色| 亚洲情色 自拍| 色婷婷婷五月天激情四射| 熟妇人妻精品一区二区视频色欲| 国产不卡免费在线视频| 91精品人妻偷情| 天天干人妻视频| 吊色| 欧美熟女妇同| 人人操人人摸人| 又大又长又粗又爽又黄| 超碰色97| 久久亚洲天堂| 麻豆人妻偷人精品无码视频| 亚洲视频一二区| 亚洲视频,小说| 中文字幕一区二区三区人妻少妇在线| 人人色97| 色九九九九久| 亚洲精品久| 无码heyzo高清一区| 婷婷激情啪啪| 亚洲精品男人的天堂| 五月婷婷AV| 国产AV精久久| 黄片免费久久久久久久| 丝袜美腿制服人妻二区中文字幕| 操逼视频色| 韩日性爱av| 韩日性爱av| 凹凸久久人人| 自拍偷拍 日韩无码| 日韩国产在线观看av| 粉嫩不卡一区二区性爱| 日韩 欧美 另类 人妻| 国产精品直播在线观看直播| 亚洲中文字幕av | 蜜臀久久一区二区| 精品对白久久不卡| 酒色综合网| 国产捆绑一区| 色综合一本| 伊人国产成人av网站| 色噜噜狠狠色综无码久久合欧美| 蜜臀中文字幕| 久久这里只精品免费福利| 精品九九国产无码| 男人a天堂手机在线版| 天天干天天操天天干天天操| 中文字幕日本久久| 99视频内射三四| 青青操97| 97五月天| 97色视频在线| av日韩中文字幕| 国产一区在线看| 日韩欧美福利视频看看| 一区不卡在线观看av| 午夜黄色免费在线观看| 日本有码影片下载| 欧美色图下一页| 麻豆a'v电影| 亚洲交性| 久久综合国产精品国产| 日本在线视频导航| 清柠毛片| 久久久久久久六六|