本发明涉及一种基于改进高斯伪谱法的空间柔性系统展开控制方法，建立自主机动空间柔性系统展开动力学模型；基于自主机动空间柔性系统展开动力学模型提出适合于伪谱法的标准Bolza问题；将标准的Bolza问题通过一种0转化为非线性规划问题；设计了改进的高斯伪谱法的迭代算法。积极效果：采用一种改进的高斯伪谱法，将自主机动空间柔性系统展开运动路径优化转化为非线性规划问题，设计了改进的高斯伪谱法的迭代算法。通过改进的高斯伪谱法得到光滑连续的状态变量和控制变量，设计的迭代算法可以提前结束规划循环，在满足优化条件的前提下，缩短时间。
1.一种基于改进高斯伪谱法的空间柔性系统展开控制方法，其特征在于步骤如下：步骤1、建立自主机动空间柔性系统展开动力学模型：以空间柔性系统质心为原点的轨道系O-xyz，Ox沿轨道半径由地心指向空间柔性系统质心，Oy垂直于Ox且指向平台前进的方向，Oz垂直于轨道平面且构成右手定则；在轨道系中，三个自主机动单元(1)的质量为mj，相对于轨道系原点的位置为rj＝(xj,yj,zj)T，j＝1,2,3；
μ1(μ2+μ3){Υ″1-Υ1(θ1'+1)2+Υ1(1-3cos2θ1)}+μ1μ3{[Υ2θ2”+2Υ'2(θ2'+1)]sin(θ1-θ2)+[Υ”2-Υ2θ2'(θ2'+2)]cos(θ1-θ2)-3Υ2cosθ1cosθ2}＝-Ω1-Ω3(Υ1+Υ2cos(θ2-θ1))/Υ3-Γ1(μ2+μ3)+Γ2μ1cos(θ1-θ2)-Γ3μ1(Υ1+Υ2cos(θ2-θ1))/Υ3μ3(μ1+μ2){Υ”2-Υ2(θ2'+1)2+Υ2(1-3cos2θ2)}+μ1μ3{-[Υ1θ1”+2Υ'1(θ1'+1)]sin(θ1-θ2)+[Υ″1-Υ1θ1'(θ1'+2)]cos(θ1-θ2)-3Υ1cosθ1cosθ2}＝-Ω2-Ω3(Υ1cos(θ2-θ1)+Υ2)/Υ3-Γ1μ3cos(θ1-θ2)-Γ2μ3-Γ3(μ1+μ2)(Υ1cos(θ2-θ1)+Υ2)/Υ3所述
其中： 是rj对时间的一阶导数，l1是连接自主机动单元m1和m2的系绳长度，l2是连接自主机动单元m2和m3的系绳长度，l3是连接自主机动单元m1和m3的系绳长度，θ1和θ2分别是系绳l1和l2与Ox轴之间的夹角，ω是轨道角速度， 分别是l1、l2、θ1、θ2对时间的一阶导数， 分别是l1、l2、θ1、θ2对时间的二阶导数，q是系统的广义坐标系，定义为q＝[θ1,θ2,l1,l2]T，表示广义坐标对时间的一阶导数，T1、T2、T3分别表示系绳的拉力，Fj表示3个自主机动单元的机动力，j＝1,2,3，R0，R0分别表示地心到轨道坐标系原点的距离和矢量，Υ1、Υ2、Υ3、Υ'1、Υ'2、Υ″1、Υ″2分别是l1、l2、l3、无量纲化后对应的量，θ′1、θ′2、θ″1、θ″2分别是 无量纲化后对应的量，L为无量纲化常量；
步骤2、将自主机动空间柔性系统展开动力学模型转换为标准Bolza问题：B(x(τ0),x(τf),t0,tf)＝0C(x(τ),u(τ),τ,t0,tf)≤0所述 为性能指标函数，其中，t0为运动起始时间，tf为待定终端时间；α和αi为给定的正实数，α是对终端时间的加权，αi是对各自主机动力作为控制量时燃料消耗的加权；Fi表示各自主机动力；
u＝[T1,T2,T3,F1,F2,F3]T为系统的控制变量：所述B(x(τ0),x(τf),t0,tf)＝0为状态变量的边界条件：其中， 分别是l1,l2,θ1,θ2, 在t0时刻的值，分别是l1,l2,θ1,θ2, 在tf时刻的值；
所述C(x(τ),u(τ),τ,t0,tf)≤0为路径约束条件：其中，l1min,l2min,θ1min,θ2min, T1min,T2min,T3min,F1min,F2min,F3min分别是l1,l2,θ1,θ2, T1,T2,T3,F1,F2,F3最小值，l1max,l2max,θ1max,θ2max, T1max,T2max,T3max,F1max,F2max,F3max分别是l1,l2,θ1,θ2, T1,T2,T3,F1,F2,F3最大值；
步骤3、将标准的Bolza问题通过一种改进的高斯伪谱法转化为非线性规划问题：将状态变量在前N+1个LG节点上进行Hermite插值近似，得到：其中，
控制变量在区间(τ0,τf)中的LG节点上进行Hermite插值近似，得到：其中，
是u(τ)的插值近似函数， 是 的导数，终端时刻的控制变量通过曲线的延拓得到；
将状态方程中的状态变量的导数在τk时刻进行离散化：状态方程式转化为代数约束：
根据高斯积分公式，τf终端时刻的终端状态表示为：其中，高斯型求积系数Ak通过下式计算：
步骤4、采用改进的高斯伪谱法的迭代算法运算步骤3中的规划问题：
1)选择离散点的个数N+2，即N次Legendre多项式的零点和两个端点值；
4)检验状态约束和路径约束，如果仅在插值点τk处超过了约束条件允许相对误差条件，则转到5)，存在不同插值点处超过约束条件相对误差条件，则转到7)，否则转到6)；
6)如果哈密尔顿函数值接近0或者某一常数，则终止计算，否则转到7)；
7)增加节点数Ni+2，Ni+1＝Ni+δn，其中，δn≥1是给定的常数；
8)将控制变量、状态变量和系统参数作为下一步计算的初始值，返回步骤2)。
一种基于改进高斯伪谱法的空间柔性系统展开控制方法
技术领域
[0001] 本发明属于绳系航天器展开控制技术的研究，涉及一种基于改进高斯伪谱法的空间柔性系统展开控制方法，具体涉及空间柔性系统在展开过程中实现终端状态的一种路径规划的最优控制方法。
背景技术
[0002] 空间柔性系统是一种具有绳系结构的空间机器人系统，具有高灵活性和高安全性。在空间在轨捕获和轨道清理任务中将会扮演重要角色。本专利所提出的自主机动空间柔性系统是一种由“”空间平台+柔性绳网+自主机动单元”组成的新型航天器。柔性绳网的网口形状为三角形，3个自主机动单元分别位于柔性绳网的三个顶角上。
[0003] 空间柔性系统的展开是一个复杂的动力学过程，不恰当的展开方式可能导致网绳单元和网面的剧烈振动，甚至出现网绳缠绕等危险情形。目前，针对飞网展开所提出的方式主要有旋转展开、刚性构件支撑展开和弹射展开三种。但这三种展开方式对网口最大展开面积和飞网有效作用时间都有很大的影响，严重限制了其操作距离和机动性。
[0004] 柔性网完全展开后，在自主机动单元及空间平台的支持下，控制并保持柔性网的网型。国内学者针对自主机动空间柔性系统的展开控制技术提出了一些策略，例如，在文献《一种空间飞网机器人网型保持控制方法》中，设计了一种基于积分切换函数的滑模变结构控制器，保证各自主机动单元以一定相对速度沿着期望轨迹运动，进而实现网型保持的目的。在文献《空间飞网机器人网型保持控制方法研究》中，提出了一种基于Leader-Follower方法的网型保持控制策略，有效实现空间飞网机器人逼近目标过程中的网型保持控制。
发明内容
[0005] 要解决的技术问题
[0006] 为了避免现有技术的不足之处，本发明提出一种基于改进高斯伪谱法的空间柔性系统展开控制方法，使展开消耗的时间和燃料达到相对最少的一种最优控制。
[0007] 技术方案
[0008] 一种基于改进高斯伪谱法的空间柔性系统展开控制方法，其特征在于步骤如下：
[0009] 步骤1、建立自主机动空间柔性系统展开动力学模型：以空间柔性系统质心为原点的轨道系O-xyz，Ox沿轨道半径由地心指向空间柔性系统质心，Oy垂直于Ox且指向平台前进的方向，Oz垂直于轨道平面且构成右手定则；在轨道系中，三个自主机动单元(1)的质量为Tmj，相对于轨道系原点的位置为rj＝(xj,yj,zj) ，j＝1,2,3；
[0010]
[0011]
[0012] μ1(μ2+μ3){Υ”1-Υ1(θ1'+1)2+Υ1(1-3cos2θ1)}+μ1μ3{[Υ2θ2”+2Υ'2(θ2'+1)]sin(θ1-θ2)+[Υ”2-Υ2θ2'(θ2'+2)]cos(θ1-θ2)-3Υ2cosθ1cosθ2}＝-Ω1-Ω3(Υ1+Υ2cos(θ2-θ1))/Υ3-Γ1(μ2+μ3)+Γ2μ1cos(θ1-θ2)-Γ3μ1(Υ1+Υ2cos(θ2-θ1))/Υ3[0013] μ3(μ1+μ2){Υ”2-Υ2(θ2'+1)2+Υ2(1-3cos2θ2)}+μ1μ3{-[Υ1θ1”+2Υ'1(θ1'+1)]sin(θ1-θ2)+[Υ”1-Υ1θ1'(θ1'+2)]cos(θ1-θ2)-3Υ1cosθ1cosθ2}＝-Ω2-Ω3(Υ1cos(θ2-θ1)+Υ2)/Υ3-Γ1μ3cos(θ1-θ2)-Γ2μ3-Γ3(μ1+μ2)(Υ1cos(θ2-θ1)+Υ2)/Υ3[0014] 所述
[0015] 其中： 是rj对时间的一阶导数，l1是连接自主机动单元m1和m2的系绳长度，l2是连接自主机动单元m2和m3的系绳长度，l3是连接自主机动单元m1和m3的系绳长度，θ1和θ2分别是系绳l1和l2与Ox轴之间的夹角，ω是轨道角速度，
分别是l1、l2、θ1、θ2对时间的一阶导数， 分别是l1、l2、θ1、θ2对时间的二阶导数，q是系统的广义坐标系，定义为q＝[θ1,θ2,l1,l2]T，表示广义坐标对时间的一阶导数，Q是系统的广义力，T1、T2、T3分别表示系绳的拉力，F1、F2、F3分别表示3个自主机动单元的机动力，R0，R0分别表示地心到轨道坐标系原点的距离和矢量，Υ1、Υ2、Υ3、Υ'1、Υ'2、Υ”1、Υ”2分别是l1、l2、l3、 无量纲化后对应的量，θ'1、θ'2、θ”1、θ”2分别是
无量纲化后对应的量，L为无量纲化常量；
[0016] 步骤2、将自主机动空间柔性系统展开动力学模型转换为标准Bolza问题：
[0017]
[0018]
[0019] B(x(τ0),x(τf),t0,tf)＝0
[0020] C(x(τ),u(τ),τ,t0,tf)≤0
[0021] 所述 为性能指标函数，其中，t0为运动起始时间，tf为待定终端时间；α和αi为给定的正实数，α是对终端时间的加权，αi是对各自主机动力作为控制量时燃料消耗的加权；Fi表示各自主机动力；
[0022] 所述 u(τ),τ,t0,tf)为系统的动力学公式，
[0023] 其中： 为系统的状态变量；
[0024] u＝[T1,T2,T3,F1,F2,F3]T为系统的控制变量：
[0025] 所述B(x(τ0),x(τf),t0,tf)＝0为状态变量的边界条件：
[0026]
[0027] 其中， 分别是l1,l2,θ1,θ2, 在t0时刻的值，分别是l1,l2,θ1,θ2, 在tf时刻的值；
[0028] 所述C(x(τ),u(τ),τ,t0,tf)≤0为路径约束条件：
[0029]
[0030] 其中，l1min,l2min,θ1min,θ2min, T1min,T2min,T3min,F1min,F2min,F3min[0031] 分别是l1,l2,θ1,θ2, T1,T2,T3,F1,F2,F3最小值，
[0032] l1max,l2max,θ1max,θ2max, T1max,T2max,T3max,F1max,F2max,F3max
[0033] 分别是l1,l2,θ1,θ2, T1,T2,T3,F1,F2,F3最大值；
[0034] 步骤3、将标准的Bolza问题通过一种改进的高斯伪谱法转化为非线性规划问题：将状态变量在前N+1个LG节点上进行Hermite插值近似，得到：
[0035]
[0036] 其中，
[0037] 是x(τ)插值近似函数， 是 的导数；
[0038] 控制变量在区间(τ0,τf)中的LG节点上进行Hermite插值近似，得到：
[0039]
[0040] 其中，
[0041] 是u(τ)的插值近似函数， 是 的导数，终端时刻的控制变量通过曲线的延拓得到；
[0042] 将状态方程中的状态变量的导数在τk时刻进行离散化：
[0043]
[0044] 状态方程式转化为代数约束：
[0045]
[0046] 根据高斯积分公式，τf终端时刻的终端状态表示为：
[0047]
[0048] 其中，高斯型求积系数Ak通过下式计算：
[0049]
[0050] 其中， 是pN的导数在τk时刻的取值
[0051] 离散化后得到的性能指标函数为：
[0052]
[0053] 步骤4、采用改进的高斯伪谱法的迭代算法运算步骤3中的规划问题：
[0054] 1)选择离散点的个数N+2，即N次Legendre多项式的零点和两个端点值；
[0055] 2)计算步骤3的状态变量x和控制变量u；
[0056] 3)将计算得到的控制变量代入控制系统的输入端；
[0057] 4)检验状态约束和路径约束，如果仅在插值点τk处超过了约束条件允许相对误差条件，则转到5)，存在不同插值点处超过约束条件相对误差条件，则转到7)，否则转到6)；
[0058] 5)则取点 直到插值点 处满足允许相对误差条件，令 返回2)；
[0059] 6)如果哈密尔顿函数值接近0或者某一常数，则终止计算，否则转到7)；
[0060] 7)增加节点数Ni+2，Ni+1＝Ni+δn，其中，δn≥1是给定的常数；
[0061] 8)将控制变量、状态变量和系统参数作为下一步计算的初始值，返回步骤2)。
[0062] 有益效果
[0063] 本发明提出的一种基于改进高斯伪谱法的空间柔性系统展开控制方法，建立自主机动空间柔性系统展开动力学模型；基于自主机动空间柔性系统展开动力学模型提出适合于伪谱法的标准Bolza问题；将标准的Bolza问题通过一种0转化为非线性规划问题；设计了改进的高斯伪谱法的迭代算法。
[0064] 本发明与现有技术相比具有如下积极效果：采用一种改进的高斯伪谱法，将自主机动空间柔性系统展开运动路径优化转化为非线性规划问题，设计了改进的高斯伪谱法的迭代算法。通过改进的高斯伪谱法得到光滑连续的状态变量和控制变量，设计的迭代算法可以提前结束规划循环，在满足优化条件的前提下，缩短时间。
附图说明
[0065] 图1为空间绳系机器人的结构示意图
[0066] 其中：1为自主机动单元，2为柔性绳网
具体实施方式
[0067] 现结合实施例、附图对本发明作进一步描述：
[0068] 为了实现上述目的，本发明所采用的技术方案包括以下步骤：
[0069] 1)建立自主机动空间柔性系统展开动力学模型；
[0070] 2)基于自主机动空间柔性系统展开动力学模型提出适合于伪谱法的标准Bolza问题；
[0071] 3)将标准的Bolza问题通过一种0转化为非线性规划问题；
[0072] 4)设计了改进的高斯伪谱法的迭代算法；
[0073] 所述的步骤1)中，建立了自主机动空间柔性系统展开动力学模型，该模型只考虑了3个自主机动单元的位置模型。
[0074] 其中O-xyz为以空间柔性系统质心为原点的轨道系，Ox沿轨道半径由地心指向空间柔性系统质心，Oy垂直于Ox且指向平台前进的方向，Oz垂直于轨道平面且构成右手定则。在轨道系中，3个自主机动单元的质量为mj(j＝1,2,3)，相对于轨道系原点的位置为rj＝(xj,yj,zj)T(j＝1,2,3)
[0075] 由质心定理：
[0076]
[0077] 3个自主机动单元的相对位置坐标为:
[0078]
[0079] 其中，
[0080] 系统的动能为：
[0081]
[0082] 系统的势能为：
[0083]
[0084] 各非保守力所做的虚功之和为：
[0085]
[0086] 利用拉格朗日方程：
[0087]
[0088] 无量纲化后得到系统的动力学公式为：
[0089]
[0090]
[0091]
[0092]
[0093]
[0094] 其中， 是rj对时间的一阶导数，l1是连接自主机动单元m1和m2的系绳长度，l2是连接自主机动单元m2和m3的系绳长度，l3是连接自主机动单元m1和m3的系绳长度，θ1和θ2分别是系绳l1和l2与Ox轴之间的夹角，ω是轨道角速度， 分别是l1、l2、θ1、θ2对时间的一阶导数， 分别是l1、l2、θ1、θ2对时间的二阶导数，q是系统的广义坐标系，定义为q＝[θ1,θ2,l1,l2]T，表示广义坐标对时间的一阶导数，Q是系统的广义力，T1、T2、T3分别表示系绳的拉力，F1、F2、F3分别表示3个自主机动单元的机动力，R0，R0分别表示地心到轨道坐标系原点的距离和矢量，Υ1、Υ2、Υ3、Υ'1、Υ'2、Υ”1、Υ”2分别是l1、l2、l3、无量纲化后对应的量，θ'1、θ'2、θ”1、θ”2分别是 无量纲化后对应的量，L为无量纲化常量。
[0095] 所述的步骤2)中，基于自主机动空间柔性系统展开动力学模型提出适合于伪谱法的标准Bolza问题。
[0096] 自主机动空间柔性系统展开过程中兼顾考虑快速性和经济性，是一类时间最短控制和燃料最省控制的折中问题。取性能指标函数为：
[0097]
[0098] 其中，t0为运动起始时间，tf为待定终端时间；α和αi为给定的正实数，α是对终端时间的加权，αi是对各自主机动力作为控制量时燃料消耗的加权；Fi表示各自主机动力。
[0099] 根据系统的动力学公式，取系统的状态变量为：
[0100]
[0101] 取系统的控制变量为：
[0102] u＝[T1,T2,T3,F1,F2,F3]T (14)
[0103] 系统的动力学公式表示成如下统一形式：
[0104]
[0105] 状态变量的边界条件为：
[0106]
[0107] 其中，l10,l20,θ10,θ20, 分别是l1,l2,θ1,θ2, 在t0时刻的值，分别是l1,l2,θ1,θ2, 在tf时刻的值
[0108] 路径约束条件为：
[0109]
[0110] 其中，l1min,l2min,θ1min,θ2min, T1min,T2min,T3min,F1min,F2min,F3min分别是l1,l2,θ1,θ2, T1,T2,T3,F1,F2,F3最小值，
[0111] l1max,l2max,θ1max,θ2max, T1max,T2max,T3max,F1max,F2max,F3max分别是l1,l2,θ1,θ2, T1,T2,T3,F1,F2,F3最大值
[0112] 伪谱法的离散点分布在区间[-1,1]，因此，首先把上述问题时间取值范围转化到区间[τ0,τf]＝[-1,1]上的标准最优控制问题。引入时间变量τ∈[τ0,τf]，有如下时间变换：
[0113]
[0114] 将上式带入Bolza问题中，得到适合于伪谱法的标准Bolza问题。
[0115]
[0116] 所述的步骤3)中，将标准的Bolza问题通过一种改进的高斯伪谱法转化为非线性规划问题。该改进主要将传统的状态变量和控制变量Lagrange插值近似法改为Hermite插值，可以得到连续光滑的变量曲线。
[0117] 取Gauss伪谱法的N+2个LG节点为N次Legendre多项式pN(τ)的零点和初始时刻τ0、终端时刻τf，即：{τ0,τ1,…,τN,τN+1}，τN+1＝τf，一般Lagrange线性插值得到的状态变量和控制变量的曲线为不光滑的折线，采用Hermite插值使插值多项式与被插值函数在节点处不仅函数值相等，而且在这些点处有相同的导数，使插值曲线更光滑接近被插值函数曲线。将状态变量在前N+1个LG节点上进行Hermite插值近似，得到：
[0118]
[0119] 其中，是x(τ)插值近似函数， 是 的导数。
[0120] 控制变量在区间(τ0,τf)中的LG节点上进行Hermite插值近似，得到：
[0121]
[0122] 其中，是u(τ)的插值近似函数， 是 的导数，终端时刻的控制变量
通过曲线的延拓得到。
[0123] 将状态方程中的状态变量的导数在τk时刻进行离散化：
[0124]
[0125] 状态方程式转化为代数约束：
[0126]
[0127] 根据高斯积分公式，τf终端时刻的终端状态表示为：
[0128]
[0129] 其中，高斯型求积系数Ak通过下式计算：
[0130]
[0131] 其中， 是pN的导数在τk时刻的取值
[0132] 离散化后得到的性能指标函数为：
[0133]
[0134] 所述的步骤4)中，设计了改进的高斯伪谱法的迭代算法，在传统高斯伪谱法的迭代算法中增加了第5)步，如果仅有一个插值点不满足约束，则采用二分法找新插值点代替，可以提前结束规划循环。
[0135] 基于改进的高斯伪谱法的迭代算法：
[0136] 9)选择离散点的个数N+2，即N次Legendre多项式的零点和两个端点值；
[0137] 10)根据本专利中提出的改进高斯伪谱法计算状态变量和控制变量；
[0138] 11)将得到的控制变量代入系统进行仿真；
[0139] 12)检验状态约束和路径约束，如果仅在插值点τk处超过了约束条件允许相对误差条件，则转到5)，存在不同插值点处超过约束条件相对误差条件，则转到7)，否则转到6)；
[0140] 13)则取点 直到插值点 处满足允许相对误差条件，令 返回10)；
[0141] 14)如果哈密尔顿函数值接近0或者某一常数，则终止计算，否则转到15)；
[0142] 15)增加节点数Ni+2，Ni+1＝Ni+δn，其中，δn≥1是给定的常数；
[0143] 16)将仿真得到的控制变量、状态变量和系统参数作为下一步计算的初始值，返回步骤2)。
[0144] 根据此算法可以求解自主机动单元展开运动的最优轨迹。
