[发明专利]一种考虑人车冲突的协同转向控制方法

权利要求书

1.一种考虑人车冲突的协同转向控制方法，基于一种驾驶员和协同转向控制器同时在环的驾驶模式，该种模式下当驾驶员控制目标与协同转向控制器控制目标不一致产生控制冲突时，通过构建博弈关系使得驾驶员与协同转向控制器实现博弈平衡来削减控制冲突程度，其特征在于，本方法具体步骤如下：

步骤一、建立共驾车辆系统模型：

建立大地坐标系：原点O固结于地面，X轴正方向为车辆初始运动方向，Y轴的正方向为X轴逆时针旋转90度方向；

建立车辆坐标系：以车辆质心o为坐标原点，x轴的正方向为车辆前进的方向，y轴的正方向为x轴逆时针旋转90度方向；

用车辆运动学模型表征车辆的操纵稳定性与车辆的侧向运动的关系，并用二自由度车辆动力学模型表征车辆的操纵稳定性和车辆的横摆运动之间的关系，具体过程如下：

假定车辆是一个质量块，以车辆前轮作为转向轮，根据车辆运动学方程以及车辆运动的几何关系得到车辆的运动学模型如式(1)所示：

式中xo为车辆质心o的纵向位移，单位m；yo为车辆质心o的侧向位移，单位m；v为车辆质心的速度，单位m/s；r为车辆的横摆角速度，单位rad/s；ψ为车辆的航向角，单位rad；β为车辆的质心侧偏角，单位rad；

考虑到实际道路的曲率通常很小，车辆在实际行驶时航向角ψ同样可以认为是很小的，且实际车辆的质心侧偏角β变化范围也很小，所以有：sin(ψ+β)≈ψ+β，cos(ψ+β)≈1，当车辆匀速行驶时可以忽略纵向车速的影响，同时结合式(1)可以得到简化的车辆运动学模型，如式(2)所示：

本方法通过控制车辆的前轮转角来实现路径跟踪的目的，并且认为车辆保持匀速状态行驶，所以只需要考虑车辆的侧向运动，根据牛顿第二定律与力矩平衡关系，可得到如式(3)所示的二自由度车辆动力学模型：

式中v_x为车辆质心处的纵向速度，单位m/s；F_yf为车辆前轮侧向力，单位N；F_yr为车辆后轮侧向力，单位N；m为车辆的质量，单位kg；I_z为车辆绕z轴的转动惯量，单位kg·m²；a为车辆质心o到车辆前轴的距离，单位m；b为车辆质心o到车辆后轴的距离，单位m；δ_f为车辆前轮转角，单位rad；

车辆实际的前轮转角δ_f通常在小范围内变化，可以近似认为：cosδ_f≈1，sinδ_f≈0，因此对式(3)进行简化，简化后的二自由度车辆动力学模型如式(4)所示：

车辆侧向轮胎力未达到饱和时，车辆侧向轮胎力F_y与轮胎侧偏角α可近似看作呈线性关系如式(5)所示：

式中C_f为车辆前轮的轮胎侧偏刚度，单位N·rad；C_r为车辆后轮的轮胎侧偏刚度，单位N·rad；α_f为车辆前轮的轮胎侧偏角，单位rad；α_r为车辆后轮的轮胎侧偏角，单位rad；

在车辆坐标系下，前轮的轮胎侧偏角α_f和后轮的轮胎侧偏角α_r有如式(6)的关系：

结合式(4)、式(5)和式(6)，整理可得式(7)：

驾驶员和协同转向控制器之间的驾驶权重α可以根据驾驶员的意愿进行提前设定,设定范围为0≤α≤1,驾驶员和协同转向控制器共同驾驶车辆时车辆前轮转角δ_f由两部分组成，驾驶员当前时刻决策出的前轮转角δ_h，协同转向控制器当前时刻决策出的前轮转角δ_a，后再按照式(8)给出的比例关系进行叠加执行到车辆的前轮：

δ_f＝αδ_h+(1-α)δ_a (8)

式中δ_a为当前时刻协同转向控制器前轮转角，单位rad；δ_h为驾驶员当前时刻前轮转角，单位rad；

结合式(2)、式(7)和式(8)，由于侧向车速相对于纵向车速较小可以近似看作v≈v_x，整理可得共驾车辆系统模型如式(9)：

该共驾车辆系统模型选取车辆质心o的侧向位移yo作为人车协同转向系统的输出，同时选取人车协同转向系统的辅助前轮转角δ_a作为人车协同转向系统系统模型的控制输入，选取状态向量x＝[y_o ψ β r]^T，人车协同转向系统模型可被描述成如式(10)所示的状态空间形式：

其中A为系统矩阵，表示系统内部状态变量的关系；B_a为协同转向控制器的控制矩阵，表示协同转向控制器的输入变量如何控制状态变量；C为输出矩阵，表示输出变量如何反映状态；B_h为驾驶员的控制矩阵，表示驾驶员的输入变量如何控制状态变量；各个矩阵表达式如下：

C＝[1 0 0 0]；

为了方便控制器设计，将式(10)的共驾车辆系统模型进行离散化得到离散化以后的共驾车辆系统模型如式(11)：

式中T_s为采样时间，单位s；

步骤二、博弈平衡条件下人机协同控制策略设计：

驾驶员的决策过程与协同转向控制器类似，因此驾驶员和协同转向控制器均采用预测控制进行决策，当依据驾驶员的驾驶能力和驾驶习惯选定驾驶权重后，驾驶员通过一段时间的适应以后能够理解共驾车辆的特性和协同转向控制器辅助特性，在对协同转向控制器动作预测的基础上实现自身的决策；协同转向控制器能够实时采集驾驶员的驾驶信息，预测驾驶员未来的控制动作实现对驾驶员的辅助，驾驶员和协同转向控制器双方进行决策都是基于式(11)的离散化以后的共驾车辆系统模型，定义C_a＝C_h＝C_c，依据预测控制原理，定义预测时域为P，控制时域为N，驾驶员的预测输出方程如式(12)所示：

Y_h(k)＝S_h1x(k)+S_h2U_h(k)+S_h3U_a(k). (12)

式(12)中的Y_h(k)为预测时域内驾驶员预测的车辆侧向位移，U_h(k)为预测时域内驾驶员决策的控制序列，U_a(k)为预测时域内驾驶员决策的控制序列；

协同转向控制器其状态预测的基本原理与驾驶员类似，其预测方程如下所示：

Y_a(k)＝S_a1x(k)+S_a2U_h(k)+S_a3U_a(k), (13)

其中Y_a(k)为预测时域内协同转向控制器预测的车辆侧向位移，式(12)与式(13)中：

驾驶员和协同转向控制器的决策可以表达为如下优化目标的形式：

驾驶员：

协同转向控制器：

式(14)中为驾驶员的控制目标，式(15)中为协同转向控制器的控制目标，式(14)与式(15)中y_a＝y_h＝y_o，Γ_hq、Γ_hr、Γ_aq与Γ_ar分别为正定加权对角矩阵，R_h(k)为驾驶员的参考轨迹序列，R_a(k)为协同转向控制器的参考轨迹序列，通过传感感知模块获取；

驾驶员和人机协同转向控制器的理想路径存在差别，即R_h(k)≠R_a(k)，则博弈双方形成的为非合作博弈关系，当驾驶员和控制器双方都为了实现自身的期望路径而采取最优控制策略时，此时人机之间的策略组合就构成了纳什均衡策略，当双方达成博弈平衡时满足以下条件：

