[发明专利]车载桅杆倾斜量校正方法有效
申请号: | 201510078542.5 | 申请日: | 2015-02-13 |
公开(公告)号: | CN104634311B | 公开(公告)日: | 2017-04-19 |
发明(设计)人: | 彭富伦;王静;周丽华;徐姣杰;李琼;李洁 | 申请(专利权)人: | 西安应用光学研究所 |
主分类号: | G01C1/00 | 分类号: | G01C1/00;G01C9/00 |
代理公司: | 西北工业大学专利中心61204 | 代理人: | 陈星 |
地址: | 710065 陕西*** | 国省代码: | 陕西;61 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | 本发明提出一种车载桅杆倾斜量校正方法,在桅杆的底部及顶部安装基面上分别安装了两个高精度倾斜传感器,其中倾斜传感器C1安装在车体基面上,倾斜传感器C2安装在观瞄仪安装基面上,C1、C2的安装方向严格一致,通过倾斜传感器C1与C2输出的y向和x向的倾斜值进行比较,将观瞄仪轴角角度与倾斜传感器C2和C1的侧倾值结合换算到车体基面上,将数据输入计算机控制板进行极坐标转换等运算,参与系统测角输出修正,使桅杆带来的俯仰误差不大于0.1mil,用这个最终计算的结果来作为导弹弹架运动的基准,指导导弹弹架运动到指定位置,对指定目标进行攻击。 | ||
搜索关键词: | 车载 桅杆 倾斜 校正 方法 | ||
【主权项】:
一种车载桅杆倾斜量校正方法,其特征在于:将下部倾斜传感器安装在弹架平台基面上,将上部倾斜传感器安装在观瞄仪安装基面上,下部倾斜传感器和上部倾斜传感器采用双轴倾斜传感器,所述弹架平台安装在车体上,与车体刚性连接;并采用以下步骤:步骤1:在桅杆升起状态下,观瞄仪瞄准目标,得到目标方位角t_gm_fw和目标俯仰角t_gm_fy,并将目标方位角和目标俯仰角转换到观瞄仪基准坐标系O1:x1y1z1下,得到:t_gm_x=cos(t_gm_fw)×cos(t_gm_fy)t_gm_y=cos(t_gm_fw)×sin(t_gm_fy)t_gm_z=sin(t_gm_fw);t_gm_x为X1向坐标、t_gm_y为Y1向坐标、t_gm_z为Z1向坐标;步骤2:采用上部倾角传感器测得观瞄仪基准坐标系相对大地坐标系的旋转角度qsx和qsy,其中qsx为观瞄仪基准面坐标系相对大地坐标系X向旋转角度,qsy为观瞄仪基准面坐标系相对大地坐标系Y向旋转角度;采用下部倾角传感器测得弹架平台基准坐标系相对大地坐标系的旋转角度qxx和qxy,其中qxx为弹架平台基准坐标系相对大地坐标系X向旋转角度,qxy为弹架平台基准坐标系相对大地坐标系Y向旋转角度;步骤3:建立观瞄仪基准坐标系转换到弹架平台基准坐标系的坐标转换矩阵matrix[3][3],其中:matrix[0][0]=cos(qxy)×cos(qsy)+sin(qxx)×sin(qxy)×sin(qsx)×sin(qsy)+cos(qxx)×sin(qxy)×cos(qsx)×sin(qsy)matrix[0][1]=sin(qxx)×sin(qxy)×cos(qsx)‑cos(qxx)×sin(qxy)×sin(qsx)matrix[0][2]=cos(qxy)×sin(qsy)‑sin(qxx)×sin(qxy)×sin(qsx)×cos(qsy)‑cos(qxx)×sin(qxy)×cos(qsx)×cos(qsy)matrix[1][0]=cos(qxx)×sin(qsx)×sin(qsy)‑sin(qxx)×cos(qsx)×sin(qsy)matrix[1][1]=cos(qxx)×cos(qsx)+sin(qxx)×sin(qsx)matrix[1][2]=‑cos(qxx)×sin(qsx)×cos(qsy)+sin(qxx)×cos(qsx)×cos(qsy)matrix[2][0]=sin(qxy)×cos(qsy)‑sin(qxx)×cos(qxy)×sin(qsx)×sin(qsy)‑cos(qxx)×cos(qxy)×cos(qsx)×sin(qsy)matrix[2][1]=‑sin(qxx)×cos(qxy)×cos(qsy)+cos(qxx)×cos(qxy)×sin(qsx)matrix[2][2]=sin(qxy)×sin(qsy)+sin(qxx)×cos(qxy)×sin(qsx)×cos(qsy)+cos(qxx)×cos(qxy)×cos(qsx)×cos(qsy);步骤4:根据步骤1得到的目标在观瞄仪基准坐标系中坐标值t_gm_x、t_gm_y、t_gm_z和步骤3得到的坐标转换矩阵matrix[3][3],得到目标在弹架平台基准坐标系O2:x2y2z2下的坐标值:t_dj_x=(matrix[0][0])×t_gm_x+(matrix[0][1])×t_gm_y+(matrix[0][2])×t_gm_zt_dj_y=(matrix[1][0])×t_gm_x+(matrix[1][1])×t_gm_y+(matrix[1][2])×t_gm_zt_dj_z=(matrix[2][0])×t_gm_x+(matrix[2][1])×t_gm_y+(matrix[2][2])×t_gm_zt_dj_x为X2向坐标、t_dj_y为Y2向坐标、t_dj_z为Z2向坐标;步骤5:根据步骤2得到的观瞄仪基准坐标系相对大地坐标系的旋转角度qsx和qsy,建立观瞄仪基准坐标系转换到大地坐标系的坐标转换矩阵matr[3][3],其中:matr[0][0]=cos(qsy)matr[0][1]=0matr[0][2]=sin(qsy)matr[1][0]=sin(qsx)×sin(qsy)matr[1][1]=cos(qsx)matr[1][2]=‑sin(qsx)×sin(qsx)×cos(qsy)matr[2][0]=‑cos(qsx)×sin(qsy)matr[2][1]=sin(qsx)matr[2][2]=cos(qsx)×cos(qsy);步骤6:根据步骤1得到的目标在观瞄仪基准坐标系中坐标值t_gm_x、t_gm_y、t_gm_z和步骤5得到的坐标转换矩阵matr[3][3],得到目标在大地坐标系O:xyz下的坐标值:t_dd_x=(matr[0][0])×t_gm_x+(matr[0][1])×t_gm_y+(matr[0][2])×t_gm_zt_dd_y=(matr[1][0])×t_gm_x+(matr[1][1])×t_gm_y+(matr[1][2])×t_gm_zt_dd_z=(matr[2][0])×t_gm_x+(matr[2][1])×t_gm_y+(matr[2][2])×t_gm_z;t_dd_x为X向坐标、t_dd_y为Y向坐标、t_dd_z为Z向坐标。
下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于西安应用光学研究所,未经西安应用光学研究所许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/patent/201510078542.5/,转载请声明来源钻瓜专利网。