CN115047763A - 一种多无人机系统的最小能量控制方法 - Google Patents

一种多无人机系统的最小能量控制方法 Download PDF

Info

Publication number
CN115047763A
CN115047763A CN202210639228.XA CN202210639228A CN115047763A CN 115047763 A CN115047763 A CN 115047763A CN 202210639228 A CN202210639228 A CN 202210639228A CN 115047763 A CN115047763 A CN 115047763A
Authority
CN
China
Prior art keywords
point
unmanned aerial
aerial vehicle
iterative learning
control
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.)
Granted
Application number
CN202210639228.XA
Other languages
English (en)
Other versions
CN115047763B (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.)
Chuzhou Dongyuan Electric Power Engineering Co ltd Tianchang Branch
Wuhan Tianzhiran Intellectual Property Operation Co ltd
Chuzhou Power Supply Co of State Grid Anhui Electric Power Co Ltd
Tianchang Power Supply Co of State Grid Anhui Electric Power Co Ltd
Original Assignee
Jiangnan 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 Jiangnan University filed Critical Jiangnan University
Priority to CN202210639228.XA priority Critical patent/CN115047763B/zh
Publication of CN115047763A publication Critical patent/CN115047763A/zh
Application granted granted Critical
Publication of CN115047763B publication Critical patent/CN115047763B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance

Landscapes

  • Engineering & Computer Science (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Electric Propulsion And Braking For Vehicles (AREA)

Abstract

本发明公开了一种多无人机系统的最小能量控制方法,涉及直流电动机优化控制领域,该方法包括:基于提升技术将重复运行的多无人机系统转换为时间序列的输入输出矩阵模型,分别设计集中式与分布式点对点迭代学习控制方法。选取M个跟踪时间点作为变量,提出点对点迭代学习控制的最小能量问题设计框架,并基于该框架设计了一种范数优化点对点迭代学习控制与坐标下降法结合的控制算法来解决这个优化问题。通过坐标下降方法改变跟踪时间点的分布从而减少系统能量损耗。

Description

一种多无人机系统的最小能量控制方法
技术领域
本发明涉及直流电动机优化控制领域,尤其是一种多无人机系统的最小能量控制方法。
背景技术
直流电动机是一种将直流电转换为机械能的转动装置,具有变流装置简单、调速性能好、运行性能优良等特点,在工业制造领域中得到广泛的应用。
针对执行重复运动任务的直流电动机,迭代学习控制具有良好的控制性能,迭代学习控制的原理是:使用之前批次的输入输出信息,不断修正当前批次的控制输入,从而在有限的时间能实现对期望轨迹的完全跟踪。然而在很多情况下,往往并不需要跟踪完整的轨迹,只需要在关键点处满足跟踪要求即可,这就是点对点跟踪问题。针对多无人机系统的一致性控制,满足上述点对点迭代学习控制跟踪特点,通过对控制律进行修正,从而保证每个无人机最终的状态相同,即最终实现相同的输出。点对点跟踪问题对于输出的要求不高,会给设计带来潜在优化的可能,比如减少系统能量的损耗。因此,在多无人机系统的点对点跟踪问题中,对最小能量控制方法设计的研究是很有意义的。
发明内容
本发明人针对上述问题及技术需求,提出了一种多无人机系统的最小能量控制方法,在不考虑外界环境的影响,通过前馈设计的集中式范数优化点对点迭代学习控制律更加实用;以跟踪时间点为变量,通过集中式范数优化点对点迭代学习控制与坐标下降方法相结合,在满足跟踪要求的同时,实现最小能量的目的。但是集中式的控制方法会对中央控制器有很大的负担,并且响应速度较慢,于是采用ADMM(Alternating Direction Methodof Multipliers,交替方向乘子算法)实现分布式的控制方法,即分布式范数优化点对点迭代学习控制;以跟踪时间点为变量,通过分布式范数优化点对点迭代学习控制与坐标下降方法相结合,在满足跟踪要求的同时,实现最小能量的目的。
本发明的技术方案如下:
一种多无人机系统的最小能量控制方法,包括如下步骤:
第一步、建立多无人机系统的动态模型:
动态模型采用传递函数表示,描述了单个无人机系统竖直方向的位移z和直流电动机输入电压Uz的转化关系。首先列写系统微分方程组;通过拉氏变换将微分方程组转换为等价的代数方程组,并根据代数方程组画出系统结构图;通过结构图简化,或消去代数方程组的中间变量,获得所需的输出量拉氏变换与输入量拉氏变换之比,即系统的传递函数。建立如式(1)所示的实际物理模型:
Figure BDA0003683155620000021
其中,s为复数,knn,ζ为根据实验数据所得的常数值,且分别取kn=775.3207,ωn=4.5994和ζ=0.7218。
因此,动态模型可以采用式(2)动力学方程表示:
Figure BDA0003683155620000022
其中,
Figure BDA0003683155620000023
第二步、构建多无人机系统的离散状态空间方程:
对于式(2)所示的连续系统模型,进行离散化处理,选取满足香农采样定理采样周期Ts,得到第i个(1≤i≤S)无人机系统的离散状态空间方程为:
Figure BDA0003683155620000024
式中t和k分别代表采样时间和批次,批次过程的运行周期为T;在每个重复过程周期内,对于时间点t∈[0,T]取N个采样点;
Figure BDA0003683155620000025
Figure BDA0003683155620000026
分别是第i个无人机系统的离散状态空间系统在第k批次t时刻的输入、输出和状态向量,三者具有相同的维度;Ai,Bi,Ci为每个无人机线性离散系统的各个参数矩阵,且满足CiBi≠0,并且假设每个无人机系统在每个批次的初始状态一致,令xi,k(0)=0;
第三步、建立多无人机系统的提升模型:
针对式(3)形式的线性离散系统,将其离散状态空间方程转换为时间序列的输入输出矩阵模型:
yi,k=Giui,k (4)
其中:
Figure BDA0003683155620000031
ui,k=[ui,k(0)T,ui,k(1)T,...,ui,k(N-1)T]T
yi,k=[yi,k(1)T,yi,k(2)T,...,yi,k(N)T]T
Figure BDA0003683155620000032
是时间序列上的输入输出传递矩阵;输入输出的内积及相关的诱导范数定义为:
Figure BDA0003683155620000033
Figure BDA0003683155620000034
其中,v(τ)为输入Hilbert空间上的向量,权矩阵R和Q为适当维度的实正定矩阵。
定义所有无人机系统的输入、输出向量:
Figure BDA0003683155620000035
Figure BDA0003683155620000036
第四步、提出点对点迭代学习控制设计框架:
选取在运行过程中的当前运行批次中的M个跟踪时间点,定义为ti,i=1,...,M,跟踪时间点分布定义为Γ:
Γ=[t1,t2,...,tM]T∈Θ (9)
其中:
Figure BDA0003683155620000037
点对点的参考轨迹rp是从完整的参考轨迹r中提取的,表示为:
rp=[r(t1)T,r(t2)T,...,r(tM)T]T (11)
第i个无人机点对点的输出信号
Figure BDA0003683155620000038
和跟踪误差
Figure BDA0003683155620000039
与式(11)有同样的表达式:
Figure BDA00036831556200000312
Figure BDA00036831556200000313
为了将一个信号转换为其点对点形式,引入一个转换矩阵
Figure BDA00036831556200000310
为M行N列的分块矩阵,使得rp=Ψr,
Figure BDA00036831556200000311
当第m个采样时刻tm为关键跟踪时间点时,转换矩阵第m行的所有N个元素除了n=t时为单位矩阵(l×l)其余全是零矩阵,Ψ的表达式为:
Figure BDA0003683155620000041
其中,Ψmn为转换矩阵Ψ中的第m行第n列的元素;
基于式(4),推导出第i个无人机的提升模型为:
Figure BDA0003683155620000042
其中,
Figure BDA0003683155620000043
基于式(15),拓展到多无人机系统的提升模型为:
Figure BDA0003683155620000044
其中,
Figure BDA0003683155620000045
定义所有无人机系统的点对点跟踪目标、点对点误差向量分别为:
Rp=[(rp)T,(rp)T,...,(rp)T]T (17)
Figure BDA0003683155620000046
第五步、建立多无人机系统的网络拓扑结构模型:
用图结构
Figure BDA0003683155620000047
来表示网络拓扑,节点的集合
Figure BDA0003683155620000048
边的集合
Figure BDA0003683155620000049
第i个无人机的邻接节点的集合
Figure BDA00036831556200000410
无人机之间的通信情况用邻接矩阵
Figure BDA00036831556200000411
表示,其中:
Figure BDA00036831556200000412
在多无人机系统的网络拓扑结构模型中,只有有限个数的无人机可以直接获取点对点的参考轨迹rp,其他无人机则通过邻接无人机获取跟踪信息。用对角矩阵P来表示第i无人机能否直接获取点对点的参考轨迹,它的元素pii表示为:
Figure BDA00036831556200000413
第六步、提出点对点迭代学习控制的最小能量问题设计框架:
选择控制能量作为目标代价函数:
Figure BDA0003683155620000051
最小能量的设计目的是迭代地寻找一个输入信号Uk,相应的输出Yk,以及一个跟踪时间点分布Γk,满足:
Figure BDA0003683155620000052
其中,Y*表示准确地经过点对点的参考轨迹Rp,同时U*,Γ*是如下问题的优化解:
Figure BDA0003683155620000053
通过先优化输入信号U,再优化跟踪时间点分布Γ,将优化问题(23)分为两个优化问题:
Figure BDA0003683155620000054
Figure BDA0003683155620000055
其中,U*(Γ)是优化问题(24)的解析解;由于目标代价函数(21)是凸函数,所以可以保证解析解U*(Γ)是唯一的全局最优解。
第七步、设计多无人机系统的集中式点对点迭代学习最小能量控制算法:
为了满足实际工业问题设计要求,此处考虑了多无人机系统的拓扑通信结构、点对点跟踪误差及控制信号批次间变化,设计如下全局性能指标:
Jk+1(U)=q1||LEp||2+q2||PEp||2+q3||U-Uk||2 (26)
其中,
Figure BDA0003683155620000056
数q1,q2,q3表示权重。通过优化这个性能指标函数(26),得到分布式的点对点迭代学习控制律为:
Figure BDA0003683155620000057
其中,
Figure BDA0003683155620000058
IMS是维度为MS×MS的单位矩阵。
根据控制律(27),为了获取稳态控制输入,令k→∞,并且初始的输入信号U0=0,则:
Figure BDA0003683155620000059
为了解决优化问题(24),引入Language乘子λ,构造Language函数:
Figure BDA00036831556200000510
令U*(Γ)为Language函数的全局最优解,则:
Figure BDA0003683155620000061
Figure BDA0003683155620000062
代入式(30),则:
Figure BDA0003683155620000063
当且仅当
Figure BDA0003683155620000064
不等式(31)成立,并且满足跟踪条件
Figure BDA0003683155620000065
则有:
Figure BDA0003683155620000066
由范数优化迭代学习控制律生成的稳态控制输入U就是优化问题(24)的全局最优解U*(Γ);
将优化问题(24)的全局最优解表达式(28)代入优化问题(25),则有:
Figure BDA0003683155620000067
由于集合Θ在离散系统中是有限的,令初始跟踪时间点分布为Γ0,所以优化问题(33)通过坐标下降法解决,表达式为:
Figure BDA0003683155620000068
其中
Figure BDA0003683155620000069
表示坐标下降的次数;每个跟踪时间点经过函数
Figure BDA00036831556200000610
更新:
Figure BDA00036831556200000611
其中
Figure BDA00036831556200000612
是如下优化问题的解:
Figure BDA00036831556200000613
基于式(34)生成的序列{h(Γj)},向下收敛到极限h*
给定线性离散时不变系统,初始跟踪时间点分布Γ0以及集合Θ,点对点的参考轨迹Rp,选定权矩阵
Figure BDA0003683155620000071
Figure BDA0003683155620000072
趋近于零的常数ε>0和δ>0,则集中式点对点迭代学习最小能量控制算法设计包括:
步骤7.1:初始跟踪时间点分布为Γ0时,执行范数优化迭代学习控制律(27)直到系统收敛,即
Figure BDA0003683155620000073
记录稳态控制输入U*0)以及初始控制能量
Figure BDA0003683155620000074
步骤7.2:执行坐标下降法(34),令j→j+1;
步骤7.3:令跟踪时间点分布Γ=Γj时,执行范数优化迭代学习控制律(27)直到系统收敛,即
Figure BDA0003683155620000075
记录稳态控制输入U*j)以及相应的控制能量
Figure BDA0003683155620000076
步骤7.4:重复执行步骤7.2和步骤7.3,直到|h(Γj)-h(Γj-1)|<δ|h(Γj-1)|;
步骤7.5:记录最优跟踪时间点分布Γ*以及相应的最小能量
Figure BDA0003683155620000077
第八步、设计多无人机系统的分布式点对点迭代学习控制算法:
利用ADMM实现对多无人机系统的分布式控制,式(26)等价于:
Figure BDA0003683155620000078
Figure BDA0003683155620000079
是第i个无人机的局部性能指标,定义为:
Figure BDA00036831556200000710
其中,
Figure BDA00036831556200000711
是将第i个无人机和邻接无人机的输入作为局部变量。
比如说
Figure BDA00036831556200000712
Figure BDA00036831556200000713
ADMM用于优化以下优化问题:
Figure BDA00036831556200000714
其中,
Figure BDA00036831556200000715
是局部变量,
Figure BDA00036831556200000716
表示全局变量,
Figure BDA00036831556200000717
表示一个将全局变量映射到对应维度全局变量的矩阵,全局变量的组成部分zi对应于局部变量
Figure BDA00036831556200000718
的组成部分
Figure BDA00036831556200000719
对于优化问题(39),构造增广拉格朗日函数为:
Figure BDA00036831556200000720
ADMM采用三个步骤通过迭代求解,定义为:
Figure BDA0003683155620000081
Figure BDA0003683155620000082
Figure BDA0003683155620000083
其中,o∈[1,...,S],
Figure BDA0003683155620000084
表示局部变量
Figure BDA0003683155620000085
中ui出现的次数,
Figure BDA0003683155620000086
表示含有ui的局部变量
Figure BDA0003683155620000087
的编号集合。ADMM的目的就是通过迭代的方法,在第k+1批次优化局部变量
Figure BDA0003683155620000088
得到控制输入ui,以迫近于性能指标函数(26)的解析解,即集中式的控制律(27)。
给定线性离散时不变系统,对角矩阵P和拉普拉斯矩阵L,各个无人机的点对点跟踪轨迹rp,权重参数q1,q2,q3,最大ILC迭代次数kmax,最大ADMM迭代次数υmax,步长ρ,设置初始ILC迭代次数k=0,初始ADMM迭代次数υ=0,初始计数i=0,则分布式点对点迭代学习控制算法设计包括:
步骤8.1:设置i=i+1,分别执行优化步骤(41)(42)(43)最小化
Figure BDA0003683155620000089
直至i=S;
步骤8.2:设置υ=υ+1,重复执行步骤8.1,直至υ=υmax,从优化局部
Figure BDA00036831556200000810
变量中提取ui,k+1
步骤8.3:设置k=k+1,重复执行步骤8.2,直至k=kmax
步骤8.4:获取每个无人机的最优输入ui,kmax
第九步、设计多无人机系统的分布式点对点迭代学习最小能量控制算法:
多无人机系统的最优控制,就是优化性能指标函数(26),可以直接获取解析解,即集中式控制律(27)。利用ADMM实现分布式控制,优化等价的性能指标函数(39),通过迭代的方式,迫近集中式的解析解。
在集中式控制中,由范数优化迭代学习控制律生成的稳态控制输入U就是优化问题(24)的全局最优解U*(Γ)。那么在分布式控制中,改写优化问题(24)和(25):
Figure BDA00036831556200000811
Figure BDA00036831556200000812
其中,
Figure BDA00036831556200000813
是优化问题(44)的解析解。可以得到,只要经过足够的ADMM迭代次数,则最终分布式迭代学习控制的稳态输入ui,∞就是优化问题(44)的全局最优解
Figure BDA0003683155620000091
优化问题(45)同样通过坐标下降法解决,表达式为:
Figure BDA0003683155620000092
其中
Figure BDA0003683155620000093
表示坐标下降的次数;每个跟踪时间点经过函数
Figure BDA0003683155620000094
更新:
Figure BDA0003683155620000095
其中
Figure BDA0003683155620000096
是如下优化问题的解:
Figure BDA0003683155620000097
给定线性离散时不变系统,初始跟踪时间点分布Γ0以及集合Θ,对角矩阵P和拉普拉斯矩阵L,各个无人机的点对点跟踪轨迹rp,权重参数q1,q2,q3,最大ILC迭代次数kmax,最大ADMM迭代次数υmax,步长ρ,设置初始ILC迭代次数k=0,初始ADMM迭代次数υ=0,初始计数i=0,趋近于零的常数ε>0和δ>0,则分布式点对点迭代学习最小能量控制算法设计包括:
步骤9.1:初始跟踪时间点分布为Γ0时,执行分布式点对点迭代学习控制算法步骤8.1到步骤8.4直到系统收敛,即
Figure BDA0003683155620000098
记录稳态控制输入
Figure BDA0003683155620000099
以及初始控制能量
Figure BDA00036831556200000910
步骤9.2:执行坐标下降法(46),令j→j+1;
步骤9.3:令跟踪时间点分布Γ=Γj时,执行分布式点对点迭代学习控制算法步骤8.1到步骤8.4直到系统收敛,即
Figure BDA00036831556200000911
记录稳态控制输入
Figure BDA00036831556200000912
以及相应的控制能量
Figure BDA00036831556200000913
步骤9.4:重复执行步骤9.2和步骤9.3,直到|h*j)-h*j-1)|<δ|h*j-1)|;
步骤9.5:记录最优跟踪时间点分布Γ*以及相应的最小能量
Figure BDA00036831556200000914
本发明的有益技术效果是:
本申请公开了针对具有重复运动特征和线性化模型的多无人机系统,将该多无人机系统作为被控对象,分别提出集中式与分布式控制方法,并且针对点对点跟踪任务中能量损耗问题,将范数优化点对点迭代学习控制与坐标下降方法相结合,提出了点对点迭代学习控制的最小能量问题设计框架,并在该框架下设计可实现的迭代学习控制算法,通过坐标下降方法改变跟踪时间点的分布从而减少系统能量损耗。
附图说明
图1是本申请提供的多无人机系统的网络拓扑结构模型。
图2是本申请提供的多无人机系统的集中式范数优化点对点最小能量控制方法的流程框图。
图3是本申请提供的多无人机系统局部变量与全局变量之间的映射关系图。
图4是本申请提供的多无人机系统实现分布式控制时的系统框图。
图5是本申请提供的多无人机系统在第1批次时系统的输出曲线图。
图6是本申请提供的多无人机系统在第9批次时系统的输出曲线图。
图7是本申请提供的多无人机系统在第30批次时系统的输出曲线图。
图8是本申请提供的多无人机系统集中式与分布式控制的误差曲线图。
图9是本申请提供的多无人机系统跟踪时间点变化图。
图10是本申请提供的多无人机系统输入能量变化图。
图11是本申请提供的多无人机系统在初始跟踪时间点分布与最终跟踪时间点分布处的实际输入曲线图。
图12是本申请提供的多无人机系统在初始跟踪时间点分布与最终跟踪时间点分布处的实际输出曲线图。
具体实施方式
下面结合附图对本发明的具体实施方式做进一步说明。
如图1所示,是多无人机系统的网络拓扑结构模型,以四个无人机构成多无人机系统为例说明,箭头表示信息传输方向,从而得到参数如下:
Figure BDA0003683155620000111
Figure BDA0003683155620000112
如图2所示,第k批次的控制输入信号为Uk,将其作用于多无人机系统得到第k批次系统的输出信号Yk。针对点对点跟踪问题,将存储在跟踪时间点分布存储器中第j批次的Γj作用于转换模块,通过转换模块将输出信号Yk转换成其点对点输出信号
Figure BDA0003683155620000113
之后,将点对点输出信号
Figure BDA0003683155620000114
与存储在点对点期望轨迹存储器的设定期望值Rp进行比较,得到点对点跟踪误差
Figure BDA0003683155620000115
若误差精度没有达到所设定的精度,则将点对点跟踪误差
Figure BDA0003683155620000118
与当前控制器输入Uk传递到范数优化迭代学习控制器生成下一批次的控制器输入Uk+1,如此循环运行直至系统实际输出与期望值之间的误差达到精度要求,则停止ILC迭代,此时的控制器输入即为最优控制输入U*j)。若最优控制输入没有达到所设定的要求|h(Γj)-h(Γj-1)|<δ|h(Γj-1)|,则将最优控制输入U*j)与当前跟踪时间点分布存储器中的Γj作用于坐标下降法生成下一批次的跟踪时间点分布Γj+1,如此循环运行直至满足精度要求,则停止坐标迭代,此时的跟踪时间点分布存储器中是最优跟踪时间点分布Γ*,以及相应的最小输入能量
Figure BDA0003683155620000116
如图3所示,多无人机系统局部变量
Figure BDA0003683155620000117
与全局变量zi之间的映射关系图,其中局部性能指标优化函数的形式是图1多无人机系统的网络拓扑结构模型决定。
如图4所示,多无人机系统实现分布式控制时的系统框图,和图1相对应,每个圈表示优化的局部变量,和图3相对应。并且每个无人机具有相同的动力学方程,取传递函数的参数值为kn=775.3207,ωn=4.5994和ζ=0.7218。可以得到每个无人机的状态空间表达式为:
Figure BDA0003683155620000121
系统仿真时间设定为T=10s,采样时间设定为Ts=0.1s,则系统的离散状态空间方程的参数矩阵分别为:
Figure BDA0003683155620000122
C=[1 0 0].
在多无人机系统运行过程中,需要系统的在竖直方向的位移处于几个关键位置。因此,本例选取5个关键跟踪时间点,点对点期望轨迹设置为:
rp=[5 4 -4 -6 3]T,
初始跟踪时间点分布设置为:
Γ0=[5 25 45 65 85]T
选取权重参数q1=1,q2=1,q3=8000,并且初始输入ui,0=0。本申请的上述集中式范数优化迭代学习控制器基于STM32F103RCT6芯片实现,芯片的输入为电机控制电压U,通过电压传感器采集得到。第k批次的输入信号通过调理电路进入STM32F103RCT6芯片进行存储和计算,第j批次的跟踪时间点分布Γj同样存储在芯片中,并构建迭代学习更新律,CPU计算后得到的下一批次输入信号Uk+1,输入信号再经RS232通信模块作用于多无人机系统,不断修正系统输出跟踪轨迹,直到跟踪上关键跟踪时间点。多无人机系统的动态模型(3)运行时,请参考图5-图7,其示出了多无人机系统应用集中式范数优化迭代学习控制律(27)的轨迹跟踪效果图,经过一定批次k后,系统的输出值能准确跟踪上关键跟踪时间点。图8示出多无人机系统集中式与分布式控制的误差曲线图,分布式范数优化迭代学习控制中,ADMM的迭代次数υ影响最终跟踪性能,当υ≥10时,分布式控制产生的误差曲线与集中式控制产生的误差曲线相重合。
将范数优化迭代学习控制结合坐标下降法,实现减小能量损耗的目的,这就是最小能量控制方法。图9和图10分别示出了多无人机系统跟踪时间点变化图与输入能量变化图,跟踪时间点分布存储器中的最优跟踪时间分布为Γ*=[21265362100]T,以及相应的最小输入能量为
Figure BDA0003683155620000131
图11示出了多无人机系统在初始跟踪时间点分布Γ0与最终跟踪时间点分布Γ50处的实际输入曲线图,可以直观地看出在最终跟踪时间点分布处的输入能量小于在初始跟踪时间点分布处的输入能量。图12示出了多无人机系统在初始跟踪时间点分布Γ0与最终跟踪时间点分布Γ50处的实际输出曲线图,系统的输出满足点对点跟踪任务。
以上所述的仅是本申请的优选实施方式,本发明不限于以上实施例。可以理解,本领域技术人员在不脱离本发明的精神和构思的前提下直接导出或联想到的其他改进和变化,均应认为包含在本发明的保护范围之内。

Claims (1)

1.一种多无人机系统的最小能量控制方法,其特征在于,所述方法包括:
第一步、建立所述多无人机系统的动态模型:
所述动态模型采用传递函数表示,描述了单个无人机系统竖直方向的位移z和直流电动机输入电压Uz的转化关系,建立如式(1)所示的实际物理模型:
Figure FDA0003683155610000011
其中,s为复数,knn,ζ为根据实验数据所得的常数值;
因此,所述动态模型采用式(2)动力学方程表示:
Figure FDA0003683155610000012
其中,
Figure FDA0003683155610000013
第二步、构建所述多无人机系统的离散状态空间方程:
对于式(2)所示的连续系统模型,进行离散化处理,选取满足香农采样定理采样周期Ts,得到第i个(1≤i≤S)无人机系统的离散状态空间方程为:
Figure FDA0003683155610000014
式中t和k分别代表采样时间和批次,批次过程的运行周期为T;在每个重复过程周期内,对于时间点t∈[0,T]取N个采样点;
Figure FDA0003683155610000015
Figure FDA0003683155610000016
分别是第i个无人机系统的离散状态空间系统在第k批次t时刻的输入、输出和状态向量,三者具有相同的维度;Ai,Bi,Ci为每个无人机线性离散系统的各个参数矩阵,且满足CiBi≠0,并且假设每个无人机系统在每个批次的初始状态一致,令xi,k(0)=0;
第三步、建立所述多无人机系统的提升模型:
针对式(3)形式的无人机线性离散系统,将其离散状态空间方程转换为时间序列的输入输出矩阵模型:
yi,k=Giui,k (4)
其中:
Figure FDA0003683155610000021
ui,k=[ui,k(0)T,ui,k(1)T,...,ui,k(N-1)T]T
yi,k=[yi,k(1)T,yi,k(2)T,...,yi,k(N)T]T
Figure FDA0003683155610000022
是时间序列上的输入输出传递矩阵;输入输出的内积及相关的诱导范数定义为:
Figure FDA0003683155610000023
Figure FDA0003683155610000024
其中,v(τ)为输入Hilbert空间上的向量,权矩阵R和Q为适当维度的实正定矩阵;
定义所有无人机系统的输入、输出向量为:
Figure FDA0003683155610000025
Figure FDA0003683155610000026
第四步、提出点对点迭代学习控制设计框架:
选取在运行过程中的当前运行批次中的M个跟踪时间点,定义为ti,i=1,...,M,跟踪时间点分布定义为Γ:
Γ=[t1,t2,...,tM]T∈Θ (9)
其中:
Figure FDA0003683155610000027
点对点的参考轨迹rp是从完整的参考轨迹r中提取的,表示为:
rp=[r(t1)T,r(t2)T,...,r(tM)T]T (11)
第i个无人机点对点的输出信号
Figure FDA0003683155610000028
和跟踪误差
Figure FDA0003683155610000029
与式(11)有同样的表达式:
Figure FDA00036831556100000210
Figure FDA00036831556100000211
为了将一个信号转换为点对点形式,引入一个转换矩阵
Figure FDA00036831556100000212
为M行N列的分块矩阵,使得rp=Ψr,
Figure FDA00036831556100000213
当第m个采样时刻tm为关键跟踪时间点时,转换矩阵第m行的所有N个元素除了n=t时为单位矩阵其余全是零矩阵,Ψ的表达式为:
Figure FDA0003683155610000031
其中,Ψmn为转换矩阵Ψ中的第m行第n列的元素;
基于式(4),推导出第i个无人机的提升模型为:
Figure FDA0003683155610000032
其中,
Figure FDA0003683155610000033
基于式(15),拓展到所述多无人机系统的提升模型为:
Figure FDA0003683155610000034
其中,
Figure FDA0003683155610000035
定义所有无人机系统的点对点跟踪目标、点对点误差向量分别为:
Rp=[(rp)T,(rp)T,...,(rp)T]T (17)
Figure FDA0003683155610000036
第五步、建立所述多无人机系统的网络拓扑结构模型:
用图结构
Figure FDA0003683155610000037
来表示网络拓扑,节点的集合
Figure FDA0003683155610000038
边的集合
Figure FDA0003683155610000039
第i个无人机的邻接节点的集合
Figure FDA00036831556100000310
无人机之间的通信情况用邻接矩阵
Figure FDA00036831556100000311
表示,其中:
Figure FDA00036831556100000312
顶点i的入度定义为
Figure FDA00036831556100000313
并且拉普拉斯矩阵定义为
Figure FDA00036831556100000314
其中
Figure FDA00036831556100000315
在所述多无人机系统的网络拓扑结构模型中,有限个数的无人机直接获取点对点的参考轨迹rp,其他无人机则通过邻接无人机获取跟踪信息;用对角矩阵P来表示第i无人机能否直接获取点对点的参考轨迹,它的元素pii表示为:
Figure FDA00036831556100000316
第六步、提出点对点迭代学习控制的最小能量问题设计框架:
选择控制能量作为目标代价函数:
Figure FDA0003683155610000041
其中,常数q3表示权重;
最小能量的设计目的是迭代地寻找一个输入信号Uk,相应的输出Yk,以及一个跟踪时间点分布Γk,满足:
Figure FDA0003683155610000042
其中,Y*表示准确地经过点对点的参考轨迹Rp,同时U*,Γ*是如下问题的优化解:
Figure FDA0003683155610000043
通过先优化输入信号U,再优化跟踪时间点分布Γ,将优化问题(23)分为两个优化问题:
Figure FDA0003683155610000044
Figure FDA0003683155610000045
其中,U*(Γ)是优化问题(24)的解析解;由于目标代价函数(21)是凸函数,所以保证解析解U*(Γ)是唯一的全局最优解;
第七步、设计所述多无人机系统的集中式点对点迭代学习最小能量控制算法:
考虑所述多无人机系统的拓扑通信结构、点对点跟踪误差及控制信号批次间变化,设计如下全局性能指标:
Jk+1(U)=q1||LEp||2+q2||PEp||2+q3||U-Uk||2 (26)
其中,
Figure FDA0003683155610000046
常数q1,q2表示权重;通过优化性能指标函数(26),得到集中式的点对点迭代学习控制律为:
Figure FDA0003683155610000047
其中,
Figure FDA00036831556100000410
IMS是维度为MS×MS的单位矩阵;
根据控制律(27),为了获取稳态控制输入,令k→∞,并且初始的输入信号U0=0,则:
Figure FDA0003683155610000049
为了解决优化问题(24),引入Language乘子λ,构造Language函数:
Figure FDA0003683155610000051
令U*(Γ)为所述Language函数的全局最优解,则:
Figure FDA0003683155610000052
Figure FDA0003683155610000053
代入式(30),则:
Figure FDA0003683155610000054
当且仅当
Figure FDA0003683155610000055
不等式(31)成立,并且满足跟踪条件
Figure FDA0003683155610000056
则有:
Figure FDA0003683155610000057
由范数优化迭代学习控制律(27)生成的稳态控制输入U就是优化问题(24)的全局最优解U*(Γ);
将优化问题(24)的全局最优解表达式(28)代入优化问题(25),则有:
Figure FDA0003683155610000058
由于集合Θ在离散系统中是有限的,令初始跟踪时间点分布为Γ0,所以优化问题(33)通过坐标下降法解决,表达式为:
Figure FDA0003683155610000059
其中,
Figure FDA00036831556100000510
Figure FDA00036831556100000511
表示坐标下降的次数;每个跟踪时间点经过函数
Figure FDA00036831556100000512
更新:
Figure FDA00036831556100000513
其中
Figure FDA00036831556100000514
是如下优化问题的解:
Figure FDA00036831556100000515
基于式(34)生成的序列{h(Γj)},向下收敛到极限h*
给定线性离散时不变系统,初始跟踪时间点分布Γ0以及集合Θ,点对点的参考轨迹Rp,选定权矩阵
Figure FDA00036831556100000618
Figure FDA00036831556100000619
趋近于零的常数ε>0和δ>0,则所述集中式点对点迭代学习最小能量控制算法设计包括:
初始跟踪时间点分布为Γ0时,执行范数优化迭代学习控制律(27)直到系统收敛,即
Figure FDA0003683155610000061
记录稳态控制输入U*0)以及初始控制能量
Figure FDA0003683155610000062
执行坐标下降法(34),令j→j+1;
令跟踪时间点分布Γ=Γj时,执行范数优化迭代学习控制律(27)直到系统收敛,即
Figure FDA0003683155610000063
记录稳态控制输入U*j)以及相应的控制能量
Figure FDA0003683155610000064
重复所述执行坐标下降法(34),直到|h(Γj)-h(Γj-1)|<δ|h(Γj-1)|;
记录最优跟踪时间点分布Γ*以及相应的最小能量
Figure FDA0003683155610000065
第八步、设计所述多无人机系统的分布式点对点迭代学习控制算法:
利用ADMM实现对所述多无人机系统的分布式控制,式(26)等价于:
Figure FDA0003683155610000066
Figure FDA0003683155610000067
是第i个无人机的局部性能指标,定义为:
Figure FDA0003683155610000068
其中,
Figure FDA0003683155610000069
Figure FDA00036831556100000610
是将第i个无人机和邻接无人机的输入作为局部变量;
所述ADMM用于优化以下优化问题:
Figure FDA00036831556100000611
其中,
Figure FDA00036831556100000612
表示全局变量,
Figure FDA00036831556100000613
表示一个将全局变量映射到对应维度全局变量的矩阵,全局变量的组成部分zi对应于局部变量
Figure FDA00036831556100000614
的组成部分
Figure FDA00036831556100000615
对于优化问题(39),构造增广拉格朗日函数为:
Figure FDA00036831556100000616
所述ADMM采用三个步骤通过迭代求解,定义为:
Figure FDA00036831556100000617
Figure FDA0003683155610000071
Figure FDA0003683155610000072
其中,o∈[1,...,S],
Figure FDA0003683155610000073
表示局部变量
Figure FDA0003683155610000074
中ui出现的次数,
Figure FDA0003683155610000075
表示含有ui的局部变量
Figure FDA0003683155610000076
的编号集合;所述ADMM的目的是通过迭代的方法,在第k+1批次优化局部变量
Figure FDA0003683155610000077
得到控制输入ui,以迫近于性能指标函数(26)的解析解,即集中式的控制律(27);
给定线性离散时不变系统,对角矩阵P和拉普拉斯矩阵L,各个无人机的点对点跟踪轨迹rp,权重q1,q2,q3,最大ILC迭代次数kmax,最大ADMM迭代次数υmax,步长ρ,设置初始ILC迭代次数k=0,初始ADMM迭代次数υ=0,初始计数i=0,则所述分布式点对点迭代学习控制算法设计包括:
设置i=i+1,分别执行优化步骤(41)(42)(43)最小化
Figure FDA0003683155610000078
直至i=S;
设置υ=υ+1,重复执行所述i=i+1,直至υ=υmax,从优化局部
Figure FDA0003683155610000079
变量中提取ui,k+1
设置k=k+1,重复执行所述υ=υ+1,直至k=kmax
获取每个无人机的最优输入
Figure FDA00036831556100000710
第九步、设计所述多无人机系统的分布式点对点迭代学习最小能量控制算法:
所述多无人机系统的最优控制,就是优化性能指标函数(26),直接获取解析解,即集中式的点对点迭代学习控制律(27);利用所述ADMM实现分布式控制,优化等价的性能指标函数(39),通过迭代的方式,迫近集中式的解析解;
在集中式控制中,由范数优化迭代学习控制律生成的稳态控制输入U就是优化问题(24)的全局最优解U*(Γ);那么在分布式控制中,改写优化问题(24)和(25):
Figure FDA00036831556100000711
Figure FDA00036831556100000712
其中,
Figure FDA00036831556100000713
是优化问题(44)的解析解;当经过足够的ADMM迭代次数,则最终分布式迭代学习控制的稳态输入ui,∞就是优化问题(44)的全局最优解
Figure FDA00036831556100000714
优化问题(45)同样通过坐标下降法解决,表达式为:
Figure FDA0003683155610000081
其中
Figure FDA0003683155610000082
Figure FDA0003683155610000083
表示坐标下降的次数;每个跟踪时间点经过函数
Figure FDA0003683155610000084
更新:
Figure FDA0003683155610000085
其中
Figure FDA0003683155610000086
是如下优化问题的解:
Figure FDA0003683155610000087
给定线性离散时不变系统,初始跟踪时间点分布Γ0以及集合Θ,对角矩阵P和拉普拉斯矩阵L,各个无人机的点对点跟踪轨迹rp,权重q1,q2,q3,最大ILC迭代次数kmax,最大ADMM迭代次数υmax,步长ρ,设置初始ILC迭代次数k=0,初始ADMM迭代次数υ=0,初始计数i=0,趋近于零的常数ε>0和δ>0,则所述分布式点对点迭代学习最小能量控制算法设计包括:
初始跟踪时间点分布为Γ0时,执行第八步中的所述分布式点对点迭代学习控制算法设计的步骤直到系统收敛,即
Figure FDA0003683155610000088
记录稳态控制输入
Figure FDA0003683155610000089
以及初始控制能量
Figure FDA00036831556100000810
执行坐标下降法(46),令j→j+1;
令跟踪时间点分布Γ=Γj时,执行第八步中的所述分布式点对点迭代学习控制算法设计的步骤直到系统收敛,即
Figure FDA00036831556100000811
记录稳态控制输入
Figure FDA00036831556100000812
以及相应的控制能量
Figure FDA00036831556100000813
重复所述执行坐标下降法(46),直到|h*j)-h*j-1)|<δ|h*j-1)|;
记录最优跟踪时间点分布Γ*以及相应的最小能量
Figure FDA00036831556100000814
CN202210639228.XA 2022-06-08 2022-06-08 一种多无人机系统的最小能量控制方法 Active CN115047763B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210639228.XA CN115047763B (zh) 2022-06-08 2022-06-08 一种多无人机系统的最小能量控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210639228.XA CN115047763B (zh) 2022-06-08 2022-06-08 一种多无人机系统的最小能量控制方法

Publications (2)

Publication Number Publication Date
CN115047763A true CN115047763A (zh) 2022-09-13
CN115047763B CN115047763B (zh) 2023-10-13

Family

ID=83161556

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210639228.XA Active CN115047763B (zh) 2022-06-08 2022-06-08 一种多无人机系统的最小能量控制方法

Country Status (1)

Country Link
CN (1) CN115047763B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116893619A (zh) * 2023-08-29 2023-10-17 江南大学 一种工业机器人量化迭代学习控制方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20140188273A1 (en) * 2012-12-31 2014-07-03 King Fahd University Of Petroleum And Minerals Control method for mobile parallel manipulators
CN110262543A (zh) * 2019-05-23 2019-09-20 北京航空航天大学 多目标点同时到达约束下的集群四维轨迹规划设计方法
CN110815225A (zh) * 2019-11-15 2020-02-21 江南大学 电机驱动单机械臂系统的点对点迭代学习优化控制方法
CN113341726A (zh) * 2021-06-18 2021-09-03 江南大学 一种多质点车辆队列行驶系统的迭代学习控制方法
CN113900377A (zh) * 2021-10-19 2022-01-07 江南大学 双转子气动系统点对点迭代学习最小能量控制方法
WO2022088471A1 (zh) * 2020-10-28 2022-05-05 江南大学 一种移动机器人变批次长度迭代学习优化控制方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20140188273A1 (en) * 2012-12-31 2014-07-03 King Fahd University Of Petroleum And Minerals Control method for mobile parallel manipulators
CN110262543A (zh) * 2019-05-23 2019-09-20 北京航空航天大学 多目标点同时到达约束下的集群四维轨迹规划设计方法
CN110815225A (zh) * 2019-11-15 2020-02-21 江南大学 电机驱动单机械臂系统的点对点迭代学习优化控制方法
WO2022088471A1 (zh) * 2020-10-28 2022-05-05 江南大学 一种移动机器人变批次长度迭代学习优化控制方法
CN113341726A (zh) * 2021-06-18 2021-09-03 江南大学 一种多质点车辆队列行驶系统的迭代学习控制方法
CN113900377A (zh) * 2021-10-19 2022-01-07 江南大学 双转子气动系统点对点迭代学习最小能量控制方法

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116893619A (zh) * 2023-08-29 2023-10-17 江南大学 一种工业机器人量化迭代学习控制方法
CN116893619B (zh) * 2023-08-29 2024-04-09 江南大学 一种工业机器人量化迭代学习控制方法

Also Published As

Publication number Publication date
CN115047763B (zh) 2023-10-13

Similar Documents

Publication Publication Date Title
Cheng et al. Real-time optimal control for spacecraft orbit transfer via multiscale deep neural networks
Asif et al. Adaptive sliding mode dynamic controller with integrator in the loop for nonholonomic wheeled mobile robot trajectory tracking
Peng et al. Distributed model reference adaptive control for cooperative tracking of uncertain dynamical multi‐agent systems
Hao et al. Adaptive dynamic surface control for cooperative path following of underactuated marine surface vehicles via fast learning
CN110815225B (zh) 电机驱动单机械臂系统的点对点迭代学习优化控制方法
Xiong et al. Model-free adaptive control for unknown MIMO nonaffine nonlinear discrete-time systems with experimental validation
CN112318505B (zh) 一种移动机器人变批次长度迭代学习优化控制方法
Karg et al. Deep learning-based embedded mixed-integer model predictive control
Kingravi et al. Reproducing kernel Hilbert space approach for the online update of radial bases in neuro-adaptive control
Qi et al. Stable indirect adaptive control based on discrete-time T–S fuzzy model
Wang et al. Distributed consensus protocols for coordinated control of multiple quadrotors under a directed topology
Yang et al. Superior robustness of power-sum activation functions in Zhang neural networks for time-varying quadratic programs perturbed with large implementation errors
You et al. Comprehensive design of uniform robust exact disturbance observer and fixed‐time controller for reusable launch vehicles
Xiong et al. Fixed‐time observer based adaptive neural network time‐varying formation tracking control for multi‐agent systems via minimal learning parameter approach
de Almeida et al. Real-time minimum snap trajectory generation for quadcopters: Algorithm speed-up through machine learning
Wang et al. Neural network‐based multivariable fixed‐time terminal sliding mode control for re‐entry vehicles
CN115047763A (zh) 一种多无人机系统的最小能量控制方法
Ji et al. Optimal consensus model-free control for multi-agent systems subject to input delays and switching topologies
Xu et al. Adaptive sliding mode disturbance observer–based funnel trajectory tracking control of quadrotor with external disturbances
CN117055605A (zh) 多无人机姿态控制方法及系统
CN113900377B (zh) 双转子气动系统点对点迭代学习最小能量控制方法
Cui et al. Finite‐time trajectory tracking control for autonomous airships with uncertainties and external disturbances
Che et al. Data‐driven model‐free adaptive attitude control for morphing vehicles
CN107480381B (zh) 基于模拟退火算法构建响应面模型的方法及应用其的系统
Ma et al. Adaptive neural network control of a non‐linear two‐degree‐of‐freedom helicopter system with prescribed performance

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
TA01 Transfer of patent application right

