4. 轨迹规划问题描述

在车辆约束轨迹规划中，最先需要厘清的一个基础问题是：我们到底在规划什么？很多初学者会把“路径”和“轨迹”混为一谈，但在工程实现中，这两者对应着完全不同的数学对象、约束体系和求解流程。本节将围绕路径与轨迹的区别、时间参数化、状态空间表示以及规划问题的数学形式化四个核心知识点展开，为后续的约束建模与可跟踪性分析奠定基础。

一、路径与轨迹：几何与时空的本质区别

路径（Path）是车辆在空间中的几何描述，通常表示为一条连续曲线，例如以弧长参数 s 为自变量的曲线 \(\mathbf{p}(s)=[x(s), y(s), \theta(s)]^\top\)。路径只回答“车经过哪些位置”，不关心“什么时候到达”。它主要受几何约束支配，如曲率上限、道路边界、障碍物距离等。

轨迹（Trajectory）则是在路径基础上叠加时间维度，表示为 \(\mathbf{q}(t)=[x(t), y(t), \theta(t), v(t), \dots]^\top\)。轨迹不仅描述空间位置，还描述速度、加速度、航向角变化率等随时间演化的动态量。它必须同时满足几何约束、运动学约束、动力学约束以及时间相关的舒适性与安全性约束。

从工程角度看，路径与轨迹的分离带来了模块化优势：路径层可以专注于几何可行性与避障，轨迹层则专注于时间参数化与动态可行性。但两者并非完全解耦——路径的曲率分布会直接影响轨迹的速度可行域，这也是可跟踪性问题的根源之一。

二、时间参数化：从几何曲线到动态轨迹的桥梁

时间参数化的核心任务是建立一个映射 \(s(t)\)，将路径上的弧长 s 与时间 t 关联起来。给定路径 \(\mathbf{p}(s)\) 和速度剖面 \(v(t)\)，轨迹可写为：

q(t) = p(s(t))
s'(t) = v(t) / ||p'(s)||
a(t) = dv/dt
κ(s) = 曲率，约束 v ≤ sqrt(a_lat_max / κ(s))

时间参数化需要处理三类约束：

• 运动学约束：速度、加速度、转向角速度的物理上限；
• 动力学约束：轮胎附着椭圆、侧向加速度极限、纵向驱动力/制动力限制；
• 舒适性与安全性约束：加加速度（jerk）上限、最小跟车时距、碰撞时间阈值。

一个常见误区是：先规划一条几何上很“漂亮”的路径，再强行做时间参数化。如果路径曲率在局部过大，速度剖面会被迫降到极低甚至不可行，导致轨迹在时间域上出现剧烈抖动或无法满足动态约束。因此，路径规划阶段就应引入曲率与速度可行域的耦合考虑。

三、状态空间表示：统一描述车辆运动

为了形式化地描述轨迹规划问题，需要将车辆运动统一到状态空间中。对于典型的自行车模型，状态量通常取：

x = [x, y, θ, v, δ]^T
控制量 u = [a, δ_rate]^T
运动学方程：
x_dot = v * cos(θ)
y_dot = v * sin(θ)
θ_dot = v * tan(δ) / L
v_dot = a
δ_dot = δ_rate

其中 L 为轴距，δ 为前轮转角。状态空间表示的好处在于：它将路径几何、车辆运动学、时间演化统一在一个微分方程组中，使得轨迹规划可以转化为带约束的最优控制问题。对于更精细的动力学模型，还可以扩展状态量，加入侧偏角、横摆角速度、轮胎滑移率等。

四、规划问题的数学形式化

综合以上要素，车辆轨迹规划问题可以形式化为一个带约束的连续时间最优控制问题：

min_{u(t), T}  J = ∫_0^T L(x(t), u(t), t) dt + Φ(x(T))
s.t.  x_dot(t) = f(x(t), u(t))          // 车辆模型
      x(0) = x_0, x(T) ∈ X_goal          // 边界条件
      g(x(t), u(t)) ≤ 0                  // 避障与动力学约束
      x(t) ∈ X_free, u(t) ∈ U            // 状态与控制可行域

其中目标函数 J 通常包含时间最优、能量消耗、舒适性惩罚和跟踪误差等项。约束 g 则涵盖道路边界、障碍物距离、速度上限、加速度上限、曲率上限等。该问题在数学上属于非凸、非线性、无限维优化问题，直接求解困难，因此工程上常采用离散化、凸松弛、采样或分层求解策略。

五、案例与误区复盘

考虑一个城市路口右转场景：路径规划器生成了一条曲率连续的圆弧-直线拼接路径，但时间参数化时为了尽快通过，在圆弧段设置了较高的纵向速度。结果车辆在转弯时侧向加速度超过轮胎附着极限，轨迹跟踪控制器无法跟随，出现明显横向偏差。复盘发现，问题不在于路径本身，而在于时间参数化阶段没有将曲率与速度的耦合约束纳入优化。

另一个常见误区是忽略状态空间中的不可测变量。例如，规划器假设前轮转角 δ 可以瞬时达到目标值，但实际转向系统存在响应延迟和速率限制。如果状态空间中没有显式建模 δ_rate，规划出的轨迹在实车上会出现转向滞后，导致跟踪误差累积。

综上所述，路径与轨迹的区别在于是否引入时间维度；时间参数化是连接几何与动态的桥梁；状态空间表示为车辆运动提供了统一的数学描述；而规划问题的数学形式化则将目标、约束和车辆模型整合为一个最优控制问题。理解这四个层次，是后续开展约束建模、可跟踪性分析与工程实现的前提。