Work machine, method and system

Abstract

To provide a working machine, a method and a system controlling the working machine to move a tilt bucket along a designed target surface.SOLUTION: A distance calculation section calculates a first distance between a first bucket point on a bucket and a designed target surface representing a target shape of an object to be excavated. The distance calculation section calculates a second distance between the designed target surface and a second bucket point on the bucket on a straight line passing through the first bucket point and parallel to a blade tip of the bucket. A tilt control section calculates a tilt control amount to rotate the bucket around a tilt shaft through comparison between the first distance and the second distance.SELECTED DRAWING: Figure 7

Description

[Technical field]

[0001] The present disclosure relates to a work machine control system, a work machine, and a method for controlling a work machine. [Background technology]

[0002] A tilt bucket that can be attached to a hydraulic excavator and has an adjustable angle relative to the operating plane of the work machine is known (see, for example, Patent Document 1). The tilt bucket is configured to be rotatable around a bucket axis that is perpendicular to the operating plane, and also rotatable around a tilt axis that is perpendicular to the bucket axis. [Prior art documents] [Patent documents]

[0003] [Patent Document 1] JP 2014-74319 A Summary of the Invention [Problem to be solved by the invention]

[0004] Meanwhile, in a work machine such as a hydraulic excavator, a technique is known for automatically controlling the work machine so that the bucket moves along a target design surface that indicates a target shape of an excavation target. In the tilt bucket disclosed in Patent Document 1, it is desired to automatically control the work machine so that the tilt bucket moves along the target design surface. An object of the present disclosure is to provide a work machine control system, a work machine, and a control method for a work machine that automatically controls the work machine so that the tilt bucket moves along a target design surface. [Means for solving the problem]

[0005] According to one aspect, a control system for a work machine includes a boom rotatable around a boom axis, an arm rotatable around an arm axis parallel to the boom axis, and a bucket rotatable around a bucket axis parallel to the arm axis and rotatable around a tilt axis perpendicular to the bucket axis, and includes a distance calculation unit that calculates a first distance that is a distance between a first bucket point that is a point on the bucket and a target design surface that indicates a target shape of an excavation object, and a second distance that is a distance between a second bucket point that is a point on the bucket on a straight line that passes through the first bucket point and is parallel to the blade tip of the bucket, and the target design surface, and a tilt control unit that calculates a tilt control amount for rotating the bucket around the tilt axis based on at least the larger value of the first distance and the second distance. Effect of the Invention

[0006] According to the above aspect, the control system of the work machine can automatically control the work machine so that the tilt bucket moves along the target design surface. [Brief description of the drawings]

[0007] [Figure 1] 3A and 3B are diagrams illustrating examples of attitudes of a work machine and a work implement. [Diagram 2] 1 is a schematic diagram showing the configuration of a work machine according to a first embodiment. [Diagram 3] FIG. 2 is a front view showing the configuration of the bucket according to the first embodiment. [Figure 4] FIG. 2 is a diagram showing the internal configuration of a driver's cab according to the first embodiment. [Diagram 5] 1 is a schematic block diagram showing a configuration of a control device according to a first embodiment. [Figure 6] 5 is a flowchart showing the operation of the control device according to the first embodiment. [Figure 7] FIG. 13 is a diagram showing the relationship between a target design surface and points on the cutting edge in automatic tilt control. [Figure 8]5 is a diagram showing an example of a tilt function indicating a relationship between a distance difference of a bucket and a target value of a tilt angular velocity according to the first embodiment. FIG. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0008] <Coordinate System> FIG. 1 is a diagram showing examples of postures of a work machine 100 and a work implement 150. As shown in FIG. In the following description, a three-dimensional site coordinate system (Xg, Yg, Zg) and a three-dimensional vehicle body coordinate system (Xm, Ym, Zm) are defined, and positional relationships are described based on these.

[0009] The on-site coordinate system is a coordinate system that is configured with an Xg axis extending north-south, a Yg axis extending east-west, and a Zg axis extending vertically, with the position of a Global Navigation Satellite System (GNSS) reference station installed at the construction site as the reference point. An example of the GNSS is the Global Positioning System (GPS). In other embodiments, a global coordinate system represented by latitude and longitude may be used instead of the on-site coordinate system. The vehicle body coordinate system is a coordinate system that is based on a representative point O defined on the rotating unit 130 of the work machine 100 and is composed of an Xm axis extending forward and backward, a Ym axis extending left and right, and a Zm axis extending up and down when viewed from the seating position of the operator in the cab 170 described below. Based on the representative point O of the rotating unit 130, the front is called the +Xm direction, the rear is called the -Xm direction, the left is called the +Ym direction, the right is called the -Ym direction, the upward direction is called the +Zm direction, and the downward direction is called the -Zm direction. The site coordinate system and the vehicle body coordinate system can be converted between each other by specifying the position and inclination of the work machine 100 in the site coordinate system.

