CN114537419A - 一种考虑驾驶员活跃度及驾驶能力的辅助控制器设计方法 - Google Patents
一种考虑驾驶员活跃度及驾驶能力的辅助控制器设计方法 Download PDFInfo
- Publication number
- CN114537419A CN114537419A CN202210274482.4A CN202210274482A CN114537419A CN 114537419 A CN114537419 A CN 114537419A CN 202210274482 A CN202210274482 A CN 202210274482A CN 114537419 A CN114537419 A CN 114537419A
- Authority
- CN
- China
- Prior art keywords
- driver
- vehicle
- representing
- driving
- model
- 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.)
- Pending
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W50/08—Interaction between the driver and the control system
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W2050/0001—Details of the control system
- B60W2050/0002—Automatic control, details of type of controller or control system architecture
- B60W2050/0018—Method for the design of a control system
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W2050/0001—Details of the control system
- B60W2050/0019—Control system elements or transfer functions
- B60W2050/0028—Mathematical models, e.g. for simulation
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W2050/0001—Details of the control system
- B60W2050/0019—Control system elements or transfer functions
- B60W2050/0028—Mathematical models, e.g. for simulation
- B60W2050/0029—Mathematical model of the driver
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/80—Technologies aiming to reduce greenhouse gasses emissions common to all road transportation technologies
- Y02T10/84—Data processing systems or methods, management, administration
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Human Computer Interaction (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
本发明公开了一种考虑驾驶员活跃度及驾驶能力的辅助控制器设计方法,涉及智能驾驶技术领域,解决了人机控制权限分配策略不够精准、驾驶舒适性和人机合作性能较差的技术问题,其技术方案要点是引入驾驶员活跃度和驾驶能力两个量化指标,并基于驾驶员时变特性设计人机共享控制权限分配策略,构建了基于模糊推理的人机共享控制器,实现个性化辅助驾驶。此外,该方法综合考虑了车辆行驶性能以及人机合作水平,并利用鲁棒正不变集理论处理系统多约束下的共享控制问题,该方法保证了车辆稳定性和路径跟踪性能的同时,提升了驾驶舒适性和人机合作性能,在未来高级辅助驾驶系统中具有广泛的应用前景和实用性。
Description
技术领域
本申请涉及智能驾驶技术领域,尤其涉及一种考虑驾驶员活跃度及驾驶能力的辅助控制器设计方法。
背景技术
在过去的几十年里,由于驾驶员驾驶能力不足、精力不足等原因造成的误操作行为,引发了大量的交通事故。根据世界卫生组织的调查表明,每年有130万人死于交通伤害事故。因此,近年来各种自动驾驶技术发展迅速,工业界主流的技术集中于L2-L3级别的自动驾驶,即驾驶员-自动控制器协同驾驶模式。
虽然成熟的高级驾驶辅助系统包括车道偏离预警、车道保持辅助、自适应巡航控制等,通过自动驾驶技术进行车辆控制以弥补人类驾驶员在一些紧急情况下的应对不足,能够有效的提高驾驶安全性。但是,在这些安全辅助技术的设计开发过程中,大多从车辆自动控制出发,而很少考虑驾驶员的行为。这样就会导致驾驶员和自动驾驶系统之间的期望补偿产生冲突,导致驾驶员的不适应及不信任。为此,相关的人机共享控制研究急需开发和应用,以提升驾驶辅助系统的个性化特性,增强人机信任感。
人机共享控制具有充分利用驾驶员特征提高车辆性能的潜力,而如何准确的描述和表征驾驶员特性、设计综合驾驶员特征参数的人机协同控制系统是实现个性化辅助驾驶的重要环节。
发明内容
本申请提供了一种考虑驾驶员活跃度及驾驶能力的辅助控制器设计方法,其技术目的是利用驾驶数据实时地评估驾驶员的动态特性,设计个性化的人机控制权限分配策略,在保证车辆稳定性和路径跟踪性能的同时,提升驾驶舒适性和人机合作性能。
本申请的上述技术目的是通过以下技术方案得以实现的:
一种考虑驾驶员活跃度及驾驶能力的辅助控制器设计方法,包括:
S1:将驾驶员转向模型和车辆动力学模型进行耦合得到驾驶员-车辆-道路耦合动力学模型;
S2:依据驾驶员的驾驶活跃度P3和驾驶能力E,构建人机共享控制权限分配策略;
S3:将人机共享控制权限分配策略耦合到驾驶员-车辆-道路耦合动力学模型中,以构建人机交互模型;
S4:根据模糊控制理论,将人机交互模型转换成4个线性模糊子系统;
S5:根据鲁棒正不变量集,并通过并行分布式状态反馈补偿为每个模糊子系统设计人机共享控制器;
S6:通过人机共享控制器实现车辆的稳定性控制和个性化驾驶。
本申请的有益效果在于:本申请所述的方法创新的引入驾驶员活跃度和驾驶能力两个量化指标,并基于驾驶员时变特性设计人机共享控制权限分配策略,构建了基于模糊推理的人机共享控制器,实现个性化辅助驾驶。此外,该方法综合考虑了车辆行驶性能以及人机合作水平,并利用鲁棒正不变集理论处理系统多约束下的共享控制问题,该方法保证了车辆稳定性和路径跟踪性能的同时,提升了驾驶舒适性和人机合作性能,使得人机共享控制器更加个性化,显著减少人机冲突,在人机协作方面具有明显优点,其控制框架逻辑清晰,灵活性高,通用性好,在未来高级辅助驾驶系统中具有广泛的应用前景和实用性。
附图说明
图1为本申请所述方法流程图;
图2为本申请的人机共享控制器的控制框架结构图;
图3为驾驶员转向模型结构示意图;
图4为驾驶员在环仿真实验框架图;
图5为仿真实验的交通道路场景示意图;
图6为所设计的人机共享控制器驾驶辅助水平结果示意图。
具体实施方式
下面将结合附图对本申请技术方案进行详细说明。
一种考虑驾驶员活跃度及驾驶能力的辅助控制器设计方法,如图1所示,具体包括:
S1:将驾驶员转向模型和车辆动力学模型进行耦合得到驾驶员-车辆-道路耦合动力学模型。
具体地,车辆-道路模型为基于二自由度横向车辆动力学模型构建的,则车辆-道路模型表示为:
其中,vx表示相对车速,Av表示车辆的迎风面积,β表示车辆质心侧偏角,γ表示车辆横摆角速度,yL表示车辆侧向误差,φL表示车辆航向角偏差,Cf表示前轮侧偏刚度,Cr表示后轮侧偏刚度,Mz表示绕z轴的惯性矩,m表示车辆质量,lf表示前轴到质心的距离,lr表示后轴到质心的距离,ls表示前视距离,δf表示前轮转向角,ρref表示前方道路曲率。
基于两点预瞄策略的驾驶员转向模型,由人脑决策系统和手臂肌肉系统组成,如图3所示,lfar表示远视距离,本申请中被设置为20-30米。分别表示人脑决策系统、手臂肌肉系统,同时,大脑延迟环节通过泰勒展开的手段,被一阶惯性环节近似,因此驾驶员转向模型表示为:
其中,θnear和θfar都表示虚拟转向角,作为驾驶员转向模型的输入;Kp表示驾驶员对未来道路的预测;Kc表示驾驶员对路径偏差的修正增益;τL表示微分常数,用于消除控制过程中的抖动问题;x1表示驾驶员转向模型推导的过程量,能够用来表征驾驶员的精神负荷;τd1表示大脑延时时间,τd2表示手臂肌肉反应时间,δd表示驾驶员转向模型估计出来的驾驶员方向盘转向角,δfd表示将驾驶员方向盘转向角转化成车辆的前轮转角,Rg表示驾驶员方向盘转向角与前轮转角的系数比,且Rg∈[1/20,1/10]。
通过RBF神经网络,在驾驶模拟器实验平台上对驾驶员特性参数进行辨识,驾驶员参数包括[Kp Kc τd Td],试验后取样本平均值作为最终的驾驶员转向模型参数。
S2:依据驾驶员驾驶活跃度P3和驾驶能力E,构建人机共享控制权限分配策略。
具体地,通过高斯-伯努利受限玻尔兹曼机算法和人工势场法分别计算出驾驶活跃度P3和驾驶能力E,驾驶能力E主要和侧向跟踪误差和车辆航向角偏差有关,结合人工势场理论在车辆领域的应用,驾驶能力E通过以下公式得到:
其中,α1和α2都表示能够调节的权重系数。
驾驶活跃度和驾驶能力是设计人机共享控制权限分配策略的重要指标。当驾驶员的活跃度高且驾驶能力较强时,可以赋予驾驶员更多的控制权,增强驾驶员的驾驶体验。当驾驶员视线远离道路场景时,驾驶员的注意力会随着时间呈指数下降,相似的,当驾驶活跃度和驾驶能力下降时,驾驶员的控制权限应当指数递减,所以,人机共享控制权限分配策略可以通过如下公式得到:
其中,λ表示控制器权限等级,则人的控制权限等级表示为1-λ;μ1表示驾驶员在驾驶任务中的参与程度,μ3表示驾驶员在驾驶任务中的驾驶技能,μ2表示驾驶活跃度对控制器权限等级的影响因子,μ4表示驾驶能力对控制器权限等级的影响因子。
S3:将人机共享控制权限分配策略耦合到驾驶员-车辆-道路耦合动力学模型中,以构建人机交互模型。
具体地,根据驾驶员-车辆-道路耦合动力学模型和人机共享控制权限分配策略,得到人机交互模型如下:
其中,δc表示控制器补偿的前轮转向角输入,lfar表示远视距离。
从驾驶舒适性、车辆稳定性、跟踪能力、人机合作程度等方面,将人机共享控制权限分配策略耦合到驾驶员-车辆-道路耦合动力学模型中,即对闭环系统(驾驶员-车辆-道路耦合动力学模型和人机共享控制器反馈的转向补偿组成)的测量输出和控制性能指标进行如下设计,表示为:
其中,y表示测量输出,Q表示对测量输出y的性能调节权重,z表示最终的控制性能指标。
S4:根据模糊控制理论,将人机交互模型转换成4个线性模糊子系统。
具体地,针对人机共享控制权限等级的时变性和纵向车辆的摄动性,利用T-S模糊规则方法处理参数时变性,首先通过如下式(7)的一阶泰勒对纵向速度vx进行线性化近似,表示为:
其中,vmax表示最大纵向速度,vmin表示最小纵向速度。
然后对人机交互模型中作为时变参数的λ和vx进行模糊处理,表示为:
其中,ρ1(λ)、ρ2(λ)、ρ1(Δv)、ρ2(Δv)都表示根据模糊规则处理后得到的模糊变量,由ρ1(λ)、ρ2(λ)、ρ1(Δv)、ρ2(Δv)组成4个线性模糊子系统。模糊变量的模糊规则如表1所示,其中B表示“大”,S表示“小”。
表1
则通过模糊规则和人机交互模型,得到所述驾驶员-车辆-道路模型的闭环系统,表示为:
S5:根据鲁棒正不变量集,并通过并行分布式状态反馈补偿为每个模糊子系统设计人机共享控制器。
具体地,人机共享控制器的目标性能函数J表示为:
通过最小化目标性能函数J来实现人机共享最优控制,可以通过用一个标准的H∞控制问题来表示。因此,定义表示李雅普诺夫函数为且P>0;满足的哈密尔顿-雅各比不等式表示为:γ>0,χ>0;通过对哈密尔顿-雅各比不等式从0到+∞积分,得到:则性能函数J的上界表示为:
同时,人机共享控制器需要满足系统约束条件,其中,车辆状态约束表示为:
由执行器饱和影响的控制输入边界约束表示为:|δc|<δcmax; (12)。
最终,考虑驾驶员活跃度和驾驶能力的个性化驾驶辅助人机共享控制器设计完成,如图2所示。
S6:通过人机共享控制器实现车辆的稳定性控制和个性化驾驶。
作为具体实施例地,在驾驶模拟器平台上,借助Prescan、Carsim、Matlab/Simulink等仿真软件,搭建如图4所示的驾驶员在环仿真实验,并设计了如图5所示的交通道路场景,驾驶员根据道路信息操纵驾驶模拟器来控制车辆,同时车辆状态和驾驶员实时特征发送到控制器,计算出辅助转角进行共享控制。由经验丰富的驾驶员(驾驶员I)、激进的驾驶员(驾驶员II)和保守的驾驶员(驾驶员III)三组实验,得到控制器驾驶辅助水平结果如图6所示,将本发明提出的人机共享控制器(A)与不考虑驾驶员特性的鲁棒控制器(B)的结果进行对比,人机合作性能J1、驾驶舒适性J2、车辆稳定性J3及路径跟踪性能J4结果如表2所示。
表2
其中人机合作性能J1、驾驶舒适性J2、车辆稳定性J3及路径跟踪性能J4可以通过如下公式计算得到:
其中,δd表示驾驶员转向角,δc表示人机共享控制器的补偿转向角,人机合作性能J1为正时且越大表明合作性能越强,为负时表明人机出现冲突。ay表示车辆的侧向加速度,vy表示车辆的侧向速度,车辆稳定性J3越小表明车辆越稳定。从表2中可以发现,本申请提出的人机共享控制器在人机合作方面有着显著的提升,在驾驶舒适性方面提升也较为明显。同时,在车辆稳定性和路径跟踪性能方面,较传统人机共享控制策略也有一定的提升。
上述仅为本申请的构思作举例说明。本申请亦可以针对具体车型、具体交通环境场景对共享控制框架进行优化和改进,凡对本申请进行的非实质性的改动,均应属于侵犯本申请保护范围的行为。
Claims (7)
1.一种考虑驾驶员活跃度及驾驶能力的辅助控制器设计方法,其特征在于,包括:
S1:将驾驶员转向模型和车辆动力学模型进行耦合得到驾驶员-车辆-道路耦合动力学模型;
S2:依据驾驶员的驾驶活跃度P3和驾驶能力E,构建人机共享控制权限分配策略;
S3:将人机共享控制权限分配策略耦合到驾驶员-车辆-道路耦合动力学模型中,以构建人机交互模型;
S4:根据模糊控制理论,将人机交互模型转换成4个线性模糊子系统;
S5:根据鲁棒正不变量集,并通过并行分布式状态反馈补偿为每个模糊子系统设计人机共享控制器;
S6:通过人机共享控制器实现车辆的稳定性控制和个性化驾驶。
2.如权利要求1所述的辅助控制器设计方法,其特征在于,所述步骤S1中,驾驶员转向模型表示为:
其中,θnear和θfar都表示虚拟转向角,作为驾驶员转向模型的输入;Kp表示驾驶员对未来道路的预测,Kc表示驾驶员对路径偏差的修正增益,τL表示微分常数,x1表示驾驶员转向模型推导的过程量,τd1表示大脑延时时间,τd2表示手臂肌肉反应时间,δd表示驾驶员转向模型估计出来的驾驶员方向盘转向角,δfd表示将驾驶员方向盘转向角转化成车辆的前轮转角,Rg表示驾驶员方向盘转向角与前轮转角的系数比,且Rg∈[1/20,1/10];
车辆-道路模型为基于二自由度横向车辆动力学模型构建的,则车辆-道路模型表示为:
其中,vx表示相对车速,Av表示车辆的迎风面积,β表示车辆质心侧偏角,γ表示车辆横摆角速度,yL表示车辆侧向误差,φL表示车辆航向角偏差,Cf表示前轮侧偏刚度,Cr表示后轮侧偏刚度,Mz表示绕z轴的惯性矩,m表示车辆质量,lf表示前轴到质心的距离,lr表示后轴到质心的距离,ls表示前视距离,δf表示前轮转向角,ρref表示前方道路曲率。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210274482.4A CN114537419A (zh) | 2022-03-21 | 2022-03-21 | 一种考虑驾驶员活跃度及驾驶能力的辅助控制器设计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210274482.4A CN114537419A (zh) | 2022-03-21 | 2022-03-21 | 一种考虑驾驶员活跃度及驾驶能力的辅助控制器设计方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114537419A true CN114537419A (zh) | 2022-05-27 |
Family
ID=81666377
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210274482.4A Pending CN114537419A (zh) | 2022-03-21 | 2022-03-21 | 一种考虑驾驶员活跃度及驾驶能力的辅助控制器设计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114537419A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115629549A (zh) * | 2022-12-21 | 2023-01-20 | 江苏云幕智造科技有限公司 | 一种根据输入饱和的l2增益鲁棒路径跟踪方法 |
-
2022
- 2022-03-21 CN CN202210274482.4A patent/CN114537419A/zh active Pending
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115629549A (zh) * | 2022-12-21 | 2023-01-20 | 江苏云幕智造科技有限公司 | 一种根据输入饱和的l2增益鲁棒路径跟踪方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107015477B (zh) | 基于状态反馈的车辆路径跟踪h∞控制方法 | |
Hima et al. | Trajectory tracking for highly automated passenger vehicles | |
CN108001447A (zh) | 一种智能车辆路径跟踪前轮转角补偿控制方法 | |
Mo et al. | Interval type-2 fuzzy hierarchical adaptive cruise following-control for intelligent vehicles | |
CN112622903A (zh) | 一种车辆跟随驾驶环境下自主车辆的纵向和横向控制方法 | |
CN113415276A (zh) | 一种智能驾驶预瞄控制方法、装置和存储介质 | |
CN109484407A (zh) | 一种电动汽车辅助驾驶的自适应跟车方法 | |
Khosravani et al. | Application of lexicographic optimization method to integrated vehicle control systems | |
CN111338353A (zh) | 一种动态驾驶环境下智能车辆变道轨迹规划方法 | |
CN110027547B (zh) | 车辆横向控制方法和装置 | |
CN108791290A (zh) | 基于在线增量式dhp的双车协同自适应巡航控制方法 | |
CN113325691A (zh) | 一种无人车双闭环纵向控制方法、系统及设备 | |
CN114537419A (zh) | 一种考虑驾驶员活跃度及驾驶能力的辅助控制器设计方法 | |
Dai et al. | A bargaining game-based human–machine shared driving control authority allocation strategy | |
CN114323698B (zh) | 一种面向人机共驾智能汽车的实车实验平台测试方法 | |
CN118269984A (zh) | 一种考虑驾驶员驾驶习惯的个性化换道轨迹规划方法 | |
CN114889599A (zh) | 一种基于模型预测控制的自适应巡航控制算法 | |
Dong et al. | Autonomous vehicle lateral control based on fractional-order PID | |
CN116540737A (zh) | 一种静态避障场景下考虑驾驶习惯的路径规划与控制方法 | |
CN116331256A (zh) | 分布式驱动电动汽车换道轨迹规划方法、设备及存储介质 | |
Asperti et al. | On Torque Vectoring Control: Review and Comparison of State-of-the-Art Approaches | |
CN115476881B (zh) | 车辆轨迹跟踪控制方法、装置、设备及介质 | |
Chen et al. | Joint Estimation of Driving State and Road Surface Adhesion Coefficient of a Four-Wheel Independent and Steering-Drive Electric Vehicle | |
Zeng et al. | Research on yaw stability control of multi-axle electric vehicle with in-wheel motors based on fuzzy sliding mode control | |
CN113359733B (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 |