4、车道线模型：直线模型、B样条曲线、三次多项式模型及Clothoid模型的应用场景与优缺点

车道线模型，说白了就是给车道线拍一张数学照片。你拍得越准，控制就越稳。我在ADAS标定这行干了快十年，见过太多因为模型选错导致车辆画龙的案例。今天咱们就把这四种主流模型掰开揉碎聊清楚。

4.1 直线模型

这是最简单的模型。它假设车道线是一条直线，用两个参数就能描述：横向偏移和航向角。

// 直线模型表达式
y = C0 + C1 * x

// 其中：
// C0 - 横向偏移（m）
// C1 - 航向角（rad）
// x  - 纵向距离（m）

应用场景：

• 高速公路直线段
• 车道保持的初始状态估计
• 传感器故障时的降级模式

优点：

• 计算量极小，嵌入式平台跑起来毫无压力
• 参数物理意义明确，标定起来很直观
• 鲁棒性好，噪声干扰下也不容易发散

缺点：

• 弯道完全失效，误差会迅速累积
• 无法描述曲率变化

4.2 B样条曲线

B样条曲线是工程师的瑞士军刀。它用多个控制点来拟合车道线，灵活性极高。

// B样条曲线（三次均匀B样条）
// 控制点：P0, P1, P2, P3
// 参数 t ∈ [0, 1]

P(t) = (1-t)³/6 * P0 + (3t³ - 6t² + 4)/6 * P1 
     + (-3t³ + 3t² + 3t + 1)/6 * P2 + t³/6 * P3

应用场景：

• 复杂弯道，尤其是S弯和连续弯
• 车道线不连续或存在遮挡的情况
• 高精度地图的路径生成

优点：

• 局部控制能力强，修改一个控制点只影响局部
• 可以拟合任意形状的车道线
• 平滑性好，C2连续

缺点：

• 计算量大，对实时性要求高的场景要小心
• 控制点数量需要经验确定，多了容易过拟合
• 参数物理意义不直观，标定起来比较头疼

4.3 三次多项式模型

这是业界最常用的模型。它用四个参数描述车道线，兼顾了精度和计算效率。

// 三次多项式模型
y = C0 + C1 * x + C2 * x² + C3 * x³

// 其中：
// C0 - 横向偏移
// C1 - 航向角
// C2 - 曲率/2
// C3 - 曲率变化率/6

应用场景：

• 高速公路和城市快速路
• L2/L2+级别的车道保持
• 大部分量产项目的首选

优点：

• 计算效率高，适合实时控制
• 参数物理意义清晰，标定方便
• 能描述大部分弯道场景

缺点：

• 长距离预测误差会放大
• 对急弯和S弯拟合能力有限
• 参数之间耦合性强，调参要小心

4.4 Clothoid模型（回旋曲线）

Clothoid模型是数学上的优雅之作。它的曲率随弧长线性变化，完美模拟了真实道路的设计逻辑。

// Clothoid模型
// 曲率：κ(s) = κ0 + κ1 * s

// 其中：
// κ0 - 初始曲率
// κ1 - 曲率变化率
// s  - 弧长

// 位置计算（近似）：
x(s) ≈ s - κ0² * s³/6 - κ0*κ1 * s⁴/8
y(s) ≈ κ0 * s²/2 + κ1 * s³/6

应用场景：

• 高速公路匝道和出口
• 曲率连续变化的弯道
• 高精度路径规划

优点：

• 最接近真实道路设计
• 曲率连续变化，控制平滑
• 适合长距离预测

缺点：

• 计算复杂，实时性要求高时要注意
• 参数估计困难，容易发散
• 对传感器噪声敏感

4.5 模型对比与选择建议

模型	计算量	精度	鲁棒性	标定难度	推荐场景
直线模型	极低	低	高	低	初始化、降级模式
B样条曲线	高	高	中	高	复杂弯道、高精地图
三次多项式	低	中高	高	中	量产首选、高速场景
Clothoid	中高	高	低	高	匝道、曲率连续变化

嗯，这里要注意：没有完美的模型，只有合适的场景。我建议你根据项目需求做模型融合。比如我最近的项目就是三次多项式为主，Clothoid做补充，直线模型做兜底。三层保险，稳得很。

你想想看，如果只用一个模型，遇到极端场景怎么办？所以我的原则是：主模型要稳，备模型要准，降级模型要可靠。这个思路帮我避过了不少坑。