WO2022160760A1 - Calibration method and apparatus for multiple stereo cameras - Google Patents

Calibration method and apparatus for multiple stereo cameras Download PDF

Info

Publication number
WO2022160760A1
WO2022160760A1 PCT/CN2021/121462 CN2021121462W WO2022160760A1 WO 2022160760 A1 WO2022160760 A1 WO 2022160760A1 CN 2021121462 W CN2021121462 W CN 2021121462W WO 2022160760 A1 WO2022160760 A1 WO 2022160760A1
Authority
WO
WIPO (PCT)
Prior art keywords
calibration
point
stereo
stereo camera
stereo cameras
Prior art date
Application number
PCT/CN2021/121462
Other languages
French (fr)
Chinese (zh)
Inventor
刘锋
Original Assignee
北京罗克维尔斯科技有限公司
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by 北京罗克维尔斯科技有限公司 filed Critical 北京罗克维尔斯科技有限公司
Publication of WO2022160760A1 publication Critical patent/WO2022160760A1/en

Links

Images

Classifications

    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00Image analysis
    • G06T7/80Analysis of captured images to determine intrinsic or extrinsic camera parameters, i.e. camera calibration
    • G06T7/85Stereo camera calibration
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F18/00Pattern recognition
    • G06F18/20Analysing
    • G06F18/23Clustering techniques

