车辆运动学、航向角、偏航角、前轮转角的区别及其在MPC中的使用

参考:车辆运动学、航向角、偏航角、前轮转角的区别及其在MPC中的使用-CSDN博客

1.航向角 (φ)
车辆航向角通常指车辆质心速度与地面坐标系X轴(图中所示)的夹角,用于描述物体在全球坐标系中的方向,常用于导航和路径规划中确定车辆的绝对方向。
坐标系:地面坐标系(如图所示的XY坐标系)
方向:顺时针为正,逆时针为负(通常是从 0 度(北方)开始,顺时针增加到 360 度)
范围: [ 0 ° , 360 ° ] [0°, 360°][0°,360°]

2.偏航角 (yaw)
偏航角是车辆自身在水平面内的旋转角度,用于描述车辆相对其纵轴(自身坐标系x轴)的旋转,常用于动态稳定控制中。偏航角通常是局部的,描述车辆在水平面内的旋转运动(如转弯时的旋转)。
坐标系:车辆自身坐标系
方向:顺时针为正,逆时针为负
范围: [ − 180 ° , 180 ° ] [-180°, 180°][−180°,180°],也可以表示为 [ − π , π ] [- \pi, \pi][−π,π] 弧度。

3.前轮转角 (δ)
前轮转角描述了前轮相对于车辆纵轴的转动角度,直接影响车辆的转弯轨迹,是驾驶员控制车辆方向的关键参数。

二、3种角在MPC中的应用
1.航向角
航向角作为MPC中的状态变量之一,描述车辆相对于地理方向的行驶方向。MPC通过控制前轮转角,使航向角与目标路径方向保持一致。

2.前轮转角
前轮转角是MPC的主要控制输入,通过调节它,MPC优化车辆的行驶轨迹,确保车辆紧跟预设路径。

3.偏航角
偏航角作为MPC的状态变量,反映车辆的实际旋转角度。MPC通过预测和调整前轮转角来控制偏航角,确保车辆姿态稳定。

三、总结
1.航向角与偏航角的比较
航向角是车辆相对于地理北方的绝对方向,是一种全局定位的角度偏航角是车辆自身在水平面内的旋转角度,是一种相对于车辆自身的角度。在车辆控制领域,航向角常用于导航系统,而偏航角则在动态控制和姿态控制中使用较多。

2.前轮转角与偏航角的关系
前轮转角是一个控制输入,决定了车辆如何转向。偏航角是车辆姿态的输出,反映了车辆实际的方向变化。在车辆的转弯过程中,驾驶员通过调整前轮转角来控制车辆的偏航角,从而实现对车辆行驶方向的控制。

3.偏航角在MPC中的作用
在MPC控制中,前轮转角是直接的控制手段,通过调节它来控制车辆的姿态(偏航角)和方向(航向角)。MPC的优化目标是通过最优控制策略,使车辆在一定的预测时间内保持最佳的路径跟踪效果,确保车辆平稳、安全地行驶。偏航角作为状态变量,直接反映了车辆的动态姿态变化,这对于控制车辆的稳定性和路径跟踪至关重要。因此,偏航角在MPC中更适合作为状态变量。

### Apollo 平台中的动力学模型预测控制 (MPC) 在自动驾驶领域,Apollo平台采用的动力学模型预测控制(MPC)是一种先进的优化算法,用于实时计算最优轨迹并执行车辆控制命令。该方法通过构建精确的车辆动态模型来模拟未来一段时间内的行为,并在此基础上求解最优控制序列。 #### 动力学建模 为了实现精准的路径跟踪性能,在Apollo架构下所使用的动力学方程考虑了横向和纵向两个维度上的运动特性[^1]: - **状态变量**:包括位置(x, y),航向角(ψ),速度(v),加速度(a),以及前轮转角(δ)。 - **输入变量**:主要是油门/刹车踏板开度(u_a) 和转向度变化率(u_δ)。 这些参数共同描述了一个完整的四自由度自行车模型,能够很好地近似实际汽车行驶过程中的物理现象[^2]。 ```cpp // 定义状态空间表示法下的离散时间线性化系统矩阵A,B,C,D; Eigen::MatrixXd A(n_states_, n_states_); Eigen::MatrixXd B(n_states_, n_inputs_); ... ``` #### 预测控制器设计 基于上述建立起来的状态空间表达形式,可以进一步定义代价函数J作为评价标准之一,它通常由三部分组成: - 跟踪误差惩罚项:衡量当前时刻估计值偏离期望目标的程度; - 控制增量成本:抑制不必要的剧烈操作动作幅度波动; - 终端约束罚分:确保最终达到稳定平衡点附近停止下来而不发生振荡失稳情况。 整个寻优过程中会反复迭代调整直到找到全局最小值对应的解决方案为止[^3]。 ```matlab % 构造二次规划(QP)问题结构体qp_problem for k = 0:N-1 % N为预测时域长度 J += Q * (x_pred(:,k)-ref_traj(:,k))'*(x_pred(:,k)-ref_traj(:,k)); J += R * u_pred(:,k)'*u_pred(:,k); end ``` #### 实际应用案例分析 当面对复杂多变的城市交通环境时,比如路口转弯处存在行人突然横穿马路的情形,则需要快速响应做出适当减速避让措施;又或者是高速公路上遇到前方有障碍物需紧急制动停车等场景都可以借助于这种技术手段有效提升安全性与舒适感体验水平[^4]。
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值