基于非线性模型预测控制的空间系绳系统展开控制方法与流程

本发明涉及空间系绳系统展开控制方法，属于空间系绳系统应用技术领域。

背景技术：

空间系绳系统指一个用系绳连在一起共同完成在轨飞行的人造空间物体组合体，最具代表性的是将一颗卫星(子星)通过几米到几十千米甚至更长的系绳连接到另一颗质量较大的飞行器(主星)上，构成主星-系绳-子星空间组合体。主星可以是卫星、飞船、航天飞机、空间站等多种空间飞行器，甚至可以是废弃的末级运载火箭等；子星为小卫星、返回舱、微型探测器等。

复杂空间系绳系统由多个空间物体组成，用系绳把它们连接成闭环、树形或多面体等。空间系绳系统是人们在空间建造的一种新型结构，能够完成现有航天器不可能完成、不适于完成、不能低成本完成的任务。在大气测量、空间电动力学试验、微重力环境试验、合成孔径雷达以及有效载荷的再入轨等诸多方面具有其独特的优势，成为了近年来国内外研究的热点。在任意空间系绳系统任务中，都需要在发射至预定轨道后首先将系绳释放到预定长度。

由于空间系绳展开控制系统受到空间摄动影响，极易产生复杂的系绳振动问题，同时系统不仅是非线性的、典型的欠驱动系统，还受到一些物理限制，比如拉力始终是正的且有上限，这些给控制器的设计带来了困难。因此，需要对空间系绳系统展开释放稳定控制问题提出具有工程意义的控制方法。

技术实现要素：

本发明的目的在于针对上述现有技术中的问题，提供一种三维空间系绳系统展开释放稳定控制方法，针对近地轨道空间系绳系统展开控制问题，基于非线性模型预测控制(nmpc)方法，设计了一种仅通过调节系绳张力的非线性欠驱动空间系绳展开控制律。

为了实现上述目的，本发明的技术解决方式是：一种基于非线性模型预测控制的空间系绳系统展开控制方法，步骤如下：

(1)确定近地椭圆轨道运行的三维空间系绳系统的轨道参数、系绳总长度ldt、系绳总质量mt、主星质量m1、子星质量m2，所述的轨道参数为平均角速度为ω，近地点幅角ω，真近点角v，为轨道倾角i，升交点赤经系统的运动在轨道坐标系o-xyz下描述，ox轴指向地球与系统连线方向，oy轴沿着系统轨道运行方向，oz轴垂直于轨道平面，与ox、oz组成右手坐标系。

(2)确定近地椭圆轨道运行的三维空间系绳系统模型，并为了方便计算，进行时间和绳长的无量纲化处理，确定无量纲的摆动角与绳长变化动力学方程；

(3)确定释放过程中非线性预测控制优化函数，根据系绳能够提供的拉力上限、敏感器的测量范围和任务要求，确定系绳张力约束和系绳摆动角的约束；

(4)系绳被释放后，利用敏感器测得系绳释放状态变量，包括系绳面内角及角速度α(t),系绳面外角及角速度β(t),系绳长度及速度ld(t),然后根据步骤(2)中确定的动力学模型及步骤(3)中确定的释放过程中非线性预测控制优化函数，系绳张力约束和系绳摆动角的约束，采用基于优化算法的非线性预测控制方法，在每个采样时刻n，根据系统当前的状态对系统将来的有限时间域的采样时刻k＝0,...,n-1(n≥2)的状态进行优化，并将得到的最优控制序列的第一个控制量作为下一次采样周期的反馈控制量。在下一次采样时刻，时间序列向前推进一个采样周期，应用新的系统状态测量值进行新的最优问题的求解，直至系绳释放至全长为止，最终得到三维空间系绳系统在初始阶段展开的稳定控制律。

所述步骤(2)中，不失一般性，作如下假设：

系绳为质量分布均匀的无弹性变形的刚性绳；系绳张力沿着绳的方向,没有法线方向的能量耗散；系绳两端卫星视为质点，不考虑卫星本体的姿态。

空间系绳系统的姿态由面内角α、面外角β来描述。采用欧拉-拉格朗日方法对系统建模，

式中，q＝[α,β,ld]^t为系统广义坐标，为广义力，ta为系绳张力，l为拉格朗日函数，由系统的动能和势能组成。

应用拉格朗日第二定理求得系统的动力学方程为

式中：为系统等效质量，is为系统转动惯量。()′为对时间t的导数。进一步，为了方便计算，将方程进行无维化，定义新的导数为对无维化时间τa的导数，d()/dt＝ωd()/dτa，ε＝ld/lc，lc为参考长度，设等于系绳总长度ldt。得到如下动力学方程

所述步骤(3)中，释放过程中非线性预测控制优化函数jn为

其中

矩阵q和r分别为输出与输入权重矩阵，定义tamax为系绳最大拉力，αmax,βmax分别为面内角和面外角的最大值，约束条件可以写为

0＜ta≤tamax(8)

-αmax≤α≤αmax,-βmax≤β≤βmax(9)

所述步骤(4)中具体步骤为

第一步，空间系绳系统子星初始阶段被弹射分离后，利用敏感器测得系绳释放过程的状态变量，包括系绳面内角及角速度α(t),系绳面外角及角速度β(t),系绳长度及速度ld(t),并确定展开过程的预测控制的控制周期t；

第二步，采用勒让德伪光谱算法将步骤(2)中确定的无维化后动力学模型进行离散化，将所有变量，包括系统的微分方程、代数方程、输入和输出进行离散化，形成一个非线性规划问题。这种离散化是基于正交分配方法，即在正交多项式零点处，对状态近似值的导数进行分配，使其逼近真实的导数。之后系统离散为代数方程组，这样就可以用非线性规划方法来求取离散系统的最优值。

连续状态和控制变量的近似离散化过程如下所示：

空间系绳系统模型动力学模型可表示为如下一般非线性系统的形式

其中，状态变量其对应的离散系统为

x(k+1)＝f(x(k),ta(k))(11)

其中，pj(τ)是nc阶的拉格朗日插值多项式，通过勒让德多项式的根计算得到。在对空间系绳系统模型离散化后，预测控制中有约束的最优化问题可以表示为一个如下的非线性规划问题：

寻找状态与控制向量x^*(τj),ta^*(τj)，使得下面性能指标最小

其中，

x(τj)∈x,ta(τj)∈u(16)

满足

x(τ0)＝x0(18)

-αmax≤α(τj)≤αmax,-βmax≤β(τj)≤βmax,0＜ta(τj)≤tamax(19)

式中：x和u为状态与控制的紧集，f(·)为在x×u上的lipschitz的连续函数。wj是第j个正交点上的权重函数，hi＝τi+1-τi(i＝0,1,...,nc-1)为时间长度，j(x(τj),ta(τj))是问题的目标函数，x0是状态变量的初始值。这样，非线性规划问题的目标与约束函数都是至少二阶连续可微的。

第三步，采用基于matlab的snopt工具进行非线性规划最优化问题的求解。在求解非线性规划问题是，规划初始值的选取对于优化计算时间与最终收敛结果有一定影响，因此，本发明采用移位法对规划初值进行选取，假设当前规划的结果位于前次规划结果的附近，设上一次规划的结果为

在选择下一控制周期的规划初值时，将p^*中的和移除，并在后面补充新的初值新的初值可简单的选为p^*中的前一项，即

通过上述方法所得到的新的规划初始值p0为

第四步，在预测周期[n,n+n-1]内得到的最优控制序列表示为将得到的最优控制序列的第一段ta^t(0)结合零阶保持器作为下一周期控制输入，构成闭环控制。在下一次采样时刻，时间序列向前推进一个采样周期，应用新的系统状态测量值进行新的最优问题的求解，直至系绳释放至全长为止，最终得到三维空间系绳系统在初始阶段展开的稳定控制律。

与现有技术相比，本发明具有如下的有益效果：

(1)本发明建立了考虑系绳质量的二体空间系绳系统动力学模型，考虑了展开过程中系统质心与等效质量随展开系绳长度的变化，减小了数学模型与实际系统的建模误差。

(2)本发明提出的控制算法，在考虑空间环境干扰下，仅通过调节系绳张力，不依赖其它推进器，将系绳释放至期望长度并保持系统稳定，减少了燃料消耗，提高了系统的可靠性和适应性。

