The present invention relates to a traveling work machine in which a target heading can be calculated based on a travel trajectory and maneuvering of a machine body can be controlled to follow the target heading.
A work vehicle disclosed in JP 2018-148858A, for example, includes a position detection unit (“receiving device” in the document) capable of obtaining position information pertaining to a machine body using a satellite positioning system, and a maneuvering control unit (“automatic maneuvering control unit” in the document) capable of performing maneuvering control such that the machine body follows a target heading based on the position information obtained by the position detection unit. The target heading, which defines and functions as a reference for automatic maneuvering control, is set based on a position when an operating tool for registering a start point (“start point registration switch” in the document) is operated and a position when an operating tool for registering an end point (“end point registration switch” in the document) is operated.
According to the work vehicle disclosed in JP 2018-148858A, the start point and the end point are each registered using a separate dedicated operating tool. According to this configuration, when registering the start point and the end point, there is a risk of an occupant pressing the wrong operating tool, and in such a case, the operations for registering the start point and the end point are a burden for the occupant. If the operating tools perform operations aside from setting the start point and the end point as well, the number of operating tools can be reduced, which is advantageous in terms of costs.
Preferred embodiments of the present invention provide traveling work machines in each of which a start point and an end point can be set through simple operations when calculating a target heading.
A traveling work machine according to a preferred embodiment of the present invention includes a position detector capable of detecting position information of a machine body based on a positioning signal of a navigation satellite; a travel trajectory determiner capable of determining a travel trajectory of the machine body based on detection, over time, of the position information; a target heading calculator capable of calculating a target heading based on the travel trajectory; a maneuvering controller capable of controlling the machine body to maneuver along the target heading; and a single operating tool capable of setting both a start point and an end point of the travel trajectory obtained when calculating the target heading.
According to a preferred embodiment of the present invention, both the start point and the end point can be set using a single operating tool. Accordingly, when registering the start point and the end point, the risk that an occupant will press the wrong operating tool is reduced, and the operations for registering the start point and the end point are easier, than when using a configuration in which separate operating tools are provided. Furthermore, using the single operating tool as a plurality of operators reduces the number of operating tools and is therefore advantageous in terms of costs. This makes it possible to realize a traveling work machine in which a start point and an end point can be set through simple operations when calculating a target heading.
In a preferred embodiment of the present invention, preferably, the target heading calculator is configured or programmed to be capable of setting the end point through an operation of the operating tool after the start point has been set through an operation of the operating tool and the machine body has traveled a pre-set distance after the start point has been set.
According to this configuration, the machine body will always travel after the start point has been set, and the end point can be set in a different position from the start point. Furthermore, according to this configuration, the distance between the start point and the end point is at least a pre-set distance, and thus the target heading can be calculated with at least a predetermined accuracy.
In a preferred embodiment of the present invention, preferably, the traveling work machine includes a display capable of displaying information pertaining to setting of the target heading, and when setting of the end point through an operation of the operating tool has become possible, the display is capable of displaying an indication that the setting of the end point is possible.
According to this configuration, even if the occupant does not know how to set the target heading, the occupant can set the start point and the end point while checking information displayed in the display. This makes it even easier to set the start point and the end point when calculating the target heading.
In a preferred embodiment of the present invention, preferably, the target heading calculator is configured or programmed to be capable of setting the start point through an operation of the operating tool when an accuracy at which the position detector obtains the position information is at least a pre-set accuracy.
If the accuracy of the position information is poor when setting the start point and the end point, there is a risk that an accurate target heading cannot be calculated. According to this configuration, the start point cannot be set when the accuracy of the position information is poor, which eliminates the risk of maneuvering control being performed based on an erroneous target heading.
In a preferred embodiment of the present invention, preferably, the traveling work machine includes a maneuvering operation detector capable of detecting a maneuvering operation of the machine body, and when, after the start point has been set through an operation of the operating tool, a change amount of the maneuvering operation is detected as exceeding a pre-set range without the operating tool being operated, the setting of the start point is canceled.
When the travel trajectory is a turning state, the target heading cannot be calculated so as to follow the travel trajectory, and there is thus a risk that maneuvering control cannot be performed according to the occupant's intentions. According to this configuration, turning of the machine body can be determined based on a change amount of the maneuvering operation, which avoids a situation in which the start point and the end point are set in a state where the travel trajectory is turning.
In a preferred embodiment of the present invention, preferably, the traveling work machine includes a cabin capable of being occupied by an occupant, and a maneuvering tool that is supported by a support in the cabin and is capable of performing a maneuvering operation of the travel apparatus, with the operating tool being disposed above the support and directly below the maneuvering tool.
According to this configuration, the support that supports the maneuvering tool also defines and functions as a support for the operating tool, and the operating tool can therefore be supported using a simple support configuration. This also makes it easy for the occupant to operate the operating tool while operating the maneuvering tool, making the operation for registering the start point and the end point even easier.
The above and other elements, features, steps, characteristics and advantages of the present invention will become more apparent from the following detailed description of the preferred embodiments with reference to the attached drawings.
Preferred embodiments of traveling work machines according to the present invention will be described.
In the descriptions of preferred embodiments of the present invention, “maneuvering operations” includes changing the direction of the machine body 1 by changing the direction of the front wheels 11, but if the travel apparatus is a crawler type, changing the direction of the machine body 1 using a speed difference between left and right crawlers is included in the “maneuvering operations”.
As illustrated in
A dial switch 23 is disposed on an upper surface of the steering post 22. The side panel 21 can be operated by using the dial switch 23 as an operating tool, and the dial switch 23 is disposed in an upper portion of the steering post 22 and directly below the steering wheel 16. The dial switch 23 is freely rotatable about an axis extending in the up-down direction (or a direction inclined rearward in a front-back direction of the machine body), and an occupant can switch items of the guidance information displayed in the side panel 21 by rotating the dial switch 23. Additionally, the dial switch 23 can be pressed in a downward direction (or a direction inclined forward in the front-back direction of the machine body). By pressing the dial switch 23, the occupant can perform an operation to accept a setting item, a selected item, or the like pertaining to the guidance information displayed in the side panel 21. This dial switch 23 is also used as a trigger switch 49, which will be described later based on
A configuration for performing automatic maneuvering control will be described next. As illustrated in
The machine body 1 is provided with a satellite positioning unit 8a, which measures the position of the machine body 1 using GPS (Global Positioning System), which is a well-known technology, as an example of a satellite positioning system (GNSS, or Global Navigation Satellite System) which detects the position of the machine body 1 by receiving radio waves from a satellite. Although the satellite positioning unit 8a uses DGPS (Differential GPS, a relative positioning method) in the present preferred embodiment, it is also possible to use RTK-GPS (Real-Time Kinematic GPS, an interference-based positioning method).
Specifically, the satellite positioning unit 8a, which partially defines a position detection unit 8, is provided in the machine body 1, which is the subject of positioning. The satellite positioning unit 8a uses an antenna to receive radio waves emitted from a plurality of GPS satellites orbiting the earth. The position of the satellite positioning unit 8a is measured based on information in the radio waves received from navigation satellites.
In addition to the satellite positioning unit 8a, the machine body 1 is provided with an inertial measurement unit 8b having, for example, an IMU (Inertial Measurement Unit), as a heading detector to detect a heading of the machine body 1. The inertial measurement unit 8b may include a triaxial gyrosensor, a triaxial accelerometer, or the like. Although not illustrated, the inertial measurement unit 8b is provided in a low location at the center of the machine body 1 in a horizontal width direction, for example. The inertial measurement unit 8b can detect an angular velocity of a turning angle of the machine body 1, and can calculate a change in the azimuth of the machine body 1 by integrating the angular velocity. Accordingly, heading information of the machine body 1 is included in measurement information measured by the inertial measurement unit 8b. Although not described in detail, in addition to the angular velocity of the turning angle of the machine body 1, the inertial measurement unit 8b can also measure an angular velocity of a left-right tilt angle of the machine body 1, a front-back tilt angle of the machine body 1, and the like.
The control device 75 is configured or programmed to include a route setting unit 76, a heading deviation calculation unit 77, a travel trajectory obtainment unit 78, a control unit 79, and a maneuvering control unit 80. The route setting unit 76 sets a target travel route LM along which the machine body 1 is to travel (see
The trigger switch 49 is provided as an operating tool to set the target travel route LM used in the automatic maneuvering control (see
Information from the satellite positioning unit 8a, the inertial measurement unit 8b, the trigger switch 49 defining and functioning as an operating tool, a steering angle sensor 60 defining and functioning as a maneuvering operation detector, a torque sensor 61, a vehicle speed sensor 62, an obstruction detection unit 63, and the like is input to the control device 75. The vehicle speed sensor 62 is configured or programmed to be capable of detecting the vehicle speed from the rotational speed of a transmission shaft in a transmission mechanism for the rear wheels 12. Note that the vehicle speed may be detected not only by the vehicle speed sensor 62, but also using a positioning signal of the satellite positioning unit 8a. The obstruction detection unit 63 is provided on both a front portion and left and right side portions of the machine body 1, and is configured or programmed to be capable of detecting a ridge of the field, metal poles in the field, and so on using an electro-optical range-finding sensor, an image sensor, or the like, for example. When an obstruction is detected by the obstruction detection unit 63, an alert is issued to the occupant using an alerting unit 64, which uses a buzzer, audio guidance, or the like, for example. The control device 75 is also connected to a reporting unit 59, and the reporting unit 59 is configured or programmed to report on states such as the vehicle speed, the engine speed, and the like, for example. The reporting unit 59 is configured or programmed to be displayed on the display unit 4, for example. Furthermore, the alerting unit 64 may be configured or programmed to display the alert in the display unit 4 via the reporting unit 59. In this case, an alert that a ridge has been detected, for example, is displayed on the display unit 4. The alerting unit 64 may also be configured or programmed to be part of the reporting unit 59. The display unit 4 is configured or programmed to be capable of displaying, on a screen, a variety of information based on signal inputs from the reporting unit 59, the alerting unit 64, and the like. The display unit 4 is also configured or programmed to be capable of displaying various types of guidance information according to conditions of straight travel, conditions of turning travel, and the like of the machine body 1.
The heading deviation calculation unit 77 calculates an angular deviation between a detected heading of the machine body 1, detected by the satellite positioning unit 8a and the inertial measurement unit 8b, and a target heading LA in the target travel route LM, i.e., calculates the heading deviation. Then, when the control device 75 is set to the automatic maneuvering mode, the control unit 79 calculates and outputs an operation amount to control the steering motor 14 so as to reduce the angular deviation. In this manner, the maneuvering control unit 80 is configured or programmed to be capable of controlling the maneuvering of the machine body 1 so as to follow the target heading LA.
The travel trajectory obtainment unit 78 calculates a position of the machine body 1, i.e., a host vehicle position NM, based on the positioning signal measured by the satellite positioning unit 8a, the heading of the machine body 1 calculated by the heading deviation calculation unit 77, and the vehicle speed detected by the vehicle speed sensor 62. A storage unit 81 is configured or programmed to be capable of storing the host vehicle position NM as position information. The travel trajectory obtainment unit 78 stores the host vehicle position NM in the storage unit 81, which may be constituted by RAM (Random Access Memory), for example, as time passes. The travel trajectory obtainment unit 78 is also configured or programmed to be capable of obtaining a travel trajectory based on an aggregation of host vehicle positions NM stored in the storage unit 81. In sum, the travel trajectory obtainment unit 78 is configured or programmed to be capable of obtaining the travel trajectory of the machine body 1 based on the detection, over time, of the host vehicle position NM defining and functioning as position information.
The operation amount is calculated by the control unit 79 based on information on the heading deviation. The maneuvering control unit 80 executes the automatic maneuvering control based on the operation amount calculated by the control unit 79 during the automatic maneuvering control of the machine body 1. In other words, the steering motor 14 is operated such that the detection position of the machine body 1 as detected by the satellite positioning unit 8a and the inertial measurement unit 8b (the host vehicle position NM) is located on the target travel route LM.
In the present preferred embodiment, the control signal may be the operation amount output by the control unit 79, or may be a voltage value, a current value, or the like with which the maneuvering control unit 80 operates the steering motor 14.
A reference route setting unit 76A, a target heading calculation unit 76B, and a target travel route setting unit 76C are included in the route setting unit 76. As illustrated in
First, the reference route is generated. The occupant manually moves the machine body 1 to a ridge at one corner within the field. When the machine body 1 reaches the ridge at the corner, the occupant operates the trigger switch 49. The position at the time when the occupant operates the trigger switch 49 is registered as the start position Ts by the reference route setting unit 76A. After the registration of the start position Ts, the occupant performs manual operations to move the machine body 1 straight (or substantially straight) from the start position Ts along the ridge on one side of the field. During this period, the host vehicle position NM is calculated by the travel trajectory obtainment unit 78 as time passes and is stored in the storage unit 81. Then, after the machine body 1 has moved straight (or substantially straight) from one end to the other end of the ridge on the one side, the occupant stops the machine body 1 and operates the trigger switch 49 again. The position at the time when the occupant operates the trigger switch 49 again is registered as the end position Tf by the reference route setting unit 76A. The travel trajectory obtainment unit 78 obtains the travel trajectory based on an aggregate of the host vehicle positions NM between the start position Ts and the end position Tf, and the reference route setting unit 76A calculates the reference route between the start position Ts and the end position Tf based on that travel trajectory. When the machine body 1 travels along the target travel route LM, the direction which follows the reference route becomes the target heading LA.
Note that the travel of the machine body 1 from the start position Ts to the end position Tf may be work travel involving tilling work, or may be travel in a non-work state. When positional coordinates of the reference route are set, automatic maneuvering control can be performed in at least a portion of the reference route.
After the setting of the reference route is complete, the occupant moves the machine body 1 to the start position Ls in a target region for the first work travel in the field. In the preferred embodiment illustrated in
After this turning travel is complete, the manual maneuvering mode of the control device 75 is continued, and the occupant causes the machine body 1 to travel along the target heading LA through manual operations. During this period, the control device 75 confirms determination conditions for the heading deviation of the machine body 1 calculated by the heading deviation calculation unit 77, the direction of the front wheels 11, the steering angle of the steering wheel 16, and the like, and determines whether or not the state of the machine body 1 is a state suitable for the next tilling work. Whether or not the state of the machine body 1 is suitable for tilling work is determined, for example, using a position distanced from the pre-turning travel position by an integral multiple of a work width in a direction perpendicular or substantially perpendicular to the target heading LA as a reference position, and is determined based on whether or not travel misalignment with respect to the reference position in the left-right direction of the machine body 1 is within a permissible range. If the travel misalignment is outside of the permissible range, the occupant manually steers the machine body 1 so that the travel misalignment of the machine body 1 enters the permissible range.
The heading deviation of the machine body 1 with respect to the target heading LA being significantly high, the steering wheel 16 being repeatedly steered to the left and right so that the position of the steering wheel 16 fails to stabilize, the vehicle speed of the machine body 1 being too fast or too slow, and so on can be given as examples of states not suitable for tilling work. The detection accuracy of the position detection unit 8 being lower than a pre-set threshold can also be given as an example of a state not suitable for tilling work.
When the control device 75 determines that the state of the machine body 1 is a state suitable for the next tilling work, the automatic maneuvering control can be performed by operating the trigger switch 49. In other words, the target travel route LM1 is set by the target travel route setting unit 76C, and the work travel is started, in response to the occupant operating the trigger switch 49. When the work travel is started, the automatic maneuvering control is performed so that the machine body 1 travels along the target travel route LM1. The target travel route LM1 is a target travel route LM which is set to a heading that follows the target heading LA, and in which the machine body 1 performs the first work travel after the setting of the reference route. While the automatic maneuvering control is performed, automatic steering is performed through operations by the steering mechanism 13, and the vehicle speed of the machine body 1 is also automatically adjusted. Note, however, that the configuration may be such that the vehicle speed of the machine body 1 can be adjusted through human operations made by the occupant even while automatic maneuvering control is being performed.
When the automatic maneuvering control performed along the target travel route LM1 ends, the occupant continues manual steering until, through the above-described turning travel, the state of the machine body 1 becomes a state suitable for the next tilling work. If the trigger switch 49 is permitted to be operated, the occupant operates the trigger switch 49, and the target travel route setting unit 76C sets the target travel route LM2 for the next time to a heading following the target heading LA. Then, the automatic maneuvering control is performed so that the machine body travels along the target travel route LM2. Thereafter, the turning travel, the setting of the target travel route LM, and the work travel are repeated through the above-described process, in order of the target travel routes LM3, LM4, LM5, and LM6.
The display of guidance information pertaining to reference route generation will be described based on
If the position information of the machine body 1 is detected (step #01: Yes), guidance information for the start position Ts, such as that indicated by 6-A in
After the registration of the start position Ts, the occupant moves the machine body 1 forward through manual operations. Then, the reference route setting unit 76A determines whether or not the machine body 1 has traveled at least a pre-set distance by calculating the distance between the start position Ts and the host vehicle positions NM as time passes (step #06). If the travel distance of the machine body 1 has not reached the set distance (step #06: No), guidance information indicating that the travel distance has not reached the set distance is displayed on the display unit 4, even if the occupant operates the trigger switch 49. As the guidance information indicating that the travel distance has not reached the set distance, for example, a message reading “insufficient forward travel distance” is displayed, as indicated by 6-B in
While the machine body 1 is moving forward as a result of the manual operations, the reference route setting unit 76A determines whether or not the machine body 1 is turning (step #07). A change amount in the maneuvering operations based on operation of the steering wheel 16 is detected by the steering angle sensor 60. The configuration is such that the turning of the machine body 1 can be determined by detecting that the change amount in the maneuvering operations based on the detection by the steering angle sensor 60 has exceeded a pre-set range. Additionally, the heading deviation calculation unit 77 can calculate a turning heading of the machine body 1 based on a positioning signal from the satellite positioning unit 8a, an inertia signal from the inertial measurement unit 8b, or the like. Then, when the reference route setting unit 76A determines that the machine body 1 is turning (step #07: Yes), the registration of the start position Ts is canceled and the generation of the reference route is aborted (step #12). At this time, guidance information indicating that the generation of the reference route has been aborted, e.g., a message reading “a turn has been detected and the generation of the reference route will end. Please generate the reference route again”, is displayed on the display unit 4. In this manner, when, after the start position Ts (the start point A) has been set by operating the trigger switch as an operating tool, the change amount in the maneuvering operations is detected as having exceeded a pre-set amount without the trigger switch 49 being operated, the setting of the start position Ts is canceled.
If the travel distance of the machine body 1 has reached the set distance (step #06: Yes), guidance information for the end position Tf, such as that indicated by 6-C in
When the trigger switch 49 is operated (step #09: Yes), the reference route setting unit 76A registers the end position Tf (step #11). The reference route is generated, and the target heading LA is calculated, through the foregoing steps. In this manner, the reference route setting unit 76A sets the reference route based on the travel trajectory of the machine body 1. Additionally, the trigger switch 49 defining and functioning as the operating tool is configured or programmed to be capable of setting both the start position Ts (the start point A) and the end position Tf (the end point B) when setting the reference route.
While waiting for the trigger switch 49 to be operated (step #09: No), the reference route setting unit 76A determines whether or not the machine body 1 is turning through the same method as in step #07 (step #11). When it is determined that the machine body 1 is turning (step #11: Yes), as described above, the registration of the start position Ts is canceled and the generation of the reference route is aborted (step #12), and guidance information indicating that the generation of the reference route has been aborted is displayed on the display unit 4.
The display of guidance information in turning travel will be described based on
As illustrated in
The end determination unit 76E determines whether or not the automatic maneuvering control for traveling along the target travel route LM has ended (step #21). The end of the automatic maneuvering control is determined, for example, based on whether or not a PTO clutch lever (not shown), a pumper lever (not shown), or the like has been operated. When the end determination unit 76E determines that the automatic maneuvering control has ended (step #21: Yes), the host vehicle position NM at the point in time of the determination that the automatic maneuvering control has ended is stored in the storage unit 81 as the end position Lf (step #22). The end position Lf is used as work travel position information WP through which the start position calculation unit 76D calculates the start position Ls2 of the next work travel. Note that of the end positions Lf illustrated in
Information pertaining to the previous turning travel is stored in the storage unit 81. The start position calculation unit 76D is configured or programmed to be capable of determining whether the previous turning travel was a right turn or a left turn by reading out data pertaining to the turning travel from the storage unit 81. As illustrated in
In this manner, when the end determination unit 76E determines that the work travel has ended, the start position calculation unit 76D calculates the start position Ls2 on the right or the left of the travel direction of the machine body 1 in the work travel based on the work travel position information WP defining and functioning as position information, and the display unit 4 displays guidance information used to guide the turning travel to the start position Ls2. At this time, when the start position Ls has been calculated in one of the left- or right-side turn directions with respect to the travel direction in the previous turning travel, the start position calculation unit 76D calculates the start position Ls2 in the other of the left- or right-side turn directions relative to the travel direction in the current turning travel, and the display unit 4 displays the display line L2, based on the start position Ls2, further on the other of the left and right sides than the machine body 1 in the map screen.
After the guidance information has been displayed on the display unit 4 through the process of step #24-2 or step #25-2, the occupant turns the machine body 1 by operating the steering wheel 16. The control device 75 is configured or programmed so that the turn direction at this time can be determined by the steering angle sensor 60 defining and functioning as a maneuvering operation detector (step #24-3, step#25-3). Note that the determination of the turn direction is not limited to a determination made by the steering angle sensor 60, and may be, for example, a determination based on an aggregation of the position information of the machine body 1 measured by the satellite positioning unit 8a, a determination based on the heading information of the machine body 1 measured by the inertial measurement unit 8b, or the like. In other words, the maneuvering operation detector may be a configuration in which the maneuvering operations is detected by, for example, the satellite positioning unit 8a or the inertial measurement unit 8b detecting a turn.
If the actual turn direction of the machine body 1 differs from the guidance information displayed on the display unit 4, the guidance information displayed on the display unit 4 is changed to guidance information which corresponds to the actual turn direction of the machine body 1. When the actual turn direction of the machine body 1 is a left turn (step#24-3: left turn) in a state where guidance information for a right turn is displayed on the display unit 4 (step #24-2), the start position calculation unit 76D calculates the next start position Ls2 on the left turn side (step #24-4). Then, the guidance information in the display unit 4 is changed to guidance information for a left turn (step #24-5). On the other hand, when the actual turn direction of the machine body 1 is a right turn (step#25-3: right turn) in a state where guidance information for a left turn is displayed on the display unit 4 (step #25-2), the start position calculation unit 76D calculates the next start position Ls2 on the right turn side (step #25-4). Then, the guidance information in the display unit 4 is changed to guidance information for a right turn (step #25-5). In this manner, when, in turning travel, the steering wheel 16 (the maneuvering tool) is operated in the turn direction to the side opposite from the side on which the start position calculation unit 76D has calculated the start position Ls2, the start position calculation unit 76D re-calculates the start position Ls2 in the turn direction on the side toward which the steering wheel 16 has been operated, and the display unit 4 re-displays the start position Ls2 in the map screen, farther than the machine body 1 toward the side corresponding to the turn direction in which the steering wheel 16 has been operated.
Before describing step #26 and on, a method by which the start position calculation unit 76D calculates the start position Ls2 will be described. In the preferred embodiment illustrated in
In the preferred embodiment illustrated in
The end position Lf of the target travel route LM[n−1] is a position where the previous turning travel was started. The start position Ls of the target travel route LM[n] is a position where the previous turning travel ended. Furthermore, the end position Lf of the target travel route LM[n−1] and the start position Ls of the target travel route LM[n] are separated by the first separation distance P1. Based on this, the start position calculation unit 76D estimates that the next automatic maneuvering control will be performed at a position separated from the target travel route LM[n] in the horizontal direction (a direction orthogonal to the target heading LA; the same applies hereinafter) by the first separation distance P1. The start position calculation unit 76D then calculates the start position Ls2 for new work travel on a side opposite to where the target travel route LM[n−1] is located, in the horizontal direction, with respect to the work travel position information WP, the start position Ls2 for new work travel being separated from the work travel position information WP by the first separation distance P1 (step #25-1). A target travel route LM[n+1] illustrated in
Then, based on the process of step #25-2, guidance information for the right turn indicated by 8-B in
In this manner, the start position calculation unit 76D calculates the start position Ls2 based on the separation distance between the position where the previous turning travel started and the position where the previous turning travel ended, and the display unit 4 displays the start position Ls2, calculated based on the separation distance, in the guidance information.
As illustrated in
Descriptions of the flowchart in
While the machine body 1 is performing the turning travel, the control device 75 determines, based on the position information of the machine body 1 measured by the satellite positioning unit 8a, whether or not the machine body 1 is turning to move farther in the horizontal direction than the start position Ls2 of the next work travel (step #28).
A second separation distance P2, which is a separation distance between the work travel position information WP and the start position Ls2 of the new work travel, is indicated in
Additionally, when the start position calculation unit 76D has calculated the start position Ls2 of the new work travel, the guidance information for a right turn, indicated by 8-C in
While the machine body 1 is performing turning travel, it is determined whether or not the heading deviation, calculated by the heading deviation calculation unit 77 (see
In the determination in step #31, whether or not a distance, in the horizontal direction, between the work travel position information WP and the host vehicle positions NM calculated by the travel trajectory obtainment unit 78 is within the range of a reference distance that takes the work width of the work travel as a reference may be added as a determination item. In this case, aside from the work width of the work travel, a value which is an integral multiple of the work width may be used as the reference distance, or a value obtained by subtracting the aforementioned overlap amount from the value which is an integral multiple of the work width may be used as the reference distance.
Additionally, the distance recorded in the storage unit 81 in step #32 may be the actual distance between the work travel position information WP and the start position Ls2 of the next work travel, or may be a distance, among distances which are integral multiples of the reference distance which takes the work width of the work travel as a reference, that is close to the actual distance. In this manner, the distance stored in the storage unit 81 is, for example, the first separation distance P1, the second separation distance P2, or the like.
When the turning travel has been performed in such a manner that an unworked portion having a width equivalent to the work width of the tilling device 3 in the horizontal direction remains between the work travel position information WP and the start position Ls2 of the next work travel (see
In
The end position Lf of the target travel route LM[n−1] and the start position Ls of the target travel route LM[n] are separated by the second separation distance P2, and the second separation distance P2 has a distance of double (or substantially double but less than double) the work width of the tilling device 3. Based on this, in
In the preferred embodiment illustrated in
The display line L1 based on the work travel position information WP and the display line L2′ based on the start position Ls2 of the next work travel are displayed in the guidance information indicated by 10-B in
As described above, the guidance information for a right turn, indicated by 10-B in
In step #24-4 indicated in
After the above-described turning travel is complete, the manual maneuvering mode of the control device 75 is continued, and straight travel is continued based on human operation. During this period, the control device 75 confirms the determination conditions for heading deviation of the machine body 1 relative to the target heading LA, the direction of the front wheels 11, and the steering state of the steering wheel 16, and determines whether or not the state is one in which the mode can switch to the automatic maneuvering mode. Then, if the state is one in which the control device 75 can switch to the automatic maneuvering mode, the automatic maneuvering control is started in response to the occupant operating the trigger switch 49. Here, the occupant can, using the display unit 4, visually confirm whether or not the state is one in which the control device 75 can switch to the automatic maneuvering mode. At the same time, guidance information that assists the occupant in making the maneuvering operations is displayed on the display unit 4.
While the straight travel of the working machine based on human operations is continuing, a screen for the guidance information indicated by 13-A to 13-D in
The determination to start the automatic maneuvering control is made based on the flowchart illustrated in
While the machine body 1 is traveling straight in a direction following the target heading LA (step #41: straight), the counter Ctr is incremented (step #44), and the value of the counter Ctr increases. It is then determined whether or not the machine body 1 has traveled at least a set distance (step #45). Here, the “set distance” may be a pre-set distance from the start position Ls2 (see
If the machine body 1 has traveled at least the set distance (step #45: Yes), it is determined whether a change in the turning angle of the steering wheel 16 remains within a permissible range (step #46). A state in which the steering wheel 16 is moved neither in the direction of a right turn nor in the direction of a left turn, and the directions of the front wheels 11 and the rear wheels 12 are parallel or substantially parallel, can be given as an example of a turning angle of the steering wheel 16 for when automatic maneuvering control is permitted, but the state is not limited thereto. For example, if the travel area of the machine body 1 is a ground surface that slopes in the horizontal direction, there is a risk that if the machine body 1 simply continues traveling straight, the machine body 1 will gradually shift toward the lower ground in the left-right direction. In such a case, the direction of the front wheels 11 is kept steered toward the high ground in the left-right direction, and as a result, it is easier for the machine body 1 to advance along the target heading LA. Accordingly, the turning angle of the steering wheel 16 when the automatic maneuvering control is permitted also includes states in which the steering wheel 16 is steered in the directions of a right turn or a left turn, for example. In other words, the control device 75 is configured or programmed so that the automatic maneuvering control is permitted when the turning angle of the steering wheel 16 continues to be kept within a set range. If the change in the turning angle of the steering wheel 16 is not kept within the permissible range (step #46: No), the counter Ctr is reset to zero (step #47). Note that the configuration may be such that in the process of step #47, the value of the counter Ctr may be decremented to reduce the value of the counter Ctr rather than resetting the value of the counter Ctr to zero.
The guidance information indicated by 13-C in
The present invention is not limited to the configuration described as examples in the foregoing preferred embodiments, and examples of other representative preferred embodiments of the present invention will be given hereinafter.
In the foregoing preferred embodiments, the target heading calculation unit 76B is configured or programmed to be capable of setting the end position Tf through an operation of the trigger switch 49 after the start position Ts has been set by the trigger switch 49 being operated and after the machine body 1 has traveled a pre-set distance following the setting of the start position Ts, but the configuration is not limited to this preferred embodiment. For example, the configuration may be such that a travel trajectory is first obtained by the occupant causing the machine body 1 to travel for at least a set distance set in advance, and the occupant then sets the start position Ts and the end position Tf of the obtained travel trajectory. In other words, the trigger switch 49, which is a single operating tool, may be configured or programmed to be capable of setting both the start position Ts and the end position Tf of the travel trajectory obtained when calculating the target heading LA.
In the foregoing preferred embodiments, when the end position Tf can be set by operating the trigger switch 49, the display unit 4 displays an indication that the end position Tf can be set, but the configuration is not limited to these preferred embodiments. For example, a notification indicating that the end position Tf will be able to be set may be displayed in the display unit 4 before the end position Tf can be set by operating the trigger switch 49. This notification display may be, for example, a distance, a time, or the like until the end position Tf can be set.
In the foregoing preferred embodiments, when, after the start position Ts has been set by operating the trigger switch 49, the change amount in the maneuvering operations is detected as having exceeded a pre-set range without the trigger switch 49 being operated, the setting of the start position Ts is canceled, but the configuration is not limited to these preferred embodiments. For example, the configuration may be such that when a travel trajectory is first obtained by the occupant causing the machine body 1 to travel for at least a set distance set in advance, the occupant then selects an area of the travel trajectory excluding turning areas. In this case, the target heading LA is calculated based on the travel trajectory excluding the turning areas.
In the foregoing preferred embodiments, the maneuvering operations are performed by changing the direction of the front wheels 11, but the configuration may be such that the maneuvering operations are performed by changing the direction of the rear wheels 12. In sum, the maneuvering control unit 80 may have any configuration that enables maneuvering control of the travel apparatus along the target heading LA.
The satellite positioning unit 8a is provided in the machine body 1, which is the subject of the positioning, as the above-described position detection unit 8, but the configuration is not limited to one in which a positioning signal is received directly from a satellite positioning system. For example, the configuration may be such that base stations that receive positioning signals from satellites are provided in a plurality of locations around the work vehicle, and the position information of the traveling work machine is identified through network communication processing with the plurality of base stations. In sum, the position detection unit 8 may have any configuration capable of detecting the position information of the machine body 1 based on a positioning signal from a navigation satellite.
In the foregoing preferred embodiments, the travel trajectory obtainment unit 78 calculates the host vehicle position NM based on the positioning signal measured by the satellite positioning unit 8a, the heading of the machine body 1 calculated by the heading deviation calculation unit 77, and the vehicle speed detected by the vehicle speed sensor 62, but the configuration is not limited to these preferred embodiments. The travel trajectory obtainment unit 78 may be configured or programmed to calculate the host vehicle position NM and obtain the travel trajectory based on the positioning signal or the heading and vehicle speed of the machine body 1 (or a combination of these two). In sum, the travel trajectory obtainment unit 78 may have any configuration capable of obtaining the travel trajectory of the machine body 1 based on the detection, over time, of position information.
In the foregoing preferred embodiments, the trigger switch 49 defining and functioning as an operating tool is the dial switch 23, but the trigger switch 49 may be a pumper lever (not shown) for operating the tilling device 3, a PTO clutch (not shown), or the like, for example.
Although the target travel routes LM1 to LM6 illustrated as examples in
In the foregoing preferred embodiments, the steering wheel 16 is described as the maneuvering tool, but the maneuvering tool may be a swinging lever, a pair of buttons, or the like, for example.
Although a tractor is described as an example of the traveling work machine according to preferred embodiments of the present invention, in addition to a tractor, preferred embodiments of the present invention can also be applied in harvesters, rice transplanters, seeding machines, and the like.
Note that the configurations disclosed in the foregoing preferred embodiments (including the other preferred embodiments; the same applies hereinafter) can be applied in combination with configurations described in other preferred embodiments as long as doing so does not produce any conflicts. Additionally, the preferred embodiments disclosed in the present specification are examples. The present invention is not limited to these preferred embodiments, and can be modified as appropriate within a scope that does not deviate from the present invention.
Preferred embodiments of the present invention can be applied in traveling work machines in which a target heading can be calculated based on a travel trajectory and maneuvering of a machine body can be controlled to follow the target heading.
While preferred embodiments of the present invention have been described above, it is to be understood that variations and modifications will be apparent to those skilled in the art without departing from the scope and spirit of the present invention. The scope of the present invention, therefore, is to be determined solely by the following claims.
Number | Date | Country | Kind |
---|---|---|---|
2018-238891 | Dec 2018 | JP | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2019/047756 | 12/6/2019 | WO | 00 |