CN115371564A - Method and system for calibrating relative pose of linear laser sensor and robot flange plate - Google Patents
Method and system for calibrating relative pose of linear laser sensor and robot flange plate Download PDFInfo
- Publication number
- CN115371564A CN115371564A CN202211307719.0A CN202211307719A CN115371564A CN 115371564 A CN115371564 A CN 115371564A CN 202211307719 A CN202211307719 A CN 202211307719A CN 115371564 A CN115371564 A CN 115371564A
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- laser sensor
- robot
- axis
- dynamic tracking
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B11/00—Measuring arrangements characterised by the use of optical techniques
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B11/00—Measuring arrangements characterised by the use of optical techniques
- G01B11/002—Measuring arrangements characterised by the use of optical techniques for measuring two or more coordinates
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Length Measuring Devices By Optical Means (AREA)
Abstract
The invention discloses a method and a system for calibrating the relative pose of a linear laser sensor and a robot flange plate, and relates to a technology for calibrating the relative pose of the linear laser sensor and the robot flange plate. The calibration block disclosed by the invention realizes the measurement of the pose of the calibration block through the line laser sensor, and simultaneously utilizes the optical dynamic tracking system and the matched light pen to finish the measurement of the pose of the calibration block, so as to solve and obtain the calibration of the relative pose of the line laser sensor and the robot flange plate. According to the invention, an industrial robot does not need to be moved, the line laser sensor only needs to measure the calibration block once, the calibration can be completed, the calibration solving process is matrix equation operation, the calculation process of the optimal solution does not exist, the calibration is simple, and the result accuracy is high.
Description
Technical Field
The invention belongs to the optical detection technology, and particularly relates to a method and a system for calibrating the relative pose of a linear laser sensor and a robot flange plate.
Background
Along with the development of optical detection technique and industrial robot technique, adopt industrial robot to carry optical detection equipment and can realize automatic monitoring for industrial robot has certain perception ability. The line laser sensor can realize the measurement of two-dimensional space, combines the motion of industrial robot, can realize the collection and the measurement of three-dimensional space object point cloud, has non-contact, high accuracy, efficient advantage. The point cloud data collected by the line laser sensor is based on the coordinate system of the point cloud data, and in order to realize the combination of the industrial robot and the line laser sensor, the calibration of the relative pose of the line laser sensor and the industrial robot flange plate needs to be completed, so that the conversion of the point cloud data to be measured from the coordinate system of the line laser sensor to the base coordinate system of the industrial robot is realized. The calibration precision of the relative pose of the linear laser sensor and the industrial robot flange directly influences the detection accuracy.
The traditional method for calibrating the relative pose of the linear laser sensor and the industrial robot flange plate is mainly a standard sphere method, and the method cannot obtain the pose relation of a calibration object relative to the linear laser sensor through one-time measurement of the linear laser sensor, so that the pose of the industrial robot needs to be adjusted for many times, the linear laser sensor measures standard spheres with different poses, the kinematic error of the industrial robot is introduced in the calibration process, and meanwhile, the optimal solution calculation needs to be carried out in the calibration process, so that the operation is complex, and the calibration precision is low.
Disclosure of Invention
The invention provides a method and a system for calibrating the relative pose of a linear laser sensor and a robot flange plate, which aim to solve the technical problems in the background technology. The problems that the relative pose calibration process of the linear laser sensor and the industrial robot flange plate is complex and the calibration precision is poor are solved, the calibration flow is simplified, and the calibration accuracy is improved.
The invention adopts the following technical scheme: a method for calibrating the relative pose of a line laser sensor and a robot flange plate comprises the following steps:
step one, arranging a robot, a flange plate, a calibration block, a line laser sensor, an optical dynamic tracking system and an optical pen matched with the optical dynamic tracking system according to preset positions;
step two, a calibration test platform is formed by a calibration block, an optical dynamic tracking system and a light pen, the robot is restored to an initial state, and a robot coordinate system, a flange plate coordinate system, a line laser sensor coordinate system, a calibration block coordinate system and an optical dynamic tracking system coordinate system are respectively set as { BF }, { FF }, { LF }, { DF }, and { CF };
step three, respectively solving the matrix transformation relations of { BF } and { FF }, { LF } and { DF }, { DF } and { CF }, { CF } and { BF }, and obtaining the matrix transformation relations of { BF } and { FF }, LF } and { CF }、、、;
Fourthly, based on the matrix transformation relation, calculating by adopting the following formula to obtain the relative pose in the linear laser sensor coordinate system and the flange plate coordinate system:
In a further embodiment, the calibration block comprises:
a body;
at least four groups of semi-cylinders are arranged on the upper surface of the body in a radioactive manner; the included angles between the adjacent semi-cylinders are equal.
In a further embodiment, the predetermined positions are as follows:
the robot and the optical dynamic tracking system are arranged oppositely, and an operation table is arranged in the middle; the flange plate is arranged at the tail end of the robot, and the line laser sensor is arranged on the flange plate;
the calibration block is fixed on the operating table and is positioned in the measuring range of the line laser sensor, so that the line laser sensor can measure any two adjacent semi-cylinders and the upper surface of the body between the two adjacent semi-cylinders simultaneously;
the optical dynamic tracking system simultaneously measures the corresponding positions of the robot and the calibration block.
In a further embodiment, in step threeThe relative pose of the flange coordinate system and the robot coordinate system is calculated as follows:
reading the current flange coordinate system relative to the robot base coordinate systemX、Y、ZCorresponding rotation parameters on three axesCorresponding translation parameterSolving the matrix transformation relation of { FF } relative to { BF } through the following formula:。
in a further embodiment of the method of the invention,for calibrating the relative position and attitude of the coordinate system of the block and the coordinate system of the line laser sensor, the acquisition process comprises the following steps:
obtaining a calibration block measuring point under a line laser sensor coordinate system to obtain first point cloud data, defining two adjacent semi-cylinders measured by the line laser sensor to be a first semi-cylinder and a second semi-cylinder respectively, fitting the cylinders by adopting a least square method, and obtaining data about the first semi-cylinder respectivelyFirst axis of cylinder and second semi-cylinderL 1 And a second axisL 2 The parameter equation is as follows:
Wherein, the first and the second end of the pipe are connected with each other,for any point coordinate on the first half cylinder measured by the line laser sensor,is a first axisL 1 A set of direction numbers of;
for the coordinates of any point on the second semi-cylinder measured by the line laser sensor,is a second axisL 2 A set of direction numbers of; t is a parameter of a parameter equation;
obtaining a straight line based on the first point cloud data and least square fittingL 0 :
Wherein the content of the first and second substances,for any point coordinate within the first point cloud data,is a straight lineL 0 A set of direction numbers of; t is a parameter of a parameter equation;
using a first axisL 1 A second axisL 2 And a straight lineL 0 Constraint conditions on the same plane are solved to obtain a planeP 1 :
(ii) a Wherein the content of the first and second substances,is a planeP 1 The coefficients of the general equation;
will be the first axisL 1 And a second axisL 2 Projected onto a planeP 1 To obtain a first projection lineAnd a second projection line:
Wherein the content of the first and second substances,is a pointIn a planeP 1 The projected coordinates of the optical system are calculated,is a first projection lineA set of direction numbers of;
is a pointIn a planeP 1 The projected coordinates of the optical system are calculated,is the second projection lineA set of direction numbers of;
obtaining a first projection lineAnd a second projection lineIs marked as a pointD 1 (ii) a Setting pointD 1 For calibrating the origin O of the block coordinate system DF Passing through the origin O DF Along the first projection lineSetting X in the coordinate system of the calibration block in the direction DF Axis, passing through origin O DF Along a planeP 1 Setting Y in the coordinate system of the calibration block in the normal direction of DF Axis, Y of calibration block coordinate system obtained according to right hand rule DF Axis, calculating to obtain matrix transformation relation of { DF } relative to { LF }。
In a further embodiment of the method of the invention,the relative pose of the coordinate system of the calibration block and the coordinate system of the optical dynamic tracking system is calculated by the following steps:
measuring the upper surface of the calibration block by using an optical dynamic tracking system and a light pen to obtain a plurality of groups of upper surface measurement points of the calibration block under a coordinate system of the optical dynamic tracking system to obtain second point cloud data, and fitting by adopting a least square method principle to obtain a planeP 2 :WhereinIs a planeThe coefficients of the general equation;
measuring any two adjacent groups of semi-cylinders of the calibration block by using an optical dynamic tracking system and an optical pen to obtain a plurality of groups of point coordinate data of the two adjacent groups of semi-cylinders under a coordinate system of the optical dynamic tracking system; respectively calculating to obtain a first cylinder Q based on a least square method 1 And a second cylinder Q 2 And solving for the first cylinder Q 1 A second cylinder Q 2 Third axis of (2)L 3 And a fourth axisL 4 :
Wherein the content of the first and second substances,for the first cylinder Q in the coordinate system of the optical dynamic tracking system 1 The coordinates of any point on the surface of the object,is a third axisL 3 A set of direction numbers of (a); t is a parameter of a parameter equation;
for the second cylinder Q in the coordinate system of the optical dynamic tracking system 2 The coordinates of any point on the surface of the object,is a fourth axisL 4 A set of direction numbers of;tis a parameter of a parameter equation;
will the third axisL 3 And a fourth axisL 4 Projected onto a planeP 2 Get the third projection lineAnd a fourth projection line:
Wherein the content of the first and second substances,is a pointIn a planeP 2 The projected coordinates of the optical system are calculated,is the third projection lineA set of direction numbers of (a);
is a pointIn a planeP 2 The projected coordinates of the optical system are calculated,is a fourth projection lineA set of direction numbers of;
note the third projection lineAnd a fourth projection lineAt a point of intersection of(ii) a Point recordingFor calibrating the origin of the coordinate system of the block under the coordinate system of the optical dynamic tracking systemPassing through the originAlong the third projection lineThe direction is set in the coordinate system of the calibration blockAxis, passing through originAlong a planeP 2 Is arranged in the coordinate system of the calibration block in the normal directionAxis, namely, a calibration block coordinate system is established under an optical dynamic tracking system coordinate system, and the matrix transformation relation of { DF } relative to { CF } is obtained by solving。
In a further embodiment of the method of the invention,the relative pose of the robot coordinate system and the optical dynamic tracking system coordinate system is obtained in the following mode:
pasting a target point for detection of the optical dynamic tracking system at the tail end of the robot, respectively rotating a first mechanical arm shaft and a second mechanical arm shaft of the robot, recording coordinate values of the target point under a coordinate system of the optical dynamic tracking system for multiple times, establishing a base coordinate system of the robot under the coordinate system of the optical dynamic tracking system, and solving to obtain a matrix transformation relation of { BF } relative to { CF }, wherein。
The utility model provides a line laser sensor and relative position appearance calibration system of robot ring flange, includes:
the tail end of the robot is provided with a flange plate;
the line laser sensor is arranged on the flange plate;
the optical dynamic tracking system is arranged on the opposite surface of the robot; an operation table is arranged between the robot and the optical dynamic tracking system;
the calibration block is fixed on the operating platform; the calibration block includes: a body;
at least four groups of semi-cylinders are arranged on the upper surface of the body in a radioactive manner; the included angles between the adjacent semi-cylinders are equal.
In a further embodiment, the body is provided with at least five groups of threaded holes.
The invention designs the calibration block for calibrating the line laser sensor, and realizes that the relative position and pose relationship between the calibration block and the line laser sensor can be calculated by one-time measurement of the line laser sensor.
The invention has the beneficial effects that: in the process of calibrating the relative pose of the linear laser sensor and the industrial robot flange plate, the industrial robot does not need to be moved, so that the introduction of kinematic errors of the industrial robot is avoided, and the calibration precision is improved; the problems of complex solving process and poor calibration precision of the traditional calibration method are solved.
In the process of calibrating the relative pose of the linear laser sensor and the industrial robot flange, the matrix equation is adopted for solving, optimal solution calculation is not needed, the calibration flow is simplified, and the calibration efficiency of the relative pose of the linear laser sensor and the industrial robot flange is improved.
Drawings
FIG. 1 is a flow chart of the present invention.
Fig. 2 is a schematic diagram of the principle of the method for calibrating the relative pose of the linear laser sensor and the robot flange plate.
FIG. 3 is a diagram of a calibration block according to the present invention.
FIG. 4 is a schematic diagram of the principle of the method for calibrating the relative pose between the coordinate system of the calibration block and the coordinate system of the line laser sensor according to the present invention.
FIG. 5 is a schematic diagram of the principle of the method for calibrating the relative pose between the coordinate system of the calibration block and the coordinate system of the optical dynamic tracking system according to the present invention.
Each of fig. 2 to 5 is labeled as: the robot comprises a robot 1, a flange plate 2, a calibration block 3, a line laser sensor 4, an optical dynamic tracking system 5, an optical pen 6, a body 201, a semi-cylinder 202 and a threaded hole 203.
Detailed Description
For better clarity of the description of the objects, technical solutions and advantages of the present invention, the technical solutions of the present invention will be further described in detail with reference to the accompanying drawings and specific embodiments.
Example 1
As shown in fig. 1 and fig. 2, the embodiment discloses a method for calibrating a relative pose between a line laser sensor and a robot flange, which includes the following steps:
step one, setting a robot, a flange plate, a calibration block, a line laser sensor, an optical dynamic tracking system and an optical pen matched with the optical dynamic tracking system according to preset positions; in the present embodiment, an industrial robot, i.e., a six-degree-of-freedom robot, is employed. The optical dynamic tracking system is a C-Track optical dynamic tracking system.
In order to be able to carry out a measurement of the line laser sensor, the present exemplary embodiment therefore relates to a calibration block adapted thereto, as shown in fig. 3. Wherein, the calibration block includes: the body is provided with at least four groups of semi-cylinders which are arranged in a radioactive manner on the upper surface, and the included angles between the adjacent semi-cylinders are equal. In this embodiment, the base of the calibration block is a rectangular structure, and the upper surface of the base is composed of four semicylinders; the four semi-cylinders are distributed along the center of the upper surface of the base at equal angles, and the included angle of the axes of any two adjacent semi-cylinders is 90 degrees; the calibration block base is provided with five threaded holes for mounting and fixing the calibration block; the calibration block is subjected to finish machining, so that the accuracy of the included angle of the axes of the adjacent semicylinders, the cylindricity of the semicylinders and the flatness of the upper surface of the base is ensured; the calibration block can meet the condition that the linear laser sensor can simultaneously measure any two adjacent semi-cylinders and the upper surface of the base between the adjacent semi-cylinders.
In a further embodiment, the predetermined positions are as follows: the robot and the optical dynamic tracking system are arranged oppositely, and an operation table is arranged in the middle; the flange plate is arranged at the tail end of the robot, and the line laser sensor is arranged on the flange plate; the calibration block is fixed on the operating table and is positioned in the measuring range of the line laser sensor, so that the line laser sensor can measure any two adjacent semi-cylinders and the upper surface of the body between the adjacent semi-cylinders simultaneously; and the optical dynamic tracking system simultaneously measures the corresponding positions of the robot and the calibration block.
Step two, a calibration test platform is formed by a calibration block, an optical dynamic tracking system and a light pen, the robot is restored to an initial state, and a robot coordinate system, a flange plate coordinate system, a line laser sensor coordinate system, a calibration block coordinate system and an optical dynamic tracking system coordinate system are respectively set as { BF }, { FF }, { LF }, { DF }, and { CF };
step three, respectively solving matrix transformation relations of { BF } and { FF }, { LF } and { DF }, { DF } and { CF }, { CF } and { BF } to obtain the relative poses of the flange coordinate system and the robot coordinate systemRelative position and posture of calibration block coordinate system and linear laser sensor coordinate systemRelative position and pose in coordinate system of calibration block and optical dynamic tracking systemRelative position and posture of robot coordinate system and optical dynamic tracking system coordinate system;
Based on the matrix transformation relation, calculating by adopting the following formula to obtain the coordinate system of the linear laser sensor and the coordinate system of the flange plateRelative position and attitude of:
In a further embodiment, the relative pose of the flange coordinate system and the robot coordinate systemThe calculation flow of (2) is as follows: reading the current flange coordinate system relative to the robot base coordinate systemX、Y、ZCorresponding rotation parameters on three axesCorresponding translation parameterSolving the matrix transformation relation of { FF } relative to { BF } through the following formula:
as shown in FIG. 4, the relative pose of the coordinate system of the calibration block and the coordinate system of the line laser sensorThe acquisition process is as follows: obtaining a calibration block measuring point under a line laser sensor coordinate system to obtain first point cloud data, defining two adjacent semi-cylinders measured by the line laser sensor as a first semi-cylinder and a second semi-cylinder respectively, fitting the cylinders by adopting a least square method, and obtaining first axes about the first semi-cylinder and the second semi-cylinder respectivelyL 1 And a second axisL 2 The parameter equation is as follows:
Wherein the content of the first and second substances,for any point coordinate on the first half cylinder measured by the line laser sensor,is a first axisL 1 A set of direction numbers of;
for the coordinates of any point on the second semi-cylinder measured by the line laser sensor,is a second axisL 2 A set of direction numbers of (a); t is a parameter of a parameter equation;
obtaining a straight line based on the first point cloud data and least square fittingL 0 :
Wherein the content of the first and second substances,for arbitrary point coordinates within the first point cloud data,is a straight lineL 0 A set of direction numbers of; t is a parameter of a parameter equation;
using a first axisL 1 A second axisL 2 And a straight lineL 0 Constraint conditions on the same plane are solved to obtain a planeP 1 :
(ii) a Wherein the content of the first and second substances,is a planeP 1 The coefficients of the general equation;
will be the first axisL 1 And a second axisL 2 Projected onto a planeP 1 Get the first projection lineAnd a second projection line:
Wherein the content of the first and second substances,is a pointIn a planeP 1 The projected coordinates of the optical system are calculated,is a first projection lineA set of direction numbers of (a);
is a pointIn a planeP 1 The projected coordinates of the optical system are calculated,is the second projection lineA set of direction numbers of;
obtaining a first projection lineAnd a second projection lineIs marked as a pointD 1 (ii) a Setting pointD 1 For calibrating the origin O of the block coordinate system DF Passing through the origin O DF Along the first projection lineSetting X in the coordinate system of the calibration block in the direction DF Axis, passing through origin O DF Along a planeP 1 Setting Y in the coordinate system of the calibration block in the normal direction DF Axis, obtaining Y of the coordinate system of the calibration block according to the right hand rule DF Axis, calculating to obtain matrix transformation relation of { DF } relative to { LF }。
As shown in FIG. 5, the relative pose in the coordinate system of the calibration block and the coordinate system of the optical dynamic tracking systemThe calculation flow of (2) is as follows: measuring the upper surface of the calibration block by using an optical dynamic tracking system and an optical pen to obtain a plurality of groups of upper surface measuring points of the calibration block under a coordinate system of the optical dynamic tracking system to obtain second point cloud data, and fitting by adopting a least square method principle to obtain a planeP 2 :WhereinIs a planeP 2 The coefficients of the general equation;
measuring any two adjacent groups of semi-cylinders of the calibration block by using an optical dynamic tracking system and an optical pen to obtain a plurality of groups of point coordinate data of the two adjacent groups of semi-cylinders under a coordinate system of the optical dynamic tracking system; based on the least square method, respectively calculating to obtain a first cylinder Q 1 And a second cylinder Q 2 And solving for the first cylinder Q 1 A second cylinder Q 2 Third axis of (2)L 3 And a fourth axisL 4 :
Wherein, the first and the second end of the pipe are connected with each other,for the first cylinder Q in the coordinate system of the optical dynamic tracking system 1 The coordinates of any point on the surface of the object,is a third axisL 3 A set of directionsCounting; t is a parameter of a parameter equation;
for the second cylinder Q in the coordinate system of the optical dynamic tracking system 2 The coordinates of any point on the surface of the object,is a fourth axisL 4 A set of direction numbers of;tis a parameter of a parameter equation;
will be the third axisL 3 And a fourth axisL 4 Projected to a planeP 2 Get the third projection lineAnd a fourth projection line:
Wherein the content of the first and second substances,is a pointIn a planeP 2 The projected coordinates of the optical system are calculated,is the third projection lineA set of direction numbers of (a);
is a pointIn a planeP 2 The projected coordinates of (a) to (b),is a fourth projection lineA set of direction numbers of;
note the third projection lineAnd a fourth projection lineAt a point of intersection of(ii) a Point recordingFor calibrating the origin of the coordinate system of the block under the coordinate system of the optical dynamic tracking systemPassing through the originAlong the third projection lineThe direction is set in the coordinate system of the calibration blockAxis, passing through originAlong a planeP 2 Is arranged in the coordinate system of the calibration block in the normal directionAxis, i.e. establishing a coordinate system of a calibration block under the coordinate system of the optical dynamic tracking system, and solving to obtain a matrix transformation relation of { DF } relative to { CF }。
Relative pose of robot coordinate system and optical dynamic tracking system coordinate systemThe acquisition mode is as follows: pasting a target point for detection of the optical dynamic tracking system at the tail end of the robot, respectively rotating a first mechanical arm shaft and a second mechanical arm shaft of the robot, recording coordinate values of the target point under a coordinate system of the optical dynamic tracking system for multiple times, establishing a base coordinate system of the robot under the coordinate system of the optical dynamic tracking system, and solving to obtain a matrix transformation relation of { BF } relative to { CF }, wherein。
The embodiment provides a method for calibrating the relative pose of a linear laser sensor and a robot flange plate, solves the problems of complex calibration process and poor calibration precision of the relative pose of the linear laser sensor and the industrial robot flange plate, simplifies the calibration process and improves the calibration accuracy.
Based on the method of the embodiment, the relative pose of the linear laser sensor and the robot flange plate is calibrated, and the obtained experimental data are as follows:
example 2
In this embodiment, in order to implement the method described in embodiment 1, a system for calibrating a relative pose between a line laser sensor and a robot flange is disclosed, which includes: an industrial robot 1 has at least two robot arms. A flange 2 is installed at the tail end of the industrial robot 1, and a wired laser sensor 4 is arranged on the flange 2. The system further comprises an optical dynamic tracking system 5 arranged on the opposite surface of the industrial robot 1 and an optical pen 6 matched with the optical dynamic tracking system 5, and an operation table is arranged between the robot 1 and the optical dynamic tracking system 5. The console is then used to fix the calibration block 3. In a further embodiment, the calibration block 3 comprises: a body 201;
at least four groups of semi-cylinders 202 arranged on the upper surface of the body 201 in a radioactive manner; the included angles between adjacent half cylinders 202 are equal. In this embodiment, the base of the calibration block 3 is a rectangular structure, and the upper surface of the base is composed of four semicylinders; the four semi-cylinders are distributed along the center of the upper surface of the base at equal angles, and the included angle of the axes of any two adjacent semi-cylinders is 90 degrees; the base of the calibration block 3 is provided with five threaded holes 203 for mounting and fixing the calibration block 3.
Claims (9)
1. The method for calibrating the relative pose of the linear laser sensor and the robot flange plate is characterized by comprising the following steps of:
step one, setting a robot, a flange plate, a calibration block, a line laser sensor, an optical dynamic tracking system and an optical pen matched with the optical dynamic tracking system according to preset positions;
step two, a calibration test platform is formed by a calibration block, an optical dynamic tracking system and a light pen, the robot is restored to an initial state, and a robot coordinate system, a flange plate coordinate system, a line laser sensor coordinate system, a calibration block coordinate system and an optical dynamic tracking system coordinate system are respectively set as { BF }, { FF }, { LF }, { DF }, and { CF };
step three, respectively solving the matrix transformation relations of { BF } and { FF }, { LF } and { DF }, { DF } and { CF }, { CF } and { BF } to obtain、、、;
Based on the matrix transformation relation, calculating by adopting the following formula to obtain the relative pose in the linear laser sensor coordinate system and the flange plate coordinate system:
2. The method for calibrating the relative pose of the line laser sensor and the robot flange plate according to claim 1, wherein the calibration block comprises:
a body;
at least four groups of semi-cylinders are arranged on the upper surface of the body in a radioactive manner; the included angles between the adjacent semi-cylinders are equal.
3. The method for calibrating the relative pose of the line laser sensor and the robot flange plate according to claim 1, wherein the positional relationship of the predetermined positions is as follows:
the robot and the optical dynamic tracking system are arranged oppositely, and an operation table is arranged in the middle; the flange plate is arranged at the tail end of the robot, and the line laser sensor is arranged on the flange plate;
the calibration block is fixed on the operating table and is positioned in the measuring range of the line laser sensor, so that the line laser sensor can measure any two adjacent semi-cylinders and the upper surface of the body between the two adjacent semi-cylinders simultaneously;
the optical dynamic tracking system simultaneously measures the corresponding positions of the robot and the calibration block.
4. The method for calibrating the relative pose between the line laser sensor and the robot flange plate according to claim 1, wherein the method comprises the third stepThe relative pose of the flange coordinate system and the robot coordinate system is calculated as follows:
reading the current flange coordinate system relative to the robot base coordinate systemX、Y、ZCorresponding rotation parameters on three axesCorresponding translation parameterSolving the matrix transformation relation of { FF } relative to { BF } through the following formula:
5. the method for calibrating the relative pose between the line laser sensor and the robot flange plate according to claim 1,for calibrating the relative position and attitude of the coordinate system of the block and the coordinate system of the line laser sensor, the acquisition process comprises the following steps:
obtaining a calibration block measuring point under a line laser sensor coordinate system to obtain first point cloud data, and defining two adjacent semi-cylinders measured by the line laser sensor to be first semi-cylinders respectivelyA cylinder and a second semi-cylinder, fitting the cylinder by least square method to obtain the first axis of the first semi-cylinder and the second semi-cylinder respectivelyAnd a second axisThe parameter equation is as follows:
Wherein the content of the first and second substances,for any point coordinate on the first half cylinder measured by the line laser sensor,is a first axisL 1 A set of direction numbers of (a);
for any point coordinate on the second semi-cylinder measured by the line laser sensor,is a secondAxial lineA set of direction numbers of;is a parameter of a parameter equation;
Wherein the content of the first and second substances,for arbitrary point coordinates within the first point cloud data,is a straight lineA set of direction numbers of; t is a parameter of a parametric equation;
using a first axisA second axisAnd a straight lineConstraint conditions on the same plane are solved to obtain a plane:
(ii) a Wherein the content of the first and second substances,coefficients of a general equation of a plane;
will be the first axisAnd a second axisProjected onto a planeP 1 Get the first projection lineAnd a second projection line:
Wherein the content of the first and second substances,is a pointIn a planeP 1 The projected coordinates of the optical system are calculated,is the first projection lineA set of direction numbers of;
is a pointIn a planeP 1 The projected coordinates of the optical system are calculated,is the second projection lineA set of direction numbers of (a);
obtaining a first projection lineAnd the intersection of the second projection lineIs marked as a pointD 1 (ii) a Setting pointD 1 For calibrating the origin O of the block coordinate system DF Passing through the origin O DF Along the first projection lineSetting X in the coordinate system of the calibration block in the direction DF Axis, passing through originO DF Along a planeP 1 Setting Y in the coordinate system of the calibration block in the normal direction DF Axis, Y of calibration block coordinate system obtained according to right hand rule DF Axis, calculating to obtain matrix transformation relation of { DF } relative to { LF }。
6. The method for calibrating the relative pose between the line laser sensor and the robot flange plate according to claim 1,the relative pose of the coordinate system of the calibration block and the coordinate system of the optical dynamic tracking system is calculated by the following steps:
measuring the upper surface of the calibration block by using an optical dynamic tracking system and an optical pen to obtain a plurality of groups of upper surface measuring points of the calibration block under a coordinate system of the optical dynamic tracking system to obtain second point cloud data, and fitting by adopting a least square method principle to obtain a planeP 2 :In whichCoefficients of a general equation of a plane;
measuring any two adjacent groups of semi-cylinders of the calibration block by using an optical dynamic tracking system and an optical pen to obtain a plurality of groups of point coordinate data of the two adjacent groups of semi-cylinders under a coordinate system of the optical dynamic tracking system; respectively calculating to obtain a first cylinder Q based on a least square method 1 And a second cylinder Q 2 And solving for the first cylinder Q 1 A second cylinder Q 2 Third axis of (2)And a fourth axis:
Wherein the content of the first and second substances,for the first cylinder Q in the coordinate system of the optical dynamic tracking system 1 The coordinates of any point on the surface of the object,is a third axisL 3 A set of direction numbers of; t is a parameter of a parameter equation;
for the second cylinder Q in the coordinate system of the optical dynamic tracking system 2 The coordinates of any point on the surface of the object,is a fourth axisL 4 A set of direction numbers of (a);tis a parameter of a parameter equation;
will be the third axisL 3 And a fourth axisL 4 Projected onto a planeP 2 Get the third projection lineAnd a fourth projection line:
Wherein, the first and the second end of the pipe are connected with each other,is a pointIn a planeP 2 The projected coordinates of the optical system are calculated,is the third projection lineA set of direction numbers of;
is a pointIn a planeP 2 The projected coordinates of the optical system are calculated,is a fourth projection lineA set of direction numbers of;
note the third projection lineAnd a fourth projection lineAt a point of intersection of(ii) a Point recordingFor calibrating the origin of the coordinate system of the block under the coordinate system of the optical dynamic tracking systemPassing through the originAlong the third projection lineThe direction is set in the coordinate system of the calibration blockAxis, passing through originAlong a planeP 2 Normal direction of (a) in the coordinate system of the calibration blockIs provided withAxis, i.e. establishing a coordinate system of a calibration block under the coordinate system of the optical dynamic tracking system, and solving to obtain a matrix transformation relation of { DF } relative to { CF }。
7. The method for calibrating the relative pose between the line laser sensor and the robot flange plate according to claim 1,the relative pose of the robot coordinate system and the optical dynamic tracking system coordinate system is obtained in the following mode:
pasting a target point for detecting the optical dynamic tracking system at the tail end of the robot, respectively rotating a mechanical arm shaft I and a mechanical arm shaft II of the robot, recording coordinate values of the target point under the coordinate system of the optical dynamic tracking system for multiple times, establishing a robot base coordinate system under the coordinate system of the optical dynamic tracking system, and solving to obtain a matrix transformation relation of { BF } relative to { CF }, wherein。
8. Line laser sensor and relative position appearance calibration system of robot ring flange, its characterized in that includes:
the tail end of the robot is provided with a flange plate;
the line laser sensor is arranged on the flange plate;
the optical dynamic tracking system is arranged on the opposite surface of the robot; an operation table is arranged between the robot and the optical dynamic tracking system;
the calibration block is fixed on the operating table; the calibration block includes: a body;
at least four groups of semi-cylinders are arranged on the upper surface of the body in a radioactive manner; the included angles between the adjacent semi-cylinders are equal.
9. The system for calibrating the relative pose of the line laser sensor and the robot flange plate according to claim 8, wherein at least five groups of threaded holes are formed in the body.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211307719.0A CN115371564B (en) | 2022-10-24 | 2022-10-24 | Method and system for calibrating relative pose of linear laser sensor and robot flange plate |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211307719.0A CN115371564B (en) | 2022-10-24 | 2022-10-24 | Method and system for calibrating relative pose of linear laser sensor and robot flange plate |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115371564A true CN115371564A (en) | 2022-11-22 |
CN115371564B CN115371564B (en) | 2023-03-07 |
Family
ID=84073051
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211307719.0A Active CN115371564B (en) | 2022-10-24 | 2022-10-24 | Method and system for calibrating relative pose of linear laser sensor and robot flange plate |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115371564B (en) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20030057365A1 (en) * | 2001-09-24 | 2003-03-27 | Bennett Ralph W. | Folded reflecting path optical spot scanning system |
CN109724531A (en) * | 2018-10-18 | 2019-05-07 | 苏州光图智能科技有限公司 | 360 ° of contour measuring methods |
CN109794963A (en) * | 2019-01-07 | 2019-05-24 | 南京航空航天大学 | A kind of robot method for rapidly positioning towards curved surface member |
CN111735390A (en) * | 2020-08-28 | 2020-10-02 | 中国计量大学 | Calibration block for line laser sensor and hand-eye calibration method |
CN112223285A (en) * | 2020-09-30 | 2021-01-15 | 南京航空航天大学 | Robot hand-eye calibration method based on combined measurement |
CN113681559A (en) * | 2021-08-24 | 2021-11-23 | 宁波光雷睿融智能系统有限公司 | Line laser scanning robot hand-eye calibration method based on standard cylinder |
CN215639489U (en) * | 2021-06-18 | 2022-01-25 | 三一建筑机器人(西安)研究院有限公司 | Calibration board |
-
2022
- 2022-10-24 CN CN202211307719.0A patent/CN115371564B/en active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20030057365A1 (en) * | 2001-09-24 | 2003-03-27 | Bennett Ralph W. | Folded reflecting path optical spot scanning system |
CN109724531A (en) * | 2018-10-18 | 2019-05-07 | 苏州光图智能科技有限公司 | 360 ° of contour measuring methods |
CN109794963A (en) * | 2019-01-07 | 2019-05-24 | 南京航空航天大学 | A kind of robot method for rapidly positioning towards curved surface member |
CN111735390A (en) * | 2020-08-28 | 2020-10-02 | 中国计量大学 | Calibration block for line laser sensor and hand-eye calibration method |
CN112223285A (en) * | 2020-09-30 | 2021-01-15 | 南京航空航天大学 | Robot hand-eye calibration method based on combined measurement |
CN215639489U (en) * | 2021-06-18 | 2022-01-25 | 三一建筑机器人(西安)研究院有限公司 | Calibration board |
CN113681559A (en) * | 2021-08-24 | 2021-11-23 | 宁波光雷睿融智能系统有限公司 | Line laser scanning robot hand-eye calibration method based on standard cylinder |
Also Published As
Publication number | Publication date |
---|---|
CN115371564B (en) | 2023-03-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111660295B (en) | Industrial robot absolute precision calibration system and calibration method | |
WO2021179460A1 (en) | Laser light exit direction calibration method employing standard ball | |
CN107042528B (en) | A kind of Kinematic Calibration system and method for industrial robot | |
CN109870125B (en) | Hole-shaft coaxiality measuring device and method for hollow shaft | |
CN111941425B (en) | Rapid workpiece positioning method of robot milling system based on laser tracker and binocular camera | |
CN102654387B (en) | Online industrial robot calibration device based on spatial curved surface restraint | |
CN106441117A (en) | Turntable error detection method based on multi-station etalon laser tracking system | |
CN111678472B (en) | Error identification method for rotary table of four-axis coordinate measuring machine | |
CN111595238B (en) | Laser tracker precision field evaluation system based on multi-station method | |
CN111721198A (en) | Multi-axis space coordinate system calibration method for combined type line laser measurement system | |
CN112304218B (en) | Tool center point position calibration method and system of industrial robot | |
CN112288823A (en) | Calibration method of standard cylinder curved surface point measuring equipment | |
CN114234877B (en) | Displacement sensor vector calibration method for R-test instrument | |
CN113916128A (en) | Method for improving precision based on optical pen type vision measurement system | |
CN112277002B (en) | Robot kinematics calibration device and calibration method based on incomplete pose information | |
CN111189391B (en) | Coordinate unification method based on measurement of middle point of axis of carbon fiber rod | |
CN115371564B (en) | Method and system for calibrating relative pose of linear laser sensor and robot flange plate | |
CN112179291A (en) | Calibration method of self-rotating scanning type line structured light three-dimensional measurement device | |
CN109059761B (en) | EIV model-based handheld target measuring head calibration method | |
CN115179323A (en) | Machine end pose measuring device based on telecentric vision constraint and precision improving method | |
CN114279303A (en) | Device and method for detecting verticality of double-sided micro-cylindrical lens array | |
CN113175870A (en) | Global calibration target and calibration method for global calibration of multi-view vision sensor | |
Wang et al. | Field calibration method for industrial robots based on single position sensitive device | |
CN110733060A (en) | mechanical arm tail end space repeated positioning precision measuring device and method | |
CN112212822B (en) | Method for detecting ball center space offset error of ball joint by using three-ball bar instrument |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |