发明名称 基于CCD星敏感器的对准方法
摘要 本发明提供的是一种基于CCD星敏感器的对准方法。(1)采集CCD星敏感器的输出;(2)采集提供当地位置信息的设备信息,得到地球坐标系即e系相对于导航坐标系即n系的转换矩阵<img file="dsa00000188862500011.GIF" wi="77" he="53" />所述位置信息包括经度和纬度;(3)求解地球坐标系即e系相对于i系之间的转换矩阵<img file="dsa00000188862500012.GIF" wi="76" he="52" />(4)通过(1)、(2)、(3)所给出的信息,解算得到姿态矩阵,解算出姿态信息。本方法是一种依靠误差不随着时间的推移而发散的姿态传感器进行的初始对准,各类误差源确定,误差值不变,短时间内可以达到稳定的对准结果。
申请公布号 CN101943584B 申请公布日期 2012.05.09
申请号 CN201010215336.1 申请日期 2010.07.02
申请人 哈尔滨工程大学 发明人 高伟;付建楠;张鑫;奔粤阳;徐博;周广涛;于强;张永刚;吴晓;王秋滢
分类号 G01C25/00(2006.01)I;G01C21/16(2006.01)I;G01C21/18(2006.01)I 主分类号 G01C25/00(2006.01)I
代理机构 代理人
主权项 1.一种基于CCD星敏感器的对准方法,其特征是主要包括下列步骤:(1)采集CCD星敏感器的输出:CCD星敏感器的坐标系相对于惯性坐标系即i系之间的姿态信息<img file="FSB00000685034800011.GIF" wi="77" he="59" />惯性坐标系即i系与船舶载体坐标系即b系之间的转换矩阵:<maths num="0001"><![CDATA[<math><mrow><msubsup><mi>C</mi><mi>i</mi><mi>b</mi></msubsup><mo>=</mo><msubsup><mi>C</mi><mi>s</mi><mi>b</mi></msubsup><msubsup><mi>C</mi><mi>i</mi><mi>s</mi></msubsup><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow></math>]]></maths>其中:<img file="FSB00000685034800013.GIF" wi="56" he="85" />为CCD星敏感器坐标系即s系与船舶载体坐标系即b系之间的转换矩阵,在导航设备装船时通过光学瞄准精确获得;将天球坐标系O-UVW按照先绕W轴逆时针转w角,得到O-U<sub>1</sub>V<sub>1</sub>W<sub>1</sub>坐标系,再绕U<sub>1</sub>逆时针转u角,使W<sub>1</sub>轴与Z<sub>s</sub>重合,得到O-U<sub>2</sub>V<sub>2</sub>W<sub>2</sub>坐标系,最后再绕W<sub>2</sub>轴逆时针旋转v角,得到O<sub>s</sub>-U<sub>s</sub>V<sub>s</sub>W<sub>s</sub>坐标系,<maths num="0002"><![CDATA[<math><mrow><msubsup><mi>C</mi><mi>i</mi><mi>s</mi></msubsup><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>cos</mi><mi>w</mi><mi>cos</mi><mi>v</mi><mo>-</mo><mi>sin</mi><mi>w</mi><mi>sin</mi><mi>v</mi><mi>cos</mi><mi>u</mi></mtd><mtd><mi>sin</mi><mi>w</mi><mi>cos</mi><mi>v</mi><mo>+</mo><mi>cos</mi><mi>w</mi><mi>sin</mi><mi>v</mi><mi>cos</mi><mi>u</mi></mtd><mtd><mi>sin</mi><mi>v</mi><mi>sin</mi><mi>u</mi></mtd></mtr><mtr><mtd><mo>-</mo><mi>cos</mi><mi>w</mi><mi>sin</mi><mi>v</mi><mo>-</mo><mi>sin</mi><mi>w</mi><mi>cos</mi><mi>v</mi><mi>cos</mi><mi>u</mi></mtd><mtd><mo>-</mo><mi>sin</mi><mi>w</mi><mi>sin</mi><mi>v</mi><mo>+</mo><mi>cos</mi><mi>w</mi><mi>cos</mi><mi>v</mi><mi>cos</mi><mi>u</mi></mtd><mtd><mi>cos</mi><mi>v</mi><mi>sin</mi><mi>u</mi></mtd></mtr><mtr><mtd><mi>sin</mi><mi>w</mi><mi>sin</mi><mi>u</mi></mtd><mtd><mo>-</mo><mi>cos</mi><mi>w</mi><mi>sin</mi><mi>u</mi></mtd><mtd><mi>cos</mi><mi>u</mi></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow><mo>;</mo></mrow></math>]]></maths>(2)采集当地位置信息即经度λ和纬度<img file="FSB00000685034800015.GIF" wi="55" he="52" />得到地球坐标系即e系相对于导航坐标系即n系的转换矩阵<img file="FSB00000685034800016.GIF" wi="111" he="86" /><maths num="0003"><![CDATA[<math><mrow><msubsup><mi>C</mi><mi>e</mi><mi>n</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></mi><mi>&phi;</mi><mi>cos</mi><mi>&lambda;</mi></mtd><mtd><mo>-</mo><mi>sin</mi><mi></mi><mi>&phi;</mi><mi>sin</mi><mi>&lambda;</mi></mtd><mtd><mi>cos</mi><mi>&phi;</mi></mtd></mtr><mtr><mtd><mi>cos</mi><mi></mi><mi>&phi;</mi><mi>cos</mi><mi>&lambda;</mi></mtd><mtd><mi>cos</mi><mi></mi><mi>&phi;</mi><mi>sin</mi><mi>&lambda;</mi></mtd><mtd><mi>sin</mi><mi>&phi;</mi></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow><mo>;</mo></mrow></math>]]></maths>(3)求解地球坐标系即e系相对于惯性坐标系即i系之间的转换矩阵<img file="FSB00000685034800018.GIF" wi="49" he="51" /><maths num="0004"><![CDATA[<math><mrow><msubsup><mi>C</mi><mi>i</mi><mi>e</mi></msubsup><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>cos</mi><mrow><mo>(</mo><msub><mi>A</mi><mi>j</mi></msub><mo>+</mo><msub><mi>w</mi><mi>ie</mi></msub><mo>&CenterDot;</mo><mi>t</mi><mo>)</mo></mrow></mtd><mtd><mi>sin</mi><mrow><mo>(</mo><msub><mi>A</mi><mi>j</mi></msub><mo>+</mo><msub><mi>w</mi><mi>ie</mi></msub><mo>&CenterDot;</mo><mi>t</mi><mo>)</mo></mrow></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mo>-</mo><mi>sin</mi><mrow><mo>(</mo><msub><mi>A</mi><mi>j</mi></msub><mo>+</mo><msub><mi>w</mi><mi>ie</mi></msub><mo>&CenterDot;</mo><mi>t</mi><mo>)</mo></mrow></mtd><mtd><mi>cos</mi><mrow><mo>(</mo><msub><mi>A</mi><mi>j</mi></msub><mo>+</mo><msub><mi>w</mi><mi>ie</mi></msub><mo>&CenterDot;</mo><mi>t</mi><mo>)</mo></mrow></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><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>4</mn><mo>)</mo></mrow></mrow></math>]]></maths>w<sub>ie</sub>为地球自转角速度,t是世界标准时间系统提供的具体时间,A<sub>j</sub>是初始位置即经度和纬度与春分点之间的夹角;<maths num="0005"><![CDATA[<math><mrow><msubsup><mi>C</mi><mi>i</mi><mi>b</mi></msubsup><mo>=</mo><msubsup><mi>C</mi><mi>n</mi><mi>b</mi></msubsup><msup><msubsup><mi>C</mi><mi>e</mi><mi>n</mi></msubsup><mo>&prime;</mo></msup><msubsup><mi>C</mi><mi>i</mi><mi>e</mi></msubsup><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>5</mn><mo>)</mo></mrow></mrow></math>]]></maths>在(5)中,<img file="FSB00000685034800022.GIF" wi="50" he="76" />由(1)式提供,<img file="FSB00000685034800023.GIF" wi="80" he="58" />由(4)计算得,地球坐标系即e系相对于导航坐标系即n系的转换矩阵<img file="FSB00000685034800024.GIF" wi="83" he="57" />通过载体所在的地理坐标所确定,由于地理精度存在着一些偏差,如果不考虑这些误差时,则:<maths num="0006"><![CDATA[<math><mrow><msup><msubsup><mi>C</mi><mi>e</mi><mi>n</mi></msubsup><mo>&prime;</mo></msup><mo>=</mo><msubsup><mi>C</mi><mi>e</mi><mi>n</mi></msubsup><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>6</mn><mo>)</mo></mrow></mrow></math>]]></maths>通过(5)式得姿态矩阵<img file="FSB00000685034800026.GIF" wi="84" he="96" />快速的完成初始对准。
地址 150001 黑龙江省哈尔滨市南岗区南通大街145号哈尔滨工程大学科技处知识产权办公室