(3)本发明考虑系绳张力与系绳面内外角存在约束的条件下，提出了一种基于优化理论的非线性模型预测控制律，能够满足提出的指标的最优化，实现了对欠驱动系统的闭环稳定控制。系绳长度可释放至目标长度，同时，系绳姿态面内外角分别保持在小幅度摆动，设计的姿态控制器具有鲁棒性，能够对释放过程中存在的系统不确定性及空间干扰形成有效抑制，保证了系统的稳定性，达到了控制要求，具有潜在的应用前景。

附图说明

图1为本发明实施例的空间系绳系统示意图；

图2为本发明实施例的控制系统框图。

具体实施方式

本发明可用于三维空间系绳系统，空间系绳系统指一个用系绳连在一起共同完成在轨飞行的人造空间物体组合体，最具代表性的是将一颗卫星(子星)通过几米到几十千米甚至更长的系绳连接到另一颗质量较大的飞行器(主星)上，构成主星-系绳-子星空间组合体。主星可以使卫星、飞船、航天飞机、空间站等多种空间飞行器，甚至可以是废弃的末级运载火箭等；子星为小卫星、返回舱、微型探测器等。在任意空间系绳系统任务中，都需要在发射至预定轨道后首先将系绳释放到预定长度。本发明主要解决其发射至预定轨道后在初始阶段将系绳稳定释放到预定长度的控制问题。

下面结合附图对本发明做进一步的详细说明。

(1)空间系绳系统释放展开过程动力学模型

考虑图1所示的空间系绳系统，主星s1与子星s2通过一根长度可变的系绳连接，为了便于动力学分析与控制器设计，假设系绳为刚性绳，且忽略卫星姿态。两颗星质量分别为m1和m2，系绳总质量为mt，可变绳长为ld，系统质心o在近地轨道运行，平均角速度为ω，图中ω为近地点幅角，v为真近点角，i为轨道倾角，为升交点赤经，系统的运动在轨道坐标系o-xyz下描述，ox轴指向地球与系统连线方向，oy轴沿着系统轨道运行方向，oz轴垂直于轨道平面，与ox、oz组成右手坐标系。空间系绳系统的姿态由如图1所示的面内角α、面外角β来描述。

考虑图1所示的空间系绳系统，为简化分析过程，作如下假设：系绳为质量分布均匀的无弹性变形的刚性绳；系绳张力沿着绳的方向，没有法线方向的能量耗散；系绳两端卫星视为质点，不考虑卫星本体的姿态。

采用欧拉-拉格朗日方法对系统建模，根据欧拉-拉格朗日方程

式中，q＝[α,β,ld]^t，为广义力，ta为绳系的拉力。l为拉格朗日函数，由系统的动能和势能组成。系统的动能可以写为

其中，r为系统的轨道半径，系统总质量m＝m1+m2+mt，系统等效质量φ∈[0,π/2]由l1＝ldsin²φ和l2＝ldcos²φ定义，l1和l2分别为系统质心与两颗卫星的距离，φ的变化可以通过如下关系求得

定义md为释放出的系绳质量，λt＝mt/m,λd＝md/m，经过推导系统转动惯量可以计算为

因系绳释放过程中，系统的转动惯量随着绳长发生变化，经过计算，转动惯量随时间变化可以表示为

由于地球轨道半径r远大于系绳长度，且μer^-1＝ω²r²，μe为地球引力常数，则系统势能可以近似为

综上所述，空间系绳系统的拉格朗日函数为

应用拉格朗日第二定理求得系统的动力学方程为

真近点角与地心半径的关系可以写为

ν′＝(μe/p³)^0.5(1+ecosν)²(33)

式中：e为轨道偏心率。

为了方便计算，将方程进行无维化，得到如下动力学方程

式中：各导数为对无维化时间τa的导数，d()/dt＝ωd()/dτa，ε＝ld/lc，lc为参考长度，设为系绳总长度。

(2)非线性模型预测控制方法

非线性预测控制(nmpc)是一种基于优化算法的控制方法，根据过去和现在的控制量确定影响系统将来响应的控制量。主要目标是通过最小化所选择的系统性能指标设计控制序列。在每个采样时刻n，根据系统当前的状态对系统将来的有限时间域的采样时刻k＝0,...,n-1(n≥2)的状态进行优化，并将得到的最优控制序列的第一个控制量作为下一次采样周期的反馈控制量。在下一次采样时刻，时间序列向前推进一个采样周期，应用新的系统状态测量值进行新的最优问题的求解。为简化分析，本发明将考虑控制时域与预测时域相同，且采样周期为定值的情况，此外控制量以零阶保持器的形式作用于被控系统，即在整个采样周期内为定值。

首先确定释放过程中非线性预测控制优化函数jn为

其中

矩阵q和r分别为输出与输入权重矩阵，定义tamax为系绳最大拉力，αmax,βmax分别为面内角和面外角的最大值，约束条件可以写为

0＜t≤tamax(39)

-αmax≤α≤αmax,-βmax≤β≤βmax(40)

算法可调整的参数为目标函数中的权重矩阵(q,r)、预测的步长与控制采样周期。由于在每个采样周期的最优化问题的全部解是需要计算的，为了防止计算的延迟和控制性能的退化，非线性最优化问题的求解时间必须小于系统的采样周期。因此，需要寻找一种合适的离散化与优化算法来解决这个问题，同时也要考虑动力学系统的状态与控制的各种约束。

空间系绳系统模型动力学模型可表示为如下一般非线性系统的形式

其中，状态变量其对应的离散系统为

x(k+1)＝f(x(k),ta(k))(42)

与一般解决最优控制问题的梯度等数值方法不同，本发明采用勒让德(legendre)伪光谱算法(lpm)进行优化问题的求解。首先将所有变量，包括系统的微分方程，代数方程，输入和输出进行离散化，形成一个非线性规划问题。这种离散化是基于正交分配方法，即在正交多项式零点处，对状态近似值的导数进行分配，使其逼近真实的导数。之后系统离散为代数方程组，这样就可以用非线性规划方法来求取离散系统的最优值。

在预测控制中，整个释放过程时间在nc个正交点上进行离散化。通过这个过程，微分方程转化为一系列代数方程。正交点是由正交多项式的根决定的，维数等同于每一段正交点的个数。在lpm中，采用的正交点是lgl点，将每一等时间段转化为τj∈[-1,1]区间内，对应于nc阶勒让德正交多项式pn(τj)的导数的根。那么，连续状态和控制变量的近似离散化过程如下所示

其中，pj(τ)是nc阶的拉格朗日插值多项式，通过勒让德多项式的根计算得到。在对空间系绳系统模型离散化后，预测控制中有约束的最优化问题可以表示为一个如下的非线性规划问题：

寻找状态与控制向量x^*(τj),ta^*(τj)，使得下面性能指标最小

其中，

x(τj)∈x,ta(τj)∈u(47)

满足

x(τ0)＝x0(49)

-αmin＜α(τj)＜αmax,-βmin＜β(τj)＜βmax,0≤ta(τj)≤tamax(50)

式中：x和u为状态与控制的紧集，f(·)为在x×u上的lipschitz的连续函数。wj是第j个正交点上的权重函数，hi＝τi+1-τi(i＝0,1,...,nc-1)为时间长度，j(x(τj),ta(τj))是优化目标函数，x0是状态变量的初始值。

采用基于matlab的snopt工具进行非线性规划最优化问题的求解。在求解非线性规划问题时，规划初始值的选取对于优化计算时间与最终收敛结果有一定影响，因此，本发明采用移位法对规划初值进行选取，假设当前规划的结果位于前次规划结果的附近，设上一次规划的结果为

在选择下一控制周期的规划初值时，将p^*中的和ta^*t(n)移除，并在后面补充新的初值新的初值可简单的选为p^*中的前一项，即

通过上述方法所得到的新的规划初始值p0为

在预测周期[n,n+n-1]内得到的最优控制序列表示为将得到的最优控制序列的第一段ta^t(0)结合零阶保持器作为下一周期控制输入，构成闭环控制。在下一次采样时刻，时间序列向前推进一个采样周期，应用新的系统状态测量值进行新的最优问题的求解，直至系绳释放至全长为止，最终得到三维空间系绳系统在初始阶段展开的稳定控制律。