CN111521173B - 一种基于星敏感器的光轴与天球面交点d坐标的计算方法 - Google Patents

一种基于星敏感器的光轴与天球面交点d坐标的计算方法 Download PDF

Info

Publication number
CN111521173B
CN111521173B CN202010233680.7A CN202010233680A CN111521173B CN 111521173 B CN111521173 B CN 111521173B CN 202010233680 A CN202010233680 A CN 202010233680A CN 111521173 B CN111521173 B CN 111521173B
Authority
CN
China
Prior art keywords
point
coordinate system
coordinate
celestial
expression
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.)
Expired - Fee Related
Application number
CN202010233680.7A
Other languages
English (en)
Other versions
CN111521173A (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.)
Hubei University
Original Assignee
Hubei 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 Hubei University filed Critical Hubei University
Priority to CN202010233680.7A priority Critical patent/CN111521173B/zh
Publication of CN111521173A publication Critical patent/CN111521173A/zh
Application granted granted Critical
Publication of CN111521173B publication Critical patent/CN111521173B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/02Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by astronomical means
    • G01C21/025Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by astronomical means with the use of startrackers
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/24Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for cosmonautical navigation

Abstract

本发明涉及一种基于星敏感器的光轴与天球面交点D坐标的计算方法,包括以下步骤:建立天球坐标系下的空间直角坐标系,对其进行平移或旋转变换使之与星敏感器坐标系重合,得到两个坐标系之间的转换关系,并用各参数表示出D点在天球坐标系中的坐标表达式;通过余弦定理得到各坐标之间的关系,再利用泰勒展开式得到投影中心到其星敏感器感光面上投影点的距离f的近似表达式;将其代入D点在天球坐标系中的坐标表达式得到D点的天球坐标近似值表达式;结合中值定理进行误差分析,并得出恒星选取标准进一步提高D点坐标精度。本发明的目的是建立数学模型,求解出光轴与天球面交点D的坐标,再通过优化算法精确D点坐标,提高星敏感器姿态测量精度。

Description

一种基于星敏感器的光轴与天球面交点D坐标的计算方法
技术领域
本发明涉及天文导航领域,具体的讲是一种基于星敏感器的光轴与天球面交点D坐标的计算方法。
背景技术
天文导航是以已知准确空间位置的自然天体为基准,通过星敏感器实现航行体的自主姿态测量,这里的姿态是指航行体的像空间坐标系在给定的参考系中的方位元素,从而解算出确定测量点所在载体的导航信息。由于星敏感器利用恒星的天文信息,因此具有自主性好、精度高、工作可靠等特点,在航天飞行中具有广阔应用前景。目前星敏感器已经能够实现完全自主姿态确定,它的工作原理是以恒星为参照物,利用CCD照相机实拍到的星图,经过恒星质心提取、星图识别和姿态估算等一系列计算,确定出星敏感器的光轴在惯性参考系(一般为天球坐标系)的瞬时指向,从而确定航行器的姿态。所以精确光轴与天球面交点的位置信息对实现航行体的高精度姿态测量具有重要意义。
绝大部分航行体在完成一定任务时,如通信、对地观测、空间实验等,必须知道它们的姿态信息,利用星敏感器对其进行姿态确定。姿态确定系统通常由姿态敏感器(一般为星敏感器)和姿态确定算法组成。姿态确定算法一般又分为确定性算法和状态估计算法。确定性算法主要有:TRIAD方法、QUEST方法、FOAM方法和SVD方法。确定性方法的优点是无需先验的姿态信息,但它很难克服参考矢量的各种误差,如星敏感器的测量误差、偏置误差及安装误差等,难以建立航行体姿态确定模式以及加权处理不同精度的测量值。
为了提高姿态确定的精度,矢量观测中的一些不确定因素也应作为被估计的变量参与航行体的姿态计算,这就是姿态确定的状态估计算法。目前常用的飞行器姿态估计算法有:扩展卡尔曼滤波、扩展四元数估计、递归四元数估计、预测卡尔曼滤波和非线性预测滤波。在上述姿态估计算法中,只有卡尔曼滤波、预测卡尔曼滤波和非线性预测滤波仅需利用星敏感器观测矢量数据就可以估计飞行器姿态,其余滤波算法需要利用两种或两种以上的姿态敏感器才能完成对姿态敏感器姿态的估计。在目前的工程领域中,姿态估计算法一般采用卡尔曼滤波算法。卡尔曼滤波算法的工作原理是根据空间飞行器姿态运动学方程,建立状态方程和观测方程,最后根据观察信息得到一定准则下的最优状态估计值。
发明内容
本发明要解决的技术问题是针对以上不足,提供一种基于星敏感器的光轴与天球面交点D坐标的计算方法,本发明的目的是利用天球坐标系与星敏感器坐标系间的变换关系建立数学模型,求解出星敏感器的光轴与天球面交点D的坐标,再通过优化算法精确交点的位置信息,提高星敏感器姿态测量精度以实现航行体高精度姿态测量。
为解决以上技术问题,本发明采用以下技术方案:
一种基于星敏感器的光轴与天球面交点坐标D的计算方法,包括以下步骤:
步骤S1、建立天球坐标系下的空间直角坐标系,再对天球坐标系进行平移或旋转变换使之与星敏感器坐标系重合,完成天球坐标系与星敏感器坐标系之间坐标的转换,求出D点在星敏感器坐标系中的坐标,利用两坐标系之间的转换关系得到D点在天球坐标系中的坐标表达式,用参数ai,(αii)(i=1,2,3),f表示出D点在天球坐标系中的坐标(α0,δ0);其中Pi(i=1,2,3)为已知恒星点,O点为空间直角坐标系投影中心,O'点为O点在星敏感器感光面上的投影点,Qi为Pi在星敏感器感光面上的成像点,ai为O'到Qi的距离,(αii)为Pi在天球坐标系下的坐标,f为O点与O'点之间的距离;
步骤S2、利用余弦定理建立角度θi和距离f的关系表达式,利用D与Pi的坐标之间的关系建立角度θi和距离f的矩阵表达式,利用泰勒展开式将关系表达式和矩阵表达式转化为一元二次方程进行简化计算,得到f的近似解表达式,其中θi为D与Pi在天球坐标系中形成的球心角;
步骤S3、将f的近似解表达式直接代入步骤S1中得到的D点在天球坐标系中的坐标表达式或根据坐标间的转换关系直接计算,得到D点在天球坐标系中坐标近似值表达式;
步骤S4、利用中值定理对D点在天球坐标系中的坐标近似值进行误差分析,得到恒星点Pi的选取标准,进一步精确D点的位置信息。
进一步的,所述步骤S4中的选取标准的计算方法为:利用中值定理找出由步骤S3得到的D点在天球坐标系中坐标近似值表达式与D点坐标实际值之间误差的关系,使得D点在天球坐标系中坐标近似值表达式误差最小的条件即为选取标准。
进一步的,所述选取标准为:Pi的θi尽量小,且
Figure BDA0002430241890000031
不共面。
本发明采用以上技术方案后,与现有技术相比,具有以下优点:
本发明只需要利用星敏感器进行星空图像处理得到星体像空间坐标,进一步计算得到星敏感器的光轴与天球面交点D的坐标;同时对传统的用ai,(αii)(i=1,2,3),f表示D点坐标的方法进行改进,利用泰勒展开式简化计算,得到f的一个近似算法;相比于用星敏感器感光面每一个坐标轴方向上的像素个数、像元尺寸以及视场角等参数表示f,这种方法不容易受光学测量系统内部参数变化的影响,提高了星敏感器姿态测量的精度;将f的近似解代入计算出D点坐标近似值,可以不需要知道f的参数就表示出D点坐标,同时能对近似解的精度进行分析;利用中值定理进行误差分析可以得到选取恒星的标准,只通过选取合适的三颗恒星就可以很好地控制结果的精度,进一步精确交点的位置信息,具有很强的可操作性和适用性,大大简化了计算;由于光轴与天球面交点的坐标可以反映天球坐标系与星敏感器坐标系在空间中的一种位置关系,光轴与天球面交点的位置信息越精确,航行器在天球上的导航定位就越准确,为基于星敏感器的航行器姿态确定奠定基础,从而实现航行体的高精度姿态测量。
下面结合附图和实施例对本发明进行详细说明。
附图说明
图1为本发明的流程示意图,其中D为光轴OO'与天球面交点;(αii)为Pi在天球坐标系下的坐标;
图2为本发明在Pi点成像位置示意图,其中(xi,yi,zi)为Pi点在天球坐标系下的直角坐标;(Xi,Yi)为Qi在图像坐标系下坐标;O为投影中心;O'为O在星敏感器感光面上的投影点;f为O点与O'点之间的距离;Pi为已知恒星点,Qi为Pi在星敏感器感光面上的成像点;
图3为角度与距离关系示意图,其中O为投影中心;O'为O在星敏感器感光面上的投影点;D为光轴OO'与天球面交点;Pi为已知恒星点;Qi为Pi在星敏感器感光面上的成像点;θi为D与Pi在天球坐标系中形成的球心角。
具体实施方式
以下结合附图对本发明的原理和特征进行描述,所举实例只用于解释本发明,并非用于限定本发明的范围。
如图1所示,一种基于星敏感器的光轴与天球面交点D坐标的计算方法,包括以下步骤:
步骤S1、建立天球坐标系下的空间直角坐标系,再对天球坐标系进行平移或旋转变换使之与星敏感器坐标系重合,完成天球坐标系与星敏感器坐标系之间坐标的转换,求出D点在星敏感器坐标系中的坐标,利用两坐标系之间的转换关系得到D点在天球坐标系中的坐标表达式,用参数ai,(αii)(i=1,2,3),f表示出D点在天球坐标系中的坐标(α0,δ0);其中Pi(i=1,2,3)为已知恒星点,O点为空间直角坐标系投影中心,O'点为O点在星敏感器感光面上的投影点,Qi为Pi在星敏感器感光面上的成像点,ai为O'到Qi的距离,(αii)为Pi在天球坐标系下的坐标,f为O点与O'点之间的距离;
其中包括以下步骤:
步骤S11、建立天球坐标系下的空间直角坐标系;
由坐标变换可得Pi(xi,yi,zi)(i=1,2,3)在所建立的天球坐标系中的坐标为:
Figure BDA0002430241890000051
其中r为人为假设的天体半径。
则Pi在天球直角坐标系下的坐标为(rcos δicos αi,rcos δisin αi,rsin δi)。
步骤S12、对天球坐标系进行平移、旋转变换使之与星敏感器坐标系重合;
因为恒星与地球的距离非常远,为了简化模型,我们将天球坐标系的中心平移至与星敏感器坐标系的中心重合。又因天球坐标系本身与星敏感器坐标系存在夹角,故在使两坐标系原点重合后我们需要通过对天球坐标系进行一系列的旋转,使得两坐标系完全重合。
首先,我们规定旋转的角度及方向:
①将天球坐标系绕星敏感器坐标系的X轴逆时针旋转ω;
②将经过步骤①旋转后的天球坐标系绕星敏感器坐标系的Y轴顺时针旋转φ;
③将经过步骤②旋转后的天球坐标系绕星敏感器坐标系的Z轴逆时针旋θ。
其中,ω、φ、θ的单位都为(°)。
在经过步骤①旋转后的天球坐标系O-xαyαzα下的坐标与原天球坐标系下坐标的对应关系为:
Figure BDA0002430241890000052
同样的,经过步骤②旋转后的天球坐标系O-xωφyωφzωφ与原来天球坐标系O-xωyωzω下坐标的对应关系为:
Figure BDA0002430241890000053
经过步骤③旋转后的天球坐标系O-xωφθyωφθzωφθ与原来天球坐标系O-xωφyωφzωφ下坐标的对应关系为:
Figure BDA0002430241890000061
经过三次旋转后的天球坐标系与星敏感器坐标系完全重合,记Pi在星敏感器下的坐标为(x'i,y'i,z'i)(i=1,2,3),则两坐标系下坐标的对应表达式为:
Figure BDA0002430241890000062
用MATLAB整理后:
Figure BDA0002430241890000063
其中:
p1=cosφsinθ-sinφsinωsinθ
p2=-cosφsinθ-sinφsinωcosθ
p3=-sinφcosω
q1=cosωsinθ
q2=cosωcosθ
q3=-sinω
m1=sinφcosθ+cosφsinθsinω
m2=-sinφsinθ+cosφsinθcosω
m3=cosφcosω
步骤S13、天球坐标系与星敏感器坐标系坐标的转换;
因为点O为星敏感器坐标轴的中心,即投影中心,如图2所示,恒星Pi在感光面上成像于点Qi处。投影中心O、成像点Qi以及恒星Pi成一条直线,设Q1、Q2、Q3三点在投影平面所在的图像坐标系O'-XY上的坐标分别为(X1,Y1)、(X2,Y2)、(X3,Y3),P1、P2、P3在星敏感器坐标系O-xyz中的坐标分别为(x'1,y'1,z'1)、(x'2,y'2,z'2)、(x'3,y'3,z'3),则由O,Qi,Pi三点共线可得到表达式:
Figure BDA0002430241890000071
进一步计算可得:
Figure BDA0002430241890000072
那么可以建立图像坐标系上OQi的距离表达式:
Figure BDA0002430241890000073
而OQi=ai,利用MATLAB可解出只含有已知参数δi、αi、ai、f的三个旋转角度ω、φ、θ,据此可确定pi、qi、mi的取值。由于点D为光轴OO'与天球面的交点,所以在星敏感器坐标系下点D的横纵坐标均为0,那么可以得到表达式:
Figure BDA0002430241890000074
Figure BDA0002430241890000075
其中的(α0,δ0)即为天球坐标系下点D的坐标。由此可得:
Figure BDA0002430241890000076
从而所述由ai,(αii)(i=1,2,3),f等参数表示的D点在天球坐标系下的坐标(α0,δ0)根据如下第一公式计算:
所述第一公式如下:
Figure BDA0002430241890000081
其中,所述pi、qi、mi(i=1,2,3)是由f、(αi,δi)、ai(i=1,2,3)等参数计算得到的。
步骤S2、利用余弦定理建立角度θi和距离f的关系表达式,利用D与Pi的坐标之间的关系建立角度θi和距离f的矩阵表达式,利用泰勒展开式将关系表达式和矩阵表达式转化为一元二次方程进行简化计算,得到f的近似解表达式,其中θi为D与Pi在天球坐标系中形成的球心角;
其中包括以下步骤:
步骤S21、利用余弦定理建立D与Pi在天球坐标系中形成的球心角θi和距离f的关系表达式;
如图3所示,点D和点Pi均在天球上(天球未画出)。可得出角度与距离的表达式:
Figure BDA0002430241890000082
Figure BDA0002430241890000083
其中θi为D与Pi在天球坐标系中形成的球心角,由余弦定理:
Figure BDA0002430241890000084
令r为假定的天球半径,则由|OD|=|OPi|=r可得:
Figure BDA0002430241890000085
故:
|DPi|2=2r2-2r2cosθi
步骤S22、利用D与Pi的坐标之间的关系建立角度θi和距离f的矩阵表达式;
设D、Pi在天球坐标系下的直角坐标表示为:
D=(x0,y0,z0)=(rcos α0cos δ0,rsin α0cos δ0,rsin δ0)
Pi=(xi,yi,zi)=(rcos αicos δi,rsin αicos δi,rsin δi)
由距离公式可得:
(x0-xi)2+(y0-yi)2+(z0-zi)2=2r2-2r2cosθi
由于x0 2+y0 2+z0 2=r2,xi 2+yi 2+zi 2=r2
整理后可得:
x0xi+y0yi+z0zi=r2cosθi
Figure BDA0002430241890000091
则可进一步转换为矩阵的表达形式:
XiX0=cosθi
定义矩阵A和Θ如下:
Figure BDA0002430241890000092
Figure BDA0002430241890000093
那么对于A、X0和Θ满足:
AX0=Θ
步骤S23、利用泰勒展开式将关系表达式和矩阵表达式转化为一元二次方程进行简化计算,得到f的近似解表达式;
如果矩阵A可逆,那么
X0=A-1Θ
要使矩阵A可逆,则行列式:
Figure BDA0002430241890000101
即Xi之间线性无关,转化为几何上的关系为X1、X2、X3不共面,也就是说计算D点坐标时所选取的三颗恒星与投影中心形成的三个矢量要不共面。
由于X0 TX0=1,则
ΘT(A-1)TA-1Θ=1
令B=(A-1)TA-1,则有ΘTBΘ=1,其中B可由MATLAB求得。直接求解这个方程比较复杂,为简化计算我们利用泰勒展开式将其转化为一元二次方程求解。
将cosθi的表达式泰勒展开可得:
Figure BDA0002430241890000102
令:
Y1=(1,1,1)
Figure BDA0002430241890000103
Figure BDA0002430241890000104
则有:
(Y1+Y2+Y3)B(Y1+Y2+Y3)T=1
令a=max{a1、a2、a3},化简得:
Figure BDA0002430241890000105
其中,M=Y1BY1 T、N=4f4Y2BY2 T、K=2f2Y1BY2 T为由ai,(αii)(i=1,2,3)计算得到的常数。
从而转化为关于
Figure BDA0002430241890000106
的一元二次方程:
Figure BDA0002430241890000111
记f的近似解为f1,若高阶无穷小量
Figure BDA0002430241890000112
充分小,则有:
Figure BDA0002430241890000113
从而f的近似解根据如下第二公式计算:
所述第二公式如下:
Figure BDA0002430241890000114
其中,所述f1为f的近似解;所述M,N,K为由ai,(αii)(i=1,2,3)计算得到的常数。
步骤S3、将f的近似解表达式直接代入步骤S1中得到的D点在天球坐标系中的坐标表达式或根据坐标间的转换关系直接计算,得到D点在天球坐标系中坐标近似值表达式;
坐标间的转换公式根据如下第三公式计算:
所述第三公式如下:
X0=A-1Θ
其中,所述
Figure BDA0002430241890000115
(x0,y0,z0)为D点在天球坐标系下的直角坐标;所述A-1,Θ为已定义矩阵,A-1中的元素由参数(αii)(i=1,2,3)计算表示。
Figure BDA0002430241890000116
Figure BDA0002430241890000117
可得:
Figure BDA0002430241890000121
而由(x0,y0,z0)=(rcos α0cos δ0,rsin α0cos δ0,rsin δ0)可将上式进一步写成:
Figure BDA0002430241890000122
将cosθi(i=1,2,3)泰勒展开有:
Figure BDA0002430241890000123
若高阶无穷小量
Figure BDA0002430241890000124
充分小,记
Figure BDA0002430241890000125
由于f1为f的近似值,故
Figure BDA0002430241890000126
为cosθi的近似值,从而解出D点在天球坐标系下的坐标(α0,δ0)的近似解
Figure BDA0002430241890000127
为:
Figure BDA0002430241890000128
Figure BDA0002430241890000129
代入,从而由f1计算的D点在天球坐标系下的坐标近似值
Figure BDA00024302418900001210
Figure BDA00024302418900001211
根据如下第四公式计算:
所述第四公式如下:
Figure BDA0002430241890000131
其中,所述
Figure BDA0002430241890000132
是D点在天球坐标系下的坐标近似值;所述f1为f的近似值;所述a1i,a2i和a3i(i=1,2,3)为由参数(αii)(i=1,2,3)计算得到的常数;所述ai(i=1,2,3)为条件中给定参数。
再把步骤S23中所述第二公式代入,从而不利用f值表示的D点坐标近似值根据如下第五公式计算:
所述第五公式如下:
Figure BDA0002430241890000133
其中,所述
Figure BDA0002430241890000134
是D点在天球坐标系下的坐标近似值;所述a1i,a2i和a3i(i=1,2,3)为由(αii)(i=1,2,3)计算得到的常数;所述ai(i=1,2,3)为条件中给定参数;所述
Figure BDA0002430241890000135
M,N,K为由ai,(αii)(i=1,2,3)计算得到的常数。
步骤S4、利用中值定理对D点在天球坐标系中的坐标近似值进行误差分析,得到恒星点Pi的选取标准,进一步精确D点的位置信息;
由于D点在天球坐标系下的坐标表示为:
Figure BDA0002430241890000141
将cosθi的近似值
Figure BDA0002430241890000142
代入得到D点在天球坐标系下的坐标近似值
Figure BDA0002430241890000143
的表达式:
Figure BDA0002430241890000144
结合步骤S3中所述第四公式可得:
Figure BDA0002430241890000145
其中
Figure BDA0002430241890000146
为所求D点天球坐标的近似值。令(α0,δ0)为所求D点天球坐标的真实值,由中值定理可得:
Figure BDA0002430241890000147
Figure BDA0002430241890000151
其中
Figure BDA0002430241890000152
为介于
Figure BDA0002430241890000153
Figure BDA0002430241890000154
中间的值。
由于
Figure BDA0002430241890000155
当θi充分小时有
Figure BDA0002430241890000156
故:
Figure BDA0002430241890000157
其中C为某一常数。令
Figure BDA0002430241890000158
则有:
Figure BDA0002430241890000159
Figure BDA00024302418900001510
Figure BDA00024302418900001511
控制。记f0为f的真实值,由
Figure BDA00024302418900001512
有:
Figure BDA00024302418900001513
Figure BDA0002430241890000161
其中
Figure BDA0002430241890000162
为介于
Figure BDA0002430241890000163
Figure BDA0002430241890000164
之间的值。由此可知
Figure BDA0002430241890000165
Figure BDA0002430241890000166
控制,类似地可以证明
Figure BDA0002430241890000167
也被
Figure BDA0002430241890000168
控制。即:
Figure BDA0002430241890000169
Figure BDA00024302418900001610
其中c2、c3是与Pi相关的常数。
Figure BDA00024302418900001611
以及
Figure BDA00024302418900001612
结合步骤S23中关于
Figure BDA00024302418900001613
的一元二次方程有:
Figure BDA00024302418900001614
解方程组进一步可得:
((u1+u0)N-K)(u1-u0)=o(u0 2a4)
故:
Figure BDA00024302418900001615
由于焦距f1和f0足够小,K可被u0控制,(u1+u0)N-K可看作u0的等阶无穷小量,则有:
Figure BDA00024302418900001616
当θi足够小时,tanθi~θi,故
Figure BDA00024302418900001617
则有:
Figure BDA00024302418900001618
同理可得:
Figure BDA0002430241890000171
故求解D点在天球坐标系中坐标的近似值与实际值之间的误差由θi 6控制,θi越小误差越小。
综上所述,为了提高D点在天球坐标系中坐标的精度,我们在选取三颗恒星Pi时要满足下面两个条件:
Figure BDA0002430241890000172
不共面;
②∠P1OD、∠P2OD、∠P3OD尽量小。
以上所述为本发明最佳实施方式的举例,其中未详细述及的部分均为本领域普通技术人员的公知常识。本发明的保护范围以权利要求的内容为准,任何基于本发明的技术启示而进行的等效变换,也在本发明的保护范围之内。

Claims (3)

1.一种基于星敏感器的光轴与天球面交点D坐标的计算方法,其特征在于,包括以下步骤:
步骤S1、建立天球坐标系下的空间直角坐标系,再对天球坐标系进行平移或旋转变换使之与星敏感器坐标系重合,完成天球坐标系与星敏感器坐标系之间坐标的转换,求出D点在星敏感器坐标系中的坐标,利用两坐标系之间的转换关系得到D点在天球坐标系中的坐标表达式,用参数ai,(αi,δi)(i=1,2,3),f表示出D点在天球坐标系中的坐标(α0,δ0);其中Pi(i=1,2,3)为已知恒星点,0点为空间直角坐标系投影中心,O′点为0点在星敏感器感光面上的投影点,Qi为Pi在星敏感器感光面上的成像点,ai为O′到Qi的距离,(αi,δi)为Pi在天球坐标系下的坐标,f为0点与O′点之间的距离;
步骤S2、利用余弦定理建立角度θi和距离f的关系表达式,利用D与Pi的坐标之间的关系建立角度θi和距离f的矩阵表达式,利用泰勒展开式将关系表达式和矩阵表达式转化为一元二次方程进行简化计算,得到f的近似解表达式,其中θi为D与Pi在天球坐标系中形成的球心角;
具体包括以下步骤:
步骤S21、利用余弦定理建立D与Pi在天球坐标系中形成的球心角θi和距离f的关系表达式;
可得出角度与距离的表达式:
Figure FDA0002769180140000011
Figure FDA0002769180140000021
其中θi为D与Pi在天球坐标系中形成的球心角,由余弦定理:
Figure FDA0002769180140000022
令r为假定的天球半径,则由|OD|=|OPi|=r可得:
Figure FDA0002769180140000023
故:
|DPi|2=2r2-2r2cosθi
步骤S22、利用D与Pi的坐标之间的关系建立角度θi和距离f的矩阵表达式;
设D、Pi在天球坐标系下的直角坐标表示为:
D=(x0,y0,z0)=(r cosα0cosδ0,r sina0cosδ0,r sinδ0)
Pi=(xi,yi,zi)=(r cosαicosδi,r sinαicosδi,r sinδi)
由距离公式可得:
(x0-xi)2+(y0-yi)2+(z0-zi)2=2r2-2r2cosθi
由于x0 2+y0 2+z0 2=r2,xi 2+yi 2+zi 2=r2
整理后可得:
x0xi+y0yi+z0zi=r2cosθi
Figure FDA0002769180140000024
则可进一步转换为矩阵的表达形式:
XiX0=cosθi
定义矩阵A和Θ如下:
Figure FDA0002769180140000031
Figure FDA0002769180140000032
那么对于A、X0和Θ满足:
AX0=Θ
步骤S23、利用泰勒展开式将关系表达式和矩阵表达式转化为一元二次方程进行简化计算,得到f的近似解表达式;
如果矩阵A可逆,那么
X0=A-1Θ
要使矩阵A可逆,则行列式:
Figure FDA0002769180140000033
即Xi之间线性无关,转化为几何上的关系为X1、X2、X3不共面,也就是说计算D点坐标时所选取的三颗恒星与投影中心形成的三个矢量要不共面;
由于X0 TX0=1,则
ΘT(A-1)TA-1Θ=1
令B=(A-1)TA-1,则有ΘTBΘ=1,其中B可由MATLAB求得;直接求解这个方程比较复杂,为简化计算我们利用泰勒展开式将其转化为一元二次方程求解;
将cosθi的表达式泰勒展开可得:
Figure FDA0002769180140000041
令:
Y1=(1,1,1)
Figure FDA0002769180140000042
Figure FDA0002769180140000043
则有:
(Y1+Y2+Y3)B(Y1+Y2+Y3)T=1
令a=max{a1、a2、a3},化简得:
Figure FDA0002769180140000044
其中,M=Y1BY1 T、N=4f4Y2BY2 T、K=2f2Y1BY2 T为由ai,(αi,δi)(i=1,2,3)计算得到的常数;
从而转化为关于
Figure FDA0002769180140000045
的一元二次方程:
Figure FDA0002769180140000046
记f的近似解为f1,若高阶无穷小量
Figure FDA0002769180140000047
充分小,则有:
Figure FDA0002769180140000048
从而f的近似解根据如下第二公式计算:
所述第二公式如下:
Figure FDA0002769180140000049
其中,所述f1为f的近似解;所述M,N,K为由ai,(αi,δi)(i=1,2,3)计算得到的常数;
步骤S3、将f的近似解表达式直接代入步骤S1中得到的D点在天球坐标系中的坐标表达式或根据坐标间的转换关系直接计算,得到D点在天球坐标系中坐标近似值表达式;
步骤S4、利用中值定理对D点在天球坐标系中的坐标近似值进行误差分析,得到恒星点Pi的选取标准,进一步精确D点的位置信息。
2.根据权利要求1所述的基于星敏感器的光轴与天球面交点D坐标的计算方法,其特征在于,所述步骤S4中的选取标准的计算方法为:利用中值定理找出由步骤S3得到的D点在天球坐标系中坐标近似值表达式与D点坐标实际值之间误差的关系,使得D点在天球坐标系中坐标近似值表达式误差最小的条件即为选取标准。
3.根据权利要求1所述的基于星敏感器的光轴与天球面交点D坐标的计算方法,其特征在于,所述选取标准为:Pi的θi尽量小,且
Figure FDA0002769180140000051
不共面。
CN202010233680.7A 2020-03-30 2020-03-30 一种基于星敏感器的光轴与天球面交点d坐标的计算方法 Expired - Fee Related CN111521173B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010233680.7A CN111521173B (zh) 2020-03-30 2020-03-30 一种基于星敏感器的光轴与天球面交点d坐标的计算方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010233680.7A CN111521173B (zh) 2020-03-30 2020-03-30 一种基于星敏感器的光轴与天球面交点d坐标的计算方法

Publications (2)

Publication Number Publication Date
CN111521173A CN111521173A (zh) 2020-08-11
CN111521173B true CN111521173B (zh) 2020-12-15

Family

ID=71902190

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010233680.7A Expired - Fee Related CN111521173B (zh) 2020-03-30 2020-03-30 一种基于星敏感器的光轴与天球面交点d坐标的计算方法

Country Status (1)

Country Link
CN (1) CN111521173B (zh)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113791377B (zh) * 2021-09-09 2024-04-12 中国科学院微小卫星创新研究院 一种基于角度测量的定位方法
CN115166969B (zh) * 2022-07-22 2024-03-22 中国科学院光电技术研究所光学元件厂 一种基于透镜偏心的高精度控制方法

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101441082A (zh) * 2008-12-22 2009-05-27 中国科学院长春光学精密机械与物理研究所 快速三角形星图识别方法

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001099677A (ja) * 1999-09-30 2001-04-13 Toshiba Corp スターセンサ
CN101435704B (zh) * 2008-12-04 2010-06-16 哈尔滨工业大学 一种星敏感器高动态下的星跟踪方法
CN101893440B (zh) * 2010-05-19 2011-12-14 哈尔滨工业大学 基于星敏感器的天文自主导航方法
CN101995248B (zh) * 2010-11-12 2012-06-06 清华大学 一种快速搜索导航星表的方法
CN102128623B (zh) * 2010-12-02 2012-08-22 哈尔滨工业大学 一种星敏感器快速星图识别方法
CN103591966A (zh) * 2013-10-22 2014-02-19 浙江大学 一种星模拟器测试平台及测试标定方法
CN103968835B (zh) * 2014-05-14 2017-02-15 哈尔滨工程大学 一种折射星的模拟方法
US9791278B2 (en) * 2015-03-24 2017-10-17 Honeywell International Inc. Navigating with star tracking sensors

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101441082A (zh) * 2008-12-22 2009-05-27 中国科学院长春光学精密机械与物理研究所 快速三角形星图识别方法

Also Published As

Publication number Publication date
CN111521173A (zh) 2020-08-11

Similar Documents

Publication Publication Date Title
CN109887057B (zh) 生成高精度地图的方法和装置
CN109708649B (zh) 一种遥感卫星的姿态确定方法及系统
CN105352509B (zh) 地理信息时空约束下的无人机运动目标跟踪与定位方法
CN107728182B (zh) 基于相机辅助的柔性多基线测量方法和装置
CN111521173B (zh) 一种基于星敏感器的光轴与天球面交点d坐标的计算方法
CN111102981B (zh) 一种基于ukf的高精度卫星相对导航方法
CN108828623B (zh) 静止气象卫星成像仪的地球固定网格映射方法
CN107525492B (zh) 一种适用于敏捷对地观测卫星的偏流角仿真分析方法
KR102239562B1 (ko) 항공 관측 데이터와 지상 관측 데이터 간의 융합 시스템
CN111247389B (zh) 关于拍摄设备的数据处理方法、装置及图像处理设备
CN113627473A (zh) 基于多模态传感器的水面无人艇环境信息融合感知方法
CN111504323A (zh) 基于异源图像匹配与惯性导航融合的无人机自主定位方法
CN110728716B (zh) 一种标定方法、装置及飞行器
CN112197765B (zh) 一种实现水下机器人精细导航的方法
CN110887477B (zh) 一种基于偏振北极点及偏振太阳矢量的自主定位方法
CN113129377A (zh) 一种三维激光雷达快速鲁棒slam方法和装置
CN114858133B (zh) 一种恒星观测模式下姿态低频误差修正方法
CN112577463B (zh) 姿态参数修正的航天器单目视觉测距方法
CN111145267A (zh) 基于imu辅助的360度全景视图多相机标定方法
CN115775242A (zh) 一种基于匹配的点云地图质量评估方法
CN109764864A (zh) 一种基于颜色识别的室内无人机位姿获取方法及系统
CN110887475B (zh) 一种基于偏振北极点及偏振太阳矢量的静基座粗对准方法
CN111879298B (zh) 一种用于月球无人值守望远镜的自动指星方法
CN108489483B (zh) 一种船载星光定向仪单星次优修正算法
CN113375665A (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
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20201215

CF01 Termination of patent right due to non-payment of annual fee