IPC분류정보
국가/구분 |
United States(US) Patent
등록
|
국제특허분류(IPC7판) |
|
출원번호 |
US-0435067
(2003-05-09)
|
발명자
/ 주소 |
- Rekow, Andrew Karl Wilhelm
- Nelson, Frederick William
- Mercer, Dave
- Pickett, Terence
|
출원인 / 주소 |
|
대리인 / 주소 |
|
인용정보 |
피인용 횟수 :
42 인용 특허 :
11 |
초록
▼
A global positioning system based navigation system for a ground vehicle, in particular an agricultural ground vehicle such as a tractor, combine, sprayer, or the like, includes an inertial compensation assembly that provides inertial augmentation to compensate global positioning system based naviga
A global positioning system based navigation system for a ground vehicle, in particular an agricultural ground vehicle such as a tractor, combine, sprayer, or the like, includes an inertial compensation assembly that provides inertial augmentation to compensate global positioning system based 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.
대표청구항
▼
1. 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 navigation information for the ground vehicle, the navigation information including a position and course for the g
1. 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 navigation information for the ground vehicle, the navigation information including a position and course for the ground vehicle;a navigation control system interconnected with the global positioning system receiver assembly for steering the ground vehicle; andan inertial compensation assembly coupled to the global positioning system receiver assembly and the navigation control system for replacing the position and course with a corrected position and a corrected course that are inertially compensated for roll and yaw of the ground vehicle to provide corrected navigation information to the navigation control system, the inertial compensation assembly comprising a gyroscope assembly for measuring a yaw rate of the ground vehicle and an accelerometer assembly for measuring a lateral acceleration of the ground vehicle, the inertial compensation assembly using the measured yaw rate and lateral acceleration for generating the corrected position and course by calculating 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.wherein the navigation control system uses the corrected navigation information for steering the ground vehicle. 2. The navigation system as claimed in claim 1, wherein the inertial compensation assembly calculates a gyroscopic course from the yaw rate measured by the gyroscope assembly. 3. The navigation system as claimed in claim 2, wherein the inertial compensation unit determines the corrected course using the equation: C C =[G R /F MEAS ]+[( C GPS −C G )· Kc/CFR]+Pf where C C is the corrected course; G R is the yaw rate; F MEAS is the frequency of measurement of the yaw rate by the gyroscope assembly; C GPS is the course from the navigation information generated by the global positioning system receiver assembly; C G is the gyroscopic course; Kc is a variable filter value; CFR is a course filter resolution variable; and Pf is a value projecting the corrected course from a pivot point of the ground vehicle to a point where the global positioning system receiver assembly is mounted to the ground vehicle. 4. The navigation system as claimed in claim 1, wherein the gyroscope assembly comprises a single yaw gyroscope. 5. The navigation system as claimed in claim 1, wherein the inertial compensation assembly determines the off-track distance using the equation: D OT =( H A ·A/g )+ D HSA where D OT is the off-track distance of the ground vehicle; H A is the height of the accelerometer assembly above a control point of the ground vehicle; A is the lateral acceleration determined by the accelerometer assembly; g is the acceleration due to gravity, and D HSA is the distance due to high speed acceleration. 6. The navigation system as claimed in claim 1, wherein the accelerometer assembly comprises a single accelerometer. 7. The navigation system as claimed in claim 1, wherein the inertial compensation assembly further calculates the slope of the non-level terrain from the measured lateral acceleration of the ground vehicle, the slope being added to the corrected navigation information. 8. The navigation system as claimed in claim 7, wherein the navigation control system a uses the slope to determine the effective track spacing of an implement towed by the ground vehicle. 9. The navigation system as claimed in claim 8, wherein the effective track spacing is calculated by the equation: E=I ·cos( S )where E is the effective track spacing, I is the track width of the implement on level terrain, and S is the slope. 10. A method for steering a ground vehicle traversing non-level terrain, comprising:receiving a positioning signal from a global positioning system;generating navigation information for the ground vehicle, the navigation information including a position and course for the ground vehicle;replacing the position and course stripped from the navigation information with a corrected position and a corrected course that are inertially compensated for roll and yaw of the ground vehicle for providing corrected navigation information; andsteering the ground vehicle using the corrected navigation information,wherein the step of steering the ground vehicle using the corrected navigation information comprises steering the ground vehicle so that the ground vehicle follows a track substantially parallel to a previously navigated track. 11. The method as claimed in claim 10, wherein the step of replacing the position and course stripped from the navigation information comprises determining a yaw angle for the ground vehicle using a gyroscope assembly and determining lateral acceleration of the ground vehicle using an accelerometer assembly, the lateral acceleration and the yaw angle being used for generating the corrected position and course. 12. The method as claimed in claim 11, further comprising calculating a yaw rate and a gyroscopic course from the yaw angle. 13. The method as claimed in claim 12, wherein the corrected course is determined using the equation: C C =[G R /F MEAS ]+[( C GPS −C G )· Kc/CFR]+Pf where C C is the corrected course; G R is the yaw rate; F MEAS is the frequency of measurement of the yaw rate; C GPS is the course from the navigation information generated by the global positioning system receiver assembly; C G is the gyroscopic course; Kc is a variable filter value; CFR is a course filter resolution variable; and Pf is the previous course projected from a control point of the ground vehicle to the global positioning system receiver assembly. 14. The method as claimed in claim 11, wherein the gyroscope assembly comprises a single yaw gyroscope. 15. The method as claimed in claim 11, wherein the step of replacing the position and course stripped from the navigation information comprises calculating 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. 16. The method as claimed in claim 15, wherein the off-track distance is determined using the equation: D OT =( H A ·A/g )+ D HSA where D OT is the off-track distance of the ground vehicle; H A is the height of the accelerometer assembly above a control point of the ground vehicle; A is the lateral acceleration determined by the accelerometer assembly; g is the acceleration due to gravity; and D HSA is the distance due to high speed acceleration. 17. The method as claimed in claim 11, wherein the accelerometer assembly comprises a single accelerometer. 18. The method as claimed in claim 10, further comprising calculating the slope of non-level terrain, the slope being added to the corrected navigation information. 19. The method as claimed in claim 18, further comprising determining an effective track spacing of an implement towed by the ground vehicle using the slope. 20. The method as claimed in claim 19, wherein the effective track spacing is calculated by the formula: E=I ·cos( S )where E is the effective track spacing, I is the track width of the implement on level terrain, and S is the slope. 21. 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 glob al positioning system and generating navigation information for the ground vehicle and a navigation control system for steering 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; anda processing assembly coupled to the gyroscope assembly and accelerometer assembly for replacing the position and course information with corrected position and course information to provide corrected navigation information to the navigation control system for steering the ground vehicle,wherein the processor assembly generates the corrected position and course information using the yaw angle measured by the gyroscope assembly and the lateral acceleration measured by the accelerometer assembly so that the corrected navigation information is inertially compensated for roll and yaw of the ground vehicle over non-level terrain. 22. The inertial compensation assembly 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. 23. The inertial compensation assembly as claimed in claim 22, wherein the processing assembly determines the corrected course using the equation: C C =[G R /F MEAS ]+[( C GPS −C G )· Kc/CFR]+Pf where C C is the corrected course; G R is the yaw rate; F MEAS is the frequency of measurement of the yaw rate; C GPS is the course from the navigation information generated by the global positioning system receiver assembly; C G is the gyroscopic course; Kc is a variable filter value; CFR is a course filter resolution variable; and Pf is the previous course projected from a control point of the ground vehicle to the global positioning system receiver assembly. 24. The inertial compensation assembly as claimed in claim 21, wherein the gyroscope assembly comprises a single yaw gyroscope. 25. The inertial compensation assembly as claimed in claim 21, wherein the processing assembly 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. 26. The inertial compensation assembly as claimed in claim 25, wherein the processing assembly determines the off-track distance using the equation: D OT =( H A ·A/g )+ D HSA where D OT is the off-track distance of the ground vehicle; H A is the height of the accelerometer assembly above a control point of the ground vehicle; A is the lateral acceleration determined by the accelerometer assembly; g is the acceleration due to gravity; and D HSA is the distance due to high speed acceleration. 27. The inertial compensation assembly as claimed in claim 21, wherein the accelerometer assembly comprises a single accelerometer. 28. The inertial compensation assembly as claimed in claim 21, wherein the processing assembly further calculates the slope of the non-level terrain, the slope being added to the corrected navigation information. 29. 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 navigation information for the ground vehicle, the navigation information including a position and course for the ground vehicle;a navigation control system interconnected with the global positioning system receiver assembly for steering the ground vehicle; andan inertial compensation assembly coupled to the global positioning system receiver assembly and the navigation control system for replacing the position and course with a corrected position and a corrected course that are inertia lly compensated for roll and yaw of the ground vehicle to provide corrected navigation information to the navigation control system, the inertial compensation assembly comprising a gyroscope assembly for measuring a yaw rate of the ground vehicle and an accelerometer assembly for measuring a lateral acceleration of the ground vehicle, the inertial compensation assembly using the measured yaw rate and lateral acceleration for generating the corrected position and course using the equation: C C =[G R /F MEAS ]+[( C GPS −C G )· Kc/CFR]+Pf where C C is the corrected course; G R is the yaw rate; F MEAS is the frequency of measurement of the yaw rate by the gyroscope assembly; C GPS is the course from the navigation information generated by the global positioning system receiver assembly; C G is the gyroscopic course calculated by the inertial compensation assembly from the yaw rate measured by the gyroscope assembly; Kc is a variable filter value; CFR is a course filter resolution variable; and Pf is a value projecting the corrected course from a pivot point of the ground vehicle to a point where the global positioning system receiver assembly is mounted to the ground vehicle; andwherein the navigation control system uses the corrected navigation information for steering the ground vehicle. 30. The navigation system as claimed in claim 29, wherein the gyroscope assembly comprises a single yaw gyroscope. 31. The navigation system as claimed in claim 29, wherein the inertial compensation assembly 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. 32. The navigation system as claimed in claim 31, wherein the inertial compensation assembly determines the off-track distance using the equation: D OT =( H A ·A/g )+ D HSA where D OT is the off-track distance of the ground vehicle; H A is the height of the accelerometer assembly above a control point of the ground vehicle; A is the lateral acceleration determined by the accelerometer assembly; g is the acceleration due to gravity; and D HSA is the distance due to high speed acceleration. 33. The navigation system as claimed in claim 29, wherein the accelerometer assembly comprises a single accelerometer. 34. The navigation system as claimed in claim 29, wherein the inertial compensation assembly further calculates the slope of the non-level terrain from the measured lateral acceleration of the ground vehicle, the slope being added to the corrected navigation information. 35. The navigation system as claimed in claim 34, wherein the navigation control system a uses the slope to determine the effective track spacing of an implement towed by the ground vehicle. 36. The navigation system as claimed in claim 35, wherein the effective track spacing is calculated by the equation: E=I ·cos( S )where E is the effective track spacing, I is the track width of the implement on level terrain, and S is the slope. 37. 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 navigation information for the ground vehicle, the navigation information including a position and course for the ground vehicle;a navigation control system interconnected with the global positioning system receiver assembly for steering the ground vehicle; andan inertial compensation assembly coupled to the global positioning system receiver assembly and the navigation control system for replacing the position and course with a corrected position and a corrected course that are inertially compensated for roll and yaw of the ground vehicle to provide c orrected navigation information to the navigation control system, the inertial compensation assembly calculating the slope of the non-level terrain from the measured lateral acceleration of the ground vehicle, the slope being added to the corrected navigation information,wherein the navigation control system uses the corrected navigation information for steering the ground vehicle. 38. The navigation system as claimed in claim 37, wherein the inertial compensation assembly comprises a gyroscope assembly for measuring a yaw rate of the ground vehicle and an accelerometer assembly for measuring a lateral acceleration of the ground vehicle, the inertial compensation assembly using the measured yaw rate and lateral acceleration for generating the corrected position and course. 39. The navigation system as claimed in claim 38, wherein the inertial compensation assembly calculates a gyroscopic course from the yaw rate measured by the gyroscope assembly. 40. The navigation system as claimed in claim 39, wherein the inertial compensation unit determines the corrected course using the equation: C C =[G R /F MEAS ]+[( C GPS −C G )· Kc/CFR]+Pf where C C is the corrected course; G R is the yaw rate; F MEAS is the frequency of measurement of the yaw rate by the gyroscope assembly; C GPS is the course from the navigation information generated by the global positioning system receiver assembly, C G is the gyroscopic course; Kc is a variable filter value; CFR is a course filter resolution variable; and Pf is a value projecting the corrected course from a pivot point of the ground vehicle to a point where the global positioning system receiver assembly is mounted to the ground vehicle. 41. The navigation system as claimed in claim 38, wherein the gyroscope assembly comprises a single yaw gyroscope. 42. The navigation system as claimed in claim 38, wherein the inertial compensation assembly 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. 43. The navigation system as claimed in claim 42, wherein the inertial compensation assembly determines the off-track distance using the equation: D OT =( H A ·A/g )+ D HSA where D OT is the off-track distance of the ground vehicle; H A is the height of the accelerometer assembly above a control point of the ground vehicle; A is the lateral acceleration determined by the accelerometer assembly; g is the acceleration due to gravity; and D HSA is the distance due to high speed acceleration. 44. The navigation system as claimed in claim 38, wherein the accelerometer assembly comprises a single accelerometer. 45. The navigation system as claimed in claim 37, wherein the effective track spacing is calculated by the equation: E=I ·cos( S )where E is the effective track spacing, I is the track width of the implement on level terrain, and S is the slope. 46. A method for steering a ground vehicle traversing non-level terrain, comprising:receiving a positioning signal from a global positioning system;generating navigation information for the ground vehicle, the navigation information including a position and course for the ground vehicle;replacing the position and course stripped from the navigation information with a corrected position and a corrected course that are inertially compensated for roll and yaw of the ground vehicle for providing corrected navigation information; andsteering the ground vehicle using the corrected navigation information,wherein the step of replacing the position and course stripped from the navigation information comprises determining a yaw angle for the ground vehicle using a gyroscope assembly and determining lateral accelera tion of the ground vehicle using an accelerometer assembly, the lateral acceleration and the yaw angle being used for generating the corrected position and course. 47. The method as claimed in claim 46, wherein the step of steering the ground vehicle using the corrected navigation information comprises steering the ground vehicle so that the ground vehicle follows a track substantially parallel to a previously navigated track. 48. The method as claimed in claim 46, further comprising calculating a yaw rate and a gyroscopic course from the yaw angle. 49. The method as claimed in claim 48, wherein the corrected course is determined using the equation: C C =[G R /F MEAS ]+[( C GPS −C G )· Kc/CFR]+Pf where C C is the corrected course; G R is the yaw rate; F MEAS is the frequency of measurement of the yaw rate; C GPS is the course from the navigation information generated by the global positioning system receiver assembly; C G is the gyroscopic course; Kc is a variable filter value; CFR is a course filter resolution variable; and Pf is the previous course projected from a control point of the ground vehicle to the global positioning system receiver assembly. 50. The method as claimed in claim 46, wherein the gyroscope assembly comprises a single yaw gyroscope. 51. The method as claimed in claim 46, wherein the step of replacing the position and course stripped from the navigation information comprises calculating 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. 52. The method as claimed in claim 51, wherein the off-track distance is determined using the equation: D OT =( H A ·A/g )+ D HSA where D OT is the off-track distance of the ground vehicle; H A is the height of the accelerometer assembly above a control point of the ground vehicle; A is the lateral acceleration determined by the accelerometer assembly; g is the acceleration due to gravity; and D HSA is the distance due to high speed acceleration. 53. The method as claimed in claim 46, wherein the accelerometer assembly comprises a single accelerometer. 54. The method as claimed in claim 46, further comprising calculating the slope of non-level terrain, the slope being added to the corrected navigation information. 55. The method as claimed in claim 54, further comprising determining an effective track spacing of an implement towed by the ground vehicle using the slope. 56. The method as claimed in claim 55, wherein the effective track spacing is calculated by the formula: E=I ·cos( S )where E is the effective track spacing, I is the track width of the implement on level terrain, and S is the slope. 57. A method for steering a ground vehicle traversing non-level terrain, comprising:receiving a positioning signal from a global positioning system;generating navigation information for the ground vehicle, the navigation information including a position and course for the ground vehicle;replacing the position and course stripped from the navigation information with a corrected position and a corrected course that are inertially compensated for roll and yaw of the ground vehicle for providing corrected navigation information;calculating the slope of non-level terrain, the slope being added to the corrected navigation information; andsteering the ground vehicle using the corrected navigation information. 58. The method as claimed in claim 57, wherein the step of steering the ground vehicle using the corrected navigation information comprises steering the ground vehicle so that the ground vehicle follows a track substantially parallel to a previously navigated track. 59. The method as claimed in claim 57, wherein the step of replac ing the position and course stripped from the navigation information comprises determining a yaw angle for the ground vehicle using a gyroscope assembly and determining lateral acceleration of the ground vehicle using an accelerometer assembly, the lateral acceleration and the yaw angle being used for generating the corrected position and course. 60. The method as claimed in claim 59, further comprising calculating a yaw rate and a gyroscopic course from the yaw angle. 61. The method as claimed in claim 60, wherein the corrected course is determined using the equation: C C =[G R /F MEAS ]+[( C GPS ·C G )· Kc/CFR]+Pf where C C is the corrected course; G R is the yaw rate; F MEAS is the frequency of measurement of the yaw rate; C GPS is the course from the navigation information generated by the global positioning system receiver assembly, C G is the gyroscopic course; Kc is a variable filter value; CFR is a course filter resolution variable; and Pf is the previous course projected from a control point of the ground vehicle to the global positioning system receiver assembly. 62. The method as claimed in claim 59, wherein the gyroscope assembly comprises a single yaw gyroscope. 63. The method as claimed in claim 59, wherein the step of replacing the position and course stripped from the navigation information comprises calculating 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. 64. The method as claimed in claim 63, wherein the off-track distance is determined using the equation: D OT =( H A ·A/g )+ D HSA where D OT is the off-track distance of the ground vehicle; H A is the height of the accelerometer assembly above a control point of the ground vehicle; A is the lateral acceleration determined by the accelerometer assembly; g is the acceleration due to gravity; and D HSA is the distance due to high speed acceleration. 65. The method as claimed in claim 59, wherein the accelerometer assembly comprises a single accelerometer. 66. The method as claimed in claim 57, further comprising determining an effective track spacing of an implement towed by the ground vehicle using the slope. 67. The method as claimed in claim 66, wherein the effective track spacing is calculated by the formula: E=I ·cos( S )where E is the effective track spacing, I is the track width of the implement on level terrain, and S is the slope.
※ AI-Helper는 부적절한 답변을 할 수 있습니다.