CN108225305B - 一种星敏感器多参数优化方法及系统 - Google Patents
一种星敏感器多参数优化方法及系统 Download PDFInfo
- Publication number
- CN108225305B CN108225305B CN201711178611.5A CN201711178611A CN108225305B CN 108225305 B CN108225305 B CN 108225305B CN 201711178611 A CN201711178611 A CN 201711178611A CN 108225305 B CN108225305 B CN 108225305B
- Authority
- CN
- China
- Prior art keywords
- star
- spot
- coordinate system
- star sensor
- sensor
- 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
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
-
- 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/24—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for cosmonautical navigation
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)
- Length Measuring Devices By Optical Means (AREA)
Abstract
本发明公开了一种星敏感器多参数优化方法,通过搭建星敏感器多参数优化系统,成像星点光斑参数获取模块用以获取成像星点光斑在图像平面的坐标和转台坐标系下的方向矢量,参数求取模块用以校正星点光斑在转台坐标系下的方向矢量和求取星点光斑对在不同坐标下的角距余弦值,目标函数构建模块构建目标函数,误差判定模块对星点光斑的重投影误差进行判定,完成了星敏感器多参数的优化。本发明考虑星敏感器光学参数和安装误差两者之间存在的内在关联,同时对星敏感器光学参数和安装误差进行估计。本发明方法可以有效地完成星敏感器的多参数优化,具有很高的使用价值。
Description
技术领域
本发明涉及一种多参数优化方法及系统,特别是一种星敏感器多参数优化方法及系统。
背景技术
星敏感器作为目前航天器中重要的姿态测量敏感器之一,其测量精度直接影响航天器的姿态定位精度,通常,星敏感器在研制过程中,光学参数会存在误差,主要包括主点误差和焦距误差,同时,星敏感器坐标系和安装基准坐标系之间存在安装误差,这些误差会影响星敏感器质心定位的精度,降低星图识别算法的准确率,进而影响星敏感器的姿态定位精度。现有优化方法中,通常分别对星敏感器的光学参数和安装误差进行优化,忽略星敏感器光学参数和安装误差两者之间存在的内在关联,从而引入额外误差,降低了星敏感器参数的优化精度。
发明内容
本发明目的在于提供一种星敏感器多参数优化方法及系统,解决现有方法忽略星敏感器光学参数和安装误差之间存在的关系而引入额外误差的问题。
一种星敏感器多参数优化方法的具体步骤为:
第一步搭建星敏感器多参数优化系统
星敏感器多参数优化系统,包括:成像星点光斑参数获取模块、参数求取模块、目标函数构建模块和误差判定模块。
成像星点光斑参数获取模块的功能为:获取成像星点光斑在图像平面的坐标和转台坐标系下的方向矢量。
参数求取模块的功能为:校正星点光斑在转台坐标系下的方向矢量和求取星点光斑对在不同坐标下的角距余弦值。
目标函数构建模块的功能为:构建目标函数,优化星敏感器的光学参数和安装误差。
误差判定模块的功能为:对星点光斑的重投影误差进行判定。
第二步成像星点光斑参数获取模块用以获取成像星点光斑在图像平面的坐标和转台坐标系下的方向矢量
平行光管产生的平行光经星敏感器成像,在星敏感器成像平面中形成星点光斑,通过调节转台改变星敏感器坐标系的姿态,进而改变平行光经星敏感器成像产生的星点光斑在星敏感器坐标系的质心坐标:
通过调节俯仰滚转台,采集平行光管在星敏感器的成像星点光斑,记录星点光斑在星敏感器坐标系下的质心坐标(us,vs)和星点光斑在转动后的转台坐标系下的方向矢量r=(xs,ys,zs)T,θ、ψ、φ分别表示星敏感器与基础坐标系y轴、z轴、x轴的安装误差角,(θ,ψ,φ)的估计初值为(0,0,0)。us、vs分别表示星点光斑在星敏感器坐标系下的质心在x、y方向的坐标;xs、ys、zs分别表示星点光斑在转动后的转台坐标系下的矢量在x、y、z方向的值。
第三步参数求取模块用以校正星点光斑在转台坐标系下的方向矢量和求取星点光斑对在不同坐标下的角距余弦值
星敏感器与基础坐标系的安装误差角较小,结合小角度近似,获取星敏感器与基础坐标系的安装误差矩阵M:
星点光斑通过安装误差矩阵得到星点光斑在转台坐标系下校正后的方向矢量为:rR=(xR,yR,zR)T,则:
rR=Mr(2)
xR、yR、zR分别表示星点光斑通过安装误差矩阵得到星点光斑在转台坐标系下校正后的方向矢量在x、y、z方向的值。
将公式(2)展开:
用公式(4)求取星点光斑对在星敏感器测量坐标系下的角距余弦值,两两不同的星点光斑组成星点光斑对,用星点光斑在转台坐标系下校正后的方向矢量,结合公式(5)确定星点光斑对方向矢量之间的角距余弦值。
i、j分别表示第i个、第j个星点光斑的索引;bi、bj分别表示第i个星点光斑、第j个星点光斑在星敏感器测量坐标系下的矢量;rRi、rRj分别表示第i个星点光斑、第j个星点光斑在转台坐标系下校正后的矢量;u0、v0分别为星敏感器的主点在x、y方向的坐标;uis、vis分别表示第i个星点光斑在星敏感器测量坐标系下的质心在x、y方向的坐标;xRi、yRi、zRi分别表示第i个星点光斑在转台坐标系下校正后的方向矢量在x、y、z方向的值,f为星敏感器焦距;fij表示第i个和第j个星点光斑在转台坐标系下校正后的方向矢量构成的星间角距余弦值;表示第i个星点光斑与第j个星点光斑在星敏感器测量坐标系下的星间角距余弦值。
主点(u0,v0)的估计初始值为星敏感器成像平面的中心位置,焦距f的估计初值用公式(8)求得:
Fu为星敏感器在u方向的视场宽度。
第四步目标函数构建模块构建目标函数
结合理想的小孔成像原理,目标函数构建模块估算星点光斑在星敏感器坐标系下的质心坐标(ud,vd):
ud、vd分别表示估算星点光斑在星敏感器坐标系下的质心在x、y方向的坐标。
得到(ud,vd)与安装误差角(θ,ψ,φ)的关系为:
给定N个星点星点光斑,且有1≤i≤N-1、i+1≤j≤N和1≤t≤N,t表示第t个星点光斑。
目标函数构建模块构建目标函数:
uts、vts分别表示第t个星点光斑在星敏感器坐标系的质心在x、y方向的坐标;utd、vtd分别表示第t个星点光斑在转台坐标系下校正后的方向矢量经过公式(10)估算得到的质心在x、y方向的坐标;表示第i个星点光斑与第j个星点光斑在星敏感器测量坐标系下的星间角距余弦值;fij表示第i个和第j个星点光斑在转台坐标系下校正后的方向矢量构成的星间角距余弦值。
第五步误差判定模块对星点光斑的重投影误差进行判定
分别表示星敏感器的主点在x、y方向的坐标;分别表示星敏感器与基础坐标系y轴、z轴、x轴的安装误差角估计值;分别表示为平行光在星敏感器测量坐标下的星点光斑重投影质心在x、y方向的坐标;表示星敏感器焦距的估计值。
误差判定模块获取所有星点光斑的重投影误差ε为:
式中,p表示第p个星点光斑的索引,且1≤p≤N,N表示星点光斑的总个数;ups、vps分别表示第p个星点光斑在星敏感器测量坐标下的质心在x、y方向的坐标;分别表示第p个星点光斑的重投影质心在x、y方向的坐标。
当重投影误差ε小于容许误差ξ时,则判定结束,得到最终的主点坐标、焦距和安装误差角估计值;当重投影误差ε大于等于容许误差ξ时,重复第二步、第三步、第四步和第五步。
至此,完成了星敏感器多参数的优化。
本发明考虑星敏感器光学参数和安装误差两者之间存在的内在关联,同时对星敏感器光学参数和安装误差进行估计。本发明方法可以有效地完成星敏感器的多参数优化,具有很高的使用价值。因此,充分考虑星敏感器的光学参数和安装误差的相互影响,研究多参数同时优化的算法是非常必要的。
具体实施方式
一种星敏感器多参数优化方法的具体步骤为:
第一步搭建星敏感器多参数优化系统
星敏感器多参数优化系统,包括:成像星点光斑参数获取模块、参数求取模块、目标函数构建模块和误差判定模块。
成像星点光斑参数获取模块的功能为:获取成像星点光斑在图像平面的坐标和转台坐标系下的方向矢量。
参数求取模块的功能为:校正星点光斑在转台坐标系下的方向矢量和求取星点光斑对在不同坐标下的角距余弦值。
目标函数构建模块的功能为:构建目标函数,优化星敏感器的光学参数和安装误差。
误差判定模块的功能为:对星点光斑的重投影误差进行判定。
第二步成像星点光斑参数获取模块用以获取成像星点光斑在图像平面的坐标和转台坐标系下的方向矢量
平行光管产生的平行光经星敏感器成像,在星敏感器成像平面中形成星点光斑,通过调节转台改变星敏感器坐标系的姿态,进而改变平行光经星敏感器成像产生的星点光斑在星敏感器坐标系的质心坐标:
通过调节俯仰滚转台,采集平行光管在星敏感器的成像星点光斑,记录星点光斑在星敏感器坐标系下的质心坐标(us,vs)和星点光斑在转动后的转台坐标系下的方向矢量r=(xs,ys,zs)T,θ、ψ、φ分别表示星敏感器与基础坐标系y轴、z轴、x轴的安装误差角,(θ,ψ,φ)的估计初值为(0,0,0)。us、vs分别表示星点光斑在星敏感器坐标系下的质心在x、y方向的坐标;xs、ys、zs分别表示星点光斑在转动后的转台坐标系下的矢量在x、y、z方向的值。
第三步参数求取模块用以校正星点光斑在转台坐标系下的方向矢量和求取星点光斑对在不同坐标下的角距余弦值
星敏感器与基础坐标系的安装误差角较小,结合小角度近似,获取星敏感器与基础坐标系的安装误差矩阵M:
星点光斑通过安装误差矩阵得到星点光斑在转台坐标系下校正后的方向矢量为:rR=(xR,yR,zR)T,则:
rR=Mr(2)
xR、yR、zR分别表示星点光斑通过安装误差矩阵得到星点光斑在转台坐标系下校正后的方向矢量在x、y、z方向的值。
将公式(2)展开:
用公式(4)求取星点光斑对在星敏感器测量坐标系下的角距余弦值,两两不同的星点光斑组成星点光斑对,用星点光斑在转台坐标系下校正后的方向矢量,结合公式(5)确定星点光斑对方向矢量之间的角距余弦值。
i、j分别表示第i个、第j个星点光斑的索引;bi、bj分别表示第i个星点光斑、第j个星点光斑在星敏感器测量坐标系下的矢量;rRi、rRj分别表示第i个星点光斑、第j个星点光斑在转台坐标系下校正后的矢量;u0、v0分别为星敏感器的主点在x、y方向的坐标;uis、vis分别表示第i个星点光斑在星敏感器测量坐标系下的质心在x、y方向的坐标;xRi、yRi、zRi分别表示第i个星点光斑在转台坐标系下校正后的方向矢量在x、y、z方向的值,f为星敏感器焦距;fij表示第i个和第j个星点光斑在转台坐标系下校正后的方向矢量构成的星间角距余弦值;表示第i个星点光斑与第j个星点光斑在星敏感器测量坐标系下的星间角距余弦值。
主点(u0,v0)的估计初始值为星敏感器成像平面的中心位置,焦距f的估计初值用公式(8)求得:
Fu为星敏感器在u方向的视场宽度。
第四步目标函数构建模块构建目标函数
结合理想的小孔成像原理,目标函数构建模块估算星点光斑在星敏感器坐标系下的质心坐标(ud,vd):
ud、vd分别表示估算星点光斑在星敏感器坐标系下的质心在x、y方向的坐标。
得到(ud,vd)与安装误差角(θ,ψ,φ)的关系为:
给定N个星点星点光斑,且有1≤i≤N-1、i+1≤j≤N和1≤t≤N,t表示第t个星点光斑。
目标函数构建模块构建目标函数:
uts、vts分别表示第t个星点光斑在星敏感器坐标系的质心在x、y方向的坐标;utd、vtd分别表示第t个星点光斑在转台坐标系下校正后的方向矢量经过公式(10)估算得到的质心在x、y方向的坐标;表示第i个星点光斑与第j个星点光斑在星敏感器测量坐标系下的星间角距余弦值;fij表示第i个和第j个星点光斑在转台坐标系下校正后的方向矢量构成的星间角距余弦值。
第五步误差判定模块对星点光斑的重投影误差进行判定
分别表示星敏感器的主点在x、y方向的坐标;分别表示星敏感器与基础坐标系y轴、z轴、x轴的安装误差角估计值;分别表示为平行光在星敏感器测量坐标下的星点光斑重投影质心在x、y方向的坐标;表示星敏感器焦距的估计值。
误差判定模块获取所有星点光斑的重投影误差ε为:
式中,p表示第p个星点光斑的索引,且1≤p≤N,N表示星点光斑的总个数;ups、vps分别表示第p个星点光斑在星敏感器测量坐标下的质心在x、y方向的坐标;分别表示第p个星点光斑的重投影质心在x、y方向的坐标。
当重投影误差ε小于容许误差ξ时,则判定结束,得到最终的主点坐标、焦距和安装误差角估计值;当重投影误差ε大于等于容许误差ξ时,重复第二步、第三步、第四步和第五步。
容许误差ξ为0.05pixels。
至此,完成了星敏感器多参数的优化。
利用本方法对某星敏感器的光学参数和安装误差进行优化,采集的星点光斑在星敏感器坐标系下的质心坐标和星点光斑在转动后的转台坐标系下的方向矢量见表1,注:表1、表2和表3坐标的单位均为像素(pixels)。
表1
该表共记录了937个星点光斑的质心坐标和在转台坐标系下的方向矢量,此处只显示了前5行和最后两行的数据进行示例。
优化前,忽略星敏感器与基础坐标系的安装误差,结合小孔成像原理,利用公式(9),得到星点光斑在星敏感器平面的重投影坐标,见表2。
表2
同上表1,表2共记录了937个星点光斑的质心坐标和星点光斑在星敏感器坐标下的重投影坐标以及两者之间的坐标差值,此处只显示了前5行和最后两行的数据进行示例。
将表1中的数据构建公式(11)的目标函数,采用Levenberg-Marquardt非线性优化,经过多次迭代,得到优化后的主点位置为(1142.08,1058.62)pixels,焦距为44.376mm,优化后的星敏感器与基础坐标系安装误差角为(θ,ψ,φ)=(-0.167°,-0.248°,0.23°),°表示度,考虑星敏感器与基础坐标系的安装误差和光学参数,结合小孔成像原理,利用公式(12),得到星点光斑在星敏感器平面的重投影坐标,见表3。
表3
同上表2,表3共记录了937个星点光斑的质心坐标和星点光斑在星敏感器坐标下的重投影坐标以及两者之间的坐标差值,此处只显示了前5行和最后两行的数据进行示例。
对比表2和表3,可以发现,应用本方法优化后的结果得到的星点光斑在星敏感器下的重投影坐标误差显著减少,此外,对于表2和表3的数据分别利用公式(13)计算所有星点光斑的重投影误差,其中表2的重投影误差为42.287pixels,表3的重投影误差为0.0661pixels,优化前,即表2的星点光斑质心坐标在u方向和v方向的标准差分别为1.702pixels和1.729pixels,优化后,即表3的星点光斑质心坐标在u方向和v方向的标准差分别为0.0499pixels和0.0432pixels,实验结果表明本发明提出的方法能够有效的估计星敏感器的光学参数和安装误差角。
Claims (3)
1.一种星敏感器多参数优化方法,其特征在于该方法的具体步骤为:
第一步 搭建星敏感器多参数优化系统
星敏感器多参数优化系统,包括:成像星点光斑参数获取模块、参数求取模块、目标函数构建模块和误差判定模块;
成像星点光斑参数获取模块的功能为:获取成像星点光斑在图像平面的坐标和转台坐标系下的方向矢量;
参数求取模块的功能为:校正星点光斑在转台坐标系下的方向矢量和求取星点光斑对在不同坐标下的角距余弦值;
目标函数构建模块的功能为:构建目标函数,优化星敏感器的光学参数和安装误差;
误差判定模块的功能为:对星点光斑的重投影误差进行判定;
第二步 成像星点光斑参数获取模块获取成像星点光斑在图像平面的坐标和转台坐标系下的方向矢量
平行光管产生的平行光经星敏感器成像,在星敏感器成像平面中形成星点光斑,通过调节转台改变星敏感器坐标系的姿态,进而改变平行光经星敏感器成像产生的星点光斑在星敏感器坐标系的质心坐标:
通过调节俯仰滚转台,采集平行光管在星敏感器的成像星点光斑,记录星点光斑在星敏感器坐标系下的质心坐标(us,vs)和星点光斑在转动后的转台坐标系下的方向矢量r=(xs,ys,zs)T,θ、ψ、φ分别表示星敏感器与基础坐标系y轴、z轴、x轴的安装误差角,(θ,ψ,φ)的估计初值为(0,0,0);us、vs分别表示星点光斑在星敏感器坐标系下的质心在x、y方向的坐标;xs、ys、zs分别表示星点光斑在转动后的转台坐标系下的矢量在x、y、z方向的值;
第三步 参数求取模块校正星点光斑在转台坐标系下的方向矢量和求取星点光斑对在不同坐标下的角距余弦值
星敏感器与基础坐标系的安装误差角较小,结合小角度近似,获取星敏感器与基础坐标系的安装误差矩阵M:
星点光斑通过安装误差矩阵得到星点光斑在转台坐标系下校正后的方向矢量为:rR=(xR,yR,zR)T,则:
rR=Mr (2)
xR、yR、zR分别表示星点光斑通过安装误差矩阵得到星点光斑在转台坐标系下校正后的方向矢量在x、y、z方向的值;
将公式(2)展开:
用公式(4)求取星点光斑对在星敏感器测量坐标系下的角距余弦值,两两不同的星点光斑组成星点光斑对,用星点光斑在转台坐标系下校正后的方向矢量,结合公式(5)确定星点光斑对方向矢量之间的角距余弦值;
i、j分别表示第i个、第j个星点光斑的索引;bi、bj分别表示第i个星点光斑、第j个星点光斑在星敏感器测量坐标系下的矢量;rRi、rRj分别表示第i个星点光斑、第j个星点光斑在转台坐标系下校正后的矢量;u0、v0分别为星敏感器的主点在x、y方向的坐标;uis、vis分别表示第i个星点光斑在星敏感器测量坐标系下的质心在x、y方向的坐标;xRi、yRi、zRi分别表示第i个星点光斑在转台坐标系下校正后的方向矢量在x、y、z方向的值,f为星敏感器焦距;fij表示第i个和第j个星点光斑在转台坐标系下校正后的方向矢量构成的星间角距余弦值;fij(u0,v0,f)表示第i个星点光斑与第j个星点光斑在星敏感器测量坐标系下的星间角距余弦值;
主点(u0,v0)的估计初始值为星敏感器成像平面的中心位置,焦距f的估计初值用公式(8)求得:
Fu为星敏感器在u方向的视场宽度;
第四步 目标函数构建模块构建目标函数
结合理想的小孔成像原理,目标函数构建模块估算星点光斑在星敏感器坐标系下的质心坐标(ud,vd):
ud、vd分别表示估算星点光斑在星敏感器坐标系下的质心在x、y方向的坐标;
得到(ud,vd)与安装误差角(θ,ψ,φ)的关系为:
给定N个星点星点光斑,且有1≤i≤N-1、i+1≤j≤N和1≤t≤N,t表示第t个星点光斑;
目标函数构建模块构建目标函数:
uts、vts分别表示第t个星点光斑在星敏感器坐标系的质心在x、y方向的坐标;utd、vtd分别表示第t个星点光斑在转台坐标系下校正后的方向矢量经过公式(10)估算得到的质心在x、y方向的坐标;fij(u0,v0,f)表示第i个星点光斑与第j个星点光斑在星敏感器测量坐标系下的星间角距余弦值;fij表示第i个和第j个星点光斑在转台坐标系下校正后的方向矢量构成的星间角距余弦值;
第五步 误差判定模块对星点光斑的重投影误差进行判定
误差判定模块利用估算得到主点坐标(u0,v0)和焦距f以及安装误差角估计值(θ,ψ,φ),根据小孔成像原理,得到平行光在星敏感器测量坐标下的星点光斑重投影质心坐标为:
u0、v0分别表示星敏感器的主点在x、y方向的坐标;θ、ψ、φ分别表示星敏感器与基础坐标系y轴、z轴、x轴的安装误差角估计值;ud、vd分别表示为平行光在星敏感器测量坐标下的星点光斑重投影质心在x、y方向的坐标;f表示星敏感器焦距的估计值;
误差判定模块获取所有星点光斑的重投影误差ε为:
式中,p表示第p个星点光斑的索引,且1≤p≤N,N表示星点光斑的总个数;ups、vps分别表示第p个星点光斑在星敏感器测量坐标下的质心在x、y方向的坐标;upd、vpd分别表示第p个星点光斑的重投影质心在x、y方向的坐标;
当重投影误差ε小于容许误差ξ时,则判定结束,得到最终的主点坐标、焦距和安装误差角估计值;当重投影误差ε大于等于容许误差ξ时,重复第二步、第三步、第四步和第五步;
至此,完成了星敏感器多参数的优化。
2.根据权利要求1所述的一种星敏感器多参数优化方法,其特征在于所述的容许误差ξ为0.05pixels。
3.一种星敏感器多参数优化系统,其特征在于包括:成像星点光斑参数获取模块、参数求取模块、目标函数构建模块和误差判定模块;
成像星点光斑参数获取模块的功能为:获取成像星点光斑在图像平面的坐标和转台坐标系下的方向矢量;
参数求取模块的功能为:校正星点光斑在转台坐标系下的方向矢量和求取星点光斑对在不同坐标下的角距余弦值;
目标函数构建模块的功能为:构建目标函数,优化星敏感器的光学参数和安装误差;
误差判定模块的功能为:对星点光斑的重投影误差进行判定;
成像星点光斑参数获取模块获取成像星点光斑在图像平面的坐标和转台坐标系下的方向矢量:
平行光管产生的平行光经星敏感器成像,在星敏感器成像平面中形成星点光斑,通过调节转台改变星敏感器坐标系的姿态,进而改变平行光经星敏感器成像产生的星点光斑在星敏感器坐标系的质心坐标:
通过调节俯仰滚转台,采集平行光管在星敏感器的成像星点光斑,记录星点光斑在星敏感器坐标系下的质心坐标(us,vs)和星点光斑在转动后的转台坐标系下的方向矢量r=(xs,ys,zs)T,θ、ψ、φ分别表示星敏感器与基础坐标系y轴、z轴、x轴的安装误差角,(θ,ψ,φ)的估计初值为(0,0,0);us、vs分别表示星点光斑在星敏感器坐标系下的质心在x、y方向的坐标;xs、ys、zs分别表示星点光斑在转动后的转台坐标系下的矢量在x、y、z方向的值;
参数求取模块校正星点光斑在转台坐标系下的方向矢量和求取星点光斑对在不同坐标下的角距余弦值:
星敏感器与基础坐标系的安装误差角较小,结合小角度近似,获取星敏感器与基础坐标系的安装误差矩阵M:
星点光斑通过安装误差矩阵得到星点光斑在转台坐标系下校正后的方向矢量为:rR=(xR,yR,zR)T,则:
rR=Mr (2)
xR、yR、zR分别表示星点光斑通过安装误差矩阵得到星点光斑在转台坐标系下校正后的方向矢量在x、y、z方向的值;
将公式(2)展开:
用公式(4)求取星点光斑对在星敏感器测量坐标系下的角距余弦值,两两不同的星点光斑组成星点光斑对,用星点光斑在转台坐标系下校正后的方向矢量,结合公式(5)确定星点光斑对方向矢量之间的角距余弦值;
i、j分别表示第i个、第j个星点光斑的索引;bi、bj分别表示第i个星点光斑、第j个星点光斑在星敏感器测量坐标系下的矢量;rRi、rRj分别表示第i个星点光斑、第j个星点光斑在转台坐标系下校正后的矢量;u0、v0分别为星敏感器的主点在x、y方向的坐标;uis、vis分别表示第i个星点光斑在星敏感器测量坐标系下的质心在x、y方向的坐标;xRi、yRi、zRi分别表示第i个星点光斑在转台坐标系下校正后的方向矢量在x、y、z方向的值,f为星敏感器焦距;fij表示第i个和第j个星点光斑在转台坐标系下校正后的方向矢量构成的星间角距余弦值;fij(u0,v0,f)表示第i个星点光斑与第j个星点光斑在星敏感器测量坐标系下的星间角距余弦值;
主点(u0,v0)的估计初始值为星敏感器成像平面的中心位置,焦距f的估计初值用公式(8)求得:
Fu为星敏感器在u方向的视场宽度;
目标函数构建模块构建目标函数:
结合理想的小孔成像原理,目标函数构建模块估算星点光斑在星敏感器坐标系下的质心坐标(ud,vd):
ud、vd分别表示估算星点光斑在星敏感器坐标系下的质心在x、y方向的坐标;
得到(ud,vd)与安装误差角(θ,ψ,φ)的关系为:
给定N个星点星点光斑,且有1≤i≤N-1、i+1≤j≤N和1≤t≤N,t表示第t个星点光斑;
目标函数构建模块构建目标函数:
uts、vts分别表示第t个星点光斑在星敏感器坐标系的质心在x、y方向的坐标;utd、vtd分别表示第t个星点光斑在转台坐标系下校正后的方向矢量经过公式(10)估算得到的质心在x、y方向的坐标;fij(u0,v0,f)表示第i个星点光斑与第j个星点光斑在星敏感器测量坐标系下的星间角距余弦值;fij表示第i个和第j个星点光斑在转台坐标系下校正后的方向矢量构成的星间角距余弦值;
误差判定模块对星点光斑的重投影误差进行判定:
误差判定模块利用估算得到主点坐标(u0,v0)和焦距f以及安装误差角估计值(θ,ψ,φ),根据小孔成像原理,得到平行光在星敏感器测量坐标下的星点光斑重投影质心坐标为:
u0、v0分别表示星敏感器的主点在x、y方向的坐标;θ、ψ、φ分别表示星敏感器与基础坐标系y轴、z轴、x轴的安装误差角估计值;ud、vd分别表示为平行光在星敏感器测量坐标下的星点光斑重投影质心在x、y方向的坐标;f表示星敏感器焦距的估计值;
误差判定模块获取所有星点光斑的重投影误差ε为:
式中,p表示第p个星点光斑的索引,且1≤p≤N,N表示星点光斑的总个数;ups、vps分别表示第p个星点光斑在星敏感器测量坐标下的质心在x、y方向的坐标;upd、vpd分别表示第p个星点光斑的重投影质心在x、y方向的坐标;
当重投影误差ε小于容许误差ξ时,则判定结束,得到最终的主点坐标、焦距和安装误差角估计值;当重投影误差ε大于等于容许误差ξ时,重复成像星点光斑参数获取模块获取成像星点光斑在图像平面的坐标和转台坐标系下的方向矢量、参数求取模块校正星点光斑在转台坐标系下的方向矢量和求取星点光斑对在不同坐标下的角距余弦值、目标函数构建模块构建目标函数、误差判定模块对星点光斑的重投影误差进行判定;
至此,完成了星敏感器多参数的优化。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711178611.5A CN108225305B (zh) | 2017-11-23 | 2017-11-23 | 一种星敏感器多参数优化方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711178611.5A CN108225305B (zh) | 2017-11-23 | 2017-11-23 | 一种星敏感器多参数优化方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108225305A CN108225305A (zh) | 2018-06-29 |
CN108225305B true CN108225305B (zh) | 2021-06-15 |
Family
ID=62652654
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711178611.5A Active CN108225305B (zh) | 2017-11-23 | 2017-11-23 | 一种星敏感器多参数优化方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108225305B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109188462B (zh) * | 2018-08-30 | 2020-08-28 | 清华大学 | 复杂星空背景下的空间目标检测方法及装置 |
CN110308437A (zh) * | 2019-07-15 | 2019-10-08 | 北京遥感设备研究所 | 一种雷达光学设备引导误差补偿方法 |
CN112683307B (zh) * | 2020-12-14 | 2022-08-19 | 中国科学院光电技术研究所 | 一种星敏感器星点质心位置精度测量方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1949002A (zh) * | 2005-10-12 | 2007-04-18 | 北京航空航天大学 | 一种星敏感器内外方元素校准方法 |
CN104154928A (zh) * | 2014-05-26 | 2014-11-19 | 北京航天控制仪器研究所 | 一种适用于惯性平台内置式星敏感器的安装误差标定方法 |
-
2017
- 2017-11-23 CN CN201711178611.5A patent/CN108225305B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1949002A (zh) * | 2005-10-12 | 2007-04-18 | 北京航空航天大学 | 一种星敏感器内外方元素校准方法 |
CN104154928A (zh) * | 2014-05-26 | 2014-11-19 | 北京航天控制仪器研究所 | 一种适用于惯性平台内置式星敏感器的安装误差标定方法 |
Non-Patent Citations (3)
Title |
---|
"Systematic error analysis and compensation for high accuracy star centroid estimation of star tracker";JIA Hui;《Technological Sciences》;20101231;正文第3145-3152页 * |
"应用非线性优化算法自主标定星敏感器";叶涛;《光学精密工程》;20170930;第25卷(第9期);正文第2483-2488页 * |
一种星敏感器安装误差标定模型仿真研究;王融等;《系统仿真技术》;20131128(第04期);正文第287-291页 * |
Also Published As
Publication number | Publication date |
---|---|
CN108225305A (zh) | 2018-06-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110296691B (zh) | 融合imu标定的双目立体视觉测量方法与系统 | |
CN102472609B (zh) | 位置和姿势校准方法及设备 | |
CN108871373B (zh) | 一种基于俯仰滚转台和非线性优化的星敏感器标定方法 | |
CN108225305B (zh) | 一种星敏感器多参数优化方法及系统 | |
US10013762B2 (en) | Method and control unit for detecting a change of a relative yaw angle within a stereo-video system for a vehicle | |
US20150279016A1 (en) | Image processing method and apparatus for calibrating depth of depth sensor | |
CN111220120B (zh) | 一种动平台双目测距自校准方法及装置 | |
CN106991705B (zh) | 一种基于p3p算法的位置参数估计方法 | |
CN105021124A (zh) | 一种基于深度图的平面零件三维位置和法向量计算方法 | |
CN107300382B (zh) | 一种用于水下机器人的单目视觉定位方法 | |
CN105096341B (zh) | 基于三焦张量和关键帧策略的移动机器人位姿估计方法 | |
CN109465830B (zh) | 机器人单目立体视觉标定系统及方法 | |
CN111932565B (zh) | 一种多靶标识别跟踪解算方法 | |
CN108151713A (zh) | 一种单目vo快速位姿估计方法 | |
CN111524174B (zh) | 一种动平台动目标双目视觉三维构建方法 | |
CN105447856A (zh) | 基于机器人运动参数与特征向量的标记点匹配方法 | |
CN107314763A (zh) | 一种基于制约函数非线性估计的卫星影像区域网平差方法 | |
CN105318871A (zh) | 双星敏感器载体安装矩阵动态标定方法 | |
CN109282830B (zh) | 一种星敏感器与基础坐标系的安装误差角估计方法 | |
CN104406583A (zh) | 双星敏感器联合确定载体姿态方法 | |
CN101013065A (zh) | 一种基于像素频率的星敏感器高精度校准方法 | |
Pi et al. | On-orbit geometric calibration using a cross-image pair for the linear sensor aboard the agile optical satellite | |
CN111043984A (zh) | 隧道三维变形监测方法及相关装置 | |
JP5267100B2 (ja) | 運動推定装置及びプログラム | |
CN111145267B (zh) | 基于imu辅助的360度全景视图多相机标定方法 |
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 |