[0010] First embodiment Configuration of the work machine 100 FIG. 2 is a schematic diagram showing the configuration of a work machine 100 according to the first embodiment. The work machine 100 operates at a construction site and excavates earth and sand, etc. The work machine 100 according to the first embodiment is a hydraulic excavator. The work machine 100 includes a running body 110, a rotating body 130, a work implement 150, a cab 170, and a control device 190. The running body 110 supports the work machine 100 so that it can run. The running body 110 is, for example, a pair of left and right caterpillars. The rotating body 130 is supported on the running body 110 so that it can rotate around a rotation center. The work machine 150 is hydraulically driven. The work machine 150 is supported on the front part of the rotating body 130 so that it can be driven in the vertical direction. The cab 170 is a space where an operator boards and operates the work machine 100. The cab 170 is provided on the front part of the rotating body 130. The control device 190 controls the running body 110, the rotating body 130, and the work machine 150 based on the operation of the operator. The control device 190 is provided inside the cab 170, for example.

[0011] Configuration of the rotating body 130 As shown in FIG. 2, the rotating body 130 includes a position and orientation detector 131 and an inclination detector 132 .

[0012] The position and orientation detector 131 calculates the position of the revolving body 130 in the on-site coordinate system and the orientation in which the revolving body 130 faces. The position and orientation detector 131 includes two antennas that receive positioning signals from satellites that constitute the GNSS. The two antennas are installed at different positions on the revolving body 130. For example, the two antennas are provided on the counterweight portion of the revolving body 130. The position and orientation detector 131 detects the position of the representative point O of the revolving body 130 in the on-site coordinate system based on the positioning signal received by at least one of the two antennas. The position and orientation detector 131 detects the orientation in which the revolving body 130 faces in the on-site coordinate system using the positioning signals received by each of the two antennas.

[0013] The inclination detector 132 measures the acceleration and angular velocity of the rotating body 130, and detects the inclination of the rotating body 130 (for example, roll representing rotation about the Xm axis and pitch representing rotation about the Ym axis) based on the measurement results. The inclination detector 132 is installed, for example, below the operator's cab 170. An example of the inclination detector 132 is an IMU (Inertial Measurement Unit).

[0014] Configuration of the work machine 150 As shown in FIG. 2, the work machine 150 includes a boom 151, an arm 152, a first link 153, a second link 154, and a bucket 155.

[0015] A base end of the boom 151 is attached to the revolving body 130 via a boom pin P1. Hereinafter, the central axis of the boom pin P1 will be referred to as a boom axis X1. The arm 152 connects the boom 151 and the bucket 155. The base end of the arm 152 is attached to the tip of the boom 151 via an arm pin P2. Hereinafter, the central axis of the arm pin P2 will be referred to as an arm axis X2. A first end of the first link 153 is attached to a side surface on the tip side of the arm 152 via a first link pin P3. A second end of the first link 153 is attached to a first end of the second link 154 via a bucket cylinder pin P4. Bucket 155 has a cutting edge for excavating soil and sand, and a storage section for storing excavated soil. A base end of bucket 155 is attached to a tip of arm 152 via bucket pin P5. Hereinafter, the central axis of bucket pin P5 will be referred to as bucket axis X3. In addition, a base end of bucket 155 is attached to a second end of second link 154 via second link pin P6. The boom axis X1, the arm axis X2, and the bucket axis X3 are parallel to each other.

[0016] The work machine 150 includes a plurality of hydraulic cylinders that are actuators that generate power. Specifically, the work machine 150 includes a boom cylinder 156, an arm cylinder 157, and a bucket cylinder 158. The boom cylinder 156 is a hydraulic cylinder for driving the boom 151. A base end of the boom cylinder 156 is attached to the revolving body 130. A tip end of the boom cylinder 156 is attached to the boom 151. A boom cylinder stroke sensor 1561 that detects the stroke amount of the boom cylinder 156 is provided to the boom cylinder 156. The arm cylinder 157 is a hydraulic cylinder for driving the arm 152. A base end of the arm cylinder 157 is attached to the boom 151. A tip end of the arm cylinder 157 is attached to the arm 152. The arm cylinder 157 is provided with an arm cylinder stroke sensor 1571 that detects the stroke amount of the arm cylinder 157. The bucket cylinder 158 is a hydraulic cylinder for driving the bucket 155. A base end of the bucket cylinder 158 is attached to the arm 152. A tip end of the bucket cylinder 158 is attached to the second end of the first link 153 and the first end of the second link 154 via the second link pin P6. The bucket cylinder 158 is provided with a bucket cylinder stroke sensor 1581 that detects the stroke amount of the bucket cylinder 158.

[0017] <<Bucket 155 Configuration>> FIG. 3 is a front view showing the configuration of the bucket 155 according to the first embodiment. The bucket 155 according to the first embodiment is a tilt bucket that is rotatable about a tilt axis X4 that is an axis perpendicular to the bucket axis X3. As shown in FIG. 3, the bucket 155 includes a bucket body 161 , a joint 162 , and a tilt cylinder 163 .

[0018] A front bracket 1621 having an attachment hole for attaching the arm 152 via the bucket pin P5 and a rear bracket 1622 having an attachment hole for attaching the second link 154 via the second link pin P6 are provided at the base end of the joint 162. That is, the attachment hole of the front bracket 1621 is provided so as to pass through the bucket axis X3. The tip end of the joint 162 is attached to the base end of the bucket body 161 via a tilt pin P7. The tilt pin P7 is provided so as to be perpendicular to the bucket axis X3. The central axis of the tilt pin P7 forms the tilt axis X4.

[0019] A tilt bracket 1611 for mounting a tilt cylinder 163 is provided at one end (left end or right end) of the base end of the bucket body 161. The tilt cylinder 163 is a hydraulic cylinder for rotating the bucket body 161 around the tilt axis X4. The base end of the tilt cylinder 163 is attached to the tilt bracket 1611 via a tilt cylinder end pin P8. The tip end of the tilt cylinder 163 is attached to the joint 162 via a tilt cylinder top pin P9. The tilt cylinder end pin P8 and the tilt cylinder top pin P9 are each provided in parallel to the tilt pin P7. As a result, the bucket body 161 rotates around the tilt axis X4 by driving the tilt cylinder 163. The tilt cylinder 163 is provided with a tilt cylinder stroke sensor 1631 that detects the stroke amount of the tilt cylinder 163 .

[0020] <Configuration of the cab 170> FIG. 4 is a diagram showing the internal configuration of the operator's cab according to the first embodiment. As shown in FIG. 4, in the driver's cab 170, a driver's seat 171, an operating device 172, and a control device 190 are provided.

[0021] The operation device 172 is an interface for driving the traveling body 110, the rotating body 130, and the work machine 150 by manual operation by an operator. The operation device 172 includes a left operation lever 1721, a right operation lever 1722, a left foot pedal 1723, a right foot pedal 1724, a left traveling lever 1725, and a right traveling lever 1726.

[0022] The left operating lever 1721 is provided on the left side of the driver's seat 171. The right operating lever 1722 is provided on the right side of the driver's seat 171.

[0023] The left operation lever 1721 is an operation mechanism for performing the rotational movement of the rotating body 130 and the pulling and pushing movements of the arm 152. Specifically, when the operator tilts the left operation lever 1721 forward, the arm cylinder 157 is driven and the arm 152 is pushed. When the operator tilts the left operation lever 1721 backward, the arm cylinder 157 is driven and the arm 152 is pulled. When the operator tilts the left operation lever 1721 to the right, the rotating body 130 rotates to the right. When the operator tilts the left operation lever 1721 to the left, the rotating body 130 rotates to the left.

[0024] The right operation lever 1722 is an operation mechanism for performing the excavation operation and dump operation of the bucket 155, and the lifting operation and lowering operation of the boom 151. Specifically, when the operator tilts the right operation lever 1722 forward, the boom cylinder 156 is driven to perform the lowering operation of the boom 151. When the operator tilts the right operation lever 1722 backward, the boom cylinder 156 is driven to perform the lifting operation of the boom 151. When the operator tilts the right operation lever 1722 to the right, the bucket cylinder 158 is driven to perform the dumping operation of the bucket 155. When the operator tilts the right operation lever 1722 to the left, the bucket cylinder 158 is driven to perform the excavation operation of the bucket 155. Note that the relationship between the operation directions of the left operation lever 1721 and the right operation lever 1722 and the operation direction of the work implement 150 and the rotation direction of the rotating body 130 does not have to be the above-mentioned relationship.

[0025] In addition, a tilt operation button (not shown) is provided on the upper part of the right operation lever 1722. Specifically, when the operator slides the tilt operation button leftward, the tilt cylinder 163 is actuated, and the bucket 155 is tilted and rotated leftward as seen by the operator. When the operator slides the tilt operation button rightward, the tilt cylinder 163 is actuated, and the bucket 155 is tilted and rotated rightward as seen by the operator. The tilt operation button may be configured to rotate left and right. In addition, the tilt operation may be realized by the operator operating a pedal (not shown).

[0026] The left foot pedal 1723 is disposed on the left side of the floor surface in front of the driver's seat 171. The right foot pedal 1724 is disposed on the right side of the floor surface in front of the driver's seat 171. The left travel lever 1725 is pivotally supported by the left foot pedal 1723 and configured so that the tilt of the left travel lever 1725 and the depression of the left foot pedal 1723 are linked. The right travel lever 1726 is pivotally supported by the right foot pedal 1724 and configured so that the tilt of the right travel lever 1726 and the depression of the right foot pedal 1724 are linked.

[0027] The left foot pedal 1723 and the left travel lever 1725 correspond to the rotational drive of the left track of the running body 110. Specifically, when the driving wheels of the running body 110 are at the rear, when the operator tilts the left foot pedal 1723 or the left travel lever 1725 forward, the left track rotates in the forward direction. Conversely, when the operator tilts the left foot pedal 1723 or the left travel lever 1725 backward, the left track rotates in the reverse direction.

[0028] The right foot pedal 1724 and the right running lever 1726 correspond to the rotational drive of the right track of the running body 110. Specifically, when the driving wheels of the running body 110 are in the rear, when the operator pushes the right foot pedal 1724 or the right running lever 1726 forward, the right track rotates in the forward direction. Conversely, when the operator pushes the right foot pedal 1724 or the right running lever 1726 backward, the right track rotates in the reverse direction.

[0029] Configuration of the control device 190 The control device 190 limits the movement of the bucket 155 in a direction approaching the excavation target so that the bucket 155 does not enter a target design surface set at the construction site. The target design surface indicates a target shape of the excavation target. The control device 190 limiting the movement of the bucket 155 based on the target design surface is also called intervention control.

[0030] The following describes the intervention control when the operator performs ground leveling work at a construction site by only pulling the arm 152. When the distance between the bucket 155 and the target design surface becomes less than a predetermined intervention control distance, the control device 190 generates an operation signal for the boom cylinder 156 so that the bucket 155 does not intrude into the target design surface according to the distance between the blade tip of the bucket 155 and the target design surface as the arm 152 moves. As a result, when the operator only operates the operation of the arm 152, the control device 190 generates an operation signal for the boom cylinder 156 to automatically raise the boom 151, thereby restricting the operation of the bucket 155 and automatically preventing the blade tip of the bucket 155 from intruding into the design surface. Note that in other embodiments, the control device 190 may generate a control command for the arm cylinder 157 or a control command for the bucket cylinder 158 in the intervention control. That is, in other embodiments, the speed of the bucket 155 may be limited by raising the arm 152 in the intervention control, or the speed of the bucket 155 may be directly limited.

[0031] Furthermore, when the distance between the bucket 155 and the target design surface becomes less than a predetermined tilt control distance, the control device 190 rotates the bucket 155 about the tilt axis X4 so that the cutting edge of the bucket 155 and the target design surface become parallel. Rotating the bucket 155 about the tilt axis X4 by the control device 190 based on the target design surface is also referred to as automatic tilt control.

[0032] 5 is a schematic block diagram showing the configuration of a control device 190 according to the first embodiment. The control device 190 is a computer including a processor 210, a main memory 230, a storage 250, and an interface 270.

[0033] The storage 250 is a non-transitory tangible storage medium. Examples of the storage 250 include a magnetic disk, an optical disk, a magneto-optical disk, and a semiconductor memory. The storage 250 may be an internal medium directly connected to the bus of the control device 190, or may be an external medium connected to the control device 190 via the interface 270 or a communication line. The storage 250 stores a program for controlling the work machine 100.

[0034] The program may be for realizing a part of the functions to be performed by the control device 190. For example, the program may be for realizing the functions by combining with other programs already stored in the storage 250 or by combining with other programs implemented in other devices. In other embodiments, the control device 190 may include a custom LSI (Large Scale Integrated Circuit) such as a PLD (Programmable Logic Device) in addition to or instead of the above configuration. Examples of PLDs include PAL (Programmable Array Logic), GAL (Generic Array Logic), CPLD (Complex Programmable Logic Device), and FPGA (Field Programmable Gate Array). In this case, some or all of the functions realized by the processor may be realized by the integrated circuit.

[0035] The storage 250 stores design surface data indicating a target design surface in advance. The design surface data is three-dimensional data expressed in a site coordinate system and is represented by a plurality of triangular polygons. Each of the triangular polygons constituting the design surface data has a common side with other adjacent triangular polygons. In other words, the design surface data represents a continuous plane composed of a plurality of planes. Note that in other embodiments, the design surface data may be composed of polygonal surfaces other than triangular polygons, and may be represented in other formats such as point cloud data. In the present embodiment, the design surface data is stored in the storage 250, but this is not limited to the above. The design surface data may be downloaded from an external memory or a server (not shown) via a communication line (not shown).

[0036] By executing a program, the processor 210 functions as a detection value acquisition unit 211, a bucket position identification unit 212, a target plane determination unit 213, a distance calculation unit 214, an operation amount acquisition unit 215, an intervention control unit 216, a tilt control unit 217, and an output unit 218.

[0037] The detection value acquisition unit 211 acquires the detection values ​​of the boom cylinder stroke sensor 1561, the arm cylinder stroke sensor 1571, the bucket cylinder stroke sensor 1581, the tilt cylinder stroke sensor 1631, the position and orientation detector 131, and the inclination detector 132. In other words, the detection value acquisition unit 211 acquires the position of the revolving body 130 in the site coordinate system, the orientation in which the revolving body 130 faces, the inclination of the revolving body 130, the stroke length of the boom cylinder 156, the stroke length of the arm cylinder 157, the stroke length of the bucket cylinder 158, and the stroke length of the tilt cylinder 163.

[0038] The bucket position identifying unit 212 identifies the positions of a plurality of points on the cutting edge of the bucket 155 based on the detection values ​​acquired by the detection value acquiring unit 211. For example, the bucket position identifying unit 212 identifies the positions of five points that divide the cutting edge of the bucket 155 into four equal parts. A method for identifying the position of the cutting edge of the bucket 155 will be described later.

[0039] The target plane determination unit 213 determines a target plane to be subjected to tilt control. The target plane is a plane that passes through at least one of the plurality of triangular polygons that constitute the target design surface. Specifically, the target plane determination unit 213 determines the target plane in the following procedure. Based on the design surface data and the positions of the plurality of points identified by the bucket position identification unit 212, the target plane determination unit 213 calculates the distance between the point and one of the triangular polygons that constitute the target design surface that faces the point, for each of the plurality of points. At this time, the plurality of points may face different triangular polygons. The target plane determination unit 213 identifies the triangular polygon related to the shortest distance, and determines the plane that passes through the triangular polygon as the target plane.

[0040] The distance calculation unit 214 calculates the distance between the multiple points and the target plane based on the positions of the multiple points identified by the bucket position identification unit 212 and the target plane determined by the target plane determination unit 213.

[0041] The operation amount acquisition unit 215 acquires an operation signal indicating an operation amount from the operation device 172. The operation amount acquisition unit 215 acquires at least an operation amount related to the raising operation and lowering operation of the boom 151, an operation amount related to the pushing operation and pulling operation of the arm 152, and an operation amount related to the excavation operation, dump operation, and tilt operation of the bucket 155.

[0042] The intervention control unit 216 performs intervention control of the work machine 150 based on the operation amount of the operation device 172 acquired by the operation amount acquisition unit 215 and the shortest of the distances calculated by the distance calculation unit 214.

[0043] The tilt control unit 217 performs automatic tilt control based on the difference between a first distance, which is the distance from the left end of the blade tip of the bucket 155 to the target plane, and a second distance, which is the distance from the right end of the blade tip of the bucket 155 to the target plane, among the distances calculated by the distance calculation unit 214. The left end and the right end of the blade tip of the bucket 155 are examples of the first bucket point and the second bucket point, respectively. Note that in other embodiments, the first bucket point and the second bucket point may be other points on the bucket 155. However, the second bucket point needs to satisfy the condition that it passes through the first bucket point and exists on a straight line parallel to the blade tip of the bucket 155. That is, in other embodiments, the first bucket point and the second bucket point do not necessarily need to be points on the blade tip, such as points on the bottom surface.

[0044] The output unit 218 outputs a control signal to each actuator based on the operation amount acquired by the operation amount acquisition unit 215 and the tilt control amount calculated by the tilt control unit 217 .

[0045] <How to determine the cutting edge position of Bucket 155> 1 and 3, a method for identifying the position of the cutting edge of bucket 155 by bucket position identifying unit 212 will be described. The position of the cutting edge of bucket 155 in the vehicle body coordinate system can be identified based on boom length L1, arm length L2, joint length L3, bucket length L4, boom relative angle α, arm relative angle β, bucket relative angle γ, tilt angle η, the position of boom pin P1 in the vehicle body coordinate system, and the position of representative point O in the site coordinate system.

[0046] The boom length L1 is a known length from the boom pin P1 to the arm pin P2. The arm length L2 is a known length from the arm pin P2 to the bucket pin P3. The joint length L3 is a known length from the bucket pin P3 to the tilt pin P7. The bucket length L4 is a known length from the tilt pin P7 to the center point of the blade edge of the bucket 155.

[0047] The boom relative angle α is represented by the angle between a half line extending from the boom pin P1 to the upward direction (+Zm direction) of the revolving body 130 and a half line extending from the boom pin P1 to the arm pin P2. Note that, as shown in FIG. 1, due to the inclination θ of the revolving body 130, the upward direction (+Zm direction) of the revolving body 130 does not necessarily coincide with the vertical upward direction (+Zg direction). The arm relative angle β is represented by the angle formed by a half line extending from the boom pin P1 to the arm pin P2 and a half line extending from the arm pin P2 to the bucket pin P3. The bucket relative angle γ is represented by the angle between a half line extending from the arm pin P2 to the bucket pin P3 and a half line extending from the bucket pin P3 to the tilt pin P7. The tilt angle η is represented by the angle between a half line extending from tilt pin P7 in a direction perpendicular to bucket pin P3 and tilt pin P7 and a half line extending from tilt pin P7 to the center point of the blade edge of bucket 155.

[0048] The position of the cutting edge of the bucket 155 in the site coordinate system is identified, for example, by the following procedure. The bucket position identifying unit 212 identifies the position of the arm pin P2 in the vehicle body coordinate system based on the position of the boom pin P1 in the vehicle body coordinate system, the boom relative angle α, and the boom length L1. The bucket position identifying unit 212 identifies the position of the bucket pin P3 in the vehicle body coordinate system based on the position of the arm pin P2 in the vehicle body coordinate system, the arm relative angle β, and the arm length L2. The bucket position identifying unit 212 identifies the position of the tilt pin P7 in the vehicle body coordinate system based on the position of the bucket pin P3 in the vehicle body coordinate system, the bucket relative angle γ, and the joint length L3. The bucket position identifying unit 212 identifies the position of the center point of the cutting edge of the bucket 155 in the vehicle body coordinate system based on the position of the tilt pin P7 in the vehicle body coordinate system, the tilt angle η, and the bucket length L4. Furthermore, the bucket position identifying unit 212 can identify the position of any point on the cutting edge by identifying the distance from the center point of the cutting edge to any point on the cutting edge and calculating a position shifted from the position of the center point of the cutting edge in the direction of the tilt angle η by the distance from the center point of the cutting edge to the any point. For example, the bucket position identifying unit 212 can identify the positions of both ends of the cutting edge by calculating positions shifted from the position of the center point of the cutting edge by ½ of the length of the cutting edge in the width direction in both the positive and negative directions of the tilt angle η.

[0049] The boom relative angle α, the arm relative angle β, the bucket relative angle γ, and the tilt angle η are respectively identified by the detection value of the boom cylinder stroke sensor 1561, the detection value of the arm cylinder stroke sensor 1571, the detection value of the bucket cylinder stroke sensor 1581, and the detection value of the tilt cylinder stroke sensor 1631. Bucket position identification unit 212 converts the position of the cutting edge of bucket 155 in the vehicle body coordinate system into a position in the site coordinate system based on the position of the revolving unit 130 in the site coordinate system, the direction in which the revolving unit 130 faces, and the attitude of the revolving unit 130. The detection of the boom relative angle α, the arm relative angle β, the bucket relative angle γ, and the tilt angle η is not limited to being performed by the cylinder stroke sensor, and may be performed by an angle sensor or an IMU.

[0050] Operation of the control device 190 Fig. 6 is a flowchart showing the operation of the control device 190 according to the first embodiment. Fig. 7 is a diagram showing the relationship between a target design surface and points on the cutting edge in automatic tilt control. When the operator of the work machine 100 starts operating the work machine 100, the control device 190 executes the control described below for each predetermined control period.

[0051] The operation amount acquisition unit 215 acquires the operation amount related to the boom 151, the operation amount related to the arm 152, the operation amount related to the bucket 155, the operation amount related to the tilt, and the operation amount related to the rotation of the rotating body 130 from the operation device 172 (step S1). The detection value acquisition unit 211 acquires information detected by each of the position and orientation detector 131, the inclination detector 132, the boom cylinder stroke sensor 1561, the arm cylinder stroke sensor 1571, the bucket cylinder stroke sensor 1581, and the tilt cylinder stroke sensor 1631 (step S2).

[0052] The bucket position identifying unit 212 calculates the boom relative angle α, the arm relative angle β, the bucket relative angle γ, and the tilt angle η from the stroke length of each hydraulic cylinder (step S3). The bucket position identifying unit 212 also calculates the positions in the site coordinate system of five points that divide the blade edge of the bucket 155 into four equal parts based on the detection value acquired in step S2, the angle calculated in step S3, and the known length parameter of the work machine 150 (step S4). Hereinafter, the five points on the blade edge of the bucket 155 are referred to as point p1, point p2, point p3, point p4, and point p5, in order from the left end of the blade edge. That is, point p1 is the left end point of the blade edge, point p5 is the right end point of the blade edge, and point p3 is the center point of the blade edge. It should be noted that, if the angle is directly detected using an angle sensor or an IMU, step S3 may be omitted.

[0053] The target plane determination unit 213 reads out the design surface data from the storage 250, and calculates the distance between each of the points p1-p5 and the target design surface (step S5). In step S5, the target plane determination unit 213 calculates the distance between each of the points p1-p5 and the triangular polygon facing the point in the direction extending in the vertical direction (Zg axis direction). In the example shown in FIG. 7, the target plane determination unit 213 calculates the distance L11-L13 between the points p1-p3 and the triangular polygon t1, and the distance L14-L15 between the points p4-p5 and the triangular polygon t2. When the position of the blade tip of the bucket 155 is specified in the site coordinate system, the design surface data based on the site coordinate system is used. When the position of the blade tip of the bucket 155 is specified in the vehicle body coordinate system, the design surface data based on the vehicle body coordinate system may be used. For example, the design surface data based on the vehicle body coordinate system may be obtained by converting the design surface data based on the site coordinate system into the vehicle body coordinate system based on the detection values ​​of the position and orientation detector 131 and the tilt detector 132.

[0054] Next, the target plane determination unit 213 identifies the triangular polygon related to the shortest distance, and determines the plane passing through the triangular polygon as the target plane g1 (step S6). In the example shown in Fig. 7, the distance L13 between the point p3 and the triangular polygon t1 is the shortest among the distances L11 to L15, so the target plane determination unit 213 determines the plane passing through the triangular polygon t1 as the target plane g1.

[0055] Based on the positions of points p1 and p5 at both ends of the cutting edge calculated in step S4 and the target plane g1 determined in step S6, the distance calculation unit 214 calculates the distance L21 between point p1 and the target plane g1 and the distance L22 between point p5 and the target plane g1 (step S7). In step S7, the target plane determination unit 213 calculates the distances L21 and L22 between point p1 and point p5 and the target plane g1 in the normal direction of the target plane g1.

[0056] Next, the tilt control unit 217 determines whether or not the operator has input a tilt operation based on the amount of operation acquired in step S1 (step S8). For example, the tilt control unit 217 determines that there is no operation input when the absolute value of the amount of tilt operation is less than a predetermined value. If there is no tilt operation (step S8: NO), the tilt control unit 217 determines whether or not at least one of the distance L21 between the point p1 specified in step S7 and the target plane g1 and the distance L22 between the point p5 and the target plane g1 is less than the tilt control distance th (step S9).

[0057] If at least one of the distances L21 and L22 is less than the tilt control distance th (step S9: YES), the tilt control unit 217 calculates the difference between the distances L21 and L22 calculated in step S7 (step S10). Next, the tilt control unit 217 calculates the tilt control amount based on the difference (distance difference) between the distances L21 and L22 (step S11).

[0058] Fig. 8 is a diagram showing an example of a tilt function showing the relationship between the bucket distance difference and the target value of the tilt angular velocity according to the first embodiment. The bucket distance difference shown in Fig. 8 is obtained by subtracting the distance L22 from the distance L21 shown in Fig. 7, and the counterclockwise angular velocity in Fig. 7 is taken as positive. In step S11, the tilt control unit 217 determines the target value of the tilt angular velocity by substituting the distance difference into a predetermined tilt function as shown in FIG. 8. The tilt function is a function that determines the target value of the tilt angular velocity based on the distance difference of the bucket 155. In the tilt function, the target value of the tilt angular velocity increases monotonically with respect to the distance difference of the bucket 155. In addition, in the tilt function, an upper limit value and a lower limit value of the tilt angular velocity are set, and when the absolute value of the distance difference exceeds a predetermined value, the target value of the tilt angular velocity becomes constant. In addition, a dead zone (hysteresis) is set in the tilt function, and when the distance difference is within the dead zone near zero, the target value of the tilt angular velocity becomes zero. In other words, when the distance difference is within the dead zone near zero, the rotation of the bucket 155 around the tilt axis X4 is stopped. Then, the tilt control unit 217 determines the tilt control amount based on the determined target value of the tilt angular velocity.

