CN114877898A - Sun dynamic tracking method based on underwater polarization attitude and refraction coupling inversion - Google Patents

Sun dynamic tracking method based on underwater polarization attitude and refraction coupling inversion Download PDF

Info

Publication number
CN114877898A
CN114877898A CN202210808542.6A CN202210808542A CN114877898A CN 114877898 A CN114877898 A CN 114877898A CN 202210808542 A CN202210808542 A CN 202210808542A CN 114877898 A CN114877898 A CN 114877898A
Authority
CN
China
Prior art keywords
polarization
vector
underwater
atmospheric
angle
Prior art date
Legal status (The legal status 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 status listed.)
Granted
Application number
CN202210808542.6A
Other languages
Chinese (zh)
Other versions
CN114877898B (en
Inventor
杨健
胡鹏伟
野召斌
郭雷
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beihang University
Original Assignee
Beihang University
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 Beihang University filed Critical Beihang University
Priority to CN202210808542.6A priority Critical patent/CN114877898B/en
Publication of CN114877898A publication Critical patent/CN114877898A/en
Application granted granted Critical
Publication of CN114877898B publication Critical patent/CN114877898B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • G01C21/203Specially adapted for sailing ships
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02ATECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
    • Y02A90/00Technologies having an indirect contribution to adaptation to climate change
    • Y02A90/30Assessment of water resources

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)

Abstract

The invention relates to a solar dynamic tracking method based on underwater polarization attitude and refraction coupling inversion. Firstly, an underwater polarization angle image is calculated by utilizing a polarized light intensity image acquired by an underwater polarization sensor, and an imaging pixel in a Snell window is determined by combining a horizontal attitude angle; then calculating an underwater refraction angle of light rays entering the underwater polarization sensor by using the two horizontal attitude angles, converting an underwater polarization angle image in a Snell window into an atmosphere 8-shaped polarization angle image, further extracting a solar meridian from the atmospheric 8-shaped polarization angle image, and dividing the atmospheric 8-shaped polarization angle image into two regions by taking the atmospheric meridian as a boundary; and finally, solving the sun vector by respectively utilizing the polarization E-vector and the polarization degree of the atmosphere solved by the pixels of the two regions. The invention considers the attitude dynamic change information of the carrier and expands the application scene of the sun tracking method based on polarized light in the underwater Snell window.

Description

