This application is a U.S. National stage application of International Application No. PCT/JP2019/036367, filed on Sep. 17, 2019. This U.S. National stage application claims priority under 35 U.S.C. ยง 119(a) to Japanese Patent Application No. 2018-216702, filed in Japan on Nov. 19, 2018, the entire contents of which are hereby incorporated herein by reference.
The present invention relates to a system and a method for controlling a work machine including a work implement.
Slot dozing is work performed by a work machine such as a bulldozer. In slot dozing, the actual topography of a work site is dug by the work implement whereby a plurality of slots are formed in the actual topography. Moreover, digging walls are formed between the plurality of slots. The digging walls are berms left over along the slots. Such types of digging walls are preferably removed.
U.S. Pat. No. 9,469,967 describes a starting condition for work to dig and remove the digging walls. For example, a controller determines whether to start digging of a digging wall based on the difference in the depths of the slots adjacent to the digging wall on both sides, or the width of the digging wall.
However, the motions of the work machine for digging the digging walls are not disclosed in U.S. Pat. No. 9,469,967 An object of the present invention is to provide a system and a method for digging a digging wall by automatically controlling a work machine.
A system according to a first aspect is a system for automatically controlling a work machine including a work implement. The system includes a processor. The processor selectively executes a normal digging mode and a wall digging mode. The normal digging mode is a control mode for digging an actual topography at a work site. The wall digging mode is a control mode for digging a digging wall formed between a plurality of slots by the digging of the actual topography.
The processor acquires starting edge position data which indicates the position of a starting edge of a digging wall when the wall digging mode is executed. The processor determines a digging starting position based on the position of the starting edge of the digging wall. The processor controls the work machine to dig the digging wall from the digging starting position.
A method according to a second aspect is a method executed by a processor for automatically controlling a work machine including a work implement. The method includes the following processes. A first process is selectively executing a normal digging mode for digging an actual topography at a work site, and a wall digging mode for digging a digging wall formed between a plurality of slots by the digging of the actual topography. A second process is acquiring starting edge position data which indicates the position of a starting edge of the digging wall when the wall digging mode is executed. A third process is determining a digging starting position based on the position of the starting edge of the digging wall. A fourth process is controlling the work machine to dig the digging wall from the digging starting position.
According to the present invention, when the wall digging mode is executed, the digging starting position is determined based on the position of the starting edge of the digging wall and the work machine is controlled so as to dig the digging wall from the digging starting position. Consequently, the digging wall can be dug by automatic control of the work machine.
A work machine according to an embodiment is discussed hereinbelow with reference to the drawings.
The vehicle body 11 has an operator's cab 14 and an engine compartment 15. An operator's seat that is not illustrated is disposed inside the operator's cab 14. The engine compartment 15 is disposed in front of the operator's cab 14. The travel device 12 is attached to a bottom portion of the vehicle body 11. The travel device 12 includes a left and right pair of crawler belts 16. Only the crawler belt 16 on the left side is illustrated in
The work implement 13 is attached to the vehicle body 11. The work implement 13 has a lift frame 17, a blade 18, a lift cylinder 19, and a tilt cylinder 20. The lift frame 17 is attached to the vehicle body 11 in a manner that allows movement up and down centered on an axis X that extends in the vehicle width direction. 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 frame 17 may be attached to the travel device 12. The lift cylinder 19 is 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 centered on the axis X.
The tilt cylinder 20 is coupled to the lift frame 17 and the blade 18. Due to the extension and contraction of the tilt cylinder 20, the blade 18 tilts around an axis Z that extends in roughly the front-back direction of the work machine 1.
The hydraulic pump 23 is driven by the engine 22 to discharge hydraulic fluid. The hydraulic fluid discharged from the hydraulic pump 23 is supplied to the lift cylinder 19 and the tilt cylinder 20. While only one hydraulic pump 23 is illustrated in
The power transmission device 24 transmits driving power from the engine 22 to the travel device 12. The power transmission device 24 may be a hydrostatic transmission (HST), for example. Alternatively, the power transmission device 24, for example, may be a transmission having a torque converter or a plurality of speed change gears.
The control system 3 includes an operating device 25a, an input device 25b, a controller 26, a storage device 28, and a control valve 27. The operating device 25a and the input device 25b are disposed in the operator's cab 14. The operating device 25a is a device for operating the work implement 13, the travel device 12, the engine 22, and the power transmission device 24. The operating device 25a is disposed in the operator's cab 14.
The operating device 25a receives operations from an operator for driving the work implement 13 and outputs operation signals corresponding to the operations. The operating device 25a receives operations from the operator for causing the work machine 1 to travel, and outputs operation signals corresponding to the operations. The operation signals of the operating device 25a are output to the controller 26. The operating device 25a includes, for example, an operating lever, a pedal, and a switch and the like.
The input device 25b is a device for performing belowmentioned automatic control settings of the work machine 1. The input device 25b receives operations by an operator and outputs operation signals corresponding to the operations. The operation signals of the input device 25b are output to the controller 26. The input device 25b includes, for example, a touch screen. However, the input device 25b is not limited to a touch screen and may include hardware keys.
The controller 26 is programmed to control the work machine 1 based on acquired data. The controller 26 includes, for example, a processing device (processor) 26a such as a CPU, and a memory 26b. The memory 26b may include a volatile memory such as a RAM or the like, or a non-volatile memory such as a ROM or the like. The controller 26 acquires operation signals from the operating device 25a and the input device 25b. The controller 26 causes the work machine 1 to travel by controlling the travel device 12, the engine 22, and the power transmission device 24 in accordance with the operation signals. The controller 26 controls the control valve 27 in accordance with the operation signals to move the work implement 13.
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 and the tilt cylinder 20. The control valve 27 controls the flow rate of the hydraulic fluid supplied from the hydraulic pump 23 to the lift cylinder 19 or the tilt cylinder 20. The controller 26 generates a command signal for the control valve 27 so as to cause the lift cylinder 19 or the tilt cylinder 20 to contract and expand. As a result, the motions of the blade 18 are controlled. 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 a work implement sensor 29. The work implement sensor 29 detects the position of the work implement 13 with respect to the vehicle body 11 and outputs work implement position data which indicates the position of the work implement 13. The work implement sensor 29 may be a displacement sensor that detects displacement of the work implement 13.
For example, the work implement sensor 29 may include a sensor for detecting the stroke length of the lift cylinder 19. The controller 26 may calculate the lift angle of the blade 18 based on the stroke length of the lift cylinder 19. The work implement sensor 29 may include a sensor for detecting the stroke length of the tilt cylinder 20. The controller 26 may calculate the tilt angle of the blade 18 based on the stroke length of the tilt cylinder 20.
As illustrated in
The GNSS receiver 32 receives a positioning signal from a satellite, computes the position of the antenna from the positioning signal, and generates machine position data which indicates the position of the vehicle body 11. The controller 26 acquires the machine position data from the GNSS receiver 32. The controller 26 acquires the current position of the work machine 1 and the traveling direction and the vehicle speed of the work machine 1 from the machine position data.
The IMU 33 acquires vehicle body inclination angle data. The vehicle body inclination angle data includes the angle (pitch angle) with respect to horizontal in the front-back direction of the work machine 1, and the angle (roll angle) with respect to horizontal in the transverse direction of the work machine 1. The controller 26 acquires the vehicle body inclination angle data from the IMU 33.
The controller 26 computes a blade tip position Pb of the blade 18 from the work implement position data, the machine position data, and the vehicle body inclination angle data. For example, the controller 26 acquires global coordinates of the GNSS receiver 32 based on the machine position data. The controller 26 calculates local coordinates of the blade tip position Pb with respect to the GNSS receiver 32 based on the work implement position data. The controller 26 calculates the global coordinates of the blade tip position Pb based on the global coordinates of the GNSS receiver 32, the local coordinates of the blade tip position Pb, and the vehicle body inclination angle data. The controller 26 acquires the global coordinates of the blade tip position Pb as the current position data of the work implement 13.
The storage device 28 may be, for example, 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.
Automatic control of the work machine 1 executed by the controller 26 will be explained next. The automatic control of the work machine 1 may be a semi-automatic control that is performed in accompaniment to manual operations by the operator. Alternatively, the automatic control of the work machine 1 may be a fully automatic control that is performed without manual operations by an operator.
The controller 26 automatically controls the work machine 1 based on actual topography data, design topography data, and current position data. The actual topography data and the design topography data are stored in the storage device 28. The actual topography data indicates an actual topography 50 of the work site as illustrated in
Specifically, the actual topography 50 is represented in the actual topography data by the height Zn of the actual topography 50 at a plurality of reference points Pn (n=1, 2, . . . , A) on the travel path of the work machine 1. The plurality of reference points Pn indicate a plurality of spots at predetermined intervals in the traveling direction of the work machine 1. The predetermined distance may be, for example, 1 m. However, the predetermined distance may be shorter than 1 m or longer than 1 m.
The actual topography data is acquired by an external device and saved in the storage device 28. The actual topography data may be acquired by means of the controller 26 recording the locus of a portion of the work machine 1 such as the blade tip position Pb or the crawler belts 16, etc. Alternatively, the actual topography data may be acquired by means of carrying out distance surveying on the actual topography 50 with an on-board laser imaging detection and ranging device (LIDAR).
The design topography data indicates a target design topography 70. The target design topography 70 represents a target locus of the blade tip of the blade 18 during the work. The target design topography 70 indicates the desired topography as a result of the work by the work implement 13. The target design topography 70 is represented by the height Zn of the target design topography 70 at the plurality of reference points Pn in the same way as the actual topography 50. The target design topography 70 may be generated by the controller 26 based on the actual topography data. Alternatively, the target design topography 70 may be generated by the controller 26 based on the capability of the work machine 1 such as the capacity of the blade 18. Alternatively, the target design topography 70 may be acquired by an external device.
The controller 26 selectively executes a normal digging mode and a wall digging mode. The normal digging mode is a control mode for digging the actual topography 50 as illustrated in
Alternatively, a previously set construction plan may be saved in the storage device 28 and the controller 26 may decide to execute the normal digging mode according to the construction plan. Alternatively, the controller 26 may decide to execute the normal digging mode by determining whether a predetermined starting condition has been satisfied based on a parameter such as the shape of the actual topography 50.
In step S102, the controller 26 acquires the abovementioned current position data. The controller 26 continuously acquires and updates the current position data during the execution of the following processes. In step S103, the controller 26 acquires the abovementioned actual topography data.
In step S104, the controller 26 acquires work range data. As illustrated in
The starting edge position and the terminating edge position of the digging may be set with the input device 25b. Alternatively, the starting edge position and the distance of a digging range of the digging may be set with the input device 25b, and the terminating edge position of the digging may be determined by computing. Alternatively, the terminating edge position and the distance of the digging range of the digging may be set with the input device 25b, and the starting edge position of the digging may be determined by computing.
In addition, the work range includes the terminating edge position of the piled soil. The piled soil is a result of the work for discharging the soil dug and held by the blade 18 onto the actual topography 50. The work range data includes terminating edge position data of the piled soil. The terminating edge position data of the piled soil indicates the terminating edge position of the piled soil. The terminating edge position of the piled soil may be set with the input device 25b. Alternatively, the length of the piled soil range may be set with the input device 25b, and the terminating edge position of the piled soil may be determined by computing.
The controller 26 acquires the work range data based on operation signals from the input device 25b. However, the controller 26 may acquire the work range data with another method. For example, the controller 26 may acquire the work range data from an external device.
In step S105, the controller 26 acquires the design topography data. For example, the controller 26 determines a target design topography 70a as depicted in
The controller 26 may determine the target design topography 70a in accordance with the actual topography 50. For example, the controller 26 may determine the first target topography 71a so as to be located below the actual topography 50 by a predetermined distance. The controller 26 may determine the first target topography 71a so as to be sloped at a predetermined angle to the actual topography 50 or to the horizontal direction.
The controller 26 may determine the second target topography 72a so as to be located above the actual topography 50 by a predetermined distance. The controller 26 may determine the second target topography 72a so as to be sloped at a predetermined angle to the actual topography 50 or to the horizontal direction. Alternatively, the target design topography 70a may be determined in advance.
In step S106, the controller 26 starts the digging. The controller 26 controls the work machine 1 in accordance with the target design topography 70a. The controller 26 causes the work machine 1 to travel forward from the starting edge to the terminating edge of the digging and controls the work implement 13 so that the blade tip position Pb of the blade 18 moves in accordance with the first target topography 71a. The actual topography 50 is dug due to the blade tip of the blade 18 moving along the first target topography 71a. Consequently, the slots 51 and 52 are formed in the actual topography 50 as illustrated in
The controller 26 also causes the work machine 1 to travel forward from the digging terminating edge to the terminating edge of the piled soil and controls the work implement 13 so that the blade tip position Pb of the blade 18 moves in accordance with second first target topography 71b. The soil dug and held by the blade 18 is piled on the actual topography 50 due to the blade tip of the blade 18 moving along the second target topography 71b. Consequently, piles of piled soil 54 and 55 are formed on the actual topography 50 as illustrated in
As illustrated in
For example, the controller 26 controls the work machine 1 so as to first perform the digging from the first starting position Ps1 to the digging terminating edge, and then perform the soil piling toward the terminating edge of the piled soil by crossing over the digging terminating edge. Next, the controller 26 causes the work machine 1 to travel in reverse to the second starting position Ps2. The controller 26 then controls the work machine 1 so as to start digging from the second starting position Ps2 and perform the digging and soil piling in the same way as explained above. Next, the controller 26 causes the work machine 1 to travel in reverse to the third starting position Ps3. The controller 26 then controls the work machine 1 so as to start digging from the third starting position Ps3 and perform the digging and soil piling in the same way as explained above.
In step S107, the controller 26 updates the actual topography data. The controller 26 updates the actual topography data with position data that represents the most recent locus of the blade tip position Pb. Alternatively, the controller 26 may calculate the position of the bottom surface of the crawler belts 16 and update the actual topography data with the position data that indicates the locus of the bottom surfaces of the crawler belts 16.
Alternatively, the actual topography data may be updated from survey data measured by a surveying device outside of the work machine 1. For example, aerial laser surveying may be used as the external surveying device. Alternatively, the actual topography 50 may be imaged by a camera and work site topography data may be generated from image data captured by the camera. For example, aerial photography surveying performed with an unmanned aerial vehicle (UAV) may be used. The updating of the actual topography data may be performed at predetermined periods or at any time.
The work from the digging starting edge to the terminating edge of the piled soil is set as a one unit of work, and when one unit of work is completed, the controller 26 causes the work machine 1 to move to the side of the previously formed slot 51. The second slot 52 is then formed by executing the processing from steps S101 to S107 again.
For example, as illustrated in
In step S108, the controller 26 determines whether to finish the digging. For example, the controller 26 may decide to finish the digging in accordance with the operation of the input device 25b. Alternatively, the controller 26 may decide to finish the digging in accordance with a previously set construction plan. Alternatively, the controller 26 may decide to finish the digging by determining whether a predetermined finishing condition is satisfied.
When the forming of the first slot 51 is finished and the forming of the second slot 52 starts, the controller 26 causes the work machine 1 to move further to the side than the width of the blade 18. As a result, the digging wall 53 is formed between the first slot 51 and the second slot 52. The digging wall 53 is a berm of soil along the slots 51 and 52.
Alternatively, the controller 26 may decide to execute the wall digging mode in accordance with a previously set construction plan. Alternatively, the controller 26 may decide to execute the wall digging mode by determining whether a predetermined starting condition is satisfied.
In step S202, the controller 26 acquires the current position data in the same way as step S102. In step S203, the controller 26 acquires the actual topography data.
The current topographical data includes first slot position data, second slot position data, and digging wall position data. The first slot position data indicates the position of the first slot 51. The second slot position data indicates the position of the second slot 52. The digging wall position data indicates the position of the digging wall 53.
In step S204, the controller 26 acquires the work range data. As illustrated in
The controller 26 determines a position Pb3 of the digging terminating edge of the digging wall 53 from a position Pb1 of the digging terminating edge of the first slot 51, and a position Pb2 of the digging terminating edge of the second slot 52. For example, the controller 26 calculates an intermediate position between the position Pb1 of the digging terminating edge of the first slot 51 and the position Pb2 of the digging terminating edge of the second slot 52. The controller 26 determines the calculated intermediate position as the position Pb3 of the digging terminating edge of the digging wall 53. That is, the controller 26 determines the position of a center point of a line that joins the position Pb1 of the digging terminating edge of the first slot 51 and the position Pb2 of the digging terminating edge of the second slot 52, as the position Pb3 of the digging terminating edge of the digging wall 53 as seen in a plan view.
In addition, the work range includes the terminating edge of the piled soil as illustrated in
In step S205, the controller 26 acquires the design topography data. For example, the controller 26 determines a target design topography 70b of the digging wall 53 as illustrated in
The controller 26 determines a target digging height of the digging wall 53 from the height of the first slot 51 and the height of the second slot 52. The controller 26 determines the target design topography 70 from the target digging height. Specifically, as illustrated in
In step S206, the controller 26 sets the position Pa3 of the digging starting edge of the digging wall 53 acquired in step S204, as a digging starting position Pw1 as illustrated in
In step S207, the controller 26 causes the work machine 1 to move to the digging starting position Pw1. At this time, the controller 26 may cause the work machine 1 to move onto the digging wall 53 after traveling in reverse along the second slot 52 as illustrated by arrow A1 in
In step S208, the controller 26 starts the digging of the digging wall 53. The controller 26 controls the work machine 1 in accordance with the target design topography 70b of the digging wall 53. Specifically, the controller 26 causes the work machine 1 to travel forward from the digging starting position Pw1 toward the position Pb3 of the digging terminating edge, and controls the work implement 13 so that the blade tip position Pb of the blade 18 moves in accordance with the first target topography 71b. The digging wall 53 of the actual topography 50 is dug due to the blade tip of the blade 18 moving along the first target topography 71b.
The controller 26 also causes the work machine 1 to travel forward from the position Pc3 of the digging terminating edge to the terminating edge of the piled soil, and controls the work implement 13 so that the blade tip position Pb of the blade 18 moves in accordance with second first target topography 72b. The soil dug and held by the blade 18 is piled on the actual topography 50 due to the blade tip of the blade 18 moving along the second target topography 72b. Consequently, as illustrated in
In step S209, the controller 26 determines whether to finish the digging of the digging wall 53. For example, the controller 26 may determine to finish the digging of the digging wall 53 when the work machine 1 reaches the terminating edge of the piled soil. Alternatively, the controller 26 may decide to finish the digging in accordance with the operation of the input device 25b. Alternatively, the controller 26 may decide to finish the digging of the digging wall 53 in accordance with a previously set construction plan. Although not illustrated in the drawings, the controller 26 may also update the actual topography data in the same way as in step S107 in the wall digging mode.
In the control system 3 of the work machine 1 according to the present embodiment explained above, the controller 26 determines the position of the starting edge of digging of the digging wall 53 as the digging starting position Pw1 upon acquiring the starting command of the wall digging mode. The controller 26 then controls the work machine 1 so as to cause the work machine 1 to move from the digging starting position Pw1 toward the digging terminating edge of the digging wall 53 and dig the digging wall 53 with the work implement 13. Consequently, the digging wall 53 can be dug by means of automatic control of the work machine 1.
The controller 26 determines the digging starting edge of the digging wall 53 from the positions of the digging starting edges of the first slot 51 and the second slot 52 adjacent to the digging wall 53. The controller 26 also determines the position of the digging terminating edge of the digging wall 53 from the positions of the digging terminating edges of the first slot 51 and the second slot 52 adjacent to the digging wall 53. Consequently, the digging wall 53 can be properly reduced in size or removed.
The controller 26 determines the position of the terminating edge of the piled soil of the digging wall 53 from the positions of the terminating edges of the piled soil of the first slot 51 and the second slot 52 adjacent to the digging wall 53. Consequently, the gap between the piled soil 54 corresponding to the first slot 51 and the piled soil 55 corresponding to the second slot 52, can be properly filled in with the dug soil.
The controller 26 determines the target digging height of the digging wall 53 from the height of the first slot 51 and the height of the second slot 52. Consequently, the digging wall 53 can be properly reduced in size or removed.
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, a motor grader, a hydraulic excavator, or the like. The work machine may be driven by an electric motor. The actual topography may include material such as rocks or iron ore or the like.
The work machine may be a vehicle that can be remotely operated. In this case, a portion of the control system may be disposed outside of the work machine. For example, the controller may be disposed outside the work machine. The controller may be disposed inside a control center separated from the work site. In this case, the work machine may not be provided with an operator's cab.
The controller may have a plurality of controllers separate from each other. For example as illustrated in
The operating device 25a and the input device 25b may also be disposed outside of the work machine. In this case, the operator's cab may be omitted from the work machine. Alternatively, the operating device 25a and the input device 25b may be omitted from the work machine.
The actual topography 50 may be acquired with another device and is not limited to being acquired with the abovementioned positional sensor 31. For example, as illustrated in
The method for determining the target design topographies 70, 70a and 70b is not limited to the method of the above embodiment and may be modified. For example, the controller 26 may determine the target design topographies 70, 70a and 70b based on the load on the work implement 13, a target angle, a target position, or another parameter. Alternatively, the target design topographies 70, 70a and 70b may be determined in advance with a construction plan.
The work steps of the normal digging mode and the wall digging mode are not limited to those of the above embodiment. For example, the digging of the digging wall 53 between the two slots 51 and 52 is performed after the slots are formed in the above embodiment. However, the digging of a plurality of digging walls between three or more slots may be performed after the three or more slots are formed.
The work range data may be set by the operator operating the input device 25b in the wall digging mode. Alternatively, the controller 26 may determine either a position beside the digging starting edge of the first slot 51 or a position beside the digging starting edge of the second slot 52, as the position of the digging starting edge of the digging wall 53. The controller 26 may determine either a position beside the digging terminating edge of the first slot 51 or a position beside the digging terminating edge of the second slot 52, as the position of the digging terminating edge of the digging wall 53. The controller 26 may determine either a position beside the terminating edge of the piled soil of the first slot 51 or a position beside the terminating edge of the piled soil of the second slot 52, as the position of the terminating edge of the piled soil of the digging wall 53.
The controller 26 may determine the target digging height of the digging wall 53 from the lower height among the heights of the first slot 51 and the second slot 52. Alternatively, the controller 26 may determine the target digging height of the digging wall 53 from an intermediate value of the height of the first slot 51 and the height of the second slot 52.
According to the present invention, a digging wall can be dug by means of automatic control of a work machine.
Number | Date | Country | Kind |
---|---|---|---|
2018-216702 | Nov 2018 | JP | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2019/036367 | 9/17/2019 | WO |
Publishing Document | Publishing Date | Country | Kind |
---|---|---|---|
WO2020/105260 | 5/28/2020 | WO | A |
Number | Name | Date | Kind |
---|---|---|---|
5462122 | Yamamoto et al. | Oct 1995 | A |
9469967 | Edara et al. | Oct 2016 | B2 |
20120136508 | Taylor et al. | May 2012 | A1 |
20160076224 | Edara | Mar 2016 | A1 |
20160077514 | Taylor | Mar 2016 | A1 |
Number | Date | Country |
---|---|---|
7-26586 | Jan 1995 | JP |
9-21131 | Jan 1997 | JP |
2016-132912 | Jul 2016 | JP |
Entry |
---|
The International Search Report for the corresponding international application No. PCT/JP2019/036367, issued on Dec. 10, 2019. |
Number | Date | Country | |
---|---|---|---|
20210317640 A1 | Oct 2021 | US |