Unmanned operation backhoe dredger slope fine excavation planning control method
Through the unmanned backhoe dredger slope excavation planning control method, three-dimensional terrain data and dynamic planning algorithms are used to solve the problem that traditional manual construction is difficult to ensure slope flatness, and efficient and accurate underwater slope excavation is achieved.
Patent Information
- Application Number
- CN202510190255.7
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2025-02-20
- Publication Date
- 2025-06-10
- Estimated Expiration
- 2045-02-20
AI Technical Summary
In the underwater slope excavation construction scenario, traditional manual construction methods are difficult to ensure the flatness of the slope and cannot meet the requirements of high-precision projects, resulting in an extended construction cycle and an increased workload, and affecting the stability and safety of the project.
The unmanned operation backhoe dredger slope finishing planning control method is adopted to calculate the excavation path and optimize the bucket soiling angle by constructing three-dimensional terrain data, discrete processing terrain data, dynamic planning algorithms, and implementing high-precision slope excavation.
It improves the efficiency of underwater sump construction, improves slope flatness, reduces over-excavation and under-excavation, and enhances the stability and safety of construction.
Smart Images

Figure CN120124273A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to a method for precise excavation planning and control of the slope of an unmanned backhoe dredger. Background Art
[0002] In the scenario of precise underwater slope excavation construction of canal channels, backhoe dredgers have become important construction equipment, but they face many challenges. The underwater terrain is complex and changeable, and there may be gullies, protrusions, alternating soft and hard soil layers, etc.; the soil properties vary significantly, including silt, sand, clay and various mixed soil types. Due to external factors such as wind, waves and currents and poor visibility of the slope below the water surface, it is difficult to ensure the slope flatness under the traditional manual construction method and cannot meet the strict requirements of high-precision projects. This not only increases the workload of subsequent repair and adjustment, prolongs the construction period, but also may affect the stability and safety of the entire project.
[0003] Therefore, a method for precise excavation planning and control of the slope of an unmanned backhoe dredger is provided. Summary of the Invention
[0004] The purpose of the present invention is to provide a method for precise excavation planning and control of the slope of an unmanned backhoe dredger to overcome the existing defects, support the unmanned operation mode of the backhoe dredger, and improve the construction efficiency of underwater precise excavation.
[0005] The technical solution to achieve the above purpose is as follows:
[0006] A method for precise excavation planning and control of the slope of an unmanned backhoe dredger includes:
[0007] Step S1, constructing terrain information through the three-dimensional terrain data of the target area, including the initial model of the target slope, the reference model of the target slope, and the terrain model to be excavated;
[0008] Step S2, the planner discretizes the terrain data. For a certain cross-section, the excavation area sub-region is divided into a series of triangular regions T1 connected to the slope and approximate rectangular or approximate trapezoidal regions T2 located above the triangles;
[0009] Step S3, the planner calculates the excavation path, single excavation depth, entry point, and exit point based on the dynamic programming algorithm, and excavates layer by layer from top to bottom;
[0010] Step S4, optimizing the bucket entry angle for the triangular region T1;
[0011] Step S5, the controller controls the rotation of the base, boom, arm, and bucket based on the entry coordinates, exit coordinates, entry angle, and single excavation depth ΔH output by the planner, and real-time monitors and corrects the bucket attitude to complete the excavation of one cross-section;
[0012] Step S6. Repeat the above steps S2 - S5 to complete the excavation of the remaining cross - sections.
[0013] Preferably, in step S1, constructing the terrain information includes:
[0014] Obtaining the three - dimensional terrain data of the target area through a multibeam bathymetric device;
[0015] Processing the terrain data into a digital elevation model to generate the initial model \(M_i\) of the target slope;
[0016] Setting the flatness requirements according to the engineering needs, that is, the allowable elevation deviation range, the slope, depth, length, and boundary line of the target slope, to generate the reference model \(M_r\) of the target slope;
[0017] Subtracting the intersection of the initial model and the reference model from the initial model to obtain the terrain model to be excavated \(M_e=(M_i-(M_i\cap M_r))\).
[0018] Preferably, in step S2, for a certain cross - section, dividing the excavation area into sub - regions. For a slope terrain profile, the direction parallel to the horizontal plane is defined as the x - direction, and the direction perpendicular to the horizontal plane is defined as the y - direction. Specifically, it includes:
[0019] First, vertically divide the terrain model \(M_e\) to be excavated according to the excavation depth. Among them, the division interval \(L_{grid}\) is determined by the bucket width \(W_{bucket}\), that is, \(l_{grid}=k\cdot W_{buchet}\), where \(0.8\leq k\leq1.0\);
[0020] Then, horizontally divide the terrain model \(M_e\) to be excavated. The division method is as follows: From the previous step, the intersection points of each vertical division line and the target slope can be obtained. Starting from this intersection point, horizontally divide in the x - direction to the adjacent vertical division line;
[0021] Finally, through the above two parts of division, the terrain profile is discretized into a series of triangular regions \(T1\) connected to the slope and approximate rectangular or trapezoidal regions \(T2\) above the triangles.
[0022] Preferably, in step S3, the planner calculates the excavation path and excavates layer by layer from top to bottom, including:
[0023] Using the dynamic programming algorithm, define the bucket state variable \(s\) in the sub - region as a set of position \((x,y)\) and depth \(d\), that is, \(s = \{x,y,d\}\);
[0024] According to the excavation path optimization model and constraint conditions, calculate the optimal excavation path from the starting point to the ending point. The constraint conditions include the smoothness constraint of the excavation path and the kinematic characteristic constraint;
[0025] An optimization model is established with the objective function of minimizing the excavation path length, excavation energy consumption or excavation time;
[0026] Among them,
[0027] The excavation path smoothness constraints include:
[0028] The single - time excavation depth ΔH is limited to 10% - 80% of the maximum single - time excavation depth H_max of the bucket and is dynamically adjusted based on the current excavation soil quality;
[0029] The slope change ΔK between the current position and the adjacent position is less than the preset allowable value of slope change;
[0030] The kinematic characteristic constraints include:
[0031] The excavation path does not exceed the excavation radius and slewing radius of the backhoe dredger;
[0032] The objective function is expressed as:
[0033]
[0034] In the formula, C k is the cost function designed for the constraint conditions, u k is the action group that can be taken in the k - th step of excavation, including the single - time excavation depth ΔH, the entry point coordinates, and the exit point coordinates. sx is the value of the bucket state variable s at the k - th step, and s k+1 is the value of the bucket state variable s at the (k + 1) - th step.
[0035] Preferably, in the step S4, the entry angle of the bucket is optimized for the triangular region T1, and the entry angle adjustment strategy is:
[0036] According to the distance from the reference slope surface, the entry angle is reduced so that it is slightly larger than the slope, in order to smoothly excavate to the target depth in subsequent actions:
[0037] α′ = α - Δα;
[0038] In the formula, α′ is the corrected entry angle, α is the entry angle when perpendicular to the horizontal plane, and Δα is the correction angle, which is adjusted according to the distance from the reference slope surface, that is, the correction angle can be determined according to the following relationship:
[0039] Δα = k·d_bucket;
[0040] In the formula, k is the correction coefficient, and d_bucket is the distance between the bucket and the reference slope surface.
[0041] Preferably, the step S5 includes:
[0042] Excavation execution stage:
[0043] The planner outputs the entry coordinates, exit coordinates, entry angle, and single - pass excavation depth ΔH for each excavation, and transmits them to the controller;
[0044] The controller controls the rotation angles of the boom, arm, and base of the backhoe dredger so that the bucket moves to the specified grid coordinates;
[0045] The controller controls the bucket angle to the recommended entry angle and controls the lowering of the boom so that the entry depth is the recommended single - pass excavation depth ΔH;
[0046] The controller calculates and controls the pitching motion of the boom and arm, and controls the bucket to move from the entry point coordinates to the exit point coordinates to complete one excavation action;
[0047] Real - time monitoring and adjustment stage:
[0048] A boom angle sensor, an arm angle sensor, a bucket angle sensor, a base roll angle sensor, a base pitch angle sensor, a hull acceleration sensor, and a set of RTK differential positioning equipment are used to real - time position the bucket;
[0049] Based on the acceleration sensing and gyroscope to measure the hull acceleration and angular velocity in real - time, the translation and rotation motion trajectories of the hull and the bucket are predicted in real - time. The filtering prediction algorithm is used to fuse and correct with the RTK positioning data to correct the bucket attitude.
[0050] The beneficial effects of the present invention are:
[0051] 1) The present invention discretizes the constructed terrain information, divides the terrain section into a series of sub - regions. For different regions, the planner of the present invention calculates the excavation path, single - pass excavation depth, entry point, and exit point based on the dynamic programming algorithm, and optimizes the bucket entry angle for the near - slope region, which can effectively improve the slope flatness and reduce over - excavation and under - excavation;
[0052] 2) The controller adopted by the present invention measures the hull acceleration and angular velocity in real - time based on acceleration sensing and gyroscope, predicts the translation and rotation motion trajectories of the hull and the bucket in real - time, uses the filtering prediction algorithm to fuse and correct with the RTK positioning data, and corrects the bucket attitude, which can effectively improve the position control accuracy of the bucket;
[0053] In summary, through the high - precision planning and control method, the present invention can support the unmanned operation mode of the backhoe dredger and improve the construction efficiency of underwater precision excavation. Description of the Drawings
[0054] Figure 1 is a flowchart of a method for precision excavation planning and control of a backhoe dredger for unmanned operation according to the present invention;
[0055] Figure 2 It is a schematic diagram of the discretization and segmentation of terrain data in the present invention. Detailed implementation manners
[0056] The technical solutions of the present invention will be clearly and completely described below with reference to the accompanying drawings. In the description of the present invention, it should be noted that the orientation or positional relationship indicated by the terms "center", "upper", "lower", "left", "right", "vertical", "horizontal", "inner", "outer", etc. is based on the orientation or positional relationship shown in the accompanying drawings, and is only for the convenience of describing the present invention and simplifying the description, rather than indicating or implying that the device or element referred to must have a specific orientation, be constructed and operated in a specific orientation, and therefore should not be construed as a limitation of the present invention. In addition, the terms "first", "second", "third" are only used for descriptive purposes and cannot be construed as indicating or implying relative importance.
[0057] The present invention will be further described below with reference to the accompanying drawings.
[0058] As Figure 1 shown, a method for precise excavation planning and control of the slope of an unmanned backhoe dredger includes:
[0059] Step S1, constructing terrain information through the three-dimensional terrain data of the target area, including the initial model of the target slope, the reference model of the target slope, and the terrain model to be excavated.
[0060] In the embodiment, constructing terrain information includes:
[0061] Obtaining the three-dimensional terrain data of the target area through a multi-beam bathymetric device;
[0062] Processing the terrain data into a digital elevation model to generate the initial model M_i of the target slope;
[0063] Setting the flatness requirement according to the engineering requirements, that is, the allowable elevation deviation range, the slope, depth, length, and boundary line of the target slope, to generate the reference model M_r of the target slope;
[0064] Subtracting the intersection of the initial model and its reference model to obtain the terrain model to be excavated M_e = (M_i - (M_i ∩ M_r)).
[0065] Step S2, the planner performs discretization processing on the terrain data. For a certain cross-section, the excavation area sub-region is divided into a series of triangular regions T1 connected to the slope and approximate rectangular or approximate trapezoidal regions T2 located above the triangles, as Figure 2 shown.
[0066] In the embodiment, for a certain cross-section, the excavation area is divided into sub-areas. For a slope terrain profile, the direction parallel to the horizontal plane is defined as the x-direction, and the direction perpendicular to the horizontal plane is defined as the y-direction. Specifically, it includes:
[0067] First, according to the excavation depth, the terrain model M_e to be excavated is vertically sliced. Among them, the slicing interval Lgrid is determined by the bucket width W_bucket, that is, Lgrid = k·W_buchet, where 0.8 ≤ k ≤ 1.0;
[0068] Then, the terrain model M_e to be excavated is horizontally sliced. The slicing method is as follows: from the previous step, the intersection points of each vertical slicing line and the target slope can be obtained. Starting from this intersection point, it is horizontally sliced in the x-direction to the adjacent vertical slicing line;
[0069] Finally, through the above two parts of slicing, the terrain profile is discretized into a series of triangular regions T1 connected to the slope and approximate rectangular or trapezoidal regions T2 above the triangles;
[0070] Among them, for the trapezoidal region T2, step S3 is used to optimize the excavation path; for the triangular region T1, on the basis of step S3, step S4 is added to optimize the bucket entry angle to avoid over-excavation.
[0071] Step S3, the planner calculates the excavation path, single excavation depth, entry point, and exit point based on the dynamic programming algorithm, and excavates layer by layer from top to bottom.
[0072] In the embodiment, the planner calculates the excavation path and excavates layer by layer from top to bottom, including:
[0073] Using the dynamic programming algorithm, the bucket state variable s in the sub-region is defined as the set of position (x, y) and depth d, that is, s = {x, y, d};
[0074] According to the excavation path optimization model and constraint conditions, the optimal excavation path from the starting point to the end point is calculated. The constraint conditions include the excavation path smoothness constraint and the kinematic characteristic constraint;
[0075] Taking the minimization of the excavation path length, excavation energy consumption, or excavation time as the objective function, an optimization model is established;
[0076] Among them,
[0077] The excavation path smoothness constraint includes:
[0078] The single excavation depth ΔH is limited to 10% - 80% of the maximum single excavation depth H_max of the bucket and is dynamically adjusted based on the current excavation soil quality;
[0079] The slope change ΔK between the current position and the adjacent position is less than the allowable value of the preset slope change;
[0080] The kinematic characteristic constraints include:
[0081] The excavation path does not exceed the excavation radius and slewing radius of the backhoe dredger;
[0082] The objective function is expressed as:
[0083]
[0084] In the formula, C k is the cost function designed for the constraint conditions, u k is the action group that can be taken for the excavation at the k-th step, including the single excavation depth ΔH, the entry point coordinates, and the exit point coordinates, s k is the value of the bucket state variable s at the k-th step, s k+1 is the value of the bucket state variable s at the (k + 1)-th step.
[0085] Step S4, optimize the bucket entry angle for the triangular region T1.
[0086] In the embodiment, when optimizing the bucket entry angle for the triangular region T1, if the ideal entry angle of the bucket is perpendicular to the horizontal plane, additional downward excavation actions may be generated due to the linkage of the boom and the dipper arm after the bucket enters the soil, resulting in over-excavation. Therefore, it is necessary to optimize the entry angle to ensure the flatness of the slope. The entry angle adjustment strategy is as follows:
[0087] According to the distance from the reference slope surface, reduce the entry angle so that it is slightly larger than the slope, so as to smoothly excavate to the target depth in subsequent actions:
[0088] α′ = α - Δα;
[0089] In the formula, α′ is the corrected entry angle, α is the entry angle when perpendicular to the horizontal plane, and Δα is the correction angle, which is adjusted according to the distance from the reference slope surface. That is, the correction angle can be determined according to the following relationship:
[0090] Δα = k·d_bucket;
[0091] In the formula, k is the correction coefficient, and d_bucket is the distance between the bucket and the reference slope surface.
[0092] Step S5, the controller controls the slewing of the base, boom, dipper arm, and bucket based on the entry coordinates, exit coordinates, entry angle, and single excavation depth ΔH output by the planner, and monitors and corrects the bucket attitude in real time to complete the excavation of a cross-section.
[0093] In the embodiment, Step S5 includes:
[0094] Excavation execution stage:
[0095] The planner outputs the entry coordinates, exit coordinates, entry angle, and single-digging depth ΔH for each excavation and transmits them to the controller;
[0096] The controller controls the rotation angles of the boom, arm, and pedestal of the backhoe dredger so that the bucket moves to the specified grid coordinates;
[0097] The controller controls the bucket angle to the recommended entry angle and controls the lowering of the boom so that the entry depth is the recommended single-digging depth ΔH;
[0098] The controller calculates and controls the pitching motion of the boom and arm, and controls the bucket to move from the entry point coordinates to the exit point coordinates to complete one excavation action;
[0099] Real-time monitoring and adjustment stage:
[0100] A boom angle sensor, arm angle sensor, bucket angle sensor, pedestal roll angle sensor, pedestal pitch angle sensor, hull acceleration sensor, and a set of RTK differential positioning equipment are used to real-time position the bucket;
[0101] Based on the acceleration sensing and gyroscope to measure the hull acceleration and angular velocity in real time, the translation and rotation motion trajectories of the hull and bucket are predicted in real time, and the filtering prediction algorithm is used to fuse and correct with the RTK positioning data to correct the bucket attitude.
[0102] Step S6, repeat the above steps S2 - S5 to complete the excavation of the remaining sections.
[0103] The above embodiments are only used to illustrate the technical solutions of the present invention and are not intended to limit them; although the present invention has been described in detail with reference to the foregoing embodiments, those of ordinary skill in the art should understand that: they can still modify the technical solutions recorded in the foregoing embodiments, or perform equivalent replacements for some or all of the technical features; and these modifications or replacements do not make the essence of the corresponding technical solutions deviate from the scope of the technical solutions of the embodiments of the present invention.
Claims
1. A method for planning and controlling the precise excavation of slopes by an unmanned backhoe dredger, characterized in that: include: Step S1, constructing terrain information through three-dimensional terrain data of the target area, including an initial model of the target slope, a reference model of the target slope, and a terrain model to be excavated; Step S2, the planner discretizes the terrain data and divides the excavation area into a series of triangular areas T1 connected to the slope and approximately rectangular or trapezoidal areas T2 located on the triangles for a certain section; Step S3, the planner calculates the excavation path, single excavation depth, entry point, and exit point based on a dynamic programming algorithm, and excavates layer by layer from top to bottom; Step S4, optimizing the bucket entry angle for the triangular area T1; Step S5, the controller controls the rotation of the base, the boom, the forearm, and the bucket based on the entry coordinates, the exit coordinates, the entry angle, and the single excavation depth ΔH output by the planner, monitors and corrects the bucket posture in real time, and completes a cross-section excavation; Step S6, repeating steps S2-S5 to complete the excavation of the remaining sections.
2. The method for planning and controlling the precise excavation of slopes by an unmanned backhoe dredger according to claim 1, characterized in that: In step S1, constructing terrain information includes: Acquire three-dimensional terrain data of the target area through multi-beam underwater bathymetric equipment; Process the terrain data into a digital elevation model and generate the initial model Mi of the target slope; According to the engineering requirements, the flatness requirements, i.e. the allowable elevation deviation range, the slope, depth, length and boundary line of the target slope are set to generate the reference model Mr of the target slope; The initial model minus its intersection with the reference model is used to obtain the terrain model to be excavated Me = (M_i-(M_i∩M_r)).
3. The method for planning and controlling the precise excavation of slopes by an unmanned backhoe dredger according to claim 1, characterized in that: In step S2, for a certain section, the excavation area is divided into sub-areas. For a slope terrain profile, the direction parallel to the horizontal plane is called the x direction, and the direction perpendicular to the horizontal plane is called the y direction, which specifically includes: First, the terrain model Me to be excavated is vertically segmented according to the excavation depth, where the segmentation interval Lgrid is determined by the bucket width W_bucket, that is, Lgrid = k·W_buchet, 0.8≤k≤1.0; Then, the terrain model Me to be excavated is horizontally segmented. The segmentation method is as follows: the intersection of each vertical segmentation line and the target slope can be obtained from the previous step, and the intersection is used as the starting point to segment horizontally in the x direction to the adjacent vertical segmentation line; Finally, through the division of the above two parts, the terrain profile is discretized into a series of triangular areas T1 connected to the slope and approximately rectangular or trapezoidal areas T2 located on the triangles.
4. The method for planning and controlling the precise excavation of slopes by an unmanned backhoe dredger according to claim 1, characterized in that: In step S3, the planner calculates the mining path and mines layer by layer from top to bottom, including: Using the dynamic programming algorithm, the bucket state variable s is defined as a set of position (x, y) and depth d in the sub-area, that is, s = {x, y, d}; According to the excavation path optimization model and constraint conditions, the optimal excavation path from the starting point to the end point is calculated. The constraint conditions include the excavation path smoothness constraint and kinematic characteristic constraint. An optimization model is established with the objective function of minimizing the length of the excavation path, the excavation energy consumption or the excavation time; in, Mining path smoothness constraints include: The single excavation depth ΔH is limited to 10%-80% of the bucket's maximum single excavation depth H_max and is dynamically adjusted based on the current excavation soil quality; The slope change ΔK between the current position and the adjacent position is less than the preset slope change allowable value; Kinematic constraints include: The excavation path does not exceed the excavation radius and turning radius of the backhoe dredger; The objective function is expressed as: In the formula, C k The cost function designed for the constraint condition, u k is the set of actions that can be taken in the k-th excavation step, including the single excavation depth ΔH, the coordinates of the entry point, the coordinates of the exit point, and s k is the value of the bucket state variable s at step k, s k+1 is the value of the bucket state variable s at the k+1th step.
5. The method for planning and controlling the precise excavation of slopes by an unmanned backhoe dredger according to claim 1, characterized in that: In step S4, the bucket entry angle is optimized for the triangular area T1. The strategy for adjusting the angle of entry into the soil is as follows: According to the distance from the reference slope, reduce the entry angle to make it slightly greater than the slope to smoothly dig to the target depth in subsequent actions: α'=α-Δα; In the formula, α′ is the corrected penetration angle, α is the penetration angle when it is perpendicular to the horizontal plane, and Δα is the correction angle, which is adjusted according to the distance from the reference slope. That is, the correction angle can be determined according to the following relationship: Δα=k·d_bucket; Where k is the correction coefficient and d_bucket is the distance between the bucket and the reference slope.
6. The method for planning and controlling the precise excavation of slopes by an unmanned backhoe dredger according to claim 1, characterized in that: The step S5 comprises: Mining execution phase: The planner outputs the entry coordinates, exit coordinates, entry angle, and single excavation depth ΔH of each excavation, and transmits them to the controller; The controller controls the rotation angles of the boom, arm and base of the backhoe dredger so that the bucket moves to the specified grid coordinates; The controller controls the bucket angle to be the recommended earth-entering angle and controls the lowering of the boom so that the earth-entering depth is the recommended single excavation depth ΔH; The controller calculates and controls the pitching motion of the boom and arm, and controls the bucket to move from the entry point coordinates to the exit point coordinates, completing an excavation action; Real-time monitoring and adjustment stage: The bucket is positioned in real time using a boom angle sensor, a forearm angle sensor, a bucket angle sensor, a base roll angle sensor, a base pitch angle sensor, a hull acceleration sensor, and a set of RTK differential positioning equipment; Based on the real-time measurement of the hull acceleration and angular velocity by acceleration sensors and gyroscopes, the translation and rotation motion trajectories of the hull and bucket are predicted in real time. The filtering prediction algorithm is used to fuse and correct the RTK positioning data to correct the bucket posture.
Citation Information
Patent Citations
Foundation pit excavation monitoring method and system
CN113186996A
Real-time excavation system of excavator
KR1020020085663A
Excavating Device for Excavating Ground Under Water, and Method for Excavating Ground
US20120000098A1
Cited By
Excavator bucket adjusting method and device and excavator
CN121024138A
Automatic digging method of excavator based on image recognition
CN121024156A
Underwater bank slope excavation construction method and device, electronic equipment and storage medium
CN121066106A
