Login| Sign Up| Help| Contact|

Patent Searching and Data


Title:
COMPUTER-IMPLEMENTED METHOD AND SYSTEM FOR DYNAMICALLY POSITIONING A VEHICLE RELATIVE TO ANOTHER VEHICLE IN MOTION FOR ON-THE-FLY OFFLOADING OPERATIONS
Document Type and Number:
WIPO Patent Application WO/2015/050967
Kind Code:
A1
Abstract:
Computer-implemented methods and systems are disclosed for automatically positioning a moving first vehicle relative to a moving second vehicle traveling in a given area. The method includes the steps of: (a) tracking the second vehicle and guiding the first vehicle to attain a given position relative to the second vehicle; and (b) controlling the first vehicle to maintain a generally constant speed such that an operator of the second vehicle can adjust the speed of the second vehicle to correspondingly adjust a relative position of the second vehicle to the first vehicle in a direction of movement of the first and second vehicles, and controlling the first vehicle to maintain a given distance from the second vehicle in a direction generally perpendicular to the direction of movement of the first and second vehicles by tracking the second vehicle.

Inventors:
BAUMANN WILLIAM P (US)
Application Number:
PCT/US2014/058590
Publication Date:
April 09, 2015
Filing Date:
October 01, 2014
Export Citation:
Click for automatic bibliography generation   Help
Assignee:
JAYBRIDGE ROBOTICS INC (US)
International Classes:
G05D3/00; G05D1/02
Foreign References:
US20130213518A12013-08-22
US20120215409A12012-08-23
US20030145571A12003-08-07
US20060047418A12006-03-02
US20100066517A12010-03-18
Attorney, Agent or Firm:
VALLABH, Rajesh et al. (Seaport West155 Seaport Boulevar, Boston MA, US)
Download PDF:
Claims:
Claims

1. A computer-implemented method for automatically positioning a moving first vehicle relative to a moving second vehicle traveling in a given area, the method comprising the steps of:

(a) tracking the second vehicle and guiding the first vehicle to attain a given position relative to the second vehicle; and

(b) once the first vehicle has attained the given position relative to the second vehicle, controlling the first vehicle to maintain a generally constant speed such that an operator of the second vehicle can adjust the speed of the second vehicle to

correspondingly adjust a relative position of the second vehicle to the first vehicle in a direction of movement of the first and second vehicles, while controlling the first vehicle to maintain a given distance from the second vehicle in a direction generally

perpendicular to the direction of movement of the first and second vehicles by tracking the second vehicle.

2. The method of claim 1, wherein the second vehicle comprises an offloader, and the first vehicle comprises a receiver, wherein the receiver receives material from the offloader during step (b) in an on-the-fly offloading operation.

3. The method of claim 2, wherein the first vehicle comprises a grain cart, and the second vehicle comprises a harvester.

4. The method of claim 1, wherein the first vehicle includes a towed conveyance, and the second vehicle includes an offload spout for transferring material from the second vehicle to the towed conveyance.

5. The method of claim 4, wherein adjusting a relative position of the second vehicle to the first vehicle in the direction of movement of the first and second vehicles enables the operator of the second vehicle to adjust the position of the offload spout relative to the towed conveyance for improved distribution of transferred material in the towed conveyance.

6. The method of claim 1, wherein the first vehicle is an autonomous vehicle, and the second vehicle is an autonomous vehicle or a manually operated vehicle.

7. The method of claim 1, further comprising, prior to step (b), determining whether one or more tracking conditions have been met for a given period of time.

8. The method of claim 7, wherein the one or more conditions comprise a condition specifying that the first vehicle has a longitudinal position within a given margin relative to a target position in the second vehicle.

9. The method of claim 7, wherein the first vehicle includes a towed conveyance, and wherein the one or more conditions comprise a condition specifying that an effective curvature defined by the towed conveyance is less than a given maximum curvature.

10. The method of claim 7, wherein the one or more conditions comprise a condition specifying that the second vehicle must be traveling at a given minimum speed.

11. The method of claim 7, wherein the one or more conditions comprise a condition specifying that an offload target speed history record is non-empty.

12. The method of claim 11, wherein the one or more conditions comprise a condition specifying that the difference between minimum and maximum samples in the speed history record is below a given maximum value.

13. The method of claim 1, further comprising, during step (b), determining whether one or more conditions are being met and, if not, reverting to step (a).

14. The method of claim 13, wherein the one or more conditions comprise a condition specifying that the first vehicle has a longitudinal position within a given margin relative to a target position in the second vehicle.

15. The method of claim 14, wherein the one or more conditions comprise a condition specifying that an estimated time until a target position on the first vehicle exceeds an alongtrack target margin must exceed a minimum time period.

16. The method of claim 13, wherein the first vehicle includes a towed conveyance, and wherein the one or more conditions comprise a condition specifying that an effective curvature defined by the towed conveyance is less than a given maximum curvature.

17. The method of claim 13, wherein the one or more conditions comprise a condition specifying that the second vehicle is traveling at a minimum speed.

18. The method of claim 1, wherein step (a) is performed by:

(i) receiving location data on the first and second vehicles;

(ii) determining a legal travel path for the first vehicle in the given area from the first vehicle toward an expected position of the second vehicle;

(iii) automatically controlling the first vehicle to travel along the legal travel path; and

(iv) repeating steps (i) through (iii) to automatically move the first vehicle progressively closer to the second vehicle until the first vehicle is at a given relative position from the second vehicle and then to automatically maintain the given relative position as the first and second vehicles travel through the given area.

19. A first vehicle configured to be automatically positioned relative to a moving second vehicle traveling in a given area, the first vehicle comprising: (a) a vehicle drive system;

(b) a vehicle state property estimation system for estimating state properties of the first vehicle; and

(c) a microprocessor-based vehicle controller receiving data from the vehicle state property estimation system and controlling the vehicle drive system, the vehicle controller being configured to:

(i) track the second vehicle and control the vehicle drive system to guide the first vehicle to attain a given position relative to the second vehicle; and

(ii) once the first vehicle has attained the given position relative to the second vehicle, control the vehicle drive system to maintain a generally constant speed for the first vehicle such that an operator of the second vehicle can adjust the speed of the second vehicle to correspondingly adjust a relative position of the second vehicle to the first vehicle in a direction of movement of the first and second vehicles, and control the vehicle drive system such that the first vehicle maintains a given distance from the second vehicle in a direction generally perpendicular to the direction of movement of the first and second vehicles by tracking the second vehicle.

20. The first vehicle of claim 19, wherein the second vehicle comprises an offloader, and the first vehicle comprises a receiver, wherein the receiver receives material from the offloader during (ii) in an on-the-fly offloading operation.

21. The first vehicle of claim 20, wherein the first vehicle comprises a grain cart, and the second vehicle comprises a harvester.

22. The first vehicle of claim 19, wherein the first vehicle includes a towed conveyance, and the second vehicle includes an offload spout for transferring material from the second vehicle to the towed conveyance.

23. The first vehicle of claim 22, wherein adjusting a relative position of the second vehicle to the first vehicle in the direction of movement of the first and second vehicles enables the operator of the second vehicle to adjust the position of the offload spout relative to the towed conveyance for improved distribution of transferred material in the towed conveyance.

24. The first vehicle of claim 19, wherein the first vehicle is an autonomous vehicle, and the second vehicle is an autonomous vehicle or a manually operated vehicle.

25. The first vehicle of claim 19, wherein the vehicle controller is further configured to, prior to (ii), determine whether one or more tracking conditions have been met for a given period of time.

26. The first vehicle of claim 25, wherein the one or more conditions comprise a condition specifying that the first vehicle has a longitudinal position within a given margin relative to a target position in the second vehicle.

27. The first vehicle of claim 25, wherein the first vehicle includes a towed conveyance, and wherein the one or more conditions comprise a condition specifying that an effective curvature defined by the towed conveyance is less than a given maximum curvature.

28. The first vehicle of claim 25, wherein the one or more conditions comprise a condition specifying that the second vehicle must be traveling at a given minimum speed.

29. The first vehicle of claim 25, wherein the one or more conditions comprise a condition specifying that an offload target speed history record is nonempty.

30. The first vehicle of claim 29, wherein the one or more conditions comprise a condition specifying that the difference between minimum and maximum samples in the speed history record is below a given maximum value.

31. The first vehicle of claim 19, wherein the vehicle controller is further configured to, during (ii), determine whether one or more conditions are being met and, if not, reverting to (i).

32. The first vehicle of claim 31, wherein the one or more conditions comprise a condition specifying that the first vehicle has a longitudinal position within a given margin relative to a target position in the second vehicle.

33. The first vehicle of claim 32, wherein the one or more conditions comprise a condition specifying that an estimated time until a target position on the first vehicle exceeds an alongtrack target margin must exceed a minimum time period.

34. The first vehicle of claim 31, wherein the first vehicle includes a towed conveyance, and wherein the one or more conditions comprise a condition specifying that an effective curvature defined by the towed conveyance is less than a given maximum curvature.

35. The first vehicle of claim 31, wherein the one or more conditions comprise a condition specifying that the second vehicle is traveling at a minimum speed.

36. The first vehicle of claim 19, wherein the vehicle controller is configured to perform (i) by:

(A) receiving location data on the first and second vehicles;

(B) determining a legal travel path for the first vehicle in the given area from the first vehicle toward an expected position of the second vehicle; (C) automatically controlling the first vehicle to travel along the legal travel path; and

(D) repeating steps (A) through (C) to automatically move the first vehicle progressively closer to the second vehicle until the first vehicle is at a given relative position from the second vehicle and then to automatically maintain the given relative position as the first and second vehicles travel through the given area.

Description:
COMPUTER-IMPLEMENTED METHOD AND SYSTEM FOR DYNAMICALLY POSITIONING A VEHICLE RELATIVE TO ANOTHER VEHICLE IN MOTION FOR ON-

THE-FLY OFFLOADING OPERATIONS

CROSS REFERENCE TO RELATED APPLICATIONS

[0001] This application claims priority from U.S. Patent Application No. 14/043,433 filed on October 1, 2013 entitled COMPUTER-IMPLEMENTED METHOD AND SYSTEM FOR

DYNAMICALLY POSITIONING A VEHICLE RELATIVE TO ANOTHER VEHICLE IN MOTION FOR ON- THE-FLY OFFLOADING OPERATIONS which is hereby incorporated by reference.

BACKGROUND

[0002] The present application relates generally to automatically driven vehicles and, more specifically, to computer-implemented methods and systems for automatically driving and dynamically positioning a vehicle relative to another in motion, particularly for on-the-fly offloading of material from one vehicle to the other.

BRIEF SUMMARY OF THE DISCLOSURE

[0003] In accordance with one or more embodiments, a computer-implemented method is provided for automatically positioning a moving first vehicle relative to a moving second vehicle traveling in a given area. The method includes the steps of: (a) tracking the second vehicle and guiding the first vehicle to attain a given position relative to the second vehicle; and (b) once the first vehicle has attained the given position relative to the second vehicle, controlling the first vehicle to maintain a generally constant speed such that an operator of the second vehicle can adjust the speed of the second vehicle to correspondingly adjust a relative position of the second vehicle to the first vehicle in a direction of movement of the first and second vehicles, while controlling the first vehicle to maintain a given distance from the second vehicle in a direction generally perpendicular to the direction of movement of the first and second vehicles by tracking the second vehicle. [0004] In accordance with one or more further embodiments, a first vehicle is configured to be automatically positioned relative to a moving second vehicle traveling in a given area. The first vehicle includes (a) a vehicle drive system, (b) a vehicle state property estimation system for estimating state properties of the first vehicle, and (c) a microprocessor-based vehicle controller receiving data from the vehicle state property estimation system and controlling the vehicle drive system. The vehicle controller is configured to: (i) track the second vehicle and control the vehicle drive system to guide the first vehicle to attain a given position relative to the second vehicle; and (ii) once the first vehicle has attained the given position relative to the second vehicle, control the vehicle drive system to maintain a generally constant speed such that an operator of the second vehicle can adjust the speed of the second vehicle to correspondingly adjust a relative position of the second vehicle to the first vehicle in a direction of movement of the first and second vehicles, and control the vehicle drive system such that the first vehicle maintains a given distance from the second vehicle in a direction generally perpendicular to the direction of movement of the first and second vehicles by tracking the second vehicle.

BRIEF DESCRIPTION OF THE DRAWINGS

[0005] FIG. 1 is an illustration showing an exemplary tractor maintaining a given position relative to a harvester for an on-the-fly offloading operation.

[0006] FIG. 2 is a simplified block diagram illustrating components of a first vehicle in accordance with one or more embodiments.

[0007] FIG. 3 is a simplified illustration showing the trailer angle between the tractor and a conveyance.

[0008] FIG. 4 is a simplified diagram illustrating an exemplary field in which an automated tractor can operate.

[0009] FIG. 5 is a simplified state diagram illustrating various states of the automated vehicle. [0010] FIG. 6 is a simplified diagram illustrating a harvester.

[0011] FIG. 7 is a simplified diagram illustrating varying load positions in a conveyance.

[0012] FIG. 8 is a simplified diagram illustrating calculation of a tractor path in accordance with one or more embodiments.

[0013] FIG. 9 is a simplified illustration showing an exemplary combine harvester offloading grain on a grain cart in accordance with one or more embodiments.

[0014] FIG. 10 is a flowchart illustrating an exemplary process for switching between a tracking mode and a fixed-speed mode in accordance with one or more embodiments.

[0015] FIG. 11 is a simplified illustration showing parameters for switching into and maintaining a fixed-speed mode in accordance with one or more embodiments.

DETAILED DESCRIPTION

[0016] U.S. Patent Application No. 13/281,012 entitled METHOD AND SYSTEM FOR DYNAMICALLY POSITIONING A VEHICLE RELATIVE TO ANOTHER VEHICLE IN MOTION, which is incorporated by reference herein, discloses methods and systems for automatically driving and dynamically positioning a vehicle (referred to herein as a "first" vehicle) relative to another moving vehicle (referred to herein as a "second" vehicle). The first vehicle may be towing a conveyance, and it is controlled such that the conveyance is positioned accurately relative to the second vehicle, while the vehicles are in motion. The first vehicle may be controlled to move between a given location such as a designated parking area and a given position relative to the second vehicle. A vehicle controller controls the speed and steering of the first vehicle in order to maneuver it to and to maintain a spatial relationship between the vehicles.

[0017] Such methods and systems can have a variety of applications including, e.g., agricultural applications. By way of example, as shown in FIG. 1, the first vehicle is an automatically driven tractor 10, the towed conveyance is a grain cart 12, and the second vehicle is a harvester 14, which offloads harvested product onto the grain cart. The second vehicle is referred to as the "Offloader," and the first vehicle and cart are referred to as the "Receiver." The parking area contains a semi truck, into which the grain cart 12 is offloaded after having been filled by the harvester 14. In this example, the harvester 14 offloads harvested corn, soy, or other product or material into the grain cart 12 using the harvester's offloading spout, as the grain cart 12 is towed alongside the harvester 14 by the tractor 10. After the grain cart 12 has been filled, the tractor 10 tows it to the parking area to be offloaded into the semi truck. After the grain cart 12 has been emptied, the tractor 10 tows it back out to the harvester 14, which has remained in motion and in operation, to begin taking offloaded product again.

[0018] The process of offloading material from the harvester 14 to the grain cart 12 while the vehicles are in motion is referred to as offloading on-the-fly. Offloading on-the-fly can occur while the Offloader is continuously engaged in performing another task. As the combine harvester in the FIG. 1 example empties itself into the grain cart, it continues to move forward to harvest grain.

[0019] In one or more embodiments, the tractor is an autonomous vehicle and the harvester is manually operated by a human driver. Alternately, the harvester can be tele- operated (i.e., remotely operated) by a human outside the vehicle or it can be driven entirely automatically.

[0020] For simplicity, various exemplary embodiments disclosed herein refer to the grain cart example. However, it should be understood that there are many other possible applications for the methods and systems described herein, including agricultural and non- agricultural applications. Other possible applications can include, but are not limited to, mining, oil and gas exploration, defense, first response, and materials handling.

[0021] Various embodiments disclosed herein discuss the positioning of the towed conveyance 12 relative to the second vehicle 14. However, techniques disclosed herein are also applicable to the case where the second vehicle 14 is also towing a conveyance, and the dynamic positioning of the first conveyance is relative to the second conveyance. In some embodiments, the second vehicle 14 can tow a conveyance, and the dynamic positioning of the first vehicle 10 is relative to the conveyance of the second. In further embodiments, neither vehicle tows a conveyance, and the first vehicle 10 is controlled such that it is dynamically positioned relative to the second vehicle 14.

[0022] FIG. 2 is a simplified block diagram illustrating components of the automated first vehicle 10 in accordance with one or more embodiments. The first vehicle 10 includes a vehicle drive system 16 or chassis for moving the vehicle. The first vehicle 10 also includes an obstacle detection system 18 including one or more range sensors for detecting obstacles 36 (shown, e.g., in FIG. 4) in the vehicle travel path. The first vehicle 10 also includes a vehicle state property estimation system 20 comprising one or more sensors for estimating state properties of the vehicle. It further includes a microprocessor-based vehicle controller 22, which receives inputs from the obstacle detection system 18 and the vehicle state property estimation system. The vehicle controller 22 also receives data on estimated state properties from the second vehicle 14. The vehicle controller 22 controls operation of the drive system 16 and is programmed to maneuver the vehicle in a desired manner, including dynamically positioning the first vehicle 10 relative to the second vehicle 14.

