速度约束概述：道路限速、弯道安全车速、跟车距离约束、交通标志识别

各位同学，今天我们聊聊速度约束。说白了，就是告诉车——你该跑多快，以及为什么不能跑更快。

我刚开始做纵向控制那会儿，总觉得速度约束就是个查表的事。限速牌写着80，那就跑80呗。后来在测试场差点出事，才明白这玩意儿远没那么简单。嗯，咱们今天就把这块掰开揉碎了讲。

一、道路限速：最基础的硬约束

道路限速，是法规层面的约束。它写在交通法里，也写在路边的牌子上。作为控制系统，我们必须把它当作一个硬边界来处理。

我个人习惯把道路限速分为两类：

• 静态限速：固定不变的限速值，比如高速公路120km/h，城市道路60km/h。
• 动态限速：随时间或条件变化的限速，比如可变情报板、施工区临时限速。

在代码里，我通常会维护一个限速表。举个例子：

// 伪代码：限速管理模块
typedef struct {
    float speed_limit;      // 限速值 (m/s)
    uint8_t source_type;    // 0: 地图, 1: 视觉, 2: V2X
    float confidence;       // 置信度 0.0 ~ 1.0
    uint32_t timestamp_ms;  // 时间戳
} SpeedLimitSource;

// 最终限速取最小值
float final_speed_limit = MIN(all_sources.speed_limit);

这里有个坑——置信度。我曾经遇到过视觉识别把限速牌上的数字认错，80认成30，结果车在高速上突然急刹。后来我加了一条规则：如果视觉识别的置信度低于0.8，就优先用地图数据。

二、弯道安全车速：物理极限的约束

弯道限速，说白了就是物理定律在约束你。你想想看，车过弯时，轮胎的侧向力是有限的。速度太快，要么推头，要么甩尾。

弯道安全车速的计算，核心公式其实就一个：

v_max = sqrt( μ * g * R )

其中：

• μ：路面附着系数（干沥青0.8，湿路面0.4，冰雪路面0.1）
• g：重力加速度 9.8 m/s²
• R：弯道曲率半径（米）

但实际工程中，我不会直接用这个公式。为什么？因为μ是变化的，你没法实时知道路面到底有多滑。

我个人的做法是：

1. 从高精地图拿到弯道曲率R
2. 根据天气和路面传感器估算μ（保守一点，雨天直接取0.4）
3. 计算理论极限速度
4. 再乘以一个安全系数（我习惯取0.7~0.8）

三、跟车距离约束：安全与效率的平衡

跟车距离约束，是纵向控制里最常打交道的一个。它不像限速那么死板，也不像弯道那么物理，它更像是一种行为约束。

常用的跟车距离模型有两种：

我个人更推荐可变时距模型。为什么？因为固定时距在高速跟车时还行，但低速蠕行时，前车停你也停，距离太近容易被加塞。

这里有个细节——d0（静止安全距离）。我习惯设成2~3米，太近了系统容易误触发紧急制动，太远了又容易被插队。

四、交通标志识别：视觉的最后一公里

交通标志识别（TSR），是速度约束的感知入口。没有它，车就不知道限速变了。

TSR的难点不在于识别，而在于何时生效、何时失效。举个例子：

• 高速出口的限速牌，是给出口匝道用的，不是给主路用的
• 施工区的临时限速，过了施工区就应该失效
• 有些限速牌带附加标志（比如「雨天有效」）

我在项目中遇到过最头疼的问题——限速牌的误触发。车在高速主路上跑，旁边匝道有个限速40的牌子，视觉识别到了，直接限速到40。结果后车差点追尾。

解决方案是加一个车道关联逻辑：

// 伪代码：限速牌车道关联
if (sign.lane_id == ego.lane_id) {
    // 本车道的限速，立即生效
    apply_speed_limit(sign.value);
} else if (sign.lane_id == ego.lane_id + 1) {
    // 相邻车道，暂不生效，但缓存
    cache_speed_limit(sign.value, sign.position);
} else {
    // 远距离车道，忽略
    ignore();
}

嗯，这里要注意——限速牌的生效位置也很关键。有些限速牌是「前方500米开始限速」，有些是「从此处开始限速」。我建议在控制模块里加一个距离预瞄，提前减速，而不是到了限速点才急刹。

知识体系总览

说了这么多，咱们用一张图来总结一下速度约束的整个逻辑链条：

从这张图可以看出，速度约束不是单一模块的事。它从感知开始，经过计算、融合，最后才到执行。任何一个环节出问题，车要么跑太快，要么跑太慢。

好了，今天的内容就到这里。记住一句话：速度约束的本质，是在安全与效率之间找平衡。限速太保守，车跑不起来；限速太激进，又容易出事。这个度，得靠经验和数据慢慢调。