[发明专利]一种三轴转台综合指向误差的评定方法有效
申请号: | 201910281768.3 | 申请日: | 2019-04-09 |
公开(公告)号: | CN109974749B | 公开(公告)日: | 2021-06-01 |
发明(设计)人: | 任顺清;王孟磊;王常虹;曾庆双 | 申请(专利权)人: | 哈尔滨工业大学 |
主分类号: | G01C25/00 | 分类号: | G01C25/00 |
代理公司: | 哈尔滨龙科专利代理有限公司 23206 | 代理人: | 高媛 |
地址: | 150000 黑龙*** | 国省代码: | 黑龙江;23 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 转台 综合 指向 误差 评定 方法 | ||
1.一种三轴转台综合指向误差的评定方法,其特征在于,包括以下步骤:
通过三轴转台的三个标称转角计算标称惯性仪表坐标系相对于地理坐标系的标称姿态矩阵;在考虑三轴转台各项误差后,建立相应坐标系,并通过误差传递,推导出实际的惯性仪表坐标系相对于地理坐标系的实际姿态矩阵,并与三轴转台给出的标称姿态矩阵进行比较;最后建立综合指向误差与三轴转台各项误差之间的关系,给出三轴转台综合指向误差的评定方法,所述三轴转台各项误差包括:六个不断变化的倾角回转误差,三个恒定的初始零位误差,四个恒定的垂直度误差,三个不断变化的角位置误差和三个恒定的安装误差,具体步骤如下:
步骤一:利用水平仪、陀螺经纬仪或者自准直仪等仪器测量三轴转台的各项主要误差;
步骤二:建立五个相关坐标系,分析误差传递过程;
步骤三:在不考虑误差时,推导标称惯性仪表坐标系对于地理坐标系的标称姿态矩阵在考虑各个误差时,使用方向余弦矩阵推导实际惯性仪表坐标系对于地理坐标系的实际姿态矩阵
步骤四:计算综合指向误差,确立综合指向误差与各误差源的关系;
步骤五:结合Monte-Carlo方法进行仿真,计算和分析各项误差对于综合指向误差的灵敏度,所述步骤三中确立实际姿态矩阵与标称姿态矩阵的关系,实际姿态矩阵的计算方法为:
其中,为考虑误差时地理坐标系o0x0y0z0对于外环轴坐标系o1x1y1z1的姿态矩阵,在地理坐标系o0x0y0z0与外环轴坐标系o1x1y1z1之间,首先考虑外环轴轴线对水平面的垂直度,可以认为是在地理坐标系o0x0y0z0的基础上绕o0x0旋转Δθx0,再绕o0y0旋转Δθy0而形成,沿外环轴初始对准时会出现零位误差,即绕o0z0轴旋转Δa0,接着外环轴旋转至a角位置时,产生倾角回转误差以及角位置误差,其中倾角回转误差等效于在绕o0z0旋转a角,再分别绕新坐标系x、y轴旋转Δλx1(a)、Δλy1(a)形成,角位置误差可看作绕o0z0轴旋转Δa;
其中,地理坐标系绕轴z0旋转角度α,得到外环轴坐标系,姿态矩阵为
为考虑误差时外环轴坐标系o1x1y1z1对于中环轴坐标系o2x2y2z2的姿态矩阵,在外环轴坐标系o1x1y1z1与中环轴坐标系o2x2y2z2之间,外环轴与中环轴的轴线垂直度为Δθy1,沿中环轴初始对准时有零位误差,即绕o1x1轴旋转Δβ0,当中环轴旋转至β角位置时,产生倾角回转误差以及角位置误差,其中倾角回转误差等效于先绕o2z2旋转β角,再分别绕o1y1、o1z1轴旋转Δλy2(β)、Δλz2(β)形成,角位置误差可看作绕o1x1轴旋转Δβ;
其中,外环轴坐标系绕轴x1旋转角度β,得到中环轴坐标系,姿态矩阵为
为考虑误差时中环轴坐标系o2x2y2z2对于内环轴坐标系o3x3y3z3的姿态矩阵;在中环轴坐标系o2x2y2z2与内环轴坐标系o3x3y3z3之间,中环轴与内环轴的轴线有垂直度误差,即绕o2y2轴旋转小角度Δθy2,沿内环轴初始对准时产生零位误差,即绕o2z2轴旋转小角度Δγ0,外环轴旋转至γ角位置时,产生倾角回转误差以及角位置误差,其中倾角回转误差等效于先绕o2z2旋转γ角,再分别绕o2x2、o2y2轴旋转Δλx3(γ)、Δλy3(γ)形成,角位置误差可看作绕o2z2轴旋转Δγ;
其中,中环轴坐标系绕轴z2旋转角度γ,得到内环轴坐标系,姿态矩阵为
为考虑误差时内环轴坐标系o3x3y3z3对于惯性仪表坐标系o4x4y4z4的姿态矩阵;内环轴坐标系o3x3y3z3到惯性仪表坐标系o4x4y4z4,主要考虑安装平面的安装误差分别绕o3x3、o3y3、o3z3轴旋转小角度
其中,从内环轴坐标系到惯性仪表坐标系,姿态矩阵为
2.根据权利要求1所述的一种三轴转台综合指向误差的评定方法,其特征在于,所述步骤四中计算综合指向误差的具体方法为:
在三轴转台转过三个标称角度后,与惯性仪表固联的标称向量绕空间某一向量再旋转一小角度后,即为该向量对应的实际向量,这个小角度可以用来评定综合指向误差,也可认为在理想情况下,转台的惯性仪表坐标系先绕x轴旋转角Δεx,形成新的坐标系,再绕新形成的坐标系的y轴旋转Δεy,形成第二个新的坐标系,最后绕第二个新坐标系的z轴旋转Δεz,形成实际的惯性仪表坐标系,令Δε=[Δεx,Δεy,Δεz]T,那么姿态矩阵转动的规律为略去二阶及二阶以上小量,可得:
Δε=C1η1+C2η2+C2η3+C3η4+C3η5+C4η6+C5η7+C6η8,
其中,η1是安装误差项向量,η2是初始零位误差项向量,η3是角位置误差项向量,η4、η8是轴系垂直度误差项向量,η5、η6、η7分别为外、中、内环轴倾角回转误差向量,C1、C2、C3、C4、C5、C6为各个误差项系数;
|Δε|即为综合指向误差,简化的指向误差的平方和计算公式为:
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于哈尔滨工业大学,未经哈尔滨工业大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201910281768.3/1.html,转载请声明来源钻瓜专利网。