機器人位置、速度與轉矩控制:關節控制環解析

機器人位置、速度和轉矩控制並不是同一指令的三個可互換標籤。位置控制要求關節達到一定角度,速度控制要求其保持速率,轉矩或作用力控制要求驅動器產生旋轉力矩。可用的指令介面及其下層已經閉合的回饋環決定了真實行為。

大多數伺服關節採用級聯環路。快速電流環調節馬達轉矩,較慢的速度環位於其外層,位置環可能包圍這兩者。齒輪比、摩擦、背隙、順應性、感測器、飽和度和熱極限會影響傳遞到輸出軸的實際反應。

請結合機器人 編碼指南接觸控制比較,使用本指南。增益和模式轉換必須在實際驅動、機構和負載上進行驗證;僅憑軟體介面名稱無法證明輸出轉矩或安全性。

從應用必須調節的數量開始

拾取與放置軸通常優先考慮路徑位置和時機。輸送機或輪子可能優先考慮速度。接觸、力限制或動態平衡可能需要轉矩級別的行為。在選擇指令模式前,將任務轉換為跟蹤誤差、干擾排除、接觸反應和停止要求。

外部應用仍可生成多個量。軌跡可能包含位置、速度和加速度前饋,而關節則閉合力環。陳述指令變數、測量變數、控制器位置和速率,以確保架構清晰。

開放伺服馬達顯示電動機齒輪組和位置回饋元件
緊湊型伺服結合了馬達、減速齒輪和位置回饋,而其電子裝置則閉合一個或多個控制環路。來源:Michael Coghlan,維基共享資源。許可:CC BY-SA 3.0

電流環是實際產生的轉矩層

馬達轉矩大致與馬達轉矩常數內的 q 軸電流相關。驅動裝置測量相電流並快速切換電壓,使電流遵循其參考。電氣延遲、電壓限制、電流感測器誤差和溫度限制限制了反應。

電流指令並不自動等同於關節轉矩。齒輪比、效率、摩擦、鋼索力、反射慣性和校正等因素會介入。如果輸出轉矩重要,請驗證其與外部力或轉矩參考的方向、速度和溫度的關係。

命令層典型回饋迴圈輸出主要限制
電流或轉矩馬達電流,有時是轉矩感測器電壓或電流需求電壓、電流和熱極限
速度編碼器速度產生轉矩的需求雜訊、延遲與加速度極限
職位編碼器位置速度或轉矩需求柔順性、背隙和路徑限制
笛卡爾運動機器人運動學關節參考量奇點與模型誤差
接觸目標力感或觸覺感測運動或轉矩校正穩定性與安全極限

速度環將速度誤差轉換為轉矩需求

速度控制將測量到的關節或馬達轉速與參考值進行比較,通常產生轉矩或電流指令。它能排除負載擾動,同時不強制達到特定最終位置。速度估計質量很重要,因為編碼器微分會放大量化和雜訊。

連線機構時調諧迴路。在無負載馬達上,增益穩定,安裝後可能會激發齒輪箱順應性或結構共振。加速度、加加速度和電流限制必須協調,避免速度控制器在每次過渡中持續飽和。

位置環路由角度誤差產生運動

位置控制比較目標和測量角度,然後產生速度或轉矩需求。軌跡執行直觀,但高比例增益並不等同於免費精度。順應性、背隙、感測器位置和飽和度可能導致振盪或較大接觸力。

ROS 2關節軌跡控制器檔案區分了位置、速度和力矩命令介面,並描述瞭如何透過 PID 對映軌跡誤差以獲取速度或力矩命令。介面下方的硬體實現仍然定義了物理行為。

環路頻寬應從內向外逐漸減少

電流環通常必須比速度環更快穩定,速度環也必須快於位置環。這種分離使每個外環都能將內部反應視為其自身頻寬內的近似即時反應。分離不良會導致相互作用和調諧困難。

不要在未測量延遲、共振和計算抖動的情況下,選擇“快十倍”等口號的速率。辨識被控物件的反應,在問題模態下設定保守頻寬,並在有效負載和溫度變化下檢查增益和相位裕度。

以五個步驟整理機器人位置、速度與轉矩控制:關節控制環解析的判讀重點
依正文與一手資料整理的繁體中文實務卡。來源:Physical AI Lab。

位置、速度和作用力介面的語意不同

ROS 2 控制展示了位置、速度和力的關節狀態和指令介面,而 關節運動學和傳輸對映則連線 致動器和關節空間。作用力介面數值可能代表馬達轉矩、關節轉矩或正規化需求,具體取決於硬體外掛。

