WO2008005195A2

WO2008005195A2 - System and method for calculating instantaneous placement corrections to achieve towed implement placement on curved paths

Info

Publication number: WO2008005195A2
Application number: PCT/US2007/014483
Authority: WO
Inventors: Andrew Karl Wilhem Rekow
Original assignee: Deere & Company
Priority date: 2006-06-30
Filing date: 2007-06-21
Publication date: 2008-01-10
Also published as: EP2038789A2; WO2008005195A3; US20080004778A1; AR061731A1; US7509199B2; EP2038789A4

Abstract

A global positioning system (GPS) based navigation and steering control system (100 in FIG. 1) for ground vehicles, in particular, agricultural ground vehicles (102) such as tractors, combines, sprayers, seeders, or the like, calculates instantaneous placement corrections to achieve desired towed implement (106) placement on curved paths (104), and a method for same.

Description

SYSTEM AND METHOD FOR CALCULATING INSTANTANEOUS

PLACEMENT CORRECTIONS TO ACHIEVE TOWED IMPLEMENT

PLACEMENT ON CURVED PATHS

FIELD OF THE INVENTION

10001 J The present invention generally relates to the field of global positioning system (GPS) based navigation and steering control systems for ground vehicles such as tractors, combines, sprayers, seeders, or the like, and particularly to a system and method for calculating instantaneous placement corrections to achieve desired towed implement placement on curved paths.

BACKGROUND OF THE INVENTION

(0002| A shortcoming of global positioning system (GPS) based navigation and steering control systems used in agricultural ground vehicles is that the global positioning system receiver of such systems can only determine the position of the global positioning system antenna. On most ground vehicles, the mounting location for the global positioning system antenna is constrained by the requirement that a clear view of the sky, and thus the global positioning system satellites, be provided to the antenna.

[0003] As a consequence of this limitation, current global positioning system based navigation and steering control systems take only ground vehicle receiver position into account when regulating ground vehicle position. However, implements towed by the ground vehicle will tend to drift to the inside of a constant radius turn. This drift is especially problematic to operators when making headland turns. During a headland turn, the towed implement will drift to the inside of the turn. When the operator lowers the implement after the turn, a significant initial lateral error can be exhibited. To compensate for this error, a skilled operator will often intentionally overshoot the desired track with the ground vehicle in order to pull the towed implement more quickly onto the line along the track. However, less skilled operators may fail to make this compensation, resulting in uneven tillage or application of seed and/or chemicals (e.g., fertilizer, herbicide, and the like) particularly near the periphery of a field.

100041 Consequently, it would be advantageous to provide a global positioning system (GPS) based navigation and steering control system for agricultural ground vehicles such as tractors, or the like, which employs a system and method for calculating instantaneous placement corrections to achieve desired towed implement placement on curved paths for both headland turns and in field operations.

SUMMARY OF THE INVENTION

|0005| The present invention is directed to a global positioning system (GPS) based navigation and steering control system for an agricultural ground vehicle such as a tractor, or the like, which employs a system and method for calculating the instantaneous placement corrections to achieve desired towed implement placement on curved paths for both headland turns and in field operations.

|0006| In exemplary embodiments, the instantaneous placement corrections may be any or all three of the instantaneous ground vehicle offset, heading offset, and/or the feed forward steering angle, or the like.

J0007) In one exemplary embodiment the present invention provides a system for controlling the steering of a ground vehicle towing an implement to achieve a desired placement of the towed implement on a curved path. In this embodiment, the system includes a processing system and a steering control unit. The processing system determines instantaneous placement corrections from a predetermined track along the curved path for a ground vehicle for achieving a desired towed implement trajectory along the curved path. The steering control unit uses the instantaneous placement corrections for correcting the trajectory of the ground vehicle. The steering control unit adjusts the path of the ground vehicle so that the towed implement at least substantially follows the curved path.

(0008) In a second exemplary embodiment, the present invention provides a method for controlling the steering of a ground vehicle towing an implement to achieve a desired placement of the towed implement on a curved path. The method includes determining instantaneous placement corrections from a predetermined track along the curved path for the ground vehicle for achieving a desired towed implement trajectory along the curved path and correcting the trajectory of the ground vehicle using the instantaneous placement corrections for adjusting the path of the ground vehicle so that the towed implement at least substantially follows the curved path.

|0009i It is to be understood that both the forgoing general description and the following detailed description are exemplary and explanatory only and are not restrictive of the invention as claimed. The accompanying drawings, which are incorporated in and constitute a part of the specification, illustrate an embodiment of the invention and together with the general description, serve to explain the principles of the invention.

BRIEF DESCRIPTION OF THE DRAWINGS

[00101 The numerous advantages of the present invention may be better understood by those skilled in the art by reference to the accompanying figures in which:

FIG. 1 is an overhead view illustrating an exemplary ground vehicle towing an implement through a curved path in accordance with an exemplary embodiment of the present invention;

FIG. 2 is a top plan view further illustrating the ground vehicle and towed implement shown in FlG. 1;

FIG. 3 is a block diagram illustrating a global positioning system (GPS) based navigation system employing the method for calculating instantaneous placement corrections to achieve desired towed implement placement on curved paths in accordance with an exemplary embodiment of the present invention;

FIG. 4 is a flow diagram illustrating a method for calculating instantaneous placement corrections to achieve desired towed implement placement on curved paths; and

FIG. 5 is a flow diagram illustrating an iterative process to calculate the steady state implement angle, used in the method for calculating the instantaneous placement corrections to achieve desired towed implement placement on curved paths.

DETAILED DESCRIPTION OF THE INVENTION lOOllj Reference will now be made in detail to the presently preferred embodiments of the invention, examples of which are illustrated in the accompanying drawings.

|OO12| FIGS. 1 and 2 illustrate an agricultural ground vehicle 102 employing an exemplary global positioning system (GPS) based navigation and steering control system 100 in accordance with an exemplary embodiment of the present invention. The navigation and steering control system 100 provides global positioning system based navigation and/or steering for a ground vehicle 102 (FIG. 2), particularly, an agricultural ground vehicle 102 such as a tractor, combine, sprayer, seeder, or the like, as the ground vehicle 102 traverses a path 104 or track within a field. In accordance with the present invention, the navigation and steering control system 100 calculates instantaneous placement corrections required for a ground vehicle 102 towing an implement 106 to achieve desired placement of the towed implement 106 on curved paths 104 for both headland turns and in field operations. In exemplary embodiments, the instantaneous placement corrections may be any or all three of the instantaneous ground vehicle offset Ay(t), heading offset ΔΨ(/), and/or the feed forward steering angle Δ<f , or the like. The navigation and steering system 100 reports this calculation to the steering control unit 108 (FIG 3.) for steering the ground vehicle 102. FIG. 1 illustrates the ground vehicle 102 towing an implement 106 through a curved path 104 in accordance with an exemplary embodiment of the present invention. The curved path 104 delineates the corrected path of the implement 106 rather than the ground vehicle 102. FIG. 2 further illustrates the exemplary ground vehicle 102 and implement 106 shown in FIG. 1.

[OO13| In exemplary embodiments, the global positioning system receiver 1 12 receives positioning signals from the Global Positioning System (GPS), a space-based radio-navigation system managed by the United States Air Force for the Government of the United States. However, it is contemplated that the global positioning system receiver 1 12 may alternatively be adapted for use with other radio based navigation/global positioning systems such as the GLONASS Navigation Satellite System managed by the Russian Space Agency (RSA) for the Russian Federation. Additionally, in embodiments of the invention, the global positioning system receiver 1 12 may be capable of receiving and utilizing enhanced positioning information provided by differential GPS (DGPS) systems and wide area differential GPS (WADGPS) systems such as the STARFIRE™ WDGPS system developed by Deere & Company of Moline, Illinois, the Wide Area Augmentation System (WAAS) provided by the Federal Aviation Administration of the United States Government, the Galileo System initiated by the European Union, or the like. In such embodiments, the global positioning system receiver 1 12 may include, or be coupled to, a radio receiver for receiving differential error correction information.

|OO14| FIG. 3 is a block diagram illustrating a global positioning system (GPS) based navigation and steering system 100 employing the system 100 and method 200 for calculating instantaneous placement corrections to achieve desired placement of a towed implement 106 on curved paths 104 in accordance with an exemplary embodiment of the present invention. In particular, FIG. 3 demonstrates the relationship between the position and implement drift compensation system 1 10 of the present invention and the existing GPS receiver 1 12 and terrain compensation module system 1 14. Data from both the GPS receiver 1 12 and the terrain compensation module 1 14 feed into the positioning and implement drift compensation software 1 16. The stored desired path 118 and the stored implement information 120 complement the positioning and implement drift compensation software 1 16 to achieve the desired placement of the towed implement 106. These complementary pathways 1 16, 118, 120, are accessed via the user interface 122, the point of interaction between the human operator and the computerized navigation system. This collaborative information is then transferred to the ground vehicle's steering control unit 108. At the steering control unit 108, this data ultimately combines with data from both the steered wheel angle sensor 124 and the electronic control unit 126. The steering control unit 108 then manipulates the steering control valves 128.

[0015] Referring now to FIG. 4, an exemplary method 200 is described for calculating the instantaneous placement corrections required to achieve desired placement of a towed implement 106 on curved paths 104 for both headland turns and in field operations. As shown, an initial estimate of the required ground vehicle turning radius to seed the iterative process is calculated, at step 202.

10016] In one embodiment, a reasonable seed value can be the desired radius of the implement 106. However, in other embodiments, a more accurate estimate can be achieved by solving the following equation:

R_ground_γehicle = Rsegmenl + [biip,- + O₁) + Vlifl; + b,f] EQN. 1

