CN102679999A - 星敏感器安装误差四位置标定与补偿方法 - Google Patents
星敏感器安装误差四位置标定与补偿方法 Download PDFInfo
- Publication number
- CN102679999A CN102679999A CN2012100096927A CN201210009692A CN102679999A CN 102679999 A CN102679999 A CN 102679999A CN 2012100096927 A CN2012100096927 A CN 2012100096927A CN 201210009692 A CN201210009692 A CN 201210009692A CN 102679999 A CN102679999 A CN 102679999A
- Authority
- CN
- China
- Prior art keywords
- star sensor
- delta
- gamma
- coordinate system
- 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.)
- Pending
Links
Images
Landscapes
- Navigation (AREA)
Abstract
本发明公布了一种星敏感器安装误差四位置标定与补偿方法,该方法首先分析了星敏感器输出姿态信息与安装误差之间的耦合关系,建立了星敏感器安装误差角量测模型,得到星敏感器输出的姿态矩阵;然后分析了利用不同横滚角位置标定安装误差的原理,并在此基础上,建立了基于不同横滚角位置的星敏感器安装误差标定模型;最后实现了基于四位置量测信息的三轴星敏感器安装误差标定计算与误差补偿算法。本发明能够实现对星敏感器安装误差的高精度标定,在此基础上进行安装误差的补偿,可有效提高星光天文定姿的精度,对星敏感器的高精度应用具有重要的理论意义和实际参考价值。
Description
技术领域
发明涉及一种星敏感器安装误差四位置标定与补偿方法,属于导航技术领域,可应用于飞行器星敏感器安装误差的高精度标定和补偿,适用于空天飞行器的导航定位。
背景技术
以星敏感器为代表的星光天文导航***以其隐蔽性好、精度高、无姿态累积误差等特点,在航空、航天等领域得到了广泛的应用。随着CMOS、APS敏感器的发展和动态性能的提高,星敏感器越来越多地采用更为灵活和低成本的捷联安装方式。
星敏感器作为高精度天文敏感器,本身具有较高的测量精度,最高可达角秒级。但在实际应用中,星敏感器安装误差可达到角分级,其带来的测量误差大大高于星敏感器的随机测量误差,严重污染了星敏感器的量测信息,因此安装误差是影响星敏感器在实际应用中测量精度的主要因素之一。由于星敏感器安装误差实际是表现为像坐标轴的指向偏差,并最终耦合到星敏感器的量测信息中,因此利用星敏感器的量测输出进行安装误差标定的方法逐渐受到重视。现阶段的解决方法多使用其它器件(如陀螺)进行辅助标定,但该类方法有其自身缺点:陀螺等器件本身具有测量误差,其测量精度会影响标定精度,从而增加了标定时误差建模及相应信息处理算法的复杂性。
因此,现有的星敏感器安装误差标定方法复杂且精度较低,不能充分发挥星敏感器自身的高精度测量优势。
发明内容
本发明目的在于:降低已有星敏感器安装误差对星敏感器定姿精度的影响,提供了一种星敏感器安装误差四位置标定与补偿方法。
本发明为实现上述目的,采用如下技术方案:
本发明星敏感器安装误差四位置标定与补偿方法,其特征在于包括以下步骤:
(1)建立星敏感器安装误差角量测模型,得到星敏感器输出的载体相对于惯性系的姿态矩阵,表示为:
其中Cβ表示考虑安装误差角时的安装误差矩阵,表示地心惯性坐标系和载体坐标系之间的转换矩阵,v表示星敏感器本身的随机观测噪声,可等效为角秒级的测角精度,对姿态阵元素的影响较小,表示转台坐标系和载体坐标系之间的转换矩阵,表示当地地理坐标系和转台坐标系之间的转换矩阵,表示地心地球固联坐标系和当地地理坐标系之间的转换矩阵,表示地心惯性坐标系和地心地球固联坐标系之间的转换矩阵,坐标转移矩阵中上下标的含义分别为:i为地心惯性坐标系。e为地心地球固连坐标系,n为当地地理坐标系,p为转台坐标系,b为载体坐标系;
(2)基于步骤(1)中所述的星敏感器安装误差角量测模型,建立基于不同横滚角的星敏感器安装误差标定模型;
(3)根据步骤(2)中所述的基于不同横滚角的星敏感器安装误差标定模型,设计基于四位置量测信息的三轴星敏感器安装误差标定算法;
(4)由步骤(3)所述三轴星敏感器安装误差标定算法获得安装误差参数,在星敏感器的定姿算法中加入安装误差补偿环节,校正安装误差造成的星敏感器对惯性姿态的量测误差。
本发明克服了现有星敏感器误差标定技术受辅助测量器件量测误差影响的不足,构建了一种适用于空天飞行器星敏感器安装误差标定与补偿方法,它具有以下优势:(1)无需借用陀螺等辅助测量器件,有效减小了辅助器件量测精度对误差标定精度的影响;(2)以标定测试中星敏感器输出的姿态信息为基础,从中提取安装误差的四位置标定测试与补偿方法,大大降低了标定实现的复杂性。
附图说明
图1为本发明的星敏感器安装误差标定与补偿算法的具体实施流程图;
图2为星敏感器安装误差角示意图;
图3为第一组测试时星敏感器基座在转台上的固定关系示意图;
图4为第二组测试时星敏感器基座在转台上的固定关系示意图;
图5为仿真的一条飞行航迹;
图6为本发明的星敏感器安装误差补偿前的天文定姿误差曲线图;
图7为本发明的星敏感器安装误差补偿后的天文定姿误差曲线图。
具体实施方式
下面结合附图对发明的技术方案进行详细说明:
如图1所示,本发明的原理是:从建立安装误差角量测模型入手,得出星敏感器输出姿态矩阵,建立了基于不同横滚角位置的标定安装误差模型,实现了三轴星敏感器安装误差标定及补偿算法,实现高精度星光天文定姿。具体实施方法如下:
一、建立星敏感器安装误差角量测模型,得到星敏感器输出姿态矩阵
安装误差角表现为星敏感器像坐标系与载体坐标系之间的夹角,如附图1所示,当考虑安装误差为小量时,安装误差矩阵可表示为:
对于星敏感器固定于转台上的情况,得到星敏感器输出的载体相对于惯性系的姿态矩阵,采用一系列坐标转换矩阵表示为:
式(5)中,其中Cβ表示考虑安装误差角时的安装误差矩阵,表示地心惯性坐标系和载体坐标系之间的转换矩阵,v表示星敏感器本身的随机观测噪声,可等效为角秒级的测角精度,对姿态阵元素的影响较小,表示转台坐标系和载体坐标系之间的转换矩阵,表示当地地理坐标系和转台坐标系之间的转换矩阵,表示地心地球固联坐标系和当地地理坐标系之间的转换矩阵,表示地心惯性坐标系和地心地球固联坐标系之间的转换矩阵,坐标转移矩阵中上下标的含义分别为:i为地心惯性坐标系。e为地心地球固连坐标系,n为当地地理坐标系,p为转台坐标系,b为载体坐标系。
二、建立基于不同横滚角位置的星敏感器安装误差标定模型
(6)
当t2时刻相对与t1时刻仅横滚角变化时,得到式(3)中的姿态矩阵有
其中,Φy(Δγ2-1)表示绕y轴转过角度Δγ2-1的坐标旋转矩阵;Δγ2-1=γ2-γ1为两个不同测量位置的横滚角之差。
考虑到地球自转的影响,在t1、t2两个不同的时刻的量测关系为
则由公式(6)(7)(8),可得到基于不同横滚角位置的星敏感器安装误差标定方程:
等式(9)左端反映星敏感器两个测量位置之间的关系,右端则包含了星敏感器两次量测的信息及时间间隔。
三、基于四位置量测信息的三轴星敏感器安装误差标定计算
1.三轴安装误差标定方案设计
设计两组共四个位置的测试,具体如下:
1)第一组测试:设定载体坐标系与转台坐标系三轴重合,则星敏感器基座在转台上的固定关系示意图如附图3所示;在t1时刻记为位置1,此时转台姿态为(ψ1,φ1,γ1),星敏感器输出的惯性姿态阵为在t2时刻记为位置2,此 转台姿态为(ψ1,φ1,γ1+Δγ2-1),星敏感器输出的惯性姿态阵为
2)第二组测试:在第一组测试的基础上,将星敏感器绕载体系z轴旋转90°后重新固定于转台上,则星敏感器基座在转台上的固定关系示意图如附图4所示;在t3时刻记为位置3,此时转台姿态为(ψ3,φ3,γ3),星敏感器输出的惯性姿态阵为在t4时刻记为位置4,此时转台姿态为(ψ3,φ3,γ3+Δγ4-3),星敏感器输出的惯性姿态阵为
2.三轴安装误差标定计算
1)对于第一组两位置测试,载体坐标系与转台坐标系三轴重合,则
将式(10)代入式(6),经整理展开,并忽略二阶小量可得
由式(11)两端矩阵对应元素相等,可以获得量测矩阵式(12)
2)对于第二组两位置测试,即在第一组测试的基础上,将星敏感器在绕载体系z轴旋转90°后重新固定于转台上,经过与第一组两位置测试类似的推导,可获得式(14)所示的方程
通过上面的两组共四个位置的测试,由式(12)、(13)可得,
利用最小二乘数据处理方法求解式(14),便可以计算获得星敏感器三轴的安装误差角βz,βy,βx。需要说明的是,上面仅仅是给出星敏感器固定于转台上的两种特殊方位,与此类似,还可推导出其它固定方位的标定计算公式。
四、基于四位置量测信息的三轴星敏感器安装误差补偿
在地面使用四位置标定算法对星敏感器安装误差进行静态标定后,获得的安装误差参数,便可在星敏感器的定姿算法中加入安装误差补偿的环节,校正安装误差造成的星敏感器对惯性姿态的量测误差。对安装误差的补偿依据式(16)进行
为了验证发明所提出的惯性/卫星/天文多级嵌入式组合导航***和方法的性能,分别对未采用本发明方法前后的天文姿态误差进行了对比,图5为验证时采用的飞行航迹;图6~图7的结果表明,对星敏感器安装误差进行补偿后,天文定姿精度有明显提高,本发明的星敏感器安装误差标定与补偿方法能够显著降低星敏感器安装误差对天文定姿精度的影响。
Claims (3)
1.一种星敏感器安装误差四位置标定与补偿方法,其特征在于包括以下步骤:
(1)建立星敏感器安装误差角量测模型,得到星敏感器输出的载体相对于惯性系的姿态矩阵,表示为:
其中Cβ表示考虑安装误差角时的安装误差矩阵,表示地心惯性坐标系和载体坐标系之间的转换矩阵,v表示星敏感器本身的随机观测噪声,可等效为角秒级的测角精度,对姿态阵元素的影响较小,表示转台坐标系和载体坐标系之间的转换矩阵,表示当地地理坐标系和转台坐标系之间的转换矩阵,表示地心地球固联坐标系和当地地理坐标系之间的转换矩阵,表示地心惯性坐标系和地心地球固联坐标系之间的转换矩阵,坐标转移矩阵中上下标的含义分别为:i表示地心惯性坐标系,e表示地心地球固连坐标系,n表示当地地理坐标系,p表示转台坐标系,b表示载体坐标系;
(2)基于步骤(1)中所述的星敏感器安装误差角量测模型,建立基于不同横滚角的星敏感器安装误差标定模型;
(3)根据步骤(2)中所述的基于不同横滚角的星敏感器安装误差标定模型,设计基于四位置量测信息的三轴星敏感器安装误差标定算法;
(4)由步骤(3)所述的三轴星敏感器安装误差标定算法获得安装误差参数,在星敏感器的定姿算法中加入安装误差补偿环节,校正安装误差造成的星敏感器对惯性姿态的量测误差。
2.根据权利要求1所述的星敏感器安装误差四位置标定与补偿方法,其特征在于:步骤(2)中所述的基于星敏感器安装误差角量测方程的星敏感器安装误差标定模型,表达式如下:
3.根据权利要求1所述的星敏感器安装误差四位置标定与补偿方法,其特征在于:步骤(3)中所述的基于四位置量测信息的三轴星敏感器安装误差标定算法,具体如下:
1)第一组两位置测试,设定载体坐标系与转台坐标系三轴重合,其量测矩阵为:
其中,Δγ2-1=γ2-γ1,表示第一组测试中两个不同测量位置的横滚角之差,γ1、γ2分别表示第一组测试时t1和t2时刻的横滚角,βx、βz分别为星敏感器x轴、z轴的安装误差角,(i=1,2,3;j=1,2,3),为由两位置星敏感器输出的惯性姿态矩阵及量测时间间隔计算所得的矩阵中提取的对应元素;
式(1)中
2)第二组两位置测试,在第一组测试的基础上,将星敏感器绕载体系z轴旋转90°后重新固定于转台上,其量测矩阵为:
其中,Δγ4-3=γ4-γ3,表示第二组测试中两个不同测量位置的横滚角之差,γ3、γ4分别表示第二组测试时t3和t4时刻的横滚角,βy、βz分别为星敏感器y轴、z轴的安装误差角,(i=1,2,3;j=1,2,3),为由两位置星敏感器输出的惯性姿态矩阵及量测时间间隔计算所得的矩阵中提取的对应元素,表示t3时刻星敏感器的输出,表示t3时刻当地地理坐标系和转台坐标系之间的转换矩阵,表示t3时刻地心惯性坐标系和地心地球固联坐标系之间的转换矩阵,表示t4时刻星敏感器的输出,表示t4时刻当地地理坐标系和转台坐标系之间的转换矩阵,表示t4时刻地心惯性坐标系和地心地球固联坐标系之间的转换矩阵;
为书写方便,式(2)中
3)通过上面两组共四个位置的测试,得到三轴星敏感器安装误差量测方程为:
其中04×1表示该零矩阵有4行1列,A4×2表示矩阵A有4行2列,B4×2表示矩阵B有4行2列。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2012100096927A CN102679999A (zh) | 2012-01-13 | 2012-01-13 | 星敏感器安装误差四位置标定与补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2012100096927A CN102679999A (zh) | 2012-01-13 | 2012-01-13 | 星敏感器安装误差四位置标定与补偿方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN102679999A true CN102679999A (zh) | 2012-09-19 |
Family
ID=46812278
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2012100096927A Pending CN102679999A (zh) | 2012-01-13 | 2012-01-13 | 星敏感器安装误差四位置标定与补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102679999A (zh) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104792340A (zh) * | 2015-05-15 | 2015-07-22 | 哈尔滨工业大学 | 一种星敏感器安装误差矩阵与导航***星地联合标定与校正的方法 |
CN105424060A (zh) * | 2015-11-18 | 2016-03-23 | 湖北航天技术研究院总体设计所 | 一种飞行器星敏感器与捷联惯组安装误差的测量方法 |
CN106017507A (zh) * | 2016-05-13 | 2016-10-12 | 北京航空航天大学 | 一种用于中低精度的光纤惯组快速标定方法 |
CN106908085A (zh) * | 2017-04-10 | 2017-06-30 | 北京航天自动控制研究所 | 一种基于地球自转补偿的星光测量指向控制方法 |
CN108020244A (zh) * | 2018-02-05 | 2018-05-11 | 北京国电高科科技有限公司 | 一种星敏感器基准立方镜安装误差的标定装置及方法 |
CN108562305A (zh) * | 2018-01-15 | 2018-09-21 | 北京航空航天大学 | 一种惯性/天文深组合导航***安装误差五位置快速粗标定方法 |
CN109470269A (zh) * | 2018-11-08 | 2019-03-15 | 上海航天控制技术研究所 | 空间目标测量机构的标定方法、标定设备及标定*** |
CN111707291A (zh) * | 2020-06-23 | 2020-09-25 | 上海航天控制技术研究所 | 一种星敏感器焦平面自动装校装置及自动装校方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11160064A (ja) * | 1997-11-28 | 1999-06-18 | Toshiba Corp | 方位角検出センサ試験装置 |
US20030149529A1 (en) * | 2002-02-01 | 2003-08-07 | The Aerospace Corporation | Fault detection pseudo gyro |
CN101858755A (zh) * | 2010-06-01 | 2010-10-13 | 北京控制工程研究所 | 一种星敏感器的标定方法 |
CN101943584A (zh) * | 2010-07-02 | 2011-01-12 | 哈尔滨工程大学 | 基于ccd星敏感器的对准方法 |
CN102564455A (zh) * | 2011-12-29 | 2012-07-11 | 南京航空航天大学 | 星敏感器安装误差四位置标定与补偿方法 |
-
2012
- 2012-01-13 CN CN2012100096927A patent/CN102679999A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11160064A (ja) * | 1997-11-28 | 1999-06-18 | Toshiba Corp | 方位角検出センサ試験装置 |
US20030149529A1 (en) * | 2002-02-01 | 2003-08-07 | The Aerospace Corporation | Fault detection pseudo gyro |
CN101858755A (zh) * | 2010-06-01 | 2010-10-13 | 北京控制工程研究所 | 一种星敏感器的标定方法 |
CN101943584A (zh) * | 2010-07-02 | 2011-01-12 | 哈尔滨工程大学 | 基于ccd星敏感器的对准方法 |
CN102564455A (zh) * | 2011-12-29 | 2012-07-11 | 南京航空航天大学 | 星敏感器安装误差四位置标定与补偿方法 |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104792340B (zh) * | 2015-05-15 | 2017-08-25 | 哈尔滨工业大学 | 一种星敏感器安装误差矩阵与导航***星地联合标定与校正的方法 |
CN104792340A (zh) * | 2015-05-15 | 2015-07-22 | 哈尔滨工业大学 | 一种星敏感器安装误差矩阵与导航***星地联合标定与校正的方法 |
CN105424060A (zh) * | 2015-11-18 | 2016-03-23 | 湖北航天技术研究院总体设计所 | 一种飞行器星敏感器与捷联惯组安装误差的测量方法 |
CN105424060B (zh) * | 2015-11-18 | 2019-01-15 | 湖北航天技术研究院总体设计所 | 一种飞行器星敏感器与捷联惯组安装误差的测量方法 |
CN106017507B (zh) * | 2016-05-13 | 2019-01-08 | 北京航空航天大学 | 一种用于中低精度的光纤惯组快速标定方法 |
CN106017507A (zh) * | 2016-05-13 | 2016-10-12 | 北京航空航天大学 | 一种用于中低精度的光纤惯组快速标定方法 |
CN106908085A (zh) * | 2017-04-10 | 2017-06-30 | 北京航天自动控制研究所 | 一种基于地球自转补偿的星光测量指向控制方法 |
CN108562305A (zh) * | 2018-01-15 | 2018-09-21 | 北京航空航天大学 | 一种惯性/天文深组合导航***安装误差五位置快速粗标定方法 |
CN108562305B (zh) * | 2018-01-15 | 2021-08-17 | 北京航空航天大学 | 一种惯性/天文深组合导航***安装误差五位置快速粗标定方法 |
CN108020244A (zh) * | 2018-02-05 | 2018-05-11 | 北京国电高科科技有限公司 | 一种星敏感器基准立方镜安装误差的标定装置及方法 |
CN108020244B (zh) * | 2018-02-05 | 2024-01-02 | 北京国电高科科技有限公司 | 一种星敏感器基准立方镜安装误差的标定装置及方法 |
CN109470269A (zh) * | 2018-11-08 | 2019-03-15 | 上海航天控制技术研究所 | 空间目标测量机构的标定方法、标定设备及标定*** |
CN109470269B (zh) * | 2018-11-08 | 2020-09-04 | 上海航天控制技术研究所 | 空间目标测量机构的标定方法、标定设备及标定*** |
CN111707291A (zh) * | 2020-06-23 | 2020-09-25 | 上海航天控制技术研究所 | 一种星敏感器焦平面自动装校装置及自动装校方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102564455B (zh) | 星敏感器安装误差四位置标定与补偿方法 | |
CN102679999A (zh) | 星敏感器安装误差四位置标定与补偿方法 | |
CN110487301B (zh) | 一种雷达辅助机载捷联惯性导航***初始对准方法 | |
CN103323026B (zh) | 星敏感器和有效载荷的姿态基准偏差估计与修正方法 | |
US6876926B2 (en) | Method and system for processing pulse signals within an inertial navigation system | |
CN106289246B (zh) | 一种基于位置和姿态测量***的柔性杆臂测量方法 | |
CN103245359B (zh) | 一种惯性导航***中惯性传感器固定误差实时标定方法 | |
CN104792340A (zh) | 一种星敏感器安装误差矩阵与导航***星地联合标定与校正的方法 | |
CN106767787A (zh) | 一种紧耦合gnss/ins组合导航装置 | |
CN104729537B (zh) | 一种星敏感器低频误差在轨实时补偿方法 | |
CN102866397B (zh) | 一种多源异构遥感影像联合定位方法 | |
CN103852086B (zh) | 一种基于卡尔曼滤波的光纤捷联惯导***现场标定方法 | |
CN103852760B (zh) | 一种基于刚性和柔性基线组合的多基线测量方法 | |
CN105910602B (zh) | 一种组合导航方法 | |
CN102519485B (zh) | 一种引入陀螺信息的二位置捷联惯性导航***初始对准方法 | |
CN105737858A (zh) | 一种机载惯导***姿态参数校准方法与装置 | |
CN101858748A (zh) | 高空长航无人机的多传感器容错自主导航方法 | |
CN101788296A (zh) | 一种sins/cns深组合导航***及其实现方法 | |
CN103196448A (zh) | 一种机载分布式惯性测姿***及其传递对准方法 | |
CN103852085A (zh) | 一种基于最小二乘拟合的光纤捷联惯导***现场标定方法 | |
CN110926468A (zh) | 基于传递对准的动中通天线多平台航姿确定方法 | |
CN104344836A (zh) | 一种基于姿态观测的冗余惯导***光纤陀螺***级标定方法 | |
CN104374388A (zh) | 一种基于偏振光传感器的航姿测定方法 | |
CN103217159A (zh) | 一种sins/gps/偏振光组合导航***建模及动基座初始对准方法 | |
CN105352529B (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 | ||
C02 | Deemed withdrawal of patent application after publication (patent law 2001) | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20120919 |