CN110018632B - 一种车辆变道控制方法和装置 - Google Patents
一种车辆变道控制方法和装置 Download PDFInfo
- Publication number
- CN110018632B CN110018632B CN201810652866.9A CN201810652866A CN110018632B CN 110018632 B CN110018632 B CN 110018632B CN 201810652866 A CN201810652866 A CN 201810652866A CN 110018632 B CN110018632 B CN 110018632B
- Authority
- CN
- China
- Prior art keywords
- parameter
- coefficient
- vehicle
- determining
- speed
- 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
- 230000008859 change Effects 0.000 title claims abstract description 99
- 238000000034 method Methods 0.000 title claims abstract description 43
- 230000006870 function Effects 0.000 description 43
- 230000000875 corresponding effect Effects 0.000 description 32
- 230000001276 controlling effect Effects 0.000 description 12
- 238000010586 diagram Methods 0.000 description 12
- 230000008569 process Effects 0.000 description 12
- 238000013461 design Methods 0.000 description 5
- 238000012360 testing method Methods 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 3
- 230000007613 environmental effect Effects 0.000 description 3
- 238000001914 filtration Methods 0.000 description 3
- 230000004927 fusion Effects 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 230000008447 perception Effects 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 238000013528 artificial neural network Methods 0.000 description 1
- 238000010009 beating Methods 0.000 description 1
- 230000006399 behavior Effects 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 238000005352 clarification Methods 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012216 screening Methods 0.000 description 1
- 230000026676 system process Effects 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B11/00—Automatic controllers
- G05B11/01—Automatic controllers electric
- G05B11/36—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
- G05B11/42—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential for obtaining a characteristic which is both proportional and time-dependent, e.g. P. I., P. I. D.
-
- 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
- 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
- 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
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
- G08G1/167—Driving aids for lane monitoring, lane changing, e.g. blind spot detection
-
- 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/0008—Feedback, closed loop systems or details of feedback error signal
- B60W2050/0009—Proportional differential [PD] controller
-
- 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
-
- 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/06—Direction of travel
-
- 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
- B60W2540/00—Input parameters relating to occupants
- B60W2540/18—Steering angle
-
- 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
- B60W2554/00—Input parameters relating to objects
- B60W2554/40—Dynamic objects, e.g. animals, windblown objects
- B60W2554/404—Characteristics
- B60W2554/4041—Position
-
- 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
- B60W2554/00—Input parameters relating to objects
- B60W2554/80—Spatial relation or speed relative to objects
Landscapes
- Engineering & Computer Science (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- General Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
本发明提供了一种车辆变道控制方法,包括:接收变道指令;获取车辆的速度参数;根据速度参数确定预设控制器的控制系数;获取车辆的位置偏差参数和航向角参数;当位置偏差参数大于或等于第一阈值,或,航向角参数大于或等于第二阈值时,根据控制系数、位置偏差参数和航向角参数,确定车辆的目标方向盘转向角;根据目标方向盘转向角,控制车辆进行变道操作;直到位置偏差参数低于第一阈值,且航向角参数低于第二阈值。本发明实施例速度参数、位置偏差参数和航向角通过速度传感器、车载摄像头就可以获取,而不需要依赖高精度的定位系统,能大大减少车辆变道所需的成本和对控制器资源的占用。
Description
技术领域
本发明涉及自动控制技术领域,特别涉及一种车辆变道控制方法和装置。
背景技术
随着自动控制技术的发展,无人驾驶车辆得到越来越高的关注度。在无人驾驶车辆中,变道控制作为一项基础的车辆控制指标,也存在着较多的研究方案。
现有技术在接到变道控制指令后,进行的变道控制方法通常是:根据车辆运动学和动力学模型设计控制算法,使车辆沿着已知轨迹行驶,具体如图1所示的过程;在车辆变道时,通过高精度的定位系统来定位车辆的位置,通过位置判断车辆是否完成变道,例如,定位到车辆到达预设位置,则判定车辆完成变道,指示车辆正常行驶;定位到车辆没有到达预设位置,则判定车辆没有完成变道,继续执行变道操作。
但是,申请人在研究上述方案时发现:现有技术中依靠高精度的定位系统来实现变道控制,一方面,高精度定位系统的成本较高,提升了车辆变道控制成本;另一方面,通过高精度定位系统实现变道控制中,需要频繁的将实时位置与车辆模型结合进行计算,对控制器运算能力要求很高,对控制器的资源占用也很大。
发明内容
有鉴于此,本发明旨在提出一种车辆变道控制方法和装置,以解决或部分解决变道控制时对高精度定位系统的依赖,造成变道控制装置的成本高的问题。
为达到上述目的,本发明的技术方案是这样实现的:
一种车辆变道控制方法,包括:
接收变道指令;所述变道指令包括目标行驶车道;
获取所述车辆的速度参数;
根据所述速度参数确定预设控制器的控制系数;
变道控制,包括:获取所述车辆的位置偏差参数和航向角参数;当所述位置偏差参数大于或等于第一阈值,或,所述航向角参数大于或等于第二阈值时,根据所述控制系数、所述位置偏差参数和所述航向角参数,确定所述车辆的目标方向盘转向角;根据所述目标方向盘转向角,控制所述车辆进行变道操作;
重复所述变道控制步骤,直到所述位置偏差参数低于第一阈值,且所述航向角参数低于第二阈值;
其中,所述位置偏差参数为所述车辆的当前位置与所述目标行驶车道之间的横向距离;所述航向角为所述车辆的当前航向与所述目标行驶车道的夹角。
进一步的,所述根据所述速度参数确定预设控制器的控制系数的步骤,包括:
根据所述速度参数与预设的第一参数表的匹配关系,确定所述速度参数对应的第一比例系数和第一微分系数;
根据所述速度参数与预设的第二参数表的匹配关系,确定所述速度参数对应的第二比例系数;
所述根据所述控制系数、所述位置偏差参数和所述航向角参数确定所述车辆的目标方向盘转向角的步骤包括:
根据所述位置偏差参数、所述第一比例系数和所述第一微分系数,通过比例微分控制算法,确定出第一方向盘转角;
根据所述航向角参数、所述第二比例系数,通过比例控制算法,确定出第二方向盘转角;
按照预设规则对所述第一方向盘转角和所述第二方向盘转角进行计算,得到目标方向盘转角。
进一步的,在所述根据所述速度参数确定预设控制器的控制系数之前,还包括:
将预置车速进行模糊化,得到所述预置车速的模糊论域;其中,所述预置车速的模糊论域包括:车速模糊子集,车速隶属度函数;
根据所述车速模糊子集和所述车速隶属度函数,确定不同预置车速下所述比例系数的模糊论域、所述微分系数的模糊论域;其中,所述比例系数的模糊论域包括:比例系数模糊子集,比例系数隶属度函数;所述微分系数的模糊论域包括:微分系数模糊子集,微分系数隶属度函数;
根据所述车速模糊子集,所述车速隶属度函数,所述比例系数模糊子集、所述比例系数隶属度函数、所述微分系数模糊子集,及所述微分系数隶属度函数之间的对应关系,建立所述第一参数表。
进一步的,所述根据所述速度参数与预设的第一参数表的匹配关系,确定所述速度参数对应的第一比例系数和第一微分系数的步骤包括:
确定与所述速度参数匹配的第一车速模糊子集;
确定所述第一车速模糊子集的第一速度端值和第二速度端值;
确定所述第一速度端值在所述第一参数表中对应的第一端值比例系数、第一端值微分系数;
确定所述第二速度端值在所述第一参数表中对应的第二端值比例系数、第二端值微分系数;
确定第一隶属度系数,包括:将所述第一速度端值与所述速度参数的差值,除以所述第二速度端值与所述第一速度端值的差值,确定出第一隶属度系数;
确定第二隶属度系数,包括:将根据所述第二速度端值与所述速度参数的差值,除以所述第二速度端值与所述第一速度端值的差值,确定出第二隶属度系数;
确定所述第一比例系数,包括:将所述第一隶属度系数与所述第一端值比例系数的乘积,与所述第二隶属度系数与所述第二端值比例系数的乘积的和,除以所述第一隶属度系数与所述第二隶属度系数的和,确定出所述第一比例系数;
确定所述第一微分系数,包括:将所述第一隶属度系数与所述第一端值微分系数的乘积,与所述第二隶属度系数与所述第二端值微分系数的乘积的和,除以所述第一隶属度系数与所述第二隶属度系数的和,确定出所述第一微分系数。
进一步的,所述根据所述位置偏差参数、所述第一比例系数和所述第一微分系数,通过比例微分控制算法,确定出第一方向盘转角,包括:
根据预设时长、预设配置规律及所述位置偏差参数,确定在所述预设时长内各时刻的位置偏差参数分量;
根据所述第一比例系数、所述第一微分系数及所述各时刻的位置偏差参数分量,通过比例微分控制算法,确定出所述各时刻的第一方向盘转角;
所述按照预设规则对所述第一方向盘转角和所述第二方向盘转角进行计算,得到目标方向盘转角,包括:
按照预设规则对所述各时刻的第一方向盘转角和所述第二方向盘转角进行计算,得到所述各时刻的目标方向盘转角。
一种车辆变道控制装置,包括:
变道指令接收模块,用于接收变道指令;所述变道指令包括目标行驶车道;
速度参数获取模块,用于获取所述车辆的速度参数;
控制系数确定模块,用于根据所述速度参数确定预设控制器的控制系数;
变道控制模块,用于获取所述车辆的位置偏差参数和航向角参数;当所述位置偏差参数大于或等于第一阈值,或,所述航向角参数大于或等于第二阈值时,根据所述控制系数、所述位置偏差参数和所述航向角参数,确定所述车辆的目标方向盘转向角;根据所述目标方向盘转向角,控制所述车辆进行变道操作;直到所述位置偏差参数低于第一阈值,且所述航向角参数低于第二阈值;其中,所述位置偏差参数为所述车辆的当前位置与所述目标行驶车道之间的横向距离;所述航向角为所述车辆的当前航向与所述目标行驶车道的夹角。
进一步的,所述根据控制系数确定模块包括:
第一确定子模块,用于根据所述速度参数与预设的第一参数表的匹配关系,确定所述速度参数对应的第一比例系数和第一微分系数;
第二确定子模块,用于根据所述速度参数与预设的第二参数表的匹配关系,确定所述速度参数对应的第二比例系数;
所述变道控制模块包括:
第一方向盘转角确定子模块,用于根据所述位置偏差参数、所述第一比例系数和所述第一微分系数,通过比例微分控制算法,确定出第一方向盘转角;
第二方向盘转角确定子模块,用于根据所述航向角参数、所述第二比例系数,通过比例控制算法,确定出第二方向盘转角;
目标方向盘转角确定子模块,用于按照预设规则对所述第一方向盘转角和所述第二方向盘转角进行计算,得到目标方向盘转角。
进一步的,还包括:
车速模糊模块,用于将预置车速进行模糊化,得到所述预置车速的模糊论域;其中,所述预置车速的模糊论域包括:车速模糊子集,车速隶属度函数;
模糊论域确定模块,用于根据所述车速模糊子集和所述车速隶属度函数,确定不同预置车速下所述比例系数的模糊论域、所述微分系数的模糊论域;其中,所述比例系数的模糊论域包括:比例系数模糊子集,比例系数隶属度函数;所述微分系数的模糊论域包括:微分系数模糊子集,微分系数隶属度函数;
第一参数表建立模块,用于根据所述车速模糊子集,所述车速隶属度函数,所述比例系数模糊子集、所述比例系数隶属度函数、所述微分系数模糊子集,及所述微分系数隶属度函数之间的对应关系,建立所述第一参数表。
进一步的,所述第一方向盘转角确定子模块包括:
位置偏差参数分量确定单元,用于根据预设时长、预设配置规律及所述位置偏差参数,确定在所述预设时长内各时刻的位置偏差参数分量;
第一方向盘转角确定单元,用于根据所述第一比例系数、所述第一微分系数及所述各时刻的位置偏差参数分量,通过比例微分控制算法,确定出所述各时刻的第一方向盘转角;
所述目标方向盘转角确定子模块包括:
目标方向盘转角确定单元,用于按照预设规则对所述各时刻的第一方向盘转角和所述第二方向盘转角进行计算,得到所述各时刻的目标方向盘转角。
一种车辆,所述车辆包括任一所述的车辆变道控制装置。
相对于现有技术,本发明所述的车辆变道控制方法具有以下优势:
本发明实施例的一种车辆变道控制方法,在接收到变道指令后,根据车辆的速度参数,车辆与目标行驶车道的横向位置距离以及车辆的航向与目标行驶车道的夹角,就可以通过控制器实现变道控制。具体来说,在接收到变道指令后,先根据速度参数确定出预设控制器的控制参数,预设控制器再分别根据两个变量:车辆的位置偏差参数和航向角参数,确定车辆的目标方向盘转向角,通过目标方向盘转向角可以控制车辆进行变道操作,持续获取位置偏差参数和航向角参数,进行变道操作,直到位置偏差参数低于第一阈值,和,航向角参数低于第二阈值,可以认为该车辆在目标行驶车道上,沿着目标行驶车道的方向行驶,即完成了车辆变道。本发明实施例通过速度参数、位置偏差参数和航向角来控制车辆变道和判定是否完成变道,速度参数、位置偏差参数和航向角通过速度传感器、车载摄像头就可以获取,而不需要依赖高精度的定位系统,能大大减少车辆变道所需的成本和对控制器资源的占用。
附图说明
构成本发明的一部分的附图用来提供对本发明的进一步理解,本发明的示意性实施例及其说明用于解释本发明,并不构成对本发明的不当限定。在附图中:
图1为现有技术的一种车辆变道轨迹示意图;
图2为本发明实施例的一种车辆变道控制方法的步骤流程图;
图3为本发明实施例的一种控制系统示意图;
图4为本发明实施例的一种路径规划示意图;
图5为本发明实施例的一种不同车速的变道轨迹图;
图6为本发明实施例的一种位置偏差示意图;
图7为本发明实施例的一种航向角示意图;
图8为本发明实施例的一种车辆变道控制方法的变道控制步骤流程图;
图9为本发明实施例的一种车辆变道控制方法的具体步骤流程图;
图10为本发明实施例的一种变道控制设计示意图;
图11为本发明实施例的一种车速隶属度函数示意图;
图12为本发明实施例的一种比例系数隶属度函数示意图;
图13为本发明实施例的一种微分系数隶属度函数示意图;
图14为本发明实施例的一种消除位置偏差参数的控制算法流程图;
图15为本发明实施例的一种消除航向角参数的控制算法流程图;
图16为本发明实施例的一种具体变道流程示意图;
图17为本发明实施例的一种车辆变道控制装置的结构框图;
图18为本发明实施例的一种车辆变道控制装置的具体结构框图。
具体实施方式
需要说明的是,在不冲突的情况下,本发明中的实施例及实施例中的特征可以相互组合。
下面将参考附图并结合实施例来详细说明本发明。
如图2所示,其示出了本发明实施例提供的一种车辆变道控制方法的步骤流程图。
本发明实施例可以用于无人驾驶车辆中,无人驾驶系统的设计与开发大致可分为四个部分的关键技术:环境感知、数据融合、决策规划和运动控制。如图3所示,一辆无人驾驶车要实现自动行驶,首先需要像人一样充分“了解”周围的环境,包括:周围车辆、行人、道路标示、道路路面、天气等一切影响驾驶行为的环境信息,即环境感知。其次,控制系统将采集到的所有传感器信息进行处理,包括:提取、筛选、过滤、对比,最终得到稳定的可真实反映车辆周围环境信息的信号,即数据融合。进而,控制系统根据融合后的信息作出相应的“判断和规划”,包括:保持当前道路行驶、换道、行驶轨迹、行驶速度等内容,即决策规划。最后,控制系统根据接收的决策指令控制车辆完成相应的动作,包括:保持在当前车道内行驶、换道、按规定速度行驶、跟随前车行驶等,即运动控制。
车辆的运动控制是自动驾驶系统的关键技术,运动控制通常可以分为横向控制和纵向控制两部分。如图4所示,横向控制主要实现对车辆转向的控制,目的是控制车辆按照一定轨迹(路径)行驶;纵向控制主要实现对车辆速度的控制,目的是控制车辆按照一定速度行驶。横纵向控制耦合后就实现了系统对车辆的自动控制。
该车辆变道控制方法包括:
步骤101,接收变道指令;所述变道指令包括目标行驶车道。
具体应用中,变道指令可以由控制系统发出,具体来说,当控制系统在进行环境感知、数据融合后,做出变道的决策规划,发出变道指令,在该变道指令中,包含着目标行驶车道信息,该目标行驶车道可以是车辆完成变道后所行驶的车道。
步骤102,获取所述车辆的速度参数。
本发明实施例中,可以通过车辆的车速传感器获取车辆当前的速度参数,控制器通过总线读取速度参数,当然本领域技术人员也可以根据实际应用场景采用其他的方式获取车辆的速度参数,本发明实施例对此不做具体限制。
步骤103,根据所述速度参数确定预设控制器的控制系数。
本发明实施例中,预设控制器可以是PID(proportion integrationdifferentiation,比例积分微分)控制器。
通常情况下,PID控制器由比例单元(P)、积分单元(I)和微分单元(D)组成。其输入e(t)与输出u(t)的关系为:
该公式中积分的上下限分别是0和t。
PID控制器的传递函数为:
其中kp为比例系数;TI为积分时间常数;TD为微分时间常数。
具体应用中,车辆的行驶速度会影响变道时的行驶轨迹。如图5所示,低速时,车辆向左换道后最终到达的位置为a;高速时,车辆向左换道后最终到达的位置为c;分别产生不同的运动轨迹A和B。同理,若在某一时刻车辆向右换道,则可能到达b位置,但是b点的纵向位置也根据车速的不同而定。因此,将车辆的速度参数作为车辆变道控制的一种重要参数,根据速度参数确定预设控制器的控制系数,相较于通常情况下以偏差和偏差变化率作为PID控制器的输入,更能符合车辆的当前变道状态,能使得变道过程的控制简单易行。
步骤104,变道控制,包括:获取所述车辆的位置偏差参数和航向角参数;当所述位置偏差参数大于或等于第一阈值,或,所述航向角参数大于或等于第二阈值时,根据所述控制系数、所述位置偏差参数和所述航向角参数,确定所述车辆的目标方向盘转向角;根据所述目标方向盘转向角,控制所述车辆进行变道操作;重复所述变道控制步骤,直到所述位置偏差参数低于第一阈值,且所述航向角参数低于第二阈值;其中,所述位置偏差参数为所述车辆的当前位置与所述目标行驶车道之间的横向距离;所述航向角为所述车辆的当前航向与所述目标行驶车道的夹角。
本发明实施例中,考虑到车辆完成变道的标准通常是:横向位置在目标行驶车道中,且,车辆航向与目标行驶车道保持一致。在横向控制中,如图6所示,控制器可以根据车辆自身的当前位置和目标行驶车道位置计算得到位置偏差参数;根据位置偏差参数作PID运算得到转角控制量输出给车辆电动助力转向控制单元(EPS)控制车辆转向,随着车辆的移动会逐渐消除位置偏差,当位置偏差完全消除时,车辆就到达了横向目标位置从而实现了换道;在航向控制中,如图7所示,控制器可以根据车辆当前行驶方向与目标行程车道的方向确定出航向角参数;将航向角参数作为控制器的被控量引入,将车辆方向与道路方向的夹角目标值设置为0;控制器消除航向偏差后车辆方向就和道路方向一致,从而使车辆沿着车道行驶。
具体应用中,完成变道的步骤如图8所示,具体为:
步骤1041,获取所述车辆的位置偏差参数和航向角参数;其中,所述位置偏差参数为所述车辆的当前位置与所述目标行驶车道之间的横向距离;所述航向角为所述车辆的当前航向与所述目标行驶车道的夹角。
步骤1042,判断是否达到:所述位置偏差参数低于第一阈值,且所述航向角参数低于第二阈值。若是则结束,若否,则执行步骤1043和步骤1044。
步骤1043,根据所述控制系数、所述位置偏差参数和所述航向角参数,确定所述车辆的目标方向盘转向角。
步骤1044,根据所述目标方向盘转向角,控制所述车辆进行变道操作。
本发明实施例中,目标方向盘转向角可以是控制器将要控制方向盘进行转向的角度,通过方向盘的转动控制车辆进行变道操作。
综上所述,本发明实施例的一种车辆变道控制方法,在接收到变道指令后,根据车辆的速度参数,车辆与目标行驶车道的横向位置距离以及车辆的航向与目标行驶车道的夹角,就可以通过控制器实现变道控制。具体来说,在接收到变道指令后,先根据速度参数确定出预设控制器的控制参数,预设控制器再分别根据两个变量:车辆的位置偏差参数和航向角参数,确定车辆的目标方向盘转向角,通过目标方向盘转向角可以控制车辆进行变道操作,持续获取位置偏差参数和航向角参数,进行变道操作,直到位置偏差参数低于第一阈值,和,航向角参数低于第二阈值,可以认为该车辆在目标行驶车道上,沿着目标行驶车道的方向行驶,即完成了车辆变道。本发明实施例通过速度参数、位置偏差参数和航向角来控制车辆变道和判定是否完成变道,速度参数、位置偏差参数和航向角通过速度传感器、车载摄像头就可以获取,而不需要依赖高精度的定位系统,能大大减少车辆变道所需的成本和对控制器资源的占用。
如图9所示,其示出了本发明实施例提供的一种车辆变道控制方法的具体步骤流程图,该方法具体包括:
步骤201:将预置车速进行模糊化,得到所述预置车速的模糊论域;其中,所述预置车速的模糊论域包括:车速模糊子集,车速隶属度函数。
步骤202:根据所述车速模糊子集和所述车速隶属度函数,确定不同预置车速下所述比例系数的模糊论域、所述微分系数的模糊论域;其中,所述比例系数的模糊论域包括:比例系数模糊子集,比例系数隶属度函数;所述微分系数的模糊论域包括:微分系数模糊子集,微分系数隶属度函数。
步骤203:根据所述车速模糊子集,所述车速隶属度函数,所述比例系数模糊子集、所述比例系数隶属度函数、所述微分系数模糊子集,及所述微分系数隶属度函数之间的对应关系,建立第一参数表。
由于车辆在接收到变道指令时车速是不确定的,不同的车速下变道控制器输出的控制量是不同的。通俗的讲就是当车速较低时,驾驶员需要打出较大的方向盘转角才能控制车辆完成换道;当车速较高时,驾驶员只需打出很小的方向盘转角就能控制车辆换道。因此,在设计PID控制器时就需要根据车速变化调整不同的P、I、D参数,这样才能实现控制器对车速的自适应,从而实现系统对车辆的自适应控制。
本发明实施例中,可以预先在测试系统中构建基于控制器、车辆、传感器、执行单元的闭环控制系统,采用如图10所示的设计思路,在测试系统中预设不同的阈值车速,通过模糊PID控制理论确定出第一参数表。
具体应用中,可以预先通过步骤201至步骤203确定出第一参数表。
模糊控制模块通常有四个组成部分:输入量模糊化接口、输出量清晰化接口、模糊推理、知识库。本发明实施例中,将预置车速作为模糊控制模块的输入,将P、D的系数KP、KD作为模糊控制的输出。
举例来说,为了数学表达和运算简单选择三角形函数作为输入、输出模糊子集的隶属度函数。
输入(预置车速)的模糊论域包括:车速模糊子集,车速隶属度函数。
车速模糊子集可以为,具有固定端点差值的连续子集,以端点差值为5为例,车速模糊子集可以为下述子集:
[0,5];[5,10];[10,15];[15,20];[20,25];[25,30];[30,35];[35,40];
[40,45];[45,50];[50,55];[55,60];[60,65];[65,70];[70,75];[75,80];
[80,85];[85,90];[90,95];[95,100];[105,110];[110,115];[115,120]。
相应的车速隶属度函数如图11所示,速度越接近端值,隶属度越高。
输出的比例系数KP的模糊论域包括:比例系数模糊子集,比例系数隶属度函数。
以上述车辆模糊子集为输入,经过测试,比例系数模糊子集可以是:
[1.3,1.3];[1.3,1.4];[1.4,1.5];[1.5,1.6];[1.6,1.73];[1.73,1.8];[1.8,2];[2,2.3];[2.3,2.6];[2.6,2.8];[2.8,3.0];[3.0,3.3];[3.3,4.3];[4.3,5.0];[5.0,6.5];[6.5,8.0];[8.0,11];[11,13];[13,17];[17,24];[24,27];[27,38];[38,45]。
相应的比例系数隶属度函数如图12所示。
输出的微分系数KD的模糊论域包括:微分系数模糊子集,微分系数隶属度函数。
以上述车辆模糊子集为输入,经过测试,微分系数模糊子集可以是:
[0,0];[0,0.7];[0.7,0.9];[0.9,0.95];[0.95,1];[1,1.1];
[1.1,1.2.];[1.2,1.3];[1.3,2];[2,2.5];[2.5,3]。
相应的微分系数隶属度函数如图13所示。
根据车速模糊子集,车速隶属度函数,比例系数模糊子集、比例系数隶属度函数、微分系数模糊子集,及微分系数隶属度函数之间的对应关系,可以通过不同的预制车速整定出第一参数表作为知识库。第一参数表具体可以为表1:
表1
表1如果用模糊语言描述模糊规则,可以是:
If speed is 5,then kp is 40 and kd is 0;
If speed is 10,then kp is 38 and kd is 0;
…
If speed is 120,then kp is 1.3 and kd is 0.9。
依次可以确定出24条模糊规则。对于不同的速度参数,可以通过查取表1的参数,确定出对应的比例系数和微分系数。
步骤204:接收变道指令;所述变道指令包括目标行驶车道。
步骤205:获取所述车辆的速度参数。
步骤206:根据所述速度参数与预设的第一参数表的匹配关系,确定所述速度参数对应的第一比例系数和第一微分系数。
PID控制作为经典的控制理论底蕴深厚、应用广泛、设计简单、可行性强,较MPC(模型预测控制)、神经网络控制、滑模控制等现代控制方法的工程可行性和可推广性强,且应用PID控制设计的算法在控制器中的运行效率高,可降低CPU的负载。
本发明实施例中,根据第一参数表的到的第一比例系数和第一微分系数可以用于消除位置偏差参数。实际应用中,第一参数表的车速参数是不连续的,而实际驾驶过程中车速是连续变化的,所以总会遇到获取的速度参数在第一参数表中查寻不到的情况,在该情况下可以确定获取的车速参数在第一参数表中最接近的参数值,用该参数值确定出该速度参数对应的第一比例系数和第一微分系数。
可以理解,采用确定获取的车速参数在第一参数表中最接近的参数值,用该参数值确定出该速度参数对应的第一比例系数和第一微分系数的方式,因为是预估的参数值,会导致确定的第一比例系数和第一微分系数不够精确,影响变道过程控制的准度,为了解决该问题。
优选的,本发明实施例中,所述根据所述速度参数与预设的第一参数表的匹配关系,确定所述速度参数对应的第一比例系数和第一微分系数的步骤包括:
步骤A1:确定与所述速度参数匹配的第一车速模糊子集。
步骤A2:确定所述第一车速模糊子集的第一速度端值和第二速度端值。
步骤A3:确定所述第一速度端值在所述第一参数表中对应的第一端值比例系数、第一端值微分系数。
步骤A4:确定所述第二速度端值在所述第一参数表中对应的第二端值比例系数、第二端值微分系数。
步骤A5:确定第一隶属度系数,包括:将所述第一速度端值与所述速度参数的差值,除以所述第二速度端值与所述第一速度端值的差值,确定出第一隶属度系数。
步骤A6:确定第二隶属度系数,包括:将根据所述第二速度端值与所述速度参数的差值,除以所述第二速度端值与所述第一速度端值的差值,确定出第二隶属度系数。
步骤A7:确定所述第一比例系数,包括:将所述第一隶属度系数与所述第一端值比例系数的乘积,与所述第二隶属度系数与所述第二端值比例系数的乘积的和,除以所述第一隶属度系数与所述第二隶属度系数的和,确定出所述第一比例系数。
步骤A8:确定所述第一微分系数,包括:将所述第一隶属度系数与所述第一端值微分系数的乘积,与所述第二隶属度系数与所述第二端值微分系数的乘积的和,除以所述第一隶属度系数与所述第二隶属度系数的和,确定出所述第一微分系数。
具体应用中,以第一参数表为表1,速度参数值为16为例,步骤A1-步骤A8,具体实现可以是:
首先确定速度参数16在第一车速模糊子集[15,20]中,第一速度端值为15,第二速度端值为20;且该第一速度端值15对应的第一端值比例系数KP为27,第一端值微分系数KD不存在,该第二速度端值20对应的第一端值比例系数KP为24,第二端值微分系数KD不存在.
则可以进一步通过加权平均法确定出第一比例系数。
具体来说:
可以确定第一隶属度系数k1为:(20-16)/(20-15),得到0.8;
确定第二隶属度系数k2为:(16-15)/(20-15),得到0.2;
进而确定输出的第一比例系数KP为:(0.8*27+0.2*24)/(0.8+0.2),得到26.4。
在该例子中,因为第一端值微分系数和第二端值微分系数不存在,所以确定出第一微分系数不存在,不需要进行微分控制。在其他的例子中,假设存在第一端值微分系数和第二端值微分系数,可以用类似上述确定第一比例系数的方式,确定出第一微分系数,本发明实施例在此不做赘述。
以输出为z0,端值为zi,各端值对应的隶属度系数为ki为例,上述过程可以用公式表示为:
实际应用中,本发明实施例的根据第一参数表的到的第一比例系数和第一微分系数消除位置偏差参数的控制算法流程图可以如图14所示。
步骤207:根据所述速度参数与预设的第二参数表的匹配关系,确定所述速度参数对应的第二比例系数。
本发明实施例中,根据第二参数表得到的第二比例系数可以用于消除航向角参数。与用于消除位置偏差参数(横向位置偏差)的模糊-PID控制器设计思想相似,用于消除航向角参数(航向偏差)的PID控制器也需要根据不同的车速调节多组PID参数,在实际控制中根据车速的变化来自动调节参数。不同之处在于换道控制中对航向控制精度要求不是很高,因此PID参数的确定采用查表法且采用P控制。第二参数表可以通过预先测试确定,也可以在现有技术中获取,本发明实施例对此不作具体限定。
举例来说,以第二参数表为表2为例,可以根据获取的速度参数,在表2中查到相对应的近似的或精确的第二比例系数KP。
表2
Speed | KP |
<15 | 8 |
15 | 7.5 |
20 | 6.5 |
25 | 6.3 |
30 | 5.8 |
35 | 5 |
40 | 4.3 |
45 | 3.8 |
50 | 3.3 |
55 | 3 |
60 | 2.9 |
65 | 2.7 |
70 | 2.7 |
75 | 2.6 |
80 | 2.5 |
85 | 2.5 |
90 | 2.4 |
95 | 2.35 |
100 | 2.3 |
105 | 2.1 |
110 | 2 |
>115 | 2 |
实际应用中,本发明实施例的根据第二参数表得到的第二比例系数消除航向角参数的控制算法流程图可以如图15所示。
步骤208:获取所述车辆的位置偏差参数和航向角参数,其中,所述位置偏差参数为所述车辆的当前位置与所述目标行驶车道之间的横向距离;所述航向角为所述车辆的当前航向与所述目标行驶车道的夹角。
步骤209:判断是否达到:所述位置偏差参数低于第一阈值,且所述航向角参数低于第二阈值。若是则结束,若否,则执行步骤1043和步骤1044。。
步骤210:根据所述位置偏差参数、所述第一比例系数和所述第一微分系数,通过比例微分控制算法,确定出第一方向盘转角。
步骤211:根据所述航向角参数、所述第二比例系数,通过比例控制算法,确定出第二方向盘转角。
步骤212:按照预设规则对所述第一方向盘转角和所述第二方向盘转角进行计算,得到目标方向盘转角。
具体应用中,以车辆安装了车载摄像头为例,通过车载摄像头可以确定车辆的实时行驶状况。车辆的位置偏差参数可以通过车辆横向位置和目标行驶车道的横向目标位置的差值确定。步骤208至步骤212可以通过下述方式实现:
确定车辆横向位置:车辆横向位置可以由车载摄像头检测车道线并通过控制器拟合曲线,以三次多项式的形式输出,公式表示如下:
左侧车道线:left_y=left_c3*x^3+left_c2*x^2+left_c1*x+left_c0
右侧车道线:right_y=right_c3*x^3+right_c2*x^2+right_c1*x+right_c0
根据多项式的定义,车辆在本车道内时:横向位置=车道宽/2-left_c0,或横向位置=right_c0-车道宽/2
进入相邻车道后:横向位置=3*车道宽/2-left_c0,或横向位置=right_c0+车道宽/2
航向角参数(HeadingAngle)也可以在车载摄像头中读取为:arctan(left_c1)或arctan(right_c0)。
确定横向目标位置:左换道:一个车道宽(标准车道为3.75m);右换道:一个车道宽的负值。
偏差计算:位置偏差参数=目标横向位置-实时横向位置
航向角参数=-HeadingAngle
PID参数获取:用于消除横向位置偏差的PID控制器参数:通过第一参数表获取;用于消除航向偏差的PID控制器参数:通过第二参数表获取。
PID运算:对横向位置偏差作PD运算:y1=kp*e(t)+kd*de(t)/dt
对航向偏差作P运算:y2=kp*e(t)
目标控制量:目标方向盘转角=y1+y2
优选的,还可以对目标转角输出处理:例如变化率限制:根据EPS最大响应速率确定上下限;确定最大最小值限制:根据车辆转向机构的极限转角值确定;一阶滞后滤波:根据执行机构响应滞后时间确定滤波系数滤波。
以上过程可用图16表示。本技术方案已经在实车上经过上百次测试验证,控制的鲁棒性、舒适性均很好,且应用PID控制设计的算法在控制器中的运行效率高,可降低CPU的负载。
作为本发明实施例的一种优选方案,步骤210的一种实现方式是:根据预设时长、预设配置规律及所述位置偏差参数,确定在所述预设时长内各时刻的位置偏差参数分量;根据所述第一比例系数、所述第一微分系数及所述各时刻的位置偏差参数分量,通过比例微分控制算法,确定出所述各时刻的第一方向盘转角。此时,步骤212的实现方式是:按照预设规则对所述各时刻的第一方向盘转角和所述第二方向盘转角进行计算,得到所述各时刻的目标方向盘转角。
具体应用中,考虑到在进行变道操作时,初始时由于车辆到目标行驶航道的距离较远,位置偏差参数较大,如果将位置偏差参数直接作为控制器的输入,将会导致在开始变道时,车辆获取一个较大的目标方向盘转向角,引起车辆的不稳定。为了消除该不稳定,本发明实施例中,在获取到位置偏差参数后,根据预设时长、预设配置规律及所述位置偏差参数,确定在所述预设时长内各时刻的位置偏差参数分量;然后根据第一比例系数、所述第一微分系数及所述各时刻的位置偏差参数分量,通过比例微分控制算法,确定出所述各时刻的第一方向盘转角。也就是首先把位置偏差参量按时间划分,这个划分可以是连续的,也可以是间隔的,本发明实施例对此不作具体限定,然后得到各时间点的第一方向盘转角;那么后续就可以实现按照各时间点的目标方向盘转向角,逐步去控制车辆进行变道,保持车辆变道过程的稳定性。
综上所述,本发明实施例的一种车辆变道控制方法,在接收到变道指令后,根据车辆的速度参数,车辆与目标行驶车道的横向位置距离以及车辆的航向与目标行驶车道的夹角,就可以通过控制器实现变道控制。具体来说,在接收到变道指令后,先根据速度参数确定出预设控制器的控制参数,预设控制器再分别根据两个变量:车辆的位置偏差参数和航向角参数,确定车辆的目标方向盘转向角,通过目标方向盘转向角可以控制车辆进行变道操作,持续获取位置偏差参数和航向角参数,进行变道操作,直到位置偏差参数低于第一阈值,和,航向角参数低于第二阈值,可以认为该车辆在目标行驶车道上,沿着目标行驶车道的方向行驶,即完成了车辆变道。本发明实施例通过速度参数、位置偏差参数和航向角来控制车辆变道和判定是否完成变道,速度参数、位置偏差参数和航向角通过速度传感器、车载摄像头就可以获取,而不需要依赖高精度的定位系统,能大大减少车辆变道所需的成本和对控制器资源的占用。
如图17所示,其示出了本发明实施例提供的一种车辆变道控制装置的结构框图,该装置具体包括:
变道指令接收模块310,用于接收变道指令;所述变道指令包括目标行驶车道;
速度参数获取模块320,用于获取所述车辆的速度参数;
控制系数确定模块330,用于根据所述速度参数确定预设控制器的控制系数;
变道控制模块340,用于获取所述车辆的位置偏差参数和航向角参数;当所述位置偏差参数大于或等于第一阈值,或,所述航向角参数大于或等于第二阈值时,根据所述控制系数、所述位置偏差参数和所述航向角参数,确定所述车辆的目标方向盘转向角;根据所述目标方向盘转向角,控制所述车辆进行变道操作;直到所述位置偏差参数低于第一阈值,且所述航向角参数低于第二阈值;其中,所述位置偏差参数为所述车辆的当前位置与所述目标行驶车道之间的横向距离;所述航向角为所述车辆的当前航向与所述目标行驶车道的夹角。
如图18所示,其示出了本发明实施例提供的一种车辆变道控制装置的具体结构框图,在图17的基础上,所述装置中:
所述根据控制系数确定模块330包括:
第一确定子模块3301,用于根据所述速度参数与预设的第一参数表的匹配关系,确定所述速度参数对应的第一比例系数和第一微分系数。
第二确定子模块3302,用于根据所述速度参数与预设的第二参数表的匹配关系,确定所述速度参数对应的第二比例系数。
所述变道控制模块340包括:
第一方向盘转角确定子模块3401,用于根据所述位置偏差参数、所述第一比例系数和所述第一微分系数,通过比例微分控制算法,确定出第一方向盘转角。
第二方向盘转角确定子模块3402,用于根据所述航向角参数、所述第二比例系数,通过比例控制算法,确定出第二方向盘转角。
目标方向盘转角确定子模块3403,用于按照预设规则对所述第一方向盘转角和所述第二方向盘转角进行计算,得到目标方向盘转角。
所述装置还包括:
车速模糊模块350,用于将预置车速进行模糊化,得到所述预置车速的模糊论域;其中,所述预置车速的模糊论域包括:车速模糊子集,车速隶属度函数。
模糊论域确定模块360,用于根据所述车速模糊子集和所述车速隶属度函数,确定不同预置车速下所述比例系数的模糊论域、所述微分系数的模糊论域;其中,所述比例系数的模糊论域包括:比例系数模糊子集,比例系数隶属度函数;所述微分系数的模糊论域包括:微分系数模糊子集,微分系数隶属度函数。
第一参数表建立模块370,用于根据所述车速模糊子集,所述车速隶属度函数,所述比例系数模糊子集、所述比例系数隶属度函数、所述微分系数模糊子集,及所述微分系数隶属度函数之间的对应关系,建立所述第一参数表。
所述第一方向盘转角确定子模块3401包括:
位置偏差参数分量确定单元34011,用于根据预设时长、预设配置规律及所述位置偏差参数,确定在所述预设时长内各时刻的位置偏差参数分量;
第一方向盘转角确定单元34012,用于根据所述第一比例系数、所述第一微分系数及所述各时刻的位置偏差参数分量,通过比例微分控制算法,确定出所述各时刻的第一方向盘转角;
所述目标方向盘转角确定子模块3403包括:
目标方向盘转角确定单元34031,用于按照预设规则对所述各时刻的第一方向盘转角和所述第二方向盘转角进行计算,得到所述各时刻的目标方向盘转角。
一种车辆,车辆包括任一所述的车辆变道控制装置。
本发明实施例在接收到变道指令后,根据车辆的速度参数,车辆与目标行驶车道的横向位置距离以及车辆的航向与目标行驶车道的夹角,就可以通过控制器实现变道控制。具体来说,在接收到变道指令后,先根据速度参数确定出预设控制器的控制参数,预设控制器再分别根据两个变量:车辆的位置偏差参数和航向角参数,确定车辆的目标方向盘转向角,通过目标方向盘转向角可以控制车辆进行变道操作,持续获取位置偏差参数和航向角参数,进行变道操作,直到位置偏差参数低于第一阈值,和,航向角参数低于第二阈值,可以认为该车辆在目标行驶车道上,沿着目标行驶车道的方向行驶,即完成了车辆变道。本发明实施例通过速度参数、位置偏差参数和航向角来控制车辆变道和判定是否完成变道,速度参数、位置偏差参数和航向角通过速度传感器、车载摄像头就可以获取,而不需要依赖高精度的定位系统,能大大减少车辆变道所需的成本和对控制器资源的占用。
所属领域的技术人员可以清楚地了解到,为描述的方便和简洁,上述描述的系统、装置和单元的具体工作过程,可以参考前述方法实施例中的对应过程,在此不再赘述。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (10)
1.一种车辆变道控制方法,其特征在于,包括:
接收变道指令;所述变道指令包括目标行驶车道;
获取所述车辆的速度参数;
根据所述速度参数确定预设控制器的控制系数,包括:根据所述速度参数与预设的第一参数表的匹配关系,确定所述速度参数对应的第一比例系数和第一微分系数;
根据所述速度参数与预设的第二参数表的匹配关系,确定所述速度参数对应的第二比例系数;
变道控制,包括:获取所述车辆的位置偏差参数和航向角参数;当所述位置偏差参数大于或等于第一阈值,或,所述航向角参数大于或等于第二阈值时,根据所述控制系数、所述位置偏差参数和所述航向角参数,确定所述车辆的目标方向盘转向角;根据所述目标方向盘转向角,控制所述车辆进行变道操作;
重复所述变道控制步骤,直到所述位置偏差参数低于第一阈值,且所述航向角参数低于第二阈值;
其中,所述位置偏差参数为所述车辆的当前位置与所述目标行驶车道之间的横向距离;所述航向角为所述车辆的当前航向与所述目标行驶车道的夹角。
2.根据权利要求1所述的方法,其特征在于,所述根据所述控制系数、所述位置偏差参数和所述航向角参数确定所述车辆的目标方向盘转向角的步骤包括:
根据所述位置偏差参数、所述第一比例系数和所述第一微分系数,通过比例微分控制算法,确定出第一方向盘转角;
根据所述航向角参数、所述第二比例系数,通过比例控制算法,确定出第二方向盘转角;
按照预设规则对所述第一方向盘转角和所述第二方向盘转角进行计算,得到目标方向盘转角。
3.根据权利要求2所述的方法,其特征在于,在所述根据所述速度参数确定预设控制器的控制系数之前,还包括:
将预置车速进行模糊化,得到所述预置车速的模糊论域;其中,所述预置车速的模糊论域包括:车速模糊子集,车速隶属度函数;
根据所述车速模糊子集和所述车速隶属度函数,确定不同预置车速下所述比例系数的模糊论域、所述微分系数的模糊论域;其中,所述比例系数的模糊论域包括:比例系数模糊子集,比例系数隶属度函数;所述微分系数的模糊论域包括:微分系数模糊子集,微分系数隶属度函数;
根据所述车速模糊子集,所述车速隶属度函数,所述比例系数模糊子集、所述比例系数隶属度函数、所述微分系数模糊子集,及所述微分系数隶属度函数之间的对应关系,建立所述第一参数表。
4.根据权利要求3所述的方法,其特征在于,所述根据所述速度参数与预设的第一参数表的匹配关系,确定所述速度参数对应的第一比例系数和第一微分系数的步骤包括:
确定与所述速度参数匹配的第一车速模糊子集;
确定所述第一车速模糊子集的第一速度端值和第二速度端值;
确定所述第一速度端值在所述第一参数表中对应的第一端值比例系数、第一端值微分系数;
确定所述第二速度端值在所述第一参数表中对应的第二端值比例系数、第二端值微分系数;
确定第一隶属度系数,包括:将所述第一速度端值与所述速度参数的差值,除以所述第二速度端值与所述第一速度端值的差值,确定出第一隶属度系数;
确定第二隶属度系数,包括:将根据所述第二速度端值与所述速度参数的差值,除以所述第二速度端值与所述第一速度端值的差值,确定出第二隶属度系数;
确定所述第一比例系数,包括:将所述第一隶属度系数与所述第一端值比例系数的乘积,与所述第二隶属度系数与所述第二端值比例系数的乘积的和,除以所述第一隶属度系数与所述第二隶属度系数的和,确定出所述第一比例系数;
确定所述第一微分系数,包括:将所述第一隶属度系数与所述第一端值微分系数的乘积,与所述第二隶属度系数与所述第二端值微分系数的乘积的和,除以所述第一隶属度系数与所述第二隶属度系数的和,确定出所述第一微分系数。
5.根据权利要求2所述的方法,其特征在于,所述根据所述位置偏差参数、所述第一比例系数和所述第一微分系数,通过比例微分控制算法,确定出第一方向盘转角,包括:
根据预设时长、预设配置规律及所述位置偏差参数,确定在所述预设时长内各时刻的位置偏差参数分量;
根据所述第一比例系数、所述第一微分系数及所述各时刻的位置偏差参数分量,通过比例微分控制算法,确定出所述各时刻的第一方向盘转角;
所述按照预设规则对所述第一方向盘转角和所述第二方向盘转角进行计算,得到目标方向盘转角,包括:
按照预设规则对所述各时刻的第一方向盘转角和所述第二方向盘转角进行计算,得到所述各时刻的目标方向盘转角。
6.一种车辆变道控制装置,其特征在于,包括:
变道指令接收模块,用于接收变道指令;所述变道指令包括目标行驶车道;
速度参数获取模块,用于获取所述车辆的速度参数;
控制系数确定模块,用于根据所述速度参数确定预设控制器的控制系数;
所述控制系数确定模块包括:
第一确定子模块,用于根据所述速度参数与预设的第一参数表的匹配关系,确定所述速度参数对应的第一比例系数和第一微分系数;
第二确定子模块,用于根据所述速度参数与预设的第二参数表的匹配关系,确定所述速度参数对应的第二比例系数;
变道控制模块,用于获取所述车辆的位置偏差参数和航向角参数;当所述位置偏差参数大于或等于第一阈值,或,所述航向角参数大于或等于第二阈值时,根据所述控制系数、所述位置偏差参数和所述航向角参数,确定所述车辆的目标方向盘转向角;根据所述目标方向盘转向角,控制所述车辆进行变道操作;直到所述位置偏差参数低于第一阈值,且所述航向角参数低于第二阈值;其中,所述位置偏差参数为所述车辆的当前位置与所述目标行驶车道之间的横向距离;所述航向角为所述车辆的当前航向与所述目标行驶车道的夹角。
7.根据权利要求6所述的装置,其特征在于,所述变道控制模块包括:
第一方向盘转角确定子模块,用于根据所述位置偏差参数、所述第一比例系数和所述第一微分系数,通过比例微分控制算法,确定出第一方向盘转角;
第二方向盘转角确定子模块,用于根据所述航向角参数、所述第二比例系数,通过比例控制算法,确定出第二方向盘转角;
目标方向盘转角确定子模块,用于按照预设规则对所述第一方向盘转角和所述第二方向盘转角进行计算,得到目标方向盘转角。
8.根据权利要求7所述的装置,其特征在于,还包括:
车速模糊模块,用于将预置车速进行模糊化,得到所述预置车速的模糊论域;其中,所述预置车速的模糊论域包括:车速模糊子集,车速隶属度函数;
模糊论域确定模块,用于根据所述车速模糊子集和所述车速隶属度函数,确定不同预置车速下所述比例系数的模糊论域、所述微分系数的模糊论域;其中,所述比例系数的模糊论域包括:比例系数模糊子集,比例系数隶属度函数;所述微分系数的模糊论域包括:微分系数模糊子集,微分系数隶属度函数;
第一参数表建立模块,用于根据所述车速模糊子集,所述车速隶属度函数,所述比例系数模糊子集、所述比例系数隶属度函数、所述微分系数模糊子集,及所述微分系数隶属度函数之间的对应关系,建立所述第一参数表。
9.根据权利要求7所述的装置,其特征在于,所述第一方向盘转角确定子模块包括:
位置偏差参数分量确定单元,用于根据预设时长、预设配置规律及所述位置偏差参数,确定在所述预设时长内各时刻的位置偏差参数分量;
第一方向盘转角确定单元,用于根据所述第一比例系数、所述第一微分系数及所述各时刻的位置偏差参数分量,通过比例微分控制算法,确定出所述各时刻的第一方向盘转角;
所述目标方向盘转角确定子模块包括:
目标方向盘转角确定单元,用于按照预设规则对所述各时刻的第一方向盘转角和所述第二方向盘转角进行计算,得到所述各时刻的目标方向盘转角。
10.一种车辆,其特征在于,所述车辆包括权利要求6至9任一所述的车辆变道控制装置。
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810652866.9A CN110018632B (zh) | 2018-06-22 | 2018-06-22 | 一种车辆变道控制方法和装置 |
EP19822877.7A EP3798746B1 (en) | 2018-06-22 | 2019-06-21 | Vehicle lane change control method and device |
US17/255,215 US11919518B2 (en) | 2018-06-22 | 2019-06-21 | Vehicle lane change control method and device |
PCT/CN2019/092238 WO2019242718A1 (zh) | 2018-06-22 | 2019-06-21 | 一种车辆变道控制方法和装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810652866.9A CN110018632B (zh) | 2018-06-22 | 2018-06-22 | 一种车辆变道控制方法和装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110018632A CN110018632A (zh) | 2019-07-16 |
CN110018632B true CN110018632B (zh) | 2020-10-09 |
Family
ID=67188389
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810652866.9A Active CN110018632B (zh) | 2018-06-22 | 2018-06-22 | 一种车辆变道控制方法和装置 |
Country Status (4)
Country | Link |
---|---|
US (1) | US11919518B2 (zh) |
EP (1) | EP3798746B1 (zh) |
CN (1) | CN110018632B (zh) |
WO (1) | WO2019242718A1 (zh) |
Families Citing this family (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111016891B (zh) * | 2019-11-06 | 2022-03-22 | 国汽(北京)智能网联汽车研究院有限公司 | 一种车辆行驶的路线跟踪控制方法及装置 |
WO2021189210A1 (zh) * | 2020-03-23 | 2021-09-30 | 华为技术有限公司 | 一种车辆换道方法及相关设备 |
CN114137948B (zh) * | 2020-08-13 | 2024-06-21 | 长沙智能驾驶研究院有限公司 | 编队车辆行驶方法、装置、计算机设备和存储介质 |
JP7276282B2 (ja) * | 2020-08-24 | 2023-05-18 | トヨタ自動車株式会社 | 物体検出装置、物体検出方法及び物体検出用コンピュータプログラム |
CN112235377B (zh) * | 2020-09-30 | 2024-04-02 | 深圳市元征科技股份有限公司 | 车辆位置信息的上报方法、装置、设备及存储介质 |
CN112148016B (zh) * | 2020-09-30 | 2024-05-10 | 深兰人工智能(深圳)有限公司 | 基于模型预测控制算法横纵向解耦的车辆控制方法和装置 |
CN112874536B (zh) * | 2021-01-19 | 2023-09-12 | 英博超算(南京)科技有限公司 | 一种智能车辆拨杆换道方法 |
CN113428141B (zh) * | 2021-07-15 | 2022-12-09 | 东风汽车集团股份有限公司 | 一种前车紧急切入及时响应的智能检测方法及系统 |
CN113624520B (zh) * | 2021-07-29 | 2023-05-16 | 东风汽车集团股份有限公司 | 一种基于机器视觉技术的实时计算车辆不足转向梯度系数的系统、方法及介质 |
CN113515038B (zh) * | 2021-09-07 | 2021-11-26 | 西南交通大学 | 一种车辆换道方法、装置、设备及可读存储介质 |
CN113848899A (zh) * | 2021-09-22 | 2021-12-28 | 中国第一汽车股份有限公司 | 车辆横向控制方法、装置、设备及存储介质 |
CN113715816B (zh) * | 2021-09-30 | 2023-06-30 | 岚图汽车科技有限公司 | 车道居中功能控制方法、装置、设备及可读存储介质 |
CN113885498B (zh) * | 2021-10-08 | 2023-10-20 | 湖南三一华源机械有限公司 | 压路机的避障控制方法、控制装置和控制系统 |
CN114103957B (zh) * | 2021-12-22 | 2024-02-06 | 阿波罗智联(北京)科技有限公司 | 变道控制方法、装置、电子设备和存储介质 |
CN114506342B (zh) * | 2022-03-03 | 2023-12-05 | 东风悦享科技有限公司 | 一种自动驾驶变道决策的方法、系统及车辆 |
CN114940210B (zh) * | 2022-04-02 | 2023-10-31 | 中汽创智科技有限公司 | 一种方向盘转角信号的确定方法及装置 |
CN115240426B (zh) * | 2022-07-26 | 2024-03-26 | 东软睿驰汽车技术(沈阳)有限公司 | 一种变道数据的自动定位方法、装置、设备及存储介质 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102076541A (zh) * | 2008-06-20 | 2011-05-25 | 通用汽车环球科技运作公司 | 用于自动车道居中和车道变换控制系统的路径生成算法 |
CN103809593A (zh) * | 2012-11-06 | 2014-05-21 | 现代摩比斯株式会社 | 汽车变车道控制装置及其控制方法 |
CN105752081A (zh) * | 2014-12-30 | 2016-07-13 | 株式会社万都 | 车道变换控制装置及控制方法 |
CN107323450A (zh) * | 2017-06-08 | 2017-11-07 | 广州汽车集团股份有限公司 | 车辆变道的控制方法及装置、存储介质 |
Family Cites Families (29)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8428843B2 (en) * | 2008-06-20 | 2013-04-23 | GM Global Technology Operations LLC | Method to adaptively control vehicle operation using an autonomic vehicle control system |
CN102358287A (zh) * | 2011-09-05 | 2012-02-22 | 北京航空航天大学 | 一种用于车辆自动驾驶机器人的轨迹跟踪控制方法 |
US8849515B2 (en) * | 2012-07-24 | 2014-09-30 | GM Global Technology Operations LLC | Steering assist in driver initiated collision avoidance maneuver |
KR101439017B1 (ko) * | 2013-04-11 | 2014-10-30 | 현대자동차주식회사 | 차선 변경 제어 시스템 |
US9174672B2 (en) * | 2013-10-28 | 2015-11-03 | GM Global Technology Operations LLC | Path planning for evasive steering maneuver in presence of target vehicle and surrounding objects |
US9229453B1 (en) * | 2014-08-29 | 2016-01-05 | GM Global Technology Operations LLC | Unified motion planner for autonomous driving vehicle in avoiding the moving obstacle |
US9499197B2 (en) * | 2014-10-15 | 2016-11-22 | Hua-Chuang Automobile Information Technical Center Co., Ltd. | System and method for vehicle steering control |
CN104360687B (zh) * | 2014-11-06 | 2017-03-15 | 北京矿冶研究总院 | 一种地下铲运机多模式自主行驶控制方法 |
US20190143972A1 (en) * | 2016-03-15 | 2019-05-16 | Honda Motor Co., Ltd. | Vehicle control system, vehicle control method, and vehicle control program |
CN106080941B (zh) | 2016-08-04 | 2018-12-18 | 清华大学 | 一种实现变速平衡控制的无人驾驶自行车 |
US10150474B2 (en) * | 2017-01-04 | 2018-12-11 | Robert Bosch Gmbh | Reducing lateral position deviation during an automated lane change |
CN108082185B (zh) * | 2017-03-30 | 2021-01-01 | 长城汽车股份有限公司 | 一种车辆的行驶控制方法、装置和车辆 |
WO2018189843A1 (ja) * | 2017-04-12 | 2018-10-18 | 日産自動車株式会社 | 運転制御方法及び運転制御装置 |
JP6897349B2 (ja) * | 2017-06-09 | 2021-06-30 | トヨタ自動車株式会社 | 運転支援装置 |
JP2019003234A (ja) * | 2017-06-09 | 2019-01-10 | トヨタ自動車株式会社 | 運転支援装置 |
BR112020004099A2 (pt) * | 2017-08-30 | 2020-09-24 | Nissan Motor Co., Ltd. | método de correção de posição e dispositivo de correção de erro de posição para veículos auxiliados por condução |
US10953881B2 (en) * | 2017-09-07 | 2021-03-23 | Tusimple, Inc. | System and method for automated lane change control for autonomous vehicles |
US10586455B2 (en) * | 2017-10-19 | 2020-03-10 | Veoneer Us, Inc. | Systems and methods for vehicle lane change detection |
US10377383B2 (en) * | 2017-12-11 | 2019-08-13 | Ford Global Technologies, Llc | Vehicle lane change |
US11117584B2 (en) * | 2018-04-27 | 2021-09-14 | Honda Motor Co., Ltd. | Merge behavior systems and methods for mainline vehicles |
US11572099B2 (en) * | 2018-04-27 | 2023-02-07 | Honda Motor Co., Ltd. | Merge behavior systems and methods for merging vehicles |
US11260849B2 (en) * | 2018-05-23 | 2022-03-01 | Baidu Usa Llc | Method for determining lane changing trajectories for autonomous driving vehicles |
US20190389470A1 (en) * | 2018-06-22 | 2019-12-26 | GM Global Technology Operations LLC | System and method for controlling a vehicle based on an anticipated lane departure |
KR20200075915A (ko) * | 2018-12-07 | 2020-06-29 | 현대자동차주식회사 | 차량의 주행 제어 장치 및 그 방법 |
US11186282B2 (en) * | 2018-12-11 | 2021-11-30 | Alpine Electronics, Inc. | Automated lane change system and methods |
CN113826153B (zh) * | 2019-05-15 | 2024-01-02 | 日产自动车株式会社 | 车辆的行驶控制方法及行驶控制装置 |
US11292470B2 (en) * | 2020-01-06 | 2022-04-05 | GM Global Technology Operations LLC | System method to establish a lane-change maneuver |
US11685398B2 (en) * | 2020-02-27 | 2023-06-27 | Baidu Usa Llc | Lane based routing system for autonomous driving vehicles |
US11472435B2 (en) * | 2020-11-30 | 2022-10-18 | Automotive Research & Testing Center | Trajectory determination method for a vehicle |
-
2018
- 2018-06-22 CN CN201810652866.9A patent/CN110018632B/zh active Active
-
2019
- 2019-06-21 EP EP19822877.7A patent/EP3798746B1/en active Active
- 2019-06-21 US US17/255,215 patent/US11919518B2/en active Active
- 2019-06-21 WO PCT/CN2019/092238 patent/WO2019242718A1/zh unknown
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102076541A (zh) * | 2008-06-20 | 2011-05-25 | 通用汽车环球科技运作公司 | 用于自动车道居中和车道变换控制系统的路径生成算法 |
CN103809593A (zh) * | 2012-11-06 | 2014-05-21 | 现代摩比斯株式会社 | 汽车变车道控制装置及其控制方法 |
CN105752081A (zh) * | 2014-12-30 | 2016-07-13 | 株式会社万都 | 车道变换控制装置及控制方法 |
CN107323450A (zh) * | 2017-06-08 | 2017-11-07 | 广州汽车集团股份有限公司 | 车辆变道的控制方法及装置、存储介质 |
Also Published As
Publication number | Publication date |
---|---|
US11919518B2 (en) | 2024-03-05 |
EP3798746A1 (en) | 2021-03-31 |
WO2019242718A1 (zh) | 2019-12-26 |
EP3798746A4 (en) | 2022-03-23 |
CN110018632A (zh) | 2019-07-16 |
US20210269038A1 (en) | 2021-09-02 |
EP3798746B1 (en) | 2023-08-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110018632B (zh) | 一种车辆变道控制方法和装置 | |
Huang et al. | Data-driven shared steering control of semi-autonomous vehicles | |
Guo et al. | Nonlinear coordinated steering and braking control of vision-based autonomous vehicles in emergency obstacle avoidance | |
CN109131325B (zh) | 智能驾驶汽车的三维可拓预瞄切换的车道保持控制方法 | |
Rupp et al. | Survey on control schemes for automated driving on highways | |
CN105676643B (zh) | 一种智能汽车转向和制动自适应协调控制方法 | |
CN111016893B (zh) | 一种拥堵环境下智能车辆可拓博弈车道保持自适应巡航控制系统与控制方法 | |
Song et al. | A vehicle trajectory tracking method with a time-varying model based on the model predictive control | |
US11024178B2 (en) | System and method for autonomously steering a vehicle | |
CN107037808B (zh) | 基于滑模控制器的输送车寻迹方法 | |
CN113515125A (zh) | 一种无人驾驶汽车全工况避障控制方法及性能评价方法 | |
Bayuwindra et al. | Extended look-ahead tracking controller with orientation-error observer for vehicle platooning | |
Chen et al. | An adaptive path tracking controller based on reinforcement learning with urban driving application | |
CN114852085A (zh) | 基于路权侵入度的车辆自动驾驶轨迹规划方法 | |
CN114510032A (zh) | 一种保障车辆快速编队稳定的多车协同控制方法及装置 | |
Bai et al. | A robust guiding torque control method for automatic steering using LMI algorithm | |
Pauca et al. | Control architecture for cooperative autonomous vehicles driving in platoons at highway speeds | |
Wei et al. | Driver-centred autonomous vehicle motion control within a blended corridor | |
Pauca et al. | Trajectory planner based on third-order polynomials applied for platoon merging and splitting | |
Meng et al. | Parking path tracking method based on Kalman filter and fuzzy control | |
Kim et al. | Brain limbic system-based intelligent controller application to lane change manoeuvre | |
Cai et al. | Implementation of the Human‐Like Lane Changing Driver Model Based on Bi‐LSTM | |
Huang et al. | Robust autonomous driving with human in the loop | |
Korus et al. | Robust design of a complex, perturbed lateral control system for automated driving | |
Jianglin | Intelligent vehicle automatic lane changing lateral control method based on deep learning |
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 | ||
TR01 | Transfer of patent right |
Effective date of registration: 20210518 Address after: 100055 1802, 18 / F, building 3, yard 9, Guang'an Road, Fengtai District, Beijing Patentee after: Momo Zhixing Technology Co.,Ltd. Address before: 071000 No. 2266 Chaoyang South Street, Hebei, Baoding Patentee before: Great Wall Motor Co.,Ltd. |