CN114248792A - 车辆驾驶辅助系统及其控制单元和方法 - Google Patents

车辆驾驶辅助系统及其控制单元和方法 Download PDF

Info

Publication number
CN114248792A
CN114248792A CN202010993845.0A CN202010993845A CN114248792A CN 114248792 A CN114248792 A CN 114248792A CN 202010993845 A CN202010993845 A CN 202010993845A CN 114248792 A CN114248792 A CN 114248792A
Authority
CN
China
Prior art keywords
deflection
biased
difference
point
unbiased
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
Application number
CN202010993845.0A
Other languages
English (en)
Inventor
张贇
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Robert Bosch GmbH
Original Assignee
Robert Bosch GmbH
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Robert Bosch GmbH filed Critical Robert Bosch GmbH
Priority to CN202010993845.0A priority Critical patent/CN114248792A/zh
Publication of CN114248792A publication Critical patent/CN114248792A/zh
Pending legal-status Critical Current

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W60/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001Planning or execution of driving tasks
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/005Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/28Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42Determining position
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Indexing codes relating to the type of sensors based on the principle of their operation
    • B60W2420/40Photo, light or radio wave sensitive means, e.g. infrared sensors
    • B60W2420/403Image sensing, e.g. optical camera
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Indexing codes relating to the type of sensors based on the principle of their operation
    • B60W2420/40Photo, light or radio wave sensitive means, e.g. infrared sensors
    • B60W2420/408Radar; Laser, e.g. lidar
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W2556/00Input parameters relating to data
    • B60W2556/40High definition maps

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Human Computer Interaction (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Traffic Control Systems (AREA)

Abstract

提供了一种车辆驾驶辅助系统及其控制单元和方法。所述控制单元包括基础差量确定模块,配置成基于处于自动驾驶模式下的本车的当前位置与相应的加偏位置计算出基础差量,所述当前位置是基于卫星信号确定的位置,所述相应的加偏位置是所述当前位置经由偏转插件加偏之后的位置;偏转差量确定模块,配置成基于本车的未加偏点的位置与经由偏转插件加偏之后的加偏点的位置之间的位置差计算偏转差量,所述偏转差量是从所述位置差中去除所述基础差量之后的值;以及决策模块,配置成基于所述偏转差量为本车确定自动驾驶策略。

Description

车辆驾驶辅助系统及其控制单元和方法
技术领域
本申请总体上涉及用于车辆的驾驶辅助的技术领域,尤其涉及一种用于驾驶辅助系统的控制单元以及包括该控制单元的车辆驾驶辅助系统,还涉及一种车辆驾驶辅助方法以及相应的机器可读存储介质。
背景技术
定位技术可以提供基于位置的服务,其对于自动驾驶而言是必不可少的。在自动驾驶方面,定位技术例如可以采用基于视觉的定位技术、基于卫星的定位技术和基于高精地图的定位技术。这些定位技术各有优缺点,例如,极端的天气情况可能引起视觉的不足,遮挡可能引起GPS信号的跳变。由此,单一的定位方案往往不足以使得车辆在复杂的环境和不同的路况下对环境进行定位,所以现有技术中提出了采用多种定位方案互为冗余来为自动驾驶车辆提供定位服务的方案。
关于用于自动驾驶的定位技术,研究得比较多的是如何弥补视觉不足以及如何消除GPS信号不稳定的问题,而另一类问题,即,如何应对位置数据在被偏转和加密之后产生的非线性变形带来的定位挑战却尚不存在较佳的解决方案。
发明内容
鉴于现有技术中的上述问题,本发明旨在提供了一种改进的驾驶辅助方案。
根据本发明第一方面的实施例,提供了一种用于驾驶辅助系统的控制单元,包括:基础差量确定模块,配置成基于处于自动驾驶模式下的本车的当前位置与相应的加偏位置计算出基础差量,所述当前位置是基于卫星信号确定的位置,所述相应的加偏位置是所述当前位置经由偏转插件加偏之后的位置;偏转差量确定模块,配置成基于本车的未加偏点的位置与经由偏转插件加偏之后的加偏点的位置之间的位置差计算偏转差量,所述偏转差量是从所述位置差中去除所述基础差量之后的值;以及决策模块,配置成基于所述偏转差量为本车确定自动驾驶策略。
根据本发明第二方面的实施例,提供了一种驾驶辅助系统,包括:定位装置,用于基于卫星信号确定本车的位置;以及控制装置,包括偏转插件和如上所述的控制单元,与所述定位装置连接,用于基于未加偏点的位置和经由偏转插件加偏之后的加偏点的位置之间的位置差确定偏转差量,并基于所述偏转差量确定自动驾驶策略。
根据本发明第三方面的实施例,提供了一种驾驶辅助方法,可选地,所述方法由如上所述的控制单元和/或如上所述的系统执行,所述方法包括:基于处于自动驾驶模式下的本车的未加偏点位置与经由偏转插件加偏之后的加偏点位置之间的位置差计算偏转差量;以及基于所述偏转差量为本车确定自动驾驶策略。
根据本发明第四方面的实施例,提供了一种机器可读存储介质,其存储有可执行指令,所述指令当被执行时使得一个或多个处理器执行如上所述的方法。
由此可见,根据本发明的实施例,其能够监控车辆在自动驾驶模式下由于位置数据被偏转和加密引起的非线性偏差(即,偏转差量),还能够基于监控到偏差作出适合的自动驾驶策略,从而提升了车辆自动驾驶的安全性。
附图说明
图1示意性示出了具有根据本发明一实施方式的驾驶辅助系统的车辆。
图2是图1中的驾驶辅助系统的示意性框图。
图3是图1中的驾驶辅助系统的控制单元的示意性框图。
图4示意性示出了根据本发明一实施方式的驾驶辅助过程。
图5是根据本发明一实施方式的偏转差量确定过程的原理图。
图6是根据本发明一实施方式的驾驶辅助方法的流程图。
具体实施方式
用于车辆自动驾驶的数字地图可以为车辆感知环境提供辅助,提供道路信息和路况信息,并帮助车辆形成自动驾驶策略。但是,用于自动驾驶的数字地图必须经由偏转加密算法的处理,这样,车辆采用经加偏的地图执行自动驾驶时,对象在加偏之后的地图上的定位相对于其真实位置存在一偏差,该偏差包括基础差量(即,下文中描述的“基础差量”,例如,约几百米)和随机差量(也可以称为“非线性差量”,即,下文中描述的“偏转差量”)。
考虑到这样的随机偏差会使得本车对周围环境中的对象相对于真实道路的定位出现误差,从而引发危险事故。例如,本车对前车的定位出现的误差导致本车对前车所处车道的判断错误。本发明的发明人设计了一种用于驾驶辅助的控制策略,其能够计算并监控随机差量,还能够基于该差量确定相应的自动驾驶策略,提升了自动驾驶的安全性。
进一步地,发明人还基于该随机差量创建了系统误差模型,用于确定本车感知的对象位置相对于真实道路的误差,实现了对于该误差的定量计算。
以下结合附图来说明本发明的具体实施方式。
图1示意性示出了具有根据本发明一实施方式的驾驶辅助系统的车辆。图2是图1中的驾驶辅助系统的示意性框图。参见图1和图2,驾驶辅助系统100设置在车辆1中,主要包括定位装置10和控制装置20。
定位装置10用于确定车辆1(即,本车)的位置。定位装置10可以实现为车载GPS定位器,其接收卫星信号并基于接收到的卫星信号来确定本车的位置。
控制装置30主要包括偏转插件21和控制单元22。
偏转插件21也叫做保密插件,可以设置在驾驶辅助系统的控制器中。偏转插件21可以将定位装置10确定的位置的坐标转换成偏转加密的坐标,这样可以与经偏转的数字地图相匹配。
控制单元22具有控制策略,其能够计算并监控由偏转加密算法带来的非线性偏差,并基本该非线性偏差确定合适的自动驾驶策略。进一步,该控制策略还能够提供系统误差模型,用于确定本车感知的对象相对于真实道路的误差。控制单元22的工作原理将在下面具体描述。
控制单元22可以采用硬件或者软件或者软件与硬件相结合的方式来实现。对于硬件实现的部分,可以在一个或多个专用集成电路(ASIC)、数字信号处理器(DSP)、数据信号处理器件(DSPD)、可编程逻辑器件(PLD)、现场可编程门阵列(FPGA)、处理器、控制器、微控制器、微处理器、被设计以执行其功能的电子单元、或它们的组合中实现。对于以软件实现的部分,可以借助于微代码、程序代码或代码段来实现,还可以将它们存储在诸如存储组件之类的机器可读存储介质中。
在一个实现方式中,控制单元22实现为包括存储器和处理器。存储器包含指令,该指令在被处理器执行时使得处理器执行根据本发明的实施例的控制策略/控制方法。
驾驶辅助系统100还可以包括感测装置30和数字地图40。
感测设备30用于感测车辆1周围环境情况并输出环境信息。感测设备30实现为环境传感器。环境传感器可以设置于车辆1的内部或者车辆1的一侧或多侧,即,实现为车载传感器。例如,环境传感器可以为以下一种或多种:车载摄像头(单目标或多目标),激光雷达器,超声波雷达器(如毫米波雷达),车载接收器等。车载摄像头可以采集包含环境信息图像或者视频;雷达器可以感测本车与周围对象之间的相对距离;车载接收器可以通过接收信号的时延,或者根据接收信号中的时间戳信息,判断本车周围对象与本车之间的相对位置关系。
感测设备30也可以实现为车辆1外部的传感器并能够通过无线通信将感测到的环境信息传送至车端。例如,摄像头、雷达、无线收发器可以设置在路侧,通过路边智能设备对收集到的信息进行分析并将分析结果发送至车端,以便在车端可以基于分析结果执行进一步的运算。换言之,在本发明中,环境信息可以来自车载的环境传感器,也可以来自车辆外部的环境传感器,还可以来自这两者并对来自两者的环境信息进行融合处理。
数字地图40可以辅助车辆1的自动驾驶。例如,数字地图40可以提供道路信息和路况信息,并帮助车辆1形成自动驾驶策略。数字地图40例如是高精地图(HD MAP)。数字地图40可以存储在车端,例如,存储在驾驶辅助系统100的存储器(未示出)中。数字地图40也可以存储在边缘服务器或云端服务器中,并经由车端的通信接口从边缘服务器或云端服务器获取数字地图40。用于自动驾驶的数字地图40中的地图数据是经由偏转加密的,即,数字地图40中体现的坐标是对真实坐标进行偏转加密处理后的偏转坐标。
下面,介绍控制单元22的构成及其工作原理。
参见图3,控制单元22主要包括基础差量确定模块221、偏转差量确定模块222、决策模块223和创建模块224。可以理解的是,控制单元22的各模块的命名应当被理解为逻辑上的描述,而不应理解为物理形态或设置方式的限定。换言之,确定模块221、偏转差量确定模块222、决策模块223和创建模块224中的一个或多个可以实现在同一芯片或电路中,它们也可以分别设置于不同的芯片或电路中,本发明对此不进行限定。
图4示意性示出了根据本发明一实施方式的驾驶辅助过程400。图5示意性示出了根据本发明一实施方式的偏转差量确定过程的原理。
在框402中,基础差量确定模块221基于本车的当前位置与相应的加偏位置计算出基础差量。该当前位置是基于卫星信号确定的位置,即,没有被加偏的位置。该相应的加偏位置是当前位置经由偏转插件加偏之后的位置。
参见图5,在一个实施例中,基础差量确定模块221从定位装置10获取本车的当前位置P1以及相应的加偏位置P1’。该加偏位置P1’是当前位置P1经由偏转插件加偏之后的位置。接着,计算当前位置P1与加偏位置P1’之间的位置差,作为基础差量Δdbase
在框404中,偏转差量确定模块以当前位置为起点确定未加偏的预设轨迹Llane-pre并在该预设轨迹上采样多个未加偏点(例如,图5中的P2-P6)。多个未加偏点是在预设轨迹上采样的多个位置(例如,用多个位置坐标来表示),这些位置是没有经由偏转插件加偏的位置。预设轨迹可以是直线路径,也可以是曲线路径,还可以包含直线路径与曲线路径的组合。预设轨迹可以具有预定的长度L。该长度L可以用预设轨迹的起点到终点之间的直线距离来表示。
以下,以示例的方式描述确定预设轨迹以及多个采样点(即,采样的多个未加偏点)的实施例。
在一个实施例中,以本车的当前位置(基于卫星信号的当前位置)为起点,从自动驾驶系统为本车规划的路径中选取一段路径作为预设轨迹Llane-pre。即,借助于自动驾驶系统的规划路径来获得预设轨迹。在所选取的路径上采样多个位置点作为多个未加偏点。
在另一个实施例中,以本车的当前位置(基于卫星信号的当前位置)为起点,沿本车前进方向取一段直线路径作为预设轨迹Llane-pre。在直线路径上采样多个位置点作为多个未加偏点。
在又一个实施例中,以本车的当前位置(基于卫星信号的当前位置)为起点,以偏离本车前进方向的多个方向取多个直线路径,并将这些直线路径作为预设轨迹Llane-pre。在多个直线路径采样多个位置点作为多个未加偏点
在又一个实施例中,以本车的当前位置(基于卫星信号的当前位置)为圆心,确定出一个或多个同心圆路径,并将一个或多个同心圆路径作为预设轨迹Llane-pre。在一个或多个同心圆路径上采样多个位置点作为所述多个未加偏点。
可以理解的是,预设轨迹还可以采样以上实施例中的多个相结合的方式来确定。
可以理解的是,在确定了预设轨迹之后,对于如何在预设路上采样未加偏的位置点,本发明不进行限定。
在框406中,偏转差量确定模块222基于多个未加偏点获得相应的多个加偏点。
在一个实施例中,将多个未加偏点分别作为输入,代入偏转插件,得到经由偏转插件加偏之后的多个输出,即,多个加偏点。例如,参见图5,将未加偏点P2-P6的坐标作为输出分别输入偏转插件,以获得加偏点P2’-P6’的坐标(即,加偏坐标)。
在框408中,偏转差量确定模块222基于未加偏点和加偏点之间的位置差计算偏转差量Δd。该偏转差量Δd是从该位置差中去除了基础差量Δdbase之后的值。可以理解的是,偏转差量Δd和基础差量Δdbase均为矢量,对它们求差即将两个矢量相减,相减后的结果也为矢量,并且相减后得到的矢量的值是模长。
以下,以示例的方式描述偏转差量Δd的实施例。
在一个实施例中,偏转差量确定模块222将最后一个未加偏点与相应的加偏点之间的位置差减去所述基础差量之后的值作为所述偏转差量Δd。例如,参见图5,将采样的最后一个未加偏点P6与相应的加偏点P6’之间的位置差Δd6减去所述基础差量Δdbase之后的值作为所述偏转差量Δd。可以理解的是,与上面的矢量相减类似,位置差Δd6与基础差量Δdbase均为矢量,对它们求差即将两个矢量相减,相减后的结果也为矢量,并且相减后得到的矢量的值是模长。
在另一个实施例中,偏转差量确定模块222计算各未加偏点与相应的加偏点之间的位置差,并将这些位置差中的最大值(即,最大位置差)减去基础差量Δdbase之后的值作为所述偏转差量Δd。
在又一个实施例中,偏转差量确定模块222基于各未加偏点与相应的加偏点之间的位置差与该未加偏点距离起点的距离的比值来确定所述偏转差量Δd。例如,偏转差量确定模块222可以基于如下公式计算所述偏转差量Δd:
Δd=R(max)*L,R(max)是Ri=Δdi/Li中的最大值,
其中,Li为一未加偏点距离起点的直线距离(L3是未加偏点P3距离起点P1的直线距离),L为最后一个未加偏点距离起点的直线距离(例如,P1与P6之间的直线距离),Δdi是第i个未加偏点与第i个加偏点之间的位置差减去基础差量之后的值,Δd为所述偏转差量。i为从1至n的自然数,n是采样的未加偏点的数量。
在又一个实施例中,偏转差量确定模块222将确定出的偏转差量沿着车辆行驶方向及其垂直方向分解,并将垂直方向的分量作为用于决策自动驾驶策略的偏转差量。换言之,在该实施例中,相比于纵向偏差(即,车辆行驶方向上的偏差),更加关注的是横向偏差(即,与车辆行驶方向垂直的方向上的偏差)。
在框410中,决策模块223基于确定出偏转差量确定相应的自动驾驶策略。例如,决策模块223将偏转差量与偏转差量阈值相比较,并基于比较结果来确定自动驾驶策略。
可以理解的是,偏转差量阈值是预先确定的,可以考虑自动驾驶等级,道路等级,路况等因素来确定。偏转差量阈值还可以采用模型计算,并且结合实车试验。本发明对于该阈值的确定方式不进行限定。
在框412中,在偏转差量小于偏转差量阈值时,决策模块223使得本车继续处于自动驾驶模式。
在框414中,在偏转差量小于偏转差量阈值时,决策模块223创建包含所述偏转差量的误差模型。该误差模型用于确定本车感知到的物体相对于真实道路的误差。
在一个实施例中,决策模块223创建的误差模型为:
Figure BDA0002691825110000091
其中,δA_to_real_road为本车感知的物体A相对于真实道路的误差,δper为本车的自动驾驶系统的感知设备感知物体A时产生的误差(例如,摄像头或雷达感测前车A时产生的误差),δloc@L为本车对自身位置在数字地图上的定位误差,δmap为数字地图的地图数据的误差(例如,采用地图数据在描述位置时产生的误差),Δd为所述偏转差量。
在该实施例中,δloc@L可以通过如下公式获得:
δloc@L=L·δloc-rotloc-t
其中,L为第一个未加偏点与最后一个未加偏点之间的直线距离,δloc-t为本车对自身位置在数字地图上的定位的平移误差,δloc-rot为本车对自身位置在数字地图上的定位的旋转误差。
在框416中,在所述偏转差量大于或等于所述偏转差量阈值时,决策模块223禁用用于自动驾驶的数字地图并生成警报信息。该报警信息可以以下一种或多种方式传递给车内驾驶人员:声光报警、座椅振动、HUD上的警报信号。
在框418中,在禁用所述数字地图之后无法实现自动驾驶的情况下,决策模块223使得本车退出自动驾驶模式,并向服务器上报本车的当前位置以及相关诊断信息。这时,本车可以靠边停车或者交由人类驾驶员接管。
本发明还提供一种驾驶辅助方法600。该方法可在上述控制单元22中执行,也可在上述驾驶辅助系统100中执行。因此,以上相关描述同样适用于此,不赘述。
参见图6,在步骤S610中,基于处于自动驾驶模式下的本车的未加偏点位置与经由偏转插件加偏之后的加偏点位置之间的位置差计算偏转差量。
在步骤S620中,基于计算出的偏转差量为本车确定自动驾驶策略。
本发明还提供机器可读存储介质,其存储有可执行指令,所述指令当被执行时使得一个或多个处理器执行上述驾驶辅助方法600。
可以理解的是,以上描述的所有模块都可以通过各种方式来实施。这些模块可以被实施为硬件、软件、或其组合。此外,这些模块中的任何模块可以在功能上被进一步划分成子模块或组合在一起。
可以理解的是,处理器可以使用电子硬件、计算机软件或其任意组合来实施。这些处理器是实施为硬件还是软件将取决于具体的应用以及施加在系统上的总体设计约束。作为示例,本发明中给出的处理器、处理器的任意部分、或者处理器的任意组合可以实施为微处理器、微控制器、数字信号处理器(DSP)、现场可编程门阵列(FPGA)、可编程逻辑器件(PLD)、状态机、门逻辑、分立硬件电路、以及配置用于执行在本公开中描述的各种功能的其它适合的处理部件。本发明给出的处理器、处理器的任意部分、或者处理器的任意组合的功能可以实施为由微处理器、微控制器、DSP或其它适合的平台所执行的软件。
可以理解的是,软件应当被广泛地视为表示指令、指令集、代码、代码段、程序代码、程序、子程序、软件模块、应用、软件应用、软件包、例程、子例程、对象、运行线程、过程、函数等。软件可以驻留在计算机可读介质中。计算机可读介质可以包括例如存储器,存储器可以例如为磁性存储设备(如,硬盘、软盘、磁条)、光盘、智能卡、闪存设备、随机存取存储器(RAM)、只读存储器(ROM)、可编程ROM(PROM)、可擦除PROM(EPROM)、电可擦除PROM(EEPROM)、寄存器或者可移动盘。尽管在本公开给出的多个方面中将存储器示出为是与处理器分离的,但是存储器也可以位于处理器内部(如,缓存或寄存器)。
虽然前面描述了一些实施方式,这些实施方式仅以示例的方式给出,而不意于限制本发明的范围。所附的权利要求及其等同替换意在涵盖本发明范围和主旨内做出的所有修改、替代和改变。

Claims (12)

1.一种用于驾驶辅助系统的控制单元,包括:
基础差量确定模块,配置成基于处于自动驾驶模式下的本车的当前位置与相应的加偏位置计算出基础差量,所述当前位置是基于卫星信号确定的位置,所述相应的加偏位置是所述当前位置经由偏转插件加偏之后的位置;
偏转差量确定模块,配置成基于本车的未加偏点的位置与经由偏转插件加偏之后的加偏点的位置之间的位置差计算偏转差量,所述偏转差量是从所述位置差中去除所述基础差量之后的值;以及
决策模块,配置成基于所述偏转差量为本车确定自动驾驶策略。
2.如权利要求1所述的控制单元,其中,所述偏转差量确定模块还被配置成:
将基于所述位置差计算出的偏转差量沿着车辆行驶方向及其垂直方向分解,并将垂直方向的分量作为用于决策自动驾驶策略的偏转差量。
3.如权利要求1或2所述的控制单元,其中,所述偏转差量确定模块配置成:
以所述当前位置为起点确定未加偏的预设轨迹并在所述预设轨迹上采样多个未加偏点;
确定与所述多个未加偏点一一对应的多个加偏点,各加偏点是相应的未加偏点经由偏转插件加偏之后得到的;并且
基于所述多个未加偏点和所述多个加偏点中的全部或部分计算所述位置差。
4.如权利要求3所述的控制单元,其中,所述偏转差量确定模块配置成借助于如下项中一项或多项计算所述偏转差量:
(1)采样的最后一个未加偏点的位置与相应的加偏点的位置之间的位置差减去所述基础差量之后的值;
(2)采样的各未加偏点的位置与相应的加偏点的位置之间的位置差中的最大位置差减去所述基础差量之后的值;
(3)采样的各未加偏点的位置与相应的加偏点的位置之间的位置差与该未加偏点距离起点的距离的比值。
5.如权利要求1-4中任一项所述的控制单元,其中,所述决策模块配置成:
将所述偏转差量与偏转差量阈值相比较;
在所述偏转差量小于所述偏转差量阈值时,使得本车继续处于自动驾驶模式;并且
在所述偏转差量大于或等于所述偏转差量阈值时,禁用用于自动驾驶的数字地图并生成警报信息,
可选地,所述决策模块还被配置成在禁用所述数字地图之后无法实现自动驾驶的情况下,使得本车退出自动驾驶模式,并向服务器上报本车的当前位置以及相关诊断信息。
6.如权利要求1-5中任一项所述的控制单元,其中,所述控制单元还包括创建模块,所述创建模块配置成:
在所述决策模块确定为所述偏转差量小于偏转差量阈值时,创建包含所述偏转差量的误差模型,所述误差模型用于确定本车感知到的物体相对于真实道路的误差。
7.如权利要求6所述的控制单元,其中,所述误差模型为:
Figure FDA0002691825100000021
其中,δA_to_real_road为本车感知的物体A相对于真实道路的误差,δper为本车的自动驾驶系统的感知设备感知物体A时产生的误差,δloc@L为本车对自身位置在数字地图上的定位误差,δmap为数字地图的地图数据的误差,Δd为所述偏转差量,
可选地,δloc@L通过如下公式获得:
δloc@L=L·δloc-rotloc-t
其中,L为第一个未加偏点与最后一个未加偏点之间的直线距离,δloc-t为本车对自身位置在数字地图上的定位的平移误差,δloc-rot为本车对自身位置在数字地图上的定位的旋转误差。
8.如权利要求1-7中任一项所述的控制单元,其中,所处偏转差量确定模块配置成基于如下公式计算所述偏转差量:
Δd=R(max)*L,其中,R(max)是Ri=Δdi/Li中的最大值,其中,Li为第i个未加偏点距离起点的直线距离,L为最后一个未加偏点距离起点的直线距离,Δdi是第i个未加偏点与第i个加偏点之间的位置差减去基础差量之后的值,Δd为所述偏转差量。
9.如权利要求1-8中任一项所述的控制单元,其中,所述偏转差量确定模块配置成借助于以下一项或多项确定所述预设轨迹以及所述多个未加偏点:
(1)以所述当前位置为起点,从自动驾驶系统为本车规划的路径中选取一段路径作为所述预设轨迹,并在所选取的路径上采样多个位置点作为所述多个未加偏点;
(2)以所述当前位置为起点,沿本车前进方向取一段直线路径作为所述预设轨迹,在所述直线路径上采样多个位置点作为所述多个未加偏点;
(3)以所述当前位置为起点,以偏离本车前进方向的多个方向取多个直线路径作为所述预设轨迹,在所述多个直线路径采样多个位置点作为所述多个未加偏点;
(4)以所述当前位置为圆心,确定出一个或多个同心圆路径,在所述一个或多个同心圆路径上采样多个位置点作为所述多个未加偏点。
10.一种驾驶辅助系统,包括:
定位装置,用于基于卫星信号确定本车的位置;以及
控制装置,包括偏转插件和如权利要求1-10中任一项所述的控制单元,与所述定位装置连接,用于基于未加偏点的位置和经由偏转插件加偏之后的加偏点的位置之间的位置差确定偏转差量,并基于所述偏转差量确定自动驾驶策略。
11.一种驾驶辅助方法,可选地,所述方法由如权利要求1-9中任一项所述的控制单元和/或如权利要求10所述的系统执行,所述方法包括:
基于处于自动驾驶模式下的本车的未加偏点位置与经由偏转插件加偏之后的加偏点位置之间的位置差计算偏转差量;以及
基于所述偏转差量为本车确定自动驾驶策略。
12.一种机器可读存储介质,其存储有可执行指令,所述指令当被执行时使得一个或多个处理器执行如权利要求11所述的方法。
CN202010993845.0A 2020-09-21 2020-09-21 车辆驾驶辅助系统及其控制单元和方法 Pending CN114248792A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010993845.0A CN114248792A (zh) 2020-09-21 2020-09-21 车辆驾驶辅助系统及其控制单元和方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010993845.0A CN114248792A (zh) 2020-09-21 2020-09-21 车辆驾驶辅助系统及其控制单元和方法

Publications (1)

Publication Number Publication Date
CN114248792A true CN114248792A (zh) 2022-03-29

Family

ID=80788250

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010993845.0A Pending CN114248792A (zh) 2020-09-21 2020-09-21 车辆驾驶辅助系统及其控制单元和方法

Country Status (1)

Country Link
CN (1) CN114248792A (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115435796A (zh) * 2022-11-09 2022-12-06 苏州挚途科技有限公司 车辆的定位方法、装置和电子设备
CN116311129A (zh) * 2023-03-22 2023-06-23 中国测绘科学研究院 一种地理信息偏差检测的方法及拓展模块

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115435796A (zh) * 2022-11-09 2022-12-06 苏州挚途科技有限公司 车辆的定位方法、装置和电子设备
CN116311129A (zh) * 2023-03-22 2023-06-23 中国测绘科学研究院 一种地理信息偏差检测的方法及拓展模块

Similar Documents

Publication Publication Date Title
US10599931B2 (en) Automated driving system that merges heterogenous sensor data
US11440537B2 (en) Apparatus and method for estimating position in automated valet parking system
US7970529B2 (en) Vehicle and lane recognizing device
JP4343536B2 (ja) 車用の感知装置
CN112298181B (zh) 车辆控制装置、车辆控制方法及存储介质
US11608059B2 (en) Method and apparatus for method for real time lateral control and steering actuation assessment
CN110740914B (zh) 车辆控制系统、车辆控制方法及存储介质
US11701967B2 (en) Display control device, display control method, and storage medium
CN114248792A (zh) 车辆驾驶辅助系统及其控制单元和方法
US11042759B2 (en) Roadside object recognition apparatus
CN111746531A (zh) 车辆控制装置、车辆控制方法、及存储介质
KR20190109645A (ko) 차량의 측위 장치 및 그 방법
CN115298564A (zh) 雷达装置
CN114212077B (zh) 车辆平行泊入方法、装置、设备及存储介质
CN111746550A (zh) 车辆控制装置、车辆控制方法、及存储介质
US20220161794A1 (en) Vehicle control device, vehicle control method, and non-transitory computer-readable recording medium recording program
US11919544B2 (en) Method and device for operating an automated vehicle
CN109195849B (zh) 摄像装置
CN117168471A (zh) 车辆定位判断方法、装置、车载终端及车辆
CN116075691A (zh) 车辆控制装置、车辆控制方法及程序
CN109559540B (zh) 周边监视装置、周边监视方法及存储介质
CN111746530A (zh) 车辆控制装置、车辆控制方法、及存储介质
CN113479204B (zh) 车辆控制装置、车辆控制方法及存储介质
CN111746529A (zh) 车辆控制装置、车辆控制方法、及存储介质
CN114684191B (zh) 车辆控制装置、车辆控制方法及存储介质

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