Overhead line system cantilever maintenance mechanical arm path planning method based on intelligent space division

Through the mechanical arm path planning method for contact network wrist arm maintenance based on space intelligent division, the problems of low efficiency, large safety hazards and insufficient operational accuracy in contact network maintenance are solved, and efficient and safe bolt tightening tasks in complex environments are realized. , improve maintenance efficiency and accuracy.

CN119057789AActive Publication Date: 2024-12-03SOUTHWEST JIAOTONG UNIV +1

Patent Information

Application Number
CN202411367928.3
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-09-29
Publication Date
2024-12-03
Estimated Expiration
2044-09-29

AI Technical Summary

Technical Problem

The prior art has low efficiency, high safety hazards and insufficient operating accuracy in contact network maintenance, making it difficult to meet the needs of large-scale and high-frequency maintenance.

Method used

The robot arm path planning method based on spatial intelligent division is adopted. The work space is analyzed through DH parameter modeling and Monte Carlo method, combined with the distribution of bolt fastening work points, and the robot arm path planning is used using the RRT algorithm. Ensure efficient and safe completion of bolt tightening tasks in complex environments.

Benefits of technology

It improves maintenance efficiency and operating accuracy, enhances operation safety, reduces the collision risk between the robotic arm and the contact network structure, and reduces the probability of safety accidents.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119057789A_ABST
    Figure CN119057789A_ABST
Patent Text Reader

Abstract

The invention relates to the technical field of robots, and discloses an overhead line system cantilever maintenance mechanical arm path planning method based on intelligent space division, and the method comprises the steps: describing the relation between each joint and a connecting rod through different parameters, and building a robot kinematics model; mechanical arm working space simulation analysis is conducted on the basis of the robot kinematics model, so that whether the mechanical arm can cover contact net bolts at different positions or not is evaluated, and the accessibility of the tail end of the mechanical arm in the working space under the condition that a mechanical arm base is fixed is analyzed; according to the distribution condition of the bolt points in the overhead line system environment, dividing a working space area of overhead line system bolt working points; dividing the work space with minimizing the movement of the robot arm base; and off-line modeling is conducted on the working environment of the contact network and the mechanical arm, and the maintenance task of the cantilever of the contact network is achieved through path planning by means of the divided working space. By means of the method, the mechanical arm can efficiently and safely complete the bolt fastening task in the complex contact network environment.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the field of robot technology, and in particular to a contact network wrist-arm maintenance robot arm path planning method based on space intelligent division. Background Art

[0002] With the continuous expansion and upgrading of the railway transportation network, the contact network, as a key component of the electrified railway system, its stability and safety are the key to ensuring the normal operation of the railway. However, under the influence of environmental changes, natural factors and operational wear, the various components of the contact network may experience bolt loosening, structural deformation or damage, which will bring risks to the stable operation of the railway. At present, traditional contact network maintenance mainly relies on manual work. This method is not only inefficient, but also easily affected by subjective factors, and it is difficult to meet the large-scale and high-frequency maintenance needs. In this context, it is particularly important to introduce a robotic arm to carry out the maintenance of the contact network. Using a robotic arm instead of manual inspection can not only improve the efficiency of maintenance work, but also reduce the operation risk and labor intensity of maintenance workers.

[0003] An important task of the manipulator when carrying out contact network operations is to complete the bolt tightening of the contact network wrist arm. Due to the complex structure of the contact network and the harsh working environment, the bolt tightening at different positions requires the manipulator to operate in different working spaces. At the same time, since the manipulator is generally installed on the lifting and rotating platform of the maintenance vehicle, the movement of the lifting and rotating platform needs to be reduced as much as possible during the maintenance operation. Therefore, the division of the manipulator's workspace is an important link. By accurately dividing the workspace of the manipulator, it can be ensured that it can efficiently complete various maintenance tasks in a confined space. Reasonable division of the workspace can not only improve the operating efficiency of the manipulator, but also avoid operational errors caused by overlapping or insufficient workspace. Summary of the invention

[0004] The purpose of the present invention is to provide a method for path planning of a contact network arm maintenance manipulator based on space intelligent division, so as to solve the problems of low efficiency, safety hazards and insufficient operation accuracy in the current contact network maintenance process. DH parameter modeling is used to provide a theoretical basis for the subsequent manipulator workspace analysis, the Monte Carlo method is used to analyze the manipulator workspace, and the distribution of bolt tightening operation points in the contact network environment is combined to calculate the contact network bolt operation point workspace area division, and the RRT algorithm is used in different areas to perform manipulator safety path planning to ensure that the manipulator does not collide with obstacles during the bolt tightening operation, while maximizing the operation efficiency, so that the manipulator can efficiently and safely complete the bolt tightening task in a complex contact network environment.

[0005] In order to achieve the above purpose, the technical solutions adopted are as follows:

[0006] A method for path planning of a contact network arm maintenance robot based on space intelligent division, the method comprising:

[0007] The robot kinematic model is established by describing the relationship between each joint and connecting rod through different parameters;

[0008] Based on the robot kinematic model, a robot arm workspace simulation analysis is performed to evaluate whether the robot arm can cover the contact network bolts at different positions, and to analyze the accessibility of the end of the robot arm in the workspace when the robot arm base is fixed;

[0009] Based on the simulation analysis of the working space under the condition of fixed manipulator base, the working space area of ​​the contact network bolt operation point is divided according to the distribution of bolt points in the contact network environment;

[0010] Divide the workspace to minimize the movement of the robot base;

[0011] The working environment of the contact network and the robotic arm is modeled offline, and the divided workspace is used to achieve the maintenance task of the contact network arm through path planning.

[0012] Furthermore, describing the relationship between each joint and the connecting rod by different parameters to establish a robot kinematic model includes:

[0013] Rotate the coordinate system {i-1} around z i-1 Axis rotation θ i , then along z i-1 Move in the direction of d i-1 The distance along the current x i-1 Axis movement a i The distance z i Axis around x i Axis rotation α i , get the transformation matrix from coordinate {i-1} to coordinate system {i};

[0014] According to the transformation matrix from coordinate {i-1} to coordinate system {i}, the transformation matrix between the end of the robot and the base coordinate system is determined;

[0015] Based on the transformation matrix and the conversion matrix, the forward kinematics formula of the robot arm is determined.

[0016] Furthermore, the transformation matrix from the coordinate {i-1} to the coordinate system {i} is expressed as:

[0017]

[0018] In the formula, represents the transformation matrix from coordinate system {i-1} to coordinate system {i}, θ iis the joint angle, which means that this is the angle between the z-axis (i.e., the rotation axis) of the i-th link coordinate system and the z-axis of the i-1-th link coordinate system. z represents the rotation axis of a link coordinate system, and d i represents the distance from the coordinate origin of the i-1th link to the coordinate origin of the i-th link, measured along the z-axis of the i-1th link coordinate system. i It represents the distance between the origin of the i-1th link coordinate system and the origin of the i-th link coordinate system. Rot represents the rotation matrix, which is used to describe the rotation part of the coordinate system. Trans represents the translation matrix, which is used to describe the translation part of the coordinate system. x represents the position vector. α represents the torsion angle between two consecutive z axes. c represents the abbreviation of cosine function in the rotation matrix. s represents the abbreviation of sin function in the rotation matrix.

[0019] Furthermore, the transformation matrix between the end of the robot and the base coordinate system is expressed as:

[0020]

[0021] In the formula, represents the transformation matrix from coordinate system {0} to coordinate system {6}, They represent the transformation matrices from coordinate system {0} to coordinate system {1}, coordinate system {1} to coordinate system {2}, coordinate system {2} to coordinate system {3}, coordinate system {4} to coordinate system {5}, and coordinate system {5} to coordinate system {6} respectively.

[0022] Furthermore, the forward kinematics formula of the robotic arm is expressed as:

[0023]

[0024] Where n x 、n y 、n z represents the components of the end effector's rotation axis in the x, y, and z directions relative to the base coordinate system, o x , o y , o z They represent the components of the translation vector of the end effector relative to the base coordinate system in the x, y, and z directions, respectively. x 、a y 、a z Respectively represent the offset of the joint in the x, y, and z directions, p x 、p y 、p z Represent the translation distance of the joint respectively.

[0025] The expressions represented by each element in formula (3) are as follows:

[0026] n x=S1S5C6+C6C 234 C1C5-S 234 C1S6

[0027] n y =-C6C1S5+C6C 234 C5C1-S 234 S1S6

[0028] n z =C 234 S6+S 234 C5C6

[0029] o x =-S6S1S5-S6C 234 C1C5-S 234 C1C6

[0030] o y =S6C1S5-S6C 234 C1S5-S 234 C6S1

[0031] o z =C 234 C6-S 234 C5S6

[0032] a x =C5S1-C 234 C1S5

[0033] a y =-C1S5-C 234 S1S5

[0034] a z =-S 234 S5

[0035] p x =d6C5S1-d6C 234 C1S5+C1a3C 23 +C1a2C2+d4S1+d5S 234 C1+d2S1+d3S1

[0036] p y =S1a3C 23 +S1a2C2-d4C1-d2C1-d3C1-d6C5C1-d6C 234 S1S5+d5S 234 S1

[0037] p z =d1+a3S 234 +a2S2-d5C 234 -d4S234 S5

[0038] Wherein, C represents the abbreviation of cos function in the rotation matrix, S represents the abbreviation of sin function in the rotation matrix, S1, S2, S3, S4, S5, S6 represent the sine values ​​of the angles of the first joint, the second joint, the third joint, the fourth joint, the fifth joint, and the sixth joint respectively; d1, d2, d3, d4, d5, d6 represent the offsets of the first joint, the second joint, the third joint, the fourth joint, the fifth joint, and the sixth joint respectively; C1, C2, C3, C4, C5, C6 represent the cosine values ​​of the angles of the first joint, the second joint, the third joint, the fourth joint, the fifth joint, and the sixth joint respectively; C 23 represents the product of the cosine values ​​of the second and third joint angles, C 234 represents the product of the cosine values ​​of the second, third, and fourth joint angles; S 234 It represents the product of the sine of the second joint angle and the sine of the third and fourth joint angles; a1, a2, and a3 represent the lengths of the first joint, the second joint, and the third joint, respectively.

[0039] Furthermore, a robot arm workspace simulation analysis is performed based on the robot kinematic model to evaluate whether the robot arm can cover the contact network bolts at different positions, and to analyze the accessibility of the end of the robot arm in the workspace when the robot arm base is fixed, including:

[0040] Setting the parameters of the Monte Carlo simulation; wherein the parameters of the Monte Carlo simulation include the range of joint angles;

[0041] Randomly output a set of N joint angles within the set joint angle range. The calculation formula is as follows:

[0042] θ=θ min +(θ max -θ min )RAND(N,1) (4)

[0043] In the formula, θ represents max Indicates the maximum value of the set joint angle range, θ min Indicates the minimum value of the set joint angle range, RAND indicates the number of output joint angles;

[0044] Determine the x, y, and z coordinates of the position of the end of the robotic arm according to the forward kinematics formula of the robotic arm;

[0045] Outputting the x, y, and z coordinates of the position of the end of the robotic arm as a set of coordinate points in a three-dimensional space to obtain a scatter plot representing the workspace of the robotic arm;

[0046] Based on the scatter plot, it is evaluated whether the robotic arm can cover the contact network bolts at different positions, and the accessibility of the end of the robotic arm in the working space is analyzed when the robotic arm base is fixed.

[0047] Furthermore, based on the simulation analysis of the working space under the condition of fixed manipulator base, the working space area of ​​the contact network bolt operation point is divided according to the distribution of bolt points in the contact network environment, including:

[0048] The center of the bottom surface of the contact network column is taken as the coordinate origin, the axial direction of the column is defined as the z-axis, the direction perpendicular to the paper and outward is set as the x-axis, and the direction parallel to the contact network flat arm is set as the y-axis. A coordinate system is established, and the specific coordinate value corresponding to each bolt number is obtained by measuring the coordinates of each bolt in the coordinate system of the contact network column base, and the coordinate values ​​corresponding to different bolt numbers are obtained.

[0049] Furthermore, the workspace is divided to minimize the movement of the robot base, including:

[0050] Determine whether the plug is located in the upper half of the sphere and outside the inaccessible cylindrical area according to the judgment basis; wherein the judgment basis is expressed as:

[0051]

[0052] In the formula, x i ,y i ,z i represents the x-coordinate, y-coordinate, and z-coordinate of the ith bolt, x cir ,y cir ,z cir are the x-coordinate, y-coordinate and z-coordinate of the center of the workspace; R cir is the radius of the workspace, R cy is the radius of the cylinder of the inaccessible area in the workspace;

[0053] x cir ,y cir ,z cir The calculation formula is:

[0054]

[0055] In the formula, x bias ,y bias , z bias The x-, y- and z-coordinates of the bolt relative to the center of the workspace sphere;

[0056] If the bolt meets the judgment criteria, the bolt is classified into a corresponding workspace area; if the bolt does not meet the judgment criteria, a new spherical area is set according to the position of the bolt.

[0057] Furthermore, the working environment of the contact network and the manipulator is modeled offline, and the divided workspace is used to implement the maintenance task of the contact network arm through path planning, including:

[0058] Set starting point init As the initial point, as the root node of the random tree T;

[0059] In each loop, a random sampling point q is generated rand ;

[0060] Sampling: traverse each node in the random tree T and calculate the correlation between each node and the random sampling point q rand Euclidean distance, find the node q that is closest to nearest ;

[0061] From the nearest node q nearest To randomly sample point q rand Move forward a step δ in the direction to generate a new node q new .

[0062] Detection from the nearest node q nearest To the new node q new Whether the path intersects with the obstacle, if there is a collision, the new node q is discarded new , re-enter the sampling process; otherwise, determine that the path is feasible and add the new node q new Add to the random tree T.

[0063] Calculate the new node q new To the target point q goal If the distance is less than the set threshold, it is determined that the target point has been reached and the search ends.

[0064] The beneficial effects of the present invention are:

[0065] (1) Improve maintenance efficiency: By intelligently dividing the working space of the robot arm, the robot arm can efficiently complete the tightening task of each bolt and reduce maintenance time.

[0066] (2) Improve operation accuracy: Accurately divide the working space of the robot arm, while taking into account the working capacity range of the robot arm itself, to ensure that the end of the robot arm can accurately reach each bolt position and improve the accuracy of the bolt tightening operation.

[0067] (3) Enhance operational safety: Avoid collision between the robotic arm and the contact network structure, ensure the safety of the robotic arm during operation, and reduce the risk of safety accidents. BRIEF DESCRIPTION OF THE DRAWINGS

[0068] Figure 1 A schematic diagram of a typical structure of a contact network according to the prior art is shown.

[0069] Figure 2 The present invention shows an overall flow chart of a method for path planning of a contact network arm maintenance robot based on intelligent spatial division according to an embodiment of the present invention.

[0070] Figure 3 A schematic diagram of the DH parameter coordinate system of UR16e according to an embodiment of the present invention is shown.

[0071] Figure 4 A point cloud diagram of the UR16e workspace according to an embodiment of the present invention is shown.

[0072] Figure 5 A histogram of point set distribution in a robot arm workspace according to an embodiment of the present invention is shown.

[0073] Figure 6 A schematic diagram of establishing a contact network coordinate system and bolt distribution according to an embodiment of the present invention is shown.

[0074] Figure 7 A flow chart of the division of the working space area of ​​the contact network bolt operation point according to an embodiment of the present invention is shown.

[0075] Figure 8 A visualization result diagram of the division of the working space area of ​​the contact network bolt operation point according to an embodiment of the present invention is shown.

[0076] Fig. 9 A diagram of an offline model of a contact network and a mechanical arm according to an embodiment of the present invention is shown.

[0077] Fig.10 An offline model coordinate relationship tree according to an embodiment of the present invention is shown.

[0078] Fig.11 The figure shows the robot arm execution path of the S2 bolt target point planned according to an embodiment of the present invention. DETAILED DESCRIPTION

[0079] The following describes the embodiments of the present invention by specific examples, and those skilled in the art can easily understand other advantages and effects of the present invention from the contents disclosed in this specification. The present invention can also be implemented or applied through other different specific embodiments, and the details in this specification can also be modified or changed in various ways based on different viewpoints and applications without departing from the spirit of the present invention. It should be noted that the following embodiments and features in the embodiments can be combined with each other without conflict.

[0080] The specific implementation of the present invention is further described in detail below in conjunction with the drawings and examples.

[0081] Figure 1 A schematic diagram of a typical structure of a contact network according to the prior art is shown. Figure 1 As shown in the figure, the typical structure of the overhead contact network includes a pillar 1, an inclined arm support 2, a positioning tube support 3, a positioning tube 4, an inclined arm 5, a flat arm 6, and an insulator 7. The right side is an overhead contact network maintenance vehicle, wherein the overhead contact network maintenance vehicle includes a mechanical arm 8, a lifting and rotating platform 9, and an overhead contact network maintenance vehicle 10. During the operation, in order to improve the maintenance efficiency of the mechanical arm, it is necessary to model the typical overhead contact network, divide the working area, and use the RRT path planning algorithm to plan the safe path of the UR16e mechanical arm to achieve efficient and safe inspection purposes.

[0082] Based on this, an embodiment of the present invention provides a method for planning a path for a contact network arm maintenance robot based on space intelligent division, such as Figure 2 As shown in FIG. 1 , it is a flow chart of the method. The path planning method of the overhead line arm maintenance robot based on space intelligent division includes the following steps:

[0083] S1. Describe the relationship between each joint and connecting rod through different parameters and establish the robot kinematic model.

[0084] In this embodiment, step S1 is the process of DH modeling and forward kinematics analysis of the robot. Denavit-Hartenberg (DH) parameter modeling describes the relationship between each joint and connecting rod through different parameters to establish a robot kinematic model. This method can systematically solve the robot forward and inverse kinematics problems and lay a theoretical foundation for the subsequent robot workspace analysis.

[0085] In some embodiments, UR16e is used as an example of a robotic arm. According to the DH modeling method, step S1 specifically includes:

[0086] (1) Determine the z-axis direction of each joint axis and all coordinate systems.

[0087] (2) Determine the common perpendicular line or intersection point between joint axis i and joint axis i+1 as the origin of coordinate system {i}.

[0088] (3) Set the x-axis perpendicular to the joint axis i and the joint axis i+1 to determine the direction of the x-axis.

[0089] By combining the parameters of the UR16e mechanical structure, the corresponding DH parameter table can be obtained. The coordinate system established on the robot arm is as follows Figure 3 As shown, the DH parameter table is shown in Table 1.

[0090] Table 1 DH parameter table of UR16e

[0091]

[0092] When calculating the forward kinematics of the robot, we must first calculate the transformation matrix from coordinate system {i-1} to coordinate system {i}. According to the definition of DH parameters, the transformation from coordinate system {i-1} to coordinate system {i} can be divided into the following steps: First, transform coordinate system {i-1} around z i-1 Rotate θ i , then along z i-1 Move in the direction of d i-1 distance, and then along the current x i-1 Axis movement a i distance, and finally z i Axis around x i Axis rotation α i Therefore, the transformation matrix from coordinate {i-1} to coordinate system {i} is shown in formula (1).

[0093] According to formula (1), we can get And multiply them to get the transformation relationship between the end of the robot and the base coordinate system. The transformation matrix is ​​shown in formula (2).

[0094]

[0095] In the formula, represents the transformation matrix from coordinate system {i-1} to coordinate system {i}, θ i is the joint angle, which means that this is the angle between the z-axis (i.e., the rotation axis) of the i-th link coordinate system and the z-axis of the i-1-th link coordinate system. z represents the rotation axis of a link coordinate system, and d i represents the distance from the coordinate origin of the i-1th link to the coordinate origin of the i-th link, measured along the z-axis of the i-1th link coordinate system. i It represents the distance between the origin of the i-1th link coordinate system and the origin of the i-th link coordinate system. Rot represents the rotation matrix, which is used to describe the rotation part of the coordinate system. Trans represents the translation matrix, which is used to describe the translation part of the coordinate system. x represents the position vector. α represents the torsion angle between two consecutive z axes. c represents the abbreviation of cosine function in the rotation matrix. s represents the abbreviation of sin function in the rotation matrix.

[0096] The value obtained by formula (1) Substituting into formula (2), we can get formula (3).

[0097]

[0098] Where n x、n y 、n z represents the components of the end effector's rotation axis in the x, y, and z directions relative to the base coordinate system, o x , o y , o z They represent the components of the translation vector of the end effector relative to the base coordinate system in the x, y, and z directions, respectively. x 、a y 、a z Respectively represent the offset of the joint in the x, y, and z directions, p x 、p y 、p z Represents the translation distance of the joint in the x, y, and z directions respectively.

[0099] The expressions represented by each element in the matrix in formula (3) are as follows:

[0100] n x =S1S5C6+C6C 234 C1C5-S 234 C1S6

[0101] n y =-C6C1S5+C6C 234 C5C1-S 234 S1S6

[0102] n z =C 234 S6+S 234 C5C6

[0103] o x =-S6S1S5-S6C 234 C1C5-S 234 C1C6

[0104] o y =S6C1S5-S6C 234 C1S5-S 234 C6S1

[0105] o z =C 234 C6-S 234 C5S6

[0106] a x =C5S1-C 234 C1S5

[0107] a y =-C1S5-C 234 S1S5

[0108] a z =-S234 S5

[0109] p x =d6C5S1-d6C 234 C1S5+C1a3C 23 +C1a2C2+d4S1+d5S 234 C1+d2S1+d3S1

[0110] p y =S1a3C 23 +S1a2C2-d4C1-d2C1-d3C1-d6C5C1-d6C 234 S1S5+d5S 234 S1

[0111] p z =d1+a3S 234 +a2S2-d5C 234 -d4S 234 S5

[0112] Wherein, C represents the abbreviation of cos function in the rotation matrix, S represents the abbreviation of sin function in the rotation matrix, S1, S2, S3, S4, S5, S6 represent the sine values ​​of the angles of the first joint, the second joint, the third joint, the fourth joint, the fifth joint, and the sixth joint respectively; d1, d2, d3, d4, d5, d6 represent the offsets of the first joint, the second joint, the third joint, the fourth joint, the fifth joint, and the sixth joint respectively; C1, C2, C3, C4, C5, C6 represent the cosine values ​​of the angles of the first joint, the second joint, the third joint, the fourth joint, the fifth joint, and the sixth joint respectively; C 23 represents the product of the cosine values ​​of the second and third joint angles, C 234 represents the product of the cosine values ​​of the second, third, and fourth joint angles; S 234 It represents the product of the sine of the second joint angle and the sine of the third and fourth joint angles; a1, a2, and a3 represent the lengths of the first joint, the second joint, and the third joint, respectively.

[0113] S2. Perform a simulation analysis of the robot arm's workspace based on the robot kinematic model to evaluate whether the robot arm can cover the contact network bolts at different positions, and analyze the accessibility of the end of the robot arm in the workspace when the robot arm base is fixed.

[0114] In this embodiment, step S2 is a process of simulating and analyzing the workspace of the robot arm. First, the workspace analysis of the robot arm is performed using the Monte Carlo method to evaluate whether it can cover the contact network bolts at different positions. The accessibility of the end of the robot arm in the workspace is analyzed when the base of the robot arm is fixed.

[0115] In some embodiments, taking UR16e as an example of a robotic arm, the Monte Carlo method is used to solve the workspace process of UR16e as follows:

[0116] (1) Set the parameters of Monte Carlo simulation, such as sample size, sampling range, etc. The joint angle range used in this paper is shown in Table 2.

[0117] Table 2 Monte Carlo method robot arm joint angle motion range

[0118]

[0119] (2) In the set robot arm joint angle range [θ min ,θ max ] randomly outputs a set of N joint angles, and the calculation formula is shown in Formula 4.

[0120] θ=θ min +(θ max -θ min )RAND(N,1) (4)

[0121] Among them, RAND(N,1) is a random output function that outputs N rows and 1 column of data in the range of [0,1].

[0122] (3) According to the forward kinematics formula (3) of the robot arm, the x, y, and z coordinates of the position of the end of the robot arm are solved and stored.

[0123] (4) The calculated position is output as a set of coordinate points in three-dimensional space. The collection of these points forms a scatter plot representing the workspace of the robot arm.

[0124] Point cloud results are as follows Figure 4 As shown in the figure, its working space is approximately hemispherical in shape, and there is an inaccessible area in the center. In order to obtain detailed information about this inaccessible area and the overall shape, the research Figure 4 The spatial distribution of the point set is studied in this embodiment. The distribution of points in different coordinate directions and directions far from the origin is studied, and the corresponding point set coordinate distribution histogram is obtained as shown in FIG. Figure 5As shown. The histogram further quantifies these distribution features, showing that the point sets on the x-axis and y-axis are mainly concentrated in the range of -0.8 meters to 0.8 meters, while on the z-axis, the distribution is mainly concentrated in the range of -0.2 meters to 1.183 meters. In addition, the distribution of the point set along the z-axis is denser in the range of 0.2 meters to 1.2 meters. These analysis results are of great value for understanding the motion limitations of the robot arm, optimizing the working path, and performing precise path planning and motion control.

[0125] S3. Based on the simulation analysis of the working space under the condition of fixed manipulator base, the working space area of ​​the contact network bolt operation point is divided according to the distribution of bolt points in the contact network environment.

[0126] In this embodiment, step S3 is the process of modeling the position of the contact network bolts. By simulating and analyzing the working space under the condition of fixing the base of the manipulator, it is found that its working space is approximately a hemispherical cylinder with a hollow middle. Since the radius of the manipulator working space is limited and cannot cover all the bolts, it is necessary to divide the working space area of ​​the contact network bolt operation point according to the distribution of the bolt points in the contact network environment.

[0127] In some embodiments, step S3 specifically includes:

[0128] In a typical contact network environment, the distribution of operating bolt points is analyzed, and then the working space area of ​​the bolt operating points is calculated and divided. The contact network bolts are mainly distributed in six locations. In order to conveniently describe the positions of these bolts, this paper uses the following method to establish a coordinate system: the center of the bottom circle of the contact network column is used as the coordinate origin, the axis direction of the column is defined as the z-axis, the direction perpendicular to the paper and outward is set as the x-axis, and the direction parallel to the contact network horizontal wrist arm is set as the y-axis. Figure 6 By measuring the coordinates of bolts S1 to S6 in the contact network column base coordinate system, the specific coordinate values ​​corresponding to each bolt number can be obtained, and finally the coordinate values ​​corresponding to different bolt numbers are shown in Table 3.

[0129] Table 3 Distribution of main bolts in overhead contact network

[0130]

[0131] S4. Divide the workspace to minimize the movement of the robot base.

[0132] In this embodiment, step S4 is the process of intelligently dividing the workspace. In order to improve the maintenance efficiency of the overhead line manipulator, considering that the base of the manipulator is fixed on the track maintenance vehicle, the number of movements of the maintenance vehicle, that is, the number of movements of the base of the manipulator, is reduced, and the inspection space of the manipulator is divided. Combined with the manipulator simulation space obtained in step S2, the workspace is divided by minimizing the movement of the base of the manipulator to improve the inspection efficiency.

[0133] In some embodiments, this embodiment proposes an algorithm for dividing the working space area of ​​the contact network bolt operation point. The algorithm first reads the coordinate information of the bolt from the data set and performs a position check on each bolt to determine whether it is located in the defined working space. Specifically, it is checked whether the bolt is located in the upper half of the sphere and outside the inaccessible cylindrical area. This judgment is made according to a specific calculation formula (5).

[0134]

[0135] In formula (5), (x i ,y i ,z i ) represents the coordinates of the i-th bolt, (x cir ,y cir ,z cir ) is the coordinate of the center of the workspace. cir is the radius of the workspace. According to the previous description, it is set to 1m here. cy is the radius of the cylinder in the inaccessible area within the workspace, which is set to 0.0576m here.

[0136]

[0137] In formula (6), x bias ,y bias , z bias In order to place the bolt at a relative position from the center of the workspace, due to the presence of a cylinder in the workspace, the relative position needs to be placed outside the middle inaccessible area. In this paper, x bias is set to 0.5, y bias is set to 0, z bias is set to -0.3.

[0138] If the bolt meets the above conditions, it will be classified into the corresponding workspace area. Conversely, if the bolt does not meet the conditions, the algorithm will define a new spherical area near the bolt position. The algorithm will repeat the above steps, judging and classifying all bolt coordinates one by one until the entire set of data is processed. Through this iterative method, the algorithm can gradually build a detailed workspace division to ensure that each bolt point is reasonably assigned to the appropriate work area. This process not only improves work efficiency, but also provides accurate spatial information for subsequent job scheduling and path planning.

[0139] according to Figure 7 The algorithm flow described above is solved by writing a program in Matlab. The final results of the workspace division of the contact network bolt operation point are shown in Table 4, and the corresponding visualization results are shown in Figure 4. Figure 8 shown.

[0140] Table 4 Results of the division of working space at the contact network bolt operation point

[0141]

[0142] from Figure 8 As can be seen from Table 4, at least three independent workspaces are required to cover all bolt operation points. Bolts S1, S2, S3, and S6 are relatively close in space and are grouped into the same workspace, namely, workspace 1. Bolts S4 and S5 are far away from other bolts and each constitutes an independent workspace. Figure 8 , it can be found that these workspaces intersect with the contact network components. When planning the path of the robot arm, the possible collision between the robot arm and the contact network components must be considered to ensure that no damage is caused to the contact network during the operation.

[0143] S5. Offline modeling of the contact network and the working environment of the robotic arm is carried out, and the maintenance task of the contact network arm is realized through path planning by utilizing the divided workspace.

[0144] In this embodiment, step S5 is a process of safe path planning. First, the contact network and the working environment of the manipulator are modeled offline, and then the different working spaces obtained in step S4 are used to implement the maintenance task of the contact network arm through the RRT path planning algorithm.

[0145] In some embodiments, step S5 specifically includes:

[0146] By using offline modeling technology, models can be efficiently built and collision detection and path planning tasks can be performed. This process requires the accurate drawing of the mechanical structure model of the contact network to ensure the accuracy of collision detection. In this embodiment, a contact network model is first created in Solidworks software and exported to STL format. Then, under the ROS framework, the Xacro file is used to load the STL model to integrate the contact network model with models such as the robotic arm to jointly build a unified virtual environment. In this environment, the coordinate relationship between the models is defined, and the necessary visualization and collision properties are set to facilitate simulation analysis. The final contact network offline simulation model is as follows: Fig. 9 As shown, the coordinate relationship between the contact network and the mechanical arm defined in the Xacro file is as follows Fig.10 shown.

[0147] The RRT algorithm is used to plan the robot path in different workspaces. The process of the RRT algorithm is as follows:

[0148] (1) Set the starting point q init As the initial point, as the root node of the random tree T.

[0149] (2) Sampling: In each cycle, a random sampling point q is generated rand .

[0150] (3) Find the nearest node: traverse each node in the random tree T and calculate the distance between each node and q rand Euclidean distance, find the node q that is closest to nearest .

[0151] (4) Go one step forward: From q nearest To q rand Move forward a step δ in the direction to generate a new node q new .

[0152] (5) Collision detection: Detection from q nearest to q new Does the path intersect with the obstacle? If there is a collision, discard q new , re-enter the sampling process; otherwise, the path is considered feasible and q new Add to the random tree T.

[0153] (6) Check whether the target point has been reached: Calculate q new To the target point q goal If the distance is less than the set threshold, it is considered that the target point has been reached and the search ends.

[0154] (7) Repeat the above iterative process until q nearest and the target point q goalThe distance between them is lower than the set threshold.

[0155] This embodiment uses the RRT provided by OMPL and the built offline contact network model for testing. The target point is given as the S1~S6 bolt position on the contact network. The path planning time of different bolts in the contact network environment is tested. The results are shown in Table 5.

[0156] Table 5 Path planning time results for different bolts

[0157]

[0158] It can be seen from Table 5 that the robot can successfully complete the path planning at each bolt target point in the obtained workspace, proving the correctness of the solved workspace. At the same time, in order to verify whether the constructed simulation model of the robot and the contact network can effectively perform collision detection and path planning, this embodiment selects the S2 bolt located on the contact network positioning tube as the target point and adopts the RRT path planning algorithm. The path generated is as follows: Fig.11 As shown in the figure, no collision was found in the planned path, which shows the effectiveness of collision detection and path planning based on the intelligent space partitioning algorithm in the contact network offline model.

[0159] The above implementation modes are only used to illustrate the present invention, but not to limit the present invention. Ordinary technicians in the relevant technical field can make various changes and modifications without departing from the spirit and scope of the present invention. Therefore, all equivalent technical solutions also belong to the scope of the present invention. The patent protection scope of the present invention should be defined by the claims.

Claims

1. A method for path planning of a contact network arm maintenance robot based on space intelligent division, characterized in that: The method comprises: The robot kinematic model is established by describing the relationship between each joint and connecting rod through different parameters; Based on the robot kinematic model, a robot arm workspace simulation analysis is performed to evaluate whether the robot arm can cover the contact network bolts at different positions, and to analyze the accessibility of the end of the robot arm in the workspace when the robot arm base is fixed; Based on the simulation analysis of the working space under the condition of fixed manipulator base, the working space area of ​​the contact network bolt operation point is divided according to the distribution of bolt points in the contact network environment; Divide the workspace to minimize the movement of the robot base; The working environment of the contact network and the robotic arm is modeled offline, and the divided workspace is used to achieve the maintenance task of the contact network arm through path planning.

2. The method for path planning of a contact network arm maintenance robot based on space intelligent division according to claim 1, characterized in that: The relationship between each joint and the connecting rod is described by different parameters to establish a robot kinematic model, including: Rotate the coordinate system {i-1} around z i-1 Axis rotation θ i , then along z i-1 Move in the direction of d i-1 The distance along the current x i-1 Axis movement a i The distance z i Axis around x i Axis rotation α i , get the transformation matrix from coordinate {i-1} to coordinate system {i}; According to the transformation matrix from coordinate {i-1} to coordinate system {i}, the transformation matrix between the end of the robot and the base coordinate system is determined; Based on the transformation matrix and the conversion matrix, the forward kinematics formula of the robot arm is determined.

3. The method for path planning of a contact network arm maintenance robot based on space intelligent division according to claim 2, characterized in that: The transformation matrix from the coordinate {i-1} to the coordinate system {i} is expressed as: In the formula, represents the transformation matrix from coordinate system {i-1} to coordinate system {i}, θ i is the joint angle, which represents the angle between the z-axis of the i-th link coordinate system and the z-axis of the i-1-th link coordinate system. z represents the rotation axis of a link coordinate system. d i represents the distance from the coordinate origin of the i-1th link to the coordinate origin of the i-th link measured along the z-axis of the i-1th link coordinate system, a i It represents the distance between the origin of the i-1th link coordinate system and the origin of the i-th link coordinate system. Rot represents the rotation matrix, which is used to describe the rotation part of the coordinate system. Trans represents the translation matrix, which is used to describe the translation part of the coordinate system. x represents the position vector. α represents the torsion angle between two consecutive z axes. c represents the abbreviation of cosine function in the rotation matrix. s represents the abbreviation of sin function in the rotation matrix.

4. The method for path planning of a contact network arm maintenance robot arm based on space intelligent division according to claim 3, characterized in that: The transformation matrix between the end of the robot and the base coordinate system is expressed as: In the formula, represents the transformation matrix from coordinate system {0} to coordinate system {6}, They represent the transformation matrices from coordinate system {0} to coordinate system {1}, coordinate system {1} to coordinate system {2}, coordinate system {2} to coordinate system {3}, coordinate system {4} to coordinate system {5}, and coordinate system {5} to coordinate system {6} respectively.

5. The method for path planning of a contact network arm maintenance robot arm based on space intelligent division according to claim 4, characterized in that: The forward kinematics formula of the robotic arm is expressed as: Where n x 、n y 、n z represents the components of the end effector's rotation axis in the x, y, and z directions relative to the base coordinate system, o x , o y , o z They represent the components of the translation vector of the end effector relative to the base coordinate system in the x, y, and z directions, respectively. x 、a y 、a z Respectively represent the offset of the joint in the x, y, and z directions, p x 、p y 、p z Represents the translation distance of the joint in the x, y, and z directions respectively. The expressions represented by each element in formula (3) are as follows: n x =S1S5C6+C6C 234 C1C5-S 234 C1S6 n y =-C6C1S5+C6C 234 C5C1-S 234 S1S6 n z =C 234 S6+S 234 C5C6 o x =-S6S1S5-S6C 234 C1C5-S 234 C1C6 o y =S6C1S5-S6C 234 C1S5-S 234 C6S1 o z =C 234 C6-S 234 C5S6 a x =C5S1-C 234 C1S5 a y =-C1S5-C 234 S1S5 a z =-S 234 S5 p x =d6C5S1-d6C 234 C1S5+C1a3C 23 +C1a2C2+d4S1+d5S 234 C1+d2S1+d3S1 p y =S1a3C 23 +S1a2C2-d4C1-d2C1-d3C1-d6C5C1-d6C 234 S1S5+d5S 234 S1 p z =d1+a3S 234 +a2S2-d5C 234 -d4S 234 S5 Wherein, C represents the abbreviation of cos function in the rotation matrix, S represents the abbreviation of sin function in the rotation matrix, S1, S2, S3, S4, S5, S6 represent the sine values ​​of the angles of the first joint, the second joint, the third joint, the fourth joint, the fifth joint, and the sixth joint respectively; d1, d2, d3, d4, d5, d6 represent the offsets of the first joint, the second joint, the third joint, the fourth joint, the fifth joint, and the sixth joint respectively; C1, C2, C3, C4, C5, C6 represent the cosine values ​​of the angles of the first joint, the second joint, the third joint, the fourth joint, the fifth joint, and the sixth joint respectively; C 23 represents the product of the cosine values ​​of the second and third joint angles, C 234 represents the product of the cosine values ​​of the second, third, and fourth joint angles; S 234 It represents the product of the sine of the second joint angle and the sine of the third and fourth joint angles; a1, a2, and a3 represent the lengths of the first joint, the second joint, and the third joint, respectively.

6. The method for path planning of a contact network arm maintenance robot based on space intelligent division according to claim 2, characterized in that: Based on the robot kinematic model, the robot arm workspace simulation analysis is performed to evaluate whether the robot arm can cover the contact network bolts at different positions, and to analyze the accessibility of the end of the robot arm in the workspace when the robot arm base is fixed, including: Setting the parameters of the Monte Carlo simulation; wherein the parameters of the Monte Carlo simulation include the range of joint angles; Randomly output a set of N joint angles within the set joint angle range. The calculation formula is as follows: θ=θ min +(θ max -θ min )RAND(N,1) (4) In the formula, θ represents max Indicates the maximum value of the set joint angle range, θ min Indicates the minimum value of the set joint angle range, RAND indicates the number of output joint angles; Determine the x, y, and z coordinates of the position of the end of the robotic arm according to the forward kinematics formula of the robotic arm; Outputting the x, y, and z coordinates of the position of the end of the robotic arm as a set of coordinate points in a three-dimensional space to obtain a scatter plot representing the workspace of the robotic arm; Based on the scatter plot, it is evaluated whether the robotic arm can cover the contact network bolts at different positions, and the accessibility of the end of the robotic arm in the working space is analyzed when the robotic arm base is fixed.

7. The method for path planning of a contact network arm maintenance robot based on space intelligent division according to claim 6, characterized in that: Based on the simulation analysis of the working space under the condition of fixed manipulator base, the working space area of ​​the contact network bolt operation point is divided according to the distribution of bolt points in the contact network environment, including: The center of the bottom surface of the contact network column is taken as the coordinate origin, the axial direction of the column is defined as the z-axis, the direction perpendicular to the paper and outward is set as the x-axis, and the direction parallel to the contact network flat arm is set as the y-axis. A coordinate system is established, and the specific coordinate value corresponding to each bolt number is obtained by measuring the coordinates of each bolt in the coordinate system of the contact network column base, and the coordinate values ​​corresponding to different bolt numbers are obtained.

8. The method for path planning of a contact network arm maintenance robot based on space intelligent division according to claim 6, characterized in that: Divide the workspace to minimize the movement of the robot base, including: Determine whether the plug is located in the upper half of the sphere and outside the inaccessible cylindrical area according to the judgment basis; wherein the judgment basis is expressed as: In the formula, x i ,y i ,z i represents the x-coordinate, y-coordinate, and z-coordinate of the ith bolt, x cir ,y cir ,z cir are the x-coordinate, y-coordinate and z-coordinate of the center of the workspace; R cir is the radius of the workspace, R cy is the radius of the cylinder of the inaccessible area in the workspace; x cir ,y cir ,z cir The calculation formula is: In the formula, x bias ,y bias , z bias The x-, y- and z-coordinates of the bolt relative to the center of the workspace sphere; If the bolt meets the judgment criteria, the bolt is classified into a corresponding workspace area; if the bolt does not meet the judgment criteria, a new spherical area is set according to the position of the bolt.

9. The method for path planning of a contact network arm maintenance robot based on space intelligent division according to claim 6, characterized in that: The working environment of the contact network and the manipulator is modeled offline, and the maintenance tasks of the contact network arm are realized through path planning using the divided workspace, including: Set starting point init As the initial point, as the root node of the random tree T; In each loop, a random sampling point q is generated ran d ; Sampling: traverse each node in the random tree T and calculate the correlation between each node and the random sampling point q rand Euclidean distance, find the node q that is closest to nearest ; From the nearest node q nearest To randomly sample point q rand Move forward a step δ in the direction to generate a new node q new . Detection from the nearest node q nearest To the new node q new Whether the path intersects with the obstacle, if there is a collision, the new node q is discarded new , re-enter the sampling process; otherwise, determine that the path is feasible and add the new node q new Add to the random tree T. Calculate the new node q new To the target point q goal If the distance is less than the set threshold, it is determined that the target point has been reached and the search ends.

Citation Information

Patent Citations

  • Seven-freedom-degree mechanical arm control method and system based on analytical solution

    CN109397292A

  • Mechanical arm kinematics parameter calibration method based on measuring of laser tracker

    CN110281241A

  • Robotic system with route planning stable mechanism

    CN113766998A

  • Spraying path planning method and system for industrial robot and rotary table

    CN115716269A

  • Catenary equipment inspection robot

    CN116352689A

Cited By

  • Overhead line system bolt fastening path planning method, system and equipment and storage medium

    CN120002650A

  • Automatic fastening system and method for overhead line system cantilever bolt

    CN120244542A

  • Robot mechanical arm motion space simulation method and system and photovoltaic robot

    CN121061857A