The present disclosure relates to a system for controlling a work machine, a method, and a work machine
A technique is known that involves automatically controlling a work machine so that a work implement moves according to a target design surface. For example, in Japanese Patent Laid-open No. 2019-173470, a controller determines a target design surface that is positioned below the actual topography. The controller controls the work machine so that the work implement moves according to the target design surface. Consequently, the work machine excavates the actual topography.
Besides excavation, a work machine performs earth removal work, such as back-filling and embankment work. In the earth removal work, the controller determines a target design surface located above the actual topography and causes the work implement to move according to the target design surface. As a result, earth held by the work implement is disposed along the target design surface on the actual topography. The work machine travels over the earth arranged on the actual topography, thereby compacting the earth.
In the earth removal work, the earth held by the work implement may not be sufficient during the work. In this case, earth cannot be placed on the actual topography even if the work continues. Therefore, in order to improve work efficiency, there is a desire to accurately detect that the earth held by the work implement is insufficient. An object of the present disclosure is to accurately detect that the earth held by the work implement is insufficient in automatic control of a work machine.
A system according to first aspect of the present disclosure is a system for controlling a work machine. The work machine includes a main body including a travel device, and a work implement attached to the main body. The system includes a positional sensor and a controller. The positional sensor detects the position of the work machine. The controller determines a target design surface at least a portion of which is located above an actual topography. The controller acquires the position of the main body. The controller acquires the position of the work implement. The controller causes the work machine to travel forward while controlling the work implement in accordance with the target design surface. The controller acquires the height difference between the target design surface and a predetermined portion of the main body. The controller determines whether there is any more earth held by the work implement based on the height difference.
A method according to a second aspect of the present disclosure is a method for controlling a work machine. The work machine includes a main body including a travel device, and a work implement attached to the main body. The method comprises: acquiring a target design surface at least a portion of which is located above an actual topography; causing the work machine to travel forward while controlling the work implement in accordance with the target design surface; acquiring a height difference between the target design surface and a predetermined portion of the main body; and determining whether there is any more earth held by the work implement based on the height difference.
A work machine according to a third aspect of the present disclosure comprises a main body that includes a travel device, a work implement attached to the main body, a positional sensor that detects the position of the work machine, and a controller. The controller determines a target design surface at least a portion of which is located above an actual topography. The controller acquires the position of the main body. The controller acquires the position of the work implement. The controller causes the work machine to travel forward while controlling the work implement in accordance with the target design surface. The controller acquires the height difference between the target design surface and a predetermined portion of the main body. The controller determines whether there is any more earth held by the work implement based on the height difference.
When there is no more earth held by the work machine during earth removal work, the work machine moves from above being on the removed earth to above the actual topography where no earth is placed. At this time, the height difference of the predetermined portion of the main body with respect to the target design surface changes. According to the present disclosure, the fact that the earth on the work implement is insufficient can be detected accurately based on the height difference between the target design surface and the predetermined portion of the main body.
A work machine according to an embodiment is discussed hereinbelow with reference to the drawings.
The main body 10 includes a vehicle body 11 and a travel device 12. The vehicle body 11 includes an operating cabin 14 and an engine compartment 15. An operator's seat that is not illustrated is disposed inside the operating cabin 14. The engine compartment 15 is disposed in front of the operating cabin 14. The travel device 12 is attached to a bottom part of the vehicle body 11. The travel device 12 has a pair of left and right crawler belts 16. Only the crawler belt 16 on the left side is illustrated in
The work implement 13 is attached to the main body 10. The work implement 13 has a lift frame 17, a blade 18, and a lift cylinder 19. The lift frame 17 is attached to the travel device 12 in a manner that allows movement up and down. The lift frame 17 supports the blade 18. The blade 18 is disposed in front of the vehicle body 11. The blade 18 moves up and down accompanying the up and down movements of the lift frame 17. The lift cylinder 19 is coupled to the vehicle body 11 and the blade 18. Alternatively, the lift cylinder 19 may be coupled to the vehicle body 11 and the lift frame 17. Due to the extension and contraction of the lift cylinder 19, the lift frame 17 moves up and down. The blade 18 is lowered due to the extension of the lift cylinder 19. The blade 18 is raised due to the contraction of the lift cylinder 19,
The power transmission device 24 transmits the driving power of the engine 22 to the travel device 12. The power transmission device 24, for example, may be a hydrostatic transmission (HST). Alternatively, the power transmission device 24 may be, for example, a transmission having a torque converter or a plurality of speed change gears.
The control system 3 includes a controller 26 and a control valve 27. The controller 26 is programmed so as to control the work machine 1 based on acquired data. The controller 26 includes a storage device 28 and a processor 30. The processor 30 includes, for example, a CPU. The storage device 28 includes, for example, a memory and an auxiliary storage device. The storage device 28 may be a RAM or a ROM, for example. The storage device 28 may also be a semiconductor memory or a hard disk and the like. The storage device 28 is an example of a non-transitory computer-readable recording medium. The storage device 28 records computer commands that are executable by the processor and that are for controlling the work machine 1.
The control valve 27 is a proportional control valve and is controlled with command signals from the controller 26. The control valve 27 is disposed between the hydraulic pump 23 and hydraulic actuators such as the lift cylinder 19. The control valve 27 controls the flow rate of the hydraulic fluid supplied from the hydraulic pump 23 to the lift cylinder 19. The controller 26 controls the control valve 27 so as to raise or lower the work implement 13. The control valve 27 may also be a pressure proportional control valve. Alternatively, the control valve 27 may be an electromagnetic proportional control valve.
The control system 3 includes an input device 25. The input device 25 is, for example, a touch panel-type input device. However, the input device 25 also may be an input device such as a switch. An operator uses the input device 25 to input settings for a below mentioned automatic control.
The control system 3 includes a positional sensor 31. The positional sensor 31 measures the position of the work machine 1. The positional sensor 31 includes a global navigation satellite system (GNSS) receiver 32, an IMU 33, and an antenna 35. The GNSS receiver 32 is, for example, a receiver for a global positioning system (GPS). The GNSS receiver 32 receives a positioning signal from a satellite and computes the position of the antenna 35 from the positioning signal. The GNSS receiver 32 generates vehicle body position data that indicates the position of the antenna 35. The controller 26 acquires the vehicle body position data from the GNSS receiver 32.
The IMU 33 is an inertial measurement unit. The IMU 33 acquires vehicle body inclination angle data. The vehicle body inclination angle data includes the angle (pitch angle) relative to horizontal in the vehicle front-back direction and the angle (roll angle) relative to horizontal in the vehicle lateral direction. The controller 26 acquires the vehicle body inclination angle data from the IMU 33.
The control system 3 includes a work implement sensor 29. The work implement sensor 29 detects the attitude of the work implement 13. The attitude of the work implement 13 is, for example, the lift angle of the work implement 13 with respect to the vehicle body 11. For example, the work implement sensor 29 detects the stroke length of the lift cylinder 19. The controller 26 calculates the lift angle of the work implement 13 from the stroke length of the lift cylinder 19. Alternatively, the work implement sensor 29 may be an angle sensor that detects the lift angle of the work implement 13. The work implement sensor 29 generates work implement data that indicates the attitude of the work implement 13. The controller 26 acquires the work implement data from the work implement sensor 29.
The controller 26 automatically controls the work machine 1. Automatic control of the work machine 1 during back-fill work and executed by the controller 26 will be explained below.
In step S101 as illustrated in
In step S102, the controller 26 acquires the actual topographical data. The actual topographical data represents the actual topography 50 of the work target.
In step S103, the controller 26 acquires a starting point S0 and an ending point E0 of the work. The starting point S0 and the ending point E0 of the work are points on the actual topography 50. The ending point E0 is located in front of the starting point S0 in the traveling direction of the work machine 1. The controller 26 may acquire the positions of the starting point S0 and the ending point E0 of the work from an external computer. Alternatively, the controller 26 may acquire the positions of the starting point S0 and the ending point E0 of the work by means of an operation of the input device 25 by the operator.
In step S104, the controller 26 acquires the target design surface 60.
As illustrated in
The controller 26 determines the straight line L2 that is one line above the first target design surface 61 as a second target design surface 62. Similarly, the controller 26 determines the straight line L1 that is one line above the second target design surface 62 as a third target design surface 63. The number of the target design surfaces 60 is not limited to three. However, the number of the target design surfaces 60 may be less than three or more than three.
In step S105, the controller 26 controls the work machine 1 in accordance with the target design surface 60. The target design surface 60 includes a starting edge and an ending edge. The starting edge and the ending edge of the target design surface 60 are both points that the target design surface 60 and the actual topography 50 cross. For example, the first target design surface 61 includes a starting edge S1 and an ending edge E1.
First, as illustrated in
In step S106, the controller 26 acquires the position of the predetermined portion P1 of the main body 10. As discussed above, the predetermined portion P1 is the position of the bottom surface of the crawler belts 16. In step S107, the controller 26 updates the actual topographical data. The controller 26 updates the actual topographical data from a locus of the positions of the predetermined portion P1. That is, the locus on which the bottom surface of the crawler belts 16 has moved is used as information that indicates the actual topography 50 after the traveling of the work machine 1, and the actual topographical data is updated.
In step S108, the controller 26 assesses whether the blade tip position P0 has reached the ending edge E1 of the first target design surface 61. When the blade tip position P0 has not reached the ending edge E1 of the first target design surface 61, the process advances to step S109.
In step S109, the controller 26 assesses whether there is any more earth held by the work implement 13. The controller 26 calculates a height difference D1 between the first target design surface 61 and the predetermined portion P1. As illustrated in
The controller 26 assesses whether the height difference D1 is equal to or greater than a threshold. The threshold may be a fixed value. Alternatively, the threshold may be variable. The threshold may be decided in consideration of the height of the earth compressed by means of the crawler belts 16. As illustrated in
When there is remaining earth held by the work implement 13, the process returns to step S105. Consequently, the controller 26 continues to cause the work machine 1 to travel forward while controlling the work implement 13 in accordance with the first target design surface 61. When the height difference D1 equals or exceeds the threshold, the process advances to step S110.
In step S110, the controller 26 causes the work machine 1 to travel in reverse. As illustrated in
In step S108, as illustrated in
In the control system 3 according to the present embodiment discussed above, whether there is any more earth held by the work implement 13 is assessed based on the height difference D1 between the target design surface 60 and the predetermined portion P1 of the main body 10. Consequently, the fact that there is no more earth held by the work implement 13 can be easily and accurately detected. Specifically, in the control system 3 according to the present embodiment, the fact that there is no more earth held by the work implement 13 is estimated. When the work machine 1 is a bulldozer, whether there is any more earth carried by the blade 18 is estimated by the control system 3 according to the present embodiment.
Although an embodiment of the present invention has been described so far, the present invention is not limited to the above embodiment and various modifications may be made within the scope of the invention.
The work machine 1 is not limited to a bulldozer, and may be another type of machine, such as a wheel loader or a motor grader and the like. The input device 25 may be disposed outside of the work machine 1. The work machine 1 may be a manned machine in which an operator sits or may be an unmanned machine that no operator sits in. The operating cabin may be omitted from the work machine 1.
The controller 26 may have a plurality of controllers separate from each other. For example as illustrated in
The processes performed by the controller 26 are not limited to those of the above embodiment and may be changed. A portion of the above-mentioned processes may be omitted. A portion of the above-mentioned processes may be changed. For example, the process for assessing whether there is any more earth held by the work implement 13 is not limited to the above embodiment and may be changed.
The controller 26 may assess that there is no more earth held by the work implement 13 when the fact that the height difference D1 between the target design surface 60 and the position of the predetermined portion P1 being equal to or greater than the threshold continues for a predetermined time period. The controller 26 may assess that there is no more earth held by the work implement 13 when the fact that ratio of the first height difference D1 with respect to the second height difference D2 is equal to or greater than a threshold continues for a predetermined time period.
The shape of the target design surface 60 is not limited to the above embodiment and may be modified. The target design surface 60 is not limited to horizontal and may be slanted with respect to the horizontal direction. For example,
The work performed by the work machine 1 is not limited to back-filling and may be other work, such as embankment work. For example,
The predetermined portion P1 is not limited to the bottom surface of the crawler belts 16 and may be another portion. For example, the predetermined portion P1 may be another portion of the travel device 12. Alternatively, the predetermined portion P1 may be a portion of the vehicle body 11.
According to the present disclosure, the fact that the earth on the work implement is insufficient can be detected accurately.
Number | Date | Country | Kind |
---|---|---|---|
2021-100723 | Jun 2021 | JP | national |
This application is a U.S. National stage application of International Application No. PCT/JP2022/018172, filed on Apr. 19, 2022. This U.S. National stage application claims priority under 35 U.S.C. § 119(a) to Japanese Patent Application No. 2021-100723, filed in Japan on Jun. 17, 2021, the entire contents of which are hereby incorporated herein by reference.
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2022/018172 | 4/19/2022 | WO |