Effective date of registration: 20230914

Address after: Room 05, 27th Floor, Building 1, Phase 3, Guannan Fuxing Pharmaceutical Park, No. 58 Guanggu Avenue, Donghu New Technology Development Zone, Wuhan City, Hubei Province, 430000 (Wuhan Area of Free Trade Zone)

Applicant after: Wuhan Tianzhiran Intellectual Property Operation Co.,Ltd.

Address before: 214100 7th floor, South Building, No. 898, Tongsha Road, Liangxi District, Wuxi City, Jiangsu Province

Applicant before: Jiangnan University

Effective date of registration: 20230914

Address after: 239300 North of Guangling Road, east of Erfeng South Road, Tianchang City, Chuzhou City, Anhui Province

Applicant after: TIANCHANG CITY POWER SUPPLY COMPANY OF STATE GRID ANHUI POWER CO.,LTD.

Applicant after: STATE GRID ANHUI POWER CO., LTD. CHUZHOU POWER SUPPLY Co.

Applicant after: Chuzhou Dongyuan Electric Power Engineering Co.,Ltd. Tianchang Branch

Address before: Room 05, 27th Floor, Building 1, Phase 3, Guannan Fuxing Pharmaceutical Park, No. 58 Guanggu Avenue, Donghu New Technology Development Zone, Wuhan City, Hubei Province, 430000 (Wuhan Area of Free Trade Zone)

Applicant before: Wuhan Tianzhiran Intellectual Property Operation Co.,Ltd.

TA01 Transfer of patent application right
GR01 Patent grant
GR01 Patent grant