Apparatus for generating a heading signal for a land vehicle

• US 4,734,863 A
• Filed: 03/06/1985
• Issued: 03/29/1988
• Est. Priority Date: 03/06/1985
• Status: Expired due to Term

• Current Assignee: Tele Atlas North America (TomTom NV)
• Original Assignee: Etak, Inc. (TomTom NV)
• Inventors: Milnes, Kenneth A., Honey, Stanley K., Zavoli, Walter B.
• Primary Examiner(s): Chin, Gary
• Application Number:
  US06/708,741
• Time in Patent Office: 1,119 Days
• Field of Search: 364/449, 364/450, 364/454, 364/457, 364/460, 364/559, 364/571, 364/572, 340/988, 340/995, 33/356, 33/361
• US Class Current: 701/207
• CPC Class Codes: G01C 21/28 with correlation of data from several navigational instruments
• CPC Class Codes: G01C 22/025 Differential odometers

Abstract

Disclosed is an apparatus generating accurate data regarding the heading of a land vehicle as it travels over terrain having changing conditions. The apparatus includes a first sensor means, such as a differential odometer, generating data regarding the relative direction of the vehicle. Also included is a second sensor means, such as a flux gate compass, for generating data regarding the absolute direction of the vehicle relative to the earth. The relative directional data and the absolute directional data are combined in a means for generating accurate data regarding the heading of the vehicle. A means for reducing errors reflected in signals generated by the sensors is provided to insure the accuracy of the output.

Claims

1. An apparatus for generating data regarding a heading of a land vehicle, comprising:

a plurality of sensor means for generating respectively a plurality of independent direction signals including heading information indicating a heading of the land vehicle, said plurality of independent direction signals respectively including errors having essentially independent spectral characteristics; and

processing means, responsive to said plurality of independent direction signals, for generating an estimated heading of the land vehicle including

means, responsive to a filter control signal, for filtering a subset of said plurality of independent direction signals according to the spectral characteristics of the errors included in at least one direction signal included in the subset; and

means for generating said filter control signal in response to a parameter indicating an estimated error magnitude of the errors in at least one of the direction signals in the subset.

2. The apparatus of claim 1, wherein the subset includes one direction signal from the plurality of independent direction signals.

3. The apparatus of claim 1, wherein the subset includes all of the direction signals from the plurality of independent direction signals.

4. An apparatus for generating data regarding a heading of a land vehicle, comprising:

a plurality of sensor means for generating respectively a plurality of independent direction signals including head information indicating a heading of the land vehicle, wherein said plurality of said independent direction signals includes errors; and

processing means, responsive to said plurality of independent direction signals, for generating an estimated heading of the land vehicle including

filter means, responsive to a filter control signal, for reducing the effects of said errors; and

means for generating said filter control signal in response to a parameter indicating an estimated error magnitude of a subset of said plurality of direction signals.

5. The apparatus of claim 4, wherein the subset includes one direction signal from the plurality of independent direction signals.

6. The apparatus of claim 4, wherein the subset includes all of the direction signals from the plurality of independent direction signals.

7. An apparatus for generating data regarding a heading of a land vehicle, comprising:

first sensor means for generating a first direction signal including heading information indicating a heading of the land vehicle and errors having primarily first spectral characteristics;

second sensor means for generating a second direction signal including heading information indicating a heading of the land vehicle and errors having primarily second spectral characteristics that are different from said first spectral characteristics; and

processing means, responsive to said first and second direction signals, for generating an estimated heading of the land vehicle, including

first means for combining said first direction signal and said second direction signal to generate a combined error signal essentially isolating said first and second errors from said heading information;

filter means for filtering said combined error signal according to filter characteristics approximating said first spectral characteristics to generate a filtered error signal including essentially said second errors; and

second means for combining said filtered error signal and said second direction signal to offset said second errors and thereby provide the estimated heading.

8. The apparatus of claim 7, wherein said filter means includes

means, responsive to a filter control signal, for varying said filter characteristics;

and

means for generating said filter control signal in response to said first direction signal and said second direction signal.

9. An apparatus for generating data regarding a heading of a land vehicle, comprising:

first means for generating a relative direction signal having a heading component indicating a heading direction for the land vehicle relative to a prior heading of the land vehicle and an error component;

second means for generating an absolute direction signal having a heading component indicating a heading direction for the land vehicle relative to the earth and an error component; and

processing means, responsive to said absolute direction signal and said relative direction signal, for generating an estimated heading of the vehicle, including

filter means, responsive to a filter control signal, for filtering said error components in said absolute direction signal and said relative direction signal to reduce said error components; and

means for generating said filter control signal in response to a parameter indicating an estimated magnitude of the error component in at least one of said absolute direction signal and said relative direction signal.

10. The apparatus of claim 9, wherein:

said parameter indicates an estimated magnitude of a combination of the error components of said relative direction signal and said absolute direction signal.

11. The apparatus of claim 9, wherein said second means comprises:

compass means for generating a compass signal indicating the heading of the land vehicle relative to the magnetic field of the earth.

12. The apparatus of claim 9, wherein said second means comprises:

compass means for generating a compass signal indicating the heading of the land vehicle relative to the magnetic field of the earth and including a magnitude component; and

further including

means for generating said parameter by detecting fluctuations in said magnitude component of said compass signal relative to the expected magnitude of the magnetic field of the earth.

13. The apparatus of claim 12, wherein said means for generating said parameter includes:

means for receiving the magnitude component of the compass signal generated by said compass means;

means for storing a table of expected magnitudes of the magnetic field of the earth for a set of directions;

means for comparing the magnitude component of the compass signal generated by said compass means with the expected magnitude of the magnetic field of the earth from said table to generate a difference signal; and

means responsive to said difference signal to generate said parameter.

14. The apparatus of claim 10, wherein said second means comprises:

compass means for generating a compass signal having a directional component indicating the heading of the land vehicle; and

further including

means for combining said relative direction signal and the directional component of said compass signal to generate a combined error signal; and

means for generating a deviation statistic over a sequence of signal measurements indicating deviation of said combined error signal from an average over said sequence of signal measurements; and

means responsive to said deviation statistic for generating said parameter.

15. The apparatus of claim 9, wherein said first sensor means comprises:

differential odometer sensor means for generating said relative direction signal.

16. The apparatus of claim 9, wherein said first means comprises:

differential odometer sensor means for generating said relative direction signal; and

further including

means for generating said parameter by measuring the velocity and ratio of turn of said vehicle.

17. The apparatus of claim 9, wherein said second means comprises:

compass means for generating compass heading data indicating the heading of the land vehicle relative to the direction of the magnetic field of the earth;

means for providing a map data base including entries identifying a street segment and a predicted heading of a land vehicle on the street segment identified in the entry;

selector means, responsive to a selection signal, for selecting said compass heading data or a predicted heading in a map data base entry as said absolute direction signal; and

selector control means for supplying said selection signal.

18. The apparatus of claim 17, wherein said selector control means is responsive to a first parameter, and further including:

means for generating the first parameter in response to the difference between an estimated heading of the land vehicle and the predicted heading identified in a map data base entry.

19. The apparatus of claim 17, wherein said selector control means is responsive to a first parameter, and the map data base entries further include an error flag that is set when the compass heading data is expected to be inaccurate for the street segment identified in the entry, and further including:

means for supplying the error flag as said first parameter for selection of said predicted heading identified in the map data base entry when the vehicle is located on the street segment.

20. The apparatus of claim 17, wherein said selector control means is responsive to a first parameter, and further including:

means for storing data identifying map data base entries identifying street segments in geographic locations having characteristics which cause said compass means to be inaccurate; and

means for supplying said first parameter for selection of said predicted heading identified in the map data base entry when the vehicle is located within one of said geographic locations.

21. The apparatus of claim 17, further including:

a vehicle navigation system for locating the land vehicle; and

said selection signal is supplied to said vehicle navigation system as a parameter used in locating the land vehicle.

22. The apparatus of claim 9, wherein said second means comprises:

compass means for generating compass heading data indicating heading of the land vehicle relative to the direction of the magnetic field of the earth;

means for providing a map database including entries identifying a street segment and a predicted heading of a land vehicle on the street segment;

means, in communication with the compass means and the means for providing a map database and responsive to a control signal for supplying said absolute direction signal based on the compass heading data, and a predicted heading identified in a map database entry; and

control means for supplying said control signal.

23. The apparatus of claim 17, further including:

means for supplying to the selector means an entry in the map data base that identifies the street segment on which the land vehicle is located.

24. An apparatus for generating data regarding a heading of a land vehicle, comprising:

first means for generating a relative direction signal having a heading component indicating a heading direction for the land vehicle relative to a prior heading of the land vehicle and an error component;

second means for generating an absolute direction signal having a heading component indicating a heading direction for the land vehicle relative to the earth and an error component; and

processing means, responsive to said absolute direction signal and said relative direction signal, for generating an estimated heading of the vehicle, including

filter means, responsive to a filter control signal, for filtering high frequency errors from said absolute direction signal and low frequency errors from said relative direction signal; and

means for generating said filter control signal in response to a plurality of parameters indicating an estimated accuracy of said second means and said first means.

25. An apparatus for generating data regarding a heading of a land vehicle, comprising:

first means for generating a relative direction signal having a heading component indicating a heading direction for the land vehicle relative to a prior heading of the land vehicle and an error component;

second means for generating an absolute direction signal having a heading component indicating a heading direction for the land vehicle relative to the earth and an error component; and

processing means, responsive to said absolute direction signal and said relative direction signal, for generating an estimated heading of the vehicle, including

first means for combining said relative direction signal and said absolute direction signal to generate a combined error signal indicating the difference between said relative direction signal and said absolute direction signal;

filter means for filtering relatively high frequency errors from said combined error signal to generate a filtered error signal; and

second means for combining said filtered error signal and said relative direction signal to generate an estimated heading of the land vehicle.

26. In a vehicle navigation system for automatically tracking a motor vehicle movable over a given area identified by a map, an apparatus for generating an estimated heading of the motor vehicle, comprising:

first means for generating a relative direction signal including heading information indicating a heading direction of the motor vehicle relative to a prior heading of the motor vehicle and including first errors;

second means for generating an absolute direction signal including heading information indicating a heading direction for the motor vehicle relative to the earth and including second errors, said second means including

compass means for generating compass heading data indicating the heading of the motor vehicle relative to the earth,

means for providing a map data base including entries, each identifying a street segment and a predicted heading of a motor vehicle on the street segment,

means, in communication with said compass means and said means providing a map data base and responsive to a control signal, said compass heading data or a predicted heading identified in a map data base entry, for supplying said absolute direction signal, and

means, for supplying said control signal;

first combining means for subtracting said relative direction signal from said absolute direction signal to generate a combined error signal;

filter means, responsive to a filter control signal, for filtering said combined error signal to essentially cancel said second errors and generate a filtered error signal, said filter means including

means for generating said filter control signal in response to at least one parameter indicating the estimated magnitude of at least one of said first and second errors; and

second combining means for adding said filtered error signal to said relative direction signal to essentially cancel said first errors in said relative direction signal to generate the estimated heading of the motor vehicle.

27. An apparatus for generating an estimated heading of a land vehicle, comprising:

first means for generating a relative direction signal having a heading component indicating a heading direction for the land vehicle relative to a prior heading of the land vehicle and an error component;

second means for generating an absolute direction signal having a heading component indicating a heading direction for the land vehicle relative to the earth and an error component;

processing means, in communication with the first means and the second means, for generating the estimated heading of the land vehicle including

means, responsive to a parameter, for assigning weights to the relative direction signal and the absolute direction signal;

means for combining the relative direction signal and the absolute direction signal according to the assigned weights, and

means for supplying the parameter in response to an estimated magnitude of the error component of one of said absolute direction signal or relative direction signal.

28. The apparatus of claim 27, wherein said means for generating said parameter is further responsive to the estimated magnitude of the error components of both the absolute direction signal and the relative direction signal.

29. An apparatus for generating data regarding a heading of a land vehicle, comprising:

a plurality of sensor means for generating respectively a plurality of independent direction signals including heading information indicating a heading of the land vehicle, said plurality of independent direction signals respectively including errors having essentially independent characteristics; and

processing means, responsive to said plurality of independent direction signals, for generating an estimated heading of the land vehicle including

means responsive to a filter control signal for filtering a subset of said plurality of independent direction signals according to the characteristics of the errors including in at least one direction signal included in the subset; and

means for genrating said filter control signal in response to a parameter indicating a selected characteristic of errors in at least one of the direction signals in the subset.