跳到正文
EMBODIED INTELLIGENCE · 身体与运动控制

到得了,不代表推得动,也不代表停得稳

运动学给出几何关系,动力学回答力怎样产生运动,控制则利用反馈纠正误差。抓杯子、压海绵和四足落地都涉及接触:同一条位置轨迹,换一个质量、摩擦或控制延迟,可能变成完全不同的结果。

夹爪轻压海绵与四足机器人支撑身体的场景,直观表达柔顺接触、作用力与平衡。
直觉总览:夹爪轻压海绵与四足机器人支撑身体的场景,直观表达柔顺接触、作用力与平衡。 生成插画不承载精确结构、尺寸或安全保证,正文机制图为准。 查看原图 ↗
01 · 几何之外的一层

同样的姿态,不同的加速需要不同的力

推空购物车与推满载购物车,路线可以一样,启动和刹停的感觉却不同。质量与惯性影响加速度,摩擦阻碍运动,重力随姿态改变负载。这一类关系就是动力学。类比不包含关节之间的耦合,而机械臂的一个关节运动往往会改变其他关节承受的作用。

M(q)q¨+C(q,q˙)q˙+g(q)+τf=S⊤τ+Jc⊤fcM(q)\ddot q+C(q,\dot q)\dot q+g(q)+\tau_f=S^\top\tau+J_c^\top f_c
常见刚体模型记法:M 为质量矩阵,Cq̇ 为科氏/离心项,g 为重力项,τ_f 为摩擦项;τ 为受驱动关节输入,S 选择驱动自由度,f_c 是环境对机器人的接触力。J_c 是接触点速度雅可比,其转置 J_cᵀ 将接触力映射为广义力。不同文献的力方向与符号约定可能不同。

固定基座、所有关节均驱动、没有接触的机械臂可令 S 为单位矩阵并去掉接触项。足式机器人的基座可以在空间运动,却没有一个直接推动“基座坐标”的电机;身体加速要通过足地接触力实现,这就是浮动基座系统与固定机械臂的重要差别。

逆动力学给定期望运动求所需输入,正动力学给定输入求加速度。它们依赖模型参数:抓起一个物体后,负载质量和质心变了,原来的前馈力矩可能不再够用。只在空载条件下验证,不足以证明带载轨迹稳定。

02 · 从“猜一次”变成持续纠正

反馈看误差,前馈利用模型

  1. 参考运动

    给出随时间变化的位置、速度或期望接触力。目标应满足设备与任务约束。

  2. 比较实际状态

    从编码器、速度估计和力传感器获取反馈,计算跟踪误差。

  3. 控制输出

    反馈项纠偏,前馈项补偿已知动力学;检查饱和、变化率和故障。

  4. 物理响应

    驱动与接触产生运动,延迟、摩擦和未建模负载会让响应偏离预测。

这是功能框图,不是稳定性证明。相同控制公式换了采样周期、负载或接触条件,需要重新分析和验证。
τcmd=Kp(qd−q)+Kd(q˙d−q˙)+g^(q)\tau_{\rm cmd}=K_p(q_d-q)+K_d(\dot q_d-\dot q)+\hat g(q)
简化的比例—微分(Proportional–Derivative,PD)控制加重力补偿:K_p 对位置误差响应,K_d 对速度误差响应,ĝ 为重力模型估计。它不是完整计算力矩控制,也不能自动处理任意耦合或接触。

此式表示教学模型中的总驱动力矩。真实设备若已经内置重力补偿,不应再次添加同一补偿;例如 libfranka 的外部控制接口有自己的补偿约定,必须先读清接口文档,而不是把公式右侧直接写进命令数组。设备接口边界。

比例项像弹簧,误差越大越想拉回;微分项像阻尼,抑制快速变化。增大刚度可以减小某些误差,却可能放大冲击、噪声和延迟影响。输出达到电机限制后,控制器要求的力已经无法实现,因此“调大增益”并不是普适解决办法。

手算 · 非设备参数

刚度改变了误差与作用力的关系

一维教学设定下,位置误差 0.01 m、等效刚度 1000 N/m,对应弹性项 10 N。刚度提高为 5000 N/m,同样误差产生 50 N。真实末端还受惯性、阻尼、结构和力矩限制影响;这些数值只解释比例关系,不能作为真机安全阈值。

03 · 碰到世界后,目标需要重新分工

位置、力与柔顺性不是一个旋钮

在自由空间中跟踪位置很自然;一旦夹爪碰到刚性桌面,继续命令它向下移动,位置误差可能变成很大的接触力。纯位置控制不知道你是希望保持轻压,还是要压坏物体。力控制以接触作用为目标;阻抗控制规定偏移与作用之间的动态关系,让接触表现得像有弹性和阻尼。

阻抗控制(Impedance Control)不是“力越小越好”,而是设定合适的力—运动关系;导纳控制(Admittance Control)则可根据测得的外力生成运动参考。具体使用哪种,取决于底层接口、传感器与结构。不能仅凭上层代码叫“柔顺”就断言实际接触安全。

fn≥0,∥ft∥≤μfnf_n\geq 0,\qquad \lVert f_t\rVert\leq \mu f_n
简化库仑静摩擦接触约束:法向力 f_n 不为负,切向力大小不超过摩擦系数 μ 乘法向力。适用于接触未滑动的简化模型;真实材料、接触面积与动态摩擦还需测量。

拿起光滑物体时,夹得太松会滑,夹得太紧会损坏物体。扩大法向力也不能无限提高可靠性,因为驱动、材料和对象承受能力有限。抓取姿态、接触点与指面材料常和控制策略同样重要。

可执行性与安全

接触控制需要区分预期接触与意外碰撞。限力、限速、工作空间监测、机械防护和急停分别承担不同职责。教学控制律与碰撞阈值都不是安全认证,不应未经设备流程验证直接运行在有人接近的真机上。

04 · 身体靠地面才能加速

四足控制不是给四条腿分别播放动画

站立时,支撑脚通过地面反力支撑身体;摆动脚应按计划离地与落足。接触切换会改变能施加的力:腾空的脚不能继续提供地面推力。若规划器把本来没有接触的脚当成支撑点,算出来的身体加速度再合理也无法实现。

Di Carlo 等人在 2018 年 MIT Cheetah 3 论文中研究通过凸模型预测控制(Model Predictive Control,MPC)规划地面反力。其思想是用预测模型在有限时间范围内计算控制,再根据新状态滚动更新。这里“预测”的是运动动力学,不必是生成图像的大型世界模型。原始论文记录。

只作静态教学估算:若机器人总质量为 20 kg,取 g=9.81 m/s²,静止且由四脚均匀承重,总向上支撑约 196.2 N,每脚约 49.05 N。真实四足机器人运动时重量不一定均匀分配,还要考虑角动量、加速度、地形与摩擦;这个算例不是 Cheetah 3 的硬件参数或实验结果。

观察四足演示时,应追问它如何估计接触、处理打滑、限制力矩,以及失去一项传感器后怎样降级。成功越过一次台阶,不能替代不同摩擦、载荷与扰动条件下的重复实验。

KNOWLEDGE CONNECTIONS

把这一层放回完整机器人

返回具身智能知识地图,或沿本专栏继续展开:

RESEARCH LEDGER

一手来源与证据边界

优先使用论文、官方文档、官方模型卡和代码仓库。页面中的数字只代表来源所述设置,不自动外推到其他模型与数据。