CN113950612A - 用于2d路径规划器的道路模型流形 - Google Patents

用于2d路径规划器的道路模型流形 Download PDF

Info

Publication number
CN113950612A
CN113950612A CN201980097467.3A CN201980097467A CN113950612A CN 113950612 A CN113950612 A CN 113950612A CN 201980097467 A CN201980097467 A CN 201980097467A CN 113950612 A CN113950612 A CN 113950612A
Authority
CN
China
Prior art keywords
vehicle
road model
horizontal plane
path
manifold
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
Application number
CN201980097467.3A
Other languages
English (en)
Other versions
CN113950612B (zh
Inventor
M·德姆林
李千山
田文鑫
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.)
Bayerische Motoren Werke AG
Original Assignee
Bayerische Motoren Werke AG
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 Bayerische Motoren Werke AG filed Critical Bayerische Motoren Werke AG
Publication of CN113950612A publication Critical patent/CN113950612A/zh
Application granted granted Critical
Publication of CN113950612B publication Critical patent/CN113950612B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

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
    • B60W60/00—Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001—Planning or execution of driving tasks
    • 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/38—Electronic maps specially adapted for navigation; Updating thereof
    • G01C21/3804—Creation or updating of map data
    • G01C21/3807—Creation or updating of map data characterised by the type of data
    • G01C21/3815—Road data
    • G01C21/3819—Road shape data, e.g. outline of a route
    • 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/18—Conjoint control of vehicle sub-units of different type or different function including control of braking 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
    • 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
    • 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
    • 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
    • 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
    • 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
    • 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/38—Electronic maps specially adapted for navigation; Updating thereof
    • G01C21/3804—Creation or updating of map data
    • G01C21/3833—Creation or updating of map data characterised by the source of data
    • G01C21/3844—Data obtained from position sensors only, e.g. from inertial navigation
    • 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/38—Electronic maps specially adapted for navigation; Updating thereof
    • G01C21/3863—Structures of map data
    • G01C21/3867—Geometry of map features, e.g. shape points, polygons or for simplified maps
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C22/00—Measuring distance traversed on the ground by vehicles, persons, animals or other moving solid bodies, e.g. using odometers, using pedometers
    • G01C22/02—Measuring distance traversed on the ground by vehicles, persons, animals or other moving solid bodies, e.g. using odometers, using pedometers by conversion into electric waveforms and subsequent integration, e.g. using tachometer generator
    • G01C22/025—Differential odometers
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T17/00—Three dimensional [3D] modelling, e.g. data description of 3D objects
    • G06T17/05—Geographic models
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • 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/0043—Signal treatments, identification of variables or parameters, parameter estimation or state estimation
    • B60W2050/0057—Frequency analysis, spectral techniques or transforms
    • 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/18—Braking system
    • 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/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
    • B60W2520/00—Input parameters relating to overall vehicle dynamics
    • B60W2520/16—Pitch
    • 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/18—Roll
    • 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
    • B60W2530/00—Input parameters relating to vehicle conditions or values, not covered by groups B60W2510/00 or B60W2520/00
    • B60W2530/18—Distance travelled
    • 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/15—Road slope, i.e. the inclination of a road segment in the longitudinal direction
    • 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
    • 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
    • B60W2556/00—Input parameters relating to data
    • B60W2556/45—External transmission of data to or from the vehicle
    • B60W2556/50—External transmission of data to or from the vehicle of positioning data, e.g. GPS [Global Positioning System] data

