The present invention relates to a route generation method, a route generation system, and a route generation program that generate a target route that causes a work vehicle to travel autonomously in a field.
Conventionally, a technique is known that generates a target route that causes a work vehicle to travel autonomously in a field. For example, a technique is known that, when an operator boards a work vehicle and performs a registration operation that registers a teaching start point (reference start point) and a teaching end point (reference end point) while performing teaching travel in a field, registers a line segment connecting the reference start point and the reference end point as a reference line, and then generates a straight route (target route) that is parallel to the reference line (for example, see Patent Document 1).
However, in a teaching operation that generates a target route, the operator can sometimes perform predetermined work (such as planting work or reaping work) while the work vehicle is performing teaching travel. When a target route is generated while the work vehicle is performing predetermined work, it is easy for the operator to forget to perform operations that register a reference start point and a reference end point. In this case, because a reference line and a target route are not generated, the operator needs to perform teaching travel again. In this way, the conventional technique has a problem that the workability of the work that generates a target route is low.
An object of the present invention is to provide a route generation method, a route generation system, and a route generation program that are capable of improving the workability of work that generates a target route that causes a work vehicle to travel autonomously in a field.
A route generation method according to the present invention is a route generation method that generates a target route for causing a work vehicle to travel autonomously in a field. The route generation method executes the steps of: acquiring position information of a predetermined position of the work vehicle in the field; registering the predetermined position as a reference point when the work vehicle has traveled a predetermined distance from the predetermined position, or when a predetermined time has elapsed since the work vehicle started to travel from the predetermined position; and generating the target route based on the reference point.
A route generation system according to the present invention is a route generation system that generates a target route for causing a work vehicle to travel autonomously in a field. The route generation system includes an acquisition processing unit, a registration processing unit, and a generation processing unit. The acquisition processing unit acquires position information of a predetermined position of the work vehicle in the field. The registration processing unit registers the predetermined position as a reference point when the work vehicle has traveled a predetermined distance from the predetermined position, or when a predetermined time has elapsed since the work vehicle started to travel from the predetermined position. The generation processing unit generates the target route based on the reference point.
A route generation program according to the present invention is a route generation program that generates a target route for causing a work vehicle to autonomous travel in a field. The route generation program causes one or more processors to execute the steps of: acquiring position information of a predetermined position of the work vehicle in the field; registering the predetermined position as a reference point when the work vehicle has traveled a predetermined distance from the predetermined position, or when a predetermined time has elapsed since the work vehicle started to travel from the predetermined position; and generating the target route based on the reference point.
According to the present invention, it is possible to provide a route generation method, a route generation system, and a route generation program that are capable of improving the workability of work that generates a target route that causes a work vehicle to travel autonomously in a field.
The embodiment described below is a specific example that embodies the present invention, and is not intended to limit the technical scope of the present invention.
The autonomous travel system according to an embodiment of the present invention includes a work vehicle 10, a satellite (not shown), and a base station (not shown). In the present embodiment, a case where the work vehicle 10 is a rice transplanter will be described as an example. Note that, as other embodiments, the work vehicle 10 may be a tractor, a combine, a construction machine, a snowplow, or the like. The work vehicle 10 performs predetermined work (such as planting work) while traveling along a target route R in a field F (see
The work vehicle 10, for example, travels in the field F illustrated in
The autonomous travel system may include an operation terminal (such as a tablet terminal or a smartphone) that is operated by the operator. The operation terminal can communicate with the work vehicle 10 via a communication network such as a cellular telephone line network, a packet line network, or a wireless LAN. For example, the operator operates the operation terminal and performs operations that register various types of information (such as work vehicle information, field information, and work information) and the like. Furthermore, the operator is able to confirm, at a position away from the work vehicle 10, the travel status, the work status, and the like of the work vehicle 10 by a travel path that is displayed on the operation terminal.
[Work Vehicle 10]
As illustrated in
Furthermore, the vehicle control device 11 and the operation device 17 may be capable of performing wireless communication.
First, a rice transplanter, which is an example of the work vehicle 10, will be described with reference to
An engine (drive unit) 131 is disposed inside a hood 134 arranged in a front portion of the vehicle body portion 30. The power generated by the engine 131 is transmitted to the front wheels 132 and the rear wheels 133 via a transmission case 135. The power transmitted via the transmission case 135 is also transmitted to the work machine 14 via a PTO shaft 37 disposed in a rear portion of the vehicle body portion 30. The PTO shaft 37 is configured such that the power is transmitted to it via a planting clutch (working clutch) (not shown). A driver's seat 138 on which the operator boards is provided in a position between the front wheels 132 and the rear wheels 133 in a front-rear direction of the vehicle body portion 30.
Operation tools such as a steering wheel 137, a main speed change lever 13L (see
When the main speed change lever 13L is operated to the “neutral” position, the power transmitted to the front wheels 132 and the rear wheels 133 is cut off. When the main speed change lever 13L is operated to the “seedling transfer” position, the power transmitted to the front wheels 132, the rear wheels 133 and the PTO shaft 37 is cut off. Furthermore, by operating the planting clutch lever 14L, switching is possible between a transmission state in which the planting clutch transmits power to the PTO shaft 37 (that is, the work machine 14) and a cut-off state in which the planting clutch does not transmit power to the PTO shaft 37 (that is, the work machine 14).
The work machine 14 is joined to the rear of the vehicle body portion 30 via a raising/lowering link mechanism 31. The raising/lowering link mechanism 31 is configured by a parallel link structure including a top link 39, a lower link 38, and the like. A raising/lowering cylinder (raising/lowering device) 32 is joined to the lower link 38. The entire work machine 14 may be vertically raised and lowered by extending and contracting the raising/lowering cylinder 32. As a result, the height of the work machine 14 may be changed between a lowered position in which the work machine 14 is lowered to perform planting work, and a raised position in which the work machine 14 is raised and does not perform planting work. The raising/lowering cylinder 32 is a hydraulic cylinder, but an electric cylinder may also be used. Furthermore, a configuration may be used in which the work machine 14 is raised and lowered by an actuator other than a cylinder.
The work machine 14 (planting unit) includes a planting input case 33, a plurality of planting units 34, a seedling stand 35, a plurality of floats 36, and the like.
Each of the planting units 34 includes a planting transmission case 41 and a rotary case 42. The power is transmitted to the planting transmission case 41 via the PTO shaft 37 and the planting input case 33. Each of the planting transmission cases 41 has the rotary case 42 mounted on both sides thereof in a vehicle width direction. Two planting claws 43 are mounted side-by-side on each of the rotary cases 42 in the forward direction of the work vehicle 10. The two planting claws 43 perform planting of a single row.
As illustrated in
The float 36 illustrated in
Spare seedling stands 19 are provided outside of the hood 134 in the vehicle width direction, and are capable of being loaded with a seedling box that accommodates spare mat seedlings. The upper portions of the pair of left and right spare seedling stands 19 are joined to each other by a coupling frame 18 that extends in the vertical direction and the vehicle width direction. The positioning device 16 is disposed on the center of the coupling frame 18 in the vehicle width direction.
As shown in
The positioning control unit 161 is a computer system provided with one or more processors and storage memory, such as a non-volatile memory and a RAM. The storage unit 162 is a non-volatile memory or the like that stores a positioning control program for causing the positioning control unit 161 to execute positioning processing, and data such as positioning information and movement information. For example, the positioning control program is non-transiently recorded on a computer-readable recording medium such as a CD or a DVD, which is read by a predetermined reading device (not shown) and then stored in the storage unit 162. Note that, the positioning control program may be downloaded from a server (not shown) to the positioning device 16 via a communication network and then stored in the storage unit 162.
The communication unit 163 is a communication interface for connecting the positioning device 16 to a communication network in a wired or wireless fashion, and executing data communication according to a predetermined communication protocol with an external apparatus such as a base station server via the communication network.
The positioning antenna 164 is an antenna that receives radio waves (a GNSS signal) transmitted from a satellite.
The positioning control unit 161 calculates the current position of the work vehicle 10 based on the GNSS signal that the positioning antenna 164 receives from the satellite. For example, in a case where the work vehicle 10 travels autonomously in the field F, when the positioning antenna 164 receives radio waves (such as a transmission time and orbit information) transmitted from each of a plurality of satellites, the positioning control unit 161 calculates a distance between the positioning antenna 164 and each satellite, and calculates the current position (latitude and longitude) of the work vehicle 10 based on the calculated distances. Alternatively, the positioning control unit 161 may perform positioning using the real-time kinematic method (the RTK-GNSS positioning method (RTK method)), which calculates the current position of the work vehicle 10 using correction information corresponding to a base station (reference station) near the work vehicle 10. In this way, the work vehicle 10 uses positioning information based on the RTK method to perform autonomous travel. The current position of the work vehicle 10 may be the same position as the positioning position (for example, the position of the positioning antenna 164), or may be a position that is offset from the positioning position.
The communication unit 15 is a communication interface for connecting the work vehicle 10 to a communication network in a wired or wireless fashion, and executing data communication according to a predetermined communication protocol with an external apparatus (such as an operation terminal) via the communication network.
The storage unit 12 is a non-volatile storage unit such as a hard disk drive (HDD) or a solid state drive (SSD) that stores various types of information. The storage unit 12 stores a control program such as an autonomous travel program that causes the vehicle control device 11 to execute autonomous travel processing. For example, the autonomous travel program is non-transiently recorded on a computer-readable recording medium such as a CD or a DVD, which is read by a predetermined reading device (not shown) and then stored in the storage unit 12. Note that, the autonomous travel program may be downloaded from a server (not shown) to the work vehicle 10 via a communication network and then stored in the storage unit 12. The storage unit 12 may also store data of the target route R that is generated in the operation device 17.
The operation device 17 is an apparatus operated by the operator that boards the work vehicle 10, and displays various types of information and receives operations from the operator. More specifically, the operation device 17 displays various setting screens and receives various setting operations from the operator, and displays information relating to the work vehicle 10 during travel. A specific configuration of the operation device 17 will be described below.
The vehicle control device 11 includes a control apparatuses such as a CPU, a ROM, and a RAM. The CPU is a processor that executes various types of arithmetic processing. The ROM is a non-volatile storage unit that stores in advance control programs such as a BIOS and an OS for causing the CPU to execute various types of arithmetic processing. The RAM is a volatile or non-volatile storage unit that stores various types of information, and is used as a temporary storage memory (work area) for the various types of processing executed by the CPU. Further, the vehicle control device 11 controls the work vehicle 10 as a result of the CPU executing the various control programs stored in advance in the ROM or the storage unit 12. Furthermore, the vehicle control device 11 executes various types of processing according to the autonomous travel program using the CPU.
More specifically, the vehicle control device 11 controls the travel of the work vehicle 10. For example, the vehicle control device 11 causes the work vehicle 10 to manually travel based on operations from the user (manual steering) when the travel mode of the work vehicle 10 is set to manual travel (manual travel mode). For example, the vehicle control device 11 acquires operation information corresponding to driving operations by the operator, such as steering wheel operations, speed change operations, shift operations, accelerator pedal operations, brake operations, and the like, and causes the travel device 13 to execute travel motions based on the operation information.
Furthermore, when the travel mode of the work vehicle 10 is set to autonomous travel (autonomous travel mode), the vehicle control device 11 causes the work vehicle 10 to travel autonomously based on the position information (positioning information) representing the current position of the work vehicle 10 that is positioned by the positioning control unit 161. For example, when the work vehicle 10 satisfies an autonomous travel start condition and acquires a travel start instruction from the operator, the vehicle control device 11 causes the work vehicle 10 to start performing autonomous travel based on the positioning information. Moreover, the vehicle control device 11 causes the work vehicle 10 to travel autonomously along the target route R (straight route) that has been generated in advance.
In addition, the vehicle control device 11 is capable of causing the work vehicle 10 to travel autonomously along the target route R (straight route) generated according to a route generation mode that has been set to one of a plurality of route generation modes (details below). For example, when the operator selects a first route generation mode (“point A+point B” mode), the vehicle control device 11 causes the work vehicle 10 to travel autonomously along the target route R that has been generated by the first route generation mode. Furthermore, for example, when the operator selects a second route generation mode (“point A+vehicle azimuth angle” mode), the vehicle control device 11 causes the work vehicle 10 to travel autonomously along the target route R that has been generated by the second route generation mode. Moreover, for example, when the operator selects a third route generation mode (“point A+set azimuth angle” mode), the vehicle control device 11 causes the work vehicle 10 to travel autonomously along the target route R that has been generated by the third route generation mode. The setting processing of the route generation mode is executed in the operation device 17.
The autonomous travel system according to the present embodiment has the three route generation modes (the first route generation mode, the second route generation mode, and the third route generation mode). However, the present invention is not limited thereto. The details of the route generation modes will be described below.
Moreover, when the work vehicle 10 arrives at the end of a straight route, the vehicle control device 11 switches the travel mode to manual travel. The vehicle control device 11 may switch the travel mode to manual travel when it has determined that the work vehicle 10 has reached an end point, or it may switch the travel mode to manual travel in response to an operation from the operator. When the travel mode is switched to manual travel, for example, the operator performs turning travel (manual travel) of the work vehicle 10 using manual steering.
As described above, the vehicle control device 11 switches the travel mode according to an operation made by the operator with respect to the operation device 17, and causes the work vehicle 10 to travel autonomously on straight routes (target route R) by automatic steering and manually travel on turning routes by manual steering.
Here, the target route R (straight routes) on which the work vehicle 10 autonomously travels is generated based on work performed by the operator (route generation work). In the route generation work of the conventional technique, if the operator forgets to register a reference start point (point A) and a reference end point (point B) while causing the work vehicle 10 to perform teaching travel, the target route R is not generated and the operator has to perform teaching travel again. In this way, the conventional technique has a problem that the workability of the work that generates the target route R is low. In contrast, according to the configuration of the present embodiment, as described below, it is possible to improve the workability of the generation work of the target route R. A specific configuration of the operation device 17 will be described below.
[Operation Device 17]
As illustrated in
The operation display unit 73 is a user interface that includes a display unit such as a liquid crystal display an organic EL display that displays various types of information, and an operation unit such as operation buttons or a touch panel that receives operations. The operation display unit 73 displays various setting screens and work screens in response to instructions from the operation control unit 71. In addition, the operation display unit 73 receives operations from the user on the setting screens or the work screens.
Furthermore, the operation unit includes an autonomous travel button that is used by the operator to issue a travel start instruction when autonomous travel of the work vehicle 10 is to be started, an offset button that is used to perform an offset operation (correction operation) to correct a position error between the work vehicle 10 and the target route R, and a plurality of selection buttons that are used to perform selection operations on the setting screens and the work screens (these are not shown).
For example, as shown in
The storage unit 72 is a non-volatile storage unit such as an HDD or an SSD that stores various types of information. The storage unit 72 stores a control program such as a route generation program for causing the operation device 17 to execute route generation processing (see
The operation control unit 71 includes control apparatuses such as a CPU, a ROM, and a RAM. The CPU is a processor that executes various types of arithmetic processing. The ROM is a non-volatile storage unit that stores in advance control programs such as a BIOS and an OS for causing the CPU to execute various types of arithmetic processing. The RAM is a volatile or non-volatile storage unit that stores various types of information, and is used as a temporary storage memory (work area) for the various types of processing executed by the CPU. Further, the operation control unit 71 controls the operation device 17 as a result of the CPU executing various control programs stored in advance in the ROM or the storage unit 72.
More specifically, as illustrated in
The display processing unit 711 causes the operation display unit 73 to display various types of information. For example, the display processing unit 711 causes the operation display unit 73 to display the setting screens and work screens (such as
The reception processing unit 712 receives various operations from the operator. For example, the reception processing unit 712 receives, on the setting screens and the work screens, operations for generating the target route R, that is, various operations from the operator relating to the route generation work.
The setting processing unit 713 specifies a route generation mode among the plurality of route generation modes. The plurality of route generation modes are route generation mode that generate the target route R based on a reference point (such as a point A) that is set to a predetermined position in the field F.
The plurality of route generation modes according to the present embodiment include, for example, the first route generation mode (“point A+point B” mode) in which the target route R is generated based on a reference line L1 that passes through two reference points (point A and point B) that are each set to two positions of the work vehicle 10 in the field F; the second route generation mode (“point A+vehicle azimuth angle” mode) in which the target route R is generated based on a reference line L1 that passes through a reference point (point A) that is set to one position of the work vehicle 10 in the field F, and extends in the direction of an azimuth of the work vehicle 10 (vehicle azimuth); and a third route generation mode (“point A+set azimuth angle” mode) in which the target route R is generated based on a reference line L1 that passes through a reference point (point A) that is set to one position of the work vehicle 10 in the field F, and extends in the direction of a set azimuth angle (set angle) that has been set according to a setting operation (angle input operation) by the operator.
The operator can select one of the route generation modes among the plurality of route generation modes.
On the setting screen P1, “point A+point B” (setting item K1) corresponding to the first route generation mode, “point A+vehicle azimuth angle” (setting item K2) corresponding to the second route generation mode, and “point A+set azimuth angle” (setting item K3) corresponding to the third route generation mode are each displayed in a selectable manner. On the setting screen P1, the operator selects one of the route generation modes among the first route generation mode, the second route generation mode, and the third route generation mode.
The setting processing unit 713 specifies the route generation mode among the plurality of route generation modes that has been selected by the user. Then, the generation processing unit 714 generates the target route R using the route generation mode that has been specified by the setting processing unit 713. More specifically, the generation processing unit 714 generates a target route R that includes a reference line L1 that passes through a reference point (point A).
Next, specific examples of the generation methods of the target route R in each of the first route generation mode, the second route generation mode, and the third route generation mode will be described.
[First Route Generation Mode]
When the operator selects “point A+point B” (setting item K1) and presses a confirmation button K0 on the setting screen P1 (see
When the setting processing unit 713 specifies the first route generation mode (manual registration), the display processing unit 711 causes the operation display unit 73 to display a work screen D1 (see
In the first route generation mode with manual registration, the operator moves the work vehicle 10 to a desired position in the field F and presses a point A registration button Ka (see
When the setting processing unit 713 acquires position information of point A and point B, it sets a straight line that passes through point A and point B as the reference line L1 (see
In contrast, when the setting processing unit 713 specifies (see
More specifically, the acquisition processing unit 715 acquires the position information of a predetermined position of the work vehicle 10. For example, the acquisition processing unit 715 acquires the position information of a position at which a predetermined motion of the work vehicle 10 is executed. The predetermined motion is, for example, a raising/lowering motion of the work machine 14, or a turning motion of the work vehicle 10. For example, when the operator performs an operation that moves the work vehicle 10 in the field F to a start position of the planting work and lowers the work machine 14 (first predetermined motion), the acquisition processing unit 715 acquires the position information of the current position of the work vehicle 10 (first position) at the time the operation was received. The acquisition processing unit 715 may acquire position information of the current position of the work vehicle 10 (first position) at the time it is detected that the floats 36 have made contact with the ground surface.
Furthermore, for example, when the operator performs an operation that turns the work vehicle 10 or raises the work machine 14 (second predetermined motion) after performing the planting work while causing the work vehicle 10 to manually travel on the first route of the planting work, the acquisition processing unit 715 acquires the position information of the position of the work vehicle 10 (second position) at the time the operation was received. The acquisition processing unit 715 may acquire the position information of the current position of the work vehicle 10 (second position) at the time a steering angle of the steering wheel 137 becomes greater than or equal to a predetermined angle, or it is detected that the floats 36 are no longer in contact with the ground surface.
The registration processing unit 716 registers the first position at which the first predetermined motion of the work vehicle 10 (such as a lowering motion of the work machine 14) was executed as the first reference point (point A), and registers the second position at which the second predetermined motion of the work vehicle 10 (such as a turning motion of the work vehicle 10 or a raising motion of the work machine 14) was executed as the second reference point (point B).
Furthermore, the registration processing unit 716 may register the predetermined position as a reference point when the work vehicle 10 has traveled a predetermined distance from the predetermined position, or when a predetermined time has elapsed since the work vehicle 10 started to travel from the predetermined position. More specifically, the registration processing unit 716 registers the first position corresponding to the first predetermined motion as the first reference point (point A) when the work vehicle 10 has traveled a first predetermined distance from the first position, or when a first predetermined time has elapsed since the work vehicle 10 started to travel from the first position. For example, as shown in
As another embodiment, when the work machine 14 is lowered and the first predetermined time has elapsed from the time in which planting work became possible, the registration processing unit 716 may register the position p1 as the first reference point (point A). Furthermore, when the work machine 14 is lowered and the travel distance L0 of the work vehicle 10 from the position p1 (first position) of the work vehicle 10 at the time in which planting work became possible reaches the first predetermined distance, and the work machine 14 is lowered and the first predetermined time has elapsed from the time in which planting work became possible, the registration processing unit 716 may register the position p1 as the first reference point (point A).
Moreover, the registration processing unit 716 may register the second position corresponding to the second predetermined motion as the second reference point (point B) when the work vehicle 10 has traveled a second predetermined distance from the first position, or when a second predetermined time has elapsed from the time the work vehicle 10 was at the first position. For example, as shown in
As another embodiment, when the work machine 14 is lowered and the second predetermined time has elapsed from the time in which planting work became possible (note: second predetermined time >first predetermined time), the registration processing unit 716 may register the position p2 as the second reference point (point B). Furthermore, when the work machine 14 is lowered and a travel distance L0 of the work vehicle 10 from the position p1 (first position) of the work vehicle 10 at the time in which planting work became possible reaches the second predetermined distance, and the work machine 14 is lowered and the second predetermined time has elapsed from the time in which planting work became possible, the registration processing unit 716 may register the position p2 as the second reference point (point B).
The generation processing unit 714 generates the target route R based on the reference points registered by the registration processing unit 716. More specifically, the generation processing unit 714 generates the target route R based on the reference line L1 that passes through the first reference point (point A) and the second reference point (point B) corresponding to the positions at which the predetermined motions of the work vehicle 10 were executed.
The first predetermined distance is set to, for example, 1 to 3 m, and the second predetermined distance is set to, for example, 7 to 10 m. Moreover, the first predetermined distance and the second predetermined distance may be set according to the width La of the field F. For example, the first predetermined distance may be set to “La×0.2” (m), and the second predetermined distance may be set to “La×0.8” (m). In addition, the first predetermined time may be set to, for example, 2 to 3 seconds, and the second predetermined time may be set to, for example 5 seconds or more. Also, the first predetermined time and the second predetermined time may be set according to the width La of the field F and the vehicle speed of the work vehicle 10.
Furthermore, the predetermined motion includes at least one of a raising/lowering motion of the work machine 14, a motion that switches the forward direction of the work vehicle 10, an operation that changes the vehicle speed of the work vehicle 10, a motion that switches the working clutch, a motion that switches the side clutch of the rear wheels (ON/OFF motion), an ON/OFF motion of a seat switch, and work by a marker that generates the reference line L1 of the target route R of the subsequent journey or an operation that stores the marker in a storage position. Moreover, the first predetermined motion and the second predetermined motion may be the same type of motion (for example, a raising/lowering motion of the work machine 14), or may be different types of motions (for example, a raising/lowering motion of the work machine 14 and a switching motion of the forward direction). The work by the marker is, for example, a motion (marker motion) that draws a marking that indicates the travel route of the subsequent journey in the field F using the marker (by marking a track or groove in the field F), and the motion that stores the marker in the storage position is a motion that stores the marker in the storage position after the marker motion is completed. In addition, as another embodiment, the work by the marker may be work that sets the position in which the marking has been drawn to be the travel route (reference line L1) of the next journey.
According to the first route generation mode, because it is possible to generate the target route R by using the reference line L1 that passes through two points (point A and point B) at both end portions of the field F, the work accuracy of the work vehicle 10 can be improved.
[Second Route Generation Mode]
When the operator selects “point A+vehicle azimuth angle” (setting item K2) and presses the confirmation button K0 on the setting screen P1 (see
When the setting processing unit 713 specifies the second route generation mode (referenced to point A), the display processing unit 711 causes the operation display unit 73 to display the work screen D1 (see
The generation processing unit 714 generates a travel route (target route R) including the reference line L1 and a plurality of straight lines that are parallel to the reference line L1 (see
In contrast, when the setting processing unit 713 specifies the second route generation mode (referenced to travel path), the operation control unit 71 generates the target route R based on the reference point (point A) and the travel path that the work vehicle 10 has traveled from the reference point (point A).
More specifically, the acquisition processing unit 715 acquires the position information of a predetermined position of the work vehicle 10. The acquisition processing unit 715 acquires a predetermined position of the work vehicle 10 in the same manner as in the “first route generation mode”. For example, the acquisition processing unit 715 acquires the position information of the position at which a predetermined motion of the work vehicle 10 (such as a raising/lowering motion of the work machine 14) is executed. For example, when the operator performs an operation that moves the work vehicle 10 in the field F to a start position of the planting work and lowers the work machine 14 (first predetermined motion), the acquisition processing unit 715 acquires the position information of the current position of the work vehicle 10 (first position) at the time the operation was received.
Furthermore, for example, when the operator performs an operation that turns the work vehicle 10 or raises the work machine 14 (second predetermined motion) after performing the planting work while causing the work vehicle 10 to manually travel on the first route of the planting work, the acquisition processing unit 715 acquires the vehicle azimuth angle based on the travel path that the work vehicle 10 has traveled from the first position. For example, the acquisition processing unit 715 acquires the vehicle azimuth angle when the work vehicle 10 has traveled the second predetermined distance from the first position, or when the second predetermined time has elapsed since the work vehicle 10 started to travel from the first position. Moreover, for example, the acquisition processing unit 715 acquires an average value of the vehicle azimuth angle corresponding to the travel path from the first position until the work vehicle 10 has traveled the second predetermined distance or until the second predetermined time has elapsed as the vehicle azimuth angle.
In addition, when the work vehicle 10 has traveled the first predetermined distance from the first position, or when the first predetermined time has elapsed since the work vehicle 10 started to travel from the first position, and then the second predetermined motion of the work vehicle 10 (such as a turning motion of the work vehicle 10, or a raising motion of the work machine 14) has been executed, the acquisition processing unit 715 acquires, referenced to the first position, an average value of the vehicle azimuth angle corresponding to the travel path from the first position to the second position, at which the second predetermined motion has been executed, as the vehicle azimuth angle. As another embodiment, the acquisition processing unit 715 may acquire an average value of the vehicle azimuth angle corresponding to the travel path from the first position to the position after the predetermined distance has been traveled or the predetermined time has elapsed as the vehicle azimuth angle.
The registration processing unit 716 registers the first position at which the first predetermined motion of the work vehicle 10 (such as a lowering motion of the work machine 14) was executed as the first reference point (point A) in the same manner as in the “first route generation mode”. For example, as shown in
As another embodiment, when the work machine 14 is lowered and the first predetermined time has elapsed from the time in which planting work became possible, the registration processing unit 716 may register the position p1 as the first reference point (point A). Furthermore, when the work machine 14 is lowered and the travel distance L0 of the work vehicle 10 from the position p1 (first position) of the work vehicle 10 at the time in which planting work became possible reaches the first predetermined distance, and the work machine 14 is lowered and the first predetermined time has elapsed from the time in which planting work became possible, the registration processing unit 716 may register the position p1 as the first reference point (point A).
The generation processing unit 714 generates the target route R based on the first reference point (point A) registered by the registration processing unit 716, and the vehicle azimuth angle corresponding to the travel path acquired by the acquisition processing unit 715. More specifically, the setting processing unit 713 sets a straight line that passes through the first reference point (point A) corresponding to the position at which the predetermined motion of the work vehicle 10 is executed and extends in the direction of the vehicle azimuth angle of the travel path as the reference line L1. The generation processing unit 714 generates a travel route (target route R) including the reference line L1 and a plurality of straight lines that are parallel to the reference line L1.
In the second route generation mode that is referenced to the travel path, the operation control unit 71 may receive an operation that presses the point A registration button Ka from the operator and register the current position of the work vehicle 10 as the first reference point (point A), and generate the reference line L1 and the target route R based on the first reference point (point A) and the vehicle azimuth angle (average vehicle azimuth angle) of the travel path.
[Third Route Generation Mode]
When the operator selects “point A+set azimuth angle” (selection item K3) on the setting screen P1 (see
In the third route generation mode, the setting processing unit 713 sets the set azimuth angle, which is an angle relative to a reference azimuth (such as north). For example, the display processing unit 711 displays an input field into which an angle is input to a setting screen (not shown), and the reception processing unit 712 receives an angle input operation from the operator. The operator inputs the desired angle. Then, the setting processing unit 713 sets the angle that has been input by the operator as the set azimuth angle.
When the setting processing unit 713 sets the set azimuth angle, the display processing unit 711 causes the operation display unit 73 to display the work screen D1 (see
In this way, in the third route generation mode, the operation control unit 71 receives an input operation of an angle relative to a reference azimuth from the operator, and the target route R is generated based on the angle (set azimuth angle) input by the operator.
As described above, the operation control unit 71 generates the target route R in a route generation mode that is selected by the operator from among the plurality of route generation modes (the first route generation mode, the second route generation mode, and the third route generation mode).
After the target route R is generated, the operator instructs the work vehicle 10 to start traveling autonomously in the field F (travel start instruction). For example, when the work vehicle 10 satisfies an autonomous travel start condition and is in a state where it is capable of traveling autonomously, the operator can issue the travel start instruction. When the travel start instruction is acquired from the operator, the vehicle control device 11 executes autonomous travel processing according to the target route R corresponding to the route generation mode that has been set.
More specifically, in the vehicle control device 11, when the work vehicle 10 satisfies the autonomous travel start condition, the operator presses an autonomous travel button (not shown) on the operation display unit 73 and issues a travel start instruction. When the travel start instruction is received, the vehicle control device 11 starts automatic steering of the work vehicle 10 such that the work vehicle 10 travels along the target route R that has been generated in the route generation mode that has been set. In this way, the vehicle control device 11 causes the work vehicle 10 to travel autonomously along the straight routes by automatic steering.
When the work vehicle 10 starts traveling autonomously, the vehicle control device 11 causes the operation device 17 to display a work screen. For example, based on information (travel information and the like) acquired from the vehicle control device 11, the operation device 17 causes the work screen of the operation display unit 73 to display the location of the work vehicle 10, the straight routes, the worked area (work status), guidance information (operation guidance information), and the like.
The vehicle control device 11 ends the automatic steering at the end of the straight route. For example, when the work vehicle 10 is performing straight travel by automatic steering and approaches the end of the work route (straight route), the vehicle control device 11 notifies the operator of the guidance information K2 and ends the automatic steering in response to an operation from the operator. The position of the end of each work route may be a position that is a predetermined distance inside the end portion of the field F, a position that is specified in advance by the operator, a position that is aligned with a position in which the operator switched from autonomous travel to manual travel in the immediately preceding worked route (a position in which the work route intersects a line which passes through the position at which switching was performed to manual travel and is perpendicular to the worked route, or a position in which the work route intersects a line which passes through the position at which switching was performed to manual travel and is parallel to an edge of the field F), a position in which the work route intersects a line which passes through point B of the reference line L1 and is perpendicular to the reference line L1, and the like.
[Route Generation Processing]
An example of the route generation processing executed by the operation control unit 71 of the operation device 17 will be described below. The present invention may be viewed as an invention of a route generation method in which the operation device 17 executes part or all of the route generation processing, or as an invention of a route generation program that causes the operation device 17 to execute part or all of the route generation method. One or more processors may execute the route generation processing.
In step S1, the operation control unit 71 determines whether or not a selection operation of the “automatic registration” mode of the “point A+point B” mode has been received from the operator. For example, on the setting screen P1 (see
In step S2, the operation control unit 71 determines whether or not the work machine 14 is in contact with the ground surface. More specifically, when the operator moves the work vehicle 10 to the start position of the planting work in the field F and performs an operation that lowers the work machine 14 (first predetermined motion), the work machine 14 is lowered and the floats 36 make contact with the ground surface. Furthermore, when the work machine 14 is lowered, the operator starts the manual travel of the work vehicle 10 by operating the main speed change lever 13L or the like. When the operation control unit 71 acquires a detection signal indicating that the floats 36 have made contact with the ground surface from the work machine 14 or the float sensor (S2: Yes), it shifts the processing to step S3. The operation control unit 71 waits until it obtains a detection signal indicating that the floats 36 have made contact with the ground surface (S2: No). The motion of lowering the work machine 14 is an example of the predetermined motion of the present invention.
In step S3, the operation control unit 71 determines whether or not the work vehicle 10 has reached the first predetermined distance. More specifically, the operation control unit 71 determines whether or not the travel distance L0 (see
In step S4, the operation control unit 71 registers the position p1 (first position) as the first reference point (point A) (see
In step S5, the operation control unit 71 determines whether or not the work vehicle 10 has reached the second predetermined distance. More specifically, the operation control unit 71 determines whether or not the travel distance L0 (see
In step S6, the operation control unit 71 determines whether or not the work vehicle 10 has performed a turning motion. More specifically, the operator causes the work vehicle 10 to travel from the first position p1 in the field F and performs a turning operation at an end portion of the field F. When the operation control unit 71 acquires from the travel device 13 a detection signal indicating that the steering angle of the steering wheel 137 of the work vehicle 10 is greater than or equal to a predetermined angle, it determines that the work vehicle 10 has performed a turning motion (S6: Yes), and shifts the processing to step S7. The processing waits until the work vehicle 10 performs a turning motion (S6: No). The turning motion is an example of the predetermined motion of the present invention.
In step S7, the operation control unit 71 registers the position p2 (second position) as the second reference point (point B) (see
In step S8, the operation control unit 71 generates the reference line L1 that passes through the first reference point (point A) and the second reference point (point B), and also generates the target route R that includes a plurality of straight lines parallel to the reference line L1 (see
In step S1, when a selection operation of the “manual registration” mode (see
In step S12, the operation control unit 71 registers the position p1 (first position) as the first reference point (point A) (see
In step S13, the operation control unit 71 determines whether or not an operation that registers the second reference point (point B) has been received from the operator. For example, the operator drives the work vehicle 10 straight in a direction that is parallel to a work direction (for example, a planting direction) in which travel and work is to be performed by the work vehicle 10 (see
In step S14, the operation control unit 71 registers the position p2 (second position) as the second reference point (point B) (see
In this way, the operation control unit 71 executes the route generation processing corresponding to the first route generation mode (“point A+point B” mode).
In step S21, the operation control unit 71 determines whether or not a selection operation of the “referenced to travel path” mode of the “point A+vehicle azimuth angle” mode has been received from the operator. For example, on the setting screen P3 (see
In step S22, the operation control unit 71 determines whether or not the work machine 14 is in contact with the ground surface. More specifically, when the operator moves the work vehicle 10 to the start position of the planting work in the field F and performs an operation that lowers the work machine 14 (first predetermined motion), the work machine 14 is lowered and the floats 36 make contact with the ground surface. Furthermore, when the work machine 14 is lowered, the operator causes the work vehicle 10 to manually travel by operating the main speed change lever 13L or the like. When the operation control unit 71 acquires a detection signal indicating that the floats 36 have made contact with the ground surface from the work machine 14 or the float sensor (S22: Yes), it shifts the processing to step S23. The operation control unit 71 waits until it obtains a detection signal indicating that the floats 36 have made contact with the ground surface (S22: No).
In step S23, the operation control unit 71 determines whether or not the work vehicle 10 has reached the first predetermined distance. More specifically, the operation control unit 71 determines whether or not the travel distance L0 (see
In step S24, the operation control unit 71 registers the position p1 (first position) as the first reference point (point A) (see
In step S25, the operation control unit 71 determines whether or not the work vehicle 10 has reached the second predetermined distance. More specifically, the operation control unit 71 determines whether or not the travel distance L0 (see
In step S26, the operation control unit 71 determines whether or not the work vehicle 10 has performed a turning motion. More specifically, the operator causes the work vehicle 10 to travel from the first position p1 in the field F and performs a turning operation at an end portion of the field F. When the operation control unit 71 acquires from the travel device 13 a detection signal indicating that the steering angle of the steering wheel 137 of the work vehicle 10 is greater than or equal to a predetermined angle, it determines that the work vehicle 10 has performed a turning motion (S26: Yes), and shifts the processing to step S27. The processing waits until the work vehicle 10 performs a turning motion (S26: No).
In step S27, the operation control unit 71 acquires the vehicle azimuth angle. More specifically, the operation control unit 71 acquires, referenced to the position p1 (first position), an average value of the vehicle azimuth angle (average vehicle azimuth angle) corresponding to the travel path (travel path of the travel distance L0 in
In step S28, the operation control unit 71 generates the reference line L1 based on the first reference point (point A) and the vehicle azimuth angle, and also generates the target route R that includes a plurality of straight lines parallel to the reference line L1. For example, the operation control unit 71 sets a straight line that passes through the first reference point (point A) that extends in the direction of the vehicle azimuth angle as the reference line L1, and generates the target route R from the reference line L1.
In step S21, when a selection operation of the “referenced to point A” mode is received from the operator, in step S31 (S21: No), the operation control unit 71 determines whether or not an operation that registers the first reference point (point A) has been received from the operator. For example, the operator moves the work vehicle 10 to a desired position in the field F and presses the point A registration button Ka (see
In step S32, the operation control unit 71 registers the position p1 (first position) as the first reference point (point A) (see
In step S33, the operation control unit 71 acquires the current azimuth (vehicle azimuth angle) of the work vehicle 10 at the position p1. After step S33, the operation control unit 71 shifts the processing to step S28. In step S28, the operation control unit 71 sets a straight line that passes through the first reference point (point A) that extends in the direction of the vehicle azimuth angle of the work vehicle 10 at the position p1 as the reference line L1, and generates the target route R from the reference line L1.
In this way, the operation control unit 71 executes the route generation processing corresponding to the second route generation mode (“point A+vehicle azimuth angle” mode).
As described above, the operation device 17 according to the present embodiment generates the target route R that causes the work vehicle 10 travels autonomously in the field F. More specifically, the operation device 17 acquires the position information of a predetermined position of the work vehicle 10 in the field F, registers the predetermined position as a reference point when the work vehicle 10 has traveled a predetermined distance from the predetermined position, or when a predetermined time has elapsed since the work vehicle 10 started to travel from the predetermined position, and generates the target route R based on the reference point.
For example, the operation device 17 registers the first position p1 (see
Furthermore, for example, the operation device 17 registers the first position p1 (see
According to the configuration above, for example, it is not necessary for the operator to perform operations that register point A and point B, or to perform an operation that inputs the vehicle azimuth angle. Furthermore, because a configuration is provided in which the predetermined position is registered as the reference point when the work vehicle 10 has traveled the predetermined distance from the predetermined position, or the predetermined time has elapsed since the work vehicle 10 started to travel from the predetermined position, it is possible to prevent a position corresponding to a behavior of the work vehicle 10 not intended by the operator from being registered as the reference point. Therefore, it is possible to improve the workability of the generation work of the target route R.
The present invention is not limited to the embodiment described above. Other embodiments of the present invention are described below.
As mentioned above, the operation device 17 has a function that registers a first reference point (point A) and a second reference point (point B) due to a registration operation from the operator (“manual registration” mode in
After confirming the message, for example, the operator moves the work vehicle 10 to the position to be registered as point B, and presses the point B registration button Kb (see
Furthermore, as shown in
If the operation control unit 71 determines that the operator has forgotten to perform the registration operation of point A, it may similarly display a message that prompts the registration operation of point A and the automatic registration button Kc on the work screen D1. For example, the operation control unit 71 displays the message and the automatic registration button Kc when manual travel of the work vehicle 10 is started in a state where the registration operation of point A has not been received, and the predetermined distance has been traveled or the predetermined time has elapsed.
Further, in the “automatic registration” mode, in which the first reference point (point A) and the second reference point (point B) are automatically registered, it is possible that positions that are not intended by the operator may be registered as point A and point B. For example, as shown in
Therefore, as another embodiment of the present invention, the operation control unit 71 may be provided with a configuration in which the operator is asked whether or not the predetermined position corresponding to the predetermined motion is to be registered as the reference point of the reference line L1, and the predetermined position is registered as the reference point when a registration instruction is acquired from the operator.
For example, as shown in
In a similar manner, in the second route generation mode (“point A+vehicle azimuth angle” mode), the operation control unit 71 may ask the operator whether or not a vehicle azimuth angle calculated based on the travel path is to be registered.
The work vehicle 10 of the present invention may be capable of traveling autonomously even when turning. In this case, the target route R includes straight routes and turning routes. Furthermore, in the work vehicle 10, the operator may be able to switch between whether autonomous travel or manual travel is performed during turning. Moreover, the work vehicle 10 may also be capable of traveling autonomously on the target route R while unmanned. In this case, the operator may remotely control the operation terminal to issue a travel start instruction and the like. In addition, the operation terminal that is used for remote control may be the operation device 17 according to the present embodiment, or may include each of the processing units of the operation device 17.
The route generation system of the present invention may be configured by the operation device 17 alone, or may be configured by a server provided with each of the processing units included in the operation device 17. Also, the route generation system may be configured by the work vehicle 10 provided with the operation device 17.
[Supplementary Notes of the Invention]
A summary of the invention extracted from the embodiment is described as the following supplementary notes. Note that the configurations and processing functions described in the supplementary notes below may be selected, omitted, and combined as appropriate.
<Supplementary Note 1>
A route generation method that generates a target route for causing a work vehicle to travel autonomously in a field, and executes the steps of:
<Supplementary Note 2>
The route generation method according to supplementary note 1, wherein
<Supplementary Note 3>
The route generation method according to supplementary note 2, wherein
<Supplementary Note 4>
The route generation method according to supplementary note 3, wherein
<Supplementary Note 5>
The route generation method according to supplementary note 2, wherein
<Supplementary Note 6>
The route generation method according to supplementary note 5, wherein
<Supplementary Note 7>
The route generation method according to supplementary note 6, wherein
<Supplementary Note 8>
The route generation method according to any one of supplementary notes 5 to 7, wherein
<Supplementary Note 9>
The route generation method according to any one of supplementary notes 2 to 8, wherein
<Supplementary Note 10>
The route generation method according to any one of supplementary notes 1 to 9, wherein
Number | Date | Country | Kind |
---|---|---|---|
2022-144447 | Sep 2022 | JP | national |