CN115164937B - 一种基于车载惯组的双光路方位基准传递方法及装置 - Google Patents
一种基于车载惯组的双光路方位基准传递方法及装置 Download PDFInfo
- Publication number
- CN115164937B CN115164937B CN202210778415.6A CN202210778415A CN115164937B CN 115164937 B CN115164937 B CN 115164937B CN 202210778415 A CN202210778415 A CN 202210778415A CN 115164937 B CN115164937 B CN 115164937B
- Authority
- CN
- China
- Prior art keywords
- prism light
- angle
- prism
- light tube
- azimuth
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 28
- 230000005540 biological transmission Effects 0.000 title claims abstract description 18
- 238000005259 measurement Methods 0.000 title abstract 4
- 238000009434 installation Methods 0.000 claims abstract description 39
- 230000009466 transformation Effects 0.000 claims description 45
- 239000011159 matrix material Substances 0.000 claims description 41
- 230000003287 optical effect Effects 0.000 claims description 40
- 238000004364 calculation method Methods 0.000 claims description 24
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 4
- 238000012423 maintenance Methods 0.000 description 3
- 101001121408 Homo sapiens L-amino-acid oxidase Proteins 0.000 description 2
- 102100026388 L-amino-acid oxidase Human genes 0.000 description 2
- 101100012902 Saccharomyces cerevisiae (strain ATCC 204508 / S288c) FIG2 gene Proteins 0.000 description 2
- 101100233916 Saccharomyces cerevisiae (strain ATCC 204508 / S288c) KAR5 gene Proteins 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000014509 gene expression Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02A—TECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
- Y02A90/00—Technologies having an indirect contribution to adaptation to climate change
- Y02A90/30—Assessment of water resources
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manufacturing & Machinery (AREA)
- Navigation (AREA)
Abstract
本发明提供一种基于车载惯组的双光路方位基准传递方法及装置。所述方法包括:分别建立弹上棱镜光管坐标系g1和惯组棱镜光管坐标系g2,地理坐标系记为n系;获取惯组棱镜实时输出的方位角、棱线不水度,惯组棱镜光管实时输出的失准角、俯仰角,进而计算惯组棱镜光管的方位角、俯仰角和横滚角;计算从n系到g1系的方位角;获取弹上棱镜光管实时输出的失准角、俯仰角,计算弹上棱镜光管的方位角和俯仰角。本发明可实时将车载惯组方位基准向弹上传递,不受载车姿态变化影响;所述方位基准与车载惯组及弹上棱镜之间均通过光路进行传递,不损失精度,安装位置不受限制,可提高产品适用范围,提升武器的实战化水平。
Description
技术领域
本发明涉及惯组技术领域,具体涉及一种基于车载惯组的双光路方位基准传递方法及装置。
背景技术
为了突出实战化能力,实现无依托快速发射的性能要求,越来越多的武器系统采用车载惯组为武器系统提供方位基准,并将方位基准传递至弹上棱镜,为弹上惯组提供初始方位基准。
传统的基准传递方法是将光管与车载惯组固连,受车载惯组转位精度的影响,损失精度,同时限制车载惯组安装位置。此外,车载惯组拆装外壳后,需要重新标定光管与车载惯组之间的关系,增加了产品的维护成本。
为此,本发明提出一种双光路方位基准传递方法,车载惯组棱镜与弹上棱镜之间通过光路进行方位基准传递,直接与车载惯组棱镜准直,不损失精度;同时安装位置不受限制,可提高产品适用范围,降低产品的维护成本,提升武器的实战化水平。
发明内容
为了解决现有技术中存在的上述问题,本发明提供一种基于车载惯组的双光路方位基准传递方法及装置。
为了实现上述目的,本发明采用以下技术方案。
第一方面,本发明提供一种基于车载惯组的双光路方位基准传递方法,包括以下步骤:
分别建立弹上棱镜光管坐标系和惯组棱镜光管坐标系,分别记为g1系和g2系,地理坐标系记为n系;
获取惯组棱镜实时输出的方位角、棱线不水度,惯组棱镜光管实时输出的失准角、俯仰角,进而计算惯组棱镜光管的方位角、俯仰角和横滚角;
根据惯组棱镜光管的方位角、俯仰角和横滚角,计算从n系到g2系的变换矩阵以及并根据计算从n系到g1系的方位角,由标定好的惯组棱镜光管相对弹上棱镜光管的安装偏差角确定;
获取弹上棱镜光管实时输出的失准角、俯仰角,并根据从n系到g1系的方位角计算弹上棱镜光管的方位角和俯仰角。
进一步地,三个坐标系分别定义为:
n系:Xn轴正向为正东方向,Yn轴正向为正北方向,Zn轴正向为竖直向上方向;
g1系:Xg1轴垂直于弹上棱镜光管光轴出光方向,向右为正向,Yg1轴正向为弹上棱镜光管光轴出光方向,Zg1轴正向沿弹上棱镜光管光轴垂直方向向外,坐标系构成右手直角坐标系;
g2系:Xg2轴垂直于惯组棱镜光管光轴出光方向,向右为正向,Yg2轴正向为惯组棱镜光管光轴出光方向,Zg2轴正向沿惯组棱镜光管光轴垂直方向向外,坐标系构成右手直角坐标系;
从n系到g1系或g2系的坐标转换公式为:
式中,g为g1或g2,ψ、θ、γ分别为从n系到g1系或g2系的3个旋转角度,为从n系到g1系或g2系的变换矩阵。
更进一步地,惯组棱镜光管相对弹上棱镜光管的安装偏差角的标定方法包括:
将惯组棱镜光管和弹上棱镜光管固定在调平的基座上,将惯组棱镜光管的方位角Ψ2设置为0,测量此状态下惯组光管相对水平面的俯仰角θ2,将惯组棱镜光管相对于水平面的横滚角γ2设置为0;
测量此状态下弹上棱镜光管相对惯组棱镜光管的方位夹角,作为弹上棱镜光管的方位角Ψ1,测量此状态下弹上棱镜光管俯仰角θ1,将惯组棱镜光管相对于水平面的横滚角γ1设置为0;
将Ψ2、θ2、γ2代入(1)式得到从n系到g2系的变换矩阵将Ψ1、θ1、γ1代入(1)式得到从n系到g1系的变换矩阵计算从g2系的g1系的变换矩阵:
根据计算惯组棱镜光管相对弹上棱镜光管的安装偏差角即方位角Ψ0、俯仰角θ0、横滚角γ0。
更进一步地,根据计算安装偏差角Ψ0、θ0、γ0的方法包括:
将Ψ0、θ0、γ0代入(1)式得到用Ψ0、θ0、γ0表示的
令:
根据(1)式可得:
θ0=arcsinT32,γ0=arctan(-T31/T33)。
进一步地,惯组棱镜光管的方位角ψg2的计算公式为:
ψg2=αGZ+VGZ×tanθg2-Δα2
式中,αGZ、VGZ、θg2和Δα2分别为惯组棱镜实时输出的方位角、棱线不水度和惯组棱镜光管实时输出的俯仰角、失准角。
进一步地,弹上棱镜光管的方位角ψD的计算公式为:
ψD=ψg1+Δα1
式中,ψg1为n系到g1系的方位角,Δα1为失准角。
第二方面,本发明提供一种基于车载惯组的双光路方位基准传递装置,包括:
坐标系建立模块,用于分别建立弹上棱镜光管坐标系和惯组棱镜光管坐标系,分别记为g1系和g2系,地理坐标系记为n系;
第一计算模块,用于获取惯组棱镜实时输出的方位角、棱线不水度,惯组棱镜光管实时输出的失准角、俯仰角,进而计算惯组棱镜光管的方位角、俯仰角和横滚角;
第二计算模块,用于根据惯组棱镜光管的方位角、俯仰角和横滚角,计算从n系到g2系的变换矩阵以及并根据计算从n系到g1系的方位角,由标定好的惯组棱镜光管相对弹上棱镜光管的安装偏差角确定;
第三计算模块,用于获取弹上棱镜光管实时输出的失准角、俯仰角,并根据从n系到g1系的方位角计算弹上棱镜光管的方位角和俯仰角。
进一步地,三个坐标系分别定义为:
n系:Xn轴正向为正东方向,Yn轴正向为正北方向,Zn轴正向为竖直向上方向;
g1系:Xg1轴垂直于弹上棱镜光管光轴出光方向,向右为正向,Yg1轴正向为弹上棱镜光管光轴出光方向,Zg1轴正向沿弹上棱镜光管光轴垂直方向向外,坐标系构成右手直角坐标系;
g2系:Xg2轴垂直于惯组棱镜光管光轴出光方向,向右为正向,Yg2轴正向为惯组棱镜光管光轴出光方向,Zg2轴正向沿惯组棱镜光管光轴垂直方向向外,坐标系构成右手直角坐标系;
从n系到g1系或g2系的坐标转换公式为:
式中,g为g1或g2,ψ、θ、γ分别为从n系到g1系或g2系的3个旋转角度,为从n系到g1系或g2系的变换矩阵。
更进一步地,惯组棱镜光管相对弹上棱镜光管的安装偏差角的标定方法包括:
将惯组棱镜光管和弹上棱镜光管固定在调平的基座上,将惯组棱镜光管的方位角Ψ2设置为0,测量此状态下惯组光管相对水平面的俯仰角θ2,将惯组棱镜光管相对于水平面的横滚角γ2设置为0;
测量此状态下弹上棱镜光管相对惯组棱镜光管的方位夹角,作为弹上棱镜光管的方位角Ψ1,测量此状态下弹上棱镜光管俯仰角θ1,将惯组棱镜光管相对于水平面的横滚角γ1设置为0;
将Ψ2、θ2、γ2代入(1)式得到从n系到g2系的变换矩阵将Ψ1、θ1、γ1代入(1)式得到从n系到g1系的变换矩阵计算从g2系的g1系的变换矩阵:
根据计算惯组棱镜光管相对弹上棱镜光管的安装偏差角即方位角Ψ0、俯仰角θ0、横滚角γ0。
更进一步地,根据计算安装偏差角Ψ0、θ0、γ0的方法包括:
将Ψ0、θ0、γ0代入(1)式得到用Ψ0、θ0、γ0表示的
令:
根据(1)式可得:
θ0=arcsinT32,γ0=arctan(-T31/T33)。
进一步地,惯组棱镜光管的方位角ψg2的计算公式为:
ψg2=αGZ+VGZ×tanθg2-Δα2
式中,αGZ、VGZ、θg2和Δα2分别为惯组棱镜实时输出的方位角、棱线不水度和惯组棱镜光管实时输出的俯仰角、失准角。
进一步地,弹上棱镜光管的方位角ψD的计算公式为:
ψD=ψg1+Δα1
式中,ψg1为n系到g1系的方位角,Δα1为失准角。
与现有技术相比,本发明具有以下有益效果。
本发明通过建立弹上棱镜光管坐标系g1、惯组棱镜光管坐标系g2和地理坐标系n,获取惯组棱镜实时输出的方位角、棱线不水度,惯组棱镜光管实时输出的失准角、俯仰角,进而计算惯组棱镜光管的方位角、俯仰角和横滚角,并利用标定好的安装偏差角,计算从n系到g1系的方位角,最后基于弹上棱镜光管实时输出的失准角、俯仰角得到弹上棱镜光管的方位角和俯仰角,实现了双光路方位基准传递。本发明可实时将车载惯组方位基准向弹上传递,不受载车姿态变化影响;所述方位基准与车载惯组及弹上棱镜之间均通过光路进行传递,不损失精度,安装位置不受限制,可提高产品适用范围,降低产品的维护成本,提升武器的实战化水平。
附图说明
图1为本发明实施例一种基于车载惯组的双光路方位基准传递方法的流程图。
图2为弹上棱镜光管坐标系g1系和惯组棱镜光管坐标系g2系的示意图。
图3为本发明实施例一种基于车载惯组的双光路方位基准传递装置的方框图。
具体实施方式
为使本发明的目的、技术方案及优点更加清楚、明白,以下结合附图及具体实施方式对本发明作进一步说明。显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
图1为本发明实施例一种基于车载惯组的双光路方位基准传递方法的流程图,包括以下步骤:
步骤101,分别建立弹上棱镜光管坐标系和惯组棱镜光管坐标系,分别记为g1系和g2系,地理坐标系记为n系;
步骤102,获取惯组棱镜实时输出的方位角、棱线不水度,惯组棱镜光管实时输出的失准角、俯仰角,进而计算惯组棱镜光管的方位角、俯仰角和横滚角;
步骤103,根据惯组棱镜光管的方位角、俯仰角和横滚角,计算从n系到g2系的变换矩阵以及并根据计算从n系到g1系的方位角,由标定好的惯组棱镜光管相对弹上棱镜光管的安装偏差角确定;
步骤104,获取弹上棱镜光管实时输出的失准角、俯仰角,并根据从n系到g1系的方位角计算弹上棱镜光管的方位角和俯仰角。
本实施例中,步骤101主要用于建立空间直角坐标系。本实施例用到三种空间直角坐标系,一种是地理坐标系即n系,一种是弹上棱镜光管坐标系即g1系,一种是惯组棱镜光管坐标系即g2系。本实施例多次用到三种坐标系之间的变换关系,其中g1系和g2系的示意图如图2所示。图2也表明了惯组棱镜和弹上棱镜的位置关系。
本实施例中,步骤102主要用于获得惯组棱镜光管的方位角、俯仰角和横滚角。本实施例基于惯组棱镜实时输出的方位角、棱线不水度,以及惯组棱镜光管实时输出的失准角、俯仰角得到惯组棱镜光管的方位角、俯仰角和横滚角。棱线不水度就是棱线与水平面的夹角。失准角是棱镜相对于光管光轴的偏转角度,光管利用自准直原理测量失准角,光管发出平行光照射在棱镜上,根据返回光在光管CCD上的位置计算棱镜失准角。根据上述实时输出的各个角度之间的几何关系可以计算惯组棱镜光管的方位角,后面的实施例将给出一种具体的计算公式;惯组棱镜光管的俯仰角就是光管实时输出的俯仰角;惯组棱镜光管的横滚角设置为0。
本实施例中,步骤103主要用于计算从n系到g1系的方位角。首先,根据步骤102得到的惯组棱镜光管的方位角、俯仰角和横滚角,计算从n系到g2系的变换矩阵然后,根据g1系、g2系和n系之间的转换关系,计算从n系到g1系的变换矩阵由事先标定好的惯组棱镜光管相对弹上棱镜光管的安装偏差角确定。安装偏差角包含方位偏差角、俯仰偏差角和横滚偏差角,后面的实施例将给出标定安装偏差角的一种技术方案。标定好的安装偏差角保存在光管的FRAM存储器中,应用时从所述存储器中读出所述安装偏差角即可。最后,根据从n系到g1系的变换矩阵计算从n系到g1系的方位角,后面的实施例将给出根据变换矩阵计算对应的角度的一种技术方案。
本实施例中,步骤104主要用于计算弹上棱镜光管的方位角和俯仰角。本实施例基于弹上棱镜光管实时输出的失准角、俯仰角得到弹上棱镜光管的方位角和俯仰角。所述失准角是棱镜相对于光管光轴的偏转角度,根据所述失准角和步骤103得到的从n系到g1系的方位角,就可得到弹上棱镜光管的方位角,后面的实施例将给出弹上棱镜光管方位角的一种计算公式。弹上棱镜光管的的俯仰角就是其实时输出的俯仰角。
作为一可选实施例,三个坐标系分别定义为:
n系:Xn轴正向为正东方向,Yn轴正向为正北方向,Zn轴正向为竖直向上方向;
g1系:Xg1轴垂直于弹上棱镜光管光轴出光方向,向右为正向,Yg1轴正向为弹上棱镜光管光轴出光方向,Zg1轴正向沿弹上棱镜光管光轴垂直方向向外,坐标系构成右手直角坐标系;
g2系:Xg2轴垂直于惯组棱镜光管光轴出光方向,向右为正向,Yg2轴正向为惯组棱镜光管光轴出光方向,Zg2轴正向沿惯组棱镜光管光轴垂直方向向外,坐标系构成右手直角坐标系;
从n系到g1系或g2系的坐标转换公式为:
式中,g为g1或g2,ψ、θ、γ分别为从n系到g1系或g2系的3个旋转角度,为从n系到g1系或g2系的变换矩阵。
本实施例给出了三个坐标系(g1系、g2系、n系)的具体定义,即详细描述了每个坐标系的每个坐标轴的方向,具体如图2所示。还给出了从一个坐标系到另一个坐标系的变换矩阵,如(1)式所示。值得说明的是,变换矩阵 的表达式均如(1)式所示,只是其中角度的含义略有不同而已,且满足
作为一可选实施例,惯组棱镜光管相对弹上棱镜光管的安装偏差角的标定方法包括:
将惯组棱镜光管和弹上棱镜光管固定在调平的基座上,将惯组棱镜光管的方位角Ψ2设置为0,测量此状态下惯组光管相对水平面的俯仰角θ2,将惯组棱镜光管相对于水平面的横滚角γ2设置为0;
测量此状态下弹上棱镜光管相对惯组棱镜光管的方位夹角,作为弹上棱镜光管的方位角Ψ1,测量此状态下弹上棱镜光管俯仰角θ1,将惯组棱镜光管相对于水平面的横滚角γ1设置为0;
将Ψ2、θ2、γ2代入(1)式得到从n系到g2系的变换矩阵将Ψ1、θ1、γ1代入(1)式得到从n系到g1系的变换矩阵计算从g2系的g1系的变换矩阵:
根据计算惯组棱镜光管相对弹上棱镜光管的安装偏差角即方位角Ψ0、俯仰角θ0、横滚角γ0。
本实施例给出了标定安装偏差角的一种技术方案。本实施例将惯组棱镜光管和弹上棱镜光管固定在大致调平的基座上,进行安装偏差角的标定。首先,将惯组棱镜光管的方位角Ψ2设置为0,测量此状态下惯组光管的俯仰角θ2,并将惯组棱镜光管的横滚角γ2设置为0;测量此状态下弹上棱镜光管相对惯组棱镜光管的方位夹角,作为弹上棱镜光管的方位角Ψ1,测量弹上棱镜光管俯仰角θ1,并将横滚角γ1设置为0。然后,将Ψ2、θ2、γ2和Ψ1、θ1、γ1分别代入(1)式得到变换矩阵和并计算最后根据计算安装偏差角Ψ0、θ0、γ0。
更进一步地,根据计算安装偏差角Ψ0、θ0、γ0的方法包括:
将Ψ0、θ0、γ0代入(1)式得到用Ψ0、θ0、γ0表示的
令:
根据(1)式可得:
θ0=arcsinT32,γ0=arctan(-T31/T33)。
本实施例给出了根据计算安装偏差角Ψ0、θ0、γ0的一种技术方案。本实施例给出的计算方法并不只适合而是适合根据任何一种变换矩阵计算对应的角度的情况。先用Ψ0、θ0、γ0替换公式(1)矩阵中的Ψ、θ、γ,得到用Ψ0、θ0、γ0表示的然后用Tij(i,j=1,2,3)分别表示矩阵中的各个元素的值;最后通过求解矩阵中用Ψ0、θ0、γ0表示的元素与对应的Tij相等的方程就可以得到Ψ0、θ0、γ0。比如:根据T32=sinθ0,得θ0=arcsinT32。
作为一可选实施例,惯组棱镜光管的方位角ψg2的计算公式为:
ψg2=αGZ+VGZ×tanθg2-Δα2
式中,αGZ、VGZ、θg2和Δα2分别为惯组棱镜实时输出的方位角、棱线不水度和惯组棱镜光管实时输出的俯仰角、失准角。
本实施例给出了根据惯组棱镜实时输出的方位角αGZ、棱线不水度VGZ和惯组棱镜光管实时输出的俯仰角θg2、失准角Δα2,计算惯组棱镜光管的方位角的一种技术方案。根据上述角度的几何关系,很容易得到上面的计算公式,这里不再展开详细说明。
作为一可选实施例,弹上棱镜光管的方位角ψD的计算公式为:
ψD=ψg1+Δα1
式中,ψg1为n系到g1系的方位角,Δα1为失准角。
本实施例给出了根据n系到g1系的方位角ψg1和失准角Δα1计算弹上棱镜光管的方位角ψD的一种技术方案。根据上述角度的几何关系,很容易得到上面的计算公式,这里不再展开详细说明。
图3为本发明实施例一种基于车载惯组的双光路方位基准传递装置的组成示意图,所述装置包括:
坐标系建立模块11,用于分别建立弹上棱镜光管坐标系和惯组棱镜光管坐标系,分别记为g1系和g2系,地理坐标系记为n系;
第一计算模块12,用于获取惯组棱镜实时输出的方位角、棱线不水度,惯组棱镜光管实时输出的失准角、俯仰角,进而计算惯组棱镜光管的方位角、俯仰角和横滚角;
第二计算模块13,用于根据惯组棱镜光管的方位角、俯仰角和横滚角,计算从n系到g2系的变换矩阵以及并根据计算从n系到g1系的方位角,由标定好的惯组棱镜光管相对弹上棱镜光管的安装偏差角确定;
第三计算模块14,用于获取弹上棱镜光管实时输出的失准角、俯仰角,并根据从n系到g1系的方位角计算弹上棱镜光管的方位角和俯仰角。
本实施例的装置,可以用于执行图1所示方法实施例的技术方案,其实现原理和技术效果类似,此处不再赘述。后面的实施例也是如此,均不再展开说明。
作为一可选实施例,三个坐标系分别定义为:
n系:Xn轴正向为正东方向,Yn轴正向为正北方向,Zn轴正向为竖直向上方向;
g1系:Xg1轴垂直于弹上棱镜光管光轴出光方向,向右为正向,Yg1轴正向为弹上棱镜光管光轴出光方向,Zg1轴正向沿弹上棱镜光管光轴垂直方向向外,坐标系构成右手直角坐标系;
g2系:Xg2轴垂直于惯组棱镜光管光轴出光方向,向右为正向,Yg2轴正向为惯组棱镜光管光轴出光方向,Zg2轴正向沿惯组棱镜光管光轴垂直方向向外,坐标系构成右手直角坐标系;
从n系到g1系或g2系的坐标转换公式为:
式中,g为g1或g2,ψ、θ、γ分别为从n系到g1系或g2系的3个旋转角度,为从n系到g1系或g2系的变换矩阵。
作为一可选实施例,惯组棱镜光管相对弹上棱镜光管的安装偏差角的标定方法包括:
将惯组棱镜光管和弹上棱镜光管固定在调平的基座上,将惯组棱镜光管的方位角Ψ2设置为0,测量此状态下惯组光管相对水平面的俯仰角θ2,将惯组棱镜光管相对于水平面的横滚角γ2设置为0;
测量此状态下弹上棱镜光管相对惯组棱镜光管的方位夹角,作为弹上棱镜光管的方位角Ψ1,测量此状态下弹上棱镜光管俯仰角θ1,将惯组棱镜光管相对于水平面的横滚角γ1设置为0;
将Ψ2、θ2、γ2代入(1)式得到从n系到g2系的变换矩阵将Ψ1、θ1、γ1代入(1)式得到从n系到g1系的变换矩阵计算从g2系的g1系的变换矩阵:
根据计算惯组棱镜光管相对弹上棱镜光管的安装偏差角即方位角Ψ0、俯仰角θ0、横滚角γ0。
作为一可选实施例,根据计算安装偏差角Ψ0、θ0、γ0的方法包括:
将Ψ0、θ0、γ0代入(1)式得到用Ψ0、θ0、γ0表示的
令:
根据(1)式可得:
θ0=arcsinT32,γ0=arctan(-T31/T33)。
作为一可选实施例,惯组棱镜光管的方位角ψg2的计算公式为:
ψg2=αGZ+VGZ×tanθg2-Δα2
式中,αGZ、VGZ、θg2和Δα2分别为惯组棱镜实时输出的方位角、棱线不水度和惯组棱镜光管实时输出的俯仰角、失准角。
作为一可选实施例,弹上棱镜光管的方位角ψD的计算公式为:
ψD=ψg1+Δα1
式中,ψg1为n系到g1系的方位角,Δα1为失准角。
以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应以权利要求的保护范围为准。
Claims (6)
1.一种基于车载惯组的双光路方位基准传递方法,其特征在于,包括以下步骤:
分别建立弹上棱镜光管坐标系和惯组棱镜光管坐标系,分别记为g1系和g2系,地理坐标系记为n系;
获取惯组棱镜实时输出的方位角、棱线不水度,惯组棱镜光管实时输出的失准角、俯仰角,进而计算惯组棱镜光管的方位角、俯仰角和横滚角;
根据惯组棱镜光管的方位角、俯仰角和横滚角,计算从n系到g2系的变换矩阵以及并根据计算从n系到g1系的方位角,由标定好的惯组棱镜光管相对弹上棱镜光管的安装偏差角确定;
获取弹上棱镜光管实时输出的失准角、俯仰角,并根据从n系到g1系的方位角计算弹上棱镜光管的方位角和俯仰角;
三个坐标系分别定义为:
n系:Xn轴正向为正东方向,Yn轴正向为正北方向,Zn轴正向为竖直向上方向;
g1系:Xg1轴垂直于弹上棱镜光管光轴出光方向,向右为正向,Yg1轴正向为弹上棱镜光管光轴出光方向,Zg1轴正向沿弹上棱镜光管光轴垂直方向向外,坐标系构成右手直角坐标系;
g2系:Xg2轴垂直于惯组棱镜光管光轴出光方向,向右为正向,Yg2轴正向为惯组棱镜光管光轴出光方向,Zg2轴正向沿惯组棱镜光管光轴垂直方向向外,坐标系构成右手直角坐标系;
从n系到g1系或g2系的坐标转换公式为:
式中,g为g1或g2,ψ、θ、γ分别为从n系到g1系或g2系的3个旋转角度,为从n系到g1系或g2系的变换矩阵;
惯组棱镜光管相对弹上棱镜光管的安装偏差角的标定方法包括:
将惯组棱镜光管和弹上棱镜光管固定在调平的基座上,将惯组棱镜光管的方位角Ψ2设置为0,测量此状态下惯组光管相对水平面的俯仰角θ2,将惯组棱镜光管相对于水平面的横滚角γ2设置为0;
测量此状态下弹上棱镜光管相对惯组棱镜光管的方位夹角,作为弹上棱镜光管的方位角Ψ1,测量此状态下弹上棱镜光管俯仰角θ1,将惯组棱镜光管相对于水平面的横滚角γ1设置为0;
将Ψ2、θ2、γ2代入(1)式得到从n系到g2系的变换矩阵将Ψ1、θ1、γ1代入(1)式得到从n系到g1系的变换矩阵计算从g2系的g1系的变换矩阵:
根据计算惯组棱镜光管相对弹上棱镜光管的安装偏差角即方位角Ψ0、俯仰角θ0、横滚角γ0。
2.根据权利要求1所述的基于车载惯组的双光路方位基准传递方法,其特征在于,根据计算安装偏差角Ψ0、θ0、γ0的方法包括:
将Ψ0、θ0、γ0代入(1)式得到用Ψ0、θ0、γ0表示的
令:
根据(1)式可得:
θ0=arcsinT32,γ0=arctan(-T31/T33)。
3.根据权利要求1所述的基于车载惯组的双光路方位基准传递方法,其特征在于,惯组棱镜光管的方位角ψg2的计算公式为:
ψg2=αGZ+VGZ×tanθg2-Δα2
式中,αGZ、VGZ、θg2和Δα2分别为惯组棱镜实时输出的方位角、棱线不水度和惯组棱镜光管实时输出的俯仰角、失准角。
4.根据权利要求1所述的基于车载惯组的双光路方位基准传递方法,其特征在于,弹上棱镜光管的方位角ψD的计算公式为:
ψD=ψg1+Δα1
式中,ψg1为n系到g1系的方位角,Δα1为失准角。
5.一种基于车载惯组的双光路方位基准传递装置,其特征在于,包括:
坐标系建立模块,用于分别建立弹上棱镜光管坐标系和惯组棱镜光管坐标系,分别记为g1系和g2系,地理坐标系记为n系;
第一计算模块,用于获取惯组棱镜实时输出的方位角、棱线不水度,惯组棱镜光管实时输出的失准角、俯仰角,进而计算惯组棱镜光管的方位角、俯仰角和横滚角;
第二计算模块,用于根据惯组棱镜光管的方位角、俯仰角和横滚角,计算从n系到g2系的变换矩阵以及并根据计算从n系到g1系的方位角,由标定好的惯组棱镜光管相对弹上棱镜光管的安装偏差角确定;
第三计算模块,用于获取弹上棱镜光管实时输出的失准角、俯仰角,并根据从n系到g1系的方位角计算弹上棱镜光管的方位角和俯仰角;
三个坐标系分别定义为:
n系:Xn轴正向为正东方向,Yn轴正向为正北方向,Zn轴正向为竖直向上方向;
g1系:Xg1轴垂直于弹上棱镜光管光轴出光方向,向右为正向,Yg1轴正向为弹上棱镜光管光轴出光方向,Zg1轴正向沿弹上棱镜光管光轴垂直方向向外,坐标系构成右手直角坐标系;
g2系:Xg2轴垂直于惯组棱镜光管光轴出光方向,向右为正向,Yg2轴正向为惯组棱镜光管光轴出光方向,Zg2轴正向沿惯组棱镜光管光轴垂直方向向外,坐标系构成右手直角坐标系;
从n系到g1系或g2系的坐标转换公式为:
式中,g为g1或g2,ψ、θ、γ分别为从n系到g1系或g2系的3个旋转角度,为从n系到g1系或g2系的变换矩阵;
惯组棱镜光管相对弹上棱镜光管的安装偏差角的标定方法包括:
将惯组棱镜光管和弹上棱镜光管固定在调平的基座上,将惯组棱镜光管的方位角Ψ2设置为0,测量此状态下惯组光管相对水平面的俯仰角θ2,将惯组棱镜光管相对于水平面的横滚角γ2设置为0;
测量此状态下弹上棱镜光管相对惯组棱镜光管的方位夹角,作为弹上棱镜光管的方位角Ψ1,测量此状态下弹上棱镜光管俯仰角θ1,将惯组棱镜光管相对于水平面的横滚角γ1设置为0;
将Ψ2、θ2、γ2代入(1)式得到从n系到g2系的变换矩阵将Ψ1、θ1、γ1代入(1)式得到从n系到g1系的变换矩阵计算从g2系的g1系的变换矩阵:
根据计算惯组棱镜光管相对弹上棱镜光管的安装偏差角即方位角Ψ0、俯仰角θ0、横滚角γ0。
6.根据权利要求5所述的基于车载惯组的双光路方位基准传递装置,其特征在于,根据计算安装偏差角Ψ0、θ0、γ0的方法包括:
将Ψ0、θ0、γ0代入(1)式得到用Ψ0、θ0、γ0表示的
令:
根据(1)式可得:
θ0=arcsinT32,γ0=arctan(-T31/T33)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210778415.6A CN115164937B (zh) | 2022-07-04 | 2022-07-04 | 一种基于车载惯组的双光路方位基准传递方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210778415.6A CN115164937B (zh) | 2022-07-04 | 2022-07-04 | 一种基于车载惯组的双光路方位基准传递方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115164937A CN115164937A (zh) | 2022-10-11 |
CN115164937B true CN115164937B (zh) | 2024-09-13 |
Family
ID=83491834
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210778415.6A Active CN115164937B (zh) | 2022-07-04 | 2022-07-04 | 一种基于车载惯组的双光路方位基准传递方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115164937B (zh) |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111141282A (zh) * | 2020-01-09 | 2020-05-12 | 北京航天发射技术研究所 | 基于龙芯处理器定瞄计算机的定位瞄准控制方法及装置 |
CN113295049A (zh) * | 2021-04-21 | 2021-08-24 | 北京航天发射技术研究所 | 一种运载火箭瞄准方法及装置 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2436043C1 (ru) * | 2010-07-08 | 2011-12-10 | Открытое акционерное общество "Завод им. В.А. Дегтярева" | Способ согласования осей инерциальной навигационной системы с осью наземного транспортного средства и измерительный комплекс для его осуществления |
-
2022
- 2022-07-04 CN CN202210778415.6A patent/CN115164937B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111141282A (zh) * | 2020-01-09 | 2020-05-12 | 北京航天发射技术研究所 | 基于龙芯处理器定瞄计算机的定位瞄准控制方法及装置 |
CN113295049A (zh) * | 2021-04-21 | 2021-08-24 | 北京航天发射技术研究所 | 一种运载火箭瞄准方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN115164937A (zh) | 2022-10-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107144273B (zh) | 基于倾角传感的室内测量定位系统基站姿态自动补偿方法 | |
CN107782293B (zh) | 基于六自由度激光跟踪靶的航天器设备位姿信息测量方法 | |
CN108413988B (zh) | 机器人末端经纬仪坐标系快速标定方法 | |
CN102032918B (zh) | 三探头星敏指向标定方法 | |
CN110849338B (zh) | 一种控制网测量方法 | |
CN102538825B (zh) | 一种星敏感器探头组合体光轴指向标定方法 | |
CN113295049B (zh) | 一种运载火箭瞄准方法及装置 | |
CN105973268B (zh) | 一种基于共基座安装的传递对准精度定量评估方法 | |
CN110672128B (zh) | 一种星光/惯性组合导航及误差在线标定方法 | |
CN107765279B (zh) | 一种融合惯性、卫星的车载定位定向瞄准系统及瞄准方法 | |
CN113281797B (zh) | 一种基于惯性导航的机动侦校雷达系统 | |
CN103884334A (zh) | 基于宽波束激光测距和单摄像机的运动目标定位方法 | |
CN104880205A (zh) | 非正交轴系激光经纬仪测量系统标定方法 | |
CN111141282B (zh) | 基于龙芯处理器定瞄计算机的定位瞄准控制方法及装置 | |
CN115164937B (zh) | 一种基于车载惯组的双光路方位基准传递方法及装置 | |
CN102207380A (zh) | 一种高精度横轴倾斜误差补偿方法 | |
CN105627916B (zh) | 一种建立跟踪仪地理坐标系及六自由度测量的方法 | |
CN101441065A (zh) | 微小位移变形高精度、非接触式测量系统及测量方法 | |
CN110736452B (zh) | 一种应用于控制测量领域的导线测量方法及系统 | |
CN104535078A (zh) | 一种基于标志点的光电设备对飞行目标的测量方法 | |
CN105115478A (zh) | 机动经纬仪基座平台晃动测量与修正方法 | |
CN101858712B (zh) | 一种应用于飞机总装配的航炮数字化校靶方法 | |
CN102155956B (zh) | 一种高精度垂直角横轴倾斜误差补偿方法 | |
CN110455277B (zh) | 基于物联网数据融合的高精度姿态测量装置与方法 | |
CN114739424B (zh) | 一种瞄准系统安装误差标定装置及方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |