主权项 |
一种星敏感器姿态稳定跟踪的方法,其特征在于步骤如下:1)星敏感器得到新的一帧跟踪模式星图信息后,进行星点提取和匹配识别,得到识别队列IR,所述的识别队列IR中包括各导航星点的导航星号GSId和像面提取坐标信息;2)获取跟踪列表TL中的下一个节点TLn;所述的跟踪列表TL为之前每帧积累的跟踪列表,包括跟踪星数tsn、定姿星数qsn以及每个跟踪列表节点的导航星号GSId、连续丢失次数LostCycles、跟踪次数TrackedCycles和该节点是否可用于定姿的标志FlgUseToCalc;3)取识别队列IR中的下一个导航星IRn;4)比较TLn的导航星号TLn.GSId与导航星IRn的导航星号IRn.GSId是否相等,若相等,将此导航星从识别队列IR中剔除,则执行步骤6);否则,执行步骤5);5)判断识别队列IR中所有导航星是否提取结束,若是,则执行步骤7);否则,执行步骤3);6)跟踪列表节点TLn的跟踪次数TLn.TrackedCycles加一,连续丢失次数TLn.LostCycles置0,判断若TLn.TrackedCycles大于等于跟踪阈值minNumForTracked,则置此节点的定姿标志FlgUseToCalc为真,否则置此节点的定姿标志FlgUseToCalc为非真;判断结束后执行步骤8);其中minNumForTracked为正整数;7)判断跟踪列表节点TLn的连续丢失次数TLn.LostCycles是否大于等于丢失阈值maxNumForLosted,若是,清空该跟踪列表节点,即把该节点置为NullTLNode;否则,TLn.LostCycles加一,置此节点的定姿标志FlgUseToCalc为非真,执行步骤8);其中maxNumForLosted为正整数;8)判断跟踪列表中所有节点是否提取结束,若是,执行步骤9);否则,返回步骤2);9)用识别队列IR中剩余的导航星信息填充跟踪列表TL中被清空的节点,上述被填充节点的连续丢失次数置为0,跟踪次数置为1,定姿标志置为非真;10)计算获得跟踪列表TL中非空节点数A,将跟踪列表TL的跟踪星数tsn置为A;计算获得跟踪定姿标志为真的节点数B,将跟踪列表的定姿星数qsn置为B;11)使用跟踪列表TL中定姿标志为真的节点导航星信息完成星敏感器本帧的姿态解算和稳定跟踪。 |