蝨孨槑黽1. 项目概述
在自动驾驶系统中，轨迹跟踪控制是确保车辆安全、稳定行驶的核心技术之一。LQR（线性二次型调节器）作为一种经典的最优控制算法，通过最小化性能指标函数来求解最优控制律，在车辆控制领域有着广泛应用。本文将详细介绍基于LQR算法的车辆轨迹跟踪控制实现方案，包括动力学模型建立、控制算法设计、参数调优以及仿真验证等完整流程。
需要模型API调用？ 免费领10W Token，多模型网关一键接入 Claude、DeepSeek 等主流模型。
2. 车辆动力学模型建立
2.1 四自由度模型选择
我们采用包含质心侧偏角(β)、横摆角速度(ω_r)、横向误差(e_y)和航向误差(e_θ)的四自由度动力学模型。这种模型结构既能准确描述车辆运动特性，又保持了适中的计算复杂度，非常适合实时控制应用。
模型选择经验：在工程实践中，模型复杂度需要在精度和实时性之间取得平衡。四自由度模型相比更简单的二自由度模型能更好地反映车辆动态特性，而相比更复杂的七自由度或十四自由度模型则具有明显的计算效率优势。
2.2 关键状态变量定义
2.2.1 质心侧偏角动力学
质心侧偏角β表示车辆速度方向与车身纵轴线的夹角，其动态方程可表示为：
[
\dot{\beta} = \frac{1}{mV_x} \left[ -2C_f \left( \beta + \frac{l_f}{V_x}\omega_r \right) + 2C_r \left( \frac{l_r}{V_x}\omega_r - \beta \right) \right]
]
其中：
- m：车辆质量(kg)
- V_x：纵向速度(m/s)
- C_f、C_r：前后轮侧偏刚度(N/rad)
- l_f、l_r：质心到前后轴距离(m)
2.2.2 横摆角速度动力学
横摆角速度ω_r描述车辆绕垂直轴的旋转速率，其动态方程为：
[
\dot{\omega}_r = \frac{1}{I_z} \left[ 2l_fC_f \left( \beta + \frac{l_f}{V_x}\omega_r \right) - 2l_rC_r \left( \frac{l_r}{V_x}\omega_r - \beta \right) \right]
]
I_z表示车辆绕z轴的转动惯量(kg·m²)。