CN103909927B - 横向控制装置及其控制方法 - Google Patents
横向控制装置及其控制方法 Download PDFInfo
- Publication number
- CN103909927B CN103909927B CN201310033303.9A CN201310033303A CN103909927B CN 103909927 B CN103909927 B CN 103909927B CN 201310033303 A CN201310033303 A CN 201310033303A CN 103909927 B CN103909927 B CN 103909927B
- Authority
- CN
- China
- Prior art keywords
- car
- transversal displacement
- offset
- measurement
- preview
- 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 20
- 238000005259 measurement Methods 0.000 claims abstract description 60
- 238000006073 displacement reaction Methods 0.000 claims abstract description 57
- 230000002159 abnormal effect Effects 0.000 abstract description 4
- 230000009286 beneficial effect Effects 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 8
- SAZUGELZHZOXHB-UHFFFAOYSA-N acecarbromal Chemical compound CCC(Br)(CC)C(=O)NC(=O)NC(C)=O SAZUGELZHZOXHB-UHFFFAOYSA-N 0.000 description 2
- 230000004888 barrier function Effects 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- WHGYBXFWUBPSRW-FOUAGVGXSA-N beta-cyclodextrin Chemical compound OC[C@H]([C@H]([C@@H]([C@H]1O)O)O[C@H]2O[C@@H]([C@@H](O[C@H]3O[C@H](CO)[C@H]([C@@H]([C@H]3O)O)O[C@H]3O[C@H](CO)[C@H]([C@@H]([C@H]3O)O)O[C@H]3O[C@H](CO)[C@H]([C@@H]([C@H]3O)O)O[C@H]3O[C@H](CO)[C@H]([C@@H]([C@H]3O)O)O3)[C@H](O)[C@H]2O)CO)O[C@@H]1O[C@H]1[C@H](O)[C@@H](O)[C@@H]3O[C@@H]1CO WHGYBXFWUBPSRW-FOUAGVGXSA-N 0.000 description 1
- 235000013399 edible fruits Nutrition 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Classifications
-
- 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
- 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
- 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/109—Lateral acceleration
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B21/00—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant
- G01B21/16—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant for measuring distance of clearance between spaced objects
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
-
- 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/0062—Adapting control system settings
- B60W2050/0075—Automatic parameter input, automatic initialising or calibrating means
- B60W2050/009—Priority selection
-
- 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
- B60W2420/00—Indexing codes relating to the type of sensors based on the principle of their operation
- B60W2420/40—Photo, light or radio wave sensitive means, e.g. infrared sensors
- B60W2420/403—Image sensing, e.g. optical camera
-
- 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
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/12—Lateral 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
- 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/40—Dynamic objects, e.g. animals, windblown objects
- B60W2554/404—Characteristics
- B60W2554/4043—Lateral 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
- B60W2554/00—Input parameters relating to objects
- B60W2554/80—Spatial relation or speed relative to objects
- B60W2554/801—Lateral distance
-
- 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
- B60W2554/802—Longitudinal distance
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60Y—INDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
- B60Y2300/00—Purposes or special features of road vehicle drive control systems
- B60Y2300/10—Path keeping
- B60Y2300/12—Lane keeping
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Mathematical Physics (AREA)
- Traffic Control Systems (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
本发明提供一种横向控制装置及其控制方法,该横向控制装置包括:偏移量测量部,测量当前时刻至少两个他车从行驶车道中心的当前横向偏移量;预览偏移量计算部,基于所述他车的位置和车速,在经过既定时间的时刻,预测所述他车从所述行驶车道中心的横向偏移量而算出预览偏移量;优先顺序决定部,基于所述横向偏移量和所述预览偏移量的相差值,决定所述他车的优先顺序;控制部,基于所述优先顺序决定部定为最优先顺序的所述他车的横向偏移量生成旨在自车车道保持控制的路径。以属于最优先顺序的他车为准实施车道保持控制而扩大LKAS的控制范围,进而提供为驾驶者排除转向异常感或驾驶不稳定感的有益效果。
Description
技术领域
本发明涉及横向控制装置及其控制方法,具体是根据在邻接车道上行驶的他车信息实施车道保持控制的横向控制装置及横向控制方法。
背景技术
智能车辆控制***必须使用车道保持控制装置(Lane Keeping Assist System,以下简称LKAS)才能保护驾驶者的安全。该***一般通过检测车道,监测车辆的行使状态,执行车道保持控制或者做出车道偏离警告,以防车辆偏离检测的车道。
行驶车道或邻接车道是,通过车辆的挡风玻璃和室内镜之间装配的摄像头传感器获得前方的道路图像,将获得的道路图像在LKAS摄像头***中进行处理而检测出。
LKAS是一般以如此检测到的车道为准实施车道保持控制。但,只以检测的车道为准执行车道保持控制,则因周边车辆或者障碍物而引起事故的风险较大。而且为避开周边车辆或与障碍物发生冲撞而无法实施车道保持控制。
而且只以车道为准实施车道保持控制,则与车辆位置相对应地决定转向扭矩,造成转向异常和车辆倾斜现象而容易导致驾驶不安全的问题。
为此,韩国公开专利10-2011-0054144提出了一种将自车的行驶轨迹从车道中心向周边车辆的相反方向偏向地设置,而且根据偏向设置的行驶轨迹偏向地生成转向扭矩图的方案。但是,如果两侧车道前方都有多个车辆,就无法将自车的行驶轨迹向左或向右偏向设置。而且因只考虑在邻接车道行驶中的前方车辆而无法应对后面快速接近的车辆。
而且不会预测周边车辆的行进轨迹,只是利用周边车辆的当前测定的横向偏移量,故在车辆的举动发生变换时,无法精确地实施车道保持控制。
发明内容
技术课题
本发明的目的在于提供一种不仅考虑邻接车道的先行车辆,还考虑后行车辆实施车道保持控制的横向控制装置及横向控制方法,以解决所述问题。
本发明的目的在于提供一种最大限度的减少驾驶者感受到的转向异常感和不安全感的横向控制装置及横向控制方法。
技术方案
为实现所述目的,本发明提供一种横向控制装置,包括:偏移量测量部,测量当前时刻至少两个他车从行驶车道中心的当前横向偏移量;预览偏移量计算部,基于所述他车的位置和车速,在经过既定时间的时刻,预测所述他车从所述行驶车道中心的横向偏移量而算出预览偏移量;优先顺序决定部,基于所述横向偏移量和所述预览偏移量的相差值,决定所述他车的优先顺序;控制部,基于所述优先顺序决定部定为最优先顺序的所述他车的横向偏移量生成旨在自车车道保持控制的路径。
优选地,所述偏移量测量部包括:第一偏移量测量部,测量位于以所述行驶车道中心为准既定的前方距离内的至少一个先行车辆的横向偏移量;第二偏移量测量部,测量位于以所述行驶车道中心为准既定的前方距离内的至少一个后行车辆的横向偏移量。
优选地,所述预览偏移量计算部包括:测量部,测量所述自车和所述他车的纵向间距和横向间距,并测量所述他车的纵向速度和横向速度;计算部,基于所述测量部测量的所述纵向间距、横向间距、纵向速度和横向速度计算经过所述既定时间之后所述他车的预览偏移量。
优选地,所述测量部包括:前方摄像头传感器,获得所述自车的前方图像;后方摄像头传感器,获得所述自车的后方图像。
优选地,所述优先顺序决定部是从所述他车中将所述横向偏移量与所述预览偏移量的相差值最大的某一个定为最优先顺序。
优选地,所述控制部是,在与所生成的路径相对应的控制扭矩值超过既定的临界值时,改变所述自车的车速而重新生成路径。
为实现所述目的,本发明的实施步骤包括:测量当前时刻至少两个他车从行驶车道中心的横向偏移量;基于所述他车的位置和车速,经过既定时间的时刻预测所述他车从所述行驶车道中心的横向偏移量而算出预览偏移量;基于所述横向偏移量和所述预览偏移量的相差值决定所述他车的优先顺序;基于定为最优先顺序的所述他车的横向偏移量生成旨在自车车道保持控制的路径。
优选地,在所述横向偏移量测量阶段,测量位于以所述行驶车道中心为准既定的前方距离内的至少一个先行车辆的横向偏移量,测量位于以所述行驶车道中心为准既定的后方距离内的至少一个后行车辆的横向偏移量。
优选地,在所述预览偏移量计算步骤,测量所述自车与所述他车的纵向间距和横向间距,测量所述他车的纵向速度和横向速度,基于所测量的所述纵向间距、横向间距、纵向速度和横向速度计算出经过所述既定时间之后所述他车的预览偏移量。
优选地,所述纵向间距、横向间距、纵向速度和横向速度是通过所述自车的前方图像和后方图像测量。
优选地,在所述优先顺序决定步骤,从所述他车中,将所述横向偏移量与所述预览偏移量的相差值最大的某一个定为最优先顺序。
优选地,若与所生成的路径对应的控制扭矩值超过既定的临界值,则改变所述自车的速度而重新生成路径。
有益效果
根据本发明的横向控制装置及横向控制方法,对他车的当前横向偏移量和预览横向偏移量进行比较,以相当于最优先顺序的他车为准实施车道保持控制,从而扩大LKAS的控制范围,为驾驶者排除转向异常感或者驾驶的不安全感。
而且,根据本发明的横向控制装置及横向控制方法,不仅考虑邻接车道的前方车辆,还考虑后方车辆生成为车道保持控制的路径,从而更加稳定地车道保持控制。
而且,根据本发明的横向控制装置及横向控制方法,与对他车的当前横向偏移量和预览横向偏移量进行比较生成的路径相应的控制扭矩值超过既定的临界值时,可以重新设置路径而防止因大转向扭矩而产生转向异常感。
附图说明
图1是以行驶车道中心为准显示他车横向偏移量的图示;
图2是本发明优选实施例的横向控制装置图示;
图3是图2中图示的偏移量测量部图示;
图4是图2中图示的预览偏移量计算部图示;
图5是以行驶车道中心为准表示的他车预览偏移量图示;
图6是本发明优选的一个实施例的横向控制方法的流程图。
附图标记说明
110 : 偏移量测量部
111 : 第一偏移量测量部
112 : 第二偏移量测量部
120 : 预览偏移量计算部
121 : 测量部
122 : 计算部
130 : 优先顺序决定部
140 : 控制部。
具体实施方式
下面参照附图,对发明优选实施例详细进行描述。说明内容和不同附图中的同一个构件尽量用同一个符号表示。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
图1是以行驶车道中心为准显示他车横向偏移量的图示。根据图1,LKAS可以利用邻接车道上行驶的他车2、3从自车1的行驶车道(L)中心(C)的横向偏移量(ε1、ε2、ε3、ε4)实施自车1的车道保持控制。所谓横向偏移量(ε1、ε2、ε3、ε4)是指他车2、3从行驶车道(L)中心(C)的横向偏离距离。对于所述的他车2、3横向偏离距离,可以用自车1上安装的摄像头传感器等设备测量。
另一方面,以图1的箭头方向为行驶方向时,图1的2表示的是在自车1前面行驶的他车,图1的3是表示在自车1后面行驶的他车。
图2是本发明优选实施例的横向控制装置图示。
根据图2,本发明优选实施例的横向控制装置100包括偏移量测量部110、预览偏移量计算部120、优先顺序决定部130和控制部140。
首先,偏移量测量部110如图1所示,测量在当前时刻在邻接车道上行驶的他车2、3从自车1的行驶车道(L)中心(C)的横向偏移量(ε1,ε2,ε3,ε4)。
图3是图2中图示的偏移量测量部图示,图4是图2中图示的预览偏移量计算部图示,图5是他车从行驶车道中心的预览偏移量图示。
一个实施例中,所述偏移量测量部110是根据图1和图3,包含测量位于以自车1为中心既定的前方距离内的至少一个先行他车2横向偏移量((ε1,ε2,ε3))的第一偏移量测量部111。而且偏移量测量部110可以包含测量位于以自车1为中心既定的后方距离内的至少一个后行他车2的横向偏移量(ε4)的第二偏移量测量部112。
根据图5,第一偏移量测量部111可以指安装于自车1前方的前方摄像头传感器1a,第二偏移量测量部112可以指安装于自车1后方的后方摄像头传感器1b。
然后,预览偏移量计算部120是测量当前时刻在邻接车道行驶的他车2、3从自车1行驶车道(L)中心(C)的预览偏移量(preview offset, 图5的ε1’,ε4’)。所谓预览偏移量(图5的ε1’,ε4’)是指从当前时刻过既定时间的时刻预测的他车2、3横向偏移量。一个实施例中,预览偏移量计算部120可以包含测量部121和计算部122。
根据图4和图5,测量部121可以测量自车1和他车2、3的纵向间距(x1,x4)和横向间距(y1,y4),测量他车2、3的纵向速度(Vx1, Vx4)和横向速度(Vy1, Vy4)。一个实施例中,如果以图5的箭头为行驶方向,则所述测量部121就是安装在自车1前方的前方摄像头传感器1a和自车1后方安装的后方摄像头传感器1b。测量部121可以测量在自车1的前方图像上先行的他车2纵向间距(x1)、横向间距(y1)、纵向速度(Vx1)以及横向速度(Vy1)。而且测量部121可以测量在自车1的后方图像上后行他车4的纵向间距(x4)、横向间距(Vx4)以及横向速度(Vy4)。
计算部122是基于测量部121测量的纵向间距(x1,x4)、横向间距(y1,y4)、纵向速度(Vx1, Vx4)和横向速度(Vy1, Vy4),预测计算从当前时刻经过既定时间之后时刻的他车2、3横向偏移量(预览偏移量(ε1’,ε4’))。
然后,优先顺序决定部130基于偏移量测量部110测量的当前时刻横向偏移量和预览偏移量计算部120算出的未来时刻预览偏移量的相差值(εn- εn’),从车道保持控制观点上决定优选顺序。一个实施例中,优先顺序决定部130可以从多个他车中,将当前时刻横向偏移量和未来时刻预览偏移量相差值(εn-εn’)最大的他车定为最优先顺序。例如,从ε1-ε1’、ε2-ε2’、ε3-ε3’和ε4-ε4’中值最大的是ε1-ε1’,则以图5为准,基于比自车先行的他车2的横向偏移量(ε1)实施车道保持控制。因为被定为最优先顺序的该他车是在既定的时间内最快接近自车1的车辆,与自车1发生碰撞的风险度高而需实施相应的车道保持控制。如果横向偏移量和预览偏移量的相差值(εn-εn’)显示为负的方向,则可以预测该他车是从自车1远离的车辆,因此可以从旨在车道保持控制的标准中排除。
另外,根据本发明优选实施例的横向控制装置100的说明,优先顺序决定部130将当前时刻的横向偏移量和未来时刻预览偏移量的相差值(εn-εn’)最大的他车定为最优先顺序,但这并不是对本发明进行限制,本发明还可以用多种方式决定成为车道保持控制基准的他车的优先顺序。
然后控制部140基于优先顺序决定部130决定的最优先顺序的他车的横向偏移量,生成旨在自车1车道保持控制的路径。与生成的路径相对应地算出的转向控制扭矩值超过既定的临界值,则可以将自车1加速或减速而重新生成路径,从而防止因大控制扭矩值而导致转向异常感。
图6是本发明优选实施例的横向控制方法的流程图。
根据图1至图6,本发明优选实施例的横向控制装置100是测量当前时刻至少两个他车2、3从行驶车道中心(C)的横向偏移量。(步骤S100)此时测量位于以行驶车道中心(C)为准既定的前方距离以内的至少一个先行他车2横向偏移量,测量位于以行驶车道中心(C)为准既定的后方距离以内的至少一个后行他车3的横向偏移量。
然后,横向控制装置100基于他车2、3的位置和车速,在经过既定的时间的时刻预测他车从行驶车道中心(C)的横向偏移量而算出预览偏移量。(步骤S200)并测量自车1和他车2、3的纵向间距(x1,x4)和横向间距(y1,y4),测量他车2、3的纵向速度(Vx1, Vx4)和横向速度(Vy1, Vy4)。
然后,横向控制装置100基于横向偏移量和预览偏移量的相差值(εn- εn’)决定他车2、3的优先顺序。(步骤S300)此时,可以将他车中的横向偏移量和预览偏移量的相差值(εn- εn’)最大的某一个定为最优先顺序。
然后,横向控制装置100基于定为最优先顺序的他车2、3的横向偏移量(ε1, ε2,ε3, ε4),为自车1的车道保持控制而生成路径。(S400)并判断与生成的路径的相对应的控制扭矩值是否超过临界值(S410),且控制扭矩值超过临界值,则改变自车1的车速而重新生成路径(S420)。
以上实施例和附图仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所述的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例所述技术方案的范围。本发明的保护范围应根据下述的权利要求范围进行解释,而且在其同等范围内的所有技术方案应都属于本发明的权利要求范围。
Claims (10)
1.一种横向控制装置,其特征在于,其包括:
偏移量测量部,测量当前时刻至少两个他车从行驶车道中心的当前横向偏移量;
预览偏移量计算部,基于所述他车的位置和车速,在经过既定时间的时刻,预测所述他车从所述行驶车道中心的横向偏移量而算出预览偏移量;
优先顺序决定部,基于所述横向偏移量和所述预览偏移量的相差值,决定所述他车的优先顺序;
控制部,基于所述优先顺序决定部定为最优先顺序的所述他车的横向偏移量生成旨在自车车道保持控制的路径,
其中,所述控制部是,在与所生成的路径相对应的控制扭矩值超过既定的临界值时,改变所述自车的车速而重新生成路径。
2.根据权利要求1所述的横向控制装置,其特征在于,所述偏移量测量部包括:
第一偏移量测量部,测量位于以所述行驶车道中心为准既定的前方距离内的至少一个先行车辆的横向偏移量;
第二偏移量测量部,测量位于以所述行驶车道中心为准既定的后方距离内的至少一个后行车辆的横向偏移量。
3.根据权利要求1所述的横向控制装置,其特征在于,所述预览偏移量计算部包括:
测量部,测量所述自车和所述他车的纵向间距和横向间距,并测量所述他车的纵向速度和横向速度;
计算部,基于所述测量部测量的所述纵向间距、横向间距、纵向速度和横向速度计算经过所述既定时间之后所述他车的预览偏移量。
4.根据权利要求3所述的横向控制装置,其特征在于,所述测量部包括:
前方摄像头传感器,获得所述自车的前方图像;
后方摄像头传感器,获得所述自车的后方图像。
5.根据权利要求1所述的横向控制装置,其特征在于,
所述优先顺序决定部是从所述他车中将所述横向偏移量与所述预览偏移量的相差值最大的某一个定为最优先顺序。
6.一种横向控制方法,其特征在于,该方法的实施步骤包括:
测量当前时刻至少两个他车从行驶车道中心的横向偏移量;
基于所述他车的位置和车速,经过既定时间的时刻预测所述他车从所述行驶车道中心的横向偏移量而算出预览偏移量;
基于所述横向偏移量和所述预览偏移量的相差值决定所述他车的优先顺序;
基于定为最优先顺序的所述他车的横向偏移量生成旨在自车车道保持控制的路径,
其中,在生成旨在自车车道保持控制的路径的步骤中,若与所生成的路径对应的控制扭矩值超过既定的临界值,则改变所述自车的速度而重新生成路径。
7.根据权利要求6所述的横向控制方法,其特征在于,
在所述横向偏移量测量阶段,测量位于以所述行驶车道中心为准既定的前方距离内的至少一个先行车辆的横向偏移量,测量位于以所述行驶车道中心为准既定的后方距离内的至少一个后行车辆的横向偏移量。
8.根据权利要求6所述的横向控制方法,其特征在于,
在所述预览偏移量计算步骤,测量所述自车与所述他车的纵向间距和横向间距,测量所述他车的纵向速度和横向速度,基于所测量的所述纵向间距、横向间距、纵向速度和横向速度计算出经过所述既定时间之后所述他车的预览偏移量。
9.根据权利要求8所述的横向控制方法,其特征在于,
所述纵向间距、横向间距、纵向速度和横向速度是通过所述自车的前方图像和后方图像测量。
10.根据权利要求6所述的横向控制方法,其特征在于,
在所述优先顺序决定步骤,从所述他车中,将所述横向偏移量与所述预览偏移量的相差值最大的某一个定为最优先顺序。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020120155703A KR101409747B1 (ko) | 2012-12-28 | 2012-12-28 | 횡방향 제어 장치 및 그 제어 방법 |
KR10-2012-0155703 | 2012-12-28 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103909927A CN103909927A (zh) | 2014-07-09 |
CN103909927B true CN103909927B (zh) | 2017-10-24 |
Family
ID=51018135
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310033303.9A Active CN103909927B (zh) | 2012-12-28 | 2013-01-29 | 横向控制装置及其控制方法 |
Country Status (3)
Country | Link |
---|---|
US (2) | US9037373B2 (zh) |
KR (1) | KR101409747B1 (zh) |
CN (1) | CN103909927B (zh) |
Families Citing this family (26)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102013201796A1 (de) * | 2013-02-05 | 2014-08-07 | Robert Bosch Gmbh | Verfahren zur Bereitstellung eines Fahrkorridors für ein Fahrzeug und Fahrassistenzsystem |
JP2016018295A (ja) * | 2014-07-07 | 2016-02-01 | 日立オートモティブシステムズ株式会社 | 情報処理システム |
CN104260723B (zh) * | 2014-09-29 | 2018-03-06 | 长安大学 | 一种后方车辆运动状态追踪预测装置及预测方法 |
KR20160066297A (ko) * | 2014-12-02 | 2016-06-10 | 현대모비스 주식회사 | 차선 유지 보조 시스템의 동작 개시 제어 장치 및 이의 제어 방법 |
WO2016127307A1 (en) * | 2015-02-10 | 2016-08-18 | Harman International Industries, Incorporated | Vehicular communication |
KR101980547B1 (ko) * | 2015-08-19 | 2019-05-21 | 엘지전자 주식회사 | 차량 운전 보조 장치 및 차량 |
KR20170071120A (ko) * | 2015-12-15 | 2017-06-23 | 현대자동차주식회사 | Lkas 시스템, 이를 포함하는 차량, 및 lkas 제어 방법 |
JP2017114155A (ja) * | 2015-12-21 | 2017-06-29 | 三菱自動車工業株式会社 | 運転支援装置 |
KR101860626B1 (ko) * | 2016-01-07 | 2018-07-02 | 엘지전자 주식회사 | 차량 운전 보조장치 및 이를 포함하는 차량 |
JP6575479B2 (ja) * | 2016-10-13 | 2019-09-18 | トヨタ自動車株式会社 | 車線維持支援装置 |
JP6592423B2 (ja) * | 2016-11-25 | 2019-10-16 | 株式会社デンソー | 車両制御装置 |
CN106627582B (zh) * | 2016-12-09 | 2019-01-22 | 重庆长安汽车股份有限公司 | 单车道自动驾驶超越相邻车道车辆的路径规划***及方法 |
US10353393B2 (en) * | 2016-12-29 | 2019-07-16 | Baidu Usa Llc | Method and system for improving stability of autonomous driving vehicles |
US10403145B2 (en) * | 2017-01-19 | 2019-09-03 | Ford Global Technologies, Llc | Collison mitigation and avoidance |
JP7238670B2 (ja) * | 2019-07-23 | 2023-03-14 | トヨタ自動車株式会社 | 画像表示装置 |
CN111806437B (zh) * | 2020-09-10 | 2021-01-15 | 中汽研(天津)汽车工程研究院有限公司 | 自动驾驶汽车预瞄点确定方法、装置、设备及存储介质 |
CN112590802B (zh) * | 2020-12-04 | 2022-12-20 | 英博超算(南京)科技有限公司 | 车辆驾驶控制方法、装置、车辆以及计算机可读存储介质 |
CN112622899B (zh) * | 2021-01-18 | 2022-04-01 | 中国重汽集团济南动力有限公司 | 一种基于预瞄面积控制的车辆车道保持方法及*** |
US11840147B2 (en) | 2021-07-13 | 2023-12-12 | Canoo Technologies Inc. | System and method in data-driven vehicle dynamic modeling for path-planning and control |
US11891059B2 (en) | 2021-07-13 | 2024-02-06 | Canoo Technologies Inc. | System and methods of integrating vehicle kinematics and dynamics for lateral control feature at autonomous driving |
US12017661B2 (en) | 2021-07-13 | 2024-06-25 | Canoo Technologies Inc. | System and method in vehicle path prediction based on full nonlinear kinematics |
US11845428B2 (en) | 2021-07-13 | 2023-12-19 | Canoo Technologies Inc. | System and method for lane departure warning with ego motion and vision |
US11908200B2 (en) * | 2021-07-13 | 2024-02-20 | Canoo Technologies Inc. | System and method in the prediction of target vehicle behavior based on image frame and normalization |
US11891060B2 (en) | 2021-07-13 | 2024-02-06 | Canoo Technologies Inc. | System and method in lane departure warning with full nonlinear kinematics and curvature |
JP7191179B1 (ja) * | 2021-10-27 | 2022-12-16 | 三菱電機株式会社 | 車両制御装置、車両制御システム、車両制御方法および車両制御プログラム |
CN115083190B (zh) * | 2022-06-17 | 2023-04-25 | 东风汽车集团股份有限公司 | 多车道交通路口的自动驾驶***及方法 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6571176B1 (en) * | 1999-06-16 | 2003-05-27 | Honda Giken Kogyo Kabushiki Kaisha | Vehicle travel safety device |
Family Cites Families (28)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5642093A (en) * | 1995-01-27 | 1997-06-24 | Fuji Jukogyo Kabushiki Kaisha | Warning system for vehicle |
DE19722947C1 (de) * | 1997-05-31 | 1999-02-25 | Bosch Gmbh Robert | Verfahren und Vorrichtung zur Bestimmung eines zukünftigen Kursbereichs eines Fahrzeugs |
JP3763211B2 (ja) * | 1998-07-10 | 2006-04-05 | 日産自動車株式会社 | レーンキープシステム |
US7366595B1 (en) * | 1999-06-25 | 2008-04-29 | Seiko Epson Corporation | Vehicle drive assist system |
DE19954536B4 (de) * | 1999-11-12 | 2010-09-23 | Robert Bosch Gmbh | Verfahren zur Auswertung von Objekten im Kursverlauf eines Fahrzeuges |
JP3760827B2 (ja) * | 2001-09-28 | 2006-03-29 | 日産自動車株式会社 | 車線逸脱防止装置 |
DE10218010A1 (de) * | 2002-04-23 | 2003-11-06 | Bosch Gmbh Robert | Verfahren und Vorrichtung zur Querführungsunterstützung bei Kraftfahrzeugen |
JP2004334808A (ja) * | 2003-05-12 | 2004-11-25 | Nissan Motor Co Ltd | 起動判断装置 |
JP4124050B2 (ja) * | 2003-07-31 | 2008-07-23 | 日産自動車株式会社 | 車線逸脱防止装置 |
JP3982503B2 (ja) * | 2004-01-21 | 2007-09-26 | 日産自動車株式会社 | 車両用走行制御装置 |
JP2006069322A (ja) * | 2004-09-01 | 2006-03-16 | Mazda Motor Corp | 車両の車線逸脱警報装置 |
JP4400418B2 (ja) * | 2004-10-29 | 2010-01-20 | 日産自動車株式会社 | 車間距離制御装置及び車間距離制御方法並びに運転操作支援装置及び運転操作支援方法 |
JP2008070998A (ja) | 2006-09-13 | 2008-03-27 | Hitachi Ltd | 車両周囲情報表示装置 |
DE102006047634A1 (de) * | 2006-10-09 | 2008-04-10 | Robert Bosch Gmbh | Verfahren zum Erfassen eines Umfelds eines Fahrzeugs |
CN101135558B (zh) * | 2007-09-28 | 2010-09-01 | 上海中科深江电动车辆有限公司 | 一种基于机器视觉的汽车防撞预警方法及装置 |
JP5359085B2 (ja) | 2008-03-04 | 2013-12-04 | 日産自動車株式会社 | 車線維持支援装置及び車線維持支援方法 |
JP5070171B2 (ja) * | 2008-09-19 | 2012-11-07 | 日立オートモティブシステムズ株式会社 | 車両制御装置 |
KR101382279B1 (ko) | 2008-11-24 | 2014-04-08 | 현대자동차(주) | 가변 판정 기준을 적용하는 차선 유지 제어 시스템 |
US8190330B2 (en) * | 2009-03-06 | 2012-05-29 | GM Global Technology Operations LLC | Model based predictive control for automated lane centering/changing control systems |
JP2010271750A (ja) | 2009-05-19 | 2010-12-02 | Suzuki Motor Corp | 車両走行制御装置 |
US8744661B2 (en) * | 2009-10-21 | 2014-06-03 | Berthold K. P. Horn | Method and apparatus for reducing motor vehicle traffic flow instabilities and increasing vehicle throughput |
KR101102144B1 (ko) | 2009-11-17 | 2012-01-02 | 주식회사 만도 | 차선 유지 제어 방법 및 시스템 |
JP2011242887A (ja) | 2010-05-14 | 2011-12-01 | Toyota Motor Corp | 衝突予測装置 |
US9090263B2 (en) * | 2010-07-20 | 2015-07-28 | GM Global Technology Operations LLC | Lane fusion system using forward-view and rear-view cameras |
US20120022739A1 (en) * | 2010-07-20 | 2012-01-26 | Gm Global Technology Operations, Inc. | Robust vehicular lateral control with front and rear cameras |
JP2012073925A (ja) * | 2010-09-29 | 2012-04-12 | Fuji Heavy Ind Ltd | 車両用運転支援装置 |
US8494716B1 (en) * | 2012-06-04 | 2013-07-23 | GM Global Technology Operations LLC | Lane keeping system using rear camera |
US8473144B1 (en) * | 2012-10-30 | 2013-06-25 | Google Inc. | Controlling vehicle lateral lane positioning |
-
2012
- 2012-12-28 KR KR1020120155703A patent/KR101409747B1/ko active IP Right Grant
-
2013
- 2013-01-29 CN CN201310033303.9A patent/CN103909927B/zh active Active
- 2013-03-19 US US13/847,008 patent/US9037373B2/en active Active
-
2015
- 2015-04-02 US US14/677,377 patent/US9595197B2/en active Active
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6571176B1 (en) * | 1999-06-16 | 2003-05-27 | Honda Giken Kogyo Kabushiki Kaisha | Vehicle travel safety device |
Also Published As
Publication number | Publication date |
---|---|
US9595197B2 (en) | 2017-03-14 |
US9037373B2 (en) | 2015-05-19 |
US20140188360A1 (en) | 2014-07-03 |
US20150213719A1 (en) | 2015-07-30 |
CN103909927A (zh) | 2014-07-09 |
KR101409747B1 (ko) | 2014-07-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103909927B (zh) | 横向控制装置及其控制方法 | |
US9116784B2 (en) | System and method for preventing vehicle from rolling over in curved lane | |
US8781643B2 (en) | Vehicle control device and vehicle control method | |
KR101987636B1 (ko) | 차량의 충돌회피 제어 방법 및 이를 구현하는 충돌회피 장치 | |
EP2741270B1 (en) | Driving assistance apparatus and driving assistance method | |
JP5910754B2 (ja) | 運転支援装置、及び、運転支援方法 | |
EP2487454B1 (en) | Vehicle length estimation | |
KR101398223B1 (ko) | 차량의 차선 변경 제어 장치 및 그 제어 방법 | |
CN104192144B (zh) | 一种汽车主动防撞弯道虚警消除方法 | |
KR101812863B1 (ko) | 차량 제어 시스템 | |
JP6040611B2 (ja) | 走行制御装置及び走行制御方法 | |
JP2013532858A (ja) | 自動車の側面に隣接する側面域に存在する障害物について自動車の運転者に警告する方法、および運転者支援システムを備える自動車 | |
CN106470884B (zh) | 车辆状态的确定和在驾驶车辆时的驾驶员辅助 | |
CN105518758A (zh) | 用于核查机动车错误方向行驶的方法以及控制和检测装置 | |
KR101514928B1 (ko) | 자동 주행 제어 시스템 및 방법 | |
JP6600995B2 (ja) | 車両制御装置及びプログラム | |
JP2008018923A (ja) | 車両用制動制御装置及び車両制動制御方法 | |
CN104011780A (zh) | 障碍物判定装置 | |
JP6377942B2 (ja) | 運転支援装置 | |
CN110446641A (zh) | 车辆控制装置和车辆控制方法 | |
KR102164606B1 (ko) | 자율주행 차량을 위한 횡방향 제어 파라미터 보정 장치 및 방법 | |
JP6379510B2 (ja) | 運転診断装置および保険料算定方法 | |
CN110466518A (zh) | 一种面向车辆轨迹交叉场景的安全预估方法 | |
CN105083374A (zh) | 用于控制后轮转向的方法 | |
GB2590951A (en) | Vehicle control system and method |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |