CN107856737A - 一种基于危险程度变权重的人机协同转向控制方法 - Google Patents

一种基于危险程度变权重的人机协同转向控制方法 Download PDF

Info

Publication number
CN107856737A
CN107856737A CN201711075923.3A CN201711075923A CN107856737A CN 107856737 A CN107856737 A CN 107856737A CN 201711075923 A CN201711075923 A CN 201711075923A CN 107856737 A CN107856737 A CN 107856737A
Authority
CN
China
Prior art keywords
mrow
msub
mtd
mtr
mfrac
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN201711075923.3A
Other languages
English (en)
Other versions
CN107856737B (zh
Inventor
郭洪艳
宋林桓
郭洋洋
刘俊
刘风
胡云峰
陈虹
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Zhongke Huituo Guangdong Technology Co ltd
Original Assignee
Jilin University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Jilin University filed Critical Jilin University
Priority to CN201711075923.3A priority Critical patent/CN107856737B/zh
Publication of CN107856737A publication Critical patent/CN107856737A/zh
Application granted granted Critical
Publication of CN107856737B publication Critical patent/CN107856737B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D6/00Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits

Landscapes

  • Engineering & Computer Science (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Medicines Containing Antibodies Or Antigens For Use As Internal Diagnostic Agents (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Abstract

本发明公开了一种基于危险程度变权重的人机协同转向控制方法,包括以下步骤:建立简化模型;确定车辆安全行驶道路边界;确定驾驶环境危险指数和驾驶员操作危险指数表达式,然后确定驾驶环境危险指数和驾驶员操作危险指数以及自动驾驶权重系数的隶属度函数,根据模糊规则划分不同危险程度等级,得到自动驾驶权重系数关于驾驶环境危险指数和驾驶员操作危险指数的三维map,实时确定驾驶环境危险指数和驾驶员操作危险指数,利用三维map得到自动驾驶权重系数;进行基于危险程度变权重的人机协同转向控制器设计并完成控制。本发明通过判别驾驶员和车辆危险程度来改变驾驶权重,采用约束模型预测控制,使车辆能尽可能满足驾驶员驾驶意图。

Description

一种基于危险程度变权重的人机协同转向控制方法
技术领域
本发明涉及一种基于危险程度变权重的人机协同转向控制方法,是考虑驾驶员和车辆危险程度的人机协同转向控制方法,属于高级辅助驾驶领域。
背景技术
近些年来,无人驾驶技术越来越受到人们的关注,美国SAE将无人驾驶划分成了五级,其中,人机协同控制处在中间位置,要实现完全的无人驾驶,人机协同是必经阶段,人机协同即人与控制器共同控制车辆,什么时候人来控制汽车,什么时候控制器来进行控制汽车,什么时候二者相互协同控制车辆,是人机协同控制研究的根本问题。当人在驾驶过程中的作用越来越弱,直至控制器完全取代人进行车辆的控制,无人驾驶的目的就达到了。人机协同最重要的任务是提高驾驶安全性。其次还要考虑驾驶员的舒适性,以及车辆的操纵稳定性等指标。在保障驾驶安全的情况下给人以更好的驾驶体验。
发明内容
为了解决现有技术存在的上述问题,本发明提供一种基于危险程度变权重的人机协同转向控制方法,其通过判别驾驶员和车辆危险程度来改变驾驶权重,采用约束模型预测控制,在满足避障安全的前提下,使车辆能尽可能满足驾驶员驾驶意图。
本发明得目的是通过以下技术方案实现的:
1.一种基于危险程度变权重的人机协同转向控制方法,包括以下步骤:
步骤一、建立综合车辆动力学和运动学的简化模型:
式中,
x=[yo ψ β r]T,u=δf.
式中,x为***的状态向量;u为***控制量;A为***矩阵;B为输入矩阵;yo为车辆质心o的侧向位置,单位:m;ψ为车辆航向角,单位:rad;v为车辆质心处的纵向速度,单位:m/s;β为车辆的质心侧偏角,单位:rad;r为车辆的横摆角速度,单位:rad/s;Cf为车辆前轮轮胎的侧偏刚度,单位:N/rad;Cr为车辆后轮轮胎的侧偏刚度,单位:N/rad;m为车辆的质量,单位:kg;Iz为车辆绕z轴的转动惯量,单位:kg·m2;a为车辆质心o到车辆前轴的距离,单位:m;b为车辆质心o到车辆后轴的距离,单位:m;δf为车辆的前轮转角,单位:rad;
步骤二、确定车辆安全行驶道路边界:
式中,fl(x)为通过感知***扫描后处理得到的前方可行道路区域的左边界;fr(x)为通过感知***扫描后处理得到的前方可行道路区域的右边界;w为车辆宽度,单位,m;lf为车辆质心o到车辆前端点F的距离,单位,m;lr为车辆质心o到车辆后端点R的距离,单位,m;ψ为车辆航向角,单位,rad;
步骤三、确定自动驾驶权重系数:
首先确定驾驶环境危险指数和驾驶员操作危险指数表达式,然后确定驾驶环境危险指数和驾驶员操作危险指数以及自动驾驶权重系数的隶属度函数,根据模糊规则划分不同危险程度等级,得到自动驾驶权重系数关于驾驶环境危险指数和驾驶员操作危险指数的三维map,最后实时确定驾驶环境危险指数和驾驶员操作危险指数,利用所述三维map得到自动驾驶权重系数;
步骤四、利用步骤三得到的自动驾驶权重系数,采用MPC方法进行基于危险程度变权重的人机协同转向控制器设计:
满足:x(k+i+1)=Acx(k+i)+Bcu(k+i)
式中:
Cψ=[0 1 0 0].
其中,J为优化函数的目标函数;δh为驾驶员期望的前轮转角,单位:rad;lf为车辆质心o到车辆前端点F的距离,单位:m;lr为车辆质心o到车辆后端点R的距离,单位:m;u(k+i)为k+i时刻的***控制量,即为车辆的前轮转向角,单位:rad;x(k+i)为k+i时刻的***状态向量;y(k+i)为k+i时刻的***输出量;P为预测时域,N为控制时域;Γd和Γh分别为控制量增量的权重系数和驾驶员目标权重系数;Γy和Γβ分别为道路中心线跟随权重系数和质心侧偏角权重系数;Γ为自动驾驶权重系数;fl(k+i)为前方可行道路区域左边界线fl(x)在时刻k+i的采样值,单位:m;fr(k+i)则为前方可行道路区域右边界线fr(x)在时刻k+i的采样值,单位:m;Ts为采样时间,单位:s;x为***的状态向量;A为***矩阵;B为输入矩阵;
步骤五、选取控制量并完成控制:
选取控制率u为:
u=U*(1) (4)
其中,U*为优化得到的最优控制序列;即选取最优控制序列的第一个量作为控制量作用到被控车辆上;到下一时刻,基于模型预测控制的共享转向控制器将根据当前车辆状态重新计算一个最优控制量;以此往复,实现滚动优化控制。
通过以上方案的实施,本发明的有益效果为:
1、本发明使车辆可以避开障碍物,在安全区域行驶。
2、本发明在避障安全约束选取时考虑了车辆的形状。
3、本发明考虑了驾驶员意图和驾驶环境危险程度。
附图说明
图1为本发明所述的基于危险程度变权重的人机转向协同控制方法流程图
图2为车辆模型示意图
图3为本发明车辆与道路关系模型示意图
图4为道路危险参数隶属度函数示意图
图5为驾驶员危险参数隶属度函数示意图
图6为自动驾驶权重系数隶属度函数示意图
图7为自动驾驶权重系数隶属度函数关于环境危险指数和驾驶员操作危险指数的三维map示意图
具体实施方式
以下结合附图对本发明进行详细说明:
本发明是一种基于危险程度变权重的人机协同转向控制方法,如图1所示,具体实施步骤如下:
步骤一、建立综合的车辆动力学和运动学的简化模型
(1)车辆动力学模型建立
车辆动力学模型如图2所示,其中车辆质心o为坐标原点,在这里只考虑车辆的侧向运动动力学和横摆运动运动学,忽略车辆的纵向动力学。于是我们可以得到一个简化的二自由度车辆模型。车身前进方向为x轴正方向,垂直于x轴向上的为y轴正方向。根据动力学知识可得二自由度动力学方程如式5所示。
其中,β为质心侧偏角,单位,rad;v为车辆质心处的纵向速度,单位,m/s;r为车辆的横摆角速度,单位,rad/s;Cf为车辆前轮轮胎的侧偏刚度,单位,N/rad;Cr为车辆后轮轮胎的侧偏刚度,单位,N/rad;m为车辆的质量,单位,kg;Iz为车辆绕z轴的转动惯量,单位,kg·m2;a为车辆质心o到车辆前轴的距离,单位,m;b为车辆质心o到车辆后轴的距离,单位,m;δf为车辆前轮转向角,单位,rad;
(2)车辆运动学建模
车辆动力学方程示意图如图2所示,假设车辆为一个刚体,由于车辆在行驶过程中感知到的道路曲率较小,并且航向角ψ和质心侧偏角β也都在较小范围内变化,所以我们可以得到简化后的车辆运动学方程如式(6)所示:
式中,β为质心侧偏角,单位,rad;xo为车辆质心o的纵向位置,单位,m;yo为车辆质心o的侧向位置,单位,m;r为车辆的横摆角速度,单位,rad/s;ψ为车辆航向角,单位,rad;
(3)建立车辆模型
我们假设车辆的纵向速度v保持不变,结合式(5)和式(6)可以得到车辆动力学和运动学的微分方程如式(7)所示:
我们选取[yoψβr]作为***状态变量,选取前轮转角δf作为***控制输入。于是我们可以得到***状态方程如式(8)所示:
其中:
x=[yo ψ β r]T,u=δf.
其中,x为***的状态向量;u为***控制量;A为***矩阵;B为输入矩阵;
步骤二、确定车辆安全行驶道路边界:
如图3所示为二维车路关系模型,此图中忽略车身宽度,把车辆考虑成一个刚性杆,其中F为车辆前端点,R为车辆后端点,o为车辆质心。同时,为了保证简化合理性,我们同样把上下道路边界各缩短二分之一车长。于是我们可以得到简化后的道路边界如式(9)所示:
其中fl'(x)和fr'(x)为简化后的道路边界。fl(x)和fr(x)为原来的道路边界,w为车身宽度。
我们只要保证车辆的前后端点F和R在道路边界内就可以实现防撞。图4给出了刚性杆端点和质心之间的关系,同样我们假设车辆在行驶过程中航向角ψ和质心侧偏角β也都在较小范围内变化。我们可以得到最终的道路边界表达式如式(10)所示:
步骤三、确定自动驾驶权重系数
自动驾驶权重系数Γ是通过考虑道路和驾驶员综合情况而得出的。
(1)驾驶环境危险指数表达式如式(11)所示:
其中,Yvehicle表示车辆质心当前坐标;Ycenter表示道路中心线坐标;EA是一个大于0的确定系数。这样将车辆的位置转化为安全程度的具体表达。驾驶环境危险指数越大代表车辆距离道路边界越近,危险程度越高。
(2)驾驶员操作危险指数表达式如式(12)所示:
其中,δhuman表示驾驶员期望的前轮转角,δprediction表示***预测的前轮转角,它是上一时刻预测控制中预测得到的,EB是调节系数。该指数表征了驾驶员实际操作符合***预期操作的程度。
(3)自动驾驶权重系数Γ关于驾驶环境危险指数和驾驶员操作危险指数的三维map:利用驾驶环境危险指数Eroad和驾驶员操作危险指数Edriver,采用模糊化方法,获得自动驾驶权重系数Γ关于Eroad和Edriver的三维map。
首先将驾驶环境危险指数Eroad和驾驶员操作危险指数Edriver分别模糊化为5个集合:S(安全),MS(较安全),M(中),MD(较危险),D(危险)。如图4、图5所示,利用调节参数EA将Eroad变化范围设定为[0,1],其隶属度函数的表达式如式(13)所示;利用调节参数EB将Edriver的变化范围设为[0,1],其隶属度函数的表达式如式(14)所示:
同样将自动驾驶权重系数Γ也模糊化为5个集合:S(小),MS(较小),M(中),MB(较大),B(大)。如图6所示,其对应的隶属度函数表达式如式(15)所示:
其中Aij、Bij、Cij(i=1,2,3;j=1,2,3,4,5)为常数。
然后进行模糊规则的建立。具体模糊规则如表1所示:
表1模糊规则
最后,通过模糊规则与上述隶属度函数确定自动驾驶权重系数Γ关于Eroad和Edriver的三维map,如图7所示;
(4)自动驾驶权重系数Γ的实时确定
最后实时确定驾驶环境危险指数和驾驶员操作危险指数,利用上述的三维map得到自动驾驶权重系数Γ;
步骤四、利用步骤三得到的自动驾驶权重系数,采用MPC(Model PredictiveControl,模型预测控制)方法进行基于危险程度变权重的人机协同转向控制器设计
(1)本发明的控制目标如下:
1)使***控制尽可能跟随驾驶员意图,同时控制量保持平顺。
2)行驶过程中保证车辆在道路边界线内。
(2)基于危险程度变权重的人机协同转向控制器设计
本发明做出如下假设:假设自主驾驶车辆在一个预测时域内保持恒速行驶。式(8)为车辆***的连续模型,为用于基于模型预测控制的区域型路径跟踪控制算法的设计,需要将式(8)离散化,得到离散时间的车辆***模型,如式(13)所示:
x(k+1)=Acx(k)+Bcu(k) (16)
式中,其中Ts为采样时间。
假定预测时域为P,控制时域为N,且满足N≤P。同时假定控制时域之外的控制量保持不变,即u(k+N)=u(k+N+1)=…=u(k+P-1),可推导出P步的状态预测方程,如式(17):
定义:
于是我们可以得到驾驶员目标函数如式(18)所示:
其中,δh为驾驶员期望的前轮转角,单位,rad。u(k)为控制输入,Δu(k+i)=u(k+i)-u(k+i-1)为前轮转角在采样区间的增量。Γd和Γh分别为控制量增量的权重系数和驾驶员目标权重系数。
于是我们可以得到控制器目标函数如式(19)所示:
其中yc(k+i)为道路中心线的侧向位置,作为车辆侧向位置的期望y(k+i)为车辆实际侧向位置,β(k+i)=Cβx(k+i),Cβ=[0 0 1 0]。Γy和Γβ分别为道路中心线跟随权重系数和质心侧偏角权重系数。
再根据图7中道路危险参数和驾驶员危险参数所确定的自动驾驶权重系数相结合,我们得到最终的控制目标函数如式(20)所示:
J=JH+ΓJA (20)
其中,JH为驾驶员目标函数,JA为自动控制器目标函数,Γ为自动驾驶权重系数。
车辆质心的侧向位置满足式(10)中的约束,该输出约束可被写成如式(21)所示的形式:
式中,ψ(k+i)=Cψx(k+i),Cψ=[0 1 0 0],fl(k+i)为前方可行道路区域左边界线fl(x)在时刻k+i的采样值,单位,m;fr(k+i)则为前方可行道路区域右边界线fr(x)在时刻k+i的采样值,单位,m。
采用约束模型预测方法进行共享转向控制器设计,整理为;
满足:x(k+i+1)=Acx(k+i)+Bcu(k+i)
式中:
Cψ=[0 1 0 0].
其中,J为优化函数的目标函数;δh为驾驶员期望的前轮转角,单位,rad;lf为车辆质心o到车辆前端点F的距离,单位,m;lr为车辆质心o到车辆后端点R的距离,单位,m;u(k+i)为k+i时刻的***控制量,即为车辆的前轮转向角,单位,rad;x(k+i)为k+i时刻的***状态向量;y(k+i)为k+i时刻的***输出量;P为预测时域,N为控制时域;Γd和Γh分别为控制量增量的权重系数和驾驶员目标权重系数;Γy和Γβ分别为道路中心线跟随权重系数和质心侧偏角权重系数;Γ为自动驾驶权重系数;fl(k+i)为前方可行道路区域左边界线fl(x)在时刻k+i的采样值,单位,m;fr(k+i)则为前方可行道路区域右边界线fr(x)在时刻k+i的采样值,单位,m;Ts为采样时间,单位s;x为***的状态向量;A为***矩阵;B为输入矩阵。
步骤五、选取控制量并完成控制,选取控制率u为:
u=U*(1) (23)
其中,U*为优化得到的最优控制序列;
即选取最优控制序列的第一个量作为控制量作用到被控车辆上。到下一时刻,基于模型预测控制的共享转向控制器将根据当前车辆状态重新计算一个最优控制量,以此往复,即实现了滚动优化控制。

Claims (2)

1.一种基于危险程度变权重的人机协同转向控制方法,其特征在于,包括以下步骤:
步骤一、建立综合车辆动力学和运动学的简化模型:
<mrow> <mover> <mi>x</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>=</mo> <mi>A</mi> <mi>x</mi> <mo>+</mo> <mi>B</mi> <mi>u</mi> </mrow>
式中,
x=[yo ψ β r]T,u=δf.
<mrow> <mi>A</mi> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mi>v</mi> </mtd> <mtd> <mi>v</mi> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mfrac> <mrow> <mn>2</mn> <mrow> <mo>(</mo> <msub> <mi>C</mi> <mi>f</mi> </msub> <mo>+</mo> <msub> <mi>C</mi> <mi>r</mi> </msub> <mo>)</mo> </mrow> </mrow> <mrow> <mi>m</mi> <mi>v</mi> </mrow> </mfrac> </mtd> <mtd> <mrow> <mfrac> <mrow> <mn>2</mn> <mrow> <mo>(</mo> <msub> <mi>aC</mi> <mi>f</mi> </msub> <mo>-</mo> <msub> <mi>bC</mi> <mi>r</mi> </msub> <mo>)</mo> </mrow> </mrow> <mrow> <msup> <mi>mv</mi> <mn>2</mn> </msup> </mrow> </mfrac> <mo>-</mo> <mn>1</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mfrac> <mrow> <mn>2</mn> <mrow> <mo>(</mo> <msub> <mi>aC</mi> <mi>f</mi> </msub> <mo>-</mo> <msub> <mi>bC</mi> <mi>r</mi> </msub> <mo>)</mo> </mrow> </mrow> <msub> <mi>I</mi> <mi>z</mi> </msub> </mfrac> </mtd> <mtd> <mfrac> <mrow> <mn>2</mn> <mrow> <mo>(</mo> <msup> <mi>a</mi> <mn>2</mn> </msup> <msub> <mi>C</mi> <mi>f</mi> </msub> <mo>+</mo> <msup> <mi>b</mi> <mn>2</mn> </msup> <msub> <mi>C</mi> <mi>r</mi> </msub> <mo>)</mo> </mrow> </mrow> <mrow> <msub> <mi>I</mi> <mi>z</mi> </msub> <mi>v</mi> </mrow> </mfrac> </mtd> </mtr> </mtable> </mfenced> <mo>,</mo> <mi>B</mi> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <mfrac> <mrow> <mn>2</mn> <msub> <mi>C</mi> <mi>f</mi> </msub> </mrow> <mrow> <mi>m</mi> <mi>v</mi> </mrow> </mfrac> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <mfrac> <mrow> <mn>2</mn> <msub> <mi>aC</mi> <mi>f</mi> </msub> </mrow> <msub> <mi>I</mi> <mi>z</mi> </msub> </mfrac> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>.</mo> </mrow>
式中,x为***的状态向量;u为***控制量;A为***矩阵;B为输入矩阵;yo为车辆质心o的侧向位置,单位:m;ψ为车辆航向角,单位:rad;v为车辆质心处的纵向速度,单位:m/s;β为车辆的质心侧偏角,单位:rad;r为车辆的横摆角速度,单位:rad/s;Cf为车辆前轮轮胎的侧偏刚度,单位:N/rad;Cr为车辆后轮轮胎的侧偏刚度,单位:N/rad;m为车辆的质量,单位:kg;Iz为车辆绕z轴的转动惯量,单位:kg·m2;a为车辆质心o到车辆前轴的距离,单位:m;b为车辆质心o到车辆后轴的距离,单位:m;δf为车辆的前轮转角,单位:rad;
步骤二、确定车辆安全行驶道路边界:
<mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>f</mi> <mi>r</mi> </msub> <mrow> <mo>(</mo> <mi>x</mi> <mo>)</mo> </mrow> <mo>+</mo> <mfrac> <mi>w</mi> <mn>2</mn> </mfrac> <mo>-</mo> <msub> <mi>l</mi> <mi>f</mi> </msub> <mi>&amp;psi;</mi> <mo>&amp;le;</mo> <msub> <mi>y</mi> <mi>o</mi> </msub> <mo>&amp;le;</mo> <msub> <mi>f</mi> <mi>l</mi> </msub> <mrow> <mo>(</mo> <mi>x</mi> <mo>)</mo> </mrow> <mo>+</mo> <mfrac> <mi>w</mi> <mn>2</mn> </mfrac> <mo>-</mo> <msub> <mi>l</mi> <mi>f</mi> </msub> <mi>&amp;psi;</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>f</mi> <mi>r</mi> </msub> <mrow> <mo>(</mo> <mi>x</mi> <mo>)</mo> </mrow> <mo>+</mo> <mfrac> <mi>w</mi> <mn>2</mn> </mfrac> <mo>+</mo> <msub> <mi>l</mi> <mi>r</mi> </msub> <mi>&amp;psi;</mi> <mo>&amp;le;</mo> <msub> <mi>y</mi> <mi>o</mi> </msub> <mo>&amp;le;</mo> <msub> <mi>f</mi> <mi>l</mi> </msub> <mrow> <mo>(</mo> <mi>x</mi> <mo>)</mo> </mrow> <mo>+</mo> <mfrac> <mi>w</mi> <mn>2</mn> </mfrac> <mo>+</mo> <msub> <mi>l</mi> <mi>r</mi> </msub> <mi>&amp;psi;</mi> </mrow> </mtd> </mtr> </mtable> </mfenced>
式中,fl(x)为通过感知***扫描后处理得到的前方可行道路区域的左边界;fr(x)为通过感知***扫描后处理得到的前方可行道路区域的右边界;w为车辆宽度,单位,m;lf为车辆质心o到车辆前端点F的距离,单位,m;lr为车辆质心o到车辆后端点R的距离,单位,m;ψ为车辆航向角,单位,rad;
步骤三、确定自动驾驶权重系数:
首先确定驾驶环境危险指数和驾驶员操作危险指数表达式,然后确定驾驶环境危险指数和驾驶员操作危险指数以及自动驾驶权重系数的隶属度函数,根据模糊规则划分不同危险程度等级,得到自动驾驶权重系数关于驾驶环境危险指数和驾驶员操作危险指数的三维map,最后实时确定驾驶环境危险指数和驾驶员操作危险指数,利用所述三维map得到自动驾驶权重系数;
步骤四、利用步骤三得到的自动驾驶权重系数,采用MPC方法进行基于危险程度变权重的人机协同转向控制器设计:
<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <munder> <mi>min</mi> <mrow> <mi>U</mi> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> </mrow> </munder> <mi>J</mi> <mo>=</mo> <msub> <mi>&amp;Gamma;</mi> <mi>h</mi> </msub> <mrow> <mo>(</mo> <mo>|</mo> <msub> <mi>&amp;delta;</mi> <mi>h</mi> </msub> <mo>-</mo> <mi>u</mi> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>|</mo> <mo>+</mo> <msub> <mi>&amp;Gamma;</mi> <mi>d</mi> </msub> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>1</mn> </mrow> <mrow> <mi>P</mi> <mo>-</mo> <mn>1</mn> </mrow> </munderover> <msup> <mrow> <mo>(</mo> <mrow> <mi>&amp;Delta;</mi> <mi>u</mi> <mrow> <mo>(</mo> <mrow> <mi>k</mi> <mo>+</mo> <mi>i</mi> </mrow> <mo>)</mo> </mrow> </mrow> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>)</mo> </mrow> <mo>+</mo> <mi>&amp;Gamma;</mi> <mo>(</mo> <msub> <mi>&amp;Gamma;</mi> <mi>y</mi> </msub> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>P</mi> </munderover> <msup> <mrow> <mo>(</mo> <mrow> <msub> <mi>y</mi> <mi>c</mi> </msub> <mrow> <mo>(</mo> <mrow> <mi>k</mi> <mo>+</mo> <mi>i</mi> </mrow> <mo>)</mo> </mrow> <mo>-</mo> <mi>y</mi> <mrow> <mo>(</mo> <mrow> <mi>k</mi> <mo>+</mo> <mi>i</mi> </mrow> <mo>)</mo> </mrow> </mrow> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>+</mo> <msub> <mi>&amp;Gamma;</mi> <mi>&amp;beta;</mi> </msub> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>P</mi> </munderover> <msup> <mrow> <mo>(</mo> <mrow> <mi>&amp;beta;</mi> <mrow> <mo>(</mo> <mrow> <mi>k</mi> <mo>+</mo> <mi>i</mi> </mrow> <mo>)</mo> </mrow> </mrow> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>)</mo> </mrow> </mtd> </mtr> </mtable> </mfenced>
满足:x(k+i+1)=Acx(k+i)+Bcu(k+i)
<mrow> <msub> <mi>f</mi> <mi>r</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>+</mo> <mi>i</mi> <mo>)</mo> </mrow> <mo>+</mo> <mfrac> <mi>w</mi> <mn>2</mn> </mfrac> <mo>-</mo> <msub> <mi>l</mi> <mi>f</mi> </msub> <msub> <mi>C</mi> <mi>&amp;psi;</mi> </msub> <mi>x</mi> <mrow> <mo>(</mo> <mi>k</mi> <mo>+</mo> <mi>i</mi> <mo>)</mo> </mrow> <mo>&amp;le;</mo> <mi>y</mi> <mrow> <mo>(</mo> <mi>k</mi> <mo>+</mo> <mi>i</mi> <mo>)</mo> </mrow> <mo>&amp;le;</mo> <msub> <mi>f</mi> <mi>l</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>+</mo> <mi>i</mi> <mo>)</mo> </mrow> <mo>-</mo> <mfrac> <mi>w</mi> <mn>2</mn> </mfrac> <mo>-</mo> <msub> <mi>l</mi> <mi>f</mi> </msub> <msub> <mi>C</mi> <mi>&amp;psi;</mi> </msub> <mi>x</mi> <mrow> <mo>(</mo> <mi>k</mi> <mo>+</mo> <mi>i</mi> <mo>)</mo> </mrow> </mrow>
<mrow> <msub> <mi>f</mi> <mi>r</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>+</mo> <mi>i</mi> <mo>)</mo> </mrow> <mo>+</mo> <mfrac> <mi>w</mi> <mn>2</mn> </mfrac> <mo>+</mo> <msub> <mi>l</mi> <mi>r</mi> </msub> <msub> <mi>C</mi> <mi>&amp;psi;</mi> </msub> <mi>x</mi> <mrow> <mo>(</mo> <mi>k</mi> <mo>+</mo> <mi>i</mi> <mo>)</mo> </mrow> <mo>&amp;le;</mo> <mi>y</mi> <mrow> <mo>(</mo> <mi>k</mi> <mo>+</mo> <mi>i</mi> <mo>)</mo> </mrow> <mo>&amp;le;</mo> <msub> <mi>f</mi> <mi>l</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>+</mo> <mi>i</mi> <mo>)</mo> </mrow> <mo>-</mo> <mfrac> <mi>w</mi> <mn>2</mn> </mfrac> <mo>+</mo> <msub> <mi>l</mi> <mi>r</mi> </msub> <msub> <mi>C</mi> <mi>&amp;psi;</mi> </msub> <mi>x</mi> <mrow> <mo>(</mo> <mi>k</mi> <mo>+</mo> <mi>i</mi> <mo>)</mo> </mrow> </mrow>
式中:
<mrow> <mi>U</mi> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <mi>u</mi> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>u</mi> <mrow> <mo>(</mo> <mi>k</mi> <mo>+</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mo>.</mo> </mtd> </mtr> <mtr> <mtd> <mo>.</mo> </mtd> </mtr> <mtr> <mtd> <mo>.</mo> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>u</mi> <mrow> <mo>(</mo> <mi>k</mi> <mo>+</mo> <mi>N</mi> <mo>-</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>;</mo> </mrow>
<mrow> <msub> <mi>A</mi> <mi>c</mi> </msub> <mo>=</mo> <msup> <mi>e</mi> <mrow> <msub> <mi>AT</mi> <mi>s</mi> </msub> </mrow> </msup> <mo>,</mo> <msub> <mi>B</mi> <mi>c</mi> </msub> <mo>=</mo> <msubsup> <mo>&amp;Integral;</mo> <mn>0</mn> <msub> <mi>T</mi> <mi>s</mi> </msub> </msubsup> <msup> <mi>e</mi> <mrow> <mi>A</mi> <mi>&amp;tau;</mi> </mrow> </msup> <mi>d</mi> <mi>&amp;tau;</mi> <mo>&amp;CenterDot;</mo> <mi>B</mi> <mo>;</mo> </mrow>
Cψ=[0 1 0 0].
其中,J为优化函数的目标函数;δh为驾驶员期望的前轮转角,单位:rad;lf为车辆质心o到车辆前端点F的距离,单位:m;lr为车辆质心o到车辆后端点R的距离,单位:m;u(k+i)为k+i时刻的***控制量,即为车辆的前轮转向角,单位:rad;x(k+i)为k+i时刻的***状态向量;y(k+i)为k+i时刻的***输出量;P为预测时域,N为控制时域;Γd和Γh分别为控制量增量的权重系数和驾驶员目标权重系数;Γy和Γβ分别为道路中心线跟随权重系数和质心侧偏角权重系数;Γ为自动驾驶权重系数;fl(k+i)为前方可行道路区域左边界线fl(x)在时刻k+i的采样值,单位:m;fr(k+i)则为前方可行道路区域右边界线fr(x)在时刻k+i的采样值,单位:m;Ts为采样时间,单位:s;x为***的状态向量;A为***矩阵;B为输入矩阵;
步骤五、选取控制量并完成控制:
选取控制率u为:
u=U*(1)
其中,U*为优化得到的最优控制序列;即选取最优控制序列的第一个量作为控制量作用到被控车辆上;到下一时刻,基于模型预测控制的共享转向控制器将根据当前车辆状态重新计算一个最优控制量;以此往复,实现滚动优化控制。
2.如权利要求1所述的一种基于危险程度变权重的人机协同转向控制方法,其特征在于,所述步骤三确定自动驾驶权重系数具体包括以下过程:
3.1)确定驾驶环境危险指数和驾驶员操作危险指数表达式:
驾驶环境危险指数表达式为:
<mrow> <msub> <mi>E</mi> <mrow> <mi>r</mi> <mi>o</mi> <mi>a</mi> <mi>d</mi> </mrow> </msub> <mo>=</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>Y</mi> <mrow> <mi>v</mi> <mi>e</mi> <mi>h</mi> <mi>i</mi> <mi>c</mi> <mi>l</mi> <mi>e</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Y</mi> <mrow> <mi>c</mi> <mi>e</mi> <mi>n</mi> <mi>t</mi> <mi>e</mi> <mi>r</mi> </mrow> </msub> <mo>)</mo> </mrow> <msub> <mi>E</mi> <mi>A</mi> </msub> </msup> </mrow>
式中,Yvehicle表示车辆质心当前坐标;Ycenter表示道路中心线坐标;EA是一个大于0的确定系数;
驾驶员操作危险指数表达式为:
<mrow> <msub> <mi>E</mi> <mrow> <mi>d</mi> <mi>r</mi> <mi>i</mi> <mi>v</mi> <mi>e</mi> <mi>r</mi> </mrow> </msub> <mo>=</mo> <mfrac> <mrow> <mo>|</mo> <msub> <mi>&amp;delta;</mi> <mrow> <mi>h</mi> <mi>u</mi> <mi>m</mi> <mi>a</mi> <mi>n</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>&amp;delta;</mi> <mrow> <mi>p</mi> <mi>r</mi> <mi>e</mi> <mi>d</mi> <mi>i</mi> <mi>c</mi> <mi>t</mi> <mi>i</mi> <mi>o</mi> <mi>n</mi> </mrow> </msub> <mo>|</mo> </mrow> <msub> <mi>E</mi> <mi>B</mi> </msub> </mfrac> </mrow>
式中,δhuman表示驾驶员期望的前轮转角,δprediction表示***预测的前轮转角,它是上一时刻预测控制中预测得到的,EB是调节系数;
3.2)利用驾驶环境危险指数Eroad和驾驶员操作危险指数Edriver,采用模糊化方法,获得自动驾驶权重系数Γ关于Eroad和Edriver的三维map:
首先将驾驶环境危险指数Eroad和驾驶员操作危险指数Edriver分别模糊化为5个集合:安全S,较安全MS,中M,较危险MD,危险D;利用调节参数EA将Eroad变化范围设定为[0,1],其隶属度函数的表达式如下:
<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <mi>M</mi> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mfrac> <mn>1</mn> <mrow> <msub> <mi>B</mi> <mn>13</mn> </msub> <mo>-</mo> <msub> <mi>A</mi> <mn>13</mn> </msub> </mrow> </mfrac> <mrow> <mo>(</mo> <msub> <mi>E</mi> <mrow> <mi>r</mi> <mi>o</mi> <mi>a</mi> <mi>d</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>B</mi> <mn>13</mn> </msub> <mo>)</mo> </mrow> <mo>+</mo> <mn>1</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mfrac> <mn>1</mn> <mrow> <msub> <mi>B</mi> <mn>13</mn> </msub> <mo>-</mo> <msub> <mi>C</mi> <mn>13</mn> </msub> </mrow> </mfrac> <mrow> <mo>(</mo> <msub> <mi>E</mi> <mrow> <mi>r</mi> <mi>o</mi> <mi>a</mi> <mi>d</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>B</mi> <mn>13</mn> </msub> <mo>)</mo> </mrow> <mo>+</mo> <mn>1</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow> </mtd> <mtd> <mrow> <mi>M</mi> <mi>S</mi> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mfrac> <mn>1</mn> <mrow> <msub> <mi>B</mi> <mn>12</mn> </msub> <mo>-</mo> <msub> <mi>A</mi> <mn>12</mn> </msub> </mrow> </mfrac> <mrow> <mo>(</mo> <msub> <mi>E</mi> <mrow> <mi>r</mi> <mi>o</mi> <mi>a</mi> <mi>d</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>B</mi> <mn>12</mn> </msub> <mo>)</mo> </mrow> <mo>+</mo> <mn>1</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mfrac> <mn>1</mn> <mrow> <msub> <mi>B</mi> <mn>12</mn> </msub> <mo>-</mo> <msub> <mi>C</mi> <mn>12</mn> </msub> </mrow> </mfrac> <mrow> <mo>(</mo> <msub> <mi>E</mi> <mrow> <mi>r</mi> <mi>o</mi> <mi>a</mi> <mi>d</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>B</mi> <mn>12</mn> </msub> <mo>)</mo> </mrow> <mo>+</mo> <mn>1</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow> </mtd> <mtd> <mrow> <mi>M</mi> <mi>D</mi> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mfrac> <mn>1</mn> <mrow> <msub> <mi>B</mi> <mn>14</mn> </msub> <mo>-</mo> <msub> <mi>A</mi> <mn>14</mn> </msub> </mrow> </mfrac> <mrow> <mo>(</mo> <msub> <mi>E</mi> <mrow> <mi>r</mi> <mi>o</mi> <mi>a</mi> <mi>d</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>B</mi> <mn>14</mn> </msub> <mo>)</mo> </mrow> <mo>+</mo> <mn>1</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mfrac> <mn>1</mn> <mrow> <msub> <mi>B</mi> <mn>14</mn> </msub> <mo>-</mo> <msub> <mi>C</mi> <mn>14</mn> </msub> </mrow> </mfrac> <mrow> <mo>(</mo> <msub> <mi>E</mi> <mrow> <mi>r</mi> <mi>o</mi> <mi>a</mi> <mi>d</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>B</mi> <mn>14</mn> </msub> <mo>)</mo> </mrow> <mo>+</mo> <mn>1</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow> </mtd> </mtr> </mtable> </mfenced>
<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <mi>S</mi> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mrow> <msub> <mi>E</mi> <mrow> <mi>r</mi> <mi>o</mi> <mi>a</mi> <mi>d</mi> </mrow> </msub> <mo>&amp;le;</mo> <msub> <mi>A</mi> <mn>11</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mn>1</mn> <mo>-</mo> <mn>2</mn> <mfrac> <msup> <mrow> <mo>(</mo> <msub> <mi>E</mi> <mrow> <mi>r</mi> <mi>o</mi> <mi>a</mi> <mi>d</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>A</mi> <mn>11</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <msup> <mrow> <mo>(</mo> <msub> <mi>C</mi> <mn>11</mn> </msub> <mo>-</mo> <msub> <mi>A</mi> <mn>11</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mfrac> </mrow> </mtd> <mtd> <mrow> <msub> <mi>A</mi> <mn>11</mn> </msub> <mo>&amp;le;</mo> <msub> <mi>E</mi> <mrow> <mi>r</mi> <mi>o</mi> <mi>a</mi> <mi>d</mi> </mrow> </msub> <mo>&amp;le;</mo> <msub> <mi>B</mi> <mn>11</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mn>2</mn> <msup> <mrow> <mo>(</mo> <mrow> <msub> <mi>C</mi> <mn>11</mn> </msub> <mo>-</mo> <mfrac> <msub> <mi>E</mi> <mrow> <mi>r</mi> <mi>o</mi> <mi>a</mi> <mi>d</mi> </mrow> </msub> <mrow> <msub> <mi>C</mi> <mn>11</mn> </msub> <mo>-</mo> <msub> <mi>A</mi> <mn>11</mn> </msub> </mrow> </mfrac> </mrow> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </mtd> <mtd> <mrow> <msub> <mi>B</mi> <mn>11</mn> </msub> <mo>&amp;le;</mo> <msub> <mi>E</mi> <mrow> <mi>r</mi> <mi>o</mi> <mi>a</mi> <mi>d</mi> </mrow> </msub> <mo>&amp;le;</mo> <msub> <mi>C</mi> <mn>11</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <msub> <mi>E</mi> <mrow> <mi>r</mi> <mi>o</mi> <mi>a</mi> <mi>d</mi> </mrow> </msub> <mo>&amp;GreaterEqual;</mo> <msub> <mi>C</mi> <mn>11</mn> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow> </mtd> <mtd> <mrow> <mi>D</mi> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <msub> <mi>E</mi> <mrow> <mi>r</mi> <mi>o</mi> <mi>a</mi> <mi>d</mi> </mrow> </msub> <mo>&amp;le;</mo> <msub> <mi>A</mi> <mn>15</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <msup> <mrow> <mo>(</mo> <mfrac> <mrow> <msub> <mi>E</mi> <mrow> <mi>r</mi> <mi>o</mi> <mi>a</mi> <mi>d</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>A</mi> <mn>15</mn> </msub> </mrow> <mrow> <msub> <mi>B</mi> <mn>15</mn> </msub> <mo>-</mo> <msub> <mi>A</mi> <mn>15</mn> </msub> </mrow> </mfrac> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </mtd> <mtd> <mrow> <msub> <mi>A</mi> <mn>15</mn> </msub> <mo>&amp;le;</mo> <msub> <mi>E</mi> <mrow> <mi>r</mi> <mi>o</mi> <mi>a</mi> <mi>d</mi> </mrow> </msub> <mo>&amp;le;</mo> <msub> <mi>B</mi> <mn>15</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mn>1</mn> <mo>-</mo> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <msup> <mrow> <mo>(</mo> <mfrac> <mrow> <msub> <mi>E</mi> <mrow> <mi>r</mi> <mi>o</mi> <mi>a</mi> <mi>d</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>C</mi> <mn>15</mn> </msub> </mrow> <mrow> <msub> <mi>C</mi> <mn>15</mn> </msub> <mo>-</mo> <msub> <mi>B</mi> <mn>15</mn> </msub> </mrow> </mfrac> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </mtd> <mtd> <mrow> <msub> <mi>B</mi> <mn>15</mn> </msub> <mo>&amp;le;</mo> <msub> <mi>E</mi> <mrow> <mi>r</mi> <mi>o</mi> <mi>a</mi> <mi>d</mi> </mrow> </msub> <mo>&amp;le;</mo> <msub> <mi>C</mi> <mn>15</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mrow> <msub> <mi>E</mi> <mrow> <mi>r</mi> <mi>o</mi> <mi>a</mi> <mi>d</mi> </mrow> </msub> <mo>&amp;GreaterEqual;</mo> <msub> <mi>C</mi> <mn>15</mn> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow> </mtd> </mtr> </mtable> </mfenced>
利用调节参数EB将Edriver的变化范围设为[0,1],其隶属度函数的表达式如下:
<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <mi>M</mi> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mfrac> <mn>1</mn> <mrow> <msub> <mi>B</mi> <mn>23</mn> </msub> <mo>-</mo> <msub> <mi>A</mi> <mn>23</mn> </msub> </mrow> </mfrac> <mrow> <mo>(</mo> <msub> <mi>E</mi> <mrow> <mi>d</mi> <mi>r</mi> <mi>i</mi> <mi>v</mi> <mi>e</mi> <mi>r</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>B</mi> <mn>23</mn> </msub> <mo>)</mo> </mrow> <mo>+</mo> <mn>1</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mfrac> <mn>1</mn> <mrow> <msub> <mi>B</mi> <mn>23</mn> </msub> <mo>-</mo> <msub> <mi>C</mi> <mn>23</mn> </msub> </mrow> </mfrac> <mrow> <mo>(</mo> <msub> <mi>E</mi> <mrow> <mi>d</mi> <mi>r</mi> <mi>i</mi> <mi>v</mi> <mi>e</mi> <mi>r</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>B</mi> <mn>23</mn> </msub> <mo>)</mo> </mrow> <mo>+</mo> <mn>1</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow> </mtd> <mtd> <mrow> <mi>M</mi> <mi>S</mi> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mfrac> <mn>1</mn> <mrow> <msub> <mi>B</mi> <mn>22</mn> </msub> <mo>-</mo> <msub> <mi>A</mi> <mn>22</mn> </msub> </mrow> </mfrac> <mrow> <mo>(</mo> <msub> <mi>E</mi> <mrow> <mi>d</mi> <mi>r</mi> <mi>i</mi> <mi>v</mi> <mi>e</mi> <mi>r</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>B</mi> <mn>22</mn> </msub> <mo>)</mo> </mrow> <mo>+</mo> <mn>1</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mfrac> <mn>1</mn> <mrow> <msub> <mi>B</mi> <mn>22</mn> </msub> <mo>-</mo> <msub> <mi>C</mi> <mn>22</mn> </msub> </mrow> </mfrac> <mrow> <mo>(</mo> <msub> <mi>E</mi> <mrow> <mi>d</mi> <mi>r</mi> <mi>i</mi> <mi>v</mi> <mi>e</mi> <mi>r</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>B</mi> <mn>22</mn> </msub> <mo>)</mo> </mrow> <mo>+</mo> <mn>1</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow> </mtd> <mtd> <mrow> <mi>M</mi> <mi>D</mi> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mfrac> <mn>1</mn> <mrow> <msub> <mi>B</mi> <mn>24</mn> </msub> <mo>-</mo> <msub> <mi>A</mi> <mn>24</mn> </msub> </mrow> </mfrac> <mrow> <mo>(</mo> <msub> <mi>E</mi> <mrow> <mi>d</mi> <mi>r</mi> <mi>i</mi> <mi>v</mi> <mi>e</mi> <mi>r</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>B</mi> <mn>24</mn> </msub> <mo>)</mo> </mrow> <mo>+</mo> <mn>1</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mfrac> <mn>1</mn> <mrow> <msub> <mi>B</mi> <mn>24</mn> </msub> <mo>-</mo> <msub> <mi>C</mi> <mn>24</mn> </msub> </mrow> </mfrac> <mrow> <mo>(</mo> <msub> <mi>E</mi> <mrow> <mi>d</mi> <mi>r</mi> <mi>i</mi> <mi>v</mi> <mi>e</mi> <mi>r</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>B</mi> <mn>24</mn> </msub> <mo>)</mo> </mrow> <mo>+</mo> <mn>1</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow> </mtd> </mtr> </mtable> </mfenced>
<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <mi>S</mi> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mrow> <msub> <mi>E</mi> <mrow> <mi>d</mi> <mi>r</mi> <mi>i</mi> <mi>v</mi> <mi>e</mi> <mi>r</mi> </mrow> </msub> <mo>&amp;le;</mo> <msub> <mi>A</mi> <mn>11</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mn>1</mn> <mo>-</mo> <mn>2</mn> <mfrac> <msup> <mrow> <mo>(</mo> <msub> <mi>E</mi> <mrow> <mi>d</mi> <mi>r</mi> <mi>i</mi> <mi>v</mi> <mi>e</mi> <mi>r</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>A</mi> <mn>21</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <msup> <mrow> <mo>(</mo> <msub> <mi>C</mi> <mn>11</mn> </msub> <mo>-</mo> <msub> <mi>A</mi> <mn>11</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mfrac> </mrow> </mtd> <mtd> <mrow> <msub> <mi>A</mi> <mn>21</mn> </msub> <mo>&amp;le;</mo> <msub> <mi>E</mi> <mrow> <mi>d</mi> <mi>r</mi> <mi>i</mi> <mi>v</mi> <mi>e</mi> <mi>r</mi> </mrow> </msub> <mo>&amp;le;</mo> <msub> <mi>B</mi> <mn>21</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mn>2</mn> <msup> <mrow> <mo>(</mo> <mrow> <msub> <mi>C</mi> <mn>21</mn> </msub> <mo>-</mo> <mfrac> <msub> <mi>E</mi> <mrow> <mi>d</mi> <mi>r</mi> <mi>i</mi> <mi>v</mi> <mi>e</mi> <mi>r</mi> </mrow> </msub> <mrow> <msub> <mi>C</mi> <mn>21</mn> </msub> <mo>-</mo> <msub> <mi>A</mi> <mn>21</mn> </msub> </mrow> </mfrac> </mrow> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </mtd> <mtd> <mrow> <msub> <mi>B</mi> <mn>21</mn> </msub> <mo>&amp;le;</mo> <msub> <mi>E</mi> <mrow> <mi>d</mi> <mi>r</mi> <mi>i</mi> <mi>v</mi> <mi>e</mi> <mi>r</mi> </mrow> </msub> <mo>&amp;le;</mo> <msub> <mi>C</mi> <mn>21</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <msub> <mi>E</mi> <mrow> <mi>d</mi> <mi>r</mi> <mi>i</mi> <mi>v</mi> <mi>e</mi> <mi>r</mi> </mrow> </msub> <mo>&amp;GreaterEqual;</mo> <msub> <mi>C</mi> <mn>21</mn> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow> </mtd> <mtd> <mrow> <mi>D</mi> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <msub> <mi>E</mi> <mrow> <mi>d</mi> <mi>r</mi> <mi>i</mi> <mi>v</mi> <mi>e</mi> <mi>r</mi> </mrow> </msub> <mo>&amp;le;</mo> <msub> <mi>A</mi> <mn>25</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <msup> <mrow> <mo>(</mo> <mfrac> <mrow> <msub> <mi>E</mi> <mrow> <mi>d</mi> <mi>r</mi> <mi>i</mi> <mi>v</mi> <mi>e</mi> <mi>r</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>A</mi> <mn>25</mn> </msub> </mrow> <mrow> <msub> <mi>B</mi> <mn>25</mn> </msub> <mo>-</mo> <msub> <mi>A</mi> <mn>25</mn> </msub> </mrow> </mfrac> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </mtd> <mtd> <mrow> <msub> <mi>A</mi> <mn>25</mn> </msub> <mo>&amp;le;</mo> <msub> <mi>E</mi> <mrow> <mi>d</mi> <mi>r</mi> <mi>i</mi> <mi>v</mi> <mi>e</mi> <mi>r</mi> </mrow> </msub> <mo>&amp;le;</mo> <msub> <mi>B</mi> <mn>25</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mn>1</mn> <mo>-</mo> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <msup> <mrow> <mo>(</mo> <mfrac> <mrow> <msub> <mi>E</mi> <mrow> <mi>d</mi> <mi>r</mi> <mi>i</mi> <mi>v</mi> <mi>e</mi> <mi>r</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>C</mi> <mn>25</mn> </msub> </mrow> <mrow> <msub> <mi>C</mi> <mn>25</mn> </msub> <mo>-</mo> <msub> <mi>B</mi> <mn>25</mn> </msub> </mrow> </mfrac> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </mtd> <mtd> <mrow> <msub> <mi>B</mi> <mn>25</mn> </msub> <mo>&amp;le;</mo> <msub> <mi>E</mi> <mrow> <mi>d</mi> <mi>r</mi> <mi>i</mi> <mi>v</mi> <mi>e</mi> <mi>r</mi> </mrow> </msub> <mo>&amp;le;</mo> <msub> <mi>C</mi> <mn>25</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mrow> <msub> <mi>E</mi> <mrow> <mi>d</mi> <mi>r</mi> <mi>i</mi> <mi>v</mi> <mi>e</mi> <mi>r</mi> </mrow> </msub> <mo>&amp;GreaterEqual;</mo> <msub> <mi>C</mi> <mn>25</mn> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow> </mtd> </mtr> </mtable> </mfenced>
同样将自动驾驶权重系数Γ也模糊化为5个集合:小S,较小MS,中M,较大MB,大B,其对应的隶属度函数的表达式如下:
<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <mi>M</mi> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mfrac> <mn>1</mn> <mrow> <msub> <mi>B</mi> <mn>33</mn> </msub> <mo>-</mo> <msub> <mi>A</mi> <mn>33</mn> </msub> </mrow> </mfrac> <mrow> <mo>(</mo> <mi>&amp;Gamma;</mi> <mo>-</mo> <msub> <mi>B</mi> <mn>33</mn> </msub> <mo>)</mo> </mrow> <mo>+</mo> <mn>1</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mfrac> <mn>1</mn> <mrow> <msub> <mi>B</mi> <mn>33</mn> </msub> <mo>-</mo> <msub> <mi>C</mi> <mn>33</mn> </msub> </mrow> </mfrac> <mrow> <mo>(</mo> <mi>&amp;Gamma;</mi> <mo>-</mo> <msub> <mi>B</mi> <mn>33</mn> </msub> <mo>)</mo> </mrow> <mo>+</mo> <mn>1</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow> </mtd> <mtd> <mrow> <mi>M</mi> <mi>S</mi> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mfrac> <mn>1</mn> <mrow> <msub> <mi>B</mi> <mn>32</mn> </msub> <mo>-</mo> <msub> <mi>A</mi> <mn>32</mn> </msub> </mrow> </mfrac> <mrow> <mo>(</mo> <mi>&amp;Gamma;</mi> <mo>-</mo> <msub> <mi>B</mi> <mn>32</mn> </msub> <mo>)</mo> </mrow> <mo>+</mo> <mn>1</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mfrac> <mn>1</mn> <mrow> <msub> <mi>B</mi> <mn>32</mn> </msub> <mo>-</mo> <msub> <mi>C</mi> <mn>32</mn> </msub> </mrow> </mfrac> <mrow> <mo>(</mo> <mi>&amp;Gamma;</mi> <mo>-</mo> <msub> <mi>B</mi> <mn>32</mn> </msub> <mo>)</mo> </mrow> <mo>+</mo> <mn>1</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow> </mtd> <mtd> <mrow> <mi>M</mi> <mi>D</mi> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mfrac> <mn>1</mn> <mrow> <msub> <mi>B</mi> <mn>34</mn> </msub> <mo>-</mo> <msub> <mi>A</mi> <mn>34</mn> </msub> </mrow> </mfrac> <mrow> <mo>(</mo> <mi>&amp;Gamma;</mi> <mo>-</mo> <msub> <mi>B</mi> <mn>34</mn> </msub> <mo>)</mo> </mrow> <mo>+</mo> <mn>1</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mfrac> <mn>1</mn> <mrow> <msub> <mi>B</mi> <mn>34</mn> </msub> <mo>-</mo> <msub> <mi>C</mi> <mn>34</mn> </msub> </mrow> </mfrac> <mrow> <mo>(</mo> <mi>&amp;Gamma;</mi> <mo>-</mo> <msub> <mi>B</mi> <mn>34</mn> </msub> <mo>)</mo> </mrow> <mo>+</mo> <mn>1</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow> </mtd> </mtr> </mtable> </mfenced>
<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <mi>S</mi> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mrow> <mi>&amp;Gamma;</mi> <mo>&amp;le;</mo> <msub> <mi>A</mi> <mn>31</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mn>1</mn> <mo>-</mo> <mn>2</mn> <mfrac> <msup> <mrow> <mo>(</mo> <mi>&amp;Gamma;</mi> <mo>-</mo> <msub> <mi>A</mi> <mn>31</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <msup> <mrow> <mo>(</mo> <msub> <mi>C</mi> <mn>31</mn> </msub> <mo>-</mo> <msub> <mi>A</mi> <mn>31</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mfrac> </mrow> </mtd> <mtd> <mrow> <msub> <mi>A</mi> <mn>31</mn> </msub> <mo>&amp;le;</mo> <mi>&amp;Gamma;</mi> <mo>&amp;le;</mo> <msub> <mi>B</mi> <mn>31</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mn>2</mn> <msup> <mrow> <mo>(</mo> <mrow> <msub> <mi>C</mi> <mn>31</mn> </msub> <mo>-</mo> <mfrac> <mi>&amp;Gamma;</mi> <mrow> <msub> <mi>C</mi> <mn>31</mn> </msub> <mo>-</mo> <msub> <mi>A</mi> <mn>31</mn> </msub> </mrow> </mfrac> </mrow> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </mtd> <mtd> <mrow> <msub> <mi>B</mi> <mn>31</mn> </msub> <mo>&amp;le;</mo> <mi>&amp;Gamma;</mi> <mo>&amp;le;</mo> <msub> <mi>C</mi> <mn>31</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mi>&amp;Gamma;</mi> <mo>&amp;GreaterEqual;</mo> <msub> <mi>C</mi> <mn>31</mn> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow> </mtd> <mtd> <mrow> <mi>D</mi> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mi>&amp;Gamma;</mi> <mo>&amp;le;</mo> <msub> <mi>A</mi> <mn>35</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <msup> <mrow> <mo>(</mo> <mfrac> <mrow> <mi>&amp;Gamma;</mi> <mo>-</mo> <msub> <mi>A</mi> <mn>35</mn> </msub> </mrow> <mrow> <msub> <mi>B</mi> <mn>35</mn> </msub> <mo>-</mo> <msub> <mi>A</mi> <mn>35</mn> </msub> </mrow> </mfrac> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </mtd> <mtd> <mrow> <msub> <mi>A</mi> <mn>15</mn> </msub> <mo>&amp;le;</mo> <mi>&amp;Gamma;</mi> <mo>&amp;le;</mo> <msub> <mi>B</mi> <mn>15</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mn>1</mn> <mo>-</mo> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <msup> <mrow> <mo>(</mo> <mfrac> <mrow> <mi>&amp;Gamma;</mi> <mo>-</mo> <msub> <mi>C</mi> <mn>35</mn> </msub> </mrow> <mrow> <msub> <mi>C</mi> <mn>35</mn> </msub> <mo>-</mo> <msub> <mi>B</mi> <mn>35</mn> </msub> </mrow> </mfrac> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </mtd> <mtd> <mrow> <msub> <mi>B</mi> <mn>35</mn> </msub> <mo>&amp;le;</mo> <mi>&amp;Gamma;</mi> <mo>&amp;le;</mo> <msub> <mi>C</mi> <mn>35</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mrow> <mi>&amp;Gamma;</mi> <mo>&amp;GreaterEqual;</mo> <msub> <mi>C</mi> <mn>35</mn> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow> </mtd> </mtr> </mtable> </mfenced>
式中,Aij、Bij、Cij(i=1,2,3;j=1,2,3,4,5)为常数;
然后进行模糊规则的建立,具体模糊规则如下表:
最后,通过模糊规则与上述隶属度函数确定自动驾驶权重系数Γ关于Eroad和Edriver的三维map;
3.3)实时确定驾驶环境危险指数和驾驶员操作危险指数,利用上述的三维map得到自动驾驶权重系数Γ。
CN201711075923.3A 2017-11-06 2017-11-06 一种基于危险程度变权重的人机协同转向控制方法 Active CN107856737B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201711075923.3A CN107856737B (zh) 2017-11-06 2017-11-06 一种基于危险程度变权重的人机协同转向控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201711075923.3A CN107856737B (zh) 2017-11-06 2017-11-06 一种基于危险程度变权重的人机协同转向控制方法

Publications (2)

Publication Number Publication Date
CN107856737A true CN107856737A (zh) 2018-03-30
CN107856737B CN107856737B (zh) 2019-09-13

Family

ID=61700867

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201711075923.3A Active CN107856737B (zh) 2017-11-06 2017-11-06 一种基于危险程度变权重的人机协同转向控制方法

Country Status (1)

Country Link
CN (1) CN107856737B (zh)

Cited By (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108549367A (zh) * 2018-04-09 2018-09-18 吉林大学 一种基于预测安全的人机切换控制方法
CN108803322A (zh) * 2018-05-30 2018-11-13 吉林大学 一种时域变权重的驾驶员-自动驾驶***柔性接管方法
CN108873694A (zh) * 2018-05-30 2018-11-23 吉林大学 一种时域变权重的自动驾驶***-驾驶员柔性接管方法
CN109885040A (zh) * 2019-02-20 2019-06-14 江苏大学 一种人机共驾中的车辆驾驶控制权分配***
CN110329277A (zh) * 2019-07-19 2019-10-15 中汽研(天津)汽车工程研究院有限公司 一种智能汽车人机协同控制权重分配方法
CN111688704A (zh) * 2020-06-24 2020-09-22 吉林大学 一种基于驾驶状态预测的人机力矩协同转向控制方法
CN111861010A (zh) * 2020-07-23 2020-10-30 中国人民解放军军事科学院军事科学信息研究中心 一种人机协同的领域关键技术预测方法及预测***
CN113076641A (zh) * 2021-03-31 2021-07-06 同济大学 基于风险评估的智能车人机协同转向控制并行计算方法
CN113911140A (zh) * 2021-11-24 2022-01-11 无锡物联网创新中心有限公司 一种基于非合作博弈的人机共驾控制方法及相关装置
CN115457783A (zh) * 2022-08-30 2022-12-09 重庆长安汽车股份有限公司 无信号灯交叉口通行、协同、协作通行方法及***

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105279309A (zh) * 2015-09-16 2016-01-27 南京航空航天大学 基于回正力矩估计的主动转向理想方向盘转矩设计方法
CN106004870A (zh) * 2016-06-23 2016-10-12 吉林大学 一种基于变权重模型预测算法的车辆稳定性集成控制方法
JP2017001501A (ja) * 2015-06-09 2017-01-05 株式会社デンソー 路面表示装置
CN107085423A (zh) * 2016-02-16 2017-08-22 丰田自动车株式会社 车辆控制装置
CN107140012A (zh) * 2017-05-10 2017-09-08 南京航空航天大学 一种基于可抑制发散的卡尔曼滤波器的线控转向***及控制方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2017001501A (ja) * 2015-06-09 2017-01-05 株式会社デンソー 路面表示装置
CN105279309A (zh) * 2015-09-16 2016-01-27 南京航空航天大学 基于回正力矩估计的主动转向理想方向盘转矩设计方法
CN107085423A (zh) * 2016-02-16 2017-08-22 丰田自动车株式会社 车辆控制装置
CN106004870A (zh) * 2016-06-23 2016-10-12 吉林大学 一种基于变权重模型预测算法的车辆稳定性集成控制方法
CN107140012A (zh) * 2017-05-10 2017-09-08 南京航空航天大学 一种基于可抑制发散的卡尔曼滤波器的线控转向***及控制方法

Cited By (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108549367A (zh) * 2018-04-09 2018-09-18 吉林大学 一种基于预测安全的人机切换控制方法
CN108803322A (zh) * 2018-05-30 2018-11-13 吉林大学 一种时域变权重的驾驶员-自动驾驶***柔性接管方法
CN108873694A (zh) * 2018-05-30 2018-11-23 吉林大学 一种时域变权重的自动驾驶***-驾驶员柔性接管方法
CN108803322B (zh) * 2018-05-30 2021-11-30 吉林大学 一种时域变权重的驾驶员-自动驾驶***柔性接管方法
CN109885040B (zh) * 2019-02-20 2022-04-26 江苏大学 一种人机共驾中的车辆驾驶控制权分配***
CN109885040A (zh) * 2019-02-20 2019-06-14 江苏大学 一种人机共驾中的车辆驾驶控制权分配***
CN110329277A (zh) * 2019-07-19 2019-10-15 中汽研(天津)汽车工程研究院有限公司 一种智能汽车人机协同控制权重分配方法
CN111688704A (zh) * 2020-06-24 2020-09-22 吉林大学 一种基于驾驶状态预测的人机力矩协同转向控制方法
CN111688704B (zh) * 2020-06-24 2021-05-25 吉林大学 一种基于驾驶状态预测的人机力矩协同控制方法
CN111861010A (zh) * 2020-07-23 2020-10-30 中国人民解放军军事科学院军事科学信息研究中心 一种人机协同的领域关键技术预测方法及预测***
CN111861010B (zh) * 2020-07-23 2024-03-29 中国人民解放军军事科学院军事科学信息研究中心 一种人机协同的领域关键技术预测方法及预测***
CN113076641A (zh) * 2021-03-31 2021-07-06 同济大学 基于风险评估的智能车人机协同转向控制并行计算方法
CN113076641B (zh) * 2021-03-31 2022-09-20 同济大学 基于风险评估的智能车人机协同转向控制并行计算方法
CN113911140B (zh) * 2021-11-24 2022-09-27 无锡物联网创新中心有限公司 一种基于非合作博弈的人机共驾控制方法及相关装置
CN113911140A (zh) * 2021-11-24 2022-01-11 无锡物联网创新中心有限公司 一种基于非合作博弈的人机共驾控制方法及相关装置
CN115457783A (zh) * 2022-08-30 2022-12-09 重庆长安汽车股份有限公司 无信号灯交叉口通行、协同、协作通行方法及***
CN115457783B (zh) * 2022-08-30 2023-08-11 重庆长安汽车股份有限公司 无信号灯交叉口通行、协同、协作通行方法及***

Also Published As

Publication number Publication date
CN107856737B (zh) 2019-09-13

Similar Documents

Publication Publication Date Title
CN107856737B (zh) 一种基于危险程度变权重的人机协同转向控制方法
CN107380161B (zh) 一种辅助驾驶员实现理想行驶轨迹的主动转向控制装置
CN107804315B (zh) 一种考虑驾驶权实时分配的人车协同转向控制方法
CN110597245B (zh) 基于二次型规划和神经网络的自动驾驶换道轨迹规划方法
CN111890951B (zh) 智能电动汽车轨迹跟踪与运动控制方法
CN107042841B (zh) 一种轮毂电机驱动电动汽车差动助力转向稳定性控制方法
CN104977933B (zh) 一种自主驾驶车辆的区域型路径跟踪控制方法
CN108454628B (zh) 一种驾驶员在环的人车协同转向滚动优化控制方法
CN105857306B (zh) 一种用于多种泊车场景的车辆自主泊车路径规划方法
Cai et al. Implementation and development of a trajectory tracking control system for intelligent vehicle
CN109976159A (zh) 基于安全可控域的智能车辆横向控制方法
CN108819951A (zh) 一种考虑驾驶员驾驶技能的人机共驾横向驾驶权分配方法
Attia et al. Coupled longitudinal and lateral control strategy improving lateral stability for autonomous vehicle
CN106926844A (zh) 一种基于实时环境信息的动态自动驾驶换道轨迹规划方法
CN109144076A (zh) 一种多车辆横纵向耦合协同控制***及控制方法
CN108674414A (zh) 一种极限工况的智能汽车轨迹跟踪控制方法
CN106671982A (zh) 基于多智能体的无人驾驶电动汽车自动超车***及方法
CN107521496A (zh) 一种无人车辆的横纵向协调控制轨迹跟随控制方法
CN108717268A (zh) 基于最优控制与安全距离的自动驾驶最速操纵控制***及其控制方法
CN109291932A (zh) 基于反馈的电动汽车横摆稳定性实时控制装置及方法
CN107885932A (zh) 一种考虑人机和谐的汽车紧急避撞分层式控制方法
CN108860149A (zh) 一种用于智能车辆时间最短自由变道的运动轨迹设计方法
CN107323457B (zh) 一种人机协同的共享转向控制方法
CN107839683A (zh) 一种考虑运动障碍物的汽车紧急避撞控制方法
CN107380162B (zh) 基于功能分配与多目标模糊决策的协同避撞方法

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
TR01 Transfer of patent right

Effective date of registration: 20210810

Address after: 518125 124, block F, Chuang Zhi Park, No. 18, Shangnan Shangliao Industrial Road, Shangliao community, Xinqiao street, Bao'an District, Shenzhen, Guangdong

Patentee after: Shenzhen huituo infinite Technology Co.,Ltd.

Address before: 130012 No. 2699 Qianjin Street, Jilin, Changchun

Patentee before: Jilin University

TR01 Transfer of patent right
CP03 Change of name, title or address

Address after: 518125 124, block F, Chuang Zhi Park, No. 18, Shangnan Shangliao Industrial Road, Shangliao community, Xinqiao street, Bao'an District, Shenzhen, Guangdong

Patentee after: Zhongke Huituo (Guangdong) Technology Co.,Ltd.

Country or region after: China

Address before: 518125 124, block F, Chuang Zhi Park, No. 18, Shangnan Shangliao Industrial Road, Shangliao community, Xinqiao street, Bao'an District, Shenzhen, Guangdong

Patentee before: Shenzhen huituo infinite Technology Co.,Ltd.

Country or region before: China

CP03 Change of name, title or address