CN114608564B - A combined positioning method based on night moonlight polarization-starlight information fusion - Google Patents

A combined positioning method based on night moonlight polarization-starlight information fusion Download PDF

Info

Publication number
CN114608564B
CN114608564B CN202210507489.6A CN202210507489A CN114608564B CN 114608564 B CN114608564 B CN 114608564B CN 202210507489 A CN202210507489 A CN 202210507489A CN 114608564 B CN114608564 B CN 114608564B
Authority
CN
China
Prior art keywords
vector
polarization
moon
earth
starlight
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.)
Active
Application number
CN202210507489.6A
Other languages
Chinese (zh)
Other versions
CN114608564A (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 CN202210507489.6A priority Critical patent/CN114608564B/en
Publication of CN114608564A publication Critical patent/CN114608564A/en
Application granted granted Critical
Publication of CN114608564B publication Critical patent/CN114608564B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/02—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by astronomical means
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20—Instruments for performing navigational calculations

Landscapes

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

Abstract

本发明涉及一种基于夜间月光偏振‑星光信息融合的组合定位方法，首先，利用偏振传感器获取偏振矢量信息，利用星敏感器获得星光矢量信息，根据二者计算月亮矢量和星光矢量之间的夹角；其次，通过天体几何位置关系，建立上一步中得到的夹角和由观测者位置O指向月亮点M的矢量之间的关系，求出该矢量的最优解；再次，通过所求最优解，根据地球椭球体方程和以最优解为方向且过月亮点的直线方程，计算地球与该直线的交点坐标；最后，根据交点坐标计算观测者所在位置的经度、纬度值。本发明通过将夜间天空偏振信息和星光信息相结合，解决大气层内无人系统的自主定位问题。

Figure 202210507489

The invention relates to a combined positioning method based on moonlight polarization-starlight information fusion at night. First, a polarization sensor is used to obtain polarization vector information, a star sensor is used to obtain starlight vector information, and the clip between the moon vector and the starlight vector is calculated according to the two. Secondly, through the geometrical position relationship of the celestial body, establish the relationship between the angle obtained in the previous step and the vector pointing from the observer position O to the moon point M, and obtain the optimal solution of the vector; For the optimal solution, calculate the coordinates of the intersection point between the earth and the line according to the equation of the earth ellipsoid and the line equation with the optimal solution as the direction and the bright point of the moon; finally, calculate the longitude and latitude of the observer's location according to the intersection coordinates. The invention solves the problem of autonomous positioning of the unmanned system in the atmosphere by combining the nighttime sky polarization information and starlight information.

Figure 202210507489

Description

一种基于夜间月光偏振-星光信息融合的组合定位方法A combined positioning method based on night moonlight polarization-starlight information fusion

技术领域technical field

本发明属于无人系统自主定位领域，具体涉及一种基于夜间月光偏振-星光信息融合的组合定位方法。The invention belongs to the field of autonomous positioning of unmanned systems, in particular to a combined positioning method based on moonlight polarization-starlight information fusion at night.

背景技术Background technique

夜间环境具有能见度低、可视性差的特点，具备夜间导航能力对于无人系统完成任务有着重要的意义。针对夜间陌生的导航环境，单一的导航方式都存在各自的局限性，因此，在实际应用中常采用多种手段组合进行导航。惯性、天文和卫星的组合模式是目前常用的导航方法。但是，惯导存在误差积累，卫星导航在城市建筑区域或电磁干扰环境下容易失效。天文导航是常用的自主导航手段，基于星光信息的天文导航常采用星敏感器作为测量仪器，具有高精度的优点。但由于星光距离地球很远，而地球上载体的运动又不足以改变星矢量的指向，因此，星敏感器需要结合其他导航方式进行组合。而现有的惯性/天文组合定位又会受到惯导所提供的水平基准的精度限制，随着惯导误差的积累，定位精度也会逐渐下降。The nighttime environment has the characteristics of low visibility and poor visibility. Having the ability to navigate at night is of great significance for the unmanned system to complete the task. For the unfamiliar navigation environment at night, a single navigation method has its own limitations. Therefore, a combination of various means is often used for navigation in practical applications. The combined mode of inertial, astronomical and satellite is the most commonly used navigation method at present. However, there is an accumulation of errors in inertial navigation, and satellite navigation is easy to fail in urban construction areas or in electromagnetic interference environments. Astronomical navigation is a commonly used autonomous navigation method. Astronomical navigation based on starlight information often uses star sensors as measuring instruments, which has the advantage of high precision. However, since the starlight is far away from the earth, and the motion of the carrier on the earth is not enough to change the direction of the star vector, the star sensor needs to be combined with other navigation methods. However, the existing inertial/astronomical combined positioning will be limited by the accuracy of the horizontal reference provided by the inertial navigation. With the accumulation of inertial navigation errors, the positioning accuracy will gradually decrease.

偏振光导航也是一种基于天空信息的导航方法，具有隐蔽性好，误差不随时间积累，不易受到外界干扰的优点。不同于遥远的星光，夜间的偏振光由地球的近天体——月亮产生。因此，由月光形成的天空偏振信息和星光信息之间的夹角会随着载体在地球上观测位置的不同而改变，这一夹角可以直接由偏振传感器和星敏感器测得，不依赖于载体先验姿态信息，因此，通过结合夜间偏振光和星光的信息特点，可实现大气层内夜间环境下不依赖于惯导姿态平台的自主定位方法，在卫星信号失效条件下，仍提供高精度的位置信息。Polarized light navigation is also a navigation method based on sky information. Unlike distant starlight, polarized light at night is produced by Earth's nearest celestial body, the Moon. Therefore, the angle between the sky polarization information formed by the moonlight and the starlight information will change with the observation position of the carrier on the earth. This angle can be directly measured by the polarization sensor and the star sensor, and does not depend on The carrier has prior attitude information. Therefore, by combining the information characteristics of polarized light and starlight at night, an autonomous positioning method that does not rely on the inertial navigation attitude platform in the night environment in the atmosphere can be realized. Under the condition of satellite signal failure, it can still provide high-precision location information.

现有组合定位方法，如论文“一种基于 INS/GPS/CNS的全信息导航滤波算法”利用了GPS的信息，系统抗干扰能力较弱，自主性差；而基于偏振和星光信息的组合定位方法，如已授权的中国发明专利“一种基于偏振/天文辅助的自主导航定位方法(ZL201911250913.8)”利用了惯导系统提供的姿态平台，定位结果会受到惯导精度的限制。Existing combined positioning methods, such as the paper "A Full Information Navigation Filtering Algorithm Based on INS/GPS/CNS" use GPS information, the system has weak anti-interference ability and poor autonomy; while the combined positioning method based on polarization and starlight information , such as the authorized Chinese invention patent "An autonomous navigation and positioning method based on polarization/astronomical assistance (ZL201911250913.8)" using the attitude platform provided by the inertial navigation system, the positioning result will be limited by the inertial navigation accuracy.

发明内容SUMMARY OF THE INVENTION

考虑现有技术存在的问题，本发明提出一种基于夜间月光偏振-星光信息融合的组合定位方法，该方法通过将夜间天空偏振信息和星光信息相结合，解决大气层内无人系统的自主定位问题。Considering the problems existing in the prior art, the present invention proposes a combined positioning method based on nighttime moonlight polarization-starlight information fusion, which solves the problem of autonomous positioning of unmanned systems in the atmosphere by combining nighttime sky polarization information and starlight information .

为达到上述目的，本发明采用的技术方案为：To achieve the above object, the technical scheme adopted in the present invention is:

一种基于夜间月光偏振-星光信息融合的组合定位方法，包括如下步骤：A combined positioning method based on nighttime moonlight polarization-starlight information fusion, comprising the following steps:

（1）利用偏振传感器获取两个不同观测方向上被观测天空点的偏振矢量

Figure 125391DEST_PATH_IMAGE001
，
Figure 898175DEST_PATH_IMAGE002
，利用星敏感器获得星光矢量
Figure 235616DEST_PATH_IMAGE003
，其中，k表示第k个星光矢量，b表示载体坐标系，由于偏振 矢量
Figure 144666DEST_PATH_IMAGE001
，
Figure 10991DEST_PATH_IMAGE002
和月亮矢量之间存在垂直关系，因此，获得月亮矢量和星光矢量之间的夹角
Figure 271071DEST_PATH_IMAGE004
； (1) Use the polarization sensor to obtain the polarization vector of the observed sky point in two different observation directions
Figure 125391DEST_PATH_IMAGE001
,
Figure 898175DEST_PATH_IMAGE002
, using the star sensor to obtain the star vector
Figure 235616DEST_PATH_IMAGE003
, where k represents the k -th star light vector, and b represents the carrier coordinate system, since the polarization vector
Figure 144666DEST_PATH_IMAGE001
,
Figure 10991DEST_PATH_IMAGE002
There is a vertical relationship between the moon vector and the moon vector, so the angle between the moon vector and the star vector is obtained
Figure 271071DEST_PATH_IMAGE004
;

（2）通过天体几何位置关系，建立上一步中得到的夹角

Figure 146623DEST_PATH_IMAGE004
和由观测者位置O指向 月亮点M的矢量
Figure 113442DEST_PATH_IMAGE005
的关系。根据地球系下的星光矢量
Figure 681826DEST_PATH_IMAGE006
和夹角
Figure 366886DEST_PATH_IMAGE004
，定义矢量
Figure 46129DEST_PATH_IMAGE005
的优 化问题，并求出该问题的最优解
Figure 133033DEST_PATH_IMAGE007
；其中，所述地球系为e系； (2) Through the geometric position relationship of the celestial body, establish the included angle obtained in the previous step
Figure 146623DEST_PATH_IMAGE004
and the vector pointing from the observer position O to the point M of the moon
Figure 113442DEST_PATH_IMAGE005
Relationship. According to the starlight vector under the earth system
Figure 681826DEST_PATH_IMAGE006
and angle
Figure 366886DEST_PATH_IMAGE004
, the definition vector
Figure 46129DEST_PATH_IMAGE005
optimization problem and find the optimal solution to the problem
Figure 133033DEST_PATH_IMAGE007
; Wherein, the earth system is e system;

（3）通过上一步得到的最优解

Figure 606740DEST_PATH_IMAGE007
，根据地球椭球体方程和以最优解
Figure 841412DEST_PATH_IMAGE007
为方向 且过观测者位置O、月亮点M的直线OM的直线方程，计算地球与直线OM的交点
Figure 262029DEST_PATH_IMAGE008
的坐标
Figure 265758DEST_PATH_IMAGE009
，其中，
Figure 910365DEST_PATH_IMAGE010
表示交点
Figure 570017DEST_PATH_IMAGE008
在e系下的三维坐标值； (3) The optimal solution obtained by the previous step
Figure 606740DEST_PATH_IMAGE007
, according to the Earth ellipsoid equation and the optimal solution
Figure 841412DEST_PATH_IMAGE007
is the straight line equation of the straight line OM with the direction and passing through the observer's position O and the moon point M, and calculates the intersection of the earth and the straight line OM
Figure 262029DEST_PATH_IMAGE008
coordinate of
Figure 265758DEST_PATH_IMAGE009
,in,
Figure 910365DEST_PATH_IMAGE010
Indicates the intersection
Figure 570017DEST_PATH_IMAGE008
The three-dimensional coordinate value in the e system;

（4）根据交点

Figure 591063DEST_PATH_IMAGE008
的坐标
Figure 652559DEST_PATH_IMAGE009
计算观测者位置的经度、纬度 值
Figure 468069DEST_PATH_IMAGE011
、
Figure 615016DEST_PATH_IMAGE012
。 (4) According to the intersection point
Figure 591063DEST_PATH_IMAGE008
coordinate of
Figure 652559DEST_PATH_IMAGE009
Calculate the longitude and latitude values of the observer's location
Figure 468069DEST_PATH_IMAGE011
,
Figure 615016DEST_PATH_IMAGE012
.

进一步地，所述步骤（1）中，所述夹角

Figure 439753DEST_PATH_IMAGE004
，表示为： Further, in the step (1), the included angle
Figure 439753DEST_PATH_IMAGE004
,Expressed as:

Figure 355756DEST_PATH_IMAGE013
Figure 355756DEST_PATH_IMAGE013

其中，夹角

Figure 345096DEST_PATH_IMAGE004
的取值范围为[0°,180°]。 Among them, the angle
Figure 345096DEST_PATH_IMAGE004
The value range of is [0°, 180°].

进一步地，所述步骤（2）中，通过天体几何位置关系，建立e系下的夹角

Figure 776078DEST_PATH_IMAGE004
和由观 测者位置O指向月亮点M的矢量
Figure 76609DEST_PATH_IMAGE005
的关系如下： Further, in the step (2), the included angle under the e system is established through the geometrical position relationship of the celestial body
Figure 776078DEST_PATH_IMAGE004
and the vector pointing from the observer position O to the point M of the moon
Figure 76609DEST_PATH_IMAGE005
The relationship is as follows:

Figure 175015DEST_PATH_IMAGE014
Figure 175015DEST_PATH_IMAGE014

其中，

Figure 535589DEST_PATH_IMAGE015
为e系下的星光矢量，根据天文年历求取； in,
Figure 535589DEST_PATH_IMAGE015
is the starlight vector in the e system, obtained according to the astronomical calendar;

为了求解矢量

Figure 453867DEST_PATH_IMAGE005
，定义优化问题为： In order to solve the vector
Figure 453867DEST_PATH_IMAGE005
, the optimization problem is defined as:

Figure 558089DEST_PATH_IMAGE016
Figure 558089DEST_PATH_IMAGE016

其中，J为目标函数，

Figure 511002DEST_PATH_IMAGE017
矩阵和
Figure 42477DEST_PATH_IMAGE018
矩阵的具体表示如下： Among them, J is the objective function,
Figure 511002DEST_PATH_IMAGE017
matrix and
Figure 42477DEST_PATH_IMAGE018
The specific representation of the matrix is as follows:

Figure 448051DEST_PATH_IMAGE019
Figure 448051DEST_PATH_IMAGE019

在上式中，

Figure 887122DEST_PATH_IMAGE020
为当k=1,2,…,n时对应的
Figure 632224DEST_PATH_IMAGE021
值，
Figure 396918DEST_PATH_IMAGE022
为当k=1,2,…,n时对应的
Figure 227471DEST_PATH_IMAGE004
值，
Figure 735812DEST_PATH_IMAGE023
分别表示n×3和n ×1维的实数集，将
Figure 335421DEST_PATH_IMAGE005
记为
Figure 271016DEST_PATH_IMAGE024
，则当拉格朗日乘子
Figure 588865DEST_PATH_IMAGE025
满足如下关系式时： In the above formula,
Figure 887122DEST_PATH_IMAGE020
is the corresponding when k= 1,2,…,n
Figure 632224DEST_PATH_IMAGE021
value,
Figure 396918DEST_PATH_IMAGE022
is the corresponding when k= 1,2,…,n
Figure 227471DEST_PATH_IMAGE004
value,
Figure 735812DEST_PATH_IMAGE023
Representing the set of real numbers of n×3 and n×1 dimensions, respectively, we will
Figure 335421DEST_PATH_IMAGE005
marked as
Figure 271016DEST_PATH_IMAGE024
, then when the Lagrange multiplier
Figure 588865DEST_PATH_IMAGE025
When the following relationship is satisfied:

Figure 635318DEST_PATH_IMAGE026
Figure 635318DEST_PATH_IMAGE026

其中，I为单位矩阵；Among them, I is the identity matrix;

优化问题的最优解如下：The optimal solution to the optimization problem is as follows:

Figure 151750DEST_PATH_IMAGE027
Figure 151750DEST_PATH_IMAGE027

求解方程

Figure 195930DEST_PATH_IMAGE028
，并挑选出其中对应目标函数J最小的解，记为
Figure 63392DEST_PATH_IMAGE029
，进而得 到优化问题最优解
Figure 851219DEST_PATH_IMAGE007
。 Solve the equation
Figure 195930DEST_PATH_IMAGE028
, and select the solution with the smallest corresponding objective function J , denoted as
Figure 63392DEST_PATH_IMAGE029
, and then obtain the optimal solution of the optimization problem
Figure 851219DEST_PATH_IMAGE007
.

进一步地，所述步骤（3）中，所述直线OM的直线方程表示为：Further, in the step (3), the straight line equation of the straight line OM is expressed as:

Figure 487737DEST_PATH_IMAGE030
Figure 487737DEST_PATH_IMAGE030

其中，

Figure 702817DEST_PATH_IMAGE031
代表OM直线上的任意点，
Figure 57575DEST_PATH_IMAGE032
代表该点的 三维坐标值，
Figure 383514DEST_PATH_IMAGE033
代表直线方程的参数，
Figure 874539DEST_PATH_IMAGE034
代表月亮位置，根据天文年历求取； in,
Figure 702817DEST_PATH_IMAGE031
represents any point on the OM line,
Figure 57575DEST_PATH_IMAGE032
represents the three-dimensional coordinate value of the point,
Figure 383514DEST_PATH_IMAGE033
the parameters representing the equation of the line,
Figure 874539DEST_PATH_IMAGE034
Represents the position of the moon, obtained according to the astronomical calendar;

上式定义了以最优解

Figure 526100DEST_PATH_IMAGE007
为方向向量且过月亮位置
Figure 839925DEST_PATH_IMAGE034
的直线，将地球椭球方程 与该直线方程联立，求解得到观测者位置，即直线与地球的交点
Figure 31872DEST_PATH_IMAGE035
，假设
Figure 580665DEST_PATH_IMAGE036
并且
Figure 199865DEST_PATH_IMAGE037
，其中，
Figure 201319DEST_PATH_IMAGE038
表示月亮位置
Figure 196957DEST_PATH_IMAGE034
在e系下的三维坐标值，m,n,p表示最优解
Figure 600257DEST_PATH_IMAGE007
在e系下的三维坐标值。那么交点
Figure 390358DEST_PATH_IMAGE039
由上述直线方程求出，其中直线方程的参数t计算如下：The above formula defines the optimal solution
Figure 526100DEST_PATH_IMAGE007
is the direction vector and passes the position of the moon
Figure 839925DEST_PATH_IMAGE034
The straight line of the ellipsoid of the earth is combined with the equation of the straight line, and the position of the observer is obtained by solving it, that is, the intersection of the straight line and the earth
Figure 31872DEST_PATH_IMAGE035
, assuming
Figure 580665DEST_PATH_IMAGE036
and
Figure 199865DEST_PATH_IMAGE037
,in,
Figure 201319DEST_PATH_IMAGE038
Indicates the position of the moon
Figure 196957DEST_PATH_IMAGE034
The three-dimensional coordinate value under the e system, m, n, p represent the optimal solution
Figure 600257DEST_PATH_IMAGE007
The three-dimensional coordinate value in the e system. then the intersection
Figure 390358DEST_PATH_IMAGE039
It is obtained from the above straight line equation, where the parameter t of the straight line equation is calculated as follows:

Figure 879108DEST_PATH_IMAGE040
Figure 879108DEST_PATH_IMAGE040

其中，

Figure 412858DEST_PATH_IMAGE041
和
Figure 670664DEST_PATH_IMAGE042
分别为椭球长半轴和短半轴，根据地球标准模型获得；上述计算 结果包含两个交点，其中绝对值更小的直线方程的参数t对应的结果为待求的观测者位置， 即交点
Figure 897246DEST_PATH_IMAGE035
。 in,
Figure 412858DEST_PATH_IMAGE041
and
Figure 670664DEST_PATH_IMAGE042
are the semi-major axis and semi-minor axis of the ellipsoid, respectively, and are obtained according to the standard model of the earth; the above calculation results include two intersection points, of which the result corresponding to the parameter t of the linear equation with a smaller absolute value is the position of the observer to be determined, that is, the intersection point
Figure 897246DEST_PATH_IMAGE035
.

进一步地，所述步骤（4）中，根据上一步得到的交点坐标

Figure 873292DEST_PATH_IMAGE039
计算观测者位置的经纬度，计算公式为： Further, in the step (4), according to the intersection coordinates obtained in the previous step
Figure 873292DEST_PATH_IMAGE039
Calculate the latitude and longitude of the observer's location, the calculation formula is:

Figure 679574DEST_PATH_IMAGE043
Figure 679574DEST_PATH_IMAGE043

其中，e f 为地球椭球偏心率，根据地球标准模型获得；

Figure 119783DEST_PATH_IMAGE044
是观测者位置的经 度、纬度。 Among them, e f is the eccentricity of the earth ellipsoid, obtained according to the standard model of the earth;
Figure 119783DEST_PATH_IMAGE044
are the longitude and latitude of the observer's location.

本发明与现有技术相比优点在于：Compared with the prior art, the present invention has the following advantages:

（1）本发明与现有基于偏振/星光信息的定位方法相比，不依赖于先验姿态信息，不受惯导精度的限制。(1) Compared with the existing positioning methods based on polarization/starlight information, the present invention does not rely on prior attitude information and is not limited by the precision of inertial navigation.

（2）本发明所设计组合方式在大气层内夜间陌生环境中具有较强的适用性，可作为卫星信号失效条件下的一种有效的自主定位手段。(2) The combination method designed in the present invention has strong applicability in the unfamiliar environment at night in the atmosphere, and can be used as an effective autonomous positioning method under the condition of satellite signal failure.

（3）本发明可用于无人机、无人船、无人车等无人系统的位置获取，提高无人系统在无卫星信号下的自主导航能力。(3) The present invention can be used for position acquisition of unmanned systems such as unmanned aerial vehicles, unmanned ships, and unmanned vehicles, and improves the autonomous navigation capability of unmanned systems without satellite signals.

附图说明Description of drawings

图1为本发明的基于夜间月光偏振-星光信息融合的组合定位方法流程图；Fig. 1 is the flow chart of the combined positioning method based on night moonlight polarization-starlight information fusion of the present invention;

图2为本发明的定位原理示意图。FIG. 2 is a schematic diagram of the positioning principle of the present invention.

具体实施方式Detailed ways

为了使本发明的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对本发明进行进一步详细说明。应当理解，此处所描述的具体实施例仅仅用以解释本发明，并不用于限定本发明。此外，下面所描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。In order to make the objectives, technical solutions and advantages of the present invention clearer, the present invention will be further described in detail below with reference to the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are only used to explain the present invention, but not to limit the present invention. In addition, the technical features involved in the various embodiments of the present invention described below can be combined with each other as long as they do not conflict with each other.

如图1所示，本发明的基于夜间月光偏振-星光信息融合的组合定位方法的具体实现步骤如下：As shown in Figure 1, the specific implementation steps of the combined positioning method based on nighttime moonlight polarization-starlight information fusion of the present invention are as follows:

步骤1、利用偏振传感器获取两个不同观测方向上被观测天空点的偏振矢量

Figure 715029DEST_PATH_IMAGE001
，
Figure 528264DEST_PATH_IMAGE002
，利用星敏感器获得星光矢量
Figure 822979DEST_PATH_IMAGE003
，其中，k表示第k个星光矢量，b表示载体坐标系，由于 偏振矢量
Figure 329047DEST_PATH_IMAGE001
，
Figure 76423DEST_PATH_IMAGE002
和月亮矢量之间存在垂直关系，因此，获得月亮矢量和星光矢量之间的 夹角
Figure 693349DEST_PATH_IMAGE004
： Step 1. Use the polarization sensor to obtain the polarization vector of the observed sky point in two different observation directions
Figure 715029DEST_PATH_IMAGE001
,
Figure 528264DEST_PATH_IMAGE002
, using the star sensor to obtain the star vector
Figure 822979DEST_PATH_IMAGE003
, where k represents the k -th star light vector, and b represents the carrier coordinate system, since the polarization vector
Figure 329047DEST_PATH_IMAGE001
,
Figure 76423DEST_PATH_IMAGE002
There is a vertical relationship between the moon vector and the moon vector, so the angle between the moon vector and the star vector is obtained
Figure 693349DEST_PATH_IMAGE004
:

Figure 842571DEST_PATH_IMAGE046
（1）
Figure 842571DEST_PATH_IMAGE046
(1)

其中，夹角

Figure 519540DEST_PATH_IMAGE004
的取值范围为[0°,180°]。 Among them, the angle
Figure 519540DEST_PATH_IMAGE004
The value range of is [0°, 180°].

步骤2、通过天体几何位置关系，如图2所示，图中

Figure 754212DEST_PATH_IMAGE047
在b系下的表示即为上 述步骤中的
Figure 909250DEST_PATH_IMAGE001
，
Figure 178557DEST_PATH_IMAGE002
，图中
Figure 26428DEST_PATH_IMAGE048
表示星光矢量，其在地球系（e系）和b系下的表示分别为
Figure 748396DEST_PATH_IMAGE049
和
Figure 707125DEST_PATH_IMAGE050
，图中E表示地球球心，P it 表示观测者位置的三维坐标；建立e系下夹角
Figure 290991DEST_PATH_IMAGE004
和由观测 者位置O指向月亮点M的矢量
Figure 372079DEST_PATH_IMAGE005
的关系如下： Step 2. Through the geometric position relationship of the celestial body, as shown in Figure 2, in the figure
Figure 754212DEST_PATH_IMAGE047
The representation under the b series is the one in the above steps
Figure 909250DEST_PATH_IMAGE001
,
Figure 178557DEST_PATH_IMAGE002
, Fig.
Figure 26428DEST_PATH_IMAGE048
represents the starlight vector, and its representations in the earth system ( e system) and b system are respectively
Figure 748396DEST_PATH_IMAGE049
and
Figure 707125DEST_PATH_IMAGE050
, E in the figure represents the center of the earth, P it represents the three-dimensional coordinates of the observer's position; establish the angle under the e system
Figure 290991DEST_PATH_IMAGE004
and the vector pointing from the observer position O to the point M of the moon
Figure 372079DEST_PATH_IMAGE005
The relationship is as follows:

Figure 519027DEST_PATH_IMAGE051
（2）
Figure 519027DEST_PATH_IMAGE051
(2)

其中，

Figure 343764DEST_PATH_IMAGE005
为图2中矢量
Figure 259767DEST_PATH_IMAGE052
在e系下的表示，
Figure 246178DEST_PATH_IMAGE049
为e系下的星光矢量，根据天文 年历求取； in,
Figure 343764DEST_PATH_IMAGE005
is the vector in Figure 2
Figure 259767DEST_PATH_IMAGE052
Representation under e -series,
Figure 246178DEST_PATH_IMAGE049
is the starlight vector in the e system, obtained according to the astronomical calendar;

为了求解矢量

Figure 880421DEST_PATH_IMAGE005
，定义优化问题为： In order to solve the vector
Figure 880421DEST_PATH_IMAGE005
, the optimization problem is defined as:

Figure 243269DEST_PATH_IMAGE053
（3）
Figure 243269DEST_PATH_IMAGE053
(3)

其中，J为目标函数，

Figure 279359DEST_PATH_IMAGE017
矩阵和
Figure 436670DEST_PATH_IMAGE018
矩阵的具体表示如下：Among them, J is the objective function,
Figure 279359DEST_PATH_IMAGE017
matrix and
Figure 436670DEST_PATH_IMAGE018
The specific representation of the matrix is as follows:

Figure 354948DEST_PATH_IMAGE054
Figure 354948DEST_PATH_IMAGE054

在上式中，

Figure 459170DEST_PATH_IMAGE020
为当k=1,2,…,n时对应的
Figure 146503DEST_PATH_IMAGE021
值，
Figure 677979DEST_PATH_IMAGE022
为当k=1,2,…,n时对应的
Figure 83552DEST_PATH_IMAGE004
值，
Figure 991466DEST_PATH_IMAGE023
分别表示n×3和n ×1维的实数集，将公式(3)二范数展开，并将
Figure 798885DEST_PATH_IMAGE005
记为
Figure 501261DEST_PATH_IMAGE024
，则这一优化问题可以表示为： In the above formula,
Figure 459170DEST_PATH_IMAGE020
is the corresponding when k= 1,2,…,n
Figure 146503DEST_PATH_IMAGE021
value,
Figure 677979DEST_PATH_IMAGE022
is the corresponding when k= 1,2,…,n
Figure 83552DEST_PATH_IMAGE004
value,
Figure 991466DEST_PATH_IMAGE023
respectively represent n×3 and n×1-dimensional real number sets, expand the two-norm of formula (3), and put
Figure 798885DEST_PATH_IMAGE005
marked as
Figure 501261DEST_PATH_IMAGE024
, then this optimization problem can be expressed as:

Figure 394131DEST_PATH_IMAGE055
（4）
Figure 394131DEST_PATH_IMAGE055
(4)

该优化问题的最优性条件如下：The optimality conditions for this optimization problem are as follows:

Figure 840156DEST_PATH_IMAGE056
（5）
Figure 840156DEST_PATH_IMAGE056
(5)

其中，

Figure 502081DEST_PATH_IMAGE057
表示0向量，维度为3×1，I为单位矩阵。则当拉格朗日乘子
Figure 172097DEST_PATH_IMAGE025
满足如下 关系式时： in,
Figure 502081DEST_PATH_IMAGE057
Represents a 0 vector with a dimension of 3×1, and I is the identity matrix. then when the Lagrange multiplier
Figure 172097DEST_PATH_IMAGE025
When the following relationship is satisfied:

Figure 489946DEST_PATH_IMAGE026
(6)
Figure 489946DEST_PATH_IMAGE026
(6)

优化问题的最优解如下：The optimal solution to the optimization problem is as follows:

Figure 536399DEST_PATH_IMAGE027
(7)
Figure 536399DEST_PATH_IMAGE027
(7)

为了求解作为未知数的拉格朗日乘子

Figure 256094DEST_PATH_IMAGE025
，令矩阵
Figure 362590DEST_PATH_IMAGE058
以及
Figure 167735DEST_PATH_IMAGE059
，P可以分解为
Figure 17879DEST_PATH_IMAGE060
，其中
Figure 592080DEST_PATH_IMAGE061
为正交矩阵，
Figure 872407DEST_PATH_IMAGE062
表示3 ×3的实数集，
Figure 899269DEST_PATH_IMAGE063
是以矩阵P的特征值
Figure 553104DEST_PATH_IMAGE064
为对角线元素的对角阵。进一步，将
Figure 981812DEST_PATH_IMAGE065
的表示代入公式(6)，可将
Figure 430111DEST_PATH_IMAGE066
转换为： To solve for Lagrange multipliers as unknowns
Figure 256094DEST_PATH_IMAGE025
, let the matrix
Figure 362590DEST_PATH_IMAGE058
as well as
Figure 167735DEST_PATH_IMAGE059
, P can be decomposed into
Figure 17879DEST_PATH_IMAGE060
,in
Figure 592080DEST_PATH_IMAGE061
is an orthogonal matrix,
Figure 872407DEST_PATH_IMAGE062
represents the set of 3 × 3 real numbers,
Figure 899269DEST_PATH_IMAGE063
is the eigenvalue of the matrix P
Figure 553104DEST_PATH_IMAGE064
is a diagonal matrix of diagonal elements. Further, will
Figure 981812DEST_PATH_IMAGE065
Substitute the representation of , into formula (6), the
Figure 430111DEST_PATH_IMAGE066
translates to:

Figure 209848DEST_PATH_IMAGE067
(8)
Figure 209848DEST_PATH_IMAGE067
(8)

其中，

Figure 401795DEST_PATH_IMAGE068
代表由Q·q计算得到的向量的第
Figure 481746DEST_PATH_IMAGE069
个元素。 in,
Figure 401795DEST_PATH_IMAGE068
represents the th
Figure 481746DEST_PATH_IMAGE069
elements.

进一步，求解一元方程

Figure 304209DEST_PATH_IMAGE070
，并挑选出其中对应目标函数J最小的解，记 为
Figure 367980DEST_PATH_IMAGE071
。其中，目标函数J和
Figure 301301DEST_PATH_IMAGE072
的关系可以由公式(3)和公式(7)化简得到，表示为： Further, solve the one-variable equation
Figure 304209DEST_PATH_IMAGE070
, and select the solution with the smallest corresponding objective function J , denoted as
Figure 367980DEST_PATH_IMAGE071
. Among them, the objective function J and
Figure 301301DEST_PATH_IMAGE072
The relationship of can be simplified by formula (3) and formula (7), expressed as:

Figure 501338DEST_PATH_IMAGE073
(9)
Figure 501338DEST_PATH_IMAGE073
(9)

其中，

Figure 494702DEST_PATH_IMAGE074
代表由U·B计算得到的向量的第
Figure 45769DEST_PATH_IMAGE075
个元素。
Figure 517201DEST_PATH_IMAGE076
为对A进行SVD 分解得到的正交矩阵。将
Figure 837324DEST_PATH_IMAGE077
代入公式(7)，即可得到优化问题最优解
Figure 1589DEST_PATH_IMAGE007
。 in,
Figure 494702DEST_PATH_IMAGE074
represents the first digit of the vector calculated by U · B
Figure 45769DEST_PATH_IMAGE075
elements.
Figure 517201DEST_PATH_IMAGE076
is the orthogonal matrix obtained by SVD decomposition of A. Will
Figure 837324DEST_PATH_IMAGE077
Substituting into formula (7), the optimal solution of the optimization problem can be obtained
Figure 1589DEST_PATH_IMAGE007
.

步骤3、通过上一步得到的

Figure 774373DEST_PATH_IMAGE007
，计算地球与以
Figure 49497DEST_PATH_IMAGE007
为方向且过月亮点M的直线OM 的交点，OM的直线方程表示为： Step 3, obtained through the previous step
Figure 774373DEST_PATH_IMAGE007
, calculate the earth with the
Figure 49497DEST_PATH_IMAGE007
is the intersection point of the straight line OM with the direction and passing the moon point M, the straight line equation of OM is expressed as:

Figure 489705DEST_PATH_IMAGE030
(10)
Figure 489705DEST_PATH_IMAGE030
(10)

其中，

Figure 356030DEST_PATH_IMAGE031
代表OM直线上的任意点，
Figure 819372DEST_PATH_IMAGE032
代表该点的 三维坐标值，
Figure 429345DEST_PATH_IMAGE078
代表直线方程的参数，
Figure 724060DEST_PATH_IMAGE034
代表月亮位置，可以根据天文年历求取； in,
Figure 356030DEST_PATH_IMAGE031
represents any point on the OM line,
Figure 819372DEST_PATH_IMAGE032
represents the three-dimensional coordinate value of the point,
Figure 429345DEST_PATH_IMAGE078
the parameters representing the equation of the line,
Figure 724060DEST_PATH_IMAGE034
Represents the position of the moon, which can be obtained according to the astronomical calendar;

上式定义了以最优解

Figure 964549DEST_PATH_IMAGE007
为方向向量且过月亮位置
Figure 977504DEST_PATH_IMAGE034
的直线，为求该直线与地 球的交点，需表示出地球方程，地球椭球体的方程描述为： The above formula defines the optimal solution
Figure 964549DEST_PATH_IMAGE007
is the direction vector and passes the position of the moon
Figure 977504DEST_PATH_IMAGE034
In order to find the intersection of the line and the earth, the earth equation needs to be expressed. The equation of the earth ellipsoid is described as:

Figure 594430DEST_PATH_IMAGE079
(11)
Figure 594430DEST_PATH_IMAGE079
(11)

其中，x,y,z代表椭球上任意一点的三维坐标值，

Figure 743652DEST_PATH_IMAGE041
和
Figure 420621DEST_PATH_IMAGE042
分别为椭球长半轴和 短半轴，根据地球标准模型获得；将上面两式联立，求解得到观测者位置的三维坐标，即直 线与地球的交点
Figure 392644DEST_PATH_IMAGE035
的三维坐标，对应图2中
Figure 609998DEST_PATH_IMAGE080
在e系下的表示，假设
Figure 816989DEST_PATH_IMAGE081
并且
Figure 461597DEST_PATH_IMAGE082
，其中，
Figure 121248DEST_PATH_IMAGE083
表示月亮位置
Figure 142294DEST_PATH_IMAGE084
在e系下的三维坐标值，m,n,p表示最优解
Figure 203791DEST_PATH_IMAGE007
在e系下的三维坐标值；那么
Figure 284879DEST_PATH_IMAGE085
的坐标 的计算公式如公式(10)，直线方程的参数t计算如下：Among them, x, y, z represent the three-dimensional coordinate value of any point on the ellipsoid,
Figure 743652DEST_PATH_IMAGE041
and
Figure 420621DEST_PATH_IMAGE042
are the semi-major axis and semi-minor axis of the ellipsoid, respectively, obtained according to the standard model of the earth; by combining the above two equations, the three-dimensional coordinates of the observer's position are obtained, that is, the intersection of the line and the earth
Figure 392644DEST_PATH_IMAGE035
The three-dimensional coordinates of , corresponding to Fig. 2
Figure 609998DEST_PATH_IMAGE080
Representation under the e -series, assuming
Figure 816989DEST_PATH_IMAGE081
and
Figure 461597DEST_PATH_IMAGE082
,in,
Figure 121248DEST_PATH_IMAGE083
Indicates the position of the moon
Figure 142294DEST_PATH_IMAGE084
The three-dimensional coordinate value under the e system, m, n, p represent the optimal solution
Figure 203791DEST_PATH_IMAGE007
The three-dimensional coordinate value in the e system; then
Figure 284879DEST_PATH_IMAGE085
The calculation formula of the coordinates of , is as formula (10), and the parameter t of the straight line equation is calculated as follows:

Figure 431827DEST_PATH_IMAGE086
(12)
Figure 431827DEST_PATH_IMAGE086
(12)

上述计算结果包含两个交点，其中绝对值更小的t对应的结果为待求的观测者位 置，即交点

Figure 990984DEST_PATH_IMAGE085
的三维坐标。 The above calculation result contains two intersection points, of which the result corresponding to t with a smaller absolute value is the position of the observer to be found, that is, the intersection point
Figure 990984DEST_PATH_IMAGE085
three-dimensional coordinates.

步骤4、根据上一步得到的交点坐标

Figure 906988DEST_PATH_IMAGE087
，其中，
Figure 158977DEST_PATH_IMAGE088
表示
Figure 793221DEST_PATH_IMAGE085
在e系下的三维坐标值，计算观测者位置的经纬度，计算公式为： Step 4. According to the intersection coordinates obtained in the previous step
Figure 906988DEST_PATH_IMAGE087
,in,
Figure 158977DEST_PATH_IMAGE088
express
Figure 793221DEST_PATH_IMAGE085
The three-dimensional coordinate value under the e system, calculate the longitude and latitude of the observer's position, and the calculation formula is:

Figure 156069DEST_PATH_IMAGE089
(13)
Figure 156069DEST_PATH_IMAGE089
(13)

其中，e f 为地球椭球偏心率，根据地球标准模型获得；

Figure 926579DEST_PATH_IMAGE011
、
Figure 349470DEST_PATH_IMAGE012
是观测者位置的经度、 纬度。 Among them, e f is the eccentricity of the earth ellipsoid, obtained according to the standard model of the earth;
Figure 926579DEST_PATH_IMAGE011
,
Figure 349470DEST_PATH_IMAGE012
are the longitude and latitude of the observer's location.

本发明说明书中未作详细描述的内容属于本领域专业技术人员的公知技术。本领域的技术人员容易理解，以上所述仅为本发明的较佳实施例而已，并不用以限制本发明，凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等，均应包含在本发明的保护范围之内。The content not described in detail in the specification of the present invention belongs to the well-known technology of those skilled in the art. Those skilled in the art can easily understand that the above are only preferred embodiments of the present invention, and are not intended to limit the present invention. Any modifications, equivalent replacements and improvements made within the spirit and principles of the present invention, etc., All should be included within the protection scope of the present invention.

Claims (4)

1.一种基于夜间月光偏振-星光信息融合的组合定位方法，其特征在于，包括如下步骤：1. a combined positioning method based on nighttime moonlight polarization-starlight information fusion, is characterized in that, comprises the steps: （1）利用偏振传感器获取两个不同观测方向上被观测天空点的偏振矢量
Figure RE-196707DEST_PATH_IMAGE001
，
Figure RE-448434DEST_PATH_IMAGE002
，利用星敏感器获得星光矢量
Figure RE-595382DEST_PATH_IMAGE003
，其中，k表示第k个星光矢量，b表示载体坐标系，由于偏振矢量
Figure RE-357802DEST_PATH_IMAGE001
，
Figure RE-8226DEST_PATH_IMAGE002
和月亮矢量垂直，从而获得月亮矢量和星光矢量之间的夹角
Figure RE-932320DEST_PATH_IMAGE004
；(1) Use the polarization sensor to obtain the polarization vector of the observed sky point in two different observation directions
Figure RE-196707DEST_PATH_IMAGE001
,
Figure RE-448434DEST_PATH_IMAGE002
, using the star sensor to obtain the star vector
Figure RE-595382DEST_PATH_IMAGE003
, where k represents the k -th star light vector, and b represents the carrier coordinate system, since the polarization vector
Figure RE-357802DEST_PATH_IMAGE001
,
Figure RE-8226DEST_PATH_IMAGE002
perpendicular to the moon vector to obtain the angle between the moon vector and the star vector
Figure RE-932320DEST_PATH_IMAGE004
; （2）通过天体几何位置关系，建立上一步中得到的夹角
Figure RE-300984DEST_PATH_IMAGE004
和由观测者位置O指向月亮点M的矢量
Figure RE-601515DEST_PATH_IMAGE005
的关系；根据地球系下的星光矢量
Figure RE-372025DEST_PATH_IMAGE006
和夹角
Figure RE-467020DEST_PATH_IMAGE004
，定义矢量
Figure RE-588560DEST_PATH_IMAGE005
的优化问题，并求出该优化问题的最优解
Figure RE-692782DEST_PATH_IMAGE007
，其中，所述地球系为e系，具体包括：(2) Through the geometric position relationship of the celestial body, establish the included angle obtained in the previous step
Figure RE-300984DEST_PATH_IMAGE004
and the vector pointing from the observer position O to the point M of the moon
Figure RE-601515DEST_PATH_IMAGE005
relationship; according to the starlight vector in the earth system
Figure RE-372025DEST_PATH_IMAGE006
and angle
Figure RE-467020DEST_PATH_IMAGE004
, the definition vector
Figure RE-588560DEST_PATH_IMAGE005
optimization problem, and find the optimal solution of the optimization problem
Figure RE-692782DEST_PATH_IMAGE007
, wherein the earth system is the e system, which specifically includes: 通过天体几何位置关系，建立e系下的夹角
Figure RE-317799DEST_PATH_IMAGE004
和由观测者位置O指向月亮点M的矢量
Figure RE-85160DEST_PATH_IMAGE005
的关系如下：Through the geometric position relationship of celestial bodies, the included angle under the e system is established
Figure RE-317799DEST_PATH_IMAGE004
and the vector pointing from the observer position O to the point M of the moon
Figure RE-85160DEST_PATH_IMAGE005
The relationship is as follows:
Figure RE-428416DEST_PATH_IMAGE008
Figure RE-428416DEST_PATH_IMAGE008
 其中，
Figure RE-336329DEST_PATH_IMAGE009
为e系下的星光矢量，根据天文年历求取；in,
Figure RE-336329DEST_PATH_IMAGE009
is the starlight vector in the e system, obtained according to the astronomical calendar; 为了求解矢量
Figure RE-81432DEST_PATH_IMAGE005
，定义优化问题为：In order to solve the vector
Figure RE-81432DEST_PATH_IMAGE005
, the optimization problem is defined as:
Figure RE-518229DEST_PATH_IMAGE010
Figure RE-518229DEST_PATH_IMAGE010
 其中，J为目标函数，
Figure RE-348782DEST_PATH_IMAGE011
矩阵和
Figure RE-794807DEST_PATH_IMAGE012
矩阵的具体表示如下：Among them, J is the objective function,
Figure RE-348782DEST_PATH_IMAGE011
matrix and
Figure RE-794807DEST_PATH_IMAGE012
The specific representation of the matrix is as follows:
Figure RE-394415DEST_PATH_IMAGE013
Figure RE-394415DEST_PATH_IMAGE013
 在上式中，
Figure RE-267693DEST_PATH_IMAGE014
为当k=1,2,…,n时对应的
Figure RE-319963DEST_PATH_IMAGE015
值，
Figure RE-304100DEST_PATH_IMAGE016
为当k=1,2,…,n时对应的
Figure RE-23794DEST_PATH_IMAGE004
值，
Figure RE-67973DEST_PATH_IMAGE017
分别表示n×3和n×1维的实数集，将
Figure RE-106074DEST_PATH_IMAGE005
记为
Figure RE-893902DEST_PATH_IMAGE018
，则当拉格朗日乘子
Figure RE-468102DEST_PATH_IMAGE019
满足如下关系式时：In the above formula,
Figure RE-267693DEST_PATH_IMAGE014
is the corresponding when k= 1,2,…,n
Figure RE-319963DEST_PATH_IMAGE015
value,
Figure RE-304100DEST_PATH_IMAGE016
is the corresponding when k= 1,2,…,n
Figure RE-23794DEST_PATH_IMAGE004
value,
Figure RE-67973DEST_PATH_IMAGE017
Representing the set of real numbers of n×3 and n×1 dimensions, respectively, the
Figure RE-106074DEST_PATH_IMAGE005
marked as
Figure RE-893902DEST_PATH_IMAGE018
, then when the Lagrange multiplier
Figure RE-468102DEST_PATH_IMAGE019
When the following relationship is satisfied:
Figure RE-683183DEST_PATH_IMAGE020
Figure RE-683183DEST_PATH_IMAGE020
 优化问题的最优解如下：The optimal solution to the optimization problem is as follows:
Figure RE-710045DEST_PATH_IMAGE021
Figure RE-710045DEST_PATH_IMAGE021
 其中，I为单位矩阵；Among them, I is the identity matrix; 求解方程
Figure RE-35984DEST_PATH_IMAGE022
，并挑选出其中对应目标函数J最小的解，记为
Figure RE-464691DEST_PATH_IMAGE023
，进而得到优化问题最优解
Figure RE-850673DEST_PATH_IMAGE007
；Solve the equation
Figure RE-35984DEST_PATH_IMAGE022
, and select the solution with the smallest corresponding objective function J , denoted as
Figure RE-464691DEST_PATH_IMAGE023
, and then obtain the optimal solution of the optimization problem
Figure RE-850673DEST_PATH_IMAGE007
; （3）通过上一步得到的最优解
Figure RE-630410DEST_PATH_IMAGE007
，根据地球椭球体方程和以最优解
Figure RE-760041DEST_PATH_IMAGE007
为方向且过观测者位置O、月亮点M的直线OM的直线方程，计算地球与直线OM的交点
Figure RE-777675DEST_PATH_IMAGE024
的坐标
Figure RE-600138DEST_PATH_IMAGE025
，其中，
Figure RE-601592DEST_PATH_IMAGE026
表示交点
Figure RE-534913DEST_PATH_IMAGE024
在e系下的三维坐标值；(3) The optimal solution obtained by the previous step
Figure RE-630410DEST_PATH_IMAGE007
, according to the Earth ellipsoid equation and the optimal solution
Figure RE-760041DEST_PATH_IMAGE007
is the straight line equation of the straight line OM with the direction and passing through the observer's position O and the moon point M, and calculates the intersection of the earth and the straight line OM
Figure RE-777675DEST_PATH_IMAGE024
coordinate of
Figure RE-600138DEST_PATH_IMAGE025
,in,
Figure RE-601592DEST_PATH_IMAGE026
Indicates the intersection
Figure RE-534913DEST_PATH_IMAGE024
The three-dimensional coordinate value in the e system; （4）根据所述交点
Figure RE-908518DEST_PATH_IMAGE024
的坐标
Figure RE-901882DEST_PATH_IMAGE027
计算观测者位置的经度、纬度值
Figure RE-390632DEST_PATH_IMAGE028
、
Figure RE-862065DEST_PATH_IMAGE029
。(4) According to the intersection point
Figure RE-908518DEST_PATH_IMAGE024
coordinate of
Figure RE-901882DEST_PATH_IMAGE027
Calculate the longitude and latitude values of the observer's location
Figure RE-390632DEST_PATH_IMAGE028
,
Figure RE-862065DEST_PATH_IMAGE029
. 2.根据权利要求1所述的一种基于夜间月光偏振-星光信息融合的组合定位方法，其特征在于：所述步骤（1）中，所述夹角
Figure RE-119871DEST_PATH_IMAGE004
，表示为：2 . A combined positioning method based on nighttime moonlight polarization-starlight information fusion according to claim 1 , wherein: in the step (1), the included angle
Figure RE-119871DEST_PATH_IMAGE004
,Expressed as:
Figure RE-18557DEST_PATH_IMAGE030
Figure RE-18557DEST_PATH_IMAGE030
 其中，夹角
Figure RE-729024DEST_PATH_IMAGE004
的取值范围为[0°,180°]。Among them, the angle
Figure RE-729024DEST_PATH_IMAGE004
The value range of is [0°, 180°]. 3.根据权利要求2所述的一种基于夜间月光偏振-星光信息融合的组合定位方法，其特征在于：所述步骤（3）中，所述直线OM的直线方程表示为：3. A combined positioning method based on nighttime moonlight polarization-starlight information fusion according to claim 2, characterized in that: in the step (3), the straight line equation of the straight line OM is expressed as:
Figure RE-DEST_PATH_IMAGE031
Figure RE-DEST_PATH_IMAGE031
 其中，
Figure RE-738568DEST_PATH_IMAGE032
代表OM直线上的任意点，
Figure RE-DEST_PATH_IMAGE033
代表该点的三维坐标值，t代表直线方程的参数，
Figure RE-319722DEST_PATH_IMAGE036
代表月亮位置，根据天文年历求取；in,
Figure RE-738568DEST_PATH_IMAGE032
represents any point on the OM line,
Figure RE-DEST_PATH_IMAGE033
represents the three-dimensional coordinate value of the point, t represents the parameter of the equation of the line,
Figure RE-319722DEST_PATH_IMAGE036
Represents the position of the moon, obtained according to the astronomical calendar; 上式定义了以最优解
Figure RE-389310DEST_PATH_IMAGE007
为方向向量且过月亮位置
Figure RE-85608DEST_PATH_IMAGE036
的直线，将地球椭球方程与该直线方程联立，求解得到观测者位置，即直线与地球的交点
Figure RE-DEST_PATH_IMAGE037
，假设
Figure RE-633264DEST_PATH_IMAGE038
并且
Figure RE-DEST_PATH_IMAGE039
，其中，
Figure RE-334504DEST_PATH_IMAGE040
表示月亮位置
Figure RE-574992DEST_PATH_IMAGE036
在e系下的三维坐标值，m,n,p表示最优解
Figure RE-525631DEST_PATH_IMAGE007
在e系下的三维坐标值；那么交点
Figure RE-DEST_PATH_IMAGE041
由上述直线方程求出，其中直线方程的参数t计算如下：The above formula defines the optimal solution
Figure RE-389310DEST_PATH_IMAGE007
is the direction vector and passes the position of the moon
Figure RE-85608DEST_PATH_IMAGE036
The straight line of the ellipsoid of the earth is combined with the equation of the straight line, and the position of the observer is obtained by solving it, that is, the intersection of the straight line and the earth
Figure RE-DEST_PATH_IMAGE037
, assuming
Figure RE-633264DEST_PATH_IMAGE038
and
Figure RE-DEST_PATH_IMAGE039
,in,
Figure RE-334504DEST_PATH_IMAGE040
Indicates the position of the moon
Figure RE-574992DEST_PATH_IMAGE036
The three-dimensional coordinate value under the e system, m, n, p represent the optimal solution
Figure RE-525631DEST_PATH_IMAGE007
The three-dimensional coordinate value under the e system; then the intersection point
Figure RE-DEST_PATH_IMAGE041
It is obtained from the above straight line equation, where the parameter t of the straight line equation is calculated as follows:
Figure RE-876977DEST_PATH_IMAGE042
Figure RE-876977DEST_PATH_IMAGE042
 其中，
Figure RE-DEST_PATH_IMAGE043
和
Figure RE-167144DEST_PATH_IMAGE044
分别为椭球长半轴和短半轴，根据地球标准模型获得；上述计算结果包含两个交点，其中绝对值更小的直线方程的参数t对应的结果为待求的观测者位置，即交点
Figure RE-506215DEST_PATH_IMAGE037
。in,
Figure RE-DEST_PATH_IMAGE043
and
Figure RE-167144DEST_PATH_IMAGE044
are the semi-major axis and semi-minor axis of the ellipsoid, respectively, obtained according to the standard model of the earth; the above calculation results include two intersection points, of which the result corresponding to the parameter t of the linear equation with a smaller absolute value is the position of the observer to be determined, that is, the intersection point
Figure RE-506215DEST_PATH_IMAGE037
. 4.根据权利要求3所述的一种基于夜间月光偏振-星光信息融合的组合定位方法，其特征在于：所述步骤（4）中，根据上一步得到的交点
Figure RE-395674DEST_PATH_IMAGE037
的坐标
Figure RE-602664DEST_PATH_IMAGE041
计算观测者位置的经纬度，计算公式为：4 . The combined positioning method based on nighttime moonlight polarization-starlight information fusion according to claim 3 , wherein in the step (4), according to the intersection point obtained in the previous step
Figure RE-395674DEST_PATH_IMAGE037
coordinate of
Figure RE-602664DEST_PATH_IMAGE041
Calculate the latitude and longitude of the observer's location, the calculation formula is:
Figure RE-DEST_PATH_IMAGE045
Figure RE-DEST_PATH_IMAGE045
 其中，e f 为地球椭球偏心率，根据地球标准模型获得；
Figure RE-919376DEST_PATH_IMAGE046
是观测者位置的经度、纬度。Among them, e f is the eccentricity of the earth ellipsoid, obtained according to the standard model of the earth;
Figure RE-919376DEST_PATH_IMAGE046
are the longitude and latitude of the observer's location.
CN202210507489.6A 2022-05-11 2022-05-11 A combined positioning method based on night moonlight polarization-starlight information fusion Active CN114608564B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210507489.6A CN114608564B (en) 2022-05-11 2022-05-11 A combined positioning method based on night moonlight polarization-starlight information fusion

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210507489.6A CN114608564B (en) 2022-05-11 2022-05-11 A combined positioning method based on night moonlight polarization-starlight information fusion

Publications (2)

Publication Number Publication Date
CN114608564A CN114608564A (en) 2022-06-10
CN114608564B true CN114608564B (en) 2022-07-29

Family

ID=81870356

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210507489.6A Active CN114608564B (en) 2022-05-11 2022-05-11 A combined positioning method based on night moonlight polarization-starlight information fusion

Country Status (1)

Country Link
CN (1) CN114608564B (en)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115343743B (en) * 2022-08-10 2025-04-11 烟台赤乌科技有限公司 An astronomical satellite integrated navigation and positioning system and method independent of horizontal reference and satellite signals
CN120489102B (en) * 2025-06-11 2026-02-03 北京航空航天大学 Night inertia, starlight and polarization combined navigation method and device considering measurement failure

Citations (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
GB146545A (en) * 1917-07-31 1918-08-09 Thomas Yeomans Baker Navigation machine for determination of position from astronomical observations
WO2001046648A1 (en) * 1999-12-21 2001-06-28 Hidemi Miura Star chart navigation system
CN101178312A (en) * 2007-12-12 2008-05-14 南京航空航天大学 Spacecraft Integrated Navigation Method Based on Multi-Information Fusion
CN101852616A (en) * 2010-04-30 2010-10-06 北京航空航天大学 A method and device for realizing astral target extraction under high dynamic conditions
EP2480869A1 (en) * 2009-09-22 2012-08-01 Vorotec Ltd. Apparatus and method for navigation
CN103148849A (en) * 2013-03-12 2013-06-12 北京控制工程研究所 Combined navigation method based on earth-moon satellite united distance measurement and ultraviolet sensor
WO2020033068A2 (en) * 2018-06-27 2020-02-13 Polaris Sensor Technologies Inc. Celestial positioning system and method
CN110887476A (en) * 2019-12-09 2020-03-17 北京航空航天大学 Autonomous heading and attitude determination method based on polarization-astronomical angle information observation
CN110906926A (en) * 2019-12-02 2020-03-24 哈尔滨工业大学 A high-precision SWIR star-sensing system and method for all-day near-Earth space
CN111307139A (en) * 2019-12-09 2020-06-19 北京航空航天大学 Course and attitude determination method based on polarization/astronomical information fusion
CN111595329A (en) * 2020-05-29 2020-08-28 北京航空航天大学 Autonomous positioning method based on observation moonlight atmospheric polarization mode
CN111947652A (en) * 2020-08-13 2020-11-17 北京航空航天大学 Inertia/vision/astronomy/laser ranging combined navigation method suitable for lunar lander
CN111947653A (en) * 2020-08-13 2020-11-17 北京航空航天大学 Dual-mode inertial/visual/astronomical navigation method for lunar surface inspection tour detector
CN113063436A (en) * 2021-02-25 2021-07-02 上海卫星工程研究所 Forecasting method and system for evaluating satellite stability and pointing accuracy on-orbit performance
CN113589343A (en) * 2021-07-19 2021-11-02 中国科学院微小卫星创新研究院 Moon center vector and sun direction extraction method based on moon imaging sensor
CN113720360A (en) * 2021-11-01 2021-11-30 武汉大学 On-orbit calibration method for included angle of agile optical remote sensing satellite/ground camera
CN113834481A (en) * 2021-11-26 2021-12-24 北京航空航天大学 Night polarization angle error correction method based on starlight vector information

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108759819B (en) * 2018-06-08 2021-06-15 北京航空航天大学 A real-time positioning method for polarization navigation based on all-sky polarization information
CN111595330B (en) * 2020-05-29 2021-09-14 北京航空航天大学 Night polarization course calculation method based on probability density function estimation

Patent Citations (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
GB146545A (en) * 1917-07-31 1918-08-09 Thomas Yeomans Baker Navigation machine for determination of position from astronomical observations
WO2001046648A1 (en) * 1999-12-21 2001-06-28 Hidemi Miura Star chart navigation system
CN101178312A (en) * 2007-12-12 2008-05-14 南京航空航天大学 Spacecraft Integrated Navigation Method Based on Multi-Information Fusion
EP2480869A1 (en) * 2009-09-22 2012-08-01 Vorotec Ltd. Apparatus and method for navigation
CN101852616A (en) * 2010-04-30 2010-10-06 北京航空航天大学 A method and device for realizing astral target extraction under high dynamic conditions
CN103148849A (en) * 2013-03-12 2013-06-12 北京控制工程研究所 Combined navigation method based on earth-moon satellite united distance measurement and ultraviolet sensor
WO2020033068A2 (en) * 2018-06-27 2020-02-13 Polaris Sensor Technologies Inc. Celestial positioning system and method
CN110906926A (en) * 2019-12-02 2020-03-24 哈尔滨工业大学 A high-precision SWIR star-sensing system and method for all-day near-Earth space
CN110887476A (en) * 2019-12-09 2020-03-17 北京航空航天大学 Autonomous heading and attitude determination method based on polarization-astronomical angle information observation
CN111307139A (en) * 2019-12-09 2020-06-19 北京航空航天大学 Course and attitude determination method based on polarization/astronomical information fusion
CN111595329A (en) * 2020-05-29 2020-08-28 北京航空航天大学 Autonomous positioning method based on observation moonlight atmospheric polarization mode
CN111947652A (en) * 2020-08-13 2020-11-17 北京航空航天大学 Inertia/vision/astronomy/laser ranging combined navigation method suitable for lunar lander
CN111947653A (en) * 2020-08-13 2020-11-17 北京航空航天大学 Dual-mode inertial/visual/astronomical navigation method for lunar surface inspection tour detector
CN113063436A (en) * 2021-02-25 2021-07-02 上海卫星工程研究所 Forecasting method and system for evaluating satellite stability and pointing accuracy on-orbit performance
CN113589343A (en) * 2021-07-19 2021-11-02 中国科学院微小卫星创新研究院 Moon center vector and sun direction extraction method based on moon imaging sensor
CN113720360A (en) * 2021-11-01 2021-11-30 武汉大学 On-orbit calibration method for included angle of agile optical remote sensing satellite/ground camera
CN113834481A (en) * 2021-11-26 2021-12-24 北京航空航天大学 Night polarization angle error correction method based on starlight vector information

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
The star sensor layout based on geometric position analysis;Lin Zhao等;《2012 IEEE International Conference on Automation and Logistics》;20120920;第141-144页 *
基于天空光偏振模式的无人机航姿优化方法研究;谢林达;《中国优秀博硕士学位论文全文数据库(硕士) 工程科技Ⅱ辑》;20200215;第C031-749页 *
基于月光偏振罗盘的载体自主定位方法;李浩天等;《飞控与探测》;20200925;第3卷(第5期);第28-34页 *
月球探测器天文测角/单程无线电时间差分测距/差分测速导航方法;宁晓琳等;《航空学报》;20201230;第42卷(第11期);第1-10页 *

Also Published As

Publication number Publication date
CN114608564A (en) 2022-06-10

Similar Documents

Publication Publication Date Title
CN109556632B (en) INS/GNSS/polarization/geomagnetic integrated navigation alignment method based on Kalman filtering
CN106767752B (en) Combined navigation method based on polarization information
CN108362288B (en) Polarized light SLAM method based on unscented Kalman filtering
CN109556631B (en) INS/GNSS/polarization/geomagnetic combined navigation system alignment method based on least squares
CN109459027B (en) A Navigation Method Based on Polarization-Geomagnetic Vector Compact Combination
CN112697138B (en) A method for biomimetic polarization synchronization positioning and composition based on factor graph optimization
CN108759819A (en) A kind of polarization navigation real-time location method based on omnimax polarization degree information
CN111982106A (en) Navigation method, navigation device, storage medium and electronic device
CN114608564B (en) A combined positioning method based on night moonlight polarization-starlight information fusion
CN103822629A (en) Positioning system and its positioning method based on multi-directional polarized light navigation sensor
CN108562305B (en) A fast and rough calibration method for five positions of installation error of inertial/astronomical deep integrated navigation system
CN107727101A (en) 3 d pose information fast resolution algorithm based on double polarizing light vector
CN106441372B (en) A kind of quiet pedestal coarse alignment method based on polarization with gravitation information
He et al. A combination orientation compass based on the information of polarized skylight/geomagnetic/MIMU
Gao et al. An integrated land vehicle navigation system based on context awareness
Wang et al. Application of gravity passive aided strapdown inertial navigation in underwater vehicles
CN109459015B (en) Polarization navigation global autonomous positioning method based on maximum polarization degree observation
CN119642826B (en) A three-dimensional attitude determination method for a vehicle based on dual-vector characteristics of polarized light fields at night
CN115638789A (en) A Gravity Matching Method Based on Computational Geometry Triangle Matching Algorithm
Deng et al. Underwater map-matching aided inertial navigation system based on multi-geophysical information
CN117470233A (en) An optimized abscissa coordinate system integrated navigation method under the earth ellipsoid model
CN115979257A (en) A hierarchical fusion positioning method, system, electronic equipment and storage medium
CN108344410A (en) A method of the raising star sensor output frequency based on gyroscope auxiliary
CN113740890A (en) Course angle correction method, system, computer equipment and storage medium
CN120426988B (en) Unmanned system dead reckoning method based on underwater polarized light assistance

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