Device and method for measuring arc track guide precision of robot vision system

By designing a measuring device for a two-degree of freedom motion platform and calibration flange, the robot vision system is accurately measured and adjusted by using a laser tracker, which solves the problem of lack of arc track guidance accuracy detection in the existing technology, and achieves high accuracy The visual system guides the improvement of processing quality.

CN118927307AActive Publication Date: 2024-11-12INST OF MACHINERY MFG TECH CHINA ACAD OF ENG PHYSICS

Patent Information

Application Number
CN202411055389.X
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-02
Publication Date
2024-11-12
Estimated Expiration
2044-08-02

AI Technical Summary

Technical Problem

The prior art lacks detection standards and methods to measure the guidance accuracy of a robot vision system when performing spatial arc trajectory movement, which affects the processing quality.

Method used

A measuring device including a two-degree of freedom motion platform and calibration flange was designed. The laser tracker was used to measure and adjust the center point of the target ball and the robot tool, and the arc trajectory guidance of the robot vision system was obtained through fitting and compensation. Accuracy.

Benefits of technology

The precise measurement of the spatial arc trajectory guidance accuracy of the robot vision system is realized, ensuring high-precision trajectory guidance of the vision system in tasks such as welding, glue coating, and spraying, and improving the processing quality of the final product.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118927307A_ABST
    Figure CN118927307A_ABST
Patent Text Reader

Abstract

The invention discloses a device and a method for measuring the arc track guiding precision of a robot vision system, and relates to the technical field of robot guiding, and the robot vision system recognizes a circumferential generatrix of an end face circle of a second cylinder of a calibration flange, and generates a point cloud based on the circumferential generatrix of the end face circle of the second cylinder; the visual system guides the center point of the robot tool to move along the circumferential generatrix track of the second cylindrical end face circle, the laser tracker measures the actual movement track guided by the visual system in a dynamic measurement mode, and the laser tracking measurement system has circumferential generatrix theoretical track point positions based on the second cylindrical end face circle at the same time. And the actual motion track point position after the guidance of the visual system is provided, so that the guidance precision of the space arc track of the visual system of the robot can be accurately measured and calculated.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of robot guidance technology, and in particular to a device and method for measuring the circular arc trajectory guidance accuracy of a robot vision system. Background Art

[0002] Robots are essential basic production equipment in the fields of aviation, aerospace, national defense, and mechanical manufacturing. With the development towards Industry 4.0, the integration and application of robot systems are moving towards intelligence. The intelligence of robot systems is often reflected in the integration of high-precision vision systems at the end of the robot. After the robot integrates the vision system, the vision system usually establishes a corresponding posture matrix relationship with the robot base coordinate system and the tool coordinate system. The calibration of the robot vision system and the tool coordinate system (commonly known as "hand-eye" calibration) is an important step for the robot to rely on the vision system to guide the end tool to complete the task.

[0003] When the robot performs circular trajectory motion, in most cases the end of the robot tool will continuously change its posture around the center point of the tool during the entire operation process, so the accuracy of the robot's "hand-eye" calibration determines whether the vision system can accurately complete the robot's spatial arc trajectory guidance. In actual production, the robot's vision system welding trajectory guidance, vision system gluing trajectory guidance, vision system spraying trajectory guidance, vision system cutting trajectory guidance, etc., the accuracy of the vision system trajectory guidance is a key factor affecting the quality of the final product processing.

[0004] Currently, there are no relevant testing standards and methods for the spatial arc trajectory guidance accuracy of the robot vision system; Summary of the invention

[0005] The present invention aims to solve the deficiencies of the prior art and to provide a device and method for measuring the circular arc trajectory guidance accuracy of a robot vision system, so as to accurately measure and calculate the guidance accuracy of the spatial circular arc trajectory of the robot vision system.

[0006] The present invention is achieved through the following technical solutions:

[0007] A device for measuring the circular arc trajectory guidance accuracy of a robot vision system, comprising:

[0008] A two-degree-of-freedom motion platform device, the two-degree-of-freedom motion platform device comprising a first linear motion servo axis arranged vertically and a second linear motion servo axis arranged horizontally;

[0009] A workbench is connected to the second linear motion servo shaft, and the workbench can slide along the length direction of the second linear motion servo shaft; a calibration flange is fixed to the workbench;

[0010] The calibration flange comprises a first cylinder and a second cylinder which are coaxially connected. The diameter of the first cylinder is greater than the diameter of the second cylinder, and the thickness of the second cylinder is equal to the radius of the target sphere.

[0011] Further solutions:

[0012] The present invention also provides a method for measuring the circular arc trajectory guidance accuracy of a robot vision system, comprising the following steps:

[0013] S0: The calibration flange is fixedly mounted on the workbench of the two-degree-of-freedom motion platform device, and the target ball moves M positions on the end surface of the second cylinder of the calibration flange at a uniform interval, M>6, and the laser tracker measures the M points in sequence, and the end plane of the second cylinder of the calibration flange is fitted based on the M measurement points;

[0014] S1: Move the workbench to a fixed position A, evenly set at least three measuring points in the radial and circumferential directions of the second cylinder, and move the target ball to several measuring points respectively, measure the coordinate value of the target ball at each point by a laser tracker, fit a circle based on the several measuring points, and project the measured and fitted circle onto the end plane of the second cylinder;

[0015] S2: Compensate a number of measuring points along the radial direction of the end face circle of the second cylinder so that the measuring points are all on the circumference of the end plane of the second cylinder;

[0016] S3: adsorb the target ball onto the target seat at the end of the robot, and calibrate the tool center point of the robot to the center of the target ball;

[0017] S4: Move the workbench to the fixed position B. In the dynamic measurement mode of the laser tracker, adjust the center point of the robot end tool to accurately coincide with the several measurement points compensated in step S2. Operate the robot to teach and record the points P1..PN that coincide with the several measurement points. N is greater than or equal to 3.

[0018] S5: Based on the points P1..PN taught by the robot, arc trajectory instructions are used to compile and generate corresponding arc trajectory operation programs;

[0019] S6: Run the robot arc trajectory program, measure the robot's motion trajectory dynamically and in real time through a laser tracker, and obtain a number of sampling points of the robot's arc trajectory starting from point P1 and passing through points P2, ..PN respectively. The sampling points are used as theoretical values ​​of the arc trajectory guidance of the robot vision system;

[0020] S7: Control the workbench to move to the fixed position A, and the robot vision system identifies and scans the circumferential generatrix of the second cylindrical end face circle to generate a vision system point cloud based on the circumferential generatrix of the second cylindrical end face circle; then the vision system guides the center point of the robot tool to move along the trajectory of the second cylindrical circumferential generatrix, and the laser tracker dynamically measures the actual motion trajectory of the robot after the vision system is guided in real time to obtain the actual value of the arc trajectory guided by the robot vision system;

[0021] S8: According to the theoretical value before the robot vision system trajectory guidance and the actual value after the robot vision system trajectory guidance, the trajectory accuracy of the robot vision system after the spatial arc trajectory guidance is obtained.

[0022] In this solution, the robot running speed value in step S6 is consistent with that in step S7, and the sampling frequency value of the laser tracking dynamic measurement in step S6 is consistent with that in step S7.

[0023] Furthermore, the step S1 further includes the following specific steps:

[0024] In the radial circumferential direction of the second cylinder, measurement point 1, measurement point 2 and measurement point 3 are evenly set, and the target ball is moved to measurement point 1, measurement point 2 and measurement point 3 respectively. The coordinate value of the target ball at each point is measured by a laser tracker, and a circle is fitted based on measurement point 1, measurement point 2 and measurement point 3, and the measured fitted circle is projected onto the end plane of the second cylinder.

[0025] Furthermore, the step S3 includes the following specific steps:

[0026] S31: Move the robot to a suitable position, adsorb the target ball to the target seat at the end of the robot, teach and record the robot posture P0; the robot moves around the flange coordinate system X F , Y F , Z F The laser tracker collects the spatial coordinate points of the target ball at each posture of the robot and converts the X coordinates of the flange coordinate system into F , Y F , Z F All spatial points of the axis rotation measurement are fitted to obtain a spatial sphere, and the circles and their planes rotating around Rx, Ry, and Rz are fitted, and the normal vectors of the circles and their planes rotating around Rx, Ry, and Rz are constructed. Find the angle between any two normal vectors;

[0027] S32: The robot returns to P0 position. The two normal vectors closest to 90° between the three vectors are used as reference axes, and the coordinate system {F} is established using the right-hand rule with the center of the sphere as the origin; at this time, the coordinate system {F} based on laser tracking coincides with the robot flange coordinate system;

[0028] S33: Measure the coordinate value of the target ball at the end of the robot in the laser tracking coordinate system {F}. This value is the offset value of the center of the target ball relative to the origin of the robot flange coordinate system. Import the coordinate value of the target ball into the robot controller. At this time, the tool center point of the robot is the center of the target ball.

[0029] Furthermore, in step S31, when solving the angle between any two normal vectors, if θ XY ,θ YZ ,θ XZ If any one of the angles is within the range of 90°±0.03°, stop step S31; if all three angles are not within the range of 90°±0.03°, repeat step S31.

[0030] Furthermore, the angle between normal vectors is calculated as:

[0031]

[0032] Furthermore, in step S6, N is equal to 3, and the specific steps of dynamically measuring the motion trajectory of the robot in real time by a laser tracker to obtain several sampling points of the circular arc trajectory of the robot starting from point P1 and passing through points P2 and P3 are as follows:

[0033] The laser tracker is set to a fixed sampling frequency of Q Hz in the dynamic measurement mode, and the tool center of the robot is moved to point P1. The robot automatically runs the arc trajectory path program of the entire 360° circle starting from point P1 and passing through points P2 and P3 at a fixed speed S m / s. The laser tracker dynamically measures the motion trajectory of the robot in real time at a fixed sampling frequency of Q Hz, and collects several sampling points C of the arc trajectory of the entire 360° circle starting from point P1 and passing through points P2 and P3. i (Xc i , Yc i , Zc i ), where i = 1, 2, 3, 4…m, C i (Xc i , Yc i , Zc i ) is the theoretical value of the circular trajectory guidance of the robot vision system.

[0034] Furthermore, in step S7, the visual system guides the center point of the robot tool to move along the second cylindrical circumference generatrix trajectory, and the specific steps of dynamically and real-time measuring the actual motion trajectory of the robot after the visual system is guided by the laser tracker are:

[0035] The trajectory running speed S m / s is set in the robot control program. The robot vision system guides the center point of the robot tool to run along the entire circumferential generatrix of the second cylindrical end face circle at a fixed speed S m / s. The laser tracker dynamically measures the motion trajectory of the robot after vision guidance at a fixed sampling frequency of Q Hz, and collects several sampling points K of the motion trajectory after the robot vision system guides. i (X i , Y i , Z i ), where i = 1, 2, 3, 4…m, K i (X i , Y i , Z i ) is the actual value after the circular trajectory guidance of the robot vision system.

[0036] Furthermore, after collecting several sampling points K of the space arc trajectory guided by the robot vision system for the first time i (X i , Y i , Z i ), further comprising the following steps:

[0037] Repeat step S7 for n times (n≥10) in total. Through n times of recognition and scanning by the robot vision system, the vision system guides the target ball at the end of the robot to run along the trajectory of the entire circumference generatrix of the second cylindrical end face circle at a fixed speed S m / s. The laser tracker also performs n times of dynamic real-time measurement of the target ball (TCP) on the robot at a fixed sampling frequency Q Hz, and the coordinates of the n measurement points K can be obtained. ij (X ij , Y ij , Z ij ), where j = 1, 2, 3, 4…n.

[0038] Furthermore, the trajectory accuracy AT P The calculation formula is:

[0039] Where: i = 1, 2, 3, 4 ... m;

[0040]

[0041] The calculation method of trajectory repeatability after n-time arc trajectory guidance by the robot vision system is as follows:

[0042]

[0043] Where: i = 1, 2, 3, 4 ... m;

[0044]

[0045] Compared with the prior art, the present invention has the following advantages and beneficial effects:

[0046] The present invention provides a device and method for measuring the circular arc trajectory guidance accuracy of a robot vision system. Three measuring points are evenly distributed at 120° on the radial circumference of a second cylinder. A target ball is moved to the three measuring points in sequence. A laser tracker measures the target ball at the three measuring points in sequence. The three measuring points are calibrated along the radius direction of the flange based on the radius value R of the target ball. 靶 The robot tool center point is calibrated to the center of the target ball. Based on the dynamic measurement function of the laser tracker, the robot tool center point is dynamically monitored and adjusted to coincide with the three measurement points evenly distributed at 120° on the circumferential generatrix of the end face circle of the second cylinder, and three points (P1, P2, P3) are recorded and taught. The robot adopts arc trajectory motion instructions and runs the arc trajectory instructions at a fixed speed S m / s in automatic mode. The laser tracker adopts dynamic measurement mode with a fixed sampling frequency Q Hz to measure the arc motion trajectory of the robot. The coordinate values ​​of several points of the arc trajectory measured are the theoretical values ​​of the arc trajectory guidance accuracy of the visual system. The robot vision system identifies the circumferential generatrix of the end face circle of the second cylinder and generates a point cloud based on the circumferential generatrix of the end face circle of the second cylinder. The visual system guides the robot tool center point to move at a fixed speed S m / s. m / s moves along the circumferential generatrix trajectory of the second cylindrical end face circle. The laser tracker measures the actual motion trajectory after the guidance of the vision system at a fixed sampling frequency of Q Hz in the dynamic measurement mode. In the laser tracking measurement system, there are both theoretical trajectory points based on the circumferential generatrix of the second cylindrical end face circle and actual motion trajectory points after the guidance of the vision system. The guidance accuracy of the spatial arc trajectory of the robot vision system can be accurately measured and calculated.

[0047] In summary, for the same feature of the calibration flange, the laser tracker is used to measure its feature and the visual system is used to scan and identify its feature. Before and after the guidance of the robot vision system, the robot adopts a unified running speed S m / s, and the laser tracker adopts a unified dynamic sampling frequency Q Hz. Based on the above constraints, the theoretical value of the robot vision system before guidance and the measured value after guidance are obtained under the same experimental conditions, so that the guidance accuracy of the circular trajectory of the robot vision system can be accurately, conveniently and quickly measured. BRIEF DESCRIPTION OF THE DRAWINGS

[0048] In order to more clearly illustrate the technical solutions of the exemplary embodiments of the present invention, the following briefly introduces the drawings required for use in the embodiments. It should be understood that the following drawings only illustrate certain embodiments of the present invention and should not be regarded as limiting the scope. For those of ordinary skill in the art, other relevant drawings can be obtained based on these drawings without creative work. In the drawings:

[0049] Figure 1 A schematic diagram of a robot end provided by the present invention rotating around the flange coordinate axis to fit the space ball;

[0050] Figure 2 A schematic diagram of the structure of the calibration flange provided by the present invention;

[0051] Figure 3 A schematic structural diagram of a two-degree-of-freedom motion platform device provided by the present invention;

[0052] Figure 4 This is a schematic diagram of the measurement layout provided by the present invention.

[0053] Marks and corresponding parts names in the attached drawings:

[0054] 1-first linear motion servo axis, 2-second linear motion servo axis, 3-workbench, 4-calibration flange, 41-first cylinder, 42-second cylinder. DETAILED DESCRIPTION

[0055] In order to make the objectives, technical solutions and advantages of the present invention more clearly understood, the present invention is further described in detail below in conjunction with embodiments and drawings. The exemplary embodiments of the present invention and their description are only used to explain the present invention and are not intended to limit the present invention.

[0056] Embodiment 1:

[0057] This embodiment 1 provides a device for measuring the circular arc trajectory guidance accuracy of a robot vision system, such as Figure 2 and Figure 3 As shown, it includes: a two-degree-of-freedom motion platform device, the two-degree-of-freedom motion platform device includes a vertically arranged first linear motion servo axis 1 and a horizontally arranged second linear motion servo axis 2; the second linear motion servo axis 2 is connected to a workbench 3, and the workbench 3 can slide along the length direction of the second linear motion servo axis 2; a calibration flange 4 is fixed on the workbench 3; the calibration flange 4 includes two coaxially connected first cylinders 41 and second cylinders 42, the diameter of the first cylinder 41 is larger than the diameter of the second cylinder 42, and the thickness of the second cylinder 42 is equal to the radius of the target sphere.

[0058] In the above device, the calibration flange 4 includes a first cylinder 41 and a second cylinder 42. Figure 2 As shown, the two-degree-of-freedom motion platform device includes a first linear motion servo axis 1, a second linear motion servo axis 2 and a workbench 3. Figure 3 As shown in Figure 2, the layout of the robot system, laser tracker, and calibration device during the entire measurement process is as follows: Figure 4 As shown. When the target ball moves on the calibration flange 4, the outer surface of the second cylinder 42 of the calibration flange 4 radially positions the target ball, and the end surface of the first cylinder 41 of the calibration flange 4 axially positions the target ball. The repeatability of the first linear motion servo axis 1 and the second linear motion servo axis 2 is better than 2μm, and the flatness of the workbench 3 is better than 3μm; the calibration flange 4 is composed of two cylindrical step structures, namely the first cylinder 41 and the second cylinder 42, wherein the first cylinder 41 is fixedly connected to the end surface of the second cylinder 42, and the diameter of the first cylinder 41 is Larger than the second cylinder 42 The thickness d2 of the second cylinder 42 is equal to the radius R of the target sphere. 靶 Equal, that is, d2 = R 靶 The flatness of the end face of the first cylinder 41 is better than 2 μm, the cylindricity of the second cylinder 42 is better than 2 μm, and the flatness of the end face of the second cylinder 42 is better than 1 μm.

[0059] Embodiment 2:

[0060] This embodiment 2 is further optimized on the basis of embodiment 1, and provides a measurement method for a device for measuring the circular arc trajectory guidance accuracy of a robot vision system, such as Figure 1-Figure 4 As shown, the robot tool end revolves around the flange coordinate system X F , Y F , Z F Axis rotation fitting ball and space circle Figure 1 As shown, the specific steps include:

[0061] 1. The calibration flange 4 is fixedly installed on the workbench 3 of the two-degree-of-freedom motion platform device, and the workbench 3 of the two-degree-of-freedom motion platform device is controlled to move to the fixed position A. The target ball moves M positions (M>6) at a uniform interval on the end surface of the second cylinder 42. The laser tracker measures the M points in turn, and fits the end plane of the second cylinder 42 based on the M measurement points.

