A dual-arm collaborative operation planning method, device, equipment and medium

By conducting hydrodynamic analysis and path planning on the three-dimensional model of the underwater robot dual robot arm system, combining the D-H parameter method and the simplified model of the bounding box, the problem of high collision risk between robot arms is solved, and safer and more efficient movement is achieved Path planning.

CN118876070BActive Publication Date: 2024-12-06HARBIN ENGINEERING UNIVERSITY SANYA NANHAI INNOVATION & DEVELOPMENT BASE +1
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411353965.9
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-09-27
Publication Date
2024-12-06
Estimated Expiration
2044-09-27

AI Technical Summary

Technical Problem

The prior art fails to effectively consider the collision problems caused by the relative motion between the two robotic arms when planning the motion path of the underwater robot dual robotic arm system, resulting in unreasonable planning paths and high collision risk.

Method used

By conducting hydrodynamic analysis on the three-dimensional model of UVDMS, hydrodynamic constraints are generated, and the starting and target positions of the robot arm are obtained based on the D-H parameter method, path planning is carried out, discrete path point intervals are used, and the model is simplified by the bounding box to extract the robot arm. The minimum distance between them is determined based on the minimum distance and the preset threshold, and a target planning path is generated.

Benefits of technology

It reduces the risk of collision between robotic arms, improves the feasibility and accuracy of path planning, and ensures that tasks are completed safely and efficiently in complex hydrodynamic environments.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118876070B_ABST
    Figure CN118876070B_ABST
Patent Text Reader

Abstract

The present invention provides a dual-arm collaborative operation planning method, device, equipment and medium, which relates to the technical field of robot motion planning. The method includes: performing hydrodynamic analysis on a UVDMS three-dimensional model to generate hydrodynamic constraints; obtaining the starting position and target position of a first robot arm and the starting position and target position of a second robot arm according to a D-H parameter method; performing path planning on the first robot arm and the second robot arm respectively to generate a first planning path and a second planning path; discretizing the first planning path and the second planning path to generate at least one discrete path point interval; simplifying the UVDMS three-dimensional model using a bounding box to generate a dual-arm simplified model; extracting the minimum distance between the first robot arm and the second robot arm; determining the collision situation according to the minimum distance and a preset minimum threshold, and generating a target planning path according to the collision situation, the first planning path and the second planning path. The present invention can improve the efficiency of motion planning.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of robot arm motion planning, and in particular to a dual-arm collaborative operation planning method, device, equipment and medium. Background Art

[0002] The Underwater Vehicle Dual Manipulator System (UVDMS) is a robotic system designed for underwater environments. It is equipped with two robotic arms and can perform complex underwater tasks. UVDMS is widely used in marine science, underwater engineering, resource exploration, underwater structure inspection and maintenance, and other fields.

[0003] In order to perform motion planning for the two robotic arms of UVDMS, the existing technology mainly uses constraints and planning algorithms for path planning. However, the path planned by the existing technology does not consider the collision problem that may be caused by the relative motion between the two robotic arms. The resulting planned path is unreasonable and has a high risk of collision. Summary of the invention

[0004] The problem solved by the present invention is how to reduce the collision risk of the planned paths of the two mechanical arms of the UVDMS.

[0005] To solve the above problems, in a first aspect, the present invention provides a dual-arm collaborative operation planning method, comprising:

[0006] Conduct hydrodynamic analysis on the UVDMS 3D model and generate hydrodynamic constraints;

[0007] According to the DH parameter method, the starting position and the target position of the first robot arm and the starting position and the target position of the second robot arm are obtained;

[0008] Based on the hydrodynamic constraint condition, according to the starting position and target position of the first robotic arm and the starting position and target position of the second robotic arm, respectively, path planning is performed on the first robotic arm and the second robotic arm to generate a first planned path and a second planned path;

[0009] Discretize the first planned path and the second planned path to generate at least one discrete path point interval;

[0010] The UVDMS three-dimensional model is simplified by using a bounding box to generate a simplified double-arm model;

[0011] Extracting a minimum distance between the first robotic arm and the second robotic arm based on the dual-arm simplified model and the discrete path point interval;

[0012] A collision situation is determined according to the minimum distance and a preset minimum threshold, and a target planned path is generated according to the collision situation, the first planned path, and the second planned path.

[0013] Optionally, extracting the minimum distance between the first robotic arm and the second robotic arm based on the dual-arm simplified model and the discrete path point interval includes:

[0014] Determining spatial pose data of the first robotic arm and the second robotic arm in each discrete path point interval according to the dual-arm simplified model;

[0015] Determining a common perpendicular line between the first robotic arm and the second robotic arm according to the spatial posture data;

[0016] The minimum distance is determined according to the endpoint positions of the common perpendicular line.

[0017] Optionally, determining the minimum distance according to the endpoint positions of the common perpendicular line includes:

[0018] When the endpoints of the common perpendicular line are both on the first mechanical arm and the second mechanical arm, the minimum distance is determined according to a first distance formula group, wherein the first distance formula group includes:

[0019] ;

[0020] ;

[0021] in, d min is the minimum distance, P k1 is the endpoint of the common perpendicular line on the first robotic arm, Q k2 is the endpoint of the common perpendicular line on the second robotic arm, Expressed as P k1 and Q k2 The distance P s is the first endpoint of the first robotic arm, Q s is the first endpoint of the second robotic arm, k 1 is the first proportionality coefficient, k 2 is the second proportionality coefficient, and p = P e - P s , q = Qe - Q s , Q e is the second endpoint of the second robotic arm, P e is the second endpoint of the first robotic arm;

[0022] When the endpoint of the common perpendicular line is on the first mechanical arm or the second mechanical arm, the minimum distance is determined according to a second distance formula group, where the second distance formula group includes:

[0023] ;

[0024] ;

[0025] in, d 1 is the first distance, d 2 is the second distance, d 3 is the third distance, d 4 is the fourth distance, d 5 is the fifth distance, d 6 is the sixth distance;

[0026] When the endpoints of the common perpendicular are not on the first mechanical arm and the second mechanical arm, the minimum distance is determined according to a third distance formula group, and the third distance formula group includes:

[0027] ;

[0028] ;

[0029] in, d minQ is the seventh distance, d minP The eighth distance.

[0030] Optionally, based on the hydrodynamic constraint condition, according to the starting position and target position of the first robotic arm and the starting position and target position of the second robotic arm, respectively performing path planning on the first robotic arm and the second robotic arm to generate a first planned path and a second planned path includes:

[0031] Obtain obstacle data;

[0032] Based on the obstacle data, according to the starting position and the target position of the first robotic arm, a first planning algorithm is used to perform path planning on the first robotic arm to generate the first planned path;

[0033] Based on the obstacle data and the first planned path, according to the starting position and the target position of the second robotic arm, a second planning algorithm is used to perform path planning on the second robotic arm to generate the second planned path;

[0034] When the first planned path or the second planned path does not satisfy the hydrodynamic constraint condition, path planning is performed again to generate the first planned path or the second planned path.

[0035] Optionally, the adopting a second planning algorithm to perform path planning on the second robotic arm to generate the second planned path includes:

[0036] Determining obstacle points according to the first planned path and the obstacle data;

[0037] According to the obstacle points, the node growth direction is determined by using the artificial potential field method;

[0038] Based on the starting position and target position of the second robot arm, and according to the node growth direction, the second planning path is generated by using the RRT algorithm and the RRT* algorithm.

[0039] Optionally, the generating the second planned path based on the starting position and the target position of the second manipulator and according to the node growth direction by using the RRT algorithm and the RRT* algorithm includes:

[0040] Based on the starting position and target position of the second robot arm, the tree structure is initialized according to the RRT algorithm, and random sampling is performed to determine a candidate parent node;

[0041] Determine a parent node of the tree structure according to the RRT* algorithm and the candidate parent node;

[0042] Determine a new node according to the parent node and the node growth direction, and generate a preliminary planning path according to the parent node and the new node;

[0043] According to the RRT* algorithm, the preliminary planned path is verified, and according to the verification result, the second planned path is generated.

[0044] Optionally, the performing of hydrodynamic analysis on the UVDMS three-dimensional model to generate hydrodynamic constraints includes:

[0045] According to the UVDMS three-dimensional model, hydrodynamic force data is generated using hydrodynamic simulation software;

[0046] Determining a dimensionless hydrodynamic coefficient according to the hydrodynamic force data;

[0047] According to the dimensionless hydrodynamic coefficient, CFD analysis is performed on the UVDMS three-dimensional model to generate the hydrodynamic constraint condition.

[0048] In a second aspect, the present invention provides a dual-arm collaborative operation planning device, comprising:

[0049] Analysis module, used to perform hydrodynamic analysis on the UVDMS three-dimensional model and generate hydrodynamic constraints;

[0050] A position module, used for obtaining a starting position and a target position of the first robotic arm and a starting position and a target position of the second robotic arm according to a DH parameter method;

[0051] a planning module, configured to perform path planning for the first robotic arm and the second robotic arm respectively based on the hydrodynamic constraint conditions and according to the starting position and the target position of the first robotic arm and the starting position and the target position of the second robotic arm, so as to generate a first planned path and a second planned path;

[0052] A discretization module, used for discretizing the first planned path and the second planned path to generate at least one discrete path point interval;

[0053] A simplification module, used to simplify the UVDMS three-dimensional model by using a bounding box to generate a simplified model of two arms;

[0054] A distance module, configured to extract a minimum distance between the first robotic arm and the second robotic arm based on the dual-arm simplified model and the discrete path point interval;

[0055] A collision module is used to determine a collision situation according to the minimum distance and a preset minimum threshold, and to generate a target planned path according to the collision situation, the first planned path and the second planned path.

[0056] In a third aspect, the present invention provides an electronic device, including a memory and a processor;

[0057] The memory is used to store computer programs;

[0058] The processor is used to implement the dual-arm collaborative work planning method as described in the first aspect when executing the computer program.

[0059] In a fourth aspect, the present invention provides a computer-readable storage medium having a computer program stored thereon. When the computer program is executed by a processor, the dual-arm collaborative work planning method as described in the first aspect is implemented.

[0060] The beneficial effects of the dual-arm collaborative operation planning method, device, equipment and medium of the present invention are:

[0061] By performing hydrodynamic analysis on the three-dimensional model of UVDMS, the force of the model in water can be determined, and the hydrodynamic constraints can be obtained, which is helpful to consider the influence of the actual operating environment in the subsequent path planning, and improve the feasibility and accuracy of the planned path; then, according to the DH parameter method, the starting position and target position of the first manipulator and the starting position and target position of the second manipulator are obtained, ensuring the accuracy and consistency of the position data, which is convenient for subsequent path planning. Based on the hydrodynamic constraints, the first manipulator and the second manipulator are respectively planned according to the starting position and the target position, and the first planning path and the second planning path are generated to obtain the preliminary motion path of the first manipulator and the second manipulator. Then, the first planning path and the second planning path are discretized into at least one discrete path point interval, so as to facilitate collision detection in each discrete path point interval, and only the discrete path point interval with collision risk is re-planned, thereby reducing the collision risk, improving the accuracy of collision detection, and reducing the cost of re-planning the path; then, the UVDMS three-dimensional model is simplified by using a bounding box, that is, the geometric shape of the manipulator is simplified, so that collision detection can be performed quickly and efficiently, avoiding complex calculations while ensuring the accuracy of detection. Then, according to the minimum distance between a robotic arm and a second robotic arm and a preset minimum threshold, the collision situation is determined, and according to the collision situation, the first planned path and the second planned path, the final target planned path is generated, which solves the collision problem that the prior art does not consider the relative movement between the two robotic arms and reduces the irrationality of path planning, reduces the collision risk of the two robotic arms, and ensures that the UVDMS completes the predetermined task safely and efficiently in a complex hydrodynamic environment. BRIEF DESCRIPTION OF THE DRAWINGS

[0062] Figure 1 A schematic diagram of a process flow of a dual-arm collaborative operation planning method provided by an embodiment of the present invention;

[0063] Figure 2 A front view of a UVDMS three-dimensional model provided in an embodiment of the present invention;

[0064] Figure 3 A right view of the UVDMS three-dimensional model provided in an embodiment of the present invention;

[0065] Figure 4 A schematic diagram of the structure of a simplified dual-arm model provided by an embodiment of the present invention;

[0066] Figure 5 A first schematic diagram of the endpoint position of a common perpendicular line provided by an embodiment of the present invention;

[0067] Figure 6 A second schematic diagram of the endpoint position of the common perpendicular line provided in an embodiment of the present invention;

[0068] Figure 7 A third schematic diagram of the endpoint positions of a common perpendicular line provided in an embodiment of the present invention;

[0069] Figure 8 A schematic diagram of the structure of a fluid domain provided by an embodiment of the present invention;

[0070] Fig. 9 A schematic diagram of mesh division of a UVDMS three-dimensional model provided in an embodiment of the present invention;

[0071] Fig.10 A schematic diagram of the structure of a dual-arm collaborative operation planning device provided by an embodiment of the present invention;

[0072] Fig.11 A schematic diagram of the structure of an electronic device provided by an embodiment of the present invention. DETAILED DESCRIPTION

[0073] In order to make the above-mentioned objects, features and advantages of the present invention more obvious and easy to understand, the specific embodiments of the present invention are described in detail below in conjunction with the accompanying drawings. Although certain embodiments of the present invention are shown in the accompanying drawings, it should be understood that the present invention can be implemented in various forms and should not be interpreted as being limited to the embodiments described herein. On the contrary, these embodiments are provided to provide a more thorough and complete understanding of the present invention. It should be understood that the drawings and embodiments of the present invention are only for exemplary purposes and are not intended to limit the scope of protection of the present invention.

[0074] It should be understood that the various steps described in the method embodiments of the present invention may be performed in different orders and / or in parallel. In addition, the method embodiments may include additional steps and / or omit the steps shown. The scope of the present invention is not limited in this respect.

[0075] The term "including" and its variations used in this document are open inclusions, that is, "including but not limited to"; the term "based on" means "based at least in part on"; the term "one embodiment" means "at least one embodiment"; the term "another embodiment" means "at least one other embodiment"; the term "some embodiments" means "at least some embodiments"; the term "optionally" means "optional embodiments". The relevant definitions of other terms will be given in the following description. It should be noted that the concepts of "first", "second", etc. mentioned in the present invention are only used to distinguish different devices, modules or units, and are not used to limit the order or interdependence of the functions performed by these devices, modules or units.

[0076] It should be noted that the modifications of "one" and "plurality" mentioned in the present invention are illustrative rather than restrictive, and those skilled in the art should understand that, unless otherwise clearly indicated in the context, it should be understood as "one or more".

[0077] The names of the messages or information exchanged between multiple devices in the embodiments of the present invention are only used for illustrative purposes, and are not used to limit the scope of these messages or information.

[0078] In view of the problems existing in the above-mentioned related technologies, this embodiment provides a dual-arm collaborative operation planning method, device, equipment and medium.

[0079] like Figure 1 As shown, a dual-arm collaborative operation planning method provided by an embodiment of the present invention includes:

[0080] Perform hydrodynamic analysis on the UVDMS three-dimensional model and generate hydrodynamic constraints.

[0081] Specifically, the UVDMS three-dimensional model is as follows Figure 2 and Figure 3 As shown, a hydrodynamic analysis is performed on the UVDMS three-dimensional model to generate hydrodynamic constraints to determine the hydrodynamic influences on the two robotic arms of the UVDMS three-dimensional model in different postures, thereby obtaining the safe activity angle space of each part of the robotic arm, for example, the safe activity space of the shoulder, upper arm and forearm.

[0082] According to the DH parameter method, the starting position and target position of the first robotic arm and the starting position and target position of the second robotic arm are obtained.

[0083] Specifically, the DH parameter method is used to determine the starting position and target position of the first robot arm and the second robot arm, respectively. Since the first robot arm and the second robot arm use the same method to obtain the starting position and target position using the DH parameter method, this embodiment only explains the method for the first robot arm to obtain the starting position and target position using the DH parameter method, and does not repeat the method for the second robot arm to obtain the starting position and target position using the DH parameter method. First, define the first robot arm to include i joints, then define the coordinate system of the i-1th joint as the {i-1} coordinate system, and the origin is the intersection of the i-1th joint axis and the common perpendicular line of the i-th joint axis, x i-1 The coordinate axis is on this common perpendicular line and points to the i-axis. z i-1 The coordinate axis has the same axial direction as the i-1th joint axis. According to the right-hand rule, the x i-1 Coordinate axis and z i-1 The plane formed by the coordinate axes is determined as y i-1 The direction of the coordinate axes defines the base as the {0} coordinate system.

[0084] According to the coordinate system defined above, the four parameters in DH , , and Respectively expressed as:

[0085] Connecting rod length : Along x i-1 Coordinate axis, from z i-1 The coordinate axis is translated to z i The distance between the coordinate axes;

[0086] Connecting rod angle : Around x i-1 Coordinate axis, from z i-1 Rotate the coordinate axis to z i The angle of the coordinate axis;

[0087] Connecting rod offset : Along z i Coordinate axis, from x i-1 The coordinate axis is translated to x i The distance between the coordinate axes;

[0088] Joint rotation angle : Around z i Coordinate axis, from x i-1 Rotate the coordinate axis to x i The angle of the coordinate axis.

[0089] Then, according to the structure and size of the first robot arm, the DH parameter table is listed:

[0090]

[0091] The coordinate transformation matrix to the adjacent coordinates can be calculated through the DH parameter table:

[0092] ;

[0093] in, is the coordinate transformation matrix of the i-th joint, is the rotation matrix around the z-axis, and the rotation angle is , is the translation matrix along the z-axis, and the translation distance is , is the rotation matrix around the x-axis, and the rotation angle is , is the translation matrix along the x-axis, and the translation distance is .

[0094] According to the DH parameters, the transformation matrix of each joint of the first robot arm is:

[0095] .

[0096] Multiplying the above matrices together gives the forward kinematics model of the first manipulator:

[0097] ;

[0098] in, n k ( k=x,y,z ) is the direction vector, o k ( k=x,y,z ) is the origin drift, a k ( k=x,y,z ) is the scale factor, p is the coordinate value, x is the x-axis, y is the y-axis, and z is the z-axis.

[0099] The forward kinematics model represents the coordinate system of the end position of the first robot arm relative to the base position, in which all parameters are known, that is, the starting position of the first robot arm is obtained. The target position of the first robot arm determines the coordinate system of the target position relative to the base position according to actual needs, and the above method is used to obtain the final target position.

[0100] Based on the hydrodynamic constraints, path planning is performed on the first robotic arm and the second robotic arm respectively according to the starting position and target position of the first robotic arm and the starting position and target position of the second robotic arm to generate a first planned path and a second planned path.

[0101] Specifically, a path planning algorithm may be used for path planning, for example, a probabilistic roadmap algorithm (PRM algorithm), a rapidly-exploring random tree algorithm (RRT algorithm), an optimized rapidly-exploring random tree star algorithm (RRT* algorithm), a dynamic programming algorithm (DP algorithm), an artificial potential field algorithm (APF algorithm), and a deep reinforcement learning algorithm (DRL algorithm), etc. One path planning algorithm or a combination of several path planning algorithms may be used for path planning to obtain an accurate first planned path and a second planned path. If the first planned path and the second planned path do not satisfy the hydrodynamic constraints, the path planning is performed again to ensure that the first robotic arm and the second robotic arm can move safely according to the first planned path and the second planned path.

[0102] The first planned path and the second planned path are discretized to generate at least one discrete path point interval.

[0103] Specifically, the first planned path and the second planned path are discretized by using the spacing discretization method to generate at least one discrete path point interval, and the first planned path and the second planned path are discretized by setting the distance or time interval between adjacent discrete points. The distance or time interval can be set according to the length of the first planned path and the second planned path and the complexity of the path. When a problem occurs in the planned path of a discrete path point interval, such as failure to meet the hydrodynamic constraint or detection of a collision, only the discrete path point interval is re-planned to reduce the calculation cost, save computing power, and ensure the reliability and safety of the robot arm movement.

[0104] The UVDMS three-dimensional model is simplified by using a bounding box to generate a simplified double-arm model.

[0105] Specifically, since the structure of the robot arm is relatively complex, if the collision detection is performed on the first robot arm and the second robot arm through the UVDMS three-dimensional model that reflects the real structure, the amount of calculation will be very large, so it is necessary to simplify the UVDMS three-dimensional model, and use a bounding box that can completely surround the connecting rods and joints of the robot arm to spatially envelop the UVDMS three-dimensional model, thereby simplifying it and ensuring that the bounding box does not occupy too much space. Exemplarily, the bounding box can be an axis-aligned bounding box (AABB), an oriented bounding box (OBB), and a spherical bounding box (Bounding Sphere).

[0106] Based on the dual-arm simplified model and the discrete path point interval, a minimum distance between the first robotic arm and the second robotic arm is extracted.

[0107] Specifically, by simplifying the simplified dual-arm model, the minimum distance between the bounding boxes of the first robotic arm and the second robotic arm in each discrete path point interval can be calculated, and the spatial posture data of the bounding boxes of the first robotic arm and the second robotic arm can be extracted. According to the spatial posture data, the bounding boxes of the first robotic arm and the second robotic arm are converted into spatial line segments, and the minimum distance between the spatial line segments is calculated, thereby determining the minimum distance between the first robotic arm and the second robotic arm, and then determining the collision situation, so as to solve the collision problem that the path planned by the prior art does not take into account the relative movement between the two robotic arms.

[0108] A collision situation is determined according to the minimum distance and a preset minimum threshold, and a target planned path is generated according to the collision situation, the first planned path, and the second planned path.

[0109] Specifically, the preset minimum threshold is set according to the actual situation. When the minimum distance is less than or equal to the preset minimum threshold, it is determined that the first robot arm and the second robot arm will collide. At this time, if the first robot arm and the second robot arm are moving, the first robot arm and the second robot arm will stop or pop open or retreat to the previous step urgently; if the first robot arm and the second robot arm are not moving, the path of the discrete path point interval corresponding to the minimum distance less than or equal to the preset minimum threshold is replanned. In addition, the cube model of the remaining obstacles is obtained. When the bounding box of the first robot arm and the second robot arm intersects with the cube model, it is determined that the first robot arm and the second robot arm will collide. At this time, if the first robot arm and the second robot arm are moving, the first robot arm and the second robot arm will stop or pop open or retreat to the previous step urgently; if the first robot arm and the second robot arm are not moving, the path of the discrete path point interval corresponding to the first robot arm and the second robot arm is replanned.

[0110] In this embodiment, by performing hydrodynamic analysis on the three-dimensional model of UVDMS, the force conditions of the model in water can be determined, and hydrodynamic constraints can be obtained, which is helpful to consider the influence of the actual operating environment in subsequent path planning, and improve the feasibility and accuracy of the planned path; then, according to the DH parameter method, the starting position and target position of the first robotic arm and the starting position and target position of the second robotic arm are obtained, which ensures the accuracy and consistency of the position data and facilitates subsequent path planning. Based on the hydrodynamic constraints, according to the starting position and the target position, a path planning algorithm or a combination of several path planning algorithms is used for path planning, and the first robotic arm and the second robotic arm are respectively path planned to generate a first planned path and a second planned path to obtain a reasonable and accurate preliminary motion path of the first robotic arm and the second robotic arm, and then the first planned path and the second planned path are discretized into at least one discrete path point interval, so as to facilitate collision detection in each discrete path point interval, and only the discrete path point interval with collision risk is re-planned, thereby reducing the collision risk and improving the accuracy of collision detection and reducing the cost of re-planning the path; then, a bounding box is used to simplify the UVDMS three-dimensional model, that is, to simplify the geometric shape of the robotic arm, so that collision detection can be performed quickly and efficiently, avoiding complex calculations while ensuring the accuracy of detection. Then, according to the minimum distance between a robotic arm and a second robotic arm and a preset minimum threshold, as well as the intersection with other obstacles, the collision situation is determined, and according to the collision situation, the first planned path and the second planned path, the final target planned path is generated, which solves the problem that the prior art does not consider the possible collision caused by the relative movement between the two robotic arms, reduces the irrationality of path planning, reduces the risk of collision, and improves the efficiency of motion planning for the two robotic arms of UVDMS, ensuring that UVDMS can complete the predetermined tasks safely and efficiently in a complex hydrodynamic environment.

[0111] Optionally, extracting the minimum distance between the first robotic arm and the second robotic arm based on the dual-arm simplified model and the discrete path point interval includes:

[0112] Determining spatial pose data of the first robotic arm and the second robotic arm in each discrete path point interval according to the dual-arm simplified model;

[0113] Determining a common perpendicular line between the first robotic arm and the second robotic arm according to the spatial posture data;

[0114] The minimum distance is determined according to the endpoint positions of the common perpendicular line.

[0115] Specifically, Figure 4As shown, the cylinder in the simplified model of the two arms is the upper arm or lower arm of the first robotic arm and the second robotic arm, the length of the cylinder is the length of the upper arm or lower arm, the center of the top and bottom surfaces of the cylinder is the center of the joints at both ends of the upper arm or lower arm, the common perpendicular line refers to the common perpendicular line between the connecting line between the two end points of each part of the first robotic arm and the connecting line between the two end points of each part of the second robotic arm, and the common perpendicular line is set according to the specific structure of the first robotic arm and the second robotic arm. If the first robotic arm and the second robotic arm both include an upper arm and a lower arm, the common perpendicular line includes the common perpendicular line between the upper arm of the first robotic arm and the upper arm of the second robotic arm, the common perpendicular line between the upper arm of the first robotic arm and the lower arm of the second robotic arm, the common perpendicular line between the lower arm of the first robotic arm and the upper arm of the second robotic arm, and the common perpendicular line between the lower arm of the first robotic arm and the lower arm of the second robotic arm; if the first robotic arm and the second robotic arm each have only one robotic arm component, then there is only one common perpendicular line between the first robotic arm and the second robotic arm. According to the simplified dual-arm model, the spatial pose data of the first and second robotic arms in each discrete path point interval are extracted, that is, the spatial coordinates of each component of the first and second robotic arms, for example, the spatial coordinates of the upper arm or the lower arm. According to the spatial pose data, the cylinder in the simplified dual-arm model is converted into a spatial line segment to determine the common perpendicular line of the first and second robotic arms, such as Figures 5 to 7 As shown, finally, the final minimum distance is determined according to the endpoint positions of the common perpendicular line.

[0116] Optionally, determining the minimum distance according to the endpoint positions of the common perpendicular line includes:

[0117] When the endpoints of the common perpendicular line are both on the first mechanical arm and the second mechanical arm, the minimum distance is determined according to a first distance formula group, wherein the first distance formula group includes:

[0118] ;

[0119] ;

[0120] in, d min is the minimum distance, P k1 is the endpoint of the common perpendicular line on the first robotic arm, Q k2 is the endpoint of the common perpendicular line on the second robotic arm, Expressed as P k1 and Q k2 The distance P s is the first endpoint of the first robotic arm, Q sis the first endpoint of the second robotic arm, k 1 is the first proportionality coefficient, k 2 is the second proportionality coefficient, and p = P e - P s , q = Q e - Q s , Q e is the second endpoint of the second robotic arm, P e is the second endpoint of the first robotic arm;

[0121] When the endpoint of the common perpendicular line is on the first mechanical arm or the second mechanical arm, the minimum distance is determined according to a second distance formula group, where the second distance formula group includes:

[0122] ;

[0123] ;

[0124] in, d 1 is the first distance, d 2 is the second distance, d 3 is the third distance, d 4 is the fourth distance, d 5 is the fifth distance, d 6 is the sixth distance;

[0125] When the endpoints of the common perpendicular are not on the first mechanical arm and the second mechanical arm, the minimum distance is determined according to a third distance formula group, and the third distance formula group includes:

[0126] ;

[0127] ;

[0128] in, d minQ is the seventh distance, d minP The eighth distance.

[0129] Specifically, the minimum distance between the first robotic arm and the second robotic arm can be converted into the minimum distance between the space segments corresponding to the first robotic arm and the second robotic arm. The minimum distance between the space segments can be expressed as:

[0130] ;

[0131] The above formula transforms the solution to the minimum distance into a constrained optimization problem:

[0132] ;

[0133] At this time, you can get k 1 and k Extreme value of 2:

[0134] ;

[0135] according to k 1 and k 2, the minimum distance can be determined, such as Figure 5 As shown, when k 1 and k 2 are both within the range of [0,1], that is, when the endpoints of the common perpendicular line are both on the first robotic arm and the second robotic arm, the minimum distance is determined according to the second distance formula group; Figure 6 As shown, when k 1 and k 2 has one that is not in the range of [0,1], that is, when the endpoint of the common perpendicular line is on the first robotic arm or the second robotic arm, the minimum distance is determined according to the second distance formula group; Figure 7 As shown, when k 1 and k 2 are both not in the range of [0,1], that is, when the endpoints of the common perpendicular line are not on the first robotic arm and the second robotic arm, the minimum distance is determined according to the third distance formula group.

[0136] Optionally, based on the hydrodynamic constraint condition, according to the starting position and target position of the first robotic arm and the starting position and target position of the second robotic arm, respectively performing path planning on the first robotic arm and the second robotic arm to generate a first planned path and a second planned path includes:

[0137] Obtain obstacle data;

[0138] Based on the obstacle data, according to the starting position and the target position of the first robotic arm, a first planning algorithm is used to perform path planning on the first robotic arm to generate the first planned path;

[0139] Based on the obstacle data and the first planned path, according to the starting position and the target position of the second robotic arm, a second planning algorithm is used to perform path planning on the second robotic arm to generate the second planned path;

[0140] When the first planned path or the second planned path does not satisfy the hydrodynamic constraint condition, path planning is performed again to generate the first planned path or the second planned path.

[0141] Specifically, the first planning algorithm and the second planning algorithm include a probabilistic roadmap algorithm (PRM algorithm), a rapidly exploring random tree algorithm (RRT algorithm), an optimized rapidly exploring random tree algorithm (RRT* algorithm), a dynamic programming algorithm (DP algorithm), an artificial potential field algorithm (APF algorithm), and a deep reinforcement learning algorithm (DRL algorithm), etc., and one of the path planning algorithms or a combination of several path planning algorithms can be used for path planning. Based on the obstacle data, according to the starting position and the target position, the first planning algorithm is used to plan the path of the first manipulator to generate a first planning path; then the first manipulator is also taken as an obstacle, and according to the starting position and the target position, the second planning algorithm is used to plan the path of the second manipulator to generate a second planning path, so as to ensure that the motion paths of the first manipulator and the second manipulator do not affect each other. In addition, when the first planned path or the second planned path does not meet the hydrodynamic constraint condition, the path planning is re-performed to generate a new first planned path or second planned path to ensure the safe operation of the first robot arm and the second robot.

[0142] Optionally, the adopting a second planning algorithm to perform path planning on the second robotic arm to generate the second planned path includes:

[0143] Determining obstacle points according to the first planned path and the obstacle data;

[0144] According to the obstacle points, the node growth direction is determined by using the artificial potential field method;

[0145] Based on the starting position and target position of the second robot arm, and according to the node growth direction, the second planning path is generated by using the RRT algorithm and the RRT* algorithm.

[0146] Specifically, according to the new node determined by the node direction formula, the potential field force is determined by using the resultant force formula group according to the artificial potential field method, and then the node growth direction is determined by integrating the new node and the potential field force according to the fusion formula, and then the RRT algorithm and the RRT* algorithm are used to generate the second planning path. Through the artificial potential field algorithm, the node growth direction is changed to the vector addition of the RRT algorithm search direction and the artificial potential field algorithm direction, so that the planned path maintains a certain distance from the obstacle and the existence of the potential field can make the path points more concentrated between the starting position and the target position, which further reduces the search area and randomness compared to other algorithms, and can better avoid the possibility of collision during the planning process. At the same time, the second planning path generated by combining the RRT algorithm and the RRT* algorithm can solve the problems of uneven path and poor quality of the planned path.

[0147] In one embodiment, the node direction formula includes:

[0148] ;

[0149] in, x rand is the new sampling random point position obtained by random sampling in space, x goal is the target location, x near is the point set in the known search tree and x rand The location of the nearest point, x new According to the step length x near arrive x rand The new node position taken in the straight line direction, is the probability value of generating a random node, is the baseline bias probability value;

[0150] The combined force formula group includes:

[0151] ;

[0152] ;

[0153] ;

[0154] in, F total For the force of potential, F att is the potential field repulsion, F rep is the potential field gravitational force, Katt is the repulsive potential field coefficient, K rep The gravitational potential field coefficient, dis, is x goal and x near The distance between x obstacle are the coordinates of the obstacle center, is the radius of the repulsive potential field, and it is stipulated that the area beyond the radius of the repulsive potential field will not be affected by the repulsive force;

[0155] The fusion formula includes:

[0156] ;

[0157] in, is the node growth direction, k is the algorithm fusion coefficient

[0158] Optionally, the generating the second planned path based on the starting position and the target position of the second manipulator and according to the node growth direction by using the RRT algorithm and the RRT* algorithm includes:

[0159] Based on the starting position and target position of the second robot arm, the tree structure is initialized according to the RRT algorithm, and random sampling is performed to determine a candidate parent node;

[0160] Determine a parent node of the tree structure according to the RRT* algorithm and the candidate parent node;

[0161] Determine a new node according to the parent node and the node growth direction, and generate a preliminary planning path according to the parent node and the new node;

[0162] According to the RRT* algorithm, the preliminary planned path is verified, and according to the verification result, the second planned path is generated.

[0163] Specifically, firstly, according to the RRT algorithm, an empty tree structure is initialized, and the starting point is added to the tree as the root node, and then random sampling is performed to determine the candidate parent node. Then, according to the RRT* algorithm and the candidate parent node, the parent node of the tree structure is determined. When selecting the parent node, the new node will select the closest node as its parent node among all nodes in the circular or spherical space of the custom radius R, that is, by calculating the Euclidean distance between each candidate parent node and the new node, and selecting the smallest node as the parent node of the new node. Then, according to the parent node and the node growth direction, the new node after the parent node is determined, and the preliminary planning path is generated according to the parent node and the new node. Finally, according to the RRT* algorithm, the random tree is re-arranged for verification, and the distance from the new node to the node within the custom radius R is evaluated. If the verification result shows that the new path is shorter, the connection relationship is updated and a new second planning path is generated to ensure that the second planning path is the shortest.

[0164] Optionally, the performing of hydrodynamic analysis on the UVDMS three-dimensional model to generate hydrodynamic constraints includes:

[0165] According to the UVDMS three-dimensional model, hydrodynamic force data is generated using hydrodynamic simulation software;

[0166] Determining a dimensionless hydrodynamic coefficient according to the hydrodynamic force data;

[0167] According to the dimensionless hydrodynamic coefficient, CFD analysis is performed on the UVDMS three-dimensional model to generate the hydrodynamic constraint condition.

[0168] Specifically, firstly, according to the UVDMS three-dimensional model, hydrodynamic simulation software, such as STARCCM+ software, DHI MIKE series software, TELEMAC-MASCARET software, and ANSYS AQWA software, is used to simplify the UVDMS three-dimensional model and create a rectangular underwater robot fluid domain, such as Figure 8 As shown in the figure, it contains a velocity inlet, a wall and four pressure outlets. The distance from the underwater robot to the boundary of the fluid domain must be greater than twice the length, width and height of the corresponding underwater robot body, and the influence of the side wall is ignored. Then the UVDMS three-dimensional model is meshed, as shown in the figure. Fig. 9 As shown in the figure, the meshes of the first and second mechanical arms are set densely, and the mesh quality diagnosis function of the hydrodynamic simulation software is used to analyze the effectiveness of the mesh division. When the effectiveness analysis score exceeds 0.5 points, monitors in the three directions of XYZ are set to observe the external forces and torque disturbances on the model in these three directions. The hydrodynamic force on the X-axis of UVDMS under the condition of external forces and torques is obtained through the iterative solution function of the hydrodynamic simulation software. Fx , the hydrodynamic force on the Y axis F y , the hydrodynamic force on the Z axis F z , and obtain the hydrodynamic force data. Secondly, according to the hydrodynamic force data, the dimensionless formula group is used to determine the dimensionless hydrodynamic coefficient. The dimensionless hydrodynamic coefficient includes the longitudinal moment coefficient, the lateral moment coefficient and the vertical moment coefficient. The dimensionless formula group includes:

[0169] ;

[0170] ;

[0171] ;

[0172] in, C x is the longitudinal moment coefficient, C y is the lateral moment coefficient, C z is the vertical moment coefficient, is the fluid density, v is the headstream velocity, S max is the maximum cross-sectional area of ​​the UVDMS three-dimensional model body. The fluid density can be set according to the actual situation, for example, seawater density, river water density or river water density. Through the dimensionless formula group, the hydrodynamic force of the UVDMS three-dimensional model is decomposed into three directions. The longitudinal moment coefficient represents the hydrodynamic disturbance in the axial direction of the underwater robot during movement; the lateral moment coefficient represents the magnitude of the longitudinal tilt force of the underwater robot. The movement of the arms and the pitching movement of the body will affect the vertical force, so the vertical moment coefficient is used. The dimensionless formula group includes the quadratic term of the velocity, because the force term of the UVDMS three-dimensional model is approximately proportional to the square of the velocity. The dimensionless formula group is convenient for displaying the dimensionless hydrodynamic coefficient in a linear manner.

[0173] Finally, according to the dimensionless hydrodynamic coefficient, the UVDMS three-dimensional model is analyzed by CFD to generate hydrodynamic constraints. Interpolation analysis is performed on each part of the first and second mechanical arms of the UVDMS three-dimensional model, such as the shoulder, upper arm and lower arm, to obtain the interference caused by joint movement and the correlation curve of hydrodynamic coefficient. The appropriate working space of the two arms is analyzed through CFD simulation to reduce the hydrodynamic influence on the UVDMS. When performing CFD simulation analysis, it is stipulated that the upward rotation direction of the shoulder is positive, and the outward movement of the upper arm and the lower arm is positive. The shoulder joints of the two arms are set to rotate separately, and the upper arm and the lower arm remain stationary. The water flow rate is set to 1m / s, the model is facing the flow forward, and the hydrodynamic influence of each arm shape of the left and right shoulders is verified when the distance from the bottom is 4 times the height of the body. The shoulders of the left and right arms are set to rotate 30° each time, and the other joints remain unchanged for one simulation. In addition, the hydrodynamic interference of the model is observed by comparing the above-mentioned rotation of the left and right shoulders when the arms are not in operation. Assuming that the rotation angles of the first and second mechanical arms are reversed, the hydrodynamic forces they are subjected to are not much changed and can be approximately equal. The following simulations are numbered, with the first and second mechanical arms' shoulders at 60° being numbered 1, the first mechanical arm's shoulder at 60° and the second mechanical arm's shoulder at 90° being numbered 2.

[0174] The speed inlet is set to 1m / s and the straight-forward navigation method is adopted. The simulation is performed using the same interpolation method as the shoulder simulation. According to the actual situation, the arm motion range of the first and second manipulators is set to the interval of [-30°, 60°]. The arm configurations are -30°0°15°30°60°. It is stipulated that the first and second manipulators rotate inward as negative and rotate outward as positive. The arm shapes of the first and second manipulators are swapped, which can be simply regarded as the same situation. The shoulder is fixed at 120° and the forearm is 0°. The first and second manipulators are retracted as a simulation control to analyze the coupling interference of the two arms on the underwater robot body.

[0175] The speed entry is set to 1m / s and the straight-forward navigation method is adopted. The same interpolation method as the shoulder and upper arm joint simulation is used for simulation, and the shoulder and upper arm are fixed in the common working arm shape of 120°-30°. Considering the application scenario or the possibility of collision, the movement range of the forearm is constrained within the range of [-30°, 60°], and the forearm configuration is set to -30°0°15°30°60°. The forearms of the first and second robotic arms are compared with each other, and it is stipulated that the inward rotation of the first and second robotic arms is negative, and the outward rotation is positive, and the arm shape of the first and second robotic arms can be simply regarded as the same situation.

[0176] In the hydrodynamic simulation software, the change curve of the UVDMS three-dimensional model under the influence of lateral and axial hydrodynamic forces and the change curve of the dimensionless hydrodynamic coefficient are obtained when the shoulder, upper arm and lower arm are rotating. After setting the lateral and axial hydrodynamic safety thresholds, if the shoulder, upper arm and lower arm are in certain specific angle ranges, the UVDMS three-dimensional model will have lateral and axial hydrodynamic forces exceeding the safety thresholds. In this case, the UVDMS should avoid the shoulder, upper arm and lower arm being in the specific angle range at the same time during the movement. After setting the dimensionless hydrodynamic coefficient safety threshold, the dimensionless hydrodynamic coefficient should be avoided from exceeding the safety threshold for a long time. Based on this analysis, the hydrodynamic constraints that the first manipulator and the second manipulator need to meet during the movement are obtained.

[0177] like Fig.10 As shown, a dual-arm collaborative operation planning device 1000 provided in an embodiment of the present invention includes:

[0178] An analysis module 1010 is used to perform hydrodynamic analysis on the UVDMS three-dimensional model and generate hydrodynamic constraints;

[0179] A position module 1020 is used to obtain a starting position and a target position of the first robotic arm and a starting position and a target position of the second robotic arm according to a DH parameter method;

[0180] A planning module 1030 is used to perform path planning for the first robotic arm and the second robotic arm respectively based on the hydrodynamic constraint condition and according to the starting position and target position of the first robotic arm and the starting position and the target position of the second robotic arm, so as to generate a first planned path and a second planned path;

[0181] A discretization module 1040, configured to discretize the first planned path and the second planned path to generate at least one discrete path point interval;

[0182] A simplification module 1050 is used to simplify the UVDMS three-dimensional model by using a bounding box to generate a simplified model of two arms;

[0183] A distance module 1060 is used to extract a minimum distance between the first robotic arm and the second robotic arm based on the dual-arm simplified model and the discrete path point interval;

[0184] The collision module 1070 is used to determine the collision situation according to the minimum distance and the preset minimum threshold, and generate a target planned path according to the collision situation, the first planned path and the second planned path.

[0185] like Fig.11As shown, an electronic device 1100 provided by an embodiment of the present invention includes a memory 1110 and a processor 1120; the memory 1110 is used to store a computer program; the processor 1120 is used to implement the dual-arm collaborative work planning method as described above when executing the computer program.

[0186] In other words, an electronic device 1100 includes a memory 1110 and a processor 1120 coupled to the memory 1110; the memory 1110 is configured to store a computer program; and the processor 1120 is configured to perform the following operations when executing the computer program:

[0187] Conduct hydrodynamic analysis on the UVDMS 3D model and generate hydrodynamic constraints;

[0188] According to the DH parameter method, the starting position and the target position of the first robot arm and the starting position and the target position of the second robot arm are obtained;

[0189] Based on the hydrodynamic constraint condition, according to the starting position and target position of the first robotic arm and the starting position and target position of the second robotic arm, respectively, path planning is performed on the first robotic arm and the second robotic arm to generate a first planned path and a second planned path;

[0190] Discretize the first planned path and the second planned path to generate at least one discrete path point interval;

[0191] The UVDMS three-dimensional model is simplified by using a bounding box to generate a simplified double-arm model;

[0192] Extracting a minimum distance between the first robotic arm and the second robotic arm based on the dual-arm simplified model and the discrete path point interval;

[0193] A collision situation is determined according to the minimum distance and a preset minimum threshold, and a target planned path is generated according to the collision situation, the first planned path, and the second planned path.

[0194] An embodiment of the present invention provides a computer-readable storage medium, on which a computer program is stored. When the computer program is executed by a processor, the dual-arm collaborative operation planning method as described above is implemented.

[0195] In other words, a non-volatile computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the processor performs the following operations:

[0196] Conduct hydrodynamic analysis on the UVDMS 3D model and generate hydrodynamic constraints;

[0197] According to the DH parameter method, the starting position and the target position of the first robot arm and the starting position and the target position of the second robot arm are obtained;

[0198] Based on the hydrodynamic constraint condition, according to the starting position and target position of the first robotic arm and the starting position and target position of the second robotic arm, respectively, path planning is performed on the first robotic arm and the second robotic arm to generate a first planned path and a second planned path;

[0199] Discretize the first planned path and the second planned path to generate at least one discrete path point interval;

[0200] The UVDMS three-dimensional model is simplified by using a bounding box to generate a simplified double-arm model;

[0201] Extracting a minimum distance between the first robotic arm and the second robotic arm based on the dual-arm simplified model and the discrete path point interval;

[0202] A collision situation is determined according to the minimum distance and a preset minimum threshold, and a target planned path is generated according to the collision situation, the first planned path, and the second planned path.

[0203] An electronic device 1100 that can be used as a server or client of the present invention will now be described, which is an example of a hardware device that can be applied to various aspects of the present invention. Electronic device 1100 is intended to represent various forms of digital electronic computer equipment, such as laptop computers, desktop computers, workbenches, personal digital assistants, servers, blade servers, mainframe computers, and other suitable computers. Electronic device 1100 can also represent various forms of mobile devices, such as personal digital processing, cellular phones, smart phones, wearable devices, and other similar computing devices. The components shown herein, their connections and relationships, and their functions are merely examples, and are not intended to limit the implementation of the present invention described and / or required herein.

[0204] The electronic device 1100 includes a computing unit, which can perform various appropriate actions and processes according to a computer program stored in a read-only memory (ROM) or a computer program loaded from a storage unit into a random access memory (RAM). In the RAM, various programs and data required for the operation of the device can also be stored. The computing unit, ROM, and RAM are connected to each other via a bus. An input / output (I / O) interface is also connected to the bus.

[0205] A person of ordinary skill in the art can understand that all or part of the processes in the above-mentioned embodiment method can be implemented by instructing the relevant hardware through a computer program, and the program can be stored in a computer-readable storage medium. When the program is executed, it can include the processes of the embodiments of the above-mentioned methods. Among them, the storage medium can be a disk, an optical disk, a read-only memory (ROM) or a random access memory (RAM), etc. In the present application, the unit described as a separate component may or may not be physically separated, and the component displayed as a unit may or may not be a physical unit, that is, it may be located in one place, or it may be distributed on multiple network units. Some or all of the units can be selected according to actual needs to achieve the purpose of the embodiment of the present invention. In addition, each functional unit in each embodiment of the present invention can be integrated in a processing unit, or each unit can exist physically separately, or two or more units can be integrated in one unit. The above-mentioned integrated unit can be implemented in the form of hardware or in the form of a software functional unit.

[0206] Although the present invention is disclosed as above, the protection scope of the present invention is not limited thereto. Those skilled in the art may make various changes and modifications without departing from the spirit and scope of the present invention, and these changes and modifications will fall within the protection scope of the present invention.

Claims

1. A dual-arm collaborative operation planning method, characterized in that: include: Conduct hydrodynamic analysis on the UVDMS 3D model and generate hydrodynamic constraints; According to the DH parameter method, the starting position and the target position of the first robot arm and the starting position and the target position of the second robot arm are obtained; Based on the hydrodynamic constraint condition, according to the starting position and target position of the first robotic arm and the starting position and target position of the second robotic arm, respectively, path planning is performed on the first robotic arm and the second robotic arm to generate a first planned path and a second planned path; Discretize the first planned path and the second planned path to generate at least one discrete path point interval; The UVDMS three-dimensional model is simplified by using a bounding box to generate a simplified double-arm model; Extracting a minimum distance between the first robotic arm and the second robotic arm based on the dual-arm simplified model and the discrete path point interval; Determine a collision situation according to the minimum distance and a preset minimum threshold, and generate a target planned path according to the collision situation, the first planned path, and the second planned path; The method of performing path planning on the first robotic arm and the second robotic arm based on the hydrodynamic constraint condition and according to the starting position and the target position of the first robotic arm and the starting position and the target position of the second robotic arm to generate a first planned path and a second planned path includes: Obtain obstacle data; Based on the obstacle data, according to the starting position and the target position of the first robotic arm, a first planning algorithm is used to perform path planning on the first robotic arm to generate the first planned path; Based on the obstacle data and the first planned path, according to the starting position and the target position of the second robotic arm, a second planning algorithm is used to perform path planning on the second robotic arm to generate the second planned path; When the first planned path or the second planned path does not satisfy the hydrodynamic constraint condition, re-performing path planning to generate the first planned path or the second planned path; The adopting the second planning algorithm to perform path planning on the second robotic arm to generate the second planned path includes: Determining obstacle points according to the first planned path and the obstacle data; According to the obstacle points, the node growth direction is determined by using the artificial potential field method; Based on the starting position and target position of the second robot arm, and according to the node growth direction, the RRT algorithm and the RRT* algorithm are used to generate the second planning path; The method of generating the second planning path based on the starting position and the target position of the second robot arm and the node growth direction by using the RRT algorithm and the RRT* algorithm includes: Based on the starting position and target position of the second robot arm, the tree structure is initialized according to the RRT algorithm, and random sampling is performed to determine a candidate parent node; Determine a parent node of the tree structure according to the RRT* algorithm and the candidate parent node; Determine a new node according to the parent node and the node growth direction, and generate a preliminary planning path according to the parent node and the new node; According to the RRT* algorithm, the preliminary planned path is verified, and according to the verification result, the second planned path is generated.

2. The dual-arm collaborative operation planning method according to claim 1, characterized in that: The extracting the minimum distance between the first robotic arm and the second robotic arm based on the dual-arm simplified model and the discrete path point interval includes: Determining spatial pose data of the first robotic arm and the second robotic arm in each discrete path point interval according to the dual-arm simplified model; Determining a common perpendicular line between the first robotic arm and the second robotic arm according to the spatial posture data; The minimum distance is determined according to the endpoint positions of the common perpendicular line.

3. The dual-arm collaborative operation planning method according to claim 2, characterized in that: Determining the minimum distance according to the endpoint position of the common perpendicular line includes: When the endpoints of the common perpendicular line are both on the first mechanical arm and the second mechanical arm, the minimum distance is determined according to a first distance formula group, wherein the first distance formula group includes: ; ; in, d min is the minimum distance, P k1 is the endpoint of the common perpendicular line on the first robotic arm, Q k2 is the endpoint of the common perpendicular line on the second robotic arm, Expressed as P k1 and Q k2 The distance P s is the first endpoint of the first robotic arm, Q s is the first endpoint of the second robotic arm, k 1 is the first proportionality coefficient, k 2 is the second proportionality coefficient, and p = P e - P s , q = Q e - Q s , Q e is the second endpoint of the second robotic arm, P e is the second endpoint of the first robotic arm; When the endpoint of the common perpendicular line is on the first mechanical arm or the second mechanical arm, the minimum distance is determined according to a second distance formula group, where the second distance formula group includes: ; ; in, d 1 is the first distance, d 2 is the second distance, d 3 is the third distance, d 4 is the fourth distance, d 5 is the fifth distance, d 6 is the sixth distance; When the endpoints of the common perpendicular are not on the first mechanical arm and the second mechanical arm, the minimum distance is determined according to a third distance formula group, and the third distance formula group includes: ; ; in, d minQ is the seventh distance, d minP The eighth distance.

4. The dual-arm collaborative operation planning method according to claim 1, characterized in that: The hydrodynamic analysis of the UVDMS three-dimensional model is performed to generate hydrodynamic constraints, including: According to the UVDMS three-dimensional model, hydrodynamic force data is generated using hydrodynamic simulation software; Determining a dimensionless hydrodynamic coefficient according to the hydrodynamic force data; According to the dimensionless hydrodynamic coefficient, CFD analysis is performed on the UVDMS three-dimensional model to generate the hydrodynamic constraint condition.

5. A dual-arm collaborative operation planning device, characterized in that: include: Analysis module, used to perform hydrodynamic analysis on the UVDMS three-dimensional model and generate hydrodynamic constraints; A position module, used for obtaining a starting position and a target position of the first robotic arm and a starting position and a target position of the second robotic arm according to a DH parameter method; a planning module, configured to perform path planning for the first robotic arm and the second robotic arm respectively based on the hydrodynamic constraint conditions and according to the starting position and the target position of the first robotic arm and the starting position and the target position of the second robotic arm, so as to generate a first planned path and a second planned path; A discretization module, used for discretizing the first planned path and the second planned path to generate at least one discrete path point interval; A simplification module, used to simplify the UVDMS three-dimensional model by using a bounding box to generate a simplified model of two arms; A distance module, configured to extract a minimum distance between the first robotic arm and the second robotic arm based on the dual-arm simplified model and the discrete path point interval; A collision module, configured to determine a collision situation according to the minimum distance and a preset minimum threshold, and generate a target planned path according to the collision situation, the first planned path and the second planned path; The method of performing path planning on the first robotic arm and the second robotic arm based on the hydrodynamic constraint condition and according to the starting position and the target position of the first robotic arm and the starting position and the target position of the second robotic arm to generate a first planned path and a second planned path includes: Obtain obstacle data; Based on the obstacle data, according to the starting position and the target position of the first robotic arm, a first planning algorithm is used to perform path planning on the first robotic arm to generate the first planned path; Based on the obstacle data and the first planned path, according to the starting position and the target position of the second robotic arm, a second planning algorithm is used to perform path planning on the second robotic arm to generate the second planned path; When the first planned path or the second planned path does not satisfy the hydrodynamic constraint condition, re-performing path planning to generate the first planned path or the second planned path; The adopting the second planning algorithm to perform path planning on the second robotic arm to generate the second planned path includes: Determining obstacle points according to the first planned path and the obstacle data; According to the obstacle points, the node growth direction is determined by using the artificial potential field method; Based on the starting position and target position of the second robot arm, and according to the node growth direction, the RRT algorithm and the RRT* algorithm are used to generate the second planning path; The method of generating the second planning path based on the starting position and the target position of the second robot arm and the node growth direction by using the RRT algorithm and the RRT* algorithm includes: Based on the starting position and target position of the second robot arm, the tree structure is initialized according to the RRT algorithm, and random sampling is performed to determine a candidate parent node; Determine a parent node of the tree structure according to the RRT* algorithm and the candidate parent node; Determine a new node according to the parent node and the node growth direction, and generate a preliminary planning path according to the parent node and the new node; According to the RRT* algorithm, the preliminary planned path is verified, and according to the verification result, the second planned path is generated.

6. An electronic device, characterized in that: including memory and processor; The memory is used to store computer programs; The processor is used to implement the dual-arm collaborative work planning method as described in any one of claims 1 to 4 when executing the computer program.

7. A computer-readable storage medium, characterized in that: The storage medium stores a computer program, and when the computer program is executed by the processor, the dual-arm collaborative work planning method as described in any one of claims 1 to 4 is implemented.