A heading angle extraction method based on atmospheric polarization pattern symmetry
By installing an array polarization light sensor on the carrier to obtain the sky polarization angle information and fit it, combining time and geographical position information, the problems of polarization mode symmetry axis extraction and heading solution under tilt attitude are solved, and the polarized light orientation is improved Applicability and robustness.
Patent Information
- Application Number
- CN202210486538.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-05-06
- Publication Date
- 2024-11-26
- Estimated Expiration
- 2042-05-06
AI Technical Summary
The existing heading angle extraction method based on atmospheric polarization mode symmetry is only applicable to horizontal placement of polarization light measurement systems. It is unable to effectively extract the polarization mode symmetry axis and perform heading solution in an inclined attitude, which limits its practical application.
The array polarization light sensor installed on the carrier obtains the sky polarization angle information image, eliminates the points with infinite gradients, and performs linear fitting through the least squares method to obtain the angle of the polarization angle information symmetry, and calculates it based on local time and geographical location information. The sun's direction vector, and then solve the carrier heading angle.
The symmetry of the atmospheric polarization mode can be effectively obtained in a horizontal or inclined attitude, which improves the applicability and robustness of polarized light orientation, and the algorithm process is simple and easy to program and implement.
Smart Images

Figure CN115597586B_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the technical field of direction measurement, and in particular to a method for extracting heading angles based on the symmetry of atmospheric polarization patterns. Background Art
[0002] Autonomous navigation technology has been receiving continuous attention from the military field of countries around the world due to its characteristics such as concealment and anti-interference. At present, inertial navigation technology is dominant in the field of autonomous navigation. Inertial navigation can achieve navigation solution and obtain high-precision carrier acceleration and angular velocity information by relying solely on the carrier's own inertial information. When the initial position and attitude of the carrier are known, real-time measurement of the carrier's position and attitude can be achieved. Inertial navigation technology has the characteristics of strong concealment, high update frequency and good short-term accuracy, but it has the disadvantage of error accumulation over time and is not suitable for long-term navigation. Bionic polarized light navigation, as a new type of autonomous navigation technology, can achieve the carrier's heading acquisition by measuring the polarized light of the sky. It has the advantage that the error does not accumulate over time and can provide heading observation for the inertial navigation system to correct the error. Bionic polarized light navigation can provide long-term and high-precision heading information, and can form a combined navigation system with various navigation methods, so it has broad application prospects.
[0003] At present, the methods of using sky polarized light for orientation can be mainly divided into two categories. The first type of orientation method uses the characteristic that the polarization direction of sky observation light is perpendicular to the direction of the sun's line of sight to obtain the azimuth of the sun in the measurement coordinate system. Combined with the azimuth of the sun in the local geographic coordinate system, the yaw angle of the measurement coordinate system can be solved. This type of method can be divided into point measurement orientation and surface measurement orientation. Point measurement orientation only relies on the polarization information of a small area of the sky for orientation solution, and the observation area is usually selected as the zenith. The surface measurement orientation observes the entire sky area within the viewing angle, and each small area is equivalent to a point measurement. The polarization information of all points in the surface is integrated to obtain an optimal heading result. Point measurement orientation is easily affected by factors such as weather and air quality, so it is not very robust. The surface measurement orientation result is not limited to a small area of the sky, and is more robust. It can also achieve good accuracy in less cloudy weather. In the surface measurement orientation model, the light in each observation direction has different altitude angles. When the observation direction deviates from the optical axis of the sensor, the polarization angle is similar, and the error increases with the degree of deviation. Domestic scholars (He Xiaofeng et al., Bionic polarized light orientation algorithm for ground unmanned platforms [J]. Navigation Positioning and Timing, 2019) proposed a weighted average orientation method, which uses the altitude angle corresponding to the observation direction as the weight basis to reduce the influence of the polarization angle error. Its dynamic experimental accuracy is better than 0.5°.
[0004] The second type of orientation method uses the symmetry of the atmospheric polarization pattern. The direction of its symmetry axis is related to the position of the sun. By extracting the symmetry axis of the polarization image, the position of the sun in the measurement coordinate system can be obtained to achieve orientation. Compared with the first type of method, the core of this method is how to extract high-precision image features. As long as the symmetry of the atmospheric polarization pattern exists, orientation can be achieved, so it has higher environmental adaptability. At present, the orientation method based on the symmetry of the atmospheric polarization pattern is only applicable when the polarization measurement system is placed horizontally, and does not consider the extraction of the symmetry axis and the heading solution under the inclined posture. However, most carriers usually have a certain horizontal angle when moving, which makes this method have great limitations in practical application. Therefore, it is of great significance to find a method to extract the symmetry axis of the polarization pattern and solve the heading under the inclined posture. Summary of the invention
[0005] Based on this, it is necessary to provide a heading angle extraction method based on the symmetry of the atmospheric polarization mode, which can extract the symmetry axis of the polarization mode and perform heading solution under an inclined posture, in order to address the above technical problems.
[0006] A heading angle extraction method based on the symmetry of atmospheric polarization mode, the method comprising:
[0007] An array polarization light sensor installed on a carrier is used to obtain a sky polarization angle information image in a measurement coordinate system;
[0008] Obtaining the polarization angle information gradient distribution information according to the sky polarization angle information image, eliminating points with infinite gradient, and further performing straight line fitting by the least square method to obtain the polarization angle information symmetry axis angle information; wherein the fitted straight line passes through the center point of the image;
[0009] According to the local time and geographical location information, as well as the coordinate system conversion relationship, the sun direction vector in the measurement coordinate system is obtained;
[0010] The carrier heading angle information is obtained according to the symmetry axis angle information of the polarization angle information and the sun direction vector in the measurement coordinate system.
[0011] In one of the embodiments, the method further includes: obtaining the polarization direction of the incident light of each pixel unit by an array polarization light sensor mounted on the carrier;
[0012] The polarization direction of the incident light corresponding to each pixel unit is subtracted from its azimuth angle to obtain symmetrical polarization angle information, and then a sky polarization angle information image in the measurement coordinate system is obtained.
[0013] In one of the embodiments, the method further includes: filtering the sky polarization angle information image to obtain polarization angle information gradient distribution information;
[0014] According to the polarization angle information gradient distribution information, points with infinite gradient are eliminated, and further linear fitting is performed through the least square method to obtain the polarization angle information symmetry axis angle information.
[0015] In one embodiment, the method further includes: obtaining local time and geographic location information, and further obtaining solar azimuth angle information and solar altitude angle information;
[0016] Obtaining a sun direction vector in a navigation coordinate system according to the sun azimuth angle information and the sun altitude angle information;
[0017] Acquire a coordinate system conversion relationship; the coordinate system conversion relationship includes a posture transfer matrix from a carrier coordinate system to a measurement coordinate system, and a carrier posture matrix; the carrier posture matrix includes the carrier heading angle information to be obtained;
[0018] According to the sun direction vector in the navigation coordinate system and the coordinate system conversion relationship, the sun direction vector in the measurement coordinate system is obtained as follows:
[0019]
[0020] in, To measure the sun direction vector in the coordinate system, is the sun direction vector in the navigation coordinate system, is the attitude transfer matrix from the carrier coordinate system to the measurement coordinate system.
[0021] In one of the embodiments, the method further includes: obtaining a first element and a second element of a sun direction vector in the measurement coordinate system;
[0022] Substitute the symmetry axis angle information of the polarization angle information and the first element and the second element of the sun direction vector in the measurement coordinate system into the preset formula:
[0023]
[0024] Wherein, β is the symmetry axis angle information of the polarization angle information, is the first element of the sun direction vector in the measurement coordinate system, is the second element of the sun direction vector in the measurement coordinate system;
[0025] Solve and obtain the carrier heading angle information.
[0026] In one of the embodiments, it also includes: every four pixels constitute a pixel unit.
[0027] In one of the embodiments, the array polarization light sensor is in a horizontal or tilted posture.
[0028] The above-mentioned heading angle extraction method based on the symmetry of the atmospheric polarization pattern obtains the sky polarization angle information image in the measurement coordinate system through an array polarization light sensor, obtains the polarization angle information gradient distribution information based on the sky polarization angle information image, removes points with infinite gradients, and further performs linear fitting through the least squares method to obtain the symmetry axis angle information of the polarization angle information, and then calculates the sun direction vector in the measurement coordinate system based on the local time and geographical location; obtains the carrier heading angle information based on the symmetry axis angle information of the polarization angle information and the sun direction vector in the measurement coordinate system. The present invention can obtain a symmetrical measurement atmospheric polarization pattern in either a horizontal or tilted posture, and solves the carrier heading angle by integrating the carrier position and time information, thereby improving the applicability of polarized light orientation; the algorithm flow is simple, the robustness is strong, and it is easy to program and implement. BRIEF DESCRIPTION OF THE DRAWINGS
[0029] Figure 1 1 is a flow chart of a method for extracting a heading angle based on the symmetry of an atmospheric polarization pattern in one embodiment;
[0030] Figure 2 Measured atmospheric polarization angle patterns when the polarization light sensor is placed horizontally and tilted in one embodiment, wherein (a) is a distribution diagram of measured polarization angle patterns when the polarization light sensor is placed horizontally, and (b) is a distribution diagram of measured polarization angle patterns when the polarization light sensor is pitched 15°;
[0031] Figure 3 A schematic diagram of the gradient distribution of the measured polarization angle information in one embodiment;
[0032] Figure 4 is a diagram of symmetry axis fitting results based on the least squares method in one embodiment;
[0033] Figure 5 4 is a flow chart of a method for extracting a heading angle based on the symmetry of an atmospheric polarization pattern in another embodiment. DETAILED DESCRIPTION
[0034] In order to make the purpose, technical solution and advantages of the present application more clearly understood, the present application is further described in detail below in conjunction with the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are only used to explain the present application and are not used to limit the present application.
[0035] In one embodiment, Figure 1 As shown, a heading angle extraction method based on the symmetry of the atmospheric polarization pattern is provided, comprising the following steps:
[0036] Step 102: Acquire a sky polarization angle information image in a measurement coordinate system through an array polarization light sensor installed on a carrier.
[0037] Using array polarization light sensors, the polarization information of any area of the sky can be measured in real time and dynamically.
[0038] Figure 2 The actual atmospheric polarization angle pattern calculated is shown. Figure 2 (a) is the distribution diagram of the measured polarization angle pattern when the polarization light sensor is placed horizontally. Figure 2 (b) is the measured polarization angle pattern distribution diagram of the polarization light sensor when it is pitched 15°. Both have good symmetry and the axis of symmetry passes through the center of the image, which is the position of the sensor optical axis.
[0039] Step 104, obtaining the polarization angle information gradient distribution information according to the sky polarization angle information image, eliminating points with infinite gradient, and further performing linear fitting by the least square method to obtain the polarization angle information symmetry axis angle information.
[0040] Among them, the fitted straight line passes through the center point of the image.
[0041] The role of filtering is to reduce the impact of noise. Figure 3 To measure the gradient distribution of polarization angle information, since the area with large polarization angle information gradient basically coincides with the symmetry axis of the measured polarization angle, points with polarization angle gradient greater than the threshold are selected, and a straight line is fitted based on the least squares method. At the same time, the straight line passing through the center point of the image is used as a constraint. The symmetry axis fitting result is as follows: Figure 4 As shown in the figure, the symmetry axis fitting result of the polarization angle image is the solar meridian projection under the measurement system. l The angle β between the axes is used to obtain the symmetry axis angle of the polarization angle information.
[0042] Step 106, according to the local time and geographic location information, as well as the coordinate system conversion relationship, the sun direction vector in the measurement coordinate system is obtained, and the projection of the unit vector of the sun's line of sight direction in the measurement coordinate system is obtained by projecting it to the measurement coordinate system through the attitude transfer matrix.
[0043] Step 108, obtaining the carrier heading angle information according to the polarization angle information, the symmetry axis angle information and the sun direction vector in the measurement coordinate system.
[0044] In the measurement coordinate system, the projection of the sun direction vector on the measurement plane is the symmetry axis of the polarization angle information. According to the geometric relationship, the following equation can be obtained:
[0045]
[0046] in Represents the i-th element in the sun direction vector (i=1,2,3);
[0047] Finally, the carrier heading angle ψ is obtained:
[0048]
[0049] in,
[0050] Where: k s1 , k s2 and k s3 is an intermediate variable.
[0051] In the above-mentioned heading angle extraction method based on the symmetry of the atmospheric polarization pattern, the sky polarization angle information image in the measurement coordinate system is obtained by an array polarization light sensor, the polarization angle information gradient distribution information is obtained according to the sky polarization angle information image, the points with infinite gradient are eliminated, and further linear fitting is performed by the least square method to obtain the symmetry axis angle information of the polarization angle information, and then the sun direction vector in the measurement coordinate system is calculated according to the local time and geographical location; the carrier heading angle information is obtained according to the symmetry axis angle information of the polarization angle information and the sun direction vector in the measurement coordinate system. The present invention can obtain a symmetrical measurement atmospheric polarization pattern in a horizontal or inclined posture, and solve the carrier heading angle by integrating the carrier position and time information, thereby improving the applicability of polarized light orientation; the algorithm flow is simple, the robustness is strong, and it is easy to program and implement.
[0052] In one of the embodiments, it also includes: obtaining the polarization direction of the incident light of each pixel unit through an array polarization light sensor installed on a carrier; subtracting the polarization direction of the incident light corresponding to each pixel unit from its azimuth angle to obtain symmetrical polarization angle information, wherein the azimuth angle refers to the azimuth angle of the pixel unit, and then obtaining a sky polarization angle information image in the measurement coordinate system.
[0053] In one of the embodiments, it also includes: filtering the sky polarization angle information image to obtain polarization angle information gradient distribution information; according to the polarization angle information gradient distribution information, eliminating points with infinite gradient, and further performing straight line fitting through the least squares method to obtain the polarization angle information symmetry axis angle information.
[0054] In one embodiment, the method further includes: obtaining local time and geographic location information, and further obtaining solar azimuth information and solar altitude information; obtaining a solar direction vector in a navigation coordinate system according to the solar azimuth information and the solar altitude information; obtaining a coordinate system conversion relationship; the coordinate system conversion relationship includes a posture transfer matrix from a carrier coordinate system to a measurement coordinate system, and a posture matrix of the carrier; the posture matrix of the carrier includes the carrier heading angle information to be obtained; according to the solar direction vector in the navigation coordinate system and the coordinate system conversion relationship, the solar direction vector in the measurement coordinate system is obtained as follows:
[0055]
[0056] in, To measure the sun direction vector in the coordinate system, is the sun direction vector in the navigation coordinate system, is the attitude transfer matrix from the carrier coordinate system to the measurement coordinate system.
[0057] In one embodiment, the method further includes: obtaining a first element and a second element of a sun direction vector in a measurement coordinate system; substituting the symmetry axis angle information of the polarization angle information and the first element and the second element of the sun direction vector in the measurement coordinate system into a preset formula:
[0058]
[0059] Among them, β is the symmetry axis angle information of the polarization angle information, is the first element of the sun direction vector in the measured coordinate system, It is the second element of the sun direction vector in the measurement coordinate system; the carrier heading angle information is obtained by solving it.
[0060] In one of the embodiments, the array polarization light sensor is in a horizontal or tilted posture.
[0061] In a specific embodiment, Figure 5 As shown, a heading angle extraction method based on the symmetry of the atmospheric polarization pattern is provided. The polarization angle of each pixel unit is obtained from the polarization image, and the polarization angle gradient distribution diagram is drawn. The symmetry axis is extracted to obtain the solar meridian projection under the measurement system. On the other hand, the solar direction vector under the navigation system is determined by the position and time of the carrier, and the carrier heading information is obtained by combining the predicted carrier horizontal angle and the solar meridian projection under the measurement system.
[0062] It should be understood that although Figure 1 The steps in the flowchart are shown in sequence as indicated by the arrows, but these steps are not necessarily executed in the order indicated by the arrows. Unless otherwise specified in this document, there is no strict order restriction for the execution of these steps, and these steps can be executed in other orders. Moreover, Figure 1 At least part of the steps may include multiple sub-steps or multiple stages. These sub-steps or stages are not necessarily executed at the same time, but can be executed at different times. The execution order of these sub-steps or stages is not necessarily sequential, but can be executed in turn or alternately with other steps or at least part of the sub-steps or stages of other steps.
[0063] The technical features of the above embodiments may be combined arbitrarily. To make the description concise, not all possible combinations of the technical features in the above embodiments are described. However, as long as there is no contradiction in the combination of these technical features, they should be considered to be within the scope of this specification.
[0064] The above-mentioned embodiments only express several implementation methods of the present application, and the descriptions thereof are relatively specific and detailed, but they cannot be understood as limiting the scope of the invention patent. It should be pointed out that, for a person of ordinary skill in the art, several variations and improvements can be made without departing from the concept of the present application, and these all belong to the protection scope of the present application. Therefore, the protection scope of the patent of the present application shall be subject to the attached claims.
Claims
1. A heading angle extraction method based on the symmetry of atmospheric polarization mode, characterized in that: The method comprises: The polarization direction of the incident light of each pixel unit is obtained by an array polarization light sensor installed on the carrier; Subtract the polarization direction of the incident light corresponding to each pixel unit from its azimuth angle to obtain symmetrical polarization angle information, and then obtain a sky polarization angle information image in the measurement coordinate system; After filtering the sky polarization angle information image, polarization angle information gradient distribution information is obtained; According to the polarization angle information gradient distribution information, points with infinite gradient are eliminated, and further a linear fitting is performed by the least square method to obtain the symmetry axis angle information of the polarization angle information; wherein the fitted straight line passes through the center point of the image; According to the local time and geographic location information, as well as the coordinate system conversion relationship, the sun direction vector in the measurement coordinate system is obtained, including: S1, obtaining local time and geographic location information, and further obtaining solar azimuth angle information and solar altitude angle information; S2, obtaining a sun direction vector in a navigation coordinate system according to the sun azimuth information and the sun altitude information; S3, obtaining a coordinate system conversion relationship; the coordinate system conversion relationship includes a posture transfer matrix from the carrier coordinate system to the measurement coordinate system, and a carrier posture matrix; the carrier posture matrix includes the carrier heading angle information to be obtained; S4, according to the sun direction vector in the navigation coordinate system and the coordinate system conversion relationship, the sun direction vector in the measurement coordinate system is obtained as: S5, where To measure the sun direction vector in the coordinate system, is the sun direction vector in the navigation coordinate system, is the attitude transfer matrix from the navigation coordinate system to the measurement coordinate system; According to the symmetry axis angle information of the polarization angle information and the sun direction vector in the measurement coordinate system, the carrier heading angle information is obtained, including: S11, obtaining the first element and the second element of the sun direction vector in the measurement coordinate system; S21, substituting the symmetry axis angle information of the polarization angle information and the first element and the second element of the sun direction vector in the measurement coordinate system into a preset formula: Wherein, β is the symmetry axis angle information of the polarization angle information, is the first element of the sun direction vector in the measurement coordinate system, is the second element of the sun direction vector in the measurement coordinate system; S31, solving and obtaining the heading angle information of the carrier.
2. The method according to claim 1, characterized in that Every four pixels constitute a pixel unit.
3. The method according to any one of claims 1 to 2, characterized in that: The array-type polarized light sensor is in a horizontal or inclined posture.
