CN104931071B - 一种基于选权迭代的星敏感器在轨几何定标方法及系统 - Google Patents

一种基于选权迭代的星敏感器在轨几何定标方法及系统 Download PDF

Info

Publication number
CN104931071B
CN104931071B CN201510385934.6A CN201510385934A CN104931071B CN 104931071 B CN104931071 B CN 104931071B CN 201510385934 A CN201510385934 A CN 201510385934A CN 104931071 B CN104931071 B CN 104931071B
Authority
CN
China
Prior art keywords
mrow
msub
mtd
star
mtr
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
CN201510385934.6A
Other languages
English (en)
Other versions
CN104931071A (zh
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.)
Wuhan University WHU
Original Assignee
Wuhan University WHU
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 Wuhan University WHU filed Critical Wuhan University WHU
Priority to CN201510385934.6A priority Critical patent/CN104931071B/zh
Publication of CN104931071A publication Critical patent/CN104931071A/zh
Application granted granted Critical
Publication of CN104931071B publication Critical patent/CN104931071B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass

Landscapes

  • Engineering & Computer Science (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Studio Devices (AREA)
  • Image Processing (AREA)

Abstract

一种基于选权迭代的星敏感器在轨几何定标方法及系统,利用星敏感器拍摄多张恒星背景,获取恒星控制点的方向矢量和量测矢量,构建星敏感器在轨几何定标模型,利用选权迭代与最小二乘方法解算定标参数,获取定标结果。本发明可以有效的抑制由于星敏感器相机参数存在偏差造成的星图误识别引入的错误恒星控制点信息,有效的提高星敏感器在轨几何定标的可靠性与稳定性,提高卫星测量精度。

Description

一种基于选权迭代的星敏感器在轨几何定标方法及系统
技术领域
本发明属于卫星测量精密仪器高精度定标领域,涉及一种基于选权迭代的星敏感器在轨几何定标技术方案。
背景技术
星敏感器在卫星的姿态测量和控制系统中起着重要的作用,它以恒星为参考,输出卫星在天球惯性坐标系下的姿态,是目前卫星测量精度最高的一种的定姿设备。星敏感器的定标可以通过地面定标和在轨定标两种方式完成,通过地面上进行的严格定标,可以确定在轨运行的初始参数。但是受卫星发射过程中应力的释放、成像环境的变化以及器件的老化等多种因素的影响,会使得光学系统的参数发生漂移,测量精度下降,因此需要对其进行在轨定标。
目前存在的星敏感器在轨定标方法,都是基于星图中的恒星能够正确识别的基础上进行的,然而现有的绝大多数星图识别方法都依赖于星敏感器的相机参数,当相机参数存在较大的偏差时,就会严重影响星图识别的准确性,错误识别的恒星作为星敏感器在轨定标的控制点信息时,会显著影响在轨几何定标中相机参数的解算精度。因此,如何有效地抑制由于相机参数偏差造成的错误识别的恒星对定标精度的影响,是星敏感器在轨几何定标中亟待解决的问题。
发明内容
本发明所要解决的问题是,针对星敏感器,提供一种有效稳健的在轨几何定标技术方案,可以有效抑制错误识别的恒星对定标精度的影响。
本发明的技术方案提供一种基于选权迭代的星敏感器在轨几何定标方法,包括以下步骤:
步骤1,利用星敏感器拍摄多张恒星背景,获取恒星控制点的方向矢量vi和量测矢量wi
步骤2,构建星敏感器在轨几何定标模型如下,
设星敏感器同一星图内两个星点对应的两个量测所得量测矢量wi和wj之间的夹角θij,与导航星表中对应恒星的方向矢量vi和vj之间的夹角θij相等,星敏感器在轨几何定标模型的公式如下,
其中,Ri,j是余弦的偏差值,gij(.)是cosθij的函数表示;
是真值X=(x0,y0,f,k1,p1,p2)的估计值,估计值的改正数用ΔX=(Δx0,Δy0,Δf,Δk1,Δp1,Δp2)表示,(x0,y0)是星敏感器的主光轴与像平面的交点的地面定标值,f是星敏感器的焦距地面定标值,k1为光学镜头的径向畸变系数,p1和p2为光学镜头的切向畸变系数;
矩阵
步骤3,利用选权迭代与最小二乘方法解算定标参数,获取定标结果。
而且,所述恒星控制点的方向矢量如下,
其中,αi和δi分别为恒星控制点的赤经和赤纬。
而且,设恒星控制点通过星敏感器成像以后在像平面上的坐标为(xi,yi),星敏感器的主光轴与像平面的交点的地面定标值为(x0,y0),则星像点对应的量测矢量如下,
其中,Δx与Δy为像平面上的坐标(xi,yi)处的畸变误差。
而且,步骤3的实现方式如下,
设一共观测了H张星图,第h张星图中有nh个星点,其中h=1,2,…,H,则根据星敏感器在轨几何定标模型有
Rh=AhΔX
其中,
矩阵矩阵
i=1,...,nh-1,j=i+1,...,nh
利用观测的H张星图,构建超定方程组如下
Rk=AkΔXk
其中k为迭代次数,ΔXk是第k次迭代的估计值的改正数,
且矩阵矩阵
执行以下步骤,
步骤3.1,输入参数x0,y0,f,k1,p1,p2的初始值,令k=0;
步骤3.2,进行最小二乘估计如下,
ΔXk=(Ak TPkAk)-1Ak TPkRk.
其中,矩阵Pk=diag(p1,p2…pt…pRow(A))k且t=1,2…,Row(A),Row(A)表示中矩阵Ak行数,是夹角观测值的数量,pt为第k次迭代时对应夹角观测值的权,Pk的初始值为单位阵;
步骤3.3,判断是否||ΔXk||>ε,ε为预设的正数值;
否则输出结束流程;其中,是第k次迭代的估计值是第k+1次迭代的估计值
是则进入步骤3.4;
步骤3.4,判断是否k>0,
是则更新参数然后进入步骤3.5;
否则直接进入步骤3.5;
步骤3.5,采用选权迭代的方式更新各权值pt,令k=k+1,然后返回步骤3.2。
而且,步骤3.5中,采用选权迭代的方式更新各权值pt实现如下,
满足标准正态分布,lt是各个夹角观测值的多余观测分量,ut是各个夹角观测值的残差,t=1,2…,Row(A),
其中,Tt为统计信息,F是预设的阈值,的单位权方差的估计值。
本发明还相应提供一种基于选权迭代的星敏感器在轨几何定标系统,包括以下模块:
恒星控制点提取模块,用于利用星敏感器拍摄多张恒星背景,获取恒星控制点的方向矢量vi和量测矢量wi
模型构建模块,用于构建星敏感器在轨几何定标模型如下,
设星敏感器同一星图内两个星点对应的两个量测所得量测矢量wi和wj之间的夹角θij,与导航星表中对应恒星的方向矢量vi和vj之间的夹角θij相等,星敏感器在轨几何定标模型的公式如下,
其中,Ri,j是余弦的偏差值,gij(.)是cosθij的函数表示;
是真值X=(x0,y0,f,k1,p1,p2)的估计值,估计值的改正数用ΔX=(Δx0,Δy0,Δf,Δk1,Δp1,Δp2)表示,(x0,y0)是星敏感器的主光轴与像平面的交点的地面定标值,f是星敏感器的焦距地面定标值,k1为光学镜头的径向畸变系数,p1和p2为光学镜头的切向畸变系数;
矩阵
定标模块,用于利用选权迭代与最小二乘方法解算定标参数,获取定标结果。
而且,所述恒星控制点的方向矢量如下,
其中,αi和δi分别为恒星控制点的赤经和赤纬。
而且,设恒星控制点通过星敏感器成像以后在像平面上的坐标为(xi,yi),星敏感器的主光轴与像平面的交点的地面定标值为(x0,y0),则星像点对应的量测矢量如下,
其中,Δx与Δy为像平面上的坐标(xi,yi)处的畸变误差。
而且,定标模块的实现方式如下,
设一共观测了H张星图,第h张星图中有nh个星点,其中h=1,2,…,H,则根据星敏感器在轨几何定标模型有
Rh=AhΔX
其中,
矩阵矩阵
i=1,...,nh-1,j=i+1,...,nh
利用观测的H张星图,构建超定方程组如下
Rk=AkΔXk
其中k为迭代次数,ΔXk是第k次迭代的估计值的改正数,
且矩阵矩阵
执行以下步骤,
步骤3.1,输入参数x0,y0,f,k1,p1,p2的初始值,令k=0;
步骤3.2,进行最小二乘估计如下,
ΔXk=(Ak TPkAk)-1Ak TPkRk.
其中,矩阵Pk=diag(p1,p2…pt…pRow(A))k且t=1,2…,Row(A),Row(A)表示中矩阵Ak行数,是夹角观测值的数量,pt为第k次迭代时对应夹角观测值的权,Pk的初始值为单位阵;
步骤3.3,判断是否||ΔXk||>ε,ε为预设的正数值;
否则输出结束流程;其中,是第k次迭代的估计值是第k+1次迭代的估计值
是则进入步骤3.4;
步骤3.4,判断是否k>0,
是则更新参数然后进入步骤3.5;
否则直接进入步骤3.5;
步骤3.5,采用选权迭代的方式更新各权值pt,令k=k+1,然后返回步骤3.2。
而且,步骤3.5中,采用选权迭代的方式更新各权值pt实现如下,
满足标准正态分布,lt是各个夹角观测值的多余观测分量,ut是各个夹角观测值的残差,t=1,2…,Row(A),
其中,Tt为统计信息,F是预设的阈值,的单位权方差的估计值。
本发明基于恒星控制点的物方和像方信息,构建星敏感器在轨几何定标模型,基于选权迭代定标参数解算,可以有效的抑制由于星敏感器相机参数存在偏差造成的星图误识别引入的错误恒星控制点信息,有效的提高星敏感器在轨几何定标的可靠性与稳定性。
附图说明
图1为本发明实施例的星敏感器成像模型示意图。
图2为本发明实施例的基于选权迭代的定标参数解算方法流程图。
具体实施方式
以下结合附图和实施例详细说明本发明具体实施方式。
具体实施时,本发明技术方案可由本领域技术人员采用计算机软件技术实现自动运行流程。本发明实施例提供的一种基于选权迭代的星敏感器在轨几何定标方法,包括以下步骤:
步骤1,以恒星为控制点,即为恒星控制点;利用星敏感器拍摄多张星图获取恒星控制点的物方矢量与像方矢量,即方向矢量vi和量测矢量wi
一般可以拍摄10张以上星图,获取百颗以上恒星作为控制点。具体实施时,步骤1可采用现有的星图识别方法与星点质心提取方法,获取恒星控制点的物方矢量vi与像方矢量wi。本步骤可以预先实现。
实施例中,步骤1中通过星图识别的方法获取的恒星控制点的方向矢量如下,
其中,vi表示每个恒星i在导航星表中唯一的单位方向矢量,可以用该恒星的赤经αi和赤纬δi表示。
恒星通过星敏感器成像以后在像平面上的坐标为(xi,yi),设星敏感器的焦距地面定标值为f,星敏感器的主光轴与像平面的交点的地面定标值为(x0,y0),则恒星控制点通过星敏感器成像所得星像点对应的量测矢量wi如下,
其中,Δx与Δy为像平面上的坐标(xi,yi)处像点的畸变误差,可由下式表示
其中,r代表像点距离主点的径向,即k1为光学镜头的径向畸变系数,p1和p2为光学镜头的切向畸变系数。
步骤2,构建星敏感器在轨几何定标模型,如公式(6)所示。
实施例中,步骤2构建星敏感器在轨几何定标模型,在理想状况下,星敏感器同一星图内两个星点对应的两个量测矢量wi和wj之间的夹角θij,与导航星表中对应恒星的方向矢量vi和vj之间的夹角θij相等,如图1所示,O-XYZ表示惯性坐标系,o-xyz表示相机坐标系。同时取矢量夹角的方向余弦,则量测矢量与方向矢量满足:
是恒星i和恒星j的实际量测矢量,M是惯性坐标系到相机坐标系的旋转矩阵,gij(.)是cosθij的函数表示。是真值X=(x0,y0,f,k1,p1,p2)的估计值,估计值的改正数用ΔX=(Δx0,Δy0,Δf,Δk1,Δp1,Δp2)表示。
由于误差很小,故在估计值处线性化方程得:
构建星敏感器在轨几何定标模型,如下式
其中,Ri,j是余弦cosθij的偏差值,gij表示的简写;
矩阵
步骤3,利用选权迭代与最小二乘方法解算定标参数,获取定标结果。
实施例中,步骤3利用选权迭代与最小二乘方法解算定标参数,如图2所示:
步骤3.1,输入参数x0,y0,f,k1,p1,p2的初始值,具体实施时可采用地面标定值;令k=0;
步骤3.2,进行最小二乘估计,具体实现如以下公式(9);
步骤3.3,判断是否||ΔXk||>ε,ε为极小的正数值,具体实施时本领域技术人员可以自行预设取值;
否则输出结束流程;
是则进入步骤3.4;
步骤3.4,判断是否k>0,
是则更新参数然后进入步骤3.5;
否则直接进入步骤3.5;
步骤3.5,更新权值,令k=k+1,然后返回步骤3.2。具体更新采用以下公式(19)实现,更新各个权值pt
具体计算原理解释如下:
设一共观测了H张星图,设第h张星图中有nh个星点,其中h=1,2,…,H,则公式(6)可以写作
Rh=AhΔX (7)
其中,矩阵矩阵
i=1,...,nh-1,j=i+1,...,nh
利用观测的H张星图,构建超定方程组:
Rk=AkΔXk (8)
其中k=0,1,2,…为迭代次数,ΔXk是第k次迭代的估计值的改正数,且矩阵矩阵采用最小二乘的方法解得
ΔXk=(Ak TPkAk)-1Ak TPkRk. (9)
其中,矩阵Pk=diag(p1,p2…pt…pRow(A))k且t=1,2…,Row(A),Row(A)表示公式(8)中矩阵Ak行数,即所有夹角观测值(即夹角θij的观测值)的数量,pt为第k次迭代时对应夹角观测值的权,Pk的初始值为P0=E,E表示单位阵。
随着迭代,Pk通过选权迭代的方法进行更新,具体的实施方法如下:
假设公式(6)中的满足标准正态分布,并且它的单位权方差为则单位权方差的估计值
其中,L是总的多余观测数,Col(A)表示公式(8)中矩阵Ak的列数,则多余观测数L可表示为
L=Row(A)-Col(A) (11)
设lt是各个夹角观测值的多余观测分量且t=1,2...,Row(A)
L=l1+l2…+lt+…+lRow(A) (12)
在公式(10)中,矩阵U=[u1,u2,…ut…,uRow(A)]T,ut是各个夹角观测值的残差且t=1,2…,Row(A),U可由公式(12)求得,
U=AΔX-R
=A(ATPA)-1ATPR-R (13)
=(A(ATPA)-1AT-Q)PR
其中Q=P-1,即Q为权矩阵P的逆矩阵。
根据误差传播定律可以得到U的权系数矩阵是
QUU=Q-A(ATPA)-1AT (14)
每个夹角观测值的方差估计值和对应的多余观测分量lt可以如下求解
其中,是权系数矩阵QUU的对角线元素,pt是权矩阵P的对角线元素。
为了评估方差的正常性,统计信息可以通过以下方式获得,
假设:
其中是各观测值方差的均值,即中误差。
可得统计信息Tt
如果观测值中不存在粗差,那么假设成立,并且统计信息Tt满足高斯正太分布,设F是阈值,具体实施时本领域技术人员可自行预设F的取值。当Tt>F时,可认为方差与其他方差值存在显著的不同,则对应的观测值可能会是粗差值,因此观测值的权应该采用公式(19)进行减小,以减小其对优化结果的影响。
当k>0时,根据公式(8)求得的改正数ΔXk,利用公式(20)对估计值进行更新
其中,ΔXk是第k次迭代的改正数,是第k次迭代的估计值是第k+1次迭代的估计值
具体实施时,还可以采用模块化方式提供相应系统。本发明实施例相应提供一种基于选权迭代的星敏感器在轨几何定标系统,包括以下模块:
恒星控制点提取模块,用于利用星敏感器拍摄多张恒星背景,获取恒星控制点的方向矢量vi和量测矢量wi
模型构建模块,用于构建星敏感器在轨几何定标模型如下,
设星敏感器同一星图内两个星点对应的两个量测所得量测矢量wi和wj之间的夹角θij,与导航星表中对应恒星的方向矢量vi和vj之间的夹角θij相等,星敏感器在轨几何定标模型的公式如下,
其中,Ri,j是余弦的偏差值,gij(.)是cosθij的函数表示;
是真值X=(x0,y0,f,k1,p1,p2)的估计值,估计值的改正数用ΔX=(Δx0,Δy0,Δf,Δk1,Δp1,Δp2)表示,(x0,y0)是星敏感器的主光轴与像平面的交点的地面定标值,f是星敏感器的焦距地面定标值,k1为光学镜头的径向畸变系数,p1和p2为光学镜头的切向畸变系数;
矩阵
定标模块,用于利用选权迭代与最小二乘方法解算定标参数,获取定标结果。
各模块具体实现可参见相应步骤,具体实施时本领域技术人员可以自行设定具体模块中更具体的模块划分,例如定标模块中设置以下子模块:
初始化子模块,用于输入参数x0,y0,f,k1,p1,p2的初始值,令k=0;
最小二乘估计子模块,用于进行最小二乘估计如下,
ΔXk=(Ak TPkAk)-1Ak TPkRk.
其中,矩阵Pk=diag(p1,p2…pt…pRow(A))k且t=1,2…,Row(A),Row(A)表示中矩阵Ak行数,是夹角观测值的数量,pt为第k次迭代时对应夹角观测值的权,Pk的初始值为单位阵;
阈值判断子模块,用于判断是否||ΔXk||>ε,ε为预设的正数值;
否则输出结束流程;其中,是第k次迭代的估计值是第k+1次迭代的估计值
是则命令参数更新子模块工作;
参数更新子模块,用于判断是否k>0,
是则更新参数然后命令权值更新子模块工作;
否则直接命令权值更新子模块工作;
权值更新子模块,用于采用选权迭代的方式更新各权值pt,令k=k+1,然后命令最小二乘估计子模块工作。
本文中所描述的具体实施例仅仅是对本发明精神作举例说明。本发明所属技术领域的技术人员可以对所描述的具体实施例做各种各样的修改或补充或采用类似的方式替代,但并不会偏离本发明的精神或者超越所附权利要求书所定义的范围。

Claims (6)

1.一种基于选权迭代的星敏感器在轨几何定标方法,其特征在于,包括以下步骤:
步骤1,利用星敏感器拍摄多张恒星背景,获取恒星控制点的方向矢量vi和量测矢量wi
步骤2,构建星敏感器在轨几何定标模型如下,
设星敏感器同一星图内两个星点对应的两个量测所得量测矢量wi和wj之间的夹角θij,与导航星表中对应恒星的方向矢量vi和vj之间的夹角θij相等,星敏感器在轨几何定标模型的公式如下,
<mrow> <msub> <mi>R</mi> <mrow> <mi>i</mi> <mo>,</mo> <mi>j</mi> </mrow> </msub> <mo>=</mo> <msubsup> <mi>v</mi> <mi>i</mi> <mi>T</mi> </msubsup> <msub> <mi>v</mi> <mi>j</mi> </msub> <mo>-</mo> <msub> <mi>g</mi> <mrow> <mi>i</mi> <mi>j</mi> </mrow> </msub> <mrow> <mo>(</mo> <mover> <mi>X</mi> <mo>^</mo> </mover> <mo>)</mo> </mrow> <mo>=</mo> <mo>-</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mfrac> <mrow> <mo>&amp;part;</mo> <msub> <mi>g</mi> <mrow> <mi>i</mi> <mi>j</mi> </mrow> </msub> </mrow> <mrow> <mo>&amp;part;</mo> <mover> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>^</mo> </mover> </mrow> </mfrac> </mtd> <mtd> <mfrac> <mrow> <mo>&amp;part;</mo> <msub> <mi>g</mi> <mrow> <mi>i</mi> <mi>j</mi> </mrow> </msub> </mrow> <mrow> <mo>&amp;part;</mo> <mover> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>^</mo> </mover> </mrow> </mfrac> </mtd> <mtd> <mfrac> <mrow> <mo>&amp;part;</mo> <msub> <mi>g</mi> <mrow> <mi>i</mi> <mi>j</mi> </mrow> </msub> </mrow> <mrow> <mo>&amp;part;</mo> <mover> <mi>f</mi> <mo>^</mo> </mover> </mrow> </mfrac> </mtd> <mtd> <mfrac> <mrow> <mo>&amp;part;</mo> <msub> <mi>g</mi> <mrow> <mi>i</mi> <mi>j</mi> </mrow> </msub> </mrow> <mrow> <mo>&amp;part;</mo> <mover> <msub> <mi>k</mi> <mn>1</mn> </msub> <mo>^</mo> </mover> </mrow> </mfrac> </mtd> <mtd> <mfrac> <mrow> <mo>&amp;part;</mo> <msub> <mi>g</mi> <mrow> <mi>i</mi> <mi>j</mi> </mrow> </msub> </mrow> <mrow> <mo>&amp;part;</mo> <mover> <msub> <mi>p</mi> <mn>1</mn> </msub> <mo>^</mo> </mover> </mrow> </mfrac> </mtd> <mtd> <mfrac> <mrow> <mo>&amp;part;</mo> <msub> <mi>g</mi> <mrow> <mi>i</mi> <mi>j</mi> </mrow> </msub> </mrow> <mrow> <mo>&amp;part;</mo> <mover> <msub> <mi>p</mi> <mn>2</mn> </msub> <mo>^</mo> </mover> </mrow> </mfrac> </mtd> </mtr> </mtable> </mfenced> <mi>&amp;Delta;</mi> <mi>X</mi> <mo>=</mo> <mi>A</mi> <mi>&amp;Delta;</mi> <mi>X</mi> </mrow>
其中,Ri,j是余弦的偏差值,gij(.)是cosθij的函数表示;
是真值X=(x0,y0,f,k1,p1,p2)的估计值,估计值的改正数用ΔX=(Δx0,Δy0,Δf,Δk1,Δp1,Δp2)表示,(x0,y0)是星敏感器的主光轴与像平面的交点的地面定标值,f是星敏感器的焦距地面定标值,k1为光学镜头的径向畸变系数,p1和p2为光学镜头的切向畸变系数;
矩阵
步骤3,利用选权迭代与最小二乘方法解算定标参数,获取定标结果;
步骤3的实现方式如下,
设一共观测了H张星图,第h张星图中有nh个星点,其中h=1,2,…,H,则根据星敏感器在轨几何定标模型有
Rh=AhΔX
其中,
矩阵矩阵
i=1,...,nh-1,j=i+1,...,nh
利用观测的H张星图,构建超定方程组如下
Rk=AkΔXk
其中k为迭代次数,ΔXk是第k次迭代的估计值的改正数,
且矩阵矩阵
执行以下步骤,
步骤3.1,输入参数x0,y0,f,k1,p1,p2的初始值,令k=0;
步骤3.2,进行最小二乘估计如下,
ΔXk=(Ak TPkAk)-1Ak TPkRk.
其中,矩阵Pk=diag(p1,p2…pt…pRow(A))k且t=1,2…,Row(A),Row(A)表示中矩阵Ak行数,是夹角观测值的数量,pt为第k次迭代时对应夹角观测值的权,Pk的初始值为单位阵;
步骤3.3,判断是否||ΔXk||>ε,ε为预设的正数值;
否则输出结束流程;其中,是第k次迭代的估计值 是第k+1次迭代的估计值
是则进入步骤3.4;
步骤3.4,判断是否k>0,
是则更新参数然后进入步骤3.5;
否则直接进入步骤3.5;
步骤3.5,采用选权迭代的方式更新各权值pt,令k=k+1,然后返回步骤3.2,
步骤3.5中,采用选权迭代的方式更新各权值pt实现如下,
满足标准正态分布,lt是各个夹角观测值的多余观测分量,ut是各个夹角观测值的残差,t=1,2…,Row(A),
<mrow> <msub> <mi>p</mi> <mi>t</mi> </msub> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mn>1</mn> <mo>,</mo> </mrow> </mtd> <mtd> <mrow> <msub> <mi>T</mi> <mi>t</mi> </msub> <mo>&lt;</mo> <mi>F</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mfrac> <mrow> <msubsup> <mover> <mi>&amp;sigma;</mi> <mo>^</mo> </mover> <mn>0</mn> <mn>2</mn> </msubsup> <msub> <mi>l</mi> <mi>t</mi> </msub> </mrow> <msubsup> <mi>u</mi> <mi>t</mi> <mn>2</mn> </msubsup> </mfrac> <mo>,</mo> </mrow> </mtd> <mtd> <mrow> <msub> <mi>T</mi> <mi>t</mi> </msub> <mo>&amp;GreaterEqual;</mo> <mi>F</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow>
其中,Tt为统计信息,F是预设的阈值,的单位权方差的估计值。
2.如权利要求1所述基于选权迭代的星敏感器在轨几何定标方法,其特征在于:所述恒星控制点的方向矢量如下,
<mrow> <msub> <mi>v</mi> <mi>i</mi> </msub> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <msub> <mi>cos&amp;alpha;</mi> <mi>i</mi> </msub> <msub> <mi>cos&amp;delta;</mi> <mi>i</mi> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>sin&amp;alpha;</mi> <mi>i</mi> </msub> <msub> <mi>cos&amp;delta;</mi> <mi>i</mi> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>sin&amp;delta;</mi> <mi>i</mi> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow>
其中,αi和δi分别为恒星控制点的赤经和赤纬。
3.如权利要求1或2所述基于选权迭代的星敏感器在轨几何定标方法,其特征在于:设恒星控制点通过星敏感器成像以后在像平面上的坐标为(xi,yi),星敏感器的主光轴与像平面的交点的地面定标值为(x0,y0),则星像点对应的量测矢量如下,
<mrow> <msub> <mi>w</mi> <mi>i</mi> </msub> <mo>=</mo> <mfrac> <mn>1</mn> <msqrt> <mrow> <msup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mi>i</mi> </msub> <mo>-</mo> <mi>&amp;Delta;</mi> <mi>x</mi> <mo>-</mo> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mi>i</mi> </msub> <mo>-</mo> <mi>&amp;Delta;</mi> <mi>y</mi> <mo>-</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mi>f</mi> <mn>2</mn> </msup> </mrow> </msqrt> </mfrac> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mo>-</mo> <mo>(</mo> <msub> <mi>x</mi> <mi>i</mi> </msub> <mo>-</mo> <mi>&amp;Delta;</mi> <mi>x</mi> <mo>-</mo> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>)</mo> </mtd> </mtr> <mtr> <mtd> <mo>-</mo> <mo>(</mo> <msub> <mi>y</mi> <mi>i</mi> </msub> <mo>-</mo> <mi>&amp;Delta;</mi> <mi>y</mi> <mo>-</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>)</mo> </mtd> </mtr> <mtr> <mtd> <mi>f</mi> </mtd> </mtr> </mtable> </mfenced> </mrow>
其中,Δx与Δy为像平面上的坐标(xi,yi)处的畸变误差。
4.一种基于选权迭代的星敏感器在轨几何定标系统,其特征在于,包括以下模块:
恒星控制点提取模块,用于利用星敏感器拍摄多张恒星背景,获取恒星控制点的方向矢量vi和量测矢量wi
模型构建模块,用于构建星敏感器在轨几何定标模型如下,
设星敏感器同一星图内两个星点对应的两个量测所得量测矢量wi和wj之间的夹角θij,与导航星表中对应恒星的方向矢量vi和vj之间的夹角θij相等,星敏感器在轨几何定标模型的公式如下,
<mrow> <msub> <mi>R</mi> <mrow> <mi>i</mi> <mo>,</mo> <mi>j</mi> </mrow> </msub> <mo>=</mo> <msubsup> <mi>v</mi> <mi>i</mi> <mi>T</mi> </msubsup> <msub> <mi>v</mi> <mi>j</mi> </msub> <mo>-</mo> <msub> <mi>g</mi> <mrow> <mi>i</mi> <mi>j</mi> </mrow> </msub> <mrow> <mo>(</mo> <mover> <mi>X</mi> <mo>^</mo> </mover> <mo>)</mo> </mrow> <mo>=</mo> <mo>-</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mfrac> <mrow> <mo>&amp;part;</mo> <msub> <mi>g</mi> <mrow> <mi>i</mi> <mi>j</mi> </mrow> </msub> </mrow> <mrow> <mo>&amp;part;</mo> <mover> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>^</mo> </mover> </mrow> </mfrac> </mtd> <mtd> <mfrac> <mrow> <mo>&amp;part;</mo> <msub> <mi>g</mi> <mrow> <mi>i</mi> <mi>j</mi> </mrow> </msub> </mrow> <mrow> <mo>&amp;part;</mo> <mover> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>^</mo> </mover> </mrow> </mfrac> </mtd> <mtd> <mfrac> <mrow> <mo>&amp;part;</mo> <msub> <mi>g</mi> <mrow> <mi>i</mi> <mi>j</mi> </mrow> </msub> </mrow> <mrow> <mo>&amp;part;</mo> <mover> <mi>f</mi> <mo>^</mo> </mover> </mrow> </mfrac> </mtd> <mtd> <mfrac> <mrow> <mo>&amp;part;</mo> <msub> <mi>g</mi> <mrow> <mi>i</mi> <mi>j</mi> </mrow> </msub> </mrow> <mrow> <mo>&amp;part;</mo> <mover> <msub> <mi>k</mi> <mn>1</mn> </msub> <mo>^</mo> </mover> </mrow> </mfrac> </mtd> <mtd> <mfrac> <mrow> <mo>&amp;part;</mo> <msub> <mi>g</mi> <mrow> <mi>i</mi> <mi>j</mi> </mrow> </msub> </mrow> <mrow> <mo>&amp;part;</mo> <mover> <msub> <mi>p</mi> <mn>1</mn> </msub> <mo>^</mo> </mover> </mrow> </mfrac> </mtd> <mtd> <mfrac> <mrow> <mo>&amp;part;</mo> <msub> <mi>g</mi> <mrow> <mi>i</mi> <mi>j</mi> </mrow> </msub> </mrow> <mrow> <mo>&amp;part;</mo> <mover> <msub> <mi>p</mi> <mn>2</mn> </msub> <mo>^</mo> </mover> </mrow> </mfrac> </mtd> </mtr> </mtable> </mfenced> <mi>&amp;Delta;</mi> <mi>X</mi> <mo>=</mo> <mi>A</mi> <mi>&amp;Delta;</mi> <mi>X</mi> </mrow>
其中,Ri,j是余弦的偏差值,gij(.)是cosθij的函数表示;
是真值X=(x0,y0,f,k1,p1,p2)的估计值,估计值的改正数用ΔX=(Δx0,Δy0,Δf,Δk1,Δp1,Δp2)表示,(x0,y0)是星敏感器的主光轴与像平面的交点的地面定标值,f是星敏感器的焦距地面定标值,k1为光学镜头的径向畸变系数,p1和p2为光学镜头的切向畸变系数;
矩阵
定标模块,用于利用选权迭代与最小二乘方法解算定标参数,获取定标结果;
定标模块的实现方式如下,
设一共观测了H张星图,第h张星图中有nh个星点,其中h=1,2,…,H,则根据星敏感器在轨几何定标模型有
Rh=AhΔX
其中,
矩阵矩阵
i=1,...,nh-1,j=i+1,...,nh
利用观测的H张星图,构建超定方程组如下
Rk=AkΔXk
其中k为迭代次数,ΔXk是第k次迭代的估计值的改正数,
且矩阵矩阵
执行以下步骤,
步骤3.1,输入参数x0,y0,f,k1,p1,p2的初始值,令k=0;
步骤3.2,进行最小二乘估计如下,
ΔXk=(Ak TPkAk)-1AkTPkRk.
其中,矩阵Pk=diag(p1,p2…pt…pRow(A))k且t=1,2…,Row(A),Row(A)表示中矩阵Ak行数,是夹角观测值的数量,pt为第k次迭代时对应夹角观测值的权,Pk的初始值为单位阵;
步骤3.3,判断是否||ΔXk||>ε,ε为预设的正数值;
否则输出结束流程;其中,是第k次迭代的估计值 是第k+1次迭代的估计值
是则进入步骤3.4;
步骤3.4,判断是否k>0,
是则更新参数然后进入步骤3.5;
否则直接进入步骤3.5;
步骤3.5,采用选权迭代的方式更新各权值pt,令k=k+1,然后返回步骤3.2;
步骤3.5中,采用选权迭代的方式更新各权值pt实现如下,
满足标准正态分布,lt是各个夹角观测值的多余观测分量,ut是各个夹角观测值的残差,t=1,2…,Row(A),
<mrow> <msub> <mi>p</mi> <mi>t</mi> </msub> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mn>1</mn> <mo>,</mo> </mrow> </mtd> <mtd> <mrow> <msub> <mi>T</mi> <mi>t</mi> </msub> <mo>&lt;</mo> <mi>F</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mfrac> <mrow> <msubsup> <mover> <mi>&amp;sigma;</mi> <mo>^</mo> </mover> <mn>0</mn> <mn>2</mn> </msubsup> <msub> <mi>l</mi> <mi>t</mi> </msub> </mrow> <msubsup> <mi>u</mi> <mi>t</mi> <mn>2</mn> </msubsup> </mfrac> <mo>,</mo> </mrow> </mtd> <mtd> <mrow> <msub> <mi>T</mi> <mi>t</mi> </msub> <mo>&amp;GreaterEqual;</mo> <mi>F</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow>
其中,Tt为统计信息,F是预设的阈值,的单位权方差的估计值。
5.如权利要求4所述基于选权迭代的星敏感器在轨几何定标系统,其特征在于:所述恒星控制点的方向矢量如下,
<mrow> <msub> <mi>v</mi> <mi>i</mi> </msub> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mi>c</mi> <mi>o</mi> <mi>s</mi> <msub> <mi>&amp;alpha;</mi> <mi>i</mi> </msub> <mi>c</mi> <mi>o</mi> <mi>s</mi> <msub> <mi>&amp;delta;</mi> <mi>i</mi> </msub> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>sin&amp;alpha;</mi> <mi>i</mi> </msub> <msub> <mi>cos&amp;delta;</mi> <mi>i</mi> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>sin&amp;delta;</mi> <mi>i</mi> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow>
其中,αi和δi分别为恒星控制点的赤经和赤纬。
6.如权利要求4或5所述基于选权迭代的星敏感器在轨几何定标系统,其特征在于:设恒星控制点通过星敏感器成像以后在像平面上的坐标为(xi,yi),星敏感器的主光轴与像平面的交点的地面定标值为(x0,y0),则星像点对应的量测矢量如下,
<mrow> <msub> <mi>w</mi> <mi>i</mi> </msub> <mo>=</mo> <mfrac> <mn>1</mn> <msqrt> <mrow> <msup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mi>i</mi> </msub> <mo>-</mo> <mi>&amp;Delta;</mi> <mi>x</mi> <mo>-</mo> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mi>i</mi> </msub> <mo>-</mo> <mi>&amp;Delta;</mi> <mi>y</mi> <mo>-</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mi>f</mi> <mn>2</mn> </msup> </mrow> </msqrt> </mfrac> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mo>-</mo> <mo>(</mo> <msub> <mi>x</mi> <mi>i</mi> </msub> <mo>-</mo> <mi>&amp;Delta;</mi> <mi>x</mi> <mo>-</mo> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>)</mo> </mtd> </mtr> <mtr> <mtd> <mo>-</mo> <mo>(</mo> <msub> <mi>y</mi> <mi>i</mi> </msub> <mo>-</mo> <mi>&amp;Delta;</mi> <mi>y</mi> <mo>-</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>)</mo> </mtd> </mtr> <mtr> <mtd> <mi>f</mi> </mtd> </mtr> </mtable> </mfenced> </mrow>
其中,Δx与Δy为像平面上的坐标(xi,yi)处的畸变误差。
CN201510385934.6A 2015-06-30 2015-06-30 一种基于选权迭代的星敏感器在轨几何定标方法及系统 Active CN104931071B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510385934.6A CN104931071B (zh) 2015-06-30 2015-06-30 一种基于选权迭代的星敏感器在轨几何定标方法及系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510385934.6A CN104931071B (zh) 2015-06-30 2015-06-30 一种基于选权迭代的星敏感器在轨几何定标方法及系统

Publications (2)

Publication Number Publication Date
CN104931071A CN104931071A (zh) 2015-09-23
CN104931071B true CN104931071B (zh) 2017-12-26

Family

ID=54118348

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510385934.6A Active CN104931071B (zh) 2015-06-30 2015-06-30 一种基于选权迭代的星敏感器在轨几何定标方法及系统

Country Status (1)

Country Link
CN (1) CN104931071B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108447024A (zh) * 2018-01-30 2018-08-24 中国科学院上海技术物理研究所 基于在轨恒星数据的人工智能畸变自校正方法

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105444778B (zh) * 2015-11-10 2018-10-09 北京空间飞行器总体设计部 一种基于成像几何反演的星敏感器在轨定姿误差获取方法
CN107607127B (zh) * 2017-07-28 2020-07-10 湖北航天技术研究院总体设计所 一种基于外场的星敏感器内部参数标定及精度快速验证系统
CN107677265B (zh) * 2017-09-01 2019-11-15 中国科学院长春光学精密机械与物理研究所 一种组合全天时星敏感器
CN108106634B (zh) * 2017-11-21 2020-06-16 中国人民解放军国防科技大学 一种直接观星的星敏感器内参数标定方法
CN108332739B (zh) * 2018-01-19 2020-04-24 中国人民解放军国防科技大学 确定星敏感器在轨姿态测量精度主成分因素响应边界的方法

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN100348947C (zh) * 2006-10-10 2007-11-14 北京航空航天大学 基于weng模型的星敏感器在轨校准方法
CN103674063B (zh) * 2013-12-05 2016-08-31 中国资源卫星应用中心 一种光学遥感相机在轨几何定标方法

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108447024A (zh) * 2018-01-30 2018-08-24 中国科学院上海技术物理研究所 基于在轨恒星数据的人工智能畸变自校正方法
CN108447024B (zh) * 2018-01-30 2021-10-01 中国科学院上海技术物理研究所 基于在轨恒星数据的人工智能畸变自校正方法

Also Published As

Publication number Publication date
CN104931071A (zh) 2015-09-23

Similar Documents

Publication Publication Date Title
CN104931071B (zh) 一种基于选权迭代的星敏感器在轨几何定标方法及系统
CN105910624B (zh) 一种惯组光学瞄准棱镜安装误差的标定方法
CN105371844B (zh) 一种基于惯性/天文互助的惯性导航系统初始化方法
CN103994763B (zh) 一种火星车的sins/cns深组合导航系统及其实现方法
CN104236546B (zh) 一种卫星星光折射导航误差确定与补偿方法
CN106125069B (zh) 一种基于指向角残差的星载激光测高仪指向角系统误差标定方法
CN105182994B (zh) 一种无人机定点降落的方法
CN109708649B (zh) 一种遥感卫星的姿态确定方法及系统
CN107806874B (zh) 一种视觉辅助的捷联惯导极区初始对准方法
CN105698764B (zh) 一种光学遥感卫星影像时变系统误差建模补偿方法及系统
CN104180808A (zh) 一种用于自主空中加油的圆形锥套视觉位姿解算方法
CN107831515B (zh) 水下定位方法和系统
CN107270891B (zh) 基于抗差估计的惯性地磁匹配定位方法
CN108225307B (zh) 一种惯性测量信息辅助的星图匹配方法
CN103674021A (zh) 基于捷联惯导与星敏感器的组合导航系统及方法
CN105526951B (zh) 一种星敏感器原始观测数据预处理方法及系统
CN107607127B (zh) 一种基于外场的星敏感器内部参数标定及精度快速验证系统
CN107179533A (zh) 一种多参数机载LiDAR系统误差自动检校方法
CN106052718A (zh) 一种基于pos设备与数字航测相机的校验方法及装置
CN102261921A (zh) 一种修正大气折射对星敏感器精度影响的方法
CN110243377A (zh) 一种基于分层式结构的集群飞行器协同导航方法
Tjahjadi et al. Single frame resection of compact digital cameras for UAV imagery
CN105698766A (zh) 考虑定向参数精度信息的卫星影像rfm模型区域网平差方法
CN109855623A (zh) 基于Legendre多项式和BP神经网络的地磁模型在线逼近方法
CN105424034B (zh) 一种船载全天时星光惯导组合导航系统

Legal Events

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