Sun dynamic tracking method based on underwater polarization attitude and refraction coupling inversion
Technical Field
The invention belongs to the field of underwater autonomous navigation, and particularly relates to a solar dynamic tracking method based on underwater polarization attitude and refraction coupling inversion.
Background
The bionic polarized light navigation is a novel navigation means inspired by the behavior of determining the self course by sensing atmospheric polarized light by insects, has the advantages of complete autonomy, no error accumulation and the like, has been widely researched in the atmospheric environment at present, and the research of applying the polarized light navigation to underwater is still in the starting stage. The polarized light can provide navigation information because it contains sun information, so the basic idea of polarized light navigation is to solve the position of the sun through the acquired polarization information, and then realize navigation capability through the sun.
Solving the position of the sun based on polarized light is a precondition for realizing navigation by utilizing the polarized light. The Chinese patent CN201410652332.8 of the invention utilizes the atmospheric polarization distribution mode to resolve the position of the sun by a cluster analysis method; the Chinese patent of invention CN201710027484.2 utilizes the polarization E-vector of the atmosphere to establish the optimal estimation array of the sun vector to solve the sun position information; the chinese invention patent CN201810592616.0 proposes a sun position calculating method based on atmospheric polarization degree. However, in an underwater environment, in the process of transmitting polarized light from the atmosphere into water, a refraction phenomenon occurs on the water surface, and the refraction changes the propagation direction of the polarized light and the deflection of a polarization plane, so that the above method for calculating the sun vector in the atmospheric environment is not suitable for the underwater environment; the chinese invention patent CN201911252040.4 proposes a sun tracking method based on polarized light in an underwater snell window, which compensates the effect of refraction on polarized light, but is only applicable to the application scenario of a horizontal static base, and cannot be applied to the scenario of dynamic attitude change. When dynamic change of the attitude exists, the imaging position of the snell window in the image also changes, and the image identification-based method is utilized, the invention patent CN202011307276.6 in china proposes a method for identifying the edge in the image to extract the snell window, but the image processing algorithm has a large calculation amount and cannot be applied to real-time calculation of an underwater dynamic scene.
Different from the atmospheric environment, the sun tracking method based on the underwater polarized light field has obvious difference in two scenes, namely the dynamic change of the carrier attitude in the underwater environment and the horizontal static base. The water surface refraction phenomenon occurs under a navigation coordinate system, and the compensation of the refraction action needs to calculate the horizontal posture first to obtain information such as a refraction angle. Therefore, dynamic coupling of attitude and refraction phenomena exists in the underwater environment, which seriously affects the solar dynamic tracking precision based on the underwater polarized light field. Quantification and compensation of refraction in dynamic change of carrier attitude are key problems for improving applicability of dynamic application scenes of the sun tracking method.
Disclosure of Invention
In order to solve the technical problem, the invention provides a solar dynamic tracking method based on underwater polarization attitude and refraction coupling inversion, two horizontal attitude angles of a pitch angle and a roll angle are introduced to determine the imaging position of a Snell window and the refraction angle of light in the observation direction in the window, thereby compensating the influence of light bending and polarization plane deflection caused by refraction and realizing the solar dynamic tracking under the attitude/refraction coupling action. Furthermore, the polarization degree reflects the quality of polarized light, and the polarization degree is introduced as the weight of each polarization E vector, so that the robustness of solar dynamic tracking can be improved. The invention combines the attitude information of the carrier, and inverts the refraction polarization light distribution mode in the underwater Snell window obtained under any attitude to obtain the polarization E-vector of the atmosphere by dynamic compensation of the refraction action on the water surface, thereby calculating the sun vector.
The technical scheme adopted by the invention for solving the technical problems is as follows: the solar dynamic tracking method based on underwater polarization attitude and refraction coupling inversion comprises the following implementation steps:
step (1), obtaining a polarized light intensity image by using an underwater polarization sensorP k kFor analyzing the polarization direction) to calculate an underwater polarization angle image I, and combining the underwater polarization angle image I with a pitch angleθAnd roll angleγDetermining imaging pixels in a Snell window by the two horizontal attitude angles;
step (2) calculating the underwater refraction angle of the light entering the underwater polarization sensor by using the two horizontal attitude anglesrThe polarization angle image I in the underwater Snell window is processed by compensating refraction in Performing inversion calculation to obtain an atmospheric 8-shaped polarization angle image I in8
Step (3), obtaining an atmospheric 8-shaped polarization angle image I in the step (2) in8 Extracting the solar meridian and dividing I by the solar meridian in8 Divided into two regionsp Andp
step (4), utilizing the atmospheric 8-shaped polarization angle image I obtained in the step (3) in8 Inp And withp And the pixels of the two regions solve the polarization E-vector and the polarization degree of the atmosphere, and solve the sun vector according to the orthogonal relation of the polarization E-vector and the sun vector of the atmosphere.
Further, the specific steps of step (1) are as follows:
defining a horizontal coordinate system (hSystem), carrier pitch angle and roll angle are respectivelyθAndγthen the carrier coordinate system (bSystem) andhthe coordinate transformation matrix between the systems is represented as:
Figure 400295DEST_PATH_IMAGE001
coordinates of each pixel in underwater polarization angle image I (m,n) In thatbObservation vector under systeml b Inverted from the camera lens model Θ:
l b =Θ(m,n)
then the observation vector is inhIs represented as follows:
Figure 51857DEST_PATH_IMAGE002
if it ishObservation vector under systeml h Underwater angle of refraction of directionally incident lightrIn an azimuth ofφThen, thenl h Can be expressed as:
l h = [cosφsinr sinφsinr cosr] T
angle of refractionrIs acute angle, and has sine value of
Figure 362752DEST_PATH_IMAGE003
. Whereinl h Is represented byl h The first element of (1). Known from Snell's law of refraction, the angle of refraction underwaterrThe relationship between the angle of incidence of the light ray is:
Figure 493649DEST_PATH_IMAGE004
wherein the content of the first and second substances,n a andn w respectively representing the refractive indices in the atmosphere and in water,iis the angle of incidence of the light. When in usei<At 90 deg., the incident ray can be refracted. The sine function is a monotone decreasing function in the acute angle range, so that the refraction angle in the Snell windowrThe requirements are satisfied:
Figure 42442DEST_PATH_IMAGE005
then, the underwater polarization angle image I is satisfied
Figure 599325DEST_PATH_IMAGE006
The pixel is judged to be in the Snell window, and the underwater Snell window polarization angle image I is obtained in
Further, the specific steps of the step (2) are as follows:
polarization angle image I in underwater snell window in The value of each pixel is the included angle between the polarization E-vector of the atmosphere in the observation direction of the point and the zero position of the imageαWherein, in the step (A),
Figure 600779DEST_PATH_IMAGE007
. The observation vector of the pixel obtained in the step (1) isl h Then, thenl h The azimuth angle of (A) is:
ϕ=arctan2(l h (2),l h (1))
the underwater "8" polarization azimuth angle χ of the pixel u Comprises the following steps:
χ u =α−ϕ
observation vectorl h Angle of refraction of directionally incident light rays under waterrComprises the following steps:
Figure 268521DEST_PATH_IMAGE008
the angle of incidence of the beam from the atmosphere can be calculated from snell's law of refraction:
Figure 671820DEST_PATH_IMAGE009
whereiniRepresenting the incident angle of the light, since the incident angle of the light is acute, then:
Figure 648872DEST_PATH_IMAGE010
then the "8" polarization azimuth angle χ of the atmospheric incident ray a
Figure 872043DEST_PATH_IMAGE012
And simultaneously calculating the propagation vector of the incident light of the atmosphere:
Figure 77897DEST_PATH_IMAGE014
imaging the directional atmospheric incident light directly through the camera lens, imaging pixel coordinates: (m a ,n a ) Comprises the following steps:
Figure 70124DEST_PATH_IMAGE015
wherein the content of the first and second substances,round(. x) denotes rounding operation. Thereby obtainingm a ,n a ) Is a pixel coordinate of χ a Atmospheric "8" polarization angle image I of pixel values in8
Further, the specific steps in step (2) are as follows:
atmospheric 8-shaped polarization angle image I calculated in step (2) in8 The atmospheric polarization E-vector of the atmospheric incident polarized light corresponding to each pixel is:
Figure 234389DEST_PATH_IMAGE016
because the E-vector of the atmospheric polarization is perpendicular to the sun vector, the E-vector of the atmospheric polarization on the sun meridian is perpendicular to the sun meridian, and the 8-shaped polarization azimuth angle chi of the atmospheric incident light ray a And the polarization E-vector z-axis azimuth component of the atmosphere on the solar meridian is zero by substituting the formula. Therefore, a threshold value is set according to the actual situationκ,(κ>0) Is selected to satisfy
Figure 194123DEST_PATH_IMAGE017
Is formed by a plurality of pixelsp * As pixels near the solar meridian
Figure 938088DEST_PATH_IMAGE018
Whereine a (3) Representing a vectore a The third element of (1); and fitting the pixels meeting the condition to form a straight linem+kn+b=0, whereinkAndbrespectively, the linear parameters are the atmospheric 8-shaped polarization angle image I in8 The middle solar meridian.
When I is in8 Inner pixel coordinate satisfiesm+kn+b>At 0, the pixel is on one side of the solar meridian, and the set of all pixels in the area is defined asp (ii) a In the same way, when I in8 Inner pixel coordinate satisfiesm+kn+b<At 0, the pixels are on the other side of the solar meridian, and the set of all pixels in the area is defined asp
Further, the specific steps of the step (4) are as follows:
obtaining polarized light intensity image by underwater polarization sensorPSolving out images of degree of polarizationDAnd from I to I calculated in step (2) and step (3) in8 By a polarization degree imageDDetermination of I in8 The polarization degree corresponding to each pixel in the image is obtained to obtain an atmospheric polarization degree imageD in8 . The sum vector of the polarization E-vectors respectively constructing the two regional atmospheres is as follows:
Figure 315980DEST_PATH_IMAGE019
wherein the content of the first and second substances,E E respectively representing the sum vector of the polarization E-vectors of the two regional atmospheres,
Figure 119988DEST_PATH_IMAGE020
representing images of atmospheric polarization degreeD in8 The middle pixel coordinate is (m a ,n a ) The pixel value of (a), i.e., the degree of polarization;
Figure 583330DEST_PATH_IMAGE021
by the expression I in8 The middle pixel coordinate is (m a ,n a ) Pixel value χ a And solving the calculated atmospheric polarization E-vector of the atmospheric incident polarized light.
Then to solvehSystematic ambiguity sun vectors h′ Comprises the following steps:
Figure 645833DEST_PATH_IMAGE022
taking into account that the sun is above the horizon during the day, the zenith vector is utilized
Figure 612652DEST_PATH_IMAGE023
To resolve the ambiguity, the final sun vector is as follows:
Figure 118720DEST_PATH_IMAGE024
whereinsign(v) represents the sign of v, from which the solution is derivedhIs the lower sun vector.
Has the advantages that:
compared with the prior art, the invention has the following advantages: the existing sun tracking method based on underwater polarized light is only suitable for a horizontal static base scene. According to the solar dynamic tracking method based on underwater polarization attitude and refraction coupling inversion, pixels in a Snell window in polarization imaging are dynamically selected through the acquired horizontal attitude angle, the effect of refraction on atmospheric incident polarized light is dynamically compensated, the polarization degree is introduced to serve as the atmospheric polarization E-vector weight, and the precision and robustness of solar dynamic tracking are improved.
Drawings
FIG. 1 is a flow chart of a solar dynamic tracking method based on underwater polarization attitude and refraction coupling inversion according to the present invention;
FIG. 2 is a schematic diagram of a coordinate system and refraction according to the present invention.
Detailed Description
The technical solutions in the embodiments of the present invention will be described clearly and completely with reference to the accompanying drawings in the embodiments of the present invention, and it is obvious that the described embodiments are only a part of the embodiments of the present invention, rather than all embodiments, and all other embodiments obtained by a person skilled in the art based on the embodiments of the present invention belong to the protection scope of the present invention without creative efforts.
According to an embodiment of the present invention, as shown in fig. 1, the solar dynamic tracking method based on underwater polarization attitude and refraction coupling inversion of the present invention includes the following steps:
step 1, obtaining a polarized light intensity image by using an underwater polarization sensorP k Solving underwater polarization angle imageICombined with carrier pitch angleθAnd roll angleγThe two horizontal attitude angles determine the imaging pixels within the snell window, wherekIs the polarization detection direction. The method comprises the following specific steps:
in this embodiment, taking a four-channel underwater polarization sensor as an example, the four-channel polarization detection directions are respectively 0 °,45 °,90 ° and 135 °, so that the underwater polarization sensor obtains the polarized light intensity imageP 0 ,P 45 ,P 90 ,P 135 From this, the underwater polarization angle image I can be calculated as:
Figure 538200DEST_PATH_IMAGE025
defining a horizontal coordinate system (hSystem), carrier pitch angle and roll angle are respectivelyθAndγthen the carrier coordinate system (bSystem) andhthe coordinate transformation matrix between the systems is represented as:
Figure 155126DEST_PATH_IMAGE001
coordinates of each pixel in underwater polarization angle image I (m,n) In thatbObservation vector under systeml b Inverted from the camera lens model Θ:
l b =Θ(m,n)
then the observation vector is inhIs represented as follows:
Figure 242031DEST_PATH_IMAGE002
if it ishObservation vector under systeml h The angle of refraction of a directionally incident ray under water isrIn an azimuth ofφThen, thenl h Can be expressed as:
l h = [cosφsinr sinφsinr cosr] T
angle of refractionrIs acute angle, and has sine value of
Figure 168267DEST_PATH_IMAGE026
Angle of refraction known from Snell's law of refractionrAngle of incidence to lightiThe relationship between them is:
Figure 340623DEST_PATH_IMAGE027
wherein the content of the first and second substances,n a andn w respectively representing the refractive indices in the atmosphere and in water,iis the angle of incidence of the light.
When in usei<At 90 deg., the light is refracted. The sine function is a monotone decreasing function in the acute angle range, so the refraction angle in the Snell windowrThe requirements are satisfied:
Figure 495661DEST_PATH_IMAGE028
then, it is satisfied in the underwater polarization angle image I
Figure 702651DEST_PATH_IMAGE029
The pixel is judged to be in the Snell window, and the polarization angle image I in the underwater Snell window is obtained in . Whereinl h Is represented byl h The first element of (1).
Step 2, calculating the refraction angle of the light entering the underwater polarization sensor by using the two horizontal attitude anglesrThe polarization angle image I in the underwater Snell window is obtained by compensating refraction in Performing inversion calculation to obtain an atmospheric 8-shaped polarization angle image I in8 . The method comprises the following specific steps:
polarization angle image I in underwater snell window in The value of each pixel is the included angle between the polarized light vibration direction and the image zero position in the observation direction of the pointαWherein, in the step (A),αin the range of
Figure 550521DEST_PATH_IMAGE007
The observation vector of the pixel obtained from step 1 isl h Then, thenl h The azimuth angle of (A) is:
ϕ=arctan2(l h (2),l h (1))
the underwater 8-shaped polarization azimuth angle of the pixelχ u Comprises the following steps:
χ u =α−ϕ
observation vectorl h Angle of refraction of directionally incident light rays under waterrComprises the following steps:
Figure 210173DEST_PATH_IMAGE030
the incident angle of the beam of light from the atmosphereiCan be calculated from snell's law of refraction:
Figure 168901DEST_PATH_IMAGE031
whereiniRepresenting the angle of incidence of the light. Since the incident angle of the light is acute, it is obtained:
Figure 964819DEST_PATH_IMAGE032
as shown in FIG. 2, the E-vector of polarization of the atmosphere can be decomposed into two orthogonal components, each perpendicular to the plane of refractione And parallel to the refracting surfacese . When the water surface refraction occurs, the attenuation degrees of the two components are different, and the polarized light is refracted by airInto the water, the two components being represented ast Andt from the fresnel refraction equation:
Figure 232858DEST_PATH_IMAGE033
the following relation exists between the atmospheric and underwater 8-shaped polarization azimuth angles before and after refraction:
Figure 379806DEST_PATH_IMAGE034
then the "8" polarization azimuth angle χ of the atmospheric incident ray a Can be expressed as:
Figure 407805DEST_PATH_IMAGE036
observation vectorl h In an azimuth ofϕThe zenith angle is equal to the refraction anglerThen, thenl h Can be expressed as:
l h = [cosϕsinr sinϕsinr cosr] T
the azimuth angle of the atmospheric incident light before and after refraction is unchanged, and only the zenith angle is changed. The zenith angle of atmospheric incident light is the incident angle of lightiThen, as shown in FIG. 2, the propagation vector of the incident light of the atmospherel a In thathIs represented as
Figure 323808DEST_PATH_IMAGE037
Due to the fact that
Figure 982323DEST_PATH_IMAGE038
Therefore:
Figure 616566DEST_PATH_IMAGE040
imaging the directional atmospheric incident light directly through the camera lens, imaging pixel coordinates: (m a ,n a ) Comprises the following steps:
Figure 182677DEST_PATH_IMAGE041
whereinround(. x) denotes rounding operation. Thereby obtainingm a ,n a ) Is a pixel coordinate of χ a Atmospheric "8" polarization angle image I of pixel values in8
Step 3, obtaining an atmospheric 8-shaped polarization angle image I in the step 2 in8 Extracting the solar meridian and dividing I by the solar meridian in8 Divided into two regionsp Andp . The method comprises the following specific steps:
atmospheric 8-shaped polarization angle image I calculated in step 2 in8 Each pixel value in the set of pixel values is the atmospheric polarization E-vector of the atmospheric incident polarized light corresponding to the pixele a In thathIs represented as follows:
e a =v cosχ a +u sinχ a
whereinv,uRespectively represent the tangential unit vector of the meridian direction and the latitude direction of the celestial sphere observation point in the over-atmosphere, and the tangential unit vector is as follows:
v=[cosicosφcosisinφ−sini] T
u=[sinφcosφ0] T
this gives:
Figure 218766DEST_PATH_IMAGE042
since the E-vector of the atmospheric polarization is perpendicular to the sun vector, the atmospheric polarization lies in the solar meridianThe E-vector is perpendicular to the solar meridian, so that the '8' -shaped polarization azimuth angle of the atmospheric incident lightχ a And the polarization E-vector z-axis azimuth component of the atmosphere on the solar meridian is zero by substituting the formula. Therefore, a threshold value is set according to the actual situationκ,(κ>0) Is selected to satisfy
Figure 313761DEST_PATH_IMAGE017
Is formed by a plurality of pixelsp * As pixels near the solar meridian
Figure 684568DEST_PATH_IMAGE018
Whereine a (3) Representing a vectore a The third element of (1); and fitting the pixels meeting the condition to form a straight linem+kn+b=0, whereinkAndbrespectively, the linear parameters are the atmospheric 8-shaped polarization angle image I in8 The middle solar meridian.
When I is in8 Inner pixel coordinate satisfiesm+kn+b>At 0, the pixel is on one side of the solar meridian, and the set of all pixels in the area is defined asp (ii) a In the same way, when I in8 Inner pixel coordinate satisfiesm+kn+b<At 0, the pixels are on the other side of the solar meridian, and the set of all pixels in the area is defined asp
Step 4, utilizing the atmospheric 8-shaped polarization angle image I obtained in the step 3 in8 Inp Andp and the pixels of the two regions solve the polarization E-vector and the polarization degree of the atmosphere, and solve the sun vector according to the orthogonal relation of the polarization E-vector and the sun vector of the atmosphere. The method comprises the following specific steps:
obtaining polarized light intensity image by underwater polarization sensorP k Solving out images of degree of polarizationD
Figure 788790DEST_PATH_IMAGE043
From I to I calculated in step 2 and step 3 in8 Using polarization degree imagesDDetermination of I in8 Obtaining an atmospheric polarization degree image by the corresponding polarization degree of each pixelD in8 . Then order:
Figure 413807DEST_PATH_IMAGE044
wherein the content of the first and second substances,E E respectively representing the sum vector of the polarization E-vectors of the two regional atmospheres,
Figure 945282DEST_PATH_IMAGE045
representing images of atmospheric polarization degreeD in8 The middle pixel coordinate is (m a ,n a ) The pixel value of (a), i.e., the degree of polarization;
Figure 554118DEST_PATH_IMAGE046
by the expression I in8 The middle pixel coordinate is (m a ,n a ) Pixel value χ a And solving the calculated atmospheric polarization E-vector of the atmospheric incident polarized light.
Then to solvehSystematic ambiguity sun vectors h′ Comprises the following steps:
Figure DEST_PATH_IMAGE047
the zenith vector is utilized in view of the fact that the sun is usually above the horizon during the day
Figure 196452DEST_PATH_IMAGE048
To resolve the ambiguity, the final sun vector is as follows:
Figure DEST_PATH_IMAGE049
whereinsign(*)The sign of #is expressed, and then the sign is solvedhIs the lower sun vector.
Although illustrative embodiments of the present invention have been described above to facilitate the understanding of the present invention by those skilled in the art, it should be understood that the present invention is not limited to the scope of the embodiments, but various changes may be apparent to those skilled in the art, and it is intended that all inventive concepts utilizing the inventive concepts set forth herein be protected without departing from the spirit and scope of the present invention as defined and limited by the appended claims.

