[发明专利]光电稳定平台姿态角传递方法和存储介质在审
| 申请号: | 202110974342.3 | 申请日: | 2021-08-24 |
| 公开(公告)号: | CN113884091A | 公开(公告)日: | 2022-01-04 |
| 发明(设计)人: | 甘欣辉;宋亮;姚连喜;万韬;郭贺;赵长超;郭健;王成;赵德堂;杨苏文;王世祥 | 申请(专利权)人: | 江苏无线电厂有限公司 |
| 主分类号: | G01C21/18 | 分类号: | G01C21/18;G01C21/20 |
| 代理公司: | 江苏圣典律师事务所 32237 | 代理人: | 吴庭祥 |
| 地址: | 210012 江*** | 国省代码: | 江苏;32 |
| 权利要求书: | 查看更多 | 说明书: | 查看更多 |
| 摘要: | |||
| 搜索关键词: | 光电 稳定 平台 姿态 传递 方法 存储 介质 | ||
1.一种光电稳定平台姿态角传递方法,其特征在于,包括以下步骤:
S1、建立关于惯性导航设备、光电稳定平台和光电设备的坐标系;
S2、将目标在所述惯性导航设备坐标系下的直角坐标转换成光电稳定平台的视轴坐标系下的坐标,实现所述光电稳定平台和所述惯性导航设备之间的误差修正。
2.根据权利要求1所述的光电稳定平台姿态角传递方法,其特征在于,所述坐标系包括,
视轴坐标系(L系):表示视轴的姿态,XL轴沿光电设备的视轴方向;
俯仰坐标系(E系):随俯仰轴系运动,YE轴平行于俯仰轴方向,E0系为俯仰零位处的坐标系,采用俯仰编码器测量值β来表示E系与E0系之间的旋转角度;
方位坐标系(A系),随方位轴系运动,ZA轴平行于方位轴方向,A0系为方位零位处的坐标系,采用方位编码器测量值α来表示A系与A0系之间的旋转角度;
基座坐标系(B系),YBZB平行于安装基座平面,XB轴垂直于安装基面;
惯导坐标系(0系),X0轴、Y0轴和Z0轴分别沿惯性导航设备的敏感轴方向,惯性导航设备相对于地理坐标系的运动可以用惯性导航设备的姿态角来表示;
惯性坐标系(n系),XnYn为当地水平面,Z轴垂直向上。
3.根据权利要求1所述的光电稳定平台姿态角传递方法,其特征在于,步骤S2具体为,
设目标在惯性坐标系下的直角坐标为Xn=[xn,yn,zn]T,
式中,XL=[1,0,0]T为目标在视轴坐标系L系下的直角坐标,为L系到E系的视轴垂直度误差转换矩阵;为E系到E0系的俯仰回转误差转换矩阵;为E0系到A系的俯仰垂直度误差转换矩阵;为A系到A0系的方位回转误差转换矩阵;为A0系到B系的方位垂直度误差转换矩阵;为B系到0系的安装对准误差转换矩阵;为0系到n系惯导测量误差转换矩阵。
4.根据权利要求3所述的光电稳定平台姿态角传递方法,其特征在于,根据球面坐标与直角坐标的转换关系,得到视轴指向误差的基本参数模型为
其中,αi和βi为目标的实际指向信息,δαi和δβi为视轴指向误差信息,Δα为方位编码器误差,Δβ为俯仰编码器误差,αi和βi为目标的实际指向信息,Δαxa和Δβxa为视轴垂直度误差,Δαyr和Δγyr为俯仰轴回转误差,Δαya和Δγya为俯仰轴垂直度误差,Δγzr和Δβzr为方位轴回转误差,Δγza和Δβza为方位轴垂直度误差,Δψa为惯性导航设备安装时的方位对准误差,Δφa和Δθa分别为惯性导航设备滚动和俯仰方向的安装误差,Δψm、Δθm和Δφm分别为惯性导航设备姿态测量误差。
5.一种可读计算机存储介质,其特征在于,所述计算机可读的存储介质中存储有计算机程序,其中,所述计算机程序被设置为运行时执行所述权利要求1至4任一项中所述的方法。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于江苏无线电厂有限公司,未经江苏无线电厂有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202110974342.3/1.html,转载请声明来源钻瓜专利网。





