主权项 |
一种面向编队飞行的相对导航测速方法,其特征在于:基于相对速度测量模型进行相对导航测速,包括以下步骤,步骤A1,获得每个航天器与各导航星之间的相对速度,设编队飞行的两个航天器分别记为航天器0和航天器1,记v<sub>D0</sub>和v<sub>D1</sub>分别为航天器0和1相对于某颗导航星的速度;步骤A2,计算航天器0和1相对于每颗导航星的速度之间的差值如下,<img file="FDA0000990336470000011.GIF" wi="1443" he="72" />其中,l=1,2,..., L,L为导航星的数量,<img file="FDA0000990336470000012.GIF" wi="57" he="59" />为航天器0和1相对于第l颗导航星的相应速度v<sub>D0</sub>、v<sub>D1</sub>之间的差值;s<sup>l</sup>为第l颗导航星的方位矢量,v<sub>0</sub>和v<sub>1</sub>分别是航天器0和航天器1的速度矢量,<img file="FDA0000990336470000013.GIF" wi="54" he="63" />为第l颗导航星的测量噪声;步骤A3,建立基于星光多普勒的相对速度测量模型如下,Y<sup>s</sup>(t)=h<sup>s</sup>(X,t)+ω<sub>v</sub> 式二其中,相对速度测量值Y<sup>s</sup> ,相对速度测量函数h<sup>s</sup> 以及测量噪声矢量ω<sub>v</sub>的定义分别为,<img file="FDA0000990336470000014.GIF" wi="1350" he="83" />h<sup>s</sup>(X,t)=[s<sup>1</sup>·(v<sub>0</sub>‑v<sub>1</sub>),s<sup>2</sup>·(v<sub>0</sub>‑v<sub>1</sub>),…,s<sup>L</sup>·(v<sub>0</sub>‑v<sub>1</sub>)]<sup>T</sup> 式四<img file="FDA0000990336470000015.GIF" wi="1275" he="83" />其中,Y<sup>s</sup>(t)为时刻t的相对速度测量值,<img file="FDA0000990336470000016.GIF" wi="275" he="59" />为航天器0和1相对于第1,2,...,L颗导航星的速度;X为编队飞行的状态矢量,h<sup>s</sup>(X,t)为时刻t与状态矢量X相应的相对速度测量函数值,s<sup>1</sup>,s<sup>2</sup>,…,s<sup>L</sup>为第1,2,...,L颗导航星的方位矢量,<img file="FDA0000990336470000017.GIF" wi="262" he="63" />为第1,2,...,L颗导航星的测量噪声。 |