【导语】人形机器人抓取玻璃杯时，关节太“硬”易打翻，太“软”难抓稳，理想的执行器需像人臂般刚柔并济。力位混合控制正是为解决这一难题而生，它让关节“可软可硬”，在精确跟踪与环境顺应间找到平衡。HPM MCL v2电机控制库集成该功能，不改变现有架构，仅在上层加外环，就能让关节按任务阶段切换刚度，实现稳定、安全的交互。
想象这样一个场景：你的人形机器人正在弯腰拾起一个玻璃杯。如果关节太“硬”，手一碰到杯子就急停，可能打翻它；如果太“软”，又会陷进去，无法稳定抓取。理想的执行器，应该像人的手臂——既能稳稳托住物体，又能顺应外力微调姿态。
这正是力位混合控制（Hybrid Force-Position Control）要解决的核(hé)心(xīn)问(wèn)题。
在人形机(jī)器(qì)人(rén)这(zhè)种(zhǒng)带(dài)减(jiǎn)速(sù)器(qì)的(de)高(gāo)动(dòng)态(tài)关节(jié)中(zhōng)，开(kāi)发(fā)者(zhě)常(cháng)面(miàn)临(lín)两(liǎng)难(nán)：
为(wèi)平(píng)衡(héng)这(zhè)两(liǎng)者(zhě)，我(wǒ)们(men)在(zài) HPM MCL v2 电(diàn)机(jī)控(kòng)制(zhì)库(kù)中(zhōng)集成(chéng)了(le)轻(qīng)量(liàng)级(jí)力(lì)位(wèi)混(hùn)合(hé)控(kòng)制(zhì)器(qì)。它(tā)不(bù)改(gǎi)变(biàn)现(xiàn)有(yǒu) FOC 电(diàn)流(liú)环(huán)架(jià)构(gòu)，仅(jǐn)在(zài)上(shàng)层(céng)增(zēng)加(jiā)一(yī)个(gè)外(wài)环(huán)，即(jí)可(kě)让(ràng)关节(jié)具(jù)备(bèi)可(kě)调(diào)的(de)刚(gāng)度(dù)与(yǔ)阻(zǔ)尼，在精确跟踪与环境顺应之间找到最佳平衡点。
更关键的是：在“抓取/接触”这类任务里，关节并不存在唯一的最佳刚度。
力位混合控制让执行单元具备这种“刚度可调”的能力：不是在硬/软之间二选一，而是按任务阶段切换到合适的状态。
当关节需要与外界接触（地面、桌面、人体、装配件等），若只追求位置刚性，系统往往会出现：
力位混合控制的价值在于：在不改动底层驱动的前提下，为执行单元增加一层可控的“阻抗行(xíng)为(wèi)”。无(wú)论(lùn)外(wài)部(bù)扰(rǎo)动(dòng)如(rú)何(hé)变(biàn)化(huà)，关节(jié)都(dōu)能(néng)按(àn)预(yù)设(shè)的(de)刚度和(hé)阻(zǔ)尼(ní)响(xiǎng)应(yīng)，使(shǐ)接(jiē)触(chù)过(guò)程(chéng)更(gèng)平(píng)滑(huá)、更(gèng)可(kě)预(yù)测(cè)。
在(zài)典(diǎn)型(xíng)的(de)人(rén)形(xíng)机(jī)器(qì)人(rén)分(fēn)层(céng)控(kòng)制(zhì)架(jià)构(gòu)中(zhōng)：
HPM MCL v2 的(de)力(lì)位(wèi)混(hùn)合(hé)控(kòng)制(zhì)明(míng)确(què)归(guī)属(shǔ)于(yú)执(zhí)行(xíng)单(dān)元(yuán)侧(cè)。它(tā)不(bù)参(cān)与(yǔ)任(rèn)务(wu)规(guī)划(huà)，也(yě)不(bù)决(jué)定(dìng)“该(gāi)施(shī)加(jiā)多(duō)大(dà)的(de)力(lì)”，而(ér)是(shì)接(jiē)收(shōu)上(shàng)层(céng)给(gěi)出(chū)的(de)期(qī)望(wàng)位(wèi)置(zhì)、速(sù)度(dù)（以(yǐ)及(jí)可(kě)选(xuǎn)的(de)前(qián)馈(kuì)力(lì)矩(ju)），在(zài)电(diàn)机(jī)侧(cè)实(shí)时(shí)合(hé)成(chéng)一(yī)个(gè)符(fú)合(hé)设(shè)定(dìng)刚(gāng)度(dù)/阻(zǔ)尼(ní)特(tè)性(xìng)的(de)力(lì)矩(ju)指(zhǐ)令(lìng)，并(bìng)通(tōng)过(guò) FOC 电(diàn)流(liú)环(huán)精(jīng)准(zhǔn)执(zhí)行(xíng)。
简(jiǎn)言(yán)之(zhī)：上(shàng)层(céng)决(jué)定(dìng)“想(xiǎng)要(yào)什(shén)么(me)”，我(wǒ)们(men)负(fù)责(zé)把(bǎ)它(tā)稳(wěn)定(dìng)、安(ān)全、可(kě)控地做出来。
注：虽然“阻抗控制”与“导纳控制”在理论层面常被区分，但在实际系统中，只要采样率与带宽匹配，二者可通过数学变换等效。对执行单元而言，最终落地需要一个高带宽、带限幅与滤波的力矩执行链路——这正是本方案的定位。
力位混合控制的本质，是将位置误差和速度误差映射为力矩输出
输出力矩 = 刚度(kp) × 位置误差 + 阻尼(kd) × 速度误差 + 前馈力矩(tau_ff)
其中：
执行单元将输出力矩除以电机转矩常数 Kt，得到 q 轴电流指令，交由 FOC 电流环执行。整个过程可在微秒级完成，确保阻抗行为实时响应。
这里要强调的是：低刚度与高刚度都是正常系统状态。
力位混合控制的价值在于让这种行为“可调且一致”，并在执行层用限幅/滤波把它做得可控、可实现。
力位混合控制虽逻辑简洁，但对计算实时性与控制带宽要求高。先楫高性能 RISC-V MCU 为此提供了关键硬件支撑：
得益于此，开发者无需牺牲现有 FOC 架构，仅需调用一个函数，即可启用可调阻抗行为。
我们已在 hpm_sdk_extra 仓库中提供完整的力位混合控制示例，集成过程极为简洁，仅需四步：
整个外环逻辑不到十行代码，却能让原本“非硬即刚”的伺服系统，具备按需调节的柔顺交互能力——无需改动现有驱动架构，开箱即用。
为了直观展示力位混合的价值，我们设计了一个典型场景：上层控制器给出一个“穿过物理限位”的目标位置（例如指令要求转到 1.2 rad，但机械限位在 1.0 rad）。这在抓取、装配或足式行走中非常常见。
我们并排对比三种策略：
图中关键信息已标注：
可以看到：
这意味着：同一个执行单元，可在不同任务阶段动态切换“手感”——接触时柔顺，抓持时稳固，全程不超限、不失稳。
再看一个更贴近真实世界的场景：在稳定运行中，关节突然受到外部扰动（例如人手推一下，或机器人脚踩到石子），我们模拟为 +0.5 N·m 的阶跃力矩，持续 100ms。
对比结果如下：
| 模式 | 峰值输出力矩 (N·m) | 最大位置偏转 (°) |
|---|---|---|
| 传统位置控制 | 0.60（已达限幅） | 2.66 |
| 力位混合（低刚度） | 0.41 | 10.28 |
| 力位混合（高刚度） | 0.54 | 6.41 |
表面看，低刚度偏转更大，但这恰恰是主动顺应的表现：它通过允许可控的微小位移，显著降低了力矩峰值和电流冲击。而传统位置控制因“拒绝任何偏移”，反而被迫输出最大力矩对抗扰动，极易触发过流保护。
在实际应用中，你完全可以：
这种“按需调节”的能力，正是力位混合控制的核心优势。
