Control device and control method
The control device dynamically adjusts the bucket's target trajectory based on real-time inclination measurements to maintain efficient excavation despite posture changes in the working machine, addressing inefficiencies caused by varying ground conditions and ensuring consistent performance.
Patent Information
- Application Number
- PCT/JP2024/015741
- Authority / Receiving Office
- WO · WO
- Patent Type
- Applications
- Current Assignee / Owner
- Priority Date
- 2023-05-31
- Filing Date
- 2024-04-22
- Publication Date
- 2024-12-05
AI Technical Summary
Automatic excavation control systems face inefficiencies when the posture of a working machine changes during excavation due to varying ground hardness and instability, as the force transmission to work implements like buckets is compromised, leading to suboptimal excavation performance.
A control device that acquires measurement data on the working machine's inclination and adjusts the operation signal for the bucket's target trajectory dynamically, ensuring effective excavation even when the machine's posture changes, by modifying the excavation depth and length based on real-time measurements to maintain optimal force application and prevent tilting.
This solution enables continuous and efficient automatic excavation by adapting the target trajectory to the changing posture of the working machine, maintaining excavation efficiency and preventing tilting issues, thereby ensuring consistent and maximized excavation performance.
Smart Images

Figure JP2024015741_05122024_PF_FP_ABST
Abstract
Description
Control device and control method
[0001] This application claims priority to Japanese Patent Application No. 2023-089903, filed May 31, 2023, the contents of which are incorporated herein by reference.
[0002] Patent Document 1 discloses a technique for controlling the angle of the bucket cutting edge depending on the hardness of the ground when excavating with a work machine.
[0003] International Publication No. 2019 / 009341
[0004] The attitude of a work machine may change during excavation work due to factors such as the hardness of the ground and the instability of footing. If the attitude of the work machine changes due to the reaction force of the excavation work, force is not properly transmitted to a work tool such as a bucket, resulting in reduced excavation efficiency. Automatic excavation control by a work machine is performed by controlling the work equipment to move the bucket along a predetermined target trajectory. However, if an attempt is made to move the bucket along the same target trajectory even when the attitude of the work machine changes in automatic excavation control, automatic excavation may not be performed properly. An object of the present disclosure is to provide a control device and control method that can perform automatic excavation properly even when the attitude of the work machine changes.
[0005] According to a first aspect of the present invention, the control device is a control device for a work machine equipped with a work implement, acquires measurement data of the inclination of the work machine, starts automatic excavation control that outputs an operation signal for the work implement according to a target excavation trajectory, and changes the excavation operation according to changes in the measurement data during the automatic excavation control.
[0006] According to the above aspect, automatic excavation can be performed appropriately even if the attitude of the work machine changes.
[0007] FIG. 1 is a schematic diagram showing the configuration of a work machine according to a first embodiment; FIG. 2 is a schematic block diagram showing the configuration of a control device according to the first embodiment; FIG. 3 is a diagram showing an example of a target trajectory according to the first embodiment; FIG. 4 is a flowchart (part 1) showing an automatic excavation control method according to the first embodiment; FIG. 5 is a flowchart (part 2) showing an automatic excavation control method according to the first embodiment; FIG. 6 is a flowchart (part 3) showing an automatic excavation control method according to the first embodiment; FIG. 7 is a diagram showing an example of generation of an excavation trajectory according to the first embodiment; and FIG. 8 is a diagram showing an example of change of a target trajectory according to the first embodiment.
[0008] First Embodiment Configuration of Work Machine 100 FIG. 1 is a schematic diagram showing the configuration of a work machine 100 according to a first embodiment. The work machine 100 operates at a construction site and excavates a construction target such as earth and sand. The work machine 100 according to the first embodiment is autonomously controlled according to instructions from a host device (not shown). The host device automatically generates signals for controlling the work machine 100 based on the position and attitude of the work machine 100 and outputs those signals to the work machine. Note that in other embodiments, the work machine 100 may be operated directly or remotely by an operator. In this case, the host device corresponds to an operating device provided on the work machine 100 for direct operation or a remote operating device for operating the work machine 100 for remote operation. Autonomous control refers to the work machine 100 autonomously controlling the drive of the work implement 130 to achieve a predetermined operation. The work machine 100 according to the first embodiment autonomously performs an excavation operation in which the work implement 130 excavates an excavation target. Details of autonomous control will be described later.
[0009] Examples of the work machine 100 include a face shovel, a backhoe shovel, and a rope shovel. The work machine 100 may be electrically driven or hydraulically driven. The work machine 100 according to the first embodiment is a backhoe shovel. The work machine 100 includes a traveling body 110, a rotating body 120, and a work implement 130.
[0010] The running body 110 supports the work machine 100 so that it can travel. The running body 110 is equipped with two caterpillar tracks 111, one on the left and one on the right, and two travel motors 112 for driving each caterpillar track 111. The running body 110 is an example of a support unit. The revolving body 120 is supported on the running body 110 so that it can rotate about a rotation center. The work implement 130 is hydraulically driven. Note that in other embodiments, the work implement 130 may be electrically driven. The work implement 130 is supported on the front of the revolving body 120 so that it can be driven in the vertical direction. Here, the portion of the revolving body 120 to which the work implement 130 is attached is referred to as the front portion. Furthermore, with respect to the revolving body 120, the opposite portion, the left portion, and the right portion are referred to as the rear, left portion, and right portion, respectively, based on the front portion.
[0011] <Configuration of the Swing Unit 120> The swing unit 120 includes an engine 121, a hydraulic pump 122, a control valve 123, and a swing motor 124. The engine 121 is a prime mover that drives the hydraulic pump 122. The engine 121 is an example of a power source. The hydraulic pump 122 is a variable displacement pump driven by the engine 121. The hydraulic pump 122 supplies hydraulic oil to each actuator (boom cylinder 131C, arm cylinder 132C, bucket cylinder 133C, travel motor 112, and swing motor 124) via a control valve 123. The control valve 123 controls the flow rate of hydraulic oil supplied from the hydraulic pump 122. The swing motor 124 is driven by hydraulic oil supplied from the hydraulic pump 122 via the control valve 123, causing the swing unit 120 to swing.
[0012] <Configuration of Work Machine 130> The work machine 130 includes a boom 131, an arm 132, a bucket 133 having a cutting edge as a work tool, a boom cylinder 131C, an arm cylinder 132C, and a bucket cylinder 133C. Other examples of work tools include tip attachments such as a clam bucket, a tilt bucket, and a tilt rotate bucket.
[0013] The base end of the boom 131 is rotatably attached to the revolving unit 120 via a boom pin. Note that, in the work machine 100 shown in FIG. 1 , the boom 131 is provided in the center portion of the front of the revolving unit 120, but this is not limited thereto. The boom 131 may be attached offset in the left-right direction. In this case, the center of rotation of the revolving unit 120 is not located on the operating plane of the work implement 130. The arm 132 connects the boom 131 and the bucket 133. The base end of the arm 132 is rotatably attached to the tip of the boom 131 via an arm pin. The bucket 133 is rotatably attached to the tip of the arm 132 via a pin. The bucket 133 functions as a container for collecting excavated soil and sand. The bucket 133 is attached so that its opening faces the revolving unit 120 (rear). In other words, the work machine 100, which is a backhoe excavator, performs excavation by pulling the bucket 133 toward the front of the revolving unit 120.
[0014] The boom cylinder 131C is a hydraulic cylinder for operating the boom 131. A base end of the boom cylinder 131C is attached to the revolving unit 120. A tip end of the boom cylinder 131C is attached to the boom 131. The arm cylinder 132C is a hydraulic cylinder for driving the arm 132. A base end of the arm cylinder 132C is attached to the boom 131. A tip end of the arm cylinder 132C is attached to the arm 132. The bucket cylinder 133C is a hydraulic cylinder for driving the bucket 133. A base end of the bucket cylinder 133C is attached to the arm 132. A tip end of the bucket cylinder 133C is attached to a link mechanism that rotates the bucket 133. The link mechanism has an idler link that rotatably connects the tip end of the bucket cylinder 133C to the arm 132, and a bucket link that rotatably connects the tip end of the bucket cylinder 133C to the back surface of the bucket 133.
[0015] <Configuration of Measurement System> As shown in FIG. 1 , the work machine 100 is equipped with a spatial measuring device 151 , an inclination measuring device 152 , a boom stroke sensor 153 , an arm stroke sensor 154 , and a bucket stroke sensor 155 .
[0016] The spatial measuring instrument 151 measures the position of an object that exists in the space in front of the work machine 100. Examples of the spatial measuring instrument 151 include a stereo camera, LiDAR, and a laser scanner. The spatial measuring instrument 151 is installed so that at least the ground surface of the excavable range is captured within the measurement range. The spatial measuring instrument 151 specifies the three-dimensional position of the target object in a three-dimensional Cartesian coordinate system based on the position of the spatial measuring instrument 151.
[0017] The inclinometer 152 measures the acceleration and angular velocity of the rotating unit 120, and detects the attitude (e.g., roll angle, pitch angle, yaw angle) and rotation speed of the rotating unit 120 based on the measurement results. The inclinometer 152 is installed, for example, on the underside of the rotating unit 120. The inclinometer 152 can be, for example, an inertial measurement unit (IMU).
[0018] The boom stroke sensor 153 is attached to the boom cylinder 131C and detects the cylinder length of the boom cylinder 131C. The cylinder length of the boom cylinder 131C can be converted into the relative angle of the boom 131 with respect to the revolving unit 120. The arm stroke sensor 154 is attached to the arm cylinder 132C and detects the cylinder length of the arm cylinder 132C. The cylinder length of the arm cylinder 132C can be converted into the relative angle of the arm 132 with respect to the boom 131. The bucket stroke sensor 155 is attached to the bucket cylinder 133C and detects the cylinder length of the bucket cylinder 133C. The cylinder length of the bucket cylinder 133C can be converted into the relative angle of the bucket 133 with respect to the arm 132. The work machine 100 according to the first embodiment uses the boom stroke sensor 153, the arm stroke sensor 154, and the bucket stroke sensor 155 to identify the angle of each link component of the work implement 130, but this is not limited to this in other embodiments. For example, in other embodiments, instead of the stroke sensor, a potentiometer that detects the relative rotation angle of the link parts may be provided, or an inclination sensor that detects the angle of each link part relative to the ground may be provided.
[0019] 2 is a schematic block diagram showing the configuration of the control device 160 according to the first embodiment. The work machine 100 is equipped with the control device 160. The control device 160 receives command signals from a higher-level device, and drives the work implement 130, the revolving unit 120, and the traveling unit 110 by autonomous control based on the command signals.
[0020] The control device 160 is a computer including a processor 610, a main memory 630, a storage 650, and an interface 670. The storage 650 stores a program. The processor 610 reads the program from the storage 650, loads it into the main memory 630, and executes processing in accordance with the program.
[0021] Examples of storage 650 include semiconductor memory, magnetic disks, magneto-optical disks, optical disks, etc. Storage 650 may be an internal medium directly connected to a common communication line of control device 160, or may be an external medium connected to control device 160 via interface 670. Main memory 630 and storage 650 are non-transitory tangible storage media.
[0022] The processor 610 includes a measurement data acquisition unit 611, an instruction signal receiving unit 612, a posture identification unit 613, a trajectory generation unit 614, and a movement processing unit 615 by executing a program.
[0023] The measurement data acquisition unit 611 acquires measurement data from the measurement system of the work machine 100. Specifically, the measurement data acquisition unit 611 acquires measurement data from the spatial measuring instrument 151, the inclination measuring instrument 152, the boom stroke sensor 153, the arm stroke sensor 154, and the bucket stroke sensor 155. The measurement data acquisition unit 611 may generate an environment map in the vehicle body coordinate system by SLAM processing using the measurement data from the spatial measuring instrument 151.
[0024] The instruction signal receiving unit 612 receives instruction signals that instruct work from a higher-level device. One example of the instruction signals is an excavation instruction signal. When the control device 160 receives the excavation instruction signal, it drives the work machine 130 and executes excavation control of the excavation target.
[0025] The posture identification unit 613 identifies the posture of the work implement 130 in a vehicle body coordinate system based on the revolving unit 120, based on the measurement data acquired by the measurement data acquisition unit 611. Specifically, the posture identification unit 613 identifies the angles and tip positions of the boom 131, arm 132, and bucket 133.
[0026] Specifically, the posture identification unit 613 identifies the posture of the work implement 130 in the following procedure. The posture identification unit 613 identifies the position of the tip of the boom 131 relative to the revolving unit 120 based on the relative angle of the boom 131 identified from the cylinder length of the boom cylinder 131C and the known length of the boom 131 (the distance from the pin at the base end to the pin at the tip end). The relative angle of the boom 131 is equal to the inclination of the boom 131 in the vehicle body coordinate system. The posture identification unit 613 determines the inclination of the arm 132 in the vehicle body coordinate system based on the relative angle of the arm 132 identified from the cylinder length of the arm cylinder 132C and the inclination of the boom 131 in the vehicle body coordinate system. The posture identification unit 613 identifies, as the position of the tip of the arm 132, a position that is separated from the position of the tip of the boom 131 by the known length of the arm 132 in the direction of the inclination of the arm 132. The attitude identifying unit 613 determines the inclination of the bucket 133 in the vehicle body coordinate system based on the relative angle of the bucket 133 determined from the cylinder length of the bucket cylinder 133C and the inclination of the arm 132 in the vehicle body coordinate system. The inclination of the bucket 133 determined here, that is, the inclination of the line extending from the pin at the base end of the bucket 133 to the cutting edge, can be considered to be the inclination of the opening plane of the bucket 133. The attitude identifying unit 613 determines, in the direction of the inclination of the bucket 133, a position that is away from the position of the tip of the arm 132 by the known length from the pin at the base end of the bucket 133 to the cutting edge, as the position of the cutting edge of the bucket 133.
[0027] The trajectory generating unit 614 generates a target trajectory T for the bucket 133 based on the measurement data of the spatial measuring device 151. FIG. 3 is a diagram showing an example of a target trajectory according to the first embodiment. Because the work machine 100 according to the first embodiment is a backhoe excavator, the target trajectory T for the bucket 133 is drawn as an arc-shaped trajectory moving from the front to the rear. For example, the target trajectory T for the bucket 133 is drawn as a trajectory of the cutting edge of the bucket 133 that excavates the excavation target in the excavation direction from the position of the cutting edge of the bucket 133 when the automatic excavation command signal is input. The target trajectory T is defined by the excavation depth D and the excavation length L. The excavation length L is the length of the chord of the arc that represents the target trajectory T. The excavation depth D is the distance from the midpoint of the arc that represents the target trajectory T to the midpoint of the chord. Note that once the excavation depth D and the excavation length L are determined, the radius of the arc can be calculated. Trajectory generating unit 614 generates target trajectory T so that the amount of excavation when excavating according to target trajectory T is equal to the maximum capacity of bucket 133. Note that the shape of target trajectory T according to other embodiments may be any curve having a downward convex shape, such as an elliptical arc, a parabola, or a gentle curve without an inflection point.
[0028] The trajectory generating unit 614 resets the target trajectory T in accordance with changes in the inclination of the work machine 100 during autonomous control of excavation. Specifically, if the work machine 100 tilts backward during autonomous control, that is, if the work machine 100 lifts, the trajectory generating unit 614 decreases the excavation depth D and increases the excavation length L. The work machine 100 tilts backward when excavation does not progress because the excavation target is too hard for the load acting on the cutting edge of the work implement 130, or because the footing of the work machine 100 is unstable. Therefore, by decreasing the excavation depth D, the trajectory generating unit 614 reduces the vertically upward component of the reaction force against the ground and prevents the work machine 100 from tilting backward. In addition, the trajectory generating unit 614 increases the excavation length L to prevent a decrease in the amount of earth and sand excavated. On the other hand, when the posture of the work machine 100 is stable during autonomous control, i.e., when the work machine 100 does not tilt backward, the trajectory generating unit 614 increases the excavation depth D and decreases the excavation length L. In this way, the trajectory generating unit 614 aims to improve excavation efficiency. Note that changes to the excavation depth D, the excavation length L, and the target trajectory T are all examples of changes to the excavation operation.
[0029] The movement processing unit 615 generates an operation signal for the work implement 130 to move the cutting edge of the bucket 133 along the target trajectory T, and outputs the operation signal to the control valve 123 .
[0030] <<Operation>> Fig. 4 is a flowchart (part 1) showing the automatic excavation control method according to the first embodiment. Fig. 5 is a flowchart (part 2) showing the automatic excavation control method according to the first embodiment. Fig. 6 is a flowchart (part 3) showing the automatic excavation control method according to the first embodiment. When the control device 160 receives input of an automatic excavation instruction signal from a higher-level device, it executes the automatic excavation control shown in Fig. 4.
[0031] The measurement data acquisition unit 611 acquires measurement data from the spatial measuring device 151, inclination measuring device 152, boom stroke sensor 153, arm stroke sensor 154, and bucket stroke sensor 155 (step S1). The measurement data acquisition unit 611 generates an environment map representing the shape of the ground surface in the vehicle body coordinate system by SLAM processing using the measurement data acquired from the spatial measuring device 151 (step S2). The trajectory generation unit 614 records the pitch angle representing the attitude of the revolving unit 120 indicated by the measurement data acquired from the inclination measuring device 152 in step S1 in the main memory 630 as the pitch angle at the start of automatic excavation (step S3). For example, the pitch angle representing the attitude of the revolving unit 120 is equal to the pitch angle of the work machine 100.
[0032] The attitude identification unit 613 identifies the attitude of the work implement 130 based on the measurement data acquired from the boom stroke sensor 153, the arm stroke sensor 154, and the bucket stroke sensor 155 in step S1 (step S4).
[0033] The trajectory generating unit 614 reads the initial values of the digging depth D and the digging length L from the main memory 630 (step S5). The trajectory generating unit 614 generates a target trajectory T based on the value of the digging depth D, the value of the digging length L, and the known lengths of the arm 132 and bucket 133 (step S6). For example, the trajectory generating unit 614 generates the target trajectory T in the following procedure.
[0034] 7 is a diagram showing an example of the generation of an excavation trajectory according to the first embodiment. The trajectory generation unit 614 calculates the height H from the blade tip of the bucket 133 to the pin at the base end of the arm 132 when the arm 132 is in the maximum digging force position, which is a position where the arm 132 can exert the maximum digging force, and the angle of the blade tip of the bucket 133 is tilted a predetermined interference prevention angle from the ground surface. The work machine 100 is designed so that the maximum force can be exerted when the work implement 130 is in the maximum digging force position. The maximum digging force position of the arm 132 is, for example, a position where the angle between the arm cylinder 132C and the arm 132 is a right angle. The angle between the arm cylinder 132C and the arm 132 is the angle between a straight line connecting the tip end of the arm cylinder 132C and the base end of the arm cylinder 132C and a straight line connecting the tip end of the arm cylinder 132C and the arm pin at the tip of the boom 131. The interference prevention angle is a target angle set in advance to prevent the bottom surface of the bucket 133 from interfering with the target trajectory T. For example, the interference prevention angle may be the angle formed by a tangent to the target trajectory T and a line formed by the cutting edge of the bucket 133 and the bottom surface of the bucket 133 at the point where the cutting edge of the bucket 133 touches the target trajectory T. In another embodiment, the height H may be the height from the cutting edge of the bucket 133 to a pin at the base end of the arm 132 when the arm 132 and the bucket 133 are in the maximum excavation force posture. The maximum excavation force posture of the bucket 133 is, for example, a posture in which the angle formed by the bucket cylinder and the idler link is perpendicular. The angle formed by the bucket cylinder 133C and the idler link is the angle formed by a straight line connecting the tip end of the bucket cylinder 133C and the base end of the bucket cylinder 133C and a line extending in the extension direction of the idler link. The trajectory generating unit 614 identifies an arc A that is centered on the pin at the base end of the boom 131 and passes through the pin at the tip end. Arc A is a set A1 of points that the tip of the boom 131 can take. Of the points on arc A, the trajectory generating unit 614 identifies point P1 where the distance to the ground surface is equal to the difference between the height H and the excavation depth D. When the tip of the boom 131 is located at point P1, the trajectory generating unit 614 identifies point P2 where the tip of the bucket 133 is located when the arm 132 and bucket 133 are in a vertical excavation posture.The trajectory generating unit 614 positions the target trajectory T so that the apex (lowest point) of the arc representing the target trajectory T is located at the identified point P2. The work machine 100 can exert maximum force when the arm 132 is in a vertical excavation posture, so by setting point P2 as the lowest point of the target trajectory T, it is possible to maximize excavation efficiency.
[0035] When the trajectory generation unit 614 generates the target trajectory T, the movement processing unit 615 determines whether or not there is a posture of the boom 131 and the arm 132 in which the cutting edge of the bucket 133 is positioned at the start point of the target trajectory T and the angle formed by the cutting edge of the bucket 133 and a tangent to the target trajectory T is an interference prevention angle (step S7). For example, it determines whether or not there is a posture in which the angle formed by the line passing through the cutting edge of the bucket 133 and the bottom surface of the bucket and a tangent to the target trajectory T is an interference prevention angle. If there is a posture of the boom 131 and the arm 132 in which the angle of the cutting edge is the interference prevention angle (step S7: YES), the movement processing unit 615 determines the position and posture identified in step S7 as the target position and posture of the boom 131, the arm 132, and the bucket 133 (step S8). On the other hand, if there is no posture of the boom 131 and the arm 132 in which the angle of the cutting edge is the interference prevention angle (step S7: YES), the movement processing unit 615 determines the target position and target posture of the boom 131, the arm 132, and the bucket 133 for positioning the cutting edge of the bucket 133 at the start point of the target trajectory T (step S9). At this time, the angle formed by the cutting edge of the bucket 133 and the tangent to the target trajectory T is larger than the interference prevention angle. For example, if the angle is larger than the interference prevention angle, the bucket 133 will be in a direction to rotate toward the soil discharge posture. For example, if the cutting edge of the bucket 133 is in a posture in which it is raised at the start point of the target trajectory T, the angle will be larger than the interference prevention angle.
[0036] The movement processing unit 615 generates an operation signal based on the identified target positions and target attitudes of the boom 131, arm 132, and bucket 133, and outputs the operation signal to the control valve 123 (step S10). As a result, the work machine 130 moves so that the cutting edge of the bucket 133 is positioned at the start point of the target trajectory T. For example, the start point of the target trajectory T is the point where excavation on the excavation target starts.
[0037] When the cutting edge of the bucket 133 reaches the start point of the target trajectory T, the measurement data acquisition unit 611 acquires measurement data from the inclination measuring device 152, the boom stroke sensor 153, the arm stroke sensor 154, and the bucket stroke sensor 155 (step S11). The attitude identification unit 613 identifies the attitude of the work implement 130 based on the measurement data acquired from the boom stroke sensor 153, the arm stroke sensor 154, and the bucket stroke sensor 155 in step S11 (step S12).
[0038] The trajectory generating unit 614 determines whether the work machine 100 is tilting backward and causing lift based on the pitch angle indicating the attitude of the revolving unit 120 indicated by the measurement data acquired from the inclinometer 152 in step S11 and the pitch angle indicating the attitude of the revolving unit 120 at the start of autonomous control recorded in the main memory 630 in step S3 (step S13). Specifically, the trajectory generating unit 614 determines whether the deviation obtained by subtracting the current pitch angle from the pitch angle at the start of autonomous control is smaller than the stable angle threshold. The pitch angle increases as the vehicle body leans backward. The stable angle threshold represents the maximum pitch angle at which it can be determined that the vehicle body of the work machine 100 is stable. For example, the stable angle threshold is an angle at which the front of the vehicle body does not lift due to a reaction force from soil during excavation, or the vehicle body does not sway immediately after excavation. The pitch angle of the work machine 100 fluctuates during excavation work, but within a range in which the work machine 100 does not lift, the amount of change in the pitch angle does not exceed the stable angle threshold.
[0039] If it is determined that floating has occurred in the work machine 100 (step S13: YES), the trajectory generating unit 614 calculates a first change amount by multiplying the pitch angle deviation by the first gain, and reduces the excavation depth D by the first change amount (step S14). Note that the first change amount is not limited to the pitch angle deviation multiplied by the first gain. For example, in other embodiments, the first change amount may be determined by integral control based on the pitch angle deviation, or may be a constant. The trajectory generating unit 614 increases the excavation length L so that the target trajectory T passes through the current position of the cutting edge identified in step S12 and the excavation depth becomes the changed excavation depth D (step S15).
[0040] 8 is a diagram showing an example of changing the target trajectory T according to the first embodiment. If the work machine 100 begins to float during automatic excavation according to a certain target trajectory T1, the trajectory generating unit 614 changes the digging depth D1 of the target trajectory T1 to a shallower digging depth D2. The trajectory generating unit 614 determines the changed target trajectory T2 by calculating an digging length L2 that passes through the position of the cutting edge of the bucket 133 at the digging depth D2.
[0041] If it is determined that the work machine 100 is stable and not floating (step S13: NO), the trajectory generating unit 614 calculates a second change amount by multiplying the pitch angle deviation by the second gain, and deepens the excavation depth D by the second change amount (step S16). The second change amount is not limited to the pitch angle deviation multiplied by the second gain. For example, in other embodiments, the second change amount may be determined by integral control based on the pitch angle deviation, or may be a constant. In either case, the second gain is smaller than the first gain. The trajectory generating unit 614 shortens the excavation length L so that the target trajectory T passes through the current position of the cutting edge identified in step S12 and the excavation depth becomes the changed excavation depth D (step S17).
[0042] The trajectory generating unit 614 records the excavation depth D changed in step S14 or step S16 and the excavation length L changed in step S15 or step S17 in the main memory 630 (step S18). This makes it possible to change the excavation depth D and excavation length L at the start of the next excavation. Note that since the start point of the target trajectory T is determined as shown in Figure 8, the longer the excavation length L, the farther the start point will be from the body of the work machine 100. In other words, the trajectory generating unit 614 determines the next target trajectory in accordance with changes to the excavation operation.
[0043] The movement processing unit 615 determines a target position of the cutting edge of the bucket 133 and a target attitude of the bucket 133 based on the changed target trajectory T and the position of the cutting edge of the bucket 133 identified in step S12 (step S19). For example, the movement processing unit 615 determines, as the target position of the cutting edge, a point on the target trajectory T that is a distance away from the current position of the cutting edge that is the distance that the bucket 133 can move within the time period related to the control cycle. The movement processing unit 615 also determines, as the target attitude of the bucket 133, an attitude that is inclined by an interference prevention angle with respect to a tangent to the target position of the cutting edge.
[0044] The movement processing unit 615 determines the target position and target attitude of the boom 131 and the arm 132 based on the target position of the cutting edge and the target attitude of the bucket 133 (step S20). For example, the movement processing unit 615 can specify the position of the tip of the boom 131, i.e., the position of the base end of the arm 132, for moving the cutting edge of the bucket 133 to the target position, based on the relationship between the position of the base end of the bucket 133 specified from the target position of the cutting edge and the target attitude of the bucket 133 and the known position of the base end of the boom 131.
[0045] The movement processing unit 615 generates an operation signal based on the identified target positions and target attitudes of the boom 131, arm 132, and bucket 133, and outputs the operation signal to the control valve 123 (step S21).
[0046] The movement processing unit 615 determines whether the cutting edge of the bucket 133 has reached a predetermined end preparation point near the end point of the target trajectory T (step S22). The end preparation point may be, for example, a position a predetermined length before the end point of the target trajectory T, or it may be the end point of the target trajectory T. For example, the end preparation point may be a point at which the opening of the bucket 133 is brought closer to horizontal so that excavated soil and sand do not spill out of the bucket 133. If the cutting edge of the bucket 133 has not reached the end preparation point (step S22: NO), the control device 160 returns the process to step S11 and continues excavation control along the target trajectory T.
[0047] On the other hand, if the cutting edge of the bucket 133 has reached the end preparation point (step S22: YES), the measurement data acquisition unit 611 acquires measurement data from the boom stroke sensor 153, the arm stroke sensor 154, and the bucket stroke sensor 155 (step S23). The posture identification unit 613 identifies the posture of the work implement 130 based on the measurement data acquired from the boom stroke sensor 153, the arm stroke sensor 154, and the bucket stroke sensor 155 in step S23 (step S24).
[0048] The movement processing unit 615 determines the target attitude of the bucket 133 to be an attitude where the opening plane of the bucket 133 is horizontal, and determines the target position of the cutting edge of the bucket 133 to be a position where the bottom surface of the bucket 133 is along the target trajectory T in the determined target attitude (step S25). The movement processing unit 615 determines the target positions and target attitudes of the boom 131 and the arm 132 based on the target position of the cutting edge and the target attitude of the bucket 133 (step S26). The movement processing unit 615 generates an operation signal based on the specified target positions and target attitudes of the boom 131, arm 132, and bucket 133, and outputs the operation signal to the control valve 123 (step S27). The control device 160 then ends the automatic excavation control.
[0049] <<Actions and Effects>> In this way, the control device 160 of the work machine 100 according to the first embodiment performs the following processes. The control device 160 acquires measurement data of the inclination of the work machine 100. The control device 160 starts automatic excavation control, which outputs an operation signal for the work implement 130 in accordance with the target trajectory T for excavation. The control device 160 changes the target trajectory T in accordance with changes in the measurement data during automatic excavation control. This allows the work machine 100 to perform automatic excavation control while changing the target trajectory T in accordance with the hardness of the excavation target and the instability of the footing.
[0050] Furthermore, when a change in measurement data during automatic excavation control indicates that the work machine 100 is tilting backward, the control device 160 according to the first embodiment changes the target trajectory T so that the excavation depth D becomes shallower. The shallower the excavation depth D, the smaller the magnitude of the upward component of the reaction force of the excavation object. Therefore, in this way, when the work machine 100 tilts backward due to the hardness of the excavation object or the instability of the footing, the control device 160 can continue automatic excavation control while preventing the work machine 100 from tilting backward.
[0051] Furthermore, when a change in measurement data during automatic excavation control indicates that the work machine 100 is tilting backward, the control device 160 according to the first embodiment changes the target trajectory T to increase the excavation length L. When the excavation depth D becomes shallower, the amount of excavation by the bucket 133 decreases, so by increasing the excavation length L, the control device 160 can prevent the work machine 100 from tilting backward while also preventing a decrease in the amount of excavation.
[0052] The control device 160 according to the first embodiment changes the target trajectory T so that the digging depth D becomes deeper when a change in the measurement data during automatic excavation control indicates that the work machine 100 is not tilting backward. The deeper the digging depth D, the higher the excavation efficiency. Therefore, this enables the control device 160 to increase the efficiency of automatic excavation control within the range in which the work machine 100 does not tilt backward. Note that the control device 160 according to other embodiments may decrease the digging depth D when the work machine 100 is tilting backward, and maintain the digging depth D when the work machine 100 is not tilting backward.
[0053] Furthermore, when a change in the measurement data during automatic excavation control indicates that the work machine 100 is not tilting backward, the control device 160 according to the first embodiment changes the target trajectory T to shorten the excavation length L. As the excavation depth D increases, the amount of excavation by the bucket 133 increases, so by shortening the excavation length L, the control device 160 can prevent the amount of excavation from becoming excessive.
[0054] The control device 160 according to the first embodiment determines the next target trajectory T as the target trajectory T is changed. This makes it possible to set an appropriate target trajectory T from the start in the next automatic excavation control, thereby optimizing the efficiency of the automatic excavation control. In particular, according to the first embodiment, the work machine 100 can exert maximum force when the arm 132 is in a vertical excavation posture, and therefore, in automatic excavation control, excavation efficiency can be maximized by setting the point where the cutting edge of the bucket 133 is located in a vertical excavation posture as the lowest point of the target trajectory T. In other words, if the excavation length L of the target trajectory T becomes longer, the control device 160 according to the first embodiment can increase excavation efficiency by changing the start point of the target trajectory T to be further forward of the work machine 100 accordingly.
[0055] In automatic excavation control, the control device 160 according to the first embodiment generates an operation signal so that the angle of the cutting edge conforms to a target angle determined based on a tangent to the target trajectory T. Specifically, the operation signal is generated so that the angle between the cutting edge and the tangent becomes the interference prevention angle. If the cutting edge does not reach the start point of the target trajectory T when the angle of the bucket 133 is set to the interference prevention angle, the control device 160 increases the angle of the cutting edge with respect to the tangent at the start point beyond the interference prevention angle. This makes it possible to align the cutting edge with the target trajectory T even when the start point of the target trajectory T is far away. Note that a control device 160 according to other embodiments may increase the target attitude at the start point beyond the interference prevention angle, regardless of whether the cutting edge reaches the start point of the target trajectory T when the angle of the bucket 133 is set to the interference prevention angle. Furthermore, a control device 160 according to other embodiments may shorten the excavation length L of the target trajectory T or move the target trajectory T closer to the work machine 100 when the cutting edge does not reach the start point of the target trajectory T.
[0056] The control device 160 according to the first embodiment generates an operation signal to bring the opening of the bucket 133 closer to horizontal when the cutting edge of the bucket 133 reaches the end preparation point near the end point of the target trajectory T. If the slope of the tangent line at the end point of the target trajectory T is small, aligning the cutting edge along the tangent line to the target trajectory T with the end point may result in soil spilling from the bucket 133. Therefore, by controlling the opening of the bucket 133 to approach horizontal near the end point of the target trajectory T, soil spilling from the bucket 133 can be prevented. Note that while the control device 160 according to the first embodiment starts an operation to bring the opening closer to horizontal at the end preparation point, control devices 160 according to other embodiments may start an operation to bring the opening closer to horizontal at the end point of the target trajectory T. In this case as well, the control device 160 can prevent soil spilling from the bucket 133. Note that in other embodiments, the opening may be controlled to approach horizontal only when the slope of the tangent line at the end point of the target trajectory T is smaller than a predetermined threshold. In other embodiments, the control device 160 does not need to control the opening to approach horizontal.
[0057] 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 modifications are possible. That is, in other embodiments, the order of the above-described processes may be changed as appropriate. Furthermore, some processes may be executed in parallel.
[0058] The work machine 100 according to the embodiment described above is used for excavation on land, but is not limited to this and may be used for excavation underwater. Buoyancy occurs in the work machine 100 underwater, so the work machine 100 is more likely to float than on land.
[0059] The work machine 100 according to the embodiment described above operates autonomously in accordance with instructions from a higher-level device, but this is not limited to this. For example, the work machine 100 according to other embodiments may be a manned vehicle with an operator on board, or may be remotely controlled. In this case, the control device 160 starts automatic excavation control when it receives an automatic excavation instruction by the operator operating a button or the like. When the work machine 100 is remotely controlled, some of the functions of the control device 160 may be provided in the remote control device.
[0060] According to the above aspect, automatic excavation can be performed appropriately even if the attitude of the work machine changes.
[0061] DESCRIPTION OF SYMBOLS 100...Work machine 110...Traveling body 111...Crawler 112...Travel motor 120...Swinging body 121...Engine 122...Hydraulic pump 123...Control valve 124...Swing motor 130...Working machine 131...Boom 131C...Boom cylinder 132...Arm 132C...Arm cylinder 133...Bucket 133C...Bucket cylinder 151...Space measuring instrument 152...Inclination measuring instrument 153...Boom stroke sensor 154...Arm stroke sensor 155...Bucket stroke sensor 160...Control device 610...Processor 611...Measurement data acquisition unit 612...Instruction signal receiving unit 613...Attitude identification unit 614...Trajectory generation unit 615...Movement processing unit 630...Main memory 650...Storage 670...Interface T...Target trajectory
Claims
1. A control device for a work machine equipped with a work implement, comprising: acquiring measurement data of the inclination of the work machine; initiating automatic excavation control that outputs an operation signal for the work machine according to a target excavation trajectory; and changing the excavation operation in response to changes in the measurement data during the automatic excavation control.
2. The control device according to claim 1, wherein the excavation operation is changed by changing the target trajectory in response to a change in the measurement data.
3. The control device according to claim 2, wherein when a change in the measurement data during the automatic excavation control indicates that the work machine is leaning backward, the target trajectory is changed so that the lowest point becomes shallower.
4. The control device according to claim 3, wherein when a change in the measurement data during the automatic excavation control indicates that the work machine is leaning backward, the control device changes the target trajectory so that the arc length becomes longer.
5. The control device according to claim 2, wherein when a change in the measurement data during the automatic excavation control indicates that the work machine is not tilting backward, the target trajectory is changed so that the lowest point becomes deeper.
6. A control device as set forth in claim 5, wherein when a change in said measurement data during said automatic excavation control indicates that said work machine is not tilting backward, said control device changes said target trajectory so as to shorten the arc length.
7. The control device according to any one of claims 1 to 6, wherein a next target trajectory is determined in accordance with a change in the excavation operation.
8. A control device as claimed in any one of claims 1 to 6, wherein the working machine is provided with a work tool having a cutting edge, and in the automatic excavation control, the operation signal is generated so that the angle of the cutting edge conforms to a target angle determined based on a tangent to the target trajectory, and if the cutting edge does not reach the starting point of the target trajectory when the work tool is set at the target angle, the angle of the cutting edge with respect to the tangent at the starting point is made larger than the target angle.
9. A control device as claimed in any one of claims 1 to 6, wherein the working machine is provided with a work tool having a cutting edge and an opening for taking in soil and gravel, and in the automatic excavation control, the operation signal is generated so that the angle of the cutting edge conforms to a target angle determined based on a tangent to the target trajectory, and the operation signal is generated so that the opening approaches horizontal when or before the cutting edge reaches an end point of the target trajectory.
10. A control method for a work machine equipped with a work implement, comprising: a step of acquiring measurement data of the inclination of the work machine; a step of starting automatic excavation control that outputs an operation signal for the work machine according to a target excavation trajectory; and a step of changing the excavation operation in response to changes in the measurement data during the automatic excavation control.
Citation Information
Patent Citations
Drilling control device of hydraulic shovel
JP2003105795A
Shovel
JP2019007173A
Excavator
JP7146755B2
Work machine
WO2020049623A1
Work machine
WO2022224624A1