式中为博弈平衡条件下驾驶员最优控制序列，为博弈平衡条件下协同转向控制器的最优控制序列，在转向控制的博弈过程中，如果驾驶员和协同转向控制器之间没有进行最优路径之间信息沟通，驾驶员与协同转向控制器双方都没有改变自身最优控制量的可能，因为单边改变自身最优控制量都会使得自身对参考路径的跟踪精度下降，因此达到均衡条件时，驾驶员和协同转向控制器双方均达成了自身的最优控制策略，虽然这不一定是全局条件下双方可能达到的全局最优策略，但一定程度上通过实现的博弈的平衡削减了人机冲突的程度；

步骤三、博弈平衡条件下人机最优控制策略求解：

驾驶员的控制目标式(14)中和协同转向控制器的控制目标式(15)中进行转换则可以写成如下形式：

上式(17)等价于

因此博弈平衡条件下驾驶员最优控制序列和博弈平衡条件下协同转向控制器最优控制序列可以求得如下形式：

式(19)中博弈平衡条件下驾驶员最优控制序列和博弈平衡条件下协同转向控制器最优控制序列相互耦合，博弈双方优化问题的求解需要已知对方优化的结果，因此无法直接求解最优的控制策略，因此为了解决这个问题，可以添加如下凸迭代伴随方程求解：

其中ω₁与ω₂为加权系数并且满足ω₂+ω₂＝1，p代表的是迭代的步数，表示迭代过程中第p步时的驾驶员的最优控制序列，U_h(k)^[p]表示迭代过程中第p步时的驾驶员的非最优控制序列，U_h(k)^[p+1]表示迭代过程中第p+1步时的驾驶员的非最优控制序列，表示迭代过程中第p步时的协同转向控制器的最优控制序列，U_a(k)^[p]表示迭代过程中第p步时的协同转向控制器的非最优控制序列，U_a(k)^[p+1]表示迭代过程中第p+1步时的协同转向控制器的非最优控制序列；当迭代步数一定时，其迭代的顺序如下：首先给定p＝0时驾驶员和控制器的控制输入初值，式(19)可以用来求取p＝0时的“最优”人机控制输入，利用式(20)可以求得p+1人机所采取的控制策略，以此循环往复；当迭代步数到达无穷时，即p→∞,时，将方程和代入式(19)可以求得：

其中：

Δ_h＝(I-Φ_hS_h3Φ_aS_h2)^-1Φ_h,Δ_a＝(I-Φ_aS_h2Φ_hS_h3)^-1Φ_a.

针对式(19)中若第一个矩阵奇异导致纳什均衡问题不可解的问题加以证明，考虑加权矩阵Γ_hq、Γ_hr、Γ_aq、与Γ_ar一般为正定对角阵，则矩阵和为列满秩矩阵，则根据广义逆的性质：

可以看出为对称满秩方阵，因此其逆也为对称满秩方阵，观察矩阵也为对称满秩矩阵，因此Φ_hS_h3则为对称满秩方阵，同理Φ_aS_h2也为对称满秩方阵，则矩阵I-Φ_hS_h3Φ_aS_h2与矩阵I-Φ_aS_h2Φ_hS_h3也为对称满秩方阵，则式(19)则必定有解；

步骤四、人车协同转向控制执行：

将步骤三中式(21)求解出的博弈平衡条件下驾驶员最优控制序列中控制序列的第一项和博弈平衡条件下协同转向控制器最优控制序列中控制序列的第一项按照式(8)求得当前时刻车辆前轮转角如式(23)：

当前时刻车辆前轮转角δ_f作为最终控制量传给车辆，车辆通过相应的执行机构执行控制量δ_f，即可完成驾驶员控制目标和协同转向控制器控制目标发生冲突的条件下的协同转向控制。

2.根据权利要求1所述的一种考虑人车冲突的协同转向控制方法，其特征在于，步骤二中驾驶员的参考轨迹序列R_h(k)通过求取均值的方法获得，具体是通过反复采集驾驶员通过某一路段的行驶轨迹，将多次行驶轨迹进行叠加并求取均值获得。