一种驾驶员在环的人车协同转向滚动优化控制方法技术

本发明专利技术提供了一种驾驶员在环的人车协同转向滚动优化控制方法，具体步骤如下：一、建立车辆二自由度动力学模型与车辆运动学模型；二、利用危险评估模糊逻辑确定干预程度系数；三、建立人车协同转向系统模型；四、采用模型预测方法进行人车协同转向系统控制器设计；五、进行驾驶权分配并计算控制量完成控制；本方法在驾驶员驾驶汽车有可能发生危险时能够在线实时辅助驾驶员进行操作，在驾驶员正常操作车辆时能够不干预驾驶员操作，车辆行驶在安全区域时，驾驶员拥有车辆转向的绝对控制权，控制器完全不干预驾驶员正确的转向操作，超出安全区域后根据驾驶员操作行为和车辆位置实时决定干预程度并协同驾驶员完成转向操作。

【技术实现步骤摘要】
一种驾驶员在环的人车协同转向滚动优化控制方法
本专利技术属于汽车驾驶控制领域，涉及一种人车协同驾驶策略，更加具体的来讲，涉及一种考虑驾驶员在环的人车协同转向控制方法。
技术介绍
随着道路上汽车数量的增加，道路交通环境将会日益复杂，人类驾驶员面对如此纷繁复杂的环境，常常会有一时的疏忽大意，这种情况下极易造成交通事故，如何保障驾驶员安全驾驶汽车是亟待解决的问题。无人驾驶汽车是一种把人类驾驶员从复杂驾驶任务中解脱出来的有效手段。然而，在无人驾驶技术和相关法律法规尚不完善的情况下，开发先进的人车协同控制技术是保障驾驶员行车安全十分有效的途径。当前，众多研究学者和汽车相关企业在人车协同驾驶方面投入极大热情，是驾驶自动化在当前技术水平下的主要目标。现有人车协同驾驶过程中驾驶员行为有着个性化、驾驶时间长易疲劳和难以预测的特点，同时应对未知和危险工况能力十分薄弱，如何保障驾驶员在未知和危险工况下安全性是人车协同驾驶必须解决的问题。
技术实现思路
本专利技术为解决驾驶员在未知和危险工况下易误操作的问题，提出一种可以在线纠正驾驶员误操作的协同转向滚动优化控制方法。本专利技术所述的一种驾驶员在环的人车协同转向滚动优化控制方法，是采用如下技术方案实现的：一种考虑驾驶权实时分配的人车协同转向控制方法，基于一种驾驶员和协同转向控制器同时在环的驾驶模式，该种模式下当驾驶员的驾驶行为不出现错误时，车辆的驾驶权完全由驾驶员支配，在驾驶员驾驶行为出现错误时，将驾驶员的驾驶权重减小甚至减少至零，由协同转向控制器辅助驾驶员协同控制转向，其特征在于，本方法具体步骤如下：步骤一、建立车辆二自由度动力学模型与车辆运动学模型：建立大地坐标系：原点O固结于地面，X轴通常与车辆初始运动方向重合，X轴沿逆时针方向旋转90度的方向为Y轴的正方向建立大地坐标系；建立车辆坐标系：以车辆动力学模型中车辆质心o为坐标原点，沿着车辆前进的方向为x轴的正方向，x轴沿逆时针方向旋转90度的方向为y轴的正方向建立车辆坐标系；用车辆运动学模型表征车辆的操纵稳定性与车辆的侧向运动的关系，并用车辆二自由度动力学模型表征车辆的操纵稳定性和车辆的横摆运动之间的关系，具体过程如下：假定车辆是一个刚性体，车辆装置着四个不会发生形变的车轮，并以车辆前轮作为转向轮，根据车辆运动学方程以及车辆运动的几何关系得到车辆运动学模型如式(1)所示：式中xo为车辆质心o的纵向位移，单位m；yo为车辆质心o的侧向位移，单位m；v为车辆质心的速度，单位m/s；r为车辆的横摆角速度，单位rad/s；ψ为车辆的航向角，单位rad；β为车辆的质心侧偏角，单位rad；考虑到实际道路的曲率通常很小，车辆在这段实际道路区域内行驶时航向角ψ同样认为是很小的，且实际上车辆的质心侧偏角β变化范围也很小，所以有：sin(ψ+β)≈ψ+β，cos(ψ+β)≈1，结合式(1)可以得到简化的车辆运动学模型，如式(2)所示：本方法是通过控制车辆的前轮转角来实现路径跟踪的目的，并且认为车辆保持匀速状态行驶，所以只需要考虑车辆的侧向运动，根据牛顿第二定律与力矩平衡关系，可得到如式(3)所示的车辆二自由度动力学模型：式中vx为车辆质心处的纵向速度，单位m/s；Fyf为车辆前轮侧向力，单位N；Fyr为车辆后轮侧向力，单位N；m为车辆的质量，单位kg；Iz为车辆绕z轴的转动惯量，单位kg·m2；a为车辆质心o到车辆前轴的距离，单位m；b为车辆质心o到车辆后轴的距离，单位m；δf为车辆前轮转角，单位rad；车辆实际的前轮转角δf通常也很小，可以近似认为：cosδf≈1，sinδf≈0，因此对式(3)进行简化，简化后的车辆二自由度动力学模型如式(4)所示：车辆侧向轮胎力未达到饱和时，车辆侧向轮胎力Fy与轮胎侧偏角α可近似看作呈线性关系如式(5)所示：式中Cf为车辆前轮的轮胎侧偏刚度，单位N·rad；Cr为车辆后轮的轮胎侧偏刚度，单位N·rad；αf为车辆前轮的轮胎侧偏角，单位rad；αr为车辆后轮的轮胎侧偏角，单位rad；在车辆坐标系下，前轮的轮胎侧偏角αf和后轮的轮胎侧偏角αr有如式(6)的关系：结合式(4)、式(5)和式(6)，整理可得车辆二自由度动力学模型如式(7)所示：步骤二、利用危险评估模糊逻辑确定干预程度系数：定义干预程度系数为α且0≤α≤1，干预程度系数是通过对驾驶员行为和车辆侧向位置综合分析得出，设当前时刻为k时刻，驾驶员行为系数Dh表达如式(8)所示：其中δh(k)为驾驶员k时刻决策出的前轮转角，δf(k|k-1)为k-1时刻求解出k时刻车辆前轮转角，Dh为δh与δf(k|k-1)的差值的绝对值比上δh与δf(k|k-1)的差值的绝对值的最大值，Dh值越大说明驾驶员操作的错误程度越高；车辆侧向位置系数Dr表达式如式(9)所示：其中，yo(k)为k时刻车辆的侧向位移，ro(k)为k时刻与yo(k)相同x坐标所对应的道路中心线的侧向位移，Dr为yo(k)与ro(k)差值的绝对值比上yo(k)与ro(k)差值的绝对值的最大值，Dr值越大说明车辆偏离道路中心线的程度越高；将驾驶员行为系数Dh模糊化为5个集合：Sh，MSh，Mh，MBh，Bh；车辆侧向位置系数Dr模糊化为4个集合：Sr，MSr，Mr，Br；将Dh变化范围设定为[0，1]，其隶属度函数的表达式如式(10)所示；将Dh变化范围设定为[0，1]，其隶属度函数的表达式如式(11)所示；同样将干预程度系数α也模糊化为5个集合：Sα，MSα，Mα，MBα，Bα；其对应的隶属度函数表达式如式(12)所示：具体模糊规则如表1所示：表1模糊规则表最后，通过查表获得干预程度系数α的隶属度，然后利用去模糊方法中的最大隶属度法确定干预程度系数α的值；步骤三、建立人车协同转向系统模型：步骤三通过建立人车协同转向系统模型对人车协同转向系统进行描述，由步骤二决策出的当前时刻干预程度系数α,采集驾驶员当前时刻决策出的前轮转角δh，通过人车协同转向系统控制器求解出的当前时刻人车协同转向系统的辅助前轮转角δa，后再按照式(13)给出的比例关系进行叠加执行到车辆的前轮：δf＝αδh+(1-α)δa(13)式中δa为人车协同转向控制器求解出的当前时刻人车协同转向系统的辅助前轮转角，单位rad；δh为驾驶员当前时刻决策出的前轮转角，单位rad；求解出当前时刻人车协同转向系统的辅助前轮转角δa后，根据式(13)给出的叠加关系得到当前时刻车辆前轮转角δf作为前轮转角控制量；结合式(2)、式(7)和式(13)，由于侧向车速相对于纵向车速较小可以近似看作v≈vx，整理可得人车协同转向系统模型如式(14)：该人车协同转向系统选取车辆质心o的侧向位移yo作为人车协同转向系统的输出，同时选取人车协同转向系统的辅助前轮转角δa作为人车协同转向系统系统模型的控制输入，选取状态向量x＝[yoψβr]T，人车协同转向系统模型可被描述成如式(15)所示的状态空间形式：其中A为系统矩阵，表示系统内部状态变量的关系；Bs为控制矩阵，表示输入变量如何控制状态变量；C为输出矩阵，表示输出变量如何反映状态；Bd为常数项矩阵；各个矩阵表达式如下：C＝[1000]；步骤四、采用模型预测方法进行人车协同转向系统控制器设计：以步骤三中的人车协同转向系统模型本文档来自技高网...

【技术保护点】
1.一种驾驶员在环的人车协同转向滚动优化控制方法，基于一种驾驶员和协同转向控制器同时在环的驾驶模式，该种模式下当驾驶员的驾驶行为不出现错误时，车辆的驾驶权完全由驾驶员支配，在驾驶员驾驶行为出现错误时，将驾驶员的驾驶权重减小甚至减少至零，由协同转向控制器辅助驾驶员协同控制转向，其特征在于，本方法具体步骤如下：步骤一、建立车辆二自由度动力学模型与车辆运动学模型：建立大地坐标系：原点O固结于地面，X轴通常与车辆初始运动方向重合，X轴沿逆时针方向旋转90度的方向为Y轴的正方向建立大地坐标系；建立车辆坐标系：以车辆动力学模型中车辆质心o为坐标原点，沿着车辆前进的方向为x轴的正方向，x轴沿逆时针方向旋转90度的方向为y轴的正方向建立车辆坐标系；用车辆运动学模型表征车辆的操纵稳定性与车辆的侧向运动的关系，并用车辆二自由度动力学模型表征车辆的操纵稳定性和车辆的横摆运动之间的关系，具体过程如下：假定车辆是一个刚性体，车辆装置着四个不会发生形变的车轮，并以车辆前轮作为转向轮，根据车辆运动学方程以及车辆运动的几何关系得到车辆运动学模型如式(1)所示：

