機(jī)械臂運(yùn)動學(xué)原理入門正逆解、D-H 參數(shù)、軌跡規(guī)劃基礎(chǔ)運(yùn)動學(xué)聽起來嚇人其實(shí)就是回答兩個問題關(guān)節(jié)轉(zhuǎn)了多少度末端到了哪兒反過來末端想去哪兒關(guān)節(jié)該轉(zhuǎn)多少度一、運(yùn)動學(xué)到底是什么機(jī)械臂的**運(yùn)動學(xué)Kinematics**研究的是運(yùn)動本身不涉及力。它只關(guān)心兩件事關(guān)節(jié)角度和末端位置之間的幾何關(guān)系這個關(guān)系怎么算和運(yùn)動學(xué)對應(yīng)的叫動力學(xué)Dynamics那才是研究力、質(zhì)量、加速度的。新手先別碰動力學(xué)把運(yùn)動學(xué)搞明白就夠?qū)Ω?80% 的場景了。運(yùn)動學(xué)核心分兩類正運(yùn)動學(xué)和逆運(yùn)動學(xué)下面分別拆解。二、正運(yùn)動學(xué)已知關(guān)節(jié)角度求末端位置2.1 基本思路正運(yùn)動學(xué)Forward Kinematics簡稱 FK的輸入是各關(guān)節(jié)的角度輸出是末端執(zhí)行器在空間中的位置和姿態(tài)。比如一個六軸機(jī)械臂告訴你 6 個關(guān)節(jié)各自轉(zhuǎn)了多少度θ? 到 θ?你能算出末端夾爪當(dāng)前在三維空間哪個坐標(biāo)、朝哪個方向。這叫正向——從關(guān)節(jié)推到末端。2.2 數(shù)學(xué)本質(zhì)矩陣乘法正運(yùn)動學(xué)的計算核心是齊次變換矩陣的連乘。每個關(guān)節(jié)對應(yīng)一個變換矩陣把所有矩陣按順序乘起來就得到末端到基座的總變換關(guān)系。齊次變換矩陣是一個 4×4 矩陣把旋轉(zhuǎn)和平移統(tǒng)一在一個矩陣?yán)锉硎綯 | R p | R: 3×3 旋轉(zhuǎn)矩陣描述姿態(tài) | 0 1 | p: 3×1 平移向量描述位置其中 R 是 3×3 的旋轉(zhuǎn)矩陣p 是 3×1 的位置向量。矩陣最后一行固定是 [0 0 0 1]純粹是為了湊成方陣好做矩陣乘法。三、逆運(yùn)動學(xué)已知末端位置求關(guān)節(jié)角度3.1 基本思路逆運(yùn)動學(xué)Inverse Kinematics簡稱 IK是正運(yùn)動學(xué)的反向操作輸入是我希望末端到這個位置輸出是各關(guān)節(jié)該轉(zhuǎn)多少度。這個反算比正算難得多。原因有三可能無解目標(biāo)位置超出機(jī)械臂工作空間物理上夠不著可能多解同一個末端位置可能對應(yīng)多組關(guān)節(jié)角度組合比如肘朝上和肘朝下都能到非線性方程涉及三角函數(shù)沒法簡單反解3.2 兩種求解方法解析法Closed-form通過幾何關(guān)系直接推導(dǎo)出角度公式速度快、可實(shí)時但只適用于結(jié)構(gòu)簡單的機(jī)械臂且有特殊幾何約束比如相鄰三軸交于一點(diǎn)數(shù)值法Numerical用迭代優(yōu)化如牛頓-拉夫遜法、雅可比偽逆法逼近解通用性強(qiáng)但計算量大、可能不收斂工業(yè)機(jī)械臂控制器一般用解析法因?yàn)榻Y(jié)構(gòu)已知且優(yōu)化過通用機(jī)器人框架如 ROS MoveIt兩者都支持。四、D-H 參數(shù)模型用 4 個參數(shù)描述一個關(guān)節(jié)4.1 D-H 是什么D-H 參數(shù)Denavit-Hartenberg是描述機(jī)械臂關(guān)節(jié)的經(jīng)典方法核心思想是給每個關(guān)節(jié)指定一個坐標(biāo)系用 4 個參數(shù)描述相鄰坐標(biāo)系之間的關(guān)系。這 4 個參數(shù)是參數(shù)含義類型a連桿長度沿 x 軸的偏移結(jié)構(gòu)參數(shù)固定α連桿扭角繞 x 軸的旋轉(zhuǎn)結(jié)構(gòu)參數(shù)固定d關(guān)節(jié)偏距沿 z 軸的偏移移動關(guān)節(jié)為變量轉(zhuǎn)動關(guān)節(jié)固定θ關(guān)節(jié)角繞 z 軸的旋轉(zhuǎn)轉(zhuǎn)動關(guān)節(jié)為變量移動關(guān)節(jié)固定一句話理解a 和 α 描述連桿本身的形狀d 和 θ 描述關(guān)節(jié)怎么動。4.2 每個關(guān)節(jié)對應(yīng)一個變換矩陣相鄰兩個關(guān)節(jié)坐標(biāo)系之間的變換就是把這 4 個參數(shù)對應(yīng)的 4 個基本變換串起來T Rot(z, θ) · Trans(z, d) · Trans(x, a) · Rot(x, α)展開后是一個固定的 4×4 矩陣形式θ 或 d 作為變量代入即可。n 個關(guān)節(jié)就有 n 個這樣的矩陣全乘起來就是正運(yùn)動學(xué)的解。五、二連桿機(jī)械臂正解推導(dǎo)示例最簡單的入門案例一個兩連桿平面機(jī)械臂兩個轉(zhuǎn)動關(guān)節(jié)連桿長度分別為 l? 和 l?。5.1 建立坐標(biāo)系基座原點(diǎn)在關(guān)節(jié) 1 處關(guān)節(jié) 1 角度 θ?從 x 軸逆時針量關(guān)節(jié) 2 角度 θ?相對于連桿 1 的方向量5.2 推導(dǎo)末端位置末端坐標(biāo) (x, y) 直接用三角函數(shù)寫出x l?·cos(θ?) l?·cos(θ? θ?) y l?·sin(θ?) l?·sin(θ? θ?)這就是正運(yùn)動學(xué)解。輸入 θ?、θ?輸出末端 (x, y)。5.3 反推逆解已知 (x, y)求 θ? 和 θ?。先用余弦定理算出 θ?cos(θ?) (x2 y2 - l?2 - l?2) / (2·l?·l?)再算 θ?θ? atan2(y, x) - atan2(l?·sin(θ?), l? l?·cos(θ?))注意 θ? 有正負(fù)兩個解對應(yīng)肘朝上和肘朝下兩種姿態(tài)——這就是逆運(yùn)動學(xué)的多解性最直觀的體現(xiàn)。六、逆解的多解性問題同一個末端位姿機(jī)械臂可能有多組關(guān)節(jié)角度都能到達(dá)。六軸機(jī)械臂最多有8 組解。實(shí)際控制時要根據(jù)以下策略選一組最短路徑準(zhǔn)則選離當(dāng)前關(guān)節(jié)角度最近的解減少運(yùn)動量避障準(zhǔn)則選不會撞到障礙物的解奇異規(guī)避準(zhǔn)則避開雅可比矩陣奇異的位置七、軌跡規(guī)劃基礎(chǔ)知道去哪兒還不夠還得規(guī)劃怎么去這就是軌跡規(guī)劃。7.1 三種基本運(yùn)動類型類型全稱說明PTPPoint-to-Point點(diǎn)到點(diǎn)運(yùn)動只關(guān)心起點(diǎn)終點(diǎn)中間路徑自由LINLinear直線插補(bǔ)末端走直線軌跡CIRCCircular圓弧插補(bǔ)末端走圓弧軌跡PTP 最快但不控路徑LIN/CIRC 控路徑但慢。抓取通常用 PTP 快速接近最后一段用 LIN 精確對準(zhǔn)。7.2 關(guān)節(jié)空間 vs 笛卡爾空間軌跡規(guī)劃可以在兩個空間進(jìn)行關(guān)節(jié)空間規(guī)劃直接對各關(guān)節(jié)角度做插值如梯形速度曲線計算簡單、不會出現(xiàn)奇異但末端軌跡不可預(yù)測笛卡爾空間規(guī)劃先在直角坐標(biāo)系規(guī)劃末端路徑再通過逆運(yùn)動學(xué)實(shí)時算出各關(guān)節(jié)角度末端軌跡可控但計算量大、可能遇到奇異點(diǎn)實(shí)際系統(tǒng)通?；旌鲜褂煤暧^移動用關(guān)節(jié)空間快精細(xì)操作用笛卡爾空間準(zhǔn)。7.3 速度規(guī)劃梯形速度曲線最常用的速度曲線是梯形速度曲線勻加速 → 勻速 → 勻減速。加速度恒定速度曲線呈梯形。好處是計算簡單、對電機(jī)沖擊小。進(jìn)階的還有 S 型曲線加速度也平滑變化更柔和但計算更復(fù)雜。八、小結(jié)運(yùn)動學(xué)的學(xué)習(xí)路徑給新手一個建議的學(xué)習(xí)順序先理解齊次變換矩陣旋轉(zhuǎn) 平移手推二連桿平面機(jī)械臂的正逆解學(xué) D-H 參數(shù)建模給一個簡單機(jī)械臂標(biāo) D-H 參數(shù)用 MATLAB 或 Python 實(shí)現(xiàn)正運(yùn)動學(xué)計算接觸逆運(yùn)動學(xué)的數(shù)值解法雅可比迭代最后進(jìn)入軌跡規(guī)劃實(shí)現(xiàn) PTP/LIN 運(yùn)動運(yùn)動學(xué)是機(jī)械臂控制的根基這塊搞透了后面的視覺抓取、力控、大模型指令對接才有立足點(diǎn)。別跳過基礎(chǔ)直接調(diào)包不然出了問題根本不知道哪兒錯了。