逆運動學與逆動力學:姿態、運動與機器人轉矩

逆運動學探討哪種關節設定能將機器人框架置於期望的位置和方向。逆動力學則探討在機器人模型、目前狀態和外力下,哪些廣義力或關節轉矩能產生期望的關節運動。它們解決了同一運動問題的不同層次。

僅靠目標姿態無法決定致動器轉矩。機器人需要選定的關節解、時間參數化、速度、加速度、有效負載、重力方向和接觸假設。同樣,轉矩計算也不選擇無碰撞姿態。規劃、運動學、動力學和回饋必須顯式連線。

本指南應與 機器人校正工作流程關節控制模式結合使用。數值解只有在檢查關節、碰撞、轉矩、速度和任務約束後才能使用。

前向運動學定義了幾何模型

前向運動學將關節座標對映到末端效應器或另一個機器人框架的姿態。計算過程結合從基底到運動學鏈的鏈節變換。它使用幾何和關節位置,而非質量、慣性或施加的力。

在解決逆問題之前,影格定義必須正確。 OpenCV calib3d 記錄了相機和手眼校正中使用的相關剛性變換。求解器無法補償錯誤的基底、工具或相機變換;它會持續達到錯誤的物理姿態。

機器人連線並協調底座攝影機夾爪與目標之間的變換
機器人運動學負責構建座標變換;逆動力學在定義關節空間運動後新增運動和力項。來源:OpenCV 檔案。許可:Apache 2.0

逆運動學將任務姿勢對映到候選關節構型

給定期望的末端效應器姿態, IK 會找到在公差範圍內滿足幾何關係的關節座標。一個六軸臂可以有多個有效分支,冗餘臂可以有無限多個解,而有些目標則沒有,因為它們位於工作區之外或違反約束。

解析求解器為支援幾何體提供閉式分支。數值求解器從初始種子迭代減少姿態誤差,且更通用,但可能收斂到不同解或在困難設定附近失效。報告殘差誤差、迭代次數、種子和終止條件,而非只返回單一向量。

問題逆運動學逆動力學附加檢查
主要輸入期望姿態與幾何形狀Q、 QDOT、 QDDOT 和模型車架與單元
主要輸出關節設定關節力或轉矩致動器對映
包括質量嗎?是的有效負載辨識
包括時間安排嗎?不僅僅是姿勢需要運動導數軌跡生成
主要可行性伸展與關節界限轉矩與動態極限碰撞與接觸

多個 IK 解需要一個選擇規則

求解者不應隨意選擇肘部向上、肘部向下或冗餘姿勢。選擇標準可以包括與目前狀態的距離、關節極限餘裕、碰撞間隙、可操作性、可見性、電纜佈線、轉矩餘裕以及與前一解的連續性。

將之前的接合狀態作為平滑跟蹤的種子,但不要讓種子連續性將臂困在極限或碰撞附近。全域規劃器或顯式態態任務可以指導分支選擇。在不連續點處,應重新規劃,而非跳躍到遠處有效解。

奇點改變速度和力對映

雅可比矩陣將關節速度對映為任務空間速度,將關節轉矩對映為任務空間扳手關係。 《現代機器人學 》提供了這些運動學和動力學基礎。在奇點附近,某些任務方向需要非常大的關節速度,否則失去某些方向的獨立運動能力。

阻尼偽逆可以限制數值放大,但以穩定性為代價,犧牲任務精度。監控奇異值、狀態指標和指令關節速率。任務擴充、姿態調整或重新規劃可能比機器人進入不良設定後增加阻尼更安全。

軌跡會為姿態加上速度和加速度

路徑指定幾何序列,軌跡則賦予時間。關節位置 q(t)產生關節速度和加速度參考,這與動力學需求相反。時間尺度可以將同一路徑從溫和運動轉變為超過馬達轉速、轉矩或母線功率極限的路徑。

確保位置、速度和加速度對控制器和機構足夠連續。不連續加速度可能需要驅動力矩。檢查插值軌跡而非僅測量路徑節點,因為取樣姿態之間可能違反關節極限、碰撞和奇點。

以五個步驟整理逆運動學與逆動力學:姿態、運動與機器人轉矩的判讀重點
依正文與一手資料整理的繁體中文實務卡。來源:Physical AI Lab。

逆動力學將期望的運動對映為廣義力

對於剛性機器人,逆動力學通常評估慣性、速度相關項、重力和外部力,以估算廣義力。 欠驅動機器人筆記 為全驅動、浮動基座和接觸系統提供了基於模型的控制背景。

通常輸入為 q、 qdot、 qddot、模型參數和已知的外部力/力矩。對於固定基座旋轉關節,輸出可能是關節轉矩,浮動系統則為更大的廣義力向量。馬達可能需要透過傳動比、效率和轉矩常數進行轉換。

模型術語物理來源所需證據常見誤差
慣性大規模分佈鏈路與有效負載參數使用名義有效負載
重力質量與方向基重力框架錯誤的標誌或框架
速度項科裡奧利效應與離心效應關節速度雜訊微分
摩擦軸承與傳動系統雙向辨識一個恆定的效率
外部力量接觸點和工具負載扳手與接觸型號假設自由空間

接觸改變了動力學問題

當腳、輪子或工具接觸環境時,接觸力和約束會進入方程。固定基座臂接觸表面可以變成閉鏈系統。有腿機器人必須滿足摩擦、單側接觸和平衡條件,同時將力分攤到多個接觸點之間。

未知接觸無法僅靠 IK 姿態修復。估算或規劃接觸模式,定義允許的運動和力方向,幷包含外部扳手證據。確認預期解決方案不需透過單側接觸點或超過摩擦錐。

模型誤差使回饋變得不可或缺

反向動力學基於估計模型進行前饋。有效負載變化、電纜力、摩擦、溫度和彎曲會使部分估計失效。位置、速度、轉矩或任務空間回饋修正殘餘誤差,並排除可用頻寬內的干擾。

在符號、單位和框架驗證之前,不要增加基於模型的轉矩。從重力補償和慢動作開始,比較測量到的電流或轉矩,然後擴充範圍。在整個除錯過程中,應用獨立的位置、速度、電流、轉矩和工作空間限制。

軟體介面可能會隱藏已解的層

一個包可以暴露無動態可行性的 IK,或提供無碰撞檢查的逆動力學。 Orocos KDL 檔案 涵蓋運動學和動態求解器,但相關應用仍需提供校正模型、約束和控制器整合。

檢查單元、關節排序、基準慣例、重力向量和工具框架。記錄模型和設定版本並附帶結果。求解器返回成功表示其數值終止條件已滿足;但這並不證明物理機器人能夠安全執行該命令。

驗證從任務請求到測得力或力矩的完整鏈路

測試可達和不可達的姿態、多分支、關節極限邊緣和奇異區域。然後對選定路徑進行時間參數化,並比較預測轉矩與致動器證據在負載、方向、速度和溫度上的表現。包括實際任務將遇到的碰撞和接觸情況。

將期望和測量的任務姿態、 q、 qdot、 qddot、轉矩指令、目前、飽和和求解器狀態記錄在同一個時鐘上。這樣團隊可以區分幾何誤差、軌跡誤差、模型誤差和控制誤差,而不必將每次失敗的動作都歸咎於 IK。

評估“逆運動學與逆動力學:姿態、運動與機器人轉矩”時,還應儲存模型版本、機器人設定、校正檔案、測試日期和全部試驗記錄。

只有把這些持續投入與單位成功任務的價值比較,才能判斷方案是否適合擴大。

上線後仍要持續檢查分佈變化、感測器漂移、機械磨損和人工接管原因。

實際專案還應指定資料、模型、控制器和安全流程的負責人,並預先定義回復條件。責任邊界、審批記錄與變更紀錄越清楚,故障發生後越容易停止擴散、定位原因並安全恢復。

  • 先校正底座、工具和關節的參考點。
  • 保留所有相關的 IK 候選解及其選擇代價。
  • 檢查整個路徑上的奇點、碰撞和極限。
  • 提供動力學的定時導數和外力假設。
  • 比較模型轉矩與致動器測量資料。

常見問題

逆運動學計算馬達轉矩嗎?

不是。它計算任務姿勢的關節設定。轉矩需要運動時機、動態模型、有效負載和外力假設。

為什麼 IK 會返回多個答案?

不同的關節分支或冗餘姿勢可能產生相同的終點致動器姿勢。需要針對特定任務的選擇標準。

逆動力學能替代回饋嗎?

不是。它是基於模型的前饋;回饋是糾正參數誤差、摩擦、擾動和執行不匹配的必要條件。

奇點附近會發生什麼?

有些任務指令失去控制能力或需要非常大的關節活動。阻尼在數值上可以有所幫助,但可能需要調整姿勢或重新規劃。

哪個計算先行?

通常,任務姿勢會被轉換為選擇的關節路徑,計時會加上導數,逆動力學則在回饋執行動作前估算所需關節力矩或廣義力。

機器人模型邊界註釋

IK 成功並不能證明碰撞、動態或硬體的可行性,逆動力學輸出的準確性取決於模型、狀態和接觸假設。驗證機器人上的完整指令鏈,並設定獨立限制。

相關主題:倉儲揀選機器人如何運作?架構、指標與導入判斷