一种基于索引的敏感器数据选用控制方法技术

本发明专利技术一种基于索引的敏感器数据选用控制方法，步骤如下：(1)对同一类敏感器安装的各个组件建立编号索引，结合敏感器测量数据，完成卫星定姿控制；(2)通过自诊断方式判断出当前选用组件的健康状态，组件编号索引对应的健康状态将作为下一个控制周期确定选用组件构型及其编号索引集合的依据，进而完成下一个控制周期的定姿控制。本发明专利技术通过为每个敏感器组件设定索引，并形成一个选用敏感器组件的索引集合及其位选标志量，基于选用组件集合和设定的位选标志实现姿态确定及控制并完成异常判断与处理，从而大大拓展了算法实现的灵活性和可扩展性。

【技术实现步骤摘要】
一种基于索引的敏感器数据选用控制方法
本专利技术是属于航天嵌入式软件设计领域，涉及一种基于索引的敏感器数据选用控制方法。
技术介绍
航天器在轨一般要求具有高精度姿态确定能力以及高精度、高稳定度的姿态控制能力，而且往往需要硬件的冗余备份，以期实现航天器的长寿命和高可靠运行。为此，航天器上每一类组件(如敏感器)均安装了多个，以实现故障情况下组件的诊断及替换，提高航天器在轨姿轨控能力和可靠性。以某航天器的陀螺敏感器为例，陀螺组件以航天器的OZ轴为锥面中心，以54°44′08″为锥面半锥角的方式安装了9个。在定姿过程中，可根据情况选用其中的任意3～9个进行定姿计算。在定姿计算前，都要根据所选用的陀螺确定安装矩阵完成定姿过程。在陀螺的异常判断过程中，任一个陀螺是否存在异常均采用其余选用陀螺合成的姿态结果来判断，在这种设计策略下，在确定选用的N个陀螺(3<＝N<＝9)中任意M(3<＝M<N)个陀螺均需要组合进行姿态计算，以完成对陀螺异常判断的覆盖性和有效性。如果某个陀螺出现异常，则不再选用该陀螺。这种工况下所选用陀螺的个数及其构成的安装阵随时可能发生变化。针对这种敏感器数据源组合随时变化的工况及其算法实现问题，以往单纯采用引用标志的方式，确定敏感器数据源组合进而完成计算的设计策略，在组件异常判断及组件选用组合发生变化的情况下，缺乏灵活性和扩展性，从软件实现的角度，其算法实现的效率也不高。
技术实现思路
本专利技术解决的技术问题：针对敏感器数据源组合随时变化的工况及其算法实现问题，提供一种基于索引的敏感器数据选用控制方法，通过为每个敏感器组件设定索引，并形成一个选用敏感器组件的索引集合及其位选标志量，基于选用组件集合和设定的位选标志实现姿态确定及控制并完成异常判断与处理，从而大大拓展了算法实现的灵活性和可扩展性。本专利技术的技术方案：一种基于索引的敏感器数据选用控制方法，步骤如下：(1)对同一类敏感器安装的各个组件建立编号索引，每个控制周期处理前确定所选用的组件数目及构型，建立所选用组件的编号索引集合；根据选用组件的索引集合确定选用构型下的敏感器安装矩阵，结合敏感器测量数据，完成卫星定姿控制；(2)利用所选用组件的构型及其编号索引集合，通过自诊断方式判断出当前选用组件的健康状态，组件编号索引对应的健康状态将作为下一个控制周期确定选用组件构型及其编号索引集合的依据，进而完成下一个控制周期的定姿控制。所述步骤(1)中的具体方法如下：(11)对同一类敏感器安装的所有组件进行编号0,1…,(MAX-1)，并获取每一个组件在卫星本体上的1×3安装矢量ri，0≤i≤(MAX-1)，其中MAX为该类型敏感器组件安装的数目；(12)每个控制周期通过读取敏感器组件的状态或组件选用条件来确定当前选用的组件构型，形成一个组件选用的标志F；在标志F中选定MAX个bit位，每一个bit位代表一个组件的选用状态；(13)根据步骤(12)确定的组件构型F，建立所选用组件的编号索引集合gSelflg，在索引集合gSelflg中顺序存储了当前所有选用组件的编号索引，并记录组件选用个数为gSelcnt(gSelcnt≥3)；(14)根据步骤(13)确定的索引集合gSelflg，建立gSelcnt×3的组件安装矩阵R，所述组件安装矩阵R由gSelcnt个选用组件的1×3安装矢量rj构成，其中j为索引集合gSelflg中的元素；构建gSelcnt×1的敏感器测量数据矩阵G，测量数据矩阵G的gSelcnt个元素作为gSelcnt个选用组件的输入测量数据；基于安装矩阵R和测量数据矩阵G完成卫星定姿控制。所述步骤(2)中通过自诊断方式判断出当前选用组件的健康状态的具体方法为：如果当前选用构型不存在异常，则当前所选用组件均为健康状态，否则依次判断出索引集合中的选用组件是否存在异常，如果判断出索引集合中某个组件存在异常，则将该异常组件编号索引对应的健康状态置为不健康，否则为健康状态。所述步骤(2)的具体方法如下：(21)判断选用组件的构型F是否存在异常，即对索引集合gSelflg中每一个选用组件i判断是否满足如下公式：|ri·Angi_-gi|<Llimit(a)其中ri为组件i在卫星本体上的1×3安装矢量，Angi_为除选用组件i外的其余所有选用组件按照步骤(1)的方式以新的组件选用构型Fi_计算的定姿结果；所述Fi_是将构型F中选用组件i的bit位状态置为未选用状态；gi为选用组件i的输入测量数据，0≤i≤(MAX-1)，Llimit为设定的异常诊断阈值，如果每一个选用组件均满足公式(a)，则当前选用组件的构型无异常，执行步骤(23)，否则执行步骤(22)；(22)依次对索引集合gSelflg中的选用组件i进行异常判断。选用组件i的异常判断是通过除组件i外的其余选用组件实现的，即对每一个除组件i外的选用组件s以如下公式来判断：|rs·Angis_-gs|<Llimit(b)其中rs为组件s在卫星本体上的1×3安装矢量，Angis_为除选用组件i和选用组件s外的其余所有选用组件按照步骤(1)的方式以新的组件选用构型Fis_计算的定姿结果；所述Fis_是将构型F中选用组件i和选用组件s的bit位状态置为未选用状态；gs为选用组件s的输入测量数据，0≤i≤(MAX-1)，0≤s≤(MAX-1)，Llimit为设定的异常诊断阈值，如果除组件i外的其余选用组件均满足公式(b)，则组件i存在异常，将其编号索引i对应的健康状态置为不健康，否则为健康状态；(23)对当前选用组件的构型F异常判断后，索引集合gSelflg中的每一个选用组件对应的健康状态将作为下一个控制周期确定选用组件构型及其编号索引集合gSelflg的依据，进而完成下一个控制周期的定姿控制。本专利技术与现有技术相比的优点在于：(1)通过基于索引的敏感器数据选用控制方法，对敏感器的选用组件建立编号索引集合，使用bit位表征组件的任意组合，有效的适应了敏感器数据源组合随时变化的工况及其算法实现问题，拓展了算法实现的灵活性和可扩展性。(2)基于索引的敏感器数据选用控制方法，通过bit位的位移量循环判等，简化了选用组件相互异常判断的软件设计和实现，有利于代码的模块化。通过以位选标志为特征，保存相关组件构型的定姿结果，便于实现空间换时间，提高了算法运行效率。(3)该方法已经在多个航天器软件姿态确定与控制中得到了应用，不仅适用于敏感器组件，同时也适用于控制器组件，经工程实施验证了该方法的可行性和有效性。附图说明图1是基于索引的敏感器数据选用控制方法流程图。具体实施方式下面结合附图对本方法做进一步说明。本专利技术的一种基于索引的敏感器数据选用控制方法，主要是面向但不限于敏感器组件的航天器嵌入式软件设计方法。内容包括：通过对敏感器各组件建立编号索引，每个控制周期处理前确定所选用的组件构型F，即位选标志，建立所选用组件的索引集合，确定组件选用构型F下的组件安装矩阵，完成定姿控制，在组件异常判断时，利用设定的组件构型位选标志结合选用组件的索引集合依次实现每个选用组件被其余组件诊断的功能。本专利技术的实现方法如下：(1)对安装的一类敏感器的所有组件进行编号：0..(MAX-1)，并获取每一个组件在卫星本体上的1本文档来自技高网...

