CN108422998A - 一种车道偏离辅助控制系统及方法 - Google Patents
一种车道偏离辅助控制系统及方法 Download PDFInfo
- Publication number
- CN108422998A CN108422998A CN201810208880.XA CN201810208880A CN108422998A CN 108422998 A CN108422998 A CN 108422998A CN 201810208880 A CN201810208880 A CN 201810208880A CN 108422998 A CN108422998 A CN 108422998A
- Authority
- CN
- China
- Prior art keywords
- information
- vehicle
- deviation
- driver
- auxiliary control
- 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
- 238000000034 method Methods 0.000 title claims abstract description 44
- 238000004458 analytical method Methods 0.000 claims description 7
- 230000003321 amplification Effects 0.000 claims description 4
- 238000003384 imaging method Methods 0.000 claims description 4
- 238000003199 nucleic acid amplification method Methods 0.000 claims description 4
- 230000008569 process Effects 0.000 claims description 2
- 230000035484 reaction time Effects 0.000 claims description 2
- 230000008901 benefit Effects 0.000 abstract description 4
- 230000004044 response Effects 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 206010039203 Road traffic accident Diseases 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000013178 mathematical model Methods 0.000 description 1
- 239000000203 mixture Substances 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
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/10—Path keeping
- B60W30/12—Lane keeping
-
- 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
- B60W10/00—Conjoint control of vehicle sub-units of different type or different function
- B60W10/20—Conjoint control of vehicle sub-units of different type or different function including control of steering systems
-
- 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
-
- 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/08—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 drivers or passengers
-
- 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
- B60W40/105—Speed
-
- 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
- B60W50/14—Means for informing the driver, warning the driver or prompting a driver intervention
-
- 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
-
- 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/0003—In analogue systems, e.g. continuous systems
-
- 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
- B60W50/14—Means for informing the driver, warning the driver or prompting a driver intervention
- B60W2050/143—Alarm means
-
- 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
- B60W2510/00—Input parameters relating to a particular sub-units
- B60W2510/20—Steering systems
- B60W2510/202—Steering torque
-
- 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
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/10—Longitudinal speed
-
- 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
- B60W2555/00—Input parameters relating to exterior conditions, not covered by groups B60W2552/00, B60W2554/00
- B60W2555/60—Traffic rules, e.g. speed limits or right of way
-
- 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
- B60W2710/00—Output or target parameters relating to a particular sub-units
- B60W2710/20—Steering systems
-
- 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
- B60W2720/00—Output or target parameters relating to overall vehicle dynamics
- B60W2720/10—Longitudinal speed
Landscapes
- Engineering & Computer Science (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Human Computer Interaction (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
本发明提供一种车道偏离辅助控制系统及方法,系统包括依次通信连接的感知模块、辅助决策模块、自抗扰控制器模块以及执行模块。本发明将将自抗扰控制器(ADRC)引入车道偏离辅助控制系统及控制方法中,能够实时估计并补偿系统运行时受到的各种“外扰”和“内扰”的总和作用,并结合特殊的非线性反馈结构实现良好的控制品质,具有超调小、响应快、精度高、抗干扰能力强等优点。本发明结合车道偏离信息和驾驶员的驾驶状态进行判断,优化辅助决策控制方案,能够有效提高车道偏离辅助控制的准确性和有效性。
Description
技术领域
本发明涉及汽车技术领域,尤其涉及一种车道偏离辅助控制系统及方法。
背景技术
车道偏离辅助系统作为横向的驾驶员辅助系统之一,能有效地阻止车辆在高速驾驶时偏出车道,从而有效预防由于车道偏离所导致的交通事故的发生。
现有的车道偏离辅助控制器主要采用经典的PID控制器实现,具有控制策略简单的优点,但由于经典PID控制器需要对控制对象建立精确的数学模型,且抗干扰能力不足,因此对无法建立精确模型的控制系统适用性不强。
发明内容
为了解决现有技术中存在的上述技术缺陷,本发明提供一种基于自抗扰控制器(ADRC)的车道偏离辅助控制系统及方法。
本发明是通过以下技术方案实现的:
一种车道偏离辅助控制系统,包括依次通信连接的感知模块、辅助决策模块、自抗扰控制器模块以及执行模块,其中:
感知模块:用于采集车道信息和车辆信息;其中,所述车道信息包括道路信息以及车辆位置信息;所述车辆信息包括车速信息、横摆角速度信息、转向灯信息以及方向盘转矩信息。
辅助决策模块:包括车道偏离识别子模块、驾驶员状态识别子模块以及决策生成子模块;其中,所述车道偏离识别子模块用于根据所述车道信息和车辆信息实时识别车辆是否偏离车道,获得相应的偏离信息;所述驾驶员状态识别子模块用于根据所述车辆信息实时识别驾驶员当前状态;所述决策生成子模块用于根据所述偏离信息和驾驶员当前状态分析计算获得辅助决策信息;其中,所述偏离信息包括三种:车道未偏离;车道偏离,启动预警;车道偏离,可以启动辅助控制;所述驾驶员当前状态包括三种:主动操纵状态、紧急操纵车辆状态、未操纵车辆状态。
自抗扰控制器模块:用于根据所述辅助决策信息生成控制纠正车辆行驶姿态的辅助控制指令。
执行模块:用于根据所述辅助控制指令对车辆执行转向及行驶速度调控。
一种车道偏离辅助控制方法,包括以下步骤:
步骤S1,实时采集车道信息和车辆信息。
其中,所述车道信息包括道路信息以及车辆位置信息;所述车辆信息包括车速信息、横摆角速度信息、转向灯信息以及方向盘转矩信息。
步骤S2,根据所述车道信息和车辆信息实时识别车辆是否偏离车道,获得相应的偏离信息;根据所述车辆信息实时识别驾驶员当前状态;根据所述偏离信息和驾驶员当前状态分析计算获得辅助决策信息。
其中,所述偏离信息包括三种:车道未偏离;车道偏离,启动预警;车道偏离,可以启动辅助控制;所述驾驶员当前状态包括三种:主动操纵状态、紧急操纵车辆状态、未操纵车辆状态。
步骤S3,利用自抗扰控制器(ADRC)根据所述辅助决策信息生成控制纠正车辆行驶姿态的辅助控制指令。
步骤S4,根据所述辅助控制指令对车辆执行转向及行驶速度调控。
本发明相对于现有技术的有益效果在于:
1、将自抗扰控制器(ADRC)引入车道偏离辅助控制系统及控制方法中,能够实时估计并补偿系统运行时受到的各种“外扰”和“内扰”的总和作用,并结合特殊的非线性反馈结构实现良好的控制品质,具有超调小、响应快、精度高、抗干扰能力强等优点。
2、结合车道偏离信息和驾驶员的驾驶状态进行判断,优化辅助决策控制方案,能够有效提高车道偏离辅助控制的准确性和有效性。
附图说明
图1为实施例1车道偏离辅助控制系统的整体结构框图。
图2为自抗扰控制器模块实现路径规划的总流程图。
图3为实施例2车道偏离辅助控制方法的总流程图。
图4为实现车道偏离辅助控制的总流程图。
图5为车道偏离辅助控制的结果示意图。
在所有附图中,相同的附图标记用来表示相同的元件或结构,包括:
感知模块1、图像传感器11、车身传感器12、转向盘扭矩传感器13、辅助决策模块2、车道偏离识别子模块21、驾驶员状态识别子模块22、决策生成子模块23、自抗扰控制器模块3、自抗扰控制器31、执行模块4、电动助力转向控制器41、阻力电机42。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施方式仅仅用以解释本发明,并不用于限定本发明。
实施例1:
如图1所示,一种车道偏离辅助控制系统,包括依次通信连接的感知模块1、辅助决策模块2、自抗扰控制器模块3以及执行模块4。
其中:
感知模块1:用于采集车道信息和车辆信息;其中,车道信息包括道路信息以及车辆位置信息。道路信息包括:道路宽度、道路中心与车辆纵向轴线的距离,车辆位置信息包括:左前轮到相应道路边界的位置、右前轮到相应道路边界的位置。车辆信息包括车速信息、横摆角速度信息、转向灯信息以及方向盘转矩信息。
在具体应用中,感知模块1具体进一步包括以下设备:
图像传感器11:用于获取车辆前方道路信息。在实际应用中可选用型号为YCS-21的CCD笔筒式摄像头。
车身传感器12:用于获取车速信息、横摆角速度信息。在实际应用中可选用霍尔型车速传感器。
转向盘扭矩传感器13:用于获取方向盘转矩信息。在实际应用中可选用KR-803动态转矩传感器。
转向灯开关14:用于获取转向灯信息。在实际应用中可选用型号为153的东风紫罗兰组合开关。
辅助决策模块2:包括车道偏离识别子模块21、驾驶员状态识别子模块22以及决策生成子模块23。
其中,车道偏离识别子模块21用于根据车道信息和车辆信息实时识别车辆是否偏离车道,获得相应的偏离信息;驾驶员状态识别子模块22用于根据车辆信息实时识别驾驶员当前状态;决策生成子模块23用于根据偏离信息和驾驶员当前状态分析计算获得辅助决策信息;其中,偏离信息包括三种:车道未偏离;车道偏离,启动预警;车道偏离,可以启动辅助控制;驾驶员当前状态包括三种:主动操纵状态、紧急操纵车辆状态、未操纵车辆状态。
自抗扰控制器模块3:用于根据辅助决策信息生成控制纠正车辆行驶姿态的辅助控制指令。
在本实施例中,如图2所示,自抗扰控制器模块3采用由两个自抗扰控制器(ADRC)构成的闭环控制器,两个自抗扰控制器分别为ADRCyψ,ADRCψδ。每个自抗扰控制器(ADRC)均包括跟踪微分器(TD),扩张状态观测器(ESO方程),控制量形成(NF)三部分;具体设置方式如下:
根据公式(4)设置自抗扰控制器的跟踪微分器:
其中r0为控制目标,r1为r0的跟踪信号,r2是r0的微分信号,v速度因子。
跟踪微分控制器(TD)能有效解决经典PID控制器快速性和超调之间的矛盾,同时提高调节器的鲁棒性。
根据公式(5)设置自抗扰控制器的扩张状态观测器:
其中z1是系统输出y的估计信号,z2是y微分的估计信号,z3则是对系统状态和模型不确定性以及外部扰动的总体估计。
扩张状态观测器(ESO方程)是自抗扰控制器的核心部分,它采用非线性状态观测器对系统的状态进行观测,通过对扩张的状态量进行补偿,可将原来的控制系统转化为线性的积分串联型控制系统,大大增强了该控制器对系统的适应性。
根据公式(6)设置自抗扰控制器的控制量形成:
其中e1,e2是误差及其微分,u为控制量,b为控制放大系数的估计。
如图2所示,期望路径输入和实际路径输出的差值e,进过第一个ADRC控制器得到横摆角Ψ,将其传输给第二个控制器得到车辆前轮转角δ。
执行模块4:用于根据辅助控制指令对车辆执行转向及行驶速度调控。
在实际应用中,执行模块4进一步包括:电动助力转向控制器41和阻力电机42。由电动助力转向控制器41根据所述辅助控制指令获得助力电机42的期望转角θsw,通过转向盘扭矩传感器13测量助力电机42的真实转角θ。再利用期望转角θsw和真实转角θ的差值经过PID控制器得到期望电流Jsw,通过电流传感器测量真实电流J,同样利用期望电流Jsw和实际电流J的差值输入到电流调节器计算得到PWM信号,控制助力电机带动车辆前轮转向,从而使车辆回归原有车道。
本实施例的具体技术原理和工作流程将在实施例2中结合车道偏离的辅助控制方法一并进行说明,在此不再赘述。
实施例2:
如图3和图4所示,一种利用实施例1提供的控制系统实现车道偏离的辅助控制方法,包括以下步骤:
步骤S1,实时采集车道信息和车辆信息。
其中,车道信息包括道路信息以及车辆位置信息。道路信息包括:道路宽度、道路中心与车辆纵向轴线的距离,车辆位置信息包括:左前轮到相应道路边界的位置、右前轮到相应道路边界的位置。车辆信息包括车速信息、横摆角速度信息、转向灯信息以及方向盘转矩信息。
具体的,车辆前方道路信息通过图像传感器11获取,车速信息、横摆角速度信息通过车身传感器12获取,方向盘转矩信息通过转向盘扭矩传感器13获取,转向灯信息通过转向灯开关14获取。
步骤S2,根据车道信息和车辆信息实时识别车辆是否偏离车道,获得相应的偏离信息;根据车辆信息实时识别驾驶员当前状态;根据偏离信息和驾驶员当前状态分析计算获得辅助决策信息。
其中,偏离信息包括三种:车道未偏离;车道偏离,启动预警;车道偏离,可以启动辅助控制;驾驶员当前状态包括三种:主动操纵状态、紧急操纵车辆状态、未操纵车辆状态。
进一步的,在本实施例中,利用车道偏离识别子模块21根据车道信息和车辆信息实时识别车辆是否偏离车道,获得相应的偏离信息,具体可采用TLC判断方法或CCP判断方法;TLC是基于车辆在路面上未来跨越车道的时间预警算法,CCP是基于车辆在车道中的当前位置预警算法。其中:
TLC判断方法具体包括如下步骤:
步骤S211,根据公式(1)计算TLC值;
其中,DLC为车辆从当前位置行驶至车道边界线过程中车辆经过的距离,vx是车辆的纵向运动速度。
步骤S212,根据TLC值进行判断:
若TLC≤Ttw,则设置偏离信息为:车道偏离,启动预警;其中,Ttw为预设的判定车道偏离启动预警的阈值。一般情况下,Ttw可设置为2.5s。
若TLC≤Ttc=Ttw+Ttr,则设置偏离信息为:车道偏离,可以启动辅助控制;其中,Ttc为预设的判定车道偏离启动辅助控制的最低阈值;Ttr为预设的启动预警至驾驶员采取措施过程中驾驶员的反应时间。一般情况下,Ttr可设置为2s,即Ttc可设置为4.5s。
若TLC>Tof,则设置偏离信息为:车道未偏离;其中,Tof为预设的关闭车道偏离辅助控制的阈值。一般情况下,Tof可设置为5.5s。
CCP判断方法具体包括如下步骤:
步骤S221,根据公式(2)计算汽车左右前轮相对于道路边界的位置:
其中b为道路宽度,bc为车辆宽度,y0为道路中心与车辆纵向轴线的距离,Δyl左前轮到相应道路边界的位置,Δyr为右前轮到相应道路边界的位置。
步骤S222,根据左右前轮相对于道路边界的位置进行判断:
若Δyl﹥0并且Δyr﹥0,则设置偏离信息为:车道未偏离;若Δyl﹤0或者Δyr﹤0,则设置偏离信息为:车道偏离,可以启动辅助控制。
为了提升决策判断的准确性,针对TLC判断方法和CCP判断方法的特性,在本实施例中,根据车道信息和车辆信息实时判断车辆是否偏离道路的方法可以进一步采用联合判断方法,具体包括如下步骤:
步骤S231,根据公式(3)计算偏离速度,即车辆偏离车道时垂直于车道边界线的速度:v=vx*sinβ+vy*sinβ (3)
其中,v为偏离速度,vx为纵向速度,vy侧向速度,β为车辆的相对偏航角。
步骤S232,根据偏离速度进行判断:
若偏离速度v大于0.6m/s,则判定车辆正以较大速度靠近车道边界,启动TLC判断方法,进入步骤S211。
若偏离速度v小于0.6m/s,则判定车辆靠近车道边界的速度较小,启动CCP判断方法,进入步骤S221。
进一步的,在步骤S2中,利用驾驶员状态识别子模块22根据车辆信息实时识别驾驶员当前状态,具体实现方法包括如下步骤:
步骤S241,识别判断转向灯是否关闭;若转向灯打开,判定驾驶员为主动操纵状态;若转向灯关闭,则进入步骤S242。
步骤S242,读取方向盘转矩信息,若方向盘转矩大于预设的转矩阈值,其值一般取3.5N/M,则判定驾驶员为紧急操纵车辆状态;当方向盘转矩小于阈值,则判定驾驶员为未操纵车辆状态。
进一步的,在步骤S2中,利用决策生成子模块23根据偏离信息和驾驶员当前状态分析计算获得辅助决策信息,其实现方法具体为:
(1)若偏离信息为车道未偏离,则设置辅助决策信息为:关闭辅助控制,由驾驶员控制车辆。具体地说,如果识别到车辆未偏离车道,此时不需要进行辅助控制,因此关闭辅助控制功能,交由驾驶员自行控制车辆即可。
(2)若偏离信息为车道偏离,启动预警,则设置辅助决策信息为:向驾驶员发送预警警报。
(3)若偏离信息为车道偏离,可以启动辅助控制,则根据驾驶员当前状态进一步判断:若驾驶员当前状态为主动操纵状态,则设置辅助决策信息为:关闭辅助控制,由驾驶员控制车辆。具体地说,如果识别到转向灯打开时,认为驾驶员正在主动操纵车辆,此时由驾驶员继续操作即可,不需要进行辅助控制,因此关闭辅助控制功能,交由驾驶员自行控制车辆即可。
若驾驶员当前状态为紧急操纵车辆状态,则设置辅助决策信息为:关闭辅助控制,由驾驶员控制车辆。具体地说,在紧急操纵车辆状态下,方向盘转矩较大,认为驾驶员正在紧急操纵车辆,此时不宜进行辅助控制,因此关闭辅助控制功能,交由驾驶员自行控制车辆。
若驾驶员当前状态为未操纵车辆状态,则设置辅助决策信息为:切断驾驶员控制,启动辅助控制。具体地说,在未操纵车辆状态下,方向盘转矩较小,认为双手即将或已经脱离方向盘,此时应执行进行辅助控制,因此开启辅助控制功能取得车辆控制权,断开驾驶员的车辆控制权。
步骤S3,利用自抗扰控制器(ADRC)根据辅助决策信息生成控制纠正车辆行驶姿态的辅助控制指令。
具体的实现方法和工作流程如下:
如图2所示,期望路径输入和实际路径输出的差值e,进过第一个ADRC控制器得到横摆角Ψ,将其传输给第二个控制器得到车辆前轮转角δ。
自抗扰控制器模块3内部两个自抗扰控制器(ADRC)的具体设置方法如下:
步骤S301,根据公式(4)设置自抗扰控制器的跟踪微分器:
其中r0为控制目标,r1为r0的跟踪信号,r2是r0的微分信号,v速度因子;
步骤S302,根据公式(5)设置自抗扰控制器的扩张状态观测器:
其中z1是系统输出y的估计信号,z2是y微分的估计信号,z3则是对系统状态和模型不确定性以及外部扰动的总体估计;
步骤S303,根据公式(6)设置自抗扰控制器的控制量形成:
其中e1,e2是误差及其微分,u为控制量,b为控制放大系数的估计;
步骤S304,启动自抗扰控制器运算,生成相应的辅助控制指令。
步骤S4,根据辅助控制指令对车辆执行转向及行驶速度调控。
在实际应用中,执行模块4进一步包括:电动助力转向控制器41和阻力电机42。由电动助力转向控制器41根据所述辅助控制指令获得助力电机42的期望转角θsw,通过转向盘扭矩传感器13测量助力电机42的真实转角θ。再利用期望转角θsw和真实转角θ的差值经过PID控制器得到期望电流Jsw,通过电流传感器测量真实电流J,同样利用期望电流Jsw和实际电流J的差值输入到电流调节器计算得到PWM信号,控制助力电机带动车辆前轮转向,从而使车辆回归原有车道。
图5为车道偏离辅助结果示意图。图中为双移线工况下车辆中心运动轨迹的仿真曲线,虚线为车辆的期望路径,实线为车辆的实际路径。有图可知,控制算法可以较好地控制车辆跟踪预期行驶轨迹,横向位移误差较小,在容许的范围之内。
本领域的技术人员容易理解,以上仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。
Claims (10)
1.一种车道偏离辅助控制系统,其特征在于,包括依次通信连接的感知模块、辅助决策模块、自抗扰控制器模块以及执行模块,其中:
感知模块:用于采集车道信息和车辆信息;其中,所述车道信息包括道路信息以及车辆位置信息;所述车辆信息包括车速信息、横摆角速度信息、转向灯信息以及方向盘转矩信息;
辅助决策模块:包括车道偏离识别子模块、驾驶员状态识别子模块以及决策生成子模块;其中,所述车道偏离识别子模块用于根据所述车道信息和车辆信息实时识别车辆是否偏离车道,获得相应的偏离信息;所述驾驶员状态识别子模块用于根据所述车辆信息实时识别驾驶员当前状态;所述决策生成子模块用于根据所述偏离信息和驾驶员当前状态分析计算获得辅助决策信息;其中,所述偏离信息包括三种:车道未偏离;车道偏离,启动预警;车道偏离,可以启动辅助控制;所述驾驶员当前状态包括三种:主动操纵状态、紧急操纵车辆状态、未操纵车辆状态;
自抗扰控制器模块:用于根据所述辅助决策信息生成控制纠正车辆行驶姿态的辅助控制指令;
执行模块:用于根据所述辅助控制指令对车辆执行转向及行驶速度调控。
2.根据权利要求1所述的一种车道偏离辅助控制系统,其特征在于:所述感知模块进一步包括:
获取车辆前方道路信息的图像传感器;
获取所述车速信息、横摆角速度信息的车身传感器;
以及获取所述方向盘转矩信息的转向盘扭矩传感器。
3.根据权利要求1所述的一种车道偏离辅助控制系统,其特征在于:所述自抗扰控制器模块采用由两个自抗扰控制器(ADRC)构成的闭环控制器,每个自抗扰控制器均包括跟踪微分器(TD),扩张状态观测器(ESO方程),控制量形成(NF)三部分;
根据公式(4)设置自抗扰控制器的跟踪微分器:
其中r0为控制目标,r1为r0的跟踪信号,r2是r0的微分信号,v速度因子;
根据公式(5)设置自抗扰控制器的扩张状态观测器:
其中z1是系统输出y的估计信号,z2是y微分的估计信号,z3则是对系统状态和模型不确定性以及外部扰动的总体估计;
根据公式(6)设置自抗扰控制器的控制量形成:
其中e1,e2是误差及其微分,u为控制量,b为控制放大系数的估计。
4.根据权利要求1所述的一种车道偏离辅助控制系统,其特征在于:所述执行模块进一步包括:电动助力转向控制器和阻力电机。
5.一种车道偏离辅助控制方法,其特征在于,包括以下步骤:
步骤S1,实时采集车道信息和车辆信息;
其中,所述车道信息包括道路信息以及车辆位置信息;所述车辆信息包括车速信息、横摆角速度信息、转向灯信息以及方向盘转矩信息;
步骤S2,根据所述车道信息和车辆信息实时识别车辆是否偏离车道,获得相应的偏离信息;根据所述车辆信息实时识别驾驶员当前状态;根据所述偏离信息和驾驶员当前状态分析计算获得辅助决策信息;
其中,所述偏离信息包括三种:车道未偏离;车道偏离,启动预警;车道偏离,可以启动辅助控制;所述驾驶员当前状态包括三种:主动操纵状态、紧急操纵车辆状态、未操纵车辆状态;
步骤S3,利用自抗扰控制器(ADRC)根据所述辅助决策信息生成控制纠正车辆行驶姿态的辅助控制指令;
步骤S4,根据所述辅助控制指令对车辆执行转向及行驶速度调控。
6.根据权利要求5所述的辅助控制方法,其特征在于:在所述步骤S2中,根据所述车道信息和车辆信息实时识别车辆是否偏离车道,获得相应的偏离信息的方法具体包括TLC判断方法或CCP判断方法;其中:
所述TLC判断方法具体包括如下步骤:
步骤S211,根据公式(1)计算TLC值;
其中,DLC为车辆从当前位置行驶至车道边界线过程中车辆经过的距离,vx是车辆的纵向运动速度;
步骤S212,根据TLC值进行判断:
若TLC≤Ttw,则设置偏离信息为:车道偏离,启动预警;其中,Ttw为预设的判定车道偏离启动预警的阈值;
若TLC≤Ttc=Ttw+Ttr,则设置偏离信息为:车道偏离,可以启动辅助控制;其中,Ttc为预设的判定车道偏离启动辅助控制的最低阈值;Ttr为预设的启动预警至驾驶员采取措施过程中驾驶员的反应时间;
若TLC>Tof,则设置偏离信息为:车道未偏离;其中,Tof为预设的关闭车道偏离辅助控制的阈值;
所述CCP判断方法具体包括如下步骤:
步骤S221,根据公式(2)计算汽车左右前轮相对于道路边界的位置:
其中b为道路宽度,bc为车辆宽度,y0为道路中心与车辆纵向轴线的距离,Δyl左前轮到相应道路边界的位置,Δyr为右前轮到相应道路边界的位置;
步骤S222,根据左右前轮相对于道路边界的位置进行判断:
若Δyl﹥0并且Δyr﹥0,则设置偏离信息为:车道未偏离;若Δyl﹤0或者Δyr﹤0,则设置偏离信息为:车道偏离,可以启动辅助控制。
7.根据权利要求6所述的辅助控制方法,其特征在于:在所述步骤S2中,根据所述车道信息和车辆信息实时判断车辆是否偏离道路的方法还包括联合判断方法,具体包括如下步骤:
步骤S231,根据公式(3)计算偏离速度,即车辆偏离车道时垂直于车道边界线的速度:
v=vx*sinβ+vy*sinβ (3)
其中,v为偏离速度,vx为纵向速度,vy侧向速度,β为车辆的相对偏航角;
步骤S232,根据所述偏离速度进行判断:
若偏离速度v大于0.6m/s,则判定车辆正以较大速度靠近车道边界,启动所述TLC判断方法,进入步骤S211;
若偏离速度v小于0.6m/s,则判定车辆靠近车道边界的速度较小,启动所述CCP判断方法,进入步骤S221。
8.根据权利要求5所述的辅助控制方法,其特征在于:在所述步骤S2中,根据所述车辆信息实时识别驾驶员当前状态的方法具体包括如下步骤:
步骤S241,识别判断转向灯是否关闭;若转向灯打开,判定驾驶员为主动操纵状态;若转向灯关闭,则进入步骤S242;
步骤S242,读取所述方向盘转矩信息,若方向盘转矩大于预设的转矩阈值,则判定驾驶员为紧急操纵车辆状态;当方向盘转矩小于阈值,则判定驾驶员为未操纵车辆状态。
9.根据权利要求5所述的辅助控制方法,其特征在于:在所述步骤S2中,根据所述偏离信息和驾驶员当前状态分析计算获得辅助决策信息的方法具体为:
若所述偏离信息为车道未偏离,则设置辅助决策信息为:关闭辅助控制,由驾驶员控制车辆;
若所述偏离信息为车道偏离,启动预警,则设置辅助决策信息为:向驾驶员发送预警警报;
若所述偏离信息为车道偏离,可以启动辅助控制,则根据所述驾驶员当前状态进一步判断:若所述驾驶员当前状态为主动操纵状态,则设置辅助决策信息为:关闭辅助控制,由驾驶员控制车辆;若所述驾驶员当前状态为紧急操纵车辆状态,则设置辅助决策信息为:关闭辅助控制,由驾驶员控制车辆;若所述驾驶员当前状态为未操纵车辆状态,则设置辅助决策信息为:切断驾驶员控制,启动辅助控制。
10.根据权利要求5所述的辅助控制方法,其特征在于:所述步骤S3具体为:
步骤S301,根据公式(4)设置自抗扰控制器的跟踪微分器:
其中r0为控制目标,r1为r0的跟踪信号,r2是r0的微分信号,v速度因子;
步骤S302,根据公式(5)设置自抗扰控制器的扩张状态观测器:
其中z1是系统输出y的估计信号,z2是y微分的估计信号,z3则是对系统状态和模型不确定性以及外部扰动的总体估计;
步骤S303,根据公式(6)设置自抗扰控制器的控制量形成:
其中e1,e2是误差及其微分,u为控制量,b为控制放大系数的估计;
步骤S304,启动自抗扰控制器运算,生成相应的辅助控制指令。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810208880.XA CN108422998A (zh) | 2018-03-14 | 2018-03-14 | 一种车道偏离辅助控制系统及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810208880.XA CN108422998A (zh) | 2018-03-14 | 2018-03-14 | 一种车道偏离辅助控制系统及方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN108422998A true CN108422998A (zh) | 2018-08-21 |
Family
ID=63158428
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810208880.XA Pending CN108422998A (zh) | 2018-03-14 | 2018-03-14 | 一种车道偏离辅助控制系统及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108422998A (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109870899A (zh) * | 2019-02-25 | 2019-06-11 | 中国科学院光电技术研究所 | 一种基于扩张状态观测器的光电跟踪系统控制方法 |
CN110203210A (zh) * | 2019-06-19 | 2019-09-06 | 厦门金龙联合汽车工业有限公司 | 一种车道偏离预警方法、终端设备及存储介质 |
CN110350839A (zh) * | 2019-08-09 | 2019-10-18 | 大连海事大学 | 一种模型不确定异步电动机的位置跟踪控制器及控制方法 |
WO2020082352A1 (en) * | 2018-10-26 | 2020-04-30 | SZ DJI Technology Co., Ltd. | Automated vehicle actions, and associated systems and methods |
CN112015194A (zh) * | 2020-08-20 | 2020-12-01 | 南京航空航天大学 | 一种基于直接升力控制的舰载机抑制舰尾流扰动的方法 |
CN112373477A (zh) * | 2020-11-23 | 2021-02-19 | 重庆长安汽车股份有限公司 | 自动驾驶系统的冗余控制方法、自动驾驶系统、汽车、控制器及计算机可读存储介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1298021B1 (en) * | 2001-09-28 | 2005-12-07 | Nissan Motor Company, Limited | Lane-keep control system for vehicle |
CN101804814A (zh) * | 2010-01-08 | 2010-08-18 | 北京世纪高通科技有限公司 | 一种确定车道偏离的方法、装置和系统 |
CN104015725A (zh) * | 2014-06-11 | 2014-09-03 | 吉林大学 | 一种基于多参数决策的车道偏离预警方法 |
CN105620359A (zh) * | 2016-02-25 | 2016-06-01 | 上海斐讯数据通信技术有限公司 | 一种基于移动终端的车道偏离预警方法及系统 |
CN107150682A (zh) * | 2017-04-27 | 2017-09-12 | 同济大学 | 一种车道保持辅助系统 |
-
2018
- 2018-03-14 CN CN201810208880.XA patent/CN108422998A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1298021B1 (en) * | 2001-09-28 | 2005-12-07 | Nissan Motor Company, Limited | Lane-keep control system for vehicle |
CN101804814A (zh) * | 2010-01-08 | 2010-08-18 | 北京世纪高通科技有限公司 | 一种确定车道偏离的方法、装置和系统 |
CN104015725A (zh) * | 2014-06-11 | 2014-09-03 | 吉林大学 | 一种基于多参数决策的车道偏离预警方法 |
CN105620359A (zh) * | 2016-02-25 | 2016-06-01 | 上海斐讯数据通信技术有限公司 | 一种基于移动终端的车道偏离预警方法及系统 |
CN107150682A (zh) * | 2017-04-27 | 2017-09-12 | 同济大学 | 一种车道保持辅助系统 |
Non-Patent Citations (1)
Title |
---|
吴乙万: "人机协同下的车道偏离辅助驾驶关键技术研究", 《博士学位论文》 * |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2020082352A1 (en) * | 2018-10-26 | 2020-04-30 | SZ DJI Technology Co., Ltd. | Automated vehicle actions, and associated systems and methods |
CN111433095A (zh) * | 2018-10-26 | 2020-07-17 | 深圳市大疆创新科技有限公司 | 自动化车辆动作以及相关的系统和方法 |
CN109870899A (zh) * | 2019-02-25 | 2019-06-11 | 中国科学院光电技术研究所 | 一种基于扩张状态观测器的光电跟踪系统控制方法 |
CN110203210A (zh) * | 2019-06-19 | 2019-09-06 | 厦门金龙联合汽车工业有限公司 | 一种车道偏离预警方法、终端设备及存储介质 |
CN110350839A (zh) * | 2019-08-09 | 2019-10-18 | 大连海事大学 | 一种模型不确定异步电动机的位置跟踪控制器及控制方法 |
CN112015194A (zh) * | 2020-08-20 | 2020-12-01 | 南京航空航天大学 | 一种基于直接升力控制的舰载机抑制舰尾流扰动的方法 |
CN112373477A (zh) * | 2020-11-23 | 2021-02-19 | 重庆长安汽车股份有限公司 | 自动驾驶系统的冗余控制方法、自动驾驶系统、汽车、控制器及计算机可读存储介质 |
CN112373477B (zh) * | 2020-11-23 | 2023-03-28 | 重庆长安汽车股份有限公司 | 自动驾驶系统的冗余控制方法、自动驾驶系统、汽车、控制器及计算机可读存储介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108422998A (zh) | 一种车道偏离辅助控制系统及方法 | |
CN108327717B (zh) | 一种人机共驾的车道偏离辅助系统及其车道偏离辅助方法 | |
CN107635854B (zh) | 电动助力转向装置 | |
Hatipoglu et al. | Automated lane change controller design | |
US10179602B2 (en) | Driver assistance system for vehicle | |
Llorca et al. | Autonomous pedestrian collision avoidance using a fuzzy steering controller | |
EP1127727B1 (en) | Cruise control device for a vehicle | |
Klančar et al. | A control strategy for platoons of differential drive wheeled mobile robot | |
CN109426244B (zh) | 自动驾驶装置 | |
Benine-Neto et al. | Dynamic controller for lane keeping and obstacle avoidance assistance system | |
CN108945092B (zh) | 基于高速公路的自动驾驶车辆人机转向交互方法及系统 | |
JP3660011B2 (ja) | 車両の操舵制御装置 | |
JP5023869B2 (ja) | 車両用運転操作支援装置、および車両用運転操作支援方法 | |
Guo et al. | Regional path moving horizon tracking controller design for autonomous ground vehicles | |
US11364921B2 (en) | Object recognition apparatus, object recognition method, and vehicle | |
CN111994067A (zh) | 一种应对车辆爆胎的智能安全控制系统和方法 | |
US20220135030A1 (en) | Simulator for evaluating vehicular lane centering system | |
CN114179799A (zh) | 用于acc与aeb的融合多传感器信息的自车行驶路径识别方法 | |
Litkouhi et al. | Estimator and controller design for lanetrak, a vision-based automatic vehicle steering system | |
JP4419560B2 (ja) | 車両のレーン走行支援装置 | |
CN110077462B (zh) | 一种无人车行驶过程中的转向保护方法及终端 | |
CN207631230U (zh) | 一种车道保持系统 | |
Jung et al. | A novel control strategy of crosswind disturbance compensation for rack-type motor driven power steering (R-MDPS) system | |
JP2005247158A (ja) | 車両走行制御装置 | |
Kwon et al. | Autonomous emergency stop system |
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 | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20180821 |
|
WD01 | Invention patent application deemed withdrawn after publication |