主权项 |
1.重力辅助惯性导航系统中重力图匹配的初始匹配方法,其特征在于步骤如下:第一步,判断运载体已进入重力场适配区域Ψ,选取运载体所承载的重力场传感器连续的三个采样点,三个采样点所对应的时间分别为t<sub>1</sub>、t<sub>2</sub>和t<sub>3</sub>时刻;第二步,确定运载体重力匹配参考图的搜索区域Ω首先根据运载体所承载惯导系统的误差分布特性函数,确定当前时刻惯性系统的距离误差阈值δ,然后以惯导系统所提供的运载体当前位置信息为中心,距离误差阈值δ为半径,划定重力匹配参考图的搜索区域Ω,从而在减小搜索区域提高搜索速度前提条件下,确保运载体真实位置信息落于重力匹配参考图的搜索区域Ω内;第三步,构建三角形几何约束模型,并构建三角空间Γ;第四步,利用运载体所承载的重力场传感器在t<sub>1</sub>、t<sub>2</sub>和t<sub>3</sub>时刻所采取的重力值,获取运载体在t<sub>1</sub>、t<sub>2</sub>和t<sub>3</sub>时刻对应参考重力场等值线C<sub>1</sub>、C<sub>2</sub>和C<sub>3</sub>所包含的点集P<sub>1</sub>、P<sub>2</sub>和P<sub>3</sub>;第五步,基于三角形几何约束模型等值线匹配算法,获取运载体在当前时刻的所有初始匹配对<maths num="0001"><![CDATA[<math><mrow><mover><mrow><msub><mi>p</mi><mn>1</mn></msub><msub><mi>q</mi><mn>1</mn></msub><msub><mi>m</mi><mn>1</mn></msub></mrow><mo>‾</mo></mover><mo>,</mo><mover><mrow><msub><mi>p</mi><mn>2</mn></msub><msub><mi>q</mi><mn>2</mn></msub><msub><mi>m</mi><mn>2</mn></msub></mrow><mo>‾</mo></mover><mo>,</mo><mo>·</mo><mo>·</mo><mo>·</mo><mo>,</mo><mover><mrow><msub><mi>p</mi><mi>j</mi></msub><msub><mi>q</mi><mi>j</mi></msub><msub><mi>mj</mi><mi>j</mi></msub></mrow><mo>‾</mo></mover><mo>,</mo><mo>·</mo><mo>·</mo><mo>·</mo><mo>,</mo><mover><mrow><msub><mi>p</mi><mi>N</mi></msub><msub><mi>q</mi><mi>N</mi></msub><msub><mi>m</mi><mi>N</mi></msub></mrow><mo>‾</mo></mover><mo>,</mo></mrow></math>]]></maths>这些初始匹配对组成的集合定义为初始匹配集<img file="FSB00000804776500012.GIF" wi="145" he="91" />j为自然数,1<j<N,N为匹配对集<img file="FSB00000804776500013.GIF" wi="119" he="80" />所包含的匹配对数,p<sub>j</sub>、q<sub>j</sub>、m<sub>j</sub>分别表示第j个初始匹配对在等值线C<sub>1</sub>、等值线C<sub>2</sub>、等值线C<sub>3</sub>上所对应的点;第六步,采用加权概率估计模型算法,利用价值函数为角度误差因子和距离误差因子的二次函数,计算初始匹配集中各组数据的代价值,最终获取精确的初始匹配值。 |