AUTOMATIC CONTROL SYSTEM FOR WORK MACHINE AND CONTROL METHOD FOR WORK MACHINE

Abstract

A posture detection sensor detects a posture of a work implement. A controller identifies an unloading point and a passing point on a route through which a bucket passes during revolution of a revolving body, based on a detection result of the posture detection sensor, sets a position shifted from the passing point to a side opposite to the unloading point as a corrected passing point, and performs control such that the bucket passes through the corrected passing point during the revolution.

Description

TECHNICAL FIELD

The present disclosure relates to an automatic control system for a work machine and a control method for the work machine.

BACKGROUND ART

JP 2019-190234 A (Patent Document 1) describes a technique for changing a target revolution speed of a revolving body so that a bucket does not interfere with a loading target while the revolving body is revolving in automatic loading.

CITATION LIST

Patent Literature

Patent Document 1: JP 2019-190234 A

SUMMARY OF INVENTION

Technical Problem

However, in the technique described in Patent Document 1, depending on the movement trajectory of a work implement having a work tool such as a bucket, the work tool may interfere with the loading target.

An object of the present disclosure is to provide an automatic control system for a work machine and a control method for the work machine, the work machine being able to reduce interference between a work tool and a loading target.

Solution to Problem

An automatic control system for a work machine according to the present disclosure includes a revolving body, a work implement, a posture detection sensor, and a controller. The revolving body revolves. The work implement is attached to the revolving body and has a work tool. The posture detection sensor detects a posture of the work implement. The controller identifies an unloading point and a passing point on a route through which the work tool passes during revolution of the revolving body, based on a result of the detection by the posture detection sensor, sets, as a corrected passing point, a point shifted from the passing point to a side opposite to the unloading point, and performs a control such that the work tool passes through the corrected passing point during the revolution.

A control method for a work machine according to the present disclosure is a method of controlling a work machine including a revolving body that revolves and a work implement attached to the revolving body and having a work tool, the method including the following steps.

Based on a detection result of a posture of the work implement, an unloading point and a passing point on a route through which the work tool passes during revolution of the revolving body are identified. A position shifted from the passing point to a side opposite to the unloading point is set as a corrected passing point. A control is performed such that the work tool passes through the corrected passing point during revolution.

Advantageous Effects of Invention

According to the present disclosure, it is possible to obtain an automatic control system for a work machine and a control method for the work machine, the work machine being able to reduce interference between a work tool and a loading target.

BRIEF DESCRIPTION OF DRAWINGS

FIG. 1 is a diagram illustrating a configuration of a hydraulic excavator as an example of a work machine according to an embodiment of the present disclosure.

FIG. 2 is a diagram illustrating an operation flow of excavation and loading by a hydraulic excavator.

FIG. 3 is a perspective view illustrating a state in which a hydraulic excavator performs automatic loading.

FIG. 4 is a diagram illustrating a movement trajectory of a bucket during automatic loading control.

FIG. 5 is a block diagram illustrating an automatic control system for the hydraulic excavator of FIG. 1.

FIG. 6 is a flowchart illustrating a control method for a hydraulic excavator according to an embodiment of the present disclosure.

DESCRIPTION OF EMBODIMENTS

Hereinafter, an embodiment of the present disclosure will be described with reference to the drawings.

In the specification and the drawings, the same components or equivalent components are denoted by the same reference signs, and duplicated description are not repeated. In the drawings, configurations may be omitted or simplified for convenience of description.

In the following description, “up”, “down”, “front”, “back”, “left”, and “right” are directions with reference to an operator seated on an operator seat 4S in a cab 4 illustrated in FIG. 1.

Configuration of Work Machine

A configuration of a hydraulic excavator as an example of a work machine of the present disclosure will be described using FIG. 1.

FIG. 1 is a diagram schematically illustrating a configuration of a hydraulic excavator according to an embodiment of the present disclosure. As illustrated in FIG. 1, a hydraulic excavator 100 of the present embodiment includes a main body 1 and a work implement 2 that is operated by a hydraulic pressure. The main body 1 includes a revolving body 3 and a traveling body 5.

The traveling body 5 includes a pair of crawler belts 5Cr and a traveling motor 5M. The hydraulic excavator 100 can travel by the turn of the crawler belts 5Cr. The traveling motor 5M is provided as a driving source of the traveling body 5. The traveling motor 5M is a hydraulic motor operated by a hydraulic pressure. The traveling body 5 may include wheels (tires).