Definitions

  • the present disclosure relates to the technical field of computer vision, and in particular, to a method and device for calibrating a multi-stereo camera, an electronic device, and a storage medium.
  • the stereo camera can obtain the 3D point cloud of the target object, and the point cloud can be used to realize 3D reconstruction, detection and measurement of the target.
  • the number of stereo cameras can be increased, and multiple stereo cameras can obtain point clouds at the same time and stitch them together to expand the field of view and obtain point clouds of larger targets.
  • To complete the splicing of point clouds obtained by multiple stereo cameras the most important thing is to unify the point clouds obtained by multiple stereo cameras into the same coordinate system, that is, to find the transformation matrix of the coordinate system where multiple cameras are located to complete multiple stereo cameras. Camera extrinsic calibration.
  • one solution is to complete the calibration of the stereo camera by shooting two-dimensional images and three-dimensional point clouds of the calibration chessboard fixed on the calibration plate in different postures.
  • Another solution is to use wrinkled paper regardless of thickness, and use the iterative closest point algorithm to calibrate the external parameters of multiple stereo cameras.
  • a global coordinate system can also be established in various ways, and marker points can be prepared in advance in the global coordinate system, and the marker points are known in the global coordinate system, but a total station or complex calibration objects are often required to cooperate, increasing the The cost of completing stereo camera calibration.
  • the present disclosure provides a multi-stereo camera calibration method and device, an electronic device and a storage medium, which improve the calibration efficiency and accuracy of the multi-stereo camera.
  • an embodiment of the present disclosure provides a method for calibrating a multi-stereo camera, including:
  • the first calibration object is placed in the field of view of the plurality of stereo cameras and the second calibration object is placed in the field of view of the plurality of stereo cameras; wherein, the first calibration object includes a calibration plate, and the second calibration object Including a plurality of calibration points on a straight line, at least two of the calibration points can be seen in each of the stereo cameras;
  • the shooting coordinates of the first calibration point and the second calibration point and fit a straight line according to the shooting coordinates of the first calibration point; wherein, the first calibration point and the second calibration point are located in different a calibration point in the field of view of the stereo camera, the second calibration point is located on the fitted straight line;
  • the translation matrix between the coordinate systems where the two stereo cameras are located is obtained according to the calculated coordinates and the shooting coordinates of the same second calibration point and the rotation matrix between the coordinate systems where the two stereo cameras are located.
  • the method further includes:
  • the point cloud to which the first calibration object belongs in the point cloud obtained by the stereo camera is extracted by using a clustering algorithm and/or a filtering algorithm.
  • a least squares algorithm or a random sampling consensus algorithm is used to fit the plane according to the point cloud to which the first calibration object belongs, obtained by the stereo camera.
  • obtaining the rotation matrix between the coordinate systems where the two stereo cameras are located according to the normal vectors corresponding to the two stereo cameras including:
  • (N 1x , N 1y , N 1z ) are the three-dimensional coordinates of the normal vector corresponding to one of the two stereo cameras
  • (N 2x , N 2y , N 2z ) are the two stereo cameras the three-dimensional coordinates of the normal vector corresponding to another stereo camera in the stereo camera
  • R21 is the rotation matrix between the coordinate systems where the two stereo cameras are located
  • a singular value decomposition algorithm is used to obtain the rotation matrix between the coordinate systems where the two stereo cameras are located according to the normal vectors corresponding to the two stereo cameras.
  • fitting a straight line according to the shooting coordinates of the first calibration point including:
  • a straight line is fitted according to the shooting coordinates of at least two of the first calibration points, so that the at least two first calibration points are located on the fitted straight line.
  • obtaining the calculated coordinates of the second calibration point according to the shooting coordinates of the first calibration point and the distribution positions of all the calibration points including:
  • the calculated coordinates of the second calibration point are obtained according to the shooting coordinates of the first calibration point, the fitted equation of the straight line, and the distance.
  • the calibration points are arranged at equal intervals
  • the product of the difference between the label of the second calibration point and the label of the first calibration point located on the fitted straight line and the distance between two adjacent calibration points is the The distance between the first calibration point and the second calibration point on the straight line.
  • the different second calibration points list the calculated coordinates of the second calibration points, the shooting coordinates, the rotation matrix between the coordinate systems where the two stereo cameras are located, and the coordinates where the two stereo cameras are located.
  • R is the rotation matrix between the coordinate systems where the two stereo cameras are located
  • T is the translation matrix between the coordinate systems where the two stereo cameras are located
  • (Px', Py', Pz') is the first The calculated coordinates of the two calibration points, (Px, Py, Pz) are the shooting coordinates of the second calibration point;
  • the translation matrix between the coordinate systems where the two stereo cameras are located is obtained according to the relational equation.
  • the average value algorithm is used to obtain the coordinates between the coordinate systems where the two stereo cameras are located according to the calculated coordinates of the same second calibration point, the shooting coordinates, and the rotation matrix between the coordinate systems where the two stereo cameras are located. the translation matrix.
  • acquiring the shooting coordinates of the first calibration point includes:
  • the shooting coordinates of the first calibration point where the second calibration object is in different poses are acquired.
  • the pose of the first calibration object includes a distance from the first calibration object to the stereo camera, and/or an inclination angle of the first calibration object relative to the stereo camera;
  • the pose of the second calibration object includes a distance from the second calibration object to the stereo camera, and/or an inclination angle of the second calibration object relative to the stereo camera.
  • the first calibration object and the second calibration object are set integrally or independently.
  • an embodiment of the present disclosure also provides a multi-stereo camera calibration device, including:
  • a calibration object setting module used for placing a first calibration object in the field of view of a plurality of stereo cameras and placing a second calibration object in the field of view of the plurality of stereo cameras; wherein the first calibration object includes a calibration plate , the second calibration object includes a plurality of calibration points located on a straight line, and at least two of the calibration points can be seen in each of the stereo cameras;
  • a normal vector acquisition module configured to extract the point cloud to which the first calibration object belongs in the point cloud obtained by the stereo camera when the first calibration object is in different poses, and according to the first calibration obtained by the stereo camera The point cloud fitting plane to which the object belongs, and the normal vector of the fitted plane is obtained;
  • a rotation matrix acquisition module configured to acquire the rotation matrix between the coordinate systems where the two stereo cameras are located according to the normal vectors corresponding to the two stereo cameras
  • a straight line fitting module used for acquiring the shooting coordinates of the first calibration point and the second calibration point, and fitting a straight line according to the shooting coordinates of the first calibration point; wherein, the first calibration point and the second calibration point
  • the fixed points are calibration points located in different fields of view of the stereo cameras, and the second calibration point is located on the fitted straight line;
  • a calculation coordinate obtaining module configured to obtain the calculation coordinates of the second calibration point according to the shooting coordinates of the first calibration point and the distribution positions of all the calibration points;
  • the translation matrix acquisition module is used for acquiring the translation matrix between the coordinate systems where the two stereo cameras are located according to the calculated coordinates of the same second calibration point, the shooting coordinates and the rotation matrix between the coordinate systems where the two stereo cameras are located .
  • an embodiment of the present disclosure further provides an electronic device, including a processor and a memory, where the processor executes the steps of the calibration method for a multi-stereo camera according to the first aspect by invoking a program or an instruction stored in the memory.
  • an embodiment of the present disclosure further provides a storage medium, where the storage medium stores a program or an instruction, where the program or instruction causes a computer to execute the steps of the calibration method for a multi-stereo camera according to the first aspect.
  • the technical solutions of the embodiments of the present disclosure provide a method for calibrating multiple stereo cameras.
  • the coordinate system where one stereo camera is located is used as the basic coordinate system, and the rotation matrix between each other stereo cameras and the coordinate system where the basic stereo camera is located is calibrated and translation matrix, that is, the external parameter matrix between each other stereo camera and the coordinate system of the basic stereo camera is calibrated, which realizes the calibration of multi-stereo cameras, and the step-by-step calibration of the rotation matrix and translation matrix is conducive to the
  • the theorem analysis of the calibration accuracy of the rotation matrix and the translation matrix is carried out to reduce the calibration error, so as to improve the calibration accuracy of the rotation matrix or translation matrix of a stereo camera in different ways.
  • the production of the first calibration object and the second calibration object is relatively simple, no iterative calculation is required, the calibration efficiency and accuracy are high, and third-party tools such as total stations are not required, which effectively reduces the multi-stereo camera calibration work. cost.
  • FIG. 1 is a schematic flowchart of a method for calibrating a multi-stereo camera according to an embodiment of the present disclosure
  • FIG. 2 is a schematic diagram of a position structure of a multi-stereo camera according to an embodiment of the present disclosure
  • FIG. 3 is a schematic top-view structure diagram of a first calibration object provided by an embodiment of the present disclosure
  • FIG. 4 is a schematic structural diagram of a multi-stereo camera calibration device according to an embodiment of the present disclosure
  • FIG. 5 is a schematic structural diagram of an electronic device according to an embodiment of the present invention.
  • FIG. 1 is a schematic flowchart of a method for calibrating a multi-stereo camera according to an embodiment of the present disclosure.
  • the method for calibrating a multi-stereo camera can be applied to an application scenario where multiple stereo cameras need to be calibrated, and can be performed by the multi-stereo camera calibration device provided by the embodiment of the present disclosure, and the multi-stereo camera calibration device can use software and/or hardware. way to achieve.
  • the calibration method of the multi-stereo camera includes the following steps:
  • FIG. 2 is a schematic diagram of a position structure of a multi-stereo camera according to an embodiment of the present disclosure. As shown in FIG. 2 , multiple stereo cameras 10 are located at the same level. FIG. 2 exemplarily sets the fields of view of different stereo cameras 10 to overlap, and it is also possible to set some or all of the fields of view of the stereo cameras 10 . There is no overlap.
  • FIG. 3 is a schematic top-view structural diagram of a first calibration object provided by an embodiment of the present disclosure. 2 and 3, a first calibration object 1 and a second calibration object 2 can be seen in each stereo camera 10.
  • the first calibration object 1 includes a calibration plate.
  • the calibration plate can be, for example, a solid color calibration plate, and a first calibration can be set.
  • Object 1 that is, the area of the calibration plate is large enough to ensure that the first calibration object 1 can be seen in each stereo camera 10 .
  • the second calibration object 2 includes a plurality of calibration points A located on a straight line. At least two calibration points A can be seen in each stereo camera 10 , that is, at least two calibration points A are located in the field of view of the same stereo camera 10 .
  • the fabrication of the first calibration object 1 and the second calibration object 2 used in the disclosed embodiment is relatively simple.
  • S102 Extract the point cloud to which the first calibration object belongs in the point cloud obtained by the stereo camera when the first calibration object is in different poses, fit the plane according to the point cloud to which the first calibration object belongs, and obtain the fitted plane normal vector.
  • two-dimensional images and corresponding three-dimensional point clouds captured by each stereo camera 10 are obtained, and the point cloud to which the first calibration object 1 belongs is extracted from the point cloud obtained by each stereo camera 10 .
  • a clustering algorithm and/or a filtering algorithm may be used to extract the point cloud to which the first calibration object 1 belongs in the point cloud obtained by each stereo camera 10 .
  • the clustering algorithm is to cluster the point clouds that may be located on the same plane in the point cloud to which the first calibration object 1 belongs, so as to facilitate the subsequent work of fitting the plane
  • the filtering algorithm is to filter out the points in the acquired point cloud. Noise, in order to improve the accuracy of the point cloud extraction to which the first calibration object 1 belongs, the clustering algorithm and the filtering algorithm are both commonly used processing algorithms for 3D point clouds, and will not be discussed in detail here.
  • Fitting the plane corresponding to the stereo camera 10 according to the point cloud of the first calibration object 1 obtained by the stereo camera 10 exemplarily, the least squares algorithm or the random sampling consensus algorithm can be used according to the first calibration object 1 obtained by the stereo camera 10 .
  • the normal vector of the plane corresponding to the stereo camera 10 is obtained according to the equation of the fitted plane.
  • the vector N(A, B, C) is the unit normal vector of the fitted plane .
  • the first calibration object 1 Before fitting the plane corresponding to the stereo camera 10 according to the point cloud obtained by the stereo camera 10 to which the first calibration object 1 belongs, the first calibration object 1 can be extracted in different poses, and the first calibration object 1 in the point cloud obtained by each stereo camera 10 is the first The point cloud to which calibration object 1 belongs.
  • the pose of the first calibration object 1 includes the distance from the first calibration object 1 to the stereo camera 10 , and/or the inclination angle of the first calibration object 1 relative to the stereo camera 10 .
  • the pose of the first calibration object 1 is continuously changed, that is, the first calibration object 1 is continuously adjusted.
  • the point cloud to which the first calibration object 1 belongs in the point cloud obtained by the stereo camera 10 .
  • each time the pose of the first calibration object 1 is adjusted a set of samplings of the point cloud to which the first calibration object 1 belongs in the point cloud obtained by each stereo camera 10 is formed, and the first calibration object 1 corresponding to each group of samples is sampled. If the pose is different, that is, the distance between the corresponding first calibration object 1 and the stereo camera 10, or the inclination angle of the first calibration object 1 relative to the stereo camera 10 is different, add the first calibration object 1 in the point cloud obtained by each stereo camera 10.
  • the sampling times of the point cloud to which it belongs is beneficial to improve the accuracy and precision of the camera calibration result.
  • the rotation matrix between the coordinate systems where the two stereo cameras 10 are located is obtained according to the normal vectors corresponding to the two stereo cameras 10 , and the relationship between the normal vector and the rotation matrix can be listed according to the normal vectors corresponding to the two stereo cameras 10 equation, the relational equation is:
  • (N 1x , N 1y , N 1z ) are the three-dimensional coordinates of the normal vector corresponding to one of the two stereo cameras 10
  • (N 2x , N 2y , N 2z ) are the two stereo cameras 10
  • the three-dimensional coordinates of the normal vector corresponding to another stereo camera 10, R21 is the rotation matrix between the coordinate systems where the two stereo cameras 10 are located, and the rotation matrix between the coordinate systems where the two stereo cameras 10 are located is obtained according to the relational equation.
  • the plane corresponding to the stereo camera 101 is fitted according to the point cloud obtained by the stereo camera 101 to which the first calibration object 1 belongs, such as:
  • the normal vector of the first fitting plane is obtained, for example, the first normal vector N1.
  • a plane corresponding to the stereo camera 102 is fitted according to the point cloud obtained by the stereo camera 102 to which the first calibration object 1 belongs, such as the second fitting plane, and the normal vector of the second fitting plane is obtained, such as the second normal vector N2.
  • the first normal vector N1, the second normal vector N2, and the rotation matrix between the coordinate system where the stereo camera 101 and the stereo camera 102 are located satisfy the above equation relationship.
  • the first method The coordinates of the vector N1 are (N 1x , N 1y , N 1z ), the coordinates of the second normal vector N2 are (N 2x , N 2y , N 2z ), and R21 is the coordinate system where the stereo camera 102 is located and wants to be unified to the stereo camera
  • each of the other stereo cameras 10 converts their respective coordinate systems to the coordinate system where the stereo camera 101 is located according to the above method.
  • the corresponding rotation matrices of the process are different.
  • the normal vector corresponding to the stereo camera 101 and the corresponding normal vector of the stereo camera 102 can be obtained.
  • a set of normal vector relationship equations described in the above-mentioned embodiments that are satisfied by the normal vector and the rotation matrix between the coordinate systems of the two stereo cameras 10, the number of times to adjust the pose of the first calibration object 1 can be set to N, then N groups of normal vector relationship equations described in the above embodiments can be obtained corresponding to the stereo camera 101 and the stereo camera 102 .
  • a singular value decomposition algorithm can be used to obtain the two stereo cameras according to the normal vectors corresponding to the two stereo cameras 10 .
  • the rotation matrix between the coordinate systems where the stereo camera 101 is located that is, the rotation matrix between the coordinate systems where the stereo camera 101 and the stereo camera 102 are located can be obtained by using the singular value decomposition algorithm according to the normal vectors corresponding to the stereo camera 101 and the stereo camera 102 .
  • the planes fitted according to the point clouds of the first calibration object 1 obtained by different stereo cameras 10 are different. To achieve the unification of the coordinate systems where all stereo cameras 10 are located, it is necessary to make the fitting corresponding to different stereo cameras 10 through the calibration process. planes coincide.
  • the embodiment of the present disclosure first obtains the rotation matrices between the coordinate systems where the two stereo cameras 10 are located, and through the rotation matrices between the coordinate systems where the different stereo cameras 10 are located, the fitting planes corresponding to the different stereo cameras 10 can be realized to be parallel to each other, Then calculate the translation matrix between the coordinate systems where the different stereo cameras 10 are located, and use the translation matrix to translate the fitting planes that are parallel to each other, so that the fitting planes corresponding to the different stereo cameras 10 can be overlapped, and then the coordinate systems where all the stereo cameras 10 are located can be realized.
  • the unification of multiple stereo cameras 10 completes the calibration work.
  • S104 Obtain the shooting coordinates of the first calibration point and the second calibration point, and fit a straight line according to the shooting coordinates of the first calibration point; wherein, the first calibration point and the second calibration point are located in different fields of view of the stereo camera Calibration point, the second calibration point is located on the fitted straight line.
  • a stereo camera can be set and set, for example, the stereo camera 101 shoots the second calibration object 2 to obtain a set stereo camera, such as a two-dimensional image of the second calibration object 2 in the field of view of the stereo camera 101 .
  • the image and the corresponding three-dimensional point cloud extract and set the stereo camera, for example, the calibration point A in the two-dimensional image obtained by the stereo camera 101, that is, the first calibration point A1 and determine the shooting coordinates of the first calibration point A1.
  • the shooting coordinates of the fixed point A1 are the three-dimensional coordinates corresponding to the first calibration point A1 in the point cloud.
  • a straight line is fitted according to the shooting coordinates of the first calibration point A1, and a straight line can be fitted according to the shooting coordinates of the at least two first calibration points A1 so that the at least two first calibration points A1 are located on the fitted straight line.
  • a straight line can be fitted according to the shooting coordinates of the two first calibration points A1 so that the two first calibration points A1 are located on the fitted straight line, and the stereo camera 101 in FIG. 2 is set as the stereo camera.
  • acquiring the shooting coordinates of the first calibration point A1 may be acquiring the shooting coordinates of the first calibration point A1 where the second calibration object 2 is in a different pose.
  • the pose of the second calibration object 2 may include the second calibration object 2 to the stereo camera, for example, the distance from the stereo camera 101 is set, and/or the second calibration object 2 is relative to the stereo camera, for example, the stereo camera is set.
  • the tilt angle of the camera 101 may be acquiring the shooting coordinates of the first calibration point A1 where the second calibration object 2 is in a different pose.
  • the pose of the second calibration object 2 may include the second calibration object 2 to the stereo camera, for example, the distance from the stereo camera 101 is set, and/or the second calibration object 2 is relative to the stereo camera, for example, the stereo camera is set.
  • the tilt angle of the camera 101 may be acquiring the shooting coordinates of the first calibration point A1 where the second calibration object 2 is in a different pose.
  • the pose of the second calibration object 2 may include the second calibration object 2 to the stereo camera
  • the pose of the second calibration object 2 is continuously changed, that is, the second calibration object 2 is continuously adjusted to the stereo camera, for example, the distance of the stereo camera 101 is set, and the second calibration object 2 is continuously adjusted.
  • the calibration object 2 is relative to the stereo camera, for example, the inclination angle of the stereo camera 101 is set, and each time the pose of the second calibration object 2 is adjusted, the shooting coordinates of the first calibration point A1 corresponding to a pose of the second calibration object 2 are obtained.
  • it may be set to acquire the shooting coordinates of the first calibration point A1 where the second calibration object 2 is in at least eight different poses.
  • the distance between the object 2 and the stereo camera for example, setting the distance of the stereo camera 101, or the second calibration object 2 relative to the stereo camera, for example, setting the inclination angle of the stereo camera 101 to be different, increasing the sampling times of the shooting coordinates of the first calibration point A1 is beneficial to Improve the accuracy and precision of camera calibration results.
  • the shooting coordinates of the second calibration point are acquired, the first calibration point and the second calibration point are calibration points located in different fields of view of the stereo camera, and the second calibration point is located on the fitted straight line.
  • the stereo camera 102 shoots the second calibration object 2 to obtain a two-dimensional image of the second calibration object 2 in the field of view of the stereo camera 102 and the corresponding three-dimensional point cloud , extract the calibration point A in the two-dimensional image obtained by the stereo camera 102, that is, the second calibration point A2 and determine the shooting coordinates of the second calibration point A2, the shooting coordinates of the second calibration point A2 are the second calibration point A2 at the point
  • the corresponding three-dimensional coordinates in the cloud, and the shooting coordinates of the second calibration point A2 are the coordinates of the second calibration point A2 in the coordinate system where the stereo camera 102 is located, and the process of obtaining the shooting coordinates of the first calibration point A1 and the second calibration point can be set.
  • the shooting coordinates of the second calibration point A2 where the second calibration object 2 is in different poses can be obtained.
  • the pose of the second calibration object 2 is constantly changed, that is, the distance from the second calibration object 2 to the stereo camera 10 is continuously adjusted, and the relative position of the second calibration object 2 to the stereo camera 10 is continuously adjusted.
  • the tilt angle of the camera 10 is adjusted every time the pose of the second calibration object 2 is adjusted, and the shooting coordinates of the second calibration point A2 corresponding to one pose of the second calibration object 2 are obtained.
  • it may be set to acquire the shooting coordinates of the second calibration point A2 where the second calibration object 2 is in at least eight different poses.
  • each time the pose of the second calibration object 2 is adjusted a set of samples of the shooting coordinates of the second calibration point A2 are formed, and the poses of the second calibration object 2 corresponding to each set of samples are different, that is, the corresponding second calibration
  • the distance from the object 2 to the stereo camera 10 or the inclination angle of the second calibration object 2 relative to the stereo camera 10 is different.
  • Increasing the sampling times of the shooting coordinates of the second calibration point A2 is beneficial to improve the accuracy and precision of the camera calibration result.
  • S105 Acquire the calculated coordinates of the second calibration point according to the shooting coordinates of the first calibration point and the distribution positions of all the calibration points.
  • the shooting coordinates of the first calibration point A1 and the distribution positions of all the calibration points A the calculated coordinates of the second calibration point A2 located on the fitted straight line are obtained, and the second calibration point A2 is located in the stereo camera except the setting,
  • the calibration point A in the field of view of the other stereo cameras other than the stereo camera 101 is taken as an example here that the second calibration point A2 is the calibration point A located in the field of view of the stereo camera 102 .
  • the distance between the first calibration point A1 and the second calibration point A2 on the fitted straight line can be determined according to the distribution positions of all the calibration points A, according to the shooting coordinates of the first calibration point A1, the equation of the fitted straight line and The distance obtains the calculated coordinates of the second calibration point A2 located on the fitted straight line.
  • the calibration points A can be set at equal intervals, and the distance between the first calibration point A1 and the second calibration point A2 on the fitted straight line is determined according to the distribution positions of all the calibration points A, All calibration points A can be numbered in sequence, and the product of the difference between the label of the second calibration point A2 on the fitted straight line and the label of the first calibration point A1 and the distance d between the adjacent two calibration points A is: The distance between the first calibration point A1 and the second calibration point A2 on the fitted straight line.
  • the marking point may be, for example, a circular marking point.
  • the first calibration point A1 may be, for example, the calibration point A11 with the label 2
  • the second calibration point A2 may be, for example, the calibration point A21 with the label 7.
  • five times the distance d between two adjacent calibration points A is the distance between the first calibration point A11 and the second calibration point A21 on the fitted straight line.
  • the equation of the fitted straight line is known, and then combined Knowing the shooting coordinates of the first calibration point A11 on the straight line, that is, the three-dimensional coordinates, the calculated coordinates of the second calibration point A21 on the fitted straight line can be obtained by calculation, and the calculated coordinates of the second calibration point A21 are the second calibration point A21.
  • the fixed point A21 is setting the stereo camera, for example, the coordinates in the coordinate system where the stereo camera 101 is located.
  • the above embodiments are only described by taking the stereo camera 101 as the setting stereo camera as an example, and other stereo cameras may also be used as the setting stereo camera, which is not limited in the embodiments of the present disclosure.
  • S106 Obtain a translation matrix between the coordinate systems where the two stereo cameras are located according to the calculated coordinates of the same second calibration point, the shooting coordinates, and the rotation matrix between the coordinate systems where the two stereo cameras are located.
  • the stereo camera 10 can acquire the three-dimensional point cloud of the target object, and the point cloud can be used to realize the three-dimensional reconstruction, detection and measurement of the target.
  • the number of stereo cameras 10 can be increased, and multiple stereo cameras 10 can acquire point clouds at the same time and use them for splicing to expand the field of view and acquire point clouds of larger targets.
  • the transformation matrix B can be represented as a 4 ⁇ 4 matrix, and the transformation matrix B satisfies the following calculation formula:
  • the transformation matrix B that is, the external parameter calibration matrix
  • the transformation matrix B can be marked as a 4 ⁇ 4 matrix, or it can be composed of a 3 ⁇ 3 rotation matrix R and a 3 ⁇ 1 translation matrix T, and the coordinate system is transformed by some rigid bodies. , for example, it can be converted to another coordinate system by doing some translation and rotation along the x direction, y direction or z direction respectively.
  • the translation matrix T and the rotation matrix R can be calculated.
  • both the rotation matrix R and the translation matrix T are expanded into 4 ⁇ 4 matrices.
  • the first three matrices in the second row of the equation correspond to the rotation matrix R, and the latter matrix corresponds to the translation matrix T. According to the linear Algebraic related theory, the expansion of the above matrix does not affect the calculation results.
  • the stereo camera for example, the coordinate system where the stereo camera 101 is located can be used as the basic coordinate system, as long as the transformation matrix B of the remaining stereo cameras 10 and the stereo cameras 101 is calibrated, that is, the calibration
  • the calibration of multiple stereo cameras 10 can be completed, and the coordinate systems of all the stereo cameras 10 can be unified.
  • the coordinate system where other stereo cameras 10 are located may also be set as the base coordinate system, and the coordinate system where the stereo camera 101 is located is not limited to be the base coordinate system.
  • the shooting coordinates and the rotation matrix between the coordinate systems where the two stereo cameras are located can be obtained according to different second Calibration point A2, which lists the calculated coordinates, shooting coordinates, rotation matrix between the coordinate systems where the two stereo cameras are located, and translation matrices between the coordinate systems where the two stereo cameras are located.
  • a stereo camera can be set according to the calculated coordinates and shooting coordinates of the same second calibration point A2, for example, the stereo camera 101 corresponding to the second calibration point A2, such as the rotation between the coordinate systems where the stereo camera 102 is located.
  • Matrix to obtain and set the stereo camera, for example, the stereo camera corresponding to the stereo camera 101 and the second calibration point A2, such as the translation matrix between the coordinate systems where the stereo camera 102 is located, can list many different second calibration points A2.
  • the relational equation between the translation matrices between the coordinate systems where the camera 102 is located is:
  • R is the rotation matrix between the coordinate systems where the two stereo cameras are located
  • T is the translation matrix between the coordinate systems where the two stereo cameras are located.
  • R can be the setting of the stereo camera, such as the stereo camera 101 and the second standard
  • T can be the set stereo camera, such as the stereo camera corresponding to the stereo camera 101 and the second calibration point A2, such as the coordinates of the stereo camera 102
  • the translation matrix between the systems, (Px', Py', Pz') are the calculated coordinates of the second calibration point A2
  • Px, Py, Pz are the shooting coordinates of the second calibration point A2, according to the relational equation to obtain the setting A stereo camera, for example, a stereo camera corresponding to the stereo camera 101 and the second calibration point A2, for example, a translation matrix between the coordinate systems where the stereo camera 102 is located.
  • the calibration transformation matrix includes a rotation matrix and a translation matrix, and the three-dimensional coordinate point P' corresponding to the calculated coordinates of the second calibration point A2 obtained according to the distribution positions of all the calibration points A and the three-dimensional coordinates corresponding to the shooting coordinates of the second calibration point A2
  • the point P belongs to the same point in the physical world, which is called the point of the same name.
  • the coordinates of P' are (Px', Py', Pz'), and the coordinates of P are (Px, Py, Pz).
  • the formula P' (RT)P, that is, the above RT relational equation is satisfied.
  • an average value algorithm can be used to obtain the translation matrix between the coordinate systems where the two stereo cameras are located according to the calculated coordinates of the same second calibration point, the shooting coordinates, and the rotation matrix between the coordinate systems where the two stereo cameras are located, for example
  • the average value algorithm can be used to calculate the coordinates, shooting coordinates and set the stereo camera according to the same second calibration point A2, for example, the stereo camera 101 corresponding to the second calibration point A2, for example, the stereo camera 102 is located between the coordinate systems.
  • For the rotation matrix obtain and set the stereo camera, for example, the stereo camera corresponding to the stereo camera 101 and the second calibration point A2, for example, the translation matrix between the coordinate systems where the stereo camera 102 is located.
  • S101 to S106 are only used to represent each step in the calibration method of the multi-stereo camera 10, and do not represent a limitation on the execution order of each step. Unless it is absolutely necessary to make one of the two steps There is a strict sequential execution order between the other steps, and the other steps may be performed simultaneously or the sequential execution order may be adjusted, which is not specifically limited in this embodiment of the present disclosure.
  • the translation matrix obtained by the solution in the above-mentioned embodiment is the solution result of the average value, so the translation matrix obtained from the sampling group can be compared with the average value of the translation matrix. If it is large, the sampling group can be deleted to improve the accuracy of the translation matrix obtained by the solution.
  • the process of solving the rotation matrix in the above-mentioned embodiment is an approximate solving process of singular value decomposition. The difference between the normal vectors is large, indicating that the rotation matrix obtained by the sampling group has a large error, and the sampling group can also be deleted to improve the accuracy of the rotation matrix obtained by the solution.
  • the first calibration object 1 and the second calibration object 2 can be set integrally or independently.
  • the first calibration object 1 and the second calibration object 2 can be sampled at the same time or can be sampled at the same time. sample separately.
  • the first calibration object 1 and the second calibration object 2 can be integrated, the first calibration object 1 includes a calibration plate, and the second calibration object 2 includes a plurality of calibration points A located on a straight line, which can be drawn on the calibration plate A straight line and multiple calibration points A are marked on the straight line.
  • the first calibration object 1 and the second calibration object 2 can also be set independently.
  • the first calibration object 1 can be a block-shaped steel plate, and the second calibration object 2 can be a straight rod, and multiple targets are marked on the straight rod. Fixed point A.
  • the adjacent stereo cameras 10 can be calibrated first, and then the first calibration object 1 can be moved. and the second calibration object 2 to be calibrated by transfer.
  • the first to fourth stereo cameras 10 can be calibrated by using the first calibration object 1 and the second calibration object 2, and the first to fourth stereo cameras 10 are unified to the location where the first stereo camera 10 is located.
  • Coordinate system then move the first calibration object 1 and the second calibration object 2, calibrate the fifth to eighth stereo cameras 10, and unify the fifth to eighth stereo cameras 10 to the fifth stereo camera
  • the coordinate system where 10 is located is finally unified to the coordinate system where the first stereo camera 10 is located, so as to prevent the first calibration object 1 or the second calibration object 2 from being too large in size, resulting in heavy calibration of multiple stereo cameras 10 .
  • FIG. 4 is a schematic structural diagram of a multi-stereo camera calibration device according to an embodiment of the present disclosure.
  • the multi-stereo camera calibration device includes a calibration object setting module 201 , a normal vector obtaining module 202 , a rotation matrix obtaining module 203 , a line fitting module 204 , a calculation coordinate obtaining module 205 and a translation matrix obtaining module 206 .
  • the calibration object setting module 201 is used for placing the first calibration object in the field of view of the plurality of stereo cameras and placing the second calibration object in the field of view of the plurality of stereo cameras; wherein the first calibration object includes a calibration plate, and the first calibration object includes a calibration plate.
  • the second calibration object includes a plurality of calibration points located on a straight line, and at least two calibration points are visible in each stereo camera.
  • the normal vector acquisition module 202 is used to extract the point cloud to which the first calibration object belongs in the point cloud obtained by the stereo camera under different poses of the first calibration object, and to fit the plane according to the point cloud of the first calibration object obtained by the stereo camera, and obtain The normal vector of the fitted plane.
  • the rotation matrix obtaining module 203 is configured to obtain the rotation moment between the coordinate systems where the two stereo cameras are located according to the normal vectors corresponding to the two stereo cameras.
  • the straight line fitting module 204 is used to obtain the shooting coordinates of the first calibration point and the second calibration point, and fit a straight line according to the shooting coordinates of the first calibration point; wherein, the first calibration point and the second calibration point are located in different three-dimensional The calibration point in the camera's field of view, the second calibration point is located on the fitted straight line.
  • the calculation coordinate obtaining module 205 is configured to obtain the calculation coordinates of the second calibration point according to the shooting coordinates of the first calibration point and the distribution positions of all the calibration points.
  • the translation matrix obtaining module 206 is configured to obtain the translation matrix between the coordinate systems where the two stereo cameras are located according to the calculated coordinates of the same second calibration point, the shooting coordinates and the rotation matrix between the coordinate systems where the two stereo cameras are located.
  • the technical solutions of the embodiments of the present disclosure provide a method for calibrating multiple stereo cameras.
  • the coordinate system where one stereo camera is located is used as the basic coordinate system, and the rotation matrix between each other stereo cameras and the coordinate system where the basic stereo camera is located is calibrated and translation matrix, that is, the external parameter matrix between each other stereo camera and the coordinate system of the basic stereo camera is calibrated, which realizes the calibration of multi-stereo cameras, and the step-by-step calibration of the rotation matrix and translation matrix is conducive to the
  • the theorem analysis of the calibration accuracy of the rotation matrix and the translation matrix is carried out to reduce the calibration error, so as to improve the calibration accuracy of the rotation matrix or translation matrix of a stereo camera in different ways.
  • the production of the first calibration object and the second calibration object is relatively simple, no iterative calculation is required, the calibration efficiency and accuracy are high, and third-party tools such as total stations are not required, which effectively reduces the multi-stereo camera calibration work. cost.
  • FIG. 5 is a schematic structural diagram of an electronic device provided by an embodiment of the present invention.
  • the electronic device includes a processor and a memory.
  • the processor executes the steps of the method for calibrating a multi-stereo camera according to the above-mentioned embodiment by invoking a program or an instruction stored in the memory. Therefore, it has the beneficial effects of the above-mentioned embodiment. No longer.
  • the electronic device may be arranged to include at least one processor 301 , at least one memory 302 and at least one communication interface 303 .
  • the various components in the electronic device are coupled together by a bus system 304 .
  • the communication interface 303 is used for information transmission with external devices.
  • the bus system 304 is used to implement the connection communication between these components.
  • the bus system 304 also includes a power bus, a control bus and a status signal bus.
  • the various buses are labeled as bus system 304 in FIG. 5 .
  • the memory 302 in this embodiment may be a volatile memory or a non-volatile memory, or may include both volatile and non-volatile memory.
  • the memory 302 stores the following elements: executable units or data structures, or a subset thereof, or an extended set of operating systems and applications.
  • the processor 301 executes the steps of the various embodiments of the calibration method for a multi-stereo camera provided by the embodiment of the present invention by calling a program or an instruction stored in the memory 302 .
  • the multi-stereo camera calibration method provided in the embodiment of the present invention may be applied to the processor 301 or implemented by the processor 301 .
  • the processor 301 may be an integrated circuit chip, which has signal processing capability. In the implementation process, each step of the above-mentioned method can be completed by an integrated logic circuit of hardware in the processor 301 or an instruction in the form of software.
  • the above-mentioned processor 301 can be a general-purpose processor, a digital signal processor (Digital Signal Processor, DSP), an application specific integrated circuit (Application Specific Integrated Circuit, ASIC), a ready-made programmable gate array (Field Programmable Gate Array, FPGA) or other Programmable logic devices, discrete gate or transistor logic devices, discrete hardware components.
  • a general purpose processor may be a microprocessor or the processor may be any conventional processor or the like.
  • the steps of the method for calibrating a multi-stereo camera provided by the embodiment of the present invention may be directly embodied as being executed by a hardware decoding processor, or executed by a combination of hardware and software units in the decoding processor.
  • the software unit may be located in random access memory, flash memory, read-only memory, programmable read-only memory or electrically erasable programmable memory, registers and other storage media mature in the art.
  • the storage medium is located in the memory 302, and the processor 301 reads the information in the memory 302, and completes the steps of the method in combination with its hardware.
  • the electronic device may further include one entity component, or multiple entity components, according to the instructions generated by the processor 301 when executing the calibration method for a multi-stereo camera provided by the embodiment of the present application.
  • Each entity component cooperates with the processor 301 and the memory 302 to realize the functions of the electronic device in this embodiment.
  • An embodiment of the present invention also provides a storage medium, such as a computer-readable storage medium, the storage medium stores a program or an instruction, the program or instruction enables a computer to execute a multi-stereo camera calibration method when running, and the method includes:
  • the first calibration object is placed in the field of view of the plurality of stereo cameras and the second calibration object is placed in the field of view of the plurality of stereo cameras; wherein, the first calibration object includes a calibration plate, and the second calibration object Including a plurality of calibration points on a straight line, at least two of the calibration points can be seen in each of the stereo cameras;
  • the shooting coordinates of the first calibration point and the second calibration point and fit a straight line according to the shooting coordinates of the first calibration point; wherein, the first calibration point and the second calibration point are located in different a calibration point in the field of view of the stereo camera, the second calibration point is located on the fitted straight line;
  • the translation matrix between the coordinate systems where the two stereo cameras are located is obtained according to the calculated coordinates and the shooting coordinates of the same second calibration point and the rotation matrix between the coordinate systems where the two stereo cameras are located.
  • the computer-executable instructions when executed by a computer processor, may also be used to execute the technical solution of the calibration method for a multi-stereo camera provided by any embodiment of the present invention.
  • the present application can be implemented by software and necessary general-purpose hardware, and of course can also be implemented by hardware, but in many cases, the former is a better implementation.
  • the technical solutions of the present application can be embodied in the form of software products in essence or the parts that make contributions to the prior art, and the computer software products can be stored in a computer-readable storage medium, such as a floppy disk of a computer , read-only memory (Read-Only Memory, ROM), random access memory (Random Access Memory, RAM), flash memory (FLASH), hard disk or optical disk, etc., including several instructions to make a computer device (which can be a personal computer , server, or network device, etc.) to execute the methods of various embodiments of the present invention.
  • a computer-readable storage medium such as a floppy disk of a computer , read-only memory (Read-Only Memory, ROM), random access memory (Random Access Memory, RAM), flash memory (FLASH), hard disk or optical disk, etc.

Landscapes

  • Engineering & Computer Science (AREA)
  • Data Mining & Analysis (AREA)
  • Theoretical Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • General Physics & Mathematics (AREA)
  • Bioinformatics & Cheminformatics (AREA)
  • Bioinformatics & Computational Biology (AREA)
  • Evolutionary Biology (AREA)
  • Evolutionary Computation (AREA)
  • Artificial Intelligence (AREA)
  • General Engineering & Computer Science (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Length Measuring Devices By Optical Means (AREA)
  • Measurement Of Optical Distance (AREA)

Abstract

The present application relates to a calibration method and apparatus for multiple stereo cameras, an electronic device, and a storage medium. The calibration method comprises: extracting point clouds to which a first calibration object belongs in point clouds obtained by stereo cameras when the first calibration object is at different poses, fitting planes according to the point clouds to which the first calibration object belongs obtained by the stereo cameras, and obtaining normal vectors of the planes; obtaining, according to normal vectors corresponding to two stereo cameras, a rotation matrix between coordinate systems where the two stereo cameras are located; obtaining photographing coordinates of first and second calibration points, and fitting a straight line according to the photographing coordinates of the first calibration point; obtaining calculated coordinates of the second calibration point according to the photographing coordinates of the first calibration point and distribution positions of all calibration points; and according to the calculated coordinates and the photographing coordinates of the same second calibration point and the rotation matrix between the coordinate systems where the two stereo cameras are located, obtaining a translation matrix between the coordinate systems where the two stereo cameras are located.

Description

多立体相机的标定方法及装置Calibration method and device for multi-stereo camera
相关申请的交叉引用CROSS-REFERENCE TO RELATED APPLICATIONS
本申请基于申请号为202110125395.8、申请日为2021年1月29日的中国专利申请提出,并要求该中国专利申请的优先权,该中国专利申请的全部内容在此引入本申请作为参考。This application is based on the Chinese patent application with the application number of 202110125395.8 and the filing date of January 29, 2021, and claims the priority of the Chinese patent application. The entire content of the Chinese patent application is incorporated herein by reference.
技术领域technical field
本公开涉及计算机视觉技术领域,尤其涉及一种多立体相机的标定方法及装置、电子设备及存储介质。The present disclosure relates to the technical field of computer vision, and in particular, to a method and device for calibrating a multi-stereo camera, an electronic device, and a storage medium.
背景技术Background technique
立体相机可以获取目标物体的三维点云,利用点云可以实现对目标的三维重建、检测以及测量工作等,单个立体相机的视野有限,单次获取的目标物体点云有时无法满足实际需求,因此可以增加立体相机的数量,多台立体相机同时获取点云并进行拼接使用以扩大视野,获取更大目标的点云。要完成多台立体相机获取点云的拼接,这其中最重要是把多台立体相机获取的点云统一到同一个坐标系下,即找到多台相机所在坐标系的转换矩阵以完成多台立体相机的外参标定。The stereo camera can obtain the 3D point cloud of the target object, and the point cloud can be used to realize 3D reconstruction, detection and measurement of the target. The number of stereo cameras can be increased, and multiple stereo cameras can obtain point clouds at the same time and stitch them together to expand the field of view and obtain point clouds of larger targets. To complete the splicing of point clouds obtained by multiple stereo cameras, the most important thing is to unify the point clouds obtained by multiple stereo cameras into the same coordinate system, that is, to find the transformation matrix of the coordinate system where multiple cameras are located to complete multiple stereo cameras. Camera extrinsic calibration.
目前已有的立体相机标定方案中,一种方案是通过拍摄固定于标定平板上的标定棋盘在不同姿态下的二维图像和三维点云,完成立体相机的标定。另一种方案是使用不计厚度的褶皱纸张,利用迭代最近点算法对多台立体相机进行外参标定,虽然能够实现多立体相机的匹配,但是两种标定过程均需要进行迭代过渡计算,标定效率极低,且随着迭代过程的进行,标定误差越来越大,标定精度较差。另外,还可以通过各种方式建立全局坐标系,在全局坐标系提前做好标志点,而且标志点在全局坐标系已知,但是往往需要全站仪或者制作复杂的标定物进行配合,增加了完成立体相机标定的成本。Among the existing stereo camera calibration solutions, one solution is to complete the calibration of the stereo camera by shooting two-dimensional images and three-dimensional point clouds of the calibration chessboard fixed on the calibration plate in different postures. Another solution is to use wrinkled paper regardless of thickness, and use the iterative closest point algorithm to calibrate the external parameters of multiple stereo cameras. Although the matching of multiple stereo cameras can be achieved, both calibration processes require iterative transition calculation, and the calibration efficiency It is extremely low, and with the progress of the iterative process, the calibration error becomes larger and larger, and the calibration accuracy is poor. In addition, a global coordinate system can also be established in various ways, and marker points can be prepared in advance in the global coordinate system, and the marker points are known in the global coordinate system, but a total station or complex calibration objects are often required to cooperate, increasing the The cost of completing stereo camera calibration.
发明内容SUMMARY OF THE INVENTION
为了解决上述技术问题或者至少部分地解决上述技术问题,本公开提供了一种多立体相机的标定方法及装置、电子设备及存储介质,提高了多立体相机的标定效率和精度。In order to solve the above technical problems or at least partially solve the above technical problems, the present disclosure provides a multi-stereo camera calibration method and device, an electronic device and a storage medium, which improve the calibration efficiency and accuracy of the multi-stereo camera.
第一方面,本公开实施例提供了一种多立体相机的标定方法,包括:In a first aspect, an embodiment of the present disclosure provides a method for calibrating a multi-stereo camera, including:
将第一标定物放置于多个立体相机的视场中以及将第二标定物放置于多个立体相机的视场中;其中,所述第一标定物包括标定板,所述第二标定物包括位于一条直线上的多个标定点,每台所述立体相机中可见至少两个所述标定点;The first calibration object is placed in the field of view of the plurality of stereo cameras and the second calibration object is placed in the field of view of the plurality of stereo cameras; wherein, the first calibration object includes a calibration plate, and the second calibration object Including a plurality of calibration points on a straight line, at least two of the calibration points can be seen in each of the stereo cameras;
提取所述第一标定物处于不同位姿下所述立体相机所得点云中所述第一标定物所属点云,并根据所述立体相机获取的所述第一标定物所属点云拟合平面,并获取拟合的所述平面的法向量;Extracting the point cloud to which the first calibration object belongs in the point cloud obtained by the stereo camera when the first calibration object is in different poses, and fitting a plane according to the point cloud to which the first calibration object belongs to obtained by the stereo camera , and obtain the normal vector of the fitted plane;
根据两台立体相机对应的所述法向量获取所述两台立体相机所在坐标系之间的旋转矩 阵;Obtain the rotation matrix between the coordinate systems where the two stereo cameras are located according to the normal vectors corresponding to the two stereo cameras;
获取第一标定点和第二标定点的拍摄坐标,根据所述第一标定点的拍摄坐标拟合一条直线;其中,所述第一标定点与所述第二标定点为位于不同的所述立体相机视场中的标定点,所述第二标定点位于拟合的所述直线上;Obtain the shooting coordinates of the first calibration point and the second calibration point, and fit a straight line according to the shooting coordinates of the first calibration point; wherein, the first calibration point and the second calibration point are located in different a calibration point in the field of view of the stereo camera, the second calibration point is located on the fitted straight line;
根据所述第一标定点的拍摄坐标以及所有所述标定点的分布位置获取所述第二标定点的计算坐标;Obtain the calculated coordinates of the second calibration point according to the shooting coordinates of the first calibration point and the distribution positions of all the calibration points;
根据同一所述第二标定点的计算坐标、拍摄坐标以及两台立体相机所在坐标系之间的旋转矩阵,获取所述两台立体相机所在坐标系之间的平移矩阵。The translation matrix between the coordinate systems where the two stereo cameras are located is obtained according to the calculated coordinates and the shooting coordinates of the same second calibration point and the rotation matrix between the coordinate systems where the two stereo cameras are located.
可选地,在根据所述立体相机获取的所述第一标定物所属点云拟合平面之前,还包括:Optionally, before the point cloud fitting plane to which the first calibration object belongs, obtained according to the stereo camera, the method further includes:
采用聚类算法和/或滤波算法提取所述立体相机所得点云中所述第一标定物所属点云。The point cloud to which the first calibration object belongs in the point cloud obtained by the stereo camera is extracted by using a clustering algorithm and/or a filtering algorithm.
可选地,采用最小二乘算法或者随机抽样一致算法根据所述立体相机获取的所述第一标定物所属点云拟合平面。Optionally, a least squares algorithm or a random sampling consensus algorithm is used to fit the plane according to the point cloud to which the first calibration object belongs, obtained by the stereo camera.
可选地,根据两台立体相机对应的所述法向量获取所述两台立体相机所在坐标系之间的旋转矩阵,包括:Optionally, obtaining the rotation matrix between the coordinate systems where the two stereo cameras are located according to the normal vectors corresponding to the two stereo cameras, including:
根据所述两台立体相机对应的所述法向量,列出所述法向量与所述旋转矩阵的关系等式,所述关系等式为:According to the normal vectors corresponding to the two stereo cameras, the relationship equation between the normal vector and the rotation matrix is listed, and the relationship equation is:
Figure PCTCN2021121462-appb-000001
Figure PCTCN2021121462-appb-000001
其中,(N 1x,N 1y,N 1z)为所述两台立体相机中的一台立体相机对应的所述法向量的三维坐标,(N 2x,N 2y,N 2z)为所述两台立体相机中的另一台立体相机对应的所述法向量的三维坐标,R21为所述两台立体相机所在坐标系之间的旋转矩阵; Wherein, (N 1x , N 1y , N 1z ) are the three-dimensional coordinates of the normal vector corresponding to one of the two stereo cameras, and (N 2x , N 2y , N 2z ) are the two stereo cameras the three-dimensional coordinates of the normal vector corresponding to another stereo camera in the stereo camera, and R21 is the rotation matrix between the coordinate systems where the two stereo cameras are located;
根据所述关系等式获取所述两台立体相机所在坐标系之间的旋转矩阵。The rotation matrix between the coordinate systems where the two stereo cameras are located is obtained according to the relational equation.
可选地,采用奇异值分解算法根据所述两台立体相机对应的所述法向量获取所述两台立体相机所在坐标系之间的旋转矩阵。Optionally, a singular value decomposition algorithm is used to obtain the rotation matrix between the coordinate systems where the two stereo cameras are located according to the normal vectors corresponding to the two stereo cameras.
可选地,根据所述第一标定点的拍摄坐标拟合一条直线,包括:Optionally, fitting a straight line according to the shooting coordinates of the first calibration point, including:
根据至少两个所述第一标定点的拍摄坐标拟合一条直线以使所述至少两个所述第一标定点位于拟合的所述直线上。A straight line is fitted according to the shooting coordinates of at least two of the first calibration points, so that the at least two first calibration points are located on the fitted straight line.
可选地,根据所述第一标定点的拍摄坐标以及所有所述标定点的分布位置获取所述第二标定点的计算坐标,包括:Optionally, obtaining the calculated coordinates of the second calibration point according to the shooting coordinates of the first calibration point and the distribution positions of all the calibration points, including:
根据所有所述标定点的分布位置确定位于拟合的所述直线上的所述第一标定点和所述第二标定点之间的间距;Determine the distance between the first calibration point and the second calibration point on the fitted straight line according to the distribution positions of all the calibration points;
根据所述第一标定点的拍摄坐标、拟合的所述直线的方程以及所述间距获取所述第二标定点的计算坐标。The calculated coordinates of the second calibration point are obtained according to the shooting coordinates of the first calibration point, the fitted equation of the straight line, and the distance.
可选地,所述标定点等间距设置;Optionally, the calibration points are arranged at equal intervals;
根据所有所述标定点的分布位置确定位于拟合的所述直线上的所述第一标定点和所述 第二标定点之间的间距,包括:Determine the distance between the first calibration point and the second calibration point on the fitted straight line according to the distribution positions of all the calibration points, including:
对所有所述标定点依次编号;Numbering all the calibration points in sequence;
位于拟合的所述直线上的所述第二标定点的标号与所述第一标定点的标号的差值与相邻两个所述标定点之间间距的乘积,为位于拟合的所述直线上的所述第一标定点和所述第二标定点之间的间距。The product of the difference between the label of the second calibration point and the label of the first calibration point located on the fitted straight line and the distance between two adjacent calibration points is the The distance between the first calibration point and the second calibration point on the straight line.
可选地,根据同一所述第二标定点的计算坐标、拍摄坐标以及两台立体相机所在坐标系之间的旋转矩阵,获取所述两台立体相机所在坐标系之间的平移矩阵,包括:Optionally, obtain the translation matrix between the coordinate systems where the two stereo cameras are located according to the calculated coordinates of the same second calibration point, the shooting coordinates and the rotation matrix between the coordinate systems where the two stereo cameras are located, including:
依据不同的所述第二标定点,列出多组所述第二标定点的计算坐标、拍摄坐标、所述两台立体相机所在坐标系之间的旋转矩阵、所述两台立体相机所在坐标系之间的平移矩阵之间的关系等式;According to the different second calibration points, list the calculated coordinates of the second calibration points, the shooting coordinates, the rotation matrix between the coordinate systems where the two stereo cameras are located, and the coordinates where the two stereo cameras are located. The relationship equation between the translation matrices between the systems;
所述关系等式为:The relational equation is:
Figure PCTCN2021121462-appb-000002
Figure PCTCN2021121462-appb-000002
其中,R为所述两台立体相机所在坐标系之间的旋转矩阵,T为所述两台立体相机所在坐标系之间的平移矩阵,(Px’,Py’,Pz’)为所述第二标定点的计算坐标,(Px,Py,Pz)为所述第二标定点的拍摄坐标;Wherein, R is the rotation matrix between the coordinate systems where the two stereo cameras are located, T is the translation matrix between the coordinate systems where the two stereo cameras are located, and (Px', Py', Pz') is the first The calculated coordinates of the two calibration points, (Px, Py, Pz) are the shooting coordinates of the second calibration point;
根据所述关系等式获取所述两台立体相机所在坐标系之间的平移矩阵。The translation matrix between the coordinate systems where the two stereo cameras are located is obtained according to the relational equation.
可选地,采用平均值算法根据同一所述第二标定点的计算坐标、拍摄坐标以及所述两台立体相机所在坐标系之间的旋转矩阵,获取所述两台立体相机所在坐标系之间的平移矩阵。Optionally, the average value algorithm is used to obtain the coordinates between the coordinate systems where the two stereo cameras are located according to the calculated coordinates of the same second calibration point, the shooting coordinates, and the rotation matrix between the coordinate systems where the two stereo cameras are located. the translation matrix.
可选地,获取所述第一标定点的拍摄坐标,包括:Optionally, acquiring the shooting coordinates of the first calibration point includes:
获取所述第二标定物处于不同位姿下的所述第一标定点的拍摄坐标。The shooting coordinates of the first calibration point where the second calibration object is in different poses are acquired.
可选地,所述第一标定物的位姿包括所述第一标定物至所述立体相机的距离,和/或,所述第一标定物相对于所述立体相机的倾斜角度;Optionally, the pose of the first calibration object includes a distance from the first calibration object to the stereo camera, and/or an inclination angle of the first calibration object relative to the stereo camera;
所述第二标定物的位姿包括所述第二标定物至所述立体相机的距离,和/或,所述第二标定物相对于所述立体相机的倾斜角度。The pose of the second calibration object includes a distance from the second calibration object to the stereo camera, and/or an inclination angle of the second calibration object relative to the stereo camera.
可选地,所述第一标定物和所述第二标定物集成设置或独立设置。Optionally, the first calibration object and the second calibration object are set integrally or independently.
第二方面,本公开实施例还提供了一种多立体相机的标定装置,包括:In a second aspect, an embodiment of the present disclosure also provides a multi-stereo camera calibration device, including:
标定物设置模块,用于将第一标定物放置于多个立体相机的视场中以及将第二标定物放置于多个立体相机的视场中;其中,所述第一标定物包括标定板,所述第二标定物包括位于一条直线上的多个标定点,每台所述立体相机中可见至少两个所述标定点;A calibration object setting module, used for placing a first calibration object in the field of view of a plurality of stereo cameras and placing a second calibration object in the field of view of the plurality of stereo cameras; wherein the first calibration object includes a calibration plate , the second calibration object includes a plurality of calibration points located on a straight line, and at least two of the calibration points can be seen in each of the stereo cameras;
法向量获取模块,用于提取所述第一标定物处于不同位姿下所述立体相机所得点云中所述第一标定物所属点云,并根据所述立体相机获取的所述第一标定物所属点云拟合平面,并获取拟合的所述平面的法向量;A normal vector acquisition module, configured to extract the point cloud to which the first calibration object belongs in the point cloud obtained by the stereo camera when the first calibration object is in different poses, and according to the first calibration obtained by the stereo camera The point cloud fitting plane to which the object belongs, and the normal vector of the fitted plane is obtained;
旋转矩阵获取模块,用于根据两台立体相机对应的所述法向量获取所述两台立体相机所在坐标系之间的旋转矩阵;a rotation matrix acquisition module, configured to acquire the rotation matrix between the coordinate systems where the two stereo cameras are located according to the normal vectors corresponding to the two stereo cameras;
直线拟合模块,用于获取第一标定点和第二标定点的拍摄坐标,根据所述第一标定点的拍摄坐标拟合一条直线;其中,所述第一标定点与所述第二标定点为位于不同的所述立体相机视场中的标定点,所述第二标定点位于拟合的所述直线上;a straight line fitting module, used for acquiring the shooting coordinates of the first calibration point and the second calibration point, and fitting a straight line according to the shooting coordinates of the first calibration point; wherein, the first calibration point and the second calibration point The fixed points are calibration points located in different fields of view of the stereo cameras, and the second calibration point is located on the fitted straight line;
计算坐标获取模块,用于根据所述第一标定点的拍摄坐标以及所有所述标定点的分布位置获取所述第二标定点的计算坐标;a calculation coordinate obtaining module, configured to obtain the calculation coordinates of the second calibration point according to the shooting coordinates of the first calibration point and the distribution positions of all the calibration points;
平移矩阵获取模块,用于根据同一所述第二标定点的计算坐标、拍摄坐标以及两台立体相机所在坐标系之间的旋转矩阵,获取所述两台立体相机所在坐标系之间的平移矩阵。The translation matrix acquisition module is used for acquiring the translation matrix between the coordinate systems where the two stereo cameras are located according to the calculated coordinates of the same second calibration point, the shooting coordinates and the rotation matrix between the coordinate systems where the two stereo cameras are located .
第三方面,本公开实施例还提供了一种电子设备,包括处理器和存储器,处理器通过调用存储器存储的程序或指令,执行如第一方面所述的多立体相机的标定方法的步骤。In a third aspect, an embodiment of the present disclosure further provides an electronic device, including a processor and a memory, where the processor executes the steps of the calibration method for a multi-stereo camera according to the first aspect by invoking a program or an instruction stored in the memory.
第四方面,本公开实施例还提供了一种存储介质,存储介质存储程序或指令,程序或指令使计算机执行如第一方面所述的多立体相机的标定方法的步骤。In a fourth aspect, an embodiment of the present disclosure further provides a storage medium, where the storage medium stores a program or an instruction, where the program or instruction causes a computer to execute the steps of the calibration method for a multi-stereo camera according to the first aspect.
本公开实施例提供的技术方案与现有技术相比具有如下优点:Compared with the prior art, the technical solutions provided by the embodiments of the present disclosure have the following advantages:
本公开实施例技术方案提供了一种多立体相机的标定方法,以一台立体相机所在坐标系为基础坐标系,标定出了其余每台立体相机与基础立体相机所在坐标系之间的旋转矩阵和平移矩阵,即标定出了其余每台立体相机与基础立体相机所在坐标系之间的外参矩阵,实现了多立体相机的标定工作,且分步标定旋转矩阵和平移矩阵,有利于分别对旋转矩阵和平移矩阵的标定精度进行定理分析以降低标定误差,进而实现用不同的方式分别提高某个立体相机的旋转矩阵或平移矩阵的标定精度。另外,第一标定物与第二标定物的制作较为简单,无需进行迭代计算,标定效率和精度较高,且无需借助例如全站仪等第三方工具,有效降低了完成多立体相机标定工作的成本。The technical solutions of the embodiments of the present disclosure provide a method for calibrating multiple stereo cameras. The coordinate system where one stereo camera is located is used as the basic coordinate system, and the rotation matrix between each other stereo cameras and the coordinate system where the basic stereo camera is located is calibrated and translation matrix, that is, the external parameter matrix between each other stereo camera and the coordinate system of the basic stereo camera is calibrated, which realizes the calibration of multi-stereo cameras, and the step-by-step calibration of the rotation matrix and translation matrix is conducive to the The theorem analysis of the calibration accuracy of the rotation matrix and the translation matrix is carried out to reduce the calibration error, so as to improve the calibration accuracy of the rotation matrix or translation matrix of a stereo camera in different ways. In addition, the production of the first calibration object and the second calibration object is relatively simple, no iterative calculation is required, the calibration efficiency and accuracy are high, and third-party tools such as total stations are not required, which effectively reduces the multi-stereo camera calibration work. cost.
附图说明Description of drawings
此处的附图被并入说明书中并构成本说明书的一部分,示出了符合本公开的实施例,并与说明书一起用于解释本公开的原理。The accompanying drawings, which are incorporated in and constitute a part of this specification, illustrate embodiments consistent with the disclosure and together with the description serve to explain the principles of the disclosure.
为了更清楚地说明本公开实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,对于本领域普通技术人员而言,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。In order to more clearly illustrate the embodiments of the present disclosure or the technical solutions in the prior art, the accompanying drawings that are required to be used in the description of the embodiments or the prior art will be briefly introduced below. In other words, on the premise of no creative labor, other drawings can also be obtained from these drawings.
图1为本公开实施例提供的一种多立体相机的标定方法的流程示意图;FIG. 1 is a schematic flowchart of a method for calibrating a multi-stereo camera according to an embodiment of the present disclosure;
图2为本公开实施例提供的一种多立体相机的位置结构示意图;FIG. 2 is a schematic diagram of a position structure of a multi-stereo camera according to an embodiment of the present disclosure;
图3为本公开实施例提供的一种第一标定物的俯视结构示意图;3 is a schematic top-view structure diagram of a first calibration object provided by an embodiment of the present disclosure;
图4为本公开实施例提供的一种多立体相机的标定装置的结构示意图;4 is a schematic structural diagram of a multi-stereo camera calibration device according to an embodiment of the present disclosure;
图5为本发明实施例提供的一种电子设备的结构示意图。FIG. 5 is a schematic structural diagram of an electronic device according to an embodiment of the present invention.
具体实施方式Detailed ways
为了能够更清楚地理解本公开的上述目的、特征和优点,下面将对本公开的方案进行进一步描述。需要说明的是,在不冲突的情况下,本公开的实施例及实施例中的特征可以相互 组合。In order to more clearly understand the above objects, features and advantages of the present disclosure, the solutions of the present disclosure will be further described below. It should be noted that the embodiments of the present disclosure and the features in the embodiments may be combined with each other under the condition of no conflict.
在下面的描述中阐述了很多具体细节以便于充分理解本公开,但本公开还可以采用其他不同于在此描述的方式来实施;显然,说明书中的实施例只是本公开的一部分实施例,而不是全部的实施例。Many specific details are set forth in the following description to facilitate a full understanding of the present disclosure, but the present disclosure can also be implemented in other ways different from those described herein; obviously, the embodiments in the specification are only a part of the embodiments of the present disclosure, and Not all examples.
图1为本公开实施例提供的一种多立体相机的标定方法的流程示意图。多立体相机的标定方法可以应用在需要对多个立体相机进行标定的应用场景,可以由本公开实施例提供的多立体相机的标定装置执行,该多立体相机的标定装置可以采用软件和/或硬件的方式来实现。如图1所示,多立体相机的标定方法包括以下步骤:FIG. 1 is a schematic flowchart of a method for calibrating a multi-stereo camera according to an embodiment of the present disclosure. The method for calibrating a multi-stereo camera can be applied to an application scenario where multiple stereo cameras need to be calibrated, and can be performed by the multi-stereo camera calibration device provided by the embodiment of the present disclosure, and the multi-stereo camera calibration device can use software and/or hardware. way to achieve. As shown in Figure 1, the calibration method of the multi-stereo camera includes the following steps:
S101、将第一标定物放置于多个立体相机的视场中以及将第二标定物放置于多个立体相机的视场中。S101. Place the first calibration object in the field of view of the plurality of stereo cameras and place the second calibration object in the field of view of the plurality of stereo cameras.
图2为本公开实施例提供的一种多立体相机的位置结构示意图。如图2所示,多台立体相机10位于同一水平高度,图2示例性地设置不同的立体相机10的视场之间存在交叠,也可以设置部分或者全部立体相机10的视场之间不存在交叠。FIG. 2 is a schematic diagram of a position structure of a multi-stereo camera according to an embodiment of the present disclosure. As shown in FIG. 2 , multiple stereo cameras 10 are located at the same level. FIG. 2 exemplarily sets the fields of view of different stereo cameras 10 to overlap, and it is also possible to set some or all of the fields of view of the stereo cameras 10 . There is no overlap.
图3为本公开实施例提供的一种第一标定物的俯视结构示意图。结合图2和图3,每台立体相机10中均可见第一标定物1和第二标定物2,第一标定物1包括标定板,标定板例如可以为纯色标定板,可以设置第一标定物1,即标定板的面积足够大,确保每台立体相机10中均可见第一标定物1。第二标定物2包括位于一条直线上的多个标定点A,每台立体相机10中可见至少两个标定点A,即至少有两个标定点A位于同一立体相机10的视场中,本公开实施例所使用的第一标定物1和第二标定物2的制作较为简单。FIG. 3 is a schematic top-view structural diagram of a first calibration object provided by an embodiment of the present disclosure. 2 and 3, a first calibration object 1 and a second calibration object 2 can be seen in each stereo camera 10. The first calibration object 1 includes a calibration plate. The calibration plate can be, for example, a solid color calibration plate, and a first calibration can be set. Object 1 , that is, the area of the calibration plate is large enough to ensure that the first calibration object 1 can be seen in each stereo camera 10 . The second calibration object 2 includes a plurality of calibration points A located on a straight line. At least two calibration points A can be seen in each stereo camera 10 , that is, at least two calibration points A are located in the field of view of the same stereo camera 10 . The fabrication of the first calibration object 1 and the second calibration object 2 used in the disclosed embodiment is relatively simple.
S102、提取第一标定物处于不同位姿下立体相机所得点云中第一标定物所属点云,并根据立体相机获取的第一标定物所属点云拟合平面,并获取拟合的平面的法向量。S102: Extract the point cloud to which the first calibration object belongs in the point cloud obtained by the stereo camera when the first calibration object is in different poses, fit the plane according to the point cloud to which the first calibration object belongs, and obtain the fitted plane normal vector.
具体地,结合图2和图3,获取每台立体相机10拍摄得到的二维图像以及对应的三维点云,提取每台立体相机10所得点云中第一标定物1所属点云。示例性地,可以采用聚类算法和/或滤波算法提取每台立体相机10所得点云中第一标定物1所属点云。具体地,聚类算法即把第一标定物1所属点云中可能位于同一平面上的点云进行聚类,以便于后续拟合平面工作的进行,滤波算法即滤除获取的点云中的噪点,以提高第一标定物1所属点云提取的精度,聚类算法和滤波算法均为三维点云常用处理算法,这里不再具体展开论述。Specifically, with reference to FIGS. 2 and 3 , two-dimensional images and corresponding three-dimensional point clouds captured by each stereo camera 10 are obtained, and the point cloud to which the first calibration object 1 belongs is extracted from the point cloud obtained by each stereo camera 10 . Exemplarily, a clustering algorithm and/or a filtering algorithm may be used to extract the point cloud to which the first calibration object 1 belongs in the point cloud obtained by each stereo camera 10 . Specifically, the clustering algorithm is to cluster the point clouds that may be located on the same plane in the point cloud to which the first calibration object 1 belongs, so as to facilitate the subsequent work of fitting the plane, and the filtering algorithm is to filter out the points in the acquired point cloud. Noise, in order to improve the accuracy of the point cloud extraction to which the first calibration object 1 belongs, the clustering algorithm and the filtering algorithm are both commonly used processing algorithms for 3D point clouds, and will not be discussed in detail here.
根据立体相机10获取的第一标定物1所属点云拟合对应该立体相机10的平面,示例性地,可以采用最小二乘算法或者随机抽样一致算法根据立体相机10获取的第一标定物1所属点云拟合平面,即拟合对应该立体相机10的平面,拟合平面例如可以满足方程Ax+By+Cz+D=0。根据拟合平面的方程获取对应该立体相机10的平面的法向量,针对平面方程Ax+By+Cz+D=0,矢量N(A,B,C)即为该拟合平面的单位法向量。Fitting the plane corresponding to the stereo camera 10 according to the point cloud of the first calibration object 1 obtained by the stereo camera 10 , exemplarily, the least squares algorithm or the random sampling consensus algorithm can be used according to the first calibration object 1 obtained by the stereo camera 10 . The corresponding point cloud fitting plane, that is, fitting the plane corresponding to the stereo camera 10 , and the fitting plane may satisfy the equation Ax+By+Cz+D=0, for example. The normal vector of the plane corresponding to the stereo camera 10 is obtained according to the equation of the fitted plane. For the plane equation Ax+By+Cz+D=0, the vector N(A, B, C) is the unit normal vector of the fitted plane .
在根据立体相机10获取的第一标定物1所属点云拟合对应该立体相机10的平面之前,可以提取第一标定物1处于不同位姿下,每台立体相机10所得点云中第一标定物1所属点云。示例性地,第一标定物1的位姿包括第一标定物1至立体相机10的距离,和/或,第一标定物1相对于立体相机10的倾斜角度。Before fitting the plane corresponding to the stereo camera 10 according to the point cloud obtained by the stereo camera 10 to which the first calibration object 1 belongs, the first calibration object 1 can be extracted in different poses, and the first calibration object 1 in the point cloud obtained by each stereo camera 10 is the first The point cloud to which calibration object 1 belongs. Exemplarily, the pose of the first calibration object 1 includes the distance from the first calibration object 1 to the stereo camera 10 , and/or the inclination angle of the first calibration object 1 relative to the stereo camera 10 .
具体地,结合图2和图3,在获取每台立体相机10所得点云中第一标定物1所属点云时,不断更换第一标定物1的位姿,即不断调整第一标定物1至不同立体相机10的距离,以及第一标定物1相对于不同立体相机10的倾斜角度,每调整一次第一标定物1的位姿,获取对应第一标定物1一个位姿下的每台立体相机10所得点云中第一标定物1所属点云。示例性地,可以设置获取第一标定物1处于至少八个不同位姿下的每台立体相机10所得点云中第一标定物1所属点云。Specifically, referring to FIG. 2 and FIG. 3 , when acquiring the point cloud of the first calibration object 1 in the point cloud obtained by each stereo camera 10 , the pose of the first calibration object 1 is continuously changed, that is, the first calibration object 1 is continuously adjusted. The distance to the different stereo cameras 10 and the inclination angle of the first calibration object 1 relative to the different stereo cameras 10, each time the pose of the first calibration object 1 is adjusted, obtain each camera corresponding to the first calibration object 1 in one pose The point cloud to which the first calibration object 1 belongs in the point cloud obtained by the stereo camera 10 . Exemplarily, it may be set to acquire the point cloud to which the first calibration object 1 belongs in the point cloud obtained by each stereo camera 10 in which the first calibration object 1 is in at least eight different poses.
由此,每调整一次第一标定物1的位姿,形成一组每台立体相机10所得点云中第一标定物1所属点云的采样,且每组采样对应的第一标定物1的位姿不同,即对应的第一标定物1到立体相机10的距离,或者第一标定物1相对于立体相机10的倾斜角度不同,增加每台立体相机10所得点云中第一标定物1所属点云的采样次数有利于提高相机标定结果的准确性和精度。Thus, each time the pose of the first calibration object 1 is adjusted, a set of samplings of the point cloud to which the first calibration object 1 belongs in the point cloud obtained by each stereo camera 10 is formed, and the first calibration object 1 corresponding to each group of samples is sampled. If the pose is different, that is, the distance between the corresponding first calibration object 1 and the stereo camera 10, or the inclination angle of the first calibration object 1 relative to the stereo camera 10 is different, add the first calibration object 1 in the point cloud obtained by each stereo camera 10. The sampling times of the point cloud to which it belongs is beneficial to improve the accuracy and precision of the camera calibration result.
S103、根据两台立体相机对应的法向量获取两台立体相机所在坐标系之间的旋转矩阵。S103: Acquire a rotation matrix between the coordinate systems where the two stereo cameras are located according to the normal vectors corresponding to the two stereo cameras.
具体地,根据两台立体相机10对应的法向量获取该两台立体相机10所在坐标系之间的旋转矩阵,可以根据两台立体相机10对应的法向量,列出法向量与旋转矩阵的关系等式,关系等式为:Specifically, the rotation matrix between the coordinate systems where the two stereo cameras 10 are located is obtained according to the normal vectors corresponding to the two stereo cameras 10 , and the relationship between the normal vector and the rotation matrix can be listed according to the normal vectors corresponding to the two stereo cameras 10 equation, the relational equation is:
Figure PCTCN2021121462-appb-000003
Figure PCTCN2021121462-appb-000003
其中,(N 1x,N 1y,N 1z)为两台立体相机10中的一台立体相机10对应的法向量的三维坐标,(N 2x,N 2y,N 2z)为两台立体相机10中的另一台立体相机10对应的法向量的三维坐标,R21为两台立体相机10所在坐标系之间的旋转矩阵,根据关系等式获取两台立体相机10所在坐标系之间的旋转矩阵。 Among them, (N 1x , N 1y , N 1z ) are the three-dimensional coordinates of the normal vector corresponding to one of the two stereo cameras 10 , and (N 2x , N 2y , N 2z ) are the two stereo cameras 10 . The three-dimensional coordinates of the normal vector corresponding to another stereo camera 10, R21 is the rotation matrix between the coordinate systems where the two stereo cameras 10 are located, and the rotation matrix between the coordinate systems where the two stereo cameras 10 are located is obtained according to the relational equation.
示例性地,以图2中的第一台立体相机101和第二台立体相机102为例,根据立体相机101获取的第一标定物1所属点云拟合对应立体相机101的平面,例如为第一拟合平面,获取第一拟合平面的法向量,例如为第一法向量N1。同样地,根据立体相机102获取的第一标定物1所属点云拟合对应立体相机102的平面,例如为第二拟合平面,获取第二拟合平面的法向量,例如为第二法向量N2。Exemplarily, taking the first stereo camera 101 and the second stereo camera 102 in FIG. 2 as an example, the plane corresponding to the stereo camera 101 is fitted according to the point cloud obtained by the stereo camera 101 to which the first calibration object 1 belongs, such as: For the first fitting plane, the normal vector of the first fitting plane is obtained, for example, the first normal vector N1. Similarly, a plane corresponding to the stereo camera 102 is fitted according to the point cloud obtained by the stereo camera 102 to which the first calibration object 1 belongs, such as the second fitting plane, and the normal vector of the second fitting plane is obtained, such as the second normal vector N2.
第一法向量N1、第二法向量N2以及立体相机101与立体相机102所在坐标系之间的旋转矩阵即满足上述等式关系,以立体相机101所在坐标系为基础坐标系,则第一法向量N1的坐标为(N 1x,N 1y,N 1z),第二法向量N2的坐标为(N 2x,N 2y,N 2z),R21则为立体相机102所在坐标系想要统一到立体相机101所在坐标系对应的旋转矩阵。 The first normal vector N1, the second normal vector N2, and the rotation matrix between the coordinate system where the stereo camera 101 and the stereo camera 102 are located satisfy the above equation relationship. Taking the coordinate system where the stereo camera 101 is located as the basic coordinate system, the first method The coordinates of the vector N1 are (N 1x , N 1y , N 1z ), the coordinates of the second normal vector N2 are (N 2x , N 2y , N 2z ), and R21 is the coordinate system where the stereo camera 102 is located and wants to be unified to the stereo camera The rotation matrix corresponding to the coordinate system where 101 is located.
需要说明的是,为实现所有立体相机10的标定工作,需要将所有立体相机10所在坐标系统一到一台立体相机10所在坐标系,例如可以均统一到立体相机101所在坐标系,即以立体相机101所在坐标系为基础坐标系为例,由于其余每台立体相机10对应的法向量互不相同,因此其余每台立体相机10按照上述方法将各自所在坐标系统一到立体相机101所在坐标系的过程对应的旋转矩阵各不相同。It should be noted that, in order to realize the calibration of all the stereo cameras 10, it is necessary to convert the coordinate systems where all the stereo cameras 10 are located to the coordinate system where one stereo camera 10 is located. Take the coordinate system where the camera 101 is located as the basic coordinate system as an example, since the normal vectors corresponding to each of the other stereo cameras 10 are different from each other, each of the other stereo cameras 10 converts their respective coordinate systems to the coordinate system where the stereo camera 101 is located according to the above method. The corresponding rotation matrices of the process are different.
针对每两台立体相机10,例如针对图2中的立体相机101和立体相机102,第一标定物1每处于一个位姿下,即可获取到立体相机101对应的法向量、立体相机102对应的法向量和两台立体相机10所在坐标系之间的旋转矩阵所满足的一组上述实施例所述的法向量关系等式,可以设置调整第一标定物1位姿的次数为N,则可以获取到对应立体相机101和立体相机102的N组上述实施例所述的法向量关系等式。示例性地,针对对应立体相机101和立体相机102的N组上述实施例所述的法向量关系等式,可以采用奇异值分解算法根据两台立体相机10对应的法向量获取该两台立体相机10所在坐标系之间的旋转矩阵,即可以采用奇异值分解算法根据立体相机101和立体相机102对应的法向量获取立体相机101和立体相机102所在坐标系之间的旋转矩阵。For every two stereo cameras 10 , for example, for the stereo cameras 101 and 102 in FIG. 2 , each time the first calibration object 1 is in a pose, the normal vector corresponding to the stereo camera 101 and the corresponding normal vector of the stereo camera 102 can be obtained. A set of normal vector relationship equations described in the above-mentioned embodiments that are satisfied by the normal vector and the rotation matrix between the coordinate systems of the two stereo cameras 10, the number of times to adjust the pose of the first calibration object 1 can be set to N, then N groups of normal vector relationship equations described in the above embodiments can be obtained corresponding to the stereo camera 101 and the stereo camera 102 . Exemplarily, for the N groups of normal vector relationship equations described in the above embodiments corresponding to the stereo cameras 101 and 102 , a singular value decomposition algorithm can be used to obtain the two stereo cameras according to the normal vectors corresponding to the two stereo cameras 10 . 10 The rotation matrix between the coordinate systems where the stereo camera 101 is located, that is, the rotation matrix between the coordinate systems where the stereo camera 101 and the stereo camera 102 are located can be obtained by using the singular value decomposition algorithm according to the normal vectors corresponding to the stereo camera 101 and the stereo camera 102 .
根据不同立体相机10获取的第一标定物1所属点云拟合出来的平面各不相同,要实现所有的立体相机10所在坐标系的统一,需要通过标定过程使得不同立体相机10对应的拟合平面重合。因此,本公开实施例先获取两台立体相机10所在坐标系之间的旋转矩阵,通过不同立体相机10所在坐标系之间的旋转矩阵,可实现不同立体相机10对应的拟合平面相互平行,再计算不同立体相机10所在坐标系之间的平移矩阵,利用平移矩阵平移相互平行的拟合平面,即可实现不同立体相机10对应的拟合平面重合,进而实现所有的立体相机10所在坐标系的统一,完成多个立体相机10的标定工作。The planes fitted according to the point clouds of the first calibration object 1 obtained by different stereo cameras 10 are different. To achieve the unification of the coordinate systems where all stereo cameras 10 are located, it is necessary to make the fitting corresponding to different stereo cameras 10 through the calibration process. planes coincide. Therefore, the embodiment of the present disclosure first obtains the rotation matrices between the coordinate systems where the two stereo cameras 10 are located, and through the rotation matrices between the coordinate systems where the different stereo cameras 10 are located, the fitting planes corresponding to the different stereo cameras 10 can be realized to be parallel to each other, Then calculate the translation matrix between the coordinate systems where the different stereo cameras 10 are located, and use the translation matrix to translate the fitting planes that are parallel to each other, so that the fitting planes corresponding to the different stereo cameras 10 can be overlapped, and then the coordinate systems where all the stereo cameras 10 are located can be realized. The unification of multiple stereo cameras 10 completes the calibration work.
S104、获取第一标定点和第二标定点的拍摄坐标,根据第一标定点的拍摄坐标拟合一条直线;其中,第一标定点与第二标定点为位于不同的立体相机视场中的标定点,第二标定点位于拟合的直线上。S104: Obtain the shooting coordinates of the first calibration point and the second calibration point, and fit a straight line according to the shooting coordinates of the first calibration point; wherein, the first calibration point and the second calibration point are located in different fields of view of the stereo camera Calibration point, the second calibration point is located on the fitted straight line.
具体地,如图2所示,可以设置设定立体相机,例如立体相机101对第二标定物2进行拍摄,获取设定立体相机,例如立体相机101视场中第二标定物2的二维图像以及对应的三维点云,提取设定立体相机,例如立体相机101获取到的二维图像中的标定点A,即第一标定点A1并确定第一标定点A1的拍摄坐标,第一标定点A1的拍摄坐标为第一标定点A1在点云中对应的三维坐标。Specifically, as shown in FIG. 2 , a stereo camera can be set and set, for example, the stereo camera 101 shoots the second calibration object 2 to obtain a set stereo camera, such as a two-dimensional image of the second calibration object 2 in the field of view of the stereo camera 101 . The image and the corresponding three-dimensional point cloud, extract and set the stereo camera, for example, the calibration point A in the two-dimensional image obtained by the stereo camera 101, that is, the first calibration point A1 and determine the shooting coordinates of the first calibration point A1. The shooting coordinates of the fixed point A1 are the three-dimensional coordinates corresponding to the first calibration point A1 in the point cloud.
可选地,根据第一标定点A1的拍摄坐标拟合一条直线,可以根据至少两个第一标定点A1的拍摄坐标拟合一条直线以使至少两个第一标定点A1位于拟合的直线上。示例性地,可以根据两个第一标定点A1的拍摄坐标拟合一条直线以使两个第一标定点A1位于拟合的直线上,以图2中的立体相机101为设定立体相机为例,用于拟合直线的第一标定点A1例如可以为标定点A11和标定点A12,根据标定点A11和标定点A12的拍摄坐标即可拟合一条直线,拟合直线的方程例如可以为(x-x0)/l=(y-y0)/m=(z-z0)/n,即拟合直线经过点(x0,y0,z0)且拟合直线的方向向量为(l,m,n)。Optionally, a straight line is fitted according to the shooting coordinates of the first calibration point A1, and a straight line can be fitted according to the shooting coordinates of the at least two first calibration points A1 so that the at least two first calibration points A1 are located on the fitted straight line. superior. Exemplarily, a straight line can be fitted according to the shooting coordinates of the two first calibration points A1 so that the two first calibration points A1 are located on the fitted straight line, and the stereo camera 101 in FIG. 2 is set as the stereo camera. For example, the first calibration point A1 for fitting the straight line can be, for example, the calibration point A11 and the calibration point A12, and a straight line can be fitted according to the shooting coordinates of the calibration point A11 and the calibration point A12, and the equation of the fitted straight line can be, for example, (x-x0)/l=(y-y0)/m=(z-z0)/n, that is, the fitted straight line passes through the point (x0, y0, z0) and the direction vector of the fitted straight line is (l, m, n).
可选地,获取第一标定点A1的拍摄坐标,可以是获取第二标定物2处于不同位姿下的第一标定点A1的拍摄坐标。示例性地,可以第二标定物2的位姿包括第二标定物2至立体相机,例如设定立体相机101的距离,和/或,第二标定物2相对于立体相机,例如设定立体相机101的倾斜角度。Optionally, acquiring the shooting coordinates of the first calibration point A1 may be acquiring the shooting coordinates of the first calibration point A1 where the second calibration object 2 is in a different pose. Exemplarily, the pose of the second calibration object 2 may include the second calibration object 2 to the stereo camera, for example, the distance from the stereo camera 101 is set, and/or the second calibration object 2 is relative to the stereo camera, for example, the stereo camera is set. The tilt angle of the camera 101 .
具体地,在获取第一标定点A1的拍摄坐标时,不断更换第二标定物2的位姿,即不断 调整第二标定物2至立体相机,例如设定立体相机101的距离,以及第二标定物2相对于立体相机,例如设定立体相机101的倾斜角度,每调整一次第二标定物2的位姿,获取对应第二标定物2一个位姿下的第一标定点A1的拍摄坐标。示例性地,可以设置获取第二标定物2处于至少八个不同位姿下的第一标定点A1的拍摄坐标。Specifically, when acquiring the shooting coordinates of the first calibration point A1, the pose of the second calibration object 2 is continuously changed, that is, the second calibration object 2 is continuously adjusted to the stereo camera, for example, the distance of the stereo camera 101 is set, and the second calibration object 2 is continuously adjusted. The calibration object 2 is relative to the stereo camera, for example, the inclination angle of the stereo camera 101 is set, and each time the pose of the second calibration object 2 is adjusted, the shooting coordinates of the first calibration point A1 corresponding to a pose of the second calibration object 2 are obtained. . Exemplarily, it may be set to acquire the shooting coordinates of the first calibration point A1 where the second calibration object 2 is in at least eight different poses.
由此,每调整一次第二标定物2的位姿,形成一组第一标定点A1拍摄坐标的采样,且每组采样对应的第二标定物2的位姿不同,即对应的第二标定物2到立体相机,例如设定立体相机101的距离,或者第二标定物2相对于立体相机,例如设定立体相机101的倾斜角度不同,增加第一标定点A1拍摄坐标的采样次数有利于提高相机标定结果的准确性和精度。Therefore, each time the pose of the second calibration object 2 is adjusted, a set of samples of the shooting coordinates of the first calibration point A1 is formed, and the poses of the second calibration object 2 corresponding to each set of samples are different, that is, the corresponding second calibration The distance between the object 2 and the stereo camera, for example, setting the distance of the stereo camera 101, or the second calibration object 2 relative to the stereo camera, for example, setting the inclination angle of the stereo camera 101 to be different, increasing the sampling times of the shooting coordinates of the first calibration point A1 is beneficial to Improve the accuracy and precision of camera calibration results.
获取第二标定点的拍摄坐标,第一标定点与第二标定点为位于不同的立体相机视场中的标定点,第二标定点位于拟合的直线上。具体地,如图2所示,以立体相机102为例,立体相机102对第二标定物2进行拍摄,获取立体相机102视场中第二标定物2的二维图像以及对应的三维点云,提取立体相机102获取到的二维图像中的标定点A,即第二标定点A2并确定第二标定点A2的拍摄坐标,第二标定点A2的拍摄坐标为第二标定点A2在点云中对应的三维坐标,且第二标定点A2的拍摄坐标为第二标定点A2在立体相机102所在坐标系中的坐标,可以设置第一标定点A1的拍摄坐标获取过程与第二标定点A2的拍摄坐标的获取过程同时进行。The shooting coordinates of the second calibration point are acquired, the first calibration point and the second calibration point are calibration points located in different fields of view of the stereo camera, and the second calibration point is located on the fitted straight line. Specifically, as shown in FIG. 2 , taking the stereo camera 102 as an example, the stereo camera 102 shoots the second calibration object 2 to obtain a two-dimensional image of the second calibration object 2 in the field of view of the stereo camera 102 and the corresponding three-dimensional point cloud , extract the calibration point A in the two-dimensional image obtained by the stereo camera 102, that is, the second calibration point A2 and determine the shooting coordinates of the second calibration point A2, the shooting coordinates of the second calibration point A2 are the second calibration point A2 at the point The corresponding three-dimensional coordinates in the cloud, and the shooting coordinates of the second calibration point A2 are the coordinates of the second calibration point A2 in the coordinate system where the stereo camera 102 is located, and the process of obtaining the shooting coordinates of the first calibration point A1 and the second calibration point can be set. The acquisition process of the shooting coordinates of A2 is performed simultaneously.
同样地,如图2所示,获取第二标定点A2的拍摄坐标,可以获取第二标定物2处于不同位姿下的第二标定点A2的拍摄坐标。具体地,在获取第二标定点A2的拍摄坐标时,不断更换第二标定物2的位姿,即不断调整第二标定物2至立体相机10的距离,以及第二标定物2相对于立体相机10的倾斜角度,每调整一次第二标定物2的位姿,获取对应第二标定物2一个位姿下的第二标定点A2的拍摄坐标。示例性地,可以设置获取第二标定物2处于至少八个不同位姿下的第二标定点A2的拍摄坐标。Similarly, as shown in FIG. 2 , by obtaining the shooting coordinates of the second calibration point A2 , the shooting coordinates of the second calibration point A2 where the second calibration object 2 is in different poses can be obtained. Specifically, when acquiring the shooting coordinates of the second calibration point A2, the pose of the second calibration object 2 is constantly changed, that is, the distance from the second calibration object 2 to the stereo camera 10 is continuously adjusted, and the relative position of the second calibration object 2 to the stereo camera 10 is continuously adjusted. The tilt angle of the camera 10 is adjusted every time the pose of the second calibration object 2 is adjusted, and the shooting coordinates of the second calibration point A2 corresponding to one pose of the second calibration object 2 are obtained. Exemplarily, it may be set to acquire the shooting coordinates of the second calibration point A2 where the second calibration object 2 is in at least eight different poses.
由此,每调整一次第二标定物2的位姿,形成一组第二标定点A2拍摄坐标的采样,且每组采样对应的第二标定物2的位姿不同,即对应的第二标定物2到立体相机10的距离,或者第二标定物2相对于立体相机10的倾斜角度不同,增加第二标定点A2拍摄坐标的采样次数有利于提高相机标定结果的准确性和精度。Thus, each time the pose of the second calibration object 2 is adjusted, a set of samples of the shooting coordinates of the second calibration point A2 are formed, and the poses of the second calibration object 2 corresponding to each set of samples are different, that is, the corresponding second calibration The distance from the object 2 to the stereo camera 10 or the inclination angle of the second calibration object 2 relative to the stereo camera 10 is different. Increasing the sampling times of the shooting coordinates of the second calibration point A2 is beneficial to improve the accuracy and precision of the camera calibration result.
S105、根据第一标定点的拍摄坐标以及所有标定点的分布位置获取第二标定点的计算坐标。S105: Acquire the calculated coordinates of the second calibration point according to the shooting coordinates of the first calibration point and the distribution positions of all the calibration points.
具体地,根据第一标定点A1的拍摄坐标以及所有标定点A的分布位置获取位于拟合的直线上的第二标定点A2的计算坐标,第二标定点A2为位于除设定立体相机,例如立体相机101外的其余立体相机视场中的标定点A,这里以第二标定点A2为位于立体相机102视场中的标定点A为例。可以根据所有标定点A的分布位置确定位于拟合的直线上的第一标定点A1和第二标定点A2之间的间距,根据第一标定点A1的拍摄坐标、拟合的直线的方程以及间距获取位于拟合的直线上的第二标定点A2的计算坐标。Specifically, according to the shooting coordinates of the first calibration point A1 and the distribution positions of all the calibration points A, the calculated coordinates of the second calibration point A2 located on the fitted straight line are obtained, and the second calibration point A2 is located in the stereo camera except the setting, For example, the calibration point A in the field of view of the other stereo cameras other than the stereo camera 101 is taken as an example here that the second calibration point A2 is the calibration point A located in the field of view of the stereo camera 102 . The distance between the first calibration point A1 and the second calibration point A2 on the fitted straight line can be determined according to the distribution positions of all the calibration points A, according to the shooting coordinates of the first calibration point A1, the equation of the fitted straight line and The distance obtains the calculated coordinates of the second calibration point A2 located on the fitted straight line.
示例性地,如图2所示,标定点A可以等间距设置,根据所有标定点A的分布位置确定位于拟合的直线上的第一标定点A1和第二标定点A2之间的间距,可以先对所有标定点 A依次编号,位于拟合的直线上的第二标定点A2的标号与第一标定点A1的标号的差值与相邻两个标定点A之间间距d的乘积为位于拟合的直线上的第一标定点A1和第二标定点A2之间的间距。Exemplarily, as shown in Figure 2, the calibration points A can be set at equal intervals, and the distance between the first calibration point A1 and the second calibration point A2 on the fitted straight line is determined according to the distribution positions of all the calibration points A, All calibration points A can be numbered in sequence, and the product of the difference between the label of the second calibration point A2 on the fitted straight line and the label of the first calibration point A1 and the distance d between the adjacent two calibration points A is: The distance between the first calibration point A1 and the second calibration point A2 on the fitted straight line.
具体地,标记点例如可以为圆标记点,如图2所示,第一标定点A1例如可以为标号为2的标定点A11,第二标定点A2例如可以为标号为7的标定点A21,则五倍的相邻两个标定点A之间间距d即为拟合的直线上的第一标定点A11和第二标定点A21之间的间距,拟合的直线的方程已知,再结合已知该直线上的第一标定点A11的拍摄坐标,即三维坐标,可以计算获得位于拟合的直线上的第二标定点A21的计算坐标,第二标定点A21的计算坐标是第二标定点A21在设定立体相机,例如立体相机101所在坐标系中的坐标。Specifically, the marking point may be, for example, a circular marking point. As shown in FIG. 2 , the first calibration point A1 may be, for example, the calibration point A11 with the label 2, and the second calibration point A2 may be, for example, the calibration point A21 with the label 7. Then five times the distance d between two adjacent calibration points A is the distance between the first calibration point A11 and the second calibration point A21 on the fitted straight line. The equation of the fitted straight line is known, and then combined Knowing the shooting coordinates of the first calibration point A11 on the straight line, that is, the three-dimensional coordinates, the calculated coordinates of the second calibration point A21 on the fitted straight line can be obtained by calculation, and the calculated coordinates of the second calibration point A21 are the second calibration point A21. The fixed point A21 is setting the stereo camera, for example, the coordinates in the coordinate system where the stereo camera 101 is located.
需要说明的是,上述实施例仅以立体相机101为设定立体相机为例进行说明,也可以以其它立体相机为设定立体相机,本公开实施例对此不作限定。It should be noted that, the above embodiments are only described by taking the stereo camera 101 as the setting stereo camera as an example, and other stereo cameras may also be used as the setting stereo camera, which is not limited in the embodiments of the present disclosure.
S106、根据同一第二标定点的计算坐标、拍摄坐标以及两台立体相机所在坐标系之间的旋转矩阵,获取两台立体相机所在坐标系之间的平移矩阵。S106: Obtain a translation matrix between the coordinate systems where the two stereo cameras are located according to the calculated coordinates of the same second calibration point, the shooting coordinates, and the rotation matrix between the coordinate systems where the two stereo cameras are located.
具体地,立体相机10可以获取目标物体的三维点云,利用点云可以实现对目标的三维重建、检测以及测量工作等,单个立体相机10的视野有限,单次获取的目标物体点云有时无法满足实际需求,因此可以增加立体相机10的数量,多台立体相机10同时获取点云并进行拼接使用以扩大视野,获取更大目标的点云。要完成多台立体相机10获取点云的拼接,这其中最重要是把多台立体相机10获取的点云统一到一个坐标系下,即找到多台相机所在坐标系的转换矩阵以完成多台立体相机10的外参标定。Specifically, the stereo camera 10 can acquire the three-dimensional point cloud of the target object, and the point cloud can be used to realize the three-dimensional reconstruction, detection and measurement of the target. To meet actual needs, the number of stereo cameras 10 can be increased, and multiple stereo cameras 10 can acquire point clouds at the same time and use them for splicing to expand the field of view and acquire point clouds of larger targets. To complete the splicing of point clouds obtained by multiple stereo cameras 10, the most important thing is to unify the point clouds obtained by multiple stereo cameras 10 into one coordinate system, that is, to find the transformation matrix of the coordinate system where the multiple cameras are located to complete the multiple cameras. External parameter calibration of the stereo camera 10 .
示例性地,转换矩阵B可以表示为4×4的矩阵,转换矩阵B满足如下计算公式:Exemplarily, the transformation matrix B can be represented as a 4×4 matrix, and the transformation matrix B satisfies the following calculation formula:
Figure PCTCN2021121462-appb-000004
Figure PCTCN2021121462-appb-000004
其中,转换矩阵B,即外参标定矩阵可以标记成一个4×4的矩阵,也可以是由一个3×3的旋转矩阵R和一个3×1的平移矩阵T组成,坐标系通过一些刚体变换,例如分别沿x方向,y方向或者z方向做一些平移和旋转就可以转换到另外一个坐标系。要实现两个立体相机10的标定,就需要求出平移量x,y和z以及旋转量rx,ry和rz,就可以计算出平移矩阵T和旋转矩阵R。上述公式中,为方便计算,将旋转矩阵R和平移矩阵T均扩展为4×4的矩阵,等式中第二行前三个矩阵对应旋转矩阵R,后面一个矩阵对应平移矩阵T,根据线性代数相关理论,上述矩阵的扩展并不影响计算结果。Among them, the transformation matrix B, that is, the external parameter calibration matrix, can be marked as a 4×4 matrix, or it can be composed of a 3×3 rotation matrix R and a 3×1 translation matrix T, and the coordinate system is transformed by some rigid bodies. , for example, it can be converted to another coordinate system by doing some translation and rotation along the x direction, y direction or z direction respectively. To realize the calibration of the two stereo cameras 10, it is necessary to obtain the translation quantities x, y and z and the rotation quantities rx, ry and rz, and then the translation matrix T and the rotation matrix R can be calculated. In the above formula, for the convenience of calculation, both the rotation matrix R and the translation matrix T are expanded into 4×4 matrices. The first three matrices in the second row of the equation correspond to the rotation matrix R, and the latter matrix corresponds to the translation matrix T. According to the linear Algebraic related theory, the expansion of the above matrix does not affect the calculation results.
针对多台立体相机10,如图2所示,可以以设定立体相机,例如立体相机101所在坐标系作为基础坐标系,只要标定出其余立体相机10与立体相机101的转换矩阵B,即标定 出其余立体相机10与立体相机101的旋转矩阵R和平移矩阵T,就可以完成多台立体相机10的标定工作,实现所有立体相机10坐标系的统一。需要说明的是,也可以设置其它立体相机10所在坐标系为基础坐标系,并不限定以立体相机101所在坐标系作为基础坐标系。For multiple stereo cameras 10 , as shown in FIG. 2 , the stereo camera, for example, the coordinate system where the stereo camera 101 is located can be used as the basic coordinate system, as long as the transformation matrix B of the remaining stereo cameras 10 and the stereo cameras 101 is calibrated, that is, the calibration By obtaining the rotation matrices R and translation matrices T of the remaining stereo cameras 10 and the stereo cameras 101 , the calibration of multiple stereo cameras 10 can be completed, and the coordinate systems of all the stereo cameras 10 can be unified. It should be noted that the coordinate system where other stereo cameras 10 are located may also be set as the base coordinate system, and the coordinate system where the stereo camera 101 is located is not limited to be the base coordinate system.
具体地,根据同一第二标定点A2的计算坐标、拍摄坐标以及两台立体相机所在坐标系之间的旋转矩阵,获取两台立体相机所在坐标系之间的平移矩阵,可以依据不同的第二标定点A2,列出多组第二标定点A2的计算坐标、拍摄坐标、两台立体相机所在坐标系之间的旋转矩阵、两台立体相机所在坐标系之间的平移矩阵之间的关系等式。Specifically, according to the calculated coordinates of the same second calibration point A2, the shooting coordinates and the rotation matrix between the coordinate systems where the two stereo cameras are located, the translation matrix between the coordinate systems where the two stereo cameras are located can be obtained according to different second Calibration point A2, which lists the calculated coordinates, shooting coordinates, rotation matrix between the coordinate systems where the two stereo cameras are located, and translation matrices between the coordinate systems where the two stereo cameras are located. Mode.
具体地,可以根据同一第二标定点A2的计算坐标、拍摄坐标以及设定立体相机,例如立体相机101与该第二标定点A2对应的立体相机,例如立体相机102所在坐标系之间的旋转矩阵,获取设定立体相机,例如立体相机101与该第二标定点A2对应的立体相机,例如立体相机102所在坐标系之间的平移矩阵,可以依据不同的第二标定点A2,列出多组第二标定点A2的计算坐标、拍摄坐标、立体相机101与该第二标定点A2对应的立体相机102所在坐标系之间的旋转矩阵、立体相机101与该第二标定点A2对应的立体相机102所在坐标系之间的平移矩阵之间的关系等式,关系等式为:Specifically, a stereo camera can be set according to the calculated coordinates and shooting coordinates of the same second calibration point A2, for example, the stereo camera 101 corresponding to the second calibration point A2, such as the rotation between the coordinate systems where the stereo camera 102 is located. Matrix, to obtain and set the stereo camera, for example, the stereo camera corresponding to the stereo camera 101 and the second calibration point A2, such as the translation matrix between the coordinate systems where the stereo camera 102 is located, can list many different second calibration points A2. The calculated coordinates of the second calibration point A2, the shooting coordinates, the rotation matrix between the stereo camera 101 and the coordinate system of the stereo camera 102 corresponding to the second calibration point A2, and the stereo camera 101 corresponding to the second calibration point A2. The relational equation between the translation matrices between the coordinate systems where the camera 102 is located is:
Figure PCTCN2021121462-appb-000005
Figure PCTCN2021121462-appb-000005
其中,R为两台立体相机所在坐标系之间的旋转矩阵,T为两台立体相机所在坐标系之间的平移矩阵,例如R可以为设定立体相机,例如立体相机101与该第二标定点A2对应的立体相机,例如立体相机102所在坐标系之间的旋转矩阵,T可以为设定立体相机,例如立体相机101与该第二标定点A2对应的立体相机,例如立体相机102所在坐标系之间的平移矩阵,(Px’,Py’,Pz’)为第二标定点A2的计算坐标,(Px,Py,Pz)为第二标定点A2的拍摄坐标,根据关系等式获取设定立体相机,例如立体相机101与该第二标定点A2对应的立体相机,例如立体相机102所在坐标系之间的平移矩阵。Among them, R is the rotation matrix between the coordinate systems where the two stereo cameras are located, and T is the translation matrix between the coordinate systems where the two stereo cameras are located. For example, R can be the setting of the stereo camera, such as the stereo camera 101 and the second standard The stereo camera corresponding to the fixed point A2, such as the rotation matrix between the coordinate systems where the stereo camera 102 is located, T can be the set stereo camera, such as the stereo camera corresponding to the stereo camera 101 and the second calibration point A2, such as the coordinates of the stereo camera 102 The translation matrix between the systems, (Px', Py', Pz') are the calculated coordinates of the second calibration point A2, (Px, Py, Pz) are the shooting coordinates of the second calibration point A2, according to the relational equation to obtain the setting A stereo camera, for example, a stereo camera corresponding to the stereo camera 101 and the second calibration point A2, for example, a translation matrix between the coordinate systems where the stereo camera 102 is located.
具体地,标定转换矩阵包括旋转矩阵和平移矩阵,根据所有标定点A的分布位置求解得到的第二标定点A2计算坐标对应的三维坐标点P’与第二标定点A2拍摄坐标对应的三维坐标点P属于物理世界中的同一个点,称为同名点,P’的坐标为(Px’,Py’,Pz’),P的坐标为(Px,Py,Pz),二者之间满足计算公式P’=(RT)P,即满足上述RT关系等式。在第二标定点A2的计算坐标(Px’,Py’,Pz’)和第二标定点A2的拍摄坐标(Px,Py,Pz)已知的情况下,代入步骤103求解得到的设定立体相机,例如立体相机101与该第二标定点A2对应的立体相机,例如立体相机102之间的旋转矩阵,即可获取设定立体相机,例如立体相机101与该第二标定点A2对应的立体相机,例如立体相机102所在坐标系之间的平移矩阵。Specifically, the calibration transformation matrix includes a rotation matrix and a translation matrix, and the three-dimensional coordinate point P' corresponding to the calculated coordinates of the second calibration point A2 obtained according to the distribution positions of all the calibration points A and the three-dimensional coordinates corresponding to the shooting coordinates of the second calibration point A2 The point P belongs to the same point in the physical world, which is called the point of the same name. The coordinates of P' are (Px', Py', Pz'), and the coordinates of P are (Px, Py, Pz). The formula P'=(RT)P, that is, the above RT relational equation is satisfied. When the calculated coordinates (Px', Py', Pz') of the second calibration point A2 and the shooting coordinates (Px, Py, Pz) of the second calibration point A2 are known, substitute the set stereo obtained by solving in step 103 A camera, such as the stereo camera corresponding to the stereo camera 101 and the second calibration point A2, such as the rotation matrix between the stereo cameras 102, can obtain and set the stereo camera, such as the stereo camera 101 corresponding to the second calibration point A2. Cameras, such as the translation matrix between the coordinate systems where the stereo camera 102 is located.
可选地,可以采用平均值算法根据同一第二标定点的计算坐标、拍摄坐标以及两台立体相机所在坐标系之间的旋转矩阵,获取两台立体相机所在坐标系之间的平移矩阵,例如可以采用平均值算法根据同一第二标定点A2的计算坐标、拍摄坐标以及设定立体相机,例如立体相机101与该第二标定点A2对应的立体相机,例如立体相机102所在坐标系之间的旋转 矩阵,获取设定立体相机,例如立体相机101与该第二标定点A2对应的立体相机,例如立体相机102所在坐标系之间的平移矩阵。Optionally, an average value algorithm can be used to obtain the translation matrix between the coordinate systems where the two stereo cameras are located according to the calculated coordinates of the same second calibration point, the shooting coordinates, and the rotation matrix between the coordinate systems where the two stereo cameras are located, for example The average value algorithm can be used to calculate the coordinates, shooting coordinates and set the stereo camera according to the same second calibration point A2, for example, the stereo camera 101 corresponding to the second calibration point A2, for example, the stereo camera 102 is located between the coordinate systems. For the rotation matrix, obtain and set the stereo camera, for example, the stereo camera corresponding to the stereo camera 101 and the second calibration point A2, for example, the translation matrix between the coordinate systems where the stereo camera 102 is located.
具体地,立体相机102的视场内有多少个第二标定点A2,在实现将立体相机102所在坐标系统一到立体相机101所在坐标系的过程中,就有多少个P’=(RT)P的关系等式,图2示例性地设置立体相机102的视场内有四个第二标定点A2,在实现将立体相机102所在坐标系统一到立体相机101所在坐标系的过程中,就有四组同名点,即有四个P’=(RT)P的关系等式,可以设置获取第二标定物2处于八个不同位姿下的第二标定点A的拍摄坐标,则共存在32组同名点,32组同名点均满足P’=(RT)P的关系等式,即可以列出32个P’=(RT)P的关系等式。Specifically, how many second calibration points A2 are in the field of view of the stereo camera 102, and how many P'=(RT) in the process of converting the coordinate system where the stereo camera 102 is located to the coordinate system where the stereo camera 101 is located The relationship equation of P, Fig. 2 exemplarily sets four second calibration points A2 in the field of view of the stereo camera 102. In the process of realizing the transformation from the coordinate system where the stereo camera 102 is located to the coordinate system where the stereo camera 101 is located, the There are four groups of points with the same name, that is, there are four relational equations of P'=(RT)P, which can be set to obtain the shooting coordinates of the second calibration point A of the second calibration object 2 in eight different poses, then there are co-existence There are 32 groups of points with the same name, and all the 32 groups of points with the same name satisfy the relational equation of P'=(RT)P, that is, 32 relational equations of P'=(RT)P can be listed.
针对32个P’=(RT)P的关系等式,可以采用平均值算法获取设定立体相机,例如立体相机101与该第二标定点A2对应的立体相机,例如立体相机102所在坐标系之间的平移矩阵,即对每个P’=(RT)P关系等式计算得出的平移矩阵T求解平均值,最终确定设定立体相机,例如立体相机101与该第二标定点A2对应的立体相机,例如立体相机102所在坐标系之间的平移矩阵。For the relational equation of 32 P'=(RT)P, the average value algorithm can be used to obtain and set the stereo camera, for example, the stereo camera corresponding to the stereo camera 101 and the second calibration point A2, such as the coordinate system where the stereo camera 102 is located. That is, the average value of the translation matrix T calculated by each P'=(RT)P relational equation is calculated, and the stereo camera is finally determined, for example, the stereo camera 101 corresponds to the second calibration point A2. Stereo cameras, such as translation matrices between coordinate systems where the stereo camera 102 is located.
需要说明的是,上述实施例仅示例性地以S101至S106表示多立体相机10的标定方法中的各个步骤,并不代表对各个步骤执行顺序的限定,除有绝对的必要使得两个步骤之间的严格的先后执行顺序,其余步骤之间可以同时进行或者进行先后执行顺序的调整,本公开实施例对此不作具体限定。It should be noted that, in the above-mentioned embodiments, S101 to S106 are only used to represent each step in the calibration method of the multi-stereo camera 10, and do not represent a limitation on the execution order of each step. Unless it is absolutely necessary to make one of the two steps There is a strict sequential execution order between the other steps, and the other steps may be performed simultaneously or the sequential execution order may be adjusted, which is not specifically limited in this embodiment of the present disclosure.
另外,上述实施例求解得到的平移矩阵为平均值的求解结果,因此可以比对哪个采样组求得的平移矩阵与平移矩阵的平均值相差较大,说明该采样组求解得到的平移矩阵误差较大,可以删除该采样组,以提高求解得到的平移矩阵的精度。另外,上述实施例求解旋转矩阵的过程为奇异值分解的近似求解过程,可以将单独采样组求解得到的旋转矩阵代入上述法向量的关系等式,若反推出来的法向量与实际计算获得的法向量相差较大,说明该采样组求解得到的旋转矩阵误差较大,同样可以删除该采样组,以提高求解得到的旋转矩阵的精度。由此,可以通过标定的旋转矩阵,检测各个坐标系下的平面法向量统一到一个坐标系下的误差,以及通过标定的平移矩阵,检测各个坐标系下的同名点转换后的误差,旋转矩阵和平移矩阵分开求解,分开进行误差分析,以便于确定标定中的某个立体相机10单独的某个矩阵存在的问题,这样就可以对每个旋转矩阵和平移矩阵的标定精度做分别的定量分析,实现用不同的方式分别提高某个立体相机10标定的旋转矩阵和平移矩阵的精度,例如可以删除某组采样等。In addition, the translation matrix obtained by the solution in the above-mentioned embodiment is the solution result of the average value, so the translation matrix obtained from the sampling group can be compared with the average value of the translation matrix. If it is large, the sampling group can be deleted to improve the accuracy of the translation matrix obtained by the solution. In addition, the process of solving the rotation matrix in the above-mentioned embodiment is an approximate solving process of singular value decomposition. The difference between the normal vectors is large, indicating that the rotation matrix obtained by the sampling group has a large error, and the sampling group can also be deleted to improve the accuracy of the rotation matrix obtained by the solution. In this way, it is possible to use the calibrated rotation matrix to detect the error that the plane normal vectors under each coordinate system are unified into one coordinate system, and to use the calibrated translation matrix to detect the converted error of the points with the same name in each coordinate system, and the rotation matrix The solution and translation matrix are solved separately, and the error analysis is carried out separately, so as to determine the problem of a single matrix of a certain stereo camera 10 in the calibration, so that the calibration accuracy of each rotation matrix and translation matrix can be quantitatively analyzed separately. , so as to improve the precision of the rotation matrix and the translation matrix calibrated by a certain stereo camera 10 in different ways, for example, a certain group of samples can be deleted.
可选地,结合图2和图3,第一标定物1和第二标定物2可以集成设置,也可以独立设置,相应的,第一标定物1和第二标定物2可以同时采样也可以分别采样。具体地,第一标定物1和第二标定物2可以集成设置,第一标定物1包括标定板,第二标定物2包括位于一条直线上的多个标定点A,可以在标定板上绘制一条直线,并在直线上标出多个标定点A。第一标定物1和第二标定物2也可以独立设置,例如第一标定物1可以为块状钢板,第二标定物2可以为一根直杆,并在直杆上标示出多个标定点A。Optionally, in conjunction with FIG. 2 and FIG. 3 , the first calibration object 1 and the second calibration object 2 can be set integrally or independently. Correspondingly, the first calibration object 1 and the second calibration object 2 can be sampled at the same time or can be sampled at the same time. sample separately. Specifically, the first calibration object 1 and the second calibration object 2 can be integrated, the first calibration object 1 includes a calibration plate, and the second calibration object 2 includes a plurality of calibration points A located on a straight line, which can be drawn on the calibration plate A straight line and multiple calibration points A are marked on the straight line. The first calibration object 1 and the second calibration object 2 can also be set independently. For example, the first calibration object 1 can be a block-shaped steel plate, and the second calibration object 2 can be a straight rod, and multiple targets are marked on the straight rod. Fixed point A.
另外,若需要标定的立体相机10的数量较多,第一标定物1或第二标定物2的尺寸不足够时,可以先标定相邻的多个立体相机10,再移动第一标定物1和第二标定物2以传递着进行标定。例如可以先使用第一标定物1和第二标定物2对第一台至第四台立体相机10进行标定,将第一台至第四台立体相机10均统一至第一台立体相机10所在坐标系,再移动第一标定物1和第二标定物2,对第五台至第八台立体相机10进行标定,将第五台至第八台立体相机10均统一至第五台立体相机10所在坐标系,最终再均统一至第一台立体相机10所在坐标系,避免第一标定物1或第二标定物2尺寸过大,导致多个立体相机10的标定工作较为繁重。In addition, if the number of stereo cameras 10 to be calibrated is large, and the size of the first calibration object 1 or the second calibration object 2 is not enough, the adjacent stereo cameras 10 can be calibrated first, and then the first calibration object 1 can be moved. and the second calibration object 2 to be calibrated by transfer. For example, the first to fourth stereo cameras 10 can be calibrated by using the first calibration object 1 and the second calibration object 2, and the first to fourth stereo cameras 10 are unified to the location where the first stereo camera 10 is located. Coordinate system, then move the first calibration object 1 and the second calibration object 2, calibrate the fifth to eighth stereo cameras 10, and unify the fifth to eighth stereo cameras 10 to the fifth stereo camera The coordinate system where 10 is located is finally unified to the coordinate system where the first stereo camera 10 is located, so as to prevent the first calibration object 1 or the second calibration object 2 from being too large in size, resulting in heavy calibration of multiple stereo cameras 10 .
本公开实施例还提供了一种多立体相机的标定装置,图4为本公开实施例提供的一种多立体相机的标定装置的结构示意图。如图4所示,多立体相机的标定装置包括标定物设置模块201、法向量获取模块202、旋转矩阵获取模块203、直线拟合模块204、计算坐标获取模块205和平移矩阵获取模块206。An embodiment of the present disclosure further provides a multi-stereo camera calibration device, and FIG. 4 is a schematic structural diagram of a multi-stereo camera calibration device according to an embodiment of the present disclosure. As shown in FIG. 4 , the multi-stereo camera calibration device includes a calibration object setting module 201 , a normal vector obtaining module 202 , a rotation matrix obtaining module 203 , a line fitting module 204 , a calculation coordinate obtaining module 205 and a translation matrix obtaining module 206 .
标定物设置模块201用于将第一标定物放置于多个立体相机的视场中以及将第二标定物放置于多个立体相机的视场中;其中,第一标定物包括标定板,第二标定物包括位于一条直线上的多个标定点,每台立体相机中可见至少两个标定点。法向量获取模块202用于提取第一标定物处于不同位姿下立体相机所得点云中第一标定物所属点云,并根据立体相机获取的第一标定物所属点云拟合平面,并获取拟合的平面的法向量。旋转矩阵获取模块203用于根据两台立体相机对应的法向量获取两台立体相机所在坐标系之间的旋转矩。直线拟合模块204用于获取第一标定点和第二标定点的拍摄坐标,根据第一标定点的拍摄坐标拟合一条直线;其中,第一标定点与第二标定点为位于不同的立体相机视场中的标定点,第二标定点位于拟合的直线上。计算坐标获取模块205用于根据第一标定点的拍摄坐标以及所有标定点的分布位置获取第二标定点的计算坐标。平移矩阵获取模块206用于根据同一第二标定点的计算坐标、拍摄坐标以及两台立体相机所在坐标系之间的旋转矩阵,获取两台立体相机所在坐标系之间的平移矩阵。The calibration object setting module 201 is used for placing the first calibration object in the field of view of the plurality of stereo cameras and placing the second calibration object in the field of view of the plurality of stereo cameras; wherein the first calibration object includes a calibration plate, and the first calibration object includes a calibration plate. The second calibration object includes a plurality of calibration points located on a straight line, and at least two calibration points are visible in each stereo camera. The normal vector acquisition module 202 is used to extract the point cloud to which the first calibration object belongs in the point cloud obtained by the stereo camera under different poses of the first calibration object, and to fit the plane according to the point cloud of the first calibration object obtained by the stereo camera, and obtain The normal vector of the fitted plane. The rotation matrix obtaining module 203 is configured to obtain the rotation moment between the coordinate systems where the two stereo cameras are located according to the normal vectors corresponding to the two stereo cameras. The straight line fitting module 204 is used to obtain the shooting coordinates of the first calibration point and the second calibration point, and fit a straight line according to the shooting coordinates of the first calibration point; wherein, the first calibration point and the second calibration point are located in different three-dimensional The calibration point in the camera's field of view, the second calibration point is located on the fitted straight line. The calculation coordinate obtaining module 205 is configured to obtain the calculation coordinates of the second calibration point according to the shooting coordinates of the first calibration point and the distribution positions of all the calibration points. The translation matrix obtaining module 206 is configured to obtain the translation matrix between the coordinate systems where the two stereo cameras are located according to the calculated coordinates of the same second calibration point, the shooting coordinates and the rotation matrix between the coordinate systems where the two stereo cameras are located.
本公开实施例技术方案提供了一种多立体相机的标定方法,以一台立体相机所在坐标系为基础坐标系,标定出了其余每台立体相机与基础立体相机所在坐标系之间的旋转矩阵和平移矩阵,即标定出了其余每台立体相机与基础立体相机所在坐标系之间的外参矩阵,实现了多立体相机的标定工作,且分步标定旋转矩阵和平移矩阵,有利于分别对旋转矩阵和平移矩阵的标定精度进行定理分析以降低标定误差,进而实现用不同的方式分别提高某个立体相机的旋转矩阵或平移矩阵的标定精度。另外,第一标定物与第二标定物的制作较为简单,无需进行迭代计算,标定效率和精度较高,且无需借助例如全站仪等第三方工具,有效降低了完成多立体相机标定工作的成本。The technical solutions of the embodiments of the present disclosure provide a method for calibrating multiple stereo cameras. The coordinate system where one stereo camera is located is used as the basic coordinate system, and the rotation matrix between each other stereo cameras and the coordinate system where the basic stereo camera is located is calibrated and translation matrix, that is, the external parameter matrix between each other stereo camera and the coordinate system of the basic stereo camera is calibrated, which realizes the calibration of multi-stereo cameras, and the step-by-step calibration of the rotation matrix and translation matrix is conducive to the The theorem analysis of the calibration accuracy of the rotation matrix and the translation matrix is carried out to reduce the calibration error, so as to improve the calibration accuracy of the rotation matrix or translation matrix of a stereo camera in different ways. In addition, the production of the first calibration object and the second calibration object is relatively simple, no iterative calculation is required, the calibration efficiency and accuracy are high, and third-party tools such as total stations are not required, which effectively reduces the multi-stereo camera calibration work. cost.
本发明实施例还提供了一种电子设备,图5为本发明实施例提供的一种电子设备的结构示意图。如图5所示,电子设备包括处理器和存储器,处理器通过调用存储器存储的程序或指令,执行如上述实施例的多立体相机的标定方法的步骤,因此具备上述实施例的有益效果,这里不再赘述。An embodiment of the present invention further provides an electronic device, and FIG. 5 is a schematic structural diagram of an electronic device provided by an embodiment of the present invention. As shown in FIG. 5 , the electronic device includes a processor and a memory. The processor executes the steps of the method for calibrating a multi-stereo camera according to the above-mentioned embodiment by invoking a program or an instruction stored in the memory. Therefore, it has the beneficial effects of the above-mentioned embodiment. No longer.
如图5所示,可以设置电子设备包括至少一个处理器301、至少一个存储器302和至少一个通信接口303。电子设备中的各个组件通过总线系统304耦合在一起。通信接口303用于与外部设备之间的信息传输。可理解,总线系统304用于实现这些组件之间的连接通信。总线系统304除包括数据总线之外,还包括电源总线、控制总线和状态信号总线。但为了清楚说明起见,在图5中将各种总线都标为总线系统304。As shown in FIG. 5 , the electronic device may be arranged to include at least one processor 301 , at least one memory 302 and at least one communication interface 303 . The various components in the electronic device are coupled together by a bus system 304 . The communication interface 303 is used for information transmission with external devices. It will be appreciated that the bus system 304 is used to implement the connection communication between these components. In addition to the data bus, the bus system 304 also includes a power bus, a control bus and a status signal bus. However, for clarity of illustration, the various buses are labeled as bus system 304 in FIG. 5 .
可以理解,本实施例中的存储器302可以是易失性存储器或非易失性存储器,或可包括易失性和非易失性存储器两者。在一些实施方式中,存储器302存储了如下的元素:可执行单元或者数据结构,或者他们的子集,或者他们的扩展集操作系统和应用程序。在本发明实施例中,处理器301通过调用存储器302存储的程序或指令,执行本发明实施例提供的多立体相机的标定方法各实施例的步骤。It is understood that the memory 302 in this embodiment may be a volatile memory or a non-volatile memory, or may include both volatile and non-volatile memory. In some embodiments, the memory 302 stores the following elements: executable units or data structures, or a subset thereof, or an extended set of operating systems and applications. In the embodiment of the present invention, the processor 301 executes the steps of the various embodiments of the calibration method for a multi-stereo camera provided by the embodiment of the present invention by calling a program or an instruction stored in the memory 302 .
本发明实施例提供的多立体相机的标定方法可以应用于处理器301中,或者由处理器301实现。处理器301可以是一种集成电路芯片,具有信号的处理能力。在实现过程中,上述方法的各步骤可以通过处理器301中的硬件的集成逻辑电路或者软件形式的指令完成。上述的处理器301可以是通用处理器、数字信号处理器(Digital Signal Processor,DSP)、专用集成电路(Application Specific Integrated Circuit,ASIC)、现成可编程门阵列(Field Programmable Gate Array,FPGA)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件。通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等。The multi-stereo camera calibration method provided in the embodiment of the present invention may be applied to the processor 301 or implemented by the processor 301 . The processor 301 may be an integrated circuit chip, which has signal processing capability. In the implementation process, each step of the above-mentioned method can be completed by an integrated logic circuit of hardware in the processor 301 or an instruction in the form of software. The above-mentioned processor 301 can be a general-purpose processor, a digital signal processor (Digital Signal Processor, DSP), an application specific integrated circuit (Application Specific Integrated Circuit, ASIC), a ready-made programmable gate array (Field Programmable Gate Array, FPGA) or other Programmable logic devices, discrete gate or transistor logic devices, discrete hardware components. A general purpose processor may be a microprocessor or the processor may be any conventional processor or the like.
本发明实施例提供的多立体相机的标定方法的步骤可以直接体现为硬件译码处理器执行完成,或者用译码处理器中的硬件及软件单元组合执行完成。软件单元可以位于随机存储器,闪存、只读存储器,可编程只读存储器或者电可擦写可编程存储器、寄存器等本领域成熟的存储介质中。该存储介质位于存储器302,处理器301读取存储器302中的信息,结合其硬件完成方法的步骤。The steps of the method for calibrating a multi-stereo camera provided by the embodiment of the present invention may be directly embodied as being executed by a hardware decoding processor, or executed by a combination of hardware and software units in the decoding processor. The software unit may be located in random access memory, flash memory, read-only memory, programmable read-only memory or electrically erasable programmable memory, registers and other storage media mature in the art. The storage medium is located in the memory 302, and the processor 301 reads the information in the memory 302, and completes the steps of the method in combination with its hardware.
该电子设备还可以包括一个实体部件,或者多个实体部件,以根据处理器301在执行本申请实施例提供的多立体相机的标定方法时生成的指令。各个实体部件与处理器301和存储器302共同配合实现本实施例中电子设备的功能。The electronic device may further include one entity component, or multiple entity components, according to the instructions generated by the processor 301 when executing the calibration method for a multi-stereo camera provided by the embodiment of the present application. Each entity component cooperates with the processor 301 and the memory 302 to realize the functions of the electronic device in this embodiment.
本发明实施例还提供一种存储介质,例如计算机可读存储介质,存储介质存储程序或指令,该程序或指令使计算机执行行时用于执行一种多立体相机的标定方法,该方法包括:An embodiment of the present invention also provides a storage medium, such as a computer-readable storage medium, the storage medium stores a program or an instruction, the program or instruction enables a computer to execute a multi-stereo camera calibration method when running, and the method includes:
将第一标定物放置于多个立体相机的视场中以及将第二标定物放置于多个立体相机的视场中;其中,所述第一标定物包括标定板,所述第二标定物包括位于一条直线上的多个标定点,每台所述立体相机中可见至少两个所述标定点;The first calibration object is placed in the field of view of the plurality of stereo cameras and the second calibration object is placed in the field of view of the plurality of stereo cameras; wherein, the first calibration object includes a calibration plate, and the second calibration object Including a plurality of calibration points on a straight line, at least two of the calibration points can be seen in each of the stereo cameras;
提取所述第一标定物处于不同位姿下所述立体相机所得点云中所述第一标定物所属点云,并根据所述立体相机获取的所述第一标定物所属点云拟合平面,并获取拟合的所述平面的法向量;Extracting the point cloud to which the first calibration object belongs in the point cloud obtained by the stereo camera when the first calibration object is in different poses, and fitting a plane according to the point cloud to which the first calibration object belongs to obtained by the stereo camera , and obtain the normal vector of the fitted plane;
根据两台立体相机对应的所述法向量获取所述两台立体相机所在坐标系之间的旋转矩阵;Obtain the rotation matrix between the coordinate systems where the two stereo cameras are located according to the normal vectors corresponding to the two stereo cameras;
获取第一标定点和第二标定点的拍摄坐标,根据所述第一标定点的拍摄坐标拟合一条直 线;其中,所述第一标定点与所述第二标定点为位于不同的所述立体相机视场中的标定点,所述第二标定点位于拟合的所述直线上;Obtain the shooting coordinates of the first calibration point and the second calibration point, and fit a straight line according to the shooting coordinates of the first calibration point; wherein, the first calibration point and the second calibration point are located in different a calibration point in the field of view of the stereo camera, the second calibration point is located on the fitted straight line;
根据所述第一标定点的拍摄坐标以及所有所述标定点的分布位置获取所述第二标定点的计算坐标;Obtain the calculated coordinates of the second calibration point according to the shooting coordinates of the first calibration point and the distribution positions of all the calibration points;
根据同一所述第二标定点的计算坐标、拍摄坐标以及两台立体相机所在坐标系之间的旋转矩阵,获取所述两台立体相机所在坐标系之间的平移矩阵。The translation matrix between the coordinate systems where the two stereo cameras are located is obtained according to the calculated coordinates and the shooting coordinates of the same second calibration point and the rotation matrix between the coordinate systems where the two stereo cameras are located.
可选地,该计算机可执行指令在由计算机处理器执行时还可以用于执行本发明任意实施例所提供的多立体相机的标定方法的技术方案。Optionally, when executed by a computer processor, the computer-executable instructions may also be used to execute the technical solution of the calibration method for a multi-stereo camera provided by any embodiment of the present invention.
通过以上关于实施方式的描述,所属领域的技术人员可以清楚地了解到,本申请可借助软件及必需的通用硬件来实现,当然也可以通过硬件实现,但很多情况下前者是更佳的实施方式。基于这样的理解,本申请的技术方案本质上或者说对现有技术做出贡献的部分可以以软件产品的形式体现出来,该计算机软件产品可以存储在计算机可读存储介质中,如计算机的软盘、只读存储器(Read-Only Memory,ROM)、随机存取存储器(Random Access Memory,RAM)、闪存(FLASH)、硬盘或光盘等,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本发明各个实施例的方法。From the above description of the embodiments, those skilled in the art can clearly understand that the present application can be implemented by software and necessary general-purpose hardware, and of course can also be implemented by hardware, but in many cases, the former is a better implementation. . Based on this understanding, the technical solutions of the present application can be embodied in the form of software products in essence or the parts that make contributions to the prior art, and the computer software products can be stored in a computer-readable storage medium, such as a floppy disk of a computer , read-only memory (Read-Only Memory, ROM), random access memory (Random Access Memory, RAM), flash memory (FLASH), hard disk or optical disk, etc., including several instructions to make a computer device (which can be a personal computer , server, or network device, etc.) to execute the methods of various embodiments of the present invention.
需要说明的是,在本文中,诸如“第一”和“第二”等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括要素的过程、方法、物品或者设备中还存在另外的相同要素。It should be noted that, in this document, relational terms such as "first" and "second" etc. are only used to distinguish one entity or operation from another entity or operation, and do not necessarily require or imply these There is no such actual relationship or sequence between entities or operations. Moreover, the terms "comprising", "comprising" or any other variation thereof are intended to encompass non-exclusive inclusion such that a process, method, article or device comprising a list of elements includes not only those elements, but also includes not explicitly listed or other elements inherent to such a process, method, article or apparatus. Without further limitation, an element qualified by the phrase "comprising a..." does not preclude the presence of additional identical elements in the process, method, article, or device that includes the element.
以上仅是本公开的具体实施方式,使本领域技术人员能够理解或实现本公开。对这些实施例的多种修改对本领域的技术人员来说将是显而易见的,本文中所定义的一般原理可以在不脱离本公开的精神或范围的情况下,在其它实施例中实现。因此,本公开将不会被限制于本文的这些实施例,而是要符合与本文所公开的原理和新颖特点相一致的最宽的范围。The above are only specific embodiments of the present disclosure, so that those skilled in the art can understand or implement the present disclosure. Various modifications to these embodiments will be readily apparent to those skilled in the art, and the generic principles defined herein may be implemented in other embodiments without departing from the spirit or scope of the present disclosure. Therefore, the present disclosure is not to be limited to the embodiments herein, but is to be accorded the widest scope consistent with the principles and novel features disclosed herein.

Claims (15)

  1. 一种多立体相机的标定方法,包括:A method for calibrating a multi-stereo camera, comprising:
    将第一标定物放置于多个立体相机的视场中以及将第二标定物放置于多个所述立体相机的视场中;其中,所述第一标定物包括标定板,所述第二标定物包括位于一条直线上的多个标定点,每台所述立体相机中可见至少两个所述标定点;The first calibration object is placed in the field of view of a plurality of stereo cameras and the second calibration object is placed in the field of view of the plurality of stereo cameras; wherein, the first calibration object includes a calibration plate, and the second calibration object The calibration object includes a plurality of calibration points located on a straight line, and at least two of the calibration points can be seen in each of the stereo cameras;
    提取所述第一标定物处于不同位姿下所述立体相机所得点云中所述第一标定物所属点云,并根据所述立体相机获取的所述第一标定物所属点云拟合平面,并获取拟合的所述平面的法向量;Extracting the point cloud to which the first calibration object belongs in the point cloud obtained by the stereo camera when the first calibration object is in different poses, and fitting the plane according to the point cloud to which the first calibration object belongs, obtained by the stereo camera , and obtain the normal vector of the fitted plane;
    根据所述两台立体相机对应的所述法向量获取所述两台立体相机所在坐标系之间的旋转矩阵;Obtain the rotation matrix between the coordinate systems where the two stereo cameras are located according to the normal vectors corresponding to the two stereo cameras;
    获取所述第一标定点和所述第二标定点的拍摄坐标,根据所述第一标定点的拍摄坐标拟合一条直线;其中,所述第一标定点与所述第二标定点为位于不同的所述立体相机视场中的标定点,所述第二标定点位于拟合的所述直线上;Obtain the shooting coordinates of the first calibration point and the second calibration point, and fit a straight line according to the shooting coordinates of the first calibration point; wherein, the first calibration point and the second calibration point are located at different calibration points in the stereo camera field of view, the second calibration point is located on the fitted straight line;
    根据所述第一标定点的拍摄坐标以及所有所述标定点的分布位置获取所述第二标定点的计算坐标;Obtain the calculated coordinates of the second calibration point according to the shooting coordinates of the first calibration point and the distribution positions of all the calibration points;
    根据同一所述第二标定点的计算坐标、拍摄坐标以及所述两台立体相机所在坐标系之间的旋转矩阵,获取所述两台立体相机所在坐标系之间的平移矩阵。The translation matrix between the coordinate systems where the two stereo cameras are located is obtained according to the calculated coordinates and the shooting coordinates of the same second calibration point and the rotation matrix between the coordinate systems where the two stereo cameras are located.
  2. 根据权利要求1所述的多立体相机的标定方法,其中,在所述根据所述立体相机获取的所述第一标定物所属点云拟合平面之前,还包括:The method for calibrating a multi-stereo camera according to claim 1, wherein before the point cloud fitting plane to which the first calibration object obtained according to the stereo camera belongs, the method further comprises:
    采用聚类算法和/或滤波算法提取所述立体相机所得点云中所述第一标定物所属点云。The point cloud to which the first calibration object belongs in the point cloud obtained by the stereo camera is extracted by using a clustering algorithm and/or a filtering algorithm.
  3. 根据权利要求1所述的多立体相机的标定方法,其中,采用最小二乘算法或者随机抽样一致算法根据所述立体相机获取的所述第一标定物所属点云拟合平面。The method for calibrating a multi-stereo camera according to claim 1 , wherein a least squares algorithm or a random sampling consensus algorithm is used to fit the plane of the point cloud to which the first calibration object obtained by the stereo camera belongs.
  4. 根据权利要求1所述的多立体相机的标定方法,其中,所述根据两台所述立体相机对应的所述法向量获取所述两台立体相机所在坐标系之间的旋转矩阵,包括:The method for calibrating multi-stereo cameras according to claim 1, wherein the acquiring a rotation matrix between the coordinate systems where the two stereo cameras are located according to the normal vectors corresponding to the two stereo cameras, comprises:
    根据所述两台立体相机对应的所述法向量,列出所述法向量与所述旋转矩阵的关系等式,所述关系等式为:According to the normal vectors corresponding to the two stereo cameras, the relationship equation between the normal vector and the rotation matrix is listed, and the relationship equation is:
    Figure PCTCN2021121462-appb-100001
    Figure PCTCN2021121462-appb-100001
    其中,(N 1x,N 1y,N 1z)为所述两台立体相机中的一台立体相机对应的所述法向量的三维坐标,(N 2x,N 2y,N 2z)为所述两台立体相机中的另一台立体相机对应的所述法向量的三维坐标,R21为所述两台立体相机所在坐标系之间的旋转矩阵; Wherein, (N 1x , N 1y , N 1z ) are the three-dimensional coordinates of the normal vector corresponding to one of the two stereo cameras, and (N 2x , N 2y , N 2z ) are the two stereo cameras the three-dimensional coordinates of the normal vector corresponding to another stereo camera in the stereo camera, and R21 is the rotation matrix between the coordinate systems where the two stereo cameras are located;
    根据所述关系等式获取所述两台立体相机所在坐标系之间的旋转矩阵。The rotation matrix between the coordinate systems where the two stereo cameras are located is obtained according to the relational equation.
  5. 根据权利要求4所述的多立体相机的标定方法,其中,采用奇异值分解算法根据所述两台立体相机对应的所述法向量获取所述两台立体相机所在坐标系之间的旋转矩阵。The method for calibrating multiple stereo cameras according to claim 4, wherein a singular value decomposition algorithm is used to obtain the rotation matrix between the coordinate systems where the two stereo cameras are located according to the normal vectors corresponding to the two stereo cameras.
  6. 根据权利要求1所述的多立体相机的标定方法,其中,所述根据所述第一标定点的拍摄坐标拟合一条直线,包括:The method for calibrating a multi-stereo camera according to claim 1, wherein the fitting a straight line according to the shooting coordinates of the first calibration point comprises:
    根据至少两个所述第一标定点的拍摄坐标拟合一条直线以使所述至少两个所述第一标定点位于拟合的所述直线上。A straight line is fitted according to the shooting coordinates of at least two of the first calibration points, so that the at least two first calibration points are located on the fitted straight line.
  7. 根据权利要求1所述的多立体相机的标定方法,其中,所述根据所述第一标定点的拍摄坐标以及所有所述标定点的分布位置获取所述第二标定点的计算坐标,包括:The method for calibrating a multi-stereo camera according to claim 1, wherein the obtaining the calculated coordinates of the second calibration point according to the shooting coordinates of the first calibration point and the distribution positions of all the calibration points comprises:
    根据所有所述标定点的分布位置确定位于拟合的所述直线上的所述第一标定点和所述第二标定点之间的间距;Determine the distance between the first calibration point and the second calibration point on the fitted straight line according to the distribution positions of all the calibration points;
    根据所述第一标定点的拍摄坐标、拟合的所述直线的方程以及所述间距获取所述第二标定点的计算坐标。The calculated coordinates of the second calibration point are obtained according to the shooting coordinates of the first calibration point, the fitted equation of the straight line, and the distance.
  8. 根据权利要求7所述的多立体相机的标定方法,其中,所述标定点等间距设置;The method for calibrating a multi-stereo camera according to claim 7, wherein the calibration points are arranged at equal intervals;
    所述根据所有所述标定点的分布位置确定位于拟合的所述直线上的所述第一标定点和所述第二标定点之间的间距,包括:The determining the distance between the first calibration point and the second calibration point on the fitted straight line according to the distribution positions of all the calibration points includes:
    对所有所述标定点依次编号;Number all the calibration points in sequence;
    位于拟合的所述直线上的所述第二标定点的标号与所述第一标定点的标号的差值与相邻两个所述标定点之间间距的乘积,为位于拟合的所述直线上的所述第一标定点和所述第二标定点之间的间距。The product of the difference between the label of the second calibration point and the label of the first calibration point located on the fitted straight line and the distance between two adjacent calibration points is the The distance between the first calibration point and the second calibration point on the straight line.
  9. 根据权利要求1所述的多立体相机的标定方法,其中,所述根据同一所述第二标定点的计算坐标、拍摄坐标以及所述两台立体相机所在坐标系之间的旋转矩阵,获取所述两台立体相机所在坐标系之间的平移矩阵,包括:The method for calibrating multi-stereo cameras according to claim 1 , wherein said obtaining the all the data is based on the calculated coordinates of the same second calibration point, the shooting coordinates and the rotation matrix between the coordinate systems where the two stereo cameras are located. The translation matrix between the coordinate systems where the two stereo cameras are located, including:
    依据不同的所述第二标定点,列出多组所述第二标定点的计算坐标、拍摄坐标、所述两台立体相机所在坐标系之间的旋转矩阵、所述两台立体相机所在坐标系之间的平移矩阵之间的关系等式;According to the different second calibration points, list the calculated coordinates of the second calibration points, the shooting coordinates, the rotation matrix between the coordinate systems where the two stereo cameras are located, and the coordinates where the two stereo cameras are located. The relationship equation between the translation matrices between the systems;
    所述关系等式为:The relational equation is:
    Figure PCTCN2021121462-appb-100002
    Figure PCTCN2021121462-appb-100002
    其中,R为所述两台立体相机所在坐标系之间的旋转矩阵,T为所述两台立体相机所在坐标系之间的平移矩阵,(Px’,Py’,Pz’)为所述第二标定点的计算坐标,(Px,Py,Pz)为所述第二标定点的拍摄坐标;Wherein, R is the rotation matrix between the coordinate systems where the two stereo cameras are located, T is the translation matrix between the coordinate systems where the two stereo cameras are located, and (Px', Py', Pz') is the first The calculated coordinates of the two calibration points, (Px, Py, Pz) are the shooting coordinates of the second calibration point;
    根据所述关系等式获取所述两台立体相机所在坐标系之间的平移矩阵。The translation matrix between the coordinate systems where the two stereo cameras are located is obtained according to the relational equation.
  10. 根据权利要求9所述的多立体相机的标定方法,其中,采用平均值算法根据同一所述第二标定点的计算坐标、拍摄坐标以及所述两台立体相机所在坐标系之间的旋转矩阵,获取所述两台立体相机所在坐标系之间的平移矩阵。The method for calibrating multiple stereo cameras according to claim 9, wherein an average value algorithm is used according to the calculated coordinates of the same second calibration point, the shooting coordinates and the rotation matrix between the coordinate systems where the two stereo cameras are located, Acquire the translation matrix between the coordinate systems where the two stereo cameras are located.
  11. 根据权利要求1所述的多立体相机的标定方法,其中,获取所述第一标定点的拍摄坐标,包括:The method for calibrating a multi-stereo camera according to claim 1, wherein acquiring the shooting coordinates of the first calibration point comprises:
    获取所述第二标定物处于不同位姿下的所述第一标定点的拍摄坐标。The shooting coordinates of the first calibration point where the second calibration object is in different poses are acquired.
  12. 根据权利要求11所述的多立体相机的标定方法,其中,所述第一标定物的位姿包括所述第一标定物至所述立体相机的距离,和/或,所述第一标定物相对于所述立体相机的倾斜角度;The multi-stereo camera calibration method according to claim 11, wherein the pose of the first calibration object includes a distance from the first calibration object to the stereo camera, and/or the first calibration object an angle of inclination relative to the stereo camera;
    所述第二标定物的位姿包括所述第二标定物至所述立体相机的距离,和/或,所述第二标定物相对于所述立体相机的倾斜角度。The pose of the second calibration object includes a distance from the second calibration object to the stereo camera, and/or an inclination angle of the second calibration object relative to the stereo camera.
  13. 一种多立体相机的标定装置,包括:A multi-stereo camera calibration device, comprising:
    标定物设置模块,用于将第一标定物放置于多个立体相机的视场中以及将第二标定物放置于多个所述立体相机的视场中;其中,所述第一标定物包括标定板,所述第二标定物包括位于一条直线上的多个标定点,每台所述立体相机中可见至少两个所述标定点;A calibration object setting module for placing a first calibration object in the field of view of a plurality of stereo cameras and placing a second calibration object in the field of view of the plurality of stereo cameras; wherein the first calibration object includes a calibration plate, the second calibration object includes a plurality of calibration points located on a straight line, and at least two of the calibration points can be seen in each of the stereo cameras;
    法向量获取模块,用于提取所述第一标定物处于不同位姿下所述立体相机所得点云中所述第一标定物所属点云,并根据所述立体相机获取的所述第一标定物所属点云拟合平面,并获取拟合的所述平面的法向量;A normal vector acquisition module, configured to extract the point cloud to which the first calibration object belongs in the point cloud obtained by the stereo camera when the first calibration object is in different poses, and according to the first calibration obtained by the stereo camera The point cloud fitting plane to which the object belongs, and the normal vector of the fitted plane is obtained;
    旋转矩阵获取模块,用于根据所述两台立体相机对应的所述法向量获取所述两台立体相机所在坐标系之间的旋转矩阵;a rotation matrix acquisition module, configured to acquire rotation matrices between the coordinate systems where the two stereo cameras are located according to the normal vectors corresponding to the two stereo cameras;
    直线拟合模块,用于获取所述第一标定点和所述第二标定点的拍摄坐标,根据所述第一标定点的拍摄坐标拟合一条直线;其中,所述第一标定点与所述第二标定点为位于不同的所述立体相机视场中的标定点,所述第二标定点位于拟合的所述直线上;A straight line fitting module, configured to obtain the shooting coordinates of the first calibration point and the second calibration point, and fit a straight line according to the shooting coordinates of the first calibration point; wherein, the first calibration point and the The second calibration point is a calibration point located in a different field of view of the stereo camera, and the second calibration point is located on the fitted straight line;
    计算坐标获取模块,用于根据所述第一标定点的拍摄坐标以及所有所述标定点的分布位置获取所述第二标定点的计算坐标;a calculation coordinate obtaining module, configured to obtain the calculation coordinates of the second calibration point according to the shooting coordinates of the first calibration point and the distribution positions of all the calibration points;
    平移矩阵获取模块,用于根据同一所述第二标定点的计算坐标、拍摄坐标以及所述两台立体相机所在坐标系之间的旋转矩阵,获取所述两台立体相机所在坐标系之间的平移矩阵。The translation matrix acquisition module is used to acquire the coordinate system between the coordinate systems where the two stereo cameras are located according to the calculated coordinates of the same second calibration point, the shooting coordinates and the rotation matrix between the coordinate systems where the two stereo cameras are located. Translation matrix.
  14. 一种电子设备,包括:An electronic device comprising:
    存储器;和memory; and
    处理器,所述处理器通过调用所述存储器存储的程序或指令,执行如权利要求1-12任一项所述的多立体相机的标定方法的步骤。A processor, wherein the processor executes the steps of the calibration method for a multi-stereo camera according to any one of claims 1-12 by invoking a program or an instruction stored in the memory.
  15. 一种存储介质,其中,所述存储介质存储程序或指令,所述程序或指令使计算机执行如权利要求1-12任一项所述的多立体相机的标定方法的步骤。A storage medium, wherein the storage medium stores a program or an instruction, and the program or the instruction causes a computer to execute the steps of the calibration method for a multi-stereo camera according to any one of claims 1-12.
PCT/CN2021/121462 2021-01-29 2021-09-28 Calibration method and apparatus for multiple stereo cameras WO2022160760A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202110125395.8 2021-01-29
CN202110125395.8A CN112802124B (en) 2021-01-29 2021-01-29 Calibration method and device for multiple stereo cameras, electronic equipment and storage medium

Publications (1)

Publication Number Publication Date
WO2022160760A1 true WO2022160760A1 (en) 2022-08-04

Family

ID=75812780

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2021/121462 WO2022160760A1 (en) 2021-01-29 2021-09-28 Calibration method and apparatus for multiple stereo cameras

Country Status (2)

Country Link
CN (1) CN112802124B (en)
WO (1) WO2022160760A1 (en)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115824038A (en) * 2022-08-17 2023-03-21 宁德时代新能源科技股份有限公司 Calibration scale, calibration method and device, and detection method and device
CN116038721A (en) * 2023-04-03 2023-05-02 广东工业大学 Hand-eye calibration method and system without kinematic participation
CN116878402A (en) * 2023-07-11 2023-10-13 北京博科测试系统股份有限公司 Non-contact wheel arch measuring sensor and method
US11992959B1 (en) 2023-04-03 2024-05-28 Guangdong University Of Technology Kinematics-free hand-eye calibration method and system

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112802124B (en) * 2021-01-29 2023-10-31 北京罗克维尔斯科技有限公司 Calibration method and device for multiple stereo cameras, electronic equipment and storage medium
CN113436277A (en) * 2021-07-15 2021-09-24 无锡先导智能装备股份有限公司 3D camera calibration method, device and system
CN113610930B (en) * 2021-08-13 2023-10-20 深圳臻像科技有限公司 Large-scene camera array transfer calibration method, system and storage medium
CN116592767B (en) * 2023-07-17 2024-02-27 上海威瞳视觉技术有限公司 Method and system for detecting positioning error of linear movement mechanism

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2019174146A1 (en) * 2018-03-13 2019-09-19 Boe Technology Group Co., Ltd. Image stitching method, image stitching apparatus, display apparatus, and computer product
CN112132906A (en) * 2020-09-22 2020-12-25 西安电子科技大学 External reference calibration method and system between depth camera and visible light camera
CN112802124A (en) * 2021-01-29 2021-05-14 北京罗克维尔斯科技有限公司 Calibration method and device for multiple stereo cameras, electronic equipment and storage medium

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20130063560A1 (en) * 2011-09-12 2013-03-14 Palo Alto Research Center Incorporated Combined stereo camera and stereo display interaction
CN109341668B (en) * 2018-10-11 2020-12-22 重庆邮电大学 Multi-camera measuring method based on refraction projection model and light beam tracking method
CN112180362B (en) * 2019-07-05 2024-04-23 北京地平线机器人技术研发有限公司 Method and device for determining conversion pose between radar and camera and electronic equipment
CN111965624B (en) * 2020-08-06 2024-04-09 阿波罗智联(北京)科技有限公司 Laser radar and camera calibration method, device, equipment and readable storage medium

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2019174146A1 (en) * 2018-03-13 2019-09-19 Boe Technology Group Co., Ltd. Image stitching method, image stitching apparatus, display apparatus, and computer product
CN112132906A (en) * 2020-09-22 2020-12-25 西安电子科技大学 External reference calibration method and system between depth camera and visible light camera
CN112802124A (en) * 2021-01-29 2021-05-14 北京罗克维尔斯科技有限公司 Calibration method and device for multiple stereo cameras, electronic equipment and storage medium

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115824038A (en) * 2022-08-17 2023-03-21 宁德时代新能源科技股份有限公司 Calibration scale, calibration method and device, and detection method and device
CN115824038B (en) * 2022-08-17 2023-09-29 宁德时代新能源科技股份有限公司 Calibration ruler, calibration method and device, and detection method and device
CN116038721A (en) * 2023-04-03 2023-05-02 广东工业大学 Hand-eye calibration method and system without kinematic participation
CN116038721B (en) * 2023-04-03 2023-07-18 广东工业大学 Hand-eye calibration method and system without kinematic participation
US11992959B1 (en) 2023-04-03 2024-05-28 Guangdong University Of Technology Kinematics-free hand-eye calibration method and system
CN116878402A (en) * 2023-07-11 2023-10-13 北京博科测试系统股份有限公司 Non-contact wheel arch measuring sensor and method

Also Published As

Publication number Publication date
CN112802124B (en) 2023-10-31
CN112802124A (en) 2021-05-14

Similar Documents

Publication Publication Date Title
WO2022160760A1 (en) Calibration method and apparatus for multiple stereo cameras
WO2022160761A1 (en) Method and apparatus for calibrating dual stereo cameras
CN107633536B (en) Camera calibration method and system based on two-dimensional plane template
CN105716542B (en) A kind of three-dimensional data joining method based on flexible characteristic point
CN110969668A (en) Stereoscopic calibration algorithm of long-focus binocular camera
CN109272574B (en) Construction method and calibration method of linear array rotary scanning camera imaging model based on projection transformation
CN107886547B (en) Fisheye camera calibration method and system
CN109727278B (en) Automatic registration method for airborne LiDAR point cloud data and aerial image
WO2022095596A1 (en) Image alignment method, image alignment apparatus and terminal device
CN102622747B (en) Camera parameter optimization method for vision measurement
CN111707187B (en) Measuring method and system for large part
CN110223355B (en) Feature mark point matching method based on dual epipolar constraint
WO2021004416A1 (en) Method and apparatus for establishing beacon map on basis of visual beacons
CN111612731B (en) Measuring method, device, system and medium based on binocular microscopic vision
CN109544642B (en) N-type target-based TDI-CCD camera parameter calibration method
CN112508885B (en) Method and system for detecting three-dimensional central axis of bent pipe
Zhang et al. Camera self-calibration based on multiple view images
CN114511640A (en) Method, device and storage medium for calibrating camera by using map
WO2024098428A1 (en) Registration method and system
Hui et al. Determination of line scan camera parameters via the direct linear transformation
CN112819900B (en) Method for calibrating internal azimuth, relative orientation and distortion coefficient of intelligent stereography
CN114092564B (en) External parameter calibration method, system, terminal and medium for non-overlapping vision multi-camera system
CN105184327A (en) Vertex trisection strategy-based remote sensing image feature point matching method
Wang et al. Comparison of the camera calibration between photogrammetry and computer vision
CN113223163A (en) Point cloud map construction method and device, equipment and storage medium

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 21922352

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 21922352

Country of ref document: EP

Kind code of ref document: A1

122 Ep: pct application non-entry in european phase

Ref document number: 21922352

Country of ref document: EP

Kind code of ref document: A1