Agricultural machinery
Patent Information
- Application Number
- JP2020167989
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2020-10-02
- Publication Date
- 2025-03-14
- Estimated Expiration
- 2040-10-02
Smart Images

Figure 0007645625000001 
Figure 0007645625000002 
Figure 0007645625000003
Abstract
Description
[Technical field]
[0001] The present invention relates to an agricultural machine. [Background technology]
[0002] Patent Document 1 describes a rice transplanter capable of traveling in an automatic straight-line mode. Travel in the self-propelled straight-line mode is performed as follows. First, the operator operates the steering handle to make the rice transplanter travel straight, and the operator operates the registration switch at two points along the way. A teaching direction is calculated based on satellite positioning data at those two points. A linear target line parallel to the calculated teaching direction is generated. The steering unit is controlled so that the machine moves along the target line, and travel in the automatic straight-line mode (automatic steering travel) is performed.
[0003] If an abnormality in the positioning data is detected while the automatic steering driving is being performed, the operator will be notified, the automatic steering will be stopped (transition from automatic straight-ahead mode to manual mode), driving will be stopped, etc. [Prior art documents] [Patent documents]
[0004] [Patent Document 1] JP 2017-136015 A Summary of the Invention [Problem to be solved by the invention]
[0005] In the case of travelling for work in a field, straight travel from one end of the field to the other end is repeated. According to the rice transplanter of Patent Document 1, straight travel can be performed by automatic steering, so that manual steering by the operator is not required and the workload is reduced. If automatic steering travel is interrupted during straight travel due to an abnormality, it is preferable to be able to start automatic steering travel along the same teaching direction or target line, as this further reduces the workload. The rice transplanter of Patent Document 1 does not take into consideration resumption of automatic steering travel after interruption.
[0006] An object of the present invention is to provide an agricultural machine that can reduce the work burden associated with automatic steering travel. [Means for solving the problem]
[0007] As a means for solving the above-mentioned problems, the agricultural machine of the present invention has an engine, a traveling control unit that controls the traveling of a machine body having a traveling device, An agricultural machine comprising: A mode switching unit switches the control mode of the driving control unit between a first mode in which automatic steering driving using a reference orientation and manual steering driving for calculating the reference orientation can be performed, and a second mode in which the automatic steering driving is not performed and the driving device is stopped; a storage unit stores orientation-related information which is information regarding the reference orientation when the control mode of the driving control unit is in the first mode; an A point registration button and a B point registration button which can receive manual operation; and a button which receives manual operation to the A point registration button. a reference orientation calculation unit that stores in the memory unit a position of the vehicle at the time when the vehicle is stopped as a point A coordinate and stores in the memory unit a position of the vehicle at the time when the vehicle is stopped as a point B coordinate, and calculates the reference orientation based on the point A coordinate and the point B coordinate and stores the reference orientation in the memory unit; wherein the mode switching unit switches the control mode of the travel control unit from the first mode to the second mode in response to the engine being stopped while waiting for a manual operation of the point B registration button after storing the point A coordinate, Starting up or shutting down the farm machine The present invention is characterized in that, in response to a start key being turned ON, the mode is switched from the second mode to the first mode, and the reference orientation calculation unit again waits for manual operation of the B point registration button, the position of the aircraft at the time when the manual operation of the B point registration button is accepted is stored in the memory unit as the B point coordinate, the reference orientation is calculated based on the A point coordinate and the B point coordinate and stored in the memory unit, and the driving control unit can perform automatic steering driving using the reference orientation stored in the memory unit.
[0008] According to this configuration, orientation-related information, which is information regarding the reference orientation when the control mode of the driving control unit is in the first mode, is stored in the memory unit, and when the control mode of the driving control unit becomes the first mode again, automatic steering driving can be performed using the orientation-related information, thereby eliminating the need for tasks such as regenerating the reference orientation, and making it possible to reduce the workload when resuming automatic steering driving.
[0009] In the present invention, it is preferable that, when the driving control unit is performing the automatic steering driving, the mode switching unit switches the control mode of the driving control unit from the first mode to the second mode in response to the engine being stopped, and further switches from the second mode to the first mode in response to the start key being turned ON, so that when the driving control unit is switched to the first mode in response to the start key being turned ON, the automatic steering driving is performed using the reference orientation that was used before the engine was stopped.
[0010]
[0011] In the present invention, the vehicle further includes an automatic steering control unit and an automatic steering button capable of accepting manual operation, and the automatic steering control unit, in response to accepting manual operation of the automatic steering button from the automatic steering button, determines a driving line that passes through a reference point of the aircraft at that time and is in a direction along the reference orientation as an automatic steering target line, It is preferable that, when in the first mode, the traveling control unit causes the aircraft to travel along the automatic steering target line.
[0012]
[0013]
[0014] According to this configuration, if a manual operation is performed to perform automatic steering again after the mode is switched when automatic steering driving is not being performed (for example, after automatic steering driving has ended), automatic steering driving can be performed using the direction-related information stored in the memory unit, thereby further improving the convenience of the agricultural machinery.
[0015]
[0016] According to this configuration, in an agricultural machine that switches to the second mode in which automatic steering travel is not performed when a predetermined switching condition is satisfied, it is possible to reduce the work burden when automatic steering travel is resumed, which is preferable.
[0017]
[0018] According to this configuration, in an agricultural work machine that switches to a second mode in which automatic steering travel is not performed when the engine is stopped, it is possible to reduce the work burden when automatic steering travel is resumed, which is preferable.
[0019]
[0020] According to this configuration, in an agricultural work machine that switches to the second mode in which automatic steering travel is not performed when the work implement stops, it is possible to reduce the work burden when automatic steering travel is resumed, which is preferable. [Brief description of the drawings]
[0021] [Figure 1] FIG. [Diagram 2] FIG. 2 is a block diagram showing a configuration relating to control. [Diagram 3] 1 is a flowchart of a startup routine. [Figure 4] 3 is a flowchart of a main routine. [Diagram 5] 4 is a flowchart of a reference direction acquisition routine. [Figure 6] 4 is a flowchart of an automatic steering start routine. [Figure 7] 4 is a flowchart of an automatic steering end routine. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0022] Hereinafter, a conventional combine harvester, which is an embodiment of an agricultural machine according to the present invention, will be described with reference to the drawings. Note that the present invention is not limited to the following embodiment, and various modifications are possible without departing from the gist of the present invention.
[0023] In the following description, unless otherwise specified, the direction of arrow F in FIG. 1 is the "front", the direction of arrow B is the "rear", the direction of arrow U is the "up", and the direction of arrow D is the "down".
[0024] [Overall configuration of the combine] 1, a normal combine harvester 1 (corresponding to the "farm working machine" according to the present invention) is equipped with a machine body 10, a reaping unit H (an example of a working device), a threshing device 13, a grain tank 14, a conveying unit 16, a grain discharge device 18, and a satellite positioning module 80. The machine body 10 also has a crawler-type traveling device 11, a driving unit 12, and an engine EG.
[0025] The traveling device 11 is provided at the bottom of the combine harvester 1. The traveling device 11 is driven by power from the engine EG. The combine harvester 1 can be self-propelled by the traveling device 11.
[0026] The driving section 12, the threshing device 13, and the grain tank 14 are provided on the upper side of the traveling device 11. An operator who monitors the operation of the combine harvester 1 can ride on the driving section 12.
[0027] The grain discharge device 18 is provided on the upper side of the grain tank 14. In addition, a satellite positioning module 80 is attached to the upper surface of the driving unit 12.
[0028] The reaping unit H is provided at the front of the combine harvester 1. The transport unit 16 is provided at the rear of the reaping unit H. The reaping unit H also includes a cutting blade 15 and a reel 17.
[0029] The cutting blade 15 cuts the planted culms in the field. The reel 17 rakes in the planted culms to be harvested while rotating around a reel axis 17b that runs along the left-right direction of the machine body. The cut culms cut by the cutting blade 15 are sent to the conveying section 16.
[0030] With this configuration, the reaping unit H harvests grains in the field. The combine harvester 1 is capable of reaping travel, traveling on the traveling device 11 while reaping planted culms in the field with the cutting blade 15.
[0031] The reaped stalks harvested by the reaping section H are transported to the rear of the machine body by the transport section 16. As a result, the reaped stalks are transported to the threshing device 13.
[0032] The harvested stalks are threshed in the threshing device 13. The grains obtained by the threshing process are stored in a grain tank 14. The grains stored in the grain tank 14 are discharged outside the machine by a grain discharge device 18 as necessary.
[0033] That is, the combine 1 is equipped with a grain tank 14 that stores grain harvested by the reaping section H.
[0034] As shown in FIG. 1 , a display input device 4 (an example of an input device) is disposed in the driving unit 12. The display input device 4 is configured to be capable of displaying various information and to be capable of receiving manual operations. The display input device 4 is, for example, a touch panel type liquid crystal display device. In this embodiment, the display input device 4 is fixed to the driving unit 12. However, the present invention is not limited to this, and the display input device 4 may be configured to be detachable from the driving unit 12, or the display input device 4 may be located outside the combine harvester 1.
[0035] Here, the combine harvester 1 is configured to be capable of manual steering travel and automatic steering travel. Manual steering travel means travel by manual steering by an operator. Automatic steering travel means automatic forward travel. Particularly in this embodiment, automatic steering travel means automatic forward travel without a large change of direction such as an α-turn or a U-turn.
[0036] The driving section 12 is also provided with a main speed change lever 19. When the combine harvester 1 is running under manual steering or automatic steering, the speed of the combine harvester 1 changes when the operator operates the main speed change lever 19. In other words, when the combine harvester 1 is running under manual steering or automatic steering, the operator can change the speed of the combine harvester 1 by operating the main speed change lever 19.
[0037] The driving section 12 is also provided with a steering operation device 41. When the combine harvester 1 is traveling with manual steering, if the operator operates the steering operation device 41, a speed difference is generated between the left and right crawlers of the traveling device 11. This causes the combine harvester 1 to turn. In other words, when the combine harvester 1 is traveling with manual steering, the operator can steer the combine harvester 1 by operating the steering operation device 41.
[0038] That is, the combine harvester 1 is provided with a steering operation device 41 for steering.
[0039] The combine harvester 1 is configured so that the operating force on the steering operation tool 41 is not transmitted to the traveling device 11. In other words, the steering operation tool 41 is not mechanically linked to the traveling device 11. When the operator operates the steering operation tool 41, the movement of the steering operation tool 41 is electrically detected, and the left and right crawlers of the traveling device 11 are controlled based on this detection. As a result, when a speed difference occurs between the left and right crawlers, the combine harvester 1 turns. When there is no speed difference between the left and right crawlers, the combine harvester 1 moves straight.
[0040] [Configuration regarding power transmission] 2, the combine harvester 1 includes a threshing clutch C1 and a reaping clutch C2. Power output from the engine EG is distributed to the traveling device 11 and the threshing clutch C1.
[0041] The traveling device 11 has a main transmission 11a and an auxiliary transmission 11b. In this embodiment, the main transmission 11a is configured by a hydrostatic continuously variable transmission. The auxiliary transmission 11b is configured by a gear-switching type transmission, and is configured to be switchable between a high-speed state and a low-speed state. The high-speed state is a speed-changing state for travel (non-work), and the low-speed state is a speed-changing state for work.
[0042] The power input from the engine EG to the traveling device 11 is changed in speed by the main transmission 11a and the sub-transmission 11b. Then, the crawlers of the traveling device 11 are driven by the changed-speed power, causing the combine 1 to travel.
[0043] The main speed change lever 19 is configured to be pivotable in the front-rear direction. The movable range of the main speed change lever 19 is divided into three positions: a forward operating position, a neutral position, and a reverse operating position. Operation of the main speed change lever 19 changes the speed change state of the main transmission 11a.
[0044] When the main speed change lever 19 is in the forward operating position, the main speed change device 11a is in a forward speed change state. In this state, the more the main speed change lever 19 is tilted forward, the higher the speed of the power output from the main speed change device 11a becomes.
[0045] When the main speed change lever 19 is in the neutral position, the main speed change device 11a is in a neutral state. At this time, the main speed change device 11a does not output power.
[0046] When the main speed change lever 19 is in the reverse operating position, the main speed change device 11a is in a reverse speed change state. At this time, the more the main speed change lever 19 is tilted rearward, the higher the speed of the power output from the main speed change device 11a becomes.
[0047] Further, an auxiliary speed change switch 42 (FIG. 2) is provided on the main speed change lever 19. Every time the auxiliary speed change switch 42 is pressed, the speed change state of the auxiliary speed change device 11b is switched between a high speed state and a low speed state.
[0048] The threshing clutch C1 shown in FIG. 2 is configured to be changeable between an ON state in which power is transmitted and an OFF state in which power is not transmitted.
[0049] When the threshing clutch C1 is engaged, power from the engine EG is transmitted to the threshing device 13 and the reaping clutch C2. This drives the threshing device 13.
[0050] When the threshing clutch C1 is in the disengaged state, the power from the engine EG is not transmitted to either the threshing device 13 or the reaping clutch C2. At this time, the threshing device 13 does not drive.
[0051] The mowing clutch C2 is configured to be able to change its state between an ON state in which power is transmitted and an OFF state in which power is not transmitted.
[0052] When both the threshing clutch C1 and the reaping clutch C2 are engaged, power from the engine EG is transmitted to the reaping unit H. As a result, the reaping unit H is driven.
[0053] Furthermore, when the mowing clutch C2 is in the disengaged state, the power from the engine EG is not transmitted to the mowing unit H. At this time, the mowing unit H does not drive.
[0054] Furthermore, when the threshing clutch C1 is in the disengaged state, the power from the engine EG is not transmitted to the reaping unit H. At this time, the reaping unit H does not drive.
[0055] As shown in Fig. 2, the combine harvester 1 is equipped with a reaping / threshing lever 43. The reaping / threshing lever 43 is provided on the driving section 12. The reaping / threshing lever 43 is configured to be operable to swing back and forth. The reaping / threshing lever 43 is configured to be capable of selectively switching the operating position among a first operating position, a second operating position, and a third operating position. By operating the reaping / threshing lever 43, the on / off states of the threshing clutch C1 and the reaping clutch C2 change.
[0056] When the operating position of the reaping / threshing lever 43 is the first operating position, the threshing clutch C1 and the reaping clutch C2 are both in the engaged state.
[0057] When the operating position of the reaping / threshing lever 43 is the second operating position, the threshing clutch C1 is in an on state, and the reaping clutch C2 is in a off state.
[0058] When the operating position of the reaping / threshing lever 43 is the third operating position, the threshing clutch C1 and the reaping clutch C2 are both in a disengaged state.
[0059] As shown in Fig. 2, the combine harvester 1 is provided with a steering operation device 41. The steering operation device 41 is configured to be swingable in the left and right direction.
[0060] A configuration relating to control of the combine harvester 1 will be described below with reference to the block diagram of Fig. 2. The control device CU of the combine harvester 1 includes a control unit CS and a memory device ME.
[0061] In detail, the control unit CU is a so-called ECU, and includes a memory (such as a HDD or non-volatile RAM, not shown) that stores programs corresponding to the functional units, and a CPU (not shown) that executes the programs. The functions of the functional units are realized by the programs being executed by the CPU.
[0062] The control unit CS includes a vehicle position calculation unit 21, a driving control unit 24, a vehicle direction calculation unit 25, a mode switching unit 26, a reference direction calculation unit 27, an automatic steering control unit 28, and a driving route calculation unit 29.
[0063] The memory device ME includes a status flag memory unit 51 and a direction-related information memory unit 52 (an example of a memory unit). The status flag memory unit 51 and the direction-related information memory unit 52 are provided in an element or area (e.g., non-volatile RAM) that retains memory even when the power supply to the control device CU in the memory device ME is cut off.
[0064] The status flag storage unit 51 stores an automatic steering in progress flag and a point B waiting flag. The automatic steering in progress flag and the point B waiting flag each take two values, ON and OFF.
[0065] The direction related information storage unit 52 stores direction related information, which is information about the reference direction when the control mode of the cruise control unit 24 is the first mode.
[0066] Here, in this embodiment, RTK-GPS (Real Time Kinematic GPS) is adopted. A satellite positioning module 80 shown in Fig. 1 receives GPS signals from an artificial satellite GS used in GPS (Global Positioning System) and positioning data transmitted from a reference station (not shown) installed at a known position. Then, as shown in Fig. 2, the satellite positioning module 80 sends the positioning data based on the received GPS signal and the positioning data received from the reference station to the vehicle position calculation unit 21.
[0067] The vehicle position calculation unit 21 calculates the position coordinates of the combine 1 over time based on the positioning data received from the satellite positioning module 80. The calculated position coordinates of the combine 1 over time are sent to the travel control unit 24.
[0068] Generally, in RTK-GPS positioning, the distance between a GPS satellite and a GPS receiver is defined as N×λ+φ×λ+c×dT+c×dt, and N, called the integer bias, is calculated. This enables highly accurate positioning. Here, λ is the wavelength of the carrier wave. Also, φ is the decimal part of the wave number between the GPS satellite and the GPS receiver. Also, c is the radio wave propagation speed, dT is the clock error of the GPS satellite, and dt is the clock error of the GPS receiver.
[0069] The state where N is determined as an integer solution is called FIX, and the positioning result at this time is called a FIX solution.
[0070] Also, when N is not determined as an integer solution, it is called FLOAT. The positioning result at this time is called a FLOAT solution. While a FIX solution has centimeter accuracy, a FLOAT solution has an accuracy of several tens of centimeters to a few meters.
[0071] Hereinafter, in the RTK-GPS positioning by the satellite positioning module 80 and the vehicle position calculation unit 21, a state in which a FIX solution has been obtained may be referred to as a "high accuracy state."
[0072] The satellite positioning module 80 does not have to use GPS. For example, the satellite positioning module 80 may use GNSS (GLONASS, Galileo, Michibiki, BeiDou, etc.) other than GPS.
[0073] 2, the combine harvester 1 includes an inertial measurement device 81. The control unit CS includes a vehicle orientation calculation unit 25.
[0074] The inertial measurement unit 81 detects the angular velocity of the yaw angle of the aircraft 10 and the acceleration in three mutually orthogonal axial directions over time. The detection results by the inertial measurement unit 81 are sent to the vehicle orientation calculation unit 25.
[0075] The vehicle orientation calculation unit 25 receives the position coordinates of the combine 1 from the vehicle position calculation unit 21. Then, the vehicle orientation calculation unit 25 calculates the attitude orientation of the combine 1 based on the detection result by the inertial measurement device 81 and the position coordinates of the combine 1.
[0076] More specifically, first, while the combine harvester 1 is traveling, the vehicle orientation calculation unit 25 calculates the initial attitude orientation based on the current position coordinates of the combine harvester 1 and the position coordinates of the combine harvester 1 at the point where it was traveling immediately before. Next, when the combine harvester 1 travels for a certain period of time after the initial attitude orientation is calculated, the vehicle orientation calculation unit 25 calculates the amount of change in the attitude orientation by integrating the angular velocity detected by the inertial measurement unit 81 during the certain period of travel.
[0077] Then, the vehicle orientation calculation unit 25 updates the calculation result of the attitude orientation by adding the amount of change in the attitude orientation thus calculated to the initial attitude orientation. After that, the amount of change in the attitude orientation is similarly calculated at regular time intervals, and the calculation result of the attitude orientation is successively updated.
[0078] Incidentally, the angular velocity detected by the inertial measurement unit 81 contains a measurement error (drift). This measurement error increases over time, so every time the amount of change in attitude and orientation is calculated, the error contained in the calculated amount of change in attitude and orientation becomes larger.
[0079] Therefore, the vehicle orientation calculation unit 25 is configured to correct the attitude orientation calculated based on the detection result by the inertial measurement device 81 with orientation information calculated based on the change in the position coordinates of the combine harvester 1. The orientation information calculated based on the change in the position coordinates of the combine harvester 1 is highly accurate when a FIX solution is obtained in the RTK-GPS positioning by the satellite positioning module 80 and the vehicle position calculation unit 21 and the combine harvester 1 moves straight for several meters or more. Therefore, the vehicle orientation calculation unit 25 performs correction using the orientation information calculated based on the change in the position coordinates of the combine harvester 1 only when a FIX solution is obtained in the RTK-GPS positioning by the satellite positioning module 80 and the vehicle position calculation unit 21 and the combine harvester 1 moves straight for several meters or more.
[0080] In this specification, a state in which a FIX solution has been obtained in RTK-GPS positioning by the satellite positioning module 80 and the vehicle position calculation unit 21, and the combine 1 has moved straight for more than several meters, and a state in which highly accurate orientation information is calculated based on changes in the position coordinates of the combine 1, may be described as a high-precision orientation calculation state.
[0081] With the configuration described above, the vehicle orientation calculation unit 25 can highly accurately calculate the attitude and orientation of the combine harvester 1. The attitude and orientation of the combine harvester 1 calculated by the vehicle orientation calculation unit 25 is sent to the travel control unit 24.
[0082] The traveling control unit 24 is configured to be able to control the traveling device 11. The traveling control unit 24 controls the traveling device 11, thereby controlling the traveling of the machine body 10.
[0083] That is, the combine harvester 1 is equipped with a travel control unit 24 that controls the travel of the machine body 10 having the travel device 11.
[0084] [Configuration regarding lifting and lowering operation of the reaping unit] As shown in Fig. 1, the combine harvester 1 is provided with a reaping cylinder 15A. Also, as shown in Fig. 2, the combine harvester 1 is provided with a reaping lifting operation tool 44.
[0085] The reaping lifting operation tool 44 is provided in the driving unit 12. The control unit CS is configured to control the extension and retraction of the reaping cylinder 15A in response to the operation of the reaping lifting operation tool 44 by the operator.
[0086] When the reaping cylinder 15A extends, the conveying part 16 and the reaping part H swing together in a direction in which the reaping part H rises. As a result, the reaping part H rises relative to the machine body 10.
[0087] Furthermore, when the reaping cylinder 15A is contracted, the conveying part 16 and the reaping part H are integrally swung in a direction in which the reaping part H descends. As a result, the reaping part H descends relative to the machine body 10.
[0088] With this configuration, the operator can lift and lower the reaping unit H by operating the reaping lifting operation tool 44.
[0089] [Configuration related to automatic steering driving] The mode switching unit 26 switches the control mode of the driving control unit 24 between an automatic steering mode (an example of a first mode) in which automatic steering driving can be performed using a reference heading, and a non-automatic steering mode (a second mode) in which automatic steering driving is not performed. In the automatic steering mode, manual steering driving for setting a reference heading, preliminary manual steering driving before starting automatic steering driving, starting and ending automatic steering driving based on an operator's operation, automatically starting and ending automatic steering driving, turning driving by manual steering between automatic steering driving and automatic steering driving, and the like are performed.
[0090] The automatic steering traveling will be described in detail below. The automatic steering traveling is a traveling in which an automatic steering target line is generated and determined based on a set reference heading, and the aircraft 10 is automatically steered along the determined automatic steering target line. Prior to automatic steering, the reference heading is set.
[0091] When setting the reference orientation (reference orientation acquisition routine described later), a button labeled "Register A Point" (hereinafter referred to as the "Register A Point Button") is displayed on the screen of the display input device 4. When the operator touches the Register A Point Button, a predetermined signal is sent to the reference orientation calculation unit 27. In response to receiving the signal, the reference orientation calculation unit 27 calculates the position coordinates of the combine harvester 1 at the time the Register A Point Button was touched based on the time-series position coordinates of the combine harvester 1 received from the vehicle position calculation unit 21. Hereinafter, the position coordinates are referred to as the "Point A coordinates," and the position corresponding to the Point A coordinates is simply referred to as the "Point A." The position coordinates calculated at this time (Point A coordinates) are stored in the orientation related information storage unit 52 as orientation related information.
[0092] When the combine harvester 1 is manually steered and moves a predetermined distance away from point A, a button marked "register point B" (hereinafter referred to as the "register point B button") appears on the screen of the display input device 4. When the operator touches the register point B button, a predetermined signal is sent to the reference orientation calculation unit 27. In response to receiving the signal, the reference orientation calculation unit 27 calculates the position coordinates of the combine harvester 1 at the time the register point B button was touched based on the time-dependent position coordinates of the combine harvester 1 received from the vehicle position calculation unit 21. Hereinafter, the position coordinates are referred to as "point B coordinates," and the position corresponding to the point B coordinates is simply referred to as "point B." The position coordinates calculated at this time (point B coordinates) are stored in the orientation related information storage unit 52 as orientation related information.
[0093] Then, the reference direction calculation unit 27 determines a reference direction for automatic steering based on the coordinates of point A and point B. More specifically, the reference direction calculation unit 27 calculates the direction of a straight line from point A to point B, and determines this direction as the reference direction. The determined reference direction is stored in the direction related information storage unit 52 as direction related information.
[0094] The format of the reference direction is not particularly limited, but may be, for example, a format based on north, south, east and west (for example, "north" or "27 degrees east of north"), or may be a unit vector in a coordinate system.
[0095] Furthermore, the reference direction does not have to have a direction from one side to the other. For example, the reference direction may indicate the inclination of a line in a coordinate system (e.g., the inclination of a line passing through points A and B), may indicate the line itself in a coordinate system (e.g., the line itself passing through points A and B), or may indicate a direction based on north, south, east, west, etc. (e.g., the "north-south direction" or the "east-west direction").
[0096] After the reference orientation calculation unit 27 calculates the reference orientation, the travel path calculation unit 29 constantly calculates a travel line that passes through the center of the mowing width of the mowing unit H and is aligned with the reference orientation. That is, this travel line is calculated based on the reference orientation.
[0097] Then, when the conditions for starting automatic steering (described later) are met, the automatic steering button becomes operable. When the automatic steering button is operated by the operator, a predetermined signal is sent to the automatic steering control unit 28. In response to receiving the signal, the automatic steering control unit 28 fixes the driving line that was calculated at that time. The fixed driving line becomes the automatic steering target line, and is sent from the automatic steering control unit 28 to the driving control unit 24.
[0098] The travel control unit 24 controls the travel of the combine harvester 1 based on the position coordinates of the combine harvester 1 received from the vehicle position calculation unit 21, the attitude direction of the combine harvester 1 received from the vehicle direction calculation unit 25, and the automatic steering target line received from the automatic steering control unit 28. More specifically, the travel control unit 24 controls the travel of the machine body 10 so that the combine harvester 1 travels by automatic steering along the automatic steering target line.
[0099] The travel control unit 24 may be configured to control the travel of the machine 10 based on a reference orientation instead of the automatic steering target line. In this case, the travel control unit 24 may be configured to control the travel of the machine 10 so that the attitude orientation of the combine 1 matches the reference orientation or is parallel to the reference orientation.
[0100] [Control Routine] In the combine harvester 1, the control unit CS of the control device CU executes a start-up routine (FIG. 3), a main routine (FIG. 4), a reference direction acquisition routine (FIG. 5), an automatic steering start routine (FIG. 6), and an automatic steering end routine (FIG. 7). These will be described in order below with reference to the flowcharts of FIGS. 4-7.
[0101] [Startup routine] The control unit CS continuously monitors the operation of a start key (not shown) of the combine harvester 1 (S101: No).
[0102] When the start key is turned ON (S101: Yes), the control unit CS acquires the value of the automatic steering in progress flag stored in the status flag storage unit 51 (S102).
[0103] If the automatic steering in progress flag is ON (S102: Yes), the control unit CS displays the character string "Do you want to continue the suspended automatic steering?", a Yes button, and a No button on the screen of the display input device 4 (S103).
[0104] Then, the control unit CS changes the value of the automatic steering in progress flag to OFF, and stores the value in the status flag storage unit 51 (S104).
[0105] The control unit CS monitors the operation input to the display input device 4 (S105). When the Yes button is touched, that is, when an operation input to continue automatic steering is performed (S105: Yes), the mode switching unit 26 switches the driving control unit 24 from the non-automatic steering mode to the automatic steering mode (S106).
[0106] The automatic steering control unit 28 reads out the reference direction used in the previous automatic steering traveling from the direction related information storage unit 52, and sets it as the reference direction to be used in the next automatic steering traveling (S107). Then, the control unit CS starts S408 of the automatic steering start routine (FIG. 6).
[0107] When the automatic steering in progress flag is OFF (S102: OFF), the control unit CS acquires the value of the point B waiting flag stored in the status flag storage unit 51 (S108).
[0108] If the value of the B point waiting flag is ON (S108: ON), the control unit CS displays the text "Do you want to continue the suspended B point registration?", a Yes button, and a No button on the screen of the display input device 4 (S109).
[0109] Then, the control unit CS changes the value of the point B waiting flag to OFF, and stores it in the status flag storage unit 51 (S110).
[0110] The control unit CS monitors the operation input to the display input device 4 (S111). When the Yes button is touched, that is, when an operation input to continue the B point registration is performed (S111: Yes), the mode switching unit 26 switches the driving control unit 24 from the non-automatic steering mode to the automatic steering mode (S112).
[0111] The automatic steering control unit 28 reads out the coordinates of point A registered in the interrupted reference direction acquisition routine from the direction related information storage unit 52 (S113). Then, the control unit CS starts S304 of the reference direction acquisition routine (FIG. 5).
[0112] When the No button is touched in S105, i.e., when an operation input is made to discontinue automatic steering (S105: No), when the B point waiting flag is OFF (S108: OFF), and when the No button is touched in S111, i.e., when an operation input is made to discontinue B point registration (S111: No), the control unit CS starts the main routine.
[0113] [Main routine] The control unit CS waits for an operation input for switching to the automatic steering mode (S201: No). For example, the control unit CS displays a button with the words "keep straight" (hereinafter referred to as the "keep straight button") on the screen of the display input device 4, and waits for a touch operation on the button. When the keep straight button is touched, that is, when an operation input for switching to the automatic steering mode is performed (S201: Yes), the mode switching unit 26 switches the driving control unit 24 from the non-automatic steering mode to the automatic steering mode (S202).
[0114] The automatic steering control unit 28 refers to the direction-related information stored in the direction-related information memory unit 52 and determines whether or not there is direction-related information (reference direction, point A coordinates, point B coordinates) used in automatic steering driving in the previous automatic steering mode (whether or not it is stored in the direction-related information memory unit 52) (S203).
[0115] If there is previous direction-related information (S203: Yes), the automatic steering control unit 28 determines whether the same base station is grounded in the field as when the direction-related information was generated (when the point A coordinates and B coordinates were obtained, and when the reference direction was generated using them) (S204).
[0116] If the same base station is present (S204: Yes), the automatic steering control unit 28 displays a button marked "Previous A / B" (hereinafter referred to as "Previous AB button") on the screen of the display input device 4 (S205).
[0117] If there is no same base station (S204: No), the automatic steering control unit 28 displays a button marked "Previous Reference" (hereinafter referred to as "Previous Reference button") on the screen of the display input device 4 (S206).
[0118] After S205 is completed, after S206 is completed, and if there is no previous direction-related information (S203: Yes), the automatic steering control unit 28 displays a button labeled "Register Point A" (hereinafter referred to as the "Register Point A button") on the screen of the display input device 4 (S207).
[0119] The automatic steering control unit 28 monitors the operation input to the display input device 4 (S208: No, S209: No, S211: No).
[0120] If the point A registration button is touched (S208: Yes), the control unit CS starts the reference direction acquisition routine (FIG. 5).
[0121] If the previous reference button is touched (S209: Yes), the automatic steering control unit 28 reads out the previous reference direction (reference direction related information) from the direction related information memory unit 52 and sets it as the reference direction to be used for the next automatic steering driving (S210).
[0122] If the AB button was touched last time (S211: Yes), the reference orientation calculation unit 27 reads out the previous coordinates of point A and point B (reference orientation related information) from the orientation related information storage unit 52, and calculates the reference orientation based on the read coordinates of point A and point B (S212). The automatic steering control unit 28 sets the calculated reference orientation as the reference orientation to be used for the next automatic steering travel.
[0123] After the completion of S210 and after the completion of S212, the control unit CS starts the automatic steering start routine (FIG. 6).
[0124] [Reference direction acquisition routine] The reference orientation calculation unit 27 calculates the vehicle position of the combine harvester 1 at the time when the A point registration button is touched (S208 of the main routine) based on the time-dependent position coordinates of the combine harvester 1 received from the vehicle position calculation unit 21 (S301).
[0125] The reference direction calculation unit 27 stores the position coordinates calculated in S301 as point A coordinates (direction related information) in the direction related information storage unit 52 (S302).
[0126] The reference direction calculation unit 27 changes the point B waiting flag to ON, and stores it in the status flag storage unit 51 (S303).
[0127] The automatic steering control unit 28 displays the position of point A on the screen of the display input device 4 (S304), and displays the travel path of the combine harvester 1 on the screen of the display input device 4 as the combine harvester 1 travels (S305).
[0128] The reference orientation calculation unit 27 judges whether or not the point B can be registered (S306). The point B can be registered when the combine harvester 1 is away from the point A by a predetermined distance or more (for example, 5 m). The condition for the point B can be registered is not limited to this. For example, the condition may be that a FIX solution has been obtained in the RTK-GPS positioning by the satellite positioning module 80 and the vehicle position calculation unit 21.
[0129] If point B registration is not possible (S306: No), steps S304 and S305 are executed again.
[0130] If point B registration is possible (S306: Yes), the automatic steering control unit 28 displays a button labeled "Point B Registration" (hereinafter referred to as the "Point B Registration button") on the screen of the display input device 4 (S307), and waits for the point B registration button to be touched (S308: No).
[0131] If the point B registration button is touched (S308: Yes), the reference orientation calculation unit 27 calculates the vehicle position of the combine harvester 1 at the time the point B registration button is touched based on the time-dependent position coordinates of the combine harvester 1 received from the vehicle position calculation unit 21 (S309).
[0132] The automatic steering control unit 28 causes the position of point A to be displayed on the screen of the display input device 4 (S310).
[0133] The reference direction calculation unit 27 stores the position coordinates calculated in S309 as point B coordinates (direction related information) in the direction related information storage unit 52 (S311).
[0134] The reference direction calculation unit 27 changes the point B waiting flag to OFF, and stores the flag in the status flag storage unit 51 (S312).
[0135] The reference direction calculation unit 27 calculates the reference direction based on the coordinates of point A calculated in S301 and the coordinates of point B calculated in S309 (S313).
[0136] The reference direction calculation unit 27 stores the reference direction calculated in S313 as direction related information in the direction related information storage unit 52 (S314). Then, the control unit CS starts an automatic steering start routine.
[0137] [Automatic steering start routine] The automatic steering control unit 28 acquires information indicating the operating position of the main shift lever 19 and determines whether the main shift lever 19 is in the forward operating position (S401). If the main shift lever 19 is not in the forward operating position (S401: Yes), step S401 is executed again.
[0138] If the main speed change lever 19 is in the forward operating position (S401: Yes), the automatic steering control unit 28 acquires information indicating the state of the sub-speed change device 11b and determines whether the sub-speed change device 11b is in a work speed change state (low speed state) (S402). If the sub-speed change device 11b is not in a work speed change state (low speed state) (S402: No), step S401 is executed again.
[0139] If the auxiliary transmission 11b is in a work shift state (low speed state) (S402: Yes), the automatic steering control unit 28 acquires information indicating whether or not a FIX solution has been obtained from the vehicle position calculation unit 21, and determines whether or not a FIX solution has been obtained (S403). If a FIX solution has not been obtained (S403: No), step S401 is executed again.
[0140] If a FIX solution has been obtained (S403: Yes), the automatic steering control unit 28 acquires information indicating the operation position of the reaping / threshing lever 43 and determines whether the reaping clutch C2 is engaged (S404). If the reaping clutch C2 is not engaged (S404: No), step S401 is executed again.
[0141] If the mowing clutch C2 is in the on state (S404: Yes), the automatic steering control unit 28 acquires information indicating whether the mowing unit H is located at the work position and determines whether the mowing unit H is located at the work position (S405). If the mowing unit H is not located at the work position (S405: No), step S401 is executed again.
[0142] As shown in Fig. 2, the combine harvester 1 is provided with a lifting / lowering detection unit 54. The lifting / lowering detection unit 54 detects the extension / retraction state of the cutting cylinder 15A. The detection result by the lifting / lowering detection unit 54 is sent to the control device CU. The automatic steering control unit 28 is configured to be able to determine whether the cutting unit H is located at the working position based on the detection result by the lifting / lowering detection unit 54.
[0143] In this embodiment, when the amount of descent of the cutting unit H from the highest position is equal to or greater than a predetermined value, the cutting unit H is positioned at the working position.
[0144] When the reaping unit H is located at the work position (S405: Yes), the automatic steering control unit 28 changes the automatic steering button (not shown) to an operable state (S406). The automatic steering button is, for example, a push button provided on the display input device 4. In this case, when the automatic steering button is in an operable state, a light-emitting element built into the push button is illuminated, and when the automatic steering button is not in an operable state, the light-emitting element is turned off. The automatic steering button is, for example, a button labeled "AUTOMATIC STEERING" and displayed on the screen of the display input device 4. In this case, when the automatic steering button is in an operable state, the characters labeled on the button are darkened, and when the automatic steering button is not in an operable state, the characters are lightened.
[0145] That is, when all of S401 to S405 are Yes, S406 is executed and automatic steering travel is started. Note that one or more of S401 to S405 may be omitted.
[0146] The automatic steering control unit 28 waits for operation of the automatic steering button (S407: No).
[0147] When the automatic steering button is operated (S407: Yes), the automatic steering control unit 28 determines the driving line calculated by the driving path calculation unit 29 at that time as the automatic steering target line (S408).
[0148] The driving control unit 24 starts automatic steering driving based on the automatic steering target line determined in S408 (S409).
[0149] The automatic steering control unit 28 changes the automatic steering in-progress flag to ON, and stores it in the status flag storage unit 51 (S410).
[0150] The automatic steering control unit 28 stores the current reference direction as direction related information in the direction related information storage unit 52 (S411). Then, the control unit CS starts an automatic steering end routine.
[0151] [Automatic steering termination routine] The automatic steering control unit 28 waits for operation of the automatic steering button (S501).
[0152] If the automatic steering button is not operated (S501: No), the automatic steering control unit 28 acquires information indicating the operating position of the main shift lever 19 and determines whether the main shift lever 19 is positioned in the neutral position or the reverse operating position (S501).
[0153] If the main shift lever 19 is not in the neutral position or the reverse operating position (S502: No), the automatic steering control unit 28 acquires information indicating the state of the sub-transmission device 11b and determines whether the sub-transmission device 11b is in a traveling shift state (high speed state) (S503).
[0154] If the sub-transmission device 11b is not in a driving shift state (high speed state) (S503: No), the automatic steering control unit 28 obtains information indicating whether or not a FLOAT solution has been obtained from the vehicle position calculation unit 21, and determines whether or not a FLOAT solution has been obtained (S504).
[0155] If a FLOAT solution has not been obtained (S504: No), the automatic steering control unit 28 acquires information indicating the operation position of the reaping / threshing lever 43 and determines whether the reaping clutch C2 is in the disengaged state (S505).
[0156] If the mowing clutch C2 is not in the disengaged state (S505: No), the automatic steering control unit 28 acquires information indicating whether the mowing unit H is located in the non-working position and determines whether the mowing unit H is located in the non-working position (S506). In this embodiment, the fact that the amount of descent of the mowing unit H from the highest position is equal to or less than a predetermined value corresponds to the mowing unit H being located in the non-working position.
[0157] If the cutting unit H is not located in a non-working position (S506: No), the automatic steering control unit 28 acquires information indicating whether the cutting unit H has been operated to be raised, and determines whether the cutting unit H has been operated to be raised (S507).
[0158] If the reaping unit H is not being raised (S507: No), the automatic steering control unit 28 acquires information indicating the operating state of the engine EG and determines whether the engine EG is stopped (S508). If the engine EG is not stopped, step S501 is executed again.
[0159] If the engine EG is stopped (S508: Yes), the cruise control unit 24 ends the automatic steering cruise, and the mode switching unit 26 switches the mode of the cruise control unit 24 from the automatic steering mode to the non-automatic steering mode (S509).
[0160] The control unit CS continuously monitors the operation of a start key (not shown) of the combine harvester 1 (S510: No).
[0161] When the start key is turned OFF (S510: Yes), the control unit CS shuts down the combine 1 (control unit CU) (S511), and the automatic steering end routine ends.
[0162] If the automatic steering button is operated in S501 (S501: Yes), the automatic steering control unit 28 changes the automatic steering in progress flag to OFF, and stores the flag in the status flag storage unit 51 (S512).
[0163] After S512 is completed, and if Yes is determined in S502-S507, the driving control unit 24 ends the automatic steering driving, and the mode switching unit 26 switches the mode of the driving control unit 24 from the automatic steering mode to the non-automatic steering mode (S513).
[0164] The control unit CS monitors the operation of a start key (not shown) of the combine harvester 1 (S514).
[0165] When the start key is turned OFF (S514: Yes), the control unit CS shuts down the combine 1 (control unit CU) (S511), and the automatic steering end routine ends.
[0166] If the start key is not turned OFF (S514: No), control unit CS starts the main routine.
[0167] [Combine operation] In the combine harvester 1 of this embodiment, the control device CU is configured so that when the mode switching unit 26 switches the control mode of the driving control unit 24 from an automatic steering mode (first mode) to a non-automatic steering mode (second mode) (S509, S513) and further switches from the non-automatic steering mode (second mode) to the automatic steering mode (first mode) (S106, S112, S202), the driving control unit 24 can perform automatic steering driving using a reference orientation based on the orientation-related information stored in the orientation-related information memory unit 52 (memory unit) (S409).
[0168] In addition, when the driving control unit 24 is performing automatic steering driving (S409), in response to the mode switching unit 26 switching the control mode of the driving control unit 24 from the automatic steering mode (first mode) to the non-automatic steering mode (second mode) (S509, S513), the mode switching unit 26 waits for manual operation from the display input device 4 (input device) (S105), and in response to receiving manual operation from the display input device 4 (input device) to continue automatic steering driving, the mode switching unit 26 switches the control mode of the driving control unit 24 from the non-automatic steering mode (second mode) to the automatic steering mode (first mode) (S106), and the driving control unit 24 performs automatic steering driving (S409) using a reference direction based on the direction-related information stored in the direction-related information memory unit 52 (memory unit) (S107).
[0169] In addition, the control device CU is configured so that, in response to receiving a manual operation from the display input device 4 (input device) to not continue automatic steering driving (S105: No), the mode switching unit 26 keeps the control mode of the driving control unit 24 in the non-automatic steering mode (second mode) and waits for a manual operation from the input device (S201), and, in response to receiving a manual operation from the display input device 4 (input device) to perform automatic steering driving again (S201: Yes), the mode switching unit 26 switches the control mode of the driving control unit 24 from the non-automatic steering mode (second mode) to the automatic steering mode (first mode) (S202), and the driving control unit 24 becomes capable of performing automatic steering driving using a reference direction based on the direction-related information stored in the direction-related information memory unit 52 (memory unit) (S210, S212) (S409).
[0170] In addition, when the driving control unit 24 is not performing automatic steering driving (S501: Yes), in response to the mode switching unit 26 switching the control mode of the driving control unit 24 from the automatic steering mode (first mode) to the non-automatic steering mode (second mode) (S513), the mode switching unit 26 waits for manual operation from the display input device 4 (input device) (S201), and in response to receiving manual operation from the display input device 4 (input device) to perform automatic steering driving again (S201: Yes), the mode switching unit 26 switches the control mode of the driving control unit 24 from the non-automatic steering mode (second mode) to the automatic steering mode (first mode) (S202), and the driving control unit 24 becomes capable of performing automatic steering driving using a reference direction based on the direction-related information stored in the direction-related information memory unit 52 (memory unit) (S210, S212) (S409).
[0171] In addition, the mode switching unit 26 is configured to switch the control mode of the travel control unit 24 from the automatic steering mode (first mode) to the non-automatic steering mode (second mode) (S509) in response to a predetermined switching condition being satisfied (S502-508: Yes). The switching condition includes that the engine EG has stopped (S508). In addition, the switching condition includes that the reaping unit H (working device) provided on the machine body 10 has stopped (S505).
[0172] Other Embodiments (1) The traveling device 11 may be of a wheel type or a semi-crawler type.
[0173] (2) The vehicle position calculation unit 21, the travel control unit 24, the vehicle direction calculation unit 25, the mode switching unit 26, the reference direction calculation unit 27, the automatic steering control unit 28, the travel path calculation unit 29, the status flag storage unit 51, and the direction related information storage unit 52 of the control unit CU may be provided partially or entirely outside the combine harvester 1. For example, these may be provided in a computer, a management server, a cloud server, or the like of a management facility of the field. A system that realizes automatic steering travel may be constructed by the combine harvester 1 and the computer, management server, cloud server, or the like of the management facility.
[0174] (3) The combine 1 may be configured to be capable of automatic driving in addition to automatic steering driving.
[0175] (4) The orientation related information stored in the orientation related information storage unit 52 may be one or more of a reference orientation, a point A coordinate, and a pair of the coordinates of point A and point B. The orientation related information storage unit 52 may store a plurality of reference orientations, a plurality of point A coordinates, or a plurality of pairs of the coordinates of point A and point B coordinates.
[0176] (5) The device for accepting manual operations from the operator may be a button displayed on the screen of the display input device 4, a physically operable button, switch, lever, etc., or a voice input device.
[0177] (6) In the above embodiment, the conditions for terminating automatic steering are exemplified as follows: operation of the automatic steering button (S501), operation of the main shift lever 19 (S502), state of the auxiliary shift device 11b (S503), state of the satellite positioning (S504), state of the reaping clutch C2 (S505), position of the reaping unit H (S506) and presence or absence of operation (S507), and stoppage of the engine EG (S508). Conditions for terminating automatic steering are not limited to these. For example, automatic steering may be terminated in response to the threshing device 13 (an example of a working device) stopping. [Industrial Applicability]
[0178] The present invention can be used not only in normal combine harvesters, but also in various other agricultural machines such as head-feeding combine harvesters, tractors, rice transplanters, corn harvesters, potato harvesters, and carrot harvesters. [Explanation of symbols]
[0179] 10: Aircraft 11: Running gear 24: Driving control unit 26: Mode switching section EG: Engine
Claims
1. The engine, A travel control unit that controls the travel of a body having a travel device, A mode switching unit that switches the control mode of the driving control unit between a first mode in which automatic steering driving using a reference orientation and manual steering driving for calculating the reference orientation can be performed, and a second mode in which the automatic steering driving is not performed and the driving device is stopped; a storage unit that stores orientation-related information that is information regarding the reference orientation when the control mode of the driving control unit is the first mode; A point A registration button and a point B registration button that can accept manual operation; a reference orientation calculation unit that causes the position of the aircraft when a manual operation to the A point registration button is accepted to be stored in the storage unit as a point A coordinate, causes the position of the aircraft when a manual operation to the B point registration button is accepted to be stored in the storage unit as a point B coordinate, and calculates the reference orientation based on the point A coordinate and the point B coordinate and stores the reference orientation in the storage unit; the mode switching unit switches the control mode of the travel control unit from the first mode to the second mode in response to the engine being stopped while waiting for manual operation of the B point registration button after storing the A point coordinates, and further switches from the second mode to the first mode in response to a start key that starts or shuts down the agricultural work machine being turned ON; The reference orientation calculation unit waits for a manual operation of the B point registration button again, stores the position of the aircraft when the manual operation of the B point registration button is received as the B point coordinate in the storage unit, calculates the reference orientation based on the A point coordinate and the B point coordinate, and stores the reference orientation in the storage unit, The agricultural machine wherein the travel control unit is capable of performing automatic steering travel using the reference orientation stored in the memory unit.
2. the mode switching unit switches the control mode of the travel control unit from the first mode to the second mode in response to the engine being stopped while the travel control unit is performing the automatic steering travel, and further switches the control mode of the travel control unit from the second mode to the first mode in response to the start key being turned ON, 2. The agricultural machine according to claim 1, wherein, when the travel control unit is switched to the first mode in response to the start key being turned ON, the automatic steering travel is performed using the reference orientation that was used before the engine was stopped.
3. An automatic steering control unit; An automatic steering button capable of accepting manual operation is further provided, the automatic steering control unit, in response to receiving a manual operation of the automatic steering button from the automatic steering button, determines a driving line that passes through a reference point of the aircraft at that time and is in a direction along the reference orientation as an automatic steering target line; The agricultural machine according to claim 1 or 2, wherein the travel control unit, when in the first mode, causes the machine body to travel along the automatic steering target line.
Citation Information
Patent Citations
Work vehicle
JP2017136015A
Accompanying travel work system
JP2018045710A
Agricultural work vehicle
JP2018117563A
Harvester
JP2019097534A
Automatic travel system
JP2020147205A