发明名称 一种基于恒星模拟系统的船载经纬仪的标校方法
摘要 本发明涉及GPS载波相位差分和双矢量定姿的技术融合,属于导航领域。方法包括以下步骤:一是利用机载光学合作目标模拟恒星标校船载经纬仪空间指向的方案构建。二是GPS基线修正,包括机载端和船载端的修正。三是双矢量定姿,使用修正后的GPS基线两端点相对坐标数据,计算出经纬仪在地平系下空间指向。本发明可隔离经纬仪自身轴系参数误差、惯导设备姿态误差以及未知变形传导带来的影响,较大幅度提高船载经纬仪测角精度。
申请公布号 CN106500731A 申请公布日期 2017.03.15
申请号 CN201611182628.3 申请日期 2016.12.20
申请人 中国人民解放军63680部队 发明人 王前学;周海渊;刘新明;冯小勇;赵李健;杨恒;黄晓娟;徐如祥;桑海峰
分类号 G01C25/00(2006.01)I;G01C1/02(2006.01)I 主分类号 G01C25/00(2006.01)I
代理机构 江阴市同盛专利事务所(普通合伙) 32210 代理人 唐纫兰;沈国安
主权项 一种基于恒星模拟系统的船载经纬仪的标校方法,其特征在于:所述方法包括以下步骤:步骤一、GPS基线建立GPS天线分别安装于两无人机和船甲板,利用载波相位差分获取无人机天线和船甲板天线在地平系下的高精度相对位置关系,根据光源和无人机GPS天线的相对位置关系,利用机载微型惯导测量的无人机姿态,修正无人机上光源的位置;根据船载GPS天线和经纬仪的相对位置关系,利用船载惯导测量的姿态数据以及经纬仪的方位俯仰角,修正经纬仪上标校望远镜第一主点的位置;步骤二、GPS基线修正<img file="dest_path_image002.GIF" wi="24" he="22" />为标校望远镜第一主点,在经纬仪主机坐标系的坐标固定为<img file="dest_path_image004.GIF" wi="108" he="26" />,<img file="27062dest_path_image002.GIF" wi="24" he="22" />在经纬仪甲板坐标系O<sub>j</sub>‑X<sub>j</sub>Y<sub>j</sub>Z<sub>j</sub>下的坐标为:<img file="dest_path_image006.GIF" wi="461" he="98" />其中:A为经纬仪方位角,E为经纬仪俯仰角,<img file="dest_path_image008.GIF" wi="434" he="58" />上式中:<img file="dest_path_image010.GIF" wi="16" he="19" />——经纬仪方位零位;<img file="dest_path_image012.GIF" wi="14" he="17" />——经纬仪照准差;<img file="dest_path_image014.GIF" wi="11" he="19" />——经纬仪横轴差;<img file="dest_path_image016.GIF" wi="24" he="26" />——经纬仪方位转盘最大倾斜量;<img file="dest_path_image018.GIF" wi="27" he="26" />——经纬仪方位转盘最大倾斜方向的方位角;<img file="999392dest_path_image002.GIF" wi="24" he="22" />在以O<sub>j</sub>为坐标原点的地平系下的坐标为:<img file="dest_path_image020.GIF" wi="537" he="93" />其中:<img file="dest_path_image022.GIF" wi="19" he="25" />——船横摇角;<img file="dest_path_image024.GIF" wi="19" he="24" />——船纵摇角;<img file="dest_path_image026.GIF" wi="26" he="26" />——船航向角;O<sub>j</sub>在O‑XYZ坐标系下的坐标为<img file="dest_path_image028.GIF" wi="97" he="27" />,则<img file="343786dest_path_image002.GIF" wi="24" he="22" />在O‑XYZ坐标系下的坐标为:<img file="dest_path_image030.GIF" wi="146" he="93" /><img file="dest_path_image032.GIF" wi="21" he="21" />为装备在无人机载体上的光学合作目标,<img file="497555dest_path_image032.GIF" wi="21" he="21" />在机载GPS坐标系下的坐标为<img file="dest_path_image034.GIF" wi="90" he="26" />,利用机载微惯导数据,计算出<img file="456153dest_path_image032.GIF" wi="21" he="21" />在以<img file="dest_path_image036.GIF" wi="17" he="19" />为坐标原点地平系下的坐标为:<img file="dest_path_image038.GIF" wi="554" he="83" />其中:<img file="dest_path_image040.GIF" wi="21" he="25" />——无人机载体滚动角;<img file="dest_path_image042.GIF" wi="22" he="21" />——无人机载体俯仰角;<img file="dest_path_image044.GIF" wi="27" he="26" />——无人机载体偏航角;在O‑XYZ坐标系下,某一时刻机载GPS天线相位中心的坐标分别为<img file="dest_path_image046.GIF" wi="98" he="26" />、<img file="dest_path_image048.GIF" wi="99" he="26" />,在O‑XYZ坐标系下两机载光学合作目标的坐标分别为:<img file="dest_path_image050.GIF" wi="146" he="88" /><img file="dest_path_image052.GIF" wi="152" he="88" />;在以<img file="593742dest_path_image002.GIF" wi="24" he="22" />为坐标原点的望远镜地平系<img file="dest_path_image054.GIF" wi="88" he="22" />下,两机载光学合作目标坐标分别为:<img file="dest_path_image056.GIF" wi="140" he="88" /><img file="dest_path_image058.GIF" wi="142" he="88" />;步骤三、光轴空间指向计算在地平系<img file="dest_path_image060.GIF" wi="89" he="22" />下,由两机载光学合作目标建立的单位观测矢量W1、W2分别为:<img file="dest_path_image062.GIF" wi="425" he="85" /><img file="dest_path_image064.GIF" wi="416" he="85" />其中,<img file="dest_path_image066.GIF" wi="41" he="22" />为视轴与探测器垂直,<img file="dest_path_image068.GIF" wi="45" he="26" />为方位脱靶量方向,<img file="dest_path_image070.GIF" wi="42" he="26" />为俯仰脱靶量方向,由两机载光学合作目标在探测器上像点的坐标分别为<img file="dest_path_image072.GIF" wi="85" he="35" />、<img file="dest_path_image074.GIF" wi="86" he="33" />,焦距为f,则在<img file="dest_path_image076.GIF" wi="98" he="26" />坐标系内,两光学合作目标对应单位参考矢量V1、V2分别为:<img file="dest_path_image078.GIF" wi="440" he="56" /><img file="dest_path_image080.GIF" wi="445" he="56" />单位观测矢量W和参考矢量V的关系为:<img file="dest_path_image082.GIF" wi="505" he="173" />令:<img file="dest_path_image084.GIF" wi="461" he="85" />其中:A——标校望远镜地平系下方位角;E——标校望远镜地平系下俯仰角;<img file="dest_path_image086.GIF" wi="18" he="17" />——标校望远镜地平系下像面旋转角;则有:<img file="dest_path_image088.GIF" wi="86" he="19" />对于上述获取的两个不平行的单位参考矢量V1和V2及相应的观测矢量为W1和W2,姿态矩阵K满足如下条件:<img file="dest_path_image090.GIF" wi="113" he="56" />通过如下方程构造参考矢量和观测矢量的标准三角阵:<img file="dest_path_image092.GIF" wi="121" he="115" /><img file="dest_path_image094.GIF" wi="130" he="115" />则姿态矩阵K为:<img file="dest_path_image096.GIF" wi="83" he="46" />其中:符号“T”表示矩阵转置;<img file="dest_path_image098.GIF" wi="14" he="22" />为3×1矩阵,<img file="dest_path_image100.GIF" wi="18" he="23" />为1×3矩阵;据此可得:<img file="dest_path_image102.GIF" wi="223" he="135" />其中,<img file="dest_path_image104.GIF" wi="154" he="48" />,式中:<img file="dest_path_image106.GIF" wi="104" he="48" />,I为3*3的单位矩阵;经纬仪主光学或外挂式光学观测系统光轴与标校望远镜光轴在经纬仪载体上的相对指向关系经过严格标定,分别为<img file="dest_path_image108.GIF" wi="103" he="25" />,则经纬仪光学观测系统的光轴在地平系下的指向与像面旋转分别为:<img file="dest_path_image110.GIF" wi="208" he="93" />其中:<img file="dest_path_image112.GIF" wi="26" he="27" />——主光学系统地平系下方位角;<img file="dest_path_image114.GIF" wi="22" he="27" />——主光学系统地平系下俯仰角;<img file="dest_path_image116.GIF" wi="22" he="22" />——主光学系统地平系下像面旋转角。
地址 214400 江苏省无锡市江阴市103信箱850号