Method and apparatus for measuring relative heading changes in a vehicular onboard navigation system

• US 4,788,645 A
• Filed: 03/21/1986
• Issued: 11/29/1988
• Est. Priority Date: 03/21/1986
• Status: Expired due to Term

• Current Assignee: Tele Atlas North America (TomTom NV)
• Original Assignee: Etak, Inc. (TomTom NV)
• Inventors: Peterson, Glenn R., Milnes, Kenneth A., Zavoli, Walter B.
• Primary Examiner(s): Chin, Gary
• Application Number:
  US07/843,185
• Time in Patent Office: 984 Days
• Field of Search: 364/443, 364/424, 364/449, 364/451, 364/457, 364/460, 364/571, 364/444, 340/988, 340/990, 340/995, 73/178 R
• 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
• CPC Class Codes: G05D 1/0259 using magnetic or electromagnetic means
• CPC Class Codes: G05D 1/0272 comprising means for registering the travel distance, e.g. revolutions of wheels measuring distance traversed on the ground by vehicles, e.g. using odometers G01C22/00

Abstract

A method and apparatus for measuring relative heading changes in a vehicular onboard navigation system is provided comprising apparatus for providing signals corresponding to differential wheel distance measurements, the velocity and wheel tracking distance of the vehicle. When front wheel distance measurements are used in a vehicle having an Ackerman-type steering system, an apparatus for providing a signal corresponding to an effective front wheel tracking distance as a function of the curvature of turn is also provided.

Claims

1. A method of measuring the change in the heading of a road vehicle during a turn, said vehicle having a pair of laterally spaced wheels which describe a track having a width, comprising the steps of:

measuring the distance each one of said wheels is rotated during said turn;

providing a signal Δ

D having a magnitude corresponding to the difference in the measured distances, one of said wheels is rotated relative to the other during said turn;

measuring the velocity of said vehicle during said turn;

providing a signal V having a magnitude corresponding to said velocity;

providing a signal T having a magnitude corresponding to said track width; and

providing a signal Δ

θ

_w in response to said signals Δ

D, T, and V, wherein said signal Δ

θ

_w corresponds to the change in heading of said vehicle during said turn.

2. A method according to claim 1 wherein said step of providing said signal Δ

θ

_w comprises the step of providing said signal Δ

θ

_w with a magnitude which is directly proportional to said signal Δ

D, inversely proportional to said signal T and a function of said signal V.

3. A method according to claim 2 comprising the step of:

providing a signal, a, having a magnitude corresponding to the magnitude of a predetermined constant and said function of said signal V comprises a function of said signal V and said signal, a.

4. A method according to claim 3 comprising the step of precomputing said predetermined constant.

5. A method according to claim 1 comprising the step of providing a signal, a, having a magnitude corresponding to the magnitude of a predetermined constant and wherein said step of providing said signal V comprises the step of providing a signal V² having a magnitude corresponding to a square of said velocity V and said step of providing said signal Δ

θ

_w comprises the step of providing said signal Δ

θ

_w with a magnitude determined in accordance with the following equation;

space="preserve" listing-type="equation">Δ

θ

.sub.w =Δ

D/T(1+aV.sup.2)

6. A method according to claim 3 comprising the step of changing the magnitude of said signal, a, as a function of the difference between the magnitude of said signal Δ

θ

_w and the magnitude of a signal Δ

θ

_C wherein said signal Δ

θ

_C is provided by a heading measuring means which is independent of the means used for providing said signal Δ

θ

_w and has a magnitude corresponding to a change in the heading of said vehicle as measured by said independent heading measuring means.

7. A method according to claim 6 wherein said independent means for providing said signal Δ

θ

_C comprises a compass instrument which is responsive to the earth'"'"'s magnetic field and said magnitude of said signal Δ

θ

_C corresponds to a change in the heading of said vehicle relative to said earth'"'"'s magnetic field.

8. A method according to claim 6 wherein said step of changing the magnitude of said signal, a, comprises the steps of:

providing a signal ERROR having a magnitude corresponding to the difference between the magnitude of said signal Δ

θ

_C and the then current magnitude of said signal Δ

θ

_w ; and

changing the magnitude of said signal, a, as a function of the relative magnitudes of said signal, a, before the change and said signal ERROR.

9. A method according to claim 8 wherein said step of changing the magnitude of said signal, a, comprises the steps of:

providing a signal a_old having a magnitude equal to the magnitude of the signal, a before the change;

providing a signal T_C having a magnitude corresponding to the magnitude of a predetermined constant; and

providing said signal, a, in response to said signals ERROR, a_old and T_C with a magnitude determined in accordance with the following equation;

space="preserve" listing-type="equation">a=a.sub.old +ERROR/T.sub.C

10. A method according to claim 6 wherein said steps of changing the magnitude of said signal, a, is performed when said change in heading Δ

θ

_C exceeds a predetermined magnitude, said velocity V is within a predetermined range, and said independent heading measuring means exceeds a predetermined accuracy estimate.

11. A method according to claim 10 wherein said predetermined magnitude of Δ

θ

_C is approximately 45 degrees and said predetermined range of velocity V is from approximately 15 to 45 miles per hour.

12. A method according to claim 1 wherein said signal T providing step comprises the step of providing said signal T with a magnitude which varies as a function of the curvature of turn of said vehicle.

13. A method according to claim 1 wherein said signal T providing step comprises the step of providing said signal T with a magnitude which varies as a function of a geometric foreshortening of said track width during a turn of said vehicle.

14. A method according to claim 1 comprising the step of providing a signal AD having a magnitude corresponding to the average distance said wheels rotate and wherein said steps of providing said signals Δ

D and AD comprise the steps of providing said signals Δ

D and AD using measurements taken from the rotation of wheels which are laterally spaced by a distance T_F in an Ackerman-type vehicular steering system having a Pitman arm ratio P which is mounted in a vehicle having front and rear axles which are separated by a distance B and said step of providing said signal T comprises the step of providing said signal T with a magnitude determined by the equation;

##EQU5##

15. A method according to claim 14 wherein said step of providing said signal T comprises the step of providing said signal T from a location in a table look-up memory which is addressed by an address corresponding to the curvature of turn of the vehicle for which the signal T is required.

16. A method according to claim 15 wherein said step of providing said signal T comprises the step of addressing said memory using an address corresponding to the ratio of said signals Δ

D and AD.

17. A method of measuring a change in the heading of a road vehicle during a turn, said vehicle having a pair of laterally spaced wheels which describe a track having a width which varies as a function of the curvature of said turn, comprising the steps of:

measuring the distance each one of said wheels is rotated during said turn;

providing a signal Δ

D having a magnitude corresponding to the difference in the measured distances, one of said wheels is rotated relative to the other;

providing a signal T having a magnitude corresponding to said track width which varies as a function of the curvature of said turn of said vehicle; and

providing a signal Δ

θ

_w in response to said signals Δ

D and T, wherein said signal Δ

θ

_w corresponds to the change in heading of said vehicle during said turn.

18. A method of measuring a change in the heading of a road vehicle during a turn, said vehicle having a pair of laterally spaced wheels which describe a track having a width, comprising the steps of:

measuring the distance each of said wheels is rotated during said turn;

providing a signal Δ

D having a magnitude corresponding to the difference in the measured distances, one of said wheels is rotated relative to the other during said turn;

providing a signal T having a magnitude corresponding to said track width which varies as a function of the geometric foreshortening of said track width during said turn of said vehicle; and

providing a signal Δ

θ

_w in response to said signals Δ

D and T, wherein said signal Δ

θ

_w corresponds to the change in heading of said vehicle during said turn.

19. A method of measuring the change in heading of a road vehicle during a turn, said vehicle having a pair of laterally spaced wheels which describe a track having a width which varies as a function of the curvature of said turn, comprising the steps of:

measuring the distance each of said wheels is rotated during said turn,

providing a signal Δ

D having a magnitude corresponding to the difference in the measured distances, one of said wheels is rotated relative to the other during said turn;

providing a signal AD having a magnitude corresponding to the average distance said wheels rotate during said turn;

providing a signal T having a magnitude corresponding to said track width as determined by the equation;

##EQU6## wherein T_F is the distance said wheels are spaced apart in an Ackerman-type vehicular steering system, P is the Pitman arm ratio in said system and B is the distance between the front and rear axles of said vehicle and providing a signal Δ

θ

_w in response to said signals Δ

D and T, wherein said signal Δ

θ

_w corresponds to the change in heading of said vehicle during said turn.

20. A method according to claim 19 wherein said step of providing said signal T comprises the step of providing said signal T from a location in a table look-up memory which is addressed by an address corresponding to the curvature of turn of the vehicle for which the signal T is required.

21. A method according to claim 20 wherein said step of providing said signal T comprises the step of addressing said memory using an address corresponding to the ratio of said signals Δ

D and AD.

22. An apparatus for measuring a change in heading of a road vehicle during a turn, said vehicle having a pair of laterally spaced wheels which describe a track having a width comprising:

means for measuring the distance each one of said wheels is rotated during said turn;

means responsive to said distance measuring means for providing a signal Δ

D having a magnitude corresponding to the difference in the measured distances, one of said wheels is rotated relative to the other during said turn;

means for measuring the velocity of said vehicle during said turn;

means responsive to said velocity measuring means for providing a signal V having a magnitude corresponding to said velocity;

means for providing a signal T having a magnitude corresponding to said track width; and

means for providing a signal Δ

θ

_w in response to said signals Δ

D, T, and V, wherein said signal Δ

θ

_w corresponds to the change in heading of said vehicle during said turn.

23. An apparatus according to claim 22 wherein said means for providing said signal Δ

θ

_w comprises means for providing said signal Δ

θ

_w with a magnitude which is directly proportional to said Δ

D signal and inversely proportional to said signal T and a function of said signal V.

24. An apparatus according to claim 22 comprising:

means for providing a signal, a, having a magnitude, corresponding to the magnitude of a predetermined constant, and said function of said signal V comprises a function of said signal V and said signal, a.

25. An apparatus according to claim 24 comprising means for precomputing said constant, a.

26. An apparatus according to claim 22 comprising means for providing a signal, a, having a magnitude corresponding to the magnitude of a predetermined constant and wherein said means for providing said signal V comprises means for providing a signal V² having a magnitude corresponding to a square of said velocity V and said means for providing said signal Δ

θ

_w comprises means for providing said signal Δ

θ

_w with a magnitude determined in accordance with the following equation;

space="preserve" listing-type="equation">Δ

θ

.sub.w =Δ

D/T(1+aV.sup.2)

27. An apparatus according to claim 26 comprising heading measuring means which is independent of the means used for providing said signal Δ

θ

_w for providing a signal Δ

θ

_C which has a magnitude corresponding to a change in the heading of said vehicle as measured by said independent heading measuring means and means for changing the magnitude of said signal, a, as a function of the difference between the magnitude of said signal Δ

θ

_w and the magnitude of said signal Δ

θ

_C.

28. An apparatus according to claim 27 wherein said independent means for providing said signal Δ

θ

_C comprises a compass instrument which is responsive to the earth'"'"'s magnetic field and said magnitude of said signal Δ

θ

_C corresponds to a change in the heading of said vehicle relative to said earth'"'"'s magnetic field.

29. An apparatus according to claim 27 wherein said means for changing the magnitude of said signal, a, comprises:

means for providing a signal ERROR having a magnitude corresponding to the difference between the magnitude of said signal Δ

θ

_C and the then current magnitude of said signal Δ

θ

_w ; and

means for changing the magnitude of said signal, a, as a function of the relative magnitudes of said signal, a, before the change and said signal ERROR.

30. An apparatus according to claim 29 wherein said means for changing the magnitude of said signal, a, comprises:

means for providing a signal a_old having a magnitude equal to the magnitude of the signal, a before the change;

means for providing a signal T_C having a magnitude corresponding to the magnitude of a predetermined constant; and

means for providing said signal, a, in response to said signals ERROR, a_old and T_C with a magnitude determined in accordance with the following equation;

space="preserve" listing-type="equation">a=a.sub.old +ERROR/T.sub.C

31. An apparatus according to claim 27 wherein said means for changing the magnitude of said signal, a, is performed when said change in heading Δ

θ

_C exceeds a predetermined magnitude, said velocity V is within a predetermined range, and said independent heading measuring means exceeds a predetermined accuracy estimate.

32. An apparatus according to claim 31 wherein said predetermined magnitude of Δ

θ

_C is approximately 45 degrees and said predetermined range of velocity V is from approximately 15 to 45 miles per hour.

33. An apparatus according to claim 22 wherein said signal T providing means comprises means for providing said signal T with a magnitude which varies as a function of the curvature of turn of said vehicle.

34. An apparatus according to claim 33 wherein said signal T providing means comprises means for providing said signal T with a magnitude which varies as a function of a geometric foreshortening of said track width during a turn of said vehicle.

35. An apparatus according to claim 22 comprising means for providing a signal AD having a magnitude corresponding to the average distance said wheels rotate and wherein said means for providing said signal T comprises means for providing said signal T with a magnitude determined by the equation:

##EQU7## wherein T_F is the distance said wheels are spaced apart in an Ackerman-type vehicular steering system, P is the Pitman arm ratio in said system and B is the distance between the front and rear axles of said vehicle.

36. An apparatus according to claim 35 wherein said means for providing said signal T comprises means for providing said signal T from a location in a table look-up memory which is addressed by an address corresponding to the curvature of turn of the vehicle for which the signal T is required.

37. An apparatus according to claim 36 wherein said means for providing said signal T comprises means for addressing said memory using an address corresponding to the ratio of said signals Δ

D and AD.

38. An apparatus for measuring a change in heading of a road vehicle during a turn, said vehicle having a pair of laterally spaced wheels which describe a track having a width which varies as a function of the curvature of said turn comprising:

means for measuring the distance each one of said wheels is rotated during said turn;

means responsive to said distance measuring means for providing a signal Δ

D having a magnitude corresponding to the difference in the measured distances, one of said wheels is rotated relative to the other during said turn;

means for providing a signal T having a magnitude corresponding to said track width which varies as a function of the curvature of said turn; and

means for providing a signal Δ

θ

_w in response to said signals Δ

D and T, wherein said signal Δ

θ

_w corresponds to the change in heading of said vehicle during said turn.

39. An apparatus for measuring a change in heading of a road vehicle during a turn, said vehicle having a pair of laterally spaced wheels which describe a track having a width, comprising:

means for measuring the distance each of said wheels is rotated during said turn;

means responsive to said distance measuring means for providing a signal Δ

D having a magnitude corresponding to the difference in the measured distances, one of said wheels is rotated relative to the other during said turn;

means for providing a signal T having a magnitude corresponding to said track width which varies as a function of the geometric foreshortening of said track width during a turn of said vehicle; and

means for providing a signal Δ

θ

_w in response to said signals Δ

D and T, wherein said signal Δ

θ

_w corresponds to the change in heading of said vehicle during said turn.

40. An apparatus of measuring a change in heading of a road vehicle during a turn, said vehicle having a pair of laterally spaced wheels which describe a track having a width which varies as a function of the curvature of said turn, comprising:

means for measuring the distance each of said wheels is rotated during said turn;

means responsive to said distance measuring means for providing a signal Δ

D having a magnitude corresponding to the difference in the measured distances, one of said wheels is rotated relative to the other during said turn;

means responsive to said distance measuring means for providing a signal AD having a magnitude corresponding to the average distance said wheels rotate during said turn;

means for providing a signal T having a magnitude corresponding to said track width as determined by the equation;

##EQU8## wherein T_F is the distance said wheels are spaced apart in an Ackerman-type vehicular steering system, P is the Pitman arm ratio in said system and B is the distance between the front and rear axles of said vehicle; and

means for providing a signal Δ

θ

_w in response to said signals Δ

D and T, wherein said Δ

θ

_w corresponds to the change in heading of said vehicle during said turn.

41. An apparatus according to claim 40 wherein said means for providing said signal T comprises means for providing said signal T from a location in a table look-up memory which is addressed by an address corresponding to the curvature of turn of the vehicle for which the signal T is required.

42. An apparatus according to claim 41 wherein said means for providing said signal T comprises means for addressing said memory using an address corresponding to the ratio of said signals Δ

D and AD.