Method and system for controlling construction machinery
In a method of controlling construction machinery, a bucket of a working device is moved along a first excavation trajectory to perform an excavation operation on the ground of a work area. A digging force exerted on the bucket during the excavation operation is calculated. A new second excavation trajectory is generated based on the calculated digging force. The bucket is moved along the second excavation trajectory.
1. A method of controlling construction machinery, the method comprising:
moving a bucket of a working device along a first excavation trajectory to perform an excavation operation on the ground of a work area;
measuring joint state values and cylinder pressure values of the working device during the excavation operation;
calculating a digging force exerted on the bucket during the excavation operation using the measured joint state values and the measured cylinder pressure values;
generating a second excavation trajectory based on the calculated digging force; and
moving the bucket along the second excavation trajectory.
2. The method of claim 1 , wherein the measured joint state values include an angle and an angular velocity of each of joints of a boom, an arm and the bucket, and the measured cylinder pressure valves include pressure values of a boom cylinder, an arm cylinder and a bucket cylinder.
3. The method of claim 2 , wherein the digging force is calculated based on the measured joint state values and the measured cylinder pressure values by using a Momentum-based Disturbance Observer.
4. The method of claim 1 , wherein the second excavation trajectory is generated, based on the calculated digging force, by a pre-learned prediction algorithm trained by using a digging force and topographic data of the work area.
5. The method of claim 4 , wherein the pre-learned algorithm is Dynamic Movement Primitives (DMP) using the second excavation trajectory as a critical dynamics model.
6. The method of claim 1 , wherein the second excavation trajectory is generated, based on the digging force, by reducing by reducing an excavation speed and excavation depth from the first excavation trajectory when the digging force exceeds a preset value.
7. The method of claim 1 , wherein the second excavation trajectory includes joint angle values over time of a boom, an arm and the bucket.
8. A control system for construction machinery, the system comprising:
a measurement portion configured to measure joint state values and cylinder pressure values of a working device of the construction machinery;
a control device configured to output a control signal for performing an automated excavation operation, wherein the control device is configured to
calculate a digging force exerted on a bucket during an excavation operation according to a first excavation trajectory, using the measured joint state values and the measured cylinder pressure values,
generate a second excavation trajectory based on the calculated digging force and to output a control signal for the second excavation trajectory; and
a work control device configured to move the bucket according to the control signal for the second excavation trajectory.
9. The control system for construction machinery of claim 8 , wherein the measurement portion includes a plurality of sensors for measuring an angle and an angular velocity of each of joints of a boom, an arm and the bucket, and pressure values of a boom cylinder, an arm cylinder and a bucket cylinder.
10. The control system for construction machinery of claim 8 , wherein the digging force estimator calculates the digging force based on the measured joint state values and the measured cylinder pressure values by using a Momentum-based Disturbance Observer.
11. The control system for construction machinery of claim 8 ,
wherein the control device receives topographic data of a work area, and
wherein the second excavation trajectory is generated by an algorithm trained by using the digging force and the topographic data of the work area as training data.
12. The control system for construction machinery of claim 11 , wherein the algorithm is Dynamic Movement Primitives (DMP) using the second excavation trajectory as a critical dynamics model.
13. The control system for construction machinery of claim 8 , wherein the control device generates the second excavation trajectory, based on the digging force, by reducing an excavation speed and excavation depth from the first excavation trajectory when the digging force exceeds a preset value.
14. The control system for construction machinery of claim 8 , wherein the second excavation trajectory includes joint angle values over time of a boom, an arm and the bucket of the working device.