CN107194039B - 一种基于改进高斯伪谱法的空间柔性***展开控制方法 - Google Patents

一种基于改进高斯伪谱法的空间柔性***展开控制方法 Download PDF

Info

Publication number
CN107194039B
CN107194039B CN201710283391.6A CN201710283391A CN107194039B CN 107194039 B CN107194039 B CN 107194039B CN 201710283391 A CN201710283391 A CN 201710283391A CN 107194039 B CN107194039 B CN 107194039B
Authority
CN
China
Prior art keywords
time
cos
flexible system
space flexible
pseudo
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201710283391.6A
Other languages
English (en)
Other versions
CN107194039A (zh
Inventor
黄攀峰
刘亚
张帆
孟中杰
张夷斋
刘正雄
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Northwestern Polytechnical University
Original Assignee
Northwestern Polytechnical University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Northwestern Polytechnical University filed Critical Northwestern Polytechnical University
Priority to CN201710283391.6A priority Critical patent/CN107194039B/zh
Publication of CN107194039A publication Critical patent/CN107194039A/zh
Application granted granted Critical
Publication of CN107194039B publication Critical patent/CN107194039B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06F—ELECTRIC DIGITAL DATA PROCESSING
    • G06F30/00—Computer-aided design [CAD]
    • G06F30/20—Design optimisation, verification or simulation
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06F—ELECTRIC DIGITAL DATA PROCESSING
    • G06F2111/00—Details relating to CAD techniques
    • G06F2111/06—Multi-objective optimisation, e.g. Pareto optimisation using simulated annealing [SA], ant colony algorithms or genetic algorithms [GA]

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • Computer Hardware Design (AREA)
  • Evolutionary Computation (AREA)
  • Geometry (AREA)
  • General Engineering & Computer Science (AREA)
  • General Physics & Mathematics (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Feedback Control In General (AREA)

Abstract

本发明涉及一种基于改进高斯伪谱法的空间柔性***展开控制方法，建立自主机动空间柔性***展开动力学模型；基于自主机动空间柔性***展开动力学模型提出适合于伪谱法的标准Bolza问题；将标准的Bolza问题通过一种0转化为非线性规划问题；设计了改进的高斯伪谱法的迭代算法。积极效果：采用一种改进的高斯伪谱法，将自主机动空间柔性***展开运动路径优化转化为非线性规划问题，设计了改进的高斯伪谱法的迭代算法。通过改进的高斯伪谱法得到光滑连续的状态变量和控制变量，设计的迭代算法可以提前结束规划循环，在满足优化条件的前提下，缩短时间。

Description

一种基于改进高斯伪谱法的空间柔性***展开控制方法
技术领域
本发明属于绳系航天器展开控制技术的研究，涉及一种基于改进高斯伪谱法的空间柔性***展开控制方法，具体涉及空间柔性***在展开过程中实现终端状态的一种路径规划的最优控制方法。
背景技术
空间柔性***是一种具有绳系结构的空间机器人***，具有高灵活性和高安全性。在空间在轨捕获和轨道清理任务中将会扮演重要角色。本专利所提出的自主机动空间柔性***是一种由“”空间平台+柔性绳网+自主机动单元”组成的新型航天器。柔性绳网的网口形状为三角形，3个自主机动单元分别位于柔性绳网的三个顶角上。
空间柔性***的展开是一个复杂的动力学过程，不恰当的展开方式可能导致网绳单元和网面的剧烈振动，甚至出现网绳缠绕等危险情形。目前，针对飞网展开所提出的方式主要有旋转展开、刚性构件支撑展开和弹射展开三种。但这三种展开方式对网口最大展开面积和飞网有效作用时间都有很大的影响，严重限制了其操作距离和机动性。
柔性网完全展开后，在自主机动单元及空间平台的支持下，控制并保持柔性网的网型。国内学者针对自主机动空间柔性***的展开控制技术提出了一些策略，例如，在文献《一种空间飞网机器人网型保持控制方法》中，设计了一种基于积分切换函数的滑模变结构控制器，保证各自主机动单元以一定相对速度沿着期望轨迹运动，进而实现网型保持的目的。在文献《空间飞网机器人网型保持控制方法研究》中，提出了一种基于Leader-Follower方法的网型保持控制策略，有效实现空间飞网机器人逼近目标过程中的网型保持控制。
发明内容
要解决的技术问题
为了避免现有技术的不足之处，本发明提出一种基于改进高斯伪谱法的空间柔性***展开控制方法，使展开消耗的时间和燃料达到相对最少的一种最优控制。
技术方案
一种基于改进高斯伪谱法的空间柔性***展开控制方法，其特征在于步骤如下：
步骤1、建立自主机动空间柔性***展开动力学模型：以空间柔性***质心为原点的轨道系O-xyz，Ox沿轨道半径由地心指向空间柔性***质心，Oy垂直于Ox且指向平台前进的方向，Oz垂直于轨道平面且构成右手定则；在轨道系中，三个自主机动单元(1)的质量为mj，相对于轨道系原点的位置为rj＝(xj,yj,zj)T，j＝1,2,3；
Figure GDA0002265717950000021
Figure GDA0002265717950000022
μ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
所述
Figure GDA0002265717950000031
其中：
Figure GDA0002265717950000032
Figure GDA0002265717950000033
是rj对时间的一阶导数，l1是连接自主机动单元m1和m2的系绳长度，l2是连接自主机动单元m2和m3的系绳长度，l3是连接自主机动单元m1和m3的系绳长度，θ1和θ2分别是系绳l1和l2与Ox轴之间的夹角，ω是轨道角速度，
Figure GDA0002265717950000034
分别是l1、l2、θ1、θ2对时间的一阶导数，
Figure GDA0002265717950000035
分别是l1、l2、θ1、θ2对时间的二阶导数，q是***的广义坐标系，定义为q＝[θ1,θ2,l1,l2]T，
Figure GDA0002265717950000036
表示广义坐标对时间的一阶导数，Q是***的广义力，T1、T2、T3分别表示系绳的拉力，F1、F2、F3分别表示3个自主机动单元的机动力，R0，R0分别表示地心到轨道坐标系原点的距离和矢量，Υ1、Υ2、Υ3、Υ'1、Υ'2、Υ”1、Υ”2分别是l1、l2、l3、
Figure GDA0002265717950000037
无量纲化后对应的量，θ'1、θ'2、θ”1、θ”2分别是
Figure GDA0002265717950000038
无量纲化后对应的量，L为无量纲化常量；
步骤2、将自主机动空间柔性***展开动力学模型转换为标准Bolza问题：
Figure GDA0002265717950000039
Figure GDA00022657179500000310
B(x(τ0),x(τf),t0,tf)＝0
C(x(τ),u(τ),τ,t0,tf)≤0
所述
Figure GDA00022657179500000311
为性能指标函数，其中，t0为运动起始时间，tf为待定终端时间；α和αi为给定的正实数，α是对终端时间的加权，αi是对各自主机动力作为控制量时燃料消耗的加权；Fi表示各自主机动力；
所述
Figure GDA00022657179500000312
u(τ),τ,t0,tf)为***的动力学公式，
其中：
Figure GDA00022657179500000313
为***的状态变量；
u＝[T1,T2,T3,F1,F2,F3]T为***的控制变量：
所述B(x(τ0),x(τf),t0,tf)＝0为状态变量的边界条件：
Figure GDA0002265717950000041
其中，
Figure GDA0002265717950000042
分别是l1,l2,θ1,θ2,
Figure GDA0002265717950000043
在t0时刻的值，
Figure GDA0002265717950000044
分别是l1,l2,θ1,θ2,
Figure GDA0002265717950000045
在tf时刻的值；
所述C(x(τ),u(τ),τ,t0,tf)≤0为路径约束条件：
Figure GDA0002265717950000046
其中，l1min,l2min,θ1min,θ2min,
Figure GDA0002265717950000047
T1min,T2min,T3min,F1min,F2min,F3min
分别是l1,l2,θ1,θ2,
Figure GDA0002265717950000048
T1,T2,T3,F1,F2,F3最小值，
l1max,l2max,θ1max,θ2max,
Figure GDA0002265717950000049
T1max,T2max,T3max,F1max,F2max,F3max
分别是l1,l2,θ1,θ2,
Figure GDA00022657179500000410
T1,T2,T3,F1,F2,F3最大值；
步骤3、将标准的Bolza问题通过一种改进的高斯伪谱法转化为非线性规划问题：将状态变量在前N+1个LG节点上进行Hermite插值近似，得到：
Figure GDA00022657179500000411
其中，
Figure GDA00022657179500000412
Figure GDA00022657179500000413
Figure GDA00022657179500000414
是x(τ)插值近似函数，
Figure GDA00022657179500000415
是
Figure GDA00022657179500000416
的导数；
控制变量在区间(τ0,τf)中的LG节点上进行Hermite插值近似，得到：
Figure GDA0002265717950000051
其中，
Figure GDA0002265717950000052
Figure GDA0002265717950000053
Figure GDA0002265717950000054
是u(τ)的插值近似函数，
Figure GDA0002265717950000055
是
Figure GDA0002265717950000056
的导数，终端时刻的控制变量通过曲线的延拓得到；
将状态方程中的状态变量的导数在τk时刻进行离散化：
Figure GDA0002265717950000057
状态方程式转化为代数约束：
Figure GDA0002265717950000058
根据高斯积分公式，τf终端时刻的终端状态表示为：
Figure GDA0002265717950000059
其中，高斯型求积系数Ak通过下式计算：
Figure GDA00022657179500000510
其中，
Figure GDA00022657179500000511
是pN的导数在τk时刻的取值
离散化后得到的性能指标函数为：
Figure GDA00022657179500000512
步骤4、采用改进的高斯伪谱法的迭代算法运算步骤3中的规划问题：
1)选择离散点的个数N+2，即N次Legendre多项式的零点和两个端点值；
2)计算步骤3的状态变量x和控制变量u；
3)将计算得到的控制变量代入控制***的输入端；
4)检验状态约束和路径约束，如果仅在插值点τk处超过了约束条件允许相对误差条件，则转到5)，存在不同插值点处超过约束条件相对误差条件，则转到7)，否则转到6)；
5)则取点
Figure GDA0002265717950000061
直到插值点
Figure GDA0002265717950000062
处满足允许相对误差条件，令
Figure GDA0002265717950000063
返回2)；
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)，相对于轨道系原点的位置为rj＝(xj,yj,zj)T(j＝1,2,3)
由质心定理：
Figure GDA0002265717950000071
3个自主机动单元的相对位置坐标为:
Figure GDA0002265717950000072
其中，
Figure GDA0002265717950000073
***的动能为：
Figure GDA0002265717950000081
***的势能为：
Figure GDA0002265717950000082
各非保守力所做的虚功之和为：
Figure GDA0002265717950000091
利用拉格朗日方程：
Figure GDA0002265717950000092
无量纲化后得到***的动力学公式为：
Figure GDA0002265717950000093
Figure GDA0002265717950000101
Figure GDA0002265717950000102
Figure GDA0002265717950000103
Figure GDA0002265717950000104
其中，
Figure GDA0002265717950000105
是rj对时间的一阶导数，l1是连接自主机动单元m1和m2的系绳长度，l2是连接自主机动单元m2和m3的系绳长度，l3是连接自主机动单元m1和m3的系绳长度，θ1和θ2分别是系绳l1和l2与Ox轴之间的夹角，ω是轨道角速度，
Figure GDA0002265717950000106
分别是l1、l2、θ1、θ2对时间的一阶导数，
Figure GDA0002265717950000107
分别是l1、l2、θ1、θ2对时间的二阶导数，q是***的广义坐标系，定义为q＝[θ1,θ2,l1,l2]T，
Figure GDA0002265717950000108
表示广义坐标对时间的一阶导数，Q是***的广义力，T1、T2、T3分别表示系绳的拉力，F1、F2、F3分别表示3个自主机动单元的机动力，R0，R0分别表示地心到轨道坐标系原点的距离和矢量，Υ1、Υ2、Υ3、Υ'1、Υ'2、Υ”1、Υ”2分别是l1、l2、l3、
Figure GDA0002265717950000109
无量纲化后对应的量，θ'1、θ'2、θ”1、θ”2分别是
Figure GDA0002265717950000111
无量纲化后对应的量，L为无量纲化常量。
所述的步骤2)中，基于自主机动空间柔性***展开动力学模型提出适合于伪谱法的标准Bolza问题。
自主机动空间柔性***展开过程中兼顾考虑快速性和经济性，是一类时间最短控制和燃料最省控制的折中问题。取性能指标函数为：
Figure GDA0002265717950000112
其中，t0为运动起始时间，tf为待定终端时间；α和αi为给定的正实数，α是对终端时间的加权，αi是对各自主机动力作为控制量时燃料消耗的加权；Fi表示各自主机动力。
根据***的动力学公式，取***的状态变量为：
Figure GDA0002265717950000113
取***的控制变量为：
u＝[T1,T2,T3,F1,F2,F3]T (14)
***的动力学公式表示成如下统一形式：
Figure GDA0002265717950000114
状态变量的边界条件为：
Figure GDA0002265717950000115
其中，l10,l20,θ10,θ20,
Figure GDA0002265717950000116
分别是l1,l2,θ1,θ2,
Figure GDA0002265717950000117
在t0时刻的值，
Figure GDA0002265717950000118
分别是l1,l2,θ1,θ2,
Figure GDA0002265717950000119
在tf时刻的值
路径约束条件为：
Figure GDA0002265717950000121
其中，l1min,l2min,θ1min,θ2min,
Figure GDA0002265717950000122
T1min,T2min,T3min,F1min,F2min,F3min分别是l1,l2,θ1,θ2,
Figure GDA0002265717950000123
T1,T2,T3,F1,F2,F3最小值，
l1max,l2max,θ1max,θ2max,
Figure GDA0002265717950000124
T1max,T2max,T3max,F1max,F2max,F3max分别是l1,l2,θ1,θ2,
Figure GDA0002265717950000125
T1,T2,T3,F1,F2,F3最大值
伪谱法的离散点分布在区间[-1,1]，因此，首先把上述问题时间取值范围转化到区间[τ0,τf]＝[-1,1]上的标准最优控制问题。引入时间变量τ∈[τ0,τf]，有如下时间变换：
Figure GDA0002265717950000126
将上式带入Bolza问题中，得到适合于伪谱法的标准Bolza问题。
Figure GDA0002265717950000127
所述的步骤3)中，将标准的Bolza问题通过一种改进的高斯伪谱法转化为非线性规划问题。该改进主要将传统的状态变量和控制变量Lagrange插值近似法改为Hermite插值，可以得到连续光滑的变量曲线。
取Gauss伪谱法的N+2个LG节点为N次Legendre多项式pN(τ)的零点和初始时刻τ0、终端时刻τf，即：{τ0,τ1,…,τN,τN+1}，τN+1＝τf，一般Lagrange线性插值得到的状态变量和控制变量的曲线为不光滑的折线，采用Hermite插值使插值多项式与***值函数在节点处不仅函数值相等，而且在这些点处有相同的导数，使插值曲线更光滑接近***值函数曲线。将状态变量在前N+1个LG节点上进行Hermite插值近似，得到：
Figure GDA0002265717950000131
其中，
Figure GDA0002265717950000132
Figure GDA0002265717950000133
Figure GDA0002265717950000134
是x(τ)插值近似函数，
Figure GDA0002265717950000135
是
Figure GDA0002265717950000136
的导数。
控制变量在区间(τ0,τf)中的LG节点上进行Hermite插值近似，得到：
Figure GDA0002265717950000137
其中，
Figure GDA0002265717950000138
Figure GDA0002265717950000139
Figure GDA00022657179500001310
是u(τ)的插值近似函数，
Figure GDA00022657179500001311
是
Figure GDA00022657179500001312
的导数，终端时刻的控制变量通过曲线的延拓得到。
将状态方程中的状态变量的导数在τk时刻进行离散化：
Figure GDA00022657179500001313
状态方程式转化为代数约束：
Figure GDA00022657179500001314
根据高斯积分公式，τf终端时刻的终端状态表示为：
Figure GDA00022657179500001315
其中，高斯型求积系数Ak通过下式计算：
Figure GDA0002265717950000141
其中，
Figure GDA0002265717950000142
是pN的导数在τk时刻的取值
离散化后得到的性能指标函数为：
Figure GDA0002265717950000143
所述的步骤4)中，设计了改进的高斯伪谱法的迭代算法，在传统高斯伪谱法的迭代算法中增加了第5)步，如果仅有一个插值点不满足约束，则采用二分法找新插值点代替，可以提前结束规划循环。
基于改进的高斯伪谱法的迭代算法：
9)选择离散点的个数N+2，即N次Legendre多项式的零点和两个端点值；
10)根据本专利中提出的改进高斯伪谱法计算状态变量和控制变量；
11)将得到的控制变量代入***进行仿真；
12)检验状态约束和路径约束，如果仅在插值点τk处超过了约束条件允许相对误差条件，则转到5)，存在不同插值点处超过约束条件相对误差条件，则转到7)，否则转到6)；
13)则取点
Figure GDA0002265717950000144
直到插值点
Figure GDA0002265717950000145
处满足允许相对误差条件，令
Figure GDA0002265717950000146
返回10)；
14)如果哈密尔顿函数值接近0或者某一常数，则终止计算，否则转到15)；
15)增加节点数Ni+2，Ni+1＝Ni+δn，其中，δn≥1是给定的常数；
16)将仿真得到的控制变量、状态变量和***参数作为下一步计算的初始值，返回步骤2)。
根据此算法可以求解自主机动单元展开运动的最优轨迹。

Claims (1)

1.一种基于改进高斯伪谱法的空间柔性***展开控制方法，其特征在于步骤如下：
步骤1、建立自主机动空间柔性***展开动力学模型：以空间柔性***质心为原点的轨道系O-xyz，Ox沿轨道半径由地心指向空间柔性***质心，Oy垂直于Ox且指向平台前进的方向，Oz垂直于轨道平面且构成右手定则；在轨道系中，三个自主机动单元(1)的质量为mj，相对于轨道系原点的位置为rj＝(xj,yj,zj)T，j＝1,2,3；
Figure FDA0002265717940000011
Figure FDA0002265717940000012
μ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
所述
Figure FDA0002265717940000021
其中：
Figure FDA0002265717940000022
Figure FDA0002265717940000023
是rj对时间的一阶导数，l1是连接自主机动单元m1和m2的系绳长度，l2是连接自主机动单元m2和m3的系绳长度，l3是连接自主机动单元m1和m3的系绳长度，θ1和θ2分别是系绳l1和l2与Ox轴之间的夹角，ω是轨道角速度，
Figure FDA0002265717940000024
分别是l1、l2、θ1、θ2对时间的一阶导数，
Figure FDA0002265717940000025
分别是l1、l2、θ1、θ2对时间的二阶导数，q是***的广义坐标系，定义为q＝[θ1,θ2,l1,l2]T，
Figure FDA0002265717940000026
表示广义坐标对时间的一阶导数，T1、T2、T3分别表示系绳的拉力，Fj表示3个自主机动单元的机动力，j＝1,2,3，R0，R0分别表示地心到轨道坐标系原点的距离和矢量，Υ1、Υ2、Υ3、Υ'1、Υ'2、Υ″1、Υ″2分别是l1、l2、l3、
Figure FDA0002265717940000027
无量纲化后对应的量，θ′1、θ′2、θ″1、θ″2分别是
Figure FDA0002265717940000028
无量纲化后对应的量，L为无量纲化常量；
步骤2、将自主机动空间柔性***展开动力学模型转换为标准Bolza问题：
Figure FDA0002265717940000029
Figure FDA00022657179400000210
B(x(τ0),x(τf),t0,tf)＝0
C(x(τ),u(τ),τ,t0,tf)≤0
所述
Figure FDA00022657179400000211
为性能指标函数，其中，t0为运动起始时间，tf为待定终端时间；α和αi为给定的正实数，α是对终端时间的加权，αi是对各自主机动力作为控制量时燃料消耗的加权；Fi表示各自主机动力；
所述
Figure FDA00022657179400000212
为***的动力学公式，
其中：
Figure FDA00022657179400000213
为***的状态变量；
u＝[T1,T2,T3,F1,F2,F3]T为***的控制变量：
所述B(x(τ0),x(τf),t0,tf)＝0为状态变量的边界条件：
Figure FDA0002265717940000031
其中，
Figure FDA0002265717940000032
分别是l1,l2,θ1,θ2,
Figure FDA0002265717940000033
在t0时刻的值，
Figure FDA0002265717940000034
分别是l1,l2,θ1,θ2,
Figure FDA0002265717940000035
在tf时刻的值；
所述C(x(τ),u(τ),τ,t0,tf)≤0为路径约束条件：
Figure FDA0002265717940000036
其中，l1min,l2min,θ1min,θ2min,
Figure FDA0002265717940000037
T1min,T2min,T3min,F1min,F2min,F3min
分别是l1,l2,θ1,θ2,
Figure FDA0002265717940000038
T1,T2,T3,F1,F2,F3最小值，
l1max,l2max,θ1max,θ2max,
Figure FDA0002265717940000039
T1max,T2max,T3max,F1max,F2max,F3max
分别是l1,l2,θ1,θ2,
Figure FDA00022657179400000310
T1,T2,T3,F1,F2,F3最大值；
步骤3、将标准的Bolza问题通过一种改进的高斯伪谱法转化为非线性规划问题：将状态变量在前N+1个LG节点上进行Hermite插值近似，得到：
Figure FDA00022657179400000311
其中，
Figure FDA00022657179400000312
Figure FDA00022657179400000313
Figure FDA00022657179400000314
是x(τ)插值近似函数，
Figure FDA00022657179400000315
是
Figure FDA00022657179400000316
的导数；
控制变量在区间(τ0,τf)中的LG节点上进行Hermite插值近似，得到：
Figure FDA0002265717940000041
其中，
Figure FDA0002265717940000042
Figure FDA0002265717940000043
Figure FDA0002265717940000044
是u(τ)的插值近似函数，
Figure FDA0002265717940000045
是
Figure FDA0002265717940000046
的导数，终端时刻的控制变量通过曲线的延拓得到；
将状态方程中的状态变量的导数在τk时刻进行离散化：
Figure FDA0002265717940000047
状态方程式转化为代数约束：
Figure FDA0002265717940000048
根据高斯积分公式，τf终端时刻的终端状态表示为：
Figure FDA0002265717940000049
其中，高斯型求积系数Ak通过下式计算：
Figure FDA00022657179400000410
其中，
Figure FDA00022657179400000411
是pN的导数在τk时刻的取值
离散化后得到的性能指标函数为：
Figure FDA00022657179400000412
步骤4、采用改进的高斯伪谱法的迭代算法运算步骤3中的规划问题：
1)选择离散点的个数N+2，即N次Legendre多项式的零点和两个端点值；
2)计算步骤3的状态变量x和控制变量u；
3)将计算得到的控制变量代入控制***的输入端；
4)检验状态约束和路径约束，如果仅在插值点τk处超过了约束条件允许相对误差条件，则转到5)，存在不同插值点处超过约束条件相对误差条件，则转到7)，否则转到6)；
5)则取点
Figure FDA0002265717940000051
直到插值点
Figure FDA0002265717940000052
处满足允许相对误差条件，令
Figure FDA0002265717940000053
返回2)；
6)如果哈密尔顿函数值接近0或者某一常数，则终止计算，否则转到7)；
7)增加节点数Ni+2，Ni+1＝Ni+δn，其中，δn≥1是给定的常数；
8)将控制变量、状态变量和***参数作为下一步计算的初始值，返回步骤2)。
CN201710283391.6A 2017-04-26 2017-04-26 一种基于改进高斯伪谱法的空间柔性***展开控制方法 Active CN107194039B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710283391.6A CN107194039B (zh) 2017-04-26 2017-04-26 一种基于改进高斯伪谱法的空间柔性***展开控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710283391.6A CN107194039B (zh) 2017-04-26 2017-04-26 一种基于改进高斯伪谱法的空间柔性***展开控制方法

