This application claims priority from Chinese Patent Application Serial No. 200710118498.1 filed Jul. 6, 2007, the disclosure of which, including the specification, drawings and claims, is incorporated herein by reference in its entirety.
The disclosure relates to the measurement techniques for a sun sensor, and more particularly to a kind of method and device for calibration of a digital sun sensor.
A sun sensor is a kind of attitude sensor for measuring the angle between the sun light and a certain axis or plane of a moving vehicle. Sun sensors are widely used in many areas such as, for example, solar energy utilization and attitude control of spacecraft. New digital sun sensors mainly include: an optical mask with single pinhole or pinhole array, an image sensor such as a CMOS (Complementary Metal Oxide Semiconductor) or a CCD (Charge Coupled Device), and an information processing circuit. The principle of a sun sensor is as follows: the sun light is projected onto the image sensor though the pinhole on the optical mask and a spot is formed. The position of the spot changes with the incident angle of sun light. Then, spot image processing and attitude computing are executed by an information processing circuit. Finally, the attitude of spacecraft is obtained.
Before the sun sensor is put into use, the internal parameters of it must be precisely calibrated to guarantee high measurement precision. The internal parameters include the focal length F, which equals to distance between the optical mask and the image sensor, the origin coordinate where the pin hole is projected to the image sensor (also called as main point) and the distortion coefficients, etc. The calibration of such internal parameters is referred to as sun sensor calibration. Currently, there are two kinds of calibration methods. The first utilizes the real sunlight and performs data acquisition and calibration when the sun is at or near its zenith. The second uses sun simulators to provide sun light, perform data acquisition, and calibration with the help of rotator. For the latter, only focal length F and an origin coordinate are used in the calibration model, and the calibration precision is higher than the former. Moreover, the calibration process is more convenient. However, there are some disadvantages with this method:
The sunlight vector from the sun simulator is not strictly vertical to the plane formed by the two rotation axes of the rotator coordinate frame. Moreover, there is installation error between the sun sensor and the rotator, such that the sun sensor coordinate frame can not be identical to the rotator coordinate frame. Because of those external factors, such as installation error and adjustment error, there is error in the calibration method which uses only internal parameters in imaging modeling of a sun sensor. Therefore, the precision of estimation of internal parameters is adversely influenced.
Generally, the optical mask of a sun sensor is shaped by etching a pinhole on a glass base. Because of the refraction of glass base and the limitation of the processing technique, there is nonlinear distortion in the pinhole imaging model of a sun sensor. Accordingly, errors are introduced into the calibration method which only includes internal parameters of focal length F and origin coordinate.
To address the problems mentioned above, the disclosure aims at providing a high precision calibration method and device for a digital sun sensor.
To reach the aims above, the technical scheme of the invention is as follows.
A calibration method for a digital sun sensor is disclosed, which includes the following steps.
A. First, an integrated mathematic model for imaging of a sun sensor is established according to external and internal parameters of a calibration system of a sun sensor.
B. By rotating two axes of a rotator by different angles, calibration points' data is acquired and sent to a processing computer through an interface circuit.
C. A two-step calibration program is then implemented to calculate the calibration parameters after substituting calibration points' data to the integrated mathematic model.
In one embodiment of the disclosed method, Step A further comprises:
A1. Establishing a rotator coordinate frame and a sun sensor coordinate frame, and establishing an external parameters' modeling equation according to a rotation matrix from the rotator coordinate frame to the sun sensor coordinate frame and a pitch and yaw angle of simulated sun light in the rotator coordinate frame.
A2. Establishing an internal parameters' modeling equation, wherein the internal parameters include: the origin coordinate where a pin hole on an optical mask of a sun sensor is projected to an image sensor, a focal length which equals to a distance between the optical mask and the image sensor, and a radial and tangential distortion coefficient of the optical mask.
A3. Establishing an integrated external and internal parameters imaging modeling equation of the sun sensor according to the external parameters modeling equation and the internal parameters modeling equation of calibration system.
In one embodiment, Step C of the disclosed method further includes:
C1. Assuming that the radial and tangential distortion coefficients of internal parameters are zeros, the origin coordinate where the pin hole is projected to image sensor is determined by a nonlinear least square iteration.
C2. Based on the results from step C1, the rest of the parameters are calculated by a nonlinear least square iteration.
An embodiment of a calibration device for digital sun sensor comprises: a sun simulator to provide incident sun light, a two-axis rotator with internal and external frames, a bracket on which the sun sensor is installed, an optical platform to uphold the sun simulator and two-axis rotator, and a processing computer connected to the sun sensor to perform calibration data acquisition and processing. The sun simulator and two-axis rotator are installed on the each side of the optical platform respectively.
The processing computer, which comprises a data acquisition module and a data processing module, calculates calibration parameters by a data processing program.
The data acquisition module acquires the calibration points' data, which includes the rotating angle of internal frame of the two-axis rotator, the rotating angle of external frame of the two-axis rotator and the centroid coordinate of imaging spot at this position.
The data processing module calculates the final calibration parameters based on the calibration points' data acquired above.
The embodiments disclosed have following advantages:
An integrated external and internal parameters modeling is adopted in the disclosure, which avoids the introduction of the error of external parameters into the estimation process of internal parameters. Therefore, the calibration precision of the internal parameters is improved.
The calibration precision is improved by considering the distortion coefficients as a part of the internal parameters.
No complicated installation and adjustment is needed, so that the calibration process is simplified noticeably.
The accompanying drawings, which are incorporated in and constitute a part of specification, illustrate an exemplary embodiment of the present disclosure and, together with the general description given above and the detailed description of the embodiment given below, serve to explain the principles of the present disclosure.
While the claims are not limited to the illustrated embodiments, an appreciation of various aspects of the present disclosure is best gained through a discussion of various examples thereof. Referring now to the drawings, illustrative embodiments will be described in detail. Although the drawings represent the embodiments, the drawings are not necessarily to scale and certain features may be exaggerated to better illustrate and explain an innovative aspect of an embodiment. Further, the embodiments described herein are not intended to be exhaustive or otherwise limiting or restricting to the precise form and configuration shown in the drawings and disclosed in the following detailed description.
The basic principle of the disclosure is establishing an integrated external and internal parameters imaging modeling of sun sensor, which takes into account the errors such as the installation error of sun simulator, the installation error of sun sensor on the two-axis rotator, the installation error of optical mask and the distortion of optical mask, etc; a two-step calibration method is implemented to solve the parameters and high precision of calibration is achieved.
The disclosure uses an integrated external and internal parameters modeling method to establish the mathematic imaging model of a sun sensor. The detailed steps are as follows.
Step 1: The integrated imaging model of sun sensor is established according to the external and internal parameters of the calibration system of a sun sensor,
Step 101: Coordinate frames are established.
Before the description of the external parameters modeling, the coordinate frames involved in the disclosure are explained as follows.
The sun sensor coordinate frame (marked as Sun) is defined. That is, its X-axis and Y-axis are the row and column of the image sensor respectively, and the Z-axis is vertical to the X-Y plane.
The rotator coordinate frame (Marked as Rot) is defined such that its X′-axis and Y′-axis are the horizontal rotation axis and vertical rotation axis of the rotator on which the sun sensor is installed, and the Z′ axis of Rot is vertical to the X′-Y′ plane.
The sun sensor coordinate frame and rotator coordinate frame defined in the disclosure are both right-hand coordinate (either left-hand coordinate).
Step 102: External parameters modeling
The external parameters that have effect on the calibration precision of the internal parameters of the sun sensor include:
(1) Sunlight vector e from a sun simulator is not strictly vertical to the plane formed by the two rotation axis of the rotator coordinate frame, assuming that the expression of vector e in the rotator coordinate frame is:
Here, e1, e2, e3 are three direction components of vector e in the coordinate frame Rot, and α, β are pitch and yaw angles in the coordinate frame Rot respectively.
(2) There is installation error between the sun sensor and the rotator which results in the difference of sun sensor coordinate frame Sun and rotator coordinate frame Rot. Assuming that the rotation matrix Rsr denotes the rotation from rotator coordinate frame Rot to sun sensor coordinate frame, Sun is expressed as follows:
Rsr=Rot(Z′, φ1)*Rot(Y′, β1)*Rot(X′, α1) (2)
Here, Rot(X′,α1), Rot(Y′,β1) and Rot(Z′,φ1) are rotation matrixes which denote rotation an angle of α1 about axis X′, rotation an angle of β1 about axis Y′ and rotation an angle of φ1 about axis Z′ respectively- The rotator coordinate frame is transformed to the sun sensor frame coordinate by these rotations. The expressions of these rotations are:
From above formulas, it can be seen that there are five external parameters, in total, in the calibration system of sun sensor; namely α, β, α1, β1, φ1.
Step 103: Internal parameters modeling
There are errors in the installation of an optical mask of a sun sensor:
(3) The distance between the optical mask and the imaging plane of image sensor is not the ideal value F but the real value of F′.
(4) The point where the pin hole on the optical mask of sun sensor is projected to an image sensor is not the origin of the sun sensor coordinate, and assuming the coordinate of the real projected origin is (x0, y0)
Moreover, there is distortion in the pinhole imaging because of the glass base of the optical mask of the sun sensor. Assuming that dx and dy represent the distortion in the x and y direction respectively, the radial distortion coefficients and tangential distortion coefficients are expressed as:
Here, xc and yc are the centroid coordinates of a measured spot; x0 and y0 are the coordinates of the origin corresponding to the pinhole; q1, q2, q3 are radial distortion coefficients; p1, p2, p3 are tangential distortion coefficients. So, there are a total of nine internal parameters, namely x0, y0, F′, q1, q2, q3, p1, p2, p3.
Step 104: Establishing the integrated external and internal parameters imaging model of a sun sensor
The rotator is rotated to acquire different calibration points' data. Assuming that the real rotation angle about the Y′ axis of rotator is θ1 and the rotation angle about the X′ axis of rotator is θ2, the corresponding rotation matrix Rrot can be expressed as:
According to the external and internal parameters of the calibration system and the real rotation angles of the rotator in the calibration process, the integrated imaging model of sun sensor can be established as following:
In the above formula, V is the expression of sunlight vector e in the current sun sensor coordinate frame when the internal and external frames of the rotator are rotated by θ1 and θ2 respectively.
The integrated external and internal parameters imaging model of a sun sensor is obtained by substituting equations (1)-(7) into equation (8). The calibration of sun sensor in the disclosure is to determine the internal parameters (x0, y0, F′, q1, q2, q3, p1, p2, p3) and external parameters (α, β, α1, β1, φ1) in the modeling equation according to the calibration points' data.
Step 2: Acquisition of calibration points' data
The two axes of the rotator are rotated by different angles to make sure the imaging spots spread over the whole plane of image sensor with the sunlight within the field of view of ±55° (as shown in
Step 3: Data processing
It can be seen from the model equation that there are a total of 14 calibration parameters in the calibration system. The precision of these parameters are relatively low and the iteration can't easily converge if all 14 parameters are determined by a one-time least square method. Therefore, a two-step method is adopted to calculate the 14 parameters.
Step 301: Determination of the internal parameters x0 and y0
Firstly, assume that the distortion coefficients q1, q2, q3, p1, p2, p3 are all equal to zero, so the model equation (8) can be simplified as:
Here, n is a parameter vector which consists of the model parameters [x0, y0, F′, α, β, α1, β1, φ1]. Since fx and fy are both nonlinear functions, a nonlinear least square iteration method is adopted to estimate the parameter vector n. Assuming that xc and yc are the measured values while {circumflex over (x)}c and ŷc are the estimated values, and Δn is the estimated deviation of the parameter vector, and Δx and Δy are estimated deviation of xc and yc respectively, it gets
Here, A and B are sensitive matrixes, and their expressions are:
Assuming that the number of calibration points' data is m, combining the estimated deviation Δx and Δy and the sensitive matrixes, the iteration equation of parameter vector is established as following:
Δn(k+1)=Δn(k)−(MkTMk)−1MkTP(k) (12)
In the above equation, P consists of estimated deviation Δx and Δy, and M consists of two sensitive matrixes A and B. Their expressions are:
Here, k is iteration times and can be set between 5 and 10. Among the calculated model parameters when iteration ends, only (x0, y0) is chosen as the final calibration result to be used in next step to determinate the other parameters.
Step 302: Determination of internal parameters F′, q1, q2, q3, p1, p2, p3 and external parameters
Substituting (x0, y0) calculated from the previous step into the model equation (8), and using vector j to denote the model parameters [F′, q1, q2, q3, p1, p2, p3, α, β, α1, β1, φ1], it gets:
Correspondingly the sensitive matrixes C and D change to:
A same nonlinear least square iteration method is adopted to estimate the parameter vector j, and a similar iteration equation of parameter vector is established:
Δj(k+1)=Δj(k)−(NkTNkT)−1NkTP(k) (13)
In the above equation, N consists of sensitive matrixes C and D, and their expressions are:
Here, k is iteration times and can be set between 5 and 10. When the iteration ends, the model parameters F′, q1, q2, q3, p1, p2, p3, α, β, α1, β1 and φ1 are determined and chosen as the final calibration result.
Combining (x0, y0) determined in the first step and F′, q1, q2, q3, p1, p2, p3, α, β, α1, β1, φ1 determined in the second step, all the calibration parameters in the calibration system are determined
Finally all calibrated internal parameters x0, y0, F′, q1, q2, q3, p1, p2 and p3 are substituted into corresponding attitude conversion formulas of the sun sensor, and the precise attitude angle of the sunlight in sun sensor coordinate frame will be calculated. Thereby, the attitude information of the satellites or spacecraft on which the sun sensor is installed is determined.
As shown in
The processing computer 5 includes a data acquisition module and data processing module. The data acquisition module acquires the calibration points' data which includes the rotating angle θ1 of external frame, the rotating angle θ2 of the internal frame and the centroid coordinate (xc, yc) of the imaging spot at this position. A two-step method and nonlinear least square method are used by the data processing module to determine the final calibration parameters. During the calibration process using the calibration device, the sun sensor 6 is installed on the bracket 3. Different calibration points' data is acquired by rotating the external and internal frame of rotator by different angles. The processing computer 5 records these calibration points' data and calculates the corresponding calibration parameters.
The rotator used in the invention has the precision of ±0.4″ for the external frame and ±0.3″ for the internal frame. The radiation intensity of the sun simulator is 0.1solar constant. The diameter of effective radiation area is 200 mm, and the collimation angle of light beam is 32′.
Totally 84 groups of recorded calibration point's data are listed in Table 1.
The calibration result is obtained by processing the calibration points' data listed in Table 1 using the calibration method described above. The calibration result is listed in Table 2.
The total statistical square root error of xc and yc are 5.09 pixel and 4.27 pixel respectively. Substituting the parameters calibrated by the method of the present disclosure into the attitude computing formula of sun sensor, an attitude precision of 0.02 (1σ) is obtained. Because 14 total external and internal parameters are used in the disclosure, theoretically at least 14 groups of calibration data are needed to solve the calibration parameters. Generally, in order to obtain more precise parameters, 50-100 groups of calibration data are acquired. Meanwhile, the calibration points are spread over the field of view of sun sensor as widely as possible. Of course, the more the calibration points are used, the more precise the calibration result are, but at the cost of computing.
The foregoing description of various embodiments of the disclosure has been present for purpose of illustration and description. It is not intent to be exhaustive or to limit the disclosure to the precise embodiments disclosed. Numerous modifications or variations are possible in light of the above teachings. The embodiments discussed where chosen and described to provide the best illustration of the principles of the disclosure and its practical application to thereby enable one of ordinary skill in the art to utilize the disclosure in various embodiments and with various modifications as are suited to the particular use contemplated. All such modifications and variations are within the scope of the disclosure as determined by the appended claims when interpreted in accordance with the breadth to which they are fairly, legally, and equitably entitled.
Number | Date | Country | Kind |
---|---|---|---|
200710118498.1 | Jul 2007 | CN | national |