CN108803307A - 一种主动指向超静平台自主故障诊断与容错控制方法及系统 - Google Patents
一种主动指向超静平台自主故障诊断与容错控制方法及系统 Download PDFInfo
- Publication number
- CN108803307A CN108803307A CN201810514494.3A CN201810514494A CN108803307A CN 108803307 A CN108803307 A CN 108803307A CN 201810514494 A CN201810514494 A CN 201810514494A CN 108803307 A CN108803307 A CN 108803307A
- Authority
- CN
- China
- Prior art keywords
- directed toward
- actuator
- actively
- quiet platform
- ultra quiet
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000003745 diagnosis Methods 0.000 title claims abstract description 40
- 238000000034 method Methods 0.000 title claims abstract description 39
- 239000011159 matrix material Substances 0.000 claims description 77
- 238000006073 displacement reaction Methods 0.000 claims description 40
- 239000013598 vector Substances 0.000 claims description 36
- 238000006243 chemical reaction Methods 0.000 claims description 7
- 238000005259 measurement Methods 0.000 claims description 6
- 230000009466 transformation Effects 0.000 claims description 6
- 230000008859 change Effects 0.000 claims description 4
- 230000007246 mechanism Effects 0.000 claims description 4
- 230000007704 transition Effects 0.000 claims description 4
- 230000015572 biosynthetic process Effects 0.000 claims description 3
- 230000007257 malfunction Effects 0.000 claims description 3
- 230000001133 acceleration Effects 0.000 claims description 2
- 230000005484 gravity Effects 0.000 claims description 2
- 238000000465 moulding Methods 0.000 claims 1
- 230000000694 effects Effects 0.000 abstract description 8
- 238000004088 simulation Methods 0.000 abstract description 5
- 238000010187 selection method Methods 0.000 abstract description 2
- 230000008878 coupling Effects 0.000 description 8
- 238000010168 coupling process Methods 0.000 description 8
- 238000005859 coupling reaction Methods 0.000 description 8
- 238000005516 engineering process Methods 0.000 description 4
- 238000011217 control strategy Methods 0.000 description 3
- 238000002405 diagnostic procedure Methods 0.000 description 3
- 230000004888 barrier function Effects 0.000 description 2
- 235000006508 Nelumbo nucifera Nutrition 0.000 description 1
- 240000002853 Nelumbo nucifera Species 0.000 description 1
- 235000006510 Nelumbo pentapetala Nutrition 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 230000005284 excitation Effects 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- VIKNJXKGJWUCNN-XGXHKTLJSA-N norethisterone Chemical compound O=C1CC[C@@H]2[C@H]3CC[C@](C)([C@](CC4)(O)C#C)[C@@H]4[C@@H]3CCC2=C1 VIKNJXKGJWUCNN-XGXHKTLJSA-N 0.000 description 1
- 238000011084 recovery Methods 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B9/00—Safety arrangements
- G05B9/02—Safety arrangements electric
- G05B9/03—Safety arrangements electric with multiple-channel loop, i.e. redundant control systems
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B11/00—Automatic controllers
- G05B11/01—Automatic controllers electric
- G05B11/36—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
- G05B11/42—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential for obtaining a characteristic which is both proportional and time-dependent, e.g. P. I., P. I. D.
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B23/00—Testing or monitoring of control systems or parts thereof
- G05B23/02—Electric testing or monitoring
- G05B23/0205—Electric testing or monitoring by means of a monitoring system capable of detecting and responding to faults
- G05B23/0208—Electric testing or monitoring by means of a monitoring system capable of detecting and responding to faults characterized by the configuration of the monitoring system
- G05B23/0213—Modular or universal configuration of the monitoring system, e.g. monitoring system having modules that may be combined to build monitoring program; monitoring system that can be applied to legacy systems; adaptable monitoring system; using different communication protocols
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Testing Of Devices, Machine Parts, Or Other Structures Thereof (AREA)
- Feedback Control In General (AREA)
Abstract
一种主动指向超静平台自主故障诊断与容错控制方法及系统，所设计的故障诊断与容错控制方法适用于主动指向超静平台这类高度耦合的复杂多输入多输出系统。首先，建立了主动指向超静平台动力学模型，并设计了载荷指向控制解耦模型和解耦矩阵。通过解耦矩阵实现主动指向超静平台由复杂多输入多输出系统转换为多个相对简单的单输入单输出系统，简化载荷控制器的设计。然后，针对单个作动器故障的载荷容错控制问题，通过建立新解耦矩阵实现载荷指向控制重构，并给出了基于解耦矩阵条件数最小的冗余自由度选择方法。数学仿真结果表明：基于冗余自由度最优选择的主动指向容错控制方法能够最大限度地减少作动器故障对主动指向超静平台载荷指向控制效果的影响。
Description
技术领域
本发明属于航天器姿态控制领域，涉及一种主动指向超静平台自主故障诊 断与容错控制方法及系统，实现作动器故障对主动指向超静平台的载荷指向控 制精度影响最小化。
背景技术
未来天基天文观测、极高分辨率对地观测等航天器任务提出了光学载荷毫 角秒级的指向控制以及极高稳定度控制的需求。基于我国现有航天器平台及相 关控制技术难以实现这类光学载荷超高精度指向控制需求。而天基主动指向超 静平台具备自由度高、指向精度高、结构刚度大等优势，将成为未来航天器光 学载荷超高精度控制的必备技术。主动指向超静平台属于典型的多输入多输出 冗余系统。当主动指向超静平台单个作动器故障时，由于通道之间耦合特性， 使得故障作动器影响多个通道的控制效果。因此，有必要研究主动指向超静平 台这类多输入多输出耦合冗余系统的故障诊断与容错控制方法，实现故障作动 器对主动指向超静平台的载荷指向精度影响最小化。现有的故障诊断与容错控制方法存在以下不足：
1、无法实现耦合系统准确的故障诊断
目前的故障诊断方法针对的物理相对多为线性系统，诊断方法中不考虑通 道之间的耦合因素。当系统存在耦合时，单一通道发生故障时容易引起多个输 出通道测量值变化。因此难以通过系统测量值准确定位故障。文中针对存在耦 合的一般动力学模型设计解耦模型和标准解耦矩阵，使复杂多输入多输出系统 变为多个相对简单的单输入单输出系统，实现故障的准确诊断。
2、无法实现耦合系统的故障冗余重构
目前诊断与重构方法多针对线性系统，重构方法中不考虑通道之间的耦合 因素。因此难以通过执行机构的冗余配置实现系统重构，从而恢复系统的部分 或全部功能。文中针对耦合冗余系统提出指向控制重构策略，在建立新的解耦 矩阵的基础上。通过解耦矩阵条件数最小的冗余自由度进行重构策略选择，实 现最大限度地减少作动器故障对超静平台主动指向控制效果的影响。
发明内容
本发明解决的技术问题是：克服现有技术的不足，提供了一种主动指向超 静平台自主故障诊断与容错控制方法，能够最大限度地减少作动器故障对超静 平台主动指向控制效果的影响。
本发明的技术解决方案是：一种主动指向超静平台自主故障诊断与容错控 制方法，步骤如下：
(1)在主动指向超静平台作动器空间内建立主动指向超静平台动力学模 型。
(2)忽略主动指向超静平台动力学模型中速度的关联项将步骤(1) 建立的主动指向超静平台动力学模型转换为新的线性模型。
(3)建立主动指向超静平台中作动器平动位移δl和载荷位姿δχ的运动学 约束关系。
(4)根据步骤(3)主动指向超静平台中作动器平动位移δl和载荷位姿δχ 的关系，确定主动指向超静平台作动器操纵律分配矩阵G。
(5)判断主动指向超静平台中作动器是否故障，若有故障则由故障诊断方 法找出故障的作动器编号；定义故障作动器向量d＝[d1,d2,…,ds]T和冗余自由度 向量u＝[u1,u2,…,us]T，s(s＝1,2,…,6)为故障作动器的数目。建立故障作动器 向量d转换为指向自由度ρ约束关系。确定步骤(3)中的主动指向超静平台中 作动器平动位移δl与指向自由度ρ和冗余自由度u的约束关系，并进行步骤(6)； 若无故障，表示主动指向超静平台正常工作，进入步骤(8)。
(6)根据步骤(4)主动指向超静平台作动器操纵律分配矩阵G和步骤(5) 的主动指向超静平台中作动器平动位移δl与指向自由度ρ和冗余自由度u的约 束关系、故障作动器的数量d与指向自由度ρ的约束关系，建立故障时主动指 向超静平台新的作动器操纵律分配矩阵Gr。
(7)通过故障时主动指向超静平台新的作动器操纵律分配矩阵Gr，采用 PID控制去补偿故障作动器，实现主动指向超静平台的容错控制。
(8)通过步骤(4)主动指向超静平台作动器操纵律分配矩阵G，采用PID 控制，实现主动指向超静平台的控制。
步骤(1)主动指向超静平台由六个作动器构成。每个作动器包含并行安装 的被动环节、主动环节以及测量敏感器三部分。被动环节为弹簧-阻尼，输出被 动力；主动环节为音圈电机，输出主动力；测量敏感器为涡流敏感器，用于测 量音圈电机的平动位移。主动指向超静平台上平面与载荷相连，下平面与航天 器平台相连。
步骤(1)建立的主动指向超静平台动力学模型，具体如下：
式中：Mx为载荷质量/惯量阵；为从载荷坐标系{P}到基础平台坐标系{B}的 转换矩阵，为从载荷坐标系{P}到惯性坐标系{U}的转换矩阵，为从基础平 台坐标系{B}到惯性坐标系{U}的转换矩阵；Ms为作动器质量组成的6×6维对角 阵；l为6×1维作动器长度向量；C和K分别为由六个作动器组成的6×6维刚度和 阻尼对角阵。fm为由六个作动器作动器的输出力组成的6×1维向量。J为关联载 荷工作空间运动和作动器工作空间作动器伸缩运动的6×6维变换矩阵；Jc和JB为与基础端运动相关的6×6维变换矩阵；为沿着作动器方向基础端的6×1维加 速度向量；Fd为作用于载荷的6×1维外力向量；Fc包含所有的科氏项；G包含所 有的重力项。
步骤(2)忽略主动指向超静平台动力学模型中速度的关联项，是指关联载 荷工作空间和作动器工作空间作动器变换矩阵J的变化率，即
步骤(2)将步骤(1)建立的主动指向超静平台动力学模型转换为新的线 性模型，具体如下：
新的输出方程为：
y＝J-1l
式中，输入变量u定义为
u＝J-1fm
步骤(3)定义主动指向超静平台中作动器平动位移δl和载荷位姿δχ的关 系；具体如下：
δl＝Jδχ
式中，l＝[l1,l2,...,l6]T为主动指向超静平台中六作动器平动位移；关联矩阵J定 义为，
式中，为载荷坐标系{P}中pi向量的反对称矩阵；分别为沿六个作动器的单位向量；
步骤(4)根据步骤(3)主动指向超静平台中作动器平动位移δl和载荷位 姿δχ的关系，建立主动指向超静平台作动器操纵律分配矩阵G，具体如下：
式中，J(i,j)矩阵的J的第(i，j)个元素，令a＝[1,2,...,6]T，则有D＝J(a,ρnum)。ρ＝[ρ1,ρ2,...ρr]T为包含指向自由度的子向量，ρnum＝[ρnum1,ρnum2,...ρnumr]T为对应于ρ的相应单元编号向量。，当主动指向超静平台仅进行载荷滚动-俯仰(θx和θy)两自由度 控制时，作动器操纵律分配矩阵G为6×2维常数矩阵。
步骤(5)判断主动指向超静平台中作动器是否故障，具体如下：
主动指向超静平台的载荷三轴姿态为θp，则载荷六自由度位姿 δχ＝[03×1 θp]T，则作动器的平动位移理论值δl＝[δl1 … δl2]T可计算为：
δl＝Jδχ
定义各作动器刚度系数为Km＝[km1,…,km6]T，作动器执行机构电流-力系数 为Kf＝[kf1,…,kf6]T，则作动器执行机构理论输出电流I＝[i1,…,i6]T可计算为
ii＝δlikm1/kfi(i＝1,2,…,6)
主动指向超静平台各作动器的输出电流测量值为Im＝[im1,…,im6]T。定义作 动器涡流故障失效标志为Ft＝[Ft1,…,Ft6]T。
Fti＝|imi/ii|
当Ftmin<Fti<Ftmax，则定位为第i个作动器执行机构故障。
步骤(5)定义故障作动器向量d＝[d1,d2,…,ds]T和冗余自由度向量u＝[u1,u2,…,us]T，s(s＝1,2,…,6)为故障作动器的数目。故障作动器向量d转换为指 向自由度ρ约束关系，具体如下：
当冗余自由度的数目等于故障作动器的数目时，J(d,ρnum)为方阵，从而实现通过冗余自由度的运动去补偿故障作动器。
步骤(5)确定步骤(3)中的主动指向超静平台中作动器平动位移δl与指 向自由度ρ和冗余自由度u的约束关系，具体如下：
式中：δρ为指向自由度方向的位姿变化量，δu为冗余自由度方向的位姿变化 量。
步骤(6)根据步骤(4)主动指向超静平台作动器操纵律分配矩阵G和步 骤(5)的主动指向超静平台中作动器平动位移δl与指向自由度ρ和冗余自由度 u的约束关系、故障作动器的数量d与指向自由度ρ的约束关系，建立故障时 主动指向超静平台新的作动器操纵律分配矩阵Gr，具体如下：
定义作动器故障后新的操纵律分配矩阵Gr的条件数为
cond(Gr)＝||Gr||||Gr -1||
定义满足上式的最优冗余自由度约束条件为：
通过选择主动指向超静平台故障重构冗余自由度，实现作动器故障后最优 冗余自由度选择。
采用迭代法获得作动器故障时的最优冗余自由度。根据最优冗余自由度满 足的约束条件可计算出经典立方体几何构型下一个作动器、两个作动器等故障 时，最优冗余自由度的选取编号，见下表1～3。通过查阅下表1～3最优冗余自 由度编号，实现作动器故障后新的操纵律分配矩阵Gr的计算。
表1一个作动器故障
表2两个作动器故障
表3三个作动器故障
步骤(7)通过故障时主动指向超静平台新的作动器操纵律分配矩阵Gr， 采用PID控制方法去补偿故障作动器，实现主动指向超静平台的容错控制，具 体如下：
u＝J-1KmGrδρ
通过重构后新的作动器操纵律分配矩阵Gr代替原有操纵律分配矩阵G，进 一步通过主动指向控制策略可以实现超静平台的主动指向容错控制
步骤(8)通过步骤(4)主动指向超静平台作动器操纵律分配矩阵G，采 用PID控制方法，实现主动指向超静平台的控制，具体如下：
u＝J-1KmGδρ
本发明一种主动指向超静平台自主故障诊断与容错控制系统，包括：建模 模块、转换模块、约束关系建立模块、确定模块、判断模块、新矩阵建立模块、 第一控制模块、第二控制模块；
建模模块，在主动指向超静平台作动器空间内建立主动指向超静平台动力 学模型；
转换模块，忽略主动指向超静平台动力学模型中速度的关联项，将建立的 主动指向超静平台动力学模型转换为新的线性模型；
约束关系建立模块，建立主动指向超静平台中作动器平动位移和载荷位姿 的运动学约束关系；
确定模块，根据主动指向超静平台中作动器平动位移和载荷位姿的关系， 确定主动指向超静平台作动器操纵律分配矩阵；
判断模块，判断主动指向超静平台中作动器是否故障，若有故障找出故障 的作动器编号；定义故障作动器向量和冗余自由度向量，建立故障作动器向量 转换为指向自由度约束关系；确定主动指向超静平台中作动器平动位移与指向 自由度和冗余自由度的约束关系，并由新矩阵建立模块，根据主动指向超静平 台作动器操纵律分配矩阵和主动指向超静平台中作动器平动位移δl与指向自由 度和冗余自由度的约束关系、故障作动器的数量与指向自由度的约束关系，建 立故障时主动指向超静平台新的作动器操纵律分配矩阵；再由第一控制模块， 通过故障时主动指向超静平台新的作动器操纵律分配矩阵，采用PID控制去补 偿故障作动器，实现主动指向超静平台的容错控制；若无故障，表示主动指向 超静平台正常工作，由第二控制模块通过主动指向超静平台作动器操纵律分配 矩阵，采用PID控制，实现主动指向超静平台的控制。
本发明与现有技术相比的优点在于：
(1)本发明能够实现多输出多输出耦合系统的故障诊断，针对目前诊断方 法无法实现耦合系的故障诊断，文中设计了针对主动指向超静平台的多输入多 输出耦合系统的故障诊断方法。针对存在耦合的主动指向超静平台一般动力学 模型，设计解耦模型和标准解耦矩阵，使复杂多输入多输出系统变为多个相对 简单的单输入单输出系统，实现故障的准确诊断。
(2)本发明能够实现耦合系统的故障冗余重构，通过构建故障时主动指向 超静平台新解耦矩阵Gr，采用迭代法得到立方体几何构型下一个作动器、两个 作动器等故障时的最优冗余自由度选取编号，并构建故障后新的作动器操纵律 分配矩阵Gr。通过矩阵Gr条件数最小的冗余自由度进行重构策略选择，实现最 大限度地减少作动器故障对主动指向超静平台载荷指向控制效果的影响。
(3)本发明能够实现多重故障的快速诊断，在建立主动指向超静平台作动 器动力学模型的基础上，通过载荷姿态测量能够计算出作动器的平动位移。通 过作动器的平动位移、作动器刚度系数、执行机构电流-力系数可计算出各作动 器的电流期望值。通过各执行机构电流的测量值与期望值比对，可直接定位出 故障作动器，实现多重故障的诊断。
附图说明
图1为本发明方法的流程图；
图2为无作动器故障时载荷指向跟踪控制效果图；
图3为作动器故障时载荷指向跟踪控制效果图。
具体实施方式
下面结合附图和具体实施例对本发明做进一步详细描述。
本发明一种主动指向超静平台自主故障诊断与容错控制方法及系统，所设 计的故障诊断与容错控制方法适用于主动指向超静平台这类高度耦合的复杂多 输入多输出系统。首先，建立了主动指向超静平台动力学模型，并设计了载荷 指向控制解耦模型和解耦矩阵。通过解耦矩阵实现主动指向超静平台由复杂多 输入多输出系统转换为多个相对简单的单输入单输出系统，简化载荷控制器的 设计。然后，针对单个作动器故障的载荷容错控制问题，通过建立新解耦矩阵 实现载荷指向控制重构，并给出了基于解耦矩阵条件数最小的冗余自由度选择 方法。数学仿真结果表明：基于冗余自由度最优选择的主动指向容错控制方法 能够最大限度地减少作动器故障对主动指向超静平台载荷指向控制效果的影响。
如图1所示，本发明一种主动指向超静平台自主故障诊断与容错控制方法， 步骤如下：
(1)主动指向超静平台由六个作动器构成，每个作动器包含并行安装的 被动环节、主动环节以及测量敏感器三部分。被动环节为弹簧-阻尼，输出被动 力；主动环节为音圈电机，输出主动力；测量敏感器为涡流敏感器，用于测量 音圈电机的平动位移。主动指向超静平台上平面与载荷相连，下平面与航天器 平台相连。
(2)在主动指向超静平台作动器空间内建立主动指向超静平台动力学模 型，具体如下，
式中：Mx＝diag(18kg,18kg,18kg,0.4kgm2,0.6kgm2,0.6kgm2)，主动指向超静平台高度 h＝0.03m，载荷质心在基础平台坐标系中的位置为[0,0,0.05m]；作动器质量 Ms＝0.1kg，作动器的刚度和阻尼系数分别为k＝3700N/m，c＝2.7Ns/m；在每个 作动器下平面施加扰动，分别为：低频扰动：0.01sin(0.2πt)m/s2；高频扰动： 0.01sin(120πt)m/s2；随机扰动：均值为0，标准差为0.01的高斯噪声。
作动器与载荷平台连接铰点坐标为
作动器与基础平台连接铰点坐标为
(3)忽略主动指向超静平台动力学模型中速度的关联项将步骤(2) 建立的主动指向超静平台动力学模型转换为新的线性模型，具体如下：
新的输出方程为：
y＝J-1l
式中，输入变量u定义为
u＝J-1fm
(4)建立主动指向超静平台中作动器平动位移δl和载荷位姿δχ的运动学 约束关系，具体如下：
δl＝Jδχ
式中，l＝[l1,l2,...,l6]T为主动指向超静平台中六作动器平动位移；关联矩阵J定 义为，
(5)根据步骤(4)主动指向超静平台中作动器平动位移δl和载荷位姿δχ 的关系，确定主动指向超静平台作动器操纵律分配矩阵G，具体如下：
(6)判断主动指向超静平台中作动器是否故障，具体为：
主动指向超静平台的载荷三轴姿态为θp，则载荷六自由度位姿 δχ＝[03×1 θp]T，则作动器的平动位移理论δl＝[δl1 … δl2]T可计算为：
δl＝Jδχ
定义各作动器刚度系数为Km＝[km1,…,km6]T，作动器执行机构电流-力系数 为Kf＝[kf1,…,kf6]T，则作动器执行机构理论输出电流I＝[i1,…,i6]T可计算为
ii＝δlikm1/kfi(i＝1,2,…,6)
主动指向超静平台各作动器的输出电流测量值为Im＝[im1,…,im6]T。定义作 动器涡流故障失效标志为Ft＝[Ft1,…,Ft6]T。
Fti＝|imi/ii|
当Ftmin<Fti<Ftmax，则定位为第i个作动器执行机构故障。
(7)由步骤(6)诊断方法可知，若有故障，设共有i个作动器故障，定 义d＝[d1,d2,...,ds]T为故障作动器作动器向量，其中di∈{1,2,...,6}；定义s(s＝1,2,...,6)为 故障作动器的数目。定义u＝[u1,u2,...us]T为冗余自由度向量，unum＝[unum1,unum2,...unumr]T为对应于u的相应单元编号向量。将步骤(3)中的载荷六自由度运动表示为指向 自由度ρ和冗余自由度u，则作动器运动表示为：
由于d个作动器故障，d个作动器无法运动，长度不能改变，有：
当冗余自由度的数目等于故障作动器的数目时，J(d,ρnum)为方阵，从而实现通过冗余自由度的运动去补偿故障作动器。
若无故障，表示主动指向超静平台正常工作，进入步骤(8)。
(8)根据步骤(5)主动指向超静平台作动器操纵律分配矩阵G和步骤(6) 的主动指向超静平台中作动器平动位移δl与指向自由度ρ和冗余自由度u的约 束关系、故障作动器的数量d与指向自由度ρ的约束关系，建立故障时主动指 向超静平台新的作动器操纵律分配矩阵Gr。
定义作动器故障后新的操纵律分配矩阵Gr的条件数为
cond(Gr)＝||Gr||||Gr -1||
定义满足上式的最优冗余自由度约束条件为:
通过选择主动指向超静平台故障重构冗余自由度，实现作动器故障后最优 冗余自由度选择。
采用迭代法获得作动器故障时的最优冗余自由度。根据最优冗余自由度满 足的约束条件可计算出经典立方体几何构型下一个作动器、两个作动器等故障 时，最优冗余自由度的选取编号，优选方案见下表1～3。通过查阅下表1～3最 优冗余自由度编号，实现作动器故障后新的操纵律分配矩阵Gr，实现超静平台 的主动指向容错控制。
表1一个作动器故障
表2两个作动器故障
表3三个作动器故障
(9)若无故障时，主动指向超静平台作动器操纵律分配矩阵为G，采用 PID控制方法，实现主动指向超静平台的控制，具体如下：
u＝J-1KmGδρ
(10)若有故障时，通过故障时主动指向超静平台新的作动器操纵律分配 矩阵Gr，采用PID控制去补偿故障作动器，实现主动指向超静平台的容错控制， 具体如下：
u＝J-1KmGrδρ
通过重构后新的作动器操纵律分配矩阵Gr代替原有操纵律分配矩阵G，进 一步通过主动指向控制策略可以实现超静平台的主动指向容错控制
(11)设置作动器作动器2、4、6同时发生故障，进行主动指向超静平台 控制仿真。图2给出了载荷目标指向θrefx＝60″时的载荷指向跟踪误差。图3给出 了作动器作动器2、4、6同时发生故障时的载荷指向跟踪控制效果图。其中控 制带宽为5Hz。由图3可知：当作动器2、4、6同时发生故障时，采用重构指 向控制策略，建立的新解耦矩阵Gr，并通过选择最优的冗余自由度unum＝[1,2,3]， 仍然可以很好地实现超静平台的主动指向跟踪控制。仿真结果表明：文中提出 了主动指向超静平台故障诊断与容错控制方法能够实现在多个作动器故障情况 下最大限度地减少作动器故障对主动指向超静平台载荷指向控制效果的影响， 实现载荷高精度指向控制。
本发明一种主动指向超静平台自主故障诊断与容错控制系统，包括：建模 模块、转换模块、约束关系建立模块、确定模块、判断模块、新矩阵建立模块、 第一控制模块、第二控制模块；
建模模块，在主动指向超静平台作动器空间内建立主动指向超静平台动力 学模型；
转换模块，忽略主动指向超静平台动力学模型中速度的关联项，将建立的 主动指向超静平台动力学模型转换为新的线性模型；
约束关系建立模块，建立主动指向超静平台中作动器平动位移和载荷位姿 的运动学约束关系；
确定模块，根据主动指向超静平台中作动器平动位移和载荷位姿的关系， 确定主动指向超静平台作动器操纵律分配矩阵；
判断模块，判断主动指向超静平台中作动器是否故障，若有故障找出故障 的作动器编号；定义故障作动器向量和冗余自由度向量，建立故障作动器向量 转换为指向自由度约束关系；确定主动指向超静平台中作动器平动位移与指向 自由度和冗余自由度的约束关系，并由新矩阵建立模块，根据主动指向超静平 台作动器操纵律分配矩阵和主动指向超静平台中作动器平动位移δl与指向自由 度和冗余自由度的约束关系、故障作动器的数量与指向自由度的约束关系，建 立故障时主动指向超静平台新的作动器操纵律分配矩阵；再由第一控制模块， 通过故障时主动指向超静平台新的作动器操纵律分配矩阵，采用PID控制去补 偿故障作动器，实现主动指向超静平台的容错控制；若无故障，表示主动指向 超静平台正常工作，由第二控制模块通过主动指向超静平台作动器操纵律分配 矩阵，采用PID控制，实现主动指向超静平台的控制。
本发明实现了多输出多输出耦合系统的故障诊断，针对目前诊断方法无法 实现耦合系的故障诊断，文中设计了针对主动指向超静平台的多输入多输出耦 合系统的故障诊断方法。针对存在耦合的主动指向超静平台一般动力学模型， 设计解耦模型和标准解耦矩阵，使复杂多输入多输出系统变为多个相对简单的 单输入单输出系统，实现故障的准确诊断。本发明实现了耦合系统的故障冗余 重构，通过构建故障时主动指向超静平台新解耦矩阵Gr，采用迭代法得到立方 体几何构型下一个作动器、两个作动器等故障时的最优冗余自由度选取编号， 并构建故障后新的作动器操纵律分配矩阵Gr。通过矩阵Gr条件数最小的冗余自 由度进行重构策略选择，实现最大限度地减少作动器故障对主动指向超静平台 载荷指向控制效果的影响。
本发明能够实现多重故障的快速诊断，在建立主动指向超静平台作动器动 力学模型的基础上，通过载荷姿态测量能够计算出作动器的平动位移。通过作 动器的平动位移、作动器刚度系数、执行机构电流-力系数可计算出各作动器的 电流期望值。通过各执行机构电流的测量值与期望值比对，可直接定位出故障 作动器，实现多重故障的诊断。
本发明说明书中未作详细描述的内容属本领域技术人员的公知技术。
Claims (10)
1.一种主动指向超静平台自主故障诊断与容错控制方法，其特征在于步骤如下：
(1)在主动指向超静平台作动器空间内建立主动指向超静平台动力学模型；
(2)忽略主动指向超静平台动力学模型中速度的关联项，将步骤(1)建立的主动指向超静平台动力学模型转换为新的线性模型；
(3)建立主动指向超静平台中作动器平动位移和载荷位姿的运动学约束关系；
(4)根据步骤(3)主动指向超静平台中作动器平动位移和载荷位姿的关系，确定主动指向超静平台作动器操纵律分配矩阵；
(5)判断主动指向超静平台中作动器是否故障，若有故障找出故障的作动器编号；定义故障作动器向量和冗余自由度向量，建立故障作动器向量转换为指向自由度约束关系；确定步骤(3)中的主动指向超静平台中作动器平动位移与指向自由度和冗余自由度的约束关系，并进行步骤(6)；若无故障，表示主动指向超静平台正常工作，进入步骤(8)；
(6)根据步骤(4)主动指向超静平台作动器操纵律分配矩阵和步骤(5)的主动指向超静平台中作动器平动位移δl与指向自由度和冗余自由度的约束关系、故障作动器的数量与指向自由度的约束关系，建立故障时主动指向超静平台新的作动器操纵律分配矩阵；
(7)通过故障时主动指向超静平台新的作动器操纵律分配矩阵，采用PID控制去补偿故障作动器，实现主动指向超静平台的容错控制；
(8)通过步骤(4)主动指向超静平台作动器操纵律分配矩阵，采用PID控制，实现主动指向超静平台的控制。
2.根据权利要求1所述的一种主动指向超静平台自主故障诊断与容错控制方法，其特征在于：步骤(1)主动指向超静平台由六个作动器构成，每个作动器包含并行安装的被动环节、主动环节以及测量敏感器三部分；被动环节为弹簧-阻尼，输出被动力；主动环节为音圈电机，输出主动力；测量敏感器为涡流敏感器，用于测量音圈电机的平动位移；主动指向超静平台上平面与载荷相连，下平面与航天器平台相连。
3.根据权利要求1所述的一种主动指向超静平台自主故障诊断与容错控制方法，其特征在于：步骤(1)建立的主动指向超静平台动力学模型，具体如下：
式中：Mx为载荷质量/惯量阵；为从载荷坐标系{P}到基础平台坐标系{B}的转换矩阵，为从载荷坐标系{P}到惯性坐标系{U}的转换矩阵，为从基础平台坐标系{B}到惯性坐标系{U}的转换矩阵；Ms为作动器质量组成的6×6维对角阵；l为6×1维作动器长度向量；C和K分别为由六个作动器组成的6×6维刚度和阻尼对角阵；fm为由六个作动器作动器的输出力组成的6×1维向量；J为关联载荷工作空间运动和作动器工作空间作动器伸缩运动的6×6维变换矩阵；Jc和JB为与基础端运动相关的6×6维变换矩阵；为沿着作动器方向基础端的6×1维加速度向量；Fd为作用于载荷的6×1维外力向量；Fc包含所有的科氏项；G包含所有的重力项。
4.根据权利要求1所述的一种主动指向超静平台自主故障诊断与容错控制方法，其特征在于：步骤(2)忽略主动指向超静平台动力学模型中速度的关联项，是指关联载荷工作空间和作动器工作空间作动器变换矩阵J的变化率，即
5.根据权利要求1所述的一种主动指向超静平台自主故障诊断与容错控制方法，其特征在于：步骤(2)将步骤(1)建立的主动指向超静平台动力学模型转换为新的线性模型，具体如下：
新的输出方程即线性模型为：
y＝J-1l
式中，输入变量u定义为：
u＝J-1fm。
6.根据权利要求1所述的一种主动指向超静平台自主故障诊断与容错控制方法，其特征在于：步骤(3)定义主动指向超静平台中作动器平动位移δl和载荷位姿δχ的关系；具体如下：
δl＝Jδχ
式中，l＝[l1,l2,...,l6]T为主动指向超静平台中六作动器平动位移；关联矩阵J定义为，
式中，为载荷坐标系{P}中pi向量的反对称矩阵；分别为沿六个作动器的单位向量。
7.根据权利要求1所述的一种主动指向超静平台自主故障诊断与容错控制方法，其特征在于：步骤(4)根据步骤(3)主动指向超静平台中作动器平动位移δl和载荷位姿δχ的关系，建立主动指向超静平台作动器操纵律分配矩阵G，具体如下：
式中，J(i,j)矩阵的J的第(i，j)个元素，ρ＝[ρ1,ρ2,...ρr]T为包含指向自由度的子向量，ρnum＝[ρnum1,ρnum2,...ρnumr]T为对应于ρ的相应单元编号向量，当主动指向超静平台仅进行载荷滚动-俯仰(θx和θy)两自由度控制时，作动器操纵律分配矩阵G为6×2维常数矩阵。
8.根据权利要求1所述的一种主动指向超静平台自主故障诊断与容错控制方法，其特征在于：步骤(5)判断主动指向超静平台中作动器是否故障，具体如下：
主动指向超静平台的载荷三轴姿态为θp，则载荷六自由度位姿δχ＝[03×1 θp]T，则作动器的平动位移理论值δl＝[δl1 … δl2]T计算为：
δl＝Jδχ
定义各作动器刚度系数为Km＝[km1,…,km6]T，作动器执行机构电流-力系数为Kf＝[kf1,…,kf6]T，则作动器执行机构理论输出电流I＝[i1,…,i6]T可计算为
ii＝δlikm1/kfi (i＝1,2,…,6)
主动指向超静平台各作动器的输出电流测量值为Im＝[im1,…,im6]T；定义作动器涡流故障失效标志为Ft＝[Ft1,…,Ft6]T；
Fti＝|imi/ii|
当Ftmin<Fti<Ftmax，则定位为第i个作动器执行机构故障。
9.根据权利要求1所述的一种主动指向超静平台自主故障诊断与容错控制方法，其特征在于：步骤(5)定义故障作动器向量d＝[d1,d2,…,ds]T和冗余自由度向量u＝[u1,u2,…,us]T，s(s＝1,2,…,6)为故障作动器的数目；故障作动器向量d转换为指向自由度ρ约束关系，具体如下：
当冗余自由度的数目等于故障作动器的数目时，J(d,ρnum)为方阵，从而实现通过冗余自由度的运动去补偿故障作动器。
10.一种主动指向超静平台自主故障诊断与容错控制系统，其特征在于包括：建模模块、转换模块、约束关系建立模块、确定模块、判断模块、新矩阵建立模块、第一控制模块、第二控制模块；
建模模块，在主动指向超静平台作动器空间内建立主动指向超静平台动力学模型；
转换模块，忽略主动指向超静平台动力学模型中速度的关联项，将建立的主动指向超静平台动力学模型转换为新的线性模型；
约束关系建立模块，建立主动指向超静平台中作动器平动位移和载荷位姿的运动学约束关系；
确定模块，根据主动指向超静平台中作动器平动位移和载荷位姿的关系，确定主动指向超静平台作动器操纵律分配矩阵；
判断模块，判断主动指向超静平台中作动器是否故障，若有故障找出故障的作动器编号；定义故障作动器向量和冗余自由度向量，建立故障作动器向量转换为指向自由度约束关系；确定主动指向超静平台中作动器平动位移与指向自由度和冗余自由度的约束关系，并由新矩阵建立模块，根据主动指向超静平台作动器操纵律分配矩阵和主动指向超静平台中作动器平动位移δl与指向自由度和冗余自由度的约束关系、故障作动器的数量与指向自由度的约束关系，建立故障时主动指向超静平台新的作动器操纵律分配矩阵；再由第一控制模块，通过故障时主动指向超静平台新的作动器操纵律分配矩阵，采用PID控制去补偿故障作动器，实现主动指向超静平台的容错控制；若无故障，表示主动指向超静平台正常工作，由第二控制模块通过主动指向超静平台作动器操纵律分配矩阵，采用PID控制，实现主动指向超静平台的控制。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201810514494.3A CN108803307B (zh) | 2018-05-25 | 2018-05-25 | 一种主动指向超静平台自主故障诊断与容错控制方法及系统 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201810514494.3A CN108803307B (zh) | 2018-05-25 | 2018-05-25 | 一种主动指向超静平台自主故障诊断与容错控制方法及系统 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN108803307A true CN108803307A (zh) | 2018-11-13 |
| CN108803307B CN108803307B (zh) | 2021-07-13 |
Family
ID=64091894
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201810514494.3A Active CN108803307B (zh) | 2018-05-25 | 2018-05-25 | 一种主动指向超静平台自主故障诊断与容错控制方法及系统 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN108803307B (zh) |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN114397804A (zh) * | 2021-12-15 | 2022-04-26 | 哈尔滨工业大学 | 一种超冗余并联系统的控制方法 |
| CN114408219A (zh) * | 2022-01-21 | 2022-04-29 | 北京控制工程研究所 | 一种主动指向超静平台指令力分配阵重构方法 |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104390776A (zh) * | 2014-12-10 | 2015-03-04 | 北京航空航天大学 | 一种多余度副翼作动器故障检测、诊断与性能评估方法 |
| CN105738722A (zh) * | 2016-01-27 | 2016-07-06 | 西北工业大学 | 一种航空机电作动器故障诊断方法 |
| CN108762073A (zh) * | 2018-05-23 | 2018-11-06 | 北京控制工程研究所 | 一种主动指向超静平台操纵律设计方法 |
| CN109613823A (zh) * | 2018-11-27 | 2019-04-12 | 清华大学 | 一种非线性隔振与抗冲击控制系统及方法 |
-
2018
- 2018-05-25 CN CN201810514494.3A patent/CN108803307B/zh active Active
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104390776A (zh) * | 2014-12-10 | 2015-03-04 | 北京航空航天大学 | 一种多余度副翼作动器故障检测、诊断与性能评估方法 |
| CN105738722A (zh) * | 2016-01-27 | 2016-07-06 | 西北工业大学 | 一种航空机电作动器故障诊断方法 |
| CN108762073A (zh) * | 2018-05-23 | 2018-11-06 | 北京控制工程研究所 | 一种主动指向超静平台操纵律设计方法 |
| CN109613823A (zh) * | 2018-11-27 | 2019-04-12 | 清华大学 | 一种非线性隔振与抗冲击控制系统及方法 |
Non-Patent Citations (3)
| Title |
|---|
| TANG, LIANG 等: "Dynamic modeling and multi-stage integrated control method of ultra-quiet spacecraft", 《ADVANCES IN SPACE RESEARCH》 * |
| 王有懿 等: "一种超静平台主动指向容错控制方法", 《宇航学报》 * |
| 许域菲 等: "卫星stewart隔振平台高可靠性设计及容错控制", 《上海应用技术学院学报》 * |
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN114397804A (zh) * | 2021-12-15 | 2022-04-26 | 哈尔滨工业大学 | 一种超冗余并联系统的控制方法 |
| CN114397804B (zh) * | 2021-12-15 | 2024-04-26 | 哈尔滨工业大学 | 一种超冗余并联系统的控制方法 |
| CN114408219A (zh) * | 2022-01-21 | 2022-04-29 | 北京控制工程研究所 | 一种主动指向超静平台指令力分配阵重构方法 |
| CN114408219B (zh) * | 2022-01-21 | 2023-06-16 | 北京控制工程研究所 | 一种主动指向超静平台指令力分配阵重构方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN108803307B (zh) | 2021-07-13 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| Zou et al. | Distributed attitude coordination control for spacecraft formation flying | |
| Book | Controlled motion in an elastic world | |
| Kang et al. | Optimization of flexible multibody dynamic systems using the equivalent static load method | |
| Ulrich et al. | Modeling and direct adaptive control of a flexible-joint manipulator | |
| Qinglei et al. | Adaptive integral-type sliding mode control for spacecraft attitude maneuvering under actuator stuck failures | |
| Sultan et al. | Tensegrity flight simulator | |
| CN107703742A (zh) | 一种柔性航天器传感器故障调节方法 | |
| Sun et al. | Robust coordinated control for large flexible spacecraft based on consensus theory | |
| CN114779799B (zh) | 基于扩张干扰观测器的柔性航天器姿轨跟踪控制方法 | |
| CN108803307A (zh) | 一种主动指向超静平台自主故障诊断与容错控制方法及系统 | |
| Wagner et al. | Optimal static load compensation with fault tolerance in nonlinear adaptive structures under input and state constraints | |
| Lang et al. | Non-cooperative differential game based output feedback control for spacecraft attitude regulation | |
| CN111123702B (zh) | 基于一致性理论的大型柔性航天器分散协调鲁棒控制方法 | |
| Shayya et al. | A novel (3T-1R) redundant parallel mechanism with large operational workspace and rotational capability | |
| English et al. | Measuring and reducing the Euclidean-space effects of robotic joint failures | |
| Ferguene et al. | Dynamic external force feedback loop control of a robot manipulator using a neural compensator—Application to the trajectory following in an unknown environment | |
| CN114924485A (zh) | 一种过驱动水下机器人动力定位自适应容错控制架构及方法 | |
| CN113859588A (zh) | 一种航天器姿态/故障/干扰协同观测与容错抗干扰控制方法 | |
| Liang et al. | Coordinated attitude control of flexible spacecraft formations via behavior-based control approach | |
| Fu et al. | Simultaneous Trajectory and Topology Optimization of Flexible Multibody Systems | |
| Li | Stiffness based trajectory planning and feedforward based vibration suppression control of parallel robot machines | |
| Kelkar et al. | Control of elastic systems via passivity-based methods | |
| Fekih et al. | Two neural net-learning methods for model based fault detection | |
| Qi et al. | Stability Analysis and Distortion Compensation of Robot Structure Dynamics for a Hybrid Simulator | |
| Sharma et al. | Modelling and distributed control of mobile offshore bases |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |