一种考虑飞轮动态特性的航天器姿态规避的模型预测控制方法技术

一种考虑飞轮动态特性的航天器姿态规避的模型预测控制方法，包括以下步骤：基于航天器的姿态动力学和飞轮的动力学建立预测模型；其次根据飞轮的动态特性以及仪器视线角建立约束的数学模型；然后设计面向不同任务需求的性能指标函数，将控制问题转换成在等式和不等式约束条件下，求目标函数的极值问题；最后，通过基于实时迭代的优化方法，快速求解上述问题，该方法能够很好的处理航天器在执行机构约束情况下的姿态规避问题，通过对目标函数的设计达到能量和时间的综合最优，并且通过实时迭代和热启动方法的处理，并能够减小求解优化问题的计算量。

A model predictive control method for spacecraft attitude avoidance considering dynamic characteristics of flywheels

A model predictive control method for spacecraft attitude avoidance considering the dynamic characteristics of flywheels includes the following steps: establishing a predictive model based on spacecraft attitude dynamics and flywheel dynamics; establishing a constrained mathematical model based on the dynamic characteristics of flywheels and instrument line-of-sight angle; and then designing a model for different mission requirements. The control problem is transformed into the extreme value problem of the objective function under the constraints of equality and inequality. Finally, the problem is solved quickly by the optimization method based on real-time iteration, which can deal with the attitude avoidance problem of spacecraft under the constraints of actuator. Through the design of the objective function, the energy and time can be optimized, and the real-time iteration and thermal start-up can be used to reduce the computational complexity of solving the optimization problem.

