US20190204092A1 - High definition map based localization optimization - Google Patents
High definition map based localization optimization Download PDFInfo
- Publication number
- US20190204092A1 US20190204092A1 US16/208,026 US201816208026A US2019204092A1 US 20190204092 A1 US20190204092 A1 US 20190204092A1 US 201816208026 A US201816208026 A US 201816208026A US 2019204092 A1 US2019204092 A1 US 2019204092A1
- Authority
- US
- United States
- Prior art keywords
- localization
- autonomous vehicle
- variants
- variant
- driving
- 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.)
- Abandoned
Links
- 230000004807 localization Effects 0.000 title claims abstract description 625
- 238000005457 optimization Methods 0.000 title description 2
- 238000000034 method Methods 0.000 claims abstract description 135
- 238000013507 mapping Methods 0.000 claims abstract description 15
- 238000003860 storage Methods 0.000 claims description 27
- 238000010801 machine learning Methods 0.000 claims description 17
- 238000001914 filtration Methods 0.000 claims description 13
- 238000012549 training Methods 0.000 claims description 4
- 230000008569 process Effects 0.000 abstract description 20
- 230000000875 corresponding effect Effects 0.000 description 16
- 238000004458 analytical method Methods 0.000 description 13
- 238000013135 deep learning Methods 0.000 description 13
- 230000033001 locomotion Effects 0.000 description 9
- 230000009471 action Effects 0.000 description 8
- 230000008859 change Effects 0.000 description 7
- 238000012545 processing Methods 0.000 description 7
- 230000015654 memory Effects 0.000 description 6
- 230000008447 perception Effects 0.000 description 6
- 230000007704 transition Effects 0.000 description 6
- 230000001133 acceleration Effects 0.000 description 5
- 238000004590 computer program Methods 0.000 description 5
- 238000004891 communication Methods 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 4
- 238000005259 measurement Methods 0.000 description 4
- 230000006399 behavior Effects 0.000 description 3
- 230000001276 controlling effect Effects 0.000 description 3
- 244000141353 Prunus domestica Species 0.000 description 2
- 238000013528 artificial neural network Methods 0.000 description 2
- 238000010276 construction Methods 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 238000011156 evaluation Methods 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 230000010354 integration Effects 0.000 description 2
- 238000007726 management method Methods 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 238000009448 modified atmosphere packaging Methods 0.000 description 2
- 235000019837 monoammonium phosphate Nutrition 0.000 description 2
- 238000012552 review Methods 0.000 description 2
- 238000012360 testing method Methods 0.000 description 2
- 238000012800 visualization Methods 0.000 description 2
- 241001465754 Metazoa Species 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 230000001413 cellular effect Effects 0.000 description 1
- 238000005094 computer simulation Methods 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 230000002596 correlated effect Effects 0.000 description 1
- 238000013480 data collection Methods 0.000 description 1
- 238000013144 data compression Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 238000004880 explosion Methods 0.000 description 1
- 230000007274 generation of a signal involved in cell-cell signaling Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000007689 inspection Methods 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 238000011835 investigation Methods 0.000 description 1
- 239000004973 liquid crystal related substance Substances 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000036316 preload Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 239000000126 substance Substances 0.000 description 1
- 230000002123 temporal effect Effects 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
Images
Classifications
-
- 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/28—Navigation; 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
- G01C21/30—Map- or contour-matching
- G01C21/32—Structuring or formatting of map data
-
- 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/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- 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
- G01C21/36—Input/output arrangements for on-board computers
- G01C21/3602—Input other than that of destination using image analysis, e.g. detection of road signs, lanes, buildings, real preceding vehicles using a camera
-
- 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
-
- 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
- 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/387—Organisation of map data, e.g. version management or database structures
- G01C21/3878—Hierarchical structures, e.g. layering
-
- 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/387—Organisation of map data, e.g. version management or database structures
- G01C21/3881—Tile-based structures
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO 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
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/01—Determining conditions which influence positioning, e.g. radio environment, state of motion or energy consumption
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO 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
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
- G01S5/0257—Hybrid positioning
- G01S5/0263—Hybrid positioning by combining or switching between positions derived from two or more separate positioning systems
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/027—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means comprising intertial navigation means, e.g. azimuth detector
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/0274—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
- G05D1/0278—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO 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/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining 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/42—Determining position
- G01S19/48—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO 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
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
- G01S5/0205—Details
- G01S5/0244—Accuracy or reliability of position solution or of measurements contributing thereto
-
- G05D2201/0213—
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W64/00—Locating users or terminals or network equipment for network management purposes, e.g. mobility management
- H04W64/006—Locating users or terminals or network equipment for network management purposes, e.g. mobility management with additional information processing, e.g. for direction or speed determination
Definitions
- This disclosure relates generally to localization of autonomous vehicles and more particularly to optimization of localization strategies used by an autonomous vehicle based on a driving context, for example, the geographical region in which the autonomous vehicle is driving, the time of day, the speed of the autonomous vehicle, and so on.
- Autonomous vehicles also known as self-driving cars, driverless cars, auto, or robotic cars, drive from a source location to a destination location without requiring a human driver to control and navigate the vehicle. Autonomous vehicles need to determine their location accurately to be able to navigate. Autonomous vehicles use sensor data to determine their location. There are several techniques that can be used for determining the location of an autonomous vehicle. These techniques may depend on the type of sensor data used for determining the location, for example, camera images, lidar scans, global positioning system (GPS) data, inertial measurement unit (IMU) data, and so on.
- GPS global positioning system
- IMU inertial measurement unit
- Certain localization technique may work better in certain circumstances whereas a different technique may work better in other circumstances.
- a localization technique based on lidar signal may work better in some circumstances whereas a localization techniques based on global positioning system (GPS) and inertial measurement unit (IMU) may work better under different circumstances.
- GPS global positioning system
- IMU inertial measurement unit
- geometric lidar-based localization may perform very well.
- that same localization technique may fail to identify the forward location or the yaw angle of the autonomous vehicle.
- the performance of a localization technique depends on various factors for example, the type of sensor data available, type of terrain, type of signal available, whether the vehicle is driving in city or on highway, whether there is a truck driving next to the vehicle occluding the view on the side, and so on.
- the localization must be performed periodically at a high frequency to allow the autonomous vehicle to navigate properly.
- a localization technique that may fail as the factors controlling the accuracy of the localization technique change A localization technique that works well in one geographical region may not work well in another geographical region, for example, it may take significantly longer to process or have low accuracy. Furthermore, localization techniques have parameters that need to be tuned for different driving contexts. Parameters that work well in one geographical region may not work well in another geographical region. If the localization process fails, the autonomous vehicle may not be able to navigate properly.
- Embodiments of the invention perform localization of autonomous vehicles using different localization techniques as the autonomous vehicle drives.
- the localization technique used by the autonomous vehicle is selected using a localization variant index that stores a mapping from driving contexts to localization variants.
- a localization variant identifies a localization technique and values of one or more parameters associated with the localization technique.
- Examples of localization techniques include: a localization technique based on camera images, a localization technique based on lidar scans, a localization technique based on GNSS data, and a localization technique based on IMU data.
- the driving context comprises information describing one or more of: a geographical region in which the autonomous vehicle is driving, a time of day when the autonomous vehicle is driving, information describing weather conditions in the geographical region in which the autonomous vehicle is driving at the time the autonomous vehicle is driving, a speed at which the autonomous vehicle is driving, or an angular velocity of the autonomous vehicle.
- the system stores a plurality of localization variants.
- Each localization variant represents a localization technique for determining location of an autonomous vehicle.
- the system also stores information describing a plurality of driving contexts.
- a driving context may be represented as a tuple that has various elements such as geographical region, time of day, weather condition, speed of autonomous vehicle, angular velocity of the autonomous vehicle, and so on.
- the system builds a localization index that maps driving contexts to localization variants.
- the system maps each driving context to one or more localization variants based on a measure of performance of the localization variants in the driving context.
- the system stores a plurality of localization variants for each sensor modality.
- a sensor modality corresponds to a type of sensor input used by the localization variants, for example, localization variants based on lidar scans represent a sensor modality, localization variants based on cameras represent another sensor modality, and so on. Accordingly, the vehicle computing system selects a particular sensor modality for use and selects one or more localization variants for the sensor modality for localization. In one embodiment, the vehicle computing system determines measures of confidence in localization variants and measures of covariances across localization variants using different sensors. The vehicle computing system integrates results of localization variants from different sensor modalities using Kalman filtering. The integration of localization variants based on Kalman filtering uses the measures of confidence values and measures of covariance values.
- An autonomous vehicle uses the localization index while driving as follows.
- the autonomous vehicle receives sensor data captured by sensors of the autonomous vehicle.
- the autonomous vehicle uses the sensor data to determine a driving context in which the autonomous vehicle is currently driving. For example, the autonomous vehicle may determine an approximate location based on the sensor data and determine a geographical region based on the approximate location.
- the autonomous vehicle selects one or more localization variants corresponding to the driving context using the localization index.
- the autonomous vehicle determines a location of the autonomous vehicle using the selected localization variants and uses the location for navigation of the autonomous vehicle. These steps are repeated as the autonomous vehicle drives.
- the system builds the localization index as follows.
- the system repeats the following steps for each driving context.
- the system determines a measure of performance of the localization variant.
- the system ranks the localization variants based on the measure of performance.
- the system selects one or more localization variants for the driving context based on the ranking and stores an association between the driving context and the selected localization variants in the localization index.
- the measure of performance of a localization variant in a particular driving context may be determined based on one or more factors including: an error in localization using the localization variant in the driving context, a time of execution of the localization variant in the driving context, or a rate of success of the localization variant in the driving context.
- a localization variant is successful if it determines the location of the autonomous vehicle within a threshold of an accurate location value.
- the system stores representation of geographical regions, for example, as polygons.
- the localization index maps geographical regions to localization variants.
- An autonomous vehicle determines the geographical region in which the autonomous vehicle is currently driving. The autonomous vehicle selects one or more localization variants corresponding to the geographical region and uses them for localization.
- the system stores representations of lane elements, each lane element corresponding to a portion of a lane of a street (or highway, road, etc.).
- the localization index maps lane elements to localization variants.
- An autonomous vehicle determines the lane element in which the autonomous vehicle is currently driving. The autonomous vehicle selects one or more localization variants corresponding to the lane element and uses them for localization.
- the system maps coordinates of locations, for example, latitudes and longitudes, to localization variants.
- An autonomous vehicle determines the current coordinates of the autonomous vehicle, for example, using GPS data or IMU data.
- the system identifies the nearest coordinates stored in the localization variant index for which localization variants are stored.
- the system uses the localization variants stored in association with the nearest coordinates to the location of the autonomous vehicles for performing localization.
- embodiments are described in connection with autonomous vehicles, the techniques described herein can be used by other types of vehicles, for example, vehicles that are driven by human drivers. Furthermore, embodiments of the invention may be used for other types of navigable machines, for example, robots, ships, drones, airplanes, and the like.
- FIG. 1 shows the overall system environment of an HD map system interacting with multiple vehicle computing systems, according to an embodiment.
- FIG. 2 shows the system architecture of a vehicle computing system, according to an embodiment.
- FIG. 3 illustrates the various layers of instructions in the HD Map API of a vehicle computing system, according to an embodiment.
- FIG. 4 shows the system architecture of an HD map system, according to an embodiment.
- FIG. 5 illustrates the components of an HD map, according to an embodiment.
- FIGS. 6A-B illustrate geographical regions defined in an HD map, according to an embodiment.
- FIG. 7 illustrates representations of lanes in an HD map, according to an embodiment.
- FIGS. 8A-B illustrates lane elements and relations between lane elements in an HD map, according to an embodiment.
- FIG. 9 describes the system architecture of a localization module, according to an embodiment.
- FIG. 10 illustrates the process for performing localization for a vehicle, according to an embodiment.
- FIG. 11 illustrates the process for building localization index, according to an embodiment.
- FIG. 12 illustrates the process for performing localization based on the localization index, according to an embodiment.
- FIG. 13 illustrates an embodiment of a computing machine that can read instructions from a machine-readable medium and execute the instructions in a processor or controller.
- Embodiments of the invention maintain high definition (HD) maps containing up to date information using high precision.
- the HD maps may be used by autonomous vehicles to safely navigate to their destinations without human input or with limited human input.
- An autonomous vehicle is a vehicle capable of sensing its environment and navigating without human input. Autonomous vehicles may also be referred to herein as “driverless car,” “self-driving car,” or “robotic car.”
- An HD map refers to a map storing data with very high precision, typically 5-10 cm.
- Embodiments generate HD maps containing spatial geometric information about the roads on which an autonomous vehicle can travel. Accordingly, the generated HD maps include the information necessary for an autonomous vehicle navigating safely without human intervention.
- Embodiments generate and maintain high definition (HD) maps that are accurate and include the most updated road conditions for safe navigation.
- An autonomous vehicle that uses the HD map needs to localize, i.e., determine the current location of the autonomous vehicle with high accuracy to be able to navigate.
- the HD map system supports a number of localization techniques and variations of each localization technique.
- the performance of a localization technique may depend on various factors, for example, the scene surrounding the autonomous vehicle including the geometry of structures around the autonomous vehicle, identifiable photometric features, and so on.
- Embodiments of the invention select an appropriate localization technique and parameters tuned for the specific context to perform localization efficiently and accurately.
- the combination of a localization technique and corresponding parameter values is referred to as a localization variant.
- the HD map system estimates the performance of each localization variant for different contexts and uses an index to efficiently look up the best localization variants based on the current location of the autonomous vehicle.
- the HD map system also manages the lifetime of the map and localization variants by managing versions of the localization variants which correspond to versions of the executable files running on autonomous vehicle as well as versions of the HD map data.
- FIG. 1 shows the overall system environment of an HD map system interacting with multiple vehicles, according to an embodiment.
- the HD map system 100 includes an online HD map system 110 that interacts with a plurality of vehicles 150 .
- the vehicles 150 may be autonomous vehicles but are not required to be.
- the online HD map system 110 receives sensor data captured by sensors of the vehicles, and combines the data received from the vehicles 150 to generate and maintain HD maps.
- the online HD map system 110 sends HD map data to the vehicles for use in driving the vehicles.
- the online HD map system 110 is implemented as a distributed computing system, for example, a cloud based service that allows clients such as vehicle computing systems 120 to make requests for information and services.
- a vehicle computing system 120 may make a request for HD map data for driving along a route and the online HD map system 110 provides the requested HD map data.
- FIG. 1 and the other figures use like reference numerals to identify like elements.
- the online HD map system 110 comprises a vehicle interface module 160 and an HD map store 165 .
- the online HD map system 110 interacts with the vehicle computing system 120 of various vehicles 150 using the vehicle interface module 160 .
- the online HD map system 110 stores map information for various geographical regions in the HD map store 165 .
- the online HD map system 110 may include other modules than those shown in FIG. 1 , for example, various other modules as illustrated in FIG. 4 and further described herein.
- the online HD map system 110 receives 115 data collected by sensors of a plurality of vehicles 150 , for example, hundreds or thousands of cars.
- the vehicles provide sensor data captured while driving along various routes and send it to the online HD map system 110 .
- the online HD map system 110 uses the data received from the vehicles 150 to create and update HD maps describing the regions in which the vehicles 150 are driving.
- the online HD map system 110 builds high definition maps based on the collective information received from the vehicles 150 and stores the HD map information in the HD map store 165 .
- the online HD map system 110 sends 125 HD maps to individual vehicles 150 as required by the vehicles 150 . For example, if an autonomous vehicle needs to drive along a route, the vehicle computing system 120 of the autonomous vehicle provides information describing the route being travelled to the online HD map system 110 . In response, the online HD map system 110 provides the required HD maps for driving along the route.
- the online HD map system 110 sends portions of the HD map data to the vehicles in a compressed format so that the data transmitted consumes less bandwidth.
- the online HD map system 110 receives from various vehicles, information describing the data that is stored at the local HD map store 275 of the vehicle. If the online HD map system 110 determines that the vehicle does not have certain portion of the HD map stored locally in the local HD map store 275 , the online HD map system 110 sends that portion of the HD map to the vehicle. If the online HD map system 110 determines that the vehicle did previously receive that particular portion of the HD map but the corresponding data was updated by the online HD map system 110 since the vehicle last received the data, the online HD map system 110 sends an update for that portion of the HD map stored at the vehicle. This allows the online HD map system 110 to minimize the amount of data that is communicated with the vehicle and also to keep the HD map data stored locally in the vehicle updated on a regular basis.
- a vehicle 150 includes vehicle sensors 105 , vehicle controls 130 , and a vehicle computing system 120 .
- the vehicle sensors 105 allow the vehicle 150 to detect the surroundings of the vehicle as well as information describing the current state of the vehicle, for example, information describing the location and motion parameters of the vehicle.
- the vehicle sensors 105 comprise a camera, a light detection and ranging sensor (LIDAR), a global positioning system (GPS) navigation system, an inertial measurement unit (IMU), and others.
- the vehicle has one or more cameras that capture images of the surroundings of the vehicle.
- a LIDAR surveys the surroundings of the vehicle by measuring distance to a target by illuminating that target with a laser light pulses, and measuring the reflected pulses.
- the GPS navigation system determines the location of the vehicle based on signals from satellites.
- the position of the vehicle may also be referred to as the location of the vehicle.
- An IMU is an electronic device that measures and reports motion data of the vehicle such as velocity, acceleration, direction of movement, speed, angular rate, and so on using a combination of accelerometers and gyroscopes or other measuring instruments.
- the vehicle controls 130 control the physical movement of the vehicle, for example, acceleration, direction change, starting, stopping, and so on.
- the vehicle controls 130 include the machinery for controlling the accelerator, brakes, steering wheel, and so on.
- the vehicle computing system 120 continuously provides control signals to the vehicle controls 130 , thereby causing an autonomous vehicle to drive along a selected route.
- the vehicle computing system 120 performs various tasks including processing data collected by the sensors as well as map data received from the online HD map system 110 .
- the vehicle computing system 120 also processes data for sending to the online HD map system 110 . Details of the vehicle computing system are illustrated in FIG. 2 and further described in connection with FIG. 2 .
- the interactions between the vehicle computing systems 120 and the online HD map system 110 are typically performed via a network, for example, via the Internet.
- the network enables communications between the vehicle computing systems 120 and the online HD map system 110 .
- the network uses standard communications technologies and/or protocols.
- the data exchanged over the network can be represented using technologies and/or formats including the hypertext markup language (HTML), the extensible markup language (XML), etc.
- all or some of links can be encrypted using conventional encryption technologies such as secure sockets layer (SSL), transport layer security (TLS), virtual private networks (VPNs), Internet Protocol security (IPsec), etc.
- the entities can use custom and/or dedicated data communications technologies instead of, or in addition to, the ones described above.
- FIG. 2 shows the system architecture of a vehicle computing system, according to an embodiment.
- the vehicle computing system 120 comprises a perception module 210 , prediction module 215 , planning module 220 , a control module 225 , a local HD map store 275 , an HD map system interface 280 , a localization module 290 a , and an HD map application programming interface (API) 205 .
- the various modules of the vehicle computing system 120 process various type of data including sensor data 230 , a behavior model 235 , routes 240 , and physical constraints 245 .
- the vehicle computing system 120 may have more or fewer modules. Functionality described as being implemented by a particular module may be implemented by other modules.
- the perception module 210 receives sensor data 230 from the sensors 105 of the vehicle 150 . This includes data collected by cameras of the car, LIDAR, IMU, GPS navigation system, and so on. The perception module 210 uses the sensor data to determine what objects are around the vehicle, the details of the road on which the vehicle is travelling, and so on. The perception module 210 processes the sensor data 230 to populate data structures storing the sensor data and provides the information to the prediction module 215 .
- the prediction module 215 interprets the data provided by the perception module using behavior models of the objects perceived to determine whether an object is moving or likely to move. For example, the prediction module 215 may determine that objects representing road signs are not likely to move, whereas objects identified as vehicles, people, and so on, are either moving or likely to move. The prediction module 215 uses the behavior models 235 of various types of objects to determine whether they are likely to move. The prediction module 215 provides the predictions of various objects to the planning module 200 to plan the subsequent actions that the vehicle needs to take next.
- the planning module 200 receives the information describing the surroundings of the vehicle from the prediction module 215 , the route 240 that determines the destination of the vehicle, and the path that the vehicle should take to get to the destination.
- the planning module 200 uses the information from the prediction module 215 and the route 240 to plan a sequence of actions that the vehicle needs to take within a short time interval, for example, within the next few seconds.
- the planning module 200 specifies the sequence of actions as one or more points representing nearby locations that the vehicle needs to drive through next.
- the planning module 200 provides the details of the plan comprising the sequence of actions to be taken by the vehicle to the control module 225 .
- the plan may determine the subsequent action of the vehicle, for example, whether the vehicle performs a lane change, a turn, acceleration by increasing the speed or slowing down, and so on.
- the control module 225 determines the control signals for sending to the controls 130 of the vehicle based on the plan received from the planning module 200 . For example, if the vehicle is currently at point A and the plan specifies that the vehicle should next go to a nearby point B, the control module 225 determines the control signals for the controls 130 that would cause the vehicle to go from point A to point B in a safe and smooth way, for example, without taking any sharp turns or a zig zag path from point A to point B.
- the path taken by the vehicle to go from point A to point B may depend on the current speed and direction of the vehicle as well as the location of point B with respect to point A. For example, if the current speed of the vehicle is high, the vehicle may take a wider turn compared to a vehicle driving slowly.
- the control module 225 also receives physical constraints 245 as input. These include the physical capabilities of that specific vehicle. For example, a car having a particular make and model may be able to safely make certain types of vehicle movements such as acceleration, and turns that another car with a different make and model may not be able to make safely.
- the control module 225 incorporates these physical constraints in determining the control signals.
- the control module 225 sends the control signals to the vehicle controls 130 that cause the vehicle to execute the specified sequence of actions causing the vehicle to move as planned. The above steps are constantly repeated every few seconds causing the vehicle to drive safely along the route that was planned for the vehicle.
- the various modules of the vehicle computing system 120 including the perception module 210 , prediction module 215 , and planning module 220 receive map information to perform their respective computation.
- the vehicle 100 stores the HD map data in the local HD map store 275 .
- the modules of the vehicle computing system 120 interact with the map data using the HD map API 205 that provides a set of application programming interfaces (APIs) that can be invoked by a module for accessing the map information.
- the HD map system interface 280 allows the vehicle computing system 120 to interact with the online HD map system 110 via a network (not shown in the Figures).
- the local HD map store 275 stores map data in a format specified by the HD Map system 110 .
- the HD map API 205 is capable of processing the map data format as provided by the HD Map system 110 .
- the HD Map API 205 provides the vehicle computing system 120 with an interface for interacting with the HD map data.
- the HD map API 205 includes several APIs including the localization API 250 , the landmark map API 255 , the route API 265 , the 3D map API 270 , the map update API 285 , and so on.
- the localization APIs 250 determine the current location of the vehicle, for example, when the vehicle starts and as the vehicle moves along a route.
- the localization APIs 250 include a localize API that determines an accurate location of the vehicle within the HD Map.
- the vehicle computing system 120 can use the location as an accurate relative positioning for making other queries, for example, feature queries, navigable space queries, and occupancy map queries further described herein.
- the localize API receives inputs comprising one or more of, location provided by GPS, vehicle motion data provided by IMU, LIDAR scanner data, and camera images.
- the localize API returns an accurate location of the vehicle as latitude and longitude coordinates.
- the coordinates returned by the localize API are more accurate compared to the GPS coordinates used as input, for example, the output of the localize API may have precision range from 5-10 cm.
- the vehicle computing system 120 invokes the localize API to determine location of the vehicle periodically based on the LIDAR using scanner data, for example, at a frequency of 10 Hz.
- the vehicle computing system 120 may invoke the localize API to determine the vehicle location at a higher rate (e.g., 60 Hz) if GPS/IMU data is available at that rate.
- the vehicle computing system 120 stores as internal state, location history records to improve accuracy of subsequent localize calls.
- the location history record stores history of location from the point-in-time, when the car was turned off/stopped.
- the localization APIs 250 include a localize-route API generates an accurate route specifying lanes based on the HD map.
- the localize-route API takes as input a route from a source to destination via a third party maps and generates a high precision routes represented as a connected graph of navigable lanes along the input routes based on HD maps.
- the landmark map API 255 provides the geometric and semantic description of the world around the vehicle, for example, description of various portions of lanes that the vehicle is currently travelling on.
- the landmark map APIs 255 comprise APIs that allow queries based on landmark maps, for example, fetch-lanes API and fetch-features API.
- the fetch-lanes API provide lane information relative to the vehicle and the fetch-features API.
- the fetch-lanes API receives as input a location, for example, the location of the vehicle specified using latitude and longitude of the vehicle and returns lane information relative to the input location.
- the fetch-lanes API may specify a distance parameters indicating the distance relative to the input location for which the lane information is retrieved.
- the fetch-features API receives information identifying one or more lane elements and returns landmark features relative to the specified lane elements.
- the landmark features include, for each landmark, a spatial description that is specific to the type of landmark.
- the 3D map API 265 provides efficient access to the spatial 3-dimensional (3D) representation of the road and various physical objects around the road as stored in the local HD map store 275 .
- the 3D map APIs 365 include a fetch-navigable-surfaces API and a fetch-occupancy-grid API.
- the fetch-navigable-surfaces API receives as input, identifiers for one or more lane elements and returns navigable boundaries for the specified lane elements.
- the fetch-occupancy-grid API receives a location as input, for example, a latitude and longitude of the vehicle, and returns information describing occupancy for the surface of the road and all objects available in the HD map near the location.
- the information describing occupancy includes a hierarchical volumetric grid of all positions considered occupied in the map.
- the occupancy grid includes information at a high resolution near the navigable areas, for example, at curbs and bumps, and relatively low resolution in less significant areas, for example, trees and walls beyond a curb.
- the fetch-occupancy-grid API is useful for detecting obstacles and for changing direction if necessary.
- the 3D map APIs also include map update APIs, for example, download-map-updates API and upload-map-updates API.
- the download-map-updates API receives as input a planned route identifier and downloads map updates for data relevant to all planned routes or for a specific planned route.
- the upload-map-updates API uploads data collected by the vehicle computing system 120 to the online HD map system 110 . This allows the online HD map system 110 to keep the HD map data stored in the online HD map system 110 up to date based on changes in map data observed by sensors of vehicles driving along various routes.
- the route API 270 returns route information including full route between a source and destination and portions of route as the vehicle travels along the route.
- the 3D map API 365 allows querying the HD Map.
- the route APIs 270 include add-planned-routes API and get-planned-route API.
- the add-planned-routes API provides information describing planned routes to the online HD map system 110 so that information describing relevant HD maps can be downloaded by the vehicle computing system 120 and kept up to date.
- the add-planned-routes API receives as input, a route specified using polylines expressed in terms of latitudes and longitudes and also a time-to-live (TTL) parameter specifying a time period after which the route data can be deleted.
- TTL time-to-live
- the add-planned-routes API allows the vehicle to indicate the route the vehicle is planning on taking in the near future as an autonomous trip.
- the add-planned-route API aligns the route to the HD map, records the route and its TTL value, and makes sure that the HD map data for the route stored in the vehicle computing system 120 is up to date.
- the get-planned-routes API returns a list of planned routes and provides information describing a route identified by a route identifier.
- the map update API 285 manages operations related to update of map data, both for the local HD map store 275 and for the HD map store 165 stored in the online HD map system 110 . Accordingly, modules in the vehicle computing system 120 invoke the map update API 285 for downloading data from the online HD map system 110 to the vehicle computing system 120 for storing in the local HD map store 275 as necessary.
- the map update API 285 also allows the vehicle computing system 120 to determine whether the information monitored by the vehicle sensors 105 indicates a discrepancy in the map information provided by the online HD map system 110 and uploads data to the online HD map system 110 that may result in the online HD map system 110 updating the map data stored in the HD map store 165 that is provided to other vehicles 150 .
- the localization module 290 a performs localization for an autonomous vehicle. Details of the localization module 290 are further described herein.
- FIG. 3 illustrates the various layers of instructions in the HD Map API of a vehicle computing system, according to an embodiment.
- Different manufacturer of vehicles have different instructions for receiving information from vehicle sensors 105 and for controlling the vehicle controls 130 .
- different vendors provide different compute platforms with autonomous driving capabilities, for example, collection and analysis of vehicle sensor data.
- Examples of compute platform for autonomous vehicles include platforms provided vendors, such as NVIDIA, QUALCOMM, and INTEL. These platforms provide functionality for use by autonomous vehicle manufacturers in manufacture of autonomous vehicles.
- a vehicle manufacturer can use any one or several compute platforms for autonomous vehicles.
- the online HD map system 110 provides a library for processing HD maps based on instructions specific to the manufacturer of the vehicle and instructions specific to a vendor specific platform of the vehicle.
- the library provides access to the HD map data and allows the vehicle to interact with the online HD map system 110 .
- the HD map API is implemented as a library that includes a vehicle manufacturer adapter 310 , a compute platform adapter 320 , and a common HD map API layer 330 .
- the common HD map API layer comprises generic instructions that can be used across a plurality of vehicle compute platforms and vehicle manufacturers.
- the compute platform adapter 320 include instructions that are specific to each computer platform.
- the common HD Map API layer 330 may invoke the compute platform adapter 320 to receive data from sensors supported by a specific compute platform.
- the vehicle manufacturer adapter 310 comprises instructions specific to a vehicle manufacturer.
- the common HD map API layer 330 may invoke functionality provided by the vehicle manufacturer adapter 310 to send specific control instructions to the vehicle controls 130 .
- the online HD map system 110 stores compute platform adapters 320 for a plurality of compute platforms and vehicle manufacturer adapters 310 for a plurality of vehicle manufacturers.
- the online HD map system 110 determines the particular vehicle manufacturer and the particular compute platform for a specific autonomous vehicle.
- the online HD map system 110 selects the vehicle manufacturer adapter 310 for the particular vehicle manufacturer and the compute platform adapter 320 the particular compute platform of that specific vehicle.
- the online HD map system 110 sends instructions of the selected vehicle manufacturer adapter 310 and the selected compute platform adapter 320 to the vehicle computing system 120 of that specific autonomous vehicle.
- the vehicle computing system 120 of that specific autonomous vehicle installs the received vehicle manufacturer adapter 310 and the compute platform adapter 320 .
- the vehicle computing system 120 periodically checks if the online HD map system 110 has an update to the installed vehicle manufacturer adapter 310 and the compute platform adapter 320 . If a more recent update is available compared to the version installed on the vehicle, the vehicle computing system 120 requests and receives the latest update and installs it.
- FIG. 4 shows the system architecture of an HD map system, according to an embodiment.
- the online HD map system 110 comprises a map creation module 410 , a map update module 420 , a map data encoding module 430 , a load balancing module 440 , a map accuracy management module, a vehicle interface module, a HD map store 165 , and the localization module 290 .
- Other embodiments of online HD map system 110 may include more or fewer modules than shown in FIG. 4 . Functionality indicated as being performed by a particular module may be implemented by other modules.
- the online HD map system 110 may be a distributed system comprising a plurality of processors.
- the map creation module 410 creates the map from map data collected from several vehicles that are driving along various routes.
- the map update module 420 updates previously computed map data by receiving more recent information from vehicles that recently travelled along routes on which map information changed. For example, if certain road signs have changed or lane information has changed as a result of construction in a region, the map update module 420 updates the maps accordingly.
- the map data encoding module 430 encodes map data to be able to store the data efficiently as well as send the required map data to vehicles 150 efficiently.
- the load balancing module 440 balances load across vehicles to ensure that requests to receive data from vehicles are uniformly distributed across different vehicles.
- the map accuracy management module 450 maintains high accuracy of the map data using various techniques even though the information received from individual vehicles may not have high accuracy.
- FIG. 5 illustrates the components of an HD map, according to an embodiment.
- the HD map comprises maps of several geographical regions.
- the HD map 510 of a geographical region comprises a landmark map (LMap) 520 and an occupancy map (OMap) 530 .
- the landmark map comprises information describing lanes including spatial location of lanes and semantic information about each lane.
- the spatial location of a lane comprises the geometric location in latitude, longitude and elevation at high prevision, for example, at or below 10 cm precision.
- the semantic information of a lane comprises restrictions such as direction, speed, type of lane (for example, a lane for going straight, a left turn lane, a right turn lane, an exit lane, and the like), restriction on crossing to the left, connectivity to other lanes and so on.
- the landmark map may further comprise information describing stop lines, yield lines, spatial location of cross walks, safely navigable space, spatial location of speed bumps, curb, and road signs comprising spatial location and type of all signage that is relevant to driving restrictions.
- road signs described in an HD map include stop signs, traffic lights, speed limits, one-way, do-not-enter, yield (vehicle, pedestrian, animal), and so on.
- the occupancy map 530 comprises spatial 3-dimensional (3D) representation of the road and all physical objects around the road.
- the data stored in an occupancy map 530 is also referred to herein as occupancy grid data.
- the 3D representation may be associated with a confidence score indicative of a likelihood of the object existing at the location.
- the occupancy map 530 may be represented in a number of other ways.
- the occupancy map 530 is represented as a 3D mesh geometry (collection of triangles) which covers the surfaces.
- the occupancy map 530 is represented as a collection of 3D points which cover the surfaces.
- the occupancy map 530 is represented using a 3D volumetric grid of cells at 5-10 cm resolution. Each cell indicates whether or not a surface exists at that cell, and if the surface exists, a direction along which the surface is oriented.
- the occupancy map 530 may take a large amount of storage space compared to a landmark map 520 .
- data of 1 GB/Mile may be used by an occupancy map 530 , resulting in the map of the United States (including 4 million miles of road) occupying 4 ⁇ 10 15 bytes or 4 petabytes. Therefore the online HD map system 110 and the vehicle computing system 120 use data compression techniques for being able to store and transfer map data thereby reducing storage and transmission costs. Accordingly, the techniques disclosed herein make self-driving of autonomous vehicles possible.
- the HD Map does not require or rely on data typically included in maps, such as addresses, road names, ability to geo-code an address, and ability to compute routes between place names or addresses.
- the vehicle computing system 120 or the online HD map system 110 accesses other map systems, for example, GOOGLE MAPs to obtain this information. Accordingly, a vehicle computing system 120 or the online HD map system 110 receives navigation instructions from a tool such as GOOGLE MAPs into a route and converts the information to a route based on the HD map information.
- the online HD map system 110 divides a large physical area into geographical regions and stores a representation of each geographical region. Each geographical region represents a contiguous area bounded by a geometric shape, for example, a rectangle or square. In an embodiment, the online HD map system 110 divides a physical area into geographical regions of the same size independent of the amount of data required to store the representation of each geographical region. In another embodiment, the online HD map system 110 divides a physical area into geographical regions of different sizes, where the size of each geographical region is determined based on the amount of information needed for representing the geographical region. For example, a geographical region representing a densely populated area with a large number of streets represents a smaller physical area compared to a geographical region representing sparsely populated area with very few streets. Accordingly, in this embodiment, the online HD map system 110 determines the size of a geographical region based on an estimate of an amount of information required to store the various elements of the physical area relevant for an HD map.
- the online HD map system 110 represents a geographic region using an object or a data record that comprises various attributes including, a unique identifier for the geographical region, a unique name for the geographical region, description of the boundary of the geographical region, for example, using a bounding box of latitude and longitude coordinates, and a collection of landmark features and occupancy grid data.
- FIGS. 6A-B illustrate geographical regions defined in an HD map, according to an embodiment.
- FIG. 6A shows a square geographical region 610 a .
- FIG. 6B shows two neighboring geographical regions 610 a and 610 b .
- the online HD map system 110 stores data in a representation of a geographical region that allows for smooth transition from one geographical region to another as a vehicle drives across geographical region boundaries.
- each geographic region has a buffer of a predetermined width around it.
- the buffer comprises redundant map data around all 4 sides of a geographic region (in the case that the geographic region is bounded by a rectangle).
- FIG. 6A shows a boundary 620 for a buffer of 50 meters around the geographic region 610 a and a boundary 630 for buffer of 100 meters around the geographic region 610 a .
- the vehicle computing system 120 switches the current geographical region of a vehicle from one geographical region to the neighboring geographical region when the vehicle crosses a threshold distance within this buffer. For example, as shown in FIG. 6B , a vehicle starts at location 650 a in the geographical region 610 a .
- the vehicle traverses along a route to reach a location 650 b where it cross the boundary of the geographical region 610 but stays within the boundary 620 of the buffer. Accordingly, the vehicle computing system 120 continues to use the geographical region 610 a as the current geographical region of the vehicle. Once the vehicle crosses the boundary 620 of the buffer at location 650 c , the vehicle computing system 120 switches the current geographical region of the vehicle to geographical region 610 b from 610 a .
- the use of a buffer prevents rapid switching of the current geographical region of a vehicle as a result of the vehicle travelling along a route that closely tracks a boundary of a geographical region.
- the HD map system 100 represents lane information of streets in HD maps. Although the embodiments described herein refer to streets, the techniques are applicable to highways, alleys, avenues, boulevards, or any other path on which vehicles can travel.
- the HD map system 100 uses lanes as a reference frame for purposes of routing and for localization of a vehicle.
- the lanes represented by the HD map system 100 include lanes that are explicitly marked, for example, white and yellow striped lanes, lanes that are implicit, for example, on a country road with no lines or curbs but two directions of travel, and implicit paths that act as lanes, for example, the path that a turning car makes when entering a lane from another lane.
- the HD map system 100 also stores information relative to lanes, for example, landmark features such as road signs and traffic lights relative to the lanes, occupancy grids relative to the lanes for obstacle detection, and navigable spaces relative to the lanes so the vehicle can efficiently plan/react in emergencies when the vehicle must make an unplanned move out of the lane. Accordingly, the HD map system 100 stores a representation of a network of lanes to allow a vehicle to plan a legal path between a source and a destination and to add a frame of reference for real time sensing and control of the vehicle. The HD map system 100 stores information and provides APIs that allow a vehicle to determine the lane that the vehicle is currently in, the precise vehicle location relative to the lane geometry, and all relevant features/data relative to the lane and adjoining and connected lanes.
- landmark features such as road signs and traffic lights relative to the lanes
- occupancy grids relative to the lanes for obstacle detection
- navigable spaces relative to the lanes so the vehicle can efficiently plan/react in emergencies when the vehicle must make an unplanned move out of
- FIG. 7 illustrates lane representations in an HD map, according to an embodiment.
- FIG. 7 shows a vehicle 710 at a traffic intersection.
- the HD map system provides the vehicle with access to the map data that is relevant for autonomous driving of the vehicle. This includes, for example, features 720 a and 720 b that are associated with the lane but may not be the closest features to the vehicle. Therefore, the HD map system 100 stores a lane-centric representation of data that represents the relationship of the lane to the feature so that the vehicle can efficiently extract the features given a lane.
- the HD map system 100 represents portions of the lanes as lane elements.
- a lane element specifies the boundaries of the lane and various constraints including the legal direction in which a vehicle can travel within the lane element, the speed with which the vehicle can drive within the lane element, whether the lane element is for left turn only, or right turn only, and so on.
- the HD map system 100 represents a lane element as a continuous geometric portion of a single vehicle lane.
- the HD map system 100 stores objects or data structures representing lane elements that comprise information representing geometric boundaries of the lanes; driving direction along the lane; vehicle restriction for driving in the lane, for example, speed limit, relationships with connecting lanes including incoming and outgoing lanes; a termination restriction, for example, whether the lane ends at a stop line, a yield sign, or a speed bump; and relationships with road features that are relevant for autonomous driving, for example, traffic light locations, road sign locations and so on.
- Examples of lane elements represented by the HD map system 100 include, a piece of a right lane on a freeway, a piece of a lane on a road, a left turn lane, the turn from a left turn lane into another lane, a merge lane from an on-ramp an exit lane on an off-ramp, and a driveway.
- the HD map system 100 represents a one lane road using two lane elements, one for each direction.
- the HD map system 100 represents median turn lanes that are shared similar to a one-lane road.
- FIGS. 8A-B illustrates lane elements and relations between lane elements in an HD map, according to an embodiment.
- FIG. 8A shows an example of a T junction in a road illustrating a lane element 810 a that is connected to lane element 810 c via a turn lane 810 b and is connected to lane 810 e via a turn lane 810 d .
- FIG. 8B shows an example of a Y junction in a road showing label 810 f connected to lane 810 h directly and connected to lane 810 i via lane 810 g .
- the HD map system 100 determines a route from a source location to a destination location as a sequence of connected lane elements that can be traversed to reach from the source location to the destination location.
- FIG. 9 describes the system architecture of a localization module, according to an embodiment.
- the localization module 290 includes a localization variants module 910 , a localization variant selection module 920 , localization index generation module 930 , and a localization index 940 .
- Other embodiments may include more of fewer modules than those indicated herein. Functionality performed by a module may be performed by other modules than those indicated herein.
- the localization module 290 may be present in the vehicle computing system 120 or in the online HD map system 110 .
- the localization module 290 a present in the vehicle computing system 120 has different modules (or sub-modules) compared to the localization module 290 b present in the online HD map system 110 .
- the localization module 290 a present in the vehicle computing system 120 may not have the localization index generation module 930 .
- the localization module 290 a present in the vehicle computing system 120 may have fewer localization variants compared to the localization module 290 b present in the online HD map system 110 .
- the localization module 290 b present in the online HD map system 110 collects data describing tracks from various vehicle computing systems and evaluates various localization variants on each track to build the localization index 940 .
- the localization module 290 b sends at least a portion of the localization index 940 to individual autonomous vehicles.
- the subset may be determined based on the configuration of individual autonomous vehicle. For example, if an autonomous vehicle has specific sensor configurations, the localization variants relevant to those sensor configurations are sent to the autonomous vehicle and localization variants based on sensor configurations that are not present in the autonomous vehicle skipped.
- the localization module 290 b present in the online HD map system 110 exports a subset of the localization index 940 , for example, to a file and transmits the file to an autonomous vehicle for storage in the localization module 290 a present in the vehicle computing system 120 of that autonomous vehicle.
- the localization module 290 a present in the vehicle computing system 120 of an autonomous vehicle uses the localization variants while driving to select specific localization variants based on driving context, for example, the geographical region in which the autonomous vehicle is driving and uses the localization variants to perform localization for the autonomous vehicle. As the autonomous vehicle is driving, the autonomous vehicle may move from one geographical region to another. Accordingly, the autonomous vehicle changes the localization variants used for localization as the geographical region or other attributes of the driving context change.
- the localization variants module 910 stores instructions and parameters for several localization variants.
- the localization variants module 910 stores instructions for localization techniques. For example, for each localization technique, the localization variants module 910 stores a set of executable instructions such as one or more functions or methods that implement the localization technique.
- the localization variants module 910 identifies parameters that are relevant to a localization technique and stores sets of values of these parameters.
- a localization technique receives as input a map and sensor data received by a vehicle and identifies the location of the vehicle in the map based on the sensor data.
- the various localization techniques may be added to the localization module 290 manually, for example, by an expert.
- the executable instructions for the various localization techniques may be stored on secondary storage, for example, a disk, or solid state drive (SSD) and loaded by the localization module 290 .
- the localization module 290 may either pre-load the instructions for various localization techniques or load them in a lazy fashion, as needed.
- a localization technique may be based on odometry that represents the process of estimating the motion of the vehicle relative to the vehicle's position based on sequential sensor data received by the vehicle.
- the localization module 290 may use odometry to assist in initializing position of the vehicle for use by a localization technique in performing its local search.
- the localization module 290 may also use odometry to estimate velocity and acceleration of the vehicle as a way to extrapolate the vehicle position in between sensor readings that may be used to localize. For example, if localization fails, the localization module 290 falls back to odometry to estimate motion from a previously known pose based on IMU or vehicle control signals.
- lidar based localization Another localization technique is lidar based localization.
- Localization variants based on lidar based localization include ground/non-ground variations that perform separate processing for ground based features vs. non-ground features; lidar based localization that processes all points vs. high intensity points; lidar based localization that performs color matching; lidar based localization that separated hardscape (hard surfaces such as buildings) vs. softscape (vegetation); and so on.
- Another localization technique uses edgels for localization. Accordingly the system identifies edgels in sensor data, for example, camera images and uses the edgels match objects in sensor data with objects in the OMap to determine the location of the vehicle.
- Systems and techniques for determining edgels are described in the U.S. patent application Ser. No. 16/161,035, filed on Oct. 15, 2018, which is hereby incorporated by reference in its entirety.
- a variation of edgel based localization technique process ground points separately from non-ground points.
- Another variation of edgel based localization technique separately processes hardscape and softscape.
- Another localization technique is feature-based localization that detects features using sensor data such as camera images and lidar scans and compares the features with features in the HD map to determine the location of the vehicle.
- Another localization technique uses image-based odometry to determine location of the vehicle. Variations of image-based odometry determine location of the vehicle by comparing different features extracted from camera images with map for example, ground textures, image features, edges, and so on.
- Another localization technique uses lidar-based odometry to determine location of the vehicle. Variations of lidar-based odometry use one of pairwise iterative closest point (ICP) or multi-scan ICP.
- Variants of all the above techniques are obtained by changing various parameters such as iteration limits, search radius, lorentzian weighting, and so on.
- Other localization techniques include global navigation satellite system (GNSS) based localization and inertial measurement unit (IMU) based odometry. Variants of these techniques use different integration methods and various correction methods.
- GNSS global navigation satellite system
- IMU inertial measurement unit
- the localization index 940 stores a mapping from driving contexts to localization variants.
- the localization index 940 represents a spatial index that maps geographical regions to localization variants.
- the localization module 290 defines a default localization variant for a geographical region.
- the localization module 290 receives and stores polygons that define transition zones, for example, as defined by experts. These polygons may be relatively small in area, for example entrance on and exits off the highway.
- the localization module 290 identifies transition points in the geographical region by evaluating various localization variants and identifying areas were the default variant breaks down. The transition points can also be identified by knowing what types of issues cause the default variant problems. If the vehicle is in the transition zone T 1 using a localization variant L 1 , it continues using localization variant L 1 until it enters a transition zone T 2 where it switches to another localization variant L 2 .
- the localization index 940 may store an association between lane elements and localization variants that perform well on that lane element.
- the localization index stores coordinates, for example, latitude and longitude of some locations and corresponding localization variants that have high performance in a geographical region surrounding the coordinates.
- localization index 940 stores data so as to save space by clustering geographical regions that have similar localization variants. For example, if 3 samples within a few meters of each other share the same set of localization variants, the localization index 940 stores the set of localization variants once for a location that is the average of the cluster of locations. Alternatively, the localization index 940 stores a representation of the set of localization variants that is shared by all these geographical regions.
- the localization variant selection module 920 selects one or more localization variants when the autonomous vehicle is driving.
- the localization variant selection module 920 receives sensor data and other context information from the autonomous vehicle and uses the localization index 940 to select the localization variants.
- the localization index generation module 930 evaluates different localization variants for each driving context and identifies one or more localization variants to be used in the geographical region.
- the driving context comprises information describing a current track of the autonomous vehicle, i.e., an instance during which the autonomous vehicle is driving along a portion of a route.
- a driving context may be represented as a tuple that has various elements such as geographical region, time of day, weather condition, speed of autonomous vehicle, angular velocity of the autonomous vehicle, and so on.
- the localization index generation module 930 executes each localization variant for each driving context and compares it against a ground truth, for example, the pose of the autonomous vehicle determined using an HD map obtained by aligning data from various tracks.
- a track represents information describing a drive of an autonomous vehicle through a route. Since each autonomous vehicle collects and stores sensor data as the vehicle drives, the sensor data can be used at a later stage to execute various localization variants, whether or not the autonomous vehicle used the localization variant during the drive.
- the HD map system executes the instructions of a localization variant by varying the error in the initial guesses.
- the localization index generation module 930 evaluates performance of a localization variant based on various criteria including: (1) a measure of accuracy indicating how accurately the localization variant worked (the measure of accuracy could be in meters); (2) a measure of robustness in meters indicating how prone to local minima is the localization variant (the measure indicating a size of the basin of attraction corresponding to the local minima); (3) a measure of computation cost of the localization variant indicating how expensive it was to compute the result; and (4) a measure of how well the localization variant works when the autonomous vehicle is turning as compared to when the autonomous vehicle is driving straight ahead.
- the localization index generation module 930 determines a score based on each of the above factors and determines a score representing a performance of the localization variant as a weighted aggregate of the individual scores for the factors.
- the localization module 290 uses Kalman filtering to fuse localization and odometry inputs optimally.
- the localization module 290 receives uncertainty estimates from each input source (localization, odometry, IMU, GPS, controller area network (CAN) bus) for use for the Kalman Filter.
- the Kalman filter integrates multiple inputs and results from multiple localization techniques to estimate location.
- the localization module 290 stores representation of localization strategies for driving contexts or for specific geographical regions.
- the localization strategy comprises the localization variants that perform well in a driving context.
- the localization module 290 uses a storage efficient mechanism for storing the localization strategy that stores a localization variant ID for each class of localization/odometry.
- the different classes of Localization/Odometry include: lidar localization, lidar odometry, Camera localization, Camera odometry, GPS (or GNSS) localization, IMU odometry).
- the localization module 290 may use one byte for each localization variant, thereby storing the localization strategy using as many bytes as the classes of localization/odometry, for example, 6 bytes if each variant ID fits in 8 bits and there are 6 classes of localization/odometry.
- FIG. 10 illustrates the process for performing localization for a vehicle, according to an embodiment.
- the steps described may be performed in an order different from that indicated herein.
- the steps may be performed by modules other than those indicated herein.
- the localization module 290 stores a plurality of localization variants.
- the localization variant module 910 of the localization module 290 stores 1010 instructions for various localization techniques and parameter values for various localization variants.
- the HD map system stores 1020 information describing various driving contexts.
- the system builds 1030 a localization index mapping driving contexts to localization variants.
- the localization index stores a mapping from each driving context to one or more localization variants based on a measure of performance of each localization variant in the driving context.
- An autonomous vehicle uses the localization index to determine the location of the autonomous vehicle as the autonomous vehicle is driving.
- the system navigates by determining control signals for the autonomous vehicle based on the determined location and sending 1060 control signals to the controls of the autonomous vehicle.
- FIG. 11 illustrates the process for building localization index, according to an embodiment.
- the steps described may be performed in an order different from that indicated herein.
- the steps may be performed by modules other than those indicated herein.
- the localization module 290 repeats the following steps for each driving context, or for a subset of driving contexts.
- the localization module 290 determining a measure of performance for each of the plurality of localization variants (or a subset of the plurality of localization variants).
- the localization module 290 determines performance of a localization variant by determining a location of a vehicle based on a track data such as sensor data (or previous drives of vehicles on a route).
- the localization module 290 determines an actual pose of the vehicle based on results obtained via alignment of various track data.
- the pose of the vehicle determined via alignment of multiple tracks is referred to as alignment pose.
- the alignment pose is treated as ground truth against which the localization module 290 compares results of localization based on individual localization variants.
- the localization module 290 ranks 1120 the plurality of localization variants based on the measure of performance of the localization variants.
- the localization module 290 selects 1130 one or more localization variants for the driving context based on the ranking.
- the localization module 290 stores 1140 a mapping from the driving context to the corresponding localization variants in the localization index.
- FIG. 12 illustrates the process for performing localization based on the localization index, according to an embodiment.
- the steps described may be performed in an order different from that indicated herein.
- the steps may be performed by modules other than those indicated herein.
- An autonomous vehicle repeats the following steps while driving.
- the autonomous vehicle could repeat these steps multiple times a second.
- the autonomous vehicle receives 1210 sensor data captured by sensors of the autonomous vehicle.
- the autonomous vehicle determines using on the sensor data, a driving context in which the autonomous vehicle is currently driving.
- the driving context may describe the geographical region in which the autonomous vehicle is driving.
- the autonomous vehicle determines 1220 an approximate location of the autonomous vehicle based on the sensor data.
- the autonomous vehicle identifies 1230 the geographical region in which the autonomous vehicle is currently driving based on the approximate location. For example, each geographical region may be represented as a polygon.
- the localization module 290 determines whether the current location of the autonomous vehicle falls within a polygon representing a geographical region.
- the localization module 290 uses a previous geographical region in which the autonomous vehicle was driving to narrow the search for geographical regions.
- the HD map system stores associations between adjacent geographical regions.
- the localization module 290 uses these associations to identify geographical regions neighboring the previous geographical region.
- the localization module 290 limits the search for the geographical region to the set of geographical regions neighboring the previous geographical region in which the autonomous vehicle was driving.
- the localization module 290 may first verify if the current location continues to lie within the previous geographical region before performing a search for a new geographical region.
- the HD map system stores information describing the direction in neighboring geographical regions are present with respect to a geographical region, for example, north, south, east, west, and so on.
- the localization module 290 tracks the direction in which the vehicle autonomous vehicle is driving based on information received from sensors, for example, IMU or GNSS.
- the localization module 290 further narrows the search for geographical regions to geographical regions that neighbor the previous geographical region along the direction in which the autonomous vehicle is travelling.
- the autonomous vehicle selects 1240 one or more localization variants corresponding to the driving context comprising the geographical region using the localization index.
- the autonomous vehicle determines 1250 an accurate location of the autonomous vehicle using the localization variant.
- the autonomous vehicle navigates based on the location of the autonomous vehicle.
- the control module 225 may determine control signals for navigating the autonomous vehicle using the current location of the autonomous vehicle and send the control signals to controls of the autonomous vehicle.
- the autonomous vehicle may determine control signals for navigating the autonomous vehicle using the current location of the autonomous vehicle and the data of the HD map.
- the autonomous vehicle navigates the autonomous vehicle based on the control signals.
- the autonomous vehicle may identify the lane in which the vehicle is currently driving and may decide to change the lane based on the location, for example, if the autonomous vehicle needs to turn left/right within a short distance.
- the autonomous vehicle may determine based on the location that a stop sign is approaching and the autonomous vehicle needs to slow down to come to a stop.
- the localization index stores coordinates, for example, latitude and longitude of some locations and corresponding localization variants that have high performance in a geographical region surrounding the coordinates.
- the localization module 290 determines the stored coordinates that are closest to the current location of the autonomous vehicle and uses the localization variants corresponding to the stored coordinates for determining the location of the autonomous vehicle.
- the HD map system may receive and store different version of the same localization techniques, for example, as localization techniques evolve.
- the HD map system may have to recompute the mapping from a geographical region to corresponding localization variants if there are following changes: (1) changes in the HD map data associated with the geographical region, for example, if a new structure such as a building or a tree is added or deleted from the HD map data; (2) changes to the parameters used by a localization technique; (3) changes in the executable machine instructions corresponding to a localization techniques.
- the localization index 940 stores (1) the version of the HD map data against which a mapping from a geographical region and a localization variant was computed (2) the sensor configuration used in the data that was localized to the map to compute the mapping (this includes a configuration name and version of the sensors and a change in configuration (i.e., a change in a sensor or sensor position/orientation); (3) the version of the localization technique used to compute the mapping.
- the localization index 940 stores a version of the HD map used along with the mapping data.
- the localization module 290 ensures that the localization variants used were mapped to the geographical region using HD map data version X and binary version Y.
- the localization strategy may differ between different sensor configurations in the same geographical region or driving context. As a result the localization module 290 needs to evaluate each localization variant for each sensor configuration. In order to manage the combinatorial explosion, the localization module 290 analyzes a given area of a map and identify what type of localization strategies for a given sensor configuration would be optimal.
- the localization module 290 analyzes correlations between different sensor configurations across geographical regions. If localization module 290 determines high correlation across sensor configurations, the localization module 290 evaluates a geographical region with one sensor configuration and maps the results for other sensor configuration which are correlated. This allows the localization module 290 to evaluate fewer sensor configurations for localization variants.
- the localization module 290 analyzes characteristics of the geographical regions and uses the characteristics to predict localization variants that work best. Characteristics of geographical region include whether the region is suburban or urban, the types of highway (urban or rural), if the geographical region is rural, whether the region has forests or agriculture, whether there are bridges, tunnels, whether the geographical region is flat, hilly, windy, and so on. In an embodiment, the localization module 290 builds a map that identifies these characteristics of each geographical region. The localization module 290 determines optimal localization variants for each type of geographical region having a set of characteristics.
- the localization module 290 determines the characteristics of the geographical region and determines the localization variants to use based on the characteristics. Accordingly the driving context includes various characteristics of geographical regions rather than individual geographical regions. The localization module 290 determines the characteristics of a geographical region and identifies a driving context that matches the characteristics of the geographical region. The localization module 290 identifies the localization variants to use for that driving context and uses them to perform localization.
- the driving context further includes the sensor configuration details. Accordingly, the localization module 290 maps combinations of characteristics of geographical regions and sensor configurations to localization variants.
- the localization module 290 matches characteristics of a geographical to the same characteristics of an area in our ground truth data sets. We would compute optimal localization strategies for all of the ground truth data sets. Then for a new map, we would walk through the map and identify each area's best matching area in the ground truth set (e.g., an area with buildings and narrow streets vs an area with trees and a curving road). With such a mapping, we can map an area in a map to a set of localization strategies for each kind of sensor configuration that we keep track of.
- embodiments are described in connection with autonomous vehicles, the techniques described herein can be used by other types of vehicles, for example, vehicles that are driven by human drivers. Furthermore, embodiments of the invention may be used for other types of navigable machines, for example, robots, ships, drones, airplanes, and the like.
- the localization module 290 uses machine learning based techniques such as deep learning and neural networks to build the localization variant index 940 and to perform localization.
- the localization module 290 uses deep learning to characterize types of regions where certain localization variants work best.
- the localization module 290 uses a training data set comprising the samples based on tracks representing past instances of autonomous vehicles driving through various geographical regions.
- the localization module 290 uses previously determine performance of various localization variants as expected scores for localization variants.
- the localization module 290 trains a deep learning based model, for example, a neural network such as a multilayered perceptron configured to receive an encoding of a geographical region as input and determine a score for a localization variant.
- the score indicates a measure of performance, for example, a high score may indicate that the localization variant performs well and a low score indicates that the localization variant performs poorly.
- the localization module 290 the trained deep learning based model receives an encoding of a geographical region as input and predicts a localization variant that performs well in that geographical region.
- the encoding of the geographical region may comprise HD map data for the geographical region.
- the encoding of the geographical region may comprise a low resolution map that describes various structures of the geographical region such as building, tunnels, bridges as well as physical features such as rivers, hills, altitude of different points, and so on.
- the localization module 290 uses the deep learning based model to build the localization variant index 940 , for example, to determine localization variants for geographical regions where there is insufficient track data based on vehicles driving through the geographical region.
- the localization module 290 tests the performance of the deep learning based model to see if the accuracy of the results predicted is at least above a threshold value.
- the localization module 290 tests the performance by taking a map of one or more geographical regions, performing a brute force analysis of localization variants by measuring the performance of various localization variants, and various sensor configurations for each localization variant.
- the localization module 290 executes the deep learning based model to determine the best performing localization variants or to determine a score for a particular localization variant.
- the localization module 290 compares the results of the brute force execution with the predictions of the deep learning based model and determine error statistics. The localization module 290 measures the net loss in performance to determine whether the deep learning based model is usable in particular geographical regions.
- the localization module 290 determines that the deep learning based model has poor performance and is unable to predict the best localization variant, the localization module 290 identifies the geographical regions where the model is inaccurate. Accordingly, the localization module switches to performing brute force analysis of evaluation of performance of all localization variants and different sensor configurations in those regions. However, in regions where the deep learning based model is accurate, the localization module 290 is able to use the deep learning based model in those regions thereby saving computational resources by not having to perform brute force analysis.
- the above analysis can also be performed with other machine learning based models, for example, machine learning based models.
- the localization module 290 extract specific features of the geographical regions and provides them as input to the machine learning based model.
- the machine learning based model predicts one or more localization variants that perform well for the input geographical region or the machine learning based model determines a score for a particular localization variant indicating the performance of the localization variant in the geographical region.
- features of a geographical region include types of structures present in the geographical region such as building, tunnels, bridges as well as features describing physical features such as rivers, hills, altitude of different points, and so on.
- the techniques apply to other types of driving context, for example, speed of the autonomous vehicle, time of day, weather conditions, angular velocity, and so on.
- the input to the models can be an encoding of a general driving context or specific features of the driving context, depending on the type of model.
- the localization module 290 collects statistics based on analysis of localization variants. Examples of statistics collected includes convergence radius, covariance of localization result, and error stats for the specific localization result. From the localization statistics the localization module 290 builds a map of a measure of confidence in the localization variant at each point in the map. This provides a useful visualization that helps a user identify problem areas and make improvements in the process. For each sample, the localization module 290 determines the best-case localization variant's result and uses that as a value for the sample's location in the map. The localization module 290 creates a visualization that shows a color-coded representation of the map, for example, a map with red indicating high error and green indicating low error.
- the map of confidence values also acts as a measure of a level of trust in localization results at specific locations.
- the map of confidence values allows the HD Map system to optimally integrate multiple localization results from different localization variants corresponding to different sensor modalities.
- the HD map system integrates results from different localization variants using Kalman filtering. The results of each of the localization variants weighted based on their respective convergence confidence.
- the HD map system determines measures of covariance across pairs of localization variants based on different sensors. The HD map system uses the measures of covariances for integrating results from different localization variants using Kalman filtering.
- the confidence map can also be used to generate hotspots for locations in the HD map that needs further inspection and analysis.
- Localization error may be high due to various reasons. For example, localization error may be high due to insufficient constraints in the sensor data (e.g., due to lack of vertical structure in the direction of travel, or everything being uniformly flat). Localization error may be high due to errors in the sensor data, for example, due to a software or hardware failure.
- Localization error may be high due errors in the OMap including: (1) badly aligned sample that may affect the localization results by having part of the map misaligned resulting in ambiguous results when localizing; (2) A temporal object (e.g., a car, cyclist or pedestrian) which should have been removed from the OMap but was not; these objects which are not permanent possibly cause a localization error when a similar object is close to that same position in the sample being localized; (3) missing data in the OMap, for example, due to a data collection problem before OMap construction (e.g., the sensor for the vehicle was obstructed in that location) or because data just not collected for that part of the map.
- a data collection problem before OMap construction e.g., the sensor for the vehicle was obstructed in that location
- the OMap In situations where there is high localization error, the OMap needs to be analyzed by an expert or automatically to determine whether to fix a problem (e.g., add missing data) or identify scenarios that need additional localization variant analysis.
- the localization module 290 analyses the data of the confidence map by filtering points based on certain threshold, clustering the remaining points with some maximum radius (say 10 m), and creating review tasks for each cluster.
- the localization module 290 may display the review tasks via a user interface or send via some communication mechanism to a user/expert for analysis. For example, a user may visually inspect such regions and determine a subsequent action needed.
- the number of localization variants can be infinite due to parameter variations.
- the system prunes the parameter space to reduce number of effective localization variants. This may be performed using experiments with a localization technique and comparing results over a wide range of parameters and eventually narrowing down to combinations of parameter sets that are most effective. This may result in a few lOs or so localization variants for a specific localization technique which is manageable for further analysis.
- the localization module 290 prunes localization variants that are very likely to perform poorly in a given driving context. The localization module 290 may mark these localization variants for the geographical regions. Accordingly, the localization module 290 is able to eliminate these localization variants immediately from any analysis, thereby saving computational resources.
- the localization module 290 may further analyze those cases. If the localization module 290 identifies another variant that performs close to the best for a driving content and is generally applicable, the localization module 290 marks the variant as disposable and records a description of the resolution with that variant's evaluation results. For the winning variants, the localization module 290 may further create and evaluate a number of variations of those localization variant making smaller variations to the critical parameters (i.e., smaller than the initial variation from the preceding set of variants). The localization module 290 evaluates those localization variants to re-evaluate the winning localization variants as well a losing localization variants that need to be pruned.
- the HD map system stores a measure of convergence confidence and covariance of localization variants for each geographical region. For example, HD map system determines the rate of convergence of localization variants for different tracks in each geographical region. The HD map system determines the measure of convergence confidence based on an aggregate rate of convergence of localization variants for each type of sensor for different tracks in each geographical region.
- the HD map system integrates results from localization variants using the precomputed covariances and a Kalman filter.
- the HD map system uses the confidence values to determine which localization variants are more reliable and in which directions.
- the HD map system determines measures of covariance across pairs of localization variants based on different sensors. The HD map system uses the measures of covariances for integrating results from different localization variants using Kalman filtering.
- FIG. 13 is a block diagram illustrating components of an example machine able to read instructions from a machine-readable medium and execute them in a processor (or controller). Specifically, FIG. 13 shows a diagrammatic representation of a machine in the example form of a computer system 1300 within which instructions 1324 (e.g., software) for causing the machine to perform any one or more of the methodologies discussed herein may be executed. In alternative embodiments, the machine operates as a standalone device or may be connected (e.g., networked) to other machines. In a networked deployment, the machine may operate in the capacity of a server machine or a client machine in a server-client network environment, or as a peer machine in a peer-to-peer (or distributed) network environment.
- instructions 1324 e.g., software
- the machine operates as a standalone device or may be connected (e.g., networked) to other machines. In a networked deployment, the machine may operate in the capacity of a server machine or a client machine in a
- the machine may be a server computer, a client computer, a personal computer (PC), a tablet PC, a set-top box (STB), a personal digital assistant (PDA), a cellular telephone, a smartphone, a web appliance, a network router, switch or bridge, or any machine capable of executing instructions 1324 (sequential or otherwise) that specify actions to be taken by that machine.
- PC personal computer
- PDA personal digital assistant
- STB set-top box
- a cellular telephone a smartphone
- smartphone a web appliance
- network router switch or bridge
- the example computer system 1300 includes a processor 1302 (e.g., a central processing unit (CPU), a graphics processing unit (GPU), a digital signal processor (DSP), one or more application specific integrated circuits (ASICs), one or more radio-frequency integrated circuits (RFICs), or any combination of these), a main memory 1304 , and a static memory 1306 , which are configured to communicate with each other via a bus 1308 .
- the computer system 1300 may further include graphics display unit 1310 (e.g., a plasma display panel (PDP), a liquid crystal display (LCD), a projector, or a cathode ray tube (CRT)).
- graphics display unit 1310 e.g., a plasma display panel (PDP), a liquid crystal display (LCD), a projector, or a cathode ray tube (CRT)
- the computer system 1300 may also include alphanumeric input device 1312 (e.g., a keyboard), a cursor control device 1314 (e.g., a mouse, a trackball, a joystick, a motion sensor, or other pointing instrument), a storage unit 1316 , a signal generation device 1318 (e.g., a speaker), and a network interface device 1320 , which also are configured to communicate via the bus 1308 .
- alphanumeric input device 1312 e.g., a keyboard
- a cursor control device 1314 e.g., a mouse, a trackball, a joystick, a motion sensor, or other pointing instrument
- storage unit 1316 e.g., a disk drive, or other pointing instrument
- signal generation device 1318 e.g., a speaker
- network interface device 1320 which also are configured to communicate via the bus 1308 .
- the storage unit 1316 includes a machine-readable medium 1322 on which is stored instructions 1324 (e.g., software) embodying any one or more of the methodologies or functions described herein.
- the instructions 1324 (e.g., software) may also reside, completely or at least partially, within the main memory 1304 or within the processor 1302 (e.g., within a processor's cache memory) during execution thereof by the computer system 1300 , the main memory 1304 and the processor 1302 also constituting machine-readable media.
- the instructions 1324 (e.g., software) may be transmitted or received over a network 1326 via the network interface device 1320 .
- machine-readable medium 1322 is shown in an example embodiment to be a single medium, the term “machine-readable medium” should be taken to include a single medium or multiple media (e.g., a centralized or distributed database, or associated caches and servers) able to store instructions (e.g., instructions 1324 ).
- the term “machine-readable medium” shall also be taken to include any medium that is capable of storing instructions (e.g., instructions 1324 ) for execution by the machine and that cause the machine to perform any one or more of the methodologies disclosed herein.
- the term “machine-readable medium” includes, but not be limited to, data repositories in the form of solid-state memories, optical media, and magnetic media.
- the techniques described herein are applied to autonomous vehicles, the techniques can also be applied to other applications, for example, for displaying HD maps for vehicles with drivers, for displaying HD maps on displays of client devices such as mobile phones, laptops, tablets, or any computing device with a display screen.
- Techniques displayed herein can also be applied for displaying maps for purposes of computer simulation, for example, in computer games, and so on.
- a software module is implemented with a computer program product comprising a computer-readable medium containing computer program code, which can be executed by a computer processor for performing any or all of the steps, operations, or processes described.
- Embodiments of the invention may also relate to an apparatus for performing the operations herein.
- This apparatus may be specially constructed for the required purposes, and/or it may comprise a general-purpose computing device selectively activated or reconfigured by a computer program stored in the computer.
- a computer program may be stored in a tangible computer readable storage medium or any type of media suitable for storing electronic instructions, and coupled to a computer system bus.
- any computing systems referred to in the specification may include a single processor or may be architectures employing multiple processor designs for increased computing capability.
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Aviation & Aerospace Engineering (AREA)
- Databases & Information Systems (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Geometry (AREA)
- Multimedia (AREA)
- Electromagnetism (AREA)
- Traffic Control Systems (AREA)
- Navigation (AREA)
Abstract
Description
- This application claims the benefit of priority under 35 USC 119(e) to U.S. Provisional Application No. 62/593,334 filed on Dec. 1, 2017, which is incorporated herein by reference in its entirety for all purposes.
- This disclosure relates generally to localization of autonomous vehicles and more particularly to optimization of localization strategies used by an autonomous vehicle based on a driving context, for example, the geographical region in which the autonomous vehicle is driving, the time of day, the speed of the autonomous vehicle, and so on.
- Autonomous vehicles, also known as self-driving cars, driverless cars, auto, or robotic cars, drive from a source location to a destination location without requiring a human driver to control and navigate the vehicle. Autonomous vehicles need to determine their location accurately to be able to navigate. Autonomous vehicles use sensor data to determine their location. There are several techniques that can be used for determining the location of an autonomous vehicle. These techniques may depend on the type of sensor data used for determining the location, for example, camera images, lidar scans, global positioning system (GPS) data, inertial measurement unit (IMU) data, and so on.
- Certain localization technique may work better in certain circumstances whereas a different technique may work better in other circumstances. For example, a localization technique based on lidar signal may work better in some circumstances whereas a localization techniques based on global positioning system (GPS) and inertial measurement unit (IMU) may work better under different circumstances. Similarly, on a street with houses or buildings and trees, geometric lidar-based localization may perform very well. However, on a highway with no interesting vertical geometry, that same localization technique may fail to identify the forward location or the yaw angle of the autonomous vehicle.
- The performance of a localization technique depends on various factors for example, the type of sensor data available, type of terrain, type of signal available, whether the vehicle is driving in city or on highway, whether there is a truck driving next to the vehicle occluding the view on the side, and so on. The localization must be performed periodically at a high frequency to allow the autonomous vehicle to navigate properly.
- Conventional systems use a particular localization technique that may fail as the factors controlling the accuracy of the localization technique change. A localization technique that works well in one geographical region may not work well in another geographical region, for example, it may take significantly longer to process or have low accuracy. Furthermore, localization techniques have parameters that need to be tuned for different driving contexts. Parameters that work well in one geographical region may not work well in another geographical region. If the localization process fails, the autonomous vehicle may not be able to navigate properly.
- Embodiments of the invention perform localization of autonomous vehicles using different localization techniques as the autonomous vehicle drives. The localization technique used by the autonomous vehicle is selected using a localization variant index that stores a mapping from driving contexts to localization variants. A localization variant identifies a localization technique and values of one or more parameters associated with the localization technique. Examples of localization techniques include: a localization technique based on camera images, a localization technique based on lidar scans, a localization technique based on GNSS data, and a localization technique based on IMU data. There can be multiple localization variants based on the same localization technique, for example, different localization variants corresponding to different values of parameters for the same localization technique. The driving context comprises information describing one or more of: a geographical region in which the autonomous vehicle is driving, a time of day when the autonomous vehicle is driving, information describing weather conditions in the geographical region in which the autonomous vehicle is driving at the time the autonomous vehicle is driving, a speed at which the autonomous vehicle is driving, or an angular velocity of the autonomous vehicle.
- The system stores a plurality of localization variants. Each localization variant represents a localization technique for determining location of an autonomous vehicle. The system also stores information describing a plurality of driving contexts. A driving context may be represented as a tuple that has various elements such as geographical region, time of day, weather condition, speed of autonomous vehicle, angular velocity of the autonomous vehicle, and so on. The system builds a localization index that maps driving contexts to localization variants. The system maps each driving context to one or more localization variants based on a measure of performance of the localization variants in the driving context. In an embodiment, the system stores a plurality of localization variants for each sensor modality. A sensor modality corresponds to a type of sensor input used by the localization variants, for example, localization variants based on lidar scans represent a sensor modality, localization variants based on cameras represent another sensor modality, and so on. Accordingly, the vehicle computing system selects a particular sensor modality for use and selects one or more localization variants for the sensor modality for localization. In one embodiment, the vehicle computing system determines measures of confidence in localization variants and measures of covariances across localization variants using different sensors. The vehicle computing system integrates results of localization variants from different sensor modalities using Kalman filtering. The integration of localization variants based on Kalman filtering uses the measures of confidence values and measures of covariance values.
- An autonomous vehicle uses the localization index while driving as follows. The autonomous vehicle receives sensor data captured by sensors of the autonomous vehicle. The autonomous vehicle uses the sensor data to determine a driving context in which the autonomous vehicle is currently driving. For example, the autonomous vehicle may determine an approximate location based on the sensor data and determine a geographical region based on the approximate location. The autonomous vehicle selects one or more localization variants corresponding to the driving context using the localization index. The autonomous vehicle determines a location of the autonomous vehicle using the selected localization variants and uses the location for navigation of the autonomous vehicle. These steps are repeated as the autonomous vehicle drives.
- In an embodiment, the system builds the localization index as follows. The system repeats the following steps for each driving context. For each of the plurality of localization variants, the system determines a measure of performance of the localization variant. The system ranks the localization variants based on the measure of performance. The system selects one or more localization variants for the driving context based on the ranking and stores an association between the driving context and the selected localization variants in the localization index.
- The measure of performance of a localization variant in a particular driving context may be determined based on one or more factors including: an error in localization using the localization variant in the driving context, a time of execution of the localization variant in the driving context, or a rate of success of the localization variant in the driving context. A localization variant is successful if it determines the location of the autonomous vehicle within a threshold of an accurate location value.
- In an embodiment, the system stores representation of geographical regions, for example, as polygons. The localization index maps geographical regions to localization variants. An autonomous vehicle determines the geographical region in which the autonomous vehicle is currently driving. The autonomous vehicle selects one or more localization variants corresponding to the geographical region and uses them for localization.
- In an embodiment, the system stores representations of lane elements, each lane element corresponding to a portion of a lane of a street (or highway, road, etc.). The localization index maps lane elements to localization variants. An autonomous vehicle determines the lane element in which the autonomous vehicle is currently driving. The autonomous vehicle selects one or more localization variants corresponding to the lane element and uses them for localization.
- In an embodiment, the system maps coordinates of locations, for example, latitudes and longitudes, to localization variants. An autonomous vehicle determines the current coordinates of the autonomous vehicle, for example, using GPS data or IMU data. The system identifies the nearest coordinates stored in the localization variant index for which localization variants are stored. The system uses the localization variants stored in association with the nearest coordinates to the location of the autonomous vehicles for performing localization.
- Although embodiments are described in connection with autonomous vehicles, the techniques described herein can be used by other types of vehicles, for example, vehicles that are driven by human drivers. Furthermore, embodiments of the invention may be used for other types of navigable machines, for example, robots, ships, drones, airplanes, and the like.
-
FIG. 1 shows the overall system environment of an HD map system interacting with multiple vehicle computing systems, according to an embodiment. -
FIG. 2 shows the system architecture of a vehicle computing system, according to an embodiment. -
FIG. 3 illustrates the various layers of instructions in the HD Map API of a vehicle computing system, according to an embodiment. -
FIG. 4 shows the system architecture of an HD map system, according to an embodiment. -
FIG. 5 illustrates the components of an HD map, according to an embodiment. -
FIGS. 6A-B illustrate geographical regions defined in an HD map, according to an embodiment. -
FIG. 7 illustrates representations of lanes in an HD map, according to an embodiment. -
FIGS. 8A-B illustrates lane elements and relations between lane elements in an HD map, according to an embodiment. -
FIG. 9 describes the system architecture of a localization module, according to an embodiment. -
FIG. 10 illustrates the process for performing localization for a vehicle, according to an embodiment. -
FIG. 11 illustrates the process for building localization index, according to an embodiment. -
FIG. 12 illustrates the process for performing localization based on the localization index, according to an embodiment. -
FIG. 13 illustrates an embodiment of a computing machine that can read instructions from a machine-readable medium and execute the instructions in a processor or controller. - The figures depict various embodiments of the present invention for purposes of illustration only. One skilled in the art will readily recognize from the following discussion that alternative embodiments of the structures and methods illustrated herein may be employed without departing from the principles of the invention described herein.
- Embodiments of the invention maintain high definition (HD) maps containing up to date information using high precision. The HD maps may be used by autonomous vehicles to safely navigate to their destinations without human input or with limited human input. An autonomous vehicle is a vehicle capable of sensing its environment and navigating without human input. Autonomous vehicles may also be referred to herein as “driverless car,” “self-driving car,” or “robotic car.” An HD map refers to a map storing data with very high precision, typically 5-10 cm. Embodiments generate HD maps containing spatial geometric information about the roads on which an autonomous vehicle can travel. Accordingly, the generated HD maps include the information necessary for an autonomous vehicle navigating safely without human intervention. Embodiments generate and maintain high definition (HD) maps that are accurate and include the most updated road conditions for safe navigation.
- An autonomous vehicle that uses the HD map needs to localize, i.e., determine the current location of the autonomous vehicle with high accuracy to be able to navigate. The HD map system supports a number of localization techniques and variations of each localization technique. The performance of a localization technique may depend on various factors, for example, the scene surrounding the autonomous vehicle including the geometry of structures around the autonomous vehicle, identifiable photometric features, and so on. Embodiments of the invention select an appropriate localization technique and parameters tuned for the specific context to perform localization efficiently and accurately. The combination of a localization technique and corresponding parameter values is referred to as a localization variant. The HD map system estimates the performance of each localization variant for different contexts and uses an index to efficiently look up the best localization variants based on the current location of the autonomous vehicle. The HD map system also manages the lifetime of the map and localization variants by managing versions of the localization variants which correspond to versions of the executable files running on autonomous vehicle as well as versions of the HD map data.
-
FIG. 1 shows the overall system environment of an HD map system interacting with multiple vehicles, according to an embodiment. TheHD map system 100 includes an onlineHD map system 110 that interacts with a plurality of vehicles 150. The vehicles 150 may be autonomous vehicles but are not required to be. The onlineHD map system 110 receives sensor data captured by sensors of the vehicles, and combines the data received from the vehicles 150 to generate and maintain HD maps. The onlineHD map system 110 sends HD map data to the vehicles for use in driving the vehicles. In an embodiment, the onlineHD map system 110 is implemented as a distributed computing system, for example, a cloud based service that allows clients such asvehicle computing systems 120 to make requests for information and services. For example, avehicle computing system 120 may make a request for HD map data for driving along a route and the onlineHD map system 110 provides the requested HD map data. -
FIG. 1 and the other figures use like reference numerals to identify like elements. A letter after a reference numeral, such as “105A,” indicates that the text refers specifically to the element having that particular reference numeral. A reference numeral in the text without a following letter, such as “105,” refers to any or all of the elements in the figures bearing that reference numeral (e.g. “105” in the text refers to reference numerals “105A” and/or “105N” in the figures). - The online
HD map system 110 comprises avehicle interface module 160 and anHD map store 165. The onlineHD map system 110 interacts with thevehicle computing system 120 of various vehicles 150 using thevehicle interface module 160. The onlineHD map system 110 stores map information for various geographical regions in theHD map store 165. The onlineHD map system 110 may include other modules than those shown inFIG. 1 , for example, various other modules as illustrated inFIG. 4 and further described herein. - The online
HD map system 110 receives 115 data collected by sensors of a plurality of vehicles 150, for example, hundreds or thousands of cars. The vehicles provide sensor data captured while driving along various routes and send it to the onlineHD map system 110. The onlineHD map system 110 uses the data received from the vehicles 150 to create and update HD maps describing the regions in which the vehicles 150 are driving. The onlineHD map system 110 builds high definition maps based on the collective information received from the vehicles 150 and stores the HD map information in theHD map store 165. - The online
HD map system 110 sends 125 HD maps to individual vehicles 150 as required by the vehicles 150. For example, if an autonomous vehicle needs to drive along a route, thevehicle computing system 120 of the autonomous vehicle provides information describing the route being travelled to the onlineHD map system 110. In response, the onlineHD map system 110 provides the required HD maps for driving along the route. - In an embodiment, the online
HD map system 110 sends portions of the HD map data to the vehicles in a compressed format so that the data transmitted consumes less bandwidth. The onlineHD map system 110 receives from various vehicles, information describing the data that is stored at the localHD map store 275 of the vehicle. If the onlineHD map system 110 determines that the vehicle does not have certain portion of the HD map stored locally in the localHD map store 275, the onlineHD map system 110 sends that portion of the HD map to the vehicle. If the onlineHD map system 110 determines that the vehicle did previously receive that particular portion of the HD map but the corresponding data was updated by the onlineHD map system 110 since the vehicle last received the data, the onlineHD map system 110 sends an update for that portion of the HD map stored at the vehicle. This allows the onlineHD map system 110 to minimize the amount of data that is communicated with the vehicle and also to keep the HD map data stored locally in the vehicle updated on a regular basis. - A vehicle 150 includes vehicle sensors 105, vehicle controls 130, and a
vehicle computing system 120. The vehicle sensors 105 allow the vehicle 150 to detect the surroundings of the vehicle as well as information describing the current state of the vehicle, for example, information describing the location and motion parameters of the vehicle. The vehicle sensors 105 comprise a camera, a light detection and ranging sensor (LIDAR), a global positioning system (GPS) navigation system, an inertial measurement unit (IMU), and others. The vehicle has one or more cameras that capture images of the surroundings of the vehicle. A LIDAR surveys the surroundings of the vehicle by measuring distance to a target by illuminating that target with a laser light pulses, and measuring the reflected pulses. The GPS navigation system determines the location of the vehicle based on signals from satellites. The position of the vehicle may also be referred to as the location of the vehicle. An IMU is an electronic device that measures and reports motion data of the vehicle such as velocity, acceleration, direction of movement, speed, angular rate, and so on using a combination of accelerometers and gyroscopes or other measuring instruments. - The vehicle controls 130 control the physical movement of the vehicle, for example, acceleration, direction change, starting, stopping, and so on. The vehicle controls 130 include the machinery for controlling the accelerator, brakes, steering wheel, and so on. The
vehicle computing system 120 continuously provides control signals to the vehicle controls 130, thereby causing an autonomous vehicle to drive along a selected route. - The
vehicle computing system 120 performs various tasks including processing data collected by the sensors as well as map data received from the onlineHD map system 110. Thevehicle computing system 120 also processes data for sending to the onlineHD map system 110. Details of the vehicle computing system are illustrated inFIG. 2 and further described in connection withFIG. 2 . - The interactions between the
vehicle computing systems 120 and the onlineHD map system 110 are typically performed via a network, for example, via the Internet. The network enables communications between thevehicle computing systems 120 and the onlineHD map system 110. In one embodiment, the network uses standard communications technologies and/or protocols. The data exchanged over the network can be represented using technologies and/or formats including the hypertext markup language (HTML), the extensible markup language (XML), etc. In addition, all or some of links can be encrypted using conventional encryption technologies such as secure sockets layer (SSL), transport layer security (TLS), virtual private networks (VPNs), Internet Protocol security (IPsec), etc. In another embodiment, the entities can use custom and/or dedicated data communications technologies instead of, or in addition to, the ones described above. -
FIG. 2 shows the system architecture of a vehicle computing system, according to an embodiment. Thevehicle computing system 120 comprises aperception module 210,prediction module 215,planning module 220, acontrol module 225, a localHD map store 275, an HD map system interface 280, alocalization module 290 a, and an HD map application programming interface (API) 205. The various modules of thevehicle computing system 120 process various type of data includingsensor data 230, abehavior model 235,routes 240, andphysical constraints 245. In other embodiments, thevehicle computing system 120 may have more or fewer modules. Functionality described as being implemented by a particular module may be implemented by other modules. - The
perception module 210 receivessensor data 230 from the sensors 105 of the vehicle 150. This includes data collected by cameras of the car, LIDAR, IMU, GPS navigation system, and so on. Theperception module 210 uses the sensor data to determine what objects are around the vehicle, the details of the road on which the vehicle is travelling, and so on. Theperception module 210 processes thesensor data 230 to populate data structures storing the sensor data and provides the information to theprediction module 215. - The
prediction module 215 interprets the data provided by the perception module using behavior models of the objects perceived to determine whether an object is moving or likely to move. For example, theprediction module 215 may determine that objects representing road signs are not likely to move, whereas objects identified as vehicles, people, and so on, are either moving or likely to move. Theprediction module 215 uses thebehavior models 235 of various types of objects to determine whether they are likely to move. Theprediction module 215 provides the predictions of various objects to the planning module 200 to plan the subsequent actions that the vehicle needs to take next. - The planning module 200 receives the information describing the surroundings of the vehicle from the
prediction module 215, theroute 240 that determines the destination of the vehicle, and the path that the vehicle should take to get to the destination. The planning module 200 uses the information from theprediction module 215 and theroute 240 to plan a sequence of actions that the vehicle needs to take within a short time interval, for example, within the next few seconds. In an embodiment, the planning module 200 specifies the sequence of actions as one or more points representing nearby locations that the vehicle needs to drive through next. The planning module 200 provides the details of the plan comprising the sequence of actions to be taken by the vehicle to thecontrol module 225. The plan may determine the subsequent action of the vehicle, for example, whether the vehicle performs a lane change, a turn, acceleration by increasing the speed or slowing down, and so on. - The
control module 225 determines the control signals for sending to the controls 130 of the vehicle based on the plan received from the planning module 200. For example, if the vehicle is currently at point A and the plan specifies that the vehicle should next go to a nearby point B, thecontrol module 225 determines the control signals for the controls 130 that would cause the vehicle to go from point A to point B in a safe and smooth way, for example, without taking any sharp turns or a zig zag path from point A to point B. The path taken by the vehicle to go from point A to point B may depend on the current speed and direction of the vehicle as well as the location of point B with respect to point A. For example, if the current speed of the vehicle is high, the vehicle may take a wider turn compared to a vehicle driving slowly. - The
control module 225 also receivesphysical constraints 245 as input. These include the physical capabilities of that specific vehicle. For example, a car having a particular make and model may be able to safely make certain types of vehicle movements such as acceleration, and turns that another car with a different make and model may not be able to make safely. Thecontrol module 225 incorporates these physical constraints in determining the control signals. Thecontrol module 225 sends the control signals to the vehicle controls 130 that cause the vehicle to execute the specified sequence of actions causing the vehicle to move as planned. The above steps are constantly repeated every few seconds causing the vehicle to drive safely along the route that was planned for the vehicle. - The various modules of the
vehicle computing system 120 including theperception module 210,prediction module 215, andplanning module 220 receive map information to perform their respective computation. Thevehicle 100 stores the HD map data in the localHD map store 275. The modules of thevehicle computing system 120 interact with the map data using theHD map API 205 that provides a set of application programming interfaces (APIs) that can be invoked by a module for accessing the map information. The HD map system interface 280 allows thevehicle computing system 120 to interact with the onlineHD map system 110 via a network (not shown in the Figures). The localHD map store 275 stores map data in a format specified by theHD Map system 110. TheHD map API 205 is capable of processing the map data format as provided by theHD Map system 110. TheHD Map API 205 provides thevehicle computing system 120 with an interface for interacting with the HD map data. TheHD map API 205 includes several APIs including thelocalization API 250, thelandmark map API 255, theroute API 265, the3D map API 270, themap update API 285, and so on. - The
localization APIs 250 determine the current location of the vehicle, for example, when the vehicle starts and as the vehicle moves along a route. Thelocalization APIs 250 include a localize API that determines an accurate location of the vehicle within the HD Map. Thevehicle computing system 120 can use the location as an accurate relative positioning for making other queries, for example, feature queries, navigable space queries, and occupancy map queries further described herein. The localize API receives inputs comprising one or more of, location provided by GPS, vehicle motion data provided by IMU, LIDAR scanner data, and camera images. The localize API returns an accurate location of the vehicle as latitude and longitude coordinates. The coordinates returned by the localize API are more accurate compared to the GPS coordinates used as input, for example, the output of the localize API may have precision range from 5-10 cm. In one embodiment, thevehicle computing system 120 invokes the localize API to determine location of the vehicle periodically based on the LIDAR using scanner data, for example, at a frequency of 10 Hz. Thevehicle computing system 120 may invoke the localize API to determine the vehicle location at a higher rate (e.g., 60 Hz) if GPS/IMU data is available at that rate. Thevehicle computing system 120 stores as internal state, location history records to improve accuracy of subsequent localize calls. The location history record stores history of location from the point-in-time, when the car was turned off/stopped. Thelocalization APIs 250 include a localize-route API generates an accurate route specifying lanes based on the HD map. The localize-route API takes as input a route from a source to destination via a third party maps and generates a high precision routes represented as a connected graph of navigable lanes along the input routes based on HD maps. - The
landmark map API 255 provides the geometric and semantic description of the world around the vehicle, for example, description of various portions of lanes that the vehicle is currently travelling on. Thelandmark map APIs 255 comprise APIs that allow queries based on landmark maps, for example, fetch-lanes API and fetch-features API. The fetch-lanes API provide lane information relative to the vehicle and the fetch-features API. The fetch-lanes API receives as input a location, for example, the location of the vehicle specified using latitude and longitude of the vehicle and returns lane information relative to the input location. The fetch-lanes API may specify a distance parameters indicating the distance relative to the input location for which the lane information is retrieved. The fetch-features API receives information identifying one or more lane elements and returns landmark features relative to the specified lane elements. The landmark features include, for each landmark, a spatial description that is specific to the type of landmark. - The
3D map API 265 provides efficient access to the spatial 3-dimensional (3D) representation of the road and various physical objects around the road as stored in the localHD map store 275. The 3D map APIs 365 include a fetch-navigable-surfaces API and a fetch-occupancy-grid API. The fetch-navigable-surfaces API receives as input, identifiers for one or more lane elements and returns navigable boundaries for the specified lane elements. The fetch-occupancy-grid API receives a location as input, for example, a latitude and longitude of the vehicle, and returns information describing occupancy for the surface of the road and all objects available in the HD map near the location. The information describing occupancy includes a hierarchical volumetric grid of all positions considered occupied in the map. The occupancy grid includes information at a high resolution near the navigable areas, for example, at curbs and bumps, and relatively low resolution in less significant areas, for example, trees and walls beyond a curb. The fetch-occupancy-grid API is useful for detecting obstacles and for changing direction if necessary. - The 3D map APIs also include map update APIs, for example, download-map-updates API and upload-map-updates API. The download-map-updates API receives as input a planned route identifier and downloads map updates for data relevant to all planned routes or for a specific planned route. The upload-map-updates API uploads data collected by the
vehicle computing system 120 to the onlineHD map system 110. This allows the onlineHD map system 110 to keep the HD map data stored in the onlineHD map system 110 up to date based on changes in map data observed by sensors of vehicles driving along various routes. - The
route API 270 returns route information including full route between a source and destination and portions of route as the vehicle travels along the route. The 3D map API 365 allows querying the HD Map. Theroute APIs 270 include add-planned-routes API and get-planned-route API. The add-planned-routes API provides information describing planned routes to the onlineHD map system 110 so that information describing relevant HD maps can be downloaded by thevehicle computing system 120 and kept up to date. The add-planned-routes API receives as input, a route specified using polylines expressed in terms of latitudes and longitudes and also a time-to-live (TTL) parameter specifying a time period after which the route data can be deleted. Accordingly, the add-planned-routes API allows the vehicle to indicate the route the vehicle is planning on taking in the near future as an autonomous trip. The add-planned-route API aligns the route to the HD map, records the route and its TTL value, and makes sure that the HD map data for the route stored in thevehicle computing system 120 is up to date. The get-planned-routes API returns a list of planned routes and provides information describing a route identified by a route identifier. - The
map update API 285 manages operations related to update of map data, both for the localHD map store 275 and for theHD map store 165 stored in the onlineHD map system 110. Accordingly, modules in thevehicle computing system 120 invoke themap update API 285 for downloading data from the onlineHD map system 110 to thevehicle computing system 120 for storing in the localHD map store 275 as necessary. Themap update API 285 also allows thevehicle computing system 120 to determine whether the information monitored by the vehicle sensors 105 indicates a discrepancy in the map information provided by the onlineHD map system 110 and uploads data to the onlineHD map system 110 that may result in the onlineHD map system 110 updating the map data stored in theHD map store 165 that is provided to other vehicles 150. - The
localization module 290 a performs localization for an autonomous vehicle. Details of thelocalization module 290 are further described herein. -
FIG. 3 illustrates the various layers of instructions in the HD Map API of a vehicle computing system, according to an embodiment. Different manufacturer of vehicles have different instructions for receiving information from vehicle sensors 105 and for controlling the vehicle controls 130. Furthermore, different vendors provide different compute platforms with autonomous driving capabilities, for example, collection and analysis of vehicle sensor data. Examples of compute platform for autonomous vehicles include platforms provided vendors, such as NVIDIA, QUALCOMM, and INTEL. These platforms provide functionality for use by autonomous vehicle manufacturers in manufacture of autonomous vehicles. A vehicle manufacturer can use any one or several compute platforms for autonomous vehicles. The onlineHD map system 110 provides a library for processing HD maps based on instructions specific to the manufacturer of the vehicle and instructions specific to a vendor specific platform of the vehicle. The library provides access to the HD map data and allows the vehicle to interact with the onlineHD map system 110. - As shown in
FIG. 3 , in an embodiment, the HD map API is implemented as a library that includes avehicle manufacturer adapter 310, acompute platform adapter 320, and a common HDmap API layer 330. The common HD map API layer comprises generic instructions that can be used across a plurality of vehicle compute platforms and vehicle manufacturers. Thecompute platform adapter 320 include instructions that are specific to each computer platform. For example, the common HDMap API layer 330 may invoke thecompute platform adapter 320 to receive data from sensors supported by a specific compute platform. Thevehicle manufacturer adapter 310 comprises instructions specific to a vehicle manufacturer. For example, the common HDmap API layer 330 may invoke functionality provided by thevehicle manufacturer adapter 310 to send specific control instructions to the vehicle controls 130. - The online
HD map system 110 stores computeplatform adapters 320 for a plurality of compute platforms andvehicle manufacturer adapters 310 for a plurality of vehicle manufacturers. The onlineHD map system 110 determines the particular vehicle manufacturer and the particular compute platform for a specific autonomous vehicle. The onlineHD map system 110 selects thevehicle manufacturer adapter 310 for the particular vehicle manufacturer and thecompute platform adapter 320 the particular compute platform of that specific vehicle. The onlineHD map system 110 sends instructions of the selectedvehicle manufacturer adapter 310 and the selectedcompute platform adapter 320 to thevehicle computing system 120 of that specific autonomous vehicle. Thevehicle computing system 120 of that specific autonomous vehicle installs the receivedvehicle manufacturer adapter 310 and thecompute platform adapter 320. Thevehicle computing system 120 periodically checks if the onlineHD map system 110 has an update to the installedvehicle manufacturer adapter 310 and thecompute platform adapter 320. If a more recent update is available compared to the version installed on the vehicle, thevehicle computing system 120 requests and receives the latest update and installs it. -
FIG. 4 shows the system architecture of an HD map system, according to an embodiment. The onlineHD map system 110 comprises a map creation module 410, amap update module 420, a mapdata encoding module 430, aload balancing module 440, a map accuracy management module, a vehicle interface module, aHD map store 165, and thelocalization module 290. Other embodiments of onlineHD map system 110 may include more or fewer modules than shown inFIG. 4 . Functionality indicated as being performed by a particular module may be implemented by other modules. In an embodiment, the onlineHD map system 110 may be a distributed system comprising a plurality of processors. - The map creation module 410 creates the map from map data collected from several vehicles that are driving along various routes. The
map update module 420 updates previously computed map data by receiving more recent information from vehicles that recently travelled along routes on which map information changed. For example, if certain road signs have changed or lane information has changed as a result of construction in a region, themap update module 420 updates the maps accordingly. The mapdata encoding module 430 encodes map data to be able to store the data efficiently as well as send the required map data to vehicles 150 efficiently. Theload balancing module 440 balances load across vehicles to ensure that requests to receive data from vehicles are uniformly distributed across different vehicles. The mapaccuracy management module 450 maintains high accuracy of the map data using various techniques even though the information received from individual vehicles may not have high accuracy. -
FIG. 5 illustrates the components of an HD map, according to an embodiment. The HD map comprises maps of several geographical regions. TheHD map 510 of a geographical region comprises a landmark map (LMap) 520 and an occupancy map (OMap) 530. The landmark map comprises information describing lanes including spatial location of lanes and semantic information about each lane. The spatial location of a lane comprises the geometric location in latitude, longitude and elevation at high prevision, for example, at or below 10 cm precision. The semantic information of a lane comprises restrictions such as direction, speed, type of lane (for example, a lane for going straight, a left turn lane, a right turn lane, an exit lane, and the like), restriction on crossing to the left, connectivity to other lanes and so on. The landmark map may further comprise information describing stop lines, yield lines, spatial location of cross walks, safely navigable space, spatial location of speed bumps, curb, and road signs comprising spatial location and type of all signage that is relevant to driving restrictions. Examples of road signs described in an HD map include stop signs, traffic lights, speed limits, one-way, do-not-enter, yield (vehicle, pedestrian, animal), and so on. - The
occupancy map 530 comprises spatial 3-dimensional (3D) representation of the road and all physical objects around the road. The data stored in anoccupancy map 530 is also referred to herein as occupancy grid data. The 3D representation may be associated with a confidence score indicative of a likelihood of the object existing at the location. Theoccupancy map 530 may be represented in a number of other ways. In one embodiment, theoccupancy map 530 is represented as a 3D mesh geometry (collection of triangles) which covers the surfaces. In another embodiment, theoccupancy map 530 is represented as a collection of 3D points which cover the surfaces. In another embodiment, theoccupancy map 530 is represented using a 3D volumetric grid of cells at 5-10 cm resolution. Each cell indicates whether or not a surface exists at that cell, and if the surface exists, a direction along which the surface is oriented. - The
occupancy map 530 may take a large amount of storage space compared to alandmark map 520. For example, data of 1 GB/Mile may be used by anoccupancy map 530, resulting in the map of the United States (including 4 million miles of road) occupying 4×1015 bytes or 4 petabytes. Therefore the onlineHD map system 110 and thevehicle computing system 120 use data compression techniques for being able to store and transfer map data thereby reducing storage and transmission costs. Accordingly, the techniques disclosed herein make self-driving of autonomous vehicles possible. - In one embodiment, the HD Map does not require or rely on data typically included in maps, such as addresses, road names, ability to geo-code an address, and ability to compute routes between place names or addresses. The
vehicle computing system 120 or the onlineHD map system 110 accesses other map systems, for example, GOOGLE MAPs to obtain this information. Accordingly, avehicle computing system 120 or the onlineHD map system 110 receives navigation instructions from a tool such as GOOGLE MAPs into a route and converts the information to a route based on the HD map information. - The online
HD map system 110 divides a large physical area into geographical regions and stores a representation of each geographical region. Each geographical region represents a contiguous area bounded by a geometric shape, for example, a rectangle or square. In an embodiment, the onlineHD map system 110 divides a physical area into geographical regions of the same size independent of the amount of data required to store the representation of each geographical region. In another embodiment, the onlineHD map system 110 divides a physical area into geographical regions of different sizes, where the size of each geographical region is determined based on the amount of information needed for representing the geographical region. For example, a geographical region representing a densely populated area with a large number of streets represents a smaller physical area compared to a geographical region representing sparsely populated area with very few streets. Accordingly, in this embodiment, the onlineHD map system 110 determines the size of a geographical region based on an estimate of an amount of information required to store the various elements of the physical area relevant for an HD map. - In an embodiment, the online
HD map system 110 represents a geographic region using an object or a data record that comprises various attributes including, a unique identifier for the geographical region, a unique name for the geographical region, description of the boundary of the geographical region, for example, using a bounding box of latitude and longitude coordinates, and a collection of landmark features and occupancy grid data. -
FIGS. 6A-B illustrate geographical regions defined in an HD map, according to an embodiment.FIG. 6A shows a squaregeographical region 610 a.FIG. 6B shows two neighboringgeographical regions HD map system 110 stores data in a representation of a geographical region that allows for smooth transition from one geographical region to another as a vehicle drives across geographical region boundaries. - According to an embodiment, as illustrated in
FIG. 6 , each geographic region has a buffer of a predetermined width around it. The buffer comprises redundant map data around all 4 sides of a geographic region (in the case that the geographic region is bounded by a rectangle).FIG. 6A shows aboundary 620 for a buffer of 50 meters around thegeographic region 610 a and aboundary 630 for buffer of 100 meters around thegeographic region 610 a. Thevehicle computing system 120 switches the current geographical region of a vehicle from one geographical region to the neighboring geographical region when the vehicle crosses a threshold distance within this buffer. For example, as shown inFIG. 6B , a vehicle starts atlocation 650 a in thegeographical region 610 a. The vehicle traverses along a route to reach alocation 650 b where it cross the boundary of the geographical region 610 but stays within theboundary 620 of the buffer. Accordingly, thevehicle computing system 120 continues to use thegeographical region 610 a as the current geographical region of the vehicle. Once the vehicle crosses theboundary 620 of the buffer atlocation 650 c, thevehicle computing system 120 switches the current geographical region of the vehicle togeographical region 610 b from 610 a. The use of a buffer prevents rapid switching of the current geographical region of a vehicle as a result of the vehicle travelling along a route that closely tracks a boundary of a geographical region. - The
HD map system 100 represents lane information of streets in HD maps. Although the embodiments described herein refer to streets, the techniques are applicable to highways, alleys, avenues, boulevards, or any other path on which vehicles can travel. TheHD map system 100 uses lanes as a reference frame for purposes of routing and for localization of a vehicle. The lanes represented by theHD map system 100 include lanes that are explicitly marked, for example, white and yellow striped lanes, lanes that are implicit, for example, on a country road with no lines or curbs but two directions of travel, and implicit paths that act as lanes, for example, the path that a turning car makes when entering a lane from another lane. TheHD map system 100 also stores information relative to lanes, for example, landmark features such as road signs and traffic lights relative to the lanes, occupancy grids relative to the lanes for obstacle detection, and navigable spaces relative to the lanes so the vehicle can efficiently plan/react in emergencies when the vehicle must make an unplanned move out of the lane. Accordingly, theHD map system 100 stores a representation of a network of lanes to allow a vehicle to plan a legal path between a source and a destination and to add a frame of reference for real time sensing and control of the vehicle. TheHD map system 100 stores information and provides APIs that allow a vehicle to determine the lane that the vehicle is currently in, the precise vehicle location relative to the lane geometry, and all relevant features/data relative to the lane and adjoining and connected lanes. -
FIG. 7 illustrates lane representations in an HD map, according to an embodiment.FIG. 7 shows avehicle 710 at a traffic intersection. The HD map system provides the vehicle with access to the map data that is relevant for autonomous driving of the vehicle. This includes, for example, features 720 a and 720 b that are associated with the lane but may not be the closest features to the vehicle. Therefore, theHD map system 100 stores a lane-centric representation of data that represents the relationship of the lane to the feature so that the vehicle can efficiently extract the features given a lane. - The
HD map system 100 represents portions of the lanes as lane elements. A lane element specifies the boundaries of the lane and various constraints including the legal direction in which a vehicle can travel within the lane element, the speed with which the vehicle can drive within the lane element, whether the lane element is for left turn only, or right turn only, and so on. TheHD map system 100 represents a lane element as a continuous geometric portion of a single vehicle lane. TheHD map system 100 stores objects or data structures representing lane elements that comprise information representing geometric boundaries of the lanes; driving direction along the lane; vehicle restriction for driving in the lane, for example, speed limit, relationships with connecting lanes including incoming and outgoing lanes; a termination restriction, for example, whether the lane ends at a stop line, a yield sign, or a speed bump; and relationships with road features that are relevant for autonomous driving, for example, traffic light locations, road sign locations and so on. - Examples of lane elements represented by the
HD map system 100 include, a piece of a right lane on a freeway, a piece of a lane on a road, a left turn lane, the turn from a left turn lane into another lane, a merge lane from an on-ramp an exit lane on an off-ramp, and a driveway. TheHD map system 100 represents a one lane road using two lane elements, one for each direction. TheHD map system 100 represents median turn lanes that are shared similar to a one-lane road. -
FIGS. 8A-B illustrates lane elements and relations between lane elements in an HD map, according to an embodiment.FIG. 8A shows an example of a T junction in a road illustrating alane element 810 a that is connected to laneelement 810 c via aturn lane 810 b and is connected to lane 810 e via aturn lane 810 d.FIG. 8B shows an example of a Y junction in aroad showing label 810 f connected to lane 810 h directly and connected to lane 810 i vialane 810 g. TheHD map system 100 determines a route from a source location to a destination location as a sequence of connected lane elements that can be traversed to reach from the source location to the destination location. -
FIG. 9 describes the system architecture of a localization module, according to an embodiment. Thelocalization module 290 includes alocalization variants module 910, a localizationvariant selection module 920, localizationindex generation module 930, and alocalization index 940. Other embodiments may include more of fewer modules than those indicated herein. Functionality performed by a module may be performed by other modules than those indicated herein. - The
localization module 290 may be present in thevehicle computing system 120 or in the onlineHD map system 110. In some embodiments, thelocalization module 290 a present in thevehicle computing system 120 has different modules (or sub-modules) compared to thelocalization module 290 b present in the onlineHD map system 110. For example, thelocalization module 290 a present in thevehicle computing system 120 may not have the localizationindex generation module 930. Thelocalization module 290 a present in thevehicle computing system 120 may have fewer localization variants compared to thelocalization module 290 b present in the onlineHD map system 110. - The
localization module 290 b present in the onlineHD map system 110 collects data describing tracks from various vehicle computing systems and evaluates various localization variants on each track to build thelocalization index 940. Thelocalization module 290 b sends at least a portion of thelocalization index 940 to individual autonomous vehicles. The subset may be determined based on the configuration of individual autonomous vehicle. For example, if an autonomous vehicle has specific sensor configurations, the localization variants relevant to those sensor configurations are sent to the autonomous vehicle and localization variants based on sensor configurations that are not present in the autonomous vehicle skipped. - In an embodiment, the
localization module 290 b present in the onlineHD map system 110 exports a subset of thelocalization index 940, for example, to a file and transmits the file to an autonomous vehicle for storage in thelocalization module 290 a present in thevehicle computing system 120 of that autonomous vehicle. Thelocalization module 290 a present in thevehicle computing system 120 of an autonomous vehicle uses the localization variants while driving to select specific localization variants based on driving context, for example, the geographical region in which the autonomous vehicle is driving and uses the localization variants to perform localization for the autonomous vehicle. As the autonomous vehicle is driving, the autonomous vehicle may move from one geographical region to another. Accordingly, the autonomous vehicle changes the localization variants used for localization as the geographical region or other attributes of the driving context change. - The
localization variants module 910 stores instructions and parameters for several localization variants. Thelocalization variants module 910 stores instructions for localization techniques. For example, for each localization technique, thelocalization variants module 910 stores a set of executable instructions such as one or more functions or methods that implement the localization technique. Thelocalization variants module 910 identifies parameters that are relevant to a localization technique and stores sets of values of these parameters. A localization technique receives as input a map and sensor data received by a vehicle and identifies the location of the vehicle in the map based on the sensor data. - The various localization techniques may be added to the
localization module 290 manually, for example, by an expert. The executable instructions for the various localization techniques may be stored on secondary storage, for example, a disk, or solid state drive (SSD) and loaded by thelocalization module 290. Thelocalization module 290 may either pre-load the instructions for various localization techniques or load them in a lazy fashion, as needed. - A localization technique may be based on odometry that represents the process of estimating the motion of the vehicle relative to the vehicle's position based on sequential sensor data received by the vehicle. The
localization module 290 may use odometry to assist in initializing position of the vehicle for use by a localization technique in performing its local search. Thelocalization module 290 may also use odometry to estimate velocity and acceleration of the vehicle as a way to extrapolate the vehicle position in between sensor readings that may be used to localize. For example, if localization fails, thelocalization module 290 falls back to odometry to estimate motion from a previously known pose based on IMU or vehicle control signals. - Another localization technique is lidar based localization. Localization variants based on lidar based localization include ground/non-ground variations that perform separate processing for ground based features vs. non-ground features; lidar based localization that processes all points vs. high intensity points; lidar based localization that performs color matching; lidar based localization that separated hardscape (hard surfaces such as buildings) vs. softscape (vegetation); and so on.
- Another localization technique uses edgels for localization. Accordingly the system identifies edgels in sensor data, for example, camera images and uses the edgels match objects in sensor data with objects in the OMap to determine the location of the vehicle. Systems and techniques for determining edgels are described in the U.S. patent application Ser. No. 16/161,035, filed on Oct. 15, 2018, which is hereby incorporated by reference in its entirety. A variation of edgel based localization technique process ground points separately from non-ground points. Another variation of edgel based localization technique separately processes hardscape and softscape.
- Another localization technique is feature-based localization that detects features using sensor data such as camera images and lidar scans and compares the features with features in the HD map to determine the location of the vehicle. Another localization technique uses image-based odometry to determine location of the vehicle. Variations of image-based odometry determine location of the vehicle by comparing different features extracted from camera images with map for example, ground textures, image features, edges, and so on. Another localization technique uses lidar-based odometry to determine location of the vehicle. Variations of lidar-based odometry use one of pairwise iterative closest point (ICP) or multi-scan ICP. Variants of all the above techniques are obtained by changing various parameters such as iteration limits, search radius, lorentzian weighting, and so on. Other localization techniques include global navigation satellite system (GNSS) based localization and inertial measurement unit (IMU) based odometry. Variants of these techniques use different integration methods and various correction methods.
- The
localization index 940 stores a mapping from driving contexts to localization variants. In an embodiment, thelocalization index 940 represents a spatial index that maps geographical regions to localization variants. In an embodiment, thelocalization module 290 defines a default localization variant for a geographical region. Thelocalization module 290 receives and stores polygons that define transition zones, for example, as defined by experts. These polygons may be relatively small in area, for example entrance on and exits off the highway. Thelocalization module 290 identifies transition points in the geographical region by evaluating various localization variants and identifying areas were the default variant breaks down. The transition points can also be identified by knowing what types of issues cause the default variant problems. If the vehicle is in the transition zone T1 using a localization variant L1, it continues using localization variant L1 until it enters a transition zone T2 where it switches to another localization variant L2. - The
localization index 940 may store an association between lane elements and localization variants that perform well on that lane element. In an embodiment the localization index stores coordinates, for example, latitude and longitude of some locations and corresponding localization variants that have high performance in a geographical region surrounding the coordinates. - In some embodiments,
localization index 940 stores data so as to save space by clustering geographical regions that have similar localization variants. For example, if 3 samples within a few meters of each other share the same set of localization variants, thelocalization index 940 stores the set of localization variants once for a location that is the average of the cluster of locations. Alternatively, thelocalization index 940 stores a representation of the set of localization variants that is shared by all these geographical regions. - The localization
variant selection module 920 selects one or more localization variants when the autonomous vehicle is driving. The localizationvariant selection module 920 receives sensor data and other context information from the autonomous vehicle and uses thelocalization index 940 to select the localization variants. - The localization
index generation module 930 evaluates different localization variants for each driving context and identifies one or more localization variants to be used in the geographical region. The driving context comprises information describing a current track of the autonomous vehicle, i.e., an instance during which the autonomous vehicle is driving along a portion of a route. A driving context may be represented as a tuple that has various elements such as geographical region, time of day, weather condition, speed of autonomous vehicle, angular velocity of the autonomous vehicle, and so on. - The localization
index generation module 930 executes each localization variant for each driving context and compares it against a ground truth, for example, the pose of the autonomous vehicle determined using an HD map obtained by aligning data from various tracks. A track represents information describing a drive of an autonomous vehicle through a route. Since each autonomous vehicle collects and stores sensor data as the vehicle drives, the sensor data can be used at a later stage to execute various localization variants, whether or not the autonomous vehicle used the localization variant during the drive. In an embodiment, the HD map system executes the instructions of a localization variant by varying the error in the initial guesses. - The localization
index generation module 930 evaluates performance of a localization variant based on various criteria including: (1) a measure of accuracy indicating how accurately the localization variant worked (the measure of accuracy could be in meters); (2) a measure of robustness in meters indicating how prone to local minima is the localization variant (the measure indicating a size of the basin of attraction corresponding to the local minima); (3) a measure of computation cost of the localization variant indicating how expensive it was to compute the result; and (4) a measure of how well the localization variant works when the autonomous vehicle is turning as compared to when the autonomous vehicle is driving straight ahead. In an embodiment, the localizationindex generation module 930 determines a score based on each of the above factors and determines a score representing a performance of the localization variant as a weighted aggregate of the individual scores for the factors. - In an embodiment, the
localization module 290 uses Kalman filtering to fuse localization and odometry inputs optimally. Thelocalization module 290 receives uncertainty estimates from each input source (localization, odometry, IMU, GPS, controller area network (CAN) bus) for use for the Kalman Filter. The Kalman filter integrates multiple inputs and results from multiple localization techniques to estimate location. - In an embodiment, the
localization module 290 stores representation of localization strategies for driving contexts or for specific geographical regions. The localization strategy comprises the localization variants that perform well in a driving context. Thelocalization module 290 uses a storage efficient mechanism for storing the localization strategy that stores a localization variant ID for each class of localization/odometry. The different classes of Localization/Odometry include: lidar localization, lidar odometry, Camera localization, Camera odometry, GPS (or GNSS) localization, IMU odometry). Thelocalization module 290 may use one byte for each localization variant, thereby storing the localization strategy using as many bytes as the classes of localization/odometry, for example, 6 bytes if each variant ID fits in 8 bits and there are 6 classes of localization/odometry. - Systems and methods for representations of lanes and route generation for an autonomous vehicle using HD map data are described in the U.S. patent application Ser. No. 15/853,614 filed on Dec. 22, 2017, which is hereby incorporated by reference in its entirety.
-
FIG. 10 illustrates the process for performing localization for a vehicle, according to an embodiment. The steps described may be performed in an order different from that indicated herein. The steps may be performed by modules other than those indicated herein. - The
localization module 290 stores a plurality of localization variants. In an embodiment, thelocalization variant module 910 of thelocalization module 290stores 1010 instructions for various localization techniques and parameter values for various localization variants. The HDmap system stores 1020 information describing various driving contexts. The system builds 1030 a localization index mapping driving contexts to localization variants. The localization index stores a mapping from each driving context to one or more localization variants based on a measure of performance of each localization variant in the driving context. An autonomous vehicle uses the localization index to determine the location of the autonomous vehicle as the autonomous vehicle is driving. The system navigates by determining control signals for the autonomous vehicle based on the determined location and sending 1060 control signals to the controls of the autonomous vehicle. -
FIG. 11 illustrates the process for building localization index, according to an embodiment. The steps described may be performed in an order different from that indicated herein. The steps may be performed by modules other than those indicated herein. - The
localization module 290 repeats the following steps for each driving context, or for a subset of driving contexts. Thelocalization module 290 determining a measure of performance for each of the plurality of localization variants (or a subset of the plurality of localization variants). Thelocalization module 290 determines performance of a localization variant by determining a location of a vehicle based on a track data such as sensor data (or previous drives of vehicles on a route). Thelocalization module 290 determines an actual pose of the vehicle based on results obtained via alignment of various track data. The pose of the vehicle determined via alignment of multiple tracks is referred to as alignment pose. The alignment pose is treated as ground truth against which thelocalization module 290 compares results of localization based on individual localization variants. Systems and methods for performing global alignment of data collected from sensors of vehicles for determining poses of vehicles are described in the U.S. patent application Ser. No. 15/857,602 filed on Dec. 28, 2017, which is hereby incorporated by reference in its entirety. - The
localization module 290ranks 1120 the plurality of localization variants based on the measure of performance of the localization variants. Thelocalization module 290 selects 1130 one or more localization variants for the driving context based on the ranking. Thelocalization module 290 stores 1140 a mapping from the driving context to the corresponding localization variants in the localization index. -
FIG. 12 illustrates the process for performing localization based on the localization index, according to an embodiment. The steps described may be performed in an order different from that indicated herein. The steps may be performed by modules other than those indicated herein. - An autonomous vehicle repeats the following steps while driving. The autonomous vehicle could repeat these steps multiple times a second. The autonomous vehicle receives 1210 sensor data captured by sensors of the autonomous vehicle. The autonomous vehicle determines using on the sensor data, a driving context in which the autonomous vehicle is currently driving. For example, the driving context may describe the geographical region in which the autonomous vehicle is driving.
- The autonomous vehicle determines 1220 an approximate location of the autonomous vehicle based on the sensor data. The autonomous vehicle identifies 1230 the geographical region in which the autonomous vehicle is currently driving based on the approximate location. For example, each geographical region may be represented as a polygon. The
localization module 290 determines whether the current location of the autonomous vehicle falls within a polygon representing a geographical region. In an embodiment, thelocalization module 290 uses a previous geographical region in which the autonomous vehicle was driving to narrow the search for geographical regions. For example, the HD map system stores associations between adjacent geographical regions. Thelocalization module 290 uses these associations to identify geographical regions neighboring the previous geographical region. Thelocalization module 290 limits the search for the geographical region to the set of geographical regions neighboring the previous geographical region in which the autonomous vehicle was driving. Thelocalization module 290 may first verify if the current location continues to lie within the previous geographical region before performing a search for a new geographical region. In an embodiment, the HD map system stores information describing the direction in neighboring geographical regions are present with respect to a geographical region, for example, north, south, east, west, and so on. Thelocalization module 290 tracks the direction in which the vehicle autonomous vehicle is driving based on information received from sensors, for example, IMU or GNSS. Thelocalization module 290 further narrows the search for geographical regions to geographical regions that neighbor the previous geographical region along the direction in which the autonomous vehicle is travelling. - The autonomous vehicle selects 1240 one or more localization variants corresponding to the driving context comprising the geographical region using the localization index. The autonomous vehicle determines 1250 an accurate location of the autonomous vehicle using the localization variant. The autonomous vehicle navigates based on the location of the autonomous vehicle. For example, the
control module 225 may determine control signals for navigating the autonomous vehicle using the current location of the autonomous vehicle and send the control signals to controls of the autonomous vehicle. - The autonomous vehicle may determine control signals for navigating the autonomous vehicle using the current location of the autonomous vehicle and the data of the HD map. The autonomous vehicle navigates the autonomous vehicle based on the control signals.
- For example, the autonomous vehicle may identify the lane in which the vehicle is currently driving and may decide to change the lane based on the location, for example, if the autonomous vehicle needs to turn left/right within a short distance. As another example, the autonomous vehicle may determine based on the location that a stop sign is approaching and the autonomous vehicle needs to slow down to come to a stop.
- In an embodiment the localization index stores coordinates, for example, latitude and longitude of some locations and corresponding localization variants that have high performance in a geographical region surrounding the coordinates. The
localization module 290 determines the stored coordinates that are closest to the current location of the autonomous vehicle and uses the localization variants corresponding to the stored coordinates for determining the location of the autonomous vehicle. - The HD map system may receive and store different version of the same localization techniques, for example, as localization techniques evolve. The HD map system may have to recompute the mapping from a geographical region to corresponding localization variants if there are following changes: (1) changes in the HD map data associated with the geographical region, for example, if a new structure such as a building or a tree is added or deleted from the HD map data; (2) changes to the parameters used by a localization technique; (3) changes in the executable machine instructions corresponding to a localization techniques. The
localization index 940 stores (1) the version of the HD map data against which a mapping from a geographical region and a localization variant was computed (2) the sensor configuration used in the data that was localized to the map to compute the mapping (this includes a configuration name and version of the sensors and a change in configuration (i.e., a change in a sensor or sensor position/orientation); (3) the version of the localization technique used to compute the mapping. Thelocalization index 940 stores a version of the HD map used along with the mapping data. Accordingly, if an autonomous vehicle that has map version X and binary version Y (referring to the version of executable files of the vehicle computing system 120), thelocalization module 290 ensures that the localization variants used were mapped to the geographical region using HD map data version X and binary version Y. - The localization strategy may differ between different sensor configurations in the same geographical region or driving context. As a result the
localization module 290 needs to evaluate each localization variant for each sensor configuration. In order to manage the combinatorial explosion, thelocalization module 290 analyzes a given area of a map and identify what type of localization strategies for a given sensor configuration would be optimal. - In an embodiment, the
localization module 290 analyzes correlations between different sensor configurations across geographical regions. Iflocalization module 290 determines high correlation across sensor configurations, thelocalization module 290 evaluates a geographical region with one sensor configuration and maps the results for other sensor configuration which are correlated. This allows thelocalization module 290 to evaluate fewer sensor configurations for localization variants. - In an embodiment, the
localization module 290 analyzes characteristics of the geographical regions and uses the characteristics to predict localization variants that work best. Characteristics of geographical region include whether the region is suburban or urban, the types of highway (urban or rural), if the geographical region is rural, whether the region has forests or agriculture, whether there are bridges, tunnels, whether the geographical region is flat, hilly, windy, and so on. In an embodiment, thelocalization module 290 builds a map that identifies these characteristics of each geographical region. Thelocalization module 290 determines optimal localization variants for each type of geographical region having a set of characteristics. When thelocalization module 290 receives a new geographical region, thelocalization module 290 determines the characteristics of the geographical region and determines the localization variants to use based on the characteristics. Accordingly the driving context includes various characteristics of geographical regions rather than individual geographical regions. Thelocalization module 290 determines the characteristics of a geographical region and identifies a driving context that matches the characteristics of the geographical region. Thelocalization module 290 identifies the localization variants to use for that driving context and uses them to perform localization. - In an embodiment, the driving context further includes the sensor configuration details. Accordingly, the
localization module 290 maps combinations of characteristics of geographical regions and sensor configurations to localization variants. - The
localization module 290 matches characteristics of a geographical to the same characteristics of an area in our ground truth data sets. We would compute optimal localization strategies for all of the ground truth data sets. Then for a new map, we would walk through the map and identify each area's best matching area in the ground truth set (e.g., an area with buildings and narrow streets vs an area with trees and a curving road). With such a mapping, we can map an area in a map to a set of localization strategies for each kind of sensor configuration that we keep track of. - Although embodiments are described in connection with autonomous vehicles, the techniques described herein can be used by other types of vehicles, for example, vehicles that are driven by human drivers. Furthermore, embodiments of the invention may be used for other types of navigable machines, for example, robots, ships, drones, airplanes, and the like.
- In an embodiment, the
localization module 290 uses machine learning based techniques such as deep learning and neural networks to build thelocalization variant index 940 and to perform localization. Thelocalization module 290 uses deep learning to characterize types of regions where certain localization variants work best. Thelocalization module 290 uses a training data set comprising the samples based on tracks representing past instances of autonomous vehicles driving through various geographical regions. Thelocalization module 290 uses previously determine performance of various localization variants as expected scores for localization variants. In one embodiment, thelocalization module 290 trains a deep learning based model, for example, a neural network such as a multilayered perceptron configured to receive an encoding of a geographical region as input and determine a score for a localization variant. The score indicates a measure of performance, for example, a high score may indicate that the localization variant performs well and a low score indicates that the localization variant performs poorly. In another embodiment, thelocalization module 290 the trained deep learning based model receives an encoding of a geographical region as input and predicts a localization variant that performs well in that geographical region. The encoding of the geographical region may comprise HD map data for the geographical region. Alternatively, the encoding of the geographical region may comprise a low resolution map that describes various structures of the geographical region such as building, tunnels, bridges as well as physical features such as rivers, hills, altitude of different points, and so on. Thelocalization module 290 uses the deep learning based model to build thelocalization variant index 940, for example, to determine localization variants for geographical regions where there is insufficient track data based on vehicles driving through the geographical region. - The
localization module 290 tests the performance of the deep learning based model to see if the accuracy of the results predicted is at least above a threshold value. Thelocalization module 290 tests the performance by taking a map of one or more geographical regions, performing a brute force analysis of localization variants by measuring the performance of various localization variants, and various sensor configurations for each localization variant. Thelocalization module 290 executes the deep learning based model to determine the best performing localization variants or to determine a score for a particular localization variant. - The
localization module 290 compares the results of the brute force execution with the predictions of the deep learning based model and determine error statistics. Thelocalization module 290 measures the net loss in performance to determine whether the deep learning based model is usable in particular geographical regions. - If the
localization module 290 determines that the deep learning based model has poor performance and is unable to predict the best localization variant, thelocalization module 290 identifies the geographical regions where the model is inaccurate. Accordingly, the localization module switches to performing brute force analysis of evaluation of performance of all localization variants and different sensor configurations in those regions. However, in regions where the deep learning based model is accurate, thelocalization module 290 is able to use the deep learning based model in those regions thereby saving computational resources by not having to perform brute force analysis. - Although the above embodiments describe a deep learning based model, the above analysis can also be performed with other machine learning based models, for example, machine learning based models. For example, the
localization module 290 extract specific features of the geographical regions and provides them as input to the machine learning based model. The machine learning based model predicts one or more localization variants that perform well for the input geographical region or the machine learning based model determines a score for a particular localization variant indicating the performance of the localization variant in the geographical region. Examples of features of a geographical region include types of structures present in the geographical region such as building, tunnels, bridges as well as features describing physical features such as rivers, hills, altitude of different points, and so on. - Although the above embodiments describe machine learning based models that receive description of a geographical region, the techniques apply to other types of driving context, for example, speed of the autonomous vehicle, time of day, weather conditions, angular velocity, and so on. Accordingly, the input to the models can be an encoding of a general driving context or specific features of the driving context, depending on the type of model.
- In an embodiment, the
localization module 290 collects statistics based on analysis of localization variants. Examples of statistics collected includes convergence radius, covariance of localization result, and error stats for the specific localization result. From the localization statistics thelocalization module 290 builds a map of a measure of confidence in the localization variant at each point in the map. This provides a useful visualization that helps a user identify problem areas and make improvements in the process. For each sample, thelocalization module 290 determines the best-case localization variant's result and uses that as a value for the sample's location in the map. Thelocalization module 290 creates a visualization that shows a color-coded representation of the map, for example, a map with red indicating high error and green indicating low error. Red areas would indicate locations that need further investigation, for example, analysis of other localization variants. The map of confidence values also acts as a measure of a level of trust in localization results at specific locations. The map of confidence values allows the HD Map system to optimally integrate multiple localization results from different localization variants corresponding to different sensor modalities. In an embodiment, the HD map system integrates results from different localization variants using Kalman filtering. The results of each of the localization variants weighted based on their respective convergence confidence. In an embodiment, the HD map system determines measures of covariance across pairs of localization variants based on different sensors. The HD map system uses the measures of covariances for integrating results from different localization variants using Kalman filtering. - The confidence map can also be used to generate hotspots for locations in the HD map that needs further inspection and analysis. Localization error may be high due to various reasons. For example, localization error may be high due to insufficient constraints in the sensor data (e.g., due to lack of vertical structure in the direction of travel, or everything being uniformly flat). Localization error may be high due to errors in the sensor data, for example, due to a software or hardware failure. Localization error may be high due errors in the OMap including: (1) badly aligned sample that may affect the localization results by having part of the map misaligned resulting in ambiguous results when localizing; (2) A temporal object (e.g., a car, cyclist or pedestrian) which should have been removed from the OMap but was not; these objects which are not permanent possibly cause a localization error when a similar object is close to that same position in the sample being localized; (3) missing data in the OMap, for example, due to a data collection problem before OMap construction (e.g., the sensor for the vehicle was obstructed in that location) or because data just not collected for that part of the map.
- In situations where there is high localization error, the OMap needs to be analyzed by an expert or automatically to determine whether to fix a problem (e.g., add missing data) or identify scenarios that need additional localization variant analysis. In an embodiment, the
localization module 290 analyses the data of the confidence map by filtering points based on certain threshold, clustering the remaining points with some maximum radius (say 10m), and creating review tasks for each cluster. Thelocalization module 290 may display the review tasks via a user interface or send via some communication mechanism to a user/expert for analysis. For example, a user may visually inspect such regions and determine a subsequent action needed. - The number of localization variants can be infinite due to parameter variations. The system prunes the parameter space to reduce number of effective localization variants. This may be performed using experiments with a localization technique and comparing results over a wide range of parameters and eventually narrowing down to combinations of parameter sets that are most effective. This may result in a few lOs or so localization variants for a specific localization technique which is manageable for further analysis. In an embodiment, the
localization module 290 prunes localization variants that are very likely to perform poorly in a given driving context. Thelocalization module 290 may mark these localization variants for the geographical regions. Accordingly, thelocalization module 290 is able to eliminate these localization variants immediately from any analysis, thereby saving computational resources. If thelocalization module 290 determines that a localization variant performs well for only a small percentage of tracks, thelocalization module 290 may further analyze those cases. If thelocalization module 290 identifies another variant that performs close to the best for a driving content and is generally applicable, thelocalization module 290 marks the variant as disposable and records a description of the resolution with that variant's evaluation results. For the winning variants, thelocalization module 290 may further create and evaluate a number of variations of those localization variant making smaller variations to the critical parameters (i.e., smaller than the initial variation from the preceding set of variants). Thelocalization module 290 evaluates those localization variants to re-evaluate the winning localization variants as well a losing localization variants that need to be pruned. - Different sensor modalities have different convergence regions and covariances of the solution depending on the dimensions along which localization performs well. For example, in a particular geographical region, convergence confidence for localization variants based on GPS signal may be high compared to those based on lidar scans, whereas in another geographical region the convergence confidence for localization variants based on lidar scans may be high compared to those based on GPS signals. In an embodiment, the HD map system stores a measure of convergence confidence and covariance of localization variants for each geographical region. For example, HD map system determines the rate of convergence of localization variants for different tracks in each geographical region. The HD map system determines the measure of convergence confidence based on an aggregate rate of convergence of localization variants for each type of sensor for different tracks in each geographical region.
- In an embodiment, the HD map system integrates results from localization variants using the precomputed covariances and a Kalman filter. When the HD map system integrates the localization variants of different sensor modalities, the HD map system uses the confidence values to determine which localization variants are more reliable and in which directions. In an embodiment, the HD map system determines measures of covariance across pairs of localization variants based on different sensors. The HD map system uses the measures of covariances for integrating results from different localization variants using Kalman filtering.
-
FIG. 13 is a block diagram illustrating components of an example machine able to read instructions from a machine-readable medium and execute them in a processor (or controller). Specifically,FIG. 13 shows a diagrammatic representation of a machine in the example form of acomputer system 1300 within which instructions 1324 (e.g., software) for causing the machine to perform any one or more of the methodologies discussed herein may be executed. In alternative embodiments, the machine operates as a standalone device or may be connected (e.g., networked) to other machines. In a networked deployment, the machine may operate in the capacity of a server machine or a client machine in a server-client network environment, or as a peer machine in a peer-to-peer (or distributed) network environment. - The machine may be a server computer, a client computer, a personal computer (PC), a tablet PC, a set-top box (STB), a personal digital assistant (PDA), a cellular telephone, a smartphone, a web appliance, a network router, switch or bridge, or any machine capable of executing instructions 1324 (sequential or otherwise) that specify actions to be taken by that machine. Further, while only a single machine is illustrated, the term “machine” shall also be taken to include any collection of machines that individually or jointly execute
instructions 1324 to perform any one or more of the methodologies discussed herein. - The
example computer system 1300 includes a processor 1302 (e.g., a central processing unit (CPU), a graphics processing unit (GPU), a digital signal processor (DSP), one or more application specific integrated circuits (ASICs), one or more radio-frequency integrated circuits (RFICs), or any combination of these), amain memory 1304, and astatic memory 1306, which are configured to communicate with each other via abus 1308. Thecomputer system 1300 may further include graphics display unit 1310 (e.g., a plasma display panel (PDP), a liquid crystal display (LCD), a projector, or a cathode ray tube (CRT)). Thecomputer system 1300 may also include alphanumeric input device 1312 (e.g., a keyboard), a cursor control device 1314 (e.g., a mouse, a trackball, a joystick, a motion sensor, or other pointing instrument), astorage unit 1316, a signal generation device 1318 (e.g., a speaker), and anetwork interface device 1320, which also are configured to communicate via thebus 1308. - The
storage unit 1316 includes a machine-readable medium 1322 on which is stored instructions 1324 (e.g., software) embodying any one or more of the methodologies or functions described herein. The instructions 1324 (e.g., software) may also reside, completely or at least partially, within themain memory 1304 or within the processor 1302 (e.g., within a processor's cache memory) during execution thereof by thecomputer system 1300, themain memory 1304 and theprocessor 1302 also constituting machine-readable media. The instructions 1324 (e.g., software) may be transmitted or received over anetwork 1326 via thenetwork interface device 1320. - While machine-
readable medium 1322 is shown in an example embodiment to be a single medium, the term “machine-readable medium” should be taken to include a single medium or multiple media (e.g., a centralized or distributed database, or associated caches and servers) able to store instructions (e.g., instructions 1324). The term “machine-readable medium” shall also be taken to include any medium that is capable of storing instructions (e.g., instructions 1324) for execution by the machine and that cause the machine to perform any one or more of the methodologies disclosed herein. The term “machine-readable medium” includes, but not be limited to, data repositories in the form of solid-state memories, optical media, and magnetic media. - The foregoing description of the embodiments of the invention has been presented for the purpose of illustration; it is not intended to be exhaustive or to limit the invention to the precise forms disclosed. Persons skilled in the relevant art can appreciate that many modifications and variations are possible in light of the above disclosure.
- For example, although the techniques described herein are applied to autonomous vehicles, the techniques can also be applied to other applications, for example, for displaying HD maps for vehicles with drivers, for displaying HD maps on displays of client devices such as mobile phones, laptops, tablets, or any computing device with a display screen. Techniques displayed herein can also be applied for displaying maps for purposes of computer simulation, for example, in computer games, and so on.
- Some portions of this description describe the embodiments of the invention in terms of algorithms and symbolic representations of operations on information. These algorithmic descriptions and representations are commonly used by those skilled in the data processing arts to convey the substance of their work effectively to others skilled in the art. These operations, while described functionally, computationally, or logically, are understood to be implemented by computer programs or equivalent electrical circuits, microcode, or the like. Furthermore, it has also proven convenient at times, to refer to these arrangements of operations as modules, without loss of generality. The described operations and their associated modules may be embodied in software, firmware, hardware, or any combinations thereof.
- Any of the steps, operations, or processes described herein may be performed or implemented with one or more hardware or software modules, alone or in combination with other devices. In one embodiment, a software module is implemented with a computer program product comprising a computer-readable medium containing computer program code, which can be executed by a computer processor for performing any or all of the steps, operations, or processes described.
- Embodiments of the invention may also relate to an apparatus for performing the operations herein. This apparatus may be specially constructed for the required purposes, and/or it may comprise a general-purpose computing device selectively activated or reconfigured by a computer program stored in the computer. Such a computer program may be stored in a tangible computer readable storage medium or any type of media suitable for storing electronic instructions, and coupled to a computer system bus. Furthermore, any computing systems referred to in the specification may include a single processor or may be architectures employing multiple processor designs for increased computing capability.
- Finally, the language used in the specification has been principally selected for readability and instructional purposes, and it may not have been selected to delineate or circumscribe the inventive subject matter. It is therefore intended that the scope of the invention be limited not by this detailed description, but rather by any claims that issue on an application based hereon.
Claims (39)
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US16/208,026 US20190204092A1 (en) | 2017-12-01 | 2018-12-03 | High definition map based localization optimization |
US17/375,213 US20220042805A1 (en) | 2017-12-01 | 2021-07-14 | High definition map based localization optimization |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US201762593334P | 2017-12-01 | 2017-12-01 | |
US16/208,026 US20190204092A1 (en) | 2017-12-01 | 2018-12-03 | High definition map based localization optimization |
Related Child Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
US17/375,213 Continuation US20220042805A1 (en) | 2017-12-01 | 2021-07-14 | High definition map based localization optimization |
Publications (1)
Publication Number | Publication Date |
---|---|
US20190204092A1 true US20190204092A1 (en) | 2019-07-04 |
Family
ID=66664609
Family Applications (2)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
US16/208,026 Abandoned US20190204092A1 (en) | 2017-12-01 | 2018-12-03 | High definition map based localization optimization |
US17/375,213 Pending US20220042805A1 (en) | 2017-12-01 | 2021-07-14 | High definition map based localization optimization |
Family Applications After (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
US17/375,213 Pending US20220042805A1 (en) | 2017-12-01 | 2021-07-14 | High definition map based localization optimization |
Country Status (4)
Country | Link |
---|---|
US (2) | US20190204092A1 (en) |
EP (1) | EP3717869A4 (en) |
CN (1) | CN111656135A (en) |
WO (1) | WO2019109082A1 (en) |
Cited By (24)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10820172B2 (en) * | 2018-06-27 | 2020-10-27 | Niantic, Inc. | Multi-sync ensemble model for device localization |
US20210096569A1 (en) * | 2018-07-31 | 2021-04-01 | Komatsu Ltd. | Work machine control system, work machine, and work machine control method |
US20210140789A1 (en) * | 2018-04-20 | 2021-05-13 | Robert Bosch Gmbh | Method and device for determining a highly precise position of a vehicle |
US20210190534A1 (en) * | 2019-12-23 | 2021-06-24 | Robert Bosch Gmbh | Method for providing a digital localization map |
US11143514B2 (en) * | 2019-01-17 | 2021-10-12 | GM Global Technology Operations LLC | System and method for correcting high-definition map images |
CN113494914A (en) * | 2020-04-02 | 2021-10-12 | 宝马股份公司 | Method for vehicle positioning, device for positioning and vehicle |
US11142214B2 (en) * | 2019-08-06 | 2021-10-12 | Bendix Commercial Vehicle Systems Llc | System, controller and method for maintaining an advanced driver assistance system as active |
CN113534222A (en) * | 2020-04-17 | 2021-10-22 | 宝马股份公司 | Method for vehicle positioning, device for vehicle positioning and vehicle |
EP3910291A1 (en) * | 2020-05-15 | 2021-11-17 | Baidu USA LLC | A dynamic parameter server for autonomous driving vehicles |
US20210375135A1 (en) * | 2020-06-02 | 2021-12-02 | Mobile Drive Technology Co.,Ltd. | Method for indicating parking position and vehicle-mounted device |
US20220055643A1 (en) * | 2020-08-19 | 2022-02-24 | Here Global B.V. | Method and apparatus for estimating object reliability |
US11321296B1 (en) * | 2021-01-21 | 2022-05-03 | Nasdaq, Inc. | Dynamically selecting among learned and non-learned indexes for data access |
US11347235B2 (en) * | 2019-04-17 | 2022-05-31 | GM Global Technology Operations LLC | Methods and systems for generating radar maps |
WO2022133253A1 (en) * | 2020-12-18 | 2022-06-23 | Shenzen Gudsen Technology Co., Ltd | Image-based localization module |
US11378405B2 (en) * | 2018-12-20 | 2022-07-05 | Here Global B.V. | Method and apparatus for iterative refinement of parameters of a localization framework |
WO2022153313A1 (en) * | 2021-01-15 | 2022-07-21 | ALMA Technologies Ltd. | System and method for providing localization using inertial sensors |
US11400600B2 (en) * | 2019-03-27 | 2022-08-02 | Lg Electronics Inc. | Mobile robot and method of controlling the same |
US11403816B2 (en) * | 2017-11-30 | 2022-08-02 | Mitsubishi Electric Corporation | Three-dimensional map generation system, three-dimensional map generation method, and computer readable medium |
US11415996B2 (en) * | 2016-09-22 | 2022-08-16 | Volkswagen Aktiengesellschaft | Positioning system for a mobile unit, vehicle and method for operating a positioning system |
US20230032367A1 (en) * | 2021-07-29 | 2023-02-02 | Canon Kabushiki Kaisha | Information processing apparatus and information processing method |
US11613253B2 (en) * | 2019-05-29 | 2023-03-28 | Baidu Usa Llc | Method of monitoring localization functions in an autonomous driving vehicle |
US20230160713A1 (en) * | 2021-11-19 | 2023-05-25 | Here Global B.V. | Method, apparatus and computer program product for identifying work zones within a map |
EP4206738A1 (en) | 2021-12-28 | 2023-07-05 | Yandex Self Driving Group Llc | Method and a server for updating a map representation |
US11859978B2 (en) | 2021-01-15 | 2024-01-02 | ALMA Technologies Ltd. | System and method for estimating a velocity of a vehicle using inertial sensors |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11391578B2 (en) * | 2019-07-02 | 2022-07-19 | Nvidia Corporation | Using measure of constrainedness in high definition maps for localization of vehicles |
US11347231B2 (en) * | 2019-08-07 | 2022-05-31 | Waymo Llc | Object localization for autonomous driving by visual tracking and image reprojection |
CN114253639B (en) * | 2020-09-23 | 2024-06-18 | 丰图科技(深圳)有限公司 | Data caching method, device, computer equipment and storage medium |
CN112484744B (en) * | 2020-12-07 | 2023-05-02 | 广州小鹏自动驾驶科技有限公司 | Evaluation method and device of autonomous parking semantic map |
CN114279433B (en) * | 2021-12-23 | 2024-07-16 | 北京百度网讯科技有限公司 | Automatic map data production method, related device and computer program product |
Family Cites Families (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8060308B2 (en) * | 1997-10-22 | 2011-11-15 | Intelligent Technologies International, Inc. | Weather monitoring techniques |
JP2010530958A (en) * | 2007-05-24 | 2010-09-16 | テレ アトラス ベスローテン フエンノートシャップ | Positioning apparatus, method, and program including absolute positioning mode and relative positioning mode |
US8214139B2 (en) * | 2008-01-25 | 2012-07-03 | Garmin Switzerland Gmbh | Position source selection |
US20090262974A1 (en) * | 2008-04-18 | 2009-10-22 | Erik Lithopoulos | System and method for obtaining georeferenced mapping data |
US20100255856A1 (en) * | 2009-04-03 | 2010-10-07 | Microsoft Corporation | Location Sensing Selection for Mobile Devices |
DE102011006180A1 (en) * | 2011-03-25 | 2012-09-27 | Vodafone Holding Gmbh | Method and system for radio-based localization of a terminal |
US9612343B1 (en) | 2012-06-20 | 2017-04-04 | Sprint Spectrum L.P. | Method and mobile station for using a location determining mechanism based on an extent of turning |
US9298992B2 (en) * | 2014-02-20 | 2016-03-29 | Toyota Motor Engineering & Manufacturing North America, Inc. | Geographic feature-based localization with feature weighting |
EP2921362B1 (en) * | 2014-03-18 | 2020-08-12 | Volvo Car Corporation | Vehicle, vehicle system and method for increasing safety and/or comfort during autonomous driving |
US11125566B2 (en) * | 2015-07-16 | 2021-09-21 | Ford Global Technologies, Llc | Method and apparatus for determining a vehicle ego-position |
EP3156873B2 (en) * | 2015-10-15 | 2023-04-05 | Honda Research Institute Europe GmbH | Autonomous vehicle with improved simultaneous localization and mapping function |
-
2018
- 2018-12-03 WO PCT/US2018/063629 patent/WO2019109082A1/en unknown
- 2018-12-03 US US16/208,026 patent/US20190204092A1/en not_active Abandoned
- 2018-12-03 CN CN201880088229.1A patent/CN111656135A/en active Pending
- 2018-12-03 EP EP18883081.4A patent/EP3717869A4/en not_active Withdrawn
-
2021
- 2021-07-14 US US17/375,213 patent/US20220042805A1/en active Pending
Cited By (34)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11415996B2 (en) * | 2016-09-22 | 2022-08-16 | Volkswagen Aktiengesellschaft | Positioning system for a mobile unit, vehicle and method for operating a positioning system |
US11403816B2 (en) * | 2017-11-30 | 2022-08-02 | Mitsubishi Electric Corporation | Three-dimensional map generation system, three-dimensional map generation method, and computer readable medium |
US12078492B2 (en) * | 2018-04-20 | 2024-09-03 | Robert Bosch Gmbh | Method and device for determining a highly precise position of a vehicle |
US20210140789A1 (en) * | 2018-04-20 | 2021-05-13 | Robert Bosch Gmbh | Method and device for determining a highly precise position of a vehicle |
US10820172B2 (en) * | 2018-06-27 | 2020-10-27 | Niantic, Inc. | Multi-sync ensemble model for device localization |
JP2021524636A (en) * | 2018-06-27 | 2021-09-13 | ナイアンティック, インコーポレイテッドNiantic,Inc. | Multi-sync ensemble model for device localization |
US11540096B2 (en) | 2018-06-27 | 2022-12-27 | Niantic, Inc. | Multi-sync ensemble model for device localization |
US20210096569A1 (en) * | 2018-07-31 | 2021-04-01 | Komatsu Ltd. | Work machine control system, work machine, and work machine control method |
US11378405B2 (en) * | 2018-12-20 | 2022-07-05 | Here Global B.V. | Method and apparatus for iterative refinement of parameters of a localization framework |
US11143514B2 (en) * | 2019-01-17 | 2021-10-12 | GM Global Technology Operations LLC | System and method for correcting high-definition map images |
US11400600B2 (en) * | 2019-03-27 | 2022-08-02 | Lg Electronics Inc. | Mobile robot and method of controlling the same |
US11347235B2 (en) * | 2019-04-17 | 2022-05-31 | GM Global Technology Operations LLC | Methods and systems for generating radar maps |
US11613253B2 (en) * | 2019-05-29 | 2023-03-28 | Baidu Usa Llc | Method of monitoring localization functions in an autonomous driving vehicle |
US11142214B2 (en) * | 2019-08-06 | 2021-10-12 | Bendix Commercial Vehicle Systems Llc | System, controller and method for maintaining an advanced driver assistance system as active |
US11619514B2 (en) * | 2019-12-23 | 2023-04-04 | Robert Bosch Gmbh | Method for providing a digital localization map |
US20210190534A1 (en) * | 2019-12-23 | 2021-06-24 | Robert Bosch Gmbh | Method for providing a digital localization map |
CN113494914A (en) * | 2020-04-02 | 2021-10-12 | 宝马股份公司 | Method for vehicle positioning, device for positioning and vehicle |
CN113534222A (en) * | 2020-04-17 | 2021-10-22 | 宝马股份公司 | Method for vehicle positioning, device for vehicle positioning and vehicle |
EP3910291A1 (en) * | 2020-05-15 | 2021-11-17 | Baidu USA LLC | A dynamic parameter server for autonomous driving vehicles |
US12130142B2 (en) | 2020-05-15 | 2024-10-29 | Baidu Usa Llc | Dynamic parameter server for autonomous driving vehicles |
US20210375135A1 (en) * | 2020-06-02 | 2021-12-02 | Mobile Drive Technology Co.,Ltd. | Method for indicating parking position and vehicle-mounted device |
US11963066B2 (en) * | 2020-06-02 | 2024-04-16 | Mobile Drive Netherlands B.V. | Method for indicating parking position and vehicle-mounted device |
US11702111B2 (en) * | 2020-08-19 | 2023-07-18 | Here Global B.V. | Method and apparatus for estimating object reliability |
US20220055643A1 (en) * | 2020-08-19 | 2022-02-24 | Here Global B.V. | Method and apparatus for estimating object reliability |
WO2022133253A1 (en) * | 2020-12-18 | 2022-06-23 | Shenzen Gudsen Technology Co., Ltd | Image-based localization module |
WO2022153313A1 (en) * | 2021-01-15 | 2022-07-21 | ALMA Technologies Ltd. | System and method for providing localization using inertial sensors |
US11725945B2 (en) | 2021-01-15 | 2023-08-15 | ALMA Technologies Ltd. | System and method for providing localization using inertial sensors |
US11859978B2 (en) | 2021-01-15 | 2024-01-02 | ALMA Technologies Ltd. | System and method for estimating a velocity of a vehicle using inertial sensors |
US11321296B1 (en) * | 2021-01-21 | 2022-05-03 | Nasdaq, Inc. | Dynamically selecting among learned and non-learned indexes for data access |
US20220245116A1 (en) * | 2021-01-21 | 2022-08-04 | Nasdaq, Inc. | Dynamically selecting among learned and non-learned indexes for data access |
US11726974B2 (en) * | 2021-01-21 | 2023-08-15 | Nasdaq, Inc. | Dynamically selecting among learned and non-learned indexes for data access |
US20230032367A1 (en) * | 2021-07-29 | 2023-02-02 | Canon Kabushiki Kaisha | Information processing apparatus and information processing method |
US20230160713A1 (en) * | 2021-11-19 | 2023-05-25 | Here Global B.V. | Method, apparatus and computer program product for identifying work zones within a map |
EP4206738A1 (en) | 2021-12-28 | 2023-07-05 | Yandex Self Driving Group Llc | Method and a server for updating a map representation |
Also Published As
Publication number | Publication date |
---|---|
EP3717869A4 (en) | 2021-09-15 |
US20220042805A1 (en) | 2022-02-10 |
EP3717869A1 (en) | 2020-10-07 |
CN111656135A (en) | 2020-09-11 |
WO2019109082A1 (en) | 2019-06-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US20220042805A1 (en) | High definition map based localization optimization | |
US10845820B2 (en) | Route generation using high definition maps for autonomous vehicles | |
US11727272B2 (en) | LIDAR-based detection of traffic signs for navigation of autonomous vehicles | |
US11340082B2 (en) | Determining localization confidence of vehicles based on convergence ranges | |
US11340355B2 (en) | Validation of global navigation satellite system location data with other sensor data | |
US11209548B2 (en) | Encoding lidar scanned data for generating high definition maps for autonomous vehicles | |
US20240005167A1 (en) | Annotating high definition map data with semantic labels | |
US20210254983A1 (en) | Occupancy map updates based on sensor data collected by autonomous vehicles | |
US11598876B2 (en) | Segmenting ground points from non-ground points to assist with localization of autonomous vehicles | |
US20220412747A1 (en) | Navigable boundary generation for autonomous vehicles | |
US11367208B2 (en) | Image-based keypoint generation | |
US11514682B2 (en) | Determining weights of points of a point cloud based on geometric features | |
US11927449B2 (en) | Using map-based constraints for determining vehicle state | |
WO2021007117A1 (en) | Generating training data for deep learning models for building high definition maps | |
US20230121226A1 (en) | Determining weights of points of a point cloud based on geometric features | |
US20200408533A1 (en) | Deep learning-based detection of ground features using a high definition map | |
US11594014B2 (en) | Annotating high definition map points with measure of usefulness for localization |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
AS | Assignment |
Owner name: DEEPMAP INC., CALIFORNIA Free format text: ASSIGNMENT OF ASSIGNORS INTEREST;ASSIGNOR:WHEELER, MARK DAMON;REEL/FRAME:051528/0755 Effective date: 20191206 |
|
STPP | Information on status: patent application and granting procedure in general |
Free format text: NON FINAL ACTION MAILED |
|
STPP | Information on status: patent application and granting procedure in general |
Free format text: RESPONSE TO NON-FINAL OFFICE ACTION ENTERED AND FORWARDED TO EXAMINER |
|
STPP | Information on status: patent application and granting procedure in general |
Free format text: FINAL REJECTION MAILED |
|
STCB | Information on status: application discontinuation |
Free format text: ABANDONED -- FAILURE TO RESPOND TO AN OFFICE ACTION |
|
AS | Assignment |
Owner name: NVIDIA CORPORATION, CALIFORNIA Free format text: ASSIGNMENT OF ASSIGNORS INTEREST;ASSIGNOR:DEEPMAP INC.;REEL/FRAME:061038/0311 Effective date: 20210825 |