The present invention relates to an automatic travel system that causes an operation vehicle to automatically travel.
The above automatic travel system includes a positioning unit that acquires positional information of an operation vehicle by using a satellite positioning system or the like, and causes the operation vehicle to automatically travel along a target travel path generated in advance on the basis of the positional information of the operation vehicle acquired by the positioning unit (see, for example, Patent Literature 1).
For example, in agricultural operation or the like, operation is not completed only in a specific operation region, and is sometimes performed in a plurality of operation regions in a day. In this case, operation is performed in an operation region, and when the operation is completed, an operation vehicle moves to a next operation region by traveling outside the operation region such as a farm road, and performs operation in the next operation region. Thus, while operation in the operation region, and movement between the operation regions are repeatedly performed, operation is performed in a plurality of the operation regions.
However, in the system described in the above Patent Literature 1, a field and the like are defined as the operation regions, and a target travel path is generated in each operation region, and therefore, in each operation region, an operation vehicle is caused to automatically travel along the target travel path, but cannot be caused to automatically travel outside the operation regions. Accordingly, in the movement between the operation regions, a user or the like needs to cause the operation vehicle to travel manually, which may cause a decrease in operation efficiency, and there is room for improvement in this respect.
In view of this status, a principal object of the present invention is to provide an automatic travel system that can perform not only operation in operation regions but also movement between operation regions by automatic travel with an operation vehicle when operation is performed in a plurality of the operation regions, and that enables improvement of operation efficiency.
A first characteristic configuration of the present invention is to include a path generation unit that generates an operation path for each of a plurality of operation regions and an automatic travel control unit that causes an operation vehicle to automatically travel along the operation paths generated by the path generation unit, in which the path generation unit is capable of generating a movement path that connects the operation regions by causing the operation vehicle to travel outside the operation regions, and the automatic travel control unit temporarily stops the operation vehicle before switching a traveling path where the operation vehicle is to be caused to automatically travel from a path inside the operation regions to a path outside the operation regions, and causes the operation vehicle to automatically travel by switching the traveling path to the path outside the operation regions when the temporal stop state is cancelled.
According to the present configuration, when operation is performed in the plurality of operation regions, not only operation in the operation regions, but also movement between the operation regions can be performed by automatic travel with the operation vehicle, and it is possible to improve operation efficiency.
An embodiment of an automatic travel system according to the present invention will be described with reference to the drawings. As illustrated in
As illustrated in
The tractor 1 includes a travel machine body 7 having left and right front wheels 5 which function as drivable steering wheels, and left and right rear wheels 6 which are drivable. On the front side of the travel machine body 7, a bonnet 8 is disposed, and an electronically controlled diesel engine (hereinafter referred to as an engine) 9 equipped with a common rail system is provided in the bonnet 8. On the rear side of the travel machine body 7 with respect to the bonnet 8, a cabin 10 forming a passenger-type driver unit is provided.
A rotary tillage device, which is an example of an operation device 12, can be coupled to a rear portion of the travel machine body 7 in such a manner as to be able to lift, lower, and roll, via a three-point linkage mechanism 11. Various operation devices 12 such as a mower, a plow, a seeding device, and a spraying device can be coupled to a rear portion of the tractor 1 in place of the rotary tillage device.
As illustrated in
An electronically controlled gasoline engine equipped with an electronic governor may be employed for the engine 9. A hydromechanical transmission (HMT), a hydrostatic transmission (HST), a belt-type continuously variable transmission, or the like can be employed for the transmission device 13. An electric power steering mechanism 14 including an electric motor, or the like may be employed for the power steering mechanism 14.
As illustrated in
As illustrated in
As illustrated in
As illustrated in
The positioning antenna 24, the communication module 25, and the inertial measurement unit 23 provided in the tractor 1 are housed in an antenna unit 80, as illustrated in
As illustrated in
While a way of generation of the target travel path P by the travel path generation unit 54 will be described below, the travel path generation unit 54 is capable of generating not only an operation path P1 within operation regions S but also a movement path P2 connecting operation regions S each other outside the operation regions S as the target travel path P, as illustrated in
When the travel path generation unit 54 generates the target travel path P, the terminal electronic control unit 52 transfers the path information from the mobile communication terminal 3 to the tractor 1, so that the on-board electronic control unit 18 of the tractor 1 can obtain the path information. The on-board electronic control unit 18 can cause the tractor 1 to automatically travel along the target travel path P while acquiring its own current position (current position of the tractor 1) by the positioning unit 21 on the basis of the acquired path information. The current position of the tractor 1 acquired by the positioning unit 21 is transmitted from the tractor 1 to the mobile communication terminal 3 in real time (for example, every few milliseconds), and the mobile communication terminal 3 grasps the current position of the tractor 1.
As to the transfer of the path information, at a stage before the tractor 1 starts the automatic travel, the entire path information can be transferred from the terminal electronic control unit 52 to the on-board electronic control unit 18 at once. In addition, for example, the path information including the target travel path P can be divided into a plurality of path portions each having a small amount of information for each predetermined distance. In this case, at the stage before the tractor 1 starts the automatic travel, only an initial path portion of the path information is transferred from the terminal electronic control unit 52 to the on-board electronic control unit 18. After the start by the automatic travel, each time the tractor 1 reaches a path acquisition point which is set in accordance with the amount of information or the like, the path information on only a subsequent path portion corresponding to the point may be transferred from the terminal electronic control unit 52 to the on-board electronic control unit 18.
To start the automatically travel by tractor 1, for example, when a user or the like moves the tractor 1 to a start point and various conditions for starting the automatic travel are satisfied, the user instructs the tractor to start the automatic travel by operating the display unit 51 in the mobile communication terminal 3, so that the mobile communication terminal 3 sends an instruction for starting the automatic travel to the tractor 1. Consequently, in the tractor 1, the on-board electronic control unit 18 receives the instruction for starting the automatic travel to start automatic travel control for causing the tractor 1 to automatically travel along the target travel path P while acquiring its own current position (the current position of the tractor 1) by the positioning unit 21. The on-board electronic control unit 18 is configured as an automatic travel control unit that performs automatic travel control for causing the tractor 1 to automatically travel along the target travel path P on the basis of the positioning information of the tractor 1 acquired by the positioning unit 21 by using a satellite positioning system.
The automatic travel control includes automatic transmission control for automatically controlling the actuation of the transmission device 13, automatic braking control for automatically controlling the actuation of the brake operation mechanism 15, automatic steering control for automatically steering the left and right front wheels 5, automatic control for operation for automatically controlling the actuation of the operation device 12 such as the rotary tillage device, and the like.
In the automatic transmission control, the transmission control unit 181 automatically controls the actuation of the transmission device 13 such that the target travel speed set in accordance with the travel mode of the tractor 1 on the target travel path P is obtained as the vehicle speed of the tractor 1, on the basis of the path information of the target travel path P including the target travel speed, the output of the positioning unit 21, and the output of the vehicle speed sensor 19.
In the automatic braking control, the braking control unit 182 automatically controls the actuation of the brake operation mechanism 15 such that the left and right side brakes properly brake the left and right rear wheels 6 in the braking region included in the path information of the target travel path P, on the basis of the target travel path P and the output of the positioning unit 21.
In the automatic steering control, the steering angle setting unit 184 obtains and sets the target steering angles of the left and right front wheels 5 on the basis of the path information of the target travel path P and the output of the positioning unit 21, and outputs the set target steering angle to the power steering mechanism 14 such that the tractor 1 automatically travels on the target travel path P. The power steering mechanism 14 automatically steers the left and right front wheels 5 such that the target steering angles are obtained as the steering angles of the left and right front wheels 5 on the basis of the target steering angles and the output of the steering angle sensor 20.
In the automatic control for operation, the operation device control unit 183 automatically controls the actuation of the clutch operation mechanism 16 and the lift driving mechanism 17 such that predetermined operation (for example, tilling operation) by the operation device 12 is started as the tractor 1 reaches an operation start point on the operation path P1 (for example, see
Thus, in the tractor 1, the automatic travel unit 2 is composed of the transmission device 13, the power steering mechanism 14, the brake operation mechanism 15, the clutch operation mechanism 16, the lift driving mechanism 17, the on-board electronic control unit 18, the vehicle speed sensor 19, the steering angle sensor 20, the positioning unit 21, the communication module 25, and the like.
In this embodiment, it is possible to cause the tractor 1 not only to automatically travel without a user or the like who boards the cabin 10, but also to automatically travel in a state in which a user or the like boards the cabin 10. Therefore, the tractor 1 can be caused not only to automatically travel along the target travel path P by the automatic travel control by the on-board electronic control unit 18 without a user or the like who boards the cabin 10, but also to automatically travel along the target travel path P by the automatic travel control by the on-board electronic control unit 18 even in a case where the user or the like boards the cabin 10.
When a user or the like boards the cabin 10, the on-board electronic control unit 18 can switch between an automatic travel state in which the tractor 1 is caused to automatically travel and a manual travel state in which the tractor 1 is caused to travel on the basis of the operation of the user or the like. Therefore, it is possible to switch from the automatic travel state to the manual travel state during automatic travel on the target travel path P in the automatic travel state, and conversely, it is possible to switch from the manual travel state to the automatic travel state during travel in the manual travel state. As to switching between the manual travel state and the automatic travel state, for example, a switching operation unit for switching between the automatic travel state and the manual travel state can be provided near the driver's seat 39, and the switching operation unit can be displayed on the display unit 51 of the mobile communication terminal 3. When the user operates the steering wheel 38 during automatic travel control by the on-board electronic control unit 18, the system can be switched from the automatic travel state to the manual travel state.
As illustrated in
The objects to be measured by the LiDAR sensors 101, 102, the sonar units 103, 104 and the cameras 105, 106 are objects, people, and the like. The LiDAR sensors 101, 102 are provided with a front LiDAR sensor 101 for measuring the front side of the tractor 1 as the object to be measured and a rear LiDAR sensor 102 for measuring the rear side of the tractor 1 as the object to be measured, respectively. The sonar units 103, 104 are provided with a right side sonar unit 103 for measuring the right side of the tractor 1 as the object to be measured and a left side sonar unit 104 for measuring the left side of the tractor 1 as the object to be measured, respectively. The cameras 105 and 106 are provided with a front camera 105 for measuring the front side of the tractor 1 as the object to be measured and a rear camera 106 for measuring the rear side of the tractor 1 as the object to be measured, respectively.
The obstacle detection unit 110 is configured to perform an obstacle detection process for detecting the object to be measured such as an object and a person within a predetermined distance as an obstacle on the basis of the measurement information of the LiDAR sensors 101, 102, the sonar units 103, 104 and the cameras 105, 106. The collision avoidance control unit 111 is configured to perform collision avoidance control for decelerating the tractor 1 or stopping the tractor 1 from traveling when an obstacle is detected by the obstacle detection unit 110. In the collision avoidance control, the collision avoidance control unit 111 not only decelerates the tractor 1 or stops the tractor 1 from traveling, but also activates a notification device 26 such as a notification buzzer and a notification lamp to notify that the obstacle exists. In the collision avoidance control, the collision avoidance control unit 111 communicates from the tractor 1 to the mobile communication terminal 3 by using the communication modules 25 and 53 to display the presence of the obstacle on the display unit 51, so that the collision avoidance control unit 111 can notify that the obstacle exists.
The obstacle detection unit 110 repeats the obstacle detection process based on the measurement information of the LiDAR sensors 101, 102, the sonar units 103, 104 and the cameras 105, 106 in real time, and properly detects an obstacle such as an object and a person. The collision avoidance control unit 111 performs collision avoidance control for avoiding collision with an obstacle that is detected in real time.
The obstacle detection unit 110 and the collision avoidance control unit 111 are provided in the on-board electronic control unit 18. The on-board electronic control unit 18 is communicatively connected to an electronic control unit for the engine, which is included in the common rail system, the LiDAR sensors 101 and 102, the sonar units 103 and 104, the cameras 105, 106, and the like, via a CAN (Controller Area Network).
The LiDAR sensors 101, 102 each measure a distance to an object to be measured on the basis of round-trip time during which laser light (e.g., pulsed near-infrared laser light) hits the object to be measured and returns back (Time of Flight). The LiDAR sensors 101, 102 each measure the distance to the object to be measured in three dimensions by performing scanning with the laser light in the up-down direction and the left-right direction at a high speed and sequentially measuring the distance to the object to be measured at each scanning angle. The LiDAR sensors 101, 102 each repeatedly measure the distance to the object to be measured in a measurement range in real time. The LiDAR sensors 101, 102 are each configured to generate a three-dimensional image from the measurement information and output the generated three-dimensional image externally. The three-dimensional image generated from the measurement information of the LiDAR sensors 101, 102 can be displayed on a display device such as the display unit of the tractor 1 and the display unit 51 of the mobile communication terminal 3 to allow a user or the like to visually recognize whether there is an obstacle. Incidentally, in a three-dimensional image, for example, the distance in the perspective direction can be indicated using colors or the like.
The front LiDAR sensor 101 is mounted on a bottom of the antenna unit 80 disposed at an upper position on the front side of the cabin 10, as illustrated in
The front camera 105 is disposed on the upper side of the front LiDAR sensor 101. Similar to the front LiDAR sensor 101, the front camera 105 is mounted in a forward downward posture in which the forward portion is positioned lower. The front camera 105 is provided so as to image the front side of the travel machine body 7 in a state of looking down from the oblique upper side. The front camera 105 is configured to be able to output an image captured by the front camera 105 to an external device. The image captured by the front camera 105 is displayed on the display device such as the display unit of the tractor 1 or the display unit 51 of the mobile communication terminal 3, and enables the user or the like to visually recognize the status in the surroundings of the tractor 1. The front LiDAR sensor 101 and the front camera 105 are disposed at a position corresponding to a roof 35 in the up-down direction.
The rear LiDAR sensor 102 is mounted on a pipe-shaped sensor support stay 82 extending the entire length of the cabin 10 in the left-right direction of the travel machine body 7, as illustrated in
The rear camera 106 is disposed on the upper side of the rear LiDAR sensor 102. Similar to the rear LiDAR sensor 102, the rear camera 106 is mounted in a rearward downward posture in which the rearward portion is positioned lower. The rear camera 106 is provided so as to image the rear side of the travel machine body 7 in a state of looking down from the oblique upper side. The rear camera 106 is configured to be able to output an image captured by the rear camera 106 to the external device. The image captured by the rear camera 106 is displayed on the display device such as the display unit of the tractor 1 and the display unit 51 of the mobile communication terminal 3, and enables the user or the like to visually recognize the status in the surroundings of the tractor 1. The rear LiDAR sensor 102 and the rear camera 106 are disposed at a position corresponding to the roof 35 in the up-down direction.
The sonar units 103, 104 are each configured to measure a distance to an object to be measured on the basis of round-trip time during which a ultrasonic wave hits the object to be measured and returns back. As described above, as the sonar units 103, 104, a right side sonar unit 103 that defines the right side of the tractor 1 (travel machine body 7) as a measurement range, and a left side sonar unit 104 that defines the left side of the tractor 1 (travel machine body 7) as a measurement range (see
For the front side of the tractor 1, the obstacle detection unit 110 detects, for example, the presence or absence of an obstacle on the basis of the measurement information of the front camera 105 as the obstacle detection process, and when the presence of the obstacle is detected, the position of the obstacle is detected on the basis of the measurement information of the front LiDAR sensor 101. For the rear side of the tractor 1, the obstacle detection unit 110 detects, for example, the presence or absence of an obstacle and the presence of the obstacle on the basis of the measurement information of the rear camera 106 as the obstacle detection process on the basis of the measurement information of the rear LiDAR sensor 102, similar to the front side of the tractor 1. For the right side of the tractor 1, the obstacle detection unit 110 detects the existence or absence of an obstacle and the position of the obstacle on the basis of the measurement information of the right side sonar unit 103 as the obstacle detection process, and for the left side of the tractor 1, the obstacle detection unit 110 also detects the existence or absence of an obstacle and the position of the obstacle on the basis of the measurement information of the left side sonar unit 104 as the obstacle detection process.
Hereinafter, the generation of the target travel path P by the travel path generation unit 54 will be described. Before the travel path generation unit 54 generates the target travel path P, a user such as a driver and a manager inputs various information including vehicle body information such as the model of the operation vehicle and the type and the operation width of the operation device 12, exit direction and entry direction information related to the exit direction from the inside of each operation region S to the outside of the operation region S, and the entry direction from the outside of each operation region S to the inside of the operation region S, in accordance with the input guide for setting the target travel path displayed on the display unit 51 of the mobile communication terminal 3, and the input information is stored in the terminal storage unit 55.
The exit direction and entry direction information related to the exit direction from the inside of each operation region S to the outside of the operation region S, and the entry direction from the outside of each operation region S to the inside of the operation region S can be input by operating the display unit 51 (corresponding to an operation tool) by the user, and an exit direction and entry direction information acquisition unit 56 acquires the exit direction and entry direction information from the input information. The user operates the display unit 51 to enable change of the exit direction and the entry direction in the exit and entry direction information, and the exit direction and entry direction information acquisition unit 56 acquires the exit direction and entry direction information on the exit direction and the entry direction after the change. The acquisition of the exit direction and entry direction information is not limited to the input information by a user. For example, the exit direction and entry direction information acquisition unit 56 can acquire the exit direction and entry direction information by reading the exit direction and the entry direction from map information or the like.
Each operation region S where operation is to be performed is defined as a field, and the terminal electronic control unit 52 of the mobile communication terminal 3 acquires field information related to the fields each including the shape and the position of the field and the position of the entrance and exit in the field, and outside-field information related to a region outside the fields including the shape and the position of the outside-field region and a farm road connecting between the field and the field, and stores the above information in the terminal storage unit 55. The terminal electronic control unit 52 acquires the field information and the outside-field information from the map information or the like stored in a database or the like. For example, the field information can be acquired from measurement information or the like when the shape, the position and the like of each operation region are actually measured, and the field information and the outside-field information can be acquired by various methods.
In addition to the input information by the user, in a state in which the field information and the outside-field information acquired by the terminal electronic control unit 52 are stored in the terminal storage unit 55, the travel path generation unit 54 generates the target travel path P by using the field information, the outside-field information, the vehicle body information, and the exit direction and entry direction information stored in the terminal storage unit 55. As illustrated in
When operation is performed in the plurality of operation regions S, the travel path generation unit 54 generates the target travel path P by performing, by the user, various operations on the display unit 51 in accordance with a display screen displayed on the display unit 51. Hereinafter, the display screen displayed on the display unit 51 will be described as an example.
As illustrated in
When the operation regions S where operation is to be performed are determined in the state illustrated in
When the user presses and operates the selection button 201 in
When the user presses and operates an operation order determination button 202 in
In the one illustrated in
The travel path generation unit 54 generates, as the movement path P2, for example, a path obtained by combining a plurality of linear paths to connect an end edge of the operation path P1 in the operation region S where operation is to be first performed to a start edge of the operation path P1 in the operation region S where operation is to be next performed through a farm road N and the like outside the operation regions S.
Herein, in the operation paths P1 and the movement paths P2 illustrated in
Accordingly, in the ones illustrated in
The travel path generation unit 54 can correct the generated operation paths P1 and movement path P2 in response to correct operation (change operation) by a user or the like. As illustrated in
As illustrated in
Thus, when the operation direction in the operation region S and the direction of entry into the operation region S and the direction of exit from the operation region S are corrected (changed) by the user, the travel path generation unit 54 corrects the operation path P1 and the movement path P2 on the basis of the corrected (changed) information. In the screen illustrated in
The target travel path P (the operation path P1 and the movement path P2) generated by the travel path generation unit 54 can be displayed on the display unit 51 and are stored in the terminal storage unit 55 as path information associated with various information such as field information. The path information includes the azimuth angle of the target travel path P, the set engine rotating velocity and the target travel speed set in accordance with a traveling mode of the tractor 1 on the target travel path P, and the like. The on-board electronic control unit 18 causes the tractor 1 to automatically travel along the target travel path P in a state in which the tractor 1 is controlled to the set engine speed, the target travel speed, and the like, by acquiring the path information.
Motion when the tractor 1 automatically travels in a case where operation is performed in a plurality of the operation regions S will be described with reference to the flowchart in
When a user or the like moves the tractor 1 to the start point of the operation region S where first operation is to be performed, and starts automatic travel, the on-board electronic control unit 18 first causes the tractor 1 to automatically travel along the operation path P1 of the operation region S in a state in which the operation device 12 performs predetermined operation (Step #1 in
At this time, as illustrated in
When the tractor 1 reaches a first switching point A1 for switching a traveling path where the tractor 1 is to be caused to automatically travel from a path inside the operation region S to a path outside the operation regions S as illustrated in
As illustrated in
In the one illustrated in
In this embodiment, when the mode between the in-operation-region mode and the outside-operation-region mode is switched, the measurement range is changed using the same measurement device such as the camera 105. However, the obstacle detection system 100 can include, for example, a millimeter wave radar capable of detecting an obstacle at a distance from the tractor 1, in addition to the LiDAR sensors 101, 102, the sonar units 103, 104 and the cameras 105, 106, and can switch the measurement device for detecting an obstacle to a different measurement device when the mode is switched between the in-operation-region mode and the outside-operation-region mode. For example, in the in-operation-region mode, an obstacle can be detected using the measurement devices, namely the LiDAR sensors 101, 102, the sonar units 103, 104 and the cameras 105, 106, and in the outside-operation-region mode, an obstacle can be detected using the millimeter-wave radar.
In a monitoring center 301, as illustrated in
When automatic travel is performed on the movement path P2, the transmission control unit 181 of the on-board electronic control unit 18 can switch the transmission device 13 to a high speed state, so that the tractor 1 can be caused to automatically travel in the high speed state, and the operation device control unit 183 of the on-board electronic control unit 18 controls the clutch operation mechanism 16 and the lift driving mechanism 17 such that the operation of the operation device 12 is stopped.
When the tractor 1 is caused to travel automatically on the movement path P2 outside the operation regions S, the tractor 1 is caused to automatically travel while the traveling status of the tractor 1 is intensively monitored in the monitoring center 301 as described above. When the tractor 1 includes an Intelligent Transport System (ITS) in which various information such as a status of a roadway such as the farm road N is grasped and freely transmitted externally, the on-board electronic control unit 18 of the tractor 1 transmits and receives various types of information to and from the Intelligent Transport System, so that it is possible to grasp the status of a roadway such as the farm road N. Therefore, in addition to or instead of the monitoring by the monitoring center 301, the on-board electronic control unit 18 can cause the tractor 1 to automatically travel in accordance with the status of the roadway such as the farm road N acquired from the Intelligent Transport System.
As illustrated in
When the tractor 1 reaches a second switching point A2 for switching a traveling path where the tractor 1 is to be caused to automatically travel from a path outside the operation regions S to a path inside the operation region S as illustrated in
When the condition for canceling temporal stop is satisfied by the elapse of predetermined time after the tractor 1 is temporarily stopped or by reception of a notice of permission to enter the operation region S from the monitoring center 301, the on-board electronic control unit 18 switches the traveling path where the tractor 1 is to be caused to automatically travel from the path outside the operation regions S to the path inside the operation region S as illustrated in
As illustrated in the flowchart in
When the tractor 1 is caused to automatically travel to exit outside the operation regions S, or when the tractor 1 is caused to automatically travel to enter the operation region S (see
As described above, the LiDAR sensors 101, 102 and the cameras 105, 106 (corresponding to an entrance/exit status detection unit) are provided as measurement devices for measuring the status around the tractor 1. When the tractor 1 is caused to automatically travel to exit outside the operation regions S, or when the tractor 1 is caused to automatically travel to enter the operation region S (see
Therefore, as illustrated in
The exit direction and entry direction correction unit 57 does not correct the exit direction and the entry direction when the entry direction C2 of the tractor 1 matches the possible entry direction C1, and corrects the exit direction and the entry direction when the entry direction C3 of the tractor 1 differs from the possible entry direction C1. In the one illustrated in
Thus, when the exit direction or the entry direction is corrected by the exit direction and entry direction correction unit 57, the travel path generation unit 54 is configured to be able to correct the movement path P2 on the basis of the corrected exit direction and entry direction. The travel path generation unit 54 corrects the movement path P2 such that the exit direction and the entry direction of the movement path P2 match the corrected exit direction and the entry direction (see
In this embodiment, the tractor 1 is caused to automatically travel not only on the operation path P1 in the operation region S but also on the movement path P2 outside the operation regions S, and therefore conditions for stopping the travel during the automatic travel are made different.
The tractor 1 performs predetermined operation when automatically traveling on the operation path P1 in the operation region S. Therefore, when the on-board electronic control unit 18 determines that the travel position of the tractor 1 deviates from the operation path P1 by a predetermined distance or more, or determines that failure related to operation occurs, the tractor 1 is stopped from traveling. In contrast, in the case of automatic traveling on the movement path P2 outside the operation regions S, when the on-board electronic control unit 18 determines that the travel position of the tractor 1 does not deviate from a lane of the farm road N or the like even when the travel position of the tractor 1 deviates from the movement path P2, the automatic traveling of the tractor 1 is continued. When the on-board electronic control unit 18 determines that the travel position of the tractor 1 deviates from the lane, the tractor 1 is stopped from traveling. The on-board electronic control unit 18 continues the automatic travel of the tractor 1 even when there is failure not related to travel on a roadway such as the farm road N. The on-board electronic control unit 18 stops the tractor 1 from traveling when there is a failure related to travel on a roadway.
When the positioning unit 21 cannot acquire appropriate positioning information, in the case of automatically traveling on the operation path P1 in the operation region S, automatic travel of the tractor 1 is continued until travel is performed by a predetermined distance or until predetermined time elapses, and the tractor 1 is stopped from traveling after the travel is performed by the predetermined distance or after the predetermined time elapses. In contrast, when the tractor travels automatically on the movement path P2 outside the operation regions S, the tractor 1 is immediately stopped from traveling when appropriate positioning information cannot be acquired. Incidentally, when it is possible to continue the automatic travel of the tractor 1 from the measurement information of the cameras 105, 106 provided in the tractor 1, the automatic travel of the tractor 1 can also be continued.
Other embodiments of the present invention will be described. A configuration of each embodiment described below can be applied not only independently but also in combination with the configurations of other embodiments.
(1) The configuration of the operation vehicle can be changed in various manners. For example, the operation vehicle may be configured as a hybrid specification with an engine 9 and an electric motor for traveling, or may be configured as an electric specification with an electric motor for traveling in place of the engine 9. For example, the operation vehicle may be configured as a semi-crawler specification with left and right crawlers instead of the left and right rear wheels 6 as the travel unit. For example, the operation vehicle may be configured with a rear wheel steering specification in which the left and right rear wheels 6 function as steering wheels.
(2) In the above embodiment, the travel path generation unit 54, the exit direction and entry direction information acquisition unit 56, and the exit direction and entry direction correction unit 57 are provided in the mobile communication terminal 3. However, the travel path generation unit 54, the exit direction and entry direction information acquisition unit 56 and the exit direction and entry direction correction unit 57 can be provided in the tractor 1 (operation vehicle) or an external management device.
(3) In the above embodiment, the mobile communication terminal 3 is operated, so that the generation of the target travel path, the instruction of the automatic travel start, or the like is performed, and the operation vehicle is caused to automatically travel. However, for example, as described in the above (2), the travel path generation unit 54, the exit direction and entry direction information acquisition unit 56, the exit direction and entry direction correction unit 57, and the like are provided in the external monitoring center, the monitoring device, or the like, and the generation of the target travel path, the instruction of the automatic travel start, or the like is performed by the monitoring sensor or the monitoring device, so that the operation vehicle can automatically travel.
A first characteristic configuration of the present invention is to include a path generation unit that generates an operation path for each of a plurality of operation regions, and an automatic travel control unit that causes an operation vehicle to automatically travel along each of the operation paths generated by the path generation unit, in which the path generation unit is capable of generating a movement path that connects the operation regions by causing the operation vehicle to travel outside the operation regions, and the automatic travel control unit temporarily stops the operation vehicle before switching a traveling path where the operation vehicle is to be caused to automatically travel from a path inside the operation regions to a path outside the operation regions, and causes the operation vehicle to automatically travel by switching the traveling path to the path outside the operation regions when the temporal stop state is cancelled.
According to the present configuration, the path generation unit generates not only the operation path for the operation regions, but also the movement path connecting the operation regions by causing the operation vehicle to travel outside the operation regions and, and therefore the automatic travel control unit can not only cause the operation vehicle to automatically travel on the operation path, but also cause the operation vehicle to automatically travel on the movement path. Consequently, when operation is performed in the plurality of operation regions, not only operation in the operation regions but also movement between the operation regions can be performed by automatic travel by the operation vehicle, and it is possible to improve operation efficiency.
In addition, the automatic travel control unit temporarily stops the operation vehicle before switching the traveling path where the operation vehicle is to be caused to automatically travel from the path inside the operation regions to the path outside the operation regions, and therefore it can be confirmed in advance whether or not safety and the like can be ensured even if the automatic travel is performed on the path outside the operation regions, before causing the operation vehicle to automatically travel on the path outside the operation regions. Accordingly, the automatic travel control unit can perform automatic travel on the path outside the operation regions after the temporal stop state is cancelled, so that automatic travel on the path outside the operation regions can be performed appropriately while ensuring safety.
A second characteristic configuration of the present invention is that the automatic travel control unit temporarily stops the operation vehicle before switching the traveling path where the operation vehicle is to be caused to automatically travel from the path outside the operation regions to the path inside the operation regions, and when the temporal stop state is cancelled, the automatic travel control unit switches the traveling path to the path inside the operation regions and causes the operation vehicle to automatically travel on the path inside the operation region.
According to the present configuration, the automatic travel control unit temporarily stops the operation vehicle before switching the traveling path where the operation vehicle is to be caused to automatically travel from the path outside the operation regions to the path inside the operation regions, and therefore it can be confirmed in advance whether or not operation is prepared even if the automatic travel automatically travels on the path inside the operation regions. Accordingly, the automatic travel control unit can perform automatic travel on the path inside the operation regions after the temporal stop state is cancelled, so that automatic travel on the path inside the operation regions can be performed appropriately in a state in which the preparation of the operation and the like are completed, and the operation can be efficiently performed.
A third characteristic configuration of the present invention is that the path generation unit generates the movement path on the basis of an exit direction from inside the operation regions to outside the operation regions, and an entry direction from outside the operation regions to inside the operation regions, and the exit direction and the entry direction are changeable on the basis of predetermined operation by an operation tool.
According to the present configuration, a user or the like can appropriately change and set the exit direction from inside the operation regions to outside the operation regions and the entry direction from outside the operation regions to inside the operation regions by performing the predetermined operation with the operation tool. The path generation unit generates the movement path on the basis of the corrected exit direction and entry direction, and therefore the path generation unit can generate the movement path in which the exit direction and the entry direction are set to appropriate directions. Accordingly, when the operation vehicle is caused to automatically travel on the movement path, both the exit direction from inside the operation regions to outside the operation regions and the entry direction from outside the operation regions to inside the operation regions can be set to appropriate directions, and it is possible to appropriately exit from the operation region, and enter the operation region.
A fourth characteristic configuration of the present invention is that the operation vehicle includes an entrance/exit status detection unit that detects a status of an entrance/exit in the operation regions, the operation vehicle includes an exit direction and entry direction correction unit that is capable of correcting an exit direction from inside the operation regions to outside the operation regions, and an entry direction from outside the operation regions to inside the operation regions, on the basis of detection information of the entrance/exit status detection unit, and when the exit direction and entry direction correction unit corrects the exit direction or the entry direction, the path generation unit is capable of correcting the movement path on the basis of corrected exit direction or corrected entry direction.
For example, the user may not be able to exit from the operation region in the already set exit direction or enter the operation region in the already set entry direction due to a user input error or change in the status of the entrance/exit of the operation region.
Therefore, according to the present configuration, in a case of exit from the operation region, and in a case of entry into the operation region, the status of the entrance/exit can be grasped on the basis of the detection information of the entrance/exit status detection unit, and therefore the exit direction and entry direction correction unit can determine whether or not it is possible to exit in the exit direction already set, and whether or not it is possible to enter in the entry direction already set. When the exit direction and entry direction correction unit determines that it is not possible to exit in the already set exit direction, the exit direction can be corrected on the basis of the grasped entrance/exit status. When the exit direction and entry direction correction unit determines that it is not possible to enter in the already set entry direction, the entry direction can be corrected on the basis of the grasped entrance/exit status.
Thus, when the exit direction and entry direction correction unit corrects the exit direction or the entry direction, the path generation unit can correct the movement path on the basis of the corrected exit direction or the corrected entry direction. Therefore, even when it is not possible to exit the operation region in the already set exit direction or enter the operation region in the already set entry direction due to a user input error or change in the status of the entrance/exit of the operation region, the automatic travel control unit causes the operation vehicle to automatically travel on the corrected movement path, so that it is possible to perform appropriately exit from the operation region, and appropriately enter the operation region.
A fifth characteristic configuration of the present invention is that the operation vehicle includes a surrounding monitoring device that monitors a status of a surrounding thereof, and when the operation vehicle automatically travels along the path outside the operation regions, the surrounding monitoring device raises a monitoring level compared to a case where the operation vehicle automatically travels along the path inside the operation regions.
In a case of performing automatic travel on the path inside the operation regions, even when there is an obstacle that hinders the automatic travel of the operation vehicle, the obstacle is often a fixed object such as a wall and a telegraph pole. Even when the obstacle is a person or other object that moves, the movement speed is relatively slow. In contrast, when automatic travel is performed on the path outside the operation regions, the obstacle includes other vehicles and the like, and the movement speed is relatively fast.
Therefore, according to the present configuration, when the operation vehicle automatically travels along the path outside the operation regions, the surrounding monitoring device raises the monitoring level compared to the case where the operation vehicle automatically travels along the path inside the operation regions. For example, by widening the monitoring range by the surrounding monitoring device and raising the monitoring level of the surrounding monitoring device, even when there is an obstacle of a fast movement speed, the obstacle can be detected at a position away from the operation vehicle, and it is possible to appropriately prevent contact with the obstacle. Thus, when the operation vehicle automatically travels along the path outside the operation regions, the monitoring level of the surrounding monitoring device can be raised, so that it is possible to allow the operation vehicle to travel automatically while appropriately preventing contact with the obstacle and the like.
Number | Date | Country | Kind |
---|---|---|---|
2019-128309 | Jul 2019 | JP | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2020/026931 | 7/9/2020 | WO |