[0062] 2. Measuring point 1, measuring point 2 and measuring point 3 are set in the radial circumferential direction of the second cylinder 42, wherein measuring point 1, measuring point 2 and measuring point 3 are evenly distributed at 120° on the radial circumference of the second cylinder 42, and when the target ball moves on the calibration flange 4, the outer circumference of the second cylinder 42 of the calibration flange 4 radially positions the target ball, and the end surface of the first cylinder 41 of the calibration flange 4 axially positions the target ball; the target ball moves to measuring point 1, measuring point 2 and measuring point 3 on the second cylinder 42 respectively, and the laser tracker measures the coordinate value of the target ball at each point in turn, fits a circle based on measuring point 1, measuring point 2 and measuring point 3, and projects the measured fitted circle onto the end plane of the second cylinder 42.

[0063] 3. The three measurement points are based on the target sphere radius value R 靶 Compensation is performed along the radial direction of the end face of the second cylinder 42. The compensated measuring point D1 (X D1 ,Y D1 ,Z D1 )、Measurement point D2(X D2 ,Y D2 ,Z D2 ), measuring point D3(X D3 ,Y D3 ,Z D3 ) are all on the end surface circumference of the second cylinder 42.

[0064] 4. Move the robot to a suitable position, adsorb the target ball to the target seat at the end of the robot, and teach and record the robot posture P0; the robot moves around the flange coordinate system X F , Y F , Z F The laser tracker collects the spatial coordinate points of the target ball at each posture of the robot and converts the X coordinates of the flange coordinate system into F , Y F , Z F All spatial points of the axis rotation measurement are fitted to obtain a spatial sphere, and the circle and its plane rotating around Rx, Ry, and Rz are fitted.

[0065] The space sphere equation is as follows: (xa) 2 +(yb) 2 +(zc) 2 =R 2 (1)

[0066] The equation transformation is as follows: 2ax+2by+2cz-a 2 -b 2 -c 2 +R 2 =x 2 +y 2 +z 2(2)

[0067] Let 2a = A 2b = B 2c = Ca 2 +b 2 +c 2 -R 2 =D;

[0068] The above formula can be written in matrix form as follows:

[0069]

[0070] Transform the matrix as follows:

[0071]

[0072] Solve equation (4) to get A, B, C, D, and substitute a=A / 2, b=B / 2, c=C / 2. The coordinates of the center of the sphere Qo(a,b,c) and the radius of the sphere R can be obtained.

[0073] Space plane fitting:

[0074] The spatial plane equation can be expressed as: A1x+B1y+C1z+1=0, (5)

[0075] The equation matrix form is as follows:

[0076]

[0077] After matrix transformation, the following formula can be obtained:

[0078]

[0079] Solving for the coefficients A1, B1, and C1, we can get the spatial plane equation. Combining the spatial plane equation (5) with the sphere equation (1) obtained in the previous step, we can find the spatial center coordinates Ca (a1, b1, c1) and the radius r.

[0080] Construct the normal vector of the circle rotating around Rx, Ry, Rz and its plane Solve for the angle between any two normal vectors, If θ XY ,θ YZ ,θ XZ If any one of the angles is within the range of 90°±0.03°, the above operation process is stopped; if all three angles are not within the range of 90°±0.03°, the above operation process is repeated.

[0081] 5. The robot returns to P0 position. The two normal vectors closest to 90° between the three vectors are used as reference axes, and the coordinate system {F} is established using the right-hand rule with the center of the sphere as the origin; at this time, the coordinate system {F} based on laser tracking coincides with the robot flange coordinate system.

[0082] 6. Measure the coordinate value of the target ball at this time in the laser tracking coordinate system {F}. This value is the offset value of the center of the target ball relative to the origin of the robot flange coordinate system (default TCP). Import the coordinate value of the target ball at this time into the robot controller. At this time, the tool center point (TCP) of the robot is the center of the target ball.

[0083] 7. The workbench 3 of the two-degree-of-freedom motion platform device moves to the fixed position B, and the center point of the robot end tool (target sphere center) and D1 (X D1 ,Y D1 ,Z D1 ) overlap and teach to record the current point as P1, adjust the robot end tool center point (target ball center) and D2 (X D2 ,Y D2 ,Z D2 ) overlap and teach to record the current point as P2, adjust the robot end tool center point (target ball center) and D3 (X D3 ,Y D3 ,Z D3 ) overlaps and teaches to record the current point as P3.

[0084] 8. Use the circular motion trajectory command in the robot teaching pendant to write a 360° circular trajectory path program starting from point P1 and passing through points P2 and P3, and set the trajectory running speed to S m / s.