Claims (5)

1. A solar dynamic tracking method based on underwater polarization attitude and refraction coupling inversion is characterized by comprising the following steps:
step (1), obtaining a polarized light intensity image by using an underwater polarization sensorP k Calculating underwater polarization angle image I and combining pitch angleθAnd roll angleγThe two horizontal attitude angles determine the imaging pixels within the snell window, wherekIs the direction of polarization analysis;
step (2) calculating the underwater refraction angle of the light entering the underwater polarization sensor by using the two horizontal attitude anglesrThe polarization angle image I in the underwater Snell window is obtained by compensating refraction in Performing inversion calculation to obtain an atmospheric 8-shaped polarization angle image I in8
Step (3), obtaining an atmospheric 8-shaped polarization angle image I in the step (2) in8 Extracting the solar meridian and dividing I by the solar meridian in8 Divided into two regionsp Andp
step (4), utilizing the atmospheric 8-shaped polarization angle image I obtained in the step (3) in8 Inp Andp and the pixels of the two regions solve the polarization E-vector and the polarization degree of the atmosphere, and solve the sun vector according to the orthogonal relation of the polarization E-vector and the sun vector of the atmosphere.
2. The solar dynamic tracking method based on underwater polarization attitude and refraction coupling inversion of claim 1, characterized in that:
the specific steps of the step (1) are as follows:
defining a horizontal coordinate system, and the pitch angle and the roll angle of the carrier are respectivelyθAndγthen, the coordinate transformation matrix between the carrier coordinate system and the horizontal coordinate system is expressed as:
Figure 384702DEST_PATH_IMAGE001
wherein the horizontal coordinate system ishSystem, carrier coordinate systembIs a step of;
coordinates of each pixel in underwater polarization angle image I (a)m,n) In thatbObservation vector under systeml b Inverted from the camera lens model Θ:
l b =Θ(m,n)
then the observation vector is inhIs represented as follows:
Figure 980900DEST_PATH_IMAGE002
satisfaction in underwater polarization angle image I
Figure 880723DEST_PATH_IMAGE003
The pixel is judged to be in the Snell window, and the polarization angle image I in the underwater Snell window is obtained in (ii) a Whereinl h Is represented byl h The first element of (a) is,n a andn w respectively, the refractive indices in the atmosphere and water.
3. The solar dynamic tracking method based on underwater polarization attitude and refraction coupling inversion of claim 2, characterized in that:
the specific steps of the step (2) are as follows:
polarization angle image I in underwater snell window in The value of each pixel is the included angle between the polarization E-vector of the atmosphere in the observation direction of the point and the zero position of the imageαWherein, in the step (A),αin the range of
Figure 712412DEST_PATH_IMAGE004
The observation vector of the imaging pixel obtained in the step (1) isl h The underwater "8" polarization azimuth angle χ of the imaging pixel u Comprises the following steps:
χ u =α−arctan2(l h (2),l h (1))
observation vectorl h Angle of refraction of directionally incident light rays under waterrComprises the following steps:
Figure 420605DEST_PATH_IMAGE005
then the "8" polarization azimuth angle χ of the atmospheric incident ray a Comprises the following steps:
Figure 312338DEST_PATH_IMAGE006
and simultaneously calculating the propagation vector of the incident light of the atmosphere:
Figure 699457DEST_PATH_IMAGE007
imaging the directional atmospheric incident light directly through the camera lens, imaging pixel coordinates: (m a ,n a ) Comprises the following steps:
Figure 334838DEST_PATH_IMAGE008
whereinround(x) represents rounding to the rounding operation;
thereby obtaining (A) am a ,n a ) Is a pixel coordinate of χ a Atmospheric "8" polarization angle image I of pixel values in8
4. The method of claim 3 for solar dynamic tracking based on underwater polarization attitude and refraction coupling inversion, characterized in that:
the specific steps of the step (3) are as follows:
atmospheric 8-shaped polarization angle image I calculated in step (2) in8 The atmospheric polarization E-vector of the atmospheric incident polarized light corresponding to each pixel is:
Figure 631958DEST_PATH_IMAGE009
because the E-vector of the atmospheric polarization is perpendicular to the sun vector, the E-vector of the atmospheric polarization on the sun meridian is perpendicular to the sun meridian, and the 8-shaped polarization azimuth angle chi of the atmospheric incident light a The polarization E-vector z-axis azimuth component of the atmosphere on the solar meridian is zero by substituting the formula; therefore, a threshold value is setκ,(κ>0) Is selected to satisfy
Figure 960171DEST_PATH_IMAGE010
Is formed by a plurality of pixelsp * As pixels near the solar meridian
Figure 834586DEST_PATH_IMAGE011
Whereine a (3) Representing a vectore a The third element of (1); and fitting the pixels meeting the conditions to form a straight linem+kn+b=0, whereinkAndbrespectively, the linear parameters are the atmospheric 8-shaped polarization angle image I in8 The solar meridian of middle;
when I is in8 Inner pixel coordinate satisfiesm+kn+b>At 0, the pixel is on one side of the solar meridian, and the set of all pixels in the area is defined asp (ii) a When I is in8 Inner pixel coordinate satisfiesm+kn+b<At 0, the pixels are on the other side of the solar meridian, and the set of all pixels in the area is defined asp
5. The method of claim 4 for solar dynamic tracking based on underwater polarization attitude and refraction coupling inversion, characterized in that:
the specific steps of the step (4) are as follows:
obtaining polarized light intensity image by underwater polarization sensorP k Solving out images of degree of polarizationDAnd from I to I calculated in the step (2) and the step (3) in8 By a polarization degree imageDDetermination of I in8 The corresponding polarization degree of each pixel in the image is obtained to obtain an atmospheric polarization degree imageD in8 (ii) a The sum vector of the polarization E-vectors respectively constructing the two regional atmospheres is as follows:
Figure 883445DEST_PATH_IMAGE012
wherein the content of the first and second substances,E E respectively representing the sum vector of the polarization E-vectors of the two regional atmospheres,
Figure 159705DEST_PATH_IMAGE013
representing images of atmospheric polarization degreeD in8 The middle pixel coordinate is (m a ,n a ) The pixel value of (a), i.e., the degree of polarization;
Figure 393241DEST_PATH_IMAGE014
by the expression I in8 The middle pixel coordinate is (m a ,n a ) Pixel value χ a Solving the calculated atmospheric polarization E-vector of the atmospheric incident polarized light;
solution tohSystematic ambiguity sun vectors h′ Comprises the following steps:
Figure 754952DEST_PATH_IMAGE015
because the sun is above the horizon in the daytime, the zenith vector is utilized
Figure 607501DEST_PATH_IMAGE016
Disambiguation, the final sun vector is as follows:
Figure 738268DEST_PATH_IMAGE017
whereinsign(v) represents the sign of v, from which the solution is derivedhIs the lower sun vector.
CN202210808542.6A 2022-07-11 2022-07-11 Sun dynamic tracking method based on underwater polarization attitude and refraction coupling inversion Active CN114877898B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210808542.6A CN114877898B (en) 2022-07-11 2022-07-11 Sun dynamic tracking method based on underwater polarization attitude and refraction coupling inversion

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210808542.6A CN114877898B (en) 2022-07-11 2022-07-11 Sun dynamic tracking method based on underwater polarization attitude and refraction coupling inversion

