发明名称 |
一种适用于极区的惯导系统综合校正方法 |
摘要 |
本发明公开了能够实现极区航行运载器在无阻尼条件下进行综合校正的一种适用于极区的惯导系统综合校正方法。本方法通过以横地理坐标系作为导航坐标系,在极区范围内通过横坐标系转换,将导航参数转换到横地理坐标系下。以横地理坐标系下的惯导输出误差量作为状态量,速度作为外部观测量,建立卡尔曼滤波模型,估测出水平误差角并引入到传统两点校正算法中,在无阻尼状态条件下完成极区惯导系统综合校正过程。本发明在无阻尼条件下实现极区航行运载器综合校正,解除了传统综合校正方案对运载器航行方式的限制,提高了极区惯导系统工作的灵活性。 |
申请公布号 |
CN103983277B |
申请公布日期 |
2016.11.30 |
申请号 |
CN201410206180.9 |
申请日期 |
2014.05.16 |
申请人 |
哈尔滨工程大学 |
发明人 |
孙枫;尹冬寒;赵立莎;奔粤阳;李敬春;杨晓龙;赵维珩;杨祥龙;李明宇;阮双双 |
分类号 |
G01C25/00(2006.01)I |
主分类号 |
G01C25/00(2006.01)I |
代理机构 |
|
代理人 |
|
主权项 |
一种适用于极区的惯导系统综合校正方法,其特征在于,包括以下几个步骤:步骤一:将船用惯导系统输出的导航参数量转换到横地理坐标系下,导航参数包括:经纬度值、航向、速度和姿态信息;地理坐标系与横地理坐标系的转换矩阵为:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><msubsup><mi>C</mi><mi>n</mi><mover><mi>n</mi><mo>‾</mo></mover></msubsup><mo>=</mo><msubsup><mi>C</mi><mi>i</mi><mover><mi>n</mi><mo>‾</mo></mover></msubsup><mo>·</mo><msubsup><mi>C</mi><mi>n</mi><mi>i</mi></msubsup></mrow>]]></math><img file="FDA0001054846970000011.GIF" wi="237" he="62" /></maths><maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><msubsup><mi>C</mi><mi>i</mi><mover><mi>n</mi><mo>‾</mo></mover></msubsup><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><mi>cos</mi><mover><mi>λ</mi><mo>‾</mo></mover><mi>cos</mi><mi>Ω</mi><mi>t</mi></mrow></mtd><mtd><mrow><mi>cos</mi><mover><mi>λ</mi><mo>‾</mo></mover><mi>sin</mi><mi>Ω</mi><mi>t</mi></mrow></mtd><mtd><mrow><mo>-</mo><mi>sin</mi><mover><mi>λ</mi><mo>‾</mo></mover></mrow></mtd></mtr><mtr><mtd><mrow><mo>-</mo><mi>sin</mi><mover><mi>L</mi><mo>‾</mo></mover><mi>sin</mi><mover><mi>λ</mi><mo>‾</mo></mover><mi>cos</mi><mi>Ω</mi><mi>t</mi><mo>-</mo><mi>cos</mi><mover><mi>L</mi><mo>‾</mo></mover><mi>sin</mi><mi>Ω</mi><mi>t</mi></mrow></mtd><mtd><mrow><mi>cos</mi><mover><mi>L</mi><mo>‾</mo></mover><mi>cos</mi><mi>Ω</mi><mi>t</mi><mo>-</mo><mi>sin</mi><mover><mi>L</mi><mo>‾</mo></mover><mi>sin</mi><mover><mi>λ</mi><mo>‾</mo></mover><mi>sin</mi><mi>Ω</mi><mi>t</mi></mrow></mtd><mtd><mrow><mo>-</mo><mi>sin</mi><mover><mi>L</mi><mo>‾</mo></mover><mi>cos</mi><mover><mi>λ</mi><mo>‾</mo></mover></mrow></mtd></mtr><mtr><mtd><mrow><mi>cos</mi><mover><mi>L</mi><mo>‾</mo></mover><mi>sin</mi><mover><mi>λ</mi><mo>‾</mo></mover><mi>cos</mi><mi>Ω</mi><mi>t</mi><mo>-</mo><mi>sin</mi><mover><mi>L</mi><mo>‾</mo></mover><mi>sin</mi><mi>Ω</mi><mi>t</mi></mrow></mtd><mtd><mrow><mi>cos</mi><mover><mi>L</mi><mo>‾</mo></mover><mi>sin</mi><mover><mi>λ</mi><mo>‾</mo></mover><mi>sin</mi><mi>Ω</mi><mi>t</mi><mo>+</mo><mi>sin</mi><mover><mi>L</mi><mo>‾</mo></mover><mi>cos</mi><mi>Ω</mi><mi>t</mi></mrow></mtd><mtd><mrow><mi>cos</mi><mover><mi>L</mi><mo>‾</mo></mover><mi>cos</mi><mover><mi>λ</mi><mo>‾</mo></mover></mrow></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA0001054846970000012.GIF" wi="1770" he="230" /></maths><maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><msubsup><mi>C</mi><mi>n</mi><mi>i</mi></msubsup><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><mo>-</mo><mi>sin</mi><mrow><mo>(</mo><mi>λ</mi><mo>+</mo><mi>Ω</mi><mi>t</mi><mo>)</mo></mrow></mrow></mtd><mtd><mrow><mo>-</mo><mi>sin</mi><mi>L</mi><mi>cos</mi><mrow><mo>(</mo><mi>λ</mi><mo>+</mo><mi>Ω</mi><mi>t</mi><mo>)</mo></mrow></mrow></mtd><mtd><mrow><mi>cos</mi><mi>L</mi><mi>cos</mi><mrow><mo>(</mo><mi>λ</mi><mo>+</mo><mi>Ω</mi><mi>t</mi><mo>)</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><mi>cos</mi><mrow><mo>(</mo><mi>λ</mi><mo>+</mo><mi>Ω</mi><mi>t</mi><mo>)</mo></mrow></mrow></mtd><mtd><mrow><mo>-</mo><mi>sin</mi><mi>L</mi><mi>sin</mi><mrow><mo>(</mo><mi>λ</mi><mo>+</mo><mi>Ω</mi><mi>t</mi><mo>)</mo></mrow></mrow></mtd><mtd><mrow><mi>cos</mi><mi>L</mi><mi>sin</mi><mrow><mo>(</mo><mi>λ</mi><mo>+</mo><mi>Ω</mi><mi>t</mi><mo>)</mo></mrow></mrow></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mrow><mi>cos</mi><mi>L</mi></mrow></mtd><mtd><mrow><mi>sin</mi><mi>L</mi></mrow></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA0001054846970000013.GIF" wi="1206" he="222" /></maths><img file="FDA0001054846970000014.GIF" wi="58" he="62" />表示惯性坐标系到横地理坐标系的转换矩阵,<img file="FDA0001054846970000015.GIF" wi="54" he="61" />表示地理坐标系到惯性坐标系的转换矩阵,Ω为地球自转角速度,t为时间,λ为地理坐标系下的经度值,横地理坐标系下的经纬度值为:<maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><mover><mi>L</mi><mo>‾</mo></mover><mo>=</mo><mi>a</mi><mi>r</mi><mi>c</mi><mi>s</mi><mi>i</mi><mi>n</mi><mrow><mo>(</mo><mi>cos</mi><mi>L</mi><mi>s</mi><mi>i</mi><mi>n</mi><mi>λ</mi><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001054846970000016.GIF" wi="462" he="71" /></maths><maths num="0005" id="cmaths0005"><math><![CDATA[<mrow><mover><mi>λ</mi><mo>‾</mo></mover><mo>=</mo><mi>a</mi><mi>r</mi><mi>c</mi><mi>t</mi><mi>a</mi><mi>n</mi><mrow><mo>(</mo><mfrac><mrow><mi>cos</mi><mi>L</mi><mi>c</mi><mi>o</mi><mi>s</mi><mi>λ</mi></mrow><mrow><mi>sin</mi><mi>L</mi></mrow></mfrac><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001054846970000017.GIF" wi="485" he="134" /></maths>L为地理坐标系下的纬度值,<img file="FDA0001054846970000018.GIF" wi="38" he="55" />为横地理坐标系下的纬度值,<img file="FDA0001054846970000019.GIF" wi="37" he="54" />为横地理坐标系下的经度值,横地理坐标系下航向与速度为:<maths num="0006" id="cmaths0006"><math><![CDATA[<mrow><mover><mi>K</mi><mo>‾</mo></mover><mo>=</mo><mi>K</mi><mo>+</mo><mi>a</mi><mi>r</mi><mi>c</mi><mi>t</mi><mi>a</mi><mi>n</mi><mfrac><mrow><mi>s</mi><mi>i</mi><mi>n</mi><mi>λ</mi></mrow><mrow><mi>sin</mi><mi>L</mi><mi>cos</mi><mi>λ</mi></mrow></mfrac><mo>-</mo><mi>π</mi></mrow>]]></math><img file="FDA00010548469700000110.GIF" wi="598" he="122" /></maths><maths num="0007" id="cmaths0007"><math><![CDATA[<mrow><mover><mi>V</mi><mo>‾</mo></mover><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><msub><mover><mi>V</mi><mo>‾</mo></mover><mi>x</mi></msub></mtd></mtr><mtr><mtd><msub><mover><mi>V</mi><mo>‾</mo></mover><mi>y</mi></msub></mtd></mtr></mtable></mfenced><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><mi>V</mi><mi>sin</mi><mover><mi>K</mi><mo>‾</mo></mover></mrow></mtd></mtr><mtr><mtd><mrow><mi>V</mi><mi>cos</mi><mover><mi>K</mi><mo>‾</mo></mover></mrow></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA00010548469700000111.GIF" wi="428" he="159" /></maths>K表示地理坐标系下的航向,<img file="FDA00010548469700000112.GIF" wi="46" he="55" />为横地理坐标系下的航向,π为圆周率,V为地理坐标系下的速度,<img file="FDA00010548469700000113.GIF" wi="38" he="53" />为横地理坐标系下的速度,<img file="FDA00010548469700000114.GIF" wi="42" he="63" />为横地理坐标系下的东向速度,<img file="FDA00010548469700000115.GIF" wi="45" he="71" />为横地理坐标系下的北向速度;步骤二:利用得到的横地理坐标系下的导航参数进行横地理坐标系下的导航机械编排,确定系统的状态变量和量测量;步骤三:根据系统的状态变量和量测量建立卡尔曼滤波器,由卡尔曼滤波方法得到横地理坐标系下的导航系统的x轴姿态误差角<img file="FDA00010548469700000116.GIF" wi="45" he="69" />和y轴姿态误差角<img file="FDA00010548469700000117.GIF" wi="74" he="70" />步骤四:将得到的x轴姿态误差角<img file="FDA0001054846970000021.GIF" wi="45" he="70" />和y轴姿态误差角<img file="FDA0001054846970000022.GIF" wi="43" he="71" />引入到导航系统的两点校正中,完成极区两点校正;所述的步骤二中,导航机械编排为:<maths num="0008" id="cmaths0008"><math><![CDATA[<mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><mi>δ</mi><mover><mover><mi>L</mi><mo>‾</mo></mover><mo>·</mo></mover><mo>=</mo><mfrac><mrow><mi>δ</mi><msub><mover><mi>V</mi><mo>‾</mo></mover><mi>y</mi></msub></mrow><mi>R</mi></mfrac></mrow></mtd></mtr><mtr><mtd><mrow><mi>δ</mi><mover><mover><mi>λ</mi><mo>‾</mo></mover><mo>·</mo></mover><mo>=</mo><mfrac><msub><mover><mi>V</mi><mo>‾</mo></mover><mi>x</mi></msub><mi>R</mi></mfrac><mi>δ</mi><mover><mi>L</mi><mo>‾</mo></mover><mi>tan</mi><mover><mi>L</mi><mo>‾</mo></mover><mi>sec</mi><mover><mi>L</mi><mo>‾</mo></mover><mo>+</mo><mfrac><mrow><mi>δ</mi><msub><mover><mi>V</mi><mo>‾</mo></mover><mi>x</mi></msub></mrow><mi>R</mi></mfrac><mi>sec</mi><mover><mi>L</mi><mo>‾</mo></mover></mrow></mtd></mtr><mtr><mtd><mrow><mi>δ</mi><msub><mover><mover><mi>V</mi><mo>‾</mo></mover><mo>·</mo></mover><mi>x</mi></msub><mo>=</mo><msub><mover><mi>φ</mi><mo>‾</mo></mover><mi>z</mi></msub><msub><mover><mi>f</mi><mo>‾</mo></mover><mi>y</mi></msub><mo>+</mo><mfrac><msub><mover><mi>V</mi><mo>‾</mo></mover><mi>y</mi></msub><mi>R</mi></mfrac><mi>tan</mi><mover><mi>L</mi><mo>‾</mo></mover><mo>·</mo><mi>δ</mi><msub><mover><mi>V</mi><mo>‾</mo></mover><mi>x</mi></msub><mo>+</mo><mrow><mo>(</mo><mn>2</mn><mi>Ω</mi><mi>sin</mi><mover><mi>L</mi><mo>‾</mo></mover><mo>+</mo><mfrac><msub><mover><mi>V</mi><mo>‾</mo></mover><mi>x</mi></msub><mi>R</mi></mfrac><mi>tan</mi><mover><mi>L</mi><mo>‾</mo></mover><mo>)</mo></mrow><mo>·</mo><mi>δ</mi><msub><mover><mi>V</mi><mo>‾</mo></mover><mi>y</mi></msub><mo>+</mo><mrow><mo>(</mo><mn>2</mn><mi>Ω</mi><mi>cos</mi><mover><mi>L</mi><mo>‾</mo></mover><mo>·</mo><msub><mover><mi>V</mi><mo>‾</mo></mover><mi>y</mi></msub><mo>+</mo><mfrac><mrow><msub><mover><mi>V</mi><mo>‾</mo></mover><mi>x</mi></msub><msub><mover><mi>V</mi><mo>‾</mo></mover><mi>y</mi></msub></mrow><mi>R</mi></mfrac><msup><mi>sec</mi><mn>2</mn></msup><mover><mi>L</mi><mo>‾</mo></mover><mo>)</mo></mrow><mo>·</mo><mi>δ</mi><mover><mi>L</mi><mo>‾</mo></mover><mo>+</mo><mi>Δ</mi><msub><mover><mi>A</mi><mo>‾</mo></mover><mi>x</mi></msub></mrow></mtd></mtr><mtr><mtd><mrow><mi>δ</mi><msub><mover><mover><mi>V</mi><mo>‾</mo></mover><mo>·</mo></mover><mi>y</mi></msub><mo>=</mo><mo>-</mo><msub><mover><mi>φ</mi><mo>‾</mo></mover><mi>z</mi></msub><msub><mover><mi>f</mi><mo>‾</mo></mover><mi>x</mi></msub><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mi>Ω</mi><mi>sin</mi><mover><mi>L</mi><mo>‾</mo></mover><mo>+</mo><mfrac><mrow><mn>2</mn><msub><mover><mi>V</mi><mo>‾</mo></mover><mi>x</mi></msub></mrow><mi>R</mi></mfrac><mi>tan</mi><mover><mi>L</mi><mo>‾</mo></mover><mo>)</mo></mrow><mo>·</mo><mi>δ</mi><msub><mover><mi>V</mi><mo>‾</mo></mover><mi>x</mi></msub><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mi>Ω</mi><mi>cos</mi><mover><mi>L</mi><mo>‾</mo></mover><msub><mover><mi>V</mi><mo>‾</mo></mover><mi>x</mi></msub><mo>+</mo><mfrac><msup><mrow><mo>(</mo><msub><mover><mi>V</mi><mo>‾</mo></mover><mi>x</mi></msub><mo>)</mo></mrow><mn>2</mn></msup><mi>R</mi></mfrac><msup><mi>sec</mi><mn>2</mn></msup><mover><mi>L</mi><mo>‾</mo></mover><mo>)</mo></mrow><mo>·</mo><mi>δ</mi><mover><mi>L</mi><mo>‾</mo></mover><mo>+</mo><mi>Δ</mi><msub><mover><mi>A</mi><mo>‾</mo></mover><mi>y</mi></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mover><mi>φ</mi><mo>‾</mo></mover><mo>·</mo></mover><mi>x</mi></msub><mo>=</mo><mo>-</mo><mfrac><mrow><mi>δ</mi><msub><mover><mi>V</mi><mo>‾</mo></mover><mi>y</mi></msub></mrow><mi>R</mi></mfrac><mo>+</mo><mrow><mo>(</mo><mi>Ω</mi><mi>sin</mi><mover><mi>L</mi><mo>‾</mo></mover><mo>+</mo><mfrac><mrow><msub><mover><mi>V</mi><mo>‾</mo></mover><mi>x</mi></msub><mi>tan</mi><mover><mi>L</mi><mo>‾</mo></mover></mrow><mi>R</mi></mfrac><mo>)</mo></mrow><msub><mover><mi>φ</mi><mo>‾</mo></mover><mi>y</mi></msub><mo>-</mo><mrow><mo>(</mo><mi>Ω</mi><mi>cos</mi><mover><mi>L</mi><mo>‾</mo></mover><mo>+</mo><mfrac><msub><mover><mi>V</mi><mo>‾</mo></mover><mi>x</mi></msub><mi>R</mi></mfrac><mo>)</mo></mrow><msub><mover><mi>φ</mi><mo>‾</mo></mover><mi>z</mi></msub><mo>+</mo><msub><mover><mi>ϵ</mi><mo>‾</mo></mover><mi>x</mi></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mover><mi>φ</mi><mo>‾</mo></mover><mo>·</mo></mover><mi>y</mi></msub><mo>=</mo><mo>-</mo><mfrac><mrow><mi>δ</mi><msub><mover><mi>V</mi><mo>‾</mo></mover><mi>x</mi></msub></mrow><mi>R</mi></mfrac><mo>-</mo><mi>Ω</mi><mi>sin</mi><mover><mi>L</mi><mo>‾</mo></mover><mi>δ</mi><mover><mi>L</mi><mo>‾</mo></mover><mo>-</mo><mrow><mo>(</mo><mi>Ω</mi><mi>sin</mi><mover><mi>L</mi><mo>‾</mo></mover><mo>+</mo><mfrac><mrow><msub><mover><mi>V</mi><mo>‾</mo></mover><mi>x</mi></msub><mi>tan</mi><mover><mi>L</mi><mo>‾</mo></mover></mrow><mi>R</mi></mfrac><mo>)</mo></mrow><msub><mover><mi>φ</mi><mo>‾</mo></mover><mi>x</mi></msub><mo>-</mo><mfrac><msub><mover><mi>V</mi><mo>‾</mo></mover><mi>y</mi></msub><mi>R</mi></mfrac><msub><mover><mi>φ</mi><mo>‾</mo></mover><mi>z</mi></msub><mo>+</mo><msub><mover><mi>ϵ</mi><mo>‾</mo></mover><mi>y</mi></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mover><mi>φ</mi><mo>‾</mo></mover><mo>·</mo></mover><mi>z</mi></msub><mo>=</mo><mfrac><mrow><mi>δ</mi><msub><mover><mi>V</mi><mo>‾</mo></mover><mi>x</mi></msub></mrow><mi>R</mi></mfrac><mi>tan</mi><mover><mi>L</mi><mo>‾</mo></mover><mo>+</mo><mfrac><msub><mover><mi>V</mi><mo>‾</mo></mover><mi>y</mi></msub><mi>R</mi></mfrac><msub><mover><mi>φ</mi><mo>‾</mo></mover><mi>y</mi></msub><mo>+</mo><mrow><mo>(</mo><mi>Ω</mi><mi>cos</mi><mover><mi>L</mi><mo>‾</mo></mover><mo>+</mo><mfrac><msub><mover><mi>V</mi><mo>‾</mo></mover><mi>x</mi></msub><mi>R</mi></mfrac><msup><mi>sec</mi><mn>2</mn></msup><mover><mi>L</mi><mo>‾</mo></mover><mo>)</mo></mrow><mi>δ</mi><mover><mi>L</mi><mo>‾</mo></mover><mi>+</mi><mrow><mo>(</mo><mi>Ω</mi><mi>cos</mi><mover><mi>L</mi><mo>‾</mo></mover><mo>+</mo><mfrac><msub><mover><mi>V</mi><mo>‾</mo></mover><mi>x</mi></msub><mi>R</mi></mfrac><mo>)</mo></mrow><msub><mover><mi>φ</mi><mo>‾</mo></mover><mi>x</mi></msub><mo>+</mo><msub><mover><mi>ϵ</mi><mo>‾</mo></mover><mi>z</mi></msub></mrow></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0001054846970000023.GIF" wi="1722" he="887" /></maths><img file="FDA0001054846970000024.GIF" wi="173" he="55" />分别为横纬度误差和横经度误差,<img file="FDA0001054846970000025.GIF" wi="38" he="55" />为当地横地理纬度,<img file="FDA0001054846970000026.GIF" wi="193" he="71" />分别为载体的横东向速度误差和横北向速度误差,<img file="FDA0001054846970000027.GIF" wi="211" he="79" />分别为横地理坐标系下东向和北向加速度计误差,<img file="FDA0001054846970000028.GIF" wi="206" he="78" />分别为横地理坐标系下加速度计x轴、y轴和z轴测量的比力信息,<img file="FDA0001054846970000029.GIF" wi="221" he="71" />分别为横地理坐标系下载体x轴、y轴和z轴姿态误差角,<img file="FDA00010548469700000210.GIF" wi="226" he="63" />分别为横地理坐标系下x轴、y轴和z轴陀螺漂移,系统的状态变量为:<maths num="0009" id="cmaths0009"><math><![CDATA[<mrow><mi>X</mi><mo>=</mo><msup><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><mi>δ</mi><mover><mi>L</mi><mo>‾</mo></mover></mrow></mtd><mtd><mrow><mi>δ</mi><mover><mi>λ</mi><mo>‾</mo></mover></mrow></mtd><mtd><mrow><mi>δ</mi><msub><mover><mi>V</mi><mo>‾</mo></mover><mi>x</mi></msub></mrow></mtd><mtd><mrow><mi>δ</mi><msub><mover><mi>V</mi><mo>‾</mo></mover><mi>y</mi></msub></mrow></mtd><mtd><msub><mover><mi>φ</mi><mo>‾</mo></mover><mi>x</mi></msub></mtd><mtd><msub><mover><mi>φ</mi><mo>‾</mo></mover><mi>y</mi></msub></mtd><mtd><msub><mover><mi>φ</mi><mo>‾</mo></mover><mi>z</mi></msub></mtd><mtd><msub><mover><mi>ϵ</mi><mo>‾</mo></mover><mi>x</mi></msub></mtd><mtd><msub><mover><mi>ϵ</mi><mo>‾</mo></mover><mi>y</mi></msub></mtd><mtd><msub><mover><mi>ϵ</mi><mo>‾</mo></mover><mi>z</mi></msub></mtd><mtd><mrow><mi>Δ</mi><msub><mover><mi>A</mi><mo>‾</mo></mover><mi>x</mi></msub></mrow></mtd><mtd><mrow><mi>Δ</mi><msub><mover><mi>A</mi><mo>‾</mo></mover><mi>y</mi></msub></mrow></mtd></mtr></mtable></mfenced><mi>T</mi></msup></mrow>]]></math><img file="FDA00010548469700000211.GIF" wi="1133" he="77" /></maths>系统的量测量为:<maths num="0010" id="cmaths0010"><math><![CDATA[<mrow><mi>Z</mi><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><msub><mover><mi>V</mi><mo>‾</mo></mover><mrow><mi>s</mi><mi>x</mi></mrow></msub><mo>-</mo><msub><mover><mi>V</mi><mo>‾</mo></mover><mrow><mi>d</mi><mi>x</mi></mrow></msub></mtd></mtr><mtr><mtd><mrow><msub><mover><mi>V</mi><mo>‾</mo></mover><mrow><mi>s</mi><mi>y</mi></mrow></msub><mo>-</mo><msub><mover><mi>V</mi><mo>‾</mo></mover><mrow><mi>d</mi><mi>y</mi></mrow></msub></mrow></mtd></mtr></mtable></mfenced><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><mi>δ</mi><msub><mover><mi>V</mi><mo>‾</mo></mover><mi>x</mi></msub></mrow></mtd></mtr><mtr><mtd><mrow><mi>δ</mi><msub><mover><mi>V</mi><mo>‾</mo></mover><mi>y</mi></msub></mrow></mtd></mtr></mtable></mfenced><mo>=</mo><msub><mover><mi>V</mi><mo>‾</mo></mover><mi>s</mi></msub><mo>-</mo><msub><mover><mi>V</mi><mo>‾</mo></mover><mi>d</mi></msub></mrow>]]></math><img file="FDA00010548469700000212.GIF" wi="582" he="142" /></maths><img file="FDA00010548469700000213.GIF" wi="38" he="55" />为横地理坐标系下惯导输出速度,<img file="FDA00010548469700000214.GIF" wi="46" he="60" />为横地理坐标系下电磁计程仪输出速度,<img file="FDA00010548469700000215.GIF" wi="50" he="55" />为惯导输出速度在横东向上分量,<img file="FDA00010548469700000216.GIF" wi="58" he="62" />为惯导输出速度在横北向上分量,<img file="FDA00010548469700000217.GIF" wi="53" he="62" />为电磁计程仪输出速度在横东向上分量,<img file="FDA00010548469700000218.GIF" wi="52" he="63" />为电磁计程仪输出速度在横北向上分量,<img file="FDA00010548469700000219.GIF" wi="70" he="62" />为横东向速度误差,<img file="FDA00010548469700000220.GIF" wi="68" he="63" />为横北向速度误差;所述的步骤四中,将得到的x轴姿态误差角<img file="FDA00010548469700000221.GIF" wi="46" he="67" />和y轴姿态误差角<img file="FDA00010548469700000222.GIF" wi="45" he="69" />引入到导航系统的两点校正中,得到:<maths num="0011" id="cmaths0011"><math><![CDATA[<mrow><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><mi>δ</mi><mover><mi>L</mi><mo>‾</mo></mover><mo>+</mo><msub><mover><mover><mi>φ</mi><mo>‾</mo></mover><mo>^</mo></mover><mi>x</mi></msub></mrow></mtd></mtr><mtr><mtd><mrow><mi>δ</mi><mover><mi>λ</mi><mo>‾</mo></mover><mo>-</mo><mfrac><msub><mover><mover><mi>φ</mi><mo>‾</mo></mover><mo>^</mo></mover><mi>y</mi></msub><mrow><mi>cos</mi><mover><mi>L</mi><mo>‾</mo></mover></mrow></mfrac></mrow></mtd></mtr><mtr><mtd><mrow><mi>δ</mi><mover><mi>K</mi><mo>‾</mo></mover><mo>-</mo><msub><mover><mover><mi>φ</mi><mo>‾</mo></mover><mo>^</mo></mover><mi>y</mi></msub><mi>tan</mi><mover><mi>L</mi><mo>‾</mo></mover></mrow></mtd></mtr></mtable></mfenced><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mrow><mo>-</mo><mi>sec</mi><mover><mi>L</mi><mo>‾</mo></mover></mrow></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mrow><mo>-</mo><mi>tan</mi><mover><mi>L</mi><mo>‾</mo></mover></mrow></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced><msup><mfenced open = "[" close = "]"><mtable><mtr><mtd><msub><mi>ψ</mi><mi>x</mi></msub></mtd></mtr><mtr><mtd><msub><mi>ψ</mi><mi>y</mi></msub></mtd></mtr><mtr><mtd><msub><mi>ψ</mi><mi>z</mi></msub></mtd></mtr></mtable></mfenced><mover><mi>n</mi><mo>‾</mo></mover></msup></mrow>]]></math><img file="FDA0001054846970000031.GIF" wi="726" he="335" /></maths><img file="FDA0001054846970000032.GIF" wi="78" he="55" />为横地理坐标系下的航向误差,ψ<sub>x</sub>、ψ<sub>y</sub>、ψ<sub>z</sub>为惯导系统平台漂移角。 |
地址 |
150001 黑龙江省哈尔滨市南岗区南通大街145号哈尔滨工程大学科技处知识产权办公室 |