一、边界约束基础：道路边界定义、坐标系与参考线、边界约束的数学表达

各位同学好，我是老张。今天咱们来聊聊轨迹规划里最基础、也最绕不开的一个话题——道路边界约束。

说实话，我刚入行那会儿，觉得边界约束不就是“别撞墙”嘛，有啥好讲的？结果第一次实车测试，我的车在匝道上差点蹭到护栏。嗯，从那以后，我再也不敢小看这个“基础”问题了。

道路边界，说白了就是车辆能跑的安全区域。但实际工程中，它远不止“路沿石”这么简单。

我个人习惯把道路边界分成三类：

关键点：边界不是一条线，而是一个“允许区域”。我们做轨迹规划，本质上是在这个区域内找一条最优路径。

我在项目中遇到过最头疼的情况——高精地图给的边界和实际路况对不上。比如雪天路沿被覆盖，或者施工临时改了车道。这时候你如果死磕地图数据，车就傻了。

做轨迹规划，坐标系是基本功。但我见过太多人栽在这上面。

常用的坐标系有三个：

我个人最常用的是Frenet坐标系。为什么？因为它把“沿着路走”和“偏离路多远”分开了，处理边界约束特别方便。

你想想看，在笛卡尔坐标系下，一条弯道的边界约束是个复杂的曲线方程。但在Frenet坐标系下，边界就是两条平行线——l_min 和 l_max。多清爽。

小技巧：参考线的质量直接决定轨迹质量。我建议参考线至少每0.5米一个采样点，曲率变化大的地方加密到0.1米。否则Frenet转换会失真。

好了，到了硬核部分。边界约束怎么用数学写出来？

在Frenet坐标系下，边界约束可以写成：

l_min(s) ≤ l(s) ≤ l_max(s)

其中 s 是沿参考线的弧长，l 是横向偏移。就这么简单？嗯，实际工程里要复杂得多。

我曾经在高速场景遇到过一个问题：车道宽度3.5米，车宽1.8米，按理说左右各有0.85米余量。但车以120km/h过弯时，横向加速度会压缩有效边界。所以实际约束要写成：

l_min(s) + d_safety(v, a_y) ≤ l(s) ≤ l_max(s) - d_safety(v, a_y)

这个 d_safety 就是安全裕量，跟车速和横向加速度有关。速度越快，弯道越急，裕量越大。

注意：边界约束不是静态的。动态障碍物、汇入车辆、行人都会临时改变边界。我建议把边界约束设计成“可伸缩”的，而不是写死。

另外，边界约束还要考虑车辆几何。你想想看，车头比车身中心宽出去一截。如果只用质心位置做约束，车头可能已经蹭到护栏了。所以实际代码里，我会把车辆轮廓的四个角点都做边界检查：

for each corner in [front_left, front_right, rear_left, rear_right]:
    l_corner = l + corner_offset
    assert l_min ≤ l_corner ≤ l_max

这个细节，我当年在第一个量产项目里就漏掉了。结果仿真跑得好好的，实车一测，后视镜差点刮到收费站的柱子。从那以后，我再也不敢偷懒了。

下面这张图是我自己整理的边界约束知识框架，你可以对照着复习：

这张图把边界约束拆成了三个维度：定义、坐标、数学。每个维度下面又有工程落地的具体方法。我建议你把它打印出来贴在工位上，写代码的时候对照着看。

我的个人习惯：每次拿到一个新场景，先花10分钟把边界约束画出来。用纸笔也好，用画图工具也好，把“车能去哪、不能去哪”搞清楚再写代码。这个习惯帮我省了至少一半的调试时间。

好了，边界约束的基础就讲到这里。内容不多，但都是实打实的工程经验。下一章咱们聊怎么把这些约束转化成优化问题，到时候会用到二次规划，你提前复习一下。

可可精品资料库