CN106767930B - 一种捷联惯导与对准棱镜安装偏角测量方法 - Google Patents
一种捷联惯导与对准棱镜安装偏角测量方法 Download PDFInfo
- Publication number
- CN106767930B CN106767930B CN201710052003.3A CN201710052003A CN106767930B CN 106767930 B CN106767930 B CN 106767930B CN 201710052003 A CN201710052003 A CN 201710052003A CN 106767930 B CN106767930 B CN 106767930B
- Authority
- CN
- China
- Prior art keywords
- prism
- inertial navigation
- coordinate system
- strapdown inertial
- alignment
- 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
Images
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
Landscapes
- Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Navigation (AREA)
Abstract
本发明提出了一种捷联惯导与对准棱镜安装偏角测量方法，硬件设施包括：双轴转台、捷联惯导、对准棱镜、自准直经纬仪、主控计算机、显示器及键盘等组成。方法是通过两次旋转双轴转台改变捷联惯导台体对准棱镜、自准直经纬仪准直的位置，主控计算机二次记录自准直经纬仪CCD失准角读数和水平盘读数β、双轴转台内外框码盘读数α以及捷联惯导输出参数，通过解算得出捷联惯导初始对准瞄准棱镜改为竖直安装后对准棱镜与惯导之间的安装偏差。
Description
技术领域
本发明属捷联惯导系统精确制导初始对准检测补偿技术领域，具体涉及一种捷联惯导与对准棱镜安装偏角测量方法。
背景技术
目前，捷联惯导初始对准瞄准棱镜通常为水平安装，但为了实现飞行器水平初始方位精确对准，起竖即刻发射，需将捷联惯导初始对准瞄准棱镜改为竖直安装，这样初始对准棱镜与捷联惯导之间的安装角关系发生了变化，必然会引起初始对准棱镜坐标系与捷联惯导坐标系安装偏差角测量方法发生变化。实际安装过程中很难做到捷联惯导坐标系与对准棱镜坐标系绝对重合，均会存在一定安装偏角，若安装偏角不精确测量进行软补偿，则飞行器将会存在固定对准偏角，使其偏离预定轨道，在此背景下提出了一套拟利用惯导对准棱镜反射面法矢量与自准直经纬仪的激光准直矢量相等的技术，解算出对准棱镜与惯导之间的安装偏差。
发明内容
本发明的目的是提出一种捷联惯导与对准棱镜安装偏角测量方法，可以测量、解算捷联惯导初始对准瞄准棱镜改为竖直安装后对准棱镜与惯导之间的安装偏差。
实现本发明的技术解决方案如下：一种捷联惯导与对准棱镜安装偏角测量的硬件设施包括：高精度双轴自动控制转台(以下简称：双轴转台)、捷联惯导台体(含捷联惯导、对准棱镜)、棱镜标校自准直经纬仪(以下简称：自准直经纬仪)、主控计算机、显示器及键盘等组成。测量方法是：
(1)将捷联惯导台体(含捷联惯导、对准棱镜)固定在双轴转台上，测量系统通电开始测量工作。
(2)旋转双轴转台至捷联惯导台体对准棱镜、自准直经纬仪准直位置O处，主控计算机记录自准直经纬仪CCD失准角读数和水平盘读数β、双轴转台内外框码盘读数α以及捷联惯导输出参数。
(3)再次旋转双轴转台，自准直经纬仪准直至位置P处，主控计算机记录自准直经纬仪CCD失准角读数和水平盘读数β、双轴转台内外框码盘读数α以及捷联惯导输出参数。
(4)建立矢量相等的对应坐标关系，主控计算机执行程序解算捷联惯导与对准棱镜安装偏角，步骤如下：
a)棱镜-惯导-转台坐标矢量关系
令双轴转台坐标系为Nt，其初始位置坐标系为Nt0；捷联惯导坐标系为Ni，其初始安装位置坐标系为Ni0；对准棱镜坐标系为Nm，其初始位置坐标系为Nm0，对准棱镜镜面反射面法矢量在对准棱镜坐标系下为
假设对准棱镜坐标系与捷联惯导坐标系的安装偏差角矩阵为
捷联惯导在双轴转台上的初始安装误差矩阵为
则双轴转台转动过程中，对准棱镜镜面反射面法矢量在高精度双轴自动控制转台初始位置坐标系中可表示为：
b)经纬仪自准直坐标矢量关系
令捷联惯导棱镜自准直经纬仪坐标系为Ne，其初始位置坐标系为Ne0，棱镜准直坐标系下的激光准直矢量
假设自准直经纬仪坐标系到其初始位置坐标系的转换矩阵为
自准直经纬仪初始位置坐标系到双轴转台初始位置坐标系的误差矩阵为
则自准直经纬仪激光准直矢量到双轴转台初始位置坐标系中可表示为：
自准直经纬仪与捷联惯导对准棱镜两次准直后，得到方程组如下：
由于
那么：
误差矩阵
的欧拉角形式如下：
小角处理后为：
去掉高阶项后为：
其中欧拉角
θ、γ分别为绕Z轴、X轴的和Y轴的旋转角。
c)定义坐标系统一，令误差矩阵
的欧拉角分别为绕X轴的ηi、ηm，绕Z轴的ζi、ζ，绕Y轴的-θi、-θm，并去掉高阶项后，由式(3)、(4)可得：
其中：Δα、Δβ分别为瞄准设备两次瞄准时的垂直和水平方向的两个测量角的差值，f(Δβ)为AOO′平面内的安装误差角解算用角，理想状态下f(Δβ)＝Δβ，且ηi、θi、ζi可通过捷联惯导数据标定解算出来，因此只要两次棱镜准直可解算棱镜的安装偏差角ζ和ηm。
而实际棱镜两次准直时，双轴转台的外框需旋转λ＝90°或λ＝-90°，令两次准直内框转角分别为ψ、ψ1，则式(8)变为：
-(ζi+ζ)2(sinψsinψ1+sin2λcosψcosψ1)+...
(ζi+ζ)(1+sin2λ)(cosψsinψ1-sinψcosψ1)+...
cosψcosψ1+sin2λ(sinψsinψ1-(ηi+ηm)2)-cos(f(Δβ))cos(Δα)＝0 (9)
式(9)去掉高阶项，简化后可得捷联惯导与对准棱镜安装偏角ζ：
本发明与现有技术相比，其显著优点是：方法简便，实现简单，测量精度高。
附图说明
图1是本发明捷联惯导与对准棱镜安装偏角测量流程示意图
图2是本发明捷联惯导与对准棱镜安装偏角测量结构原理图
图3是本发明双轴转台、惯导对准棱镜与自准直经纬仪角度对应关系示意图
具体实施方式
下面通过借助实施例更加详细地说明本发明，但以下实施例仅是说明性的，本发明的保护范围并不受实施例的限制。
如图1、图2、图3所示：一种捷联惯导与对准棱镜安装偏角测量的硬件设施包括：捷联惯导(1)，对准棱镜(2)，双轴转台(3)，自准直经纬仪(4)和主控计算机、显示器及键盘等组成。测量方法是：
(1)将捷联惯导(1)、对准棱镜(2)固定在双轴转台(3)上，测量系统通电开始测量工作。
(2)主控计算机发指令给双轴转台(3)旋转外框铅垂、内框至对准棱镜(2)、自准直经纬仪(4)准直位置1(或右)处，主控计算机记录自准直经纬仪(4)发回CCD失准角读数ε1和水平盘读数β1、双轴转台(3)内框码盘读数Ψ1以及捷联惯导输出。
自准直经纬仪(4)CCD失准角读数ε1为：0°0′2″；
自准直经纬仪(4)水平盘读数β1为：321°53′26″；
双轴转台(3)内框码盘读数Ψ1为：79°0′1″。
(3)主控计算机发指令给双轴转台(3)旋转外框180°向下铅垂、内框至对准棱镜(2)、自准直经纬仪(4)准直位置2(或左)处，主控计算机记录自准直经纬仪(4)发回CCD失准角读数ε2和水平盘读数β2、双轴转台(3)码盘读数Ψ2以及捷联惯导输出。
自准直经纬仪(4)CCD失准角读数ε2为：0°0′4″；
自准直经纬仪(4)水平盘读数β2为：299°53′18″；
双轴转台(3)内框码盘读数Ψ2为：303°0′2″。
(4)建立矢量相等的对应坐标关系，主控计算机执行程序解算捷联惯导(1)与对准棱镜(2)安装偏角，步骤如下：
a)棱镜-惯导-转台坐标矢量关系
令双轴转台(3)坐标系为Nt，其初始位置坐标系为Nt0；捷联惯导(1)坐标系为Ni，其初始安装位置坐标系为Ni0；对准棱镜(2)坐标系为Nm，其初始位置坐标系为Nm0，对准棱镜(2)镜面反射面法矢量在对准棱镜(2)坐标系下为
假设对准棱镜(2)坐标系与捷联惯导(1)坐标系的安装偏差角矩阵为
捷联惯导(1)在双轴转台(3)上的初始安装误差矩阵为
则双轴转台(3)转动过程中，对准棱镜(3)镜面反射面法矢量在双轴转台(3)初始位置坐标系中可表示为：
b)经纬仪自准直坐标矢量关系
令自准直经纬仪(4)坐标系为Ne，其初始位置坐标系为Ne0，准直坐标系下的准直矢量
假设自准直经纬仪(4)坐标系到其初始位置坐标系的转换矩阵为
自准直经纬仪(4)初始位置坐标系到双轴转台(3)初始位置坐标系的误差矩阵为
则自准直经纬仪(4)准直矢量到双轴转台(3)初始位置坐标系中可表示为：
自准直经纬仪(4)与捷联惯导对准棱镜(2)两次准直后，得到方程组如下：
由于
那么：
误差矩阵
的欧拉角形式如下：
小角处理后为：
去掉高阶项后为：
其中欧拉角
θ、γ分别为绕Z轴、X轴的和Y轴的旋转角。
c)定义坐标系统一，令误差矩阵
的欧拉角分别为绕X轴的ηi、ηm，绕Z轴的ζi、ζ，绕Y轴的-θi、-θm，并去掉高阶项后，由式(3)、(4)可得：
其中：Δα、Δβ分别为自准直经纬仪(4)两次惯导对准棱镜(2)准直时的垂直和水平方向的两个测量角的差值，可见Δα近似为零f(Δβ)，则cosΔα近似为1；Δβ＝β2+ε2-β1-ε1，且ηi、θi、ζi可通过捷联惯导(1)数据标定解算出来，因此通过惯导对准棱镜(2)与自准直经纬仪(4)两次准直即可解算出捷联惯导(1)与对准棱镜(2)的安装偏差角ζ和ηm。
而实际惯导对准棱镜(2)与自准直经纬仪(4)两次准直时，双轴转台(3)外框需旋转λ＝90°或λ＝-90°，令两次准直双轴转台(3)内框转角分别为ψ、ψ1，则式(8)变为：
式(9)去掉高阶项、忽略小项，简化后可得捷联惯导(1)与对准棱镜(2)安装偏角
考虑双轴转台(3)轴系旋转，内框码盘实际读数Ψ2为：
ψ2＝303°0′2″-180°＝123°0′2″
ψ1+ψ2＝79°0′1″+123°0′2″＝202°0′3″
Δβ＝β2+ε2-β1-ε1＝299°53′18″+0°0′4″-321°53′26″-0°0′2″＝-22°0′2″
则捷联惯导(1)与对准棱镜(2)安装偏角为0.5″。
本发明不仅局限于上述具体实施方式，本领域一般技术人员根据本发明公开的内容，可以采用其它多种具体实施方式实施本发明，因此，凡是采用本发明的方法，做一些简单的变化或更改的设计，都落入本发明保护的范围。
Claims (1)
1.一种捷联惯导与对准棱镜安装偏角测量方法，测量的硬件设施包括：高精度双轴自动控制转台、捷联惯导台体、棱镜标校自准直经纬仪、主控计算机、显示器及键盘，其中：捷联惯导台体包含捷联惯导及对准棱镜，测量方法是：
(1)将捷联惯导台体固定在高精度双轴自动控制转台上，测量系统通电开始测量工作；
(2)旋转高精度双轴自动控制转台至捷联惯导台体对准棱镜、棱镜标校自准直经纬仪准直至位置O处，主控计算机记录棱镜标校自准直经纬仪CCD失准角读数和水平盘读数β、高精度双轴自动控制转台内外框码盘读数α以及捷联惯导输出参数；
(3)再次旋转高精度双轴自动控制转台，棱镜标校自准直经纬仪准直至位置P处，主控计算机记录棱镜标校自准直经纬仪CCD失准角读数和水平盘读数β、高精度双轴自动控制转台内外框码盘读数α以及捷联惯导输出参数；
(4)建立矢量相等的对应坐标关系，主控计算机执行程序解算捷联惯导与对准棱镜安装偏角，步骤如下：
a)棱镜-惯导-转台坐标矢量关系
令高精度双轴自动控制转台坐标系为Nt，其初始位置坐标系为Nt0；捷联惯导坐标系为Ni，其初始安装位置坐标系为Ni0；对准棱镜坐标系为Nm，其初始位置坐标系为Nm0，对准棱镜镜面反射面法矢量在对准棱镜坐标系下为
假设对准棱镜坐标系与捷联惯导坐标系的安装偏差角矩阵为
捷联惯导在高精度双轴自动控制转台上的初始安装误差矩阵为
则高精度双轴自动控制转台转动过程中，对准棱镜镜面反射面法矢量在高精度双轴自动控制转台初始位置坐标系中可表示为：
b)经纬仪自准直坐标矢量关系
令棱镜标校自准直经纬仪坐标系为Ne，其初始位置坐标系为Ne0，棱镜准直坐标系下的激光准直矢量
假设棱镜标校自准直经纬仪坐标系到其初始位置坐标系的转换矩阵为
棱镜标校自准直经纬仪初始位置坐标系到高精度双轴自动控制转台初始位置坐标系的误差矩阵为
则棱镜标校自准直经纬仪激光准直矢量到高精度双轴自动控制转台初始位置坐标系中可表示为：
棱镜标校自准直经纬仪与捷联惯导对准棱镜两次准直后，得到方程组如下：
由于
那么：
误差矩阵
的欧拉角形式如下：
小角处理后为：
去掉高阶项后为：
其中欧拉角
θ、γ分别为绕Z轴、X轴的和Y轴的旋转角；
c)令误差矩阵
的欧拉角分别为绕X轴的ηi、ηm，绕Z轴的ζi、ζ，绕Y轴的-θi、-θm，并去掉高阶项后，由式(3)、(4)可得：
其中Δα、Δβ分别为瞄准设备两次瞄准时的垂直和水平方向的两个测量角的差值，f(Δβ)为AOO′平面内的安装误差角解算用角，理想状态下f(Δβ)＝Δβ，且ηi、θi、ζi可通过捷联惯导数据标定解算出来，因此只要两次棱镜准直可解算ζ和ηm；
而实际棱镜两次准直时，高精度双轴自动控制转台的外框需旋转λ＝90□或λ＝-90□，令两次准直内框转角分别为ψ、ψ1，则式(8)变为：
-(ζi+ζ)2(sinψsinψ1+sin2λcosψcosψ1)+...
(ζi+ζ)(1+sin2λ)(cosψsinψ1-sinψcosψ1)+...
cosψcosψ1+sin2λ(sinψsinψ1-(ηi+ηm)2)-cos(f(Δβ))cos(Δα)＝0 (9)
式(9)去掉高阶项，简化后：可得ζ，
ζ即为捷联惯导与对准棱镜安装偏角。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710052003.3A CN106767930B (zh) | 2017-01-22 | 2017-01-22 | 一种捷联惯导与对准棱镜安装偏角测量方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710052003.3A CN106767930B (zh) | 2017-01-22 | 2017-01-22 | 一种捷联惯导与对准棱镜安装偏角测量方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN106767930A CN106767930A (zh) | 2017-05-31 |
| CN106767930B true CN106767930B (zh) | 2020-06-05 |
Family
ID=58941525
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201710052003.3A Active CN106767930B (zh) | 2017-01-22 | 2017-01-22 | 一种捷联惯导与对准棱镜安装偏角测量方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN106767930B (zh) |
Families Citing this family (14)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108020243B (zh) * | 2017-12-06 | 2021-02-09 | 北京航天计量测试技术研究所 | 一种基于载体滚转的棱镜安装参数标定方法 |
| CN108759762B (zh) * | 2018-08-02 | 2023-10-03 | 中国工程物理研究院机械制造工艺研究所 | 一种内外双轴式自校准转台及使用方法 |
| CN109459054B (zh) * | 2018-10-25 | 2022-07-26 | 北京航天计量测试技术研究所 | 一种基于自准直跟踪的动基座姿态校准方法 |
| CN109470265B (zh) * | 2018-10-31 | 2020-11-06 | 湖北航天技术研究院总体设计所 | 一种惯导棱镜高度差标校方法及系统 |
| CN109470277B (zh) * | 2018-12-26 | 2022-09-13 | 湖南航天机电设备与特种材料研究所 | 非正交角度测量装置标定系数的测定方法及系统 |
| CN110006446B (zh) * | 2019-03-21 | 2021-05-14 | 湖北三江航天红峰控制有限公司 | 一种基于棱镜的惯组输出标校方法 |
| CN110940354B (zh) * | 2019-12-02 | 2021-12-14 | 湖北航天技术研究院总体设计所 | 一种光电跟踪系统捷联惯导安装姿态的标定方法 |
| CN111521198B (zh) * | 2020-04-30 | 2021-09-28 | 湖北三江航天万峰科技发展有限公司 | 一种基于外瞄磁性直角棱镜传递对准的方法 |
| CN112146681B (zh) * | 2020-09-12 | 2023-03-10 | 中国运载火箭技术研究院 | 惯组棱镜安装误差检验方法、装置及计算机存储介质 |
| CN112461071B (zh) * | 2020-11-20 | 2023-12-01 | 中国人民解放军63698部队 | 一种惯导设备重复安装误差的测量方法 |
| CN112857400B (zh) * | 2021-01-22 | 2022-12-27 | 上海航天控制技术研究所 | 一种基于十表冗余捷联惯组的运载火箭初始对准方法 |
| CN113624252B (zh) * | 2021-06-30 | 2023-09-12 | 北京自动化控制设备研究所 | 惯导棱镜方位安装偏差标定方法及惯性导航系统 |
| CN115200613B (zh) * | 2022-09-14 | 2022-12-09 | 中国船舶重工集团公司第七0七研究所 | 一种惯导系统的四棱台式台体陀螺安装面精度测试方法 |
| CN115790590B (zh) * | 2023-02-09 | 2023-05-23 | 西安航天精密机电研究所 | 可动态调整的高精度惯导及直角棱镜系统及其调整方法 |
-
2017
- 2017-01-22 CN CN201710052003.3A patent/CN106767930B/zh active Active
Also Published As
| Publication number | Publication date |
|---|---|
| CN106767930A (zh) | 2017-05-31 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN106767930B (zh) | 一种捷联惯导与对准棱镜安装偏角测量方法 | |
| CN105910624B (zh) | 一种惯组光学瞄准棱镜安装误差的标定方法 | |
| CN100565115C (zh) | 多位置捷联寻北系统方位效应的标定方法 | |
| CN102914260B (zh) | 基于光电式两轴准直仪的转台分度误差检测方法 | |
| CN103743413B (zh) | 倾斜状态下调制寻北仪安装误差在线估计与寻北误差补偿方法 | |
| CN110285816B (zh) | 一种小卫星星上设备高精度姿态测量系统及方法 | |
| CN114111753B (zh) | 一种光纤陀螺寻北仪 | |
| CN109631952B (zh) | 航天器用光学陀螺组件姿态基准镜安装误差标定方法 | |
| CN106855419B (zh) | 基于加速度计坐标系的直角棱镜标定测试方法 | |
| US20140202012A1 (en) | Geodetic device and a method for determining a characteristic of the device | |
| CN105241478A (zh) | 一种单轴调制激光陀螺惯性导航系统多坐标系标定方法 | |
| CN111551164B (zh) | 速率偏频激光陀螺寻北仪航向效应误差的补偿方法 | |
| JP2004029018A (ja) | 角度誤差規定方法及び該方法に用いる装置 | |
| CN111707229B (zh) | 一种定位定向设备的直角棱镜俯仰和方位角测量调节方法 | |
| CN110895149B (zh) | 局部基准传递对准精度内场测试系统及测试方法 | |
| Luo et al. | Rotating shaft tilt angle measurement using an inclinometer | |
| CN109798915A (zh) | 一种定向准直仪系统的误差标定方法 | |
| RU2347192C1 (ru) | Способ и устройство определения курса объекта | |
| CN216483089U (zh) | 一种光纤陀螺寻北仪 | |
| CN104792339B (zh) | 光纤陀螺测斜仪的校准方法 | |
| CN105928542A (zh) | 一种卫星的制造方法 | |
| CN110954131A (zh) | 一种光纤陀螺输入轴失准角标定工装 | |
| CN113899324A (zh) | 基于单轴激光陀螺测角仪的多轴转台垂直度误差检测方法 | |
| CN111220180B (zh) | 一种陀螺全站仪定向精度测试方法 | |
| CN108168516B (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 |