Double iteration optimization positioning method based on starlight vector and starlight refracting surface
Through the dual iterative optimization method of star vector and star refractive plane, the problem that the navigation accuracy of star sensors in the atmosphere is affected by atmospheric refractive error is solved, and high-precision autonomous positioning is achieved, which is suitable for carriers in dynamic environments.
Patent Information
- Application Number
- CN202410964058.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-18
- Publication Date
- 2024-11-08
AI Technical Summary
The positioning accuracy of the current star sensor/inclination meter combined navigation system in the atmosphere is affected by random and irregular refractive errors in the atmosphere, making it difficult to accurately calibrate, resulting in limited navigation accuracy.
The dual iterative optimization positioning method based on starlight vector and starlight refractive plane is adopted. Through least squares optimization solution, the primary observation latitude and longitude information is obtained first, and then the atmospheric refractive plane coordinate system conversion model is used to correct the atmospheric refractive plane to achieve high-precision positioning.
It effectively overcomes the impact of atmospheric refractive errors and improves the autonomous positioning accuracy of the star sensor. It is suitable for military or civilian carriers in dynamic environments, and the positioning accuracy is significantly improved.
Smart Images

Figure CN118913255A_ABST
Abstract
Description
Technical Field
[0001] The invention relates to a dual iterative optimization positioning method based on starlight vector and starlight refraction surface, which solves the problem that the positioning accuracy of the current star sensor / inclinometer combined navigation system in the atmosphere is affected and inhibited by the atmosphere. Background Art
[0002] As one of the most important application purposes of star sensors in the Earth's atmosphere, the autonomous navigation and positioning technology of star sensors has been a key technology that countries around the world have been continuously researching, exploring and seeking breakthroughs in. This technology can solve the problem of obtaining high-precision carrier position information under the conditions of satellite navigation denial or interference.
[0003] At present, the realization of autonomous positioning of star sensors is usually achieved by combining horizontal instruments, such as horizon, magnetometer, gravity pendulum, inertial navigation system or inclinometer. These devices provide horizontal reference measurement information between the star sensor and the ground, and then estimate the position information based on its heading attitude measurement results. However, this technical theory has always had a technical bottleneck problem: starlight is imaged in the star sensor after passing through the atmosphere. There is a deviation between the observed star vector and the actual star vector before entering the atmosphere, which is the atmospheric refraction error. Since the atmospheric refraction error is random and irregular, it is difficult to accurately calibrate it during the positioning process. The introduction of the above external error terms affects the accuracy of autonomous positioning and navigation of star sensors.
[0004] In summary, the current positioning accuracy of the star sensor / inclinometer combined navigation system in the atmosphere is affected and inhibited by the atmosphere, and it is urgent to break through the limitations of random and irregular atmospheric errors on the positioning accuracy of the combined navigation system. Summary of the invention
[0005] The technology of the present invention solves the problem: overcomes the shortcomings of the prior art and provides a dual iterative optimization positioning method based on starlight vector and starlight refraction surface, which can realize high-precision autonomous positioning of star sensors by optimizing and solving the navigation positioning information of starlight vector and starlight refraction surface twice respectively.
[0006] The technical solution of the present invention is a dual iterative optimization positioning method based on starlight vector and starlight refraction surface, comprising the following steps:
[0007] The first step is to use the star sensor and inclinometer to calculate the starlight observation vector, horizontal conversion matrix and zenith direction;
[0008] The second step is to establish an astronomical coordinate system conversion model based on the starlight observation vector, horizontal conversion matrix, observation time and reference star catalog, and use the least squares optimization solution to obtain the primary observation longitude and latitude information;
[0009] The third step is to establish a starlight refraction surface coordinate system conversion model based on the starlight observation vector, zenith direction, observation time and reference star catalog;
[0010] The fourth step is to use the primary observation longitude and latitude information as the initial optimization value to establish a least squares starlight refraction surface coordinate system conversion positioning solution model to obtain higher-precision observation longitude and latitude information.
[0011] Among them, in the first step, the star sensor and the inclinometer are used to calculate and obtain the starlight observation vector, the horizontal conversion matrix and the zenith direction:
[0012] (a1) The star sensor images the stars in the sky to obtain a star map. The observed star vectors in the star sensor coordinate system (S-system) are obtained by extracting the centroids of the stars in the star map;
[0013] (a2) Based on the star map recognition method, the correspondence between the observed star vector in the star sensor coordinate system and the reference star vector in the reference star catalog (J2000 inertial, I-system) coordinate system is obtained by angular distance matching;
[0014] (a3) The inclination angle between the carrier mounting surface (Q-system) and the horizontal coordinate system (H-system) is measured by the inclinometer, that is, the pitch angle and the roll angle. Based on this, the transformation matrix between the carrier coordinate system and the horizontal coordinate system is calculated
[0015] (a4) Transformation matrix between the carrier coordinate system and the horizontal coordinate system The vector of the zenith direction
[001] in the S system is calculated by body coordinates
[0016] Among them, in the second step, an astronomical coordinate system conversion model is established based on the starlight observation vector, horizontal conversion matrix, observation time and reference star catalog, and the primary observation longitude and latitude information is obtained by least squares optimization. The implementation steps are as follows:
[0017] (b1) For the starlight vector, the relationship between the conversion from the observed star vector of the S-system to the reference star vector of the I-system is expressed as follows: Where W S is the observed star vector, The installation matrix of S-series and Q-series, is the heading information matrix, is the position information matrix, is the transformation matrix between the Earth-fixed coordinate system E-system and I-system, V I is the reference star vector;
[0018] (b2) Based on the observed star vector and the reference star vector, when there are two stars, the longitude and latitude of the observed position can be calculated, that is, φ is latitude, λ is longitude;
[0019] (b3) Taking into account the imaging system error, installation matrix error, etc., the primary observation longitude and latitude information model is established using least squares optimization, that is,
[0020] Among them, in the third step, based on the starlight observation vector, zenith direction, observation time and reference star catalog, a starlight refraction surface coordinate system conversion model is established, and the implementation steps are as follows:
[0021] (c1) In the H-coordinate system, the observed star vector and the zenith direction form the starlight refraction surface
[0022] (c2) In the N-coordinate system, the reference star vector and the zenith direction form the starlight refraction surface Y N =R 2 (90°-φ)R 3 (λ)V E ×[0 0 1];
[0023] (c3) Establishing the starlight refraction surface coordinate system conversion model Y H =R 3 (θ)Y N .
[0024] Among them, in the fourth step, the primary observation longitude and latitude information is used as the optimization initial value, and the least squares starlight refraction surface coordinate system conversion positioning solution model is established to obtain higher-precision observation longitude and latitude information. The implementation steps are as follows:
[0025] (d1) Based on the starlight refraction surface coordinate system conversion model in the third step, establish the least squares optimization solution model L = argmin||Y H -R 3 (θ)Y N ||;
[0026] (d2) The primary longitude and latitude information (φ) obtained by solving the model for the observed star vector positioning in the second step 0 λ 0 ), substitute L = argmin||Y H -R 3 (θ)Y N ||Perform optimization solution to complete the secondary correction of atmospheric refraction error component and obtain the final high-precision observation position longitude and latitude information
[0027] The advantages of the present invention compared with the prior art are:
[0028] (1) The main disadvantage of the existing technology is that it ignores the influence of atmospheric refraction error or uses empirical formulas to correct the atmospheric refraction error. However, the atmospheric refraction error has been changing randomly and irregularly with the observation location, observation weather, observation time and observation posture, making it difficult to accurately estimate it;
[0029] (2) The autonomous positioning of the present invention is not or is rarely affected by atmospheric refraction errors;
[0030] (3) The invention is applicable to military or civilian vehicles that require high autonomous positioning accuracy in dynamic environments.
[0031] (4) All the above advantages of the present invention are due to the fact that the present invention proposes to realize high-precision autonomous positioning of the star sensor by optimizing and solving the starlight vector and starlight refraction surface navigation positioning information twice. The first step is to optimize and solve to obtain rough observation positioning information; the second step is to correct the atmospheric refraction error based on the rough observation positioning information through the refraction surface method to obtain the extreme point with the highest positioning accuracy and not affected by the atmospheric refraction error. BRIEF DESCRIPTION OF THE DRAWINGS
[0032] Figure 1 The present invention is a design flow chart of a dual iterative optimization positioning method based on starlight vector and starlight refraction surface.
[0033] Figure 2 This is the location information longitude comparison result diagram. DETAILED DESCRIPTION
[0034] The present invention is described in detail below with reference to the accompanying drawings and embodiments.
[0035] like Figure 1 As shown in FIG. 1 , a dual iterative optimization positioning method based on starlight vector and starlight refraction surface is shown. This method realizes high-precision autonomous positioning of the star sensor by optimizing and solving the navigation positioning information of starlight vector and starlight refraction surface twice.
[0036] First, assume that the position coordinates of the observed star on the star sensor imaging surface are A i (x Ai ,y Ai ). According to the optical parameters of the star sensor, namely the pixel size, focal length and principal point, the observed star vector of the observed star in the star sensor coordinate system is obtained.
[0037]
[0038] In the formula, (x 0 ,y 0 ) is the principal point of the star sensor, f is the focal length of the star sensor, O Sis the origin of the star sensor coordinate system.
[0039] Based on the star map recognition method, the matching relationship between the observed stars in the star sensor and the reference stars in the reference star catalog is obtained. i Compared with the reference star V in the reference star catalog i Then, based on the Standards of Fundamental Astronomy (SOFA) of the International Astronomical Union (IAU), the reference star vector V i The reference vector converted from the reference catalog coordinate system to the Earth-fixed coordinate system (E-system) before entering the atmosphere is:
[0040] Where t is the geomechanical time at the observation time, t 0 is the reference epoch time t of the Hipparcos astronomical catalog 0 =J2000.0,u B (t 0 ) is the reference star V i The position vector in the reference star catalog, is the sidereal reference epoch t 0 The proper motion of the sidereal body (arc seconds / year), E B (t) is the position of the Earth in the International Celestial Coordinate System (ICRS) at the observation time t, g[...] is the gravity light deflection function, f[...] is the aberration function, R Σ is the precession-nutation conversion matrix, R 3 (theta) is the Earth's rotation matrix, R 1 (-yp)R 2 (-xp)R 3 (sp) is the Earth's polar motion matrix, R 1 ,R 2 With R 3 Represents the unit rotation angle matrices around the x, y, and z axes respectively.
[0041] At the same time, based on the inclinometer measurement, the conversion matrix between the inclinometer coordinate system (Q-system) and the horizontal coordinate system (H-system) is obtained
[0042]
[0043] In the formula, θ X and θ Y are the angles between the two axes of the inclinometer and the horizontal, θ 0 =arcsin(tanθ X tanθ Y ).
[0044] From the S-system to the E-system, the observed star vector coordinate system transformation model of a star is expressed as:
[0045]
[0046] Where W S is the observed star vector, The installation matrix of S-series and Q-series, is the heading information matrix, is the position information matrix is the transformation matrix between the Earth-fixed coordinate system E-system and I-system, V I is the reference star vector.
[0047] Taking into account the imaging system error, installation matrix error, etc., the primary observation longitude and latitude information model is established using least squares optimization, that is,
[0048]
[0049] At this point, the position of the observed longitude and latitude can be preliminarily obtained according to the above formula. However, its positioning accuracy is still seriously affected by factors such as refraction turbulence in the atmosphere, and further processing is required.
[0050] In the H-coordinate system, the observed star vector and the zenith direction can form the starlight refraction surface
[0051]
[0052] At the same time, in the N-coordinate system, the reference star vector and the zenith direction form the starlight refraction surface
[0053] Y N =R 2 (90°-φ)R 3 (λ)V E ×[0 0 1]
[0054] Therefore, a starlight refraction surface coordinate system conversion model can be established
[0055] Y H =R 3 (θ)Y N
[0056] Considering that each star corresponds to a starlight refraction surface, a model can be established based on the least squares optimization solution method.
[0057] L=argmin||Y H -R 3 (θ)Y N ||
[0058] The above formula is prone to local optimal solutions during the solution process, so its initial solution value needs to be referenced by the preliminary solution results of the starlight vector positioning model, so as to further optimize the starlight vector positioning solution results, remove the influence of atmospheric refraction, etc., and obtain higher positioning and navigation accuracy.
[0059] The present invention proposes a dual iterative optimization positioning method based on starlight vector and starlight refraction surface. The first step is to obtain rough observation positioning information based on the optimization solution of starlight vector; the second step is to correct the atmospheric refraction error based on the rough observation positioning information through the starlight refraction surface method to obtain the extreme point with the highest positioning accuracy and not affected by the atmospheric refraction error, thereby realizing high-precision autonomous positioning of the star sensor. Figure 2 The measured experimental results are given, and the positioning longitude is improved from 0.00171° to 0.0000645°.
[0060] The above shows and describes the basic principles, main features and advantages of the present invention. Those skilled in the art should understand that the present invention is not limited to the above embodiments. The above embodiments and descriptions only describe the principles of the present invention. The present invention may be subject to various changes and improvements without departing from the spirit and scope of the present invention. These changes and improvements fall within the scope of the present invention. The scope of protection claimed by the present invention is defined by the attached claims and their equivalents.
Claims
1. A dual iterative optimization positioning method based on starlight vector and starlight refraction surface, characterized in that: The following steps are involved: The first step is to use the star sensor and inclinometer to calculate the starlight observation vector, horizontal conversion matrix and zenith direction; The second step is to establish an astronomical coordinate system conversion model based on the starlight observation vector, horizontal conversion matrix, observation time and reference star catalog, and use the least squares optimization solution to obtain the primary observation longitude and latitude information; The third step is to establish a starlight refraction surface coordinate system conversion model based on the starlight observation vector, zenith direction, observation time and reference star catalog; The fourth step is to use the primary observation longitude and latitude information as the initial optimization value to establish a least squares starlight refraction surface coordinate system conversion positioning solution model to obtain higher-precision observation longitude and latitude information.
2. The dual iterative optimization positioning method based on starlight vector and starlight refraction surface according to claim 1 is characterized in that: The first step includes the following: (a1) The star sensor images the stars in the sky to obtain a star map; the observed star vectors in the star sensor coordinate system S are obtained by extracting the centroid of the stars in the star map; (a2) Based on the star map recognition method, the correspondence between the observed star vector in the star sensor coordinate system and the reference star vector in the reference star catalog coordinate system is obtained by angular distance matching; (a3) The inclination angle between the carrier mounting surface Q system and the horizontal coordinate system H system is measured by the inclinometer, that is, the pitch angle and the roll angle, and the conversion matrix between the carrier coordinate system and the horizontal coordinate system is calculated (a4). Based on the transformation matrix The vector of the zenith direction [0 0 1] in the S system is calculated by body coordinates in, This is the installation matrix for the S and Q series.
3. The dual iterative optimization positioning method based on starlight vector and starlight refraction surface according to claim 1 is characterized in that: The second step is implemented as follows: (b1) For the starlight vector, the relationship expression of its conversion from the observed star vector of the S system to the reference star vector of the inertial coordinate system, that is, the I system, is: Where W S is the observed star vector in the S system, This is the installation matrix for the S and Q series. is the heading information matrix between the H system and the navigation coordinate system N system, is the position information matrix between the N system and the Earth-fixed coordinate system E system, is the conversion matrix between E-system and I-system, V I is the reference star vector; (b2) Based on the observed star vector and the reference star vector, when there are two stars, the longitude and latitude of the observed position can be calculated, that is, φ is latitude, λ is longitude, R1, R2, R3 are unit rotation matrices around the x-axis, y-axis, and z-axis; (b3) Taking into account the imaging system error and the installation matrix error, the primary observation longitude and latitude information model is established using least squares optimization, that is, Where θ is the heading angle, and argmin() is the minimum value.
4. The dual iterative optimization positioning method based on starlight vector and starlight refraction surface according to claim 3 is characterized in that: In the third step, based on the starlight observation vector, zenith direction, observation time and reference star catalog, a starlight refraction surface coordinate system conversion model is established, and the implementation steps are as follows: (c1). In the H coordinate system, the observed star vector and the zenith direction form the starlight refraction surface (c2). In the N-coordinate system, the reference star vector and the zenith direction form the starlight refraction surface Y N =R2(90°-φ)R3(λ)V E ×[001]; (c3). Establish the starlight refraction surface coordinate system conversion model Y H =R3(θ)Y N .
5. The dual iterative optimization positioning method based on starlight vector and starlight refraction surface according to claim 4 is characterized in that: The fourth step is implemented as follows: (d1) Based on the starlight refraction surface coordinate system conversion model in the third step, establish the least squares optimization solution model L = argmin||Y H -R3(θ)Y N ||; (d2) Using the star vector positioning solution model in the second step, the primary longitude and latitude information (φ0λ0) is obtained and substituted into L=arg min||Y H -R3(θ)Y N ||Perform optimization solution to complete the secondary correction of atmospheric refraction error component and obtain the final high-precision observation position longitude and latitude information 6. A non-volatile storage medium, characterized in that: The non-volatile storage medium includes a stored program, wherein the program controls the device where the non-volatile storage medium is located to execute the method according to any one of claims 1 to 5 when the program is executed.
7. An electronic device, characterized in that: It comprises a processor and a memory; the memory stores computer-readable instructions, and the processor is used to execute the computer-readable instructions, wherein the computer-readable instructions execute the method described in any one of claims 1 to 5 when executed.
Citation Information
Patent Citations
Starlight atmospheric refraction measurement correction method based on collinearity of refraction surfaces
CN111537003A
Star sensor self-positioning method and system based on starlight three-dimensional refraction reconstruction
CN115540856A
Star-inertial integrated external field dynamic calibration method based on refracting surface constraint mechanism
CN117571020A
