Method and apparatus for detecting vehicle location for a vehicle navigation system

• US 5,523,765 A
• Filed: 06/09/1994
• Issued: 06/04/1996
• Est. Priority Date: 06/10/1993
• Status: Expired due to Term

• Current Assignee: Alpine Electronics Incorporated (Alps Alpine Co., Ltd.)
• Original Assignee: Alpine Electronics Incorporated (Alps Alpine Co., Ltd.)
• Inventors: Ichikawa, Shigeru
• Primary Examiner(s): Issing, Gregory C.
• Application Number:
  US08/255,617
• Time in Patent Office: 726 Days
• Field of Search: 342/357, 342/451, 342/457, 364/424.01, 364/424.02, 364/449, 340/995
• US Class Current: 342/451
• CPC Class Codes: G01C 21/30 Map- or contour-matching

Abstract

Accurate detection of an existing link (current road location between two road nodes) of a vehicle by an on-board navigation system. Upon each periodic detection of the position, azimuth and velocity of the vehicle by a GPS receiver, all the links within a predetermined distance of the vehicle position are extracted by looking up road data read out from a CD-ROM. For each of the links, the distance from the vehicle position, the angle with the vehicle azimuth, the angle between the vehicle azimuth and a passable direction of the link, the difference between the vehicle velocity and the speed limit for the link and the connectability with the last-detected existing link are obtained and are substituted into a predetermined existential probability evaluation function to calculate an existential probability. The link with the largest existential probability is determined to be the existing link. This existing link and guide route data in a guide route memory are collated to determine any deviation from the guided route. If a deviation has occurred, a warning character sequence pattern is generated and displayed on a map image on a screen.

Claims

1. A method for detecting an existing link of a vehicle for vehicle navigation, the existing link being a road segment on which the vehicle is currently located, comprising the steps of:

receiving at the vehicle positioning signals;

determining vehicle position, vehicle azimuth, and vehicle velocity from the received signals;

for each determination of the vehicle position, vehicle azimuth and vehicle velocity;

(a) extracting all the links within a predetermined distance of the vehicle position by looking up road data;

(b) for each of the extracted links, obtaining information representing a relation between the vehicle position and the extracted link based on said vehicle position, vehicle azimuth and vehicle velocity relative to a speed limit of the link;

(c) substituting the obtained information into an existential probability evaluation function to calculate an existential probability;

(d) determining a link with the largest existential probability to be the existing link; and

(e) indicating a location of the vehicle to be on the existing link.

2. A method for detecting an existing link of a vehicle for vehicle navigation, the existing link being a road segment on which the vehicle is currently located, comprising the steps of:

receiving at the vehicle positioning signals;

determining vehicle position, vehicle azimuth, and vehicle velocity from the received signals;

for each determination of the vehicle position, vehicle azimuth and vehicle velocity;

(a) extracting all the links within a predetermined distance from the vehicle position by looking up road data;

(b) for each of the extracted links, obtaining;

a distance from the vehicle position to the link;

an angle formed between the vehicle azimuth and the link;

a speed difference between the vehicle velocity and the speed limit of the link; and

a connectability between a last-detected existing link and a present link;

(c) substituting the results of step (b) into a predetermined existential probability evaluation function to calculate an existential probability;

(d) determining a link with the largest existential probability to be the existing link; and

(e) indicating a location of the vehicle to be on the existing link.

3. A method for detecting the existing link of a vehicle according to claim 2, wherein said existential probability evaluation function is a sum of the distance, the angle, the speed difference, and the connectability.

4. A method for detecting the existing link of a vehicle according to claim 2, wherein, if said existential probability is lower than a predetermined value, determination of the existing link with respect to the vehicle position is not performed.

5. A method for detecting the existing link of a vehicle according to claim 2, wherein said distance from the vehicle position to the link is calculated as the length of a perpendicular drawn from the vehicle position to the link.

6. A method for detecting the existing link of a vehicle according to claim 2, wherein said first angle formed between the vehicle azimuth and the link is obtained by measuring the direction of the link with respect to the vehicle azimuth.

7. A method for detecting the existing link of a vehicle according to claim 2, wherein said angle between the vehicle azimuth and the link is obtained by measuring a passable direction of the link with respect to the vehicle azimuth.

8. A method for detecting the existing link of a vehicle according to claim 7, wherein said passable direction of the link is the direction along which travel is permitted according to traffic control data in the road data.

9. A method for detecting the existing link of a vehicle according to claim 8, wherein, if no traffic control data exists for the link, the angle between the vehicle azimuth and the passable direction of the link is obtained by measuring the direction of the link with respect to the vehicle azimuth without regard to the passable direction of the link.

10. A method for detecting the existing link of a vehicle according to claim 2, wherein said connectability between the detected existing link and the present link is obtained on the basis of a crossing traffic control data and a traffic control data.

11. A method for detecting the existing link of a vehicle according to claim 2, wherein said speed limit, traffic control data and crossing traffic control data are obtained from a system external to the vehicle.

12. A method for detecting an existing link of a vehicle for vehicle navigation, the existing link being a road segment on which the vehicle is currently located, comprising the steps of:

receiving at the vehicle positioning signals;

determining vehicle position, vehicle azimuth, vehicle velocity from the received signals;

for each determination of the vehicle position, vehicle azimuth and vehicle velocity;

extracting all the links within a predetermined distance from the vehicle position by looking up road data;

for each of the extracted links obtaining the length of a perpendicular drawn from the vehicle position to the link as a distance from the vehicle position to the link;

measuring the direction of the link with respect to the vehicle azimuth to obtain a first angle formed between the vehicle azimuth and the link;

measuring a passable direction of the link with respect to the vehicle azimuth to obtain a second angle between the vehicle azimuth and the passable direction of the link, wherein the passable direction of the link is the direction along which travel is permitted;

obtaining a speed difference between the vehicle velocity and the speed limit of the link; and

obtaining a connectability between a last-detected existing link and a present link on the basis of crossing traffic control data and traffic control data;

substituting the length, the first angle, the second angle, the speed difference and the connectability into a predetermined existential probability evaluation function to calculate an existential probability;

determining a link with the largest existential probability to be the existing link; and

indicating a location of the vehicle to be on the existing link.

13. A method for detecting the existing link of a vehicle according to claim 12, wherein said existential probability evaluation function is a sum of the length, the first angle, the second angle, the speed difference, and the connectability.

14. A vehicle navigation system comprising:

a receiver for receiving positioning signals;

means for determining vehicle position, vehicle azimuth, vehicle velocity from the received signals;

means for extracting all road segment links within a predetermined distance of the determined vehicle position by looking up road data and, for each of the extracted links, for obtaining parameters for;

a distance from the vehicle position to the link;

an angle formed between the vehicle azimuth and the link;

a speed difference between the vehicle velocity and the speed limit of the link; and

a connectability between a last-detected existing link and a present link;

means for substituting the parameters into a predetermined existential probability evaluation function to calculate an existential probability and for determining a link with the largest existential probability to be the existing link; and

means for indicating that the vehicle is located on the existing link.

15. A navigation system according to claim 14, wherein said existential probability evaluation function is a sum of the distance, the angle, the speed difference, and the connectability.

16. A route guiding method for a vehicle obtaining guide route data for an optimal route connecting a start point to a destination by looking up road data containing a crossing network list, said route guiding method comprising the steps of:

receiving positioning signals at the vehicle;

determining vehicle position, vehicle azimuth, vehicle velocity from the received signals;

for each determined vehicle position, vehicle azimuth and vehicle velocity;

extracting all road segment links within a predetermined distance from the determined vehicle position by looking up the road data;

for each of the extracted links obtaining;

a distance from the vehicle position to the link;

an angle formed between the vehicle azimuth and the link;

a speed difference between the vehicle velocity and the speed limit of the link; and

a connectability between a last-detected existing link and a present link; and

substituting the distance, the angle, the speed difference, and the connectability into a predetermined existential probability evaluation function to calculate an existential probability;

determining a link with the largest existential probability to be the existing link;

comparing link information on the existing link and said guide route data to determine whether the vehicle has deviated from the guide route or not; and

indicating whether the vehicle has so deviated.

17. A route guiding method according to claim 16, wherein said existential probability evaluation function is a sum of the distance, the angle, the speed difference, and the connectability.

18. A route guiding method according to claim 16, wherein said link information comprises longitude-latitude coordinates of the two nodes at the two ends of the existing link.

19. A route guiding method according to claim 16, wherein the vehicle is determined as traveling on the guide route if the nodes at each end of the existing link are included in the nodes constituting the guide route data and wherein the vehicle is determined as having deviated from the guide route if either of the nodes at the two ends of the existing link is not included in the nodes constituting the guide route.

20. A route guiding method according to claim 16, wherein a warning is issued when the vehicle is determined as having deviated from the guide route.

21. A method for detecting an existing link of a vehicle for purposes of vehicle navigation, the existing link being a road segment on which the vehicle is currently located, comprising the steps of:

receiving positioning signals at the vehicle;

determining vehicle position, vehicle azimuth, and vehicle velocity from the received signals;

for each determined vehicle position, vehicle azimuth and vehicle velocity;

(a) extracting all road segment links within a predetermined distance of the vehicle position by looking up road data;

(b) for each of the extracted links, obtaining;

a distance from the vehicle position to the link; and

an angle formed between the vehicle azimuth and the link;

wherein said angle between the vehicle azimuth and the link is obtained by measuring a passable direction of the link with respect to the vehicle azimuth, and wherein said passable direction of the link is the direction along which travel is permitted by traffic control data in the road data;

(c) substituting the results of steps (b) into a predetermined existential probability evaluation function to calculate an existential probability;

(d) determining a link with the largest existential probability to be the existing link; and

(d) indicating a location of the vehicle to be on the existing link.

22. A vehicle navigation system comprising:

a receiver for receiving positioning signals;

means for determining vehicle position, vehicle azimuth, vehicle velocity from the received signals;

means for extracting all road segment links within a predetermined distance of the determined vehicle position by looking up road data and, for each of the extracted links, for obtaining parameters for;

a distance from the vehicle position to the link;

an angle formed between the vehicle azimuth and a direction along which travel is permitted on the link; and

a connectability between the last-determined existing link on which the vehicle was located and the present link;

means for substituting the parameters into a predetermined existential probability evaluation function to calculate an existential probability and for determining a link with the largest existential probability to be the existing link; and

means for indicating that the vehicle is located on the existing link.