where R_gro_und_vehicie is the initial guess of the required ground vehicle turning radius, ■R_segme_ni is the desired implement turning radius, a,- is the distance from the center of the ground vehicle rear axle to the drawbar pin and b,- is the distance from the drawbar pin to the turning center of the implement (i.e. tongue length.) (FIG. 2).

|0017| Next, the steady state implement angle γ_ss is calculated, at step 204. The implement angle y is the angle between the centerlines of the towing ground vehicle 102 and the implement 106. The implement angle γ is zero when the centerlines are aligned with each other such as on a long, straight line. During turns the implement angle γ can be modeled using the equation:

Where γ is the implement angle; s is the along track distance; and p is the ground vehicle trajectory curvature (1 /radius).

[0018] During constant radius turns, the implement angle γ reaches a steady state. FIG. 5 illustrates an exemplary iterative process 300 to calculate the steady state implement angle γ_ss for step 204. The steady state implement angle γ_ss can then be used to calculate how much the implement 106 will drift to the inside of a constant radius turn.

[0019| At step 302, the iterations are initialized by using the solution to EQN. 1, Rgr_mmd_jtehi_cie, to find the initial estimate of the steady state implement angle γ_ss. The initial estimate is thus found using the equation:

_{Y ss =} (P, + O EQN. 3

^■"^ ground _ vehicle

This linearized solution provides the required steady state implement angle γ_ss for the implement in order to maintain the desired implement turn radius.

[00201 Next, at step 304, upon determining the desired implement turn radius, the steady state implement angle residual error (e) may be determined (see EQN. 4). The steady state implement angle residual error (e) is the value of the rate of change of the angle with respect to the along track distance. The steady state implement angle residual error (e) is calculated using the equation:

|002l] Next, at step 306, the steady state implement angle residual error (e) approximation from EQN. 4 is iteratively utilized in EQN. 5 to correct the estimated steady state implement angle γ_ss until convergence is achieved.

r- = r. ⁺f- ^EQN- ⁵

|0022| Next, the user determines if the steady state implement angle γ_ss has converged, at step 308. If the steady state implement angle γ_ss estimate has not converged upon completion of EQN. 5, the method 300 includes a direction 310 to repeat steps 304, 306, and 308. Typically, the steady state implement angle γ_ss estimate will converge per step 312 to less than 0.1° within two to three iterations.

|0023| Once steady state implement angle γ_ss is calculated, as shown in FIG.4, the steady state implement turning radius R_impιmcnl for the current ground vehicle 102 turn is calculated, at step 206 (see FIG. 4) In steady state, on a constant radius turn, the radius of the track of the implement 106 is related to the track of the ground vehicle 102 by the equation:

Rim≠cmen, = R ground __Wh,clc ∞*Y „ + ^i S\n y „ EQN. 6

10024] Therefore, for any ground vehicle turning radius R_gmnKt»Md._> the steady state implement turning radius R,_mpι_cmcπl may be calculated. If the resulting steady state implement turning radius R,_mpι_cmcn, is not satisfactory for the current ground vehicle radius, the steady state implement turning radius R;_mp,_cmn, can be adjusted by the steady state implement angle residual error (e), at step 208. 100251 Next, the operator may determine if the offset has converged, at step 210. If not, per step 21 1, this adjustment in the ground vehicle radius

may affect the steady state implement angle γ_ss enough to require recalculation of the previous steps 204, 206, and 208.

10026| In accordance with the present invention, once the required ground vehicle radius i?_sro,w__™*;_<rte estimate has converged, the steady state offset of a ground vehicle, Δy_ss, may be calculated at step 212 using the equation:

AVJW ~ ^COS ~Z EQN. 7

ground _vehlcle J

where l_Cj>s is the distance from the turning center of the ground vehicle 102 to the global positioning system (GPS) antenna. The last term in the above equation is included to account for the differences in radii between the turning center of the ground vehicle 102 and the measured GPS positions. The steady state offset of a ground vehicle, Δy_SSjis calculated, at step 212, of the present method 200.

|0027| Although EQN. 7 calculates the steady state offset of a ground vehicle, Δy_ss, implementation of the steady state offset of a ground vehicle, Δy_ss, must address segment transitions that occur during the ground vehicle's 102 travel for truly proper execution. If the global positioning navigation system were to instantly track the steady state offset of a ground vehicle Δy_ss the implement 106 may depart the ending segments too soon during segment transitions. This problem is addressed by filtering the trajectory of the ground vehicle 102 with implement kinematics. The method 200 includes a calculation at step 214 of instantaneous placement corrections pursuant to these kinematics; the instantaneous ground vehicle offset Δv(f) (EQN. 8), heading offset Δψ(/) (EQN. 9), and/or the feed forward steering angle AS, (EQN. 10) 212. In the time domain, the instantaneous ground vehicle offset Ay{t) is determined using the equation:

|4K0«£(4>>-«-4*)) EQN. 8

[0028] To provide better control system tracking, a heading offset Δψ(f ) may also be utilized. This is approximated by the rate of change the lateral offset with respect to along track position using the equation:

_ΔΨft), An(Q-Av(O EQN. 9

Ib₁

|0029] Additionally, the feed forward steering angle AS that may be used by the ground vehicle 102 to follow the curve is

Δ S = tan^"1 EQN. 10

Aground __ vehicle

Where L is the wheelbase of the ground vehicle 102 (e.g., tractor).

[0030| Next, the instantaneous ground vehicle offset, Δy(f), heading offset ΔΨ(/), and the feed forward steering angle AS , calculated in method 200 are used for adjusting the path 104 of the ground vehicle 102 so that the towed implement 106 at least substantially follows the desired curved path 104, at step 214. The operator may perform vehicle guidance and control, at step 216. If the trajectory radius has changed, step 218 provides a return to 202. If the trajectory radius has not changed, step 218 provides a return to step 214.

I0031J In exemplary embodiments, the methods disclosed may be implemented as sets of instructions comprising software or firmware readable by the steering control unit 108, position and implement drift compensation system 1 10, or the like. Further, it is understood that the specific order or hierarchy of steps in the methods disclosed are examples of exemplary approaches. Based upon design preferences, it is understood that the specific order or hierarchy of steps in the method can be rearranged while remaining within the scope of the present invention. The accompanying method claims present elements of the various steps in a sample order, and are not meant to be limited to the specific order or hierarchy presented.

|0032| It is believed that the present invention and many of its attendant advantages will be understood by the forgoing description. It is also believed that it will be apparent that various changes may be made in the form, construction and arrangement of the components thereof without departing from the scope and spirit of the invention or without sacrificing all of its material advantages. The form herein before described being merely an explanatory embodiment thereof. It is the intention of the following claims to encompass and include such changes.

Claims

CLAIMS What is claimed is:

1. A method for controlling the steering of a ground vehicle towing an implement to achieve a desired placement of the towed implement on a curved path, comprising: determining instantaneous placement corrections from a predetermined track along the curved path for the ground vehicle for achieving a desired towed implement trajectory along the curved path; calculating an instantaneous ground vehicle offset from the predetermined track using the instantaneous placement corrections; and correcting the trajectory of the ground vehicle using the instantaneous ground vehicle offset for adjusting the path of the ground vehicle so that the towed implement at least substantially follows the curved path.

2. The method as claimed in claim 1, wherein the step of determining the instantaneous placement corrections further comprises determining a steady state implement angle for the towed implement.

3. The method as claimed in claim 2, wherein the step of determining the instantaneous placement corrections comprises determining an initial ground vehicle turning radius.

4. The method as claimed in claim 3, wherein the step of determining the instantaneous placement corrections comprises determining a steady state implement drift offset and a steady state turn radius for the towed implement.

5. The method as claimed in claim 4, further comprising determining if the trajectory of the ground vehicle has changed.

6. The method as claimed in claim 4, wherein the initial ground vehicle turning radius is determined from

where R_{ground vehicle} is the initial ground vehicle turning radius, R_segmeπt is the desired implement turning radius, a,- is a distance from the center of the ground vehicle rear axle to the drawbar pin and b_t is the distance from the drawbar pin to the turning center of the implement.

7. The method as claimed in claim 6, wherein the steady state implement angle for the towed implement is determined from

where γ is the implement angle; s is an along track distance; and p is a ground vehicle trajectory curvature (1/radius), a_% is a distance from the center of the ground vehicle rear axle to the drawbar pin and fy is the distance from the drawbar pin to the turning center of the implement.

8. The method as claimed in claim 6, wherein the steady state implement angle is determined by determining an initial estimate of the steady state implement angle; calculating an angle residual for the steady state implement angle; and revising the estimate of the steady state implement angle using the calculated angle residual.

9. The method as claimed in claim 8, wherein the initial estimate of the steady state implement angle is determined from

i^β R ground _^ vehicle where γ_ss is the steady state implement angle, the angle residual is determined from

(_{ϊ +} ZL_{C0s r} I e₌ I ^bι )_ _ sin y»

" gmutd _ vehicle "I

where e is the angle residual, and the revised estimate of the steady state implement angle is determined from -

10. The method as claimed in claim 9, wherein the steady state ground vehicle offset is determined from

¹ClS

AXtv ~ K ground _vehtclc -^-implement ^"*^" -"gronnrf _ veft/c/e • ^C0S n ground __ vehicle

where laps is a distance from a turning center for the ground vehicle to an antenna of a global positioning system receiver mounted to the ground vehicle and Ri_mpι_emml is the steady state implement turning radius which is determined from

^implement ⁼ Aground _vehiclc ⁰⁰⁵YsS ^"*^" °i ^Sm Yss ^•

1 1. The method as claimed in claim 10, wherein the instantaneous ground vehicle offset is determined from

at Zb₁ where V^ is the velocity of the ground vehicle.

12. The method as claimed in claim 10, wherein an instantaneous placement correction is determined from

and a feed forward steering angle determined from

L

AS = tan^"

Aground _ vehicle

where L is a wheelbase of the ground vehicle.

13. A system for controlling the steering of a ground vehicle towing an implement to achieve a desired placement of the towed implement on a curved path, comprising: a processing system for determining the instantaneous placement corrections from a predetermined track along the curved path for the ground vehicle for achieving a desired towed implement trajectory along the curved path and calculating an instantaneous ground vehicle offset from the predetermined track using the steady state ground vehicle offset; and a steering control unit for correcting the trajectory of the ground vehicle using the instantaneous placement corrections, wherein the steering control unit adjusts the path of the ground vehicle so that the towed implement at least substantially follows the curved path.

14. The system as claimed in claim 13, wherein the processing system determines a steady state implement angle for the towed implement.

15. The system as claimed in claim 14, wherein the processing system determines an initial ground vehicle turning radius.

16. The system as claimed in claim 15, wherein the processing system determines a steady state implement drift offset and a steady state turn radius for the towed implement.

17. The system as claimed in claim 16, wherein the processing system further determines if the trajectory of the ground vehicle has changed.

18. The system as claimed in claim 17, wherein the steady state implement angle is determined by the processing system by determining an initial estimate of the steady state implement angle; calculating an angle residual for the steady state implement angle; and revising the estimate of the steady state implement angle using the calculated angle residual.

19. A system for controlling the steering of a ground vehicle towing an implement to achieve a desired placement of the towed implement on a curved path, comprising: means for determining instantaneous placement corrections from a predetermined track along the curved path for the ground vehicle for achieving a desired towed implement trajectory along the curved path and calculating an instantaneous ground vehicle offset from the predetermined track using the steady state ground vehicle offset; and means for correcting the trajectory of the ground vehicle using the instantaneous placement corrections, wherein the correcting unit adjusts the path of the ground vehicle so that the towed implement at least substantially follows the curved path.

20. The system as claimed in claim 19, further comprising means for determining if the trajectory of the ground vehicle has changed.