CN105043418B - 一种适用于船载动中通的惯导***快速初始粗对准方法 - Google Patents
一种适用于船载动中通的惯导***快速初始粗对准方法 Download PDFInfo
- Publication number
- CN105043418B CN105043418B CN201510472371.4A CN201510472371A CN105043418B CN 105043418 B CN105043418 B CN 105043418B CN 201510472371 A CN201510472371 A CN 201510472371A CN 105043418 B CN105043418 B CN 105043418B
- Authority
- CN
- China
- Prior art keywords
- inertial navigation
- navigation system
- carrier
- coordinate system
- motion
- 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
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)
- Radio Relay Systems (AREA)
- Mobile Radio Communication Systems (AREA)
Abstract
一种适用于船载动中通的惯导***快速初始粗对准方法,包括以下步骤:首先读取卫星位置信息,计算卫星在惯导***地理坐标系下的投影分量;然后利用短时间内的加速度计信息解算出惯导***的俯仰角和滚动角;最后读取此时天线方位角和俯仰角,计算卫星在惯导***载体坐标系下的投影分量;再利用此投影分量及惯导***的俯仰角和滚动角计算出惯导***的航向角,完成惯导***的快速初始粗对准。本方法适用于船载动中通在系泊状态下的惯导***初始粗对准。
Description
技术领域
本发明提供了一种适用于船载动中通的惯导***快速初始粗对准方法,适用于船载系泊状态下要求快速对准卫星的场合,属于卫星通讯技术领域。
背景技术
采用惯导方案动中通进行天线寻星对准时,主要是利用惯导***的俯仰角P、滚动角R以及航向角Y信息,通过坐标转换解算出天线各轴驱动角度并驱动天线指向目标卫星。因此惯导***姿态角的初始对准时间及对准精度将决定着天线初始寻星精度及寻星时间。目前,惯导***运动状态下初始对准方法一般是采用粗精结合的动态对准方法实现。首先采用粗对准算法获得载体粗略姿态和航向角后,进入卡尔曼滤波精对准过程解算出载体精确的姿态和航向角,再利用精确姿态信息解算出天线各轴驱动角度,并驱动天线转动指向卫星,完成天线动态寻星过程。
惯导***粗对准一般采用两种方法实现,一是解析式粗对准,二是摇摆动态对准。解析式粗对准要求载体必须完全静止,车载情况下甚至要求关闭发动机及避免人员走动,而且即便如此,仍需要通过延长对准时间提高初始对准精度。摇摆动态对准能够满足船载系泊状态下的粗对准,但该方法对准时间较长,至少需要1-2min时间来完成一定精度的粗对准,势必会延长惯导***初始对准时间,不能满足用户的快速性要求。
另外,初始粗对准必须满足一定精度,尤其粗对准航向角结果必须被限制在一定误差范围内,才能满足线性卡尔曼精对准时滤波器对初始条件的要求,保证滤波器收敛,否则将影响惯导***精对准后的姿态精度。
因此,如何缩短粗对准时间,同时提高粗对准精度,是动中通惯导***实现快速初始粗对准的技术难点之一。
发明内容
本发明的技术解决问题:克服现有技术的不足,依据船载动中通在系泊状态的特点,提供了一种适用于船载动中通的惯导***快速初始粗对准方法,解决了惯导***初始粗对准滤波时间长且初始姿态误差大,从而影响惯导***初始对准的快速性及对准精度的问题。
本发明的技术解决方案:
一种适用于船载动中通的惯导***快速初始粗对准方法,步骤如下:
(1)所述动中通上电后,设置水平姿态解算定时器LevelCnt和累加和数组变量SUM[2],初值均为0;读取卫星位置信息,并计算卫星位置矢量SSat在惯导***地理坐标系OX YZ下的投影分量Sp;
(2)水平姿态解算定时器LevelCnt开始计时,同时采样惯导***两水平加速度计数据进行累加计算,进入步骤(3);
(3)判断水平姿态解算定时器LevelCnt是否达到预设的定时时间T,如果达到,则解算出惯导***俯仰角P和滚动角R,之后进入步骤(4);如果水平姿态解算定时器未达到预设的定时时间,则返回步骤(2);
(4)读取天线方位角和俯仰角,推算出投影分量Sp在载体坐标系下的投影分量Sb,之后进入步骤(5);
(5)根据惯导***俯仰角P、滚动角R以及载体坐标系下的投影分量Sb解算出惯导***的航向主值Y主和航向象限变量Y象限,再通过判断航向主值和航向象限变量的值推算出惯导***的航向真值Y,完成惯导***初始粗对准过程。
本发明与现有技术相比的优点如下:
(1)本发明利用船载动中通在系泊状态下航向角变化不大的情况,设计了一种快速初始粗对准方法。该方法设计采用加速度计的短时累加信息计算惯导***的两水平姿态角,并利用平均滤波方法消除载体扰动,提高惯导***水平姿态角精度;设计了快速航向逆推方法,利用卫星位置信息、天线方位角和俯仰角以及惯导***俯仰角和航向角信息,解算出惯导***的航向真值。本发明利用船载系泊状态航向角变化不大的特点,利用反推算法简化了惯导***初始粗对准的复杂度,实现了快速的初始粗对准,同时提高了船载系泊状态下的惯导***初始粗对准精度;
(2)本发明中提出的投影分量Sp的计算方法,充分考虑了同步卫星的位置特点,简化了运算步骤,实现了一步计算出卫星位置矢量在地理坐标***投影的功能;
(3)本发明中提出的投影分量Sb的计算方法,与传统依靠惯导***姿态和航向角解算卫星位置信息在载体坐标系下的投影方法不同,同样利用了方向推导的原理,在已知当前天线的俯仰角和方位角的情况下反推出来卫星位置信息在载体坐标系下的投影,为后续能成功逆推出惯导***航向角创造了必要条件。
附图说明
图1为本发明的方法流程图;
具体实施方式
动中通(SOTM,Satcom On The Move)是“移动中的卫星地面站通信***”的简称,其利用地球同步静止卫星作为通信信号的中转平台,实现其覆盖区域内的点到点、点到多点、多点到多点的实时通信。主要特点为:卫星覆盖区域大,不受地域、距离等因素限制,专用传输信道,传输带宽大,传输速率高;可实现远程视频图像、伴音、电话以及数据传输。
动中通包括天线、天线控制***、惯导***。其中惯导***的地理坐标系是指原点O选在载体重心处,X指向东,Y指向北,Z沿垂线方向指向天,即东北天坐标系OX YZ;载体坐标系是固连在载体上的坐标系,其坐标原点O位于载体的重心处,X1沿载体横轴指向右,Y1沿载体纵轴指向前,Z1垂直于OX1Y1,并沿飞行器的竖轴指向上,载体坐标系表示为OX1Y1Z1。
如图1所示,本发明提供了一种适用于船载动中通的惯导***快速初始粗对准方法,步骤如下:
(1)当船载动中通上电后,设置水平姿态解算定时器LevelCnt和累加和数组变量SUM[2],初值均为0;读取卫星位置信息,并计算卫星位置矢量SSat在惯导***地理坐标系OXYZ下的投影分量Sp;
计算卫星位置矢量SSat在惯导***地理坐标系OXYZ下的投影分量Sp具体方法为:
首先计算动中通使用的同步卫星位置矢量在地球坐标系e上的投影S'为:
其中λSat为卫星经度,HSat为卫星高度,Re为地球半径;然后计算卫星矢量在地理坐标系OX YZ上的投影Sp为:
其中为动中通载体的当地纬度,λIns为动中通载体的当地经度;
(2)水平姿态解算定时器LevelCnt开始计时,同时采样惯导***两水平加速度计数据进行累加计算,进入步骤(3);具体计算方法如下:
SUM[0]=SUM[0]+fAX
SUM[1]=SUM[1]+fAY
其中fAX为载体坐标系下X轴加速度计输出值,fAY为载体坐标系下Y轴加速度计输出值;
(3)判断水平姿态解算定时器LevelCnt是否达到预设的定时时间T,如果达到,则解算出惯导***俯仰角P和滚动角R;具体方法为:
其中g为地球重力加速度,P为载体俯仰角,R为载体滚动角,之后进入步骤(4);如果水平姿态解算定时器未达到预设的定时时间,则返回步骤(2);
(4)读取天线方位角和俯仰角,推算出投影分量Sp在载体坐标系下的投影分量Sb,之后进入步骤(5);
推算出投影分量Sp在载体坐标系下的投影分量Sb具体方法为:在已知投影分量Sb的情况下,天线俯仰角和方位角求解方法为:
在已知天线俯仰角和方位角的情况下,可以逆向推出投影分量Sp在载体坐标系下的投影分量Sb的公式为:
其中fYaw为天线方位角,fPitch为天线俯仰角;
(5)根据惯导***俯仰角P、滚动角R以及载体坐标系下的投影分量Sb解算出惯导***的航向主值Y主和航向象限变量Y象限;具体方法如下:
设置中间变量A1=[a1 b1 c1]和A2=[a2 b2 c2],利用步骤(3)解算的惯导***俯仰角P和滚动角R逆推出载体航向主值Y主和航向象限变量Y象限:
再通过判断航向主值和航向象限变量的值推算出惯导***的航向真值Y,完成惯导***初始粗对准过程。具体判断方法如下:
本发明利用船载动中通在系泊状态下航向角变化不大的情况,设计了一种快速初始粗对准方法,该方法水平姿态粗对准采用加速度计短时平均滤波方法解算两水平姿态角;利用卫星位置信息、天线方位角和俯仰角以及惯导***俯仰角和航向角信息,解算出惯导***的真实航向角,简化了惯导***初始粗对准算法,实现了惯导***的快速初始粗对准。
实施例:
(1)设置水平姿态解算定时器LevelCnt=100ms;读取卫星经度λSat=130°,卫星高度HSat=35786.6km,载体纬度载体经度λIns=116.14°;计算卫星位置矢量SSat在惯导***地理坐标系OXpYpZp下的投影分量Sp:单位m;
(2)水平姿态解算定时器LevelCnt开始计时,同时采样惯导***两水平加速度计数据进行累加计算,当定时器达到100ms,计算姿态角P=0.85°,R=0.55°;
(3)读取天线方位角fYaw=267.049°和俯仰角fPitch=50.846°,推算Sp在载体坐标系下的投影分量Sb:单位m;
则
因为Y主>0,Y象限<0,所以航向角Y=197.538°。此时就完成了海态系泊状态下的粗对准。
下表列出了三种粗对准的对准时间及精度:
指标 | 航向角真值 | 静态对准 | 摇摆对准 | 快速粗对准 |
对准时间 | 5min | 1min | 100ms | |
对准误差 | 200° | 186.15° | 191.32° | 197.538° |
从上表三种粗对准结果来看,静态对准效果最差,其只适用于静止状态下对准,当载体出现扰动时将严重影响对准精度,且对准时间最长。摇摆对准时间能相对缩短较多,但由于时间短导致对载体扰动滤波效果变差,因此其对准误差仍较大。而本发明的快速粗对准方法对准时间最短,只有100ms即完成了粗对准过程,而且粗对准误差只有2.462°,不仅误差小于其它两种对准方法,而且能够满足卡尔曼滤波精对准初始误差的要求。
Claims (10)
1.一种适用于船载动中通的惯导***快速初始粗对准方法,其特征在于步骤如下:
(1)当船载动中通上电后,设置水平姿态解算定时器LevelCnt和累加和数组变量SUM[2];读取卫星位置信息,并计算卫星位置矢量SSat在惯导***地理坐标系OX YZ下的投影分量Sp;
(2)水平姿态解算定时器LevelCnt开始计时,同时对船载动中通惯导***中的两个水平加速度计数据进行累加计算,之后进入步骤(3);
(3)判断水平姿态解算定时器LevelCnt是否达到预设的定时时间T,如果达到,则解算出惯导***俯仰角P和滚动角R,之后进入步骤(4);如果未达到预设的定时时间,则返回步骤(2);
(4)读取船载动中通天线的方位角和俯仰角,推算出投影分量Sp在载体坐标系下的投影分量Sb,之后进入步骤(5);
(5)根据惯导***俯仰角P、滚动角R以及载体坐标系下的投影分量Sb解算出惯导***的航向主值Y主和航向象限变量Y象限,再通过判断航向主值和航向象限变量的值推算出惯导***的航向真值Y,完成惯导***初始粗对准过程。
2.根据权利要求1所述的一种适用于船载动中通的惯导***快速初始粗对准方法,其特征在于:所述计算卫星位置矢量SSat在惯导***地理坐标系OX YZ下的投影分量Sp具体方法为:
其中λSat为卫星经度,HSat为卫星高度,为动中通载体的当地纬度,λIns为动中通载体的当地经度,Re为地球半径,Xp、Yp和Zp分别为卫星位置矢量SSat在惯导***地理坐标系三轴上的分量。
3.根据权利要求1所述的一种适用于船载动中通的惯导***快速初始粗对准方法,其特征在于:所述惯导***地理坐标系OX YZ定义为:原点O选在动中通载体的重心处,X指向东,Y指向北,Z沿垂线方向指向天。
4.根据权利要求1所述的一种适用于船载动中通的惯导***快速初始粗对准方法,其特征在于:步骤(2)中对船载动中通惯导***中的两个水平加速度计数据进行累加计算具体为:
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<mi>S</mi>
<mi>U</mi>
<mi>M</mi>
<mo>&lsqb;</mo>
<mn>0</mn>
<mo>&rsqb;</mo>
<mo>=</mo>
<mi>S</mi>
<mi>U</mi>
<mi>M</mi>
<mo>&lsqb;</mo>
<mn>0</mn>
<mo>&rsqb;</mo>
<mo>+</mo>
<msub>
<mi>f</mi>
<mrow>
<mi>A</mi>
<mi>X</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>S</mi>
<mi>U</mi>
<mi>M</mi>
<mo>&lsqb;</mo>
<mn>1</mn>
<mo>&rsqb;</mo>
<mo>=</mo>
<mi>S</mi>
<mi>U</mi>
<mi>M</mi>
<mo>&lsqb;</mo>
<mn>1</mn>
<mo>&rsqb;</mo>
<mo>+</mo>
<msub>
<mi>f</mi>
<mrow>
<mi>A</mi>
<mi>Y</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>,</mo>
</mrow>
其中fAX为载体坐标系下X轴加速度计输出值,fAY为载体坐标系下Y轴加速度计输出值。
5.根据权利要求4所述的一种适用于船载动中通的惯导***快速初始粗对准方法,其特征在于:所述载体坐标系是固连在载体上的坐标系,其坐标原点O位于载体的重心处,X1沿载体横轴指向右,Y1沿载体纵轴指向前,Z1垂直于OX1Y1,并沿飞行器的竖轴指向上,载体坐标系表示为OX1Y1Z1。
6.根据权利要求1所述的一种适用于船载动中通的惯导***快速初始粗对准方法,其特征在于:步骤(3)中解算惯导***俯仰角P和滚动角R;具体方法为:
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<mi>P</mi>
<mo>=</mo>
<mi>a</mi>
<mi>r</mi>
<mi>c</mi>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mfrac>
<mrow>
<mi>S</mi>
<mi>U</mi>
<mi>M</mi>
<mo>&lsqb;</mo>
<mn>1</mn>
<mo>&rsqb;</mo>
</mrow>
<mrow>
<mi>g</mi>
<mo>&CenterDot;</mo>
<mi>T</mi>
</mrow>
</mfrac>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>R</mi>
<mo>=</mo>
<mo>-</mo>
<mi>a</mi>
<mi>r</mi>
<mi>c</mi>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mfrac>
<mrow>
<mi>S</mi>
<mi>U</mi>
<mi>M</mi>
<mo>&lsqb;</mo>
<mn>0</mn>
<mo>&rsqb;</mo>
</mrow>
<mrow>
<mi>g</mi>
<mo>&CenterDot;</mo>
<mi>T</mi>
</mrow>
</mfrac>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>,</mo>
</mrow>
其中g为地球重力加速度,P为载体俯仰角,R为载体滚动角。
7.根据权利要求1所述的一种适用于船载动中通的惯导***快速初始粗对准方法,其特征在于:所述推算出投影分量Sp在载体坐标系下的投影分量Sb具体方法为:
<mrow>
<msub>
<mi>S</mi>
<mi>b</mi>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>X</mi>
<mi>b</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>Y</mi>
<mi>b</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>Z</mi>
<mi>b</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<msqrt>
<mrow>
<msubsup>
<mi>X</mi>
<mi>p</mi>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>Y</mi>
<mi>p</mi>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>Z</mi>
<mi>p</mi>
<mn>2</mn>
</msubsup>
</mrow>
</msqrt>
<mo>&CenterDot;</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mo>(</mo>
<mi>f</mi>
<mi>Y</mi>
<mi>a</mi>
<mi>w</mi>
<mo>)</mo>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mo>(</mo>
<mi>f</mi>
<mi>P</mi>
<mi>i</mi>
<mi>t</mi>
<mi>c</mi>
<mi>h</mi>
<mo>)</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>cos</mi>
<mo>(</mo>
<mi>f</mi>
<mi>Y</mi>
<mi>a</mi>
<mi>w</mi>
<mo>)</mo>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mo>(</mo>
<mi>f</mi>
<mi>P</mi>
<mi>i</mi>
<mi>t</mi>
<mi>c</mi>
<mi>h</mi>
<mo>)</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mo>(</mo>
<mi>f</mi>
<mi>Y</mi>
<mi>a</mi>
<mi>w</mi>
<mo>)</mo>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
</mrow>
其中fYaw为天线方位角,fPitch为天线俯仰角,Xb、Yb和Zb分别为载体坐标系OX1Y1Z1三轴上的分量,Xp、Yp和Zp分别为卫星位置矢量SSat在惯导***地理坐标系三轴上的分量。
8.根据权利要求1所述的一种适用于船载动中通的惯导***快速初始粗对准方法,其特征在于:解算惯导***的航向主值Y主和航向象限变量Y象限通过如下公式进行:其中,A1=[a1 b1 c1]和A2=[a2 b2 c2]均为中间变量,
<mrow>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>a</mi>
<mn>1</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>b</mi>
<mn>1</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>c</mi>
<mn>1</mn>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<msqrt>
<mrow>
<msubsup>
<mi>X</mi>
<mi>p</mi>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>Y</mi>
<mi>p</mi>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>Z</mi>
<mi>p</mi>
<mn>2</mn>
</msubsup>
</mrow>
</msqrt>
</mfrac>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<mi>P</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<mi>P</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>P</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>.</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>X</mi>
<mi>p</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>Y</mi>
<mi>p</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>Z</mi>
<mi>p</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>+</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>X</mi>
<mi>b</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>)</mo>
</mrow>
<mo>,</mo>
</mrow>
<mrow>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>a</mi>
<mn>2</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>b</mi>
<mn>2</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>c</mi>
<mn>2</mn>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<msqrt>
<mrow>
<msubsup>
<mi>X</mi>
<mi>p</mi>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>Y</mi>
<mi>p</mi>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>Z</mi>
<mi>p</mi>
<mn>2</mn>
</msubsup>
</mrow>
</msqrt>
</mfrac>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<mi>P</mi>
<mo>)</mo>
</mrow>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<mi>R</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<mi>R</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<mi>R</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<mi>P</mi>
<mo>)</mo>
</mrow>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<mi>R</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<mi>R</mi>
<mo>)</mo>
</mrow>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<mi>P</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>&CenterDot;</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>X</mi>
<mi>p</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>Y</mi>
<mi>p</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>Z</mi>
<mi>p</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>+</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>X</mi>
<mi>b</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>)</mo>
</mrow>
<mo>,</mo>
</mrow>
其中,Xp、Yp和Zp分别为卫星位置矢量SSat在惯导***地理坐标系三轴上的分量,Xb、Yb分别为投影分量Sp在载体坐标系OX1Y1Z1两轴上的分量。
9.根据权利要求1所述的一种适用于船载动中通的惯导***快速初始粗对准方法,其特征在于:通过判断航向主值和航向象限变量的值推算出惯导***的航向角真值Y,具体为:
10.根据权利要求1所述的一种适用于船载动中通的惯导***快速初始粗对准方法,其特征在于:水平姿态解算定时器LevelCnt和累加和数组变量SUM[2]初值均为0。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510472371.4A CN105043418B (zh) | 2015-08-04 | 2015-08-04 | 一种适用于船载动中通的惯导***快速初始粗对准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510472371.4A CN105043418B (zh) | 2015-08-04 | 2015-08-04 | 一种适用于船载动中通的惯导***快速初始粗对准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105043418A CN105043418A (zh) | 2015-11-11 |
CN105043418B true CN105043418B (zh) | 2017-12-22 |
Family
ID=54450151
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510472371.4A Active CN105043418B (zh) | 2015-08-04 | 2015-08-04 | 一种适用于船载动中通的惯导***快速初始粗对准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105043418B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107483121B (zh) * | 2017-06-22 | 2020-07-14 | 山东航天电子技术研究所 | 一种动中通天线的信号遮挡检测及恢复方法 |
CN107525523B (zh) * | 2017-08-23 | 2019-10-15 | 北京华力创通科技股份有限公司 | 卫星导航辅助sins进行初始方位对准的方法及装置 |
CN107655494A (zh) * | 2017-09-15 | 2018-02-02 | 哈尔滨工程大学 | 一种摇摆基座条件下惯导***粗对准方法 |
CN110926468B (zh) * | 2019-12-05 | 2022-03-01 | 中国电子科技集团公司第五十四研究所 | 基于传递对准的动中通天线多平台航姿确定方法 |
CN112332917A (zh) * | 2020-10-23 | 2021-02-05 | 军事科学院***工程研究院网络信息研究所 | 惯性导航控制的激光通信自主跟瞄方法 |
CN112697166B (zh) * | 2020-11-04 | 2023-06-06 | 河北汉光重工有限责任公司 | 一种运动状态下的捷联惯导***自对准方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8843290B2 (en) * | 2010-07-22 | 2014-09-23 | Qualcomm Incorporated | Apparatus and methods for calibrating dynamic parameters of a vehicle navigation system |
CN103090867B (zh) * | 2012-11-02 | 2015-06-17 | 哈尔滨工程大学 | 相对地心惯性系旋转的光纤陀螺捷联惯性导航***误差抑制方法 |
CN103398725A (zh) * | 2013-07-29 | 2013-11-20 | 哈尔滨工程大学 | 一种基于星敏感器的捷联惯导***初始对准的方法 |
CN103557871B (zh) * | 2013-10-22 | 2016-06-15 | 北京航空航天大学 | 一种浮空飞行器捷联惯导空中初始对准方法 |
CN104501838B (zh) * | 2015-01-20 | 2017-08-29 | 上海华测导航技术股份有限公司 | 捷联惯导***初始对准方法 |
-
2015
- 2015-08-04 CN CN201510472371.4A patent/CN105043418B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN105043418A (zh) | 2015-11-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105043418B (zh) | 一种适用于船载动中通的惯导***快速初始粗对准方法 | |
CN104124528B (zh) | 一种惯性/gnss/卫星信标组合式动中通天线稳定跟踪方法 | |
CN103217987B (zh) | 一种用于敏捷卫星动态成像的姿态调整方法 | |
CN109786966A (zh) | 低轨卫星地面站天线的跟踪装置及其应用方法 | |
WO2017113567A1 (zh) | 火星探测器自主导航方法 | |
CN107450582B (zh) | 一种基于星上实时规划的相控阵数传引导控制方法 | |
US8521427B1 (en) | Vehicle navigation using cellular networks | |
CN108759819A (zh) | 一种基于全天域偏振度信息的偏振导航实时定位方法 | |
CN105116430B (zh) | 用于动中通的伪航向的基于卡尔曼滤波的海泊态搜星方法 | |
CN103575274A (zh) | 高性能星图匹配自主导航定位*** | |
CN101226058A (zh) | 一种卫星侧摆机动图像实时传输的实现方法 | |
CN112649817A (zh) | 一种海上浮标卫星通信自动跟踪装置及跟踪方法 | |
CN109061701A (zh) | 一种适用于星载多天线融合载波相位差分测量方法 | |
CN103487032B (zh) | 低轨空间相机自由指向像移矢量计算方法 | |
CN206540555U (zh) | 基于双gnss天线及单轴mems陀螺的前轮测角*** | |
CN202102116U (zh) | 无人机测控车的测控*** | |
CN105007109B (zh) | 动中通卫星通信***的自适应组合导航天线波束控制方法 | |
CN113794497B (zh) | 一种具有抗干扰定位功能的移动卫星通信天线终端 | |
CN104201471A (zh) | 一种sigso通信卫星的地面站天线跟踪方法 | |
CN102023301B (zh) | 一种中轨道卫星搜救***的选星方法 | |
CN117092669B (zh) | 高动态条件下北斗同步轨道卫星信号多普勒估计方法 | |
KR101129255B1 (ko) | 자세 센서를 이용한 gps 안테나용 능동형 짐벌 | |
CN112833878A (zh) | 近地面多源天文自主导航方法 | |
CN116519020A (zh) | 一种机动测控平台惯导标定装置及方法 | |
CN103900569B (zh) | 微惯导与dgps和电子罗盘组合导航姿态测量方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |