The present disclosure generally relates to a path planning method and system. An embodiment of the present disclosure relates to a coverage-based turn path planning method and system.
A path planner may be used to determine one or more path plans for a vehicle to cover a work area. The work area may represent a field for growing a crop or other vegetation. The vehicle may need to traverse the entire work area or a portion thereof to plant a crop, to treat a crop, to harvest a crop, or to perform another task associated with the crop or vegetation, to name non-limiting examples. Multiple vehicles may traverse the same work area to complete a task in the work area at the same time.
For some work areas, the boundary for the work area may be input to the vehicle before the vehicle executes a path plan and performs a task in the work area. However, high fidelity work area boundaries are not always available due to drift and/or other inaccuracies in global positioning systems (GPS), boundary recording errors, and/or other reasons. Further, the planting location of crops may not precisely follow field boundaries, thereby potentially causing gaps or overlaps of coverage near a boundary. Such boundary imprecision may cause a turn of a planned path to begin too early or end too late in operations after crop emergence, such as in product application and harvesting. Moreover, multiple vehicles performing the same task in a work area may inefficiently cover the same rows and repeat the work of each other. Accordingly, there exists a need for a system and a method for planning a path to allow one or more vehicle(s) to accurately and efficiently perform a task within a work area.
Various aspects of examples of the present disclosure are set out in the claims.
According to a first aspect of the present disclosure, a method for planning a turn path of a vehicle is provided. The method includes monitoring coverage by at least one of the vehicle and a second vehicle, defining a headland region of one or more headland passes in a work area between an exterior boundary and a headland boundary edge, defining a plurality of track paths extending in a generally parallel relationship and having a plurality of track path ends disposed at an inner headland pass of the headland region, the inner headland pass having an edge defining the headland boundary edge, determining a turn start intersection point defined by an intersection of a first track path of the plurality of track paths and the inner headland pass at its corresponding edge, determining a turn end intersection point defined by an intersection of a second track path of the plurality of track paths and the inner headland pass at its corresponding edge, and creating a curved turn path from the turn start intersection point to the turn end intersection point based on the coverage by the at least one of the vehicle and a second vehicle.
According to a second aspect of the present disclosure, a system for planning a path of a vehicle is provided. The system includes a coverage monitor configured to monitor coverage by at least one of the vehicle and a second vehicle, a headland region identifier configured to establish a headland region of one or more headland passes in a work area between an exterior boundary and a headland boundary edge defined by the one or more headland passes, a track path identifier configured to establish a plurality of track paths extending in a generally parallel relationship and having a plurality of track path ends disposed at an inner headland pass of the headland region, the inner headland pass having an edge defining the headland boundary edge, a turn start intersection point generator configured to determine a turn start intersection point of a first track path of the plurality of track paths and the inner headland pass at its corresponding edge, a turn end intersection point generator configured to determine a turn end intersection point of a second track path of the plurality of track paths and the inner headland pass at its corresponding edge, and a curved turn path generator configured to establish a curved turn path from the turn start intersection point to the turn end intersection point based on the coverage by the at least one of the vehicle and the second vehicle.
According to a third aspect of the present disclosure, a method of planning a path for a vehicle configured to unload material to one of a right side of the vehicle and a left side of the vehicle is provided. The method includes defining a headland region of one or more headland passes in a work area within an exterior boundary, defining a plurality of track paths extending in a generally parallel relationship and having a plurality of track path ends disposed at the headland region, and generating a path pattern comprising one of repeating right turn directions between the plurality of track paths if the vehicle is configured to unload the material to the right side of the vehicle and repeating left turn directions between the plurality of track paths if the vehicle is configured to unload the material to the left side of the vehicle.
The above and other features will become apparent from the following description and accompanying drawings.
The detailed description of the drawings refers to the accompanying figures in which:
Like reference numerals are used to indicate like elements throughout the several figures.
At least one example embodiment of the subject matter of this disclosure is understood by referring to
The vehicle controller 20 accepts input from the system 10 illustrated in
The steering system 20 may comprise an electrically controlled hydraulic steering system, an electrically driven rack and pinion steering, an Ackerman steering system, or another steering system. The propulsion system 24 may comprise an internal combustion engine, an internal combustion engine-electric hybrid system, an electric drive system, or the like. The braking system may comprise an electrically controlled hydraulic braking system, or another electrically controlled friction braking system. The safeguarding system may comprise an obstacle detection system, which includes one or more of the following components: an ultrasonic detector, a radar device, a laser obstacle detector, a liDAR device, a laser range finder, a vision obstacle detector, and a stereo vision detector.
Referring now to
The path planner 14 further includes a headland region identifier 78 configured to establish a headland region 26 of one or more headland passes 28 of an outer region associated with a work area 32. In the illustrated embodiment, the headland region identifier 78 establishes passes 28 in the work area 32 between an exterior boundary 30 and a headland boundary edge 40. In an embodiment, the headland region identifier 78 defines the one or more passes 28 along and inside of an exterior boundary 30 of the headland region 26. The headland boundary edge 40 of the illustrated embodiment is defined by an inner headland pass 38.
The system 10 includes a track path identifier 76 configured to establish track paths 34 that extend in a generally parallel relationship. The track paths 34 of the illustrated embodiments include at least a first track path 46 and a second track path 52. The track paths 34 have track path ends 36 disposed at the inner headland pass 38 of the headland region 26. The inner headland pass 38 includes the headland boundary edge 40.
The track path identifier 76 of the system 10 receives from an external source, calculates, generates, and/or otherwise defines, determines, and/or stores information for the first track path 46 and, in particular embodiments, one or more subsequent paths. In an embodiment, the vehicle 12 initially traverses the first track path 46, and the track path identifier 76 determines the first track path 46 based on the vehicle 12 movement and/or location. Further, in one or more additional embodiments, the track path identifier 76 defines, determines, and/or stores one or more other track paths, one or more headland paths, and/or any other areas from the vehicle 12 covering or traversing such areas. Any defining, determining, and/or storing of information relating to one or more areas covered or traversed may be processed, displayed, and/or stored on a coverage map and/or displayed to the operator of the vehicle 12 and/or transmitted or displayed to another location.
As illustrated in
Referring now to
In the illustrated embodiments, the system 10 also generates an implement turn path 88 indicating the planned path taken by an implement 90, such as a front implement on a combine or a towed planter by a tractor, to name non-limiting examples, during execution of the curved turn path 56 by the vehicle 12. In particular embodiments, the curved turn path 56 is configured to allow the swaths of both the vehicle 12 and the implement 90 to remain outside of the headland boundary edge 40 in the headland region 26 during the execution or traversing of the curved turn path 56. Should the vehicle 12 or the implement 90 travel beyond the exterior boundary 30 outside of the headland region 26, an alert signal and/or other action may be initiated by the system 10 and/or vehicle 12 in one or more embodiments. In one embodiment, upon initiation of an alert signal or warning, the system 10 instructs or expects the operator to take control and/or acknowledge the warning or alert and continue on the path. In a further embodiment, the system 10 initiates corrective control of the vehicle 12 upon travel of the vehicle 12 or implement 90 beyond the exterior boundary 30. In a particular embodiment of any method or system described herein, the vehicle 12 is equipped with an obstacle detection system. Foundational items, such as guidance and turn path generation to name non-limiting examples, provide the obstacle avoidance or corrective action as part of the method or system in the particular embodiment.
In one or more embodiments, the curved turn path generator 54 cooperates with the coverage monitor 60 to establish the curved turn path 56 based on the historic path traversed or the coverage by the vehicle 12 and any other vehicle in the work area 32. In an embodiment, the turn end intersection point generator 48 cooperates with the coverage monitor 60 to determine whether to execute a right turn or a left turn to establish the second track path 52. The coverage monitor 60 of an additional embodiment cooperates with the turn end intersection point generator 48 to determine whether to skip an intervening path 64 disposed adjacent to the first track path 46 or multiple intervening paths 64 disposed between the first track path 46 and the second track path 52.
Referring now to
The method 100 further includes creating, at step 118, the curved turn path 56 from the turn start intersection point 44 to the turn end intersection point 50 based, at least in part, on the coverage by the vehicle 12 and/or another vehicle in the work area 32. The method 100 of an embodiment further includes creating the curved turn path 56 to follow at least a portion of the curve 58 of the headland boundary edge 40 of the inner headland pass 38 to allow the swath of the vehicle 12 to remain in the headland region 26 during the execution or traversing of the curved turn path 56. Creating the curved turn path 56 of an embodiment includes creating a transitional turn path portion 130 in an embodiment. The method 100 further includes spacing the transitional turn path portion 130 from the headland boundary edge 40 of the inner headland pass 38 by at least a predetermined distance 134. In an illustrative embodiment, the predetermined distance 134 is half of a track spacing or width of a track path 34. In further embodiments, the predetermined distance 134 maybe greater than or less than half of a track spacing or width of the track path 34.
In particular embodiments, an additional vehicle 80, such as a second combine in a non-limiting example, may traverse the work area 32 at a separate location of the work area 32 from the vehicle 12, as illustrated in
Referring now to
With further reference to
In an embodiment, the method 200 further includes skipping one or more intervening paths on the left side of the vehicle 12 if the vehicle 12 is configured to unload the material to the left side of the vehicle 12. In such an embodiment, the accompanying vehicle 230 may have access to the track path immediately adjacent to the left side of the vehicle 12. The method 200 further includes skipping one or more intervening paths on the right side of the vehicle 12 if the vehicle 12 is configured to unload the material to the right side of the vehicle 12. In such an embodiment, the accompanying vehicle 230 may have access to the track path immediately adjacent to the right side of the vehicle 12. The method 200, in cooperation with the system 10 and the method 100, therefore, of one or more embodiments allows the accompanying vehicle 230 to access the vehicle 12 because the open, covered side of the work area 32 remains on the unloading side of the vehicle 12. In the embodiment illustrated in
The method 200 of a further embodiment includes generating the path pattern 220 to establish the curved turn path 56 to at least partially follow at least a portion or segment of the curve 58 of the headland boundary edge 40, the inner headland pass 38, and/or any other portion of the headland region 26 such that a vehicle swath remains in the headland region 26 while the vehicle 12 traverses the curved turn path 56.
As illustrated in
Without in any way limiting the scope, interpretation, or application of the claims appearing below, a technical effect of the system 10 and the methods 100, 200 of one or more of the illustrated embodiments disclosed herein is the ability for the vehicle 12 to autonomously execute a path plan without having the work area boundary input beforehand. For such particular embodiments, the system 10 and/or vehicle 12 defines or determines the path plan and any track paths based at least partially on headland and/or track path coverage. Further, the system 10 and the methods 100, 200 of one or more embodiments disclosed herein increases the accuracy and reliability of the boundary of the work area, thereby reducing errors and increasing efficiency for the overall path plan. Even further, the system 10 and the methods 100, 200 of one or more embodiments of the present disclosure allow the vehicle 12 to cooperate with one or more additional vehicles to plan an efficient path through the entire work area. Additionally, the system 10 and the methods 100, 200 of one or more embodiments of the present disclosure allow an accompanying vehicle 230, such as a grain cart in a non-limiting example, to access the vehicle 12 during execution of a path plan such that the vehicle 12 may unload material while executing a path plan while the vehicle 12 avoids repeating coverage of one or more paths already covered by the vehicle 12 or another work vehicle in the work area 32. As such, the vehicle 12 efficiently covers or works the work area 32 with or without one or more other vehicles in the work area and with or without the input of a work area boundary.
While the present disclosure has been illustrated and described in detail in the drawings and foregoing description, such illustration and description is not restrictive in character, it being understood that illustrative embodiment(s) have been shown and described and that all changes and modifications that come within the spirit of the present disclosure are desired to be protected. Alternative embodiments of the present disclosure may not include all of the features described yet still benefit from at least some of the advantages of such features. Those of ordinary skill in the art may devise their own implementations that incorporate one or more of the features of the present disclosure and fall within the spirit and scope of the appended claims.