Work vehicles
The work vehicle corrects deviations from the target route using a control device that adjusts steering and modifies the travel route, enhancing straight-line performance and work accuracy by stabilizing the trajectory and optimizing route efficiency.
Patent Information
- Application Number
- JP2021077092
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2021-04-30
- Publication Date
- 2024-12-05
- Estimated Expiration
- 2041-04-30
AI Technical Summary
Conventional work vehicles experience deviations from the target driving route immediately after starting automatic travel, leading to meandering and reduced work accuracy, particularly in agricultural tasks like ridge making and seeding, which can result in crooked ridges and seed rows.
A work vehicle equipped with a control device that calculates the deviation between the target travel route and the vehicle's position, adjusts the steering to align with the target route, and employs route correction methods such as modifying the target travel route by changing the intervals or adding new routes to stabilize the trajectory on a straight path.
The solution improves straight-line performance and work accuracy by stabilizing the vehicle's trajectory on the target route immediately after starting automatic travel, preventing unworked areas and optimizing the running order for efficient work execution.
Smart Images

Figure 0007594739000001 
Figure 0007594739000002 
Figure 0007594739000003
Abstract
Description
[Technical field]
[0001] The present invention relates to a work vehicle that performs agricultural work while autonomously traveling in a farm field. [Background technology]
[0002] Conventionally, as shown in, for example, Patent Document 1 below, a work vehicle is known that performs agricultural work (hereinafter simply referred to as work) while automatically traveling in a field using position information obtained from a satellite positioning system. In this conventional work vehicle, a travel route (hereinafter referred to as a target travel route), which is a target trajectory when automatically traveling, is set in advance according to the size and shape of the field before starting work. Then, during automatic traveling, the vehicle's own position (current position of the work vehicle) is calculated from the position information at predetermined time intervals, and further, the deviation of the vehicle's position from the target travel route (deviation in direction and distance) is calculated, and the steering wheel is automatically steered based on the calculated deviation. Note that the target travel route is set in a single stroke in order to efficiently work the entire field, and is set to include a straight route along which the work vehicle works while traveling straight, and a turning route along which the work vehicle turns and moves between the straight routes. [Prior art documents] [Patent documents]
[0003] [Patent Document 1] JP 2018-147163 A Summary of the Invention [Problem to be solved by the invention]
[0004] Here, immediately after the start of automatic driving, there is usually a deviation between the target driving route and the vehicle's position, so the work vehicle with the above-mentioned conventional configuration is likely to meander until it gets on the straight path of the target driving route and the trajectory stabilizes. As a result, there is a problem that the work accuracy decreases due to meandering when work is started immediately after the start of automatic driving. For example, in ridge making work or sowing work, meandering makes the ridges and sowing rows look bad, and there is also a risk that the machine will run over the curved ridges and sowing rows when performing subsequent work of cultivating soil or spraying chemicals.
[0005] Therefore, an object of the present invention is to provide a work vehicle that solves such problems and improves straight-line driving accuracy (straight-line driving ability) immediately after the start of automatic driving, thereby improving work accuracy. [Means for solving the problem]
[0006] In order to achieve the above object, the first invention provides: A work vehicle that automatically travels in a field along a target travel route, A control device is provided that acquires position information during automatic driving, calculates the vehicle's position, and automatically steers the vehicle along a set target driving route. The control device provides a work vehicle characterized in that it is equipped with a route correction unit that calculates the deviation between the work start point of the target driving route and the vehicle position in a direction perpendicular to the line direction at the start of automatic driving, and corrects the target driving route so that the work start point of the target driving route is in the line direction of the vehicle position.
[0007] According to the first aspect of the present invention, the vehicle can travel straight to the work start point immediately after starting automatic driving, and then move to the straight-line driving path of the target driving path while continuing to travel straight to start work. In other words, immediately after starting automatic driving, the vehicle can stably move to a trajectory on the straight-line driving path by simply adjusting the direction of the work vehicle. This improves straight-line driving ability immediately after starting automatic driving, and improves work accuracy.
[0008] The second invention is the above-mentioned first invention, The route correction unit corrects the target travel route by increasing or decreasing intervals between a plurality of straight line travel routes included in the target travel route.
[0009] According to the second aspect of the invention, in addition to the effect of the first aspect of the invention, it is possible to easily correct the target travel route without increasing the operation cost.
[0010] The third invention is the above-mentioned first invention, The path correction unit corrects the target traveling path by a method of translating a plurality of straight traveling paths included in the target traveling path by an amount of deviation in a direction perpendicular to the row direction.
[0011] According to the third aspect of the invention, in addition to the effect of the first aspect of the invention, it is possible to correct the target travel path so that the work start point of the target travel path is aligned with the direction of the vehicle position with high accuracy.
[0012] The fourth invention is the third invention, The control device includes an unworked area calculation unit that calculates an unworked area within a working area where work is not expected to be performed using information on a working width of a working machine and the target traveling path during a process of correcting the target traveling path by the path correction unit, The path correction unit is characterized in that when an unworked area is calculated by the unworked area calculation unit as a result of parallel shifting of multiple straight line driving paths included in the target driving path by an amount of deviation in a direction perpendicular to the row direction, the path correction unit adds a new straight line driving path to the target driving path and corrects the target driving path so that the calculated unworked area is eliminated.
[0013] According to the fourth aspect of the present invention, in addition to the effects of the third aspect of the present invention, This makes it possible to prevent areas from being left unworked as a result of correcting the target travel route.
[0014] The fifth invention is the fourth invention, The route correction unit is characterized in that, when a new straight-line travel route is added to the target travel route, the route correction unit changes the travel order of the straight-line travel routes.
[0015] According to the fifth aspect of the present invention, in addition to the effect of the fourth aspect of the present invention, by changing the travel order of the straight travel route, it is possible to prevent discrepancies in the travel order and to travel efficiently. Effect of the Invention
[0016] According to the present invention, it is possible to provide a work vehicle that has improved straight-line stability immediately after the start of autonomous driving and improved work accuracy. [Brief description of the drawings]
[0017] [Figure 1] FIG. 1 is a left side view of a work vehicle according to an embodiment of the present invention. [Diagram 2] FIG. 2 is a block diagram showing the configuration of the control device of the work vehicle of FIG. [Diagram 3] FIG. 3 is an explanatory diagram for explaining a target travel route of a work vehicle. [Figure 4] FIG. 4 is an explanatory diagram showing the flow of data relating to setting a target travel route for a work vehicle. [Diagram 5] FIG. 5 is an explanatory diagram for explaining an overview of the unworked area. [Figure 6] FIG. 6 is an explanatory diagram showing a procedure for correcting a target driving route using the overlap width increase / decrease method. [Figure 7] FIG. 7 is an explanatory diagram showing a procedure for correcting a target driving route by the straight driving route addition method. [Figure 8] FIG. 8 is an explanatory diagram showing a procedure for correcting a target travel route by the headland travel route addition method. [Figure 9] FIG. 9 is an explanatory diagram showing a procedure for correcting a target driving route according to a modified example. [Figure 10] FIG. 10 is a flowchart showing an example of processing by the control device when starting autonomous driving. [Figure 11]FIG. 11 is a flowchart showing an example of the target driving route correction process of FIG. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0018] Hereinafter, a preferred embodiment of the present invention will be described with reference to the accompanying drawings. In the following description, unless otherwise specified, the forward direction of the work vehicle is referred to as the front, the opposite direction is referred to as the rear, and the right side when facing forward is referred to as the right, and the left side is referred to as the left.
[0019] <1. Work vehicle configuration> FIG. 1 is a left side view of a work vehicle according to an embodiment of the present invention. The work vehicle A has a so-called tractor configuration, with a working implement WM, which is a working means, attached to the rear of a traveling body a1 equipped with an automatic traveling means. Note that the traveling body a1 and the working implement WM are not necessarily limited to the configuration of a tractor, and may be, for example, a combine harvester or the like.
[0020] As shown in FIG. 1, a vehicle body a1 has an engine EN as a driving source, a fuel tank (not shown), and a control device C that controls each mechanism arranged inside a bonnet a11, and the power from the engine EN is changed in speed by a transmission (not shown) in a transmission case a12 and transmitted to front wheels a13 and rear wheels a14, respectively, to move the vehicle.
[0021] A cabin a15 in which an operator sits is disposed behind the bonnet a11, and a rotating steering handle ST, which is a steering means for the traveling vehicle body a1, is provided on a dashboard inside the cabin a15.
[0022] When the steering handle ST is turned, the front wheels a13, which are steered wheels, turn via a steering device (not shown) according to the direction and amount of turning, whereby the traveling direction of the work vehicle A is changed.
[0023] A steering angle detection means (not shown) capable of detecting a steering angle corresponding to the rotation direction and operation amount of the steering handle ST is provided at the rotation base of the steering handle ST. This steering angle detection means is constituted by, for example, an angle sensor such as a rotary encoder. The traveling direction of the work vehicle A is determined according to this steering angle.
[0024] The work vehicle A is capable of switching between an automatic driving mode in which the steering handle ST is automatically operated, and a manual driving mode in which it is operated by the worker, by receiving a specified operation from the worker via an operating member not shown, using a control device C described below.
[0025] In addition, a steering actuator (steering motor) (not shown) is provided on the rotation axis (steering shaft) of the steering wheel ST to rotate and control the steering wheel ST, enabling automatic steering. Feedback control using the steering angle of this steering actuator as a control amount makes it possible to control the driving direction of the work vehicle A during automatic driving.
[0026] The transmission case a12 also houses a PTO clutch, a PTO transmission, and a braking device (not shown), making it possible to control the transmission of power to the PTO shaft. This allows the work vehicle A to control the drive of the work machine WM.
[0027] A work machine mounting device WJ consisting of lift arms a22, a22 protruding rearward from the side of a hydraulic cylinder case a21, a top link a23, a lower link a24, a24, etc. is disposed at the rear of the traveling body a1, and the work machine WM mounted on the work machine mounting device WJ can be raised and lowered by the extension and contraction of the hydraulic cylinder a25. As a result, the work machine WM is configured to be switchable between a working position where work is performed on the field and a non-working position where no work is performed. For example, if the work machine WM is a tiller, the working position refers to a grounded state, and the non-working position refers to a state where the work machine is raised from the grounded state and is not grounded. In the illustrated example, the work machine WM is a rotary tiller, but the work machine WM mounted on the work vehicle A can be a fertilizer spreader, a pesticide spreader, a seed spreader, a harvester, etc. in addition to the above-mentioned rotary tiller.
[0028] The positioning device AN is provided approximately in the center in the front-rear direction of the traveling vehicle body a1, and is a device that measures the position of the traveling vehicle body A. The positioning device AN is equipped with a GNSS (Global Navigation Satellite System) that receives radio waves from a navigation satellite AS orbiting in the sky using a positioning antenna (not shown) to perform positioning and timing, and is also equipped with an inertial measurement unit that measures the attitude, direction, etc. of the work vehicle A using a three-axis gyroscope, a three-directional acceleration sensor, etc.
[0029] <2. Configuration of the control device> FIG. 2 is a block diagram showing the configuration of a control system including the control device C of the work vehicle A. The control device C is an information processing device configured by combining multiple ECUs (Electronic Control Units). Each of the multiple ECUs is configured with a CPU that performs arithmetic processing and a memory that can read and write information required for the arithmetic processing, and the configuration shown as functional blocks in Fig. 2 is realized by the CPU operating according to various control programs stored in the memory.
[0030] As shown in FIG. 2, the control device C includes an output processing unit c1, a communication processing unit c2, an input processing unit c3, a driving control unit c4, an information storage unit c5, and a route management unit c6, which are configured to be able to send and receive information to each other via a communication bus BA.
[0031] The output processing unit c1 is a device that functions as an input / output interface, and is connected to a traveling system device group MA1 that controls traveling functions such as running, stopping, and changing the traveling direction of the work vehicle A, a work system device group MA2 that controls operations such as raising / lowering, driving, and stopping the work machine WM, and a notification unit MA3 that outputs video and audio to notify the worker of various information. Note that in this embodiment, the traveling system device group MA1 includes mechanisms such as a steering actuator, engine EN, a speed change device, and brakes, and the work system device group MA2 includes mechanisms such as a PTO clutch, a PTO speed change device, a braking device, and a hydraulic cylinder a25.
[0032] The communication processing unit c2 is a communication mechanism that connects to an external device physically separated from the control device C via a network NW and exchanges information through communication. In this embodiment, the communication processing unit c2 is connected to an operation terminal T and is capable of sending and receiving information.
[0033] The operation terminal T is equipped with a communication control unit t1, a display unit t2, and an operation unit t3, and is an information terminal having the functions of a computer system and a function as a user interface for inputting the conditions necessary for the automatic driving realized by the control device C. For example, the communication control unit t1 is an information processing device including a CPU, ROM, RAM, etc., the display unit t2 is a liquid crystal panel, and the operation unit t3 is a touch panel, buttons, etc.
[0034] The operation terminal T also includes an area selection unit t4 for setting the work area R, which will be described later. This area selection unit t4 is a program that displays information required to set the work area R on the display unit t2 in response to a request from the control device C, accepts input of information required to define the position, size, range, etc. of the work area R via the operation unit t3, and returns information regarding the work area R that is determined based on the input information selected and determined by the worker to the control device C.
[0035] The input processing unit c3 is a mechanism for receiving information input from a connected external device, and is capable of acquiring various information such as positioning information, detection information, etc. In this embodiment, the input processing unit c3 is connected to the positioning device AN, a traveling system detection sensor SN1 including a steering angle detection means, and a work system detection sensor SN2 that detects the operation, attitude, and other conditions of the work machine WM.
[0036] The control device C also includes a travel control unit c4 that controls the travel of the work vehicle A, an information storage unit c5 that stores various information, and a route management unit c6 that performs processing related to the target travel route L.
[0037] The driving control unit c4 is a mechanism that includes a program and various circuits that control the driving of the work vehicle A during automatic driving (automatic steering) and manual driving (manual steering), and is equipped with an automatic driving control unit c41 that controls the driving system equipment group MA1 during automatic driving, and a manual driving control unit c42 that controls the driving system equipment group MA1 during manual driving.
[0038] The automatic driving control unit c41 includes a vehicle position calculation unit c43 that calculates the vehicle position by acquiring positioning information (position information) from the positioning device AN, a vehicle orientation calculation unit c44 that calculates the vehicle orientation, a deviation calculation unit c45 that calculates a deviation, and a steering angle calculation unit c46 that calculates a steering angle from detection information of the driving system detection sensor group SN1. The automatic driving control unit c41 configured in this manner calculates a deviation using the deviation calculation unit c45, calculates a steering angle of the steering wheel ST appropriate for the work vehicle A to travel along the target driving path L based on the calculated deviation, and controls the steering actuator to achieve the calculated steering angle, thereby enabling the work vehicle A to travel automatically.
[0039] The information storage unit c5 is a storage device capable of storing various information, and is, for example, configured with an HDD (Hard Disc Drive) or an SSD (Solid State Drive). The information storage unit c5 includes a field information storage unit c51 that stores information about the field, a route information storage unit c52 that stores information about the travel route during automatic traveling, and a work information storage unit c53 that stores information about the work.
[0040] The field information storage section c51 stores information such as field information (such as the size, shape, and map position of the field to be worked on, and the position data of the ridges that define the boundary lines of the field), and work area information that defines the work area R within the field (the area to be worked on).
[0041] The route information storage unit c52 stores information related to the target travel route L, operation costs for the target travel route L (travel distance, fuel consumption, operation time, etc. corresponding to the target travel route L), and the like.
[0042] The work information storage section c53 stores information regarding the work width W, the type of work (inter-cultivation, seeding, etc.), and the like, which are preset by the worker.
[0043] The route management unit c6 is a program that manages (calculates, corrects, sets, etc.) the target driving route L, and includes an area setting unit c61, a route calculation unit c62, a route correction unit c63, an unworked area calculation unit c64, an inappropriate route exclusion unit c65, a work cost calculation unit c66, and a route setting unit c67.
[0044] Fig. 3 is an explanatory diagram for explaining the target travel route L of the work vehicle A, and Fig. 4 is an explanatory diagram showing the flow of data related to setting the target travel route L of the work vehicle A. Next, the functions of the area setting unit c61 and the route calculation unit c62 will be described with reference to Figs. 3 and 4.
[0045] The area setting unit c3 acquires the field information from the field information storage unit c51, and sets a working area R within the field H. As shown in Fig. 3, this working area R is a substantially rectangular area whose position, size, and range are determined within the field H based on input information from the operation unit t3. Upon acquiring the field information, the area setting unit c3 makes an input request to the operation terminal T, defines the working area R based on the input information, and passes information about the working area R together with the field information to the path calculation unit c62 (see Fig. 4).
[0046] The path calculation unit c62 acquires information on the work area R, field information, and information on the work width W, and calculates a target travel path L within the defined work area R. Here, the calculation of the target travel path L is performed, for example, by the following design procedure.
[0047] First, the working area R is divided into a headland traveling area R1 where work is performed by traveling in a circular manner, and a straight-line traveling area R2 where work is performed by traveling in a straight line. Here, the headland traveling area R1 is set as a frame-shaped area having a working width W, and a rectangular straight-line traveling area R2 is set inside the headland traveling area R1.
[0048] Next, a headland travel path l1 that travels in a circular manner within the headland travel area R1 is designed. Then, multiple straight travel paths l2 that travel in a straight line within the straight line travel area R2 are designed. A predetermined overlap width V is provided between the straight travel paths l2 so that the working width W overlaps when traveling on the straight travel paths l2.
[0049] Next, a non-work route l3 is designed, which is a route where no work is performed, for moving between the straight-line travel routes l2 in a single stroke and for moving from the straight-line travel route l2 to the headland travel route l1. At this time, the order of travel of the headland travel route l1 and the straight-line travel route l2 is also determined. The direction of the arrows of the straight-line travel route l2 and the straight-line travel route l2 shown in FIG. 3 indicates the direction of travel of the work vehicle A, and the numbers enclosed in circles shown near the ends of the arrows indicate the order of travel during automatic travel. The target travel route L is calculated by the above design procedure. The route calculation unit c62 passes information on the calculated target travel route L to the route correction unit c63 (see FIG. 4).
[0050] As shown in Fig. 3, the start point of the straight-line travel path l2 on one end of the straight-line travel area R2 is the work start point Ps (the point where work is first started by the work implement WM) on the straight-line travel path l2, and the end point of the straight-line travel path l2 on the other end is the work end point Pe (the point where work ends within the straight-line travel area R2). When the work vehicle A starts automatic traveling, it is assumed that the work vehicle A has moved to the vicinity of the work start point Ps. In the following, for ease of explanation, one end of the straight-line travel area R2 will be referred to as the right, and the other end of the straight-line travel area R2 will be referred to as the left.
[0051] The route correction unit c63 acquires information on the target driving route L, and at the start of automatic driving, acquires information on the deviation from the deviation calculation unit c45 and calculates a corrected target driving route L based on the deviation between the vehicle position and the target driving route L. Here, the route correction unit c63 is configured to calculate a plurality of corrected target driving routes L by a plurality of correction methods (overlap width increase / decrease method, straight driving route addition method, and headland driving route addition method). The plurality of correction methods will be described in detail later.
[0052] The unworked area calculation unit c64 calculates the unworked area R3 when the path correction unit c63 corrects the target travel path L. Here, the unworked area R3 refers to an area within the straight travel area R2 where no work is performed, as shown by the shaded area in Fig. 5, when it is assumed that the work vehicle A travels along the target travel path L while performing work in the work width W. Note that the colored area within the work area R in Fig. 5 indicates an area where work is performed.
[0053] The inappropriate route exclusion unit c65 acquires information on the proposed target travel route from the route correction unit c63, and performs a function of excluding an inappropriate target travel route L from the proposed target travel route. For example, an inappropriate target travel route L refers to a target travel route L that deviates from a farm field or has a straight line travel route l2 outside the straight line travel region R2.
[0054] The operation cost calculation unit c66 acquires the target travel route plan from which the inappropriate target travel route L has been excluded from the inappropriate route exclusion unit c65, and calculates the operation cost for each target travel route L. Next, the target travel route plan and information on the operation cost are transferred to the route setting unit c67 (see FIG. 4).
[0055] The route setting unit c67 acquires information on the target travel route plan and the work cost from the work cost calculation unit c66, transmits them to the operation terminal T, displays the target travel route plan and the work cost on the display unit t2, and has the worker select and decide one of the target travel route plans L by the operation unit t3, acquires input information from the operation terminal T, and sets the target travel route L decided by the worker in the control device C as the target travel route L along which the work vehicle A will automatically travel. At this time, the decided target travel route L is stored in the route information storage unit c23 and transferred to the automatic travel control unit c41, and automatic travel is started (see FIG. 4). By displaying the target travel route plan and the work cost on the display unit t2, the target travel route L, the work cost, and straightness are visualized, and can be used as information for the worker's decision.
[0056] <3. How to correct the target driving route (overlap width increase / decrease method)> FIG. 6 is an explanatory diagram showing a procedure for correcting the target travel path L by the overlap width increase / decrease method. As shown in Fig. 6(a), the correction procedure will be described for the case where the vehicle position when the work vehicle A starts automatic traveling has a deviation d to the left in the direction perpendicular to the line direction (left-right direction on the paper in Fig. 6) with respect to the work start point Ps (when the left deviation point PL in Fig. 6 is the vehicle position) and the case where the vehicle has a deviation d to the right (when the right deviation point PR in Fig. 6 is the vehicle position). Note that the line direction (up-down direction on the paper in Fig. 6) and the deviation in the orientation are not taken into consideration. Also, the line direction refers to the direction parallel to the straight-line traveling path l2.
[0057] As shown in Figure 6(b), if the vehicle position has a deviation d to the left, the straight path l2 is translated in the direction in which the overlap width V increases, thereby correcting the target driving path L so that the new work start point Ps' is in the straight-ahead direction (line direction) of the vehicle position.
[0058] As shown in Fig. 6(c), when the vehicle position has a deviation d to the right, the straight path l2 is translated in a direction that reduces the overlap width V, and the target travel path L is corrected so that the new work start point Ps' is in the straight-ahead direction (line direction) of the vehicle position. This method makes it possible to easily correct the target travel path L without increasing the work cost.
[0059] <4. How to correct the target driving route (How to add a straight driving route)> FIG. 7 is an explanatory diagram showing a procedure for correcting the target travel path L by the straight travel path addition method. As shown in Fig. 7(a), the correction procedures are explained for the case where the vehicle position when the work vehicle A starts automatic traveling with respect to the work start point Ps is the left deviation point PL and the case where the vehicle position is the right deviation point PR. Note that the deviation of the line direction (the vertical direction on the paper in Fig. 7) and the azimuth direction are not taken into consideration.
[0060] As shown in FIG. 7(b), if the vehicle position has a deviation d to the left, all straight-line paths l2 are translated to the left (downstream in the work direction) by the deviation d, and the straight-line path l2 is corrected so that the new work start point Ps' is in the straight-line direction (row direction) of the vehicle position. At this time, if an unworked area R3 does not occur, the correction of the target travel path L is completed. If an unworked area R3 occurs, as shown in FIG. 7(c), a straight-line path l2 is added to the right (upstream in the work direction) and the unworked area R3 is corrected to eliminate it. At this time, the travel order of the straight-line travel path l2 and the headland travel path l3 is also changed so that the travel order is optimized. This completes the correction of the target travel path L. According to this method, it is possible to accurately correct the target travel path so that the work start point Ps' of the target travel path L is in the row direction of the vehicle position.
[0061] As shown in FIG. 7(d), when the vehicle position has a deviation d to the right, all straight-line paths l2 are moved in parallel to the right (upstream in the work direction) by the deviation d, and the straight-line path l2 is corrected so that the new work start point Ps' is in the straight-line direction (row direction) of the vehicle position. At this time, if an unworked area R3 does not occur, the correction of the target travel path L is completed. If an unworked area R3 occurs, as shown in FIG. 7(e), a straight-line path l2 is added to the left side (downstream in the work direction) and the unworked area R3 is corrected to eliminate it. This makes it possible to prevent an area that is not worked from occurring as a result of correcting the target travel path L. At this time, the travel order is also changed so that the travel order of the straight-line travel path l2 and the headland travel path l3 is optimized. This completes the correction of the target travel path L. In this way, by changing the travel order of the target travel path L, it is possible to prevent a situation in which a discrepancy occurs in the travel order, and to travel efficiently.
[0062] <5. How to correct the target driving route (How to add a headland driving route)> FIG. 8 is an explanatory diagram showing a procedure for correcting the target travel route L by the headland travel route addition method. As shown in Fig. 8(a), the correction procedures are explained for the cases where the vehicle position when the work vehicle A starts automatic traveling with respect to the work start point Ps is the left deviation point PL and the right deviation point PR. Note that the deviation of the line direction (the vertical direction on the paper in Fig. 8) and the azimuth direction are not taken into consideration.
[0063] As shown in FIG. 8(b), if the vehicle position has a deviation d to the left, all straight-line paths l2 are moved in parallel to the left (downstream of the work direction) by the deviation d, and the straight-line path l2 is corrected so that the new work start point Ps' is in the straight-line direction (row direction) of the vehicle position. At this time, if an unworked area R3 does not occur, the correction of the target travel path L is completed. If an unworked area R3 occurs, as shown in FIG. 8(c), a headland travel path l2 is further added inside the headland travel path l1, and the unworked area R3 is corrected to eliminate it. This makes it possible to prevent the occurrence of an area that is not worked as a result of correcting the target travel path L. At this time, the travel order is also changed so that the travel order of the straight-line travel path l2 and the headland travel path l3 is optimized. This completes the correction of the target travel path L.
[0064] As shown in FIG. 8(d), if the vehicle position has a deviation d to the right, all straight-line paths l2 are translated to the right (upstream of the work direction) by the deviation d, and the straight-line paths l2 are corrected so that the new work start point Ps' is in the straight-line direction (row direction) of the vehicle position. At this time, if an unworked area R3 does not occur, the correction of the target travel path L is completed. If an unworked area R3 occurs, as shown in FIG. 8(e), a headland travel path l2 is further added inside the headland travel path l1, and the correction is made so that the unworked area R3 is eliminated. At this time, the travel order of the straight-line travel path l2 and the headland travel path l3 is also changed so that the travel order is optimized. This completes the correction of the target travel path L.
[0065] <6. Method for correcting the target driving route (variation example)> FIG. 9 is an explanatory diagram showing a procedure for correcting the target travel path L according to a modified example. In Figures 7(d) and 7(e), when an unworked area R3 occurs, a straight line path l2 is added to the left side (downstream in the work direction) to correct the unworked area R3, but as shown in Figures 9(b) and 9(c), when an unworked area R3 occurs on the left side, each straight line path l2 may be translated in the direction that reduces the overlap width V, thereby correcting the unworked area R3 to disappear. With this method, regardless of whether the unworked area R3 occurs on the left or right side, the unworked area R3 can be successfully eliminated.
[0066] By the above-mentioned method, the path correction unit c63 corrects the straight-line travel path l2 of the target travel path L based on the vehicle's position at the start of automatic driving so that the new work start point Ps' comes in the direction from the vehicle's position. Therefore, the work vehicle A according to this embodiment can travel straight to the work start point Ps' immediately after the start of automatic driving, and then move to the straight-line travel path l2 while continuing to travel straight to start work. In other words, immediately after the start of automatic driving, if only the orientation of the work vehicle A is adjusted, it can stably move to the trajectory on the straight-line travel path l2. This improves the straight-line travelability immediately after the start of automatic driving, and improves the work accuracy.
[0067] <7. Processing when automatic driving starts> Fig. 10 is a flowchart showing an example of the processing of the control device C when the automatic driving starts. Also, Fig. 11 is a flowchart showing an example of the processing of the target driving route correction processing of Fig. 10. Next, the processing of the control device C when the automatic driving starts will be described with reference to Figs. 10 and 11.
[0068] As shown in FIG. 10, before starting automatic traveling, the control device C acquires field information from the field information storage unit c51 (step S101), and sets a work area R by the area setting unit c61 (step S102).
[0069] Next, the target travel route L is calculated by the target route calculation unit c62, and information related to the calculated target travel route L is stored in the route information storage unit c52 (step S103).
[0070] Next, when the control device C receives an instruction to start automatic driving through a predetermined operation by the operator (Yes in step S104), it acquires a deviation from the deviation calculation unit c45 and starts a target driving route correction process to correct the target driving route based on the acquired deviation.
[0071] When the target driving route correction process is started, as shown in Figure 11, the control device C calculates a target driving route L corrected by the overlap width increase / decrease method using the route correction unit c63 and the unworked area calculation unit c64 (step S201), calculates a target driving route L corrected by the straight line driving route addition method (step S202), and calculates a target driving route L corrected by the headland driving route addition method (step S203), and excludes inappropriate target driving routes L from these calculated multiple target driving routes L (proposed target driving routes) using the inappropriate route exclusion unit c65 (step S204).
[0072] Next, the operation cost is calculated for each of the target travel routes L included in the target travel route proposal (step S205).
[0073] Once the work cost has been calculated, input from the worker is accepted from the information terminal T, and the target driving route L selected and determined by the worker from among the proposed target driving routes is set in the route information storage unit c52 as the target driving route L along which the work vehicle A will ultimately travel (step S206).
[0074] After that, returning to FIG. 10, the automatic driving control unit c41 starts automatic driving according to the set target driving route L (step S107).
[0075] <8. Another embodiment> The present invention is not limited to the above-described embodiments, and various modifications are possible within the scope of the invention described in the claims, and it goes without saying that these modifications are also included within the scope of the present invention.
[0076] In the above embodiment, the route setting unit c67 displays the work costs of multiple target driving routes L included in the proposed target driving route on the display unit t2, and the worker selects and determines one target driving route L using the operation unit t3. However, the route setting unit c67 may be configured to first present to the worker the most efficient target driving route L in terms of driving distance, work time, straightness, and fuel consumption.
[0077] Furthermore, the system may be configured to have a sorting function in which the operator selects which of the travel distance, work time, straightness, and fuel consumption he or she wants to prioritize.
[0078] Also, the correction of the target travel path L by the path correction unit c33 may be configured to be valid only if the deviation is within a predetermined range (one process, within the work width W, etc.). Furthermore, when the correction of the target travel path L is invalid, a pop-up may be displayed on the display unit t2 to the effect that the correction of the target travel path L has failed.
[0079] The path correction unit c33 may be configured to acquire the work content from the work information storage unit c53, and may be configured not to enable the correction of the target travel path L by the path correction unit c33 in the case of a predetermined work content. Since there are some works, such as tillage, for which the correction of the target travel path L is not appropriate, such a configuration can avoid the change of the target travel path L in the work for which it is not desirable to change it.
[0080] Furthermore, in the above embodiment, the operation terminal T is connected to the control device C via the network NW and configured as a device external to the body of the work vehicle A, but it may also be provided on the body side (for example, inside the cabin a15) by connecting to the control device C via a communication bus BA. [Explanation of symbols]
[0081] A Work vehicle a1 Running vehicle a11 bonnet a12 transmission case a13 front wheel a14 rear wheel a15 cabin a21 Hydraulic cylinder case a22 lift arm a23 Top link a24 lower link a25 hydraulic cylinder BA Communication Bus C Control device L Target driving route l1 Headland route l2 Straight driving path l3 non-working path R work area R1 Headland driving area R2 Straight driving area R3 Unworked area T Operation terminal V overlap width W Working width AS Navigation Satellite 225 Electric display section 226 LCD display section 227 Directional Information Unit 227r Right direction display 227l Left direction display 228 Input operation section 228a Rotary Switch 228b Push button switch 229 Audio output section 301 Seedling Planting Department 302 Seedling stand 303 Seedling planting device 304 Float 305 Seedling placement surface 306 Studded rod 307 Rotary Case 308 Planting transmission case 309 Hydraulic Rolling Cylinder 310 Land leveling rotor 311 Leveling rotor adjustment mechanism BA Communication Bus C Control device L Target driving route l1 Straight driving route l2 Turning path T Information terminal
Claims
1. A work vehicle that automatically travels in a field along a target travel route, A control device that acquires position information during automatic driving to calculate a vehicle position and automatically steers the vehicle along a set target driving route, and a farm field information storage unit that stores farm field information, The control device includes an area setting unit that defines and sets a work area in the field based on the field information acquired from the field information storage unit and input information input by an operator; a route calculation unit that calculates the target driving route within the working area set by the area setting unit; and a route correction unit that calculates a deviation between a working start point of the calculated target driving route and a vehicle position in a direction perpendicular to a line direction at the start of autonomous driving, and corrects the calculated target driving route. and an unworked area calculation unit that calculates an unworked area within the set working area in which no work is expected to be performed, using a preset working width of the work implement and information on the calculated target traveling path during the process of correcting the calculated target traveling path by the path correction unit, the route calculation unit is configured to divide the set working area into a headland traveling area in which work is performed by traveling in a circular manner, and a straight-line traveling area in which work is performed by traveling in a straight line, set the headland traveling area to a frame-shaped area having the working width, and set the straight-line traveling area inside the headland traveling area, so that a headland traveling path that travels in a circular manner within the headland traveling area and a plurality of straight-line traveling paths that travel in a straight line within the straight-line traveling area are included in the target traveling path; and When the calculated target driving route is corrected by the route correction unit, the multiple straight driving routes included in the calculated target driving route are translated by an amount of deviation in a direction perpendicular to the row direction, and then the unworked area calculation unit calculates the unworked area to determine whether or not an unworked area has occurred, and if it is determined that an unworked area has occurred, the calculated target driving route is corrected so as to add a new headland driving route inside the headland driving route.
2. The work vehicle according to claim 1, characterized in that, when a new headland travel route is added to the calculated target travel route, the route correction unit changes a travel order of the straight line travel routes and the headland travel routes included in the calculated target travel route.
Citation Information
Patent Citations
Route generation system
JP2018055179A
Traveling route determination device
JP2018092620A
Running route specifying system
JP2018147163A
Travel path setting device
JP2019097529A
Work vehicle
JP2019154394A
Cited By
Path generation method, path generation program, and path generation system
EP4787103A1