【技术实现步骤摘要】
一种考虑飞轮动态特性的航天器姿态规避的模型预测控制方法
本专利技术涉及属于航天器控制
，主要应用于使用反作用飞轮控制的航天器姿态机动的规避控制，具体涉及一种考虑飞轮动态特性的航天器姿态规避的模型预测控制方法。
技术介绍
近年来空间技术的发展飞速，在轨航天器的任务要求也越来越多，所以在航天器上都搭载有各种光学仪器，如CCD相机、红外干涉仪等，在这些仪器工作的过程中都需要使其视线避免直接对向强光，以保护仪器中对光照和温度比较敏感的元器件。所以这就要求航天器在姿态机动的过程中，使这些仪器的指向应绕开强光的方向。同时，大多数航天器姿态控制系统中的执行机构为反作用飞轮组合，反作用飞轮具有控制精度高、输出力矩只需消耗电能等优点。但是反作用飞轮在使用过程中也存在着反作用力矩比较小，容易达到饱和等问题，从而影响到航天器的姿态控制。所以，研究航天器在执行机构性能的约束条件下的姿态规避问题就的意义十分重要。关于姿态规避的方法可以有专利201710521561.X中提到的势函数法，势函数法可以有效的规避约束区域，不过使用模型预测控制的方法，不仅能考虑姿态规避约束，并能够考虑执行机构的性能约束，此外还能根据性能函数，实现能量和时间的优化，更适用于在执行机构性能约束下的姿态机动控制。
技术实现思路
本专利技术的目的在于克服现有技术的不足，提供一种考虑飞轮动态特性的航天器姿态规避的模型预测控制方法，在轨航天器的姿态机动过程中存在的执行机构性能约束和姿态约束的问题，本专利技术提供一种考虑飞轮动态特性的航天器姿态规避的模型预测控制方法。该方法是一种能同时处理执行机构的性能约束以及姿态规避模型预测控制方法，它在优化过程中使用了实时迭代和热启动的方法来提高求解MPC中优化问题的求解效率，并设计了性能函数使得在姿态机动过程中实现能耗和时间的综合最优。本专利技术提供了一种考虑飞轮动态特性的航天器姿态规避的模型预测控制方法，包括以下步骤：(1)根据航天器的姿态运动学和动力学特性以及飞轮的转动动力学特性建立包含执行机构的航天器姿态模型作为MPC的预测模型；(2)根据航天器搭载仪器的视线角以及规避向量建立姿态规避约束的数学模型，并根据飞轮的角动量饱和以及力矩饱和特性建立执行机构约束的数学模型；(3)根据任务需求设计相应的优化目标函数，包含执行机构输入的二次型以及系统状态误差的二次型，以综合考虑执行时间和能量消耗；(4)将控制问题转换成在系统动力学方程的等式和状态和输入受限的不等式约束条件下，求目标函数极值的问题，然后用实时迭代的优化处理方法快速求解，将优化得到的解作为系统的控制量输出。在步骤(1)所述的航天器姿态动力学模型，是通过将飞轮的动力学方程结合到航天器姿态动力学方程中，并离散化处理的到的，其表示形式如下：其中，ω＝[ω1,ω2,ω3]T表示航天器在本体坐标系下相对惯性坐标系的姿态角速度向量，ω1,ω2,ω3分别为航天器关于本体系中的横滚轴、偏航轴和俯仰轴上的角速度分量；表示ω对时间的导数；J是航天器总的惯量矩阵，简化表示为对角阵J＝diag(J1,J2,J3)，J1,J2,J3为绕惯量主轴的转动惯量；S(ω)是斜对称矩阵，其形式为τ表示执行机构的输出力矩；q＝[q0,q1,q2,q3]T表示航天器的姿态单位四元数，表示航天器的姿态单位四元数中的标量部分，θ表示绕着欧拉轴转过的一个角度，ex,ey,ez代表欧拉轴三个方向上的旋转轴，且满足表示q对时间的导数；Ω(ω)是斜对称矩阵，其形式如下：反作用飞轮组合的模型如下：其中Hrw为飞轮组合的角动量，为飞轮组合的角动量相对时间的导数，在由四个飞轮组成的飞轮组合中其角动量与转速的关系如下：Hrw＝CJrwN其中C为3×4飞轮安装矩阵，N＝[n1,n2,n3,n4]T为飞轮的角速度向量，n1,n2,n3,n4分别表示每个飞轮的角速度；Jrw表示飞轮组合的转动惯量矩阵，其形式为Jrw＝JαI4×4，Jα表示单个飞轮的转动惯量，I4×4为4阶单位矩阵；由于执行机构是通过与航天器交换角动量的方式来控制姿态，所以系统总的角动量守恒：H＝Hrw+JωH为系统总的角动量，在无外力矩时为一个常数。将执行机构的模型和航天器姿态动力学的模型整合起来得到：将上述模型离散化，设置采样间隔为Δt得到，在第k时刻有：ωk+1＝J-1ΔtS(ωk)H+J-1JαCΔNk+ωk其中下标k表示对应变量在第k时刻的值，ΔNk＝Nk-Nk-1，I3×3为三阶单位矩阵。在步骤(2)中：(a)反作用飞轮最大输出力矩约束：反作用飞轮的力矩输出是改变飞轮的角动量实现的，所以有如下形式表述：其中Tmax为最大输出力矩向量。将上述式子离散化后得到：整理后得到：(b)反作用飞轮最大角动量约束：飞轮的角动量饱和体现为飞轮转子的转速达到上限，所以角动量饱约束可以用飞轮角速度约束来表示：-Nmax≤ΔNk+Nk-1≤Nmax其中Nmax为飞轮最大角速度向量。整理后得到：(c)航天器姿态指向的视线角约束：考虑航天器的指向要规避某些锥形视线区，设计的姿态约束如下形式：其中α表示航天器在本体坐标系下指向的单位向量，β表示航天器在本体坐标系下需规避方向的单位向量，θ表示规避区域的视线角的大小。在步骤(3)中优化目标函数函数V(xk,uk)表示为：其中xk＝[qk,ωk]T表示系统的状态量，物理意义为航天器的姿态以及角速度；以飞轮组合转速变化量作为输入，即uk＝ΔNk；NP为MPC的预测范围；Q和P为状态变量和输入变量的权重矩阵，若Q相对于P较大则说明优化目标更注重于稳定的时间，若Q相对于P较大则说明优化目标更注重于能量的消耗；整理成简洁形式：其中在步骤(4)中，将控制问题转换为在约束条件下求目标函数的极值问题，并用实时迭代的方法求解控制量。将求解控制输入的问题转换为如下数学问题：xi,k+1＝F(xi,k,ui,k)L(xi,k,ui,k)≤017×1k＝0,1,…,NP-1其中表示在时刻i的最优化问题，表示在当前时刻i系统的状态反馈，xi,k表示由当前时刻状态xi,0推算的第k时刻的系统状态；ui,k表示第k时刻的预计输入，017×1表示17×1的零矩阵；F(xi,k,ui,k)为系统状态方程，具体表示为：L(xi,k,ui,k)为系统约束，具体表示为：使用实时迭代的方法的处理过程为：已知前一时刻优化问题求解出来的求出来的和进而求解优化问题具体分为两个阶段：准备阶段和响应阶段：准备阶段过程为：将xi-1和ui-1做一个采样时刻的移位，保持最后一个元素不变，得到和根据和计算敏感矩阵Ai,k,Bi,k,Ci,k,Di,k和误差li,k,ri,k，具体表达式为：通过线性化，把一个非线性约束的优化问题转化成线性约束的二次规划问题：Δui,k＝ui,k-ui-1,kΔxi,k+1＝Ai,kΔxi,k+Bi,kΔui,k+ri,kCi,kΔxi,k+Di,kΔui,k+li,k≤0k＝0,1,…,NP-1响应阶段的过程为：获取系统的状态反馈带入求解问题得到Δxi,k和Δui,k通过式子：得到问题的解(xi,k,ui,k)，最后再将ui＝ui,0作为系统的控制输入。本专利技术的考虑飞轮动态特性的航天器姿态规避的模型预测控制方法，可以使航天器在姿态机动过程中，执行机构性能有限的情本文档来自技高网...

【技术保护点】
1.一种考虑飞轮动态特性的航天器姿态规避的模型预测控制方法，其特征在于，包括以下步骤：(1)根据航天器的姿态运动学和动力学特性以及飞轮的转动动力学特性建立包含执行机构的航天器姿态模型作为MPC的预测模型；(2)根据航天器搭载仪器的视线角以及规避向量建立姿态规避约束的数学模型，并根据飞轮的角动量饱和以及力矩饱和特性建立执行机构约束的数学模型；(3)根据任务需求设计相应的优化目标函数，包含执行机构输入的二次型以及系统状态误差的二次型，以综合考虑执行时间和能量消耗；(4)将控制问题转换成在系统动力学方程的等式和状态和输入受限的不等式约束条件下，求目标函数的极值，用实时迭代的优化处理方法快速求解，将优化得到的解作为系统的控制量输出。

【技术特征摘要】
1.一种考虑飞轮动态特性的航天器姿态规避的模型预测控制方法，其特征在于，包括以下步骤：(1)根据航天器的姿态运动学和动力学特性以及飞轮的转动动力学特性建立包含执行机构的航天器姿态模型作为MPC的预测模型；(2)根据航天器搭载仪器的视线角以及规避向量建立姿态规避约束的数学模型，并根据飞轮的角动量饱和以及力矩饱和特性建立执行机构约束的数学模型；(3)根据任务需求设计相应的优化目标函数，包含执行机构输入的二次型以及系统状态误差的二次型，以综合考虑执行时间和能量消耗；(4)将控制问题转换成在系统动力学方程的等式和状态和输入受限的不等式约束条件下，求目标函数的极值，用实时迭代的优化处理方法快速求解，将优化得到的解作为系统的控制量输出。2.根据权利要求1所述的方法，其特征在于：将飞轮的动力学方程结合到航天器姿态动力学方程中，并离散化处理，建立MPC的预测模型。3.根据权利要求2所述的方法，其特征在于：步骤(1)中的航天器姿态动力学模型如下表示：其中，ω＝[ω1,ω2,ω3]T表示航天器在本体坐标系下相对惯性坐标系的姿态角速度向量，ω1,ω2,ω3分别为航天器关于本体系中的横滚轴、偏航轴和俯仰轴上的角速度分量；表示ω对时间的导数；J是航天器总的惯量矩阵，简化表示为对角阵J＝diag(J1,J2,J3)，J1,J2,J3为绕惯量主轴的转动惯量；S(ω)是斜对称矩阵，其形式为τ表示执行机构的输出力矩；q＝[q0,q1,q2,q3]T表示航天器的姿态单位四元数，表示航天器的姿态单位四元数中的标量部分，θ表示绕着欧拉轴转过的一个角度，ex,ey,ez代表欧拉轴三个方向上的旋转轴，且满足表示q对时间的导数；Ω(ω)是斜对称矩阵，其形式如下：反作用飞轮组合的模型如下：其中Hrw为飞轮组合的角动量，为飞轮组合的角动量相对时间的导数，在由四个飞轮组成的飞轮组合中其角动量与转速的关系如下：Hrw＝CJrwN其中C为3×4飞轮安装矩阵，N＝[n1,n2,n3,n4]T为飞轮的角速度向量，n1,n2,n3,n4分别表示每个飞轮的角速度；Jrw表示飞轮组合的转动惯量矩阵，其形式为Jrw＝JαI4×4，Jα表示单个飞轮的转动惯量，I4×4为4阶单位矩阵；由于执行机构是通过与航天器交换角动量的方式来控制姿态，所以系统总的角动量守恒：H＝Hrw+JωH为系统总的角动量，在无外力矩时为一个常数；将执行机构的模型和航天器姿态动力学的模型整合起来得到：将上述模型离散化，设置采样间隔为Δt得到，在第k时刻有：ωk+1＝J-1ΔtS(ωk)H+J-1JαCΔNk+ωk其中下标k表示对应变量在第k时刻的值，ΔNk＝Nk-Nk-1，I3×3为三阶单位矩阵。4.根据权利要求3所述的方法，其特征在于：步骤(2)中...

【专利技术属性】
技术研发人员：胡庆雷，杨昊旸，郭雷，王陈亮，
申请(专利权)人：北京航空航天大学，
类型：发明
国别省市：北京,11