[0085] 9. The laser tracker sets a fixed sampling frequency of Q Hz in the dynamic measurement mode, moves the tool center of the robot to point P1, and automatically runs the arc trajectory path program of the robot starting from point P1 and passing through points P2 and P3 for a 360° circle at a speed of S m / s. The laser tracker dynamically measures the motion trajectory of the robot in real time at a sampling frequency of Q Hz. In the laser tracker measurement system, there are several sampling points C of the arc trajectory of the robot starting from point P1 and passing through points P2 and P3 for a 360° circle. i (X i , Y i , Z i ), where i = 1, 2, 3, 4…m, C i (Xc i , Yc i , Zc i ) is the theoretical value of circular trajectory guidance of the robot vision system.

[0086] 10. The workbench 3 of the two-degree-of-freedom motion platform device moves to a fixed position A, and the robot vision system identifies and scans the circumferential generatrix of the end face circle of the second cylinder 42, generates a vision system point cloud based on the circumferential generatrix of the end face circle of the second cylinder 42, and then the workbench 3 of the two-degree-of-freedom motion platform device moves to a fixed position B.

[0087] 11. The trajectory running speed S m / s is set in the robot control program. The robot vision system guides the center point of the robot tool to run along the entire circumferential generatrix of the end face circle of the second cylinder 42 at a speed of S m / s. The laser tracker dynamically measures the motion trajectory of the robot vision guidance in real time at a sampling frequency of Q Hz. In the laser tracker measurement system, there are several sampling points K of the motion trajectory of the robot vision system. i (X i , Y i , Z i ), where i = 1, 2, 3, 4…m, K i (X i , Y i , Z i ) is the actual value of the circular trajectory guidance of the robot vision system.

[0088] 12. Repeat steps 10 to 11 for n times (n≥10) in total. Through n times of recognition and scanning by the robot vision system, the vision system guides the robot to move its target ball (TCP) at a fixed speed S m / s along the entire circumferential generatrix trajectory of the end face circle of the second cylinder 42 of the calibration flange 4. The laser tracker also performs n times of dynamic real-time measurement of the target ball (TCP) on the robot at a fixed sampling frequency Q Hz, and the coordinates K of the n measurement points can be obtained. ij (X ij , Y ij , Z ij ), where j = 1, 2, 3, 4…n.

[0089] 13. The laser tracking measurement system has both the theoretical value before the robot vision system guidance and the measured value after the robot vision system guidance, so the trajectory accuracy AT after the robot vision system space arc trajectory guidance can be calculated P :in:

[0090]

[0091] Where:

[0092]

[0093] The calculation method of trajectory repeatability after n-time arc trajectory guidance by the robot vision system is as follows:

[0094]

[0095] Where:

[0096]

[0097] In summary, by designing and manufacturing the corresponding high-precision calibration flange 4, its laser tracker can conveniently and quickly measure the three feature points distributed at 120° on the circumference of the second cylinder 42, and compensate the measurement points on the circumference of the second cylinder 42 of the calibration flange 4 based on the radius of the target ball, so that the three compensated feature points can accurately fall on the circumference of the end face of the second cylinder 42 of the calibration flange 4; through the dynamic measurement characteristics of the laser tracker, the target ball at the end of the robot tool is adjusted to enable the robot to teach and record the three feature points on the circumference of the second cylinder 42 of the calibration flange 4; set a fixed running speed S m / s and use arc instructions to run the arc trajectory based on the teaching and recording of the three feature points, the laser tracker measures the arc trajectory of the robot based on a dynamic measurement method with a fixed sampling frequency Q Hz, and the measurement result is the theoretical arc trajectory before the robot vision system guides; the robot vision system identifies and scans the circumference generatrix of the end face of the second cylinder 42 of the calibration flange 4, and guides the center point of the robot tool to still run at a fixed running speed S m / s moves along the circular trajectory after the visual system is identified and scanned. The laser tracker still measures the robot's motion trajectory after visual guidance in a dynamic measurement manner at a fixed sampling frequency of Q Hz. The measurement result is the actual circular arc trajectory after the robot's visual system is guided. In the laser tracking measurement system, both the theoretical circular arc motion trajectory before the robot's visual system is guided and the actual circular arc motion trajectory after the robot's visual system is guided are obtained. The deviation between the two can be easily obtained. Through multiple identification and guidance by the robot's visual system and measurement by the laser tracker, the circular arc trajectory accuracy deviation and the circular arc trajectory repeatability deviation of the robot's visual system's circular arc trajectory guidance accuracy are obtained.

