基于故障特征模型的挠性充液卫星姿态自适应容错控制方法技术

本发明专利技术属于自动控制技术领域，涉及一种基于故障特征模型的挠性充液卫星姿态自适应容错控制方法。本发明专利技术在系统存在液体晃动、挠性振动和外部干扰的情况下，针对执行器故障设计了基于故障特征模型的容错控制器，步骤为：(1)根据挠性充液卫星姿态动力学方程建立其故障特征模型；(2)利用参数估计算法对故障特征模型的系数进行辨识，得到故障特征模型系数的估计值；(3)根据故障特征模型系数的估计值设计自适应容错控制器；(4)由自适应容错控制器得到控制力矩，并将其施加到卫星姿态控制系统以控制卫星的姿态角。使用该方法能保障故障发生前、后的控制精度均很高，且达到稳态的时间短。

【技术实现步骤摘要】

本专利技术涉及自动控制
，具体涉及一种基于故障特征模型的挠性充液卫星姿态自适应容错控制方法。
技术介绍
随着航天技术的不断发展，卫星承担的任务越来越多，结构变得越来越复杂,同时卫星的在轨寿命要求大大延长，姿态控制精度要求不断提高。由于大型复杂卫星的液体燃料携带量加大，弹性附件变大，液体晃动和弹性附件振动对航天器姿态的影响越来越严重，液体晃动的抑制与挠性体振动的抑制问题一并成为姿态控制系统设计的难点之一。卫星长时间运行于真空、失重、高低温和强辐射的环境中，执行机构不可避免会发生故障，而执行器发生故障,轻则导致精度、性能降低,重则造成卫星失效。为保证卫星在执行机构故障情况下能够稳定可靠运行，设计一种容错控制方法来完成挠性充液卫星的高稳定度、高精度控制便显得尤为重要。现有技术尚未公开有有效的挠性充液卫星姿态容错控制的方法。吴宏鑫院士从工程应用的角度出发，提出了特征建模的思想，为参数和阶数均未知的高阶复杂系统的建模提供了一种新思路，为一些高阶复杂系统实现低阶控制器设计打下了理论基础。基于特征模型的全系数自适应控制方法在许多工业控制领域中已取得成功应用，特别值得一提的是：该方法的理论思想和工程要义被创造性地应用于飞船返回再入控制，其开伞精度达到国际先进水平。尽管基于特征模型的自适应控制方法在工程上方便易行，但是，将这一思想方法应用于容错控制器的设计尚无文献记载与公开的技术方法。
技术实现思路
本专利技术的目的是提供一种实时性好，控制精度高，且能保证闭环系统稳定性的基于故障特征模型的挠性充液卫星姿态自适应容错控制方法，以提高挠性充液卫星姿态控制系统的可靠性，防止因执行器故障引起的卫星姿态失控。实现本专利技术目的的技术方案是：一种基于故障特征模型的挠性充液卫星姿态自适应容错控制方法，其通过以下步骤实现：第一步，根据(1)式所给出的挠性充液卫星姿态动力学方程，建立由(2)式所描述的故障特征模型：Iω·+ω×Iω+C0η··+Gq··=Td+u+f,η··+2ξΛη·+Λ2η+C0Tω·=0,q··+Λ2q+C1ω·+C2α=0,y=α,---(1)]]>(1)式中：为星体的姿态角矢量，为滚动角，θ为俯仰角，ψ为偏航角；u＝[u1,u2,u3]T为作用在星体上的控制力矩，是系统的输入；y为系统的输出；为星体的角速度矢量；η＝[η1,η2,…,ηm]T为挠性体模态坐标矢量：q＝[η1,η2,…,η3n]T为等效摆晃动模态坐标矢量，n为等效摆的个数；Td为作用在星体上的干扰力矩，为3维列矢量；I为卫星的转动惯量矩阵，为3阶方阵；C0为挠性体振动运动与星体转动运动耦合系数矩阵，其行数为3、列数为m；ξ为挠性体振动模态阻尼矩阵，为m阶对角阵；Λ为挠性体振动模态频率矩阵，为m阶方阵；Λ2为等效摆振动模态频率矩阵，为3n阶对角阵；G，C1，C2为等效摆振动运动与星体转动运动耦合系数矩阵，G的行数为3、列数为3n，C1，C2的行数均为3n、列数均为3；f为故障项，其表达式为：为关于α的矢量函数，为故障函数，diag表示对角矩阵，βi(t-Ti)是故障开关函数，定义为βi(t-Ti)={0,t<Ti,1,t≥Ti,,i=1,2,3,]]>Ti为第i个执行器故障发生的时刻；yi(k+1)=ai1(k)yi(k)+ai2(k)yi(k-1)+bi1(k)u‾1(k)+bi2(k)u‾2(k)+bi3(k)u‾3(k)+Ei(k),---(2)]]>(2)式中：i＝1,2,3；y1(k)为第k个采样时刻的滚动角y2(k)为第k个采样时刻的俯仰角θ，y3(k)为第k个采样时刻的偏航角ψ；为第k个采样时刻故障特征模型的总输入，包括：第k个采样时刻作用在星体上的控制力矩u、干扰力矩Td、第i个执行器发生故障时故障函数的量值以及由轨道坐标系至卫星本体坐标系进行坐标变换所涉及的常量；Ei(k)为建模误差；ai1(k)，ai2(k)，bi1(k)，bi2(k)，bi3(k)为故障特征模型的系数；第二步，利用参数估计算法对由第一步得到的故障特征模型的系数ai1(k)，ai2(k)，bij(k)(i,j＝1,2,3)进行辨识得到ai1(k)，ai2(k)，bij(k)的估计值，分别为：第三步，根据第二步得到的ai1(k)，ai2(k)，bij(k)的估计值设计容错控制器：ui(k)＝ugi(k)+uIi(k)，i＝1,2,3，(3)(3)式中：ui(k)为第k个采样时刻控制力矩u的第i个分量，ugi(k)为黄金分割自适应控制律，设计为ugi(k)=-b0i[l1a^i1ei(k)+l2a^i2(k)ei(k-1)]b^ii(k)+λ0i,i=1,2,3,---(4)]]>(4)式中：b0i，λ0i均为大于0的控制增益调节参数，视控制效果可适当增减；l1＝0.382，l2＝0.618，ei(k)＝yi(k)-yri，yri为姿态角的期望值，uIi(k)为逻辑积分控制律；第四步，将第三步设计的ui(k)施加到由(1)式所描述的系统中，以控制卫星的姿态角。本专利技术的有益效果是：①首次对含有故障的控制系统建立了特征模型，即故障特征模型，为挠性充液卫星姿态的容错控制打下了基础。②基于故障特征模型设计的黄金分割自适应容错控制器不依赖于特征模型的控制增益矩阵，从而避免了对多输入多输出耦合系统通过参数辨识可能使控制增益矩阵奇异的问题。③由于在黄金分割自适应控制律的分子中引入了控制增益调节参数，当由特征模型较小的辨识系数得到的较小控制量，达不到控制要求时，上述控制增益调节参数起到了放大作用。④该方法能有效克服挠性振动、液体晃动和外干扰对卫星姿态控制的影响。⑤使用该方法能保障故障发生前、后的控制精度均很高，且达到稳态的时间短。⑥本专利技术提出的控制方法保证了闭环系统的稳定性。附图说明图1为本专利技术实施例中对滚动角期望值yr1的跟踪曲线图；图2为本专利技术实施例中对俯仰角期望值yr2的跟踪曲线图；图3为本专利技术实施例中对偏航角期望本文档来自技高网...

