四足机器人的越障与地形适应性原理：支撑、重心与落脚点怎么配合

← 返回四足机器人 · 基础知识

地形适应性要分三层看

四足机器人能走过碎石、斜坡与台阶，靠的不是某一个部件，而是三层能力的配合：感知层回答地面是什么样，规划层回答脚该落在哪、机身怎么走，控制层回答关节怎么动才跟得上、摔不倒。三层缺一不可——只有感知没有规划，会在信息里迷路；只有规划没有控制，落脚点再合理也落不准。

本文只讨论公开可核验的通用原理，不涉及具体产品的通过性指标，也不对任何厂商作评价。

支撑多边形与稳定裕度

支撑多边形是把当前所有着地足端在水平面上的投影依次连接形成的凸多边形。稳定裕度是机体重心投影到支撑多边形边界的最短距离。这个量直观说明了离翻倒还有多远：四腿着地时多边形是四边形，抬腿瞬间退化成三角形，稳定裕度随之缩小。规划步态时，如果抬腿顺序和机身重心轨迹没有配合好，就会出现抬哪条腿就往哪边倾的情况。

需要强调的是，重心投影落在支撑多边形内只是静态稳定的条件。动态行走中机身带着速度与加速度，惯性效应会改变实际的稳定判据，所以工程上还会引入压力中心与零矩点的概念。

重心、压力中心与零矩点

压力中心是地面反作用力的等效作用点，反映此刻地面在哪个位置托住机器人；零矩点是地面反作用力关于水平轴的力矩为零的点。当机器人在水平地面准静态行走时，压力中心与零矩点近似重合，且都落在支撑多边形内。控制器的任务就是让压力中心跟随一条期望轨迹在支撑多边形内移动，从而间接控制机身的加减速。

这个思路的价值在于把平衡这个模糊目标变成了几何约束：先由机身的期望运动反推需要的压力中心位置，再检查它是否落在支撑多边形内，不满足就调整落脚点或降低加速度需求。坡面摩擦条件会改变可用范围，因此同一条轨迹在摩擦较差的表面上更容易打滑，规划时需要预留余量。

落脚点选择：地形适应性的核心

落脚点选择可以拆成三步：

1. 先由感知数据筛出候选区域：把坡度、粗糙度、可支撑面积等指标算出分值，排除过陡、过滑或空隙过大的位置
2. 再按运动学可达性过滤：候选点必须落在腿的工作空间内，并留出姿态调整余量
3. 最后按任务需求排序：优先选择支撑面积大、接近期望步长的点，同时避免连续多步落在同一位置造成局部下陷

实际系统中，落脚点往往不是一次算定的，而是随感知更新滚动重算。传感器只能看到机身前方的有限区域，遮挡与噪声也会让地形估计出现空洞，因此常见做法是先用保守策略走一步，等足端接触数据回来再修正下一步的判断。

越障几何：抬腿高度与跨越能力

能否跨过一个障碍，取决于几何关系与动力学余量两方面。几何上，摆动腿的抬腿高度必须高于障碍高度，并且足端在跨越过程中不能与障碍前沿发生碰撞，这要求规划器知道障碍的轮廓，而不只是高度。动力学上，落地时的冲击、抬腿期间支撑腿数量的变化，都会影响瞬时稳定性。

常见做法是把障碍分成可通过与不可通过两类分别处理：小高度障碍直接抬高摆动腿跨过，中等障碍通过调整步长与落脚点绕开，超过几何或动力学余量的障碍则交给上层规划改走路径。判断阈值不应写死，而应结合当前步态、机身姿态与执行器可用余量动态评估。

地形估计与状态估计

地形估计回答脚下这个世界长什么样，状态估计回答我自己在哪、姿态如何。前者依赖深度相机、激光雷达或立体视觉构建的局部高度图与地面法向量，再用足端接触历史做补充，因为踩过的位置提供了最直接的高度证据。后者依赖惯性测量单元与关节运动学做融合，抑制漂移，必要时借助视觉里程计或雷达匹配。

两者会互相影响：姿态估计偏差会让地形点云整体倾斜，地形高度误差又会让落足判定出错，进而污染腿部里程计。工程上常见的做法是先做时间同步与坐标系统一，再在融合时给可靠度不同的来源分配不同权重，而不是把所有数据等权平均。

预测控制与全身协调的作用

动态越障需要提前预判：当前这一步的落脚选择会影响下一步的稳定余量。模型预测控制的做法是在一个有限的时间窗口内，用简化动力学模型预测若干步之后的状态，把稳定性、足端摩擦约束、关节力矩上限等写成约束条件，求解一段较优的机身轨迹与地面反作用力分配。

全身协调控制则把机身、四条腿与可能的附加机构放在同一次求解里，统一分配任务优先级：平衡优先于速度，安全落足优先于跟踪精度。这类方法能提升复杂地形上的表现，代价是计算量与建模复杂度上升，因此实际系统常把它放在中频控制环，高频关节环仍用简单的力矩或位置控制兜底。

典型失效模式与排查方向

复杂地形上的问题通常能归到几类可复现的模式：

• 打滑：摩擦估计过于乐观，落脚点位于低摩擦表面，表现为机身位移与腿部里程计不符
• 踩空：地形估计存在空洞或滞后，足端未接触到预期高度，触发突然下落
• 绊倒：抬腿高度或足端轨迹与障碍轮廓不匹配，摆动相末端发生碰撞
• 陷入：松软地面承载力不足，足端持续下沉，需要降低单腿负载或改用更大支撑面积
• 侧翻：稳定裕度不足叠加侧向扰动，常见于侧坡行走与快速转向
• 振荡：感知更新频率与控制周期不匹配，或落脚点反复重算导致指令抖动

核对清单

调试越障能力时，建议按以下顺序核对六项：

1. 坐标系与时间戳是否统一，感知数据与本体状态是否在同一时刻对齐
2. 地形高度图的分辨率与更新频率是否与步频匹配
3. 落脚点候选区域是否排除了过陡与低摩擦位置，并保留工作空间余量
4. 稳定裕度是否在支撑状态切换的瞬间做过检查，而不只检查静态姿态
5. 足端接触判定是否可靠，接触信号丢失时是否有降级策略
6. 失效模式是否可复现，是否能在日志中区分感知误差与控制误差

小结

地形适应性的本质，是把看不全的地面与算不完的动力学用一套分层结构管理起来：感知给出带不确定性的地形，规划在几何与动力学约束下选择落脚点与机身轨迹，控制用高频反馈吸收剩余误差。先明确每一层的输入输出与失效边界，再谈具体算法，调试会顺利得多。