想象這樣一個場景：你的人形機器人正在彎腰拾起一個玻璃杯。如果關(guān)節(jié)太“硬”，手一碰到杯子就急停，可能打翻它；如果太“軟”，又會陷進去，無法穩(wěn)定抓取。理想的執(zhí)行器，應該像人的手臂——既能穩(wěn)穩(wěn)托住物體，又能順應外力微調(diào)姿態(tài)。

這正是力位混合控制（Hybrid Force-Position Control）要解決的核心問題。

在人形機器人這種帶減速器的高動態(tài)關(guān)節(jié)中，開發(fā)者常面臨兩難：

• 純位置控制太“硬”：接觸瞬間產(chǎn)生電流尖峰，易觸發(fā)過流保護，機械沖擊大；
• 純力/電流控制太“軟”：難以維持期望姿態(tài)，容易漂移，缺乏“支撐感”。

為平衡這兩者，我們在 HPM MCL v2 電機控制庫中集成了輕量級力位混合控制器。它不改變現(xiàn)有 FOC 電流環(huán)架構(gòu)，僅在上層增加一個外環(huán)，即可讓關(guān)節(jié)具備可調(diào)的剛度與阻尼，在精確跟蹤與環(huán)境順應之間找到最佳平衡點。

更關(guān)鍵的是：在“抓取/接觸”這類任務(wù)里，關(guān)節(jié)并不存在唯一的最佳剛度。

• 接觸與對齊階段更需要柔順（低剛度）來降低沖擊、避免打滑或卡死；
• 抓穩(wěn)與支撐階段更需要穩(wěn)定（高剛度）來維持姿態(tài)、承載負載。

力位混合控制讓執(zhí)行單元具備這種“剛度可調(diào)”的能力：不是在硬/軟之間二選一，而是按任務(wù)階段切換到合適的狀態(tài)。

它解決的是執(zhí)行單元的真實工程痛點

當關(guān)節(jié)需要與外界接觸（地面、桌面、人體、裝配件等），若只追求位置剛性，系統(tǒng)往往會出現(xiàn)：

1. 接觸瞬間的力矩/電流尖峰，帶來熱應力與保護風險；
2. 因阻尼不足或速度噪聲引發(fā)振蕩、“彈跳”；
3. 接觸后位置難以收斂，要么抖動，要么持續(xù)偏移。

力位混合控制的價值在于：在不改動底層驅(qū)動的前提下，為執(zhí)行單元增加一層可控的“阻抗行為”。無論外部擾動如何變化，關(guān)節(jié)都能按預設(shè)的剛度和阻尼響應，使接觸過程更平滑、更可預測。

在“大小腦”架構(gòu)中的定位：屬于執(zhí)行單元側(cè)

在典型的人形機器人分層控制架構(gòu)中：

• 大腦（任務(wù)層） 負責感知與決策，如“抓杯子”“邁步上臺階”；
• 小腦（運動規(guī)劃層） 將任務(wù)轉(zhuǎn)化為關(guān)節(jié)軌跡、末端力目標或全身優(yōu)化指令；
• 執(zhí)行單元（伺服驅(qū)動層） 則負責將這些目標高速、穩(wěn)定地轉(zhuǎn)化為電機電流。

HPM MCL v2 的力位混合控制明確歸屬于執(zhí)行單元側(cè)。它不參與任務(wù)規(guī)劃，也不決定“該施加多大的力”，而是接收上層給出的期望位置、速度（以及可選的前饋力矩），在電機側(cè)實時合成一個符合設(shè)定剛度/阻尼特性的力矩指令，并通過 FOC 電流環(huán)精準執(zhí)行。

簡言之：上層決定“想要什么”，我們負責把它穩(wěn)定、安全、可控地做出來。

注：雖然“阻抗控制”與“導納控制”在理論層面常被區(qū)分，但在實際系統(tǒng)中，只要采樣率與帶寬匹配，二者可通過數(shù)學變換等效。對執(zhí)行單元而言，最終落地需要一個高帶寬、帶限幅與濾波的力矩執(zhí)行鏈路——這正是本方案的定位。

核心思想：讓關(guān)節(jié)“可軟可硬”，且行為一致

力位混合控制的本質(zhì)，是將位置誤差和速度誤差映射為力矩輸出

輸出力矩 = 剛度(kp) × 位置誤差 + 阻尼(kd) × 速度誤差 + 前饋力矩(tau_ff)

其中：

• Kp 決定剛度：值越大，抵抗外力變形的能力越強；
• Kd 決定阻尼：值越大，運動越平穩(wěn)，抑制振蕩；
• tau_ff 為可選前饋力矩，用于補償重力或慣性項。

執(zhí)行單元將輸出力矩除以電機轉(zhuǎn)矩常數(shù) Kt，得到 q 軸電流指令，交由 FOC 電流環(huán)執(zhí)行。整個過程可在微秒級完成，確保阻抗行為實時響應。

