Method for determining positioning accuracy of tail end of erector for automatically assembling duct pieces
By selecting several points on the assembly machine and a laser tracker to obtain coordinates, calculating the coordinate conversion relationship and kinematics positive solutions, and using positioning balls to determine the comprehensive positioning accuracy, the problem of difficulty in determining the end positioning accuracy under the automatic control conditions of the assembly machine is solved, and the accuracy is achieved Precise positioning at ±1.0mm.
Patent Information
- Application Number
- CN202411040199.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-31
- Publication Date
- 2024-11-19
AI Technical Summary
In the prior art, it is difficult to determine the end positioning accuracy of the assembly machine under automatic control conditions, and there is a lack of direct, effective and accurate measurement methods.
By selecting several points that are not coplanar on the assembly machine structure, obtaining the three-dimensional coordinates of the global and local coordinate system of the laser tracker, and calculating the vector length deviation. If it is within the range of 0.5mm, calculate and move the coordinate conversion relationship. Learn the correct solution, use the positioning ball as the accuracy measurement point, compare the coordinates obtained by the laser tracker with the coordinates calculated by the kinematic positive solution, and determine the comprehensive positioning accuracy.
The accuracy judgment of the end of the assembly machine under automatic control conditions is realized, ensuring that the positioning accuracy is within ±1.0mm, and solving the problem of difficulty in determining the end positioning accuracy in the prior art.
Smart Images

Figure CN118980310A_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the technical field of shield tunnel construction, and in particular to a method for determining the positioning accuracy of a terminal end of an assembling machine used for automatic assembly of pipe segments. Background Art
[0002] When shield segments are automatically assembled, the determination of the positioning control accuracy of the assembly machine end is a systematic problem, involving mechanical structure design, mechanical manufacturing accuracy, structural overload deformation, electrical control methods, kinematic algorithm accuracy, target posture recognition, etc. Due to the extremely high technical difficulty of automatic assembly of shield segments, there has been no substantial engineering application results so far, but the more unified technical path is: after modeling based on the motion mechanism of the assembly machine, a kinematic forward and inverse solution algorithm is developed, and the spatial positioning of the assembly machine end is achieved by combining the results of the kinematic forward and inverse solution algorithm with electrical control, but the spatial positioning accuracy is poor.
[0003] Up to now, there is no direct, effective and accurate method for determining the terminal positioning accuracy of the assembly machine, which leads to the problem that it is difficult to determine the terminal positioning accuracy of the assembly machine under automatic control conditions. Therefore, it is necessary to provide a method for determining the terminal positioning accuracy of the assembly machine for automatic assembly of pipe segments, which can solve the problem of difficulty in determining the terminal positioning accuracy of the assembly machine under automatic control conditions in the prior art. Summary of the invention
[0004] The purpose of the present invention is to provide a method for determining the terminal positioning accuracy of an assembly machine for automatic assembly of pipe segments, which can solve the problem in the prior art that it is difficult to determine the terminal positioning accuracy of an assembly machine under automatic control conditions.
[0005] The present invention is achieved in that:
[0006] A method for determining the positioning accuracy of an assembly machine end for automatic segment assembly comprises the following steps:
[0007] Step 1: Select a number of non-coplanar points on the assembly machine structure, and obtain the three-dimensional coordinates of the points in the global coordinate system of the assembly machine;
[0008] Step 2: Obtain the three-dimensional coordinates of the corresponding points of the plurality of points in the local coordinate system of the laser tracker by using the laser tracker;
[0009] Step 3: Calculate the vector between one of the several points and the remaining points, and calculate the vector between one of the several corresponding points and the remaining points to form two sets of corresponding vectors;
[0010] Step 4: Calculate the length deviation of the two sets of vectors. If the length deviation meets the deviation range, execute step 5. If the length deviation does not meet the deviation range, return to step 1.
[0011] Step 5: Calculate the coordinate transformation relationship between the global coordinate system of the assembly machine and the local coordinate system of the laser tracker;
[0012] Step 6: Install a positioning ball at the end of the assembly machine, and obtain the three-dimensional coordinates of the positioning ball in the local coordinate system of the laser tracker through the laser tracker;
[0013] Step 7: Convert the three-dimensional coordinates in step 6 into the three-dimensional coordinates of the positioning ball in the global coordinate system of the assembly machine through the coordinate conversion relationship in step 5, and record them as the first global three-dimensional coordinates;
[0014] Step 8: Use the kinematics forward solution to calculate the three-dimensional coordinates of the positioning ball in the global coordinate system of the assembly machine, recorded as the second global three-dimensional coordinates;
[0015] Step 9: Compare the first global three-dimensional coordinate calculated in step 7 with the second global three-dimensional coordinate calculated in step 8, and determine the comprehensive positioning accuracy of the assembly machine terminal under automatic control conditions based on the comparison result.
[0016] In the step 4, the deviation range is 0.5 mm.
[0017] In step 5, when the several points are A, B, C, and D, their corresponding points are A', B', C', and D'. The several points of the global coordinate system of the assembly machine and the several corresponding points of the local coordinate system of the laser tracker conform to the coordinate transformation relationship, that is, the coordinate transformation relationship between point A and the corresponding point A' is:
[0018] A=R0×A¢+S0 (1)
[0019] Among them, R0 is the Euler transformation matrix; S0 is the translation transformation vector;
[0020] According to formula (1), the six vectors The following relationship is satisfied:
[0021]
[0022] Among them, the Euler transformation matrix R0 can be expressed as:
[0023]
[0024] Among them, α, β and γ are set as the three rotation angles corresponding to the X-axis, Y-axis and Z-axis in the global coordinate system of the assembly machine, respectively, and are calculated by enumeration method;
[0025] Set the variable to increase by 1° each time. After reaching the minimum residual, increase the variable's increment accuracy for calculation until the accuracy requirement is met.
[0026] The residual loss is defined as follows:
[0027]
[0028] Get the Euler transformation matrix R0, and substitute the Euler transformation matrix R0 back into equation (1) to solve the translation transformation vector S0.
[0029] The range of the residual loss is [0,2].
[0030] In step 8, the transformation matrix between the second global three-dimensional coordinates of the positioning ball and the global coordinate system of the assembly machine is:
[0031] T'=TT0 (5)
[0032] Among them, T is the transformation relationship matrix between the global coordinate system of the assembly machine and the coordinate system of the end of the assembly machine, T0 is the transformation matrix, and T0 is expressed as:
[0033]
[0034] Among them, p, q, and r are the translation values of the origin of the assembly machine terminal coordinate system along its X-axis, Y-axis, and Z-axis to the position of the positioning ball.
[0035] In step 9, the range of comprehensive positioning accuracy is ±1.0 mm.
[0036] Compared with the prior art, the present invention has the following beneficial effects:
[0037] The present invention performs a coordinate conversion test on the global coordinate system of the assembling machine and the local coordinate system of the laser tracker to ensure that the data obtained from the two coordinate systems are valid, and then installs a positioning ball at the end of the assembling machine as a precision measuring point, converts the coordinates of the precision measuring point tracked by the laser tracker to the global coordinate system of the assembling machine, and compares them with the kinematic positive solution in the global coordinate system of the assembling machine to determine the comprehensive positioning accuracy of the precision measuring point, which is used to determine the positioning accuracy of the end of the assembling machine under automatic control conditions, thereby solving the problem in the prior art that it is difficult to determine the positioning accuracy of the end of the assembling machine under automatic control conditions. BRIEF DESCRIPTION OF THE DRAWINGS
[0038] Figure 1 It is a flow chart of a method for determining positioning accuracy of an assembly machine end for automatic assembly of pipe segments according to the present invention. DETAILED DESCRIPTION
[0039] The present invention will be further described below in conjunction with the accompanying drawings and specific embodiments.
[0040] Please see attached Figure 1 A method for determining the positioning accuracy of an assembly machine end for automatic segment assembly comprises the following steps:
[0041] Step 1: Select a number of non-coplanar points (for example, four points A, B, C, and D) on the assembly machine structure, and obtain the three-dimensional coordinates of the points in the global coordinate system of the assembly machine.
[0042] Preferably, the number of points selected on the assembly machine structure is at least 4, so that at least 3 vectors can be generated through at least 4 points.
[0043] The global coordinate system of the assembler is usually the coordinate system of the front end of the assembler structure.
[0044] Step 2: Obtain the three-dimensional coordinates of the corresponding points (the four points A, B, C, and D correspond to A', B', C', and D' respectively) corresponding to the points in the local coordinate system of the laser tracker through the laser tracker.
[0045] Step 3: Calculate the vector between one of the points and the rest of the points Calculate the vector between one of several corresponding points and the rest of the points Form two sets of corresponding vectors.
[0046] One of the points (such as point A) should correspond to one of the corresponding points (such as corresponding point A') to ensure a one-to-one correspondence between the two sets of vectors, that is, and and and
[0047] Step 4: Calculate two sets of vectors (three pairs of vectors and and and ), if the length deviation meets the deviation range, execute step 5; if the length deviation does not meet the deviation range, return to step 1.
[0048] Through steps 1 to 4, coordinate conversion test is performed on the global coordinate system of the assembly machine and the local coordinate system of the laser tracker. The deviation range can be set in advance. Preferably, the deviation range can be set to 0.5mm. It is judged whether the length deviation of each pair of vectors in the two groups of vectors meets the requirements of the deviation range. If so, it proves that the data acquisition of the global coordinate system of the assembly machine and the local coordinate system of the laser tracker is valid. The coordinate conversion test is passed and step 5 can be continued. Otherwise, return to step 1.
[0049] Step 5: Calculate the coordinate transformation relationship between the global coordinate system of the assembly machine and the local coordinate system of the laser tracker.
[0050] Since the scale of the global coordinate system of the assembly machine and the local coordinate system of the laser tracker are the same and both are right-handed rectangular coordinate systems in space, there is a coordinate transformation relationship between the two corresponding points.
[0051] Taking point A and corresponding point A' as an example, the coordinate transformation relationship is A=R0×A¢+S0(1)
[0052] Among them, R0 is the Euler transformation matrix; S0 is the translation transformation vector.
[0053] The coordinate transformation relationship between point B and point B', point C and point C', point D and point D' is consistent with the coordinate transformation relationship between point A and point A', and will not be described in detail here.
[0054] According to formula (1), the six vectors satisfy the following relationship:
[0055]
[0056] Among them, the Euler transformation matrix R0 can be expressed as:
[0057]
[0058] Among them, α, β and γ are respectively set as the three rotation angles corresponding to the X-axis, Y-axis and Z-axis in the global coordinate system of the assembly machine, which can be calculated by enumeration method. The enumeration method is a conventional calculation method in this field, and its calculation process will not be repeated here.
[0059] Set the variable to increase by 1° each time. After reaching the minimum residual, increase the variable's incremental accuracy for calculation until the accuracy requirement is met. The residual (loss) is defined as follows:
[0060]
[0061] Preferably, the range of the residual loss can be set to [0, 2], and the residual range can also be adaptively adjusted according to actual needs.
[0062] Get the Euler transformation matrix R0, and substitute the Euler transformation matrix R0 back into equation (1) to solve the translation transformation vector S0.
[0063] Step 6: Install a positioning ball at the end of the assembly machine, and use a laser tracker to obtain the three-dimensional coordinates of the positioning ball in the local coordinate system of the laser tracker.
[0064] Use the positioning ball as the precision measuring point at the end of the assembly machine.
[0065] The installation position of the positioning ball can be selected at any position of the end of the assembly machine according to actual needs, such as a corner at the end of the assembly machine gripper, etc., which is used to represent the positioning of the end of the assembly machine.
[0066] Step 7: Convert the three-dimensional coordinates obtained in step 6 into the three-dimensional coordinates of the positioning ball in the global coordinate system of the assembly machine through the coordinate conversion relationship in step 5, and record them as the first global three-dimensional coordinates.
[0067] Step 8: Use the kinematic solution to calculate the three-dimensional coordinates of the positioning ball in the global coordinate system of the assembly machine, recorded as the second global three-dimensional coordinates.
[0068] Since the global coordinate system of the assembling machine is the coordinate system of the front end of the assembling machine, the transformation relationship matrix between it and the coordinate system of the end of the assembling machine is T. The transformation relationship matrix T can be calculated by a precise motion control method for an assembling machine and a precise motion control method for an assembling machine in a control system disclosed in Chinese invention patent application CN117189188A; thereby, the three-dimensional coordinates of the positioning ball in the coordinate system of the rear end of the assembling machine can be used to calculate the second global three-dimensional coordinates through the transformation matrix T'.
[0069] The transformation matrix between the second global three-dimensional coordinates of the positioning ball and the global coordinate system of the assembly machine is:
[0070] T'=TT0 (5)
[0071] Among them, T0 is the transformation matrix between the positioning ball and the coordinate system of the assembly machine end, and T0 is expressed as:
[0072]
[0073] Since the positioning ball is usually not installed at the origin of the coordinate system at the end of the assembly machine, it is necessary to add consideration of the transformation matrix T0 on the basis of the transformation relationship matrix T, where p, q, and r are the translation values of the origin of the coordinate system at the end of the assembly machine along its X-axis, Y-axis, and Z-axis to the position of the positioning ball.
[0074] Step 9: Compare the first global three-dimensional coordinate calculated in step 7 with the second global three-dimensional coordinate calculated in step 8, and determine the comprehensive positioning accuracy of the assembly machine terminal under automatic control conditions based on the comparison result.
[0075] Embodiment 1:
[0076] Step 1: Select four non-coplanar points A, B, C, and D on the assembly machine structure, and obtain the three-dimensional coordinates of the four points A, B, C, and D in the global coordinate system of the assembly machine.
[0077] In the global coordinate system of the assembly machine, the coordinates of the four points are: A (-336.817, -1584.599, 4436.965), B (336.817, -1584.599, 4436.965), C (-443.765, -1975.044, 3540.577), D (443.183, -1977.317, 3542.184).
[0078] Step 2: Obtain the three-dimensional coordinates of the four corresponding points A', B', C', and D' corresponding to the four points A, B, C, and D in the local coordinate system of the laser tracker through a laser tracker.
[0079] The coordinates of the four corresponding points in the local coordinate system of the laser tracker are: A'(-4500.479, 14909.169, 1730.294), B'(-3838.671, 14862.053, 1844.212), C'(-4475.778, 15806.824, 1328.353), and D'(-3603.907, 15742.597, 1476.750).
[0080] Step 3: Calculate the vector
[0081] (vector length: 673.634);
[0082] (vector length: 983.563);
[0083] (vector length: 1250.304).
[0084] (vector length: 673.197);
[0085] (vector length: 983.845);
[0086] (vector length: 1250.091).
[0087] Step 4: Calculate three pairs of vectors and and and Length deviation.
[0088] Calculation shows that the length deviations of the three pairs of vectors are all within the range of 0.5 mm, meeting the requirements of the preset deviation range, proving that the data acquisition and coordinate transformation relationship between the global coordinate system of the assembly machine and the local coordinate system of the laser tracker are effective.
[0089] The joint motion amounts of the assembler in the coordinate transformation tests from step 1 to step 4 are set as shown in Table 1.
[0090] Table 1 Setting of movement amount of each joint
[0091]
[0092] Step 5: Calculate the coordinate transformation relationship between the global coordinate system of the assembly machine and the local coordinate system of the laser tracker.
[0093] Taking point A and corresponding point A' as an example, the coordinate transformation relationship is A=R0×A¢+S0(1)
[0094] Among them, R0 is the Euler transformation matrix; S0 is the translation transformation vector.
[0095] According to formula (4), when the calculation reaches a = 1.5721 rad, β = 6.1128 rad, g = 6.2119 rad, the residual loss = 1.045, and the calculation result meets the setting requirement of [0, 2], and the calculation stops.
[0096] Substituting the three rotation angles α, β and γ into equation (3), we can calculate:
[0097]
[0098] Substituting the Euler transformation matrix R0 into equation (1), we can obtain:
[0099]
[0100] Step 6: Install a positioning ball at the far end corner of the assembly machine gripper, i.e., the end of the assembly machine, and obtain the three-dimensional coordinates of the positioning ball in the local coordinate system of the laser tracker through the laser tracker.
[0101] Three common working conditions of the assembly machine are given, as shown in Table 2.
[0102] Table 2 Three working conditions of assembly machine
[0103]
[0104] Under the three working conditions in Table 2, the three-dimensional coordinates of the positioning ball in the local coordinate system of the laser tracker are captured by the laser tracker, and the three-dimensional coordinate values of the positioning ball in the local coordinate system of the laser tracker under the three working conditions are shown in the third column of Table 3. It should be noted that since the laser tracker is located at the far end of the assembly machine, in order to avoid the positioning ball being blocked, the slewing ring of the assembly machine can only make a small rotation.
[0105] Step 7: Convert the three-dimensional coordinates obtained in step 6 into the three-dimensional coordinates of the positioning ball in the global coordinate system of the assembly machine through the coordinate transformation relationship in step 5, recorded as the first global three-dimensional coordinates, as shown in the fourth column of Table 3.
[0106] Step 8: Use the kinematic solution to calculate the three-dimensional coordinates of the positioning ball in the global coordinate system of the assembly machine, recorded as the second global three-dimensional coordinates.
[0107] The second global three-dimensional coordinates of the positioning ball under the three working conditions are calculated by the transformation matrix T', as shown in the fifth column of Table 3.
[0108] Step 9: Compare the first global three-dimensional coordinate calculated in step 7 with the second global three-dimensional coordinate calculated in step 8, and determine the comprehensive positioning accuracy of the far end corner of the assembly machine gripper, i.e., the end of the assembly machine, based on the comparison result.
[0109] The three-dimensional coordinates of the positioning ball in the global coordinate system of the assembler under the three working conditions are compared with the kinematic positive solution in the known technology (as shown in the fifth column of Table 3), and the three-dimensional coordinate value in the global coordinate system of the assembler is subtracted from the kinematic positive solution in the global coordinate system of the assembler, and the single-axis deviations corresponding to the coordinates X, Y, and Z are calculated respectively, and the comprehensive positioning accuracy is calculated according to the single-axis deviations corresponding to the coordinates X, Y, and Z. The calculation formula is: The comparison results are shown in column 7 of Table 3.
[0110] Preferably, the comprehensive positioning accuracy can be set to ±1.0 mm.
[0111] Table 3 Comparison results under three working conditions
[0112]
[0113]
[0114] It can be seen from Table 3 that the comprehensive positioning accuracy of the far end corner of the assembly machine gripper can be controlled within ±1.0mm, that is, the comprehensive positioning accuracy of the assembly machine end under the three working conditions is within ±1.0mm, indicating that the positioning accuracy of the assembly machine end under automatic control conditions is good, so the comprehensive positioning accuracy can be used to determine the positioning accuracy of the assembly machine end under automatic control conditions.
[0115] The above are only preferred embodiments of the present invention and are not intended to limit the scope of protection of the invention. Therefore, any modifications, equivalent substitutions, improvements, etc. made within the spirit and principles of the present invention should be included in the scope of protection of the present invention.
Claims
1. A method for determining the positioning accuracy of the end of an assembly machine for automatic segment assembly, characterized by: The following steps are involved: Step 1: Select a number of non-coplanar points on the assembly machine structure, and obtain the three-dimensional coordinates of the points in the global coordinate system of the assembly machine; Step 2: Obtain the three-dimensional coordinates of the corresponding points of the plurality of points in the local coordinate system of the laser tracker by using the laser tracker; Step 3: Calculate the vector between one of the several points and the remaining points, and calculate the vector between one of the several corresponding points and the remaining points to form two sets of corresponding vectors; Step 4: Calculate the length deviation of the two sets of vectors. If the length deviation meets the deviation range, execute step 5. If the length deviation does not meet the deviation range, return to step 1. Step 5: Calculate the coordinate transformation relationship between the global coordinate system of the assembly machine and the local coordinate system of the laser tracker; Step 6: Install a positioning ball at the end of the assembly machine, and obtain the three-dimensional coordinates of the positioning ball in the local coordinate system of the laser tracker through the laser tracker; Step 7: Convert the three-dimensional coordinates in step 6 into the three-dimensional coordinates of the positioning ball in the global coordinate system of the assembly machine through the coordinate conversion relationship in step 5, and record them as the first global three-dimensional coordinates; Step 8: Use the kinematics forward solution to calculate the three-dimensional coordinates of the positioning ball in the global coordinate system of the assembly machine, recorded as the second global three-dimensional coordinates; Step 9: Compare the first global three-dimensional coordinate calculated in step 7 with the second global three-dimensional coordinate calculated in step 8, and determine the comprehensive positioning accuracy of the assembly machine terminal under automatic control conditions based on the comparison result.
2. The method for determining the positioning accuracy of the end of an assembly machine for automatic segment assembly according to claim 1 is characterized by: In step 4, the deviation range is 0.5 mm.
3. The method for determining the positioning accuracy of the end of an assembly machine for automatic segment assembly according to claim 1 is characterized by: In step 5, when the several points are A, B, C, and D, their corresponding points are A', B', C', and D'. The several points of the global coordinate system of the assembly machine and the several corresponding points of the local coordinate system of the laser tracker conform to the coordinate transformation relationship, that is, the coordinate transformation relationship between point A and the corresponding point A' is: A=R0×A¢+S0 (1) Among them, R0 is the Euler transformation matrix; S0 is the translation transformation vector; According to formula (1), the six vectors The following relationship is satisfied: Among them, the Euler transformation matrix R0 can be expressed as: Among them, α, β and γ are set as the three rotation angles corresponding to the X-axis, Y-axis and Z-axis in the global coordinate system of the assembly machine, respectively, and are calculated by enumeration method; Set the variable to increase by 1° each time. After reaching the minimum residual, increase the variable's increment accuracy for calculation until the accuracy requirement is met. The residual loss is defined as follows: Get the Euler transformation matrix R0, and substitute the Euler transformation matrix R0 back into equation (1) to solve the translation transformation vector S0.
4. The method for determining the positioning accuracy of the end of an assembly machine for automatic segment assembly according to claim 3 is characterized by: The range of the residual loss is [0,2].
5. The method for determining the positioning accuracy of the end of an assembly machine for automatic segment assembly according to claim 1 is characterized by: In step 8, the transformation matrix between the second global three-dimensional coordinates of the positioning ball and the global coordinate system of the assembly machine is: T'=TT0 (5) Among them, T is the transformation relationship matrix between the global coordinate system of the assembly machine and the coordinate system of the end of the assembly machine, T0 is the transformation matrix, and T0 is expressed as: Among them, p, q, and r are the translation values of the origin of the assembly machine terminal coordinate system along its X-axis, Y-axis, and Z-axis to the position of the positioning ball.
6. The method for determining the positioning accuracy of the end of an assembly machine for automatic segment assembly according to claim 1 is characterized by: In step 9, the range of comprehensive positioning accuracy is ±1.0 mm.