[0059] By providing a dead zone in the tilt function, it is possible to prevent the tilt control of the bucket 155 from repeatedly overshooting and overcorrecting. This makes it possible to prevent wobbling on the excavation surface when the tilt angle η of the bucket 155 is controlled by the automatic tilt control. In addition, by defining the dead zone according to the allowable error amount with respect to the target construction surface, it is possible to prevent wobbling on the excavation surface while suppressing the excavation error of the target construction surface within the allowable error amount.

[0060] If a tilt operation is being performed (step S8: YES), or if both distance L21 and distance L22 are equal to or greater than the tilt control distance th (step S9: NO), tilt control section 217 does not calculate the tilt control amount.

[0061] Then, the output unit 218 outputs a control signal to each actuator based on each operation amount related to the work machine 150 and the tilt control amount calculated by the tilt control unit 217 (step S12). When automatic tilt control is being executed, the tilt cylinder 163 is driven according to a signal generated by the tilt control unit 217. When automatic tilt control is not being executed, the tilt cylinder 163 is driven according to a signal based on the operator's operation amount.

[0062] Actions and Effects In this way, the control device 190 according to the first embodiment calculates the first distance L21, which is the distance between the first bucket point p1 on the bucket 155 and the target design surface, and the second distance L22, which is the distance between the second bucket point p5, which is a point on the bucket 155, and the target design surface, and calculates the tilt control amount for rotating the bucket 155 about the tilt axis X4 by comparing the first distance L21 and the second distance L22. This allows the control device 190 to automatically control the work machine 150 so that the bucket 155 moves along the target design surface.

[0063] In the first embodiment, the first bucket point p1 and the second bucket point p5 are both ends of the blade tip of the bucket 155, but are not limited to this. For example, in other embodiments, the points p2 and p4 may be the first bucket point and the second bucket point, respectively. In other embodiments, the control device 190 may calculate the tilt control amount based on the tilt angle η of the bucket 155. On the other hand, by using the distance difference between both ends of the blade tip of the bucket 155, the excavation error with respect to the target construction surface can be easily managed. For example, when the control device 190 calculates the tilt control amount based on the tilt angle η of the bucket 155, the excavation error generated by an error in the tilt angle η changes depending on the length of the blade tip of the bucket 155. In contrast, when the tilt control amount is calculated based on the difference in distance between both ends of the bucket 155 and the target plane as in the first embodiment, the excavation error does not change depending on the length of the blade tip of the bucket 155.

[0064] In the first embodiment, the control device 190 stops the rotation around the tilt axis X4 when the difference between the first distance L21 and the second distance L22 is within the dead zone. That is, in the first embodiment, the control device 190 stops the rotation around the tilt axis X4 when the angle between the cutting edge of the bucket 155 and the target design surface is equal to or less than a predetermined threshold. This makes it possible to prevent the tilt control of the bucket 155 from repeatedly overshooting and overcorrecting. In addition, since this dead zone is defined by the allowable error amount for the target construction surface, it is possible to prevent the wobbling of the excavation surface while suppressing the excavation error of the target construction surface within the allowable error amount.

[0065] Other Embodiments Although one embodiment has been described in detail above with reference to the drawings, the specific configuration is not limited to the above, and various design changes are possible. That is, in other embodiments, the order of the above-mentioned processes may be changed as appropriate. Also, some of the processes may be executed in parallel.

[0066] The control device 190 according to the embodiment described above may be configured by a single computer, or the configuration of the control device 190 may be divided and arranged among multiple computers that function as a control system by working together. In this case, some of the computers that configure the control device 190 may be mounted inside the work machine 100, and other computers may be provided outside the work machine 100.

[0067] The control device 190 according to the embodiment described above calculates the distance L11-L15 and the distance L21 and the distance L22 based on the criteria shown in FIG. 7, but is not limited thereto. For example, the control device 190 according to another embodiment may calculate the distance L11-L15 as a distance in the normal direction of the triangular polygon, or may calculate the distance in a direction perpendicular to the cutting edge of the bucket 155. The control device 190 according to another embodiment may calculate the distance L21 and the distance L22 as a distance in the vertical direction, or may calculate the distance in a direction perpendicular to the cutting edge of the bucket 155. For example, the triangular polygons t1 and t2 may be selected from the intersection line between the tilt operation plane that passes through the cutting edge of the bucket 155 and is perpendicular to the tilt axis X4 and the target design plane.

[0068] The control device 190 according to the embodiment described above compares the first distance L21 and the second distance L22 to calculate the tilt control amount for rotating the bucket 155 around the tilt axis X4, but is not limited thereto. For example, the control device 190 according to another embodiment may calculate the tilt control amount based on the other of the first distance L21 and the second distance L22 at that time when one of the first distance L21 and the second distance L22 becomes less than the tilt control distance th. For example, the control device 190 may calculate the tilt control amount based on the magnitude of the second distance L22 at that time when the first distance L21 becomes less than the tilt control distance th. Also, for example, the control device 190 may not rotate around the tilt axis X4 when the other of the first distance L21 and the second distance L22 is equal to or greater than a predetermined value. That is, the control device 190 calculates the tilt control amount based on at least the larger value of the first distance L1 and the second distance L2.

[0069] The control device 190 according to the embodiment described above always enables the automatic tilt control, but is not limited to this. The operation device 172 according to other embodiments may include a switch for switching between enabling and disabling the automatic tilt control. In this case, the control device 190 may determine whether to perform the automatic tilt control based on the state of the switch. That is, when the switch is ON, the control device 190 performs the automatic tilt control when there is no tilt operation input (step S8: NO) and the distance between the blade tip of the bucket 155 and the target plane g1 is less than the tilt control distance th (step S9). On the other hand, when the switch is OFF, the control device 190 does not perform the automatic tilt control even if there is no tilt operation input and the distance between the blade tip of the bucket 155 and the target plane g1 is less than the tilt control distance th. The switch may be provided as a function of a monitor (not shown) or may be arranged on an operation lever, etc., as long as it can be operated by the operator. [Explanation of symbols]

[0070] LIST OF SYMBOLS 100...Working machine 110...Traveling body 130...Slewing body 131...Position and orientation detector 132...Inclination detector 150...Working machine 151...Boom 152...Arm 155...Bucket 161...Bucket body 162...Joint 163...Tilt cylinder 190...Control device 211...Detection value acquisition unit 212...Bucket position identification unit 213...Target plane determination unit 214...Distance calculation unit 215...Operation amount acquisition unit 216...Intervention control unit 217...Tilt control unit 218...Output unit

Claims

1. A work machine including a boom rotatable about a boom axis, an arm rotatable about an arm axis parallel to the boom axis, and a bucket rotatable about a bucket axis parallel to the arm axis and rotatable about a tilt axis perpendicular to the bucket axis, A control device is provided, The control device includes: A target shape of an excavation target is indicated, and among target design planes constituted by a plurality of polygons, a plane passing through a polygon that is closest in vertical distance to the bucket is determined as a target plane; calculate a tilt control amount for rotating the bucket about the tilt axis based on a first distance that is a distance between a first bucket point that is a point on the bucket and the target plane, and a second distance that is a distance between a second bucket point that is a point on the bucket on a line that passes through the first bucket point and is parallel to the blade edge of the bucket, and the target plane; The rotation of the bucket about the tilt axis is controlled based on the calculated tilt control amount. Working machinery.

2. The control device includes: The first distance is compared with the second distance to calculate the tilt control amount.

2. The work machine of claim 1.

3. The control device includes: The tilt control amount is calculated based on a difference between the first distance and the second distance.

3. A work machine according to claim 2.

4. The control device includes: When at least one of the first distance and the second distance is less than a predetermined distance, a difference between the first distance and the second distance is calculated.

4. A work machine according to claim 3.

5. The control device includes: When the difference between the first distance and the second distance is equal to or less than a predetermined threshold, the rotation of the bucket around the tilt axis is not performed.

4. A work machine according to claim 3.

6. the first bucket point and the second bucket point are points at both ends of a blade tip of the bucket, The threshold value is a value equal to or smaller than a tolerance for height with respect to the target design surface.

6. A work machine according to claim 5.

7. The control device includes: When the difference between the first distance and the second distance is within a dead zone, rotation of the bucket about the tilt axis is not performed.

4. A work machine according to claim 3.

8. When the operator is performing an operation to rotate the bucket around the tilt axis, the tilt control amount is not calculated.

2. The work machine of claim 1.

9. The control device includes: When one of the first distance and the second distance becomes shorter than a predetermined distance, a tilt control amount for rotating the bucket around the tilt axis is calculated based on the other of the first distance and the second distance at that time.

2. The work machine of claim 1.

10. A method for controlling a work machine including a boom rotatable about a boom axis, an arm rotatable about an arm axis parallel to the boom axis, and a bucket rotatable about a bucket axis parallel to the arm axis and about a tilt axis perpendicular to the bucket axis, the method comprising: determining, as a target plane, a plane passing through a polygon that is closest in vertical distance to the bucket among target design planes that indicate a target shape of an excavation target and are composed of a plurality of polygons; calculating a tilt control amount for rotating the bucket about the tilt axis based on a first distance that is a distance between a first bucket point that is a point on the bucket and the target plane, and a second distance that is a distance between a second bucket point that is a point on the bucket on a line that passes through the first bucket point and is parallel to the blade edge of the bucket, and the target plane; controlling rotation of the bucket about the tilt axis based on the calculated tilt control amount; A method for providing the above.

11. A system for controlling a work machine including a boom rotatable about a boom axis, an arm rotatable about an arm axis parallel to the boom axis, and a bucket rotatable about a bucket axis parallel to the arm axis and rotatable about a tilt axis perpendicular to the bucket axis, A target shape of an excavation target is indicated, and among target design planes constituted by a plurality of polygons, a plane passing through a polygon that is closest in vertical distance to the bucket is determined as a target plane; calculate a tilt control amount for rotating the bucket about the tilt axis based on a first distance that is a distance between a first bucket point that is a point on the bucket and the target plane, and a second distance that is a distance between a second bucket point that is a point on the bucket on a line that passes through the first bucket point and is parallel to the blade edge of the bucket, and the target plane; The rotation of the bucket about the tilt axis is controlled based on the calculated tilt control amount. system.

Images