Publications (2)

Publication Number Publication Date
CN114877898A true CN114877898A (en) 2022-08-09
CN114877898B CN114877898B (en) 2022-10-18

Family

ID=82683109

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210808542.6A Active CN114877898B (en) 2022-07-11 2022-07-11 Sun dynamic tracking method based on underwater polarization attitude and refraction coupling inversion

Country Status (1)

Country Link
CN (1) CN114877898B (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116222580A (en) * 2023-05-09 2023-06-06 北京航空航天大学 Underwater polarization orientation method based on cross-medium refraction interference compensation correction
CN117109594A (en) * 2023-10-23 2023-11-24 北京航空航天大学 Autonomous orientation method based on underwater light intensity gradient

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20080088842A1 (en) * 2006-10-13 2008-04-17 Howard Schultz System and method for imaging through an irregular water surface
CN105181145A (en) * 2015-11-13 2015-12-23 北京航空航天大学 Method for simulating underwater polarization field of wave water surface transmitted light
CN111027231A (en) * 2019-12-29 2020-04-17 杭州科洛码光电科技有限公司 Underwater array camera imaging method
CN111220150A (en) * 2019-12-09 2020-06-02 北京航空航天大学 Sun vector calculation method based on underwater polarization distribution mode
CN111854957A (en) * 2020-07-21 2020-10-30 北京航空航天大学 Underwater polarization autonomous orientation method based on underwater light intensity interference model
CN112419410A (en) * 2020-11-20 2021-02-26 北京航空航天大学 Horizontal attitude determination method based on underwater Snell window edge identification
CN112461191A (en) * 2020-11-20 2021-03-09 北京航空航天大学 Sun height calculating method based on underwater refraction and scattering coupling polarization degree
WO2022022975A1 (en) * 2020-07-30 2022-02-03 Orphie Method and device for underwater imaging

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20080088842A1 (en) * 2006-10-13 2008-04-17 Howard Schultz System and method for imaging through an irregular water surface
CN105181145A (en) * 2015-11-13 2015-12-23 北京航空航天大学 Method for simulating underwater polarization field of wave water surface transmitted light
CN111220150A (en) * 2019-12-09 2020-06-02 北京航空航天大学 Sun vector calculation method based on underwater polarization distribution mode
CN111027231A (en) * 2019-12-29 2020-04-17 杭州科洛码光电科技有限公司 Underwater array camera imaging method
CN111854957A (en) * 2020-07-21 2020-10-30 北京航空航天大学 Underwater polarization autonomous orientation method based on underwater light intensity interference model
WO2022022975A1 (en) * 2020-07-30 2022-02-03 Orphie Method and device for underwater imaging
CN112419410A (en) * 2020-11-20 2021-02-26 北京航空航天大学 Horizontal attitude determination method based on underwater Snell window edge identification
CN112461191A (en) * 2020-11-20 2021-03-09 北京航空航天大学 Sun height calculating method based on underwater refraction and scattering coupling polarization degree

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
HAOYUAN CHENG 等,: ""Underwater polarization patterns considering single Rayleigh scattering of water molecules"", 《INTERNATIONAL JOURNAL OF REMOTE SENSING》 *
PENGWEI HU 等,: ""Solar-tracking methodology based on refraction-polarization in Snell’s window for underwater navigation"", 《CHINESE JOURNAL OF AERONAUTICS》 *
叶春明,: ""水下对空成像中的波面估计"", 《光学与光电技术》 *
褚金奎 等,: ""天空光主导的波浪水面下偏振分布模型仿真"", 《光学学报》 *

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116222580A (en) * 2023-05-09 2023-06-06 北京航空航天大学 Underwater polarization orientation method based on cross-medium refraction interference compensation correction
CN117109594A (en) * 2023-10-23 2023-11-24 北京航空航天大学 Autonomous orientation method based on underwater light intensity gradient
CN117109594B (en) * 2023-10-23 2024-01-05 北京航空航天大学 Autonomous orientation method based on underwater light intensity gradient

Also Published As

Publication number Publication date
CN114877898B (en) 2022-10-18

Similar Documents

Publication Publication Date Title
CN114877898B (en) Sun dynamic tracking method based on underwater polarization attitude and refraction coupling inversion
US9285460B2 (en) Method and system for estimating information related to a vehicle pitch and/or roll angle
US8249302B2 (en) Method for determining a location from images acquired of an environment with an omni-directional camera
US8639035B2 (en) Pose estimation
CN111220150B (en) Sun vector calculation method based on underwater polarization distribution mode
US20160071276A1 (en) System and method for determining geo-location(s) in images
CN107063170B (en) Course angle estimation method based on atmospheric polarization angle mould formula under complex environment
US8098280B2 (en) Moving object locating device, moving object locating method, and computer product
US9453731B2 (en) System and method for determining orientation relative to earth
CN114910080B (en) Three-dimensional navigation attitude determination method based on underwater downlink radiation light intensity and polarized light field
Grelsson et al. Highly accurate attitude estimation via horizon detection
CN111307140B (en) Atmospheric polarized light orientation method used under cloudy weather condition
CN113819904B (en) polarization/VIO three-dimensional attitude determination method based on zenith vector
CN114937075B (en) Underwater polarized light field autonomous orientation method based on three-dimensional solar meridian plane fitting
CN114894197B (en) Underwater polarization autonomous course calculation method based on zenith real-time tracking
CN110211148B (en) Underwater image pre-segmentation method based on target state estimation
Bailey et al. Determining large scale sandbar behaviour
CN112419410B (en) Horizontal attitude determination method based on underwater Snell window edge identification
CN112085751B (en) Cloud layer height estimation method based on cloud image shadow matching algorithm
CN115164900A (en) Omnidirectional camera based visual aided navigation method and system in urban environment
CN115082811A (en) Method for identifying and measuring distance of marine navigation ship according to image data
Li et al. Adaptively robust filtering algorithm for maritime celestial navigation
CN117911282B (en) Construction method and application of image defogging model
CN117109594B (en) Autonomous orientation method based on underwater light intensity gradient
Ji et al. Cnn-augmented visual-inertial slam with planar constraints

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant