CN104245463A - 机动车辆轨迹校正方法和相应的机动车辆轨迹校正装置 - Google Patents
机动车辆轨迹校正方法和相应的机动车辆轨迹校正装置 Download PDFInfo
- Publication number
- CN104245463A CN104245463A CN201380006120.6A CN201380006120A CN104245463A CN 104245463 A CN104245463 A CN 104245463A CN 201380006120 A CN201380006120 A CN 201380006120A CN 104245463 A CN104245463 A CN 104245463A
- Authority
- CN
- China
- Prior art keywords
- traffic lane
- vehicle
- moving traffic
- power actuated
- track
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 28
- 238000012937 correction Methods 0.000 title description 3
- 238000005259 measurement Methods 0.000 claims description 13
- 238000004364 calculation method Methods 0.000 claims description 4
- GOLXNESZZPUPJE-UHFFFAOYSA-N spiromesifen Chemical compound CC1=CC(C)=CC(C)=C1C(C(O1)=O)=C(OC(=O)CC(C)(C)C)C11CCCC1 GOLXNESZZPUPJE-UHFFFAOYSA-N 0.000 claims description 3
- 230000001133 acceleration Effects 0.000 description 7
- 230000001276 controlling effect Effects 0.000 description 5
- 241001269238 Data Species 0.000 description 2
- 230000005484 gravity Effects 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 238000005452 bending Methods 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 230000003111 delayed effect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000009123 feedback regulation Effects 0.000 description 1
- 238000007689 inspection Methods 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 230000002265 prevention Effects 0.000 description 1
- 230000001105 regulatory effect Effects 0.000 description 1
- 230000000717 retained effect Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 238000007493 shaping process Methods 0.000 description 1
- 230000009897 systematic effect Effects 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
- B60W40/02—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 ambient conditions
- B60W40/06—Road conditions
- B60W40/072—Curvature of the road
-
- 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/0097—Predicting future conditions
-
- 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
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D15/00—Steering not otherwise provided for
- B62D15/02—Steering position indicators ; Steering position determination; Steering aids
- B62D15/021—Determination of steering angle
- B62D15/024—Other means for determination of steering angle without directly measuring it, e.g. deriving from wheel speeds on different sides of the car
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D15/00—Steering not otherwise provided for
- B62D15/02—Steering position indicators ; Steering position determination; Steering aids
- B62D15/025—Active steering aids, e.g. helping the driver by actively influencing the steering system after environment evaluation
-
- 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/14—Yaw
-
- 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
- B60W2552/00—Input parameters relating to infrastructure
-
- 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
- B60W2552/00—Input parameters relating to infrastructure
- B60W2552/30—Road curve radius
-
- 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
- B60W2710/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
- B60W2710/00—Output or target parameters relating to a particular sub-units
- B60W2710/20—Steering systems
- B60W2710/207—Steering angle of wheels
-
- 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/24—Direction of travel
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60Y—INDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
- B60Y2400/00—Special features of vehicle units
- B60Y2400/30—Sensors
- B60Y2400/301—Sensors for position or displacement
- B60Y2400/3015—Optical cameras
Landscapes
- Engineering & Computer Science (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Human Computer Interaction (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Traffic Control Systems (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
本发明主要涉及一种行驶在行车道(11)上的机动车辆(10)的轨迹校正方法,其特征在于,所述方法包括如下步骤:-获取行车道(11)的几何形状参数和机动车辆(10)在行车道(11)上的位置参数的步骤(100),-确定对应于机动车辆(10)的纵向轴线(A)和行车道(11)的道路线(30、31)之间夹角的航向角(a)的步骤(102),-确定机动车辆(10)的速度的步骤(103),-确定机动车辆(10)与行车道(11)的道路线(30、31)相交之前的剩余时间的步骤(104),以及,根据航向角(a)和车辆与行车道(11)的道路线(30、31)相交之前的剩余时间生成车辆(10)的动态定值的步骤(106)。
Description
技术领域
本发明涉及机动车辆轨迹校正方法以及相应的机动车辆轨迹校正装置。本发明在安全领域和机动车辆辅助驾驶领域有特别有利的应用。
背景技术
机动车辆通常具有由驾驶员操作的被固定在转向系统柱体上的方向盘,以驾驭车辆的转向轮。转向系统一般包括辅助装置,辅助装置生成一部分能量,供应用于驾驭车轮,以减小驾驶员应该传送的作用力,更具体地在低速和停止时要操作的作用力。
一些转向系统具有辅助驾驶功能,通过控制计算机来操控作用在该方向上的机动力,以在该方向上传送特定的辅助扭矩,实现对遵循行车道的辅助作用,这向驾驶员指示出相对正常行车道的偏移。这些辅助驾驶功能的名称例如为“意外与道路线相交预防”(PFIL)、“车道保持支持”(LKS)、“车道保持辅助系统”(LKAS)。
而且,文件FR2706604提供了一种用于导航辅助系统的车辆轨迹确定装置,该装置具有车辆方向盘的转向角测量部件、车辆前行测量部件和根据转向角和前行数据计算车辆行车轨迹的计算部件。然而,该装置需要实施GPS系统,其精确度在一些情况下是不足够的,尤其在车辆通过隧道内部时是不足够的。
文件US2009153360提供了一种将由摄像头传输的和由道路线保持处理得到的数据相关联的装置和方法,其中这两个系统数据的交叉频率不相同。然而,该方法导致采样不足的问题。
文件US2010191421提供了一种带有功能性构造的车道保持装置和方法,其中包括根据所遇到的具体情况,例如稳定车辆的需求、将车辆保持在车道上的需求和保持轨迹的需求,进行优先处理。然而,轨迹控制是基于横向偏移概念上的。
文件WO2011002345提供了一种车道保持装置和方法,其结合了有闭环控制的“电动助力转向”(DAE),其中控制方案基于开环型低水平算法。另外,定值扭矩为要求的横向加速度的函数。
文件DE102007061900提供了一种预防与道路线相交危险的装置,但是其调节模式是基于车辆的发动机扭矩的。
然而,所有这些轨迹控制方法在确定车辆在行车道上的预期轨迹与在该行车道上测量的车辆轨迹之间的差异方面存在着精度问题。
发明内容
本发明的目的尤其在于通过提出一种根据对应于机动车辆的纵向轴线和行车道道路线之间夹角的航向角来校正车辆轨迹的轨迹校正方法,来克服现有技术的缺点。
更确切地,本发明涉及一种行驶在行车道上的机动车辆的轨迹校正方法,其特征在于,所述方法包括如下步骤:
-获取行车道的几何形状参数和机动车辆在行车道上的位置参数的步骤,
-确定对应于机动车辆的纵向轴线与行车道的道路线之间夹角的航向角的步骤,
-确定机动车辆速度的步骤,
-确定机动车辆与行车道道路线相交之前的剩余时间的步骤,以及
-根据航向角和与行车道道路线相交之前的剩余时间生成车辆的动态定值的步骤。
根据一种实施方式,所述行车道的几何形状参数包括如下参数中的至少一种:相对于摄像头在行车道右侧的道路线位置,相对于摄像头在行车道左侧的道路线位置,通常对外侧道路线测定的行车道曲率。
根据一种实施方式,在获取行车道的几何形状参数的步骤中,行车道参数的测量结果被以50毫秒随后延迟50毫秒的频率发送。
根据一种实施方式,在获取行车道的几何形状参数的步骤之后,所述方法还包括计算信任指数的步骤,该信任指数根据行车道几何形状参数的测量结果和道路线模型之间的相关性计算。
根据一种实施方式,在确定航向角的步骤中确定的航向角根据行车道几何形状参数和车辆位置来计算。。
根据一种实施方式,在不可能校正轨迹的情况下,删除生成车辆动态定值的步骤并用特定警示代替。
根据一种实施方式,在机动车辆的驾驶员操作车辆的一个控制元件时,可由所述驾驶员禁止生成车辆动态定值的步骤。
本发明还涉及一种实施所述方法的行驶在行车道上的机动车辆轨迹校正装置,所述装置包括:
-摄像头,
-控制单元,
-横摆率传感器,
-机动车辆的速度传感器,
-主动转向系统,
其特征在于,所述装置包括根据对应于车辆纵向轴线和行车道道路线之间夹角的机动车航向角来校正轨迹的部件。
附图说明
通过对以下详细描述的阅读和对所附附图的检验,本发明将被更好地理解。仅以示意而非限定本发明的方式给出这些附图。其中:
图1:示出了根据本发明的车辆轨迹校正方法的不同步骤的方框图;
图2:根据本发明轨迹校正方法校正的行驶在弯曲行车道上的机动车辆重心轨迹的图形表示;
图3:根据本发明轨迹校正方法校正的在右侧行车道上的机动车辆重心轨迹的图形表示;
图4:含有根据本发明轨迹校正装置的机动车辆的示意性表示;
图5:示出了根据本发明的车辆轨迹校正方法的生成动态定值步骤中的不同子步骤的方框图;
图6:估算行车道的几何参数的道路线模型的图形表示。
相同、相似或类似的构件在不同附图中保留相同的参考标号。
具体实施方式
图4示出了位于参考标号11的行车道上的机动车辆10。该车辆10具有转向轮35和轨迹校正装置12,轨迹校正装置12具有摄像头20、控制单元21、横摆率传感器22、机动车辆10的速度传感器23和能够引导转向轮35的主动转向系统24。所述机动车辆10还具有纵向轴线A。
主动转向系统24具有转向柱体33。方向盘34被固定在所述柱体33的端部,该方向盘34由驾驶员操作,以驾驭车辆10的转向轮35。主动转向系统24还具有方向盘真实角度Av的测量部件和生成供应驾驭转向轮35的一部分能量的辅助装置。而且,系统24能够减小驾驶员应该传送的作用力,特别是在低速和停止时的操作作用力。
此外,转向系统24具有机动组件和控制所述机动组件的计算机,所述机动组件通过传送特定的辅助扭矩作用在车辆10的走向上,以实现帮助遵循行车道11。该辅助扭矩向驾驶员指明相对于行车道11的偏移。
更具体地,机动组件具有辅助装置的电动机或液压致动器,以在转向系统24的一个方向上或另一个方向上生成扭矩。该扭矩向驾驶员指明离开了行车道11或有离开的危险。
在实施本发明方法时,在第一步骤100中借助摄像头20获取行车道11的几何参数和在行车道11上的机动车辆10的位置。
为达此目的,摄像头20连续拍摄绘制在地面上的限定行车道11的白线30、31,以相对该车道11的横向限制定位车辆10和监测车辆10相对该车道11的横向偏移。
更确切地,摄像头20能够时刻识别相对摄像头20的行车道11的右侧道路线30的位置、相对摄像头20的行车道11的左侧道路线31的位置、和通常在外侧道路线上测定的行车道11的曲率。将右侧道路线30和左侧道路线31理解为在该摄像头20拍摄这些道路线30、31时的位于摄像头20右边和左边的道路线。由摄像头20以50毫秒的频率发送行车道11的几何形状参数的测量结果。为了避免欠采样的问题,在将测量结果发送给车辆10的网络时,被延迟了50毫秒。通过优化车辆10的网络低通带可以减小该延迟。
在步骤101中,控制单元21根据来自摄像头20的行车道11的几何形状参数测量结果和道路线模型之间的相关性计算信任指数。该道路线模型例如基于表示图6所示车辆10的坐标系(X,Y)中的道路线30、31的轨迹的二次或三次多项式。车辆10的坐标系(X,Y)具有与车辆10的纵向轴线A相重合的第一轴线X和与第一轴线X相垂直的第二轴线Y。坐标系(X,Y)的原点O位定于车辆10的重心G的位置处。在标准车道的情况下,假设道路线30、31的航向角和曲率基本上相等,这表示在道路线30、31之间存在恒定偏移。为了估算这些参数,采用在小角度情况下可证明的简单等式:
根据该等式,坐标系(X,Y)中,x为道路线30、31的点P的横坐标,y为道路线30、31的点P的纵坐标,y0为x=0时上所述点的纵坐标,a为x=0时的航向角,以及c0为常数。
如果信任指数大于某一阈值,那么在步骤102中确定航向角。该航向角对应于在机动车辆10的纵向轴线A和最接近于车辆10的车道11的道路线30、31之间的夹角。如果信任指数不大于某一阈值,认为不可能计算航向角。
步骤102由控制单元21根据自摄像头20的测量结果来实施。事实上,控制单元21已知车辆10的轴线A。另外,根据相对于摄像头20的行车道11的右侧道路线30的位置、相对于摄像头20的行车道11的左侧道路线31的位置和行车道11的曲率,能够精确得到车道11的几何形状(参照图2和3)。
在步骤103中,机动车辆10的速度测量由车辆10的速度传感器23实施。另外,机动车辆10的横摆率测量由横摆率传感器22实施。可将横摆率理解为车辆10围绕其重心G的旋转速率。
在步骤104中,控制单元21确定与行车道11的道路线30、31中的一条相交前的剩余时间。所述剩余时间或英语中的“Time to Line Crossing”(TLC)根据车辆10在车道11上的位置、车辆10的横摆率、车辆10的速度、车辆10的其它动态数据和驾驶员的动作来计算。
在步骤105中,根据步骤104中计算的剩余时间推导关于车辆10离开车道11的危险程度或车辆10离开车道11的危险性。将车辆10的动态数据理解为涉及进入车辆10的航路和行为管理的物理现象辨识和规范化的数据。例如这些动态数据为横摆加速度、横向加速度、方向盘34的旋转角度等。
通过分析由摄像头20测量的参数、车辆10的动态数据和驾驶员的动作,还可探测到并非驾驶员意愿的相对于行车道11的偏移。
如果车辆10离开车道11的危险程度超过某一阈值,在步骤106中将根据由摄像头20测量的参数、车辆10的速度和车辆10的其它动态数据,确定动态定值。车辆10的该动态定值由主动转向系统24生成和应用。如果车辆10离开车道11的危险程度没超过某一阈值,则不确定动态定值。
转向系统24对动态定值的确定为状态反馈调节,如在申请号为FR1060383的文件中描述的,其中将基本调节扭矩分解为角度和辅助扭矩。
更确切地,如图5所示,转向系统24的控制计算机在子步骤107中由摄像头20测量的参数和车辆10的动态数据确定方向盘转角Av的定值pfil。该方向盘转角Av定值pfil能够遵循车道11的给定方向。另外,实时方向盘转角Av的测量部件在子步骤108中测量真实方向盘转角。
在子步骤109中,带有比例/微分或数字调节系统的控制计算机根据方向盘转角Av定值pfil和真实方向盘转角Av之间的角度偏移ΔAv,计算角度Treg上的基本调节扭矩。
接下来在子步骤110中,转向系统通过乘以增益值k1、k2(其中k2>=k1>0)计算辅助扭矩Tassist,计算方向盘的阻力扭矩值Cv,其中对于Cv<0并且有从左边离开的危险,或Cv>0并且有从右边离开的危险,则Tassist=k1Cv;对于Cv>0并且有从左边离开的危险,或Cv<0并且有从右边离开的危险,则Tassist=k2Cv。
最后在子步骤111中,转向系统将已算得的两个扭矩Treg,Tassist相加,以得到动态定值。
还可以明确区分辅助扭矩Tassist和调节扭矩Treg的两个计算,并以各自独立的方式调整这两个扭矩,从而易于调整的操作。
因此,转向系统动态定值的确定为利用补偿估算变量的低水平闭环控制。所要求的扭矩为内部函数,不由横摆率或横向加速度直接确定。
在子步骤112中,将动态定值传输到转向系统24的机动组件,机动组件根据该动态定值生成在转向系统24的一个方向或另一方向上的扭矩。
用取值例如在0和1之间的作用水平表征动态定值。这个作用水平根据车辆10离开车道11的危险性确定。危险性越大,作用水平的值越大且驾驶员感受到的阻力扭矩也越大。
有利地,从离开行车道11的危险性或离开行车道11出发,在定值方向盘转角和真实方向盘转角之间的角偏移趋向于凸显离开车道的危险时,由驾驶员感受到的阻力矩也趋于增大。
有利地,从离开行车道11的危险性或离开行车道11出发,在定值方向盘转角和真实方向盘转角之间的角偏移趋向于降低离开车道的危险时,由驾驶员感受到的阻力矩接近于零值。
在一种变化形式中,控制计算机计算能够让车辆10保留在确定区域上、即不离开车道11的横摆率。该横摆率被转换成由主动转向系统24调节的柱体角。将柱体角理解为主动转向系统的柱体33的旋转角度。
动态定值例如与车辆10的横向加速度或车辆10的横摆率一致。将横向加速度理解为车辆10相对其横向轴线的加速度。
在驾驶员操作车辆10的一个控制元件时,可由所述驾驶员禁止生成车辆10动态定值的步骤106。可将车辆10的控制元件例如理解为车辆10的方向盘34或刹车装置。
另外,在不可能校正轨迹的情况下,动态定值被删除并用特定警示代替,例如用触觉或视觉和听觉警示代替。
Claims (7)
1.一种行驶在行车道(11)上的机动车辆(10)的轨迹校正方法,其特征在于,所述方法包括如下步骤:
-获取行车道(11)的几何形状参数和机动车辆(10)在行车道(11)上的位置参数的步骤(100),
-确定对应于机动车辆(10)的纵向轴线(A)与行车道(11)的道路线(30、31)之间夹角的航向角(a)的步骤(102),
-确定机动车辆(10)的速度的步骤(103),
-确定机动车辆(10)与行车道(11)的道路线(30、31)相交之前的剩余时间的步骤(104),和
-根据航向角(a)和车辆与行车道(11)的道路线(30、31)相交之前的剩余时间生成车辆(10)的动态定值的步骤(106),
其特征在于,所述行车道(11)的几何形状参数包括如下参数中的至少一种:相对于摄像头(20)在行车道(11)右侧的道路线(30)的位置,相对于摄像头(20)在行车道(11)左侧的道路线(31)的位置,通常由摄像头(20)对外侧道路线测定的行车道(11)的曲率。
2.根据权利要求1所述的轨迹校正方法,其特征在于,在获取行车道(11)的几何形状参数的步骤(100)中,行车道(11)的参数测量结果被以50毫秒随后延迟50毫秒的频率发送。
3.根据权利要求1或2所述的轨迹校正方法,其特征在于,在获取行车道(11)的几何形状参数的步骤(100)之后,所述方法还包括计算信任指数的步骤(101),根据在行车道(11)的几何形状参数的测量结果和道路线模型之间的相关性计算该信任指数。
4.根据权利要求1到3所述的轨迹校正方法,其特征在于,在确定航向角(a)的步骤(102)中确定的航向角(a)是根据行车道(11)的几何形状参数和车辆(10)的位置计算的。
5.根据权利要求1到4所述的轨迹校正方法,其特征在于,在不可能校正轨迹的情况下,取消生成车辆(10)动态定值的步骤(106)并用一个特定警示代替。
6.根据权利要求1到5所述的轨迹校正方法,其特征在于,在机动车辆(10)的驾驶员操作车辆(10)的一个控制元件时,所述驾驶员可以禁止生成车辆(10)动态定值的步骤(106)。
7.一种实施根据前面权利要求所述方法的行驶在行车道(11)上的机动车辆(10)的轨迹校正装置(12),所述装置包括:
-摄像头(20),
-控制单元(21),
-横摆率传感器(22)
-机动车辆(10)的速度传感器(23),
-主动转向系统(24),
其特征在于,所述装置包括根据对应于车辆(10)的纵向轴线(A)与行车道(11)的道路线(30、31)之间夹角的航向角(a)来校正轨迹的部件。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
FR1250529 | 2012-01-19 | ||
FR1250529A FR2985971B1 (fr) | 2012-01-19 | 2012-01-19 | Procede de correction de trajectoire d’un vehicule automobile et dispositif de correction de trajectoire d’un vehicule automobile associe |
PCT/FR2013/050090 WO2013107978A1 (fr) | 2012-01-19 | 2013-01-15 | Procede de correction de trajectoire d'un vehicule automobile et dispositif de correction de trajectoire d'un vehicule automobile associe |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104245463A true CN104245463A (zh) | 2014-12-24 |
CN104245463B CN104245463B (zh) | 2017-04-12 |
Family
ID=47714396
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201380006120.6A Active CN104245463B (zh) | 2012-01-19 | 2013-01-15 | 机动车辆轨迹校正方法和相应的机动车辆轨迹校正装置 |
Country Status (4)
Country | Link |
---|---|
EP (1) | EP2804794A1 (zh) |
CN (1) | CN104245463B (zh) |
FR (1) | FR2985971B1 (zh) |
WO (1) | WO2013107978A1 (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TWI602725B (zh) * | 2015-10-13 | 2017-10-21 | 財團法人車輛研究測試中心 | 具路徑誤差修正的車輛軌跡追蹤裝置及方法 |
CN109085837A (zh) * | 2018-08-30 | 2018-12-25 | 百度在线网络技术(北京)有限公司 | 车辆控制方法、装置、计算机设备及存储介质 |
CN109641622A (zh) * | 2016-08-29 | 2019-04-16 | 奥迪股份公司 | 用于运行机动车的方法 |
CN112437734A (zh) * | 2018-07-13 | 2021-03-02 | 雷诺股份公司 | 用于产生可植入到用于控制机动车辆轨迹的单元中的预测命令的方法 |
CN113453157A (zh) * | 2021-08-31 | 2021-09-28 | 浙江宇视科技有限公司 | 一种时空轨迹校准方法、装置、存储介质及电子设备 |
CN115223358A (zh) * | 2022-06-01 | 2022-10-21 | 北京四维图新科技股份有限公司 | 一种交通信息动态更新方法、装置及车路协同系统 |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102014226764A1 (de) * | 2014-12-22 | 2016-06-23 | Robert Bosch Gmbh | Verfahren und Vorrichtung zum Führen eines Fahrzeugs auf einer Fahrspur |
FR3051756B1 (fr) * | 2016-05-24 | 2020-03-20 | Renault S.A.S | Dispositif de controle de trajectoire d’un vehicule |
US9666067B1 (en) | 2016-08-30 | 2017-05-30 | Allstate Insurance Company | Vehicle turn detection |
FR3066985B1 (fr) * | 2017-06-06 | 2020-10-30 | Renault Sas | Dispositif d'assistance a la conduite d'un vehicule automobile dans une voie de circulation |
FR3101306B1 (fr) * | 2019-10-01 | 2021-10-15 | Renault Sas | Dispositif de contrôle de l’angle de braquage d’un véhicule automobile à conduite autonome |
Family Cites Families (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CH294059A (fr) | 1951-09-21 | 1953-10-31 | Fontainemelon Horlogerie | Palier amortisseur de chocs. |
FR2706604B1 (fr) | 1993-06-18 | 1995-09-01 | Peugeot | Dispositif de détermination d'un cap relatif suivi par un véhicule automobile. |
DE10254525A1 (de) * | 2002-11-22 | 2004-06-17 | Audi Ag | Verfahren und Vorrichtung zur Vorhersage des Fahrzeugverhaltens sowie diesbezügliches Computer-Programm-Produkt |
DE102004039142A1 (de) * | 2004-08-12 | 2006-02-23 | Robert Bosch Gmbh | Spurhalteassistenzsystem für Kraftfahrzeuge |
DE102004045103A1 (de) * | 2004-09-17 | 2006-03-30 | Daimlerchrysler Ag | Verfahren zum Erzeugen einer Spurverlasswarnung |
JP4108706B2 (ja) * | 2005-10-31 | 2008-06-25 | 三菱電機株式会社 | 車線逸脱防止装置 |
CN101778753B (zh) | 2007-08-15 | 2012-12-05 | 沃尔沃技术公司 | 用于支持车辆的车道保持的操作方法和系统 |
KR101039722B1 (ko) | 2007-12-12 | 2011-06-09 | 현대자동차주식회사 | 차선유지 보조시스템 |
DE102007061900B4 (de) | 2007-12-20 | 2022-07-07 | Volkswagen Ag | Spurhalteassistenzsystem und -verfahren für ein Kraftfahrzeug |
BRPI0924608B1 (pt) | 2009-06-29 | 2020-05-19 | Volvo Lastvagnar Ab | método e sistema para assistência a um motorista de um veículo durante operação |
US8626391B2 (en) * | 2010-03-17 | 2014-01-07 | Mando Corporation | Method and system for lane-keeping control |
-
2012
- 2012-01-19 FR FR1250529A patent/FR2985971B1/fr active Active
-
2013
- 2013-01-15 WO PCT/FR2013/050090 patent/WO2013107978A1/fr active Application Filing
- 2013-01-15 EP EP13704157.0A patent/EP2804794A1/fr not_active Withdrawn
- 2013-01-15 CN CN201380006120.6A patent/CN104245463B/zh active Active
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TWI602725B (zh) * | 2015-10-13 | 2017-10-21 | 財團法人車輛研究測試中心 | 具路徑誤差修正的車輛軌跡追蹤裝置及方法 |
CN109641622A (zh) * | 2016-08-29 | 2019-04-16 | 奥迪股份公司 | 用于运行机动车的方法 |
CN109641622B (zh) * | 2016-08-29 | 2020-05-15 | 奥迪股份公司 | 用于运行机动车的方法 |
CN112437734A (zh) * | 2018-07-13 | 2021-03-02 | 雷诺股份公司 | 用于产生可植入到用于控制机动车辆轨迹的单元中的预测命令的方法 |
CN109085837A (zh) * | 2018-08-30 | 2018-12-25 | 百度在线网络技术(北京)有限公司 | 车辆控制方法、装置、计算机设备及存储介质 |
US11614737B2 (en) | 2018-08-30 | 2023-03-28 | Apollo Intelligent Driving Technology (Beijing) Co., Ltd. | Vehicle controlling method and apparatus, computer device, and storage medium |
CN113453157A (zh) * | 2021-08-31 | 2021-09-28 | 浙江宇视科技有限公司 | 一种时空轨迹校准方法、装置、存储介质及电子设备 |
CN115223358A (zh) * | 2022-06-01 | 2022-10-21 | 北京四维图新科技股份有限公司 | 一种交通信息动态更新方法、装置及车路协同系统 |
CN115223358B (zh) * | 2022-06-01 | 2024-04-02 | 北京四维图新科技股份有限公司 | 一种交通信息动态更新方法、装置及车路协同系统 |
Also Published As
Publication number | Publication date |
---|---|
CN104245463B (zh) | 2017-04-12 |
EP2804794A1 (fr) | 2014-11-26 |
FR2985971B1 (fr) | 2014-08-22 |
WO2013107978A1 (fr) | 2013-07-25 |
FR2985971A1 (fr) | 2013-07-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104245463A (zh) | 机动车辆轨迹校正方法和相应的机动车辆轨迹校正装置 | |
CN112733270B (zh) | 车辆行驶轨迹预测和轨迹偏离危险度评估的系统与方法 | |
JP6055525B1 (ja) | 車両の走行制御装置 | |
CN101837781B (zh) | 用于自动车道对正或换道的控制系统的基于模型的预测控制 | |
US9318023B2 (en) | System and method for collision avoidance maneuver path determination with jerk limit | |
JP6420173B2 (ja) | 自動走行圃場作業車両 | |
KR101358329B1 (ko) | 차선 추종 제어 시스템 및 그 제어 방법 | |
JP4161923B2 (ja) | 車両安定化制御システム | |
US20170291638A1 (en) | Autonomous vehicle lateral control for path tracking and stability | |
KR100851120B1 (ko) | 이에스피 통합형 차선 유지 지원장치 및 그 제어 방법 | |
WO2009155228A1 (en) | Path generation algorithm for automated lane centering and lane changing control system | |
CN110114254B (zh) | 在自动变道期间减小横向位置偏差 | |
US20180304918A1 (en) | Automatic driving system | |
CN109941342B (zh) | 估计转向力矩的方法和装置、用于车辆的横向控制的方法 | |
CN104691609A (zh) | 用于转向角度命令到扭矩命令转换的算法 | |
CN103204162A (zh) | 具有有效后转向的车道跟踪系统 | |
JP6106261B2 (ja) | 車両におけるアクティブ操舵システム用の非線形補償制御装置 | |
US20230211786A1 (en) | Path-controlling module, associated path-controlling device and associated method | |
US20220324466A1 (en) | Device for predictively controlling the movement of a motor vehicle | |
CN105774801A (zh) | 用于引导车道上的车辆的方法和设备 | |
KR102164606B1 (ko) | 자율주행 차량을 위한 횡방향 제어 파라미터 보정 장치 및 방법 | |
CN116080754B (zh) | 一种车辆自主驾驶横向控制方法 | |
JP2016030587A (ja) | 到達予測点提示装置、及びプログラム | |
CN113396093B (zh) | 用于自主控制设备移动性的方法 | |
JPWO2006013645A1 (ja) | 車両姿勢制御装置および方法 |
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 |