記錄單位、標誌、參考系、齒輪對映、飽和度以及是否包含重力或摩擦補償。確認指令停止到達時會發生什麼。直接施加力的模擬器並不證明物理驅動能提供校正的關節轉矩。

驗證測試位置模態證據速度模式證據轉矩模式證據
階梯或軌跡穩定時間與路徑誤差速率追蹤轉矩上升與極限
負載擾動位置恢復速度恢復轉矩調節
反轉反彈與滯後效應零交叉行為摩擦補償
聯絡方式峰值力與撓度速度對力瞬變力或阻抗反應
模態轉換沒有位置跳躍沒有利率跳升無轉矩衝擊

PID 項解決不同的誤差模式

比例作用反應目前誤差,積分作用消除持續偏置,導數或速度回饋增加阻尼。前饋項可以提供預期的重力、慣性、速度或摩擦需求,因此回饋糾正殘差誤差,而非承擔整個任務。

積分作用在接近飽和和模式變化時需要特別注意。大型儲存積分器在極限清除後可能會發出意外浪湧。在除錯期間使用防上振、有界積分器、無碰撞初始化和記錄項貢獻。

飽和和力學打破了理想級聯

電壓、電流、速度、加速度和行程限制都可能削減一個指令。外環必須知道何時內環無法反應;否則致動器保持固定時誤差會累積。極限管理應產生受控反應,而非隱藏的不連續。

齒輪箱彈性、背隙、摩擦和結構模式意味著馬達端回饋不總是輸出端運動。只有在測量效果後才可新增輸出感應或模型補償。用於掩蓋機械誤差的激進增益會增加熱量、磨損和接觸嚴重度。

分別驗證軌跡跟蹤、擾動反應和接觸行為

軌跡跟蹤測量在代表性速度、加速度和有效負載下的路徑和時序誤差。擾動測試應用已知負載變化並觀察恢復。接觸測試引入受控環境剛度,測量力、撓度和穩定性。一次成功的測試不能替代其他測試。

紀錄參考、測量狀態、控制器項、飽和標誌、溫度和安全事件,基於統一時間基準。在方向、姿勢和預熱階段重複。可重複的輸出端測量比干淨的內部指令追蹤更有用。

模式轉換是控制設計的一部分

從位置切換到轉矩控制時,如果新控制器的參考值與目前狀態不一致,可能會產生跳躍。根據測量條件初始化位置目標、積分器和轉矩偏置,並在顯式轉換邏輯下設定逐步放開控制權限。

定義允許的過渡、保護條件、超時行為和備份模式。測試過時命令、感測器丟失、驅動器故障和緊急停止。平滑的名義切換在故障路徑被邊界之前是不完整的。

評估“機器人位置、速度與轉矩控制:關節控制環解析”時,還應儲存模型版本、機器人設定、校正檔案、測試日期和全部試驗記錄。

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

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

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

把任務拆成感知、決策、動作執行和結果確認,可以更準確地定位瓶頸。每一階段都應有獨立指標與失敗示例,避免用端對端成功率掩蓋偶發但嚴重的風險。

  • 說明受控量,並標明回饋環在哪一層閉合。
  • 內環應比外環更快,並保留經過測量的頻寬裕量。
  • 記錄命令單元、對映和飽和度。
  • 測試追蹤、干擾抑制和接觸分別進行。
  • 讓每個模式轉換都明確且無碰撞。

常見問題

位置控制機器人沒有轉矩控制嗎?

通常,它在位置環下方仍有一個快速的馬達電流或產生轉矩的環路;使用者可能不會直接控制它。

控制器更新頻率越高越好嗎?

不行。取樣必須支援所需的頻寬,但延遲、雜訊、抖動、計算和機械共振仍然限制了有用的增益。

用力指令等同於測量的關節轉矩嗎?

不一定。用輸出端證據確認硬體定義、傳輸對映、摩擦補償和校正。

更高的位置增益總能提升準確度嗎?

不會。它能減少低頻誤差,同時還能激勵順應性、增加接觸力、讓驅動器飽和並增加熱量。

控制器能直接從位置切換到轉矩模式嗎?

只有透過設計的轉換來初始化引用和狀態、限制命令變更並驗證故障行為。

關節控制邊界說明

控制增益、極限和模式轉換是致動器、驅動、感測、負載和安全設計特有的。用代表性硬體驗證輸出行為,不要透過軟體介面名稱推斷校正過的轉矩或安全功能。

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