【技术特征摘要】
1.一种驾驶员在环的人车协同转向滚动优化控制方法，基于一种驾驶员和协同转向控制器同时在环的驾驶模式，该种模式下当驾驶员的驾驶行为不出现错误时，车辆的驾驶权完全由驾驶员支配，在驾驶员驾驶行为出现错误时，将驾驶员的驾驶权重减小甚至减少至零，由协同转向控制器辅助驾驶员协同控制转向，其特征在于，本方法具体步骤如下：步骤一、建立车辆二自由度动力学模型与车辆运动学模型：建立大地坐标系：原点O固结于地面，X轴通常与车辆初始运动方向重合，X轴沿逆时针方向旋转90度的方向为Y轴的正方向建立大地坐标系；建立车辆坐标系：以车辆动力学模型中车辆质心o为坐标原点，沿着车辆前进的方向为x轴的正方向，x轴沿逆时针方向旋转90度的方向为y轴的正方向建立车辆坐标系；用车辆运动学模型表征车辆的操纵稳定性与车辆的侧向运动的关系，并用车辆二自由度动力学模型表征车辆的操纵稳定性和车辆的横摆运动之间的关系，具体过程如下：假定车辆是一个刚性体，车辆装置着四个不会发生形变的车轮，并以车辆前轮作为转向轮，根据车辆运动学方程以及车辆运动的几何关系得到车辆运动学模型如式(1)所示：式中xo为车辆质心o的纵向位移，单位m；yo为车辆质心o的侧向位移，单位m；v为车辆质心的速度，单位m/s；r为车辆的横摆角速度，单位rad/s；ψ为车辆的航向角，单位rad；β为车辆的质心侧偏角，单位rad；考虑到实际道路的曲率通常很小，车辆在这段实际道路区域内行驶时航向角ψ同样认为是很小的，且实际上车辆的质心侧偏角β变化范围也很小，所以有：sin(ψ+β)≈ψ+β，cos(ψ+β)≈1，结合式(1)可以得到简化的车辆运动学模型，如式(2)所示：本方法是通过控制车辆的前轮转角来实现路径跟踪的目的，并且认为车辆保持匀速状态行驶，所以只需要考虑车辆的侧向运动，根据牛顿第二定律与力矩平衡关系，可得到如式(3)所示的车辆二自由度动力学模型：式中vx为车辆质心处的纵向速度，单位m/s；Fyf为车辆前轮侧向力，单位N；Fyr为车辆后轮侧向力，单位N；m为车辆的质量，单位kg；Iz为车辆绕z轴的转动惯量，单位kg·m2；a为车辆质心o到车辆前轴的距离，单位m；b为车辆质心o到车辆后轴的距离，单位m；δf为车辆前轮转角，单位rad；车辆实际的前轮转角δf通常也很小，可以近似认为：cosδf≈1，sinδf≈0，因此对式(3)进行简化，简化后的车辆二自由度动力学模型如式(4)所示：车辆侧向轮胎力未达到饱和时，车辆侧向轮胎力Fy与轮胎侧偏角α可近似看作呈线性关系如式(5)所示：式中Cf为车辆前轮的轮胎侧偏刚度，单位N·rad；Cr为车辆后轮的轮胎侧偏刚度，单位N·rad；αf为车辆前轮的轮胎侧偏角，单位rad；αr为车辆后轮的轮胎侧偏角，单位rad；在车辆坐标系下，前轮的轮胎侧偏角αf和后轮的轮胎侧偏角αr有如式(6)的关系：结合式(4)、式(5)和式(6)，整理可得车辆二自由度动力学模型如式(7)所示：步骤二、利用危险评估模糊逻辑确定干预程度系数：定义干预程度系数为α且0≤α≤1，干预程度系数是通过对驾驶员行为和车辆侧向位置综合分析得出，设当前时刻为k时刻，驾驶员行为系数Dh表达如式(8)所示：其中δh(k)为驾驶员k时刻决策出的前轮转角，δf(k|k-1)为k-1时刻求解出k时刻车辆前轮转角，Dh为δh与δf(k|k-1)的差值的绝对值比上δh与δf(k|k-1)的差值的绝对值的最大值，Dh值越大说明驾驶员操作的错误程度越高；车辆侧向位置系数Dr表达式如式(9)所示：其中，yo(k)为k时刻车辆的侧向位移，ro(k)为k时刻与yo(k)相同x坐标所对应的道路中心线的侧向位移，Dr为yo(k)与ro(k)差值的绝对值比上yo(k)与ro(k)差值的绝对值的最大值，Dr值越大说明车辆偏离道路中心线的程度越高；将驾驶员行为系数Dh模糊化为5个集合：Sh，MSh，Mh，MBh，Bh；车辆侧向位置系数Dr模糊化为4个集合：Sr，MSr，Mr，Br；将Dh变化范围设定为[0，1]，其隶属度函数的表达式如式(10)所示；将Dh变化范围设定为[0，1]，其隶属度函数的表达式如式(11)所示；同样将干预程度系数α也模糊化为5个集合：Sα，MSα，Mα，MBα，Bα；其对应的隶属度函数表达式如式(12)所示：具体模糊规则如表1所示：表1模糊规则表最后，通过查表获得干预程度系数α的隶属度，然后利用去模糊方法中的最大隶属度法确定干预程度系数α的值；步骤三、建立人车协同转向系统模型：步骤三通过建立人车协同转向系统模型对人车协同转向系统进行描述，由步骤二决策出的当前时刻干预程度系数α,采集驾驶员当前时刻决策出的前轮转角δh，通过人车协同转向系统控制器求解出的当前时刻人车协同转向系统的辅助前轮转角δa，后再按照式(13)给出的比例关系进行叠加执行到车辆的前轮：δf＝αδh+(1-α)δa(13)式中δa为人车协同转向...

【专利技术属性】
技术研发人员：刘俊，郭洪艳，郭洋洋，陈虹，朱飞白，
申请(专利权)人：吉林大学，
类型：发明
国别省市：吉林,22