【技术保护点】
一种基于故障特征模型的挠性充液卫星姿态自适应容错控制方法，其特征在于通过以下步骤实现：第一步，根据(1)式所给出的挠性充液卫星姿态动力学方程，建立由(2)式所描述的故障特征模型：Iω·+ω×Iω+C0η··+Gq··=Td+u+f,η··+2ξΛη·+Λ2η+C0Tω·=0,q··+Λ2q+C1ω·+C2α=0,y=α,---(1)]]>(1)式中：为星体的姿态角矢量，为滚动角，θ为俯仰角，ψ为偏航角；u＝[u1,u2,u3]T为作用在星体上的控制力矩，是系统的输入；y为系统的输出；为星体的角速度矢量；η＝[η1,η2,…,ηm]T为挠性体模态坐标矢量：q＝[η1,η2,…,η3n]T为等效摆晃动模态坐标矢量，n为等效摆的个数；Td为作用在星体上的干扰力矩，为3维列矢量；I为卫星的转动惯量矩阵，为3阶方阵；C0为挠性体振动运动与星体转动运动耦合系数矩阵，其行数为3、列数为m；ξ为挠性体振动模态阻尼矩阵，为m阶对角阵；Λ为挠性体振动模态频率矩阵，为m阶方阵；Λ2为等效摆振动模态频率矩阵，为3n阶对角阵；G，C1，C2为等效摆振动运动与星体转动运动耦合系数矩阵，G的行数为3、列数为3n，C1，C2的行数均为3n、列数均为3；f为故障项，其表达式为：为关于α的矢量函数，为故障函数，diag表示对角矩阵，βi(t‑Ti)是故障开关函数，定义为βi(t-Ti)=0,t<Ti,1,t≥Ti,,i=1,2,3,]]>Ti为第i个执行器故障发生的时刻；yi(k+1)=ai1(k)yi(k)+ai2(k)yi(k-1)+bi1(k)u‾1(k)+bi2(k)u‾2(k)+bi3(k)u‾3(k)+Ei(k),---(2)]]>(2)式中：i＝1,2,3；y1(k)为第k个采样时刻的滚动角y2(k)为第k个采样时刻的俯仰角θ，y3(k)为第k个采样时刻的偏航角ψ；为第k个采样时刻故障特征模型的总输入，包括：第k个采样时刻作用在星体上的控制力矩u、干扰力矩Td、第i个执行器发生故障时故障函数的量值以及由轨道坐标系至卫星本体坐标系进行坐标变换所涉及的常量；Ei(k)为建模误差；ai1(k)，ai2(k)，bi1(k)，bi2(k)，bi3(k)为故障特征模型的系数；第二步，利用参数估计算法对由第一步得到的故障特征模型的系数ai1(k)，ai2(k)，bij(k)(i,j＝1,2,3)进行辨识得到ai1(k)，ai2(k)，bij(k)的估计值，分别为：第三步，根据第二步得到的ai1(k)，ai2(k)，bij(k)的估计值设计容错控制器：ui(k)＝ugi(k)+uIi(k)，i＝1,2,3，       (3)(3)式中：ui(k)为第k个采样时刻控制力矩u的第i个分量，ugi(k)为黄金分割自适应控制律，设计为ugi(k)=-b0i[l1a^i1ei(k)+l2a^i2(k)ei(k-1)]b^ii(k)+λ0i,i=1,2,3,---(4)]]>(4)式中：b0i，λ0i均为大于0的控制增益调节参数，视控制效果可适当增减；l1＝0.382，l2＝0.618，ei(k)＝yi(k)‑yri，yri为姿态角的期望值，uIi(k)为逻辑积分控制律；第四步，将第三步设计的ui(k)施加到由(1)式所描述的系统中，以控制卫星的姿态角。...

【技术特征摘要】
1.一种基于故障特征模型的挠性充液卫星姿态自适应容错控制方法，其特征在于通过
以下步骤实现：
第一步，根据(1)式所给出的挠性充液卫星姿态动力学方程，建立由(2)式所描述的故
障特征模型：
Iω·+ω×Iω+C0η··+Gq··=Td+u+f,η··+2ξΛη·+Λ2η+C0Tω·=0,q··+Λ2q+C1ω·+C2α=0,y=α,---(1)]]>(1)式中：为星体的姿态角矢量，为滚动角，θ为俯仰角，ψ为偏航角；u＝
[u1,u2,u3]T为作用在星体上的控制力矩，是系统的输入；y为系统的输出；为星体的角
速度矢量；η＝[η1,η2,…,ηm]T为挠性体模态坐标矢量：q＝[η1,η2,…,η3n]T为等效摆晃动模
态坐标矢量，n为等效摆的个数；Td为作用在星体上的干扰力矩，为3维列矢量；I为卫星的转
动惯量矩阵，为3阶方阵；C0为挠性体振动运动与星体转动运动耦合系数矩阵，其行数为3、
列数为m；ξ为挠性体振动模态阻尼矩阵，为m阶对角阵；Λ为挠性体振动模态频率矩阵，为m
阶方阵；Λ2为等效摆振动模态频率矩阵，为3n阶对角阵；G，C1，C2为等效摆振动运动与星体
转动运动耦合系数矩阵，G的行数为3、列数为3n，C1，C2的行数均为3n、列数均为3；f为故障
项，其表达式为：
为关于α的矢量函数，为故障函
数，diag表示对角矩阵，βi(t-Ti)是故障开关函数，定义为
βi(t-Ti)=0,t<Ti,1,t&Gre...

【专利技术属性】
技术研发人员：孙多青，马晓英，
申请(专利权)人：河北科技师范学院，
类型：发明
国别省市：河北;13