[0023] In various exemplary embodiments described herein, the vehicle controller 22 is physically located within the body of the first vehicle 10. It should be understood, however, that in other embodiments, the vehicle controller 22, or portions of the controller, could be located outside of the first vehicle 10. Such separation of physical location of the electronics and software for controlling the first vehicle 10 is contemplated herein. Moreover, while in the exemplary embodiments discussed herein indicate information is sent to or from the first vehicle 10, that is intended to mean information sent to or from the vehicle controller 22, wherever it may be physically located.

[0024] The vehicle state property estimation system 20 in the first vehicle 10 estimates several state properties of the vehicle from one or more sensors. Similarly, the second vehicle 14 includes a vehicle state property estimation system to estimate several state properties of that vehicle. State variables estimated for both vehicles include absolute position in some Earth-relative navigation system (e.g., latitude and longitude), speed, heading, and yaw rate (i.e., rate of change of heading). For the first vehicle 10, the angle between the vehicle 10 and any towed conveyance 12 (e.g., between the tractor 10 and the grain cart 12 as illustrated in FIG. 3) is also estimated.

[0025] By way of example, a set of sensors for forward motion comprise a Global Positioning System (GPS) device with Real Time Kinematic (RTK) correction, which provide position and, when a vehicle is in motion, heading. The set of sensors can further include an inertial measurement unit (IMU), which provides measurements of linear acceleration and rotational velocity. The set of sensors can also include sensors for odometry measurements of the tractor's wheels and steering angle. Other combinations of sensors are also possible for forward motion.

[0026] To enable reverse motion of a vehicle 10 with a towed conveyance 12 on a hinged hitch, an additional sensor is used, which directly or indirectly measures the angle between the vehicle 10 and the conveyance 12. This additional sensor is used because reverse motion is generally unstable, and dynamic control techniques are performed using the sensor input.

[0027] By way of example, the desired state values can be estimated from the sensor data using an Unscented Kalman Filter (UKF), whose inputs are the sensor measurements and whose outputs are the state variables. Other state estimation methods could also be employed.

[0028] Both vehicles need not use the same set of sensors. For instance, the harvester 14 could use the global, earth-relative sensors described above, while the tractor 10 could use sensors that directly ascertain its position relative to the harvester 14 in some local reference frame. [0029] Relative positioning is the responsibility of the automatic tractor 10. Thus, the state estimates of the harvester 14 are continuously sent electronically to the tractor 10 to facilitate positioning.

[0030] FIG. 4 is a simplified illustration of an exemplary field 24, on which the tractor 10 and harvester 14 can operate. The field 24 is defined by a field boundary 26. The field 24 includes legal travel areas within the field boundary 26. The tractor 10 is allowed to travel only in the legal travel areas.

[0031] Legal travel areas can include a designated parking area 28. The system operator may designate zero or more geographic regions of arbitrary shape to be parking areas.

[0032] Legal travel areas can also include designated travel corridors 30. The system operator can designate zero or more geographic regions of arbitrary shape to be travel corridors.

[0033] Legal travel areas can also include previously traveled areas. If the second vehicle 14 travels over an area, that area is by default deemed to be a legal travel area. For instance, a harvester 14 harvests the crop and leaves a cleared area behind it. The harvester 14 regularly transmits newly-cleared path information to the tractor controller 22 so that the tractor 10 has an accurate representation of the harvested areas.

[0034] The field boundary 26 can be designated by the system operator as an arbitrary boundary around the operating area. No area outside of that boundary can be a legal travel area.

[0035] The system operator can also designate an arbitrary boundary 32 around zero or more obstacles. No area inside any obstacle boundary 32 can be a legal travel area.

[0036] The obstacle detection system 18 in the first vehicle allows it to detect unanticipated obstacles 36 in the field 24. While an obstacle 36 is detected, it designates an obstacle boundary 32 around the obstacle. This area within the obstacle boundary 32 is not a legal travel area.

[0037] When the second vehicle 14 is a sufficiently long distance away from the first vehicle (e.g., the tractor 10 is in a parking area 28 and the harvester 14 is operating in the field 24), a long-distance path finding procedure can be used to determine a legal path for the first vehicle 10 to follow to be at a desired position relative to the second vehicle 14. A variety of algorithms and processes can be used for such long-distance path finding, including a standard A* or hybrid A* algorithm. The A* algorithms work from a discrete set of moves, i.e., a discrete set of vehicle headings is considered at each step in the process.

[0038] The area available for the path planning algorithms to use is determined from both the pre-surveyed paths in the field 24 (e.g., designated parking areas 28, travel corridors 30, field boundaries 26, and obstacle boundaries 32) and area 34 that has been previously travelled by the harvester 14.