Landscapes

  • Engineering & Computer Science (AREA)
  • Remote Sensing (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Mechanical Engineering (AREA)
  • Transportation (AREA)
  • General Physics & Mathematics (AREA)
  • Geometry (AREA)
  • Combustion & Propulsion (AREA)
  • Software Systems (AREA)
  • Mathematical Physics (AREA)
  • Chemical & Material Sciences (AREA)
  • Human Computer Interaction (AREA)
  • Computer Graphics (AREA)
  • Theoretical Computer Science (AREA)
  • Navigation (AREA)
  • Traffic Control Systems (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Abstract

本公开的各示例描述了一种用于规划车辆路径的方法和装置。该方法包括：获取预定义的6D空间中的道路模型二维(2D)流形，其中6D空间中的道路模型2D流形是通过将道路模型中的对象从3D(x，y，z)空间转换为6D(x，y，z，r，p，y)空间来预先定义的，其中x和y表示对象在水平面上的位置，而z、r、p和y表示对象在现实世界中的高度、侧倾角、俯仰角和偏航角；获取车辆的当前位置(x0、y0、z0)和车辆在水平面上的目标位置(x1、y1)；获得覆盖当前位置和目标位置的一片道路模型2D流形；在使任意两点之间的距离从3D空间到水平面保持不变的情况下，将由该片道路模型2D流形表示的该片道路模型展平到水平面上；以及在水平面上根据展平的道路模型中的当前位置和目标位置为车辆规划路径。

Description

用于2D路径规划器的道路模型流形
技术领域
本公开一般涉及自动驾驶车辆，更具体地，涉及用于2D路径规划器的道路模型流形。
背景技术
自动驾驶车辆(也称为无人驾驶汽车、自动驾驶汽车、机器人汽车)是一种能够感测其环境并且在无需人类输入的情况下导航的车辆。自动驾驶车辆(在下文中被称为“ADV”)使用各种技术来检测其周边环境，诸如使用雷达、激光、GPS、测程法以及计算机视觉。其中，里程被用于确定自动驾驶(AD)车辆的移动(方向和距离)。传统上，里程以3D(x、y、航向)给出，而不包括车辆的高度变化。甚至，用于AD车辆的HD(高清)地图中的道路通常是2D的(也没有高程信息)。这可能导致问题。考虑斜坡或弯曲的入口坡道的情况，其长度比其在2D地图上看起来的距离要长。例如，2D地图中看起来为160米的30度坡度实际长度为200米。在这种情况下，如果AD车辆被指令向前行驶160米以到达斜坡顶部，则其可能会停在斜坡中间，因为3D里程指示其已移动160米。目前，通过车辆上配备的传统定位技术(诸如GPS系统)不断更新车辆位置，该问题被缓解。然而，传统的定位技术的精度及其更新频率不足以用于自动驾驶车辆。
对于AD车辆而言，存在路径规划器以基于HD地图来规划车辆从一个地点行驶到另一个地点的路径。此路径规划器也仅在二维中。换句话说，它只能在平面上规划路径。根据HD地图，路径规划器无法区分曲线入口坡道是在水平面中还是具有高度变化。因此，传统的路径规划器只能像在水平面中一样规划曲线入口坡道的路径。因此，所规划的路径可能会导致具有高程变化的曲线入口坡道转向过度或转向不足。
因此，需要一种考虑高程变化的新的且可靠的路径规划器。
发明内容
本公开旨在提供用于创建交通场景的快照图像的方法和装置。
根据本公开的第一示例性实施例，提供了一种用于为车辆规划路径的计算机实现的方法。该方法包括：获得预定义的6D空间中的道路模型二维(2D)流形，其中6D空间中的道路模型2D流形是通过将道路模型中的对象从3D(x,y,z)空间转换为6D(x,y,z,r,p,y)空间来预先定义的，其中x和y表示对象在水平面上的位置，而z、r、p和y表示现实世界中对象的高度、侧倾角、俯仰角和偏航角；获取车辆的当前位置(x0,y0,z0)和车辆在水平面的目标位置(x1,y1)；获得覆盖当前位置和目标位置的一片道路模型2D流形；在使任意两点之间的距离从3D空间到水平面保持不变的情况下，将由该片道路模型2D流形表示的该片道路模型展平到水平面上；以及在水平面上根据展平的道路模型中的当前位置和目标位置为车辆规划路径。根据本公开的第二示例性实施例，提供了一种用于为车辆规划路径的路径规划装置。该装置包括道路模型流形获取模块，用于获取预定义的6D空间中的道路模型二维(2D)流形，其中6D空间中的道路模型2D流形是通过将道路模型中的对象从3D(x,y,z)空间转换为6D(x,y,z,r,p,y)空间来预先定义的，其中x和y表示对象在水平面上的位置，而z、r、p和y表示对象在现实世界的高度、侧倾角、俯仰角和偏航角；位置获取模块，用于获取车辆的当前位置(x0,y0,z0)和车辆在水平面(x1,y1)上的目标位置；道路模型流形片获得模块，用于获得覆盖当前位置和目标位置的一片道路模型2D流形；展平模块，用于使任意两点之间的距离从3D空间到水平面保持不变的情况下，将由该片道路模型2D流形表示的该片道路模型展平到水平面上；以及路径规划模块，用于在水平面上根据展平的道路模型中的当前位置和目标位置为车辆规划路径。根据本公开的第三示例性实施例，提供了一种车辆，其包括用于确定车辆位置的定位系统；路径规划装置，用于根据本发明为车辆规划路径；以及规划器，用于基于所规划的路径来规划车辆的速度、油门、制动和转向。提供本发明内容以便以简化的形式介绍以下在具体实施方式中进一步描述的概念的选集。本概要并非旨在标识出要求保护的主题内容的关键特征或必要特征，亦非旨在用于限定要求保护的主题内容的范围。诸示例的附加的方面、特征和/或优点将在下面的描述中部分地阐述，并且部分地从描述中将是显而易见的，或者可以通过本公开的实践而获知。
附图说明
结合附图，通过以下对示例性实施例的详细描述，本公开的上述和其它方面和优点将变得显而易见，这些附图作为示例解说了本公开的原理。注意，附图不一定按比例绘制。
图1示出了根据本发明的实施例的示例性6D空间。
图2A示出了3D空间中的直坡道路部分。
图2B示出了图2A的道路段在水平面上的投影。
图3是根据本发明的实施例的用于获得车辆六维(6D)增量姿势的示例性方法的流程图。
图4A示出了根据本发明的实施例的与3D空间中的3D里程相对应的车辆运动的示例性图示。
图4B示出了根据本发明的实施例的3D里程在水平面上的投影的示例性图示。
图5解说了根据本发明实施例的用于为车辆规划路径的示例性路径规划装置。
图6解说了根据本发明的一实施例的示例性车辆。
图7解说了根据本公开的示例性实施例的其中可应用本公开的一般硬件环境。
具体实施方式
在以下详细描述中，阐述了许多具体细节以提供对所描述的示例性实施例的透彻理解。然而，对于本领域技术人员显而易见的是，可以在没有一些或所有这些具体细节的情况下实践所描述的实施例。在其他示例性实施例中，未详细描述众所周知的结构或处理步骤，以避免不必要地使本公开的概念模糊。
在说明书中使用的术语“车辆”是指汽车、飞机、直升机、轮船等。为了简单起见，结合“汽车”来描述本发明，但是本文所描述的各实施例不仅限于“汽车”，而是可适用于其他种类的交通工具。说明书中使用的术语“A或B”是指“A和B”和“A或B”，而不是意味着A和B是排他的，除非另有说明。
常规地，道路模型中的对象是在三维空间中定义的，因此对象的每个点都可以在三维坐标系中用(x，y，z)表示，其中x和y表示点在水平面上的位置，而z表示点的高程。在此基础上，本发明提出在6D空间中表示对象，其中对象的每个点将由(x,y,z,r,p,y)表示，其中x、y和z表示与在3D空间中相同，而r、p和y表示点的侧倾角、俯仰角和偏航角。
图1示出了根据本发明的实施例的示例性6D空间。如图1中所示，仍然使用x轴、y轴和z轴，并且在这个经典3D坐标系上，侧倾角表示围绕y轴旋转的角度，俯仰角表示围绕x轴旋转的角度，而偏航角表示围绕z轴旋转的角度。侧倾角、俯仰角和偏航角通常也称为姿态角。
有了这些定义，现在可以在6D空间中重新定义传统道路模型，至少对于道路模型中的道路是如此。在用于导航的传统导航地图中，道路通常被视为水平的，并且因此仅以2D(x,y)表示。然而，相当多的道路都是斜坡，这在山区或者用于入口坡道或出口坡道是很常见的。例如，如图2A中所示，假设存在具有30度俯仰角的直坡道路段，其可能是高架道路的入口坡道的一部分，并且道路的前进方向仅为y轴的正方向。图2B示出了该路段在水平面(即，x-y平面)上的投影，其看起来类似于用于导航的那些传统地图。现在以A点作为示例，它位于道路的中心线上。假设点A如传统道路模型中所表示的，没有反映高程或姿态角的信息。现在，在根据本发明的6D空间中，点A现在可以从(0,160)重新定义为(0,160,120,0,30,0)，其中x、y和z的单位是米，而r、p和y的单位是度，这清楚地反映了点A所在道路的实际姿态。
以这种方式，可以在6D空间中重新定义道路模型中的对象(至少是道路)的每个点。由于道路模型中的所有对象都从3D(x,y,z)空间变换为6D(x,y,z，r,p,y)空间，变换后的道路模型可被用于基于3D里程(Δx，Δy，θ)进一步获得车辆的6D增量姿势，这将在下一部分中进一步详细说明。简而言之，如果车辆在斜坡上移动，则其3D里程读数(Δx,Δy,θ)实际上反映了车辆在斜坡上的相对移动。为了使其符合为2D平面设计的现有驾驶系统，诸如导航系统或路径规划系统，将3D里程转换为6D空间看上去在某种程度上可能类似于将整个道路模型复制到2D平面上。因此，从3D(x,y,z)空间转换到6D(x,y,z,r,p,y)空间的新道路模型在下文中称为“6D空间中的道路模型2D流形(manifold)”或“道路模型2D流形(manifold)”。
图3是用于获得车辆六维(6D)增量姿势的示例性方法的流程图。该方法从框302开始，其中可获取6D空间中的预先定义的道路模型二维(2D)流形。如上所述，道路模型2D流形可以通过将道路模型中的对象从3D(x,y,z)空间变换为6D(x,y,z,r,p,y)空间来预先定义，其中x和y表示对象在水平面上的位置，而z、r、p和y表示对象在现实世界中的高度、侧倾角、俯仰角和偏航角。
在框304，可从车辆的里程表中获取增量3D里程(Δx,Δy,θ)，其中Δx和Δy表示横向和前后方向的运动，而θ表示车辆的当前航向。图4A示出了与3D空间中的增量3D里程相对应的车辆运动的示例性图示。在此示例中，假设车辆从起点A0移动到终点A1，在此期间，3D里程读数为(Δx,Δy,θ)。为了便于说明，假设移动发生在斜坡上，如图2A中所解说的。
在框306，可将获取的增量3D里程(Δx,Δy,θ)投影到道路模型2D流形上。图4B示出了3D里程(Δx，Δy，θ)在水平面上投影的示例性图示。如前所述，读出的增量3D里程(Δx,Δy,θ)仅告知此短时间窗口期间在该时刻在平面上的运动，无论该平面是否水平。因此，投影可以帮助确定车辆的实际水平和垂直运动以及其真实姿势。作为示例，将获取的增量3D里程(Δx,Δy,θ)投影到道路模型2D流形上可通过以下步骤来执行：
1.获取增量3D里程的起点(x0,y0,z0)的位置。该位置信息可从车辆上配备的GPS模块等定位系统获取；
2.确定起点(x0,y0,z0)在道路模型2D流形中的位置(x0,y0,z0,r0,p0,y0)。由于道路模型2D流形中的每个点都是在6D空间中定义的，因此起点的6D坐标(特别是r0、p0和y0的值)可以基于(x0,y0,z0)直接从道路模型2D流形中导出；
3.基于r0、p0和y0来计算3D里程(Δx,Δy,θ)在水平面上的投影(Δx',Δy'和θ')。更具体地说，分别是滚动摇角、俯仰角和偏航角的r0、p0和y0可被用于将(Δx,Δy,θ)的矢量投影到水平面上，以获得(Δx',Δy'和θ')的水平矢量。
此后，在框308，可确定与增量3D里程相对应的车辆的6DΔ姿势(Δx',Δy',Δz,θr,θp,θy)。作为示例，确定与增量3D里程相对应的车辆的6D增量姿势(Δx',Δy',Δz,r,p,y)可进一步包括以下步骤：
1.基于起点位置和计算出的3D里程的投影(Δx',Δy')来确定增量3D里程的终点(x1,y1)在水平面上的投影。在此示例中，可通过将计算出的3D里程的投影(Δx',Δy')添加到起点A0(x0,y0)的位置来计算终点A1在x-y平面(x1,y1)上的投影；
2.获得6D空间中(x1,y1,z1,r1,p1,y1)中终点A1的位置。再者，使用x1和y1，可以从预先定义的道路模型2D流形中检索6D坐标(x1,y1,z1,r1,p1,y1)；
3.基于终点r1、p1和y1的侧倾角、俯仰角和偏航角来计算3D里程的航向θ在6D空间中的投影(θr,θp,θy)。该计算可被理解为首先将θ的方向重建到车辆当前所在的实际平面上，并且随后以类似于定义侧倾角、俯仰角和偏航角的方式将其分别投影到x、y和z轴上。例如，θr可被计算为θ在x-z平面上的投影，θp可被计算为θ在y-z平面上的投影，而θy可被计算为θ在x-y平面上的投影(即θ′)。然后，计算出的投影(θr,θp,θy)表示车辆在3D空间中的确切航向；以及
4.获得车辆的6D增量姿势(Δx',Δy',Δz,θr,θp,θy)。通过上述步骤，已经获取Δx'、Δy'、θr、θp和θy。现在，Δz可通过简单计算z1和z0之差值来获取。因此，获取车辆的最终6D增量姿势(Δx',Δy',Δz,θr,θp,θy)。
有了车辆的实时6D增量姿势的知识，可以执行进一步处理，特别是关于自动驾驶。作为另一实施例，车辆600还可包括导航系统，其可被配置为从姿势确定装置602接收车辆的当前位置(x1,y1,z1,r1,p1,y1)；并提供至少部分基于车辆当前位置的导航。在另一实施例中，车辆600还可包括驾驶决策模块，其可被配置为从姿势确定装置接收车辆的当前位置(x1,y1,z1,r1,p1,y1)；并至少部分地根据车辆的当前位置来做出驾驶决策。
作为利用根据本发明的车辆在6D空间中的道路模型2D流形和6D增量姿势的示例，图5解说了用于为车辆规划路径的方法的流程图。该方法从框502开始，其中可获取预定义的6D空间中的道路模型二维(2D)流形。
在框504，可以获取车辆的当前位置(x0,y0,z0)和车辆在水平面上的目标位置(x1,y1)。为了规划路径，必须确定车辆的起点位置(通常为当前位置)和目标位置。在目前装备在AD车辆上的2D规划器中，这些位置都是2D的。因此，尽管起点位置的3D位置(x0,y0,z0)甚至6D位置(x0,y0,z0,r0,p0,y0)可能是已知的，但2D规划器可能只需要其2D位置，即(x0,y0)。然后，在确定了2D目标位置(x1,y1)的情况下，2D规划器可以开始规划路径。
在框506，可以获得覆盖当前位置和目标位置的一片道路模型2D流形。具体取决于所处的起始位置和目标位置，该片道路模型2D流形可以是任何部分。作为示例，假设起点位置和目标位置都位于弯曲的入口坡道上，如图6A中所解说的。
在框508，在使任意两点之间的距离从3D空间到水平面保持不变的情况下，可将由该片道路模型2D流形表示的该片道路模型展平到水平面上。作为一个示例，展平可以包括基于其高度、侧倾角、俯仰角和偏航角将道路模型2D流形中的每个点(x,y,z,r,p,y)投影到水平面(x',y')上，因为两点之间的距离可以基于这些姿态角来计算。图6B中解说了道路模型的展平片。作为比较，点A0和A1根据其原始x-y坐标(x0,y0)和(x1,y1)绘制，而展平点A0'和A1'被标绘在其转换位置(x0',y0')和(x1',y1')处。由于车辆存在于弯曲的入口坡道上，从A0'到A1'的距离是车辆实际需要行驶的距离。
此后，在框510，可从水平面上展平的道路模型中的当前位置和目标位置为车辆规划路径，就像道路模型最初在水平面上一样。参考图6B，规划器将规划从A0'到A1'的路径，而不是从A0到A1，从而防止在这种情况下出现转向不足的问题。还可以看出，根据本发明的路径规划方法符合现有的2D路径规划器，因此该技术不需要更换或修改已经安装在AD车辆上的规划器的额外成本。
图7解说了根据本发明实施例的用于为车辆规划路径的示例性路径规划装置700。该路径规划装置700可以包括道路模型流形获取模块702，用于获取预先定义的6D空间中的道路模型二维(2D)流形，其中6D空间中的道路模型2D流形是通过将道路模型中的对象从3D(x,y,z)空间转换为6D(x,y,z,r,p,y)空间来预先定义的，其中x和y表示对象在水平面上的位置，而z、r、p和y表示对象在现实世界的高度、侧倾角、俯仰角和偏航角；位置获取模块704，用于获取车辆的当前位置(x0,y0,z0)和车辆在水平面上的目标位置(x1,y1)；道路模型流形片获得模块706，用于获得覆盖当前位置和目标位置的一片道路模型2D流形；展平模块708，用于在使任意两点之间的距离从3D空间到水平面保持不变的情况下，将由该片道路模型2D流形表示的该片道路模型展平到水平面上；以及路径规划模块710，用于在水平面上从展平的道路模型中的当前位置和目标位置为车辆规划路径。
图8解说了根据本发明的一实施例的示例性车辆800。车辆800可包括用于确定车辆位置的定位系统802；路径规划装置804，用于根据本发明，诸如关于图7描述的路径规划装置700，为车辆规划路径；以及规划器806，用于基于所规划的路径来规划车辆的速度、油门、制动和转向。在一实施例中，在水平面上从展平的道路模型中的当前位置和目标位置为车辆规划路径可进一步包括：基于展平的道路模型来从当前位置和目标位置为车辆规划路径，就像道路模型最初在水平面上一样；以及为所规划的路径的多个段中的每一段规划增量里程(Δx,Δy,θ)，其可进一步包括将规划路径的多个段中的每一段的增量里程(Δx,Δy,θ)转换为6D空间(Δx',Δy',Δz,θr,θp,θy)；以及通过考虑高度、侧倾角、俯仰角和偏航角信息，针对每个段规划车辆的速度、油门、制动和转向。相应地，车辆800还包括里程表808，用于提供里程信息，并且其中里程表所提供的里程信息可与每个区段的增量里程(Δx,Δy,θ)进行比较，以确定车辆是否偏离所规划的路径。
图9解说了其中根据本公开的示例性实施例，用于为车辆规划路径的方法和装置可以适用的一般硬件环境900。
参照图9，现在将描述计算设备900，计算设备900是可应用于本公开的各方面的硬件设备的示例。计算设备900可以是配置成执行处理和/或计算的任何机器，可以是但不限于工作站、服务器、桌面型计算机、膝上型计算机、平板计算机、个人数字助理、智能电话、车载计算机、或其任何组合。以上提及的系统可以全部或者至少部分地由计算设备900或类似设备或系统来实现。
计算设备900可以包括可能地经由一个或多个接口来与总线902连接或者与总线902处于通信的元件。例如，计算设备900可以包括总线902、以及一个或多个处理器904、一个或多个输入设备906和一个或多个输出设备908。该一个或多个处理器904可以是任何类型的处理器，并且可以包括但不限于一个或多个通用处理器和/或一个或多个专用处理器(诸如专门的处理芯片)。输入设备906可以是可将信息输入计算设备的任何类型的设备，并且可以包括但不限于鼠标、键盘、触摸屏、话筒、和/或遥控器。输出设备908可以是可呈现信息的任何类型的设备，并且可以包括但不限于显示器、扬声器、视频/音频输出终端、振动器和/或打印机。计算设备900还可以包括非瞬态存储设备910或者与非瞬态存储设备910相连接，该非瞬态存储设备910可以是为非瞬态的且可实现数据存储的任何存储设备，并且可以包括但不限于盘驱动器、光存储设备、固态存储、软盘、软磁盘、硬盘、磁带或任何其他磁性介质、光盘或任何其他光介质、ROM(只读存储器)、RAM(随机存取存储器)、高速缓存存储器和/或任何其他存储器芯片或存储器盒、和/或计算机可从其读取数据、指令和/或代码的任何其他介质。非瞬态存储设备910可以能与接口分开。非瞬态存储设备910可以具有用于实现上述方法和步骤的数据/指令/代码。计算设备900还可以包括通信设备912。通信设备912可以是能实现与外部装置和/或网络的通信的任何类型的设备或系统，并且可以包括但不限于调制解调器、网卡、红外通信设备、诸如蓝牙TM设备、802.11设备、WiFi设备、WiMax设备、蜂窝通信设施之类的无线通信设备和/或芯片组、等等。
当计算设备900被用作车载设备时，计算设备900还可以连接至外部设备，例如GPS接收机、用于感测不同环境数据的传感器(诸如加速度传感器、车轮速度传感器、陀螺仪)、等等。以此方式，计算设备900可以例如接收指示车辆的行驶情况的位置数据和传感器数据。当计算设备900被用作车载设备时，计算设备900还可以连接至用于控制车辆的行驶和操作的其他设施(诸如引擎系统、雨刮器、制动防抱死系统等)。
另外，非瞬态存储设备910可以具有地图信息和软件元素，以使得处理器904可以执行路线引导处理。另外，输出设备906可以包括用于显示地图、车辆的位置标记以及指示车辆的行驶情况的图像的显示器。输出设备906还可以包括具有用于音频引导的耳机的扬声器或接口。
总线902可以包括但不限于工业标准架构(ISA)总线、微通道架构(MCA)总线、增强型ISA(EISA)总线、视频电子标准协会(VESA)本地总线、以及外围组件互连(PCI)总线。具体地，对于车载设备，总线902可以包括控制器局域网(CAN)总线或者被设计成用于汽车上的应用的其他架构。
计算设备900还可以包括工作存储器914，工作存储器914可以是可存储对于处理器904的工作而言有用的指令和/或数据的任何类型的工作存储器，并且可以包括但不限于随机存取存储器和/或只读存储器设备。
软件元素可以位于工作存储器914中，包括但不限于操作系统916、一个或多个应用程序918、驱动程序和/或其他数据和代码。用于执行上述方法和步骤的指令可以包括在一个或多个应用程序918中，并且以上提及的装置800的各单元可以通过处理器904读取和执行一个或多个应用程序918的指令来实现。软件元素的指令的可执行代码或源代码可以被存储在非瞬态计算机可读存储介质(诸如上述(诸)存储设备910)中，并且可以可能地通过编译和/或安装而被读取到工作存储器914中。软件元素的指令的可执行代码或源代码也可以从远程位置下载。
从上面的实施例中，本领域技术人员可以清楚地知道，本公开可以由具有必要硬件的软件来实现，或者由硬件、固件等来实现。基于这样的理解，本公开的实施例可以部分地以软件形式来实施。可以将计算机软件存储在诸如计算机的软盘、硬盘、光盘或闪存之类的可读存储介质中。该计算机软件包括一系列指令，以使计算机(例如，个人计算机、服务站或网络终端)执行根据本公开的相应实施例的方法或其一部分。
在整个说明书中，已经对“一个示例”或“一示例”进行了参考，这意味着在至少一个示例中包括具体描述的特征、结构或特性。因此，此类短语的使用可能涉及不止一个示例。此外，所描述的特征、结构或特性可以在一个或多个示例中以任何合适的方式组合。
然而，相关领域的技术人员可以认识到，可以在没有一个或多个特定细节的情况下，或者在其他方法、资源、材料等的情况下实践这些示例。在其他实例中，没有详细示出或描述众所周知的结构、资源或操作以避免使这些示例的各方面模糊。
尽管已经解说和描述了诸样例和应用，但是应当理解，这些示例不限于上述精确的配置和资源。可以对本文公开的方法和系统的布置、操作和细节作出对于本领域技术人员而言显而易见的各种修改、改变和变化，而不会脱离所要求保护的示例的范围。

Claims (15)

1.一种用于为车辆规划路径的计算机实现的方法，其特征在于，所述方法包括：
获取预定义的6D空间中的道路模型二维(2D)流形，其中所述6D空间中的道路模型2D流形是通过将道路模型中的对象从3D(x,y,z)空间转换为6D(x,y,z,r,p,y)空间来预先定义的，其中x和y表示对象在水平面上的位置，而z、r、p和y表示所述对象在现实世界中的高度、侧倾角、俯仰角和偏航角；
获取所述车辆的当前位置(x0,y0,z0)和所述车辆在水平面上的目标位置(x1,y1)；
获得覆盖当所述前位置和所述目标位置的一片道路模型2D流形；
在使任意两点之间的距离从3D空间到水平面保持不变的情况下，将由所述一片道路模型2D流形表示的所述一片道路模型部分展平到水平面上；以及
在水平面上根据展平的道路模型中的当前位置和目标位置为所述车辆规划路径。
2.如权利要求1所述的方法，其特征在于，所述当前位置的位置(x0,y0,z0)是从所述车辆的定位系统获取的。
3.如权利要求1所述的方法，其特征在于，所述当前位置和所述目标位置是从所述车辆的导航系统获取的。
4.如权利要求1所述的方法，其特征在于，获得覆盖所述当所述前位置和所述目标位置的一片道路模型2D流形进一步包括：
获得所述当所述前位置和所述目标位置所处的一片道路的道路模型2D流形。
5.如权利要求4所述的方法，其特征在于，所述一片道路是坡道的一部分。
6.如权利要求5所述的方法，其中所述坡道是弯曲坡道。
7.如权利要求1所述的方法，其特征在于，将由所述一片道路模型2D流形表示的所述一片道路模型展平到水平面上进一步包括：
在使任意两点之间的距离从3D空间到水平面保持不变的情况下，基于其高度、侧倾角、俯仰角和偏航角来将所述道路模型2D流形中的每个点(x,y,z,r,p,y)投影到水平面(x',y')上。
8.如权利要求1所述的方法，其特征在于，在水平面上根据展平的道路模型中的所述当前位置和所述目标位置为所述车辆规划路径进一步包括：
基于展平的道路模型来根据所述当前位置和所述目标位置为所述车辆规划路径，就像所述道路模型最初在水平面上一样。
9.根据权利要求8所述的方法，其特征在于，所述规划进一步包括：
为所规划的路径的多个段中的每个段规划增量里程(Δx,Δy,θ)。
10.一种用于为车辆规划路径的路径规划装置，其特征在于，所述装置包括：
道路模型流形获取模块，用于获取预定义的6D空间中的道路模型二维(2D)流形，其中所述6D空间中的道路模型2D流形是通过将道路模型中的对象从3D(x,y,z)空间转换为6D(x,y,z,r,p,y)空间来预先定义的，其中x和y表示对象在水平面上的位置，而z、r、p和y表示对象在现实世界的高度、侧倾角、俯仰角和偏航角；
位置获取模块，用于获取车辆的当前位置(x0,y0,z0)和所述车辆在水平面上的目标位置(x1,y1)；
道路模型流形片获得模块，用于获得覆盖所述当前位置和所述目标位置的一片道路模型2D流形；
展平模块，用于保持任意两点之间的距离从3D空间到水平面不变的情况下，将由所述一片道路模型2D流形表示的所述一片道路模型展平到水平面上；以及
路径规划模块，用于在水平面上从展平的道路模型中的当前位置和目标位置为所述车辆规划路径。
11.如权利要求10所述的路径规划装置，其特征在于，将由所述一片道路模型2D流形表示的所述一片道路模型展平到水平面上进一步包括：
在使任意两点之间的距离从3D空间到水平面保持不变的情况下，基于其高度、侧倾角、俯仰角和偏航角来将所述道路模型2D流形中的每个点(x,y,z,r,p,y)投影到水平面(x',y')上。
12.一种车辆，包括：
用于确定所述车辆的位置的定位系统；
用于根据权利要求10为车辆规划路径的路径规划装置；以及
规划器，用于基于所规划的路径来规划所述车辆的速度、油门、制动和转向。
13.如权利要求12所述的车辆，其特征在于，在水平面上根据展平的道路模型中的所述当前位置和所述目标位置为所述车辆规划路径进一步包括：
基于展平的道路模型来根据当前位置和目标位置为车辆规划路径，就像道路模型最初在水平面上一样；以及
为所规划的路径的多个段中的每个段规划增量里程(Δx,Δy,θ)。
14.如权利要求13所述的车辆，其特征在于，基于所规划的路径来规划所述车辆的速度、油门、制动和转向进一步包括：
在6D空间(Δx',Δy',Δz,θr,θp,θy)中为所规划的路径的多个段中的每个段规划增量里程(Δx,Δy,θ)；以及
通过考虑高度、侧倾角、俯仰角和偏航角信息，针对每个段规划所述车辆的速度、油门、刹车和转向。
15.如权利要求14所述的车辆，其中所述车辆进一步包括：
里程表，用于提供里程信息，并且其中所述里程表所提供的所述里程信息可与每个段的增量里程(Δx,Δy,θ)进行比较，以确定所述车辆是否偏离所规划的路径。
CN201980097467.3A 2019-06-14 2019-06-14 用于2d路径规划器的道路模型流形 Active CN113950612B (zh)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2019/091214 WO2020248210A1 (en) 2019-06-14 2019-06-14 Roadmodel manifold for 2d trajectory planner

Publications (2)

Publication Number Publication Date
CN113950612A true CN113950612A (zh) 2022-01-18
CN113950612B CN113950612B (zh) 2024-07-09

Family

ID=73780711

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201980097467.3A Active CN113950612B (zh) 2019-06-14 2019-06-14 用于2d路径规划器的道路模型流形

Country Status (6)

Country Link
US (1) US20220242444A1 (zh)
EP (1) EP3983756A4 (zh)
JP (1) JP2022535503A (zh)
KR (1) KR20220017481A (zh)
CN (1) CN113950612B (zh)
WO (1) WO2020248210A1 (zh)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US12078490B2 (en) 2019-06-14 2024-09-03 Bayerische Motoren Werke Aktiengesellschaft 3D odometry in 6D space with roadmodel 2D manifold
US20210318686A1 (en) * 2020-04-10 2021-10-14 Robert Bosch Gmbh Vehicle motion planning using a manifold description of road surface geometry
CN113670323B (zh) * 2021-08-17 2024-05-17 京东鲲鹏(江苏)科技有限公司 一种目标区域的确定方法、装置、设备和介质
FR3133443B1 (fr) * 2022-03-10 2024-02-09 Psa Automobiles Sa Méthodes et systèmes de validation de données cartographiques
CN117400945B (zh) * 2023-12-15 2024-02-23 广汽埃安新能源汽车股份有限公司 一种基于单目视觉信息的车辆控制方法及装置

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004048295A (ja) * 2002-07-10 2004-02-12 Toyota Motor Corp 画像処理装置、駐車支援装置、及び画像処理方法
JP2010039839A (ja) * 2008-08-06 2010-02-18 Ihi Corp 移動ロボット及び移動ロボットの走行速度制御方法
CN103278153A (zh) * 2013-04-27 2013-09-04 中南大学 一种基于空间二维映射的汽车起重机三维路径规划方法
JP2015096411A (ja) * 2013-10-11 2015-05-21 本田技研工業株式会社 駐車支援システム
CN105318888A (zh) * 2015-12-07 2016-02-10 北京航空航天大学 基于无人机感知的无人驾驶车辆路径规划方法
US20160185355A1 (en) * 2013-08-01 2016-06-30 Nissan Motor Co., Ltd. Vehicle position attitude-angle estimation device and vehicle position attitude-angle estimation method
US20160200317A1 (en) * 2013-08-20 2016-07-14 Audi Ag Device and method for controlling a motor vehicle
US20170364083A1 (en) * 2016-06-21 2017-12-21 Baidu Online Network Technology (Beijing) Co., Ltd. Local trajectory planning method and apparatus for smart vehicles
WO2019069126A1 (en) * 2017-10-05 2019-04-11 Toyota Jidosha Kabushiki Kaisha SYSTEM FOR PROVIDING MAPPING INFORMATION

Family Cites Families (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH1137730A (ja) * 1997-07-18 1999-02-12 Nissan Motor Co Ltd 道路形状推定装置
US6282496B1 (en) * 1999-10-29 2001-08-28 Visteon Technologies, Llc Method and apparatus for inertial guidance for an automobile navigation system
JP5164645B2 (ja) * 2008-04-07 2013-03-21 アルパイン株式会社 カルマンフィルタ処理における繰り返し演算制御方法及び装置
JP5328252B2 (ja) * 2008-07-30 2013-10-30 アルパイン株式会社 ナビゲーションシステムの位置検出装置および位置検出方法
US8779971B2 (en) * 2010-05-24 2014-07-15 Robert J. Wellington Determining spatial orientation information of a body from multiple electromagnetic signals
US9208601B2 (en) * 2012-06-10 2015-12-08 Apple Inc. Computing plausible road surfaces in 3D from 2D geometry
JP2014026516A (ja) * 2012-07-27 2014-02-06 Nissan Motor Co Ltd 目標経路生成装置及び目標経路生成方法
JP6009894B2 (ja) * 2012-10-02 2016-10-19 株式会社デンソー キャリブレーション方法、及びキャリブレーション装置
US9933269B2 (en) * 2015-06-22 2018-04-03 Here Global B.V. Midpoint-based map-agnostic navigation routing
US10317222B2 (en) * 2015-06-22 2019-06-11 Here Global B.V. Decision-based map-agnostic navigation routing
US10627503B2 (en) * 2017-03-30 2020-04-21 Honeywell International Inc. Combined degraded visual environment vision system with wide field of regard hazardous fire detection system
US10628671B2 (en) * 2017-11-01 2020-04-21 Here Global B.V. Road modeling from overhead imagery
US10782411B2 (en) * 2018-01-12 2020-09-22 Uatc, Llc Vehicle pose system
US20180164822A1 (en) * 2018-02-09 2018-06-14 GM Global Technology Operations LLC Systems and methods for autonomous vehicle motion planning
US20190283760A1 (en) * 2018-03-19 2019-09-19 Uber Technologies, Inc. Determining vehicle slope and uses thereof

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004048295A (ja) * 2002-07-10 2004-02-12 Toyota Motor Corp 画像処理装置、駐車支援装置、及び画像処理方法
JP2010039839A (ja) * 2008-08-06 2010-02-18 Ihi Corp 移動ロボット及び移動ロボットの走行速度制御方法
CN103278153A (zh) * 2013-04-27 2013-09-04 中南大学 一种基于空间二维映射的汽车起重机三维路径规划方法
US20160185355A1 (en) * 2013-08-01 2016-06-30 Nissan Motor Co., Ltd. Vehicle position attitude-angle estimation device and vehicle position attitude-angle estimation method
US20160200317A1 (en) * 2013-08-20 2016-07-14 Audi Ag Device and method for controlling a motor vehicle
JP2015096411A (ja) * 2013-10-11 2015-05-21 本田技研工業株式会社 駐車支援システム
CN105318888A (zh) * 2015-12-07 2016-02-10 北京航空航天大学 基于无人机感知的无人驾驶车辆路径规划方法
US20170364083A1 (en) * 2016-06-21 2017-12-21 Baidu Online Network Technology (Beijing) Co., Ltd. Local trajectory planning method and apparatus for smart vehicles
WO2019069126A1 (en) * 2017-10-05 2019-04-11 Toyota Jidosha Kabushiki Kaisha SYSTEM FOR PROVIDING MAPPING INFORMATION

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
韩忠华;冯兴浩;吕哲;杨丽英;: "一种改进的无人机路径规划环境建模方法", 信息与控制, no. 03, 15 June 2018 (2018-06-15) *

Also Published As

Publication number Publication date
WO2020248210A1 (en) 2020-12-17
EP3983756A4 (en) 2023-02-08
JP2022535503A (ja) 2022-08-09
EP3983756A1 (en) 2022-04-20
US20220242444A1 (en) 2022-08-04
CN113950612B (zh) 2024-07-09
KR20220017481A (ko) 2022-02-11

Similar Documents

Publication Publication Date Title
CN109215433B (zh) 用于自动驾驶仿真的基于视觉的驾驶场景生成器
CN113950612B (zh) 用于2d路径规划器的道路模型流形
CN108387241B (zh) 更新自动驾驶车辆的定位地图的方法和系统
CN108137015B (zh) 用于自动驾驶车辆的侧滑补偿控制方法
US10969788B2 (en) ECU, autonomous vehicle including ECU, and method of determining driving lane for the same
US20200232800A1 (en) Method and apparatus for enabling sequential groundview image projection synthesis and complicated scene reconstruction at map anomaly hotspot
CN110390240B (zh) 自动驾驶车辆中的车道后处理
CN111527013A (zh) 车辆变道预测
CN108466621A (zh) 有效滚动半径
US12085403B2 (en) Vehicle localisation
US20240054793A1 (en) Information processing device, information processing method, and program
CN115205365A (zh) 车辆距离检测方法、装置、车辆、可读存储介质及芯片
CN115220449A (zh) 路径规划的方法、装置、存储介质、芯片及车辆
US12067790B2 (en) Method and system for identifying object
CN114127658B (zh) 使用道路模型2d流形的6d空间中的3d里程
CN113085868A (zh) 用于运行自动化车辆的方法、设备和存储介质
WO2022024602A1 (ja) 情報処理装置、情報処理方法及びプログラム
CN111655561B (zh) 无需地图和定位的自动驾驶车辆的拐角协商方法
CN114126954B (zh) 用于自动化地停泊车辆的方法
WO2020073270A1 (en) Snapshot image of traffic scenario
WO2020073271A1 (en) Snapshot image of traffic scenario
WO2020073272A1 (en) Snapshot image to train an event detector
WO2020073268A1 (en) Snapshot image to train roadmodel
CN114973742A (zh) 验证车辆的定位信息的方法、系统和设备
CN116543138A (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
GR01 Patent grant
GR01 Patent grant