Patent Application
20230309435
The present invention relates to an automatic run method, an automatic run system, and an automatic run program capable of causing a work vehicle to run.
When an obstacle such as windbreak, building, etc. is present near a work vehicle automatically running, it is impossible to receive a radio signal from a satellite, or impossible to receive a signal from the given number of satellites due to a radio interference or the like, thereby, as the case may be, causing a positioning failure. When the positioning failure should be caused, the work vehicle stops automatically running, causing a problem of deteriorated work efficiency.
Conventionally, there has been proposed a system that, in the event of the positioning failure, causes the work vehicle to automatically run by an inertial navigation thereby to avoid stopping the work vehicle (see, for example, Patent Document 1).
Patent Document 1: International Publication No. WO 2015/147111
By the way, the positioning methods used for positioning the work vehicle include the DGNSS (Differential Global Navigation Satellite System) method, the real-time kinematic method (RTK-GPS method, hereinafter referred to as “RTK method”) which is higher in positioning accuracy than the DGNSS method, and the like. The DGNSS method and the RTK method have positioning accuracies different from each other; thus, when a work vehicle is switched to the RTK method when automatically running while performing the positioning by the DGNSS method, for example, the work vehicle’s self-recognized position between before and after the switching of the positioning method is significantly shifted. This causes the work vehicle to follow a target route immediately after the switching of the positioning method, resulting in a problem of unstable behavior of the work vehicle, leading to a deteriorated work accuracy.
An object of the present invention is to provide an automatic run method, an automatic run system, and an automatic run program that can maintain a work accuracy even when a positioning method of a work vehicle is switched.
An automatic run method according to the present invention includes: positioning a position of a work vehicle by a given positioning method based on a satellite signal received from a satellite; causing the work vehicle to automatically run based on position information showing the work vehicle’s positioned position; and making the automatic run prohibitable, when the work vehicle is ready for the automatic run by a first positioning method, and when the positioning method is switched to a second positioning method which is different in positioning accuracy from the first positioning method.
An automatic run system according to the present invention includes: a positioning processing unit; and a run processing unit. The positioning processing unit positions a position of a work vehicle by a given positioning method based on a satellite signal received from a satellite. The run processing unit causes the work vehicle to automatically run based on position information showing the work vehicle’s position positioned by the positioning processing unit. Further, the run processing unit is capable of prohibiting the automatic run, when the work vehicle is ready for the automatic run by a first positioning method, and when the positioning method is switched to a second positioning method which is different in positioning accuracy from the first positioning method.
An automatic run program according to the present invention is an automatic run program for causing one or more processors to execute operations including: positioning a position of a work vehicle by a given positioning method based on a satellite signal received from a satellite; causing the work vehicle to automatically run based on position information showing the work vehicle’s positioned position; and making the automatic run prohibitable, when the work vehicle is ready for the automatic run by a first positioning method, and when the positioning method is switched to a second positioning method which is different in positioning accuracy from the first positioning method.
The present invention can provide an automatic run method, an automatic run system, and an automatic run program that can maintain a work accuracy even when a positioning method of a work vehicle is switched.
The following embodiments are each an example of embodying the present invention, and are not intended to limit the technical scope of the present invention.
As shown in
For example, in the farm field F shown in
The automatic run system 1 includes an operation terminal (a tablet terminal, a smartphone, or the like) that is operated by the operator. The operation terminal can communicate with the work vehicle 10 via a communication network such as a mobile phone network, a packet line network, or a wireless LAN. For example, the operator operates the operation terminal to register various types of information (work vehicle information, farm field information, work information, and the like), and the like. At a position away from the work vehicle 10, the operator can grasp a running status, a work status, and the like of the work vehicle 10 from a running track that is displayed on the operation terminal.
The satellite 20 is a positioning satellite that is included in a satellite positioning system such as GNSS (Global Navigation Satellite System), and sends a GNSS signal (satellite signal).
Using the GNSS signal sent from the satellite 20, a positioning unit 16 performs a positioning process that calculates the current position (latitude and longitude) of the work vehicle 10. Specifically, the positioning unit 16 is capable of positioning the work vehicle 10 by using the DGNSS positioning method which positions the work vehicle 10 based on positioning information (GNSS signal, etc.) received by a single receiver (positioning antenna 164).
Further, the positioning unit 16 can position the work vehicle 10 by using the RTK positioning method which positions the work vehicle 10 based on the GNSS signal and on correction information generated based on the GNSS signal. For example, the positioning unit 16 connects to a base station (not shown) placed corresponding to the farm field F or a portable terminal (smartphone) possessed by the operator, thereby to receive the correction information and perform the positioning by the RTK method. The RTK method is a positioning method higher in positioning accuracy than the DGNSS method.
The first and second positioning methods of the present invention are two different positioning methods with different positioning accuracies. For example, one of the DGNSS and RTK methods is an example of the first positioning method of the present invention, and the other is an example of the second positioning method of the present invention. Further, the positioning method is not limited to the DGNSS and the RTK method, but may be DGPS method or other positioning method.
As shown in
The communication unit 15 is a communication interface that connects the work vehicle 10 to the communication network in a wired or wireless manner, and performs, via the communication network, data communication, which accords to a given communication protocol, with an external device (operation terminal or the like).
The storage unit 12 is a non-volatile storage unit, such as HDD (Hard Disk Drive) or SSD (Solid State Drive), that stores various types of information. The storage unit 12 stores a control program such as an automatic run program for causing the vehicle control unit 11 to execute an automatic run process described below (see
The run unit 13 is a driving unit that causes the work vehicle 10 to run. As shown in
The engine 131 is a drive source such as a diesel engine or a gasoline engine driven by using a fuel supplied to a fuel tank (not shown). The run unit 13 may include an electric motor as a drive source together with the engine 131 or instead of the engine 131. It is noted that a generator (not shown) is connected to the engine 131, and supplies electric power to electric components such as the vehicle control unit 11, a battery and the like, which are provided in the work vehicle 10. The battery stores the electric power supplied from the generator. Further, even after the engine 131 is stopped, the electric components such as the vehicle control unit 11, the positioning unit 16, and the operation unit 17, which are provided in the work vehicle 10, can be driven by the electric power supplied from the battery.
A drive force of the engine 131 is transmitted via the transmission 134 and the front axle 135 to the front wheel 132, and is transmitted via the transmission 134 and the rear axle 136 to the rear wheel 133. Also, the drive power of the engine 131 is transmitted via a PTO shaft (not shown) to the work instrument 14. The run unit 13 performs a running motion according to a command of the vehicle control unit 11.
The work instrument 14 is, for example, a cultivator, a seeder, a mower, a plow, a fertilizer applicator or the like, which can be removably attached to the work vehicle 10. As a result, the work vehicle 10 can perform any of the various work by using each of the work instruments 14.
The steering wheel 137 is an operation unit operated by the operator or by the vehicle control unit 11. For example, the run unit 13 changes an angle of the front wheel 132 by a hydraulic power steering mechanism (not shown) in response to the steering wheel 137′s operation by the operator or the vehicle control unit 11, thereby to change a forward direction of the work vehicle 10.
Further, other than the steering wheel 137, the run unit 13 includes a shift lever, an accelerator, and a brake (not shown) which are operated by the vehicle control unit 11. Then, in the run unit 13, a gear of the transmission 134 is switched to a forward gear, a backward gear or the like in accordance with the shift lever’s operation by the vehicle control unit 11, and a running mode of the work vehicle 10 is switched to be forward, backward or the like. Further, the vehicle control unit 11 operates the accelerator thereby to control a revolution speed of the engine 131. Further, the vehicle control unit 11 operates the brake thereby to control rotations of the front wheels 132 and rear wheels 133 by using an electromagnetic brake.
The positioning unit 16 is a communicator including a positioning control unit 161, a storage unit 162, a communication unit 163, a positioning antenna 164 and the like. For example, as shown in
The positioning control unit 161 is a computer system having one or more processors, and a storage memory such as a non-volatile memory and a RAM. The storage unit 162 is non-volatile memory or the like that stores: a positioning control program for causing the positioning control unit 161 to perform a positioning process; and data such as positioning information and movement information. For example, the positioning control program is non-transiently recorded in a computer-readable recording medium such as a CD or a DVD, and is read by a given reader (not shown) and stored in the storage unit 162. Further, the positioning control program may be downloaded from a server (not shown) via the communication network to the positioning unit 16 and stored in the storage unit 162.
The communication unit 163 is a communication interface that connects the positioning unit 16 to the communication network in the wired or wireless manner, and performs, via the communication network, the data communication, which accords to the given communication protocol, with the external device such as a base station server.
The positioning antenna 164 receives a radio wave (GNSS signal) emitted from the satellite 20.
The positioning control unit 161 includes various processing units such as a positioning processing unit 181 and a switch processing unit 182. Further, the positioning control unit 161 executes various processes according to the automatic run program, thereby to function as the various processing units. Further, as another embodiment, part or all of the positioning processing unit 181 and switch processing unit 182 may include an electronic circuit.
The positioning processing unit 181 positions the work vehicle 10′s position by a given positioning method (DGNSS method, RTK method, etc.) based on the GNSS signal received by the positioning antenna 164 from the satellite 20. Specifically, the positioning processing unit 181 positions the work vehicle 10 by the DGNSS method with the positioning method set to the DGNSS method, and positions the work vehicle 10 by the RTK method with the positioning method set to the RTK method. The positioning processing unit 181 is an example of a positioning processing unit of the present invention.
The switch processing unit 182 mutually switches between the method DGNSS and the RTK method. Specifically, the switch processing unit 182 switches between the DGNSS method and the RTK method based on the operation by the operator, the positioning state in the positioning processing unit 181, and the like. For example, when the operator connects a mobile terminal (such as a smartphone) via Bluetooth (registered trademark) or a communication cable to the positioning unit 16 and the positioning state is ready for the RTK positioning, the switch processing unit 182 switches the positioning method from the DGNSS method to the RTK method. Further, when the number of satellites 20 capable of receiving the GNSS signal is large and the positioning state is ready for the RTK positioning, the switch processing unit 182 switches the positioning method from the DGNSS method to the RTK method. Further, when the number of 20 satellites that can receive the GNSS signal decreases due to an obstacle such as a windbreak, a building, etc. present near the farm field F thereby to decrease the positioning state, the switch processing unit 182 switches the positioning method from the RTK method to the DGNSS method.
Here, the positioning method may be preset to the DGNSS method. That is, the default of the positioning method may be set to the DGNSS method. In this case, when the engine 131 of the work vehicle 10 is started, the positioning processing unit 181 starts receiving the GNSS signal sent from the satellite 20, and executes the positioning process until the positioning state is ready for the DGNSS positioning. The positioning processing unit 181 sends a positioning completion notification to the vehicle control unit 11. When the positioning state is ready for the DGNSS positioning, the vehicle control unit 11 permits the automatic run by the DGNSS method. When receiving a run start instruction from the operator with the positioning state ready for the DGNSS positioning, the run processing unit 111 of the vehicle control unit 11 starts the work vehicle 10′s automatic run by the DGNSS method.
The operation unit 17 is a device operated by the operator boarding the work vehicle 10, and is provided with an operation display unit 171. The operation display unit 171 is a user interface that includes: a display unit, such as a liquid crystal display or an organic EL display, for displaying various types of information; and an operation unit, such as an operation button or a touch screen, that receives an operation. The operation display unit 171 displays various setting screens and work screens. Further, the operation display unit 171 receives the operator’s operation on the setting screen or the work screen. For example, as shown in
Further, on the operation unit 17, the operator can make various settings related to the automatic run. For example, the operator can set the positioning method on a setting screen D1.
To set or change the positioning method, the operator selects the item K1 (presses down the “Determine” button) on the setting screen D1. When the operator selects the item K1, the operation unit 17 displays a setting screen D2 shown in
The operator can select the positioning method according to the contents of the work. In the present embodiment, it is assumed that the DGNSS method is set as the initial (default) setting of the positioning method.
The vehicle control unit 11 has a control device such as a CPU, a ROM, and a RAM. The CPU is a processor that performs various types of arithmetic processes. The ROM is a non-volatile storage unit in which control programs, such as a BIOS and an OS, for causing the CPU to perform the various types of arithmetic processes are preliminarily stored. The RAM is a volatile or non-volatile storage unit that stores various types of information, and is used as a transient storage memory (work area) of the various types of processes to be performed by the CPU. Then, performing, with the CPU, the various types of control programs preliminarily stored in the ROM or the storage unit 12, the vehicle control unit 11 controls the work vehicle 10.
As shown in
The run processing unit 111 controls the run of the work vehicle 10. Specifically, the run processing unit 111 causes the work vehicle 10 to perform the automatic run based on the position information showing the work vehicle 10′s position positioned by the positioning processing unit 181. For example, when the positioning state is ready for the DGNSS positioning and the operator presses down the automatic run button of the operation unit 17, the run processing unit 111 causes the work vehicle 10 to start the automatic run based on the position information showing the work vehicle 10′s position positioned by the DGNSS method. As a result, the work vehicle 10 starts the automatic run following the target route R, starting the work by the work instrument 14. Further, the run processing unit 111 may cause the work vehicle 10 to automatically run on the straight ahead route by the automatic steering, and to manually run on the turn route by the manual steering of the operator.
When remotely operating the work vehicle 10 without boarding the work vehicle 10, the operator inputs the run start instruction at the operation terminal. When acquiring the run start instruction from the operation terminal, the run processing unit 111 causes the work vehicle 10 to automatically run following the target route R while performing the positioning by the DGNSS method. Further, acquiring the run stop instruction from the operation terminal, the run processing unit 111 causes the work vehicle 10 to stop the automatic run. The run processing unit 111 is an example of a run processing unit of the present invention.
The work vehicle 10 according to the present embodiment may employ any of a run method for running while switching between the automatic steering and the manual steering by the operator (first run method), and a run method for running only by the automatic steering (second run method).
Here, a specific example of the automatic run (first run pattern) will be described with reference to
First, the operator sets a reference line L1 for generating the straight ahead route which is the target route R. For example, at an optional position in the farm field F (an outer peripheral end portion, for example), the operator causes the work vehicle 10 to manually run in a direction (target direction) in which the operator wants the work vehicle 10 to run and to work. Specifically, the operator causes the work vehicle 10 to run straight ahead in a direction parallel to a work direction (a cultivating direction, for example) used when the work vehicle 10 is to work in the work area. Then, the operator, when the work vehicle 10 is being caused to manually run in the intended target direction, operates (for example, touches) the operation display unit 171 twice at any position (for example, front or rear end portion of the work area). The vehicle control unit 11, by the operator’s first operation, registers a position (point A) of the work vehicle 10, and registers, by the operator’s second operation, a position (point B) of the work vehicle 10. Acquiring the position information of the point A and point B, the vehicle control unit 11 sets, as the reference line L1, a straight line passing through the point A and the point B (see
After the target route R is generated; for causing the work vehicle 10 to run straight ahead by the automatic steering in the farm field F, the operator, while watching the target route R displayed on the operation unit 17, moves the work vehicle 10 by the manual steering so that the direction (azimuth) of the work vehicle 10 becomes within a given range (given azimuth) relative to the direction of the reference line L1 (meeting the automatic run start condition) (see
As described above, the first run pattern of the first run method is so configured that the automatic run is performed by preliminarily generating the target route R according to the work width and lap width of the work vehicle 10. As a second run pattern of the first run method, it may be so configured that the automatic run is performed by generating the target route R on the basis of the work vehicle 10′s position.
In the second run pattern, after the reference line L1 is set (see
The vehicle control unit 11 may apply the first and second run patterns according to the operator’s selecting operation. For example, the vehicle control unit 11 may selectably display, on the setting screen (not shown), a first route creation mode that corresponds to the first run pattern and a second route creation mode that corresponds to the second run pattern, thereby to perform the automatic run by the route creation mode selected by the operator.
Further, in the first and second run patterns; when the work vehicle 10 runs straight ahead by the automatic steering thereby to approach an end point Pe (point where a line perpendicular to the reference line L1 and passing through the point B intersects with the straight ahead route (straight line)) that corresponds to the point B of the reference line L1 (see
The run processing unit 111, when the work vehicle 10 reaches the end point Pe (end point of straight ahead route), switches the run mode to the manual run. The run processing unit 111 may switch the run mode to the manual run when determining that the work vehicle 10 has reached the end point Pe, or may switch the run mode to the manual run in response to the operator’s operation. When the run mode is switched to the manual run, the operator causes the work vehicle 10 to perform the turn run by the manual steering, for example.
As described above, the run processing unit 111 switches the run mode in response to the operator’s operation on the operation unit 17, causes the work vehicle 10 to automatically run on the straight ahead route (the target route R) by the automatic steering, and to manually run on the turn route by the manual steering. The run method of the work vehicle 10 of the present invention is not limited to the embodiment described above.
The reception processing unit 112 receives the various operations by the operator. For example, on a setting screen (not shown) for setting the work information displayed on the operation unit 17, the reception processing unit 112 receives an operation to set the type of work instrument 14, the work width, the lap width, the route offset amount, etc. Further, on the setting screen D1 (see
By the way, the DGNSS method and the RTK method are different in positioning accuracy from each other; thus, when the positioning method is switched to the RTK method at the time of the work vehicle 10′s automatically running while performing the positioning by the DGNSS method, for example, the work vehicle 10′s self-recognized position between before and after the switching of the positioning method is significantly shifted. This so moves the work vehicle 10 as to follow the target route R immediately after the switching of the positioning method, resulting in unstable behavior of the work vehicle 10, causing a problem of a deteriorated work accuracy. Examples of this problem are shown in
In
Here, while the work vehicle 10 is automatically running by the DGNSS method, the positioning method, as the case may be, is switched to the RTK method. For example, when the mobile terminal (smartphone) of the operator is connected via the Bluetooth or the communication cable to the positioning unit 16 and is ready for the RTK positioning (high accuracy state), the switch processing unit 182 switches the positioning method to the RTK method. When the positioning method is switched from the DGNSS method to the RTK method, a positional shift is caused between the self-recognized position P1 positioned by the DGNSS method and the self-recognized position P1′ positioned by the RTK method, as shown in
When the positional shift of the self-recognized positions P1 and P1′ is caused between before and after the switching of the positioning method, the run processing unit 111 executes the run control to cause the work vehicle 10′s self-recognized position P1′ by the RTK method to follow the target route R. For example, as shown in
Further, the above problem is caused when the work vehicle 10 starts automatically running. For example, with the positioning method set to the DGNSS method, and when the positioning method is switched to the RTK method after the work vehicle 10 meets the automatic run start condition and the operator gives the run start instruction, there is caused the positional shift between the self-recognized position P1 positioned by the DGNSS method and the self-recognized position P1′ positioned by the RTK method. In this case, the steering wheel 137 is significantly turned immediately after the start of the automatic run, making the behavior of the work vehicle 10 unstable. In this way, the work vehicle 10 switching from the first positioning method to the second positioning method, which is different in positioning accuracy, makes the behavior of the work vehicle 10 unstable, causing the problem of the deteriorated work accuracy.
Thus, the work vehicle 10 according to the present embodiment is provided with a configuration that makes it possible to maintain the work accuracy even in the case of switching the positioning method. For specific configurations, herein shown are first, second, and third configuration examples.
As the first configuration example; the run processing unit 111, when the work vehicle 10 is ready for the automatic run by the first positioning method, and when the positioning method is switched to the second positioning method which is different in positioning accuracy from the first positioning method, prohibits the automatic run.
For example, the run processing unit 111 stops the automatic run (stops the work vehicle 10) when the work vehicle 10 is automatically running by the first positioning method, and when the positioning method is switched to the second positioning method. For example, as shown in
Further, when the work vehicle 10 is automatically running following the target route R by the RTK method, and when the positioning method is switched to the DGNSS method, for example, the run processing unit 111 stops the automatic run (stops the work vehicle 10). In this case, the vehicle control unit 11 may cause the operation unit 17 to display a message for prompting to wait until the positioning accuracy is ready for the RTK positioning, or a message for prompting to move the work vehicle 10 by the manual steering to a position where the positioning accuracy is ready for the RTK positioning. Further, the run processing unit 111, when the positioning method is switched from the DGNSS method to the RTK method (in the case of restoring), causes the work vehicle 10 to restart the automatic run.
Further, when the positioning method is switched to the RTK method at the time point of the work vehicle 10′s starting the automatic run with the positioning method set to the DGNSS method (see
Further, when the positioning method is switched to the DGNSS method at the time point of the work vehicle 10′s starting the automatic run with the positioning method set to the RTK method (see
As described above, in the first configuration example; the vehicle control unit 11, when the work vehicle 10 is ready for the automatic run by the first positioning method (when automatically running by the first positioning method, or when ready for starting the automatic run by the first positioning method), and when the positioning method is switched to the second positioning method, prohibits the automatic run (e.g., stops the automatic run, stops the work vehicle 10, or prohibits the start of the automatic run).
As a second configuration example; the run processing unit 111, when the positioning method is switched from the first positioning method to the second positioning method, and when a distance difference between the work vehicle 10′s position (self-recognized position) positioned by the first positioning method and the work vehicle 10′s position (self-recognized position) positioned by the second positioning method is more than or equal to a threshold value, prohibits the automatic run. The distance difference is a distance from the position of the previous positioning process to the position of the current positioning process.
For example, the run processing unit 111, when the work vehicle 10 is automatically running by the first positioning method, and when the positioning method is switched to the second positioning method, and when the distance difference between the work vehicle 10′s position positioned by the first positioning method and the work vehicle 10′s position positioned by the second positioning method is more than or equal to the threshold value, stops the automatic run (stops the work vehicle 10). For example, as shown in
Further, for example, as shown in
For example, as shown in
For example, as shown in
Further, when the positioning method is switched to the RTK method at the time point of the work vehicle 10′s starting the automatic run with the positioning method set to the DGNSS method (see
Further, when the positioning method is switched to the DGNSS method at the time point of the work vehicle 10′s starting the automatic run with the positioning method set to the RTK method (see
Further, when the positioning method is switched to the RTK method at the time point of the work vehicle 10′s starting the automatic run with the positioning method set to the DGNSS method (see
Further, when the positioning method is switched to the DGNSS method at the time point of the work vehicle 10′s starting the automatic run with the positioning method set to the RTK method (see
As described above, in the second configuration example; the vehicle control unit 11, when the work vehicle 10 is ready for the automatic run by the first positioning method (when automatically running by the first positioning method, or when ready for starting the automatic run by the first positioning method), and when the distance difference L2 between the work vehicle 10′s position (self-recognized position P1) positioned by the first positioning method and the work vehicle 10′s position (self-recognized position P1′) positioned by the second positioning method is more than or equal to the threshold value Lth, prohibits the automatic run, and, when the distance difference L2 is less than the threshold value Lth, permits the automatic run (continues or starts). Thus, when the change in the self-recognized position is small, the change in the behavior of the work vehicle 10 is small, thus the automatic run may be permitted.
The threshold value Lth is set to a distance that, for causing the work vehicle 10 to continue or start the automatic run, enables the work vehicle 10 to follow, from the self-recognized position P1′, the target route R which is stable. Further, the vehicle control unit 11 may differentiate, from each other, the threshold value Lth used for a determining process when the DGNSS method is switched to the RTK method, and the threshold value Lth used for the determining process when the RTK method is switched to the DGNSS method.
For example, when the positioning method with the low positioning accuracy is switched to the positioning method with the high positioning accuracy, time until the positioning method is restored tends to be shorter, and when the positioning method with the high positioning accuracy is switched to the positioning method with the low positioning accuracy, time until the positioning method is restored tends to be longer. Due to this, the vehicle control unit 11 may set the time that such the threshold value Lth used for the determining process for the restoring to the DGNSS method in the case of the switching from the DGNSS method to the RTK method becomes a distance shorter than the threshold value Lth used for the determining process for the restoring to the RTK method in the case of the switching from the RTK method to the DGNSS method.
As a third configuration example; the run processing unit 111, when the work vehicle 10 is ready for the automatic run by the first positioning method, and when the positioning method is switched to the second positioning method which is different in positioning accuracy from the first positioning method, permits the automatic run until a given time elapses after the switching from the first positioning method to the second positioning method.
The run processing unit 111, when the work vehicle 10 is automatically running by the first positioning method, and when the positioning method is switched to the second positioning method, for example, causes the work vehicle 10 to continue the automatic run until the given time elapses after the switching from the first positioning method to the second positioning method. For example, as shown in
When the positioning method is switched (is restored) from the RTK method to the DGNSS method before the given time elapses, the run processing unit 111 causes the work vehicle 10 to continue the automatic run in the DGNSS method. A run route Rb shown in
Further, the run processing unit 111, when the positioning method fails to be switched from the first positioning method to the second positioning method before the given time elapses after the positioning method is switched from the first positioning method to the second positioning method, prohibits the automatic run. Further, the run processing unit 111, when the positioning method fails to be switched from the RTK method to the DGNSS method before the given time elapses after the positioning method is switched from the DGNSS method to the RTK method, for example, stops the automatic run. In this case, by the RTK method, the work vehicle 10 automatically runs along the run route Ra and stops.
Further, the run processing unit 111, when the positioning method is switched to the RTK method, at the time point of the work vehicle 10′s starting the automatic run with the positioning method set to the DGNSS method (see
Further, the run processing unit 111, when the positioning method is switched to the DGNSS method, at the time point of the work vehicle 10′s starting the automatic run with the positioning method set to the RTK method (see
As described above, in the third configuration example; the vehicle control unit 11, when the work vehicle 10 is ready for the automatic run by the first positioning method (when automatically running by the first positioning method, or when ready for starting the automatic run by the first positioning method), and when the positioning method is switched to the second positioning method, permits the automatic run until the given time elapses, and when the positioning method is not restored to the first positioning method before the given time elapses, prohibits the automatic run.
Further, the given time may be set according to the history of the positioning state. When the place where the positioning state changes in the farm field F can be identified from the information of the run history in the past work, for example, the given time can be set by calculating the time required to pass through the above place.
Further, the vehicle control unit 11 may cause the given time used for the determining process when the DGNSS method is switched to the RTK method and the given time used for the determining process when the RTK method is switched to the DGNSS method to differ from each other. In the case of the switching from the positioning method with the low positioning accuracy to the positioning method with the high positioning accuracy, for example, the distance difference in the self-recognized position between before and after the switching of the positioning method tends to be larger, meanwhile in the case of the switching from the positioning method with the high positioning accuracy to the positioning method with the low positioning accuracy, the distance difference in the self-recognized position between before and after the switching of the positioning method tends to be smaller. Due to this, the vehicle control unit 11 may set the given time used for the determination process when the DGNSS method is switched to the RTK method to a time shorter than the given time used for the determination process when the RTK method is switched to the DGNSS method.
Hereinafter, with reference to
In the following, it is assumed that the positioning method of the work vehicle 10 is set to the DGNSS method (see
First, at step S1, the vehicle control unit 11 determines whether or not the work vehicle 10 is ready for the automatic run. For example, the vehicle control unit 11, when the starting automatic run condition, such as the work vehicle 10′s azimuth being within the given azimuth, is met, determines that the work vehicle 10 is ready for the automatic run. The vehicle control unit 11, when determining that the work vehicle 10 is ready for the automatic run (S1: Yes), moves the process to step S2. The vehicle control unit 11 waits until the work vehicle 10 is ready for the automatic run (S1: No).
Next, at step S2, the vehicle control unit 11 determines whether or not the operation of starting the automatic run (run start instruction) has been received from the operator. When the operator presses down the automatic run button of the operation unit 17, for example, the vehicle control unit 11 receives the run start instruction. When receiving the run start instruction (S2: Yes), the vehicle control unit 11 moves the process to step S3. The vehicle control unit 11 waits until receiving the run start instruction (S2: No).
At step S3, the vehicle control unit 11 executes the automatic run process. For example, the vehicle control unit 11 starts the automatic run by the DGNSS method. Specifically, the vehicle control unit 11 starts the automatic steering such that the work vehicle 10 is along the straight ahead route that is among the multiple straight ahead routes included in the target route R and that is closest to the current position P0 (see
Next, at step S4, the vehicle control unit 11 determines whether or not the positioning method is changed (switched). Here, the vehicle control unit 11 determines whether or not the positioning method is switched from the DGNSS method to the RTK method. For example, when the mobile terminal (smartphone) of the operator is connected via the Bluetooth or the communication cable to the positioning unit 16 and is ready for the RTK positioning (high accuracy state), the positioning unit 16 (switch processing unit 182) switches the positioning method to the RTK method. In this case, the vehicle control unit 11 determines that the positioning method is switched from the DGNSS method to the RTK method. When determining that the positioning method is changed (S4: Yes), the vehicle control unit 11 moves the process to step S5. Meanwhile, when determining that the positioning method is not changed (S4: No), the vehicle control unit 11 moves the process to step S8.
At step S5, the vehicle control unit 11 stops the automatic run of the work vehicle 10 (stops the work vehicle 10). When the positioning method is switched from the DGNSS method to the RTK method during the automatic run of the work vehicle 10, for example, the vehicle control unit 11 causes the work vehicle 10 to stop the automatic run (stops the work vehicle 10) at that time point. Further, then the positioning method is switched from the DGNSS method to the RTK method at the time point of the work vehicle 10′s starting the automatic run, the vehicle control unit 11 prohibits the start of the automatic run.
Next, at step S6, the vehicle control unit 11 determines whether or not the positioning method is restored. Here, the vehicle control unit 11 determines whether or not the positioning method is switched from the RTK method to the DGNSS method. For example, when the connection between the operator’s mobile terminal and the positioning unit 16 is disconnected, the positioning unit 16 (switch processing unit 182) switches the positioning method to the DGNSS method. In this case, the vehicle control unit 11 determines that the positioning method is switched from the RTK method to the DGNSS method. When determining that the positioning method is restored (S6: Yes), the vehicle control unit 11 moves the process to step S7. The vehicle control unit 11, until the positioning method is restored (S6: No), maintains the state of stopping the automatic run.
At step S7, the vehicle control unit 11 executes the automatic run process. The vehicle control unit 11, by the DGNSS method for example, restarts the automatic run having been stopped. Further, the vehicle control unit 11, by the DGNSS method for example, starts the automatic run having been prohibited. As a result, the work vehicle 10, while performing the positioning by the DGNSS method, performs the automatic run following the target route R (straight ahead route).
At step S8, the vehicle control unit 11 determines whether or not the work vehicle 10 has ended the work. When the work vehicle 10 has ended the work (S8: Yes), the vehicle control unit 11 ends the automatic run process. Meanwhile, when the work vehicle 10 has not ended the work (S8: No), the vehicle control unit 11 moves the process to step S4.
The vehicle control unit 11, when the work vehicle 10 starts the automatic run, repeats the processes at steps S4 to S8 until the work by the work vehicle 10 is ended.
As described above, the automatic run system 1 according to the present embodiment positions the work vehicle 10′s position by the given positioning method based on the satellite signal received from the satellite 20, and causes the work vehicle 10 to automatically run based on the position information showing the work vehicle 10′s position that is positioned. Further, the automatic run system 1 is so configured as to be capable of prohibiting the automatic run when the work vehicle 10 is ready for the automatic run by the first positioning method, and when the positioning method is switched to the second positioning method which is different in positioning accuracy from the first positioning method.
For example, the automatic run system 1, when the work vehicle 10 is ready for the automatic run by the first positioning method, and when the positioning method is switched to the second positioning method, stops the automatic run (stops the work vehicle 10) or prohibits the start of the automatic run.
Further, the automatic run system 1, when the work vehicle 10 is ready for the automatic run by the first positioning method, and when the positioning method is switched to the second positioning method, prohibits the automatic run when the given condition is met. Concerning the given condition, the automatic run system 1 when the distance difference in the self-recognized position of the work vehicle 10 between before and after the change in positioning method is more than or equal to the threshold value, for example, prohibits the automatic run. Also, the automatic run system 1, when the positioning method is not restored before the given time elapses after the positioning method is switched, prohibits the automatic run. Further, the automatic run system 1, when the distance difference is less than the threshold value, may permit the automatic run. Also, the automatic run system 1, until the given time elapses after the positioning method is switched, may permit the automatic run.
According to the above configuration; the automatic run system 1, when the work vehicle 10 is switched to the RTK method at the time of automatically running while performing the positioning by the DGNSS method, for example, can stop the work vehicle 10, thereby making it possible to prevent any unstable behavior caused by the shift of the vehicle 10′s self-recognized work position. Thus, the deterioration in work accuracy can be suppressed.
The present invention is not limited to the above embodiment. As another embodiment of the present invention, the automatic run system 1 may mutually differentiate the automatic run’s restricting process seen when the work vehicle 10 is ready for the automatic run by the first positioning method and when the positioning method is switched to the second positioning method which is higher in positioning than the first positioning method, and the automatic run’s restricting process seen when the work vehicle 10 is ready for the automatic run by the second positioning method and when the positioning method is switched to the first positioning method which is lower in positioning accuracy than the second positioning method.
The vehicle control unit 11, when the work vehicle 10 is ready for the automatic run by the DGNSS method, and when the positioning method is switched to the RTK method, for example, prohibits the automatic run. In the case of the switching from the positioning method with the low positioning accuracy to the positioning method with the high positioning accuracy, the distance difference in the self-recognized position between before and after the switching of the positioning method tends to be large; thus, the vehicle control unit 11 prohibits (or stops) the automatic run.
In contrast, the vehicle control unit 11, when the work vehicle 10 is ready for the automatic run by the RTK method, and when the positioning method is switched to the DGNSS method, for example, permits the automatic run for the given time or at the given distance. Thus, in the case of the switching from the positioning method with the high positioning accuracy to the positioning method with the low positioning accuracy, the distance difference in the self-recognized position between before and after the switching of positioning method tends to be smaller; thus, the vehicle control unit 11 continues the automatic run. In this case, the vehicle control unit 11, when the positioning method fails to be switched to the RTK method after the work vehicle 10 is caused to automatically run for the given time or at the given distance, may prohibit the automatic run.
By the way, continuing the positioning process with the work vehicle 10 stopped causes a problem that the self-recognized position gradually shifts from the target route R. For example, as time elapses after the work vehicle 10 stops at a time t1 (see
Then, the vehicle control unit 11, when the work vehicle 10 that automatically runs by the given positioning method stops, and when the stop state continues for the given time, may prohibit the automatic run. Specifically, the vehicle control unit 11, when the work vehicle 10 stops during the automatic run by the DGNSS or RTK method or when the vehicle speed becomes less than the threshold value, starts measuring the time (timer counting). The vehicle control unit 11, when the measured time elapses the given time, prohibits the automatic run (stops the automatic run, or stops the work vehicle 10). Further, the vehicle control unit 11, when the operator has so operated as to restart the automatic run before the measured time elapses the given time, restarts the automatic run. In this case, the vehicle control unit 11 resets the measured time.
Further, the vehicle control unit 11, when the work vehicle 10 that automatically runs by the given positioning method stops and the stop state has continued for the given time, and when the distance difference between the work vehicle 10′s position positioned at the time point of the work vehicle 10′s being stopped (self-recognized position P1) and the work vehicle 10′s position positioned at the time point of the elapse of the given time (self-recognized position P1′) is less than the threshold value, prohibits the automatic run. For example, as shown in
For example, as shown in
In this way, the vehicle control unit 11 may be so configured as to position the work vehicle 10′s position by the given positioning method based on the satellite signal received from the satellite 20, to cause the work vehicle 10 automatically run based on the position information showing the work vehicle 10′s position to be positioned, and to prohibit the automatic run when the work vehicle 10, which is ready for automatically running by the first positioning method, is stopped for the given time.
According to the above configuration; the automatic run can be prohibited (stopped), for example, when the work vehicle 10 which is ready for the automatic run is continuously stopped for the given time, thus making it possible to prevent any unstable behavior caused by the shift of the work vehicle 10′s self-recognized position. Thus, the deterioration in work accuracy can be suppressed. In the above configuration, the vehicle control unit 11 does not have to have the configuration of switching the positioning method.
The automatic run system of the present invention may be configured with the work vehicle 10 alone, or may be so configured as to be provided with each of the processing units included in the vehicle control unit 11. Further, the automatic run system may be mounted on the work vehicle 10 or outside of the work vehicle 10, such as the operation terminal (tablet terminal, smartphone and the like).
| Number | Date | Country | Kind |
|---|---|---|---|
| 2022-059518 | Mar 2022 | JP | national |
