Navigation equipment which determines current position dependent on difference between calculated value of self-contained navigation and measured value of radio navigation

• US 5,422,639 A
• Filed: 09/16/1993
• Issued: 06/06/1995
• Est. Priority Date: 09/16/1992
• Status: Expired due to Term

• Current Assignee: Xanavi Informatics Corporation (Hitachi, Ltd.)
• Original Assignee: Xanavi Informatics Corporation (Hitachi, Ltd.)
• Inventors: Hirayama, Yoshikazu, Kobayashi, Yoshiyuki
• Primary Examiner(s): Swarthout, Brent
• Application Number:
  US08/122,867
• Time in Patent Office: 628 Days
• Field of Search: 364/449, 364/443, 342/357, 342/457, 340/988, 340/990, 340/995
• US Class Current: 340/988
• CPC Class Codes: G01C 21/28 with correlation of data from several navigational instruments

Abstract

In a case where a flag delivered from a self-contained navigation processor indicates that a position measured by the self-contained navigation processor lies on or in the vicinity of a road contained in road map information, a position correction processor selects and delivers the measured position of the self-contained navigation processor as an output current position. In any other case, the position correction processor calculates the distance between a position measured by a radio navigation processor and the position measured by the self-contained navigation processor. On condition that the distance between the coordinates of the two positions has, at least, a predetermined value, the position correction processor decides the measured position of the radio navigation processor as a current position, and it corrects to the current position a drive starting coordinate point which is managed by the self-contained navigation processor.

Claims

1. A navigation equipment which is installed on a mobile object in order to produce a current position of the mobile object as an output, comprising:

radio navigation means for measuring the current position of said mobile object on the basis of electric waves received from artificial satellites;

azimuth measurement means for measuring a traveling azimuth of said mobile object on the basis of at least one of an angular velocity and a geomagnetic angle;

distance measurement means for measuring a driven distance of said mobile object;

memory means for storing road map information therein;

self-contained navigation means for estimating one of said current position of said mobile object and a drive history thereof up to a current time by use of the traveling azimuth measured by said azimuth measurement means and the driven distance measured by said distance measurement means up to the current time since a given drive starting position, and then collating one of the estimated current position or the estimated drive history with the road map information read out of said memory means, thereby determining a current position of said mobile object; and

position correction means for delivering the determined current position of said self-contained navigation means as the final current position in a case where said determined current position of said self-contained navigation means and the measured current position of said radio navigation means do not differ in excess of a predetermined distance, and for delivering said measured current position of said radio navigation means as the final current position and also giving said self-contained navigation means said measured current position of said radio navigation means as a new drive starting point in a case where the determined and measured current positions differ in excess of the predetermined distance, said position correction means collates said determined current position of said self-contained navigation means with said road map information, thereby deciding if said determined current position lies either on or in the vicinity of a road; and

upon deciding that said determined current position lies either on or in the vicinity of the road, said position correction means delivers said determined current position of said self-contained navigation means as said final current position and does not give said self-contained navigation means said measured current position of said radio navigation means as the new drive starting point even in the case where said determined and measured current positions differ in excess of said predetermined distance.

2. A navigation equipment as defined in claim 1, wherein said position correction means obtains a history of the current positions which have been measured by said radio, navigation means;

and on condition that the current positions indicated by the obtained history is discrete, said position correction means delivers said determined current position of said self-contained navigation means as said final current position and does not give said self-contained navigation means said measured current position of said radio navigation means as said new drive starting point even in said case where said determined and measured current positions differ in excess of said predetermined distance.

3. A navigation equipment as defined in claim 1, further comprising:

drive velocity measurement means for measuring a drive velocity of said mobile object;

said radio navigation means also measuring a moving direction of said mobile object on the basis of the electric waves received from said artificial satellites; and

azimuth correction means for deciding if the measured drive velocity of said drive velocity measurement means has, at least, a predetermined value, in the case where said position correction means delivers the measured final current position of said radio navigation means and also gives said self-contained navigation means said measured current position of said radio navigation means as said new drive starting point; and

for correcting said azimuth measurement means by delivering the measured moving direction of said radio navigation means as a current traveling azimuth, on condition that said measured drive velocity has, at least, the predetermined value.

4. A navigation equipment as defined in claim 2, further comprising:

drive velocity measurement means for measuring a drive velocity of said mobile object;

said radio navigation means also measuring a moving direction of said mobile object on the basis of the electric waves received from said artificial satellites; and

azimuth correction means for deciding if the measured drive velocity of said drive velocity measurement means has, at least, a predetermined value, in the case where said position correction means delivers the measured final current position of said radio navigation means and also gives said self-contained navigation means said measured current position of said radio navigation means as said new drive starting point; and

for correcting said azimuth measurement means by delivering the measured moving direction of said radio navigation means as a current traveling azimuth, on condition that said measured drive velocity has, at least, the predetermined value.

5. A navigation equipment which is installed on a mobile object in order to produce a current position of the mobile object as an output, comprising:

radio navigation means for measuring the current position of said mobile object on the basis of electric waves received from artificial satellites;

azimuth measurement means for measuring a traveling azimuth of said mobile object on the basis of at least one of an angular velocity and a geomagnetic angle;

distance measurement means for measuring a driven distance of said mobile object;

memory means for storing road map information therein;

self-contained navigation means for estimating one of said current position of said mobile object and a drive history thereof up to a current time by use of the traveling azimuth measured by said azimuth measurement means and the driven distance measured by said distance measurement means up to the current time since a given drive starting position, and then collating one of the estimated current position or the estimated drive history with the road map information read out of said memory means, thereby determining a current position of said mobile object; and

position correction means for delivering the determined current position of said self-contained navigation means as the final current position in a case where said determined current position of said self-contained navigation means and the measured current position of said radio navigation means do not differ in excess of a predetermined distance, and for delivering said measured current position of said radio navigation means as the final current position and also giving said self-contained navigation means said measured current position of said radio navigation means as a new drive starting point in a case where the determined and measured current positions differ in excess of the predetermined distance, said position correction means collates said determined current position of said self-contained navigation means with said road map information, thereby deciding if said determined current position lies either on or in the vicinity of a road;

upon deciding that said determined current position lies either on or in the vicinity of the road, said position correction means further decides a probability at which said determined current position lies either on or in the vicinity of said road according to the current positions measured by said self-contained navigation means during a period of predetermined time length up to said current time; and

upon deciding that the probability has, at least, a predetermined magnitude, said position correction means delivers said determined current position of said self-contained navigation means as said final current position and does not give said self-contained navigation means said measured current position of said radio navigation means as the new drive starting point even in the case where said determined and measured current positions differ in excess of said predetermined distance.

6. A navigation equipment as defined in claim 5, wherein said self-contained navigation means calculates a ratio of a distance over which said mobile object is estimated to be either on or in the vicinity of said road and a predetermined distance, from a history which contains said determined current position of said self-contained navigation means and the current positions determined by said self-contained navigation means during a time period up to said current time since a point of time traced back from said current time a length of time corresponding to the predetermined distance;

and it delivers the calculated ratio as said probability.

7. A navigation equipment as defined in claim 5, wherein said self-contained navigation means calculates a ratio of a distance over which said mobile object is estimated to be either on or in the vicinity of said road and a predetermined distance, from a history which contains said determined current position of said self-contained navigation means and the current positions determined during a time period up to said current time since a point of time traced back from said current time a length of time corresponding to the predetermined distance;

on condition that said determined current position of said self-contained navigation means does not lie either on or in the vicinity of said road, said self-contained navigation means subtracts from the ratio a value corresponding to either of a driven distance or a drive time period from a spot at which said mobile object is decided as having last lain either on or in the vicinity of said road; and

said self-contained navigation means delivers a result of the subtraction as said probability.

8. A navigation equipment as defined in claim 5, wherein said position correction means obtains a history of the current positions which have been measured by said radio navigation means;

and on condition that the current positions indicated by the obtained history is discrete, said position correction means delivers said determined current position of said self-contained navigation means as said final current position and does not give said self-contained navigation means said measured current position of said radio navigation means as said new drive starting point even in said case where said determined and measured current positions differ in excess of said predetermined distance.

9. A navigation equipment as defined in claim 5, further comprising:

drive velocity measurement means for measuring a drive velocity of said mobile object;

said radio navigation means also measuring a moving direction of said mobile object on the basis of the electric waves received from said artificial satellites; and

azimuth correction means for deciding if the measured drive velocity of said drive velocity measurement means has, at least, a predetermined value, in the case where said position correction means delivers the measured final current position of said radio navigation means and also gives said self-contained navigation means said measured current position of said radio navigation means as said new drive starting point; and

for correcting said azimuth measurement means by delivering the measured moving direction of said radio navigation means as a current traveling azimuth, on condition that said measured drive velocity has, at least, the predetermined value.

10. A navigation equipment as defined in claim 8, further comprising:

drive velocity measurement means for measuring a drive velocity of said mobile object;

said radio navigation means also measuring a moving direction of said mobile object on the basis of the electric waves received from said artificial satellites; and

azimuth correction means for deciding if the measured drive velocity of said drive velocity measurement means has, at least, a predetermined value, in the case where said position correction means delivers the measured final current position of said radio navigation means and also gives said self-contained navigation means said measured current position of said radio navigation means as said new drive starting point; and

for correcting said azimuth measurement means by delivering the measured moving direction of said radio navigation means as a current traveling azimuth, on condition that said measured drive velocity has, at least, the predetermined value.