Inertial augmentation for GPS navigation on ground vehicles

• US 6,694,260 B1
• Filed: 05/09/2003
• Issued: 02/17/2004
• Est. Priority Date: 05/09/2003
• Status: Active Grant

• Current Assignee: Deere & Company
• Original Assignee: Deere & Company
• Inventors: Rekow, Andrew Karl Wilhelm
• Primary Examiner(s): Cuchlinski, Jr., William A.
• Assistant Examiner(s): Hernandez, Olga
• Application Number:
  US10/435,068
• Time in Patent Office: 284 Days
• Field of Search: 701/214, 701/210, 701/213, 701/220, 701/36, 701/37, 701/96, 280/5.5, 280/5.502, 280/5.506, 280/5.507
• US Class Current: 701/214
• CPC Class Codes: G01C 21/165 combined with non-inertial navigation instruments
• CPC Class Codes: G01S 19/41 Differential correction, e.g. DGPS [differential GPS]
• CPC Class Codes: G01S 19/47 the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial

Abstract

An inertial compensation assembly suitable for use in a GPS based navigation system for a ground vehicle, in particular, an agricultural ground vehicle such as a tractor, combine, or the like, provides inertial augmentation to compensate GPS navigation information such as position, course, and track spacing for errors caused by variation of ground vehicle attitude (i.e., roll and yaw) over non-level terrain.

Claims

1. A method for determining an effective track spacing for an implement of a ground vehicle traversing non-level terrain, comprising

determining a roll angle for the ground vehicle;

ascertaining the slope of the non-level terrain using the determined roll angle; and

calculating the effective track spacing, the effective track spacing compensating for the slope of the non-level terrain.

2. The method as claimed in claim 1, wherein the roll angle of the ground vehicle is calculated from the lateral acceleration of the ground vehicle, the lateral acceleration of the ground vehicle being measured by an accelerometer.

3. The method as claimed in claim 2, wherein the effective track spacing is calculated by the formula:

4. An inertial compensation assembly for a navigation system of a ground vehicle, the navigation system including a global positioning system receiver assembly for receiving a positioning signal from a global positioning system, the positioning signal being used to generate a global positioning system based position and course for the ground vehicle, the inertial compensation assembly comprising:

a gyroscope assembly for determining a yaw angle for the ground vehicle;

an accelerometer assembly for determining a lateral acceleration of the ground vehicle; and

a processing assembly coupled to the gyroscope assembly and accelerometer assembly for determining position and course information for the ground vehicle by correcting the global positioning system position and course using the determined yaw angle and the determined lateral acceleration,

wherein the position and course information is inertially compensated for roll and yaw of the ground vehicle as the ground vehicle traverses non-level terrain.

5. The inertial compensation assembly as claimed in claim 4, wherein the processing assembly calculates a yaw rate and a gyroscopic course from the yaw angle measured by the gyroscope assembly.

6. The inertial compensation assembly as claimed in claim 5, wherein the processing assembly determines the course information using the equation:

7. The inertial compensation assembly as claimed in claim 4, wherein the gyroscope assembly comprises a single yaw gyroscope.

8. The inertial compensation assembly as claimed in claim 4, wherein the processing assembly further calculates an off-track distance for the ground vehicle from the lateral acceleration generated by the accelerometer assembly and a distance due to high speed acceleration of the ground vehicle, the distance due to high speed acceleration being determined from changes in the position of the ground vehicle with respect to the course of the ground vehicle, the off-track distance being added to the GPS position to provide the corrected position information.

9. The inertial compensation assembly as claimed in claim 8, wherein the processing assembly determines the off-track distance using the equation:

10. The inertial compensation assembly as claimed in claim 4, wherein the accelerometer assembly comprises a single accelerometer.

11. The inertial compensation assembly as claimed in claim 4, wherein the processing assembly further calculates the slope of the non-level terrain, the slope being used to determine the effective track spacing of an implement towed by the ground vehicle.

12. A method for determining the position and course information for a ground vehicle, comprising:

receiving a global positioning system based position and course from a global positioning system;

measuring the yaw angle for the ground vehicle using a gyroscope assembly

measuring the lateral acceleration of the ground vehicle using an accelerometer assembly; and

calculating position and course information for the ground vehicle by correcting the global positioning system based position and course using the determined yaw angle and the determined lateral acceleration so that the calculated position and course information is inertially compensated for roll and yaw of the ground vehicle as the ground vehicle traverses non-level terrain.

13. The method as claimed in claim 12, further comprising calculating a yaw rate and a gyroscopic course from the measured yaw angle, the yaw rate and gyroscopic course being used to determine a corrected course for the ground vehicle.

14. The method as claimed in claim 13, wherein the corrected course is determined using the equation:

15. The method as claimed in claim 12 wherein the gyroscope assembly comprises a single yaw gyroscope.

16. The method as claimed in claim 12, wherein the step of calculating position and course information for the ground vehicle comprises calculating an off-track distance for the ground vehicle from the lateral acceleration measured by the accelerometer assembly and a distance due to high speed acceleration of the ground vehicle, the distance due to high speed acceleration being determined from changes in the position of the ground vehicle with respect to the course of the ground vehicle, the and adding the off-track distance to the GPS position to provide the corrected position information.

17. The method as claimed in claim 16, wherein the off-track distance is determined using the equation:

18. The method as claimed in claim 12, wherein the accelerometer assembly comprises a single accelerometer.

19. The method as claimed in claim 12, further comprising calculating the slope of the non-level terrain, the slope being used to determine the effective track spacing of an implement towed by the ground vehicle.

20. The method as claimed in claim 19, wherein the effective track spacing is calculated by the formula:

21. A navigation system for a ground vehicle, comprising:

a global positioning system receiver assembly for receiving a positioning signal from a global positioning system and generating a global positioning system based position and course for the ground vehicle; and

an inertial compensation assembly, including;

a gyroscope assembly for determining a yaw angle for the ground vehicle;

an accelerometer assembly for determining a lateral acceleration of the ground vehicle; and

a processing assembly coupled to the gyroscope assembly and accelerometer assembly for determining position and course information for the ground vehicle by correcting the global positioning system position and course using the determined yaw angle and the determined lateral acceleration,

wherein the position and course information is inertially compensated for roll and yaw of the ground vehicle as the ground vehicle traverses non-level terrain.

22. The navigation system as claimed in claim 21, further comprising a steering system interconnected with the global positioning system receiver assembly for steering the ground vehicle using the position and course information.

23. The navigation system as claimed in claim 21, wherein the processing assembly calculates a yaw rate and a gyroscopic course from the yaw angle measured by the gyroscope assembly.

24. The navigation system as claimed in claim 23, wherein the processing assembly determines the course information using the equation:

25. The navigation system as claimed in claim 21, wherein the gyroscope assembly comprises a single yaw gyroscope.

26. The navigation system as claimed in claim 21, wherein the processing assembly further calculates an off-track distance for the ground vehicle from the lateral acceleration generated by the accelerometer assembly and a distance due to high speed acceleration of the ground vehicle, the distance due to high speed acceleration being determined from changes in the position of the ground vehicle with respect to the course of the ground vehicle, the off-track distance being added to the GPS position to provide the corrected position information.

27. The navigation system as claimed in claim 21, wherein the processing assembly determines the off-track distance using the equation:

28. The navigation system as claimed in claim 21, wherein the accelerometer assembly comprises a single accelerometer.

29. The navigation system as claimed in claim 21, wherein the processing assembly further calculates the slope of the non-level terrain, the slope being used to determine the effective track spacing of an implement towed by the ground vehicle.

30. An inertial compensation assembly for a navigation system of a ground vehicle, the navigation system including a global positioning system receiver assembly for receiving a positioning signal from a global positioning system, the positioning signal being used to generate a global positioning system based position and course for the ground vehicle, the inertial compensation assembly comprising:

means for measuring the yaw angle for the ground vehicle;

means for measuring the lateral acceleration of the ground vehicle; and

means for calculating position and course information for the ground vehicle by correcting the global positioning system based position and course using the determined yaw angle and the determined lateral acceleration,

wherein the calculated position and course information is inertially compensated for roll and yaw of the ground vehicle as the ground vehicle traverses non-level terrain.