CN102096918A - Calibration method of parameters of camera for rendezvous and docking - Google Patents

Abstract

The invention discloses a calibration method of parameters of camera for rendezvous and docking, which is a method for calibrating and accurately establishing a camera coordinate system of an effective focus of a camera and an image center by adopting an optical external standard method. The invention solves the technical problems that position measurement accuracy and posture measurement accuracy are difficult to simultaneously realize and the position measurement accuracy along a viewing direction is low through establishing a coordinate axis in a camera viewing direction by utilizing an optical lens optical axis direction reference, adopting the thought that the focus in a camera measurement mathematic model changes along with the change of distance to establish an effective focus curve.

Description

A kind of intersection butt joint scaling method of camera intrinsic parameter

Technical field

The present invention relates to a kind of scaling method of camera intrinsic parameter.

Background technology

CCD optical imagery sensor is the crucial measurement component of intersection docking mission, is made up of CCD camera and blip device.The CCD camera is installed on the tracker, and the blip device is by being installed on the target aircraft.Its function be when tracker docks with the target aircraft intersection in the certain distance scope, to imaging of blip device and measurement, obtain relative position and the relative attitude angle of optical sensor coordinate system by the CCD camera with respect to blip device coordinate system.

One of CCD optical imagery sensor development difficult point is to require to have in the certain distance scope higher position and attitude measurement accuracy.Existing method is mainly used the information of having utilized fixed form information and imaging point, can calculate the inner parameter of camera.In the monocular vision real-time measurement system, need correct the Real-Time Distortion of imaging point, obtain the coordinate of ideal image point, and calculate the pose parameter between target and camera thus.Zhang Zheng-you for example, A flexible new technique for camera calibration, Technical Report MSR-TR-98-71,1998 disclosed scaling methods, masterplate can not guarantee along the high-precision realization of direction of visual lines position measurement owing to adopt fixedly in the calibration process, and the fixing measurement meeting of masterplate produced a very large impact calibration result, thereby influence the normal measurement of CCD optical imagery sensor.

Summary of the invention

Technology of the present invention is dealt with problems and is: overcome prior art and be difficult to realize simultaneously position and attitude measurement accuracy, and along the lower technical barrier of direction of visual lines positional accuracy measurement, proposed the scaling method of a kind of intersection butt joint with the camera intrinsic parameter.

Technical solution of the present invention is: a kind of intersection butt joint scaling method of camera intrinsic parameter, and step is as follows:

(1) sets up CCD camera coordinates system, initial point is the normal intersection point spatially of crossing cross groove center of orthogonal three faces of reference mirror placed on the CCD camera, the normal direction of the minute surface of normal and reference mirror front end face normal parallel is the Z axle in described three faces, the normal direction of pointing to the benchmark minute surface of the earth direction is a Y-axis, and X-axis and Y-axis and Z axle meet the right-hand rule;

(2) point of choosing even covering camera measuring distance and viewing field of camera utilizes the CCD camera that known measuring point is measured as known measuring point, to the centre coordinate x that practises physiognomy of camera _p, y _pAnd focal distance f _pDemarcate, step is:

(21) choose the initial value of camera centre coordinate and focal length

(22) calculate F _k=(f ₁, f ₂..., f _n) (f ₁, f ₂..., f _n) ^T, wherein

I=1,2....., n, n are known measuring point number,＜the expression inner product operation,

Be i the coordinate of known measuring point under earth coordinates, χ _jThe coordinate that the individual known measuring point of measuring under diverse location for camera of i in the CCD camera coordinates is,

With

For with χ _jThe i that corresponding position is measured a down known measuring point at camera as the coordinate on the plane,

With

Be respectively first row, second row and the third line of matrix R, R is the transition matrix between earth coordinates and the CCD camera coordinates system;

(23) if the F that tries to achieve _kSatisfy accuracy requirement, then try to achieve Respectively as the practise physiognomy centre coordinate and the focal length of camera under i the known measuring point, otherwise adjust Until F _kSatisfy accuracy requirement;

(24) geometric mean is carried out with the centre coordinate of practising physiognomy of camera under each the known measuring point that obtains in continuous repeating step (21)～(23), obtains the centre coordinate x that practises physiognomy of camera _p, y _p, the focal length of camera couples together the focal length curve that forms camera under the known measuring point of each that will obtain simultaneously;

(3) the camera focus curve that step (2) is determined and the centre coordinate of practising physiognomy carry the initial value that posture position is found the solution software as camera, all known measuring points are calculated posture positions and compare with the measurement result of step (2), obtain the measuring error of CCD camera thus.

The present invention's advantage compared with prior art is: scaling method of the present invention utilizes the higher optics external standard measurement result of measuring accuracy, the camera inner parameter is demarcated, calibrating parameters is a transition matrix between effective focal length, picture centre and camera coordinates system and reference mirror coordinate system, these calibrating parameters write CCD optical imagery sensor software, promptly can guarantee position and attitude measurement accuracy in the full measurement range.This method mentality of designing novelty, the calibrating parameters process is simple, operand is little, it is little to take hardware resource, and greatly improved positional accuracy measurement along direction of visual lines, overcome scaling method design complexity commonly used, operand is big, the committed memory resource is big and, has adapted to very much the space camera use of working environment complexity along the low deficiency of the positional accuracy measurement of direction of visual lines.

Description of drawings

Fig. 1 is the FB(flow block) of the inventive method.

Embodiment

As shown in Figure 1, be the theory diagram of the inventive method, key step is as follows:

(1) the CCD camera coordinates is that initial point is set up;

Utilize cross groove on the prism square face vertical that the position measurement benchmark of CCD camera is provided with the camera optical axis, can accurately locate the initial point of CCD camera measurement coordinate system according to this benchmark, vertical mutually three the normal intersection points spatially of crossing cross groove center of reference mirror are the initial point that camera coordinates is.

(2) the CCD camera coordinates means to foundation

Utilize the cross groove on the prism square face vertical to provide three of the CCD camera to point to measuring basis with the camera optical axis, prism square is installed on the camera body, it is the directional reference of camera, be called reference mirror, first minute surface normal of camera lens and reference mirror front end face normal parallel are the Z axles of camera coordinates system, the benchmark minute surface normal that points to the earth direction is a Y-axis, and three meet right-handed coordinate system.

(3) CCD camera image center and effective focal length scaling method;

After aforementioned two steps are finished, carrying out picture centre and effective focal length again demarcates, utilize CCD camera coordinates system, measure the result of routine position under CCD camera coordinates system and survey outer measured value under the routine position as camera demarcating regulation, surveying the rule that example chooses is evenly to cover camera measuring distance and viewing field of camera.

Demarcate the outer measured value of surveying under the example for camera at i, the parameter that camera need be demarcated (CCD image planes centre coordinate and focal length) is made as

Exist as can be known according to the camera imaging formula

$f\left({\mathrm{\&Omega;}}_i\right)=\left[\begin{array}{c}(x_i^{\&prime;}-x_p^i)<{\mathrm{\&chi;}}_j-{\mathrm{\&chi;}}_i,{\hat{r}}_{3,i}>+f^i<{\mathrm{\&chi;}}_j-{\mathrm{\&chi;}}_i,{\hat{r}}_{1,i}>=0\\ (y_i^{\&prime;}-y_p^i)<{\mathrm{\&chi;}}_j-{\mathrm{\&chi;}}_i,{\hat{r}}_{3,i}>+f^i<{\mathrm{\&chi;}}_j-{\mathrm{\&chi;}}_i,{\hat{r}}_{2,i}>=0\end{array}\right]$

I=1 wherein, 2....., n, n are known measuring point number,＜the expression inner product operation,

Be i the coordinate of known measuring point under earth coordinates, χ _jThe coordinate that the individual known measuring point of measuring under diverse location for camera of i in the CCD camera coordinates is, With For with χ _jThe i that corresponding position is measured a down known measuring point at camera as the coordinate on the plane,

With Be respectively first row, second row and the third line of matrix R, R is the transition matrix between earth coordinates and the CCD camera coordinates system;

For real coefficient transcendental equation group:

$\left\{\begin{array}{c}{f}_1({\mathrm{\&alpha;}}_1,{\mathrm{\&alpha;}}_2,{\mathrm{\&alpha;}}_3)=0\\ f_2({\mathrm{\&alpha;}}_1,{\mathrm{\&alpha;}}_2,{\mathrm{\&alpha;}}_3)=0\\ \&CenterDot;\&CenterDot;\&CenterDot;\&CenterDot;\&CenterDot;\&CenterDot;\\ f_n({\mathrm{\&alpha;}}_1,{\mathrm{\&alpha;}}_2,{\mathrm{\&alpha;}}_3)=0\end{array}\right.$

α in the formula _i(i=1,2,3) represent ccd image centre coordinate and focal length respectively.

The objective definition function:

F(α ₁，α ₂，α ₃)＝(f ₁，f ₂，...，f _n)(f ₁，f ₂，...，f _n) ^T＝0

Obviously satisfy the α of minimal value condition this moment ₁, α ₂, α ₃Also be separating of equation.

(31) measured value is measured confidential reference items numerical value (focal length and image planes center) for the camera of expectation measurement result Select Error minimum in addition

As initial value;

(32) calculate

(33) if F _k＜ε, ε=10 ^-8, then

Be separating of being asked, otherwise changed for (4) step over to;

(34) to finding the solution parameter Iterative computation, substitution again (2).

L=1,2,3,

Finish above-mentioned steps and can obtain i the intrinsic parameter of demarcating under the survey example

Survey example according to the rules can be set up focal distance f _pBe the focal length curve of final camera with the curve of variable in distance, difference is surveyed the picture centre (x that example is found the solution _p, y _p) carry out the result that geometric mean can obtain final camera image center.

(4) CCD camera coordinates system and reference mirror coordinate system relation are determined

The camera focus curve determined and picture centre are reentered into the camera posture position find the solution software, calculate all regulations survey example down camera result of calculation and externally measured result relatively, calculating [θ _i, φ _i, Ψ _i] the three-axis attitude measuring error, from i=1,2 ..., n carries out geometric mean, with final statistical error system's constant error the most, is used for the final measurement correction, i.e. CCD camera final measurement=camera posture position result of calculation+system's constant error.

The content that is not described in detail in the instructions of the present invention belongs to those skilled in the art's known technology.

Claims (1)

1. the scaling method of using the camera intrinsic parameter is docked in an intersection, it is characterized in that step is as follows:

(1) sets up CCD camera coordinates system, initial point is the normal intersection point spatially of crossing cross groove center of orthogonal three faces of reference mirror placed on the CCD camera, the normal direction of the minute surface of normal and reference mirror front end face normal parallel is the Z axle in described three faces, the normal direction of pointing to the benchmark minute surface of the earth direction is a Y-axis, and X-axis and Y-axis and Z axle meet the right-hand rule;

(2) point of choosing even covering camera measuring distance and viewing field of camera utilizes the CCD camera that known measuring point is measured as known measuring point, to the centre coordinate x that practises physiognomy of camera _p, y _pAnd focal distance f _pDemarcate, step is:

(21) choose the initial value of camera centre coordinate and focal length

(22) calculate F _k=(f ₁, f ₂..., f _n) (f ₁, f ₂..., f _n) ^T, wherein

I=1,2....., n, n are known measuring point number,＜the expression inner product operation,

Be i the coordinate of known measuring point under earth coordinates, χ _jThe coordinate that the individual known measuring point of measuring under diverse location for camera of i in the CCD camera coordinates is,

With

For with χ _jThe i that corresponding position is measured a down known measuring point at camera as the coordinate on the plane,

With

Be respectively first row, second row and the third line of matrix R, R is the transition matrix between earth coordinates and the CCD camera coordinates system;

(23) if the F that tries to achieve _kSatisfy accuracy requirement, then try to achieve

Respectively as the practise physiognomy centre coordinate and the focal length of camera under i the known measuring point, otherwise adjust

Until F _kSatisfy accuracy requirement;

(24) geometric mean is carried out with the centre coordinate of practising physiognomy of camera under each the known measuring point that obtains in continuous repeating step (21)～(23), obtains the centre coordinate x that practises physiognomy of camera _p, y _p, the focal length of camera couples together the focal length curve that forms camera under the known measuring point of each that will obtain simultaneously;

(3) the camera focus curve that step (2) is determined and the centre coordinate of practising physiognomy carry the initial value that posture position is found the solution software as camera, all known measuring points are calculated posture positions and compare with the measurement result of step (2), obtain the measuring error of CCD camera thus.

Images