Construction machine
The construction machine with articulated working devices and controlled hydraulic actuators addresses the issue of unnecessary deceleration and restricted area entry, ensuring efficient operation by decelerating only the normal direction component towards the restricted area, thus preventing contact with boundaries and reducing work time.
Patent Information
- Application Number
- JP2023086023
- Authority / Receiving Office
- JP · JP
- Patent Type
- Applications
- Current Assignee / Owner
- Filing Date
- 2023-05-25
- Publication Date
- 2024-12-05
AI Technical Summary
Existing construction machines, such as hydraulic excavators, face issues with increased work time due to unnecessary deceleration when operating within deceleration areas, and existing technologies do not effectively prevent other front parts from entering restricted areas, leading to impaired operability in narrow spaces.
A construction machine with an articulated working device that includes entry detection points on multiple driven members, a control device to manage hydraulic actuators, and a system to decelerate only the normal direction component towards the restricted area, avoiding sudden stops and reducing work time by controlling the operation of non-operated actuators.
The system prevents entry into restricted areas while minimizing work time by selectively decelerating only the normal direction component towards the restricted area, allowing smooth operation and reducing the risk of contact with boundaries.
Smart Images

Figure 2024168945000001_ABST
Abstract
Description
[Technical field]
[0001] The present invention relates to a construction machine equipped with an articulated working device. [Background technology]
[0002] A hydraulic excavator, which is a type of construction machine, is equipped with an articulated working device (front device) and an operating device. The front device is made up of multiple rigid bodies that perform rotational motion, such as a boom and an arm. The operating device is, for example, an operating lever that corresponds to the rotational motion of each rigid body of the front device. A worker (operator) performs work such as shaping slopes and leveling the ground by freely operating the operating lever, for example.
[0003] Operators are required to have high level of skills to carry out these tasks. For example, when working in urban areas, care must be taken to ensure that the front gear does not interfere with surrounding objects (such as underground electric wires or walls). In the field of construction machinery, various proposals have been made to prevent interference between the front gear and surrounding objects.
[0004] Patent Document 1 describes a working area control device for an excavator. In this working area control device, a deceleration area is set just before a restricted area, and when a front part (e.g., a bucket) constituting a front device enters the deceleration area, the operation signal of an operating lever is multiplied by a damping coefficient to decelerate the front device, and when the bucket reaches the boundary of a prohibited area, it is stopped.
[0005] According to the working area control device of Patent Document 1, by providing a point for determining entry into the restricted area at any position of each front part, it is possible to monitor entry of all front parts into the restricted area.
[0006] Patent Document 2 describes a region-limiting excavation control device for a construction machine. In this region-limiting excavation control device, an excavable region is set, and when a part of the front equipment (e.g., a bucket) approaches the boundary of the excavable region, the movement of the bucket in the direction toward the boundary is decelerated, and when the bucket reaches the boundary of the excavable region, the bucket does not go outside the excavable region but can move along the boundary of the excavable region.
[0007] Furthermore, not only in the field of construction machinery, but also in the field of robots, active development of technology to prevent robot arms from colliding with other objects is being carried out (for example, Patent Document 3). Patent Document 3 describes a robot control device that provides a damping region and a limiting region, and decelerates the robot when it enters the damping region, thereby reducing the risk of it entering the limiting region. [Prior art documents] [Patent documents]
[0008] [Patent Document 1] Japanese Patent Application Publication No. 4-136324 [Patent Document 2] International Publication No. 95 / 30059 [Patent Document 3] JP 2022-131424 A Summary of the Invention [Problem to be solved by the invention]
[0009] However, in the working area control device of Patent Document 1 and the robot control device of Patent Document 3, damping is applied even when moving in a direction leaving the damping area, which increases unnecessary work time. Patent Document 2 only describes restricting entry into a restricted area based on the tip of the bucket, and does not take measures for the operation when other front parts enter the restricted area.
[0010] In addition, during hydraulic excavator work, there are cases where the bucket cylinder or arm cylinder is operated to be at its longest or shortest length to set the posture of the bucket and arm. In this case, if the above operation is performed in a narrow working space using the techniques of Patent Documents 1 and 2, the front parts may come into contact with the boundary surface of the restricted area, causing repeated stopping operations and greatly impairing operability.
[0011] In view of the above problems, the present invention has an object to provide a construction machine that can prevent a work implement from entering a restricted area while suppressing an increase in work time. [Means for solving the problem]
[0012] In order to solve the above problems, a typical configuration of a construction machine according to the present invention includes a multi-joint type working device configured by connecting multiple driven members, multiple hydraulic actuators that drive the multiple driven members, multiple operating devices that operate the operation of the multiple hydraulic actuators, a storage device that stores a restriction area that restricts the entry of the driven members, a deceleration area adjacent to the restriction area, and entry detection points set on the multiple driven members, and a control device that controls the operation of the multiple hydraulic actuators, and is characterized in that when the operating device is operated and the entry detection point enters the deceleration area, the control device decomposes the movement speed of the entry detection point into a normal component and a tangential component of the restriction area boundary surface, which is the boundary surface between the restriction area and the deceleration area, and controls the operation of the multiple hydraulic actuators so as to decelerate the normal component only if the normal component is heading toward the restriction area.
[0013] The control device having the above configuration can prevent a driven member of a working device from entering the deceleration area by slowing down the speed of the driven member (entry detection point) in the direction toward the restricted area. Therefore, even if the driven member is in the deceleration area, the speed in the direction away from the restricted area or the speed in the direction parallel to the boundary surface of the restricted area is not slowed down, so that an increase in work time can be suppressed. In addition, by setting the entry detection point not only on the tip of the bucket but also on multiple driven members (especially the position of the shaft), the speed in the direction toward the restricted area can be similarly slowed down even if a front part other than the bucket enters the deceleration area, and entry into the restricted area can be reliably prevented.
[0014] The control device described above may control the operation of hydraulic actuators that are not being operated by an operator, among the plurality of hydraulic actuators.
[0015] As a result, even if the driven member of the working device is about to enter the restricted area due to the operation of the operating device by the worker, the driven part can be prevented from entering the restricted area by operating the hydraulic actuator that is not operated by the worker. In other words, when the driven member is about to enter the restricted area, a smooth avoidance action can be taken by automatic operation rather than a sudden stop action.
[0016] When the entry detection point enters the restricted area, the control device may correct the normal direction component of the moving speed of the entry detection point in a direction in which the entry detection point leaves the restricted area.
[0017] As a result, even if the driven member of the working device enters the restricted area, the operation of the hydraulic actuator can be controlled to move the driven member out of the restricted area. Effect of the Invention
[0018] According to the present invention, a construction machine can be provided that can prevent a work implement from entering a restricted area while suppressing an increase in work time. [Brief description of the drawings]
[0019] [Figure 1] FIG. 2 is a diagram illustrating a configuration and a coordinate system of a construction machine according to an embodiment of the present invention. [Diagram 2] FIG. 2 is a diagram showing functional blocks of the construction machine of FIG. [Diagram 3] 3 is a flowchart showing the process of the control device of FIG. 2. [Figure 4] 4 is a flowchart corresponding to the processes in steps S110 and S112 of FIG. 3. [Diagram 5] FIG. 13 is a diagram showing the relationship between an entry detection point and a point on a boundary surface of a restricted area. [Figure 6] 4 is a flowchart showing the process of step S114 in FIG. 3. [Figure 7] 1(b) is a diagram showing the operation of the working device of FIG. 1(a) in a restricted region and a damping region. FIG. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0020] A preferred embodiment of the present invention will be described in detail below with reference to the accompanying drawings. The dimensions, materials, and other specific values shown in the embodiment are merely examples for facilitating understanding of the invention, and do not limit the present invention unless otherwise specified. In this specification and drawings, elements having substantially the same functions and configurations are given the same reference numerals to avoid repeated explanations, and elements not directly related to the present invention are not shown.
[0021] Fig. 1 is a diagram for explaining the configuration and coordinate system of a construction machine 100 in an embodiment of the present invention. As shown in Fig. 1(a), the construction machine 100 is a hydraulic excavator equipped with a vehicle body 102 and an articulated working device 104. The working device 104 is also called a front device.
[0022] The vehicle body 102 has a revolving body 106, a cab 108, and a traveling device 110. The revolving body 106 is disposed on the traveling device 110, and can revolve around a vertical axis. The cab 108 is placed on the revolving body 106. An operation device 112 (see FIG. 2) is disposed in the cab 108. The traveling device 110 has a pair of crawlers 110a, 110b. The construction machine 100 travels by the rotation of each of the pair of crawlers 110a, 110b of the traveling device 100.
[0023] The working device 104 is attached onto a rotating body 106. The working device 104 has a boom 114, an arm 116, and a bucket 118, which are multiple driven members, and is configured by connecting these together. The boom 114 is attached to the rotating body 106 so as to be able to swing. The arm 116 is attached to the tip of the boom 114 so as to be able to swing. The bucket 118 is attached to the tip of the arm 116 so as to be able to swing.
[0024] The work device 104 further has a boom cylinder 120, an arm cylinder 122, and a bucket cylinder 124, which are multiple hydraulic actuators driven by hydraulic fluid. The boom cylinder 120, the arm cylinder 122, and the bucket cylinder 124 drive the boom 114, the arm 116, and the bucket 118, respectively.
[0025] FIG. 1(b) shows each coordinate system set with the construction machine 100 as the reference. First, Σx means a coordinate system related to x. Σp is one of the coordinate systems of points on the restricted area boundary surface P, and is one example of an infinite number of coordinate systems. The restricted area boundary surface P is the boundary surface between the restricted area α that restricts the entry of multiple driven members and the damping area (deceleration area β) adjacent to the restricted area α, as described later (see FIG. 5 and FIG. 7). Σw shows the world coordinate system that is the reference in the working space. Furthermore, in FIG. 1(b), Σb is shown as the boom coordinate system, Σa as the arm coordinate system, Σk as the bucket coordinate system, and Σt as the bucket tip coordinate system of the bucket tip 118a (see FIG. 1(a)).
[0026] Next, xTy means the simultaneous transformation matrix from the X coordinate system to the y coordinate system. Therefore, wTp indicates the simultaneous transformation matrix from the world coordinate system to the coordinate system of the point on the boundary surface of the restricted area. Furthermore, in Figure 1(b), wTb is shown as the simultaneous transformation matrix from the world coordinate system to the boom coordinate system, bTa is shown as the simultaneous transformation matrix from the boom coordinate system to the arm coordinate system, aTk is shown as the simultaneous transformation matrix from the arm coordinate system to the bucket coordinate system, kTt is shown as the simultaneous transformation matrix from the bucket coordinate system to the bucket tip coordinate system, and pTt is shown as the simultaneous transformation matrix from the coordinate system of the point on the boundary surface of the restricted area to the bucket tip coordinate system.
[0027] Fig. 2 is a diagram showing functional blocks of the construction machine 100 in Fig. 1(a). The construction machine 100 is equipped with multiple operation devices 112, a measuring device 126, a storage device 128, a control device 130, and multiple flow control valves 132. The operation device 112 is disposed in the operator's cab 108 of the construction machine 100, and is an operation lever or the like that is operated by an operator. The operation device 112 outputs an operation signal according to the amount of operation, and controls the operation of multiple hydraulic actuators, that is, a boom cylinder 120, an arm cylinder 122, and a bucket cylinder 124.
[0028] The measuring device 126 measures the postures of the boom 114, the arm 116, and the bucket 118, which are multiple driven members. The storage device 128 stores the limited area α and the deceleration area β shown in FIG. 5 and FIG. 7 as point cloud data, and further stores the entry detection points set on the multiple driven members. The limited area boundary surface P is the boundary surface between the limited area α and the deceleration area β, and can be calculated based on the point cloud data. However, this is not limited to this, and the limited area boundary surface P may be set in advance as point cloud data. The entry detection points are set at, for example, the positions of the axes of the boom 114, the arm 116, and the bucket 118, or the position of the bucket tip 118a. A plurality of these entry detection points may be set at any positions on each driven member.
[0029] The control device 130 outputs control signals for controlling the operation of the multiple hydraulic actuators, that is, the boom cylinder 120, the arm cylinder 122, and the bucket cylinder 124, to multiple flow control valves 132. The flow control valves 132 control the flow rate and direction of hydraulic pressure supplied to the boom cylinder 120, the arm cylinder 122, and the bucket cylinder 124. The flow control valves 132 are also driven in response to operation signals output in response to the operation amounts of the multiple operating devices 112 and control signals from the control device 130.
[0030] As shown in the figure, the control device 130 includes a tentative target cylinder velocity calculation unit 134, a cylinder velocity-joint angular velocity conversion unit 136, a front posture calculation unit 138, a nearest point search unit 140, a region control calculation unit 142, a joint angular velocity-cylinder velocity conversion unit 144, and a valve command calculation unit 146.
[0031] A tentative target cylinder velocity calculation unit 134 converts the operation amount output from the operation device 112 into a tentative target velocity of the cylinder (tentative target cylinder velocity) based on an arbitrary law. A cylinder velocity-joint angular velocity conversion unit 136 converts the tentative target cylinder velocity converted by the tentative target cylinder velocity calculation unit 134 into a joint velocity (tentative target joint angular velocity). A front posture calculation unit 138 calculates the front posture based on the angle information of the boom 114, the arm 116, and the bucket 118 output from the measurement device 126 and preset geometric information.
[0032] The nearest neighbor point search unit 140 reads out the point cloud data from the storage device 128 and the entry detection points set on the front parts constituting the working device 104, i.e., the boom 114, the arm 116, and the bucket 118, and searches for the nearest point. The nearest neighbor point is the point having the shortest straight-line distance between the entry detection point of the front part and the restricted area boundary surface P based on the point cloud data. Furthermore, when there are multiple entry detection points set on one front part, the nearest neighbor point search unit 140 searches for a combination having the shortest straight-line distance between the point cloud data in the storage device 128 and multiple entry detection points on one front part.
[0033] The area control calculation unit 142 calculates a corrected target joint angular velocity by correcting the provisional target joint angular velocity calculated by the cylinder velocity-joint angular velocity conversion unit 136 based on the position information and velocity information of the entry detection point. Here, the position information of the entry detection point is the position information of the entry detection point searched for by the nearest point search unit 140, which corresponds to the entry detection point on the coordinate system of the point on the area limiting boundary P with the normal vector of the limiting area boundary surface P as the z axis. Also, the velocity information of the entry detection point is the velocity information of the entry detection point generated when the provisional target joint angular velocity calculated by the cylinder velocity-joint angular velocity conversion unit 136 is executed.
[0034] A joint angular velocity-cylinder velocity conversion unit 144 converts the corrected target angular velocity calculated by the area control calculation unit 142 into a target cylinder velocity. A valve command calculation unit 146 calculates a valve command that realizes the target cylinder velocity, and outputs the valve commands to the multiple flow control valves 132.
[0035] Fig. 3 is a flowchart showing the processing of the control device 130 in Fig. 2. First, the control device 130 acquires joint angle information of the working device 104 from the measuring device 126 (step S100), and further acquires the operation amounts of the boom cylinder 120, the arm cylinder 122, and the bucket cylinder 124 from the operation device 112 (step S102).
[0036] Next, the control device 130 searches for the nearest points from the point groups on the restricted area boundary surface P for each coordinate system, which are the arm coordinate system Σa, the bucket coordinate system Σk, and the bucket tip coordinate system Σt, as entry detection points (step S104).
[0037] The control device 130 calculates the position and Jacobian matrix of the entry detection point with the nearest point searched for in step S104 as the reference coordinate system (step S106). As an example, the joint position of Σt can be calculated using the following equation (1).
number
[0038] In step S106, the Jacobian matrix is calculated by time-differentiating the joint angle in the above formula (1). Here, X^(-1) means the inverse matrix of the matrix X. Next, the control device 130 converts the operation amount of each hydraulic actuator acquired in step S102 into a target cylinder speed based on an arbitrary law, and further obtains the speed of the entry detection point on the nearest point coordinate system from the converted target cylinder speed using the Jacobian matrix calculated in step S106 (step S108).
[0039] Next, the control device 130 judges whether the position and speed of the arm coordinate system Σa on the nearest point coordinate system are subject to area control (step S110), and if they are subject to area control (Yes), performs processing of step S112 (see FIG. 4). These steps are calculated sequentially starting from the coordinate system Σ on the base driven member that is closest to the world coordinate system Σw.
[0040] Fig. 4 is a flowchart corresponding to the processing of steps S110 and S112 in Fig. 3. Fig. 5 is a diagram showing the relationship between the entry detection point and points on the boundary surface of the restricted area. Note that Σa0, Σa1, Σa2, and Σa3 shown in Fig. 5 respectively indicate patterns 0, 1, 2, and 3 of the arm coordinate system Σa. Also, the nearest point in the arm coordinate system Σa in all patterns is p.
[0041] In step S200 shown in Fig. 4, the control device 130 uses the following formula (2) to determine whether pΣa(z), which is the Z position of the arm coordinate system in the nearest point P coordinate system, is greater than or equal to 0. Fig. 5 shows that Σa0, Σa1, and Σa2 are greater than or equal to 0, and Σa3 is smaller than 0. In other words, Σa3 is located within the restricted area α.
number
[0042] If the Z position in the arm coordinate system is equal to or greater than 0 in step S200 (No), the control device 130 uses the following formula (3) to determine whether pΣa(z), which is the Z position in the arm coordinate system in the nearest point p coordinate system, is within the attenuation region β (step S202). Figure 5 shows that Σa1 and Σa2 are located within lmin (deceleration region β), and Σa0 is not located within lmin. Note that lmin is the range of the attenuation region that is arbitrarily set.
number
[0043] If the Z position of the arm coordinate system is located within the attenuation region in step S202 (Yes), the control device 130 uses the following equation (4) to determine whether the Z velocity dot(pΣa(z)) of the arm coordinate system in the nearest point p coordinate system has a velocity component in the direction approaching the boundary surface P (step S204).
number
[0044] If the Z velocity of the arm coordinate system has a velocity component in a direction approaching the boundary surface (Yes) in step S204, the control device 130 attenuates (slows down) the Z velocity of the arm coordinate system by a damping coefficient k according to the distance from the restricted area boundary surface P, using the following formula (5) (step S206). Note that the damping coefficient k is an arbitrary value that can be freely set.
number
[0045] On the other hand, if the Z position of the arm coordinate system is smaller than 0 in step S200, i.e., if it is located within the restricted area α (Yes), the control device 130 updates the Z velocity dot(pΣa(z)) of the arm coordinate system in the nearest point p coordinate system to a velocity such that the entry detection point is on the restricted area boundary surface P (step S208). Fig. 5 shows that Σa3 is located within the restricted area α.
number
[0046] In this manner, as shown in step S112, when the arm 116 is located in the restricted region α, the control device 130 updates the target velocity so that the arm 116 leaves the restricted region α (does not enter the restricted region α), and when the arm 116 is located in the attenuation region β, the control device 130 updates the target velocity of the normal direction component approaching the boundary P. Note that specific operations of the working device 104 shown in Fig. 1(a) in the restricted region α and attenuation region β will be described later (see Fig. 7).
[0047] After steps S206 and S208, the control device 130 updates the target avoidance velocity dot(θa) and the null space projection matrix N shown in Fig. 3 (step S114). If the vehicle is not located within the attenuation region in step S202 (No), or if the vehicle does not have a velocity component in a direction approaching the boundary surface P in step S204 (No), the control device 130 performs the process of step S116 shown in Fig. 3.
[0048] Fig. 6 is a flowchart showing the process of step S114 in Fig. 3. The control device 130 judges whether the target avoidance speed dot(θa) and the null space projection matrix N have never been calculated (step S300). If the target avoidance speed dot(θa) and the null space projection matrix N have never been calculated in step S300 (Yes), the control device 130 sets the target avoidance speed dot(θa) to
[0000] as shown in the following equation (7). T and the null space projection matrix N is initialized to a 3-row, 3-column unit matrix I(3) (step S302). The number of elements changes according to the number of rows of the Jacobian matrix. However, the Jacobian matrix here has three elements because it represents the position and orientation on a quadratic plane.
number
[0049] On the other hand, if the target avoidance velocity dot(θa) and the null space projection matrix N have been calculated once in step S300 (No), or after the initialization in step S302, the control device 130 performs an operation of extracting only the elements related to the Z axis from the Jacobian matrix pJa, which converts the joint angular velocities of the working device 104 into the velocity of the arm coordinate system in the p coordinate system, using the following equation (8) (step S304).
number
[0050] Next, the control device 130 updates the target avoidance velocity dot(θa) using the following equation (9) (step S306), and calculates the target angular velocity of the joint of the working device 104 such that the sum of squares of the Z velocity dot(pΣa(z)) of the arm coordinate system in the nearest point p coordinate system is minimized. X^+ means the pseudo-inverse matrix of the non-square matrix X. Here, if the target avoidance velocity dot(θa) and the null space projection matrix N have already been calculated even once, there is often a deviation between the Z velocity dot(pΣa(z)) of the arm coordinate system in the nearest point p coordinate system and the realized velocity. In such a case, the Z velocity dot(pΣa(z)) of the arm coordinate system may be given as a target velocity taking the deviation into account.
number
[0051] An example of implementation shown in formula (10) is given below.
number
[0052] Next, the control device 130 updates the null space projection matrix N using the following equation (11) (step S308). Note that the value multiplied by the null space projection matrix N in equation (11) is projected into a space that does not affect the Z velocity dot(pΣa(z)) of the arm coordinate system in the coordinate system of the nearest point P. In this manner, the control device 130 updates the target avoidance velocity dot(θa) and the null space projection matrix N.
number
[0053] 3 are processes related to the bucket coordinate system Σk and correspond to the above-mentioned steps S110, S112, S114, respectively. Therefore, the control device 130 can execute steps S116, S118, S120 by performing the above-mentioned steps S110, S112, S114, respectively, for the bucket coordinate system Σk instead of the arm coordinate system Σa.
[0054] Furthermore, steps S122, S124, and S126 are processes related to the bucket tip coordinate system Σt, and correspond to the processes of steps S110, S112, and S114, respectively, described above. Therefore, the control device 130 can execute steps S122, S124, and S126 by performing the processes of steps S110, S112, and S114 described above for the bucket tip coordinate system Σt instead of the arm coordinate system Σa.
[0055] After step S126, i.e., after the calculations related to the front parts of the working device 104 are completed, the control device 130 calculates the final target angular velocity of each joint using the target avoidance velocity dot(θa) and the null space projection matrix N, as shown in the following equation (12) (step S128).
number
[0056] In the above formula (12), dot(θ) is the final target angular velocity of each joint of the working device 104. dot(θa) is the target avoidance velocity that is forcibly implemented when the entry detection point is located within the attenuation region or the restriction region. N is the null space projection matrix. dot(θr) is the target angular velocity of each joint of the working device 104 that is determined by the operation amount of the operation device 112. Note that for dot(θr), a target velocity that takes deviation into consideration may also be given, as in the above implementation example.
[0057] As a result, the angular velocity of each joint of the working device 104, which is determined by the amount of operation of the operating device 112, is realized within a range that satisfies the target angular velocity of each joint of the working device 104 so that the entry detection point does not enter the restricted area α.
[0058] Next, the control device 130 converts the final target angular velocity dot(θ) of each joint of the working device 104 calculated in step S128 into a target cylinder speed (step S130), and further controls the flow control valve 132 so that the hydraulic actuators, that is, the boom cylinder 120, the arm cylinder 122, and the bucket cylinder 124, follow the target cylinder speed.
[0059] Fig. 7 is a diagram showing the operation of the working implement 104 in Fig. 1(a) in the restriction region α and the deceleration region β. First, a case will be described in which, in the construction machine 100, the boom cylinder 120 is operated by the worker, the boom 114 moves at the operator-instructed speed shown by the arrow QA in Fig. 7(a), and the entry detection point set at the bucket tip 118a enters the deceleration region β.
[0060] When the entry detection point enters the deceleration region β, the control device 130 reduces the movement speed of the entry detection point by a normal direction component Z t and the tangential component x t As shown in Fig. 7(a), the normal component Z t is directed toward the restricted area α. Therefore, the control device 130 controls the operation of the arm cylinder 122 and the bucket cylinder 124 that are not being operated by the worker. The control device 130 controls the operation of the arm cylinder 122 in the direction of the arrow RA, and further controls the operation of the bucket cylinder 124 in the direction of the arrow SA, thereby reducing the normal direction component Z t A to Z t+1 The tangential component x t x t+1 is corrected to, but is not decelerated.
[0061] Also, as explained in step S204 of FIG. 4, even if the object is located within the attenuation region, the object will not attenuate (decelerate) if the velocity is in a direction away from the boundary surface.
[0062] In this way, in the construction machine 100, even if the bucket tip 118a of the work implement 104 enters the deceleration region β, the control device 130 decelerates the speed only in the direction in which the entry detection point moves toward the restricted region α, thereby making it possible to avoid entry into the restricted region α.
[0063] Therefore, according to the construction machine 100, even if the driven member of the working implement 104 is within the deceleration region β, the speed in the direction away from the restricted region α and the speed in the direction parallel to the restricted region boundary surface P are not decelerated, so that an increase in work time can be suppressed. Also, by setting entry detection points not only on the bucket tip 118a but also on multiple driven members (particularly the shaft positions), even if a front part other than the bucket 118 enters the deceleration region β, the speed in the direction toward the restricted region α can be similarly decelerated, and entry into the restricted region α can be reliably avoided.
[0064] Furthermore, when the worker operates the boom cylinder 120, the control device 130 preferentially controls the operation of the arm cylinder 122 and bucket cylinder 124 that are not being operated by the worker. As a result, even if the driven member of the working device 104 is about to enter the restricted area α due to the worker's operation of the operating device 112, the hydraulic actuator that is not being operated by the worker can be operated to prevent the driven member from entering the restricted area α. Therefore, according to the construction machine 100, when the driven member of the working device 104 is about to enter the restricted area α, it is possible to smoothly take an avoidance action by automatic operation rather than performing an abrupt stop action.
[0065] Next, we will explain the case where, in the construction machine 100, the boom cylinder 120 is operated by an operator, the boom 114 moves at the operator-instructed speed shown by arrow QB in Figure 7(b), and the entry detection point set at the bucket tip 118a enters the restricted area α.
[0066] When the entry detection point enters the restricted area α, the control device 130 calculates the moving speed of the entry detection point by the normal direction component Z t and the tangential component x t The control device 130 controls the operation of the arm cylinder 122 at the arm correction speed indicated by the arrow RB, and further controls the operation of the bucket cylinder 124 at the bucket correction speed indicated by the arrow SB. In this way, the control device 130 controls the normal direction component Z t A to Z t+1 The corrected normal component Z t+1 is the velocity component in the direction in which the entry detection point leaves the restricted area α. Note that the tangential component x t x t+1 is corrected to, but is not decelerated.
[0067] As a result, according to the construction machine 100, even if the driven member of the working implement 104 enters the restricted area α, the operation of the hydraulic actuator can be controlled to move the driven member out of the restricted area α.
[0068] Although the preferred embodiment of the present invention has been described above with reference to the accompanying drawings, it goes without saying that the present invention is not limited to such an example. It is clear that a person skilled in the art can think of various modified or altered examples within the scope of the claims, and it is understood that such examples also naturally belong to the technical scope of the present invention. [Industrial Applicability]
[0069] The present invention can be used as a construction machine equipped with an articulated working device. [Explanation of symbols]
[0070] 100...construction machine, 102...vehicle body, 104...working device, 106...swivel body, 108...operator cab, 110...traveling device, 110a, 110b...crawler, 112...operating device, 114...boom, 116...arm, 118...bucket, 118a...bucket tip, 120...boom cylinder, 122...arm cylinder, 124...bucket cylinder, 126...measuring device, 128...storage device, 130...control device, 132...flow control valve, 134...temporary target cylinder speed calculation unit, 136...cylinder speed-joint angular speed conversion unit, 138...front posture calculation unit, 140...closest point search unit, 142...area control calculation unit, 144...joint angular speed-cylinder speed conversion unit, 146...valve command calculation unit, α...restriction area, β...damping area (deceleration area), P...restriction area boundary surface
Claims
1. A multi-joint working device configured by connecting a plurality of driven members; A plurality of hydraulic actuators for driving the plurality of driven members; A plurality of operating devices for operating the plurality of hydraulic actuators; a storage device that stores a limiting area that limits the entry of the driven members, a deceleration area adjacent to the limiting area, and entry detection points set on the plurality of driven members; a control device for controlling the operation of the plurality of hydraulic actuators, The control device includes: When the operation device is operated and the entry detection point enters the deceleration area, the moving speed of the entry detection point is decomposed into a normal direction component and a tangential direction component of a restriction area boundary surface which is a boundary surface between the restriction area and the deceleration area, A construction machine characterized in that the operation of the plurality of hydraulic actuators is controlled so as to decelerate the normal direction component only when the normal direction component is heading toward the restricted area.
2. 2. The construction machine according to claim 1, wherein the control device controls the operation of hydraulic actuators that are not operated by a worker, among the plurality of hydraulic actuators.
3. 3. The actuator according to claim 1, wherein, when the entry detection point enters the restricted area, the control device corrects a normal component of the movement speed of the entry detection point in a direction in which the entry detection point leaves the restricted area.
Citation Information
Patent Citations
Working zone control device for drilling machine
JP1992136324A
Robot control device
JP2022131424A
Aera limiting digging control device for a building machine
WO1995030059A1
