CN114475596B - 一种换道场景下保证安全的智能网联队列鲁棒控制方法 - Google Patents
一种换道场景下保证安全的智能网联队列鲁棒控制方法 Download PDFInfo
- Publication number
- CN114475596B CN114475596B CN202210161599.1A CN202210161599A CN114475596B CN 114475596 B CN114475596 B CN 114475596B CN 202210161599 A CN202210161599 A CN 202210161599A CN 114475596 B CN114475596 B CN 114475596B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- follows
- constraint
- queue
- formula
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 59
- 238000006073 displacement reaction Methods 0.000 claims description 47
- 238000004364 calculation method Methods 0.000 claims description 27
- 239000011159 matrix material Substances 0.000 claims description 11
- 238000013461 design Methods 0.000 claims description 8
- 230000001133 acceleration Effects 0.000 claims description 3
- 230000003247 decreasing effect Effects 0.000 claims description 3
- 230000001105 regulatory effect Effects 0.000 claims description 3
- 238000005096 rolling process Methods 0.000 claims description 3
- 230000000452 restraining effect Effects 0.000 claims description 2
- 230000001052 transient effect Effects 0.000 abstract description 2
- 238000012508 change request Methods 0.000 description 2
- 238000004891 communication Methods 0.000 description 2
- 230000008878 coupling Effects 0.000 description 2
- 238000010168 coupling process Methods 0.000 description 2
- 238000005859 coupling reaction Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 239000000446 fuel Substances 0.000 description 1
- 238000003780 insertion Methods 0.000 description 1
- 230000037431 insertion Effects 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 230000006641 stabilisation Effects 0.000 description 1
- 238000011105 stabilization Methods 0.000 description 1
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
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/18—Propelling the vehicle
- B60W30/18009—Propelling the vehicle related to particular drive situations
- B60W30/18163—Lane change; Overtaking manoeuvres
-
- 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
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/14—Adaptive cruise control
- B60W30/16—Control of distance between vehicles, e.g. keeping a distance to preceding vehicle
-
- 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
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
-
- 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
- B60W2050/0001—Details of the control system
- B60W2050/0002—Automatic control, details of type of controller or control system architecture
- B60W2050/0014—Adaptive controllers
-
- 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/0031—Mathematical model of the vehicle
-
- 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/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
本发明提出一种换道场景下保证安全的智能网联队列鲁棒控制方法,包括:步骤1,对新队列中车辆进行重新编号;步骤2,新队列内的车辆规划层生成期望换道路径;步骤3,新队列中的车辆进行基于预设性能的纵向约束跟随控制,通过调整为换道车辆i提供适当的换道间隔;步骤4,换道车辆建立横向误差模型,并进行保证安全的横向约束跟随控制,计算前轮转角;步骤5,队列内的车辆间距稳定到期望车间距后,换道完成。本发明中控制方法将车辆的纵向控制与横向控制解耦,纵向控制采用基于预设性能的约束跟随控制方法,横向控制采用保证安全的约束跟随控制方法,不仅使控制稳定时达到期望的稳态响应,同时对控制过程中的瞬态响应也做了约束,保证安全。
Description
技术领域
本发明涉及智能网联车队技术领域,特别涉及一种换道场景下保证安全的智能网联队列鲁棒控制方法。
背景技术
随着汽车工业的迅速发展,汽车保有量的迅猛增长给高速公路***带来了严峻的挑战。智能网联队列作为智能交通***的重要组成部分,对于解决高速公路车辆拥堵、降低燃油消耗、提高道路通行效率具有重要的意义。
智能网联队列在高速公路行驶过程中是灵活可调整的,不可避免地会面临其他车道上车辆的***,即典型的高速公路换道场景,此时队列的成形控制及队列的稳定性控制尤为重要。队列的成型控制主要解决换道车辆如何安全、平稳地换入目标队列,队列的稳定性控制主要解决换道后的新队列如何按照期望的车间距与轨迹稳定行驶。根据控制方式的不同,上述问题也可归结为换道过程中所有参与车辆的纵向控制与横向控制问题。
然后,目前常用的换道场景下的智能网联车辆纵横向控制算法大多将换道过程建模为一个基于动力学模型的优化问题,只能保证换道车辆尽量跟踪设定的换道轨迹,以及换道结束新队列最终达到期望的车间距,并没有考虑整个换道过程中的车辆严格避撞安全,以及换道时机等问题。
发明内容
本发明提出一种能够解决高速公路换道场景下智能网联队列控制方法存在问题的保证安全的智能网联队列鲁棒控制方法。
本发明旨在提供一种换道场景下保证安全的智能网联队列鲁棒控制方法,其特征在于,所述换道场景下保证安全的智能网联队列鲁棒控制方法包括以下步骤:
步骤1,换道车辆请求换入到目标队列中,对新队列中车辆进行重新编号;
步骤2,新队列内的车辆获取自身及前车的状态信息,依据这些信息规划层生成期望换道路径;
步骤3,新队列中的车辆进行基于预设性能的纵向约束跟随控制,通过调整为换道车辆i提供适当的换道间隔,最终队列中的车间距达到期望车间距;
步骤4,换道车辆建立横向误差模型,并进行保证安全的横向约束跟随控制,计算前轮转角,并最终跟随期望的换道路径;
步骤5,换道车辆换入目标队列,并且队列内的车辆间距稳定到期望车间距后,换道完成;
在步骤1中,换道车辆的编号为i,其前后两辆车的编号分别为i-1,i+1,新队列内车辆从前到后依次编号为{1,2,3,…,N};
在步骤4中,横向误差模型如下:
ξ1,ξ2,ξ3,ξ4,ξ5,ξ6,ξ7,ξ8,ξ9,ξ10计算公式如下:
ξ3=ω4ξ4=-ω4DL+ω5
其中,vx,vy为的纵向、横向速度,DL为预瞄距离,KL为期望轨迹的曲率,ω1~ω6为模型参数,由下式计算:
式中,Mi为车辆质量,Cf,Cr分别为前后轮胎的侧偏刚度,lf,lr分别为质心到前、后轴的距离,Iz为车辆绕z轴的转动惯量。
更进一步地,在步骤3中,还包括以下步骤:
步骤31,建立车辆三阶非线性纵向动力学模型,计算纵向跟随误差;
步骤3.2,建立基于预设性能的跟随误差不等式约束;
步骤3.3,采用一种连续可微的双射函数将有界的跟随误差转换到无界的状态空间;
步骤3.4,建立跟随误差的等式约束,使车辆间距经过调整稳定后达到期望车间距;
步骤3.5、基于约束跟随控制的思想,设计纵向控制输入使得跟随误差满足步骤3.3与步骤3.4中的约束。
更进一步地,在步骤3.1中,建立换道车辆i第三阶非线性纵向动力学模型如下:
式中,t为时间,xi,vi,ai分别为第i辆车的位置、速度与加速度;Mi为车辆质量;为空气阻力;Fi为行驶阻力,包括滚动阻力、坡度阻力等;ui,in为驱动/制动***的输入力;τi为驱动/制动***的惯性滞后。
第i辆车的纵向跟随误差ei(t)计算公式为:
ei(t)=dd-di(t)
式中,dd为期望车间距,根据恒定车头时距的间距策略设置为其中hi为车头时距,dc为相邻两车停车时的最小安全间距;di为第i辆车的实际车间距,可根据第i-1辆车的位置xi-1、第i辆车的位置xi与第i-1辆车的车长li-1计算得到,di=xi-1-xi-li-1。
更进一步地,在步骤3.2中,预设性能的跟随误差不等式约束如下:
ciρi(t)<ei(t)<biρi(t)
式中,ci,bi为可调参数,满足:
更进一步地,在步骤3.3中,双射函数为:
fi(ei/ρi):zi(t)=λ0,itan(λ1,i·ei/ρi+λ2,i)+λ3,i
式中,λ0,i为可调参数,λ1,i=π/(bi-ci),λ2,i=-π(ci+bi)/(2bi-2ci),λ3,i=1/λ0,i·tan(π(ci+bi)/(2bi-2ci));
在步骤3.4中,设计等式约束的形式如下:
新状态变量zi(t)的等式约束如下:
式中,pi为可调参数,pi越大跟随误差ei(t)收敛速度越快。
更进一步地,在步骤3.5中,
式中,hi为车头时距;φ1,Φ2无物理意义,分别由下式计算:
式中,κ为可调比例反馈系数。对第i辆车施加ui,in的驱动、制动输入,即可使得车辆在整个换道过程中跟随误差在预设性能指定区域内变化,保证安全,并在最终收敛到零,此时车间距稳定到期望车间距。
更进一步地,在步骤4中,还包括以下步骤:
步骤4.1,建立车辆二自由度横向动力学模型,计算横向位移偏差与航向角偏差,将其转换为横向误差模型;
步骤4.2,建立保证安全的横向位移偏差不等式约束;
步骤4.3、建立横向位移偏差与航向角偏差的等式约束,使车辆横向位移与航向角最终稳定后达到期望横向位移与期望横摆角;
步骤4.4、基于约束跟随控制的思想,设计横向控制输入使得横向位移偏差与航向角偏差满足步骤4.2与步骤4.3中的约束。
更进一步地,在步骤4.2中,保证安全的横向位移偏差不等式约束如下:
eymin≤ey(t)≤eumax
式中,eymin,eymax分别为横向位移偏差允许的最小值与最大值;
采用连续可微双射函数fy(·)将有界的横向位移偏差ey(t)转换得到新的状态变量zy(t):
fy(ey):zy(t)=η0tan(η1·ey+η2)+η3
式中,η0为可调参数,其他参数的计算公式如下:
η1=π/(eymax-eymin)
η2=-π(eymin+eymax)/(2eymax-2eymin)
η3=1/η0·tan(π(eymin+eymax)/(2eymax-2eymin))
设计横向控制输入δ让新的状态变量zy(t)满足一致有界性,即可将横向位移偏差ey(t)约束在不等式约束构成的安全区域内;
在步骤4.3中,等式约束的如下:
式中,Q,Y为系数矩阵,其计算公式为:
更进一步地,在步骤4.4中,横向控制输入δ由模型约束力δc与比例反馈控制力δf组成,如下所示:
δ=δc+δf
模型约束力δc的计算公式如下:
比例反馈控制力δf的计算公式如下:
式中,κy为可调比例反馈系数。
本发明达到的有益效果是:
本发明中车队控制方法将车辆的纵向控制与横向控制解耦,纵向控制采用基于预设性能的约束跟随控制方法,横向控制采用保证安全的约束跟随控制方法,不仅使控制稳定时达到期望的稳态响应,同时对控制过程中的瞬态响应也做了约束,保证安全。
本发明中纵向控制建立了考虑驱动、制动***响应滞后的车辆三阶纵向动力学模型,相比现有控制方法中的车辆二阶模型,更符合实际的车辆纵向动力学。
本发明中纵向控制在约束跟随控制思想上引入了预设性能,预设性能的初始值可根据当前车间距进行设置,适应任意初始车辆间距下的纵向控制。
本发明中纵向控制采用基于预设性能的约束跟随控制,可保证车间距动态调整过程中始终在预设性能设定的安全区域内变化,保证纵向严格避撞,并在最终达到期望车间距,收敛速度可通过调节参数控制。
本发明中横向控制采用保证安全的约束跟随控制,可保证横向位移在期望路径附近一个安全区域内变化,不超出一个车道宽度,保证横向严格避撞。并在最终达到期望的横向位移和航向角,收敛速度可通过调节参数控制。
附图说明
图1是本发明实施例提供的一种换道场景下保证安全的智能网联队列鲁棒控制方法中换道车辆与目标队列的位置示意图;
图2是本发明实施例提供的一种换道场景下保证安全的智能网联队列鲁棒控制方法的流程示意图;
图3是本发明实施例提供的一种换道场景下保证安全的智能网联队列鲁棒控制方法中预设性能下跟随误差响应区域及响应曲线示例;
图4是本发明实施例提供的一种换道场景下保证安全的智能网联队列鲁棒控制方法中换道过程横向位移不等式约束限定的车辆安全区域示意图。
具体实施方式
下面结合附图对本发明的技术方案进行更详细的说明,本发明包括但不仅限于下述实施例。
如附图1所示,高速公路换道场景下参与换道过程的所有车辆的控制目标是:当换道车辆确定要换入队列的位置后,即开始换道前,目标队列中其后的车辆需要减速,为换道车辆产生一个适当的换道间隔;换道中和换道后队列的间距需要在一个合适的范围内变化并最终达到期望的车间距;同时所有车辆的横向位移需要在期望轨迹附近一个合适的范围内变化;从而实现避撞,保证安全。以下实例给出一种满足上述目标的车辆纵横向控制方法。
考虑一种常见的车辆换道汇入目标队列的具体情形,包含一条在目标车道上行驶的N-1辆车组成的队列,队列内车辆从前到后依次编号为{1,2,3,…,N-1},相邻车道上有两辆准备换道的车辆A与B,A车先于B车发出换道请求。车辆之间采用前继跟随(PF,predecessor following)拓扑的V2V通信技术,即相邻车辆之间为单向通信,前车可将其状态信息发送给紧随其后的车辆。
以下实施方式为针对A车发动换道请求时A车与原队列中车辆的纵横向控制方法,A车换道过程结束后,B车开始换道,后续换道车辆以此类推。
如附图2所示,本发明提供了一种换道场景下保证安全的智能网联队列鲁棒控制方法,控制方法流程如下:
步骤1、换道车辆A在某一位置发送换道请求,确定换入到目标队列中的位置,此时队列中车辆进行重新编号,设换道车辆A的编号为i,其前后两辆车的编号分别为i-1,i+1,新队列内车辆从前到后依次编号为{1,2,3,…,N}。
步骤2、根据前继跟随拓扑的V2V通信技术,队列内的车辆获取自身及前车的状态信息,依据这些信息设计控制率。换道车辆i以当前发出换道合流请求为原点,由规划层生成一条期望换道路径ydes=f1(x),
如附图3所示,步骤3、队列中的车辆根据当前车间距,进行基于预设性能的纵向约束跟随控制,计算其驱动、制动***的输入力。通过调整为换道车辆i提供适当的换道间隔,调整过程中车间距始终在预设性能设定的安全区域内变化,从而实现严格避撞,最终队列中的车间距达到期望车间距。
具体的,步骤3又可分为以下步骤:
步骤3.1、建立车辆三阶非线性纵向动力学模型,计算纵向跟随误差。
以第i辆车为例,考虑驱动和制动***延迟,将其简化为一阶惯性环节,建立三阶非线性纵向动力学模型如下:
式中,t为时间,xi,vi,ai分别为第i辆车的位置、速度与加速度;Mi为车辆质量;为空气阻力;Fi为行驶阻力,包括滚动阻力、坡度阻力等;ui,in为驱动/制动***的输入力;τi为驱动/制动***的惯性滞后。
第i辆车的纵向跟随误差ei(t)计算公式为:
ei(t)=dd-di(t)
式中,dd为期望车间距,根据恒定车头时距的间距策略设置为其中hi为车头时距,dc为相邻两车停车时的最小安全间距;di为第i辆车的实际车间距,可根据第i-1辆车的位置xi-1、第i辆车的位置xi与第i-1辆车的车长li-1计算得到,di=xi-1-xi-li-1。
步骤3.2、建立基于预设性能的跟随误差不等式约束,公式如下:
ciρi(t)<ei(t)<biρi(t)
式中,ci,bi为可调参数,满足:
fi(ei/ρi):zi(t)=λ0,itan(λ1,i·ei/ρi+λ2,i)+λ3,i
式中,λ0,i为可调参数,λ1,i=π/(bi-ci),λ2,i=-π(ci+bi)/(2bi-2ci),λ3,i=1/λ0,i·tan(π(ci+bi)/(2bi-2ci))。设计纵向控制输入ui,in让新的状态变量zi(t)满足一致有界性,即可将纵向跟随误差ei(t)约束在预设性能构成的安全区域内。
步骤3.4、建立跟随误差ei(t)的等式约束,使车辆间距di经过调整稳定后达到期望车间距dd,即跟随误差ei(t)最终要收敛到0。为了提高乘坐舒适性,设计等式约束的形式如下:
式中,pi为可调参数,pi越大,跟随误差ei(t)收敛速度越快。
根据双射函数满足的条件可知,新的状态变量zi(t)的单调性与跟随误差ei(t)相同,且当ei(t)收敛到0时,zi(t)也收敛到0。因此得到基于新状态变量zi(t)的等式约束如下:
步骤3.5、基于约束跟随控制的思想,设计纵向控制输入ui,in使得跟随误差ei(t)满足步骤3.3与步骤3.4中的不等式约束与等式约束。纵向控制输入ui,in由基于UK(Udwadia-Kalaba)方法的模型约束力与基于约束跟随误差的比例反馈控制力/>组成,如下所示:
式中,hi为车头时距;φ1,φ2无物理意义,分别由下式计算:
式中,κ为可调比例反馈系数。对第i辆车施加ui,in的驱动、制动输入,即可使得车辆在整个换道过程中跟随误差在预设性能指定区域内变化,保证安全,并在最终收敛到零,此时车间距稳定到期望车间距。
如附图4所示,步骤4、队列内的车辆进行保证安全的横向约束跟随控制,计算前轮转角。以换道车辆i为例,其横向位置在控制过程中应始终在期望路径附近一个安全区域内变化,并最终跟随期望的换道路径。
具体的,步骤4又可分为以下步骤:
步骤4.1、建立车辆二自由度横向动力学模型,计算横向位移偏差与航向角偏差,将其转换为横向误差模型。
以第i辆车为例,建立车辆二自由度横向动力学模型如下:
式中,m为第i辆车的质量,vx,vy为的纵向、横向速度,为航向角,Cf,Cr分别为前后轮侧偏刚度,lf,lr分别为质心到前、后轴的距离,δ为前轮转角,Iz为车辆绕z轴的转动惯量,ω1~ω6为模型参数,由下式计算:
式中,X为状态矩阵,A,B,C,g为系数矩阵,计算公式如下:
ξ1,ξ2,ξ3,ξ1,ξ5,ξ6,ξ7,ξ8,ξ9,ξ10无物理意义,具体计算公式如下:
ξ3=ω4ξ4=-ω4DL+ω5
步骤4.2、建立保证安全的横向位移偏差不等式约束如下:
eymin≤ey(t)≤eymax
式中,eymin,eymax分别为横向位移偏差允许的最小值与最大值。该不等式约束可以保证车辆行驶过程中在期望轨迹附近一个车道宽度的安全区域内变化,如附图4所示,从而实现横向避撞,保证安全。
采用同步骤3.3中相似的连续可微双射函数fy(·)将有界的横向位移偏差ey(t)转换到无界的状态空间,得到新的状态变量zy(t)。选用如下形式的双射函数:
fy(ey):zy(t)=η0tan(η1·ey+η2)+η3
式中,η0为可调参数,其他参数的计算公式如下:
η1=π/(eymax-eymin)
η2=-π(eymin+eymax)/(2eymax-2eymin)
η3=1/η0·tan(π(eymin+eymax)/(2eymax-2eymin))
设计横向控制输入δ让新的状态变量zy(t)满足一致有界性,即可将横向位移偏差ey(t)约束在不等式约束构成的安全区域内。
步骤4.3、建立横向位移偏差ey(t)与航向角偏差的等式约束,使车辆横向位移y与航向角/>最终稳定后达到期望横向位移ydes与期望横摆角/>即ey,/>最终要收敛到0。为了提高乘坐舒适性,设计等式约束的形式如下:
根据双射函数的性质可知,新的状态变量zy(t)的单调性与横向位移误差ey(t)相同,且当ey(t)收敛到0时,zy(t)也收敛到0。因此得到基于新状态变量zy(t)的等式约束及其矩阵形式如下:
Q,Y为系数矩阵,无实际物理意义,其计算公式为:
步骤4.4、基于约束跟随控制的思想,设计横向控制输入δ使得横向位移偏差ey(t)与航向角偏差满足步骤4.2与步骤4.3中的不等式约束与等式约束。横向控制输入δ由基于UK(Udwadia-Kalaba)方法的模型约束力δc与基于约束跟随误差的比例反馈控制力δf组成,如下所示:
δ=δc+δf
基于UK方法的模型约束力δc的计算公式如下:
基于约束跟随误差的比例反馈控制力δf的计算公式如下:
式中,κy为可调比例反馈系数。对第i辆车施加δ的前轮转角,即可使得车辆在整个换道过程中横向位移偏差在期望轨迹附近一个车道宽度的范围内变化,保证安全,横向位移偏差和横摆角偏差在最终收敛到零,此时车辆跟随规划的期望换道路径行驶。
步骤5、判断换道车辆A是否完成换道过程,当A换入目标队列,并且队列内的车辆间距稳定到期望车间距后,A车换道完成,继而开始B车的换道过程。
本发明不仅局限于上述具体实施方式,本领域一般技术人员根据实施例和附图公开内容,可以采用其它多种具体实施方式实施本发明,因此,凡是采用本发明的设计结构和思路,做一些简单的变换或更改的设计,都落入本发明保护的范围。
Claims (9)
1.一种换道场景下保证安全的智能网联队列鲁棒控制方法,其特征在于,所述换道场景下保证安全的智能网联队列鲁棒控制方法包括以下步骤:
步骤1,换道车辆请求换入到目标队列中,对新队列中车辆进行重新编号;
步骤2,新队列内的车辆获取自身及前车的状态信息,依据这些信息规划层生成期望换道路径;
步骤3,新队列中的车辆进行基于预设性能的纵向约束跟随控制,通过调整为换道车辆i提供适当的换道间隔,最终队列中的车间距达到期望车间距;
步骤4,换道车辆建立横向误差模型,并进行保证安全的横向约束跟随控制,计算前轮转角,并最终跟随期望的换道路径;
步骤5,换道车辆换入目标队列,并且队列内的车辆间距稳定到期望车间距后,换道完成;
在步骤1中,换道车辆的编号为i,其前后两辆车的编号分别为i-1,i+1,新队列内车辆从前到后依次编号为{1,2,3,…,N};
在步骤4中,横向误差模型如下:
ξ1,ξ2,ξ3,ξ1,ξ5,ξ6,ξ7,ξ8,ξ9,ξ10计算公式如下:
ξ3=ω4ξ4=-ω4DL+ω5
其中,vx,vy为的纵向、横向速度,DL为预瞄距离,KL为期望轨迹的曲率,ω1~ω6为模型参数,由下式计算:
式中,Mi为车辆质量,Cf,Cr分别为前后轮胎的侧偏刚度,lf,lr分别为质心到前、后轴的距离,Iz为车辆绕z轴的转动惯量。
2.根据权利要求1所述换道场景下保证安全的智能网联队列鲁棒控制方法,其特征在于,在步骤3中,还包括以下步骤:
步骤31,建立车辆三阶非线性纵向动力学模型,计算纵向跟随误差;
步骤3.2,建立基于预设性能的跟随误差不等式约束;
步骤3.3,采用一种连续可微的双射函数将有界的跟随误差转换到无界的状态空间;
步骤3.4,建立跟随误差的等式约束,使车辆间距经过调整稳定后达到期望车间距;
步骤3.5、基于约束跟随控制的思想,设计纵向控制输入使得跟随误差满足步骤3.3与步骤3.4中的约束。
3.根据权利要求2所述换道场景下保证安全的智能网联队列鲁棒控制方法,其特征在于,在步骤3.1中,建立换道车辆i第三阶非线性纵向动力学模型如下:
式中,t为时间,xi,vi,ai分别为第i辆车的位置、速度与加速度;Mi为车辆质量;为空气阻力;Fi为行驶阻力,包括滚动阻力、坡度阻力等;ui,in为驱动/制动***的输入力;τi为驱动/制动***的惯性滞后;
第i辆车的纵向跟随误差ei(t)计算公式为:
ei(t)=dd-di(t)
7.根据权利要求1所述换道场景下保证安全的智能网联队列鲁棒控制方法,其特征在于,在步骤4中,还包括以下步骤:
步骤4.1,建立车辆二自由度横向动力学模型,计算横向位移偏差与航向角偏差,将其转换为横向误差模型;
步骤4.2,建立保证安全的横向位移偏差不等式约束;
步骤4.3、建立横向位移偏差与航向角偏差的等式约束,使车辆横向位移与航向角最终稳定后达到期望横向位移与期望横摆角;
步骤4.4、基于约束跟随控制的思想,设计横向控制输入使得横向位移偏差与航向角偏差满足步骤4.2与步骤4.3中的约束。
8.根据权利要求7所述换道场景下保证安全的智能网联队列鲁棒控制方法,其特征在于,在步骤4.2中,保证安全的横向位移偏差不等式约束如下:
eymin≤ey(t)≤eymax
式中,eymin,eymax分别为横向位移偏差允许的最小值与最大值;
采用连续可微双射函数fy(·)将有界的横向位移偏差ey(t)转换得到新的状态变量zy(t):
fy(ey):zy(t)=η0tan(η1·ey+η2)+η3
式中,η0为可调参数,其他参数的计算公式如下:
η1=π/(eymax-eymin)
η2=-π(eymin+eymax)/(2eymax-2eymin)
η3=1/η0·tan(π(eymin+eymax)/(2eymax-2eymin))
设计横向控制输入δ让新的状态变量zy(t)满足一致有界性,即可将横向位移偏差ey(t)约束在不等式约束构成的安全区域内;
在步骤4.3中,等式约束的如下:
式中,Q,Y为系数矩阵,其计算公式为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210161599.1A CN114475596B (zh) | 2022-02-22 | 2022-02-22 | 一种换道场景下保证安全的智能网联队列鲁棒控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210161599.1A CN114475596B (zh) | 2022-02-22 | 2022-02-22 | 一种换道场景下保证安全的智能网联队列鲁棒控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114475596A CN114475596A (zh) | 2022-05-13 |
CN114475596B true CN114475596B (zh) | 2023-06-20 |
Family
ID=81482538
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210161599.1A Active CN114475596B (zh) | 2022-02-22 | 2022-02-22 | 一种换道场景下保证安全的智能网联队列鲁棒控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114475596B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114694384B (zh) * | 2022-05-18 | 2023-03-24 | 厦门金龙联合汽车工业有限公司 | 一种智能网联的车辆编队安全策略设计方法 |
CN115273450B (zh) * | 2022-08-19 | 2023-10-17 | 北京航空航天大学 | 一种网联自动驾驶环境下车辆进入编队的换道方法 |
CN116311867B (zh) * | 2023-01-18 | 2024-03-19 | 东南大学 | 一种基于智能网联车队列控制的多车协同换道方法 |
CN116118822B (zh) * | 2023-04-13 | 2023-07-28 | 江西科骏实业有限公司 | 一种列车编组运行时的主动避碰控制方法、***及介质 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005335588A (ja) * | 2004-05-27 | 2005-12-08 | Nissan Motor Co Ltd | ドライバモデルおよび同モデルを備えた車両挙動制御システムのアシスト機能評価装置 |
CN109606363A (zh) * | 2018-11-19 | 2019-04-12 | 江苏大学 | 一种多状态反馈的智能汽车可拓车道保持控制方法 |
CN111123701A (zh) * | 2019-11-27 | 2020-05-08 | 武汉理工大学 | 基于管道预测模型的自动驾驶路径跟踪抗干扰控制方法 |
CN111746539A (zh) * | 2020-07-02 | 2020-10-09 | 清华大学 | 一种智能网联汽车严格安全换道入队控制方法 |
CN112092815A (zh) * | 2020-09-02 | 2020-12-18 | 北京航空航天大学 | 一种基于模型预测的车辆换道轨迹跟踪控制方法 |
CN112859869A (zh) * | 2021-01-20 | 2021-05-28 | 中车青岛四方机车车辆股份有限公司 | 一种车辆路径跟踪方法、装置、控制器、车辆和介质 |
CN113009829A (zh) * | 2021-02-25 | 2021-06-22 | 清华大学 | 一种智能网联车队纵横向耦合控制方法 |
CN113515038A (zh) * | 2021-09-07 | 2021-10-19 | 西南交通大学 | 一种车辆换道方法、装置、设备及可读存储介质 |
CN113848942A (zh) * | 2021-10-18 | 2021-12-28 | 青岛德智汽车科技有限公司 | 一种约束导向的智能网联汽车鲁棒换道合流控制方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8190330B2 (en) * | 2009-03-06 | 2012-05-29 | GM Global Technology Operations LLC | Model based predictive control for automated lane centering/changing control systems |
-
2022
- 2022-02-22 CN CN202210161599.1A patent/CN114475596B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005335588A (ja) * | 2004-05-27 | 2005-12-08 | Nissan Motor Co Ltd | ドライバモデルおよび同モデルを備えた車両挙動制御システムのアシスト機能評価装置 |
CN109606363A (zh) * | 2018-11-19 | 2019-04-12 | 江苏大学 | 一种多状态反馈的智能汽车可拓车道保持控制方法 |
CN111123701A (zh) * | 2019-11-27 | 2020-05-08 | 武汉理工大学 | 基于管道预测模型的自动驾驶路径跟踪抗干扰控制方法 |
CN111746539A (zh) * | 2020-07-02 | 2020-10-09 | 清华大学 | 一种智能网联汽车严格安全换道入队控制方法 |
CN112092815A (zh) * | 2020-09-02 | 2020-12-18 | 北京航空航天大学 | 一种基于模型预测的车辆换道轨迹跟踪控制方法 |
CN112859869A (zh) * | 2021-01-20 | 2021-05-28 | 中车青岛四方机车车辆股份有限公司 | 一种车辆路径跟踪方法、装置、控制器、车辆和介质 |
CN113009829A (zh) * | 2021-02-25 | 2021-06-22 | 清华大学 | 一种智能网联车队纵横向耦合控制方法 |
CN113515038A (zh) * | 2021-09-07 | 2021-10-19 | 西南交通大学 | 一种车辆换道方法、装置、设备及可读存储介质 |
CN113848942A (zh) * | 2021-10-18 | 2021-12-28 | 青岛德智汽车科技有限公司 | 一种约束导向的智能网联汽车鲁棒换道合流控制方法 |
Non-Patent Citations (7)
Title |
---|
An Improved Kinematic Model Predictive Control for High-Speed Path Tracking of Autonomous Vehicles;Luqi Tang;《IEEE Access》;全文 * |
基于模型预测控制的自动驾驶汽车跟踪控制方法研究;钟思祺;《中国优秀硕士学位论文全文数据库 (工程科技Ⅱ辑)》;全文 * |
基于模型预测控制的车辆轨迹跟踪稳定性研究;宋晓华;邵毅明;屈治华;束海波;;重庆理工大学学报(自然科学)(第08期);全文 * |
有界变参数车道保持准滑模控制;任殿波;崔胜民;张京明;张继业;;北京理工大学学报(第01期);全文 * |
自动驾驶汽车局部路径规划与横向控制算法研究;张永林;《中国优秀硕士学位论文全文数据库 (工程科技Ⅱ辑)》;全文 * |
自动驾驶车辆轨迹跟踪横向偏差影响因素研究;胡正云等;《安徽理工大学学报》;全文 * |
车道保持预瞄控制及其稳态误差分析;任殿波;崔胜民;吴杭哲;;汽车工程(第02期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN114475596A (zh) | 2022-05-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN114475596B (zh) | 一种换道场景下保证安全的智能网联队列鲁棒控制方法 | |
US11364895B2 (en) | Yaw motion control method for four-wheel distributed vehicle | |
CN107738644B (zh) | 一种车辆避碰控制方法 | |
CN110286681B (zh) | 一种变曲率弯道的动态自动驾驶换道轨迹规划方法 | |
CN109969183A (zh) | 基于安全可控域的弯道跟车控制方法 | |
CN108447266A (zh) | 一种智能网联汽车协同换道入队控制方法 | |
CN108973769B (zh) | 一种全线控电动汽车路径跟踪控制方法 | |
CN109976159A (zh) | 基于安全可控域的智能车辆横向控制方法 | |
CN112660124B (zh) | 一种用于换道场景的协同自适应巡航控制方法 | |
CN112051851B (zh) | 极限工况下电动四驱车辆的自主漂移控制方法及*** | |
WO2007074716A1 (ja) | 車両の制御装置 | |
CN113009829B (zh) | 一种智能网联车队纵横向耦合控制方法 | |
CN114312848B (zh) | 基于双层mpc的智能驾驶汽车轨迹规划与跟踪控制方法 | |
CN111081069B (zh) | 一种高速公路瓶颈区域的车辆轨迹控制方法 | |
CN113002528A (zh) | 四轮轮毂电机驱动电动汽车稳定性协调控制方法和*** | |
CN113183950A (zh) | 一种电动汽车主动前轮转向的自适应控制方法 | |
CN110703775B (zh) | 一种基于改进人工势场的商用车车道保持路径规划方法 | |
Liu et al. | Trajectory tracking control of four wheel steering under high speed emergency obstacle avoidance | |
Baumann et al. | Model-based corner braking control for electric motorcycles | |
CN106672072A (zh) | 一种用于线控转向汽车主动前轮转向控制***的控制方法 | |
CN108594830A (zh) | 一种基于空间域的网联智能车编队行驶控制方法 | |
CN110968911B (zh) | 一种基于新型趋近律的汽车abs滑模控制器设计方法 | |
CN110162045B (zh) | 一种基于自适应三步法的卡车编队行驶跟随车控制方法 | |
CN115042770B (zh) | 一种基于分布式鲁棒模型预测的车辆队列横向控制方法 | |
Chen et al. | Coupled longitudinal and lateral control for trajectory tracking of autonomous vehicle based on LTV-MPC approach |
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 |