這里要強調(diào)的是：低剛度與高剛度都是正常系統(tǒng)狀態(tài)。

• 低剛度適合“觸碰/對齊/人機交互”等需要順應的階段；
• 高剛度適合“抓穩(wěn)/定位/支撐”等需要穩(wěn)態(tài)保持的階段。

力位混合控制的價值在于讓這種行為“可調(diào)且一致”，并在執(zhí)行層用限幅/濾波把它做得可控、可實現(xiàn)。

為什么 HPM 芯片能高效支持這一功能？

力位混合控制雖邏輯簡潔，但對計算實時性與控制帶寬要求高。先楫高性能 RISC-V MCU 為此提供了關(guān)鍵硬件支撐：

• 主頻高達 800MHz 以上，確保外環(huán)控制周期可短至 1μs；
• 內(nèi)置硬件加速 FOC 單元，減輕 CPU 負擔；
• 高精度同步 ADC 與 PWM 觸發(fā)機制，保障電流環(huán)與位置環(huán)的嚴格時序?qū)R。

得益于此，開發(fā)者無需犧牲現(xiàn)有 FOC 架構(gòu)，僅需調(diào)用一個函數(shù)，即可啟用可調(diào)阻抗行為。

在 HPM SDK 中如何快速集成？

我們已在 hpm_sdk_extra 倉庫中提供完整的力位混合控制示例，集成過程極為簡潔，僅需四步：

1. 從編碼器讀取當前關(guān)節(jié)位置 q 與速度 dq；
2. 調(diào)用mcl_hybrid_ctrl_step()，傳入期望位置/速度、剛度 Kp、阻尼 Kd（以及可選前饋力矩），即可獲得目標力矩tau_cmd；
3. 根據(jù)電機轉(zhuǎn)矩常數(shù) Kt，計算 q 軸電流指令：iq_cmd = tau_cmd / Kt；
4. 調(diào)用hpm_mcl_loop_set_current_q(iq_cmd)，交由底層 FOC 電流環(huán)執(zhí)行。

整個外環(huán)邏輯不到十行代碼，卻能讓原本“非硬即剛”的伺服系統(tǒng)，具備按需調(diào)節(jié)的柔順交互能力——無需改動現(xiàn)有驅(qū)動架構(gòu)，開箱即用。

實際效果一：面對“穿墻指令”，誰更聰明？

為了直觀展示力位混合的價值，我們設(shè)計了一個典型場景：上層控制器給出一個“穿過物理限位”的目標位置（例如指令要求轉(zhuǎn)到 1.2 rad，但機械限位在 1.0 rad）。這在抓取、裝配或足式行走中非常常見。

我們并排對比三種策略：

• 左：傳統(tǒng)位置控制（固定高增益）
• 中：力位混合 + 低剛度（適用于接觸、對齊階段）
• 右：力位混合 + 高剛度（適用于抓穩(wěn)、支撐階段）

圖中關(guān)鍵信息已標注：

• 灰色粗線：物理限位（無法越過）
• 紅色虛線：上層給出的“穿墻”目標位置
• 底部數(shù)字：頂墻后關(guān)節(jié)穩(wěn)定輸出的力矩值（單位：N·m）

可以看到：

• 傳統(tǒng)位置控制持續(xù)輸出接近限幅的力矩（約 0.60 N·m），相當于“死命頂墻”，既浪費能量，又增加電流與發(fā)熱風險；
• 力位混合控制則根據(jù)設(shè)定剛度，自動收斂到合理的穩(wěn)態(tài)力矩：
  • 低剛度模式僅輸出約 0.20 N·m，輕柔貼合；
  • 高剛度模式輸出約 0.50 N·m，提供強支撐。

這意味著：同一個執(zhí)行單元，可在不同任務(wù)階段動態(tài)切換“手感”——接觸時柔順，抓持時穩(wěn)固，全程不超限、不失穩(wěn)。

實際效果二：突加外力沖擊，誰更穩(wěn)健？

再看一個更貼近真實世界的場景：在穩(wěn)定運行中，關(guān)節(jié)突然受到外部擾動（例如人手推一下，或機器人腳踩到石子），我們模擬為 +0.5 N·m 的階躍力矩，持續(xù) 100ms。

對比結(jié)果如下：

表面看，低剛度偏轉(zhuǎn)更大，但這恰恰是主動順應的表現(xiàn)：它通過允許可控的微小位移，顯著降低了力矩峰值和電流沖擊。而傳統(tǒng)位置控制因“拒絕任何偏移”，反而被迫輸出最大力矩對抗擾動，極易觸發(fā)過流保護。

在實際應用中，你完全可以：

• 接觸/探索階段：啟用低剛度，提升安全性與適應性；
• 作業(yè)/支撐階段：切換至高剛度，保證精度與剛性。

這種“按需調(diào)節(jié)”的能力，正是力位混合控制的核心優(yōu)勢。