CN100349018C - 一种星敏感器内外方元素校准方法 - Google Patents
一种星敏感器内外方元素校准方法 Download PDFInfo
- Publication number
- CN100349018C CN100349018C CNB2005101125537A CN200510112553A CN100349018C CN 100349018 C CN100349018 C CN 100349018C CN B2005101125537 A CNB2005101125537 A CN B2005101125537A CN 200510112553 A CN200510112553 A CN 200510112553A CN 100349018 C CN100349018 C CN 100349018C
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- axle
- cos
- sin
- star 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.)
- Expired - Fee Related
Links
Images
Landscapes
- Length Measuring Devices By Optical Means (AREA)
Abstract
本发明航天测量技术,涉及对星敏感器校准方法的改进。它基于一个由气垫平台、单星星光模拟器、星敏感器、2维轴向转台以及数据处理计算机组成的校准***,其步骤是:校准***建模;采集数据;数据处理。本发明采用了整体建模的方法,避免了因外部参数偏差引入到内部参数的估计过程中而影响参数校准精度。该方法减少了校准过程中复杂的星敏感器安装对准过程,使得整个校准过程变得相对简单。
Description
技术领域
本发明航天测量技术,涉及对星敏感器校准方法的改进。
背景技术
星敏感器是一种利用恒星观测,为空间飞行器提供高精度姿态信息的航天测量仪器。其工作原理为:星敏感器前端摄像头单元利用CCD(或CMOS)图像传感器拍摄得到星图图像,经过图像处理程序得到恒星像点的质心坐标和亮度的信息,然后星图识别程序利用这些信息在导航星库中找到对应的恒星,最后计算出星敏感器的三轴姿态。在星敏感器投入使用前,其主点、焦距以及畸变系数等内部参数必须进行精确的测量,称为星敏感器校准。常见的星敏感器校准有几种方法,第一种是在星光实验室利用星光模拟器配合高精度2轴转台进行数据采集和校准;第二种是在大气环境良好的地点对晴朗夜空进行拍摄以获得数据并进行校准;第三种是当星敏感器在轨工作时进行校准。其中在星光实验室的校准是最基础和精度最高的校准。如图1所示,该校准***主要有气垫平台,单星星光模拟器,星敏感器,2维轴向转台以及数据处理计算机组成。目前的校准方法为:
(1)安装星敏感器到2维轴向转台上,使得星敏感器的视轴垂直于2维轴向转台的两个旋转轴。
(2)调整单星星光模拟器,使得其发生的星光方向和星敏感器的视轴对齐。
(3)然后根据图2所示,连续转动转台采集星点数据,并记录当时的转台转动坐标,最终使得星点数据遍布整个星敏感器图像传感器靶面。
(4)根据小孔成像原理,建立星敏感器星点成像模型,模型参数包括主点、焦距以及畸变系数等,利用采集得到数据计算星敏感器模型参数。
以上方法存在的问题是:
(1)星敏感器在转台上的安装存在偏差,使得星敏感器的视轴不能够和2维轴向转台的两个旋转轴恰好垂直。
(2)调整星光模拟器和转台坐标系两个旋转轴组成的平面不垂直。
由于这些安装对齐等外部因素影响,使得仅仅对星敏感器内部参数建立成像模型的校准方法存在误差,从而最终影响星敏感器内部参数的估计精度。
发明内容
本发明的目的是:针对上述校准方法存在的问题,提出一种对星敏感器校准***内部参数和外部参数联合建模的方法,利用非线性最小二乘法和共线性公式,迭代计算出星敏感器校准***内部参数和外部参数。
本发明的技术方案是:一种星敏感器内外方元素校准方法,基于一个由气垫平台、单星星光模拟器、星敏感器、2维轴向转台以及数据处理计算机组成的校准***,单星星光模拟器、星敏感器、2维轴向转台安装在气垫平台上,星敏感器安装在2维轴向转台的内框上,星敏感器的视轴垂直于2维轴向转台的两个旋转轴,单星星光模拟器发生的星光方向和星敏感器的视轴对齐,其特征在于,校准的步骤如下:
1、校准***建模;
1.1、外部参数建模;影响星敏感器采集得到的星点坐标位置的外部因素有:星光模拟器发生的星光方向,转台内外两个转动框偏离转台初始位置的角度,星敏感器在转台内框上的安装偏差,以及星敏感器图像传感器成像靶面和机壳之间的安装偏差;通过建立多个坐标系,将上述外部参数联系起来,以便分析星敏感器靶面上的星点成像位置;外部参数建模的步骤如下:
1.1.1、根据转台的初始位置建立坐标系N;
坐标系N以内框的转动轴为Xn轴,外框转动轴为Yn轴,Xn轴和Yn轴交于星敏感器镜头中心点O点,O为坐标系原点,过O点沿着星敏感器视轴方向为坐标系的Zn轴;星光模拟器发生的星光方向矢量Vn在坐标系N中的表达式为:
式中,n1、n2、n3为星光矢量Vn在坐标系N中的3个方向分量,α和β分别为该矢量在坐标系N中的偏航和俯仰角;
1.1.2、建立坐标系B;
当外框转过一个角度θ1后,根据转动后的转台状态建立坐标系B,坐标系B的原点和坐标系N相同,其Yb轴和Yn轴重合,Xb轴、Zb轴分别位于Xn轴、Zn轴转动后的位置,当外框转过θ1角后,星光矢量在坐标系B中的表达式为:
式中,b1、b2、b3为星光矢量在坐标系B中的3个方向分量,Rbn为转换矩阵;
1.1.3、建立坐标系C;
当内框转过一个角度θ2后,根据转动后的转台状态建立坐标系C;坐标系C的原点和坐标系B相同,其Xc轴和Xb轴重合,Yc轴、Zc轴分别位于Yb轴、Zb轴转动后的位置;当外框转过θ2角后,星光矢量在坐标系C中的表达式为:
式中,c1、c2、c3为星光矢量在坐标系C中的3个方向分量,Rcb为转换矩阵;
1.1.4、建立坐标系D和E;
星敏感器在转台内框上的安装偏角为1和2,1为偏航方向安装误差,2为俯仰方向安装误差;对应于星敏感器这两个安装位置,分别建立坐标系D和E;
坐标系D的原点和坐标系C相同,其Xd轴和Xc轴重合,Yd轴、Zd轴分别位于Yc轴、Zc轴转动后的位置,当外框转过1角后,星光矢量在坐标系D中的表达式为:
式中,d1、d2、d3为星光矢量在坐标系D中的3个方向分量,Rdc为转换矩阵;
坐标系E的原点和坐标系D相同,其Xe轴和Xd轴重合,Ye轴、Ze轴分别位于Yd轴、Zd轴转动后的位置,当外框转过2角后,星光矢量在坐标系E中的表达式为:
式中,e1、e2、e3为星光矢量在坐标系E中的3个方向分量,Red为转换矩阵;坐标系E即为星敏感器机壳坐标系;
1.1.5、建立坐标系F;
图像传感器靶面的X、Y轴和机壳坐标系E的Xe,Ye轴之间的安装偏差造成的偏置角为3,根据图像传感器靶面建立星敏感器的针孔成像坐标系F;坐标系F和坐标系E原点相同,Zf轴和Ze轴相重合,Xf轴和靶面图像传感器靶面的X方向一致,Yf轴和靶面Y方向一致;靶面坐标系与图像传感器采集得到的图像一致,原点位于图像左下角,X、Y方向即为图像的横、纵方向,星光矢量从坐标系E到坐标系F的转换过程为:
式中,f1,f2,f3为星光矢量在坐标系F中的3个方向分量,Rfe为转换矩阵;
根据以上坐标系的转换过程,得到从转台坐标系N到星敏感器坐标系F的转换关系为:
展开式[7]得到:
f1=cos3cos2cosθ1cosβcosα+sin3sin(θ2+1)sinθ1cosβcosα
-cos3sin2cos(θ2+1)sinθ1cosβcosα
+sin3cos(θ2+1)cosβsinα+cos3sin2sin(θ2+1)cosβsinα
-cos3cos2sinθ1sinβ+sin3sin(θ2+1)cosθ1sinβ
-cos3sin2cos(θ2+1)cosθ1sinβ
f2=-sin3cos2cosθ1cosβcosα+cos3sin(θ2+1)sinθ1cosβcosα
+sin3sin2cos(θ2+1)sinθ1cosβcosα
+cos3cos(θ2+1)cosβsinα-sin3sin3sin(θ2+1)cosβsinα
+sin3cos(2)sinθ1sinβ+cos3sin(θ2+1)cosθ1sinβ
+sin3sin2cos(θ2+1)cosθ1sinβ
f3=sin2cosθ1cosβcosα+cos2cos(θ2+1)sinθ1cosβcosα
-cosθ2sin(θ2+1)cosβsinα-sin2sinθ1sinβ+cos2cos(θ2+1)cosθ1sinβ
上述外部参数中,转台的偏航角和俯仰角由转台自身提供,需要求取的外部参数有5个,即为α、β、φ1、φ2、φ3;
1.2、针孔成像建模;
根据针孔成像原理,在坐标系F中,Zf为星敏感器视轴方向,Xf,Yf和星敏感器靶面坐标系的X,Y轴方向一致,这里的靶面坐标系为2维平面坐标系,以主点O’为原点,其X,Y轴对应于采集得到图像的横纵轴,星光经过镜头中心点O后,投影成像在星敏感器靶面P(x,y)点;假设星敏感器的焦距为fc,主点O’的图像坐标为(x0,y0),根据共线性公式有:
式中,主点(x0,y0)和焦距fc为3个未知参数;
1.3、镜头畸变建模;
dx,dy为星敏感器在x方向和y方向的畸变偏差,有:
式中,
q1、q2、q3为径向畸变系数;
p1、p2、p3为偏心畸变系数;
于是内部参数总共有9个,即为x0、y0、fc、q1、q2、q3、p1、p2、p3,根据公式[8]有:
上述模型中,总共有外部参数和内部参数14个,即:α、β、φ1、φ2、φ3、x0、y0、fc、q1、q2、q3、p1、p2、p3;
2、采集数据;
转动转台,从-6度到+6度,每间隔1度为一个采集位置,在一个位置采集n次数据,n可取100~1000,并记录当时的转台转动坐标,最终使得星点成像遍布靶面。公式为:
3、数据处理;
这里A、B为敏感矩阵;
星点采集个数为m,联合x和y方向的偏差和敏感矩阵,
这里p是由x和y方向残留偏差组成的向量,M为A和B两个敏感矩阵组成的整体敏感矩阵;
于是有迭代方程为:
这里k为迭代序号,k取5~20,迭代结束后得到稳定的数据值,这时的参数即为最后的校准结果。
本发明的优点是:第一,由于采用了整体建模的方法,将星敏感器校准***的内部参数和外部参数同时进行估计,外部参数对应于世界坐标系,求出了外部参数的估计偏差后,可以避免外部参数偏差引入到内部参数的估计过程中,影响参数校准精度。第二,该方法减少了校准过程中复杂的星敏感器安装对准过程,使得整个校准过程变得相对简单。第三,建立了世界坐标系后,可以很方便的将星敏感器坐标系引出到和机壳固联的光学立方体坐标系上,为将来星敏感器安装到空间飞行器上时的方位测量提供了基础。
附图说明
图1是现有的星敏感器校准装置构成示意图。
图2是现有的星敏感器校准装置在校准时星点采集过程示意图。
图3是建立转台初始位置坐标系N示意图。
图4是转台坐标系N中的星向量Vn示意图。
图5是由坐标系N到坐标系B的转换示意图。
图6是由坐标系B到坐标系C的转换示意图。
图7是由坐标系C到坐标系D的转换示意图。
图8是由坐标系D到坐标系E的转换示意图。
图9是由坐标系E到坐标系F的转换示意图。
图10是星点针孔成像前视示意图。
具体实施方式
下面对本发明做进一步详细说明。本发明提出一种对星敏感器校准***内部参数和外部参数联合建模的方法,并利用非线性最小二乘法和共线性公式,迭代计算出星敏感器校准***内部参数和外部参数。这种方法能够将星敏感器校准***的内部参数和外部参数分离开来,使得最终获得的星敏感器内部参数精度更高。同时,该校准过程中建立了星敏感器校准***的外部世界坐标系,从而很方便地将星敏感器坐标系引出到和星敏感器固联的光学立方体坐标系上,为将来星敏感器安装到空间飞行器上时的方位测量提供了基础。下面详细说明本发明方法的步骤。
1、***建模;
1.1、外部参数建模;
星敏感器测试***在进行数据采集过程中,影响星敏感器采集得到的星点坐标位置的外部因素有:星光模拟器发生的星光方向,转台内外两个转动框偏离转台初始位置的角度,星敏感器在转台内框上的安装偏差,以及星敏感器图像传感器成像靶面和机壳之间的安装偏差。于是需要建立多个坐标系,将这些外部参数联系起来,以便分析星敏感器靶面上的星点成像位置。
1.1.1、首先根据转台的初始位置建立坐标系N,如图3所示。坐标系N以内框的转动轴为Xn轴,外框转动轴为Yn轴,Xn轴和Yn轴交星敏感器镜头中心点O点,O为坐标系原点。过O点沿着星敏感器视轴方向为坐标系的Zn轴。星光模拟器发生的星光方向矢量Vn在坐标系N中的表达式为:
其中,n1,n2,n3为星光矢量Vn在坐标系N中的3个方向分量,α和β分别为该矢量在坐标系N中的偏航和俯仰角,如图4所示。
1.1.2、当外框转过一个角度θ1后,根据转动后的转台状态建立坐标系B,如图5所示。坐标系B的原点和坐标系N相同,其Yb轴和Yn轴重合。Xb轴、Zb轴分别位于Xn轴、Zn轴转动后的位置。当外框转过θ1角后,星光矢量在坐标系B中的表达式为:
这里,b1,b2,b3为星光矢量在坐标系B中的3个方向分量,Rbn为转换矩阵。
1.1.3、当内框转过一个角度θ2后,根据转动后的转台状态建立坐标系C,如图6所示。坐标系C的原点和坐标系B相同,其Xc轴和Xb轴重合。Yc轴、Zc轴分别位于Yb轴、Zb轴转动后的位置。当外框转过θ2角后,星光矢量在坐标系C中的表达式为:
这里c1,c2,c3为星光矢量在坐标系C中的3个方向分量,Rcb为转换矩阵。
1.1.4、星敏感器安装在转台内框上,这里假设星敏感器的安装偏角为1和2,分别对应于偏航方向误差和俯仰方向安装误差。分别建立坐标系D和E,对应于星敏感器这两个安装位置,分别如图7和图8所示。这里坐标系E即为星敏感器机壳坐标系。坐标系D的原点和坐标系C相同,其Xd轴和Xc轴重合。Yd轴、Zd轴分别位于Yc轴、Zc轴转动后的位置。当外框转过1角后,星光矢量在坐标系D中的表达式为:
这里d1,d2,d3为星光矢量在坐标系D中的3个方向分量,Rdc为转换矩阵。
坐标系E的原点和坐标系D相同,其Xe轴和Xd轴重合。Ye轴、Ze轴分别位于Yd轴、Zd轴转动后的位置。当外框转过2角后,星光矢量在坐标系E中的表达式为:
这里e1, e2,e3为星光矢量在坐标系E中的3个方向分量,Red为转换矩阵。
1.1.5、在星敏感器装配过程中,图像传感器靶面的X,Y轴和机壳坐标系E的Xe,Ye轴之间可能出现偏差,设此偏置角为3。于是,根据图像传感器靶面建立星敏感器的针孔成像坐标系F,如图9所示。坐标系F和坐标系E原点相同,Zf轴和Ze轴相重合。Xf轴和靶面图像传感器靶面的X方向一致,Yf轴和靶面Y方向一致。靶面坐标系与图像传感器采集得到的图像一致,原点位于图像左下角,X,Y方向即为图像的横,纵方向。于是星光矢量从坐标系E到坐标系F的转换过程为:
这里f1,f2,f3为星光矢量在坐标系F中的3个方向分量,Rfe为转换矩阵。
总结以上坐标系的转换过程,可以得到从转台坐标系N到星敏感器坐标系F的转换关系,即:
展开该公式可以得到:
f1=cos3cos2cosθ1cosβcosα+sin3sin(θ2+1)sinθ1cosβcosα
一cos3sin2cos(θ2+1)sinθ1cosβcosα
+sin3cos(θ2+1)cosβsinα+cos3sin2sin(θ2+1)cosβsinα
-cos3cos2sinθ1sinβ+sin3sin(θ2+1)cosθ1sinβ
-cos3sin2cos(θ2+1)cosθ1sinβ
f2=-sin3cos2cosθ1cosβcosα+cos3sin(θ2+1)sinθ1cosβcosα
+sin3sin2cos(θ2+1)sinθ1cosβcosα
+cos3cos(θ2+1)cosβsinα-sin3sin2sin(θ2+1)cosβsinα
+sin3cos(2)sinθ1sinβ+cos3sin(θ2+1)cosθ1sinβ
+sin3sin2cos(θ2+1)cosθ1sinβ
f3=sin2cosθ1cosβcosα+cos2cos(θ2+1)sinθ1cosβcosα
-cosθ2sin(θ2+1)cosβsinα-sin2sinθ1sinβ+cos2cos(θ2+1)cosθ1sinβ
考虑到转台的偏航角和俯仰角为转台自身提供,所以这里需要求取的外部参数实际有5个,即为(α,β,φ1,φ2,φ3)。
1.2、针孔成像建模;
根据针孔成像原理,坐标系F中,Zf为星敏感器视轴方向,Xf,Yf和星敏感器靶面坐标系的X,Y轴方向一致。这里的靶面坐标系为2维平面坐标系,以主点O’为原点,其X,Y轴对应于采集得到图像的横纵轴。如图10所示,星光经过镜头中心点O后,投影成像在星敏感器靶面P(x,y)点。假设星敏感器的焦距为fc,主点O’的图像坐标为(x0,y0)。根据共线性公式有:
这里,主点(x0,y0)和焦距fc为3个未知参数。
1.3、镜头畸变建模;
由于制造、安装的工艺限制,使得星敏感器镜头实际工作状态并不完全符合针孔成像透视原理,而总是会存在一点的畸变,下面对星敏感器的畸变建立数学模型。假设dx,dy为x方向和y方向的畸变偏差,有:
这里,
q1,q2,q3为径向畸变系数;
p1,p2,p3为偏心畸变系数。
于是内部参数总共有9个,即为(x0,y0,fc,q1,q2,q3,p1,p2,p3),根据公式[8]有:
考虑外部参数和内部参数,上述模型中总共有1 4个参数,即:(α,β,φ1,φ2,φ3,x0,y0,fc,q1,q2,q3,p1,p2,p3)。
2、数据采集;
转动转台,从-6度到+6度,每间隔1度为一个采集位置,在一个位置采集n次数据,n可取100~1000,并记录当时的转台转动坐标,最终使得星点成像遍布靶面。公式为:
3、数据处理;
这里A、B为敏感矩阵。
假设星点采集个数为m,联合x和y方向的偏差和敏感矩阵,假设:
这里p是由x和y方向残留偏差组成的向量,M为A和B两个敏感矩阵组成的整体敏感矩阵。
于是有迭代方程为:
这里k为迭代序号。k取5~20,例如k取10,迭代结束后得到稳定的数据值,这时的参数即为最后的校准结果。
仿真及结果分析。
仿真的星敏感器基本参数为:
视场:12×12;
像素阵列:1024×1024;
像素尺寸:0.015mm×0.015mm;
焦距:73.6059mm。
假设星点质心噪声为0均值,标准差为0.05像素的高斯噪声,每个采集位置采集次数n=100,于是噪声水平的期望值会下降一个数量级,即0.005像素。这时主要的误差来源将会是来自转台,转台0.5角秒的精度大约相当于0.01像素。假设图像中心即为主点位置,即:
x0=512×0.015mm,
y0=512×O.015mm,
单星星光模拟器发生的星光方向在转台初始坐标系N中的坐标为:
α=45度,
β=89度,
安装偏转角φ1=-1度,
安装俯仰角φ2=1度,
机壳和靶面安装滚转角φ3=2度
焦距偏差为0.2mm,
径向畸变参数为:
q1=2e-4,q2=-4e-7,q3=1e-8,
p1=2e-4,p2=2e-4,p3=4e-6,
进行参数计算前,首先给出参数的初始估计值,我们分别假设初始值为:
α=0度,
β=90度,
安装偏转角φ1=0度,
安装俯仰角φ2=0度,
机壳和靶面安装滚转角φ3=0度
初始焦距为73.8059mm,
径向畸变参数为:
q1=0,q2=0,q3=0,
p1=0,p2=0,p3=0,
在不添加噪声的情况下,根据上述的步骤,经过10次迭代计算可以得到:
α | β | α0 | β0 | φ0 | Δf | |
1 | 0 | 0 | 0 | 0 | 0 | 0 |
2 | 0 | -0.78134 | -0.27722 | 1.0802 | 2.0207 | -0.28309 |
3 | 52.265 | -0.70166 | -1.0056 | 0.99466 | 2 | -0.20342 |
4 | 43.379 | -0.83839 | -0.88902 | 0.89255 | 1.9977 | -0.13412 |
5 | 44.591 | -1.008 | -0.99813 | 1.0134 | 1.9998 | -0.19795 |
6 | 44.834 | -0.996 32 | -0.99536 | 0.99943 | 2 | -0.19999 |
7 | 45.007 | -1.0001 | -1.0002 | 1 | 2 | -0.2 |
8 | 44.999 | -0.99998 | -0.99998 | 1 | 2 | -0.2 |
9 | 45 | -1 | -1 | 1 | 2 | -0.2 |
10 | 45 | -1 | -1 | 1 | 2 | -0.2 |
q1 | q2 | q3 | p1 | p2 | p3 | |
1 | 0 | 0 | 0 | 0 | 0 | 0 |
2 | 0.00019752 | -3.6089e-007 | 9.8124e-009 | 4.8357e-005 | 6.4017e-005 | 0 |
3 | 0.00020039 | -3.9649e-007 | 1.0049e-008 | 0.0002042 | 0.00019477 | -0.00014556 |
4 | 0.00016925 | 2.1958e-007 | 6.5892e-009 | 0.00026416 | 0.00020973 | 0.0029887 |
5 | 0.0001983 | -3.7644e-007 | 9.8208e-009 | 0.00020072 | 0.00020132 | 0.00052435 |
6 | 0.00019994 | -3.9905e-007 | 9.9935e-009 | 0.00020109 | 0.00019873 | 1.2493e-005 |
7 | 0.0002 | -3.9994e-007 | 9.9996e-009 | 0.00019999 | 0.00020001 | 4.169e-006 |
8 | 0.0002 | -3.9999e-007 | 1e-008 | 0.0002 | 0.0002 | 4.0596e-006 |
9 | 0.0002 | -4e-007 | 1e-008 | 0.0002 | 0.0002 | 4.0006e-006 |
10 | 0.0002 | -4e-007 | 1e-008 | 0.0002 | 0.0002 | 4e-006 |
从上表可以看出,在没有噪声时候,经过5次迭代,可以得到校准参数精确的估计值。
进而考虑实际校准过程中噪声的引入,假设经过多次采样取平均值后的质心残留噪声水平为0均值,均方差为0.005像素的高斯白噪声。仿真结果如下:
α | β | α0 | β0 | φ0 | Δf | |
1 | 0 | 0 | 0 | 0 | 0 | 0 |
2 | 0 | -0.78034 | -0.27723 | 1.0792 | 2.0207 | -0.28443 |
3 | 52.712 | -0.70021 | -1.0108 | 0.99319 | 2 | -0.20414 |
4 | 43.696 | -0.83972 | -0.89394 | 0.88975 | 1.9977 | -0.13338 |
5 | 44.864 | -1.0112 | -1.0039 | 1.0122 | 1.9998 | -0.19851 |
6 | 45.092 | -0.99869 | -1.0002 | 0.99791 | 1.9999 | -0.20065 |
7 | 45.257 | -1.0025 | -1.0049 | 0.99855 | 2 | -0.20065 |
8 | 45.25 | -1.0023 | -1.0047 | 0.99853 | 2 | -0.20066 |
9 | 45.25 | -1.0023 | -1.0048 | 0.99853 | 2 | -0.20066 |
10 | 45.25 | -1.0023 | -1.0048 | 0.99853 | 2 | -0.20066 |
q1 | q2 | q3 | p1 | p2 | p3 | |
1 | 0 | 0 | 0 | 0 | 0 | 0 |
2 | 0.00019872 | -3.8045e-007 | 9.9013e-009 | 4.8446e-005 | 6.4127e-005 | 0 |
3 | 0.00020102 | -4.0623e-007 | 1.0093e-008 | 0.00020398 | 0.00019447 | -8.8312e-005 |
4 | 0.00016913 | 2.2429e-007 | 6.5547e-009 | 0.00026478 | 0.00021029 | 0.0030273 |
5 | 0.00019881 | -3.8412e-007 | 9.8517e-009 | 0.00020039 | 0.00020137 | 0.0005469 |
6 | 0.00020054 | -4.0829e-007 | 1.0034e-008 | 0.00020081 | 0.00019856 | 2.6804e-005 |
7 | 0.00020059 | -4.0912e-007 | 1.004e-008 | 0.00019976 | 0.00019979 | 1.7888e-005 |
8 | 0.0002006 | -4.092e-007 | 1.004e-008 | 0.00019977 | 0.00019978 | 1.792e-005 |
9 | 0.0002006 | -4.092e-007 | 1.004e-008 | 0.00019976 | 0.00019978 | 1.7862e-005 |
10 | 0.0002006 | -4.092e-007 | 1.004e-008 | 0.00019976 | 0.00019978 | 1.7862e-005 |
以上结果可以看出,由于噪声的影响,最小二乘法求出的参数估计值和真实值之间有所误差。由于该优化方法是全局优化的方法,参数的偏差并不会影响最终的校准精度。为了验证所获得的参数的精度,随机采集100个点,每个点的噪声水平为0.05像素。通过对比仿真的真实位置和校准后的星点位置,可以得到误差统计平方根为:x方向0.052像素,y方向为0.049像素,和质心算法噪声水平相一致,因此本发明校准精度完全满足要求。
Claims (1)
1、一种星敏感器内外方元素校准方法,基于一个由气垫平台、单星星光模拟器、星敏感器、2维轴向转台以及数据处理计算机组成的校准***,单星星光模拟器、星敏感器、2维轴向转台安装在气垫平台上,星敏感器安装在2维轴向转台的内框上,星敏感器的视轴垂直于2维轴向转台的两个旋转轴,单星星光模拟器发生的星光方向和星敏感器的视轴对齐,其特征在于,校准的步骤如下:
1.1、校准***建模;
1.1.1、外部参数建模;影响星敏感器采集得到的星点坐标位置的外部因素有:星光模拟器发生的星光方向,转台内外两个转动框偏离转台初始位置的角度,星敏感器在转台内框上的安装偏差,以及星敏感器图像传感器成像靶面和机壳之间的安装偏差;通过建立多个坐标系,将上述外部参数联系起来,以便分析星敏感器靶面上的星点成像位置;外部参数建模的步骤如下:
1.1.1.1、根据转台的初始位置建立坐标系N;
坐标系N以内框的转动轴为Xn轴,外框转动轴为Yn轴,Xn轴和Yn轴交于星敏感器镜头中心点0点,0为坐标系原点,过0点沿着星敏感器视轴方向为坐标系的Zn轴;星光模拟器发生的星光方向矢量Vn在坐标系N中的表达式为:
式中,n1、n2、n3为星光矢量Vn在坐标系N中的3个方向分量,α和β分别为该矢量在坐标系N中的偏航和俯仰角;
1.1.1.2、建立坐标系B;
当外框转过一个角度θ1后,根据转动后的转台状态建立坐标系B,坐标系B的原点和坐标系N相同,其Yb轴和Yn轴重合,Xb轴、Zb轴分别位于Xn轴、Zn轴转动后的位置,当外框转过θ1角后,星光矢量在坐标系B中的表达式为:
式中,b1,b2,b3为星光矢量在坐标系B中的3个方向分量,Rbn为转换矩阵;
1.1.1.3、建立坐标系C;
当内框转过一个角度θ2后,根据转动后的转台状态建立坐标系C;坐标系C的原点和坐标系B相同,其Xc轴和Xb轴重合,Yc轴、Zc轴分别位于Yb轴、Zb轴转动后的位置;当外框转过θ2角后,星光矢量在坐标系C中的表达式为:
式中,c1,c2,c3为星光矢量在坐标系C中的3个方向分量,Rcb为转换矩阵;
1.1.1.4、建立坐标系D和E;
假设星敏感器在转台内框上的安装偏角为1和2,1为偏航方向安装误差,2为俯仰方向安装误差;对应于星敏感器这两个安装位置,分别建立坐标系D和E;
坐标系D的原点和坐标系C相同,其Xd轴和Xc轴重合,Yd轴、Zd轴分别位于Yc轴、Zc轴转动后的位置,当外框转过1角后,星光矢量在坐标系D中的表达式为:
式中,d1,d2,d3为星光矢量在坐标系D中的3个方向分量,Rdc为转换矩阵;
坐标系E的原点和坐标系D相同,其Xe轴和Xd轴重合,Ye轴、Ze轴分别位于Yd轴、Zd轴转动后的位置,当外框转过2角后,星光矢量在坐标系E中的表达式为:
式中,e1、e2、e3为星光矢量在坐标系E中的3个方向分量,Red为转换矩阵;坐标系E即为星敏感器机壳坐标系;
1.1.1.5、建立坐标系F;
图像传感器靶面的X,Y轴和机壳坐标系E的Xe,Ye轴之间的安装偏差造成的偏置角为3,根据图像传感器靶面建立星敏感器的针孔成像坐标系F;坐标系F和坐标系E原点相同,Zf轴和Ze轴相重合,Xf轴和靶面图像传感器靶面的X方向一致,Yf轴和靶面Y方向一致;靶面坐标系与图像传感器采集得到的图像一致,原点位于图像左下角,X,Y方向即为图像的横、纵方向,星光矢量从坐标系E到坐标系F的转换过程为:
式中,f1、f2、f3为星光矢量在坐标系F中的3个方向分量,Rfe为转换矩阵;
根据以上坐标系的转换过程,得到从转台坐标系N到星敏感器坐标系F的转换关系为:
展开式[7]得到:
f1=cos3 cos2cosθ1cosβcosα+sin3sin(θ2+1)sinθ1cosβcosα
-cos3sin2cos(θ2+1)sinθ1cosβcosα
+sin3cos(θ2+1)cosβsinα+cos3sin2sin(θ2+1)cosβsinα
-cos3cos2sinθ1sinβ+sin3sin(θ2+1)cosθ1sinβ
-cos3sin2cos(θ2+1)cosθ1sinβ
f2=-sin3cos2cosθ1cosβcosα+cos3sin(θ2+1)sinθ1cosβcosα
+sin3sin2cos(θ2+1)sinθ1cosβcosα
+cos3cos(θ2+1)cosβsinα-sin3sin2sin(θ2+1)cosβsinα
+sin3cos(2)sinθ1sinβ+cos3sin(θ2+1)cosθ1sinβ
+sin3sin2cos(θ2+1)cosθ1sinβ
f3=sin2cosθ1cosβcosα+cos2cos(θ2+1)sinθ1cosβcosα
-cosθ2sin(θ2+1)cosβsinα-sin2sinθ1sinβ+cos2cos(θ2+1)cosθ1sinβ
上述外部参数中,转台的偏航角和俯仰角由转台自身提供,需要求取的外部参数有5个,即为α、β、φ1、φ2、φ3;
取的外部参数有5个,即为α、β、φ1、φ2、φ3;
1.1.2、针孔成像建模;
根据针孔成像原理,在坐标系F中,Zf为星敏感器视轴方向,Xf,Yf和星敏感器靶面坐标系的X,Y轴方向一致,这里的靶面坐标系为2维平面坐标系,以主点0’为原点,其X,Y轴对应于采集得到图像的横纵轴,星光经过镜头中心点0后,投影成像在星敏感器靶面P(x,y)点;假设星敏感器的焦距为fc,主点0’的图像坐标为(x0,y0),根据共线性公式有:
式中,主点(x0,y0)和焦距fc为3个未知参数;
1.1.3、镜头畸变建模;
dx,dy为星敏感器在x方向和y方向的畸变偏差,有:
式中,
q1、q2、q3为径向畸变系数;
p1、p2、p3为偏心畸变系数;
于是内部参数总共有9个,即为x0、y0、fc、q1、q2、q3、p1、p2、p3,根据公式[8]有:
上述模型中,总共有外部参数和内部参数14个,即:α、β、φ1、φ2、φ3、x0、y0、fc、q1、q2、q3、p1、p2、p3;
1.2、采集数据;
转动转台,从-6度到+6度,每间隔1度为一个采集位置,在一个位置采集n次数据,n可取100~1000,并记录当时的转台转动坐标,最终使得星点成像遍布靶面,公式为:
1.3、数据处理;
主点位置采用自准直方法,星光垂直投射到靶面上,求出此时的图像坐标;此时,需要校准的参数有12个,用一个向量
来表示这些向量有:
根据公式进一步可以得到:
这里A、B为敏感矩阵;
星点采集个数为m,联合x和y方向的偏差和敏感矩阵,
这里p是由x和y方向残留偏差组成的向量,M为A和B两个敏感矩阵组成的整体敏感矩阵;
于是有迭代方程为:
这里k为迭代序号,k取5~20,迭代结束后得到稳定的数据值,这时的参数即为最后的校准结果。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CNB2005101125537A CN100349018C (zh) | 2005-10-12 | 2005-10-12 | 一种星敏感器内外方元素校准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CNB2005101125537A CN100349018C (zh) | 2005-10-12 | 2005-10-12 | 一种星敏感器内外方元素校准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN1949002A CN1949002A (zh) | 2007-04-18 |
CN100349018C true CN100349018C (zh) | 2007-11-14 |
Family
ID=38018577
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CNB2005101125537A Expired - Fee Related CN100349018C (zh) | 2005-10-12 | 2005-10-12 | 一种星敏感器内外方元素校准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN100349018C (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101943584A (zh) * | 2010-07-02 | 2011-01-12 | 哈尔滨工程大学 | 基于ccd星敏感器的对准方法 |
CN103292981A (zh) * | 2013-05-22 | 2013-09-11 | 中国科学院上海光学精密机械研究所 | 光学镜头畸变的测量装置和校正方法 |
Families Citing this family (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN100414253C (zh) * | 2007-07-06 | 2008-08-27 | 北京航空航天大学 | 一种数字式太阳敏感器标定方法及装置 |
CN101699222B (zh) * | 2009-11-02 | 2011-04-20 | 中国人民解放军国防科学技术大学 | 一种星敏感器校准装置及应用于高精度星敏感器校准的方法 |
CN101943585B (zh) * | 2010-07-02 | 2013-07-31 | 哈尔滨工程大学 | 一种基于ccd星敏感器的标定方法 |
CN104166985B (zh) * | 2014-07-04 | 2017-03-15 | 北京控制工程研究所 | 一种基于区域分割的星敏感器标定方法 |
EP2985636B1 (de) * | 2014-08-11 | 2018-07-25 | Leuze electronic GmbH + Co KG | Verfahren zum Ausrichten einer Sensoreinrichtung |
CN105782458B (zh) * | 2014-12-26 | 2017-12-22 | 北京航天计量测试技术研究所 | 用于复合环境下星敏感器校准装置的动密封装置 |
CN105953803B (zh) * | 2016-04-25 | 2018-11-06 | 上海航天控制技术研究所 | 数字式太阳敏感器测量坐标系与棱镜坐标系偏差测量方法 |
CN106199758A (zh) * | 2016-06-30 | 2016-12-07 | 联想(北京)有限公司 | 测量数据校准方法和电子设备 |
CN108871373B (zh) * | 2017-05-11 | 2021-06-15 | 北京遥感设备研究所 | 一种基于俯仰滚转台和非线性优化的星敏感器标定方法 |
CN107588785B (zh) * | 2017-09-12 | 2019-11-05 | 中国人民解放军国防科技大学 | 一种考虑像点误差的星敏感器内外参数简化标定方法 |
CN108225305B (zh) * | 2017-11-23 | 2021-06-15 | 北京遥感设备研究所 | 一种星敏感器多参数优化方法及*** |
CN109471466B (zh) * | 2018-11-22 | 2021-01-05 | 北京航天计量测试技术研究所 | 具有温度控制功能的高精度转位机构 |
CN109798921B (zh) * | 2019-02-22 | 2022-07-19 | 中国科学院光电技术研究所 | 一种星敏感器内方位元素室内校准方法 |
CN110160445B (zh) * | 2019-06-07 | 2020-12-25 | 宝鸡文理学院 | 一种基于远心光学技术的视觉测量仪 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN87105637A (zh) * | 1986-08-18 | 1988-04-20 | 休斯航空公司 | 空间飞行器加速度计自动校准 |
US5473746A (en) * | 1993-04-01 | 1995-12-05 | Loral Federal Systems, Company | Interactive graphics computer system for planning star-sensor-based satellite attitude maneuvers |
US5865402A (en) * | 1995-05-24 | 1999-02-02 | Daimler-Benz Aerospace Ag | Triaxially stabilized, earth-oriented satellite and corresponding sun and earth acquisition process using a magnetometer |
US5978716A (en) * | 1997-05-28 | 1999-11-02 | Space Systems/Loral, Inc. | Satellite imaging control system for non-repeatable error |
CN1502524A (zh) * | 2002-11-26 | 2004-06-09 | 中国科学院光电技术研究所 | 一种星敏感器遮光罩及其设计方法 |
-
2005
- 2005-10-12 CN CNB2005101125537A patent/CN100349018C/zh not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN87105637A (zh) * | 1986-08-18 | 1988-04-20 | 休斯航空公司 | 空间飞行器加速度计自动校准 |
US5473746A (en) * | 1993-04-01 | 1995-12-05 | Loral Federal Systems, Company | Interactive graphics computer system for planning star-sensor-based satellite attitude maneuvers |
US5865402A (en) * | 1995-05-24 | 1999-02-02 | Daimler-Benz Aerospace Ag | Triaxially stabilized, earth-oriented satellite and corresponding sun and earth acquisition process using a magnetometer |
US5978716A (en) * | 1997-05-28 | 1999-11-02 | Space Systems/Loral, Inc. | Satellite imaging control system for non-repeatable error |
CN1502524A (zh) * | 2002-11-26 | 2004-06-09 | 中国科学院光电技术研究所 | 一种星敏感器遮光罩及其设计方法 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101943584A (zh) * | 2010-07-02 | 2011-01-12 | 哈尔滨工程大学 | 基于ccd星敏感器的对准方法 |
CN103292981A (zh) * | 2013-05-22 | 2013-09-11 | 中国科学院上海光学精密机械研究所 | 光学镜头畸变的测量装置和校正方法 |
Also Published As
Publication number | Publication date |
---|---|
CN1949002A (zh) | 2007-04-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN100349018C (zh) | 一种星敏感器内外方元素校准方法 | |
CN100520297C (zh) | 一种基于无偏差带的星敏感器地面校准方法 | |
CN102607526B (zh) | 双介质下基于双目视觉的目标姿态测量方法 | |
CN100348460C (zh) | 一种基于星场的星敏感器校准方法 | |
US8520067B2 (en) | Method for calibrating a measuring system | |
CN112629431B (zh) | 土木结构变形监测方法及相关设备 | |
CN102741706B (zh) | 地理参照图像区域的方法 | |
CN110517325B (zh) | 一种坐标变换及坐标变换的车身周围物体定位方法和*** | |
CN103278138B (zh) | 一种复杂结构薄部件三维位置及姿态的测量方法 | |
CN104154928B (zh) | 一种适用于惯性平台内置式星敏感器的安装误差标定方法 | |
CN109269512B (zh) | 行星着陆图像与测距融合的相对导航方法 | |
CN110849331B (zh) | 基于三维点云数据库模型的单目视觉测量与地面试验方法 | |
CN101539397B (zh) | 物体三维姿态的精密光学测量方法 | |
CN113269840A (zh) | 一种用于相机和多激光雷达的联合标定方法及电子设备 | |
CN102636081B (zh) | 一种基于视觉运动建模的传递对准方法及装置 | |
CN100376883C (zh) | 一种基于像素频率的星敏感器校准方法 | |
CN104111071B (zh) | 基于激光测距与摄像机视觉融合的高精度位姿解算方法 | |
CN107655485A (zh) | 一种巡航段自主导航位置偏差修正方法 | |
CN108663043B (zh) | 基于单个相机辅助的分布式pos主子节点相对位姿测量方法 | |
CN110363758B (zh) | 一种光学遥感卫星成像质量确定方法及*** | |
CN114608554B (zh) | 一种手持slam设备以及机器人即时定位与建图方法 | |
CN106525054A (zh) | 一种采用星上推扫遥感图像信息的单星自主测定轨方法 | |
CN110686684B (zh) | 一种小天体环绕探测器光学协同定轨方法 | |
Liu et al. | Accurate mapping method for UAV photogrammetry without ground control points in the map projection frame | |
CN108154535B (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 | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
C17 | Cessation of patent right | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20071114 Termination date: 20121012 |