Calibration method and system for additive manufacturing complex part grinding robot
By establishing the coordinate system conversion relationship between the robot and the laser tracker and the scanning unit, the precise calibration of the polishing additive parts is achieved, the problem of insufficient polishing accuracy and stability in the existing technology is solved, and the measurement and measurement of the workpiece are improved. Processing accuracy.
Patent Information
- Application Number
- CN202411316221.X
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-09-20
- Publication Date
- 2024-12-06
AI Technical Summary
The existing robot grinding technology has shortcomings in grinding accuracy and process stability, especially when dealing with complex parts, the lack of effective calibration methods leads to low accuracy and maturity that needs to be improved.
By determining the conversion relationship between the robot coordinate system and the laser tracker coordinate system, and combining the calibration of the laser scanning unit, a unified system coordinate system is established to ensure that the grinding process is carried out under the same coordinate system, thereby improving the measurement and processing accuracy of the workpiece. .
The accuracy and measurement accuracy of robot polishing additive components is improved, the error problem caused by inconsistent coordinate systems is solved, and the processing capability of complex components is enhanced.
Smart Images

Figure CN119077624A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of robots, and in particular to a calibration method for an additively manufactured complex parts polishing robot. Background Art
[0002] Workpiece grinding technology needs to be widely used in the fields of aviation, aerospace, shipbuilding, etc. Robotic grinding technology has been invested heavily in many industries due to its advantages such as automatic grinding and reducing the workload of process personnel. However, at this stage, robotic grinding technology still has problems in grinding accuracy, such as insufficient process stability, low precision, and maturity that needs to be improved.
[0003] The patent document with publication number CN108994830A discloses a system calibration method for offline programming of a grinding robot, including the following steps: S1, obtaining a point cloud model of a physical object scan; S2, calibrating the coordinate system of the grinding tool; S3, measuring and obtaining the coordinate values of the physical feature points in the robot coordinates; S4, model import and feature point matching; S5, robot offline programming and simulation; S6, robot program generation; S7, physical grinding. The system calibration method for offline programming of a grinding robot provided by the present invention can be applied to the grinding process of the thermal insulation layer of the bottom of a tank with a variety of raised flange obstacles and short shell edges, and can meet the requirements of equal thickness processing as much as possible while ensuring a smooth transition of the shape. Although this system calibration method based on offline programming can quickly and in real time perform calibration on the grinding robot, it lacks a calibration method for the workpiece measurement part.
[0004] Therefore, a calibration method for an additively manufactured complex parts grinding robot is needed to solve the above problems. Summary of the invention
[0005] In view of the defects in the prior art, the purpose of the present invention is to provide a calibration method and system for an additive manufacturing complex parts grinding robot.
[0006] A calibration method for an additive manufacturing complex parts grinding robot provided by the present invention comprises:
[0007] Step S1: determine the conversion relationship between the robot coordinate system and the laser tracker coordinate system, calibrate the polishing robot, and use the robot coordinate system as the system coordinate system;
[0008] Step S2: calibrating the grinding unit of the additive component by using a laser tracker to obtain the position coordinates of the grinding unit in the laser tracker coordinate system;
[0009] Step S3: determining the coordinate conversion relationship inside the laser scanning unit through conversion calculation, calibrating the laser scanning unit, and establishing the conversion relationship between the laser scanning unit coordinate system and the system coordinate system;
[0010] Step S4: Establish a conversion relationship between the robot coordinate system, the laser tracker coordinate system, and the laser scanning unit coordinate system and the system coordinate system, so that the process of polishing the additive parts is carried out in the same system coordinate system.
[0011] Preferably, the step S1 comprises:
[0012] Step S1.1: When the grinding robot is at the preset initial position, the center of the grinding robot base is taken as the center point O B , with the vertical direction of the base as the Z-axis direction, the direction of the grinding robot arm as the X-axis direction, and the Y-axis direction perpendicular to the X-axis direction, establish the robot coordinate system O B X B Y B Z B , and the robot coordinate system is used as the system coordinate system;
[0013] Step S1.2: Take the top center of the laser tracker as the center of the circle O T , the X-axis, Y-axis, and Z-axis of the robot coordinate system are the X-axis, Y-axis, and Z-axis directions of the laser tracker coordinate system, and the laser tracker coordinate system is established as T X T Y T Z T ; The target ball is set at the end of the grinding robot arm. At the initial position, the center of the target ball is P C , using the laser tracker to measure its coordinates in the laser tracker coordinate system
[0014] Step S1.3: by presetting three single-axis rotations, three sets of target ball center coordinate points are obtained, and the least square method is used to perform spatial circle fitting in sequence, and the three fitted circles obtained are small circle, middle circle and large circle;
[0015] Specifically, the polishing robot is placed in an initial position, and the corresponding joints of the robot are rotated so that the target ball can rotate around the coordinate axes of the robot coordinate system respectively, and the trajectory of the target ball center is measured by a laser tester to obtain three sets of target ball center coordinate sets;
[0016] Among them, around Z B The target ball trajectory circle when the axis rotates is called a great circle; B The trajectory of the target ball when rotating around the X axis is called the mid-circle; B The trajectory of the target ball when the axis rotates is called the small circle;
[0017] Get the center of the small circle O in the laser tracker coordinate system S The coordinates are O S T , the unit normal vector of the circular plane is n M, the unit normal vector of the great circle plane is n L , the radius of the large circle is R L ;
[0018] Step S1.4: Calculate the rotation matrix R: According to the parameter information of the small circle, the middle circle and the large circle, establish the rotation relationship transformation between the robot coordinate system and the laser tracker coordinate system;
[0019] Specifically, according to the corresponding geometric relationship, the great circle unit normal vector n L Parallel and coaxial to robot O B Z B Direction; In the laser tracker coordinate system, the robot O B Z B The unit direction vector is equal to the great circle unit normal vector, that is, n ZRB =n L , n ZRB For Robot O B Z B The unit direction vector of the circle; the unit normal vector n M Parallel and coaxial to robot O B Y B direction;n YRB =n M , n YRB For Robot O B Y B The unit direction vector of the small circle; the unit normal vector n S Parallel and coaxial to robot O B X B direction; so the X axis is n XRB =n YRB ×n ZRB =n M ×n L , n XRB For Robot O B Y B The unit direction vector of ;
[0020] After obtaining the unit vector of the coordinate axis direction of the robot coordinate system, construct the rotation matrix R of the robot coordinate system and the laser tracker coordinate system:
[0021] R=[n XRB n YRB n ZRB ]=[n M ×n L n M n L ]
[0022] Step S1.5: Calculate the translation matrix T: In the robot coordinate system, the center point of the robot target ball is The coordinates in the laser tracker coordinate system are In the laser tracker coordinate system, the initial position of the target ball center is P C The coordinates of The laser tracker obtains the relative position of the target ball center in the laser tracker coordinate system. S To the initial point P C The vector is O S P C , the big circle and the small circle intersect at point P C ;
[0023] P in the robot coordinate system C Relative to the center of the target ball The coordinate offset is Δ=[Δ X Δ Y Δ Z ] T , specifically:
[0024]
[0025] The components of Δ on the coordinate axis are:
[0026]
[0027] Δ Y =O S P C ·n YRB
[0028] Δ Z =O S P C ·n ZRB
[0029] In the robot coordinate system, the center of the small circle is O S Point to the origin of the coordinate system O B The vector is:
[0030]
[0031] Small circle center O S Coordinate O in the laser tracker coordinate system S T , get the origin of the robot coordinate system O B Coordinates in the tracker coordinate system:
[0032] Get the translation vector:
[0033] Step S1.6: Determine the transformation relationship between the robot and laser tracker coordinate systems through the rotation matrix R and the translation matrix T, model the polishing robot and the laser tracker system, and calibrate the polishing robot using the robot coordinate system as the system coordinate system.
[0034] Preferably, step S2 comprises:
[0035] Step S2.1: calibrating the rotation center position of the contact wheel of the grinding tool in the grinding unit in the grinding unit coordinate system;
[0036] Step S2.2: Use a laser tracker to calibrate the grinding unit of the additive component to determine the position of the grinding unit in the laser tracker coordinate system.
[0037] Preferably, step S3 comprises:
[0038] Step S3.1: The laser scanning unit includes a laser scanner and a four-degree-of-freedom platform. The measurement coordinate system of the laser scanner is defined as {C}, and the coordinate system of the four-degree-of-freedom platform is defined as {M};
[0039] Among them, the directions of the four-degree-of-freedom platform include the directions of the X-axis, the Y-axis, the Z-axis and the rotation direction of one rotation axis;
[0040] Step S3.2: Set a calibration ball at a fixed position, where the coordinates of the center of the calibration ball are C c , with a radius of R c , any point in the spherical point cloud is P ci , in P ci With R c Given the known situation, find C c value;
[0041] The calibration sphere is measured by moving the four-degree-of-freedom platform twice. Specifically, a straight-through filter is used to select a point set on the calibration sphere so that any point P in the point set ci (x pci ,y pci ,z pci ) all satisfy the following formula, i is an integer greater than 1, and all points in the point set are substituted into the following formula for standard ball measurement;
[0042] (x pci -x cc ) 2 +(y pci -y cc ) 2 +(z pci -z cc ) 2 =R c 2
[0043] x cc is the x-direction value of the center of the calibration ball; y cc is the y-direction value of the center of the calibration sphere; cc is the z-direction value of the center of the calibration sphere;
[0044] Step S3.3: After the first move, the value of the center of the fitted calibration ball at {C} is C P1; After the second move, the value of the center of the calibration ball in {C} C P2; the Euler angles are C α, C β, C γ, then M C T is about C α, C β, C The matrix function of γ is is the homogeneous transformation matrix between {M} and {C}; They are the three coordinate axes of {M}, from C P1 to C P2 establishes the equation as follows:
[0045]
[0046] where d x , d y , d z The movement of the X-axis, Y-axis, and Z-axis of the four-degree-of-freedom platform respectively; the Euler angle is obtained C α, C β, C After the value of γ is determined, the conversion relationship between {M} and {C} is established to obtain the laser scanning unit coordinate system;
[0047] Step S3.4: Establish the conversion between the laser scanning unit and the robot coordinate system; scan the complex curved surface workpiece on the polishing robot and the tooling through the laser scanning unit, load the scanned information into the PC, and calculate it through the PC coordinate conversion algorithm to establish the coordinate conversion relationship between the robot coordinate system, the laser scanning unit coordinate system and the system coordinate system, so that the point cloud of different complex curved surface workpieces is converted from the laser scanning coordinate system data coordinates to the system coordinate system.
[0048] Preferably, the step S3.2 comprises:
[0049] Place the calibration ball at the preset position, keep the rotation axis at a fixed angle, and scan the calibration ball with a laser scanner;
[0050] Specifically, the four-degree-of-freedom platform is moved along the X-axis, Y-axis, and Z-axis for the first time so that the calibration sphere is located on the left side of the field of view of the laser scanner, and the calibration sphere is scanned to obtain a point cloud data set {D1}; the four-degree-of-freedom platform is moved along the X-axis, Y-axis, and Z-axis for the second time so that the calibration sphere is located on the right side of the field of view of the laser scanner, and the point cloud data set {D2} is recorded.
[0051] A calibration system for an additive manufacturing complex parts grinding robot provided by the present invention comprises:
[0052] Module M1: Determine the conversion relationship between the robot coordinate system and the laser tracker coordinate system, calibrate the polishing robot, and use the robot coordinate system as the system coordinate system;
[0053] Module M2: Calibrate the grinding unit of the additive component through the laser tracker to obtain the position coordinates of the grinding unit in the laser tracker coordinate system;
[0054] Module M3: Determine the coordinate transformation relationship inside the laser scanning unit through conversion calculation, calibrate the laser scanning unit, and establish the transformation relationship between the laser scanning unit coordinate system and the system coordinate system;
[0055] Module M4: The robot coordinate system, laser tracker coordinate system, and laser scanning unit coordinate system are all transformed into the system coordinate system, so that the process of polishing additive parts is carried out in the same system coordinate system.
[0056] Preferably, the module M1 comprises:
[0057] Module M1.1: When the grinding robot is in the preset initial position, the center of the grinding robot base is the center point O B , with the vertical direction of the base as the Z-axis direction, the direction of the grinding robot arm as the X-axis direction, and the Y-axis direction perpendicular to the X-axis direction, establish the robot coordinate system O B X B Y B Z B , and the robot coordinate system is used as the system coordinate system;
[0058] Module M1.2: Take the top center of the laser tracker as the center of the circle O T , the X-axis, Y-axis, and Z-axis of the robot coordinate system are the X-axis, Y-axis, and Z-axis directions of the laser tracker coordinate system, and the laser tracker coordinate system is established as T X T Y T Z T ; The target ball is set at the end of the forearm of the polishing robot. At the initial position, the center of the target ball is P C , using the laser tracker to measure its coordinates in the laser tracker coordinate system
[0059] Module M1.3: By presetting three single-axis rotations, three sets of target ball center coordinate points are obtained, and the least square method is used to perform spatial circle fitting in sequence. The three fitted circles obtained are small circle, middle circle and large circle respectively;
[0060] Specifically, the polishing robot is placed in an initial position, and the corresponding joints of the robot are rotated so that the target ball can rotate around the coordinate axes of the robot coordinate system respectively, and the trajectory of the target ball center is measured by a laser tester to obtain three sets of target ball center coordinate sets;
[0061] Among them, around Z B The target ball trajectory circle when the axis rotates is called a great circle; B The trajectory of the target ball when rotating around the X axis is called the mid-circle; B The trajectory of the target ball when the axis rotates is called the small circle;
[0062] Get the center of the small circle O in the laser tracker coordinate system S The coordinates are O S T , the unit normal vector of the circular plane is n M , the unit normal vector of the great circle plane is n L , the radius of the large circle is R L ;
[0063] Module M1.4: Calculate the rotation matrix R: According to the parameter information of the small circle, the middle circle and the large circle, establish the rotation relationship transformation between the robot coordinate system and the laser tracker coordinate system;
[0064] Specifically, according to the corresponding geometric relationship, the great circle unit normal vector n L Parallel and coaxial to robot O B Z B Direction; In the laser tracker coordinate system, the robot O B Z B The unit direction vector is equal to the great circle unit normal vector, that is, n ZRB =n L , n ZRB For Robot O B Z B The unit direction vector of the circle; the unit normal vector n M Parallel and coaxial to robot O B Y B direction; n YRB =n M , n YRB For Robot O B Y B The unit direction vector of the small circle; the unit normal vector n S Parallel and coaxial to robot O B XB direction; so the X axis is n XRB =n YRB ×n ZRB =n M ×n L , n XRB For Robot O B X B The unit direction vector of ;
[0065] After obtaining the unit vector of the coordinate axis direction of the robot coordinate system, construct the rotation matrix R of the robot coordinate system and the laser tracker coordinate system:
[0066] R=[n XRB n YRB n ZRB ]=[n M ×n L n M n L ]
[0067] Module M1.5: Calculate the translation matrix T: In the robot coordinate system, the center point of the robot target ball is The coordinates in the laser tracker coordinate system are In the laser tracker coordinate system, the initial position of the target ball center is P C The coordinates of The laser tracker obtains the relative position of the target ball center in the laser tracker coordinate system. S To the initial point P C The vector is O S P C , the big circle and the small circle intersect at point P C ;
[0068] P in the robot coordinate system C Relative to the center of the target ball The coordinate offset is Δ=[Δ X Δ Y Δ Z ] T , specifically:
[0069]
[0070] The components of Δ on the coordinate axis are:
[0071]
[0072] Δ Y =O S P C ·n YRB
[0073] Δ Z =O S P C ·n ZRB
[0074] In the robot coordinate system, the center of the small circle is O S Point to the origin of the coordinate system O B The vector is:
[0075]
[0076] Small circle center O S Coordinate O in the laser tracker coordinate system S T , get the origin of the robot coordinate system O B Coordinates in the tracker coordinate system:
[0077] Get the translation vector:
[0078] Module M1.6: Determine the transformation relationship between the robot and laser tracker coordinate systems through the rotation matrix R and translation matrix T, model the polishing robot and laser tracker system, and calibrate the polishing robot using the robot coordinate system as the system coordinate system.
[0079] Preferably, the module M2 comprises:
[0080] Module M2.1: Calibrate the rotation center position of the contact wheel of the grinding tool in the grinding unit in the grinding unit coordinate system;
[0081] Module M2.2: Use the laser tracker to calibrate the grinding unit of the additive component and determine the position of the grinding unit in the laser tracker coordinate system.
[0082] Preferably, the module M3 includes:
[0083] Module M3.1: The laser scanning unit includes a laser scanner and a four-degree-of-freedom platform. The measurement coordinate system of the laser scanner is defined as {C}, and the coordinate system of the four-degree-of-freedom platform is defined as {M};
[0084] Among them, the directions of the four-degree-of-freedom platform include the directions of the X-axis, the Y-axis, the Z-axis and the rotation direction of one rotation axis;
[0085] Module M3.2: Set a calibration ball at a fixed position, where the center coordinate of the calibration ball is C c , with a radius of R c , any point in the spherical point cloud is P ci , in P ci With R c Given the known situation, find Cc value;
[0086] The calibration sphere is measured by moving the four-degree-of-freedom platform twice. Specifically, a straight-through filter is used to select a point set on the calibration sphere so that any point P in the point set ci (x pci ,y pci ,z pci ) all satisfy the following formula, i is an integer greater than 1, and all points in the point set are substituted into the following formula for standard ball measurement;
[0087] (x pci -x cc ) 2 +(y pci -y cc ) 2 +(z pci -z cc ) 2 =R c 2
[0088] x cc is the x-direction value of the center of the calibration ball; y cc is the y-direction value of the center of the calibration sphere; cc is the z-direction value of the center of the calibration sphere;
[0089] Module M3.3: After the first move, the value of the center of the fitted calibration ball at {C} is C P1; After the second move, the value of the center of the calibration ball in {C} C P2; the Euler angles are C α, C β, C γ, then About C α, C β, C The matrix function of γ is is the homogeneous transformation matrix between {M} and {C}; They are the three coordinate axes of {M}, from C P1 to C P2 establishes the equation as follows:
[0090]
[0091] where d x , d y , d z The movement of the X-axis, Y-axis, and Z-axis of the four-degree-of-freedom platform respectively; the Euler angle is obtained C α, C β, CAfter the value of γ is determined, the conversion relationship between {M} and {C} is established to obtain the laser scanning unit coordinate system;
[0092] Module M3.4: Establish the conversion between the laser scanning unit and the robot coordinate system; scan the complex curved surface workpiece on the polishing robot and the tooling through the laser scanning unit, load the scanned information into the PC, and calculate it through the PC coordinate conversion algorithm to establish the coordinate conversion relationship between the robot coordinate system, the laser scanning unit coordinate system and the system coordinate system, so that the point cloud of different complex curved surface workpieces is converted from the laser scanning coordinate system data coordinates to the system coordinate system.
[0093] Preferably, the module M3.2 includes:
[0094] Place the calibration ball at the preset position, keep the rotation axis at a fixed angle, and scan the calibration ball with a laser scanner;
[0095] Specifically, the four-degree-of-freedom platform is moved along the X-axis, Y-axis, and Z-axis for the first time so that the calibration sphere is located on the left side of the field of view of the laser scanner, and the calibration sphere is scanned to obtain a point cloud data set {D1}; the four-degree-of-freedom platform is moved along the X-axis, Y-axis, and Z-axis for the second time so that the calibration sphere is located on the right side of the field of view of the laser scanner, and the point cloud data set {D2} is recorded.
[0096] Compared with the prior art, the present invention has the following beneficial effects:
[0097] 1. The present invention uses a laser tracker to position the robot, thereby solving the problem of large robot positioning error during robot grinding of additive parts, thereby improving the grinding accuracy of the workpiece;
[0098] 2. The present invention solves the problem of accurate conversion between the measurement coordinates of the three-dimensional scanning camera and the coordinates of the four-degree-of-freedom platform by respectively positioning the laser scanner and the four-degree-of-freedom platform with high precision, thereby improving the measurement accuracy of the workpiece;
[0099] 3. The present invention calibrates each link of the process of grinding additive parts in a unified coordinate system to make positioning more accurate, thereby improving the measurement and processing accuracy of the workpiece. When facing complex parts, it solves the errors caused by the inconsistent coordinate system during the processing process. BRIEF DESCRIPTION OF THE DRAWINGS
[0100] Other features, objects and advantages of the present invention will become more apparent from the detailed description of non-limiting embodiments made with reference to the following drawings:
[0101] Figure 1 A flow chart of a calibration method for a grinding robot for complex parts manufactured by additive manufacturing according to the present invention;
[0102] Figure 2A schematic diagram of modeling the robot and laser tracker system of the present invention;
[0103] Figure 3 Modeling of the system of the present invention and schematic diagram of large / small circle trajectories;
[0104] Figure 4 It is a schematic diagram of a method for measuring the rotation center of a grinding tool contact wheel of the present invention;
[0105] Figure 5 A schematic diagram of the coordinate description of the laser scanning device and the calibration method of the laser scanning device of the present invention;
[0106] Figure 6 This is a schematic diagram of the calibration ball calculation algorithm of the present invention;
[0107] Figure 7 A schematic diagram of a calibration system for a complex component polishing robot manufactured by additive manufacturing according to the present invention;
[0108] Figure 8 It is a schematic diagram of the structure of the laser scanning unit of the present invention. DETAILED DESCRIPTION
[0109] The present invention is described in detail below in conjunction with specific embodiments. The following embodiments will help those skilled in the art to further understand the present invention, but are not intended to limit the present invention in any form. It should be noted that, for those of ordinary skill in the art, several changes and improvements can also be made without departing from the concept of the present invention. These all belong to the protection scope of the present invention.
[0110] When the present invention locally scans and globally locates the shape of a complex workpiece, in order to unify the spatial coordinates of the complex workpiece shape scanned by the laser scanner with the coordinates of the robot, polishing equipment, etc., and to ensure the convenience of subsequent robot processing trajectory planning and calculation, firstly, the layout analysis and coordinate unification of the polishing robot system of this project are carried out, and the robot base coordinates are used as the robot system coordinates, and are implemented using laser trackers, panoramic photogrammetry, and other methods; then, each unit of the robot system is designed and calibrated, especially the calibration of the robot coordinates, as well as the calibration between the four-degree-of-freedom platform and the laser scanner; finally, the coordinate space conversion of the local scanning point cloud data is analyzed and studied, and the conversion relationship between the workpiece point cloud data and the robot coordinates is confirmed.
[0111] Example 1
[0112] Step 1: Robot cell calibration
[0113] The robot unit is calibrated using the robot polar coordinates as the global space coordinates to obtain the transformation relationship between the robot coordinate system and the laser tracker coordinate system. The result of this step is a transformation matrix that represents the relationship between the robot coordinate system and the laser tracker coordinate system.
[0114] Step 2: Calibration of the Additive Part Grinding Unit
[0115] Use the laser tracker to calibrate the grinding unit of the additive component to obtain the position and posture of the grinding unit in the laser tracker coordinate system. The result of this step is the coordinate data of the grinding unit in the laser tracker coordinate system.
[0116] Step 3: Laser Scanning Unit Calibration
[0117] According to the results of step 1 and step 2, the rotation matrix is calculated through the coordinate transformation relationship. Specifically: using the transformation matrix obtained in step 1, the coordinate data of the grinding unit is transformed from the laser tracker coordinate system to the robot coordinate system. Through this transformation, the position and posture of the grinding unit in the robot coordinate system can be obtained. Finally, these data are used to calculate the coordinate system transformation of the laser scanning unit, thereby completing the calibration of the laser scanning unit.
[0118] Through this method, steps 1 and 2 provide the necessary coordinate transformation and initial calibration data, so that the rotation matrix of the laser scanning unit can be accurately calculated in step 3 to achieve its calibration. This method ensures the accuracy of the coordinate relationship between each unit, thereby improving the accuracy and reliability of the entire system. Specifically:
[0119] Step 1: Calibrate the robot unit using the robot polar coordinates as the global space coordinates;
[0120] Step 2: Calibrate the grinding unit of the additive parts;
[0121] Step 3: Calibrate the laser scanning unit.
[0122] The step 1 comprises the following steps:
[0123] Step 1.1: Figure 2 , the robot and laser tracker system is modeled, with the center of the robot base in the system as the system center point, and the vertical direction of the robot base as the Z axis. At the same time, the system coordinate system and the robot coordinate system are made to coincide, so that the coordinates of the point where the robot end is located are both the spatial points in the system coordinate system and the spatial points in the robot coordinate system;
[0124] Step 1.2: Install the target ball on the robot base, measure the plane points of the robot base using the laser tracker, and obtain the X coordinates of the robot base plane. B O B Y B Then, by measuring the target ball installed on the robot, when all the joints of the robot are in the initial position, the direction perpendicular to the base is the direction of the Z axis, and the direction of the upper arm is the direction of the Y axis, thus the origin of the robot base coordinates can be obtained;
[0125] Step 1.3: Get the robot coordinate system O B X B Y B Z B , laser tracker coordinate system O T X T Y T Z T Keep the robot's axes in their initial positions. This is the robot's initial state. Let the center of the target ball be the initial point P. C , measure its coordinates in the tracker coordinate system
[0126] Step 1.4: Control X B The axis performs a single-axis rotation motion, and the other two coordinate axes do not rotate. The coordinates of the center of the target ball are recorded at a certain angle. After the rotation is completed, the robot returns to the initial position and records all the rotation space coordinates. Use the same method to control Z B Axis and Y B The axis performs uniaxial rotation and records the coordinates of the target ball center at certain intervals. Three sets of points are obtained by three uniaxial rotations. The least squares method is used to perform spatial circle fitting in sequence, such as Figure 3 The three circles obtained are called small circle, middle circle and large circle respectively, and the center of the small circle in the tracker coordinate system can be obtained as O S The coordinates of O S T , the unit normal vector n of the mid-circle plane M , the unit normal vector n of the great circle plane L , radius of the large circle R L ;
[0127] Step 1.5: Obtain the rotation matrix R. Establish the rotation relationship between the robot coordinate system and the X, Y, and Z axes of the laser tracker. According to the geometric relationship, the great circle unit normal vector n L Parallel and coaxial to robot O RB Z RB axis, so the laser tracker, the robot O RB Z RB The unit direction vector of the axis is equal to the unit normal vector of the great circle, with n ZRB =n L , n ZRB For Robot O RB Z RB The unit direction vector of the axis.
[0128] Similarly, we can get the Y axis n YRB =n M , n YRB For Robot O RB Y RBThe unit direction vector of the axis; then the X axis is n XRB =n YRB ×n ZRB =n M ×n L , n XRB For Robot O RB X RB The unit direction vector of the axis.
[0129] From this, we can get the unit vectors of the robot coordinate system in each coordinate axis direction, so the component rotation matrix is: R = [n XRB n YRB n ZRB ]=[n M ×n L n M n L ] (1-1)
[0130] According to the formula, the angle is analyzed by the laser tracker SA software to establish the R rotation matrix;
[0131] Step 1.6: Calculate the translation matrix T. According to the robot coordinate system, the center point of the target ball at the end of the robot is The coordinates in the robot coordinate system are In the robot coordinate system, the initial position of the target ball center is P C The coordinates of (This quantity can be obtained by the laser tracker after confirming the robot coordinate origin to obtain the relative position of the target ball center under the laser tracker), the center of the small circle O S To the initial point P C The vector is O S P C , the big circle and the small circle intersect at point P C .
[0132] Assume that P in the robot coordinate system C Relative to The coordinate offset is Δ=[Δ X Δ Y Δ Z ] T ,have
[0133] (Coordinates of the target ball in the robot coordinate system)
[0134] Δ X That is P0O X , the components of the offset Δ are:
[0135]
[0136] Δ Y =OS P C ·n YRB (The distance between the intersection of the large and small circles can be obtained by using a laser tracker to calculate Δ Y )
[0137] Δ Z =O S P C ·n ZRB (by Δ Y and the radius of the small circle to obtain Δ Z )
[0138] In the robot coordinate system, the center of the small circle is O S Point to the origin of the coordinate system O RB The vector is:
[0139]
[0140] The center of the small circle is known to be O. S The coordinate O in the tracker coordinate system S T , the origin of the robot coordinate system is O RB Coordinates in the tracker coordinate system:
[0141] Then we get the translation vector:
[0142] At this point, the coordinate system transformation relations R and T have been obtained, thereby obtaining the transformation relationship between the robot and laser tracker coordinate systems.
[0143] The step 2 comprises the following steps:
[0144] Step 2.1: Use a laser tracker to calibrate the additive component grinding unit. First, calibrate the grinding tool rack and the active compliance bracket to determine the position of the grinding tool in the robot's overall coordinate system. Then calibrate the contact wheel position to determine the rotation center of the grinding tool contact wheel in the grinding tool coordinate system. Figure 4 shown.
[0145] The step 3 comprises the following steps:
[0146] Step 3.1: Laser scanning system using Slovak scanner Photoneo 3DScanner; The laser scanning unit includes a laser scanner and a four-degree-of-freedom platform. For the laser scanner unit, it is necessary to calibrate the coordinate conversion between the laser scanner and the four-degree-of-freedom platform coordinates.
[0147] Step 3.2: The four-degree-of-freedom platform includes three mutually perpendicular moving axes and one rotation axis, and the laser scanner is fixed on the rotation axis, such as Figure 5 As shown. The measurement coordinate system of the laser scanner is defined as {C}, and the coordinate system of the four-degree-of-freedom platform is defined as {M}. Due to the existence of assembly errors, it is difficult to ensure that the axis under the {M} system is completely parallel to the axis under {C}. When the axis in the four-degree-of-freedom platform moves, it is difficult to directly transform the points in {C} into {M}. The precise relationship between {C} and {M} needs to be determined by calibration. The relationship between {C} and {M} is calibrated by using a fixed calibration ball, and the rotation axis always keeps a fixed angle according to the actual situation. Move the four-degree-of-freedom platform X-axis, Y-axis, and Z-axis so that the calibration ball is located on the left side of the field of view of the three-dimensional scanning camera, scan the calibration ball, and obtain the point cloud data set {D1}; move the four-degree-of-freedom platform X-axis, Y-axis, and Z-axis again so that the calibration ball is located on the right side of the field of view of the three-dimensional scanning camera, and record the point cloud data set {D2}.
[0148] Datasets {D1} and {D2} play a key role in step 3.1. Their main role is to ensure the calibration accuracy and reliability of the 4DOF platform. The following are their specific impacts and necessity:
[0149] (1) Verify the accuracy of the measuring equipment:
[0150] By measuring two different positions, the measurement accuracy and consistency of the four-degree-of-freedom platform at different positions can be verified. If the point cloud data sets {D1} and {D2} obtained from the two measurements can accurately reflect the position and shape of the calibration sphere, it means that the measurement accuracy of the equipment is reliable.
[0151] (2) Eliminate system errors:
[0152] By taking measurements at different locations, systematic errors can be identified and eliminated. For example, the device may have slight deviations at different locations. By comparing the data of {D1} and {D2}, these deviations can be corrected to ensure the accuracy of the final calibration result.
[0153] (3) Improve the robustness of calibration:
[0154] Multiple measurements can improve the robustness and stability of the calibration process. Even if there is noise or other interference under certain measurement conditions, the impact of these interferences on the calibration results can be reduced through multiple measurements and data comparison.
[0155] Step 3.3: Assume that the center of the calibration sphere is C c , with a radius of R c , any point in the spherical point cloud is P ci , in P ci With R c Given the known situation, find C c First, use straight-through filtering to select a suitable point set on the sphere. Any point P in this point setci (x pci ,y pci ,z pci ) all satisfy equation (3-1), and all points are substituted into equation (3-1) to form a nonlinear over-constrained equation system. The Levenberg-Marquardt method is used to obtain the center P of the sphere. ci The least squares solution of the standard ball measurement algorithm is as follows Figure 6 shown.
[0156]
[0157] Step 3.4: Assume that at the end of the first move, the origins of {M} and {C} coincide, that is M P CORG ={0,0,0} T At this time, the value of the center of the fitted calibration ball at {C} is C P1; After the second move, the value of the center of the calibration ball in {C} C P2; The homogeneous transformation matrix between {M} and {C} is There is no translational component. It can be assumed that it is obtained through the Euler transformation of ZYZ. The Euler angles are C α, C β, C γ, then About C α, C β, C The matrix function of γ, Assumptions are the three coordinate axes of {M}, then from C P1 to C P2 can establish the following equation
[0158]
[0159] where d x , d y , d z are the movement of the four-degree-of-freedom platform along the X-axis, Y-axis, and Z-axis, respectively. Solving the above equations, we can obtain the Euler angle C α, C β, C The value of γ is used to establish the transformation relationship between {M} and {C}.
[0160] Step 3.5: Establish the measurement conversion method between the laser scanner and the robot. Before scanning the complex curved surface workpiece clamped by the industrial robot, a circle of N target seats are fixedly installed on the scanning positioning plate of the industrial robot, and target balls are installed on the target seats. Then, with the center point of the robot base as the origin, the center points of the circle of target balls fixedly installed on the scanning positioning plate are measured by a laser tracker in the coordinate system with the center point of the robot base as the origin, that is, the coordinates of the center points of the N target balls in the robot coordinate system. This operation only needs to be performed once before scanning the complex curved surface workpiece clamped by the industrial robot, and no measurement and calibration are required again during the subsequent rapid replacement of the complex curved surface workpiece by the quick-change plate, unless the circle of N target seats fixedly installed on the scanning positioning plate and the target balls for photographic scanning measurement are replaced or moved; then the N target balls are replaced with target balls for photographic scanning measurement and fixedly connected to the target seats; then the N target balls for photographic scanning measurement fixed on the scanning positioning plate and the complex curved surface workpiece on the overall gripping fixture are scanned as a whole by the scanning device; then, they are loaded into the PC and the PC coordinate conversion algorithm (such as spatial coordinate conversion SVD, Singular The robot coordinate system, the laser tracker coordinate system, and the scanning device coordinate system are calculated by using the value decomposition and least squares solutions algorithm to establish the coordinate conversion relationship between the robot coordinate system, the laser tracker coordinate system, and the scanning device coordinate system, and then the coordinates of the point cloud scanning coordinate system data of different complex curved surface workpieces are quickly converted to the robot coordinate system. Subsequently, the scanning coordinates of the replaced complex curved surface workpieces can be converted under this coordinate conversion relationship.
[0161] Example 2
[0162] A calibration method for an additive manufacturing complex parts grinding robot, comprising:
[0163] Step S1: determine the conversion relationship between the robot coordinate system and the laser tracker coordinate system, calibrate the polishing robot, and use the robot coordinate system as the system coordinate system;
[0164] Step S2: calibrating the grinding unit of the additive component by using a laser tracker to obtain the position coordinates of the grinding unit in the laser tracker coordinate system;
[0165] Step S3: determining the coordinate conversion relationship inside the laser scanning unit through conversion calculation, calibrating the laser scanning unit, and establishing the conversion relationship between the laser scanning unit coordinate system and the system coordinate system;
[0166] Step S4: Establish a conversion relationship between the robot coordinate system, the laser tracker coordinate system, and the laser scanning unit coordinate system and the system coordinate system, so that the process of polishing the additive parts is carried out in the same system coordinate system.
[0167] The step S1 comprises:
[0168] Step S1.1: When the grinding robot is at the preset initial position, the center of the grinding robot base is taken as the center point O B , with the vertical direction of the base as the Z-axis direction, the direction of the grinding robot arm as the X-axis direction, and the Y-axis direction perpendicular to the X-axis direction, establish the robot coordinate system O B X B Y B Z B , and the robot coordinate system is used as the system coordinate system;
[0169] Step S1.2: Take the top center of the laser tracker as the center of the circle O T , the X-axis, Y-axis, and Z-axis of the robot coordinate system are the X-axis, Y-axis, and Z-axis directions of the laser tracker coordinate system, and the laser tracker coordinate system is established as T X T Y T Z T ; The target ball is set at the end of the forearm of the polishing robot. At the initial position, the center of the target ball is P C , using the laser tracker to measure its coordinates in the laser tracker coordinate system
[0170] Step S1.3: by presetting three single-axis rotations, three sets of target ball center coordinate points are obtained, and the least square method is used to perform spatial circle fitting in sequence, and the three fitted circles obtained are small circle, middle circle and large circle;
[0171] Specifically, the polishing robot is placed in an initial position, and the corresponding joints of the robot are rotated so that the target ball can rotate around the coordinate axes of the robot coordinate system respectively, and the trajectory of the target ball center is measured by a laser tester to obtain three sets of target ball center coordinate sets;
[0172] Among them, around Z B The target ball trajectory circle when the axis rotates is called a great circle; B The trajectory of the target ball when rotating around the X axis is called the mid-circle; B The trajectory of the target ball when the axis rotates is called the small circle;
[0173] Get the center of the small circle O in the laser tracker coordinate system S The coordinates are O S T , the unit normal vector of the circular plane is n M , the unit normal vector of the great circle plane is n L , the radius of the large circle is R L ;
[0174] Step S1.4: Calculate the rotation matrix R: According to the parameter information of the small circle, the middle circle and the large circle, establish the rotation relationship transformation between the robot coordinate system and the laser tracker coordinate system;
[0175] Specifically, according to the corresponding geometric relationship, the great circle unit normal vector n L Parallel and coaxial to robot O B Z B Direction; In the laser tracker coordinate system, the robot O B Z B The unit direction vector is equal to the great circle unit normal vector, that is, n ZRB =n L , n ZRB For Robot O B Z B The unit direction vector of the circle; the unit normal vector n M Parallel and coaxial to robot O B Y B Direction; that is, n YRB =n M , n YRB For Robot O B Y B The unit direction vector of the small circle; the unit normal vector n S Parallel and coaxial to robot O B X B Direction; that is, n XRB =n YRB ×n ZRB =n M ×n L , n XRB For Robot O B X B The unit direction vector of ;
[0176] After obtaining the unit vector of the coordinate axis direction of the robot coordinate system, construct the rotation matrix R of the robot coordinate system and the laser tracker coordinate system:
[0177] R=[n XRB n YRB n ZRB ]=[n M ×n L n M n L ]
[0178] Step S1.5: Calculate the translation matrix T: In the robot coordinate system, the center point of the robot target ball is P0 RB , the coordinates in the laser tracker coordinate system are In the laser tracker coordinate system, the initial position of the target ball center is P C The coordinates of The laser tracker obtains the relative position of the target ball center in the laser tracker coordinate system. S To the initial point P C The vector is O S P C , the big circle and the small circle intersect at point P C ;
[0179] P in the robot coordinate system C Relative to the center point P0 of the target ball RB The coordinate offset is Δ=[Δ X Δ Y Δ Z ] T , specifically:
[0180]
[0181] The components of Δ on the coordinate axis are:
[0182]
[0183] Δ Y =O S P C ·n YRB
[0184] Δ Z =O S P C ·n ZRB
[0185] In the robot coordinate system, the center of the small circle is O S Point to the origin of the coordinate system O B The vector is:
[0186]
[0187] Small circle center O S Coordinate O in the laser tracker coordinate system S T , get the origin of the robot coordinate system O B Coordinates in the tracker coordinate system:
[0188] Get the translation vector:
[0189] Step S1.6: Determine the transformation relationship between the robot and laser tracker coordinate systems through the rotation matrix R and the translation matrix T, model the polishing robot and the laser tracker system, and calibrate the polishing robot using the robot coordinate system as the system coordinate system.
[0190] The step S2 comprises:
[0191] Step S2.1: calibrating the rotation center position of the contact wheel of the grinding tool in the grinding unit in the grinding unit coordinate system;
[0192] Step S2.2: Use a laser tracker to calibrate the grinding unit of the additive component to determine the position of the grinding unit in the laser tracker coordinate system.
[0193] The step S3 comprises:
[0194] Step S3.1: The laser scanning unit includes a laser scanner and a four-degree-of-freedom platform. The measurement coordinate system of the laser scanner is defined as {C}, and the coordinate system of the four-degree-of-freedom platform is defined as {M};
[0195] The directions of the four-degree-of-freedom platform include the directions of the X-axis, the Y-axis, the Z-axis and the rotation direction of a rotation axis, the rotation axis is fixed to the motion component in the Y-axis direction, the laser scanner is fixed to the rotation axis, and can drive the laser scanner to rotate;
[0196] Step S3.2: Set a calibration ball at a fixed position, where the coordinates of the center of the calibration ball are C c , with a radius of R c , any point in the spherical point cloud is P ci , in P ci With R c Given the known situation, find C c value;
[0197] The calibration sphere is measured by moving the four-degree-of-freedom platform twice. Specifically, a straight-through filter is used to select a point set on the calibration sphere so that any point P in the point set ci (x pci ,y pci ,z pci ) all satisfy the following equation, i is an integer greater than 1, and all points in the point set are substituted into the following equation to form a nonlinear over-constrained system of equations. The center P of the sphere is obtained using the Levenberg-Marquardt method. ci The least squares solution of , thus performing standard sphere measurement;
[0198]
[0199] x cc is the x-direction value of the center of the calibration ball; y cc is the y-direction value of the center of the calibration sphere; cc is the z-direction value of the center of the calibration sphere;
[0200] Step S3.3: After the first move, the value of the center of the fitted calibration ball at {C} is CP1; After the second move, the value of the center of the calibration ball in {C} C P2; the Euler angles are C α, C β, C γ, then About C α, C β, C The matrix function of γ is is the homogeneous transformation matrix between {M} and {C}; They are the three coordinate axes of {M}, from C P1 to C P2 establishes the equation as follows:
[0201]
[0202] where d x , d y , d z The movement of the X-axis, Y-axis, and Z-axis of the four-degree-of-freedom platform respectively; the Euler angle is obtained C α, C β, C After the value of γ is determined, the conversion relationship between {M} and {C} is established to obtain the laser scanning unit coordinate system;
[0203] Step S3.4: Establish the conversion between the laser scanning unit and the robot coordinate system; scan the complex curved surface workpiece on the polishing robot and the tooling through the laser scanning unit, load the scanned information into the PC, and calculate it through the PC coordinate conversion algorithm to establish the coordinate conversion relationship between the robot coordinate system, the laser scanning unit coordinate system and the system coordinate system, so that the point cloud of different complex curved surface workpieces is converted from the laser scanning coordinate system data coordinates to the system coordinate system.
[0204] The step S3.2 comprises:
[0205] Place the calibration ball at the preset position, keep the rotation axis at a fixed angle, and scan the calibration ball with a laser scanner;
[0206] Specifically, the four-degree-of-freedom platform is moved along the X-axis, Y-axis, and Z-axis for the first time so that the calibration sphere is located on the left side of the field of view of the laser scanner, and the calibration sphere is scanned to obtain a point cloud data set {D1}; the four-degree-of-freedom platform is moved along the X-axis, Y-axis, and Z-axis for the second time so that the calibration sphere is located on the right side of the field of view of the laser scanner, and the point cloud data set {D2} is recorded.
[0207] The present invention also provides a calibration system for an additive manufacturing complex parts grinding robot. The calibration system for the additive manufacturing complex parts grinding robot can be implemented by executing the process steps of the calibration method for the additive manufacturing complex parts grinding robot. That is, technical personnel in this field can understand the calibration method for the additive manufacturing complex parts grinding robot as a preferred implementation of the calibration system for the additive manufacturing complex parts grinding robot.
[0208] A calibration system for a grinding robot for complex parts in additive manufacturing comprises: a module M1: determining the conversion relationship between a robot coordinate system and a laser tracker coordinate system, calibrating the grinding robot, and taking the robot coordinate system as the system coordinate system; a module M2: calibrating a grinding unit for additive parts by means of a laser tracker to obtain the position coordinates of the grinding unit in the laser tracker coordinate system; a module M3: determining the coordinate conversion relationship inside a laser scanning unit by means of conversion calculation, calibrating the laser scanning unit at the same time, and establishing a conversion relationship between the laser scanning unit coordinate system and the system coordinate system; a module M4: establishing a conversion relationship between the robot coordinate system, the laser tracker coordinate system, and the laser scanning unit coordinate system and the system coordinate system, so that the process of grinding additive parts is carried out in the same system coordinate system.
[0209] Specifically, the module M1 includes: Module M1.1: When the polishing robot is at a preset initial position, the center of the polishing robot base is taken as the center point O B , with the vertical direction of the base as the Z-axis direction, the direction of the grinding robot arm as the X-axis direction, and the Y-axis direction perpendicular to the X-axis direction, establish the robot coordinate system O B X B Y B Z B Module M1.2: The center of the top of the laser tracker is the center of the circle O T , the X-axis, Y-axis, and Z-axis of the robot coordinate system are the X-axis, Y-axis, and Z-axis directions of the laser tracker coordinate system, and the laser tracker coordinate system is established as T X T Y T Z T ; The target ball is set at the end of the forearm of the polishing robot. At the initial position, the center of the target ball is P C , using the laser tracker to measure its coordinates in the laser tracker coordinate system Module M1.3: By presetting three single-axis rotations, three sets of target ball center coordinate points are obtained. The least square method is used to perform spatial circle fitting in sequence. The three fitted circles obtained are small circle, middle circle and large circle respectively. Specifically, the polishing robot is placed in the initial position, and the corresponding joints of the robot are rotated so that the target ball can rotate around the coordinate axis of the robot coordinate system respectively. The trajectory of the target ball center is measured by a laser tester to obtain three sets of target ball center coordinate sets. Among them, the coordinates around Z B The target ball trajectory circle when the axis rotates is called a great circle; B The trajectory of the target ball when rotating around the X axis is called the mid-circle; B The trajectory of the target ball when rotating around the X axis is called a small circle; the trajectory of the target ball when rotating around the X axis is called a small circle; the center of the small circle in the laser tracker coordinate system is obtained S The coordinates are O S T , the unit normal vector of the circular plane is n M , the unit normal vector of the great circle plane is n L , the radius of the large circle is R L Module M1.4: Calculate the rotation matrix R: According to the parameter information of the small circle, the middle circle, and the large circle, establish the rotation relationship transformation between the robot coordinate system and the laser tracker coordinate system; specifically, according to the corresponding geometric relationship, the large circle unit normal vector n L Parallel and coaxial to robot O B Z B Direction; In the laser tracker coordinate system, the robot O B Z B The unit direction vector is equal to the great circle unit normal vector, that is, n ZRB =n L , n ZRB For Robot O B Z B The unit direction vector of the circle; the unit normal vector n M Parallel and coaxial to robot O B Y B Direction; that is, n YRB =n M , n YRB For Robot O B Y B The unit direction vector of the small circle; the unit normal vector n s Parallel and coaxial to robot O B X B Direction; that is, n XRB =n YRB ×n ZRB =n M ×n L , n XRB For Robot O B X BAfter obtaining the unit vector of the coordinate axis direction of the robot coordinate system, the rotation matrix R of the robot coordinate system and the laser tracker coordinate system is constructed:
[0210] R=[n XRB n YRB n ZRB ]=[n M ×n L n M n L ]
[0211] Module M1.5: Calculate the translation matrix T: In the robot coordinate system, the center point of the robot target ball is P0 RB , the coordinates in the laser tracker coordinate system are In the laser tracker coordinate system, the initial position of the target ball center is P C The coordinates of The laser tracker obtains the relative position of the target ball center in the laser tracker coordinate system. S To the initial point P C The vector is O S P C , the big circle and the small circle intersect at point P C ; P in the robot coordinate system C Relative to the center of the target ball The coordinate offset is Δ=[Δ X Δ Y Δ Z ] T , specifically:
[0212]
[0213] The components of Δ on the coordinate axis are:
[0214]
[0215] Δ Y =O S P C ·n YRB
[0216] Δ Z =O S P C ·n ZRB
[0217] In the robot coordinate system, the center of the small circle is O S Point to the origin of the coordinate system O B The vector is:
[0218]
[0219] Small circle center O S Coordinate O in the laser tracker coordinate system S T , get the origin of the robot coordinate system O B Coordinates in the tracker coordinate system:
[0220] Get the translation vector:
[0221] Module M1.6: Determine the transformation relationship between the robot and laser tracker coordinate systems through the rotation matrix R and translation matrix T, model the polishing robot and laser tracker system, and calibrate the polishing robot using the robot coordinate system as the system coordinate system.
[0222] Specifically, the module M2 includes: module M2.1: calibrating the rotation center position of the contact wheel of the grinding tool in the grinding unit in the grinding unit coordinate system; module M2.2: calibrating the additive component grinding unit using a laser tracker to determine the position of the grinding unit in the laser tracker coordinate system.
[0223] Specifically, the module M3 includes: module M3.1: the laser scanning unit includes a laser scanner and a four-degree-of-freedom platform, the measurement coordinate system of the laser scanner is defined as {C}, and the coordinate system of the four-degree-of-freedom platform is defined as {M}; wherein the directions of the four-degree-of-freedom platform include the directions of the X-axis, the Y-axis, the Z-axis and the rotation direction of a rotation axis; module M3.2: a calibration ball is set at a fixed position, wherein the coordinates of the center of the calibration ball are C c , with a radius of R c , any point in the spherical point cloud is P ci , in P ci With R c Given the known situation, find C c value; measure the calibration sphere by moving the four-degree-of-freedom platform twice; specifically, use straight-through filtering to select a point set on the calibration sphere so that any point P in the point set ci (x pci ,y pci ,z pci ) all satisfy the following formula, i is an integer greater than 1, and all points in the point set are substituted into the following formula for standard ball measurement;
[0224] (x pci -x cc ) 2 +(y pci -y cc ) 2 +(z pci -z cc ) 2=R c 2
[0225] x cc is the x-direction value of the center of the calibration ball; y cc is the y-direction value of the center of the calibration sphere; cc is the z-direction value of the center of the calibration ball; Module M3.3: After the first movement, the value of the center of the calibration ball at {C} is C P1; After the second move, the value of the center of the calibration ball in {C} C P2; the Euler angles are C α, C β, C γ, then For about C α, C β, C The matrix function of γ is is the homogeneous transformation matrix between {M} and {C}; They are the three coordinate axes of {M}, from C P1 to C P2 establishes the equation as follows:
[0226]
[0227] where d x , d y , d z The movement of the X-axis, Y-axis, and Z-axis of the four-degree-of-freedom platform respectively; the Euler angle is obtained C α, C β, C After determining the value of γ, the conversion relationship between {M} and {C} is established to obtain the laser scanning unit coordinate system; Module M3.4: Establish the conversion between the laser scanning unit and the robot coordinate system; Use the laser scanning unit to scan the complex curved surface workpiece on the polishing robot and the tooling, load the scanned information into the PC, and use the PC coordinate conversion algorithm to calculate, establish the coordinate conversion relationship between the robot coordinate system, the laser scanning unit coordinate system and the system coordinate system, and transform the point cloud of different complex curved surface workpieces from the laser scanning coordinate system data coordinates to the system coordinate system.
[0228] Specifically, the module M3.2 includes: placing the calibration ball at a preset position, keeping the rotation axis at a fixed angle, and scanning the calibration ball with a laser scanner; specifically, moving the four-degree-of-freedom platform X-axis, Y-axis, and Z-axis for the first time so that the calibration ball is located on the left side of the field of view of the laser scanner, scanning the calibration ball, and obtaining a point cloud data set {D1}; moving the four-degree-of-freedom platform X-axis, Y-axis, and Z-axis for the second time so that the calibration ball is located on the right side of the field of view of the laser scanner, and recording the point cloud data set {D2}.
[0229] Those skilled in the art know that, in addition to realizing the system and its various devices, modules, and units provided by the present invention in a purely computer-readable program code, it is entirely possible to realize the same functions in the form of logic gates, switches, application-specific integrated circuits, programmable logic controllers, and embedded microcontrollers by logically programming the method steps. Therefore, the system and its various devices, modules, and units provided by the present invention can be considered as a hardware component, and the devices, modules, and units included therein for realizing various functions can also be regarded as structures within the hardware component; the devices, modules, and units for realizing various functions can also be regarded as both software modules for realizing the method and structures within the hardware component.
[0230] The above describes the specific embodiments of the present invention. It should be understood that the present invention is not limited to the above specific embodiments, and those skilled in the art can make various changes or modifications within the scope of the claims, which does not affect the essence of the present invention. In the absence of conflict, the embodiments of the present application and the features in the embodiments can be combined with each other arbitrarily.
Claims
1. A calibration method for a robot for grinding complex parts in additive manufacturing, characterized in that: include: Step S1: determine the conversion relationship between the robot coordinate system and the laser tracker coordinate system, calibrate the polishing robot, and use the robot coordinate system as the system coordinate system; Step S2: calibrating the grinding unit of the additive component by using a laser tracker to obtain the position coordinates of the grinding unit in the laser tracker coordinate system; Step S3: determining the coordinate conversion relationship inside the laser scanning unit through conversion calculation, calibrating the laser scanning unit, and establishing the conversion relationship between the laser scanning unit coordinate system and the system coordinate system; Step S4: Establish a conversion relationship between the robot coordinate system, the laser tracker coordinate system, and the laser scanning unit coordinate system and the system coordinate system, so that the process of polishing the additive parts is carried out in the same system coordinate system.
2. The calibration method of the additive manufacturing complex parts grinding robot according to claim 1 is characterized in that: The step S1 comprises: Step S1.1: When the grinding robot is at the preset initial position, the center of the grinding robot base is taken as the center point O B , with the vertical direction of the base as the Z-axis direction, the direction of the grinding robot arm as the X-axis direction, and the Y-axis direction perpendicular to the X-axis direction, establish the robot coordinate system O B X B Y B Z B , and the robot coordinate system is used as the system coordinate system; Step S1.2: Take the top center of the laser tracker as the center of the circle O T , the X-axis, Y-axis, and Z-axis of the robot coordinate system are the X-axis, Y-axis, and Z-axis directions of the laser tracker coordinate system, and the laser tracker coordinate system is established as T X T Y T Z T ; The target ball is set at the end of the grinding robot arm. At the initial position, the center of the target ball is P C , using the laser tracker to measure its coordinates in the laser tracker coordinate system Step S1.3: by presetting three single-axis rotations, three sets of target ball center coordinate points are obtained, and the least square method is used to perform spatial circle fitting in sequence, and the three fitted circles obtained are small circle, middle circle and large circle; Specifically, the polishing robot is placed in an initial position, and the corresponding joints of the robot are rotated so that the target ball can rotate around the coordinate axes of the robot coordinate system respectively, and the trajectory of the target ball center is measured by a laser tester to obtain three sets of target ball center coordinate sets; Among them, around Z B The target ball trajectory circle when the axis rotates is called a great circle; B The trajectory of the target ball when rotating around the X axis is called the mid-circle; B The trajectory of the target ball when the axis rotates is called the small circle; Get the center of the small circle O in the laser tracker coordinate system S The coordinates are The unit normal vector of the circular plane is n M , the unit normal vector of the great circle plane is n L , the radius of the large circle is R L ; Step S1.4: Calculate the rotation matrix R: According to the parameter information of the small circle, the middle circle and the large circle, establish the rotation relationship transformation between the robot coordinate system and the laser tracker coordinate system; Specifically, according to the corresponding geometric relationship, the great circle unit normal vector n L Parallel and coaxial to robot O B Z B Direction; In the laser tracker coordinate system, the robot O B Z B The unit direction vector is equal to the great circle unit normal vector, that is, n ZRB =n L , n ZRB For Robot O B Z B The unit direction vector of the circle; the unit normal vector n M Parallel and coaxial to robot O B Y B Direction; that is, n YRB =n M , n YRB For Robot O B Y B The unit direction vector of the small circle; the unit normal vector n S Parallel and coaxial to robot O B X B Direction; that is, n XRB =n YRB ×n ZRB =n M ×n L , n XRB For Robot O B X B The unit direction vector of ; After obtaining the unit vector of the coordinate axis direction of the robot coordinate system, construct the rotation matrix R of the robot coordinate system and the laser tracker coordinate system: R=[n XRB n YRB n ZRB ]=[n M ×n L n M n L ] Step S1.5: Calculate the translation matrix T: In the robot coordinate system, the center point of the robot target ball is The coordinates in the laser tracker coordinate system are In the laser tracker coordinate system, the initial position of the target ball center is P C The coordinates of The laser tracker obtains the relative position of the target ball center in the laser tracker coordinate system. S To the initial point P C The vector is O S P C , the big circle and the small circle intersect at point P C ; P in the robot coordinate system C Relative to the center of the target ball The coordinate offset is Δ=[Δ X Δ Y Δ Z ] T , specifically: The components of Δ on the coordinate axis are: D Y =O S P C ·n YRB D Z =O S P C ·n ZRB In the robot coordinate system, the center of the small circle is O S Point to the origin of the coordinate system O B The vector is: Small circle center O S Coordinates in the laser tracker coordinate system Get the robot coordinate system origin O B Coordinates in the tracker coordinate system: Get the translation vector: Step S1.6: Determine the transformation relationship between the robot and laser tracker coordinate systems through the rotation matrix R and the translation matrix T, model the polishing robot and the laser tracker system, and calibrate the polishing robot using the robot coordinate system as the system coordinate system.
3. The calibration method of the additive manufacturing complex parts grinding robot according to claim 1 is characterized in that: The step S2 comprises: Step S2.1: calibrating the rotation center position of the contact wheel of the grinding tool in the grinding unit in the grinding unit coordinate system; Step S2.2: Use a laser tracker to calibrate the grinding unit of the additive component to determine the position of the grinding unit in the laser tracker coordinate system.
4. The calibration method of the additive manufacturing complex parts grinding robot according to claim 1 is characterized in that: The step S3 comprises: Step S3.1: The laser scanning unit includes a laser scanner and a four-degree-of-freedom platform. The measurement coordinate system of the laser scanner is defined as {C}, and the coordinate system of the four-degree-of-freedom platform is defined as {M}; Among them, the directions of the four-degree-of-freedom platform include the directions of the X-axis, the Y-axis, the Z-axis and the rotation direction of one rotation axis; Step S3.2: Set a calibration ball at a fixed position, where the coordinates of the center of the calibration ball are C c , with a radius of R c , any point in the spherical point cloud is P ci , in P ci With R c Given the known situation, find C c value; The calibration sphere is measured by moving the four-degree-of-freedom platform twice. Specifically, a straight-through filter is used to select a point set on the calibration sphere so that any point P in the point set ci (x pci ,y pci ,z pci ) all satisfy the following formula, i is an integer greater than 1, and all points in the point set are substituted into the following formula for standard ball measurement; x cc is the x-direction value of the center of the calibration ball; y cc is the y-direction value of the center of the calibration sphere; cc is the z-direction value of the center of the calibration sphere; Step S3.3: After the first move, the value of the center of the fitted calibration ball at {C} is C P1; After the second move, the value of the center of the calibration ball in {C} C P2; the Euler angles are C α, C β, C γ, then For about C α, C β, C The matrix function of γ is is the homogeneous transformation matrix between {M} and {C}; They are the three coordinate axes of {M}, from C P1 to C P2 establishes the equation as follows: where d x , d y , d z The movement of the four-degree-of-freedom platform on the X-axis, Y-axis, and Z-axis respectively; the Euler angle is obtained C α, C β, C After the value of γ is determined, the conversion relationship between {M} and {C} is established to obtain the laser scanning unit coordinate system; Step S3.4: Establish the conversion between the laser scanning unit and the robot coordinate system; scan the complex curved surface workpiece on the polishing robot and the tooling through the laser scanning unit, load the scanned information into the PC, and calculate it through the PC coordinate conversion algorithm to establish the coordinate conversion relationship between the robot coordinate system, the laser scanning unit coordinate system and the system coordinate system, so that the point cloud of different complex curved surface workpieces is converted from the laser scanning coordinate system data coordinates to the system coordinate system.
5. The calibration method of the additive manufacturing complex parts grinding robot according to claim 4 is characterized in that: The step S3.2 comprises: Place the calibration ball at the preset position, keep the rotation axis at a fixed angle, and scan the calibration ball with a laser scanner; Specifically, the four-degree-of-freedom platform is moved along the X-axis, Y-axis, and Z-axis for the first time so that the calibration sphere is located on the left side of the field of view of the laser scanner, and the calibration sphere is scanned to obtain a point cloud data set {D1}; the four-degree-of-freedom platform is moved along the X-axis, Y-axis, and Z-axis for the second time so that the calibration sphere is located on the right side of the field of view of the laser scanner, and the point cloud data set {D2} is recorded.
6. A calibration system for a robot for grinding complex parts in additive manufacturing, characterized in that: include: Module M1: Determine the conversion relationship between the robot coordinate system and the laser tracker coordinate system, calibrate the polishing robot, and use the robot coordinate system as the system coordinate system; Module M2: Calibrate the grinding unit of the additive component through the laser tracker to obtain the position coordinates of the grinding unit in the laser tracker coordinate system; Module M3: Determine the coordinate transformation relationship inside the laser scanning unit through conversion calculation, calibrate the laser scanning unit, and establish the transformation relationship between the laser scanning unit coordinate system and the system coordinate system; Module M4: The robot coordinate system, laser tracker coordinate system, and laser scanning unit coordinate system are all transformed into the system coordinate system, so that the process of polishing additive parts is carried out in the same system coordinate system.
7. The calibration system for the additive manufacturing complex parts grinding robot according to claim 6, characterized in that: The module M1 comprises: Module M1.1: When the grinding robot is in the preset initial position, the center of the grinding robot base is the center point O B , with the vertical direction of the base as the Z-axis direction, the direction of the grinding robot arm as the X-axis direction, and the Y-axis direction perpendicular to the X-axis direction, establish the robot coordinate system O B X B Y B Z B , and the robot coordinate system is used as the system coordinate system; Module M1.2: Take the top center of the laser tracker as the center of the circle O T , the X-axis, Y-axis, and Z-axis of the robot coordinate system are the X-axis, Y-axis, and Z-axis directions of the laser tracker coordinate system, and the laser tracker coordinate system is established as T X T Y T Z T ; The target ball is set at the end of the forearm of the polishing robot. At the initial position, the center of the target ball is P C , using the laser tracker to measure its coordinates in the laser tracker coordinate system Module M1.3: By presetting three single-axis rotations, three sets of target ball center coordinate points are obtained, and the least square method is used to perform spatial circle fitting in sequence. The three fitted circles obtained are small circle, middle circle and large circle respectively; Specifically, the polishing robot is placed in an initial position, and the corresponding joints of the robot are rotated so that the target ball can rotate around the coordinate axes of the robot coordinate system respectively, and the trajectory of the target ball center is measured by a laser tester to obtain three sets of target ball center coordinate sets; Among them, around Z B The target ball trajectory circle when the axis rotates is called a great circle; B The trajectory of the target ball when rotating around the X axis is called the mid-circle; B The trajectory of the target ball when the axis rotates is called the small circle; Get the center of the small circle O in the laser tracker coordinate system S The coordinates are O S T , the unit normal vector of the circular plane is n M , the unit normal vector of the great circle plane is n L , the radius of the large circle is R L ; Module M1.4: Calculate the rotation matrix R: According to the parameter information of the small circle, the middle circle and the large circle, establish the rotation relationship transformation between the robot coordinate system and the laser tracker coordinate system; Specifically, according to the corresponding geometric relationship, the great circle unit normal vector n L Parallel and coaxial to robot O B Z B Direction; In the laser tracker coordinate system, the robot O B Z B The unit direction vector is equal to the great circle unit normal vector, that is, n ZRB =n L , n ZRB For Robot O B Z B The unit direction vector of the circle; the unit normal vector n M Parallel and coaxial to robot O B Y B Direction; that is, n YRB =n M , n YRB For Robot O B Y B The unit direction vector of the small circle; the unit normal vector n S Parallel and coaxial to robot O B X B Direction; that is, n XRB =n YRB ×n ZRB =n M ×n L , n XRB For Robot O B X B The unit direction vector of ; After obtaining the unit vector of the coordinate axis direction of the robot coordinate system, construct the rotation matrix R of the robot coordinate system and the laser tracker coordinate system: R=[n XRB n YRB n ZRB ]=[n M ×n L n M n L ] Module M1.5: Calculate the translation matrix T: In the robot coordinate system, the center point of the robot target ball is The coordinates in the laser tracker coordinate system are In the laser tracker coordinate system, the initial position of the target ball center is P C The coordinates of The laser tracker obtains the relative position of the target ball center in the laser tracker coordinate system. S To the initial point P C The vector is O S P C , the big circle and the small circle intersect at point P C ; P in the robot coordinate system C Relative to the center of the target ball The coordinate offset is Δ=[Δ X Δ Y Δ Z ] T , specifically: The components of Δ on the coordinate axis are: In the robot coordinate system, the center of the small circle is O S Point to the origin of the coordinate system O B The vector is: Small circle center O S Coordinates in the laser tracker coordinate system Get the robot coordinate system origin O B Coordinates in the tracker coordinate system: Get the translation vector: Module M1.6: Determine the transformation relationship between the robot and laser tracker coordinate systems through the rotation matrix R and translation matrix T, model the polishing robot and laser tracker system, and calibrate the polishing robot using the robot coordinate system as the system coordinate system.
8. The calibration system for the additive manufacturing complex parts polishing robot according to claim 6, characterized in that: The module M2 comprises: Module M2.1: Calibrate the rotation center position of the contact wheel of the grinding tool in the grinding unit in the grinding unit coordinate system; Module M2.2: Use the laser tracker to calibrate the grinding unit of the additive component and determine the position of the grinding unit in the laser tracker coordinate system.
9. The calibration system for the additive manufacturing complex parts polishing robot according to claim 6, characterized in that: The module M3 comprises: Module M3.1: The laser scanning unit includes a laser scanner and a four-degree-of-freedom platform. The measurement coordinate system of the laser scanner is defined as {C}, and the coordinate system of the four-degree-of-freedom platform is defined as {M}; Among them, the directions of the four-degree-of-freedom platform include the directions of the X-axis, the Y-axis, the Z-axis and the rotation direction of one rotation axis; Module M3.2: Set a calibration ball at a fixed position, where the center coordinate of the calibration ball is C c , with a radius of R c , any point in the spherical point cloud is P ci , in P ci With R c Given the known situation, find C c value; The calibration sphere is measured by moving the four-degree-of-freedom platform twice. Specifically, a straight-through filter is used to select a point set on the calibration sphere so that any point P in the point set ci (x pci ,y pci ,z pci ) all satisfy the following formula, i is an integer greater than 1, and all points in the point set are substituted into the following formula for standard ball measurement; x cc is the x-direction value of the center of the calibration ball; y cc is the y-direction value of the center of the calibration sphere; cc is the z-direction value of the center of the calibration sphere; Module M3.3: After the first move, the value of the center of the fitted calibration ball at {C} is C P1; After the second move, the value of the center of the calibration ball in {C} C P2; the Euler angles are C α, C β, C γ, then For about C α, C β, C The matrix function of γ is is the homogeneous transformation matrix between {M} and {C}; They are the three coordinate axes of {M}, from C P1 to C P2 establishes the equation as follows: where d x , d y , d z The movement of the four-degree-of-freedom platform on the X-axis, Y-axis, and Z-axis respectively; the Euler angle is obtained C α, C β, C After the value of γ is determined, the conversion relationship between {M} and {C} is established to obtain the laser scanning unit coordinate system; Module M3.4: Establish the conversion between the laser scanning unit and the robot coordinate system; scan the complex curved surface workpiece on the polishing robot and the tooling through the laser scanning unit, load the scanned information into the PC, and calculate it through the PC coordinate conversion algorithm to establish the coordinate conversion relationship between the robot coordinate system, the laser scanning unit coordinate system and the system coordinate system, so that the point cloud of different complex curved surface workpieces is converted from the laser scanning coordinate system data coordinates to the system coordinate system.
10. The calibration system for the additive manufacturing complex parts polishing robot according to claim 9, characterized in that: The module M3.2 includes: Place the calibration ball at the preset position, keep the rotation axis at a fixed angle, and scan the calibration ball with a laser scanner; Specifically, the four-degree-of-freedom platform is moved along the X-axis, Y-axis, and Z-axis for the first time so that the calibration sphere is located on the left side of the field of view of the laser scanner, and the calibration sphere is scanned to obtain a point cloud data set {D1}; the four-degree-of-freedom platform is moved along the X-axis, Y-axis, and Z-axis for the second time so that the calibration sphere is located on the right side of the field of view of the laser scanner, and the point cloud data set {D2} is recorded.
Citation Information
Patent Citations
System calibration method for off-line programming of grinding robot
CN108994830A
Laser tracker and structured light 3D scanner combined measurement and calibration method
CN110440692A
Complex curved surface space coordinate and scanning coordinate conversion device, system and method
CN114367993A
High-precision robot hand-eye calibration method and system based on guidance of laser tracker
CN118061202A
Robot system and calibration method
JP2019098409A
Cited By
Robot magneto-rheological polishing TCP calibration method based on three-coordinate measurement
CN120395540A
TCP calibration method for robot small grinding head machining based on three-coordinate measurement
CN120551851A
Shoe edge polishing equipment and contour calibration method and device thereof
CN121014982A
