一种基于矢量匹配的多敏感器星上自主互校验方法
【技术领域】
[0001] 本发明属于航天器姿态测量技术领域，涉及一种利用卫星上多个敏感器输出的测 量数据，采用矢量（日、地、光轴等)匹配原理进行互校验的方法。
【背景技术】
[0002] 正确的姿态能够保证卫星的能源、能够保证测控及载荷天线的指向，是卫星能否 正常执行任务的先决条件。卫星上获取姿态信息采用的敏感器主要有星敏感器、太阳敏感 器、地球敏感器以及陀螺等，可利用单个敏感器或敏感器组合确定卫星姿态。所以敏感器测 量信息的正确性尤为重要，其直接决定了卫星姿态的正确性。
[0003] 通常，卫星都采用阈值或滤波等方法对单个敏感器的数据进行处理，剔除敏感器 输出的异常值或野值。但是对于敏感器的缓变故障信号，目前星上无法利用敏感器自身数 据进行自主正确性判断。不同敏感器之间是异构关系，出现同样故障的概率较小，因此，可 以利用多个敏感器的信息进行相互校验，判断敏感器输出的正确性。
【发明内容】
[0004] 本发明所要解决的技术问题是，如何设计一种可在星上使用的多敏感器互校验方 法，据此可以判断各敏感器输出信息的正确性，确保控制系统获取正确的卫星姿态信息。
[0005] 为了解决上述问题，本发明提出了一种基于矢量匹配的多敏感器互校验方法，所 述卫星上包括多种敏感器(星敏感器、太阳敏感器、地球敏感器以及陀螺），互校验方法包括 如下步骤:步骤一、对各姿态敏感器的输出数据进行有效性自判断；步骤二、利用光轴矢量 匹配法进行多个星敏间的互校验;步骤三、利用太阳矢量匹配法进行星敏与太敏的互校验； 步骤四、利用地心矢量匹配法进行星敏与地敏的互校验;步骤五、利用角速度矢量匹配法进 行星敏与陀螺的互校验;步骤六、利用日地夹角匹配法进行地敏与太敏的互校验。
[0006] 可选的，步骤一中，对敏感器输出数据进行有效性判断，是结合单机特性，对于明 显不符合逻辑和超范围数据或单机自身判断异常数据进行剔除，将本次无效数据进行标 识。自判断为正确的敏感器进行后续互校验。
[0007] 可选的，步骤二中，首先，利用星敏输出的姿态四元数计算星敏光轴矢量，之后计 算每个光轴矢量之间的夹角；由于星敏光轴间的夹角在星敏安装于卫星星体上之后即为固 定值，将安装后地面测量的夹角装订在星上，利用装订夹角与相应的测量夹角进行匹配，即 相应夹角作差，判断差值是否小于指定的阈值，如果差值小于阈值，则匹配结果正确，参与 计算夹角的星敏输出正确。
[0008] 可选的，步骤三中，首先，利用星敏输出的姿态四元数计算惯性系到卫星本体系的 转换矩阵，利用太阳模型计算当前惯性系下的太阳矢量，之后利用转换矩阵将太阳矢量转 到卫星本体系；然后，利用太敏测量输出计算本体系太阳矢量;最后，将计算得到的同为卫 星本体系下的太阳矢量进行匹配运算，即计算相应矢量的夹角，判断夹角是否小于指定的 阈值，如果夹角小于阈值，则匹配结果正确，参与计算的星敏和太敏输出正确。
[0009]可选的，步骤四中，首先，利用星敏输出的姿态四元数计算惯性系到卫星本体系的 转换矩阵，利用轨道信息计算惯性系下地心矢量，之后利用转换矩阵将地心矢量转到卫星 本体系；然后，利用地敏测量输出计算本体系地心矢量;最后，将计算得到的同为卫星本体 系下的地心矢量进行匹配运算，即计算相应矢量的夹角，判断夹角是否小于指定的阈值，如 果夹角小于阈值，则匹配结果正确，参与计算的星敏和地敏输出正确。
[0010]可选的，步骤五中，利用星敏与陀螺输出的角速度矢量进行匹配运算，即利用角速 度矢量在卫星本体系的三个投影分别进行差值运算，差值均小于指定阈值则匹配结果正 确，星敏和陀螺输出正确。
[0011]可选的，步骤六中，首先，利用太阳模型计算当前惯性系下的太阳矢量，利用轨道 信息计算惯性系下地心矢量，求出两个矢量的夹角;然后，分别利用太敏和地敏的输出计算 本体系下太阳矢量和地心矢量并计算夹角；最后，计算夹角差值，如小于指定阈值，则地敏 和太敏输出正确。
[0012] 按照上述步骤，可以校验出正确的敏感器，实际应用中，通常根据敏感器的可靠性 进行互校验优先级排序，可靠性高的敏感器优先级高并先进行互校验，互校验正确的高优 先级敏感器可在与低优先级敏感器互校验时对其进行错误判断，即如果匹配结果不正确， 该敏感器输出异常。
[0013] 本发明的优点在于，充分利用星上的各种信息，采用简单、可靠的匹配方法实现了 各敏感器间数据的互校验，通过合理选择匹配阈值，能够在星上实时地、准确地给出敏感器 输出信息的校验结果。
【附图说明】
[0014] 图1所示是本发明【具体实施方式】所提供的敏感器互相校验流程图。
[0015] 图2所示是模拟太敏互校验标志。
[0016] 图3所示是模拟太敏受反照时定姿太阳矢量偏差的结果。
【具体实施方式】
[0017] 下面以某卫星在轨敏感器互校验的实际应用情况为典型实例，详细说明本发明的
【具体实施方式】。所述卫星上配置3台星敏、2台陀螺、3台太敏以及1台地敏，按照各敏感器的 可靠性对互校验优先级从高到低排序如下，星敏、太敏、地敏、陀螺。匹配阈值根据各敏感器 的测量及安装精度、同时考虑一定余量后适当选取。按照图1所示的流程进行敏感器互校 验。
[0018] 步骤一、敏感器输出有效性自判断。
[0019] 对敏感器输出数据进行有效性判断。结合单机特性，对于明显不符合逻辑或者超 范围数据以及单机自身判断异常数据进行剔除，并将无效数据进行标识。星敏采用单机输 出的有效性标志进行标识;太敏、地敏、陀螺均采用阈值法对输出进行判断，超过阈值的标 识为异常。
[0020] 步骤二、进行星敏间的互校验
[0021] 根据步骤一结果，如两个或以上星敏有效，则进行星敏互校验。具体步骤如下： [0022]①计算惯性系下星敏光轴矢量
[0023] 根据星敏输出姿态四元数QS1可以得到星敏坐标系相对惯性系的转换矩阵RS1，计 算方法为：
[0024] Qsi = qii+q2j+q3k+q4
[0025]
[0026] & % + .(? -办-（? "4.1 =. 2(?.?? - (64?.) I31 - 2 (q3Qi+Q4Q2)
[0027] Ii2 = 2(qiq2+q4q3) 4 -务 + € _ Λ: := 2(?% - <7而）
[0028] Ii3 = 2(qiq3_q4q2) I23 = 2(q2q3+q4qi) 4b =. W - :?2 - € + ￥
[0029] 星敏光轴在星敏坐标系下矢量为L，
[0030]
[0031] 贝IJ星敏光轴在惯性系矢量:U = RsiTL。
[0032] ②计算光轴矢量夹角
[0033] 利用惯性系光轴矢量计算姿态数据有效的任意两个星敏光轴矢量夹角cu，
[0034]
[0035]③进行夹角匹配
[0036]星上预置有在卫星安装阶段测量得到的各星敏光轴间夹角。将?中计算得到的夹 角与预置夹角进行匹配（即计算夹角差值），匹配阈值设置为2°，如果夹角差小于等于阈值， 则相应星敏输出正确。如果夹角差大于阈值，则本步无法判断星敏输出正确性，需通过后续 互校验步骤判断。
[0037]步骤三、进行星敏和太敏互校验
[0038] (1)若通过步骤二能够校验出正确的星敏，则利用正确星敏校验太敏，校验方法如 下：
[0039] ①利用星敏