Suzhou Outuo Lifting Technology Co., Ltd
想象如许一个场景:你的人形呆板人正于哈腰拾起一个玻璃杯。假如枢纽关头太“硬”,手一遇到杯子就急停,可能打翻它;假如太“软”,又会陷进去,没法不变抓取。抱负的履行器,应该像人的手臂——既能稳稳托住物体,又能适应外力微调姿态。
这恰是力位混淆节制(Hybrid Force-Position Control)要解决的焦点问题。
于人形呆板人这类带减速器的高动态枢纽关头中,开发者常面对两难:
纯位置节制太“硬”:接触刹时孕育发生电流尖峰,易触发过流掩护,机械打击年夜;纯力/电流节制太“软”:难以维持指望姿态,轻易漂移,缺少“支撑感”。为均衡这二者,咱们于 HPM MCL v2 机电节制库中集成为了轻量级力位混淆节制器。它不转变现有 FOC 电流环架构,仅于上层增长一个外环,便可让枢纽关头具有可调的刚度与阻尼,于切确跟踪与情况适应之间找到最好均衡点。
更要害的是:于“抓取/接触”这种使命里,枢纽关头其实不存于独一的最好刚度。
接触与对于齐阶段更需要和婉(低刚度)来降低打击、防止打滑或者卡死;抓稳与支撑阶段更需要不变(高刚度)来维持姿态、承载负载。力位混淆节制让履行单位具有这类“刚度可调”的能力:不是于硬/软之间二选一,而是按使命阶段切换到适合的状况。
它解决的是履行单位的真实工程痛点当枢纽关头需要与外界接触(地面、桌面、人体、装置件等),若只寻求位置刚性,体系往往会呈现:
接触刹时的力矩/电流尖峰,带来热应力与掩护危害;因阻尼不足或者速率噪声激发振荡、“弹跳”;接触后位置难以收敛,要末抖动,要末连续偏移。力位混淆节制的价值于在:于不改动底层驱动的条件下,为履行单位增长一层可控的“阻抗举动”。不管外部扰动怎样变化,枢纽关头都能按预设的刚度及阻尼相应,使接触历程更光滑、更可猜测。
于“巨细脑”架构中的定位:属在履行单位侧于典型的人形呆板人分层节制架构中:
年夜脑(使命层) 卖力感知与决议计划,如“抓杯子”“迈步上台阶”;小脑(运动计划层) 将使命转化为枢纽关头轨迹、结尾力方针或者全身优化指令;履行单位(伺服驱动层) 则卖力将这些方针高速、不变地转化为机电电流。HPM MCL v2 的力位混淆节制明确归属在履行单位侧。它不介入使命计划,也未定定“该施加多年夜的力”,而是吸收上层给出的指望位置、速率(以和可选的前馈力矩),于机电侧及时合成一个切合设定刚度/阻尼特征的力矩指令,并经由过程 FOC 电流环精准履行。
简言之:上层决议“想要甚么”,咱们卖力把它不变、安全、可控地做出来。
注:虽然“阻抗节制”与“导纳节制”于理论层面常被区别,但于现实体系中,只要采样率与带宽匹配,两者可经由过程数学变换等效。对于履行单位而言,终极落地需要一个高带宽、带限幅与滤波的力矩履行链路——这恰是本方案的定位。
焦点思惟:让枢纽关头“可软可硬”,且举动一致力位混淆节制的素质,是将位置偏差及速率偏差映照为力矩输出
输着力矩 = 刚度(kp) × 位置偏差 + 阻尼(kd) × 速率偏差 + 前馈力矩(tau_ff)
此中:
Kp 决议刚度:值越年夜,抵挡外力变形的能力越强;Kd 决议阻尼:值越年夜,运动越平稳,按捺振荡;tau_ff 为可选前馈力矩,用在赔偿重力或者惯性项。履行单位将输着力矩除了以机电转矩常数 Kt,获得 q 轴电流指令,交由 FOC 电流环履行。整个历程可于微秒级完成,确保阻抗举动及时相应。
这里要夸大的是:低刚度与高刚度都是正常体系状况。
低刚度合适“触碰/对于齐/人机交互”等需要适应的阶段;高刚度合适“抓稳/定位/支撑”等需要稳态连结的阶段。力位混淆节制的价值于在让这类举动“可调且一致”,并于履行层用限幅/滤波把它做患上可控、可实现。
为何 HPM 芯片能高效撑持这一功效?力位混淆节制虽逻辑简便,但对于计较及时性与节制带宽要求高。先楫高机能 RISC-V MCU 为此提供了要害硬件支撑:
主频高达 800MHz 以上,确保外环节制周期可短至 1μs;内置硬件加快 FOC 单位,减轻 CPU 承担;高精度同步 ADC 与 PWM 触发机制,保障电流环与位置环的严酷时序对于齐。患上益在此,开发者无需捐躯现有 FOC 架构,仅需挪用一个函数,便可启用可调阻抗举动。
于 HPM SDK 中怎样快速集成?咱们已经于 hpm_sdk_extra 堆栈中提供完备的力位混淆节制示例,集成历程极其简便,仅需四步:
从编码器读取当前枢纽关头位置 q 与速率 dq;挪用mcl_hybrid_ctrl_step(),传入指望位置/速率、刚度 Kp、阻尼 Kd(以和可选前馈力矩),便可得到方针力矩tau_cmd;按照机电转矩常数 Kt,计较 q 轴电流指令:iq_cmd = tau_cmd / Kt;挪用hpm_mcl_loop_set_current_q(iq_cmd),交由底层 FOC 电流环履行。整个外环逻辑不到十行代码,却能让原本“非硬即刚”的伺服体系,具有按需调治的和婉交互能力——无需改动现有驱动架构,开箱即用。
现实效果一:面临“穿墙指令”,谁更智慧?为了直不雅展示力位混淆的价值,咱们设计了一个典型场景:上层节制器给出一个“穿过物理限位”的方针位置(例如指令要求转到 1.2 rad,但机械限位于 1.0 rad)。这于抓取、装置或者足式行走中很是常见。
咱们并排对于比三种计谋:
左:传统位置节制(固定高增益)中:力位混淆 + 低刚度(合用在接触、对于齐阶段)右:力位混淆 + 高刚度(合用在抓稳、支撑阶段)
图中要害信息已经标注:
灰色粗线:物理限位(没法越过)红色虚线:上层给出的“穿墙”方针位置底部数字:顶墙后枢纽关头不变输出的力矩值(单元:N·m)可以看到:
传统位置节制连续输出靠近限幅的力矩(约 0.60 N·m),相称在“死命顶墙”,既华侈能量,又增长电流与发烧危害;力位混淆节制则按照设定刚度,主动收敛到合理的稳态力矩:低刚度模式仅输出约 0.20 N·m,柔柔贴合;高刚度模式输出约 0.50 N·m,提供强支撑。这象征着:统一个履行单位,可于差别使命阶段动态切换“手感”——接触时和婉,抓持时安定,全程不超限、不掉稳。
现实效果二:突加外力打击,谁更稳健?再看一个更切近真实世界的场景:于不变运行中,枢纽关头忽然遭到外部扰动(例如人手推一下,或者呆板人脚踩到石子),咱们模仿为 +0.5 N·m 的阶跃力矩,连续 100ms。

对于比成果以下:
模式峰值输着力矩 (N·m)最年夜位置偏转 (°)传统位置节制0.60(已经达限幅)2.66力位混淆(低刚度)0.4110.28力位混淆(高刚度)0.546.41外貌看,低刚度偏转更年夜,但这偏偏是自动适应的体现:它经由过程答应可控的微小位移,显著降低了力矩峰值及电流打击。而传统位置节制因“拒绝任何偏移”,反而被迫输出最鼎力大举矩匹敌扰动,极易触发过流掩护。
于现实运用中,你彻底可以:
接触/摸索阶段:启用低刚度,晋升安全性与顺应性;功课/支撑阶段:切换至高刚度,包管精度与刚性。这类“按需调治”的能力,恰是力位混淆节制的焦点上风。
声明:本文内容和配图由入驻作者撰写或者者入驻互助网站授权转载。文章不雅点仅代表作者本人,不代表电子发热友网态度。文章和其配图仅供工程师进修之用,若有内容侵权或者者其他背规问题,请接洽本站处置惩罚。 举报投诉 跨年早鸟福利!HPM枢纽关头伺服工程师集训营北京站要开课啦~ 跟着全世界呆板人财产进入高速成长期,枢纽关头伺服体系作为呆板人运动节制的焦点中枢,其技能成熟度直接决议呆板人的精准性、矫捷性与靠得住性。当前,具有核