法律状态公告日
法律状态信息
法律状态
2020-05-01
授权
授权
2017-10-24
实质审查的生效 IPC(主分类):G06F17/50 申请日:20170426
实质审查的生效
2017-09-22
公开
公开
技术领域
本发明属于绳系航天器展开控制技术的研究,涉及一种基于改进高斯伪谱法的空间柔性系统展开控制方法,具体涉及空间柔性系统在展开过程中实现终端状态的一种 路径规划的最优控制方法。
背景技术
空间柔性系统是一种具有绳系结构的空间机器人系统,具有高灵活性和高安全性。 在空间在轨捕获和轨道清理任务中将会扮演重要角色。本专利所提出的自主机动空间柔性系统是一种由“”空间平台+柔性绳网+自主机动单元”组成的新型航天器。柔性绳网 的网口形状为三角形,3个自主机动单元分别位于柔性绳网的三个顶角上。
空间柔性系统的展开是一个复杂的动力学过程,不恰当的展开方式可能导致网绳单元和网面的剧烈振动,甚至出现网绳缠绕等危险情形。目前,针对飞网展开所提出 的方式主要有旋转展开、刚性构件支撑展开和弹射展开三种。但这三种展开方式对网 口最大展开面积和飞网有效作用时间都有很大的影响,严重限制了其操作距离和机动 性。
柔性网完全展开后,在自主机动单元及空间平台的支持下,控制并保持柔性网的网型。国内学者针对自主机动空间柔性系统的展开控制技术提出了一些策略,例如, 在文献《一种空间飞网机器人网型保持控制方法》中,设计了一种基于积分切换函数 的滑模变结构控制器,保证各自主机动单元以一定相对速度沿着期望轨迹运动,进而 实现网型保持的目的。在文献《空间飞网机器人网型保持控制方法研究》中,提出了 一种基于Leader-Follower方法的网型保持控制策略,有效实现空间飞网机器人逼近目 标过程中的网型保持控制。
发明内容
要解决的技术问题
为了避免现有技术的不足之处,本发明提出一种基于改进高斯伪谱法的空间柔性系统展开控制方法,使展开消耗的时间和燃料达到相对最少的一种最优控制。
技术方案
一种基于改进高斯伪谱法的空间柔性系统展开控制方法,其特征在于步骤如下:
步骤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
所述
其中:
步骤2、将自主机动空间柔性系统展开动力学模型转换为标准Bolza问题:
B(x(τ0),x(τf),t0,tf)=0
C(x(τ),u(τ),τ,t0,tf)≤0
所述
所述
其中:
u=[T1,T2,T3,F1,F2,F3]T为系统的控制变量:
所述B(x(τ0),x(τf),t0,tf)=0为状态变量的边界条件:
其中,
所述C(x(τ),u(τ),τ,t0,tf)≤0为路径约束条件:
其中,l1min,l2min,θ1min,θ2min,
分别是l1,l2,θ1,θ2,
l1max,l2max,θ1max,θ2max,
分别是l1,l2,θ1,θ2,
步骤3、将标准的Bolza问题通过一种改进的高斯伪谱法转化为非线性规划问题:
将状态变量在前N+1个LG节点上进行Hermite插值近似,得到:
其中,
控制变量在区间(τ0,τf)中的LG节点上进行Hermite插值近似,得到:
其中,
将状态方程中的状态变量的导数在τk时刻进行离散化:
状态方程式转化为代数约束:
根据高斯积分公式,τf终端时刻的终端状态表示为:
其中,高斯型求积系数Ak通过下式计算:
其中,
离散化后得到的性能指标函数为:
步骤4、采用改进的高斯伪谱法的迭代算法运算步骤3中的规划问题:
1)选择离散点的个数N+2,即N次Legendre多项式的零点和两个端点值;
2)计算步骤3的状态变量x和控制变量u;
3)将计算得到的控制变量代入控制系统的输入端;
4)检验状态约束和路径约束,如果仅在插值点τk处超过了约束条件允许相对误差条件,则转到5),存在不同插值点处超过约束条件相对误差条件,则转到7),否则转>
5)则取点
6)如果哈密尔顿函数值接近0或者某一常数,则终止计算,否则转到7);
7)增加节点数Ni+2,Ni+1=Ni+δn,其中,δn≥1是给定的常数;
8)将控制变量、状态变量和系统参数作为下一步计算的初始值,返回步骤2)。
有益效果
本发明提出的一种基于改进高斯伪谱法的空间柔性系统展开控制方法,建立自主机动空间柔性系统展开动力学模型;基于自主机动空间柔性系统展开动力学模型提出 适合于伪谱法的标准Bolza问题;将标准的Bolza问题通过一种0转化为非线性规划 问题;设计了改进的高斯伪谱法的迭代算法。
本发明与现有技术相比具有如下积极效果:采用一种改进的高斯伪谱法,将自主机动空间柔性系统展开运动路径优化转化为非线性规划问题,设计了改进的高斯伪谱 法的迭代算法。通过改进的高斯伪谱法得到光滑连续的状态变量和控制变量,设计的 迭代算法可以提前结束规划循环,在满足优化条件的前提下,缩短时间。
附图说明
图1为空间绳系机器人的结构示意图
其中:1为自主机动单元,2为柔性绳网
具体实施方式
现结合实施例、附图对本发明作进一步描述:
为了实现上述目的,本发明所采用的技术方案包括以下步骤:
1)建立自主机动空间柔性系统展开动力学模型;
2)基于自主机动空间柔性系统展开动力学模型提出适合于伪谱法的标准Bolza问题;
3)将标准的Bolza问题通过一种0转化为非线性规划问题;
4)设计了改进的高斯伪谱法的迭代算法;
所述的步骤1)中,建立了自主机动空间柔性系统展开动力学模型,该模型只考虑了3个自主机动单元的位置模型。
其中O-xyz为以空间柔性系统质心为原点的轨道系,Ox沿轨道半径由地心指向空间柔性系统质心,Oy垂直于Ox且指向平台前进的方向,Oz垂直于轨道平面且构成 右手定则。在轨道系中,3个自主机动单元的质量为mj(j=1,2,3),相对于轨道系原点>j=(xj,yj,zj)T(j=1,2,3)
由质心定理:
3个自主机动单元的相对位置坐标为:
其中,
系统的动能为:
系统的势能为:
各非保守力所做的虚功之和为:
利用拉格朗日方程:
无量纲化后得到系统的动力学公式为:
其中,
所述的步骤2)中,基于自主机动空间柔性系统展开动力学模型提出适合于伪谱法的标准Bolza问题。
自主机动空间柔性系统展开过程中兼顾考虑快速性和经济性,是一类时间最短控制和燃料最省控制的折中问题。取性能指标函数为:
其中,t0为运动起始时间,tf为待定终端时间;α和αi为给定的正实数,α是对终端时间的加权,αi是对各自主机动力作为控制量时燃料消耗的加权;Fi表示各自主机动>
根据系统的动力学公式,取系统的状态变量为:
取系统的控制变量为:
u=[T1,T2,T3,F1,F2,F3]T(14)
系统的动力学公式表示成如下统一形式:
状态变量的边界条件为:
其中,
路径约束条件为:
其中,l1min,l2min,θ1min,θ2min,
伪谱法的离散点分布在区间[-1,1],因此,首先把上述问题时间取值范围转化到区 间[τ0,τf]=[-1,1]上的标准最优控制问题。引入时间变量τ∈[τ0,τf],有如下时间变换:
将上式带入Bolza问题中,得到适合于伪谱法的标准Bolza问题。
所述的步骤3)中,将标准的Bolza问题通过一种改进的高斯伪谱法转化为非线性规 划问题。该改进主要将传统的状态变量和控制变量Lagrange插值近似法改为Hermite插值,可以得到连续光滑的变量曲线。
取Gauss伪谱法的N+2个LG节点为N次Legendre多项式pN(τ)的零点和初始时>0、终端时刻τf,即:{τ0,τ1,…,τN,τN+1},τN+1=τf,一般Lagrange线性插值得到的>
其中,
控制变量在区间(τ0,τf)中的LG节点上进行Hermite插值近似,得到:
其中,
将状态方程中的状态变量的导数在τk时刻进行离散化:
状态方程式转化为代数约束:
根据高斯积分公式,τf终端时刻的终端状态表示为:
其中,高斯型求积系数Ak通过下式计算:
其中,
离散化后得到的性能指标函数为:
所述的步骤4)中,设计了改进的高斯伪谱法的迭代算法,在传统高斯伪谱法的迭代 算法中增加了第5)步,如果仅有一个插值点不满足约束,则采用二分法找新插值点代替,可以提前结束规划循环。
基于改进的高斯伪谱法的迭代算法:
9)选择离散点的个数N+2,即N次Legendre多项式的零点和两个端点值;
10)根据本专利中提出的改进高斯伪谱法计算状态变量和控制变量;
11)将得到的控制变量代入系统进行仿真;
12)检验状态约束和路径约束,如果仅在插值点τk处超过了约束条件允许相对误差>
13)则取点
14)如果哈密尔顿函数值接近0或者某一常数,则终止计算,否则转到7);
15)增加节点数Ni+2,Ni+1=Ni+δn,其中,δn≥1是给定的常数;
16)将仿真得到的控制变量、状态变量和系统参数作为下一步计算的初始值,返回步骤2)。
根据此算法可以求解自主机动单元展开运动的最优轨迹。
机译: 基于视频分析的开放柔性系统可预测性的一种方法
机译: 基于视频分析的开放柔性系统可预测性的一种方法
机译: 当使用空间自适应处理方法来检测雷达信号中的目标时使用空间自适应处理来检测雷达信号中的目标的系统,以及当复合高斯环境时使用复合高斯环境的系统