Differential odometer dynamic calibration method and apparatus therefor

• US 5,402,365 A
• Filed: 10/28/1992
• Issued: 03/28/1995
• Est. Priority Date: 10/28/1992
• Status: Expired due to Term

• Current Assignee: Temic Automotive of North America, Incorporated (Continental AG)
• Original Assignee: Motorola, Inc. (Motorola Solutions, Inc.)
• Inventors: Kozikaro, Elisha M., Ives, Martin D.
• Primary Examiner(s): Chin, Gary
• Application Number:
  US07/967,328
• Time in Patent Office: 881 Days
• Field of Search: 364/424.01, 364/424.04, 364/449, 364/559, 364/560, 364/561, 364/565, 364/571.01, 364/571.02, 377/24, 73/1 R, 73/1 J, 73/2
• US Class Current: 702/97
• CPC Class Codes: G01C 22/025 Differential odometers
• CPC Class Codes: G01C 25/00 Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass testing, calibrating or compensating compasses G01C17/38

Abstract

A differential odometer includes a left wheel sensor (503) coupled to a left wheel (103), and a right wheel sensor (513) coupled to a right wheel (105). The left wheel sensor (503) provides a left wheel pulse count (505) as the left wheel (103) rotates. A left wheel distance traversed is determined by a product of the left wheel pulse count and a left distance per pulse coefficient. The right wheel sensor (513) provides a right wheel pulse count (515) as the right wheel rotates. A right wheel distance traversed is determined by a product of the right wheel pulse count and a right distance per pulse coefficient. A vehicle heading (601'"'"'), and vehicle distance traversed (1201), are determined using the left wheel distance traversed and the right wheel distance traversed. A correction value (901, 1001) is provided corresponding to a measured relationship between the left wheel pulse count and the right wheel pulse count. Then a new left distance per pulse coefficient (1105), corresponding to the provided correction value (901, 1001), and a new right distance per pulse coefficient (1101), corresponding to the provided correction value (901, 1001) are provided. Then the left distance per pulse coefficient (605) is substituted with the new left distance per pulse coefficient (1105), and the right distance per pulse coefficient (609) with the new right distance per pulse coefficient (1101). This substitution causes calibration of the differential odometer, consistent with the provided correction value (901, 1001).

Claims

1. A method for continuously calibrating a differential odometer of a vehicle, said vehicle having a left wheel and a right wheel, wherein the left wheel is located a known track distance opposite the right wheel, said differential odometer including a left wheel sensor coupled to the left wheel, and a right wheel sensor coupled to the right wheel, said left wheel sensor providing a left wheel pulse count as the left wheel rotates, wherein left wheel distance traversed is determined by a product of the left wheel pulse count and a left distance per pulse coefficient, and said right wheel sensor providing a right wheel pulse count as the right wheel rotates, wherein right wheel distance traversed is determined by a product of the right wheel pulse count and a right distance per pulse coefficient, wherein vehicle heading, and vehicle distance traversed are determined using the left wheel distance traversed and the right wheel distance traversed, said method comprising the steps of:

providing a correction value corresponding to a measured relationship between the left wheel pulse count and the right wheel pulse count;

determining a new left distance per pulse coefficient, corresponding to the provided correction value, and a new right distance per pulse coefficient, corresponding to the provided correction value; and

substituting the left distance per pulse coefficient with the new left distance per pulse coefficient, and the right distance per pulse coefficient with the new right distance per pulse coefficient, thereby causing calibration of said differential odometer, consistent with the provided correction value.

2. A method in accordance with claim 1 wherein said measured relationship between the right wheel pulse count and the left wheel pulse count is bounded within a predetermined range for a predetermined vehicle distance traversed before the correction value is provided.

3. A method in accordance with claim 2 wherein said measured relationship is continuously bounded within a predetermined range for a predetermined continuous vehicle distance traversed.

4. A method in accordance with claim 1 wherein said measured relationship between the right wheel pulse count and the left wheel pulse count corresponds to a ratio between the right wheel pulse count and the left wheel pulse count.

5. A method in accordance with claim 2 wherein said measured relationship between the right wheel pulse count and the left wheel pulse count corresponds to a ratio between the right wheel pulse count and the left wheel pulse count.

6. A method in accordance with claim 1 further comprising a step of determining an accuracy of the relationship measured between the left wheel pulse count and the right wheel pulse count, by a process autonomous to the step of providing a correction value corresponding to the measured relationship, and for adjusting an intensity of said correction value dependent on the determined accuracy.

7. A method in accordance with claim 6 wherein said step of determining the accuracy of the measured relationship of the left wheel pulse count and the right wheel pulse count comprises a step of measuring a vehicle heading.

8. A method in accordance with claim 7 wherein said step of measuring a vehicle heading further comprises a step of adjusting the intensity of the correction value in accordance with the measured vehicle heading.

9. A method in accordance with claim 8 wherein said step of measuring a vehicle heading comprises measuring a vehicle heading from a compass.

10. A method in accordance with claim 9 wherein said step of adjusting the intensity of the correction value includes decreasing the intensity of the correction value responsive to the measured vehicle heading.

11. A method in accordance with claim 6 wherein said step of determining an accuracy of the measured relationship comprises a step of determining a level of sanity of the right wheel pulse count and the left wheel pulse count and adjusting the intensity of the correction value in accordance with the determined level of sanity.

12. A method in accordance with claim 11 wherein said step of adjusting the intensity of the correction value includes increasing the intensity of the correction value responsive to a low level of said determined sanity.

13. A method for continuously calibrating a differential odometer of a vehicle, said vehicle having a left wheel and a right wheel, wherein the left wheel is located a known track distance opposite the right wheel, said differential odometer including a left wheel sensor coupled to the left wheel, and a right wheel sensor coupled to the right wheel, said left wheel sensor providing a left wheel pulse count as the left wheel rotates, and said right wheel sensor providing a right wheel pulse count as the right wheel rotates, said method comprising the steps of:

determining vehicle heading and vehicle distance traversed using a product of the left wheel pulse count and a left distance per pulse coefficient and a product of the right wheel pulse count and a right distance per pulse coefficient;

providing a correction value corresponding to a measured ratio of the right wheel pulse count to the left wheel pulse count, when a predetermined another vehicle distance has been traversed while said measured ratio is bounded within a predetermined range for a predetermined vehicle distance traversed;

determining a new left distance per pulse coefficient, corresponding to the provided correction value, and a new right distance per pulse coefficient, corresponding to the provided correction value; and

substituting the left distance per pulse coefficient with the new left distance per pulse coefficient, and the right distance per pulse coefficient with the new right distance per pulse coefficient, thereby causing calibration of said differential odometer, consistent with the provided correction value.

14. A method in accordance with claim 13 wherein said measured ratio is continuously bounded within a predetermined range for a predetermined continuous vehicle distance traversed.

15. A method in accordance with claim 14 further comprising a step of determining correctness of said measured relationship of the left wheel pulse count and the right wheel pulse count by a process autonomous to the step of providing a correction value and providing an intensity of said correction value dependent on the determined correctness.

16. A method in accordance with claim 15 wherein said step of determining correctness of said measured relationship of the left wheel pulse count and the right wheel pulse count by a process autonomous to the step of providing a correction value comprises a step of measuring a vehicle heading.

17. A method in accordance with claim 16 wherein said step of measuring a vehicle heading, autonomous to the differential odometer process further comprises a step of adjusting the intensity of the correction value in accordance with the measured vehicle heading.

18. A method in accordance with claim 17 wherein said step of adjusting the intensity of the correction value includes decreasing the intensity of the correction value responsive to the measured vehicle heading.

19. A method in accordance with claim 18 wherein said step of measuring a vehicle heading comprises measuring a vehicle heading from a compass.

20. A method in accordance with claim 19 wherein said step of determining correctness of the measured relationship comprises a step of determining a level of sanity of the right wheel pulse count and the left wheel pulse count and adjusting the intensity of the correction value in accordance with the determined level of sanity.

21. A method in accordance with claim 20 wherein said step of adjusting the intensity of the correction value includes increasing the intensity of the correction value responsive to a low level of said determined sanity.

22. A method for calibrating a differential odometer of a vehicle, said vehicle having a left wheel and a right wheel, wherein the right wheel is located a known track distance opposite the left wheel, said differential odometer including a left wheel sensor coupled to the left wheel, and a right wheel sensor coupled to the right wheel, said sensors for providing electrical pulses as the associated wheel rotates, said sensors for determining, vehicle heading and vehicle distance traversed, said method comprising the steps of:

counting the electrical pulses provided by each wheel and periodically providing a left wheel pulse count corresponding to a totalized number of electrical pulses provided by the left wheel sensor within a period, and periodically providing a right wheel pulse count corresponding to a totalized number of electrical pulses provided by the right wheel sensor within said period;

determining said vehicle heading by dividing a difference of a product of the left wheel pulse count and a left distance per pulse coefficient and a product of the right wheel pulse count and a right distance per pulse coefficient by the track distance;

determining said vehicle distance traversed by dividing a sum of the product of the left wheel pulse count and the left distance per pulse coefficient and the right wheel pulse count and the right distance per pulse coefficient by two;

filtering the right wheel pulse count and the left wheel pulse count and providing a correction ratio corresponding to a measured ratio of the right wheel pulse count to the left wheel pulse count, when a predetermined vehicle distance has been traversed while said measured ratio is bounded within a predetermined range for a predetermined vehicle distance traversed;

determining a new left distance per pulse coefficient for the left wheel corresponding to the provided correction ratio, and a new right distance per pulse coefficient for the right wheel corresponding to the provided correction ratio; and

substituting the left distance per pulse coefficient with the new left distance per pulse coefficient, and the right distance per pulse coefficient with the new right distance per pulse coefficient, thereby causing calibration of said differential odometer, consistent with the provided correction ratio.

23. A method in accordance with claim 22 wherein said measured ratio is continuously bounded within a predetermined range for a predetermined continuous vehicle distance traversed.

24. A method in accordance with claim 23 further comprising a step of determining an accuracy of the measured ratio between the left wheel pulse count and the right wheel pulse count, by a process autonomous to the step of providing a correction ratio corresponding to the measured relationship, and for adjusting an intensity of said correction ratio dependent on the determined accuracy.

25. A method in accordance with claim 24 wherein said step of determining the intensity of the correction ratio includes increasing the intensity of the correction ratio responsive to the vehicle heading measured in said step of measuring a heading using a to be provided compass, and the vehicle heading.

26. A method for continuously calibrating a differential odometer of a vehicle, said vehicle having a left wheel and a right wheel, wherein the left wheel is located a known track distance opposite the right wheel, said differential odometer including a left wheel sensor coupled to the left wheel, and a right wheel sensor coupled to the right wheel, said method comprising the steps of:

providing a left wheel pulse count as the left wheel rotates, wherein a left wheel distance traversed is determined by a product of the left wheel pulse count and a left distance per pulse coefficient;

providing a right wheel pulse count as the right wheel rotates, wherein a right wheel distance traversed is determined by a product of the right wheel pulse count and a right distance per pulse coefficient;

determining vehicle heading by dividing a difference of the left wheel distance traversed and the right wheel distance traversed by the track distance;

determining a vehicle distance traversed by dividing the sum of the left wheel distance traversed and the right wheel distance traversed by two;

filtering the right wheel pulse count and the left wheel pulse count and providing a correction ratio corresponding to a measured ratio of the right wheel pulse count to the left wheel pulse count, when a predetermined continuous vehicle distance has been traversed while said measured ratio is continuously bounded within a predetermined range for a predetermined vehicle distance traversed;

determining an autonomous vehicle heading using a to be provided compass;

determining an intensity of the correction ratio responsive to a measured relationship between the determined vehicle heading and the autonomously determined vehicle heading, and providing a revised correction ratio corresponding to the provided ratio and the determined intensity;

determining a new left distance per pulse coefficient, corresponding to the provided revised correction ratio, and a new right distance per pulse coefficient, corresponding to the provided revised correction ratio; and

substituting the left distance per pulse coefficient with the new left distance per pulse coefficient, and the right distance per pulse coefficient with the new right distance per pulse coefficient, thereby causing calibration of said differential odometer, consistent with the provided revised correction ratio.

27. An apparatus for continuously calibrating a differential odometer of a vehicle, said vehicle having a left wheel and a right wheel, wherein the left wheel is located a known track distance opposite the right wheel, said differential odometer including a left wheel sensor coupled to the left wheel, and a right wheel sensor coupled to the right wheel, said left wheel sensor providing a left wheel pulse count as the left wheel rotates, wherein a left wheel distance traversed is determined by a product of the left wheel pulse count and a left distance per pulse coefficient, and said right wheel sensor providing a right wheel pulse count as the right wheel rotates, wherein a right wheel distance traversed is determined by a product of the right wheel pulse count and a right distance per pulse coefficient, wherein vehicle heading is determined using the left wheel distance traversed and the right wheel distance traversed, and wherein vehicle distance traversed is determined by the left wheel distance traversed and the right wheel distance traversed, said apparatus comprising:

means for providing a correction value corresponding to a measured relationship between the left wheel pulse count and the right wheel pulse count;

means for determining a new left distance per pulse coefficient, corresponding to the provided correction value, and a new right distance per pulse coefficient, corresponding to the provided correction value; and

means for substituting the left distance per pulse coefficient with the new left distance per pulse coefficient, and the right distance per pulse coefficient with the new right distance per pulse coefficient, thereby causing calibration of said differential odometer, consistent with the provided correction value.

28. An apparatus in accordance with claim 27 wherein said measured relationship between the right wheel pulse count and the left wheel pulse count corresponds to a ratio between the right wheel pulse count and the left wheel pulse count.

29. An apparatus in accordance claim 28 further comprising means for determining correctness of said measured relationship of the left wheel pulse count and the right wheel pulse count independent of the differential odometer and providing an intensity of said correction value.

30. An apparatus in accordance claim 29 wherein said means for determining correctness of said measured relationship of the left wheel pulse count and the right wheel pulse count comprises means for measuring a vehicle heading and adjusting the intensity of the correction value in accordance with the measured vehicle heading.

31. An apparatus for continuously calibrating a differential odometer of a vehicle, said vehicle having a left wheel and a right wheel, wherein the left wheel is located a known track distance opposite the right wheel, said differential odometer including a left wheel sensor coupled to the left wheel, and a right wheel sensor coupled to the right wheel, said left wheel sensor providing a left wheel pulse count as the left wheel rotates, and said right wheel sensor providing a right wheel pulse count as the right wheel rotates, said apparatus comprising:

means for determining vehicle heading using a product of the left wheel pulse count and a left distance per pulse coefficient and a product of the right wheel pulse count and a right distance per pulse coefficient;

means for determining a vehicle distance traversed using a product of the left wheel pulse count and a left distance per pulse coefficient and a product of the right wheel pulse count and the right distance per pulse coefficient;

means for providing a correction ratio corresponding to the ratio of the right wheel pulse count to the left wheel pulse count, when a predetermined vehicle distance has been traversed while said measured correction ratio is bounded within a predetermined range for a predetermined vehicle distance traversed;

means for determining a new left distance per pulse coefficient, corresponding to the provided correction ratio, and a new right distance per pulse coefficient, corresponding to the provided correction ratio; and

means for substituting the left distance per pulse coefficient with the new left distance per pulse coefficient, and the right distance per pulse coefficient with the new right distance per pulse coefficient, thereby causing calibration of said differential odometer, consistent with the provided correction ratio.

32. An apparatus in accordance with claim 31 wherein said correction ratio between the right wheel pulse count and the left wheel pulse count corresponds to a ratio between the right wheel pulse count and the left wheel pulse count.

33. An apparatus in accordance with claim 32 further comprising means for determining correctness of said correction ratio of the left wheel pulse count and the right wheel pulse count independent of the differential odometer and providing an intensity of said correction ratio.

34. An apparatus in accordance with claim 33 wherein said means for determining correctness of said correction ratio of the left wheel pulse count and the right wheel pulse count comprises means for measuring said vehicle heading.

35. An apparatus in accordance with claim 34 further comprising means for adjusting the intensity of the correction ratio in accordance with the measured vehicle heading.