The revolving body 3 is disposed on the traveling body 5 and supported by the traveling body 5. The revolving body 3 can be revolved about a revolution axis RX with respect to the traveling body 5 by a revolving motor (not illustrated). The revolving motor is a hydraulic motor operated by a hydraulic pressure. The revolution axis RX is a virtual straight line serving as a revolution center of the revolving body 3. The traveling motor 5M or the revolving motor may be an electric motor.

The revolving body 3 includes a cab 4. An operator seat 4S on which an operator is seated is provided inside the cab 4. The operator (occupant) can be seated in the cab 4 to perform an operation of the work implement 2, a revolving operation of the revolving body 3 with respect to the traveling body 5, and a traveling operation of the hydraulic excavator 100 by the traveling body 5. The revolving body 3 includes an exterior cover 9. The exterior cover 9 covers a machine room. The hydraulic excavator 100 may be remotely operated.

The work implement 2 is supported by the revolving body 3. The work implement 2 includes a boom 6, an arm 7, and a bucket 8. The work implement 2 further includes a boom cylinder 10, an arm cylinder 11, and a bucket cylinder 12.

The boom 6 is pivotably connected to the main body 1. Specifically, a base end portion of the boom 6 is pivotably connected to the revolving body 3 with a boom foot pin 13 as a supporting point. The arm 7 is pivotably connected to the boom 6. Specifically, a base end portion of the arm 7 is pivotably connected to a leading end portion of the boom 6 with a boom top pin 14 as a supporting point. The bucket 8 is turnably connected to the arm 7. Specifically, a base end portion of the bucket 8 is pivotably connected to a leading end portion of the arm 7 with an arm top pin 15 as a supporting point. The bucket 8 may be another work tool such as a grapple. Since the overall length of a grapple varies depending on the open/close state of claws, the grapple may interfere with a loading target 200 due to a change in the state or posture of the grapple. The present disclosure can be applied to a work tool having a length in the horizontal direction varying depending on the state or posture as described above or a work implement whose relative positional relationship with the loading target 200 varies.

One end of the boom cylinder 10 is connected to the revolving body 3, and the other end is connected to the boom 6. The boom 6 can be driven relative to the main body 1 by the boom cylinder 10. By this driving, the boom 6 is pivotable in an up-down direction with respect to the revolving body 3 with the boom foot pin 13 as a supporting point.

One end of the arm cylinder 11 is connected to the boom 6, and the other end is connected to the arm 7. The arm 7 can be driven relative to the boom 6 by the arm cylinder 11. By this driving, the arm 7 is pivotable in the up-down direction or a front-back direction with respect to the boom 6 with the boom top pin 14 as a supporting point.

One end of the bucket cylinder 12 is connected to the arm 7, and the other end is connected to a bucket link 17. The bucket 8 can be driven relative to the arm 7 by the bucket cylinder 12. By this driving, the bucket 8 is pivotable in the up-down direction or the front-back direction with respect to the arm 7 with the arm top pin 15 as a supporting point.

Each of the boom cylinder 10, the arm cylinder 11, and the bucket cylinder 12 is a hydraulic cylinder driven by a hydraulic pressure, but may be another actuator such as an electric cylinder.

The hydraulic excavator 100 further includes a work implement posture sensor 20 (FIG. 5), a position and orientation sensor 21, a tilt sensor 22 (FIG. 5), and a detection sensor 23. The work implement posture sensor 20 detects a posture of the work implement 2 and outputs a posture signal indicating the posture of the work implement 2. The work implement posture sensor 20 can detect a posture of each of the boom 6, the arm 7, and the bucket 8. The work implement posture sensor 20 includes sensors disposed at each of the boom 6, the arm 7, and the bucket 8. The work implement posture sensor 20 may be any one of or any combination of an inertial measurement unit (IMU), a stroke sensor, a potentiometer, an imaging device, and the like.

The position and orientation sensor 21 is, for example, a global navigation satellite systems (GNSS) receiver. The position and orientation sensor 21 includes two GNSS receivers 21a and 21b. The two GNSS receivers 21a and 21b are installed at different positions of the revolving body 3. Each of the GNSS receivers 21a and 21b receives a satellite positioning signal indicating a position of the revolving body 3 in the global coordinate system from a satellite. The position and orientation sensor 21 outputs the received satellite positioning signal indicating the position of the revolving body 3 in the global coordinate system. The controller 50 calculates, from the satellite positioning signal, the position of the revolving body 3 in the global coordinate system and the orientation in which the revolving body 3 faces.

The position and orientation sensor 21 may include a revolution angle sensor. The revolution angle sensor is fixed to the revolving body 3, for example. The revolution angle sensor detects a revolution angle of the revolving body 3 with respect to the traveling body 5 and outputs a revolution angle signal indicating the revolution angle of the revolving body 3. The revolution angle sensor can detect a revolution angle in a machine coordinate system (local coordinate system). The revolution angle sensor may be any one of or any combination thereof an IMU, a potentiometer, an imaging device, and the like. The machine coordinate system is an orthogonal coordinate system represented by an axis extending in the front-back direction, an axis extending in a left-right direction, and an axis extending in the up-down direction (the revolution axis RX) with the revolution center of the revolving body 3 as an origin.

The tilt sensor 22 measures an acceleration and an angular velocity (revolution speed) of the revolving body 3 and, based on a result of the measurement, detects a posture (e.g., a roll angle, a pitch angle, and a yaw angle) of the revolving body 3. The tilt sensor 22 is installed, for example, on a lower surface of the revolving body 3. The tilt sensor 22 is, for example, an IMU. The tilt sensor 22 outputs a tilt signal obtained by the measurement.

The detection sensor 23 detects a landform or an object around a work site of the hydraulic excavator 100. For example, the detection sensor 23 may be attached to the cab 4, or may be attached to the exterior cover 9, or may be attached to any other member. The detection sensor 23 outputs a detection signal detected.

The detection sensor 23 is, for example, a light detection and ranging (LiDAR) that acquires information on a target object by emitting laser light. The detection sensor 23 may be a radio detection and ranging (Radar) that acquires information on a target object by emitting radio waves. The Radar may be, for example, a millimeter wave radar that detects, with a reception antenna, a state in which radio waves in a millimeter wave band emitted from a transmission antenna is reflected by a surface of an object and returns. The detection sensor 23 may be a visual sensor including a camera. Note that the detection sensor 23 may have a function of detecting a posture of the work implement 2, similarly to the work implement posture sensor 20.

The hydraulic excavator 100 further includes an instruction unit 24 (FIG. 5) and an operation unit 25 (FIG. 5). Each of the instruction unit 24 and the operation unit 25 is disposed in the cab 4. The instruction unit 24 and the operation unit 25 are manually operated by the operator who is seated in the cab 4 and output an operation command by manual driving. The instruction unit 24 is a unit for instructing a point through which the bucket 8 is to pass in an automatic loading control. The operation unit 25 is a unit for operating each of the operation, revolution, and traveling of the boom 6, the arm 7, and the bucket 8.

Operation Flow of Excavation and Loading and Automatic Loading Control

Next, an operation flow of excavation and loading of the work machine and an automatic loading control will be described using FIG. 2 to FIG. 4.

FIG. 2 is a diagram illustrating an operation flow of excavation and loading by the hydraulic excavator. FIG. 3 is a perspective view illustrating a state in which the hydraulic excavator performs automatic loading. FIG. 4 is a diagram illustrating a movement trajectory of a bucket during the automatic loading control.

As illustrated in FIG. 2 and FIG. 3, in excavation and loading by the hydraulic excavator 100, excavation is first performed (step SA). By the excavation, a load such as earth and sand is loaded in the bucket 8. After the excavation, the revolving body 3 revolves with the load loaded in the bucket 8 (step SB). This revolution is so-called loaded revolution. During the loaded revolution, the operation of the bucket 8 is controlled so as not to interfere with the loading target 200. The loading target 200 is, for example, a dump truck. The dump truck 200 includes a vessel 200A for loading a load in the bucket 8.

When the bucket 8 reaches a point at which the load in the bucket 8 is unloaded to the vessel 200A by the loaded revolution, the revolution of the revolving body 3 is stopped. Then, the load in the bucket 8 is discharged (unloaded) to the vessel 200A of the dump truck 200 (step SC). After unloading, the revolving body 3 performs return revolution to perform excavation again (step SD).

As illustrated in FIG. 3, in order to automate the loading operation, a point through which the bucket 8 passes during the loading operation needs to be identified. In this automation, the operation of the work implement 2 needs to be controlled so that the bucket 8 as a work tool does not interfere with the vessel 200A. As the point through which the bucket 8 passes during the loading operation, for example, at least a passing point (interference avoidance point) P1A, an unloading point P2, and a returning point (excavating point) P3 are identified.

The passing point P1A is a point at which the center of the arm top pin 15 in the left-right direction is positioned directly above a side edge SE of the loading target 200 (e.g., a side edge of the vessel 200A). The unloading point P2 is a point at which the center of the arm top pin 15 in the left-right direction is positioned directly above the loading target 200 (e.g., the vessel 200A). The returning point P3 is a point at which the center of the arm top pin 15 in the left-right direction is positioned directly above a point where excavation is to be performed. Here, in order to identify the passing point P1A, the unloading point P2, and the returning point P3, the points P1A, P2, and P3 are described as points at which the center of the arm top pin 15 in the left-right direction is positioned, but may be identified using another point. For example, the passing point P1A, the unloading point P2, and the returning point P3 may be identified using a point of a blade tip 8T of the bucket 8. Alternatively, for example, when the position of the loading target 200 is detected by an external sensor or the like and the instruction unit 24 is operated, the passing point P1A, the unloading point P2, and the returning point P3 may be identified by using a point on the work implement 2 at which the relative distance between the work implement 2 and the loading target 200 is the closest.

Each of the passing point P1A, the unloading point P2, and the returning point P3 is identified, for example, by the operator operating the instruction unit 24 during the revolution of the revolving body 3. Specifically, the operator operates the instruction unit 24 when the operator visually determines that the center of the arm top pin 15 in the left-right direction is positioned directly above the side edge SE of the loading target 200 (for example, the side edge of the vessel 200A) during the revolution of the revolving body 3. The operator operates the instruction unit 24 when the operator visually determines that the center of the arm top pin 15 in the left-right direction is positioned directly above a point at which the load in the bucket 8 is to be unloaded during the revolution of the revolving body 3. The operator operates the instruction unit 24 when the operator visually determines that the center of the arm top pin 15 in the left-right direction is positioned directly above a point at which excavation is to be performed during the revolution of the revolving body 3.

The coordinates of the points P1A, P2, and P3 in the machine coordinate system are calculated based on the posture of the work implement 2 and the revolution angle of the revolving body 3 at a timing at which the operator operates the instruction unit 24. As a result, the points P1A, P2, and P3 are identified. Each of the points P1A, P2, and P3 is identified, for example, during return revolution after unloading. In the automatic loading control, the operation of the work implement 2 and the revolution of the revolving body 3 are controlled such that the center of the arm top pin 15 in the left-right direction moves from the returning point P3, passes through the passing point P1A, and reaches the unloading point P2.

The passing point P1A is identified such that the bucket 8 does not interfere with the loading target 200. However, depending on the movement trajectory of the bucket 8, the bucket 8 may interfere with the loading target 200. Specifically, as illustrated in FIG. 4, in the automatic loading control, the center of the arm top pin 15 in the left-right direction moves from the returning point P3, passes through the passing point P1A, and reaches the unloading point P2. At this time, the movement trajectory from the returning point P3 to the passing point P1A is not identified. Or, even when the movement trajectory from the returning point P3 to the passing point P1A is identified, a variation in control may occur. For this reason, the passing point P1A may be reached from the returning point P3 along a movement trajectory R1, or the passing point P1A may be reached from the returning point P3 along a movement trajectory R2. For example, when the weight of a load loaded in the bucket 8 is large, there is a high tendency that the movement trajectory R2 is followed rather than the movement trajectory R1. When the bucket 8 moves along the movement trajectory R2 as described above, the bucket 8 may interfere with the loading target 200 (vessel 200A).

Therefore, in the present disclosure, the passing point P1A is calibrated to a corrected passing point P1B so that the bucket 8 does not interfere with the loading target 200, regardless of the movement trajectory from the returning point P3 to the passing point during the automatic loading control. An automatic control system for the work machine and a control method for the work machine that calibrate the passing point P1A to the corrected passing point P1B will be described.

Automatic Control System for Work Machine

First, a configuration of an automatic control system according to the present embodiment will be described using FIG. 5.

FIG. 5 is a block diagram illustrating an automatic control system for the hydraulic excavator in the present disclosure. As illustrated in FIG. 5, the automatic control system includes a controller 50. The controller 50 includes a processor, a main memory, and a storage unit 53. The processor is, for example, a central processing unit (CPU). The main memory includes, for example, a non-volatile memory such as a read only memory (ROM) and a volatile memory such as a random access memory (RAM). The controller 50 reads a program stored in the storage unit 53, loads the program into the main memory, and executes predetermined processing in accordance with the program.