【技术保护点】
一种基于索引的敏感器数据选用控制方法，其特征在于步骤如下：(1)对同一类敏感器安装的各个组件建立编号索引，结合敏感器测量数据，完成卫星定姿控制；(2)通过自诊断方式判断出当前选用组件的健康状态，组件编号索引对应的健康状态将作为下一个控制周期确定选用组件构型及其编号索引集合的依据，进而完成下一个控制周期的定姿控制。

【技术特征摘要】
1.一种基于索引的敏感器数据选用控制方法，其特征在于步骤如下：(1)对同一类敏感器安装的各个组件建立编号索引，结合敏感器测量数据，完成卫星定姿控制；(2)通过自诊断方式判断出当前选用组件的健康状态，组件编号索引对应的健康状态将作为下一个控制周期确定选用组件构型及其编号索引集合的依据，进而完成下一个控制周期的定姿控制。2.根据权利要求1所述的一种基于索引的敏感器数据选用控制方法，其特征在于：所述步骤(1)的具体方法为：(11)对同一类敏感器安装的各个组件建立编号索引，每个控制周期处理前确定所选用的组件数目及构型，建立所选用组件的编号索引集合；(12)根据选用组件的索引集合确定选用构型下的敏感器安装矩阵，结合敏感器测量数据，完成卫星定姿控制。3.根据权利要求1或2所述的一种基于索引的敏感器数据选用控制方法，其特征在于：所述步骤(2)中通过自诊断方式判断出当前选用组件的健康状态的具体方法为：如果当前选用构型不存在异常，则当前所选用组件均为健康状态，否则依次判断出索引集合中的选用组件是否存在异常，如果判断出索引集合中某个组件存在异常，则将该异常组件编号索引对应的健康状态置为不健康，否则为健康状态。4.根据权利要求2所述的一种基于索引的敏感器数据选用控制方法，其特征在于：所述步骤(11)的具体方法如下：(111)对同一类敏感器安装的所有组件进行编号0,1…,(MAX-1)，并获取每一个组件在卫星本体上的1×3安装矢量ri，0≤i≤(MAX-1)，其中MAX为该类型敏感器组件安装的数目；(112)每个控制周期通过读取敏感器组件的状态或组件选用条件来确定当前选用的组件构型，形成一个组件选用的标志F；在标志F中选定MAX个bit位，每一个bit位代表一个组件的选用状态；(113)根据步骤(12)确定的组件构型F，建立所选用组件的编号索引集合gSelflg，在索引集合gSelflg中顺序存储了当前所有选用组件的编号索引，并记录组件选用个数为gSelcnt。5.根据权利要求4所述的一种基于索引的敏感器数据选用控制方法，其特征在于：所述步骤(12)的具体方法如下：根据确定的索引集合gSelflg，建立gSelcnt×3的组件安装矩阵R，所述组件安装矩阵R由gSelcnt个选用组件的1×3安装矢量rj构成，其中j为索引集合gSelflg中的元素；构建gSelcnt×1的敏感器测量数据矩阵G，测量...

【专利技术属性】
技术研发人员：李振松，杜建伟，索旭华，党纪红，周中泽，李光旭，柴志，王裙，刘新彦，
申请(专利权)人：北京控制工程研究所，
类型：发明
国别省市：北京,11