发明名称 一种定标器与卫星指向对准的确定方法
摘要 一种定标器与卫星指向对准的确定方法,本发明提出了一种新的设计思路:卫星-地心连线与卫星-有源定标器连线的夹角与卫星视角差最小时,卫星天线波束中心与地球的交点离有源定标器最近,本发明具体步骤:(1)建立坐标系—地球坐标系、地理坐标系和载体坐标系;(2)获取卫星轨道预测数据和有源定标器位置信息;(3)计算卫星与定标器连线的矢量<img file="DDA0000426524710000011.GIF" wi="84" he="71" />和地心与卫星连线的<img file="DDA0000426524710000012.GIF" wi="75" he="72" />的夹角α角;(4)定位卫星位置;(5)将矢量<img file="DDA0000426524710000013.GIF" wi="98" he="83" />转换到载体坐标系<img file="DDA0000426524710000014.GIF" wi="137" he="86" />(6)计算定标器天线相对于定标器自身(载体坐标系)的方位角ψ、俯仰角θ;(7)通过伺服控制系统控制天线按照这两个角转动,实现定标器和卫星对准。本方法依据坐标系转换理论,没有近似误差,对准精度高。
申请公布号 CN103675773B 申请公布日期 2015.10.21
申请号 CN201310636410.0 申请日期 2013.11.29
申请人 西安空间无线电技术研究所 发明人 金阿鑫;段崇棣;薛强;吕爱玲;刘丽霞;王小宁;李浩;谭小敏;陈文新
分类号 G01S7/40(2006.01)I 主分类号 G01S7/40(2006.01)I
代理机构 中国航天科技专利中心 11009 代理人 安丽
主权项 一种定标器与卫星指向对准的确定方法,其特征在于步骤如下:(1)建立地球坐标系、地理坐标系和载体坐标系;所述地球坐标系用ox<sub>e</sub>y<sub>e</sub>z<sub>e</sub>表示,原点为地球中心,z<sub>e</sub>轴与地球自转轴重合,x<sub>e</sub>、y<sub>e</sub>轴在地球赤道平面内,x<sub>e</sub>轴在赤道平面内指向格林威治子午线,y<sub>e</sub>轴指向东经90°方向;所述地理坐标系用ox<sub>g</sub>y<sub>g</sub>z<sub>g</sub>表示,原点为载体重心,x<sub>g</sub>轴指向东,y<sub>g</sub>轴指向北,z<sub>g</sub>轴指向天;地理坐标系相对于地球坐标系的方位关系就是载体的地理位置信息,所述地理位置信息为经度λ和纬度L;所述载体坐标系ox<sub>b</sub>y<sub>b</sub>z<sub>b</sub>表示,原点为载体重心,x<sub>b</sub>轴沿载体横轴向右,y<sub>b</sub>轴沿载体纵轴向前,z<sub>b</sub>轴沿载体立轴向上,该坐标系与载体固连,载体坐标系相对与地理坐标系的角度关系就是载体的俯仰角、横滚角和方位角;(2)获取卫星轨道预测数据和有源定标器位置信息,所述的卫星轨道预测数据包括卫星位置和时间预测信息;卫星某时刻在地球坐标系的位置A的坐标为[x<sub>ae</sub>,y<sub>ae</sub>,z<sub>ae</sub>]<sup>T</sup>,有源定标器在地球坐标系的位置B的坐标为[x<sub>be</sub>,y<sub>be</sub>,z<sub>be</sub>]<sup>T</sup>,o为地球质心;(3)利用步骤(2)中的卫星轨道预测数据和有源定标器位置信息计算得到卫星与定标器连线的矢量<img file="FDA0000426524680000011.GIF" wi="80" he="68" />和地心与卫星连线的矢量<img file="FDA0000426524680000012.GIF" wi="72" he="69" />的夹角α角;所述的α角计算方法如下:矢量<img file="FDA0000426524680000013.GIF" wi="82" he="68" />为:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><mover><mi>BA</mi><mo>&RightArrow;</mo></mover><mo>=</mo><msup><mrow><mo>[</mo><msub><mi>x</mi><mi>ae</mi></msub><msub><mrow><mo>-</mo><mi>x</mi></mrow><mi>be</mi></msub><mo>,</mo><msub><mi>y</mi><mi>ae</mi></msub><msub><mrow><mo>-</mo><mi>y</mi></mrow><mi>be</mi></msub><mo>,</mo><msub><mi>z</mi><mi>ae</mi></msub><msub><mrow><mo>-</mo><mi>z</mi></mrow><mi>be</mi></msub><mo>]</mo></mrow><mi>T</mi></msup><mo>=</mo><msup><mrow><mo>[</mo><msub><mi>x</mi><mi>bae</mi></msub><mo>,</mo><msub><mi>y</mi><mi>bae</mi></msub><mo>,</mo><msub><mi>z</mi><mi>bae</mi></msub><mo>]</mo></mrow><mi>T</mi></msup></mrow>]]></math><img file="FDA0000426524680000014.GIF" wi="1077" he="81" /></maths>矢量<img file="FDA0000426524680000015.GIF" wi="74" he="70" />为:<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><mover><mi>oA</mi><mo>&RightArrow;</mo></mover><mo>=</mo><msup><mrow><mo>[</mo><msub><mi>x</mi><mi>ae</mi></msub><mo>,</mo><msub><mi>y</mi><mi>ae</mi></msub><mo>,</mo><msub><mi>z</mi><mi>ae</mi></msub><mo>]</mo></mrow><mi>T</mi></msup></mrow>]]></math><img file="FDA0000426524680000016.GIF" wi="403" he="81" /></maths><maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><mi>&alpha;</mi><mo>=</mo><mi>arccos</mi><mrow><mo>(</mo><mfrac><mrow><msub><mi>x</mi><mi>bae</mi></msub><msub><mi>x</mi><mi>ae</mi></msub><mo>+</mo><msub><mi>y</mi><mi>bae</mi></msub><msub><mi>y</mi><mi>ae</mi></msub><msub><mrow><mo>+</mo><mi>z</mi></mrow><mi>bae</mi></msub><msub><mi>z</mi><mi>ae</mi></msub></mrow><mrow><msqrt><msubsup><mi>x</mi><mi>bae</mi><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>y</mi><mi>bae</mi><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>z</mi><mi>bae</mi><mn>2</mn></msubsup></msqrt><msqrt><msubsup><mi>x</mi><mi>ae</mi><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>y</mi><mi>ae</mi><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>z</mi><mi>ae</mi><mn>2</mn></msubsup></msqrt></mrow></mfrac><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000426524680000017.GIF" wi="1040" he="177" /></maths>(4)通过计算一轨轨道预测数据中所有卫星位置对应的α角与卫星视角的差,并确定最小差值对应的卫星位置<img file="FDA00004265246800000210.GIF" wi="351" he="68" />(5)将最小差值对应的卫星与定标器连线的矢量<img file="FDA0000426524680000021.GIF" wi="108" he="83" />转换到载体坐标系中:<img file="FDA0000426524680000022.GIF" wi="787" he="89" />其中,<img file="FDA0000426524680000023.GIF" wi="72" he="71" />为地球坐标系转换至地理坐标系的转换矩阵,<img file="FDA0000426524680000024.GIF" wi="68" he="69" />是定标器经纬度的函数:<maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><msubsup><mi>C</mi><mi>e</mi><mi>g</mi></msubsup><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mo>-</mo><mi>sin</mi><mi>&lambda;</mi></mtd><mtd><mi>cos</mi><mi>&lambda;</mi></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mo>-</mo><mi>sin</mi><mi>L</mi><mi>cos</mi><mi>&lambda;</mi></mtd><mtd><mo>-</mo><mi>sin</mi><mi>L</mi><mi>sin</mi><mi>&lambda;</mi></mtd><mtd><mi>cos</mi><mi>L</mi></mtd></mtr><mtr><mtd><mi>cos</mi><mi>L</mi><mi>cos</mi><mi>&lambda;</mi></mtd><mtd><mi>cos</mi><mi>L</mi><mi>sin</mi><mi>&lambda;</mi></mtd><mtd><mi>sin</mi><mi>L</mi></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA0000426524680000025.GIF" wi="1039" he="279" /></maths>载体在地球坐标系中的坐标为:[x<sub>e</sub>,y<sub>e</sub>,z<sub>e</sub>]<sup>T</sup>,则经纬度为:<maths num="0005" id="cmaths0005"><math><![CDATA[<mrow><mi>&lambda;</mi><mo>=</mo><mfenced open='{' close=''><mtable><mtr><mtd><mi>arcsin</mi><mrow><mo>(</mo><mfrac><msub><mi>y</mi><mi>e</mi></msub><msqrt><msubsup><mi>x</mi><mi>e</mi><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>y</mi><mi>e</mi><mn>2</mn></msubsup></msqrt></mfrac><mo>)</mo></mrow></mtd><mtd><msub><mi>x</mi><mi>e</mi></msub><mo>&GreaterEqual;</mo><mn>0</mn></mtd></mtr><mtr><mtd><mi>&pi;</mi><mo>-</mo><mi>arcsin</mi><mrow><mo>(</mo><mfrac><msub><mi>y</mi><mi>e</mi></msub><msqrt><msubsup><mi>x</mi><mi>e</mi><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>y</mi><mi>e</mi><mn>2</mn></msubsup></msqrt></mfrac><mo>)</mo></mrow></mtd><mtd><msub><mi>x</mi><mi>e</mi></msub><mo>&lt;</mo><mn>0</mn></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA0000426524680000026.GIF" wi="756" he="386" /></maths><maths num="0006" id="cmaths0006"><math><![CDATA[<mrow><mi>l</mi><mo>=</mo><mi>arcsin</mi><mrow><mo>(</mo><mfrac><msub><mi>z</mi><mi>e</mi></msub><msqrt><msubsup><mi>x</mi><mi>e</mi><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>y</mi><mi>e</mi><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>z</mi><mi>e</mi><mn>2</mn></msubsup></msqrt></mfrac><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000426524680000027.GIF" wi="538" he="190" /></maths><img file="FDA0000426524680000028.GIF" wi="68" he="84" />为地理坐标系至载体坐标系的转换矩阵:<maths num="0007" id="cmaths0007"><math><![CDATA[<mfenced open='' close=''><mtable><mtr><mtd><msubsup><mi>C</mi><mi>g</mi><mi>b</mi></msubsup><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>cos</mi><mi>&gamma;</mi></mtd><mtd><mn>0</mn></mtd><mtd><mo>-</mo><mi>sin</mi><mi>&gamma;</mi></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mi>sin</mi><mi>&gamma;</mi></mtd><mtd><mn>0</mn></mtd><mtd><mi>cos</mi><mi>&gamma;</mi></mtd></mtr></mtable></mfenced><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><mi>cos</mi><mi>&theta;</mi></mtd><mtd><mi>sin</mi><mi>&theta;</mi></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mo>-</mo><mi>sin</mi><mi>&theta;</mi></mtd><mtd><mi>cos</mi><mi>&theta;</mi></mtd></mtr></mtable></mfenced><mfenced open='[' close=']'><mtable><mtr><mtd><mi>cos</mi><mi>&psi;</mi></mtd><mtd><mi>sin</mi><mi>&psi;</mi></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mo>-</mo><mi>sin</mi><mi>&psi;</mi></mtd><mtd><mi>cos</mi><mi>&psi;</mi></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced></mtd></mtr><mtr><mtd><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>cos</mi><mi></mi><mi>&gamma;</mi><mi>cos</mi><mi>&psi;</mi><mo>-</mo><mi>sin</mi><mi></mi><mi>&gamma;</mi><mi>sin</mi><mi></mi><mi>&theta;</mi><mi>sin</mi><mi>&psi;</mi></mtd><mtd><mi>cos</mi><mi></mi><mi>&gamma;</mi><mi>sin</mi><mi>&psi;</mi><mo>+</mo><mi>sin</mi><mi></mi><mi>&gamma;</mi><mi>sin</mi><mi></mi><mi>&theta;</mi><mi>cos</mi><mi>&psi;</mi></mtd><mtd><mo>-</mo><mi>sin</mi><mi></mi><mi>&gamma;</mi><mi>cos</mi><mi>&theta;</mi></mtd></mtr><mtr><mtd><mo>-</mo><mi>cos</mi><mi></mi><mi>&theta;</mi><mi>sin</mi><mi>&psi;</mi></mtd><mtd><mi>cos</mi><mi></mi><mi>&theta;</mi><mi>cos</mi><mi>&psi;</mi></mtd><mtd><mi>sin</mi><mi>&theta;</mi></mtd></mtr><mtr><mtd><mi>sin</mi><mi></mi><mi>&gamma;</mi><mi>cos</mi><mi>&psi;</mi><mo>+</mo><mi>cos</mi><mi></mi><mi>&gamma;</mi><mi>sin</mi><mi></mi><mi>&theta;</mi><mi>sin</mi><mi>&psi;</mi></mtd><mtd><mi>sin</mi><mi></mi><mi>&gamma;</mi><mi>sin</mi><mi>&psi;</mi><mo>-</mo><mi>cos</mi><mi></mi><mi>&gamma;</mi><mi>sin</mi><mi></mi><mi>&theta;</mi><mi>cos</mi><mi>&psi;</mi></mtd><mtd><mi>cos</mi><mi></mi><mi>&gamma;</mi><mi>cos</mi><mi>&theta;</mi></mtd></mtr></mtable></mfenced></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000426524680000029.GIF" wi="1424" he="512" /></maths>其中,ψ为载体的方位角、θ为俯仰角、γ为横滚角;(6)利用步骤(5)中得到的结果计算得到最终定标器天线相对于定标器自身的方位角<img file="FDA00004265246800000211.GIF" wi="49" he="52" />、俯仰角β;方位角ψ、俯仰角β计算方法如下:<img file="FDA0000426524680000031.GIF" wi="1084" he="614" /><maths num="0008" id="cmaths0008"><math><![CDATA[<mrow><mi>&beta;</mi><mo>=</mo><mi>arcsin</mi><mrow><mo>(</mo><mfrac><msub><mi>z</mi><mrow><msub><mi>ba</mi><mn>0</mn></msub><mi>b</mi></mrow></msub><msqrt><msubsup><mi>x</mi><mrow><msub><mi>ba</mi><mn>0</mn></msub><mi>b</mi></mrow><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>y</mi><mrow><msub><mi>ba</mi><mn>0</mn></msub><mi>b</mi></mrow><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>z</mi><mrow><msub><mi>ba</mi><mn>0</mn></msub><mi>b</mi></mrow><mi>b</mi></msubsup></msqrt></mfrac><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000426524680000032.GIF" wi="673" he="201" /></maths>(7)利用步骤(6)中得到定标器天线相对于定标器的方位角ψ、俯仰角β,通过伺服控制系统控制天线按照这两个角转动,实现定标器和卫星对准。
地址 710100 陕西省西安市长安区西街150号