CN113655466B - Calibration system and calibration method based on structured light triangulation - Google Patents
Calibration system and calibration method based on structured light triangulation Download PDFInfo
- Publication number
- CN113655466B CN113655466B CN202110808275.8A CN202110808275A CN113655466B CN 113655466 B CN113655466 B CN 113655466B CN 202110808275 A CN202110808275 A CN 202110808275A CN 113655466 B CN113655466 B CN 113655466B
- Authority
- CN
- China
- Prior art keywords
- calibration plate
- image acquisition
- coordinate system
- checkerboard calibration
- checkerboard
- 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.)
- Active
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/497—Means for monitoring or calibrating
Landscapes
- Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Length Measuring Devices By Optical Means (AREA)
Abstract
The invention discloses a calibration method based on structured light triangulation, which relates to the technical field of laser ranging and solves the technical problem of high cost of the existing calibration mode, and comprises the following steps: and (3) calibrating the image acquisition equipment by using the checkerboard calibration plate, irradiating a word line laser to the checkerboard calibration plate, acquiring an image of the checkerboard calibration plate, acquiring crossing points of black and white squares in the image, establishing a checkerboard calibration plate coordinate system, calculating actual coordinates of all crossing points, calculating the relative position relation between the image acquisition equipment coordinate system and the checkerboard calibration plate coordinate system, and calculating to obtain a word line laser plane equation of the word line laser in the image acquisition equipment coordinate system. The invention also discloses a calibration system based on structured light triangulation. According to the invention, the relative relation of the laser planes of the cameras is not required to be calibrated by means of an external mechanical moving platform, the parallel installation of the laser planes and the cameras is not required to be limited, and the complexity and the calibration cost of a calibration system are greatly reduced.
Description
Technical Field
The invention relates to the technical field of laser ranging, in particular to a calibration system and a calibration method based on structured light triangulation.
Background
At present, laser ranging is widely applied at home and abroad, and the triangulation method is widely applied to occasions with high precision requirements of various industries due to high precision. The existing calibration method needs to provide the absolute displacement of a reference object by means of an external mechanism, the position relation between the camera and the one-word line laser is calculated through the absolute displacement, the one-word line laser plane needs to be parallel to the single axis of the camera, a complex control system is needed to be built, and the control precision requirement on the mobile platform is high and the cost is high.
Disclosure of Invention
The invention aims to solve the technical problem of the prior art, and provides a calibration method based on structured light triangulation with low cost.
The invention aims at providing a calibration system based on structured light triangulation with low cost.
In order to achieve the above object, the present invention provides a calibration method based on structured light triangulation, including:
step one, calibrating the image acquisition equipment by using a checkerboard calibration plate to obtain a calibration parameter matrix K of the image acquisition equipment,
wherein f x Is focal length in x-axis direction, f y C is focal length in y-axis direction x C is the x-direction coordinate of the optical axis of the image acquisition device in the image coordinate system y The y-direction coordinate of the optical axis of the image acquisition device in an image coordinate system;
step two, irradiating a word line laser to the checkerboard calibration plate and obtaining an image of the checkerboard calibration plate;
step three, obtaining the crossing points of black and white squares in the image to obtain a point set p of the crossing points, wherein the coordinates of a certain point are p (u, v);
step four, a checkerboard calibration plate coordinate system is established according to the checkerboard calibration plate, the actual coordinates of all the crossing points in the step three are obtained according to the checkerboard calibration plate coordinate system, the point set is marked as P, and the coordinates of the ith row and the jth column of points are marked as P ij (X,Y,Z);
And fifthly, according to the point P (u, v) and the corresponding point P (X, Y, Z), solving a relative position relation (R, t) between the coordinate system of the image acquisition equipment and the coordinate system of the checkerboard calibration plate by using a PnP method, wherein a solving formula of the PnP is as follows:
wherein, by r j The square matrix is a rotation matrix R, t i The composed column vector is a translation vector t;
step six, selecting any two points p from the laser lines in the image 1 ′、p 2 ' calculating the coordinate P under the coordinate system of the checkerboard calibration plate through the calibration parameters of (R, t) and the image acquisition equipment 1 ′、P 2 ' the calculation formula is:
will P 1 ′、P 2 ' converting to an image acquisition equipment coordinate system, and calculating an actual coordinate P corresponding to two points 1 ″、P 2 "the calculation formula is:
step seven, randomly changing the gesture of the checkerboard calibration plate, repeating the steps three to six until N groups of points are acquired, and recording the point P of the coordinate system of the image acquisition equipment in each group of operation 1 ″、P 2 ", and constitutes a point set P";
step eight, calculating an equation by a least square method according to the point set P' obtained in the step seven:
Z=AX+BY+C,
a word line laser plane equation of a word line laser in an image acquisition device coordinate system is obtained, and coordinates (X, Y, Z) of any point (u, v) on a laser line in the image acquisition device coordinate system are calculated according to the word line laser plane equation, wherein the calculation formula is as follows:
as a further improvement, the establishing a checkerboard calibration plate coordinate system is specifically as follows: taking the upper left corner of the checkerboard calibration plate as the origin of a checkerboard calibration plate coordinate system, taking the long-side direction of the checkerboard calibration plate as the x axis, taking the short-side direction of the checkerboard calibration plate as the y axis, taking the normal direction of the checkerboard calibration plate as the z axis, and calculating the ith row and jth column point P according to the square size squareSize of the checkerboard calibration plate ij Actual coordinates X, Y, Z of (X, Y, Z):
further, in the seventh step, N is not less than 10.
In order to achieve the second purpose, the invention provides a calibration system based on structured light triangulation, which comprises image acquisition equipment, a word line laser transmitter, a checkerboard calibration plate and a computer processing unit, wherein the computer processing unit is in signal connection with the image acquisition equipment and the word line laser transmitter, and the image acquisition equipment and the word line laser transmitter form a triangulation position relationship and are fixed in position;
the word line laser transmitter is used for irradiating a word line laser to the checkerboard calibration plate;
the computer processing unit acquires the image of the checkerboard calibration plate through the image acquisition equipment, and calculates the coordinates of any point selected on the laser line in the image according to the method.
As a further refinement, the image acquisition device is a video camera or a still camera or a video camera.
Advantageous effects
Compared with the prior art, the invention has the advantages that:
the invention does not need to calibrate the relative relation of the laser planes of the cameras by means of an external mechanical moving platform, does not need to limit the parallel installation of the laser planes and the cameras, greatly reduces the complexity of a calibration system and reduces the calibration cost.
Drawings
FIG. 1 is a calibration flow chart of the present invention;
fig. 2 is a schematic diagram of the system of the present invention.
Wherein: 1-image acquisition equipment, 2-word line laser emitter, 3-checkerboard calibration plate and 4-computer processing unit.
Detailed Description
The invention will be further described with reference to specific embodiments in the drawings.
Referring to fig. 1 and 2, a calibration method based on structured light triangulation includes:
step one, calibrating the image acquisition equipment 1 by using the checkerboard calibration plate 3 to obtain a calibration parameter matrix K of the image acquisition equipment 1,
wherein f x Is focal length in x-axis direction, f y C is focal length in y-axis direction x C is the x-direction coordinate of the optical axis of the image acquisition device in the image coordinate system y The y-direction coordinate of the optical axis of the image acquisition device in an image coordinate system;
step two, placing the checkerboard calibration plate 3 in the field of view of the image acquisition equipment 1, irradiating a word line laser to the checkerboard calibration plate 3, and obtaining an image of the checkerboard calibration plate 3;
acquiring a crossing point of black and white squares in the image in a coordinate system on the image to obtain a point set p of the crossing point, wherein the coordinate of a certain point is p (u, v), and u and v represent pixels;
step four, establishing a checkerboard calibration plate coordinate system according to the checkerboard calibration plate 3, obtaining the actual coordinates of all the crossing points in the step three according to the checkerboard calibration plate coordinate system, marking a point set as P, and marking the coordinates of the ith row and the jth column of points as P ij (X,Y,Z);
Fifth, the point set P corresponds to the points in the point set P one by one, and according to the point P (u, v) and the corresponding point P (X, Y, Z), the relative position relation (R, t) between the coordinate system of the image acquisition device and the coordinate system of the checkerboard calibration plate is solved by using a PnP method, wherein the calculation formula of PnP is as follows:
wherein the vector of the left column of the equal sign is the coordinate of the intersection point on the image, the first matrix of the right side of the equal sign is the calibration parameter matrix K of the image acquisition equipment, the second matrix of the right side of the equal sign is the matrix to be solved, and r is used for solving the problem j The square matrix is a rotation matrix R, t i The formed column vectors are translation vectors t, (R, t) describe the position relationship between the coordinate system of the image acquisition equipment and the coordinate system of the checkerboard calibration plate, and the rightmost column vector is the coordinate of each characteristic point in the coordinate system of the checkerboard calibration plate;
step six, selecting any two points p from the laser lines in the image 1 ′、p 2 ' calculating the coordinate P under the coordinate system of the checkerboard calibration plate through the calibration parameters of (R, t) and the image acquisition equipment 1 ′、P 2 ' the calculation formula is:
wherein, the left column vector of the equal sign is the point coordinate selected under the checkerboard calibration plate coordinate system, R is the rotation matrix calculated in the fifth step, t is the translation vector, K is the calibration parameter matrix of the image acquisition equipment calibrated in the first step, s is the coefficient, and the rightmost column vector is the image pixel coordinate, because of P 1 ′、P 2 'on the same plane, Z' is a constant 0;
will P 1 ′、P 2 ' converting to an image acquisition equipment coordinate system, and calculating an actual coordinate P corresponding to two points 1 ″、P 2 "the calculation formula is:
seventhly, changing the posture of the checkerboard calibration plate 3 as much as possibleRepeating the steps three to six without being parallel to the last time until N groups of points are acquired, wherein N is more than or equal to 10, and recording the point P of the coordinate system of the image acquisition equipment in each group of operation 1 ″、P 2 ", and constitutes a point set P";
step eight, calculating an equation by a least square method according to the point set P' obtained in the step seven:
Z=AX+BY+C,
a word line laser plane equation of the word line laser in the image acquisition device coordinate system is obtained, and coordinates (X, Y, Z) of any point (u, v) on the laser line in the image acquisition device coordinate system are calculated according to the word line laser plane equation, wherein the calculation formula is as follows:
the calibration parameter matrix K of the camera is obtained through calibration in the step one.
The establishment of the checkerboard calibration plate coordinate system is specifically as follows: the upper left corner of the checkerboard calibration plate 3 is taken as the origin of a checkerboard calibration plate coordinate system, the long side direction of the checkerboard calibration plate 3 is taken as the x axis, the short side direction of the checkerboard calibration plate 3 is taken as the y axis, the normal direction of the checkerboard calibration plate 3 is taken as the z axis, and the j-th row and column point P of the i-th row is calculated according to the square size squareSize of the checkerboard calibration plate 3 ij Actual coordinates X, Y, Z of (X, Y, Z):
the calibration system based on structured light triangulation comprises an image acquisition device 1, a word line laser emitter 2, a checkerboard calibration plate 3 and a computer processing unit 4, wherein the computer processing unit 4 is in signal connection with the image acquisition device 1 and the word line laser emitter 2, for example, the computer processing unit 4 is in signal connection with the image acquisition device 1 and the word line laser emitter 2 through cables, or the computer processing unit 4 is in signal connection with the image acquisition device 1 and the word line laser emitter 2 through wireless signals, and the image acquisition device 1 and the word line laser emitter 2 are in triangulation position relation and fixed in position;
a word line laser emitter 2 for irradiating a word line laser to the checkerboard calibration plate 3;
the computer processing unit 4 acquires the image of the checkered calibration plate 3 through the image acquisition device 1, and calculates coordinates of any point selected on the laser line in the image according to the above method.
The image acquisition device 1 is a video camera or a still camera or a video camera.
The invention does not need to calibrate the relative relation of the laser planes of the cameras by means of an external mechanical moving platform, does not limit the parallel installation of the laser planes and the cameras, reduces the complexity and the calibration cost of a calibration system, and overcomes the defects of the prior calibration scheme that a complex control system is needed and the cost is high.
The foregoing is merely a preferred embodiment of the present invention, and it should be noted that modifications and improvements can be made by those skilled in the art without departing from the structure of the present invention, and these do not affect the effect of the implementation of the present invention and the utility of the patent.
Claims (6)
1. A structured light triangulation-based calibration method, comprising:
step one, calibrating the image acquisition equipment (1) by using a checkerboard calibration plate (3) to obtain a calibration parameter matrix K of the image acquisition equipment (1),
wherein f x Is focal length in x-axis direction, f y C is focal length in y-axis direction x C is the x-direction coordinate of the optical axis of the image acquisition device in the image coordinate system y The y-direction coordinate of the optical axis of the image acquisition device in an image coordinate system;
step two, irradiating a word line laser to the checkerboard calibration plate (3) and obtaining an image of the checkerboard calibration plate (3);
step three, obtaining the crossing points of black and white squares in the image to obtain a point set p of the crossing points, wherein the coordinates of a certain point are p (u, v);
step four, establishing a checkerboard calibration plate coordinate system according to the checkerboard calibration plate (3), obtaining the actual coordinates of all the crossing points in the step three according to the checkerboard calibration plate coordinate system, marking a point set as P, and marking the point coordinates of the ith row and the jth column as P ij (X,Y,Z);
And fifthly, according to the point P (u, v) and the corresponding point P (X, Y, Z), solving a relative position relation (R, t) between the coordinate system of the image acquisition equipment and the coordinate system of the checkerboard calibration plate by using a PnP method, wherein a solving formula of the PnP is as follows:
wherein, by r j The square matrix is a rotation matrix R, t i The composed column vector is a translation vector t;
step six, selecting any two points p from the laser lines in the image 1 ′、p 2 ' calculating the coordinate P under the coordinate system of the checkerboard calibration plate through the calibration parameters of (R, t) and the image acquisition equipment 1 ′、P 2 ' the calculation formula is:
will P 1 ′、P 2 ' converting to an image acquisition equipment coordinate system, and calculating an actual coordinate P corresponding to two points 1 ″、P 2 "the calculation formula is:
step seven, randomly changing the gesture of the checkerboard calibration plate (3), repeating the steps three to six until N groups of points are acquired, and recording images in each group of operationsAcquisition of a point P of a device coordinate system 1 ″、P 2 ", and constitutes a point set P";
step eight, calculating an equation by a least square method according to the point set P' obtained in the step seven:
Z=AX+BY+C,
a word line laser plane equation of a word line laser in an image acquisition device coordinate system is obtained, and coordinates (X, Y, Z) of any point (u, v) on a laser line in the image acquisition device coordinate system are calculated according to the word line laser plane equation, wherein the calculation formula is as follows:
2. the calibration method based on structured light triangulation according to claim 1, wherein the establishing a checkerboard calibration plate coordinate system is specifically: calculating the ith row and jth column point P according to square size squareSize of the checkerboard calibration plate (3) by taking the upper left corner of the checkerboard calibration plate (3) as the origin of the checkerboard calibration plate coordinate system, taking the long side direction of the checkerboard calibration plate (3) as the x axis, taking the short side direction of the checkerboard calibration plate (3) as the y axis and taking the normal direction of the checkerboard calibration plate (3) as the z axis ij Actual coordinates X, Y, Z of (X, Y, Z):
3. the method according to claim 1, wherein in the step seven, N is equal to or greater than 10.
4. A calibration method based on structured light triangulation according to claim 1, characterized in that the image acquisition device (1) is a video camera or a still camera or a video camera.
5. The calibration system based on structured light triangulation is characterized by comprising image acquisition equipment (1), a word line laser emitter (2), a checkerboard calibration plate (3) and a computer processing unit (4), wherein the computer processing unit (4) is in signal connection with the image acquisition equipment (1) and the word line laser emitter (2), and the image acquisition equipment (1) and the word line laser emitter (2) form a triangulation position relationship and are fixed in position;
the word line laser transmitter (2) is used for irradiating a word line laser to the checkerboard calibration plate (3);
the computer processing unit (4) acquires the image of the checkerboard calibration plate (3) through the image acquisition device (1), and calculates coordinates of any point selected on a laser line in the image according to the method of any one of claims 1 to 4.
6. A structured light triangulation based calibration system according to claim 5, characterized in that the image acquisition device (1) is a video camera or a camera head.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110808275.8A CN113655466B (en) | 2021-07-16 | 2021-07-16 | Calibration system and calibration method based on structured light triangulation |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110808275.8A CN113655466B (en) | 2021-07-16 | 2021-07-16 | Calibration system and calibration method based on structured light triangulation |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113655466A CN113655466A (en) | 2021-11-16 |
CN113655466B true CN113655466B (en) | 2023-09-29 |
Family
ID=78489520
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110808275.8A Active CN113655466B (en) | 2021-07-16 | 2021-07-16 | Calibration system and calibration method based on structured light triangulation |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113655466B (en) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103837869A (en) * | 2014-02-26 | 2014-06-04 | 北京工业大学 | Vector-relation-based method for calibrating single-line laser radar and CCD camera |
CN106056620A (en) * | 2016-06-13 | 2016-10-26 | 西南科技大学 | Calibration board for line laser position calibration and line laser camera measurement system calibration method |
CN111272102A (en) * | 2020-05-06 | 2020-06-12 | 中国空气动力研究与发展中心低速空气动力研究所 | Line laser scanning three-dimensional measurement calibration method |
CN111536902A (en) * | 2020-04-22 | 2020-08-14 | 西安交通大学 | Galvanometer scanning system calibration method based on double checkerboards |
CN112161586A (en) * | 2020-11-20 | 2021-01-01 | 苏州睿牛机器人技术有限公司 | Line structured light vision sensor calibration method based on coding checkerboard |
WO2021051296A1 (en) * | 2019-09-18 | 2021-03-25 | Beijing Voyager Technology Co., Ltd. | Systems and methods for calibrating a camera and a multi-line lidar |
-
2021
- 2021-07-16 CN CN202110808275.8A patent/CN113655466B/en active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103837869A (en) * | 2014-02-26 | 2014-06-04 | 北京工业大学 | Vector-relation-based method for calibrating single-line laser radar and CCD camera |
CN106056620A (en) * | 2016-06-13 | 2016-10-26 | 西南科技大学 | Calibration board for line laser position calibration and line laser camera measurement system calibration method |
WO2021051296A1 (en) * | 2019-09-18 | 2021-03-25 | Beijing Voyager Technology Co., Ltd. | Systems and methods for calibrating a camera and a multi-line lidar |
CN111536902A (en) * | 2020-04-22 | 2020-08-14 | 西安交通大学 | Galvanometer scanning system calibration method based on double checkerboards |
CN111272102A (en) * | 2020-05-06 | 2020-06-12 | 中国空气动力研究与发展中心低速空气动力研究所 | Line laser scanning three-dimensional measurement calibration method |
CN112161586A (en) * | 2020-11-20 | 2021-01-01 | 苏州睿牛机器人技术有限公司 | Line structured light vision sensor calibration method based on coding checkerboard |
Non-Patent Citations (2)
Title |
---|
基于梯形棋盘格的摄像机和激光雷达标定方法;贾子永;任国全;李冬伟;程子阳;;计算机应用(07);全文 * |
基于棋盘格的线结构光平面标定方法;李瑞;熊显名;;仪器仪表用户(04);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN113655466A (en) | 2021-11-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110264520B (en) | Vehicle-mounted sensor and vehicle pose relation calibration method, device, equipment and medium | |
CN111311689B (en) | Method and system for calibrating relative external parameters of laser radar and camera | |
CN109454634B (en) | Robot hand-eye calibration method based on plane image recognition | |
KR100869570B1 (en) | Camera calibrating method and camera calibrating device | |
CN100583151C (en) | Double-camera calibrating method in three-dimensional scanning system | |
CN111369630A (en) | Method for calibrating multi-line laser radar and camera | |
CN203084734U (en) | System for regenerating virtual object | |
CN109859272B (en) | Automatic focusing binocular camera calibration method and device | |
CN112819903B (en) | L-shaped calibration plate-based camera and laser radar combined calibration method | |
CN109448054A (en) | The target Locate step by step method of view-based access control model fusion, application, apparatus and system | |
CN105758426A (en) | Combined calibration method for multiple sensors of mobile robot | |
CN104657982A (en) | Calibration method for projector | |
CN111508027A (en) | Method and device for calibrating external parameters of camera | |
CN113658266B (en) | Visual measurement method for rotation angle of moving shaft based on fixed camera and single target | |
CN112665523B (en) | Combined measurement method for complex profile | |
CN113655466B (en) | Calibration system and calibration method based on structured light triangulation | |
CN111710002B (en) | Camera external parameter calibration method based on Optitrack system | |
CN112507755A (en) | Target object six-degree-of-freedom positioning method and system for minimizing two-dimensional code corner re-projection error | |
CN109682312B (en) | Method and device for measuring length based on camera | |
EP4071713A1 (en) | Parameter calibration method and apapratus | |
CN115619877A (en) | Method for calibrating position relation between monocular laser sensor and two-axis machine tool system | |
CN115908562A (en) | Different-surface point cooperation marker and measuring method | |
CN115183981A (en) | Wind tunnel coordinate shafting calibration method and calibration device based on coding marks | |
CN114359365A (en) | Convergent binocular vision measuring method with high resolution | |
CN111028298B (en) | Convergent binocular system for rigid coordinate system space transformation calibration |
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 |