Publications (2)

Publication Number Publication Date
CN107194039A CN107194039A (zh) 2017-09-22
CN107194039B true CN107194039B (zh) 2020-05-01

Family

ID=59872580

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710283391.6A Active CN107194039B (zh) 2017-04-26 2017-04-26 一种基于改进高斯伪谱法的空间柔性***展开控制方法

Country Status (1)

Country Link
CN (1) CN107194039B (zh)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108319136B (zh) * 2018-01-18 2019-12-27 西北工业大学 一种基于模型预测的系绳张力控制方法
CN108319135B (zh) * 2018-01-18 2019-12-27 西北工业大学 基于神经网络鲁棒自适应的空间柔性***展开控制方法
CN111975777A (zh) * 2020-08-21 2020-11-24 哈尔滨工业大学 一种基于Radau伪谱的机器人关节空间自适应轨迹规划方法
CN115204449B (zh) * 2022-05-26 2023-04-25 中国人民解放军国防科技大学 一种基于自适应勒让德皮卡迭代法的轨道预测方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103914073A (zh) * 2014-04-22 2014-07-09 西北工业大学 基于变质心滚控模式的再入飞行器轨迹优化方法
CN103955611A (zh) * 2014-04-28 2014-07-30 西北工业大学 一种空间绳系机器人的通用动力学模型的建立方法
CN104143021A (zh) * 2014-07-17 2014-11-12 西北工业大学 一种空间绳网机器人的逼近动力学建模方法
CN104536452A (zh) * 2015-01-26 2015-04-22 哈尔滨工业大学 基于时间-燃料最优控制的航天器相对轨道转移轨迹优化方法
CN105174061A (zh) * 2015-09-28 2015-12-23 南开大学 基于伪谱法的双摆吊车全局时间最优轨迹规划方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103914073A (zh) * 2014-04-22 2014-07-09 西北工业大学 基于变质心滚控模式的再入飞行器轨迹优化方法
CN103955611A (zh) * 2014-04-28 2014-07-30 西北工业大学 一种空间绳系机器人的通用动力学模型的建立方法
CN104143021A (zh) * 2014-07-17 2014-11-12 西北工业大学 一种空间绳网机器人的逼近动力学建模方法
CN104536452A (zh) * 2015-01-26 2015-04-22 哈尔滨工业大学 基于时间-燃料最优控制的航天器相对轨道转移轨迹优化方法
CN105174061A (zh) * 2015-09-28 2015-12-23 南开大学 基于伪谱法的双摆吊车全局时间最优轨迹规划方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
On-line Estimation of Inertia;Fan Zhang等;《ACTA Astronautica》;20150331;第107卷;第150-162页 *
基于高斯伪谱法的弹道优化设计与实现;张洪倩;《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》;20140715(第07期);C032-141 *

Also Published As

Publication number Publication date
CN107194039A (zh) 2017-09-22

Similar Documents

Publication Publication Date Title
CN107490965B (zh) 一种空间自由漂浮机械臂的多约束轨迹规划方法
CN107194039B (zh) 一种基于改进高斯伪谱法的空间柔性***展开控制方法
CN108381553B (zh) 一种用于空间非合作目标捕获的相对导航近距离跟踪方法及***
CN106708068B (zh) 仿生波动鳍推进水下航行器路径跟踪控制方法
CN110027678B (zh) 一种基于海浪主动补偿的混联登乘机构运动规划方法
CN109634307A (zh) 一种无人水下航行器复合航迹跟踪控制方法
CN104850122A (zh) 基于可变船长比的抵抗侧风无人水面艇直线路径跟踪方法
Fan et al. Formation control of multiple unmanned surface vehicles using the adaptive null-space-based behavioral method
CN113093804B (zh) 基于反演滑模控制的无人艇编队控制方法和控制***
CN107450317A (zh) 一种空间机械臂自适应动力学协调控制方法
Hafez et al. Reactionless visual servoing of a dual-arm space robot
Zhao et al. Minimum base disturbance control of free-floating space robot during visual servoing pre-capturing process
Chen et al. Failure tolerance strategy of space manipulator for large load carrying tasks
Yu et al. A traversal multi-target path planning method for multi-unmanned surface vessels in space-varying ocean current
You et al. Adaptive neural sliding mode control for heterogeneous ship formation keeping considering uncertain dynamics and disturbances
Li et al. Sim-real joint experimental verification for an unmanned surface vehicle formation strategy based on multi-agent deterministic policy gradient and line of sight guidance
Kang et al. Experimental study of dynamic stability of underwater vehicle-manipulator system using zero moment point
Kim et al. Any-angle path planning with limit-cycle circle set for marine surface vehicle
Fan et al. A formation reconfiguration method for multiple unmanned surface vehicles executing target interception missions
CN111829528B (zh) 仿生滑翔机器海豚的实时路径规划方法及***
Gu et al. Dexterous obstacle-avoidance motion control of Rope Driven Snake Manipulator based on the bionic path following
CN114347017B (zh) 基于平面投影的吸附式移动加工机器人曲面运动控制方法
Xu et al. Analytical control design for a biomimetic robotic fish
Li et al. Path-following control for multi-axle car-like wheeled mobile robot with nonholonomic constraint
Kamath et al. Vision Augmented 3 DoF Quadrotor Control using a Non-singular Fast-terminal Sliding Mode Modified Super-twisting Controller

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant