在四足机器人与机械臂协同作业的研究与工程应用中当机械臂质量较大、动力学特性不可忽略时传统控制框架往往因为模型过度简化导致整机在行走、操作、负载、抗扰等场景下出现步态抖动、重心偏移、跟踪精度下降甚至失稳倾倒。本文基于arXiv:2507.22042最新学术论文成果。该框架最大的贡献在于在不忽略机械臂动力学的前提下通过模型分解与双层实时控制架构实现四足本体与 Kinova 机械臂的稳定、高效、鲁棒协同。在具身智能、自主移动操作快速发展的今天四足机器人凭借地形适应能力强、运动灵活、越障能力突出等优势逐渐成为户外巡检、应急救援、工业现场、家庭服务等场景的重要载体。而为了让四足机器人真正具备 “作业能力”而不只是 “行走工具”搭载机械臂完成抓取、搬运、推拉、开关门、操作工具等任务已经成为行业共识与技术趋势。但在实际研发与实验过程中研究者与工程师会普遍遇到一个非常现实的问题当机械臂质量较大、动力学特性不可忽略时四足本体的稳定性会受到巨大影响传统控制方法几乎无法胜任。第一传统控制框架过度简化机械臂动力学重型 Kinova 臂对小型四足的扰动极强极易引发步态失稳。论文所使用的硬件平台非常具有代表性四足本体为 Unitree Go2自重约 15kg机械臂为 Kinova Gen2 4 自由度力矩臂自重 4.4kg。简单计算就可以发现机械臂质量已经达到四足本体质量的29%。同时Kinova 臂展开后高度较高质心偏移明显臂展高度接近本体高度的 216%。这意味着只要机械臂开始运动、承载负载、对外施力就会对四足本体产生明显的倾覆力矩、惯性冲击与重心偏移。在崎岖地面、外力推动、重载推拉等场景下传统控制器根本无法快速响应这种强耦合扰动最终表现为步态晃荡、机身倾斜、跟踪精度变差甚至直接摔倒。而如果为了实时性不断简化模型又会丢失关键动态信息导致鲁棒性不足、抗扰能力差、作业精度低。这种 “精度 — 实时性” 两难问题长期限制了小型四足搭载重型 Kinova 臂的实际应用。二、分解式 NMPC 双层控制架构我们从模型分解、控制架构、关键模块三个层面进行完整、原创、忠于原文的解读。1. 模型分解策略1四足运动子系统单刚体模型SRB对于四足本体的移动与步态论文采用工程中常用的单刚体模型。这个模型只关注机器人的质心位置、线速度、姿态、角速度以及地面反作用力维度低、计算快能够高效完成步态优化、重心调整、姿态稳定等关键任务保证四足在各种地形下都能稳定行走。2机械臂子系统完整保留 Kinova 臂全阶动力学与传统方法不同这篇论文没有简化 Kinova 机械臂而是直接使用基于欧拉 — 拉格朗日方程得到的全阶动力学模型。模型包含质量矩阵、科氏力 / 离心力项、重力项、关节力矩输入、交互力映射等全部关键动态特性。3交互约束实时计算本体与机械臂的力 / 力矩耦合两个子系统并不是独立运行而是通过完整约束强制保证机械臂基座与四足机身刚性固连。在优化过程中算法会实时求解两者之间的交互 wrench力与力矩并把它作为状态变量纳入优化目标。2. 双层实时控制架构60Hz 规划 500Hz 执行1高层非线性模型预测控制NMPC运行频率 60Hz高层 NMPC 是整个系统的 “大脑”。它在每个控制周期内统一完成以下任务优化四足本体的质心轨迹、姿态轨迹、地面反作用力优化 Kinova 机械臂的关节位置、速度、力矩指令优化四足与机械臂之间的交互力 / 力矩满足摩擦锥约束、力矩限幅、关节限位等安全约束NMPC 以滚动时域方式运行每次只求解未来一小段轨迹保证实时性。论文使用 CasADi IPOPT 求解在常规 Intel 桌面 CPU 上即可稳定运行。2低层全身控制器WBC运行频率 500Hz低层 WBC 负责把高层 NMPC 给出的指令 “精准落地”。它基于二次规划QP实时计算四足每条腿的关节力矩保证机身严格跟踪质心与姿态目标同时抑制振动、扰动、模型误差。3Kinova 机械臂力矩直驱无中间 PD 转换与很多方案不同这篇论文中Kinova 机械臂不经过额外的位置环 / 速度环而是直接使用 NMPC 输出的关节力矩指令。这种方式延迟更低、动态响应更快、力控精度更高尤其适合推拉重物、开关门、操作设备等需要力控的作业场景。3. 优化目标设计稳定、平滑、精准三者兼顾论文的 NMPC 代价函数由三部分组成四足子系统代价跟踪质心、姿态、足端轨迹机械臂子系统代价跟踪关节位置、限制力矩大小交互代价抑制本体与臂之间的过大冲击通过合理调节权重系统可以在 “稳定、平滑、精准” 之间达到最优平衡既不会因为过于追求操作速度而失稳也不会因为过于保守而动作迟钝。三、实验验证与结果1. 硬件平台四足机器人Unitree Go2自重 15kg18 自由度机械臂Kinova Gen2 4-DoF 力矩机械臂自重 4.4kg带三指夹爪控制系统离线 PCIntel Core i9以太网通信求解环境CasADi IPOPTNMPC 60HzWBC 500Hz选择 Kinova 臂并非偶然而是因为它力矩控制能力强、质量典型、动力学特性明显最能验证 “不可忽略机械臂动力学” 这一核心前提。2. 典型实验任务论文设计了五大类实验覆盖移动操作最核心、最工程化的场景1崎岖地形移动操作机器人在铺设 5cm 木块的崎岖地面、草地、碎石路面上连续行走同时 Kinova 臂携带 1kg 负载。实验结果显示系统步态稳定、无明显晃动、无打滑倾倒、质心跟踪误差小证明在无感知非结构地形中依然具备强鲁棒性。2外力扰动抗扰实验机器人在原地小跑状态下接受人为横向推力冲击。在明显外力扰动下四足本体快速调整姿态与重心迅速恢复稳定同时 Kinova 臂保持持物状态不晃动展示出优秀的扰动抑制能力。3重载未知负载推拉操作这是最能体现机械臂动力学价值的实验之一。机器人推动总重达 24.4kg 的推车其中有效负载已经达到四足本体质量的 125%。在负载未知、质量不确定、地面摩擦不确定的条件下系统依然稳定完成推拉、前进、转向等动作。这证明只有把 Kinova 臂的动力学完整纳入控制才能真正实现重载可靠作业。4家庭 / 室内精细操作机器人完成一系列贴近真实使用场景的任务打开冰箱门 → 抓取瓶子 → 放置台面 → 关闭冰箱门旋转门把手 → 推开房门 → 通过门洞拉开抽屉 → 抓取物件 → 关闭抽屉 → 放置桌面所有动作连贯、稳定、无抖动行走与操作无缝衔接完全达到 “可实用” 级首次在小型四足平台上实现重型 Kinova 力矩臂的全动力学移动操作填补技术空白。在这篇论文之前小型四足机器人几乎只能搭载轻量化、弱动力学、位置控制型机械臂。一旦使用 Kinova 这类质量占比高、力矩特性强的机械臂系统稳定性会急剧下降。该论文首次证明在不忽略、不简化机械臂动力学的前提下依然可以构建计算高效、实时运行、鲁棒性强的控制框架让 Kinova 重型力矩臂真正安全、稳定、可靠地工作在小型四足平台上。这直接拓宽了复合机器人的硬件组合边界让 “小四足 大臂” 从不可能变为可能。