Control device, drilling device, control method, and program
The control device addresses inefficiencies in excavation systems by managing excavation rig operations based on hydraulic pressure and attitude data thresholds, ensuring efficient and safe excavation by preventing stuck conditions.
Patent Information
- Application Number
- JP2023082853
- Authority / Receiving Office
- JP · JP
- Patent Type
- Applications
- Current Assignee / Owner
- Filing Date
- 2023-05-19
- Publication Date
- 2024-11-29
AI Technical Summary
Existing excavation systems face issues with inappropriate operation changes due to errors in calculating excavation reaction forces, leading to inefficient and potentially stuck conditions.
A control device that includes a hydraulic pressure acquisition unit, attitude data acquisition unit, and a control unit to manage excavation rig operations based on predetermined thresholds and conditions, allowing for controlled changes in excavation unit positions and angles to prevent stuck states and maintain efficient excavation.
Enables effective control of excavation rigs regardless of calculated excavation reaction forces, reducing the likelihood of erroneous determinations of stuck states and improving excavation efficiency and safety.
Smart Images

Figure 2024166637000001_ABST
Abstract
Description
[Technical field]
[0001] The present invention relates to a control device, an excavation device, a control method, and a program. [Background technology]
[0002] Conventionally, devices for excavating earth and sand are known. The construction machine described in Patent Document 1 determines whether or not it is necessary to change the content of the excavation operation when the excavation reaction force of the earth and sand acting on the bucket is greater than an upper limit value. [Prior art documents] [Patent documents]
[0003] [Patent Document 1] Patent No. 5519414 Summary of the Invention [Problem to be solved by the invention]
[0004] Various parameters are used to calculate the excavation reaction force. If there is an error in some of these parameters, the calculated value of the excavation reaction force will be an inappropriate value. As a result, there is a problem that the operation content of the construction machine may not be changed appropriately.
[0005] The present invention has been made in consideration of these points, and has an object to make it possible to control an excavation device without relying on a calculated value of the excavation reaction force. [Means for solving the problem]
[0006] A control device of a first aspect of the present invention is a control device that controls an excavation device that excavates soil, and has a hydraulic pressure acquisition unit that acquires hydraulic pressure for driving an excavation section of the excavation device that excavates soil, and a control unit that controls the excavation device by sending control data to the excavation device, and when the hydraulic pressure acquired by the hydraulic pressure acquisition unit remains above a threshold value for a first predetermined time or more, the control unit sends change control data to the excavation device for changing the position of the excavation section.
[0007] The control device may further have an attitude data acquisition unit that acquires attitude data indicating the attitude of the drilling device, and the control unit may transmit the change control data to the drilling device when the oil pressure acquired by the oil pressure acquisition unit remains above a threshold for a first predetermined time or more and the attitude of the drilling device indicated by the attitude data remains the same for a second predetermined time or more.
[0008] The control unit may transmit the change control data for changing an angle of the excavation unit relative to an arm to which the excavation unit is coupled. The control unit may transmit the change control data for changing an angle of the arm to which the excavation unit is coupled.
[0009] The control unit may output the control data for causing the hydraulic pressure to be equal to or greater than the threshold when the attitude of the drilling device indicated by the attitude data remains the same for a second predetermined time or more and the hydraulic pressure acquired by the hydraulic pressure acquisition unit remains equal to or greater than the threshold for less than a first predetermined time and then changes to a state below the threshold.
[0010] The control unit may output data other than the change control data without transmitting the change control data to the drilling device when the attitude of the drilling device indicated by the attitude data remains the same for a second predetermined time or more and the oil pressure acquired by the oil pressure acquisition unit remains above a threshold for less than a first predetermined time.
[0011] The control device may further have a memory unit that stores operation content data that associates the hydraulic pressure of the drilling device, the attitude of the drilling device, and the operation content to be performed by the drilling device, and the control unit may transmit to the drilling device the change control data corresponding to the operation content associated in the operation content data with a combination of the hydraulic pressure acquired by the hydraulic pressure acquisition unit and the attitude corresponding to the attitude data acquired by the attitude data acquisition unit.
[0012] The operation content data includes a trajectory along which the drilling unit moves as an operation content to be executed by the drilling device, and the control unit may transmit the change control data to the drilling device for moving the drilling unit along a trajectory associated with the combination in the operation content data.
[0013] The control device may further have a soil volume acquisition unit that acquires the amount of soil excavated by the excavation unit, and the control unit may transmit the change control data to the excavation device when the oil pressure acquired by the oil pressure acquisition unit is less than the threshold value and the amount acquired by the soil volume acquisition unit is less than a reference amount.
[0014] The control unit may transmit the change control data to the excavation device for changing the excavation position of the excavation unit in the horizontal direction when the excavation unit reaches a target excavation depth.
[0015] A control device of a second aspect of the present invention is a control device that controls an excavation device that excavates soil, and has an acquisition unit that acquires a driving force value indicating the magnitude of driving force generated by an electric motor that generates driving force for driving an excavation section that excavates soil by the excavation device, and a control unit that controls the excavation device by sending control data to the excavation device, and when a state in which the driving force value acquired by the acquisition unit is greater than or equal to a threshold value continues for more than a first predetermined time, the control unit sends change control data to the excavation device for changing the position of the excavation section.
[0016] A third aspect of the excavation device of the present invention comprises an excavation unit that excavates soil, a hydraulic pressure generating unit that generates hydraulic pressure to drive the excavation unit, and a control unit that controls the excavation unit by sending control data to the hydraulic pressure generating unit, and the control unit sends change control data to the hydraulic pressure generating unit for changing the position of the excavation unit when the hydraulic pressure generated by the hydraulic pressure generating unit remains above a threshold value for a first predetermined time or more.
[0017] A fourth aspect of the present invention provides an excavation device comprising: an excavation unit for excavating soil; an electric motor for generating a driving force for driving the excavation unit; and a control unit for controlling the excavation unit by sending control data to the electric motor, wherein the control unit sends change control data to the electric motor for changing the position of the excavation unit when the driving force generated by the electric motor remains above a threshold value for a first predetermined time or longer.
[0018] A control method of a fifth aspect of the present invention includes the steps of: acquiring hydraulic pressure for driving an excavation section of an excavation device that excavates earth, the excavation device being executed by a computer; and, when the acquired hydraulic pressure remains above a threshold value for a first predetermined time or longer, transmitting change control data to the excavation device for changing the position of the excavation section.
[0019] A sixth aspect of the program of the present invention causes a computer to execute the steps of acquiring hydraulic pressure for driving an excavation section of an excavation device that excavates earth, and, when the acquired hydraulic pressure remains above a threshold value for a first predetermined time or longer, transmitting change control data to the excavation device for changing the position of the excavation section. Effect of the Invention
[0020] According to the present invention, it is possible to effectively control the excavation equipment without relying on the calculated value of the excavation reaction force. [Brief description of the drawings]
[0021] [Figure 1] FIG. 2 is a diagram for explaining an overview of the excavation system S. [Diagram 2] FIG. 2 is a diagram showing a configuration of a control device 1. [Diagram 3] FIG. 11 is a diagram showing an example of operation content data. [Figure 4] FIG. 11 is a diagram showing another example of the operation content data. [Diagram 5] 11 is a flowchart of a process in which the control unit 134 controls the excavation device 2 based on hydraulic pressure and attitude data. [Figure 6] 13 is a flowchart showing the flow of a stack release process (S15). [Figure 7] 10 is a flowchart showing a process in which the control unit 134 controls the excavation device 2 based on the hydraulic pressure and the amount of soil. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0022] [Outline of Drilling System S] FIG. 1 is a diagram for explaining an overview of an excavation system S. The excavation system S is a system for excavating soil T. The soil T may be non-artificial soil or may be an artificially created bank. As shown in FIG. 1(a), the excavation system S has a control device 1 and an excavation device 2. The excavation system S is a system for excavating soil T below a structure B by, for example, a pneumatic caisson method.
[0023] The control device 1 is a device, such as a computer, for controlling the excavation device 2. The control device 1 may be mounted on the excavation device 2, but in this specification, a case will be described in which the control device 1 is installed in a remote control room away from the position where the excavation device 2 excavates the soil T.
[0024] The excavation device 2 excavates soil T under the control of the control device 1. The excavation device 2 transmits and receives data to and from the control device 1 via a cable C or a wireless communication line. The excavation device 2 transmits, for example, data indicating the hydraulic pressure applied to the excavation device 2 and the attitude of each part of the excavation device 2 to the control device 1, and receives control data for operating the excavation device 2 from the control device 1. The excavation device 2 excavates soil T by changing the position of each part based on the received control data. The excavation device 2 moves along a rail R installed on the ceiling of the space between the structure B and the soil T.
[0025] The excavation device 2 has a bucket 21, an arm 22, a boom 23, a bucket cylinder 24, and an arm cylinder 25. The bucket 21 is an excavation part for excavating earth and sand, and is connected to the arm 22 in a state where its angle can be changed. The arm 22 is provided between the bucket 21 and the boom 23, and is connected to the boom 23 in a state where its angle can be changed. The arm 22 may be configured to be extendable and retractable. The boom 23 is connected to the rail R in a state where it can move along the rail R. The boom 23 may be connected to the rail R in a state where its angle with respect to the rail R can be changed.
[0026] The bucket cylinder 24 has one end fixed to the bucket 21 and the other end fixed to the arm 22. The arm cylinder 25 has one end fixed to the arm 22 and the other end fixed to the boom 23. The bucket cylinder 24 and the arm cylinder 25 extend and retract by hydraulic pressure. The arm 22 may include a hydraulic pressure generating unit that generates hydraulic pressure for extending and retracting. The bucket cylinder 24 and the arm cylinder 25 may each include a hydraulic pressure generating unit that generates hydraulic pressure for extending and retracting the arm 22.
[0027] The hydraulic pressure generating unit changes the hydraulic pressure for extending and retracting the arm 22, the bucket cylinder 24, and the arm cylinder 25 based on control data transmitted by the control device 1. The change in hydraulic pressure causes the arm 22, the bucket cylinder 24, and the arm cylinder 25 to extend and retract, changing the angles of the bucket 21 and the arm 22. The change in at least one of the angle of the bucket 21 or the angle of the arm 22 enables the bucket 21 to excavate soil T.
[0028] FIG. 1(b) is an enlarged view of the excavation device 2. Position A in FIG. 1(b) is the position where one end of the bucket cylinder 24 is fixed to the arm 22. Position B is the position where the other end of the bucket cylinder 24 is fixed to the bucket 21. Position C is the position of the center of rotation when the bucket 21 changes its angle. In this specification, the distance d in the vertical direction from the rail R to the tip of the bucket 21 (i.e., the direction perpendicular to the longitudinal direction of the rail R) is referred to as the excavation depth. Also, the angle θ (see FIG. 1(c)) formed by the line segments AC and CB in FIG. 1(b) is referred to as the bucket angle θ.
[0029] [Configuration of control device 1] 2 is a diagram showing the configuration of the control device 1. The control device 1 has a communication unit 11, a storage unit 12, and a CPU (Central Processing Unit) 13. The CPU 13 has a hydraulic pressure acquisition unit 131, a posture data acquisition unit 132, a soil volume acquisition unit 133, and a control unit 134.
[0030] The communication unit 11 has a communication interface for transmitting and receiving data to and from the excavation device 2. The communication unit 11 inputs data indicating the hydraulic pressure received from the excavation device 2 to the hydraulic pressure acquisition unit 131. The communication unit 11 inputs soil volume data indicating the amount of soil scooped up by the excavation device 2 to the soil volume acquisition unit 133.
[0031] Furthermore, the communication unit 11 inputs data indicating the attitude of the excavation device 2 received from the excavation device 2 to the attitude data acquisition unit 132. The data indicating the attitude is expressed by at least one of the angle of the bucket 21 relative to the arm 22, the angle of the arm 22 relative to the boom 23, the length of the arm 22, the length of the bucket cylinder 24, and the length of the arm cylinder 25, for example.
[0032] The communication unit 11 transmits control data input from the control unit 134 to the excavation device 2. The control data is, for example, data for increasing or decreasing the hydraulic pressure for driving the arm 22, the bucket cylinder 24, and the arm cylinder 25. The control data may be data indicating a target value of the hydraulic pressure.
[0033] The storage unit 12 has storage media such as a read only memory (ROM), a random access memory (RAM), and a solid state drive (SSD). The storage unit 12 stores a program executed by the CPU 13. The storage unit 12 also stores various data used by the CPU 13 to control the drilling device 2.
[0034] The memory unit 12 stores operation content data in which, for example, the hydraulic pressure of the excavation device 2, the attitude of the excavation device 2, and the operation content to be executed by the excavation device 2 are associated with each other. The memory unit 12 may store operation content data in which the hydraulic pressure, the amount of soil scooped up by the bucket 21, and the operation content to be executed by the excavation device 2 are associated with each other. The operation content data may be data described by a program. The operation content data may include a trajectory along which the bucket 21 moves as the operation content to be executed by the excavation device 2.
[0035] Fig. 3 is a diagram showing an example of operation content data. In the operation content data shown in Fig. 3, the hydraulic pressure, the time during which the same hydraulic pressure continues, the posture of the excavation device 2, the time during which the same posture continues, and the operation content are associated with each other. In this specification, the "same posture" is not limited to the completely same posture, but also includes a state in which the bucket 21 is vibrating, the bucket 21 is only moving slightly, or the bucket 21 is unable to scoop up soil because the bucket 21 is unable to scoop up soil due to the bucket 21 being pushed down by the reaction force of the soil T and rotating as the arm 22 extends.
[0036] Fig. 4 is a diagram showing another example of operation content data. In the operation content data shown in Fig. 4, the hydraulic pressure, the amount of soil scooped up by bucket 21, the angle of bucket 21, and operation content are associated with each other. The operation content data may further be associated with the length of arm 22. Details of the operation executed by CPU 13 with reference to these operation content data will be described later.
[0037] The storage unit 12 may further store data indicating targets of the excavation operation of the excavation device 2. The data indicating the targets is, for example, data indicating horizontal target positions in the space where the excavation device 2 works, or data indicating targeted excavation depths at each horizontal position.
[0038] Next, a description will be given of the CPU 13. The CPU 13 executes the programs stored in the storage unit 12 to function as a hydraulic pressure acquisition unit 131, a posture data acquisition unit 132, a soil volume acquisition unit 133, and a control unit .
[0039] The hydraulic pressure acquisition unit 131 acquires the hydraulic pressure for driving the bucket 21 of the excavation device 2 via the communication unit 11. The hydraulic pressure acquisition unit 131 notifies the control unit 134 of the acquired hydraulic pressure.
[0040] The attitude data acquisition unit 132 acquires attitude data indicating the attitude of the excavator 2 via the communication unit 11. The attitude data includes, for example, at least one of the angle of the arm 22 with respect to the boom 23, the length of the arm 22, and the length of the bucket cylinder 24. The attitude data acquisition unit 132 notifies the control unit 134 of the acquired attitude data.
[0041] The soil volume acquisition unit 133 acquires the volume of soil excavated by the bucket 21. The soil volume acquisition unit 133 acquires data indicating the volume of soil measured by, for example, a weight sensor provided in the excavation device 2, or by processing point cloud data acquired by a LiDAR provided in the excavation device 2 or in the space in which the excavation device 2 operates. The soil volume acquisition unit 133 notifies the control unit 134 of the acquired volume of soil. Note that a means other than LiDAR may be used to measure the volume of soil, or both LiDAR and a means other than LiDAR may be used.
[0042] The control unit 134 controls the excavation device 2 by transmitting control data to the excavation device 2. The control unit 134 determines the operation content of the excavation device 2 based on at least one of the hydraulic pressure notified from the hydraulic pressure acquisition unit 131, the attitude of the excavation device 2 notified from the attitude data acquisition unit 132, and the amount of soil notified from the soil amount acquisition unit 133.
[0043] The control unit 134 transmits change control data for changing the position of the bucket 21 to the excavation device 2 when the hydraulic pressure acquired by the hydraulic pressure acquisition unit 131 continues to be equal to or higher than the threshold for a first predetermined time or more. The threshold is, for example, F1 in FIG. 3, and is a hydraulic pressure that is not expected to occur when no stuck state occurs. Stuck is a state in which the bucket 21 does not move even if the hydraulic pressure for driving the bucket 21 is increased. The first predetermined time is a time during which the hydraulic pressure is not expected to continue to be equal to or higher than the threshold when no stuck state occurs, and is, for example, 2 seconds.
[0044] The control unit 134 determines that a stuck state has occurred when the hydraulic pressure continues to be equal to or higher than the threshold value for a first predetermined time or longer. In this case, the control unit 134 controls the bucket 21 to perform an operation to release the stuck state. Specifically, the control unit 134 transmits change control data to the excavation device 2 to make the position of the bucket 21 shallower or to change the horizontal position where the bucket 21 excavates.
[0045] More specifically, the control unit 134 transmits change control data for changing the bucket angle θ, which is the angle of the bucket 21 with respect to the arm 22 to which the bucket 21 is joined, or transmits change control data for changing the angle or length of the arm 22 to which the bucket 21 is joined. In the case of the example shown in Fig. 1, the control unit 134 reduces the bucket angle θ or changes the angle or length of the arm 22 so that the arm 22 approaches the rail R.
[0046] The control unit 134 may transmit change control data for shortening the arm 22. The control unit 134 may transmit change control data for changing the angle of the arm 22 with respect to the boom 23 in order to change the horizontal position of the excavation device 2, or may transmit change control data for changing the position of the boom 23 on the rail R.
[0047] [Hydraulic and attitude-based control] The control unit 134 may control the excavation device 2 based on the hydraulic pressure acquired by the hydraulic pressure acquisition unit 131 and the attitude of the excavation device 2. The control unit 134, for example, refers to data indicating a relationship between a predetermined length of the bucket cylinder 24 and a bucket angle θ, and specifies the bucket angle θ corresponding to the length of the bucket cylinder 24 indicated by the attitude data, thereby specifying the attitude of the excavation device 2.
[0048] As an example, when the hydraulic pressure acquired by the hydraulic pressure acquisition unit 131 remains equal to or higher than the threshold for a first predetermined time or more, and the attitude of the excavation device 2 indicated by the attitude data remains the same for a second predetermined time or more, the control unit 134 determines that a stuck state has occurred, and transmits change control data for changing the position of the bucket 21 to the excavation device 2. The second predetermined time is a time during which the attitude of the excavation device 2 is not expected to remain the same if the excavation device 2 is not stuck or if the excavation device 2 is not broken, and is, for example, 3 seconds, which is longer than the first predetermined time. By the control unit 134 determining whether a stuck state has occurred using the attitude of the excavation device 2 in this manner, it is possible to prevent an erroneous determination that a stuck state has occurred when the bucket 21 is moving little by little in the excavation direction even though the hydraulic pressure is equal to or higher than the threshold.
[0049] The second predetermined time may be 1 second, which is shorter than the first predetermined time. By setting the second predetermined time in this manner, when the moving speed of the bucket 21 gradually decreases due to hard soil in the place where the bucket 21 is excavating, and the bucket 21 stops moving after the hydraulic pressure reaches or exceeds a threshold value, the control unit 134 can quickly release the excavation device 2 from the stuck state when the first predetermined time has elapsed. The second predetermined time may be a fixed time, or may be a time set by a user of the excavation device 2 based on the characteristics of the soil T to be excavated by the excavation device 2.
[0050] The control unit 134 may determine that a stuck state has occurred on the condition that the hydraulic pressure acquired by the hydraulic pressure acquisition unit 131 remains equal to or higher than the threshold value for a first predetermined time or more, the attitude of the excavation device 2 indicated by the attitude data remains the same for a second predetermined time or more, and the excavation position of the bucket 21 in the vertical direction is shallower than a reference position. In this case, the control unit 134 transmits change control data to the excavation device 2 for changing the horizontal position at which the bucket 21 excavates or for stopping the operation of the excavation device 2. The control unit 134 may display the occurrence of an abnormal state on a display or transmit alarm data to an information terminal used by the manager of the excavation device 2.
[0051] Even if the posture of the excavation device 2 continues in the same state for more than the second predetermined time, the stuck state may be released and the hydraulic pressure may drop. In order to enable the excavation device 2 to excavate the soil T in such a case, the control unit 134 may output control data for causing the hydraulic pressure to be equal to or higher than the threshold (e.g., a maximum allowable value) when the posture of the excavation device 2 indicated by the posture data continues in the same state for more than the second predetermined time and the hydraulic pressure acquired by the hydraulic pressure acquisition unit 131 changes to a state below the threshold after being equal to or higher than the threshold for less than the first predetermined time.
[0052] However, if the attitude of the excavation device 2 does not change for a long period of time even though the hydraulic pressure has not reached or exceeded the threshold, there is a risk that a malfunction has occurred in the excavation device 2. Therefore, when the attitude of the excavation device 2 indicated by the attitude data remains the same for a second predetermined time or more and the hydraulic pressure acquired by the hydraulic pressure acquisition unit 131 remains at or above the threshold for less than a first predetermined time, the control unit 134 may output data other than the change control data without transmitting the change control data to the excavation device 2. The data other than the change control data is, for example, warning data for notifying the manager of the excavation device 2 or data for flashing a warning light mounted on the excavation device 2.
[0053] When the hydraulic pressure remains equal to or above the threshold for less than a first predetermined time and then changes to a state below the threshold, the control unit 134 may output warning data or the like other than the change control data on the condition that the attitude of the excavation device 2 does not change even after outputting the change control data for making the hydraulic pressure equal to or above the threshold. By operating in this manner, the control unit 134 can determine whether or not there is a malfunction by testing whether or not the attitude of the excavation device 2 changes in response to changing the hydraulic pressure after the hydraulic pressure falls below the threshold, thereby reducing the probability of erroneously determining that there is a malfunction.
[0054] The control unit 134 may determine the operation content corresponding to the notified hydraulic pressure and attitude by referring to the operation content data shown in Fig. 3. That is, the control unit 134 transmits to the excavation device 2 change control data corresponding to the operation content associated in the operation content data with a combination of the hydraulic pressure acquired by the hydraulic pressure acquisition unit 131 and the attitude corresponding to the attitude data acquired by the attitude data acquisition unit. When the operation content data includes data indicating a trajectory along which the bucket 21 moves as the operation content to be executed by the excavation device 2, the control unit 134 may transmit to the excavation device 2 change control data for moving the bucket 21 on a trajectory associated with the combination in the operation content data.
[0055] Specifically, when the attitude of the excavation device 2 changes within a second predetermined time (T2) even though the hydraulic pressure is equal to or greater than the hydraulic pressure threshold (F1), the control unit 134 determines that the excavation device 2 is operating normally and causes the excavation device 2 to continue operating. In this case, the control unit 134 periodically transmits control data for causing the excavation device 2 to excavate soil and sand T, for example. The control unit 134 outputs warning data when the state in which the hydraulic pressure is equal to or greater than the hydraulic pressure threshold (F1) continues for only within the first predetermined time (T1) but the state in which the attitude does not change continues for the second predetermined time (T2) or more.
[0056] When the state in which the hydraulic pressure is equal to or higher than the hydraulic pressure threshold value (F1) continues for at least a first predetermined time (T1) and the state in which the attitude does not change continues for at least a second predetermined time (T2), the control unit 134 determines that a stuck state has occurred, and transmits, for example, change control data for making the trajectory of the bucket 21 shallower to the excavation device 2. When different trajectories are associated with the operation content data depending on the hydraulic pressure and attitude states, the control unit 134 transmits change control data to the excavation device 2 for moving the bucket 21 on a trajectory corresponding to the hydraulic pressure and attitude states.
[0057] The control unit 134 determines that the hydraulic pressure is below the hydraulic pressure threshold (F1) and a change in attitude is occurring as long as it is normal, and allows the excavation device 2 to continue operating. The control unit 134 outputs warning data when the state in which the hydraulic pressure is below the hydraulic pressure threshold (F1) and the attitude is not changing continues for a second predetermined time (T2) or more.
[0058] [Hydraulic and volume-based control] There may be cases where a stuck state does not occur and the amount of soil scooped up by the bucket 21 is small. In such a case, there is a possibility that a situation has occurred in which the excavation equipment 2 is not present at a position where soil and sand that can be excavated is present, or a situation in which the excavation equipment 2 has broken down. Therefore, when the hydraulic pressure acquired by the hydraulic pressure acquisition unit 131 is less than the hydraulic pressure threshold value (F1) and the amount acquired by the soil volume acquisition unit 133 is less than the soil volume reference amount, the control unit 134 transmits change control data to the excavation equipment 2. The reference amount is the amount of soil that is expected to be scooped up by the bucket 21 when the excavation equipment 2 is performing an excavation operation at a position where soil can be excavated.
[0059] The control unit 134 executes control of the excavation device 2 based on the hydraulic pressure and the amount of soil, for example, based on the operation content data shown in FIG. 4 stored in the memory unit 12. When the hydraulic pressure is less than the hydraulic pressure threshold (F1) and the amount of soil is equal to or greater than the soil amount reference value (V1), the control unit 134 determines that the excavation device 2 is normally excavating the soil T, and causes the excavation device 2 to continue the excavation operation. When the hydraulic pressure is less than the hydraulic pressure threshold (F1), the amount of soil is less than the soil amount reference value (V1), and the bucket angle θ has not reached the angle limit value (A1), the control unit 134 transmits change control data to the excavation device 2 for decreasing the bucket angle θ so that the bucket 21 can be inserted deeper into the soil T. The angle limit value (A1) is, for example, the minimum value of the bucket angle θ shown in FIG. 1. The control unit 134 may transmit change control data to the excavation device 2 for lengthening the arm 22 so that the bucket 21 can be inserted deeper into the soil T.
[0060] When the hydraulic pressure is less than the hydraulic pressure threshold value (F1), the soil volume is less than the soil volume reference value (V1), and the bucket angle θ has reached the angle limit value (A1), the control unit 134 determines that the bucket 21 cannot excavate any more soil T at the position of the excavation equipment 2, and transmits change control data for changing the horizontal excavation position of the excavation equipment 2 to the excavation equipment 2. The control unit 134 may transmit change control data for changing the horizontal excavation position of the excavation equipment 2 to the excavation equipment 2, on the condition that the bucket angle θ and the length of the arm 22 have reached their limit values.
[0061] When the hydraulic pressure is equal to or greater than the hydraulic pressure threshold value (F1) and the amount of soil is equal to or greater than the soil amount reference value (V1), the control unit 134 determines that the excavation device 2 is operating normally and causes the excavation device 2 to continue the excavation operation. However, when the control unit 134 determines that the excavation operation should not be continued based on the attitude of the excavation device 2 and the operation content data shown in Fig. 3, it may execute an operation corresponding to the combination of the hydraulic pressure and attitude.
[0062] When the hydraulic pressure is equal to or greater than the hydraulic pressure threshold value (F1) and the soil volume is less than the soil volume reference value (V1), it is determined that there is hard rock at the depth to which the bucket 21 is excavating, and change control data for shallowing the trajectory of the bucket 21 is transmitted to the excavation device 2. The control unit 134 may change the angle of the bucket 21, or may shorten either the bucket cylinder 24 or the arm cylinder 25 to shallow the trajectory of the bucket 21.
[0063] [Hydraulic, attitude and volume-based control] The control unit 134 may control the excavation device 2 based on the hydraulic pressure, the attitude of the excavation device 2, and the amount of soil. The control unit 134 may deepen the next excavation trajectory, for example, when it is determined that the amount of soil is less than the soil amount reference value (V1) and that a stuck state will not occur based on the hydraulic pressure and the duration of the attitude.
[0064] That is, when the amount of soil is less than the soil amount reference value (V1) and the state in which the hydraulic pressure acquired by the hydraulic pressure acquisition unit 131 is equal to or greater than the threshold has not continued for a first predetermined time or more, or when the attitude of the excavator 2 indicated by the attitude data has not continued in the same state for a second predetermined time or more, the control unit 134 deepens the excavation trajectory by decreasing the bucket angle θ. The control unit 134 may deepen the excavation trajectory by changing the angle of the arm 22. Conversely, the control unit 134 may change the angle of the arm 22 to make the excavation trajectory shallower. By operating the control unit 134 in this manner, it is possible to improve the excavation efficiency when no stuck occurs.
[0065] [Control based on excavation depth] The control unit 134 may control the excavation device 2 based on the depth (i.e., excavation depth) excavated by the bucket 21. As an example, when the bucket 21 reaches a target excavation depth, the control unit 134 transmits change control data to the excavation device 2 for changing the excavation position of the bucket 21 in the horizontal direction.
[0066] Specifically, the control unit 134 first specifies the vertical distance d from the rail R to the tip of the bucket 21 as the excavation depth based on the angle of the bucket 21 relative to the arm 22 and the angle of the arm 22 relative to the boom 23 indicated by the posture data, the size of the bucket 21, the length of the arm 22, and the size of the boom 23. If the specified excavation depth is less than the target depth stored in the memory unit 12, the control unit 134 transmits change control data for increasing the excavation depth to the excavation device 2. If the specified excavation depth has reached the target depth stored in the memory unit 12, the control unit 134 determines that excavation should not be continued at the same position, and transmits change control data for changing the position of the boom 23 along the rail R to the excavation device 2.
[0067] When the control unit 134 determines that no stuck condition has occurred based on the hydraulic pressure and the attitude of the excavation device 2, the control unit 134 may cause the bucket 21 to continue excavation in the same position until the target excavation depth is reached. The control unit 134 may also change the horizontal position of the excavation device 2 on the condition that the bucket 21 has reached the target depth at the time when the control unit 134 determines that a stuck condition has occurred based on the hydraulic pressure and the attitude of the excavation device 2. By operating in this manner, the control unit 134 can make the bucket 21 dig as deep as possible when no stuck condition has occurred, and can change the horizontal position at which the excavation device 2 excavates when a stuck condition has occurred, thereby improving excavation efficiency.
[0068] [Processing flow in the control device 1] Figures 5 to 7 are flowcharts showing the flow of processing in the control device 1. Figure 5 is a flowchart of processing in which the control unit 134 controls the excavation device 2 based on hydraulic pressure and attitude data. The flowchart shown in Figure 5 starts from the point in time when the excavation device 2 starts excavation.
[0069] The hydraulic pressure acquisition unit 131 periodically acquires, for example, hydraulic pressure for driving the bucket cylinder 24 and the arm cylinder 25 (S11). Furthermore, the attitude data acquisition unit 132 periodically acquires, for example, attitude data indicating the attitude of each part of the excavation device 2 (S12).
[0070] Each time the hydraulic pressure acquisition unit 131 acquires hydraulic pressure, the control unit 134 determines whether the state in which the hydraulic pressure is equal to or greater than the hydraulic pressure threshold (F1) continues for a first predetermined time (T1) or more (S13). When the control unit 134 determines that the state in which the hydraulic pressure is equal to or greater than the hydraulic pressure threshold (F1) continues for the first predetermined time (T1) or more (YES in S13), it determines whether the same posture continues for a second predetermined time (T2) or more (S14). When the control unit 134 determines that the same posture continues for the second predetermined time (T2) or more (YES in S14), it executes a process for releasing the stuck state (S15). When the control unit 134 determines that the same posture has not continued for the second predetermined time (T2) or more (NO in S14), it returns to S13.
[0071] If there is a change in at least one of the conditions of the hydraulic pressure or the attitude of the excavation device 2 as a result of executing the stuck release process (YES in S16), the control unit 134 determines that the stuck state has been released and returns to S11. If there is no change in either the hydraulic pressure or the attitude of the excavation device 2 (NO in S16), the control unit 134 outputs warning data (S17) and then transmits change control data for changing the horizontal position of the excavation device 2 to the excavation device 2 (S18).
[0072] When the control unit 134 determines in S13 that the hydraulic pressure is less than the hydraulic pressure threshold value (F1) (NO in S13), it determines whether the same posture continues for a second predetermined time (T2) or more (S19). When the same posture continues for the second predetermined time (T2) or more (YES in S19), the control unit 134 changes the hydraulic pressure command value to increase the hydraulic pressure and returns to S13 (S20). When the same posture does not continue for the second predetermined time (T2) or more (NO in S19), the control unit 134 waits until the same posture continues for the second predetermined time (T2) or more. The control device 1 repeats the processes from S11 to S20 until it receives an instruction to end the control of the excavation device 2 (NO in S21).
[0073] 6 is a flowchart showing the flow of the stack release process (S15). The control unit 134 determines whether or not the bucket angle θ can be changed to be smaller (S151). For example, when the bucket angle θ has not reached the angle limit value (A1) (the minimum value in the example of FIG. 1), the control unit 134 determines that the bucket angle θ can be reduced.
[0074] If the control unit 134 determines that the bucket angle θ can be changed to be smaller (YES in S151), it transmits change control data for decreasing the bucket angle θ so that the bucket 21 can be pulled out of the soil T (S152). Next, the control unit 134 transmits change control data for increasing the bucket angle θ, thereby inserting the bucket 21 again into the soil T (S153).
[0075] If the control unit 134 determines that the bucket angle θ cannot be reduced (NO in S151), it determines whether or not it is possible to change the angle of the arm 22 by shortening the arm cylinder 25 (S154). If the control unit 134 determines that the angle of the arm 22 can be changed (YES in S154), it changes the angle of the arm 22 by shortening the arm cylinder 25 so that the bucket 21 is inserted into the soil T at a shallow trajectory (S155). If the control unit 134 determines in S154 that the angle of the arm 22 cannot be changed (NO in S154), it ends the process and proceeds to S16.
[0076] 7 is a flowchart of a process in which the control unit 134 controls the excavation device 2 based on the hydraulic pressure and the volume of soil. The hydraulic pressure acquisition unit 131 acquires the hydraulic pressure for driving the bucket cylinder 24 and the arm cylinder 25, for example, periodically (S31). The soil volume acquisition unit 133 also acquires soil volume data, for example, periodically (S32).
[0077] When the control unit 134 judges that the hydraulic pressure is less than the hydraulic pressure threshold value (F1) (YES in S33), it judges whether the amount of soil is less than the soil amount reference value (V1) (S34). When the control unit 134 judges that the amount of soil is less than the soil amount reference value (V1) (YES in S34), it judges whether the angles of the bucket 21, the arm 22, and the boom 23 (hereinafter referred to as "angles of each part") have reached their limit values (S35). For example, the control unit 134 judges whether the bucket angle θ has reached the angle limit value (A1) (minimum value in the example of FIG. 1) and the angles of the joints of the arm 22 and the boom 23 have also reached their limit values. When the control unit 134 judges that the amount of soil is equal to or greater than the soil amount reference value (V1) (NO in S34), it returns to S31.
[0078] If the angle of each part has reached its limit value (YES in S35), the control unit 134 transmits to the excavation device 2 change control data for changing the horizontal position of the excavation device 2 (S36). If any of the angles of each part has not reached its limit value (NO in S35), the control unit 134 transmits to the excavation device 2 change control data for changing at least any of the angles of each part so that the excavation can be performed deeper (S37). The control unit 134 repeats S31 to S39 until it receives an instruction to end excavation from the manager, for example (NO in S38).
[0079] When the control unit 134 determines in S33 that the hydraulic pressure is equal to or greater than the hydraulic pressure threshold value (F1) (NO in S33), it determines whether or not the amount of soil is less than the soil amount reference value (V1) (S39). When the control unit 134 determines that the amount of soil is less than the soil amount reference value (V1) (YES in S39), it advances the process to S14 in Fig. 5. When the control unit 134 determines that the amount of soil is equal to or greater than the soil amount reference value (V1) (NO in S39), it returns to S31.
[0080] [Effect of control device 1] As described above, when the state in which the hydraulic pressure acquired by the hydraulic pressure acquisition unit 131 is equal to or higher than the threshold continues for a first predetermined time or more, the control unit 134 determines that a stuck has occurred, and transmits change control data for changing the position of the bucket 21 to the excavation device 2. By the control unit 134 operating in this manner, the control device 1 becomes able to control the excavation device 2 regardless of the calculated value of the excavation reaction force.
[0081] Furthermore, the control unit 134 determines that the excavation device 2 is stuck if the posture of the excavation device 2 continues for a second predetermined time or more, thereby reducing the probability of erroneous determination. The control device 1 that uses the posture of the excavation device 2 in this manner is suitable for a caisson shovel type excavation device 2 in which the inclination of the excavation device 2 does not change even when an excavation reaction force is applied.
[0082] [Variations] In the above explanation, the control device 1 is a computer provided at a different location from the excavation device 2, but the excavation device 2 may have the functions of the control device 1 built in, and the excavation device 2 may excavate soil T by automatic control. That is, the processor of the excavation device 2 executes processing equivalent to that of the control unit 134 that controls the bucket 21 by sending control data to the hydraulic pressure generating unit. As an example, the processor of the excavation device 2 sends change control data to the hydraulic pressure generating unit for changing the position of the excavation unit when the hydraulic pressure generated by the hydraulic pressure generating unit remains at or above a threshold for a first predetermined time or longer.
[0083] In addition, in the above explanation, an example was given of the case where the control device 1 automatically controls the drilling device 2, but an operator may operate the control device 1, and the control device 1 may perform part of the control based on the operator's operation.
[0084] In the above description, the excavation device 2 is operated by hydraulic pressure, but the excavation device 2 may be configured to be operated by a driving force generated by an electric motor instead of or in addition to hydraulic pressure. In this case, the control device 1 has an acquisition unit, instead of the hydraulic pressure acquisition unit 131, that acquires a driving force value indicating the magnitude of the driving force generated by the electric motor that generates the driving force for driving the excavation unit that excavates soil, and the control unit 134 transmits change control data for changing the position of the excavation unit to the excavation device 2 when the driving force value acquired by the acquisition unit is equal to or greater than a threshold value and continues for a first predetermined time or longer. Then, the control device 1 can control the excavation device 2 in an equivalent manner by replacing the hydraulic pressure in the above description with the driving force value. Note that the driving force value may be, for example, a value indicating the voltage or current given to the electric motor, or a value indicating the driving force output from the electric motor.
[0085] In addition, instead of a hydraulic generating unit, the drilling device 2 has an electric motor for driving the drilling unit, and a control unit for controlling the drilling unit by sending control data to the electric motor, and the control unit may send change control data to the electric motor for changing the position of the drilling unit when the driving force generated by the electric motor remains above a threshold value for a first predetermined time or more.
[0086] Although the present invention has been described above using the embodiments, the technical scope of the present invention is not limited to the scope described in the above embodiments, and various modifications and changes are possible within the scope of the gist of the present invention. For example, all or part of the device can be configured by distributing or integrating functionally or physically in any unit. In addition, new embodiments resulting from any combination of multiple embodiments are also included in the embodiments of the present invention. The effect of the new embodiment resulting from the combination combines the effect of the original embodiment. [Explanation of symbols]
[0087] 1 Control device 2. Drilling rig 11 Communications Department 12 Storage section 21 Bucket 22 Arm 23. Boom 24 Bucket Cylinder 25 Arm Cylinder 131 Hydraulic acquisition section 132 Attitude data acquisition unit 133 Land Acquisition Department 134 Control Unit
Claims
1. A control device for controlling an excavation device for excavating soil, a hydraulic pressure acquisition unit for acquiring hydraulic pressure for driving an excavation unit that excavates soil by the excavation device; A control unit that controls the drilling device by transmitting control data to the drilling device; having The control unit transmits change control data for changing a position of the excavation unit to the excavation device when a state in which the hydraulic pressure acquired by the hydraulic pressure acquisition unit is equal to or higher than a threshold continues for a first predetermined time or more. Control device.
2. Further, a posture data acquisition unit that acquires posture data indicating the posture of the drilling device, The control unit transmits the change control data to the excavation device when a state in which the hydraulic pressure acquired by the hydraulic pressure acquisition unit is equal to or higher than a threshold continues for a first predetermined time or more and an attitude of the excavation device indicated by the attitude data continues to be the same for a second predetermined time or more. The control device according to claim 1 .
3. The control unit transmits the change control data for changing an angle of the excavation unit relative to an arm to which the excavation unit is coupled. The control device according to claim 2.
4. The control unit transmits the change control data for changing the angle of an arm to which the excavation unit is coupled. The control device according to claim 2 or 3.
5. The control unit outputs the control data for causing the hydraulic pressure to be equal to or greater than the threshold when the attitude of the excavation device indicated by the attitude data continues in the same state for a second predetermined time or more and the hydraulic pressure acquired by the hydraulic pressure acquisition unit changes to a state below the threshold after a state of being equal to or greater than the threshold continued for less than a first predetermined time. The control device according to claim 2.
6. The control unit outputs data other than the change control data without transmitting the change control data to the excavation device when the attitude of the excavation device indicated by the attitude data continues in the same state for a second predetermined time or more and the state in which the hydraulic pressure acquired by the hydraulic pressure acquisition unit is equal to or higher than a threshold value continues for less than a first predetermined time. The control device according to claim 2.
7. Further comprising a storage unit that stores operation content data in which the hydraulic pressure of the excavation device, the attitude of the excavation device, and the operation content to be executed by the excavation device are associated with each other, The control unit transmits to the excavation device the change control data corresponding to the operation content associated in the operation content data with a combination of the hydraulic pressure acquired by the hydraulic pressure acquisition unit and the attitude corresponding to the attitude data acquired by the attitude data acquisition unit. The control device according to claim 2.
8. The operation content data includes a trajectory along which the excavation unit moves as an operation content to be executed by the excavation device, The control unit transmits the change control data to the excavation device for moving the excavation unit along a trajectory associated with the combination in the operation content data. The control device according to claim 7.
9. The excavation unit further includes a soil volume acquisition unit that acquires the volume of soil excavated by the excavation unit, The control unit transmits the change control data to the excavation device when the hydraulic pressure acquired by the hydraulic pressure acquisition unit is less than the threshold value and the amount acquired by the soil volume acquisition unit is less than a reference amount. The control device according to claim 1 .
10. The control unit transmits the change control data to the excavation device when the excavation unit reaches a target excavation depth, for changing an excavation position of the excavation unit in a horizontal direction. The control device according to claim 1 .
11. A control device for controlling an excavation device for excavating soil, an acquisition unit that acquires a driving force value indicating a magnitude of a driving force generated by an electric motor that generates a driving force for driving an excavation unit that excavates soil by the excavation device; A control unit that controls the drilling device by transmitting control data to the drilling device; having The control unit transmits change control data for changing a position of the excavation unit to the excavation device when a state in which the driving force value acquired by the acquisition unit is equal to or greater than a threshold value continues for a first predetermined time or more. Control device.
12. An excavation unit that excavates soil; A hydraulic pressure generating unit that generates hydraulic pressure for driving the excavation unit; A control unit that controls the excavation unit by transmitting control data to the hydraulic pressure generating unit; having The control unit transmits change control data to the hydraulic pressure generating unit for changing a position of the excavation unit when a state in which the hydraulic pressure generated by the hydraulic pressure generating unit is equal to or higher than a threshold value continues for a first predetermined time or more. Drilling equipment.
13. An excavation unit that excavates soil; an electric motor that generates a driving force for driving the excavation unit; A control unit that controls the excavation unit by transmitting control data to the electric motor; having The control unit transmits change control data to the electric motor for changing a position of the excavation unit when a state in which the driving force generated by the electric motor is equal to or greater than a threshold value continues for a first predetermined time or more. Drilling equipment.
14. The computer executes A step of obtaining hydraulic pressure for driving an excavation section of an excavation device that excavates earth; When the acquired hydraulic pressure is equal to or higher than the threshold value for a first predetermined time or more, transmitting change control data for changing the position of the excavation unit to the excavation device; The control method includes:
15. On the computer, A step of obtaining hydraulic pressure for driving an excavation section of an excavation device that excavates earth; When the acquired hydraulic pressure is equal to or higher than the threshold value for a first predetermined time or more, transmitting change control data for changing the position of the excavation unit to the excavation device; A program for executing the above.
Citation Information
Patent Citations
Automatic junction point tracer
JP1980019414A