[0039] The algorithm for checking whether a path lies entirely inside legal travel areas can use a simplified polygon representation of the vehicle and the legal travel areas, and performs intersection-checking of the vehicle polygon with the various areas.

[0040] In accordance with one or more embodiments, to reduce the frequency with which the tractor 10 has to "stop to think," it runs a path planning algorithm tuned to run to conclusion quickly, but to give up relatively easily on any path. In order to find a path even in complex terrain, the tractor 10 simultaneously runs a copy of the path planning algorithm tuned to be very aggressive in trying to find a path. This ensures that if the quick path finder above fails, the tractor 10 can eventually think its way out of any solvable situation.

[0041] The system operator can issue various high-level commands (shown in FIG. 5) to the automatic tractor 10, including STOP 50, EMERGENCY STOP 52, PARK 54, FOLLOW 56, and OFFLOAD 58A, 58B. As shown in FIG. 5, any state can transition to STOP 50 or EM ERGENCY STOP 52. [0042] Upon receiving a STOP command 50, the tractor 10 will slow to a halt along its currently planned path. The manner of stopping is intended to be as quick as possible while remaining subjectively comfortable for any human occupant of the tractor 10.

[0043] When executing an EMERGENCY STOP operation 52, the tractor 10 will attempt to halt as quickly as possible, e.g., by fully engaging the brakes and fully disengaging the clutch. The manner of stopping is intended to be immediate, without regard to the subjective comfort of any human occupant of the tractor 10.

[0044] When executing a PARK operation 54, the tractor 10 will perform long-distance path finding to find a legal path to the designated parking area 28. If a path is found, the tractor 10 will travel using the long-distance path following process. If no path is found, the tractor 10 will perform a STOP operation 50, returning to active motion when a legal PARK path is discovered.

[0045] Upon receiving FOLLOW command 56, the tractor 10 will perform a FOLLOW operation to begin following the harvester 14 at a standoff distance. If the harvester 14 is not nearby when the operation starts, the tractor 10 will first transit from its current location to the harvester 14 via legal long-distance travel paths, using the long-distance path following process. If no legal path can be determined, the tractor 10 will begin a STOP operation 50, returning to active motion when a legal FOLLOW path is discovered.

[0046] As the harvester 14 moves, the tractor 10 creates new plans to the current harvester position. The plan is made from a point in the tractor's future path. If an updated plan is found successfully, the remainder of the current plan is replaced with the new plan. This update and re-plan procedure continues indefinitely while the tractor 10 is in FOLLOW mode 56.

[0047] Upon receiving an OFFLOAD command, the tractor 10 will perform an OFFLOAD operation 58A, 58B to take up a precisely-maintained position relative to the harvester 14 to support offload. [0048] The harvester 14 can include a lever arm with an offload spout 70 (shown in FIG. 6) for offloading material to the grain cart 12. The system operator identifies a position relative to the harvester 14, called the "lever arm position" or "spout position" 72 (shown in FIG. 6), and a position relative to the grain cart 12, called the "load position" 74 (shown in FIG. 7). During the OFFLOAD operation, the system endeavors to keep the two positions co-located.

[0049] The OFFLOAD process is comprised of two major steps. In the first step, ROUGH POSITIONI NG 58A, the automatic tractor 10 tows the trailer 12 into a "roughly correct" position using the long-distance path finding and long-distance path following processes to get progressively near the harvester 14. If the tractor 10 cannot determine a legal path to an offload position, or if the tractor 10 is already in offload position, but the current legal path "dead ends," it will perform a FOLLOW operation 56 until such time as a legal offload path can be found.

[0050] The second step, FIN E POSITION ING 58B, begins once the trailer 12 is in approximately the correct position, to bring it to the desired position, and to maintain that position, with the required accuracy. In this mode, the tractor 10 uses the state information received from the harvester 14 to estimate the arc that the lever arm position will trace out, assuming that the current harvester yaw rate remains constant. A standard control algorithm known as "pure pursuit" can be used to determine the path that the grain cart should traverse in order to keep the load position 74 co-located with the spout position 72.

[0051] Given the grain cart's required path and current position, the angle alpha between the automatic tractor 10 and the grain cart 12 can be determined given simple models of each element. The automatic vehicle 10 is then steered to create the desired "alpha" 76 as shown in FIG. 8 using a standard PID controller integrated into the vehicle controller 22.

[0052] The harvester vehicle 14 may support more than one lever arm position. For example, a harvester 14 may support offloading to the right or to the left sides. [0053] The load position 74 can be deliberately varied (as shown in FIG. 7) during operation, e.g., in order to maintain even fill of a grain cart 12. The system operator may manually adjust the load position 74 during operations. The load position 74 may also optionally be set to automatically cycle from the front of the grain cart to the back.

Furthermore, the use of sensors such as load sensors or content-height sensors affixed to the grain cart at various points can be used to automatically guide the loading position 74 along the axis of the grain cart 12 to provide more even loading.

BIMODAL CONTROL SYSTEM FOR ADJUSTING LOAD POSITION

[0054] In accordance with one or more further embodiments, a bimodal control system is provided, enabling the load position 74 in the cart to be varied. The bimodal control system is implemented in an offload control module (OCM) in the vehicle controller 22 of the first vehicle 10.

[0055] As discussed above, the autonomous first vehicle 10 is designed to navigate and maneuver to the second vehicle 14 in order to establish a specific spatial relationship between the two vehicles while the vehicles are in motion. This is referred to as the "tracking" mode in the bimodal control process. In the grain harvesting example shown in FIG. 9, the tractor 10 attempts to center its grain cart 12 under the combine's offloading spout 70. The center of the cart is typically the offload target 80. The outer perimeter of the cart indicated by reference number 82 defines the open area of the cart.

[0056] Often the Offloader operator wants to exert some limited manual control over the relative position of the spout position 72 of the offloading spout 70 to the grain cart. The operator in the combine example may want to adjust the position of the spout 70 over the grain cart 12 by moving the spout position 72 off-center (i.e., away from the offload target 80) in order temper the distribution of the grain load in the cart 12.

[0057] The bimodal control system in accordance with one or more embodiments provides a physically intuitive mechanism to help the Offloader operator perform such adjustment while the Offloader continues with its primary task. When the system is activated in a "fixed-speed" mode as discussed below, the Offloader operator can adjust the position of the spout by simply adjusting the forward driving speed of the Offloader vehicle 14.

[0058] The bimodal control system operates in conjunction with other systems controlling the transverse position (in a direction transverse to the direction of motion of the vehicles) of the Receiver 10 with respect to the Offloader 14.

[0059] Although various exemplary embodiments disclosed herein refer to the grain cart and combine harvester example, it should be understood that there are many other possible applications for the methods and systems described herein, including agricultural and non- agricultural applications. Other possible applications can include, but are not limited to, mining, oil and gas exploration, defense, emergency response, and other domains.

[0060] FIG. 10 is a flow chart illustrating exemplary operation of a bimodal control system in accordance with one or more embodiments.

[0061] When the Receiver is commanded to receive material from the Offloader, the OCM of the Receiver first enters a tracking mode at step 90, which causes the Receiver vehicle to progressively maneuver towards a desired given position relative to the Offloader as previously discussed. The OCM actively tracks the Offloader's position in two dimensions, namely the direction of motion of the Offloader and a direction perpendicular to the direction of motion.

[0062] The OCM periodically receives navigation updates at step 94, which it uses to evaluate tracking success. The navigation updates can be obtained from the state property estimation systems of the Offloader and Receiver vehicles, as previously discussed.

[0063] Once the Receiver has fulfilled a certain set of conditions indicating tracking success (the fixed-speed entry conditions) at step 96, the OCM switches to the fixed-speed mode at step 98, in which the Receiver continues to track the Offloader in the transverse direction (perpendicular to direction of forward motion) while its forward drive speed becomes fixed. If the fixed-speed entry conditions have not been met at step 96, the OCM remains in a tracking mode at step 100 until the fixed-speed entry conditions are met.

[0064] Once in the fixed-speed mode, the Offloader operator can adjust the relative position of the two vehicles by simply adjusting the speed of the Offloader vehicle.

[0065] The OCM periodically receives navigation updates at step 102 while in fixed- speed mode, which it uses to determine if the relative position of the two vehicles violates a second set of conditions (the maintenance conditions) at step 104. If the OCM determines that the conditions are violated, indicating imminent tracking failure, then the OCM switches back to tracking mode at 90 to actively reestablish the baseline relative position in two dimensions. The OCM maintains the fixed-speed mode at 106 if the maintenance conditions are not violated.

Parameters

[0066] In accordance with one or more embodiments, fixed-speed offload can be configured with various parameters as depicted in FIG. 11. The "alongtrack" error refers to the deviation from the offload target position 80 along the direction of motion of the Receiver. The speed history is a record of Receiver speed values, as described in further detail below.

-alongtrack target margins: maximum allowed alongtrack error values (usually constrained by the available capture surface of the Receiver, i.e., the open area 82 of the grain cart 12)

-minimum offloader speed: minimum required speed of the Offloader vehicle

-maximum receiver curvature (optional): if the Receiver includes a towed vehicle, the maximum curvature (as reflected in the angle of the tow linkage).

-maximum alongtrack error for entry: maximum allowed alongtrack error before entering fixed-speed mode (represented by the elongated target area 81 in FIG. 11) -maximum speed change for entry: maximum allowed range of Receiver speeds recorded in the speed history

-minimum duration for entry: minimum duration for which the entry conditions must be maintained before switching to fixed-speed mode

-minimum time to alongtrack margin for exit: minimum allowed time until the alongtrack error reaches a margin

Tracking Mode

[0067] In the tracking mode, the OCM controls both the speed and steering of the Receiver vehicle in order to maneuver to and maintain a given position relative to the (still moving) Offloader vehicle.

[0068] While in the tracking mode, the OCM maintains a history of the speed of the Receiver's offload target point. The history is time-based; the target's current speed is added to the sample set at every navigation update, and any samples older than the minimum duration for entry are removed.

Transition to Fixed-Speed Mode

[0069] In accordance with one or more embodiments, several conditions should be met before the OCM can switch into the fixed speed mode:

-The Receiver longitudinal position should lie within the maximum alongtrack error for entry margin of target position.

-If the Receiver is a towed vehicle, the effective curvature should be less than maximum receiver curvature. (This ensures that the tow linkage is not too kinked.)

-The Offloader should be travelling at least a minimum offloader speed.

-The Offload target speed history record should be non-empty. -The difference between the minimum and maximum samples in the speed history record should be below maximum speed change for entry. (This ensures that the vehicles have similar speeds and that the Receiver is not rushing to catch up to Offloader.)

[0070] These conditions should be maintained for minimum duration for entry (typically, 2 seconds) before transition to fixed speed mode. This provides a degree of hysteresis, ensuring that the OCM has achieved a reliable target lock before ceding control of the alongtrack axis to the Offloader operator. These conditions are evaluated upon every navigation update to the system.

[0071] If all these conditions are met, the specific fixed speed is calculated as the mean of all the samples recorded in the speed history record and the OCM switches to fixed speed mode.

Fixed-Speed Mode

[0072] In the fixed speed mode, the OCM to continues control the steering of the Receiver vehicle as in tracking mode. However, the Receiver's vehicle speed is kept constant at the specific fixed speed.

Transition Back to Tracking Mode

[0073] In accordance with one or more embodiments, to remain in fixed speed mode, the following conditions should be maintained continuously:

-The Receiver longitudinal position should lie within the alongtrack target margins of target position. (This ensures that the Receiver is generally on target, e.g., the grain cart is so not so far from the combine spout that grain is being dumped on the ground.)

-The estimated time until the target position does exceed the alongtrack target margins should be greater than the minimum time to alongtrack margin for exit (typically three seconds). (This ensures that the OCM will have sufficient time to correct the longitudinal error if it must switch back to tracking mode.) -If the Receiver is a towed vehicle, the effective curvature must be less than maximum receiver curvature. (This ensures that the tow linkage is not too kinked.)

-The Offloader should be travelling at least minimum offloader speed.

[0074] These conditions are evaluated upon every navigation update to the system, and if any one of these conditions are not met at any given update, the OCM switches back to tracking mode.

[0075] When switching back to tracking mode, the speed history record is cleared.

[0076] The processes of the vehicle controller 22 described above may be implemented in software, hardware, firmware, or any combination thereof. The processes are preferably implemented in one or more computer programs executing on the vehicle controller 22. Each computer program can be a set of instructions (program code) in a code module resident in the random access memory of the controller 22. Until required by the controller 22, the set of instructions may be stored in another computer memory (e.g., in a hard disk drive, or in a removable memory such as an optical disk, external hard drive, memory card, or flash drive) or stored on another computer system and downloaded via the Internet or other network.

[0077] Having thus described several illustrative embodiments, it is to be appreciated that various alterations, modifications, and improvements will readily occur to those skilled in the art. Such alterations, modifications, and improvements are intended to form a part of this disclosure, and are intended to be within the spirit and scope of this disclosure. While some examples presented herein involve specific combinations of functions or structural elements, it should be understood that those functions and elements may be combined in other ways according to the present disclosure to accomplish the same or different objectives. In particular, acts, elements, and features discussed in connection with one embodiment are not intended to be excluded from similar or other roles in other embodiments. Additionally, elements and components described herein may be further divided into additional components or joined together to form fewer components for performing the same functions. [0078] Accordingly, the foregoing description and attached drawings are by way of example only, and are not intended to be limiting.