CN112254743B - 一种基于星角距相减的星敏感器在轨标定方法 - Google Patents
一种基于星角距相减的星敏感器在轨标定方法 Download PDFInfo
- Publication number
- CN112254743B CN112254743B CN202011100192.5A CN202011100192A CN112254743B CN 112254743 B CN112254743 B CN 112254743B CN 202011100192 A CN202011100192 A CN 202011100192A CN 112254743 B CN112254743 B CN 112254743B
- Authority
- CN
- China
- Prior art keywords
- star
- coordinate system
- axis
- observability
- matrix
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 88
- 238000003384 imaging method Methods 0.000 claims abstract description 19
- 238000004458 analytical method Methods 0.000 claims abstract description 16
- 238000011410 subtraction method Methods 0.000 claims abstract description 12
- 239000011159 matrix material Substances 0.000 claims description 38
- 239000013598 vector Substances 0.000 claims description 18
- 230000003287 optical effect Effects 0.000 claims description 12
- 238000005259 measurement Methods 0.000 claims description 7
- 238000000354 decomposition reaction Methods 0.000 claims description 6
- 238000010586 diagram Methods 0.000 claims description 3
- 230000026676 system process Effects 0.000 claims description 3
- 230000009466 transformation Effects 0.000 claims description 3
- 238000001914 filtration Methods 0.000 claims description 2
- 238000004422 calculation algorithm Methods 0.000 abstract description 4
- 238000004088 simulation Methods 0.000 abstract description 4
- 238000002474 experimental method Methods 0.000 description 8
- 238000007796 conventional method Methods 0.000 description 5
- 230000000694 effects Effects 0.000 description 5
- 238000012360 testing method Methods 0.000 description 5
- 238000011156 evaluation Methods 0.000 description 4
- YJCCSLGGODRWKK-NSCUHMNNSA-N 4-Acetamido-4'-isothiocyanostilbene-2,2'-disulphonic acid Chemical compound OS(=O)(=O)C1=CC(NC(=O)C)=CC=C1\C=C\C1=CC=C(N=C=S)C=C1S(O)(=O)=O YJCCSLGGODRWKK-NSCUHMNNSA-N 0.000 description 2
- 230000000007 visual effect Effects 0.000 description 2
- 230000007547 defect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
-
- 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)
- General Physics & Mathematics (AREA)
- Manufacturing & Machinery (AREA)
- Automation & Control Theory (AREA)
- Measurement Of Optical Distance (AREA)
- Navigation (AREA)
Abstract
本发明涉及一种基于星角距相减的星敏感器在轨标定方法,属于天文导航领域。研究方法如下:基于场景物体成像到成像平面的物理过程建立针孔成像的相机模型;建立星敏感器角距模型;星敏感器相减方法;可观测性分析;星角距方法的改进;仿真实验。本发明通过改进的ADS(angular distance subtraction)算法,u 0 和v 0 比传统的AD(angular distance)算法精度分别提高了64.0%,21.7%,有效提高了主点标定精度。
Description
技术领域
本本发明涉及天文导航领域,特别涉及一种标定方法,尤指一种基于星角距相减的星敏感器在轨标定方法。
背景技术
星敏感器是一种导航系统,通过对恒星的观测,获取载体的姿态信息。它是目前最精确的光学姿态传感器。由于其导航精度高、自主性强、无累积误差,受到航空航天工业的青睐。作为航天器的“眼睛”,星敏感器的精度直接决定了航天器的性能。然而,星敏感器是一种光学器件,其精度取决于成像质量和光学参数(包括焦距、主点和畸变)的精度。因此,标定是星敏感器的关键技术之一。
星敏感器在标定时需要进行实时标定以提高其导航精度,在所有标定参数中,主点的位置相比其他参数更容易受测量误差影响从而导致标定精度低,目前星敏感器在轨标定方法大多是以星间角距离作为标定参考,这种方法主点的可观测度较差,对主点的标定精度没有其他参数精度高。
发明内容
本发明涉及一种基于星角距相减的星敏感器在轨标定方法,解决了现有技术存在的上述问题。针对传统方法的不足,本发明提供了一种基于星角距相减的星敏感器在轨标定方法,在星敏感器标定中具有良好的应用效果,尤其适用于计算资源有限的星敏感器,针对星角距相减方法耗时长的问题,提出了改进星角距相减模型,与传统的星角距标定方法相比,改进ADS(angular distance subtraction)算法的u0和v0比AD(angular distance)法精度分别提高了64.0%,21.7%,有效提高了主点标定精度。
本发明的上述目的通过以下技术方案实现:
基于星角距相减的星敏感器在轨标定方法,包括如下步骤:
步骤1)、基于场景物体成像到成像平面的物理过程建立针孔成像的相机模型;
步骤2)、建立星角距相减模型;
步骤3)、可观测性分析;
步骤4)、星角距方法的改进。
步骤1)所述的基于场景物体成像到成像平面的物理过程建立针孔成像的相机模型是:(1)相机坐标系(Oc-XcYcZc):以相机的光心为坐标原点,X轴和Y轴分别平行于图像坐标系的X轴和Y轴,相机的光轴为Z轴;
(2)物理图像坐标系(o’-xy):以CCD图像平面与相机光轴的交点为坐标原点o’,X轴和Y轴分别平行于图像平面的两条垂直边,图像坐标系是用物理单位(例如毫米)表示像素在图像中的位置;
(3)像素坐标系(o-uv):以CCD图像平面的左上角顶点为原点,X轴和Y轴分别平行于图像坐标系的X轴和Y轴,像素坐标系就是以像素为单位的图像坐标系;
假设w=[X,Y,Z]T相机坐标系的任意星单位向量,其在针孔模型下理想的图像投影为p=[x,y]T,w和p之间的透视投影关系可以表示为:
其中,[u,v,1]T是点p的齐次坐标,fu和fv分别为u轴和v轴方向的像素焦距;实际上镜头都存在不同大小的畸变,在考虑畸变的情况下,可以使用下述公式来描述相机非线性模型:
其中,(u,v)是等式中的无失真坐标,(ud,vd)是非线性模型下的图像坐标,即考虑镜头几何畸变时的图像坐标。δu(u,v)和δv(u,v)分别是u和v方向的畸变。相机的畸变主要分为径向畸变、偏心畸变以及薄棱镜畸变三种类型,由于径向畸变所带来的影响是最大的,并且高阶畸变可能导致数值不稳定,因此这里我们只考虑径向畸变的一阶和二阶,畸变方程为:
其中k1,k2是径向畸变系数。
步骤2)所述的建立星角距相减模型是:
目前星敏感器标定大多使用角距为标定参考,星敏感器的焦距为f,w和v分别为恒星在星敏感器坐标系中和天球坐标系中的方向矢量,恒星i在星敏感器成像平面坐标系下投影点中心坐标为(xi,yi),则
其中,(x0,y0)主点坐标,αi和δi分别表示第i颗星的赤经和赤纬;假设有i,j两颗星,根据星角距正交变换不变原理,在不考虑畸变和噪声的条件下,恒星i,j在星敏感器坐标系中的方向矢量wi,wj的夹角与对应的天球坐标系中的位置矢量vi,vj的夹角θij相等,可以表示为:
cosθij=wi Twj=vi Tvj (7)
把公式(5)代入公式(7)中,得到
其中,
假设有i,j,k三颗星,利用公式(8)分别计算vi Tvj和vj Tvk,再将两式相减,用S表示,得到:
由于焦距f比CCD尺寸大很多,因此
DiDj≈DjDk (11)
将式(11)近似为DaDb,a,b为任意两颗星,a≠b;公式(10)可以写为:
即将分子的f2项消除,减小焦距的影响,放大对主点的计算,从而提高主点的可观测度,提高标定精度;使用扩展卡尔曼滤波的方法进行标定,对星点图像序列进行循环迭代,则可得到标定后的参数,状态方程为:
xk=I2×2·xk-1 (13)
其中xk为需要标定的主点参数(x0,y0),k-1和k分别代表第k-1和第k幅图像,I2X2为单位矩阵,测量方程是:
zk=h(xk)+nc (14)
其中,zk为星角距相减形成的矩阵,由天球坐标系中的位置矢量计算得到,h(xk)为利用星敏感器标定模型和图像点求解星角距相减的过程,nc是由噪声引起的测量误差,EKF预测方程为:
其中Pk -为k时刻的先验估计协方差,Q为系统过程的协方差矩阵,EKF更新方程为:
其中R是观测噪声的协方差矩阵,Hk是雅可比矩阵。
步骤3)所述的可观测性分析是:
可观测性可以反映状态可估计性的能力,是评价系统可行性的指标,即在不同的模型下,相同的输入偏差可能导致不同的输出偏差,如果输出偏差的幅度较大,即在相同的输出偏差下,输入偏差更小,则可观测性更好,系统更可行,反之亦然;根据可观测性的定义,我们可以得到:
δzk=Hkδx (20)
其中δx是输入偏差,δzk输出偏差,Hk是雅可比矩阵,对雅克比矩阵进行可观测性分析,利用可观测矩阵的奇异值分解,公式(20)可表示为:
δzk=Pk∑kQkδx (21)
其中Pk和Qk分别是左奇异向量和右奇异向量的正交矩阵,∑k为2×N对角矩阵,对角元素是非零奇异值σi(i=1~2);由于Pk和Qk是正交矩阵,可以计算:
其中‖δx‖2和‖δzk‖2分别为δx和δzk的2范数,输出偏差的下确界为:
其中,σmin是可观测矩阵的最小奇异值,σmin越大,输出偏差的最小值越大,可观测性越好;根据以上分析,我们对式(16)中的雅克比矩阵Hk进行奇异值分解,计算每一帧的最小奇异值σmin,对传统星角距方法和星角距相减方法进行可观测性分析比较;相比而言,星角距相减方法的最小奇异值比传统方法的高很多,这表示星角距相减方法的可观测性更好,但是由于使用角距相减组合过多不可避免会增加计算量,导致星敏感器工作效率降低,无法满足实时性要求,因此我们在此基础上对模型进行改进,在不降低标定精度的前提下减少星角距相减的数量,提高标定效率。
步骤4)所述的星角距方法的改进是:
为了提高星角距相减方法的效率,我们提出四种改进方法。假设一帧星点图有N颗星点,根据公式(7),计算任意两颗星的角距离,可以得到一个N阶星角距对称方阵,我们只取上半部分三角形矩阵,给出如下四种相减方式方法1:每一行横向依次相减,即a12-a13,a13-a14,a14-a15……每行最后一个再和下一行第一个相减,即a1N-a23,a2N-a34……
方法2:同方法1,先每行横向依次相减,即a12-a13,a13-a14,a14-a15,……再每列依次相减,即a13-a23,a14-a24,a24-a34……
方法3:在方法2的基础上,增加对角线相减,即a12-a23,a23-a34,a34-a45……
方法4:在方法3的基础上,除了对角线相减外,增加所有斜向相减,即a13-a24,a14-a25,a15-a26……
从使用次数和均匀度综合来看,改进2较好。
附图说明
此处所说明的附图用来提供对本发明的进一步理解,构成本申请的一部分,本发明的示意性实例及其说明用于解释本发明,并不构成对本发明的不当限定。
图1为摘要附图;
图2为相机坐标系与物理图像坐标系的关系;
图3为图像坐标系与物理图像坐标系的关系;
图4为星敏感器角距模型;
图5为传统星角距和星角距相减方法的最小奇异值比较;
图6为星角距矩阵;
图7为噪声标准差为0.5像素实验的姿态残差图。
具体实施方式
下面结合附图进一步说明本发明的详细内容及其具体实施方式。
1.建立星角距相减模型:
目前星敏感器标定大多使用角距为标定参考,星敏感器的焦距为f,w和v分别为恒星在星敏感器坐标系中和天球坐标系中的方向矢量,恒星i在星敏感器成像平面坐标系下投影点中心坐标为(xi,yi),则
其中,(x0,y0)主点坐标,αi和δi分别表示第i颗星的赤经和赤纬;假设有i,j两颗星,根据星角距正交变换不变原理,在不考虑畸变和噪声的条件下,恒星i,j在星敏感器坐标系中的方向矢量wi,wj的夹角与对应的天球坐标系中的位置矢量vi,vj的夹角θij相等,可以表示为:
cosθij=wi Twj=vi Tvj (3)
把公式(5)代入公式(7)中,得到
其中,
假设有i,j,k三颗星,利用公式(4)分别计算vi Tvj和vj Tvk,再将两式相减,用S表示,得到:
由于焦距f比CCD尺寸大很多,因此
DiDj≈DjDk(7)
将式(11)近似为DaDb,a,b为任意两颗星,a≠b。公式(6)可以写为:
即将分子的f 2项消除,减小焦距的影响,放大对主点的计算,从而提高主点的可观测度,提高标定精度。
2.根据上述方法进行标定
使用扩展卡尔曼滤波,对星点图像序列进行循环迭代,则可得到标定后的参数,状态方程为:
xk=I2×2·xk-1 (9)
其中xk为需要标定的主点参数(x0,y0),k-1和k分别代表第k-1和第k幅图像,I2X2为单位矩阵,测量方程是:
zk=h(xk)+nc (10)
其中,zk为星角距相减形成的矩阵,由天球坐标系中的位置矢量计算得到,h(xk)为利用星敏感器标定模型和图像点求解星角距相减的过程,nc是由噪声引起的测量误差,EKF预测方程为:
其中Pk -为k时刻的先验估计协方差,Q为系统过程的协方差矩阵,EKF更新方程为:
其中R是观测噪声的协方差矩阵,Hk是雅可比矩阵。
3.可观测性分析
可观测性可以反映状态可估计性的能力,是评价系统可行性的指标,即在不同的模型下,相同的输入偏差可能导致不同的输出偏差。如果输出偏差的幅度较大,即在相同的输出偏差下,输入偏差更小,则可观测性更好,系统更可行,反之亦然。根据可观测性的定义,我们可以得到:
δzk=Hkδx (16)
其中δx是输入偏差,δzk输出偏差,是雅可比矩阵,对雅克比矩阵进行可观测性分析,利用可观测矩阵的奇异值分解,公式(15)可表示为:
δzk=Pk∑kQkδx (17)
其中Pk和Qk分别是左奇异向量和右奇异向量的正交矩阵,∑k为2×N对角矩阵,对角元素是非零奇异值σi(i=1~2)。由于Pk和Qk是正交矩阵,可以计算:
其中‖δx‖2和‖δzk‖2分别为δx和δzk的2范数。输出偏差的下确界为:
其中,σmin是可观测矩阵的最小奇异值,σmin越大,输出偏差的最小值越大,可观测性越好;根据以上分析,我们对式(11)中的雅克比矩阵Hk进行奇异值分解,计算每一帧的最小奇异值σmin,对传统星角距方法和星角距相减方法进行可观测性分析比较;相比而言,星角距相减方法的最小奇异值比传统方法的高很多,这表示星角距相减方法的可观测性更好,但是由于使用角距相减组合过多不可避免会增加计算量,导致星敏感器工作效率降低,无法满足实时性要求,因此我们在此基础上对模型进行改进,在不降低标定精度的前提下减少星角距相减的数量,提高标定效率。
4.对星角距方法进行改进
为了提高星角距相减方法的效率,我们提出四种改进方法。假设一帧星点图有N颗星点,根据公式(3),计算任意两颗星的角距离,可以得到一个N阶星角距对称方阵,我们只取上半部分三角形矩阵,给出如下四种相减方式,
方法1:每一行横向依次相减,即a12-a13,a13-a14,a14-a15……每行最后一个再和下一行第一个相减,即a1N-a23,a2N-a34……
方法2:同方法1,先每行横向依次相减,即a12-a23,a13-a14,a14-a15,……再每列依次相减,即a13-a23,a14-a24,a24-a34……
方法3:在方法2的基础上,增加对角线相减,即a12-a23,a23-a34,a34-a45……
方法4:在方法3的基础上,除了对角线相减外,增加所有斜向相减,即a13-a24,a14-a25,a15-a26……
表1:
对以上四种改进方法进行均匀度分析,以7颗星为例,每颗星的使用次数和使用率如表1所示;改进1方法每颗星的使用率最均匀,但是使用次数较少,可能会影响标定精度;改进3与改进4每颗星使用次数多,但是均匀度较差;因此从使用次数和均匀度综合来看,改进2较好。
5.仿真实验
采用19.14°×11.18°视场、1920×1080像素阵列星敏感器,以2Hz更新率进行模拟,模拟数据由三组数据组成:惯性坐标系中的3D星矢量、图像坐标系中相应的2D星坐标和具有正态分布噪声的2D星坐标;为了避免其他参数对主点精度的影响,我们将焦距和畸变参数都设为标准值,只对主点进行标定,参数和标准值见表2:
为了充分评价标定方法的性能,提出姿态残差作为评价标准:利用标定所使用的带噪声的仿真数据及主点标定结果计算姿态矩阵和光轴指向,与设定的标准参数计算出的姿态矩阵和光轴指向进行比较,计算每幅图像求得的两个光轴指向的夹角得到的即为姿态残差,最终评价指标是最后100幅图像中姿态残差的均值(μAtt);测试1传统方法与星角距相减方法比较,我们通过设置星敏感器的极限视觉星等,得到恒星数目不同的数据进行实验,AD方法的内参数和畸变参数同样使用表2的标准值,只对主点进行标定,三次实验的平均恒星数分别为7.7、13.6和19.1,极限视星等分别为4.6、5和5.5,2D星坐标添加均值为0,标准差为0.5的正态分布噪声,结果见表3:
表3中,Δu0和Δv0表示标定的主点结果与表1中标准值的差值,μAtt是第四节提出的评价标准,即最后100幅图像中姿态残差的均值,T是处理一幅图像所用的时间,根据表3的结果,星角距相减方法的主点标定精度明显好于传统方法,但是和设想的一样,星角距相减方法耗时长,尤其是在星点数量较多时,这会严重影响星敏感器标定效率,无法满足实时性要求;在测试2中我们采用四种改进方案进行实验,为了验证3C节中对改进方法使用次数和均匀度的分析,进行如下实验。使用每帧平均恒星数为7.7颗星的数据进行实验,添加均值为0,标准差为0.5的正态分布噪声,实验结果如表4:
从表4可以看出,改进1虽然星点使用率比较均匀,但是星角距相减组合数较少,一定程度上导致标定效果不好,改进3和4的星点使用均匀度较差,这会导致标定结果不稳定,且改进4使用角距相减组合数量较多,虽然标定效果比改进1好,但是耗时明显增加,相比之下,改进2的姿态残差最小,精度比改进1提高了44.3%,比ADS方法提高了49.2%,同时耗时比ADS方法减少了12.9%,因此改进2标定效果更好,这与我们在3C节中的分析一致;在测试3中,我们将改进2与传统方法进行比较,使用每帧平均恒星数为7.7颗星,进行三组实验,每组实验噪声标准差分别为0.2像素,0.5像素,0.8像素。实验结果如表5所示:
从表5中可以看出,噪声标准差为0.2像素时改进方法的Δu0比传统方法降低了约50.5%,但是Δv0比传统方法精度提高了约61.1%,从姿态残差也可以看出改进方法对主点的标定精度有所提升;噪声标准差为0.5像素时,改进方法的Δu0和Δv0均好于传统方法;噪声标准差为0.8像素时改进方法的Δv0与传统方法相差不大,但是Δu0有很大幅度的提升;在测试4中,我们将改进2与传统方法全参数比较,为了充分分析IADS2方法的性能,我们对所有参数进行标定实验,实验条件同测试2,校准结果见表6:
Δf(mm) | Δk1 | Δk2 | u0(pixel) | v0(pixel) | T(ms) | |
AD | 0.00002 | -0.0007 | 0.0565 | -2.060 | 2.639 | 126.446 |
改2 | 0.00058 | -0.0087 | 0.3048 | -1.329 | 1.926 | 88.561 |
我们发现,IADS2算法在其他参数标定效果没有AD方法好,但是在其他参数标定精度不高的前提下,主点的标定精度依然要好于传统方法,因此在标定主点前,可以先使用AD法标定其他参数,实现主点高精度标定。
Claims (1)
1.一种基于星角距相减的星敏感器在轨标定方法,其特征在于:包括如下步骤:
步骤1)、基于场景物体成像到成像平面的物理过程建立针孔成像的相机模型;
步骤2)、建立星敏感器角距相减模型;
步骤3)、可观测性分析;
步骤4)、星角距方法的改进;
具体内容如下:
其中,步骤1)所述的基于场景物体成像到成像平面的物理过程建立针孔成像的相机模型是:
(1)相机坐标系(Oc-XcYcZc):以相机的光心为坐标原点,X轴和Y轴分别平行于图像坐标系的X轴和Y轴,相机的光轴为Z轴;
(2)物理图像坐标系(o’-xy):以CCD图像平面与相机光轴的交点为坐标原点o’,X轴和Y轴分别平行于图像平面的两条垂直边,图像坐标系是用物理单位(例如毫米)表示像素在图像中的位置;
(3)像素坐标系(o-uv):以CCD图像平面的左上角顶点为原点,X轴和Y轴分别平行于图像坐标系的X轴和Y轴,像素坐标系就是以像素为单位的图像坐标系;
假设w=[X,Y,Z]T相机坐标系的任意星单位向量,其在针孔模型下理想的图像投影为p=[x,y]T,w和p之间的透视投影关系可以表示为:
其中,[u,v,1]T是点p的齐次坐标,fu和fv分别为u轴和v轴方向的像素焦距;实际上镜头都存在不同大小的畸变,在考虑畸变的情况下,可以使用下述公式来描述相机非线性模型:
其中,(u,v)是等式中的无失真坐标,(ud,vd)是非线性模型下的图像坐标,即考虑镜头几何畸变时的图像坐标,δu(u,v)和δv(u,v)分别是u和v方向的畸变,相机的畸变主要分为径向畸变、偏心畸变以及薄棱镜畸变三种类型,由于径向畸变所带来的影响是最大的,并且高阶畸变可能导致数值不稳定,因此这里我们只考虑径向畸变的一阶和二阶,畸变方程为:
其中k1,k2是径向畸变系数;
其中,步骤2)所述的星敏感器角距相减方法模型是:
目前星敏感器标定大多使用角距为标定参考,星敏感器的焦距为f,w和v分别为恒星在星敏感器坐标系中和天球坐标系中的方向矢量,恒星i在星敏感器成像平面坐标系下投影点中心坐标为(xi,yi),则
其中,(x0,y0)主点坐标,αi和δi分别表示第i颗星的赤经和赤纬;假设有i,j两颗星,根据星角距正交变换不变原理,在不考虑畸变和噪声的条件下,恒星i,j在星敏感器坐标系中的方向矢量wi,wj的夹角与对应的天球坐标系中的位置矢量vi,vj的夹角θij相等,可以表示为:
cosθij=wi Twj=vi Tvj (7)
把公式(5)代入公式(7)中,得到
其中,
假设有i,j,k三颗星,利用公式(8)分别计算vi Tvj和vj Tvk,再将两式相减,用S表示,得到:
由于焦距f比CCD尺寸大很多,因此
DiDj≈DjDk(11)
将式(11)近似为DaDb;a,b为任意两颗星,a≠b;公式(10)可以写为:
即将分子的f 2项消除,减小焦距的影响,放大对主点的计算,从而提高主点的可观测度,提高标定精度;使用扩展卡尔曼滤波的方法进行标定,对星点图像序列进行循环迭代,则可得到标定后的参数,状态方程为:
xk=I2×2·xk-1 (13)
其中xk为需要标定的主点参数(x0,y0),k-1和k分别代表第k-1和第k幅图像,I2X2为单位矩阵,测量方程是:
zk=h(xk)+nc (14)
其中,zk为星角距相减形成的矩阵,由天球坐标系中的位置矢量计算得到,h(xk)为利用星敏感器标定模型和图像点求解星角距相减的过程,nc是由噪声引起的测量误差,EKF预测方程为:
其中Pk -为k时刻的先验估计协方差,Q为系统过程的协方差矩阵,EKF更新方程为:
其中R是观测噪声的协方差矩阵,Hk是雅可比矩阵;
其中,步骤3)所述的可观测性分析是:
可观测性可以反映状态可估计性的能力,是评价系统可行性的指标,即在不同的模型下,相同的输入偏差可能导致不同的输出偏差,如果输出偏差的幅度较大,即在相同的输出偏差下,输入偏差更小,则可观测性更好,系统更可行,反之亦然;根据可观测性的定义,我们可以得到:
δzk=Hkδx (20)
其中δx是输入偏差,δzk输出偏差,Hk是雅可比矩阵,对雅克比矩阵进行可观测性分析,利用可观测矩阵的奇异值分解,公式(20)可表示为:
δzk=Pk∑k Qkδx (21)
其中Pk和Qk分别是左奇异向量和右奇异向量的正交矩阵,∑k为2×N对角矩阵,对角元素是非零奇异值σi(i=1~2);由于Pk和Qk是正交矩阵,可以计算:
其中‖δx‖2和‖δzk‖2分别为δx和δzk的2范数,输出偏差的下确界为:
其中,σmin是可观测矩阵的最小奇异值,σmin越大,输出偏差的最小值越大,可观测性越好;根据以上分析,我们对式(16)中的雅克比矩阵Hk进行奇异值分解,计算每一帧的最小奇异值σmin,对传统星角距方法和星角距相减方法进行可观测性分析比较;相比而言,星角距相减方法的最小奇异值比传统方法的高很多,这表示星角距相减方法的可观测性更好,但是由于使用角距相减组合过多不可避免会增加计算量,导致星敏感器工作效率降低,无法满足实时性要求,因此我们在此基础上对模型进行改进,在不降低标定精度的前提下减少星角距相减的数量,提高标定效率;
其中,步骤4)所述的星角距方法的改进是:
假设一帧星点图有N颗星点,根据公式(7),计算任意两颗星的角距离,可以得到一个N阶星角距对称方阵,我们只取上半部分三角形矩阵,给出如下四种相减方式:
方法1:每一行横向依次相减,即a12-a13,a13-a14,a14-a15……每行最后一个再和下一行第一个相减,即a1N-a23,a2N-a34……
方法2:同方法1,先每行横向依次相减,即a12-a13,a13-a14,a14-a15,……再每列依次相减,即a13-a23,a14-a24,a24-a34……
方法3:在方法2的基础上,增加对角线相减,即a12-a23,a23-a34,a34-a45……
方法4:在方法3的基础上,除了对角线相减外,增加所有斜向相减,即a13-a24,a14-a25,a15-a26……。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011100192.5A CN112254743B (zh) | 2020-10-15 | 2020-10-15 | 一种基于星角距相减的星敏感器在轨标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011100192.5A CN112254743B (zh) | 2020-10-15 | 2020-10-15 | 一种基于星角距相减的星敏感器在轨标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112254743A CN112254743A (zh) | 2021-01-22 |
CN112254743B true CN112254743B (zh) | 2024-05-31 |
Family
ID=74242090
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011100192.5A Active CN112254743B (zh) | 2020-10-15 | 2020-10-15 | 一种基于星角距相减的星敏感器在轨标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112254743B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112945270B (zh) * | 2021-01-27 | 2023-12-19 | 中国科学院新疆理化技术研究所 | 一种基于星对角距平均测量误差的星敏感器辐射损伤外场评估方法 |
CN113034610B (zh) * | 2021-03-17 | 2022-06-03 | 北京控制工程研究所 | 一种基于天文技术的空间指向测量仪器标定方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1923621A (zh) * | 2006-10-10 | 2007-03-07 | 北京航空航天大学 | 基于径向排列约束的星敏感器在轨校准方法 |
CN103438907A (zh) * | 2013-09-11 | 2013-12-11 | 哈尔滨工业大学 | 一种星敏感器六自由度像平面误差的在轨标定方法 |
CN106989761A (zh) * | 2017-05-25 | 2017-07-28 | 北京航天自动控制研究所 | 一种基于自适应滤波的空间飞行器制导工具在轨标定方法 |
CN107449444A (zh) * | 2017-07-17 | 2017-12-08 | 中国人民解放军国防科学技术大学 | 一种多星图姿态关联的星敏感器内参数标定方法及其装置 |
CN110006462A (zh) * | 2019-05-23 | 2019-07-12 | 长春工业大学 | 基于奇异值分解的星敏感器在轨标定方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7451022B1 (en) * | 2006-12-28 | 2008-11-11 | Lockheed Martin Corporation | Calibration of ship attitude reference |
-
2020
- 2020-10-15 CN CN202011100192.5A patent/CN112254743B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1923621A (zh) * | 2006-10-10 | 2007-03-07 | 北京航空航天大学 | 基于径向排列约束的星敏感器在轨校准方法 |
CN103438907A (zh) * | 2013-09-11 | 2013-12-11 | 哈尔滨工业大学 | 一种星敏感器六自由度像平面误差的在轨标定方法 |
CN106989761A (zh) * | 2017-05-25 | 2017-07-28 | 北京航天自动控制研究所 | 一种基于自适应滤波的空间飞行器制导工具在轨标定方法 |
CN107449444A (zh) * | 2017-07-17 | 2017-12-08 | 中国人民解放军国防科学技术大学 | 一种多星图姿态关联的星敏感器内参数标定方法及其装置 |
CN110006462A (zh) * | 2019-05-23 | 2019-07-12 | 长春工业大学 | 基于奇异值分解的星敏感器在轨标定方法 |
Non-Patent Citations (5)
Title |
---|
Star sensor on-orbit calibration based on multiple calibration targets;L Wu等;2019 14th IEEE International Conference on Electronic Measurement & Instruments (ICEMI);20191103;第1402-1409页 * |
基于卡尔曼滤波的星敏感器在轨校准方法;申娟;张广军;魏新国;;航空学报(06);全文 * |
基于最小损失函数的三视场天文定位定向;吴量;王建立;王昊京;;光学精密工程(03);全文 * |
星敏感器标定方法研究;钟红军;杨孟飞;卢欣;;光学学报;20100515(05);全文 * |
星敏感器误差模型及参数分析;王永胜;王宏力;刘洁梁;崔祥祥;;电光与控制(02);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN112254743A (zh) | 2021-01-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112254743B (zh) | 一种基于星角距相减的星敏感器在轨标定方法 | |
CN110689579A (zh) | 基于合作目标的快速单目视觉位姿测量方法及测量系统 | |
US8542947B2 (en) | Method for RPC refinement using ground control information | |
Chatterjee et al. | Algorithms for coplanar camera calibration | |
CN112435262A (zh) | 基于语义分割网络和多视图几何的动态环境信息检测方法 | |
CN112465877B (zh) | 一种基于运动状态估计的卡尔曼滤波视觉追踪稳定方法 | |
CN111207670A (zh) | 一种线结构光标定装置及方法 | |
Ding et al. | A robust detection method of control points for calibration and measurement with defocused images | |
CN116342661A (zh) | 利用路标点偏置位姿修正的双目视觉惯性里程计方法 | |
CN111553954B (zh) | 一种基于直接法单目slam的在线光度标定方法 | |
CN110006462B (zh) | 基于奇异值分解的星敏感器在轨标定方法 | |
CN116929338A (zh) | 地图构建方法、设备及存储介质 | |
CN115908581A (zh) | 一种车载相机俯仰角标定方法、装置、设备及存储介质 | |
CN115630254A (zh) | 高精度星敏感器光学系统内参数微变化量的在轨标定方法 | |
Ning et al. | Spacecraft angular velocity estimation method using optical flow of stars | |
CN112712107B (zh) | 一种基于优化的视觉和激光slam融合定位方法 | |
Wu et al. | An on-orbit calibration method of star sensor based on angular distance subtraction | |
CN111968183B (zh) | 一种用于单目线激光三维测量模块标定的量块标定法 | |
An et al. | On the camera position dithering in visual 3D reconstruction | |
CN113159197A (zh) | 一种纯旋转运动状态判定方法及装置 | |
CN110827323A (zh) | 一种用于水下装置定点悬停的方法和装置 | |
JP5215615B2 (ja) | 3次元位置情報復元装置およびその方法 | |
CN111428411B (zh) | 一种去除有限元仿真分析结果中节点离散误差的方法 | |
Zhen-wei et al. | Effective factors analysis on camera calibration | |
CN111242995A (zh) | 一种快速鲁棒的摄像机绝对姿态估计方法 |
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 |