[0098] The specific implementation methods described above further illustrate the objectives, technical solutions and beneficial effects of the present invention in detail. It should be understood that the above description is only a specific implementation method of the present invention and is not intended to limit the scope of protection of the present invention. 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 device for measuring the circular arc trajectory guidance accuracy of a robot vision system. It is characterized in that include: A two-degree-of-freedom motion platform device, the two-degree-of-freedom motion platform device comprising a first linear motion servo axis (1) arranged vertically and a second linear motion servo axis (2) arranged horizontally; A workbench (3) is connected to the second linear motion servo shaft (2), and the workbench (3) can slide along the length direction of the second linear motion servo shaft (2); a calibration flange (4) is fixed to the workbench (3); The calibration flange (4) comprises a first cylinder (41) and a second cylinder (42) which are coaxially connected, the diameter of the first cylinder (41) being greater than the diameter of the second cylinder (42), and the thickness of the second cylinder (42) being equal to the radius of the target sphere.

2. A method for measuring the circular arc trajectory guidance accuracy of a robot vision system according to claim 1, It is characterized in that The following steps are involved: S0: The calibration flange (4) is fixedly mounted on the workbench (3) of the two-degree-of-freedom motion platform device, the target ball is moved to M positions at a uniform interval on the end surface of the second cylinder (42) of the calibration flange (4), M>6, the laser tracker measures the M points in sequence, and the end plane of the second cylinder (42) of the calibration flange (4) is fitted based on the M measurement points; S1: moving the workbench (3) to a fixed position A, evenly setting at least three measuring points in the entire radial circumferential direction of the second cylinder (42), and moving the target ball to the plurality of measuring points respectively, measuring the coordinate value of the target ball at each point by a laser tracker, fitting a circle based on the plurality of measuring points, and projecting the measured fitting circle onto the end plane of the second cylinder (42); S2: Compensate a number of measuring points along the radial direction of the end face circle of the second cylinder so that the measuring points are all on the circumference of the end plane of the second cylinder; S3: adsorb the target ball onto the target seat at the end of the robot, and calibrate the tool center point of the robot to the center of the target ball; S4: Move the workbench (3) to a fixed position B, and in the dynamic measurement mode of the laser tracker, adjust the center point of the robot end tool to accurately coincide with the several measurement points compensated in step S2, and operate the robot to teach and record the points P1..PN that coincide with the several measurement points; N is greater than or equal to 3; S5: Based on the points P1..PN taught by the robot, arc trajectory instructions are used to compile and generate corresponding arc trajectory operation programs; S6: Run the robot arc trajectory program, measure the robot's motion trajectory dynamically and in real time through a laser tracker, and obtain a number of sampling points of the robot's arc trajectory starting from point P1 and passing through points P2, ..PN respectively. The sampling points are used as theoretical values ​​of the arc trajectory guidance of the robot vision system; S7: Control the workbench (3) to move to a fixed position A, and the robot vision system identifies and scans the circumferential generatrix of the end face circle of the second cylinder (42), and generates a vision system point cloud based on the circumferential generatrix of the end face circle of the second cylinder (42); then the vision system guides the center point of the robot tool to move along the trajectory of the circumferential generatrix of the second cylinder (42), and the actual motion trajectory of the robot after the guidance of the vision system is dynamically measured in real time by a laser tracker, so as to obtain the actual value of the arc trajectory guided by the robot vision system; S8: According to the theoretical value before the robot vision system trajectory guidance and the actual value after the robot vision system trajectory guidance, the trajectory accuracy of the robot vision system after the spatial arc trajectory guidance is obtained.

3. The measuring method of the device for measuring the circular arc trajectory guidance accuracy of a robot vision system according to claim 1, It is characterized in that The step S1 also includes the following specific steps: Measuring point 1, measuring point 2 and measuring point 3 are evenly set in the radial circumferential direction of the second cylinder, and the target ball is moved to measuring point 1, measuring point 2 and measuring point 3 respectively, the coordinate value of the target ball at each point is measured by a laser tracker, a circle is fitted based on measuring point 1, measuring point 2 and measuring point 3, and the measured fitted circle is projected onto the end plane of the second cylinder.

4. The measuring method of the device for measuring the circular arc trajectory guidance accuracy of a robot vision system according to claim 1, It is characterized in that The step S3 comprises the following specific steps: S31: Move the robot to a suitable position, adsorb the target ball to the target seat at the end of the robot, teach and record the robot posture P0; the robot moves around the flange coordinate system X F , Y F , Z F The laser tracker collects the spatial coordinate points of the target ball at each posture of the robot and converts the X coordinates of the target ball around the flange coordinate system into F , Y F , Z F All spatial points of the axis rotation measurement are fitted to obtain a spatial sphere, and the circles and their planes rotating around Rx, Ry, and Rz are fitted, and the normal vectors of the circles and their planes rotating around Rx, Ry, and Rz are constructed. Find the angle between any two normal vectors; S32: The robot returns to P0 position. The two normal vectors closest to 90° between the three vectors are used as reference axes, and the coordinate system {F} is established using the right-hand rule with the center of the sphere as the origin; at this time, the coordinate system {F} based on laser tracking coincides with the robot flange coordinate system; S33: Measure the coordinate value of the target ball at the end of the robot in the laser tracking coordinate system {F}. This value is the offset value of the center of the target ball relative to the origin of the robot flange coordinate system. Import the coordinate value of the target ball into the robot controller. At this time, the tool center point of the robot is the center of the target ball.

5. The measuring method of the device for measuring the circular arc trajectory guidance accuracy of a robot vision system according to claim 4, It is characterized in that In step S31, when solving the angle between any two normal vectors, if θ XY ,θ YZ ,θ XZ If any one of the angles is within the range of 90°±0.03°, stop step S31; if all three angles are not within the range of 90°±0.03°, repeat step S31.

6. The measuring method of the device for measuring the circular arc trajectory guidance accuracy of a robot vision system according to claim 1, It is characterized in that The angle between normal vectors is calculated as:

7. The measuring method of the device for measuring the circular arc trajectory guidance accuracy of a robot vision system according to claim 2, It is characterized in that In step S6, N is equal to 3, and the specific steps of dynamically measuring the motion trajectory of the robot in real time by using a laser tracker to obtain several sampling points of the arc trajectory of the robot starting from point P1 and passing through points P2 and P3 are as follows: The laser tracker is set to a fixed sampling frequency of Q Hz in the dynamic measurement mode, and the tool center of the robot is moved to point P1. The robot automatically runs the arc trajectory path program of the robot starting from point P1 and passing through points P2 and P3 for a 360° circle at a fixed speed Sm / s. The laser tracker dynamically measures the motion trajectory of the robot in real time at a fixed sampling frequency of Q Hz, and collects several sampling points C of the arc trajectory of the robot starting from point P1 and passing through points P2 and P3 for a 360° circle. i (Xc i , Yc i , Zc i ), where i = 1, 2, 3, 4…m, C i (Xc i , Yc i , Zc i ) is the theoretical value of the robot vision system trajectory guidance.

8. The measuring method of the device for measuring the circular arc trajectory guidance accuracy of a robot vision system according to claim 2, It is characterized in that In step S7, the visual system guides the center point of the robot tool to move along the second cylindrical circumference generatrix trajectory, and the specific steps of dynamically and real-time measuring the actual motion trajectory of the robot after the visual system guidance by the laser tracker are as follows: The trajectory running speed Sm / s is set in the robot control program. The robot vision system guides the center point of the robot tool to run along the entire circumferential generatrix of the second cylindrical end face circle at a fixed speed Sm / s. The laser tracker dynamically measures the motion trajectory of the robot after vision guidance in real time at a fixed sampling frequency of Q Hz, and collects several sampling points K of the motion trajectory after the robot vision system guides i (X i , Y i , Z i ), where i = 1, 2, 3, 4…m, K i (X i , Y i , Z i ) is the actual value after trajectory guidance by the robot vision system.

9. The measuring method of the device for measuring the circular arc trajectory guidance accuracy of a robot vision system according to claim 8, It is characterized in that After collecting several sampling points K of the spatial motion trajectory guided by the robot vision system for the first time i (X i , Y i , Z i ), further comprising the following steps: Repeat step S7 for n times (n≥10) in total. Through n times of recognition and scanning by the robot vision system, the vision system guides the target ball at the end of the robot to run along the trajectory of the entire circumference generatrix of the second cylindrical end face circle at a fixed speed Sm / s. The laser tracker also performs n times of dynamic real-time measurement of the target ball (TCP) on the robot at a fixed sampling frequency Q Hz, and the coordinates K of the n measurement points can be obtained. ij (X ij , Y ij , Z ij ), where j = 1, 2, 3, 4…n.

10. The measuring method of the device for measuring the circular arc trajectory guidance accuracy of a robot vision system according to claim 9, It is characterized in that The trajectory accuracy AT P The calculation formula is: Where: i = 1, 2, 3, 4 ... m; The calculation method of trajectory repeatability after n-time arc trajectory guidance by the robot vision system is as follows: Where: i = 1, 2, 3, 4 ... m;

Citation Information

Patent Citations

  • Special testing device and method for correcting welding track based on machine vision

    CN103846606A

  • Method, device, terminal and system for target tracking trajectory accuracy measurement

    CN107481284A

  • Space trajectory precision measuring device and method

    CN112536822A

  • Device and method for measuring guidance precision of spatial position of robot vision system

    CN116000927A

  • Method and system for measuring space pose adjustment resolution of robot

    CN116352757A

Cited By

  • Robot track precision optimization method based on guidance of measuring equipment

    CN120363223A