专利名称：星敏感器安装误差四位置标定与补偿方法
技术领域：
发明涉及一种星敏感器安装误差四位置标定与补偿方法，属于导航技术领域，可应用于飞行器星敏感器安装误差的高精度标定和补偿，适用于空天飞行器的导航定位。
背景技术：
以星敏感器为代表的星光天文导航系统以其隐蔽性好、精度高、无姿态累积误差等特点，在航空、航天等领域得到了广泛的应用。随着CMOS、APS敏感器的发展和动态性能的提高，星敏感器越来越多地采用更为灵活和低成本的捷联安装方式。星敏感器作为高精度天文敏感器，本身具有较高的测量精度，最高可达角秒级。但在实际应用中，星敏感器安装误差可达到角分级，其带来的测量误差大大高于星敏感器的随机测量误差，严重污染了星敏感器的量测信息，因此安装误差是影响星敏感器在实际应用中测量精度的主要因素之一。由于星敏感器安装误差实际是表现为像坐标轴的指向偏差，并最终耦合到星敏感器的量测信息中，因此利用星敏感器的量测输出进行安装误差标定的方法逐渐受到重视。现阶段的解决方法多使用其它器件(如陀螺)进行辅助标定，但该类方法有其自身缺点陀螺等器件本身具有测量误差，其测量精度会影响标定精度，从而增加了标定时误差建模及相应信息处理算法的复杂性。因此，现有的星敏感器安装误差标定方法复杂且精度较低，不能充分发挥星敏感器自身的高精度测量优势。
发明内容
本发明目的在于降低已有星敏感器安装误差对星敏感器定姿精度的影响，提供了一种星敏感器安装误差四位置标定与补偿方法。本发明为实现上述目的，采用如下技术方案本发明星敏感器安装误差四位置标定与补偿方法，其特征在于包括以下步骤(1)建立星敏感器安装误差角量测模型，得到星敏感器输出的载体相对于惯性系的姿态矩阵，表示为&f = ccfficic，其中ce表示考虑安装误差角时的安装误差矩阵，<表示地心惯性坐标系和载体坐标系之间的转换矩阵，ν表示星敏感器本身的随机观测噪声，可等效为角秒级的测角精度，对姿态阵元素的影响较�。�<表示转台坐标系和载体坐标系之间的转换矩阵， τ表示当地地理坐标系和转台坐标系之间的转换矩阵，cr表示地心地球固联坐标系和当地地理坐标系之间的转换矩阵，c;表示地心惯性坐标系和地心地球固联坐标系之间的转换矩阵，坐标转移矩阵中上下标的含义分别为i为地心惯性坐标系。e为地心地球固连坐标系，η为当地地理坐标系，P为转台坐标系，b为载体坐标系；(2)基于步骤(1)中所述的星敏感器安装误差角量测模型，建立基于不同横滚角的星敏感器安装误差标定模型；(3)根据步骤O)中所述的基于不同横滚角的星敏感器安装误差标定模型，设计基于四位置量测信息的三轴星敏感器安装误差标定算法；(4)由步骤C3)所述三轴星敏感器安装误差标定算法获得安装误差参数，在星敏感器的定姿算法中加入安装误差补偿环节，校正安装误差造成的星敏感器对惯性姿态的量测误差。本发明克服了现有星敏感器误差标定技术受辅助测量器件量测误差影响的不足， 构建了一种适用于空天飞行器星敏感器安装误差标定与补偿方法，它具有以下优势(1) 无需借用陀螺等辅助测量器件，有效减小了辅助器件量测精度对误差标定精度的影响；(2) 以标定测试中星敏感器输出的姿态信息为基�。又刑崛“沧拔蟛畹乃奈恢帽甓ú馐杂氩钩シ椒ǎ蟠蠼档土吮甓ㄊ迪值母丛有�。
图1为本发明的星敏感器安装误差标定与补偿算法的具体实施流程图；图2为星敏感器安装误差角示意图；图3为第一组测试时星敏感器基座在转台上的固定关系示意图；图4为第二组测试时星敏感器基座在转台上的固定关系示意图；图5为仿真的一条飞行航迹；图6为本发明的星敏感器安装误差补偿前的天文定姿误差曲线图；图7为本发明的星敏感器安装误差补偿后的天文定姿误差曲线图。
具体实施例方式下面结合附图对发明的技术方案进行详细说明如图1所示，本发明的原理是从建立安装误差角量测模型入手，得出星敏感器输出姿态矩阵，建立了基于不同横滚角位置的标定安装误差模型，实现了三轴星敏感器安装误差标定及补偿算法，实现高精度星光天文定姿。具体实施方法如下一、建立星敏感器安装误差角量测模型，得到星敏感器输出姿态矩阵安装误差角表现为星敏感器像坐标系与载体坐标系之间的夹角，如附图1所示， 当考虑安装误差为小量时，安装误差矩阵可表示为
权利要求
1.一种星敏感器安装误差四位置标定与补偿方法，其特征在于包括以下步骤(1)建立星敏感器安装误差角量测模型，得到星敏感器输出的载体相对于惯性系的姿态矩阵，表示为其中C0表示考虑安装误差角时的安装误差矩阵，Cf表示地心惯性坐标系和载体坐标系之间的转换矩阵，V表示星敏感器本身的随机观测噪声，可等效为角秒级的测角精度，对姿态阵元素的影响较�。�<表示转台坐标系和载体坐标系之间的转换矩阵，q表示当地地理坐标系和转台坐标系之间的转换矩阵，cr表示地心地球固联坐标系和当地地理坐标系之间的转换矩阵，C;表示地心惯性坐标系和地心地球固联坐标系之间的转换矩阵，坐标转移矩阵中上下标的含义分别为i表示地心惯性坐标系，e表示地心地球固连坐标系，η表示当地地理坐标系，P表示转台坐标系，b表示载体坐标系；(2)基于步骤(1)中所述的星敏感器安装误差角量测模型，建立基于不同横滚角的星敏感器安装误差标定模型；(3)根据步骤O)中所述的基于不同横滚角的星敏感器安装误差标定模型，设计基于四位置量测信息的三轴星敏感器安装误差标定算法；(4)由步骤C3)所述的三轴星敏感器安装误差标定算法获得安装误差参数，在星敏感器的定姿算法中加入安装误差补偿环节，校正安装误差造成的星敏感器对惯性姿态的量测误差。
2.根据权利要求1所述的星敏感器安装误差四位置标定与补偿方法，其特征在于步骤O)中所述的基于星敏感器安装误差角量测方程的星敏感器安装误差标定模型，表达式如下
3.根据权利要求1所述的星敏感器安装误差四位置标定与补偿方法，其特征在于步骤(3)中所述的基于四位置量测信息的三轴星敏感器安装误差标定算法，具体如下1)第一组两位置测试，设定载体坐标系与转台坐标系三轴重合，其量测矩阵为其中，Δ,表示第-组测试中两个不同测量位置的横滚角之差，Ypl分别表示第一组测试时、和t2时刻的横滚角，β χ、β z分别为星敏感器X轴、ζ轴的安装误差角，^^P^OWUgff)-1] (i = l,2,3;j = 1，2，3)，为由两位置星敏感器输出的惯性姿态矩阵及量测时间间隔计算所得的矩阵中提取的对应元素； 式⑴中
全文摘要
本发明公布了一种星敏感器安装误差四位置标定与补偿方法，该方法首先分析了星敏感器输出姿态信息与安装误差之间的耦合关系，建立了星敏感器安装误差角量测模型，得到星敏感器输出的姿态矩阵；然后分析了利用不同横滚角位置标定安装误差的原理，并在此基础上，建立了基于不同横滚角位置的星敏感器安装误差标定模型；最后实现了基于四位置量测信息的三轴星敏感器安装误差标定计算与误差补偿算法。本发明能够实现对星敏感器安装误差的高精度标定，在此基础上进行安装误差的补偿，可有效提高星光天文定姿的精度，对星敏感器的高精度应用具有重要的理论意义和实际参考价值。
文档编号G01C25/00GK102564455SQ201110449659
公开日2012年7月11日 申请日期2011年12月29日 优先权日2011年12月29日
发明者刘建业, 吴旋, 张丹, 张承, 张旭, 彭惠, 熊智, 王融, 陈计辉 申请人:南京航空航天大学
专业数控铣床产品供应商
20年生产经验，实力工厂，精工品质，质量有保障
