CN110088573B - Apparatus for determining vehicle position and associated method - Google Patents

Apparatus for determining vehicle position and associated method Download PDF

Info

Publication number
CN110088573B
CN110088573B CN201780078146.XA CN201780078146A CN110088573B CN 110088573 B CN110088573 B CN 110088573B CN 201780078146 A CN201780078146 A CN 201780078146A CN 110088573 B CN110088573 B CN 110088573B
Authority
CN
China
Prior art keywords
vehicle
travel paths
travel
travel path
likelihood
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201780078146.XA
Other languages
Chinese (zh)
Other versions
CN110088573A (en
Inventor
奥利弗·杜斯
安德里·马蒂尼瓦
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Here Global BV
Original Assignee
Here Global BV
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Here Global BV filed Critical Here Global BV
Publication of CN110088573A publication Critical patent/CN110088573A/en
Application granted granted Critical
Publication of CN110088573B publication Critical patent/CN110088573B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/28Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
    • G01C21/30Map- or contour-matching

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Navigation (AREA)

Abstract

An apparatus comprising a processor and a memory containing computer program code, the memory and computer program code configured to, with the processor, enable the apparatus to at least: a current location of a vehicle on a road network including a plurality of different travel paths is determined for each of the different travel paths using a respective recursive bayesian filter, wherein each recursive bayesian filter is configured to compare data received from sensors on the vehicle with predetermined map data for the respective travel path to calculate a probability that the vehicle is currently located on the respective travel path and a probability distribution of possible locations along the travel path.

Description

Apparatus for determining vehicle position and associated method
Technical Field
The present disclosure relates to the field of route navigation, associated methods and apparatus, and in particular to apparatus configured to determine a current location of a vehicle on a road network comprising a plurality of different travel paths using respective recursive Bayesian (Bayesian) filters for each of the different travel paths. Certain disclosed example aspects/embodiments relate to portable or car navigation devices. In-vehicle navigation devices may include hardware having similar characteristics as mobile navigation devices, but typically include less power hardware designed for tasks. In the present case, the portable or car navigation device should be able to access a database (online or offline) containing map data and sensor data from one or more sensors (e.g., GNSS, inertial measurement unit, accelerometer, compass, magnetometer, gyroscope, barometer/altitude sensor, camera, liDAR, RADAR, ultrasonic sensor, etc.).
Background
Research is currently underway to develop improved navigation devices that can provide users with more detailed and accurate information about road networks to further assist route navigation.
One or more aspects/embodiments of the present disclosure may or may not address this issue.
Listing or discussion of a prior-published document or any background in this specification should not be taken as an acknowledgement that the document or background is part of the state of the art or is common general knowledge.
Disclosure of Invention
According to a first aspect, there is provided an apparatus comprising a processor and a memory including computer program code, the memory and computer program code configured to, with the processor, enable the apparatus to at least:
a respective recursive bayesian filter is used for each of the different travel paths to determine a current position of the vehicle on a road network comprising a plurality of different travel paths,
wherein each recursive bayesian filter is configured to compare data received from sensors on the vehicle with predetermined map data for the respective travel path to calculate a probability that the vehicle is currently located on the respective travel path and a probability distribution of possible locations along that travel path.
The apparatus may be configured to determine the plurality of different travel paths.
The apparatus may be configured to map at least one known location of the vehicle with the predetermined map data to determine the plurality of different travel paths.
The apparatus may be configured to extend a travel path based on the predetermined map data when it is determined that the current position of the vehicle is proximal to an end of the travel path.
The apparatus may be configured to determine one or more additional travel paths if the likelihood associated with each of the different travel paths indicates that these travel paths are not sufficiently suitable for the sensor data.
The apparatus may be configured to determine the current location of the vehicle at least in part by excluding any travel paths for which an associated likelihood is below a predefined threshold.
The apparatus may be configured to determine the current location of the vehicle at least in part by excluding any travel paths whose ratio of associated likelihood to likelihood of a most likely travel path is below a predefined threshold.
The apparatus may be configured to determine the current location of the vehicle at least in part by excluding all travel paths outside of a predefined number of travel paths having a highest associated likelihood while preserving any travel paths having an associated likelihood equal to a lowest associated likelihood of remaining travel paths.
The apparatus may be configured to determine the current location of the vehicle as one or more of the possible locations along the travel path having the greatest associated likelihood (e.g., a distributed "expected value").
Each recursive bayesian filter may be a kalman filter configured to generate a gaussian distribution of possible locations along the respective travel path, and wherein the apparatus may be configured to determine the current location of the vehicle as a center of the gaussian distribution associated with the travel path having the greatest associated likelihood.
The apparatus may be configured to normalize the likelihood calculated by the recursive bayesian filter to obtain a probability distribution of the possible travel paths.
Each recursive bayesian filter may be configured to compare the sensor with predetermined map data to include one or more additional physical state variables in the probability distribution.
The one or more additional physical state variables may include at least one of speed, heading, angular speed, odometer scale factor, and gyroscope calibration parameters.
The travel path is unidirectional, and wherein the apparatus may be configured to add the same travel path extending in opposite directions if the heading of the vehicle deviates more than 90 ° from the direction of a particular travel path.
Each recursive bayesian filter may be configured to compare real-time sensor data with the predetermined map data.
The apparatus may be configured to store sensor data after the sensor data has been received, and each recursive bayesian filter may be configured to compare the stored sensor data with the predetermined map data.
The sensors on the vehicle may be one or more of global or regional navigation satellite system receivers (e.g., for NAVSTAR GPS, GLONASS, beidou, galileo, GAGAN, or IRNSS), inertial sensors, cameras, accelerometers, and gyroscopes.
The plurality of different travel paths may be two-dimensional travel paths or three-dimensional travel paths.
The device may be one or more of the following: electronic devices, portable communication devices, mobile phones, personal digital assistants, tablet computers, tablet phones, desktop computers, notebook computers, servers, smartphones, smartwatches, smart glasses, portable satellite navigation devices, in-vehicle satellite navigation devices, and modules for one or more of them.
According to another aspect, there is provided a method comprising:
a respective recursive bayesian filter is used for each of the different travel paths to determine a current position of the vehicle on a road network comprising a plurality of different travel paths,
wherein each recursive bayesian filter is configured to compare data received from sensors on the vehicle with predetermined map data for the respective travel path to calculate a probability that the vehicle is currently located on the respective travel path and a probability distribution of possible locations along that travel path.
The steps of any method disclosed herein do not have to be performed in the exact order disclosed, unless explicitly stated or understood by the skilled artisan.
Corresponding computer programs (which may or may not be recorded on a carrier) for implementing one or more of the methods disclosed herein are also within the present disclosure and encompassed by one or more of the described example embodiments.
The disclosure includes one or more corresponding aspects, example embodiments, or features, alone or in various combinations, whether or not specifically stated (including what is required) in the combinations or alone. Respective means for performing one or more of the discussed functions are within the present disclosure.
The above summary is intended to be merely exemplary and non-limiting.
Drawings
The description is now given, by way of example only, with reference to the accompanying drawings, in which:
FIG. 1 schematically illustrates an apparatus configured to perform one or more methods described herein;
fig. 2a schematically shows an example of a road network;
fig. 2b schematically shows three different travel paths on the road network of fig. 2 a;
fig. 3a schematically shows a probability distribution of possible positions along a particular travel path;
fig. 3b schematically shows a probability distribution of possible positions further along the specific travel path of fig. 3 a;
fig. 4a schematically shows a probability distribution of possible positions on a travel path without drivable deviation;
fig. 4b schematically shows a probability distribution of possible locations at a road intersection;
FIG. 5 schematically illustrates the main steps of the method described herein; and is also provided with
Fig. 6 illustrates a computer-readable medium comprising a computer program configured to perform, control, or implement one or more methods described herein.
Detailed Description
The navigation device needs to be able to determine the current position of the vehicle relative to the map in order to provide route guidance for the driver of the vehicle. This is typically accomplished using one or more on-board sensors, such as Global Navigation Satellite Systems (GNSS), inertial sensors, cameras, accelerometers, and gyroscopes. The latest solutions to this problem include a number of individual steps. First, dead reckoning, which typically combines known reference positions (e.g., from GNSS) with sensor data (e.g., from inertial sensors), is used to determine a trajectory and infer this trajectory when no satellite signals are available (e.g., in a tunnel). Map matching is then performed to correlate the determined trajectory with the most likely travel path on the road network. Since there is often a significant change between the determined trajectory and the most likely travel path (e.g., due to atmospheric conditions or reflections affecting GNSS signals, or drift in dead reckoning), the map-matched position is then fed back to the dead reckoning unit so that it can be used to correct for errors in the trajectory. Finally, if a lane assist system is available, it can be used to track on which lane the vehicle is currently. This module takes as input the number of lanes available on the current road and tracks the lane crossing, which allows tracking the lateral position of the vehicle on the road.
One problem with this approach is that some areas of the road network include adjacent roads, which are indistinguishable from each other based on data from certain on-board sensors. For example, there are situations where a GNSS signal indicates that a vehicle is traveling along an expressway, but in fact it is on a single lane parallel to a particular section of the expressway (or vice versa). In this case, the road guidance provided by the navigation device does not match the current travel path, which is useless to the driver and may create a potential hazard to the driver and other road users (especially considering that different classes of roads typically have different speed limits).
An apparatus and associated method that can address this issue will now be described.
Fig. 1 illustrates a device 101 configured to perform one or more methods described herein. The device 101 may be at least one of the following: electronic devices, portable communication devices, mobile phones, personal digital assistants, tablet computers, tablet phones, desktop computers, notebook computers, servers, smartphones, smartwatches, smart glasses, portable satellite navigation devices, in-vehicle satellite navigation devices, and modules for one or more of them.
In this example, the apparatus 101 includes a processor 102, a memory 103, a transceiver 104, a power source 105, an electronic display 106, and a microphone 107, which are electrically connected to each other by a data bus 108. The processor 102 is configured for general operation of the device 101 by providing signaling to and receiving signaling from other components to manage their operation. The memory 103 is configured to store computer program code configured to perform, control or implement the operations of the device 101. The memory 103 may also be configured to store settings of other components. The processor 102 may access the memory 103 to retrieve component settings in order to manage the operation of other components. The processor 102 may be a microprocessor, including an Application Specific Integrated Circuit (ASIC). Memory 103 may be a temporary storage medium such as a volatile random access memory. Alternatively, memory 103 may be a permanent storage medium, such as a hard disk drive, flash memory, or nonvolatile random access memory.
Transceiver 104 is configured to transmit data to and/or receive data from other devices/apparatuses while power supply 105 is configured to provide power to other components to achieve its functionality, and may include one or more of a power adapter, a battery, a capacitor, a supercapacitor, and a hybrid battery capacitor. Electronic display 106 may be an LED, LCD, or plasma display and is configured to display visual content stored on device 101 (e.g., on a storage medium) or received by device 101 (e.g., via a transceiver). Similarly, microphone 107 is configured to output audio content stored on device 101 or received by device 101. The visual and audio content may include related components of the combined audio visual content. In some examples, the audio and/or visual content may include navigational content (e.g., geographic information and direction of travel, distance, speed, or time).
The methods described herein depart from the above-mentioned methods of fusing multiple sensor inputs to derive a location for subsequent map matching. Instead, the assumption that the vehicle is traveling on the road network is utilized to derive a plurality of different travel paths (or "road tracks") that represent the likelihood that the vehicle must traverse the road network. In this context, the travel path consists of a series of drivable, successive road segments which reflect the trajectory of the vehicle up to now in two or three dimensions. The inventive device may be configured to determine a plurality of different travel paths by map matching at least one known location of the vehicle with predetermined map data. This involves finding a list of road segments in the vicinity of a known location and, for each road segment, creating a travel path that includes the road segment. If the road segment can travel in two directions, two travel paths may be created that extend in opposite directions from each end of the road segment.
Fig. 2a and 2b show a map of the road network indicating an initial position 209 (not necessarily the current position) of the vehicle and three possible travel paths r1-r3 through the road network as determined by the device. As can be seen, the three different travel paths r1-r3 intersect at a common point 210 on a road network, which may be a circular road or an intersection or the like.
After a plurality of different travel paths r1-r3 have been determined, the device is configured to compare data received from the sensor (or sensors) on the vehicle with predetermined map data (e.g., digital maps, street and aerial images, road coordinates, speed limits, road limits, etc.) for each travel path r1-r3 using a respective recursive bayesian filter. For example, the sensor may be a global navigation satellite system receiver and the device may be configured to compare geographic coordinates from satellite data with coordinates of a stored digital map. Similarly, the sensor may be a camera and the device may be configured to compare images recorded by the camera with stored street images taken at various locations on the road network. The latter case may be particularly suitable for detecting lanes or exits on a section of road.
Each recursive bayesian filter calculates the likelihood that the vehicle is currently located on the respective travel path r1-r3, and the probability distribution of possible locations along this travel path r1-r3. Thus, the likelihood is a measure of how well the respective travel paths r1-r3 fit the sensor data. However, in some cases, the likelihood associated with each of the different travel paths r1-r3 may indicate that none of these travel paths r1-r3 are sufficiently suitable for sensor data (e.g., because the likelihood is below a predefined threshold). In this case, the apparatus may be configured to determine one or more additional travel paths. This may be achieved by map matching (as described above) or by considering other travel paths that are close to the existing travel path. In some cases, no additional travel path may fit the sensor data, which may indicate that there is an error in the map data. This error can be resolved by obtaining the latest map data of the road intersection.
While recursive bayesian filters will typically be configured to compare real-time sensor data to predetermined map data to enable determination of the current location of the vehicle, they may use sensor data from a previous portion of the vehicle's trajectory (e.g., which has been stored by the device) to predict the current location. This enables the present method to be used for recursive bayesian smoothing, in addition to or instead of recursive bayesian filtering.
This process is iteratively repeated to ensure that the current location of the vehicle is up-to-date (e.g., in a predefined time step or whenever new sensor data becomes available). The current location of the vehicle may then be determined by considering the likelihood and probability distribution of each recursive bayesian filter. For example, the apparatus may be configured to determine the current location of the vehicle as one or more of the possible locations along the travel path having the greatest associated likelihood.
Fig. 3a and 3b show the probability distributions 311, 312 calculated at two different points on the travel path 313 having the greatest associated likelihood. In this example, each recursive bayesian filter is a kalman filter (but it may be another type of filter, such as an unscented kalman filter) configured to produce a gaussian distribution of possible locations along the respective travel path 313, and the apparatus is configured to determine the current location of the vehicle as the center of the gaussian distribution (as indicated by the star 314). It should be noted that when the determined vehicle position approaches the end of the current road segment 315, the filter may require additional information about the travel path 313 in order to function. In this case, the apparatus is configured to extend the travel path 313 based on predetermined map data when it is determined that the current position of the vehicle is proximal to the end of the travel path 313 (i.e., obtain map data of the next road segment 316 when the vehicle approaches the end of the current road segment 315).
Fig. 4a and 4b show probability distributions 417, 418 calculated at two different points on another travel path 419 (i.e. a separate vehicle track to one travel path shown in fig. 3a and 3 b) with the greatest associated likelihood. In fig. 4a, the travel path 419 is relatively straight and has no drivable deviation (as in fig. 3a and 3 b). However, as the vehicle approaches the end of the current road section 420, the road diverges in different directions, creating two different possible travel paths 421, 422. Thus, the device considers the likelihood of each travel path 421, 422 separately using a respective bayesian filter in order to track vehicle position.
As the vehicle continues to travel along the driver's selected trajectory, more sensor data is obtained and one travel path 421 accumulates more likelihood than the other travel path 422. Thus, it is believed that the driver does not follow the unlikely path 422. As a result, unlikely travel paths 422 and their associated filters may be discarded from analysis. In this way, when less likely paths 422 are excluded, an increase in the number of paths at the intersection is compensated. This allows the amount of data to be processed to be at a manageable level. Indeed, the device may be configured to exclude any travel path for which the associated likelihood is below a predefined threshold; excluding any travel paths whose ratio of the associated likelihood to the likelihood of the most likely travel path is below a predefined threshold; or excluding all travel paths outside of the predefined number of travel paths having the highest associated likelihood while preserving any travel paths having an associated likelihood equal to the lowest associated likelihood of the remaining travel paths.
In some examples, the apparatus may be configured to determine a probability distribution over all possible travel paths instead of a plurality of respective likelihoods. This can be achieved by normalizing the likelihood.If different travel paths have the possibility l 1 ,l 2 ,…,l n The probability distribution is composed of p i The individual probabilities for each path i are defined, wherein:
Figure BDA0002097179970000091
in addition to location, each recursive bayesian filter may be configured to compare the sensor to predetermined map data to include one or more additional physical state variables in the probability distribution depending on which sensors and map data are available. For example, the additional physical state variables may include at least one of speed, heading, angular speed, odometer scale factor, and gyroscope calibration parameters. In this way, the inventive device can determine not only the current position of the vehicle, but also its speed and direction, etc. When the recursive bayesian filter takes into account a plurality of physical state variables, it outputs a joint distribution of all the variables, but this can then be marginalized to obtain a probability distribution for one particular variable, if desired. For example, if a state contains three physical variables x, y, and z, the edge distribution for x can be obtained using the following equation:
p (x) = ≡≡p (x, y, z) dydz equation 2
Additional variables may also be used in the bayesian filter to determine the most likely travel path (e.g., because different travel paths may have different associated shapes and speed limits). One such example is when the heading of the vehicle deviates more than 90 ° from the direction of the particular travel path. In this case, the apparatus may be configured to add the same travel path extending in opposite directions.
Fig. 5 shows the main steps 523 to 525 of the method described herein. The method generally includes: using a respective recursive bayesian filter for each of a plurality of different travel paths on the road network to compare data received from sensors on the vehicle with predetermined map data 523 for the respective travel paths; calculating a probability distribution 524 of the likelihood that the vehicle is currently located on the corresponding travel path and the likely location along the travel path; and determining a current location 525 of the vehicle on the road network.
Fig. 6 illustrates a computer/processor readable medium 626 that provides a computer program according to one embodiment. The computer program may comprise computer code configured to perform, control or implement one or more of the method steps 523 to 525 of fig. 5. The computer/processor readable medium 626 in this example is an optical disc, such as a Digital Versatile Disc (DVD) or a Compact Disc (CD). In other embodiments, the computer/processor readable medium 626 can be any medium that has been programmed in a manner to perform the functions of the present invention. The computer/processor readable medium 626 may be a fixed or removable memory device such as a hard drive, a solid state drive, a memory stick (e.g., a USB memory stick), or a memory card (e.g., compact flash, SD, mini SD, micro SD, or nano SD). The computer code may be installed at the factory where the apparatus (e.g., a portable or in-vehicle satellite navigation device) or a vehicle including the apparatus is assembled. The system may be updated later via the computer/processor readable medium 626 described above.
Other embodiments depicted in the drawings have been provided with reference numerals corresponding to similar features of the previously described embodiments. For example, feature number 1 may also correspond to the numbers 101, 201, 301, etc. These numbered features may appear in the figures, but may not be directly referenced in the description of these particular embodiments. These are still provided in the drawings to aid in understanding other embodiments, particularly with respect to features of similar previously described embodiments.
Those skilled in the art will appreciate that any of the mentioned devices/means and/or other features of the specifically mentioned devices/means may be provided by a device arranged such that they are configured to perform the desired operation only when enabled, e.g. switched on or the like. In such cases, they may not necessarily have the appropriate software loaded into active memory in an inactive (e.g., off state) and only the appropriate software loaded in an active (e.g., on state). The device may include hardware circuitry and/or firmware. The device may include software loaded onto the memory. Such software/computer programs may be recorded on the same memory/processor/functional unit and/or on one or more memory/processor/functional units.
In some embodiments, the particular mentioned device/apparatus may be preprogrammed with the appropriate software to perform the desired operation, and wherein the appropriate software may be enabled for use by a user to download a "key", for example to unlock/enable the software and its associated functionality. Advantages associated with such embodiments may include reduced requirements for downloading data when further functionality is required for the device, and this may be useful in instances where the sensing device has sufficient capacity to store such preprogrammed software to obtain functionality that a user may not be able to enable.
It will be appreciated that any of the mentioned device circuits/elements/processors may have other functions in addition to the mentioned functions, and that these functions may be performed by the same device/circuit/element/processor. One or more of the disclosed aspects may encompass an electronic distribution of an associated computer program and a computer program (which may be source/transport encoded) recorded on a suitable carrier (e.g., memory, signal).
It will be appreciated that any "computer" described herein may include a collection of one or more individual processors/processing elements that may or may not be located on the same circuit board or the same area/location of a circuit board or even on the same device. In some embodiments, one or more of any of the mentioned processors may be distributed across multiple devices. The same or different processors/processing elements may perform one or more functions described herein.
It should be appreciated that the term "signaling" may refer to one or more signals transmitted as a series of transmitted and/or received signals. A series of signals may comprise one, two, three, four or even more individual signal components or different signals used to compose the signaling. Some or all of these individual signals may be transmitted/received simultaneously in sequence and/or so that they overlap each other in time.
With reference to any discussion of any reference to a computer and/or processor and memory (e.g., including ROM, CD-ROM, etc.), these may include a computer processor, an Application Specific Integrated Circuit (ASIC), a Field Programmable Gate Array (FPGA), and/or other hardware components that have been programmed in a manner to perform the functions of the invention.
The applicant hereby discloses in isolation each individual feature described herein and any combination of two or more such features, to the extent that such features or combinations are capable of being carried out based on the present specification as a whole in the light of the common general knowledge of a person skilled in the art, irrespective of whether such features or combinations of features solve any problems disclosed herein; and do not limit the scope of the claims. The applicant indicates that the disclosed aspects/embodiments may consist of any such individual feature or combination of features. It will be apparent to those skilled in the art in view of the foregoing description that various modifications may be made within the scope of the disclosure.
While there have been shown and described and pointed out fundamental novel features of the invention as applied to different embodiments thereof, it will be understood that various omissions and substitutions and changes in the form and details of the devices and methods described may be made by those skilled in the art without departing from the spirit of the invention. For example, it is expressly intended that all combinations of those elements and/or method steps which perform substantially the same function in substantially the same way to achieve the same results are within the scope of the invention. In addition, it should be appreciated that, structures and/or elements and/or method steps shown and/or described in connection with any disclosed form or embodiment may be incorporated in any other disclosed or described or suggested form or embodiment as a general matter of design choice. Furthermore, in the claims means-plus-function clauses (means-plus-function clase) are intended to cover the structures described herein as performing the recited function and not only structural equivalents but also equivalent structures. Thus, although a nail and a screw may not be structural equivalents in that a nail employs a cylindrical surface to secure wooden parts together, whereas a screw employs a helical surface, in the environment of fastening wooden parts, a nail and a screw may be equivalent structures.

Claims (14)

1. An apparatus for navigation comprising a processor and a memory containing computer program code, the memory and computer program code configured to, with the processor, enable the apparatus to at least:
determining a plurality of different travel paths of the vehicle on the road network by map-matching at least one known location of the vehicle with predetermined map data of the road network, each of the plurality of different travel paths comprising a drivable series of consecutive road segments reflecting in two or three dimensions the trajectory of the vehicle so far,
determining a current location of the vehicle on the road network using a respective recursive bayesian filter for each of the different travel paths, each recursive bayesian filter being configured to compare data received from sensors on the vehicle with predetermined map data for the respective travel path to calculate a probability that the vehicle is currently located on the respective travel path and a probability distribution of possible locations along the travel path; and
one or more additional travel paths are determined in the event that the likelihood associated with each of the different travel paths is below a predefined threshold.
2. The apparatus of claim 1, wherein the apparatus is configured to extend the travel path based on the predetermined map data when it is determined that the current position of the vehicle is proximal to an end of travel path.
3. The apparatus of claim 1 or 2, wherein the apparatus is configured to determine the current location of the vehicle at least in part by:
excluding any travel paths for which the associated likelihood is below a predefined threshold;
excluding any travel paths whose ratio of the associated likelihood to the likelihood of the most likely travel path is below a predefined threshold; or (b)
All travel paths outside the predefined number of travel paths having the highest associated likelihood are excluded while any travel paths having an associated likelihood equal to the lowest associated likelihood of the remaining travel paths are retained.
4. The apparatus of claim 1 or 2, wherein the apparatus is configured to determine the current location of the vehicle as one or more of the possible locations along the travel path having the greatest associated likelihood.
5. The apparatus according to claim 4, wherein each recursive bayesian filter is a kalman filter configured to produce a gaussian distribution of possible locations along the respective travel path, and wherein the apparatus is configured to determine the current location of the vehicle as a center of the gaussian distribution associated with the travel path having the greatest associated likelihood.
6. The apparatus according to claim 1 or 2, wherein the apparatus is configured to normalize the likelihood calculated by the recursive bayesian filter to obtain a probability distribution of possible travel paths.
7. The apparatus of claim 1 or 2, wherein each recursive bayesian filter is configured to compare the sensor with predetermined map data to include one or more additional physical state variables in the probability distribution.
8. The apparatus of claim 7, wherein the one or more additional physical state variables comprise at least one of speed, heading, angular speed, odometer scale factor, and gyroscope calibration parameters.
9. The apparatus of claim 8, wherein the travel paths are unidirectional, and wherein the apparatus is configured to add identical travel paths extending in opposite directions if the heading of the vehicle deviates more than 90 ° from a travel direction associated with one of the travel paths.
10. The apparatus of claim 1 or 2, wherein each recursive bayesian filter is configured to compare real-time sensor data with the predetermined map data.
11. The apparatus of claim 1 or 2, wherein the apparatus is configured to store sensor data after it has been received, and each recursive bayesian filter is configured to compare the stored sensor data with the predetermined map data.
12. The apparatus of claim 1 or 2, wherein the plurality of different travel paths comprises two or more travel paths intersecting at a common point on the road network.
13. A computer-implemented method for navigation, comprising:
determining a plurality of different travel paths of the vehicle on the road network by map-matching at least one known location of the vehicle with predetermined map data of the road network, each of the plurality of different travel paths comprising a drivable series of consecutive road segments reflecting in two or three dimensions the trajectory of the vehicle so far,
determining a current location of the vehicle on the road network using a respective recursive bayesian filter for each of the different travel paths, each recursive bayesian filter being configured to compare data received from sensors on the vehicle with predetermined map data for the respective travel path to calculate a probability that the vehicle is currently located on the respective travel path and a probability distribution of possible locations along the travel path; and
one or more additional travel paths are determined in the event that the likelihood associated with each of the different travel paths is below a predefined threshold.
14. A computer readable medium having stored thereon a computer program comprising computer code configured to perform the method of claim 13.
CN201780078146.XA 2016-12-20 2017-12-20 Apparatus for determining vehicle position and associated method Active CN110088573B (en)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
EP16205344.1 2016-12-20
EP16205344.1A EP3339807B1 (en) 2016-12-20 2016-12-20 An apparatus and associated methods for determining the location of a vehicle
PCT/EP2017/083855 WO2018115142A1 (en) 2016-12-20 2017-12-20 An apparatus and associated methods for determining the location of a vehicle

Publications (2)

Publication Number Publication Date
CN110088573A CN110088573A (en) 2019-08-02
CN110088573B true CN110088573B (en) 2023-06-23

Family

ID=57570816

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201780078146.XA Active CN110088573B (en) 2016-12-20 2017-12-20 Apparatus for determining vehicle position and associated method

Country Status (4)

Country Link
US (1) US11493346B2 (en)
EP (1) EP3339807B1 (en)
CN (1) CN110088573B (en)
WO (1) WO2018115142A1 (en)

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP3339807B1 (en) 2016-12-20 2024-03-13 HERE Global B.V. An apparatus and associated methods for determining the location of a vehicle
US10921133B2 (en) * 2017-12-07 2021-02-16 International Business Machines Corporation Location calibration based on movement path and map objects
DE102018206067A1 (en) * 2018-04-20 2019-10-24 Robert Bosch Gmbh Method and device for determining a highly accurate position of a vehicle
EP3882649B1 (en) * 2020-03-20 2023-10-25 ABB Schweiz AG Position estimation for vehicles based on virtual sensor response
US11017347B1 (en) * 2020-07-09 2021-05-25 Fourkites, Inc. Supply chain visibility platform
CN112966059B (en) * 2021-03-02 2023-11-24 北京百度网讯科技有限公司 Data processing method and device for positioning data, electronic equipment and medium
EP4206606A1 (en) * 2021-12-28 2023-07-05 Zenseact AB Hypothesis inference for vehicles

Family Cites Families (57)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0278907A (en) 1988-09-16 1990-03-19 Hitachi Ltd Navigation system using map data and location system for moving body
US5488559A (en) * 1993-08-02 1996-01-30 Motorola, Inc. Map-matching with competing sensory positions
JPH1047982A (en) * 1996-08-06 1998-02-20 Sony Corp Instrument and method for measuring location, device and method for navigation, information service method, and automobile
US5923286A (en) * 1996-10-23 1999-07-13 Honeywell Inc. GPS/IRS global position determination method and apparatus with integrity loss provisions
DE19724919A1 (en) * 1997-06-12 1999-01-07 Adolph Michael Dr Method for generating, merging and updating data usable in a route guidance system
US6192312B1 (en) * 1999-03-25 2001-02-20 Navigation Technologies Corp. Position determining program and method
US6941220B2 (en) * 2000-09-12 2005-09-06 Center Comm Corporation Apparatus and method for vehicle navigation
SE0004096D0 (en) 2000-11-08 2000-11-08 Nira Automotive Ab Positioning system
US20020128768A1 (en) * 2001-03-09 2002-09-12 Nobuyuki Nakano Route guide information distributing system
US6546335B1 (en) * 2001-12-21 2003-04-08 Garmin, Ltd. System, functional data, and methods to bias map matching
US6975939B2 (en) * 2002-07-29 2005-12-13 The United States Of America As Represented By The Secretary Of The Army Mapping patterns of movement based on the aggregation of spatial information contained in wireless transmissions
WO2005010549A2 (en) * 2003-07-23 2005-02-03 Qualcomm Incorporated Selecting a navigation solution used in determining the position of a device in a wireless communication system
CA2583458C (en) * 2004-10-01 2016-02-23 Networks In Motion, Inc. Method and system for enabling an off board navigation solution
WO2007143806A2 (en) * 2006-06-15 2007-12-21 Uti Limited Partnership Vehicular navigation and positioning system
JP4600357B2 (en) * 2006-06-21 2010-12-15 トヨタ自動車株式会社 Positioning device
JP4341649B2 (en) * 2006-07-12 2009-10-07 トヨタ自動車株式会社 Navigation device and position detection method
JP4124249B2 (en) * 2006-07-25 2008-07-23 トヨタ自動車株式会社 Positioning device, navigation system
JP4902733B2 (en) * 2007-03-23 2012-03-21 三菱電機株式会社 Navigation device
US8290648B2 (en) * 2007-06-20 2012-10-16 Denso Corporation Charge-discharge management apparatus and computer readable medium comprising instructions for achieving the apparatus
US7987047B2 (en) * 2007-09-10 2011-07-26 Mitsubishi Electric Corporation Navigation equipment
AU2008316523A1 (en) * 2007-10-26 2009-04-30 Tomtom International B.V. A method of processing positioning data
KR20090058879A (en) * 2007-12-05 2009-06-10 삼성전자주식회사 Apparatus and method for providing position information of wiresless terminal
US8046169B2 (en) * 2008-01-03 2011-10-25 Andrew, Llc System and method for determining the geographic location of a device
US8188917B2 (en) * 2008-02-25 2012-05-29 CSR Technology Holdings Inc. System and method for operating a GPS device in a micro power mode
US7890262B2 (en) * 2008-03-31 2011-02-15 Honeywell International Inc. Position estimation for navigation devices
TWI378223B (en) * 2008-06-24 2012-12-01 Mstar Semiconductor Inc Navigation apparatus and positioning method thereof
US7855683B2 (en) * 2008-11-04 2010-12-21 At&T Intellectual Property I, L.P. Methods and apparatuses for GPS coordinates extrapolation when GPS signals are not available
CN102187178B (en) * 2008-12-22 2015-11-25 电子地图北美公司 For the method for green route selection, device and map data base
US8416129B2 (en) * 2009-04-20 2013-04-09 The Boeing Company Positioning determinations of receivers
CN101696886A (en) * 2009-10-29 2010-04-21 哈尔滨工业大学 Electronic map aided inertial navigation method in GPS dead zone
US8305264B1 (en) * 2010-02-03 2012-11-06 Sprint Spectrum L.P. GPS enhancement for wireless devices
US8645061B2 (en) * 2010-06-16 2014-02-04 Microsoft Corporation Probabilistic map matching from a plurality of observational and contextual factors
US8812014B2 (en) * 2010-08-30 2014-08-19 Qualcomm Incorporated Audio-based environment awareness
EP2698608B1 (en) * 2011-04-11 2015-08-26 Clarion Co., Ltd. Position calculation method and position calculation device
CN102278995B (en) * 2011-04-27 2013-02-13 中国石油大学(华东) Bayes path planning device and method based on GPS (Global Positioning System) detection
KR101074638B1 (en) * 2011-05-04 2011-10-18 한국항공우주연구원 Lane determination method using steering wheel model
US8718932B1 (en) * 2011-06-01 2014-05-06 Google Inc. Snapping GPS tracks to road segments
US9429437B2 (en) * 2012-06-08 2016-08-30 Apple Inc. Determining location and direction of travel using map vector constraints
US9798010B2 (en) * 2012-07-31 2017-10-24 Qualcomm Incorporated Devices, methods, and apparatuses for mobile device acquisition assistance
US9798011B2 (en) * 2012-08-31 2017-10-24 Apple Inc. Fast GPS recovery using map vector data
US9226111B2 (en) * 2012-11-21 2015-12-29 Apple Inc. Pathway matching
US8457880B1 (en) 2012-11-28 2013-06-04 Cambridge Mobile Telematics Telematics using personal mobile devices
EP2972488A1 (en) * 2013-03-15 2016-01-20 Nextnav, LLC Methods and systems for improving time of arrival determination
AU2014339699B2 (en) * 2013-10-24 2019-02-28 Peck Tech Consulting Ltd. Dead reckoning-augmented GPS for tracked vehicles
KR20150058679A (en) * 2013-11-20 2015-05-29 한국전자통신연구원 Apparatus and method for localization of autonomous vehicle in a complex
US9408175B2 (en) * 2014-05-02 2016-08-02 Apple Inc. Positioning accuracy using 3D building models
CN107110651B (en) * 2014-09-08 2021-04-30 应美盛股份有限公司 Method and apparatus for enhanced portable navigation using map information assistance
US9746331B1 (en) * 2014-12-15 2017-08-29 Marvell International Ltd. Method and apparatus for map matching
DE102015205097A1 (en) * 2015-01-15 2016-07-21 Fraunhofer-Gesellschaft zur Förderung der angewandten Forschung e.V. Location device and method for localization
US10126134B2 (en) * 2015-12-21 2018-11-13 Invensense, Inc. Method and system for estimating uncertainty for offline map information aided enhanced portable navigation
US10018474B2 (en) * 2015-12-21 2018-07-10 Invensense, Inc. Method and system for using offline map information aided enhanced portable navigation
CN105716620B (en) * 2016-03-16 2018-03-23 沈阳建筑大学 A kind of air navigation aid based on cloud computing and big data
GB201613105D0 (en) * 2016-07-29 2016-09-14 Tomtom Navigation Bv Methods and systems for map matching
US10281279B2 (en) * 2016-10-24 2019-05-07 Invensense, Inc. Method and system for global shape matching a trajectory
EP3339807B1 (en) 2016-12-20 2024-03-13 HERE Global B.V. An apparatus and associated methods for determining the location of a vehicle
EP3358303B1 (en) * 2017-02-07 2021-09-01 HERE Global B.V. An apparatus and associated methods for use in updating map data
CN112639664B (en) * 2018-07-24 2023-03-24 奇跃公司 Method and device for determining and/or evaluating a positioning map of an image display device

Also Published As

Publication number Publication date
US20200088526A1 (en) 2020-03-19
EP3339807A1 (en) 2018-06-27
US11493346B2 (en) 2022-11-08
CN110088573A (en) 2019-08-02
WO2018115142A1 (en) 2018-06-28
EP3339807B1 (en) 2024-03-13

Similar Documents

Publication Publication Date Title
CN110088573B (en) Apparatus for determining vehicle position and associated method
US10197404B2 (en) Path curve confidence factors
CN107328410B (en) Method for locating an autonomous vehicle and vehicle computer
US10996061B2 (en) Apparatus and associated method for use in updating map data
EP3739512A1 (en) Automatic feature extraction from imagery
US10036639B1 (en) Systems and methods for determining and displaying a route using information determined from a vehicle, user feedback, and a mobile electronic device
US9618344B2 (en) Digital map tracking apparatus and methods
US20150179073A1 (en) Information processing apparatus, information processing method, and information processing system
CN109696177B (en) Device for compensating gyro sensing value, system having the same and method thereof
CN111562603B (en) Navigation positioning method, equipment and storage medium based on dead reckoning
JP5762656B2 (en) Vehicle position display control device and vehicle position specifying program
CN110319850B (en) Method and device for acquiring zero offset of gyroscope
US11796324B2 (en) Vehicle control device
US10289115B2 (en) Automated vehicle map localization based on observed geometries of roadways
EP3647820A1 (en) Method, apparatus, and computer program product for establishing location
US8214149B2 (en) Navigation apparatus and positioning method thereof
Amin et al. A novel vehicle stationary detection utilizing map matching and IMU sensors
JP2008032598A (en) Altitude detector and one's-own-vehicle location determination device
JP2001264091A (en) Navigation system
CN111928863A (en) High-precision map data acquisition method, device and system
US11487025B1 (en) Method for inferring GPS location
US20230048365A1 (en) Corrected trajectory mapping
Krzikalla et al. Safety by self-localisation using satellites, landmarks
Holmström Lane departure warning using low-cost satellite-aided positioning technology on modern highways

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant