机器人足端轨迹与步态规划实战：从宇树IPO定价150.8元看足式机器人建模

8 月 6 日，宇树科技 IPO 定价 150.8 元，DeepSeek、腾讯等获战略配售，这只"大肉签"让四足与人形机器人再次站上风口。四足机器人能跑、能跳、能上下楼梯，背后藏着一套被国赛评委偏爱的建模体系——足端轨迹规划。本文不写一行代码，用"规划五步法 + 三自由度算例 + 落足点优化"把足式机器人的步态规划讲清楚，顺便回答一个国赛高频问题：当题目给你一条机器人小腿、一组关节角度，你怎么建模让它走得稳、走得快。

一、为什么足式机器人是 2026 建模的最热题材

8 月 6 日宇树科技 IPO 定价 150.8 元，发行市值超过 500 亿元，DeepSeek、腾讯、红杉等均出现在战略配售名单中。就在同一周，多家厂商相继发布四足与人形机器人新品，从巡检到物流、从陪伴到救灾，足式机器人正在从实验室走向产业。对数学建模来说，足式机器人几乎是一套"自带题库"的题材：运动学要算，步态要规划，稳定要判断，能耗要优化，传感器数据要融合——一题更比一题丰富。

国赛历年真题里，机器人相关题目几乎每两三年出现一次：2015 年的"太阳影长定位"、2019 年的"智能车停车问题"、2023 年的"移动机器人定位"都与机器人建模沾边。而足式机器人的步态规划，是其中"建模层次最清晰"的一类：你可以把它拆成一条腿、两条腿、四条腿，逐级建模。

二、足端轨迹规划五步法

第一步，建立坐标系。以机器人髋关节（大腿根部）为原点，竖直向上为 Y 轴、前进方向为 X 轴建立平面坐标系。足端（脚掌中心）在这个坐标系里的位置，就是我们要规划的对象。第二步，写运动学方程。把一条腿看作"髋-膝"或"髋-膝-踝"两到三个连杆，每个关节角为待求量，足端位置由关节角唯一决定——这是正向运动学。反过来，已知足端位置求关节角，叫逆运动学，步态规划里我们几乎只用逆运动学。第三步，设计足端轨迹。摆动相（脚离开地面向前迈）的足端轨迹常用"抬脚-向前-落地"三段式：抬脚阶段足端向上抬到安全高度，向前阶段水平移动，落地阶段下降回支撑面。第四步，加约束。抬脚高度要大于障碍物高度，落地速度要尽量为零（避免冲击），足端速度在起脚和落脚两点处要连续。第五步，离散采样。把轨迹按时间等间隔采样成若干个点，每个点反解一组关节角，就得到了"关节角随时间变化"的驱动曲线。

三、一个三自由度算例：让足端画一条"拱形线"

用一个最简单的算例说明：假设机器人一条腿只有髋关节和膝关节两个转动关节，大腿长 0.4 米、小腿长 0.35 米，髋关节在原点。我们要让足端从 (0.45, -0.3) 出发，向前迈到 (0.65, -0.3)，中间抬脚最高点到 (0.55, -0.18)，全程用时 0.8 秒。

第一步，把这条路径写成一个显式轨迹。水平方向用匀速：X 从 0.45 到 0.65，0.8 秒内走 0.2 米，平均速度 0.25 米每秒。竖直方向用"抛物线抬脚"：Y 从 -0.3 抬到 -0.18 再落回 -0.3。第二步，在每个采样时刻，由足端坐标反解髋关节角和膝关节角。这是一个标准的平面两连杆逆运动学问题：先由足端到髋关节的距离、大腿长、小腿长用余弦定理解出膝关节角，再解出髋关节角。第三步，把 0.8 秒按 0.05 秒间隔采样成 17 个点，逐个反解，得到两组关节角时间序列。第四步，检查关节角速度与加速度是否连续、是否超出关节限位（比如膝关节角不超过 150 度）。

这张表说明，只要给定足端轨迹，关节角序列就能唯一确定。国赛里"给你足端轨迹求关节角"和"给你关节角求足端轨迹"是正反两问，本质都是运动学建模。

四、稳定判据：走快可以，别摔跤

步态规划的第二大问题是"稳定"。双足机器人的稳定用"零力矩点"（ZMP）判据：只要零力矩点落在支撑多边形内部，机器人就不会翻倒。四足机器人常用"静态稳定裕度"：质心在支撑面内的投影到支撑多边形边界的最近距离，距离越大越稳。步态规划里，摆动相抬腿会缩小支撑多边形，此时质心要主动向支撑侧偏移，否则稳定裕度变小甚至为负。

国赛写步态规划的论文，只要把"为什么选这个判据"和"稳定裕度随步幅怎么变"两张图表做出来，就基本稳住了。

五、落足点优化：让步子迈得又稳又省

第三步是优化。给定地形（比如有障碍物、有斜坡），机器人每一步"落在哪里"是一个优化问题。目标函数通常是"稳定裕度最大 + 能耗最小 + 步幅最大"的加权组合；约束包括足端不能踩到障碍物、关节角在限位内、步幅不超过腿长范围。这类问题用枚举或启发式算法都能解：先把落足点离散成网格，再在每个候选点上计算稳定裕度与能耗，最后选出加权得分最高的点。

六、从"单腿"到"整机"：步态与节律

有了单腿的轨迹，多腿协调还需要"节律"。四足机器人最常见的节律是"对角小跑"：左前腿和右后腿同步摆动、右前腿和左后腿同步摆动，占空比约 0.5。步态规划里用"相位"描述每条腿的摆动时序：同相位的腿一起抬、一起落，相位差 180 度的腿交替抬落。建模时把四条腿的相位做成参数，通过仿真比较不同相位组合下的速度与稳定裕度，就能找到最优步态。

七、把步态规划写进国赛论文的三个加分点

加分点一：画可达空间。把足端能到达的所有位置画成一个区域（工作空间），一眼看出步幅极限在哪。加分点二：做对比实验。"直线行走 vs 上坡 vs 跨障碍"三种地形各跑一组，对比稳定裕度与能耗，比只算一种情况有说服力得多。加分点三：与真实参数挂钩。宇树机器人的公开参数（如最大奔跑速度、单腿关节数量）可以直接作为算例参数，让论文"踩在真数据上"。

八、写在最后

从 8 月 6 日宇树 IPO 定价 150.8 元这件事出发，我们走完了一条完整的足式机器人建模路径：建坐标系、写运动学、设计足端轨迹、判断稳定性、优化落足点、协调步态节律。这套方法不需要一行代码，只需要一张纸一支笔加一张表格。国赛遇到机器人题材，记住五步法，先从单腿算起，再逐级拼成整机——足端画出的每一条拱形线，都是你的模型在走路。