US6282496B1
Expired / Lapsed
US
⏱️ 0.0 years remaining
Method and apparatus for inertial guidance for an automobile navigation system
Assignee: TomTom Navigation BV
•
Filing: 1999-10-29
•
Granted: 2001-08-28
•
Expires: 2019-10-29
Abstract
Abstract The present invention discloses an improved vehicular inertial guidance navigation system, a.k.a. a dead reckoning system for navigation of a vehicle. The inertial guidance navigation system which may be used alone or in combination with other position determination means, such as GPS and map databases, to determine the location of a vehicle. The dead reckoning system has several advantages over existing systems. First, it can be easily mounted to the chassis of any vehicle. Second, it does not require any interface with existing sensors on the vehicle. Third, the system contains logic for removing errors in the position and heading determinations, brought about by angulation/rotation of the chassis and inertial guidance sensors, brought about by inclination or tilt of the chassis, with respect to an inertial/quasi-inertial frame of reference, such as the earth. The inertial guidance system includes: an inertial guidance sensor, a translation unit, and a logic unit. The inertial guidance sensor is suitable for coupling to the vehicle. The inertial guidance sensor senses motion of the vehicle in a non-inertial frame of reference and forming a sensor signal corresponding thereto. The translation unit is coupled to receive the sensor signal formed by the inertial guidance sensor. The translation unit translates the sensor signal into a quasi-inertial frame of reference and forms a translated signal corresponding thereto. The logic unit receives the translated signal formed by the translation unit and converts converting the translated signal into an estimated position and heading of the vehicle.
Inventors
- 👤 Mahesh Chowdhary
Bibliographic Details
Application Number
—
Jurisdiction
US
Data Source
google_patents
Last Synchronized
2026-11-09 23:11
CPC Classifications
G; G01; G01C; G01C21/00; G01C21/10; G01C21/12; G01C21/16; G01C21/165; G01C21/26
Claims Analysis
Total Claims: 27
Claim 1
Independent Claim
153 words
An inertial guidance system for navigation of a vehicle having a body plane angle associated therewith, said inertial guidance system comprising: an inertial guidance sensor for coupling to the vehicle, and for sensing motion of the vehicle in a non-inertial frame of reference and forming an angular motion signal and an acceleration signal corresponding thereto; a frame transformation unit coupled to receive the angular motion and acceleration signals, correct the angular motion signal using body plane angle data derived from the acceleration signal, and correct the acceleration signal using a rotation matrix representing the corrected angular motion signal, thereby transforming the angular motion and acceleration signals into a quasi-inertial frame of reference; and a logic unit coupled to receive the corrected angular motion and acceleration signals formed by said frame transformation unit, said logic unit for converting the corrected angular motion and acceleration signals into an estimated position and heading of the vehicle.
Claim 2
Dependent Claim
153 words
An inertial guidance system for navigation of a vehicle having a body plane angle associated therewith, said inertial guidance system comprising: an inertial guidance sensor for coupling to the vehicle, and for sensing motion of the vehicle in a non-inertial frame of reference and forming an angular motion signal and an acceleration signal corresponding thereto; a frame transformation unit coupled to receive the angular motion and acceleration signals, correct the angular motion signal using body plane angle data derived from the acceleration signal, and correct the acceleration signal using a rotation matrix representing the corrected angular motion signal, thereby transforming the angular motion and acceleration signals into a quasi-inertial frame of reference; and a logic unit coupled to receive the corrected angular motion and acceleration signals formed by said frame transformation unit, said logic unit for converting the corrected angular motion and acceleration signals into an estimated position and heading of the vehicle.
Claim 3
Dependent Claim
95 words
The inertial guidance system of claim 1 , wherein the inertial guidance sensor further comprises: an acceleration sensor for coupling to the vehicle, and the acceleration sensor forming a z axis raw acceleration signal and an x axis raw acceleration signal, and the z axis raw acceleration signal corresponding to an acceleration of the vehicle along a z axis substantially normal to a chassis of the vehicle, and the x axis raw acceleration signal corresponding to an acceleration of the vehicle along an x axis substantially aligned with a direction of motion of the vehicle.
Claim 4
Dependent Claim
38 words
The inertial guidance system of claim 1 , wherein the inertial guidance sensor further comprises: an angular rate sensor to measure an angular rotation rate of the vehicle; and an accelerometer to measure an acceleration of the vehicle.
Claim 5
Dependent Claim
32 words
The inertial guidance system for vehicle navigation of claim 3 , wherein the angular rate sensor comprises at least one of: an inclinometer and an angular rate sensor together with an integrator.
Claim 6
Dependent Claim
41 words
The inertial guidance system of claim 1 , wherein the angular motion signal represents angular rotation of the vehicle in a non-inertial frame of reference and the acceleration signal represents an acceleration of the vehicle in a non-inertial frame of reference.
Claim 7
Dependent Claim
48 words
The inertial guidance system for vehicle navigation of claim 1 , wherein the the body plane angle data is derived from the projections into the acceleration signal of at least one of a gravitational constant and a magnitude of a gravity vector at a location of the vehicle.
Claim 8
Dependent Claim
27 words
The inertial guidance system for vehicle navigation of claim 1 , wherein the logic unit comprises at least one of: a Kalman filter and a covariance filter.
Claim 9
Dependent Claim
67 words
The inertial guidance system of claim 5 , wherein the body plane angle data is derived from the projections into the acceleration signal of at least one of a gravitational constant and a magnitude of a gravity vector at a location of the vehicle; and wherein the angular motion signal is corrected in an inertial rotation module by a scale factor corresponding with the body plane angle.
Claim 10
Dependent Claim
37 words
The inertial guidance system for vehicle navigation of claim 8 , wherein in a rotation matrix module the acceleration signal is corrected by matrix multiplication of the rotation matrix and an acceleration matrix representing the acceleration signal.
Claim 11
Dependent Claim
218 words
A hybrid system for navigation of a vehicle having a body plane angle associated therewith, said hybrid system comprising: an inertial guidance sensor for coupling to the vehicle, and for sensing motion of the vehicle in a non-inertial frame of reference and forming an angular motion signal and an acceleration signal corresponding thereto; a frame transformation unit coupled to receive the angular motion and acceleration signals, correct the angular motion signal using body plane angle data derived from the acceleration signal, and correct the acceleration signal using a rotation matrix representing the corrected angular motion signal, thereby transforming the angular motion and acceleration signals into a quasi-inertial frame of reference; a first logic unit coupled to receive the corrected angular motion and acceleration signals formed by said frame transformation unit, said logic unit for converting the corrected angular motion and acceleration signals into a first estimated position and heading of the vehicle; a position and heading determination means for forming a second estimated position and heading of the vehicle; and a second logic unit coupled to receive the first estimated position and heading signal formed by the first logic unit, together with the second estimated position and heading signal formed by said position and heading determination means and for estimating the position and heading of the vehicle therefrom.
Claim 12
Dependent Claim
218 words
A hybrid system for navigation of a vehicle having a body plane angle associated therewith, said hybrid system comprising: an inertial guidance sensor for coupling to the vehicle, and for sensing motion of the vehicle in a non-inertial frame of reference and forming an angular motion signal and an acceleration signal corresponding thereto; a frame transformation unit coupled to receive the angular motion and acceleration signals, correct the angular motion signal using body plane angle data derived from the acceleration signal, and correct the acceleration signal using a rotation matrix representing the corrected angular motion signal, thereby transforming the angular motion and acceleration signals into a quasi-inertial frame of reference; a first logic unit coupled to receive the corrected angular motion and acceleration signals formed by said frame transformation unit, said logic unit for converting the corrected angular motion and acceleration signals into a first estimated position and heading of the vehicle; a position and heading determination means for forming a second estimated position and heading of the vehicle; and a second logic unit coupled to receive the first estimated position and heading signal formed by the first logic unit, together with the second estimated position and heading signal formed by said position and heading determination means and for estimating the position and heading of the vehicle therefrom.
Claim 13
Dependent Claim
29 words
The hybrid system for navigation of a vehicle of claim 10 , wherein said first logic unit comprises at least one of: a Kalman filter and a covariance filter.
Claim 14
Dependent Claim
40 words
The hybrid system for navigation of a vehicle of claim 10 , wherein said second position and heading determination means comprises at least one of: a GPS system, a WAAS system and a map database together with map matching processes.
Claim 15
Dependent Claim
266 words
A hybrid system for navigation of a vehicle, and said hybrid system comprising: an inertial guidance sensor for coupling to the vehicle, and for sensing motion of the vehicle in a non-inertial frame of reference and forming sensor signals corresponding thereto; a frame transformation unit coupled to receive the sensor signals formed by the inertial guidance sensor, said frame transformation unit for transforming the sensor signals into a quasi-inertial frame of reference and forming a first signal corresponding to an acceleration of the vehicle in a quasi-inertial reference frame and an angulation of the vehicle in a quasi-inertial reference frame; a first logic unit coupled to receive the first signal formed by said frame transformation unit, said logic unit for converting the first signal into a first estimated position and heading of the vehicle; a position and heading determination means for forming a second estimated position and heading of the vehicle, said position and heading determination means having a map database together with map matching processes, and said map database including data corresponding to inclinations for each of a plurality of road segments; and a second logic unit coupled to receive the first estimated position and heading signal formed by the first logic unit, together with the second estimated position and heading signal formed by said position and heading determination means and for estimating the position and heading of the vehicle therefrom, wherein said frame transformation unit utilizes said inclinations for a road segment corresponding with a location of the vehicle, for transforming a portion of the first signal corresponding to the angulation of the vehicle.
Claim 16
Dependent Claim
266 words
A hybrid system for navigation of a vehicle, and said hybrid system comprising: an inertial guidance sensor for coupling to the vehicle, and for sensing motion of the vehicle in a non-inertial frame of reference and forming sensor signals corresponding thereto; a frame transformation unit coupled to receive the sensor signals formed by the inertial guidance sensor, said frame transformation unit for transforming the sensor signals into a quasi-inertial frame of reference and forming a first signal corresponding to an acceleration of the vehicle in a quasi-inertial reference frame and an angulation of the vehicle in a quasi-inertial reference frame; a first logic unit coupled to receive the first signal formed by said frame transformation unit, said logic unit for converting the first signal into a first estimated position and heading of the vehicle; a position and heading determination means for forming a second estimated position and heading of the vehicle, said position and heading determination means having a map database together with map matching processes, and said map database including data corresponding to inclinations for each of a plurality of road segments; and a second logic unit coupled to receive the first estimated position and heading signal formed by the first logic unit, together with the second estimated position and heading signal formed by said position and heading determination means and for estimating the position and heading of the vehicle therefrom, wherein said frame transformation unit utilizes said inclinations for a road segment corresponding with a location of the vehicle, for transforming a portion of the first signal corresponding to the angulation of the vehicle.
Claim 17
Dependent Claim
166 words
The hybrid system for navigation of a vehicle of claim 13 , wherein said second position and heading determination means includes a map database together with map matching processes, and said map database including data corresponding to inclinations for each of a plurality of road segments; wherein said sensor signals include an acceleration signal corresponding to the acceleration of the vehicle in a non-inertial frame of reference and an angular signal corresponding to the angle of the vehicle in a non-inertial frame of reference; and wherein said frame transformation unit derives from the acceleration signal a gravity angle corresponding to the angle with respect to the gravity vector of the non-inertial frame of reference, and further utilizes inclinations for a road segment corresponding with a location of the vehicle to modify a gain factor applied to the combination of the gravity angle with the angulation signal to generate the portion of the first signal corresponding to the angulation of the vehicle in a quasi-inertial reference frame.
Claim 18
Dependent Claim
51 words
The hybrid system for navigation of a vehicle of claim 14 , wherein said frame transportation unit further utilizes at least one of: a history of the effect of each gain factor on calculated angles for common maneuvers, a data corresponding to a particular driving style to modify the gain factor.
Claim 19
Independent Claim
143 words
A method for navigating a vehicle having a body plane angle associated therewith comprising the acts of: detecting an initial position and an initial heading of the vehicle; sensing a motion of the vehicle in a non-inertial frame of reference and generating an angular motion signal and an acceleration signal corresponding to the motion; transforming the motion sensed into motion within a quasi-inertial frame of reference by correcting the angular motion signal using body plane angle data derived from the acceleration signal, and correcting the acceleration signal using a rotation matrix representing the corrected angular motion signal; converting the motion within a quasi-inertial frame of reference into a position change and a heading change; and adding the position change to the initial position and the heading change to the initial heading to form respectively an updated position estimate and an updated heading estimate.
Claim 20
Independent Claim
143 words
A method for navigating a vehicle having a body plane angle associated therewith comprising the acts of: detecting an initial position and an initial heading of the vehicle; sensing a motion of the vehicle in a non-inertial frame of reference and generating an angular motion signal and an acceleration signal corresponding to the motion; transforming the motion sensed into motion within a quasi-inertial frame of reference by correcting the angular motion signal using body plane angle data derived from the acceleration signal, and correcting the acceleration signal using a rotation matrix representing the corrected angular motion signal; converting the motion within a quasi-inertial frame of reference into a position change and a heading change; and adding the position change to the initial position and the heading change to the initial heading to form respectively an updated position estimate and an updated heading estimate.
Claim 21
Dependent Claim
111 words
The method for navigating a vehicle of claim 16 , wherein the acceleration signal is generated by sensing along a first axis substantially normal to a chassis of the vehicle and a second axis substantially aligned with a direction of travel of the vehicle; and wherein the body plane angle is derived from the acceleration signal by projecting the first axis and the second axis into a quasi-inertial frame of reference such that the projected acceleration of the vehicle along the first axis in the quasi-inertial frame of reference corresponds to at least one of a gravitational constant and a magnitude of a gravity vector at a location of the vehicle.
Claim 22
Dependent Claim
143 words
The method for navigating a vehicle of claim 16 , wherein the sensing act further comprises the acts of: measuring an acceleration of the vehicle in a non-inertial frame of reference; measuring an angular motion of the vehicle in the non-inertial frame of reference; and wherein the transforming act further comprises the acts of: correlating a vertical component of the acceleration of the vehicle measured in said first measuring act with at least one of a gravitational constant and a magnitude of a gravity vector at a location of the vehicle; generating a gravity angle responsive to said correlating act and the gravity angle corresponding to an angular rotation of the non-inertial reference frame with respect to a quasi-inertial reference frame; and correcting the angular motion of the vehicle sensed in said second measuring act by an amount corresponding with the gravity angle.
Claim 23
Dependent Claim
50 words
The method for navigating a vehicle of claim 18 , further comprising the act of: multiplying the rotation matrix corresponding to a corrected angular motion of the vehicle determined in said correcting act with an acceleration matrix corresponding to the acceleration of the vehicle determined in said first measuring act.
Claim 24
Dependent Claim
188 words
A computer program product for navigating a vehicle, and the computer program product comprising: a computer-readable storage medium having computer-readable program code means embodied in the medium, the computer-readable program code means comprising: computer-readable program code means for detecting an initial position and an initial heading of the vehicle; computer-readable program code means for sensing a motion of the vehicle in a non-inertial frame of reference and generating an angular motion signal and an acceleration signal corresponding to the motion; computer-readable program code means for transforming the motion senses in said act of sensing into motion within quasi-inertial frame of reference by correcting the angular motion signal using body plane angle data derived from the acceleration signal, and correcting the acceleration signal using a rotation matrix representing the corrected angular motion signal; computer-readable program code means for converting the motion with a quasi-inertial frame of reference into a position change and a heading change; and computer-readable program code means for adding the position change to the initial position and the heading change to the initial heading to form respectively an updated position estimate and an updated heading estimate.
Claim 25
Dependent Claim
188 words
A computer program product for navigating a vehicle, and the computer program product comprising: a computer-readable storage medium having computer-readable program code means embodied in the medium, the computer-readable program code means comprising: computer-readable program code means for detecting an initial position and an initial heading of the vehicle; computer-readable program code means for sensing a motion of the vehicle in a non-inertial frame of reference and generating an angular motion signal and an acceleration signal corresponding to the motion; computer-readable program code means for transforming the motion senses in said act of sensing into motion within quasi-inertial frame of reference by correcting the angular motion signal using body plane angle data derived from the acceleration signal, and correcting the acceleration signal using a rotation matrix representing the corrected angular motion signal; computer-readable program code means for converting the motion with a quasi-inertial frame of reference into a position change and a heading change; and computer-readable program code means for adding the position change to the initial position and the heading change to the initial heading to form respectively an updated position estimate and an updated heading estimate.
Claim 26
Dependent Claim
133 words
The computer readable program product of claim 20 , wherein the computer-readable program code means for sensing a motion further comprises: computer-readable program code means for sensing an acceleration of the vehicle along a first axis substantially normal to a chassis of the vehicle and a second axis substantially aligned with a direction of travel of the vehicle to generate the acceleration signal; and wherein the computer-readable program code means for transforming further comprises: computer-readable program code means for projecting the first axis and the second axis into a quasi-inertial frame of reference such that the projected acceleration of the vehicle along the first axis in the quasi-inertial frame of reference corresponds to at least one of: a gravitational constant and a magnitude of a gravity vector at a location of the vehicle.
Claim 27
Dependent Claim
179 words
The computer readable program product of claim 20 , wherein the computer-readable program code means for sensing further comprises: computer-readable program code means for sensing an acceleration of the vehicle along a first axis substantially normal to a chassis of the vehicle and a second axis substantially aligned with a direction of travel of the vehicle to generate the acceleration signal; and wherein the computer-readable program code means for transforming further comprises: computer-readable program code means for deriving the body plane angle from the acceleration signal by projecting the first axis and the second axis into a quasi-inertial frame of reference such that the projected acceleration of the vehicle along the first axis in the quasi-inertial frame of reference corresponds to at least one of: a gravitational constant and a magnitude of a gravity vector at a location of the vehicle; and computer-readable program code means for subtracting the body plane angle derived and corresponding to a rotation of the chassis of the vehicle relative to the quasi-inertial frame of reference from the angular motion of the vehicle sensed.
References Cited (Backward Citations)
US3845289A
Cited
US4139889A
Cited
US4254465A
Cited
US4672565A
Cited
US4608656A
Cited
US4723218A
Cited
US4570227A
Cited
US4673878A
Cited
US4611293A
Cited
US4797841A
Cited
US4796191A
Cited
US4920655A
Cited
US4758959A
Cited
US4914605A
Cited
US4734863A
Cited
US4782447A
Cited
US4833787A
Cited
US4751512A
Cited
US4831563A
Cited
US4862398A
Cited
US4903212A
Cited
US5040122A
Cited
US4999783A
Cited
US4984168A
Cited
US4996645A
Cited
US4964052A
Cited
US4992947A
Cited
US4937753A
Cited
US4926336A
Cited
US4989151A
Cited
US4970652A
Cited
US4982332A
Cited
US5046011A
Cited
US4918609A
Cited
JPH02107985A
Cited
US5060162A
Cited
US5067579A
Cited
US5119301A
Cited
US5287297A
Cited
US5179519A
Cited
US5148884A
Cited
US5220509A
Cited
US5177685A
Cited
US5297050A
Cited
EP0485120A2
Cited
US5486822A
Cited
US5241478A
Cited
US5283743A
Cited
US5272638A
Cited
EP0527558A1
Cited
US5293318A
Cited
US5369588A
Cited
US5383127A
Cited
EP0544403A1
Cited
US5434788A
Cited
US5521826A
Cited
US5323152A
Cited
US5440484A
Cited
EP0575943A1
Cited
US5422639A
Cited
GB2271423A
Cited
US5410485A
Cited
US5374933A
Cited
US5506774A
Cited
US5412573A
Cited
US5416712A
Cited
US5463554A
Cited
US5513110A
Cited
US5550538A
Cited
US5519619A
Cited
US5617317A
Cited
US5898390A
Cited
US5912635A
Cited
US5862511A
Cited
US5991692A
Cited
US5928309A
Cited
US5760737A
Cited
US5986547A
Cited
US5912643A
Cited
USPTO Annuity & Maintenance Windows
| Annuity Stage | Window Opens | Payment Deadline | Surcharge Period Until | Estimated Fee | Status |
|---|---|---|---|---|---|
| 3.5 Years (Year 4) | 2004-08-27 | 2005-02-26 | 2005-08-28 | $2000.00 | Window Closed / Lapsed |
| 7.5 Years (Year 8) | 2008-08-27 | 2009-02-26 | 2009-08-28 | $3760.00 | Window Closed / Lapsed |
| 11.5 Years (Year 12) | 2012-08-27 | 2013-02-26 | 2013-08-28 | $7700.00 | Window Closed / Lapsed |