The controller 50 includes an instruction point identification unit 51, a corrected passing point calculation unit 52, a storage unit 53, and an EPC valve control unit 54.

The instruction point identification unit 51 acquires a posture signal output from the work implement posture sensor 20. The instruction point identification unit 51 acquires a satellite positioning signal and a revolution angle signal output from the position and orientation sensor 21. The instruction point identification unit 51 acquires a tilt signal output from the tilt sensor 22. The instruction point identification unit 51 acquires a detection signal output from the detection sensor 23. The instruction point identification unit 51 acquires an instruction signal output from the instruction unit 24.

The instruction point identification unit 51 identifies the coordinates of a point through which the bucket is to pass in the automatic loading control. Specifically, the instruction point identification unit 51 calculates the coordinates of the center position of the arm top pin 15 in the left-right direction at a timing at which an instruction signal is acquired from the instruction unit 24.

When the operator operates the instruction unit 24 for the purpose of acquiring the passing point P1A, the coordinates of the center position of the arm top pin 15 in the left-right direction at a timing at which the instruction unit 24 is operated are calculated by a passing point identification unit 51A as the coordinates of the passing point P1A. When the operator operates the instruction unit 24 for the purpose of acquiring the unloading point P2, the coordinates of the center position of the arm top pin 15 in the left-right direction at a timing at which the instruction unit 24 is operated are calculated by an unloading point identification unit 51B as the coordinates of the unloading point P2. When the operator operates the instruction unit 24 for the purpose of acquiring the returning point P3, the coordinates of the center position of the arm top pin 15 in the left-right direction at a timing at which the instruction unit 24 is operated are calculated by a returning point identification unit 51C as the coordinates of the returning point P3.

The coordinates of each of the points P1A, P2, and P3 are calculated based on a signal acquired from each of the work implement posture sensor 20, the position and orientation sensor 21, and the tilt sensor 22. At this time, the instruction point identification unit 51 may refer to dimensions and the like, stored in the storage unit 53, of each component of the work implement 2. The instruction point identification unit 51 outputs coordinate signals of the identified passing point P1A, unloading point P2, and returning point P3 to the corrected passing point calculation unit 52.

Although the passing point identification unit 51A, the unloading point identification unit 51B, and the returning point identification unit 51C are illustrated separately from each other in the drawing, the passing point identification unit 51A, the unloading point identification unit 51B, and the returning point identification unit 51C are not necessarily separated from each other and may be the same part. That is, the points P1A, P2, and P3 may be identified by the same part of the instruction point identification unit 51. The instruction point identification unit 51 may output the coordinate signals of the identified unloading point P2 and returning point P3, not to the corrected passing point calculation unit 52, but directly to the EPC valve control unit 54.

The corrected passing point calculation unit 52 acquires the coordinate signal of the passing point P1A from the passing point identification unit 51A. The corrected passing point calculation unit 52 calibrates the acquired coordinates of the passing point P1A to a corrected passing point P1B.

As illustrated in FIG. 4, the calibration of the coordinates of the passing point P1A is performed by setting a position shifted by a distance L from the passing point P1A to a side opposite to the unloading point P2 as a corrected passing point P1B and calculating the coordinates of the corrected passing point P1B.

The distance L for the position shifting is, for example, equal to or greater than half (W/2) a width W (FIG. 1) of the bucket 8 in the left-right direction. Accordingly, the bucket 8 is further prevented from interfering with the loading target 200.

The corrected passing point P1B is set at a position shifted from the passing point P1A in a horizontal direction in a machine coordinate system (local coordinate system) based on the hydraulic excavator 100. Specifically, when the hydraulic excavator 100 is disposed on a horizontal plane in a global coordinate system, a horizontal direction in the global coordinate system and a horizontal direction in the machine coordinate system coincide with each other. Thus, in this case, the corrected passing point P1B is set at a position shifted from the passing point P1A in the horizontal direction of the machine coordinate system which is the same as the horizontal direction of the global coordinate system.

On the other hand, when the hydraulic excavator 100 is disposed on an inclined plane inclined with respect to a horizontal plane in the global coordinate system, a horizontal direction in the global coordinate system and a horizontal direction in the machine coordinate system do not coincide with each other. Thus, in this case, the corrected passing point P1B is set at a position shifted by the distance L from the passing point P1A, for example, to a side opposite to the unloading point P2 in the horizontal direction of the machine coordinate system different from the horizontal direction of the global coordinate system.

As illustrated in FIG. 5, when calculating the corrected passing point P1B, the corrected passing point calculation unit 52 refers to the shape data of the bucket 8 stored in the storage unit 53, and the like. The storage unit 53 stores dimensions of each component of the work implement 2, and the like.

Various types of information are input to the storage unit 53 from the input device 26. The input device 26 may be a touch panel, a keyboard, or the like. The input device 26 may be mounted on the hydraulic excavator 100, or may be located away from the hydraulic excavator 100 and connected to the controller 50 in a wired or wireless manner. In addition, the shape data of the bucket 8 (work tool) and the like may be stored in advance in the storage unit 53, or may be transmitted from the outside to the storage unit 53 in a wireless manner by the input device 26.

The corrected passing point calculation unit 52 outputs signals indicating the respective coordinates of the corrected passing point P1B calculated as above, the unloading point P2, and the returning point P3 to the EPC valve control unit 54. The EPC valve control unit 54 controls an EPC valve 28, based on the acquired signals indicating the coordinates of the corrected passing point P1B, the unloading point P2, and the returning point P3.

The EPC valve 28 controls a hydraulic valve 30, based on a command current from the EPC valve control unit 54 of the controller 50. Accordingly, the EPC valve 28 controls the supply of oil pumped up from an oil tank (not illustrated) by a hydraulic pump 27 to an actuator 29. The actuator 29 is, for example, a hydraulic actuator, such as the boom cylinder 10, the arm cylinder 11, the bucket cylinder 12, and the revolving motor.

The EPC valve 28 is controlled by the EPC valve control unit 54, whereby each of the hydraulic actuators is controlled such that the center of the arm top pin 15 in the left-right direction moves from the returning point P3, passes through the corrected passing point P1B, and reaches the unloading point P2 in the automatic loading control. As a result, the automatic loading control in which interference between the bucket 8 and the loading target 200 is prevented becomes available.

The EPC valve control unit 54 acquires an operation signal from the operation unit 25. The EPC valve control unit 54 may control the EPC valve 28, based on an operation command for manual driving output from the operation unit 25. Accordingly, the operation of the work implement 2 and the revolution of the revolving body 3 can be performed through manual driving by the operator. As a result, the operator can move the work implement to positions corresponding to the passing point P1A, the unloading point P2, and the returning point P3.

A series of excavation and loading operations illustrated in FIG. 2 may be fully automated based on the detection signal of the detection sensor 23. The detection sensor 23 detects a situation and an object around the hydraulic excavator 100, so that a relative positional relationship between the hydraulic excavator 100 and an excavating point or the loading target 200 can be detected. Thus, each of the passing point P1A, the unloading point P2, and the returning point P3 can also be automatically identified during automatic returning revolution SD (FIG. 2). In addition, the detection sensor 23 detects the landform around the hydraulic excavator 100 or the like, so that excavation SA (FIG. 2) can also be automatically performed.

Accordingly, in combination with the automatic loading control, the series of excavation and loading operations can be fully automated.

Each of the controller 50, the instruction unit 24, the operation unit 25, and the input device 26 may be mounted on the hydraulic excavator 100, or may be disposed outside and away from the hydraulic excavator 100. When each of the controller 50, the instruction unit 24, the operation unit 25, and the input device 26 is disposed outside and away from the hydraulic excavator 100, each of the controller 50, the instruction unit 24, the operation unit 25, and the input device 26 may be connected to the various sensors 20 to 23, the EPC valve 28, and the like in a wireless manner. The controller 50 may be stored in a server away from the hydraulic excavator 100. When the operation unit 25 is away from the hydraulic excavator 100, the operator may remotely operate the hydraulic excavator 100 without being seated in the cab 4 of the hydraulic excavator 100.

Control Method for Work Machine

Next, a control method for a work machine according to the present embodiment will be described using FIG. 5 and FIG. 6.

FIG. 6 is a flowchart illustrating a control method for a hydraulic excavator according to an embodiment of the present disclosure. As illustrated in FIG. 5 and FIG. 6, the instruction point identification unit 51 of the controller 50 acquires a posture signal (work implement posture information) output from the work implement posture sensor 20 (step S1: FIG. 6). The instruction point identification unit 51 of the controller 50 acquires a satellite positioning signal and a revolution angle signal (revolution angle information) output from the position and orientation sensor 21 (step S2: FIG. 6). The instruction point identification unit 51 of the controller 50 acquires a tilt signal output from the tilt sensor 22. The instruction point identification unit 51 of the controller 50 acquires a detection signal output from the detection sensor 23. The instruction point identification unit 51 of the controller 50 acquires an instruction signal output from the instruction unit 24.

The instruction point identification unit 51 of the controller 50 identifies the coordinates of a point through which the bucket 8 is to pass in the automatic loading control. Specifically, the instruction point identification unit 51 calculates the coordinates of the center position of the arm top pin 15 in the left-right direction at a timing at which an instruction signal is acquired from the instruction unit 24.

When the operator determines that the center of the arm top pin 15 in the left-right direction is positioned directly above a side edge of the loading target 200 and operates the instruction unit 24 or when the detection sensor 23 determines that the center of the arm top pin 15 in the left-right direction is positioned directly above a side edge of the loading target 200, the coordinates of the center position of the arm top pin 15 in the left-right direction at that timing are calculated by the passing point identification unit 51A as the coordinates of the passing point P1A. As a result, the passing point P1A is identified (step S3: FIG. 6).

When the operator determines that the center of the arm top pin 15 in the left-right direction is positioned directly above a point at which a load is to be unloaded and operates the instruction unit 24 or when the detection sensor 23 determines that the center of the arm top pin 15 in the left-right direction is positioned directly above a point at which a load is to be unloaded, the coordinates of the center position of the arm top pin 15 in the left-right direction at that timing are calculated by the unloading point identification unit 51B as the coordinates of the unloading point P2. As a result, the unloading point P2 is identified.

When the operator determines that the center of the arm top pin 15 in the left-right direction is positioned directly above a point at which excavation is to be performed and operates the instruction unit 24 or when the detection sensor 23 determines that the center of the arm top pin 15 in the left-right direction is positioned directly above a point at which excavation is to be performed, the coordinates of the center position of the arm top pin 15 in the left-right direction at that timing are calculated by the returning point identification unit 51C as the coordinates of the returning point P3. As a result, the returning point P3 is identified.

The instruction point identification unit 51 outputs coordinate signals of the identified passing point P1A, unloading point P2, and returning point P3 to the corrected passing point calculation unit 52. The instruction point identification unit 51 may output the coordinate signals of the identified unloading point P2 and returning point P3, not to the corrected passing point calculation unit 52, but directly to the EPC valve control unit 54.

The corrected passing point calculation unit 52 acquires the coordinate signal of the passing point P1A from the passing point identification unit 51A and calibrates the acquired coordinates of the passing point P1A to the corrected passing point P1B. That is, the corrected passing point calculation unit 52 of the controller 50 calculates the corrected passing point P1B obtained by correcting the passing point P1A (step S4: FIG. 6).

As described above using FIG. 4, the calibration of the coordinates of the passing point P1A is performed by setting a position shifted by the distance L from the passing point P1A to a side opposite to the unloading point P2 as the corrected passing point P1B and calculating the coordinates of the corrected passing point P1B.

The corrected passing point calculation unit 52 outputs signals indicating the respective coordinates of the corrected passing point P1B calculated as above, the unloading point P2, and the returning point P3 to the EPC valve control unit 54. The EPC valve control unit 54 controls the EPC valve 28, based on the acquired signals indicating the coordinates of the corrected passing point P1B, the unloading point P2, and the returning point P3.

The EPC valve 28 is controlled by the EPC valve control unit 54, whereby each of the hydraulic actuators is controlled such that the center of the arm top pin 15 in the left-right direction moves from the returning point P3, passes through the corrected passing point P1B, and reaches the unloading point P2 in the automatic loading control (step S5: FIG. 6). As a result, the automatic loading control in which interference between the bucket 8 and the loading target 200 is prevented becomes available.

Effects

Next, the effects of the present embodiment will be described.

In the present embodiment, as illustrated in FIG. 4, a position shifted from the passing point P1A to a side opposite to the unloading point P2 is set as a corrected passing point P1B, and the coordinates of the corrected passing point P1B are calculated. Then, the operation of the work implement 2 is controlled so as to pass through the corrected passing point P1B during revolution. Accordingly, interference between the bucket 8 and the loading target 200 can be prevented in the automatic loading control.

In addition, in the present embodiment, as illustrated in FIG. 4, a position shifted from the passing point P1A to a side opposite to the unloading point P2 by half (W/2) the width W (FIG. 1) of the bucket 8 in the left-right direction is set as the corrected passing point P1B.

Accordingly, interference between the bucket 8 and the loading target 200 can be further prevented in the automatic loading control.

Further, in the present embodiment, a position shifted from the passing point P1A in the horizontal direction in a machine coordinate system based on the hydraulic excavator 100 is set as the corrected passing point P1B. Accordingly, even when the hydraulic excavator 100 is disposed on an inclined plane inclined with respect to a horizontal plane in a global coordinate system, interference between the bucket 8 and the loading target 200 can be prevented in the automatic loading control.

In the present embodiment, as illustrated in FIG. 5, the automatic control system includes the operation unit 25 that outputs an operation command for manual driving to drive the actuator 29, and the instruction unit 24 that instructs the passing point P1A when the operation command is output to operate the work implement 2. Accordingly, the operator can operate the work implement 2 and the revolving body 3 by manual driving to identify the passing point P1A.

It should be understood that the embodiment disclosed herein is illustrative in all respects and is not restrictive. The scope of the present invention is defined by the terms of the claims, rather than the description above, and is intended to include any modifications within the scope and meaning equivalent to the terms of the claims.

REFERENCE SIGNS LIST

1 Main body; 2 Work implement; 3 Revolving body; 4 Cab; 4S Operator seat; 5 Traveling body; 5Cr Crawler belt; 5M Traveling motor; 6 Boom; 7 Arm; 8 Bucket; 9 Exterior cover; 10 Boom cylinder; 11 Arm cylinder; 12 Bucket cylinder; 13 Boom foot pin; 14 Boom top pin; 15 Arm top pin; 17 Bucket link; 20 Work implement posture sensor; 21 Position and orientation sensor; 21a Receiver; 22 Tilt sensor; 23 Detection sensor; 24 Instruction unit; 25 Operation unit; 26 Input device; 27 Hydraulic pump; 28 EPC valve; 29 Actuator; 50 Controller; 51 Instruction point identification unit; 51A Passing point identification unit; 51B Unloading point identification unit; 51C Returning point identification unit; 52 Corrected passing point calculation unit; 53 Storage unit; 54 EPC valve control unit; 100 Hydraulic excavator; 200 Loading target; 200A vessel; P1A Passing point; P1B Corrected passing point; P2 Unloading point; P3 Returning point; R1, R2 Movement trajectory; RX Revolution axis; SE Side edge.

Claims

1. An automatic control system for a work machine, comprising:

a revolving body configured to revolve;

a work implement attached to the revolving body and having a work tool;

a posture detection sensor configured to detect a posture of the work implement; and

a controller configured to:

identify an unloading point and a passing point on a route through which the work tool passes during revolution of the revolving body, based on a result of the detection by the posture detection sensor;

set, as a corrected passing point, a position shifted from the passing point to a side opposite to the unloading point; and

perform control such that the work tool passes through the corrected passing point during the revolution.

2. The automatic control system for a work machine according to claim 1, wherein the controller is configured to set, as the corrected passing point, a position shifted from the passing point to a side opposite to the unloading point by half a width of the work tool.

3. The automatic control system for a work machine according to claim 1, wherein the controller is configured to set, as the corrected passing point, a position shifted from the passing point in a horizontal direction in a machine coordinate system based on the work machine.

4. The automatic control system for a work machine according to claim 1, wherein a point located above a side edge of a loading target is identified as the passing point on a route through which the work tool passes during the revolution of the revolving body.

5. The automatic control system for a work machine according to claim 1, further comprising:

an actuator configured to drive the work implement;

an operation unit configured to output an operation command for manual driving to drive the actuator; and

an instruction unit configured to instruct the passing point when the operation command is output to operate the work implement.

6. A control method for a work machine, the work machine comprising:

a revolving body configured to revolve; and

a work implement attached to the revolving body and having a work tool, the control method comprising:

identifying an unloading point and a passing point on a route through which the work tool passes during revolution of the revolving body, based on a detection result of a posture of the work implement;

setting, as a corrected passing point, a position shifted from the passing point to a side opposite to the unloading point in a top view, and

performing control such that the work tool passes through the corrected passing point during the revolution.

7. The control method for a work machine according to claim 6, the method comprising, in the identifying, the passing point is identified based on a detection result of a posture of the work implement when an operation signal based on a manual operation is input.