首页 > 专利 > 江南大学 > 一种多无人机系统的最小能量控制方法专利详情

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

实质审查 查看PDF
专利申请流程有哪些步骤?
专利申请流程图
申请
申请号:指国家知识产权局受理一件专利申请时给予该专利申请的一个标示号码。唯一性原则。
申请日:提出专利申请之日。
2022-06-08
申请公布
申请公布指发明专利申请经初步审查合格后,自申请日(或优先权日)起18个月期满时的公布或根据申请人的请求提前进行的公布。
申请公布号:专利申请过程中,在尚未取得专利授权之前,国家专利局《专利公报》公开专利时的编号。
申请公布日:申请公开的日期,即在专利公报上予以公开的日期。
2022-09-30
授权
授权指对发明专利申请经实质审查没有发现驳回理由,授予发明专利权;或对实用新型或外观设计专利申请经初步审查没有发现驳回理由,授予实用新型专利权或外观设计专利权。
预估到期
发明专利权的期限为二十年,实用新型专利权期限为十年,外观设计专利权期限为十五年,均自申请日起计算。专利届满后法律终止保护。
2042-06-08
基本信息
有效性 实质审查 专利类型 发明专利
申请号 CN202210639228.X 申请日 2022-06-08
公开/公告号 CN115047763A 公开/公告日 2022-09-13
授权日 预估到期日 2042-06-08
申请年 2022年 公开/公告年 2022年
缴费截止日
分类号 G05B13/04 主分类号 G05B13/04
是否联合申请 独立申请 文献类型号 A
独权数量 1 从权数量 0
权利要求数量 1 非专利引证数量 0
引用专利数量 0 被引证专利数量 0
非专利引证
引用专利 被引证专利
专利权维持 99 专利申请国编码 CN
专利事件 事务标签 公开、实质审查
申请人信息
申请人 第一申请人
专利权人 江南大学 当前专利权人 江南大学
发明人 陶洪峰、周晨辉、庄志和、巩朝阳 第一发明人 陶洪峰
地址 江苏省无锡市梁溪区通沙路898号南楼七层 邮编 214100
申请人数量 1 发明人数量 4
申请人所在省 江苏省 申请人所在市 江苏省无锡市
代理人信息
代理机构
专利代理机构是经省专利管理局审核,国家知识产权局批准设立,可以接受委托人的委托,在委托权限范围内以委托人的名义办理专利申请或其他专利事务的服务机构。
无锡华源专利商标事务所 代理人
专利代理师是代理他人进行专利申请和办理其他专利事务,取得一定资格的人。
过顾佳
摘要
本发明公开了一种多无人机系统的最小能量控制方法,涉及直流电动机优化控制领域,该方法包括:基于提升技术将重复运行的多无人机系统转换为时间序列的输入输出矩阵模型,分别设计集中式与分布式点对点迭代学习控制方法。选取M个跟踪时间点作为变量,提出点对点迭代学习控制的最小能量问题设计框架,并基于该框架设计了一种范数优化点对点迭代学习控制与坐标下降法结合的控制算法来解决这个优化问题。通过坐标下降方法改变跟踪时间点的分布从而减少系统能量损耗。
  • 摘要附图
    一种多无人机系统的最小能量控制方法
  • 说明书附图:图1
    一种多无人机系统的最小能量控制方法
  • 说明书附图:图2
    一种多无人机系统的最小能量控制方法
  • 说明书附图:图3
    一种多无人机系统的最小能量控制方法
  • 说明书附图:图4
    一种多无人机系统的最小能量控制方法
  • 说明书附图:图5
    一种多无人机系统的最小能量控制方法
  • 说明书附图:图6
    一种多无人机系统的最小能量控制方法
  • 说明书附图:图7
    一种多无人机系统的最小能量控制方法
  • 说明书附图:图8
    一种多无人机系统的最小能量控制方法
  • 说明书附图:图9
    一种多无人机系统的最小能量控制方法
  • 说明书附图:图10
    一种多无人机系统的最小能量控制方法
  • 说明书附图:图11
    一种多无人机系统的最小能量控制方法
  • 说明书附图:图12
    一种多无人机系统的最小能量控制方法
法律状态
序号 法律状态公告日 法律状态 法律状态信息
1 2022-09-30 实质审查的生效 IPC(主分类): G05B 13/04 专利申请号: 202210639228.X 申请日: 2022.06.08
2 2022-09-13 公开
权利要求
权利要求书是申请文件最核心的部分,是申请人向国家申请保护他的发明创造及划定保护范围的文件。
1.一种多无人机系统的最小能量控制方法,其特征在于,所述方法包括:
第一步、建立所述多无人机系统的动态模型:
所述动态模型采用传递函数表示,描述了单个无人机系统竖直方向的位移z和直流电动机输入电压Uz的转化关系,建立如式(1)所示的实际物理模型:
其中,s为复数,kn,ωn,ζ为根据实验数据所得的常数值;
因此,所述动态模型采用式(2)动力学方程表示:
其中,
第二步、构建所述多无人机系统的离散状态空间方程:
对于式(2)所示的连续系统模型,进行离散化处理,选取满足香农采样定理采样周期Ts,得到第i个(1≤i≤S)无人机系统的离散状态空间方程为:
式中t和k分别代表采样时间和批次,批次过程的运行周期为T;在每个重复过程周期内,对于时间点t∈[0,T]取N个采样点; 和 分别是第i个
无人机系统的离散状态空间系统在第k批次t时刻的输入、输出和状态向量,三者具有相同的维度;Ai,Bi,Ci为每个无人机线性离散系统的各个参数矩阵,且满足CiBi≠0,并且假设每个无人机系统在每个批次的初始状态一致,令xi,k(0)=0;
第三步、建立所述多无人机系统的提升模型:
针对式(3)形式的无人机线性离散系统,将其离散状态空间方程转换为时间序列的输入输出矩阵模型:
yi,k=Giui,k                (4)
其中:
T T T T
ui,k=[ui,k(0) ,ui,k(1) ,...,ui,k(N‑1) ]
T T T T
yi,k=[yi,k(1) ,yi,k(2) ,...,yi,k(N) ]
是时间序列上的输入输出传递矩阵;输入输出的内积及相关的诱导范数定
义为:
其中,v(τ)为输入Hilbert空间上的向量,权矩阵R和Q为适当维度的实正定矩阵;
定义所有无人机系统的输入、输出向量为:
第四步、提出点对点迭代学习控制设计框架:
选取在运行过程中的当前运行批次中的M个跟踪时间点,定义为ti,i=1,...,M,跟踪时间点分布定义为Γ:
T
Γ=[t1,t2,...,tM]∈Θ             (9)
其中:
p
点对点的参考轨迹r是从完整的参考轨迹r中提取的,表示为:
p T T T T
r=[r(t1) ,r(t2) ,...,r(tM) ]           (11)
第i个无人机点对点的输出信号 和跟踪误差 与式(11)有同样的表达式:
为了将一个信号转换为点对点形式,引入一个转换矩阵 为M行N列的分块矩
p
阵,使得r=Ψr, 当第m个采样时刻tm为关键跟踪时间点时,转换矩
阵第m行的所有N个元素除了n=t时为单位矩阵其余全是零矩阵,Ψ的表达式为:
其中,Ψmn为转换矩阵Ψ中的第m行第n列的元素;
基于式(4),推导出第i个无人机的提升模型为:
其中, 基于式(15),拓展到所述多无人机系统的提升模型为:
其中, 定义所有无人
机系统的点对点跟踪目标、点对点误差向量分别为:
p p T p T p T T
R=[(r) ,(r) ,...,(r) ]          (17)
第五步、建立所述多无人机系统的网络拓扑结构模型:
用图结构 来表示网络拓扑,节点的集合 边的集合
第i个无人机的邻接节点的集合 无人机之间的通信
情况用邻接矩阵 表示,其中:
顶点i的入度定义为 并且拉普拉斯矩阵定义为 其中
在所述多无人机系统的网络拓扑结构模型中,有限个数的无人机直接获取点对点的参p
考轨迹r ,其他无人机则通过邻接无人机获取跟踪信息;用对角矩阵P来表示第i无人机能否直接获取点对点的参考轨迹,它的元素pii表示为:
第六步、提出点对点迭代学习控制的最小能量问题设计框架:
选择控制能量作为目标代价函数:
其中,常数q3表示权重;
最小能量的设计目的是迭代地寻找一个输入信号Uk,相应的输出Yk,以及一个跟踪时间点分布Γk,满足:
* p * *
其中,Y表示准确地经过点对点的参考轨迹R,同时U,Γ是如下问题的优化解:
通过先优化输入信号U,再优化跟踪时间点分布Γ,将优化问题(23)分为两个优化问题:
*
其中,U (Γ)是优化问题(24)的解析解;由于目标代价函数(21)是凸函数,所以保证解*
析解U(Γ)是唯一的全局最优解;
第七步、设计所述多无人机系统的集中式点对点迭代学习最小能量控制算法:
考虑所述多无人机系统的拓扑通信结构、点对点跟踪误差及控制信号批次间变化,设计如下全局性能指标:
p 2 p 2 2
Jk+1(U)=q1||LE||+q2||PE||+q3||U‑Uk||           (26)
其中, 常数q1,q2表示权重;通过优化性能指标函数(26),得到集
中式的点对点迭代学习控制律为:
其中, IMS是维度为MS×MS的单位矩阵;
根据控制律(27),为了获取稳态控制输入,令k→∞,并且初始的输入信号U0=0,则:
为了解决优化问题(24),引入Language乘子λ,构造Language函数:
*
令U(Γ)为所述Language函数的全局最优解,则:
将 代入式(30),则:
当且仅当 不等式(31)成立,并且满足跟踪条件
则有:
由范数优化迭代学习控制律(27)生成的稳态控制输入U∞就是优化问题(24)的全局最*
优解U(Γ);
将优化问题(24)的全局最优解表达式(28)代入优化问题(25),则有:
由于集合Θ在离散系统中是有限的,令初始跟踪时间点分布为Γ0,所以优化问题(33)通过坐标下降法解决,表达式为:
其中, 表示坐标下降的次数;每个跟踪时间点经过函数 更
新:
其中 是如下优化问题的解:
*
基于式(34)生成的序列{h(Γj)},向下收敛到极限h;
p
给定线性离散时不变系统,初始跟踪时间点分布Γ0以及集合Θ,点对点的参考轨迹R ,选定权矩阵 和 趋近于零的常数ε>0和δ>0,则所述集中式点对点迭代学习最小能量控制算法设计包括:
初始跟踪时间点分布为Γ0时,执行范数优化迭代学习控制律(27)直到系统收敛,即*
记录稳态控制输入U(Γ0)以及初始控制能量
执行坐标下降法(34),令j→j+1;
令跟踪时间点分布Γ=Γj时,执行范数优化迭代学习控制律(27)直到系统收敛,即*
记录稳态控制输入U (Γj)以及相应的控制能量
重复所述执行坐标下降法(34),直到|h(Γj)‑h(Γj‑1)|<δ|h(Γj‑1)|;
*
记录最优跟踪时间点分布Γ以及相应的最小能量
第八步、设计所述多无人机系统的分布式点对点迭代学习控制算法:
利用ADMM实现对所述多无人机系统的分布式控制,式(26)等价于:
是第i个无人机的局部性能指标,定义为:
其中, 是将第i个无人机和邻接无人机的输入作为局部变量;
所述ADMM用于优化以下优化问题:
其中, 表示全局变量, 表示一个将全局变量映射到对应维度全局变
量的矩阵,全局变量的组成部分zi对应于局部变量 的组成部分 对于优化问题
(39),构造增广拉格朗日函数为:
所述ADMM采用三个步骤通过迭代求解,定义为:
其中,o∈[1,...,S], 表示局部变量 中ui出现的次数, 表示含有ui的局部变量的编号集合;所述ADMM的目的是通过迭代的方法,在第k+1批次优化局部变量 得到控制输入ui,以迫近于性能指标函数(26)的解析解,即集中式的控制律(27);
给定线性离散时不变系统,对角矩阵P和拉普拉斯矩阵L,各个无人机的点对点跟踪轨p
迹r ,权重q1,q2,q3,最大ILC迭代次数kmax,最大ADMM迭代次数υmax,步长ρ,设置初始ILC迭代次数k=0,初始ADMM迭代次数υ=0,初始计数i=0,则所述分布式点对点迭代学习控制算法设计包括:
设置i=i+1,分别执行优化步骤(41)(42)(43)最小化 直至i=S;
设置υ=υ+1,重复执行所述i=i+1,直至υ=υmax,从优化局部 变量中提取ui,k+1;
设置k=k+1,重复执行所述υ=υ+1,直至k=kmax;
获取每个无人机的最优输入
第九步、设计所述多无人机系统的分布式点对点迭代学习最小能量控制算法:
所述多无人机系统的最优控制,就是优化性能指标函数(26),直接获取解析解,即集中式的点对点迭代学习控制律(27);利用所述ADMM实现分布式控制,优化等价的性能指标函数(39),通过迭代的方式,迫近集中式的解析解;
在集中式控制中,由范数优化迭代学习控制律生成的稳态控制输入U∞就是优化问题*
(24)的全局最优解U(Γ);那么在分布式控制中,改写优化问题(24)和(25):
其中, 是优化问题(44)的解析解;当经过足够的ADMM迭代次数,则最终分布式迭代学习控制的稳态输入ui,∞就是优化问题(44)的全局最优解
优化问题(45)同样通过坐标下降法解决,表达式为:
其中 表示坐标下降的次数;每个跟踪时间点经过函数 更
新:
其中 是如下优化问题的解:
给定线性离散时不变系统,初始跟踪时间点分布Γ0以及集合Θ,对角矩阵P和拉普拉斯p
矩阵L,各个无人机的点对点跟踪轨迹r ,权重q1,q2,q3,最大ILC迭代次数kmax,最大ADMM迭代次数υmax,步长ρ,设置初始ILC迭代次数k=0,初始ADMM迭代次数υ=0,初始计数i=0,趋近于零的常数ε>0和δ>0,则所述分布式点对点迭代学习最小能量控制算法设计包括:
初始跟踪时间点分布为Γ0时,执行第八步中的所述分布式点对点迭代学习控制算法设计的步骤直到系统收敛,即 记录稳态控制输入 以及初始控制能量
执行坐标下降法(46),令j→j+1;
令跟踪时间点分布Γ=Γj时,执行第八步中的所述分布式点对点迭代学习控制算法设计的步骤直到系统收敛,即 记录稳态控制输入 以及相应的控制能

* * *
重复所述执行坐标下降法(46),直到|h(Γj)‑h(Γj‑1)|<δ|h(Γj‑1)|;
*
记录最优跟踪时间点分布Γ以及相应的最小能量
说明书

技术领域

[0001] 本发明涉及直流电动机优化控制领域,尤其是一种多无人机系统的最小能量控制方法。

背景技术

[0002] 直流电动机是一种将直流电转换为机械能的转动装置,具有变流装置简单、调速性能好、运行性能优良等特点,在工业制造领域中得到广泛的应用。
[0003] 针对执行重复运动任务的直流电动机,迭代学习控制具有良好的控制性能,迭代学习控制的原理是:使用之前批次的输入输出信息,不断修正当前批次的控制输入,从而在有限的时间能实现对期望轨迹的完全跟踪。然而在很多情况下,往往并不需要跟踪完整的轨迹,只需要在关键点处满足跟踪要求即可,这就是点对点跟踪问题。针对多无人机系统的一致性控制,满足上述点对点迭代学习控制跟踪特点,通过对控制律进行修正,从而保证每个无人机最终的状态相同,即最终实现相同的输出。点对点跟踪问题对于输出的要求不高,会给设计带来潜在优化的可能,比如减少系统能量的损耗。因此,在多无人机系统的点对点跟踪问题中,对最小能量控制方法设计的研究是很有意义的。

发明内容

[0004] 本发明人针对上述问题及技术需求,提出了一种多无人机系统的最小能量控制方法,在不考虑外界环境的影响,通过前馈设计的集中式范数优化点对点迭代学习控制律更加实用;以跟踪时间点为变量,通过集中式范数优化点对点迭代学习控制与坐标下降方法相结合,在满足跟踪要求的同时,实现最小能量的目的。但是集中式的控制方法会对中央控制器有很大的负担,并且响应速度较慢,于是采用ADMM(Alternating Direction Method of Multipliers,交替方向乘子算法)实现分布式的控制方法,即分布式范数优化点对点迭代学习控制;以跟踪时间点为变量,通过分布式范数优化点对点迭代学习控制与坐标下降方法相结合,在满足跟踪要求的同时,实现最小能量的目的。
[0005] 本发明的技术方案如下:
[0006] 一种多无人机系统的最小能量控制方法,包括如下步骤:
[0007] 第一步、建立多无人机系统的动态模型:
[0008] 动态模型采用传递函数表示,描述了单个无人机系统竖直方向的位移z和直流电动机输入电压Uz的转化关系。首先列写系统微分方程组;通过拉氏变换将微分方程组转换为等价的代数方程组,并根据代数方程组画出系统结构图;通过结构图简化,或消去代数方程组的中间变量,获得所需的输出量拉氏变换与输入量拉氏变换之比,即系统的传递函数。建立如式(1)所示的实际物理模型:
[0009]
[0010] 其中,s为复数,kn,ωn,ζ为根据实验数据所得的常数值,且分别取kn=775.3207,ωn=4.5994和ζ=0.7218。
[0011] 因此,动态模型可以采用式(2)动力学方程表示:
[0012]
[0013] 其中,
[0014] 第二步、构建多无人机系统的离散状态空间方程:
[0015] 对于式(2)所示的连续系统模型,进行离散化处理,选取满足香农采样定理采样周期Ts,得到第i个(1≤i≤S)无人机系统的离散状态空间方程为:
[0016]
[0017] 式中t和k分别代表采样时间和批次,批次过程的运行周期为T;在每个重复过程周期内,对于时间点t∈[0,T]取N个采样点; 和 分别是第i个无人机系统的离散状态空间系统在第k批次t时刻的输入、输出和状态向量,三者具有相同的维度;Ai,Bi,Ci为每个无人机线性离散系统的各个参数矩阵,且满足CiBi≠0,并且假设每个无人机系统在每个批次的初始状态一致,令xi,k(0)=0;
[0018] 第三步、建立多无人机系统的提升模型:
[0019] 针对式(3)形式的线性离散系统,将其离散状态空间方程转换为时间序列的输入输出矩阵模型:
[0020] yi,k=Giui,k   (4)
[0021] 其中:
[0022]
[0023] ui,k=[ui,k(0)T,ui,k(1)T,...,ui,k(N‑1)T]T
[0024] yi,k=[yi,k(1)T,yi,k(2)T,...,yi,k(N)T]T
[0025] 是时间序列上的输入输出传递矩阵;输入输出的内积及相关的诱导范数定义为:
[0026]
[0027]
[0028] 其中,v(τ)为输入Hilbert空间上的向量,权矩阵R和Q为适当维度的实正定矩阵。
[0029] 定义所有无人机系统的输入、输出向量:
[0030]
[0031]
[0032] 第四步、提出点对点迭代学习控制设计框架:
[0033] 选取在运行过程中的当前运行批次中的M个跟踪时间点,定义为ti,i=1,...,M,跟踪时间点分布定义为Γ:
[0034] Γ=[t1,t2,...,tM]T∈Θ   (9)
[0035] 其中:
[0036]
[0037] 点对点的参考轨迹rp是从完整的参考轨迹r中提取的,表示为:
[0038] rp=[r(t1)T,r(t2)T,...,r(tM)T]T   (11)
[0039] 第i个无人机点对点的输出信号 和跟踪误差 与式(11)有同样的表达式:
[0040]
[0041]
[0042] 为了将一个信号转换为其点对点形式,引入一个转换矩阵 为M行N列的p分块矩阵,使得r=Ψr, 当第m个采样时刻tm为关键跟踪时间点时,
转换矩阵第m行的所有N个元素除了n=t时为单位矩阵(l×l)其余全是零矩阵,Ψ的表达式为:
[0043]
[0044] 其中,Ψmn为转换矩阵Ψ中的第m行第n列的元素;
[0045] 基于式(4),推导出第i个无人机的提升模型为:
[0046]
[0047] 其中, 基于式(15),拓展到多无人机系统的提升模型为:
[0048]
[0049] 其中, 定义所有无人机系统的点对点跟踪目标、点对点误差向量分别为:
[0050] Rp=[(rp)T,(rp)T,...,(rp)T]T   (17)
[0051]
[0052] 第五步、建立多无人机系统的网络拓扑结构模型:
[0053] 用图结构 来表示网络拓扑,节点的集合 边的集合第i个无人机的邻接节点的集合 无人机之间的通信
情况用邻接矩阵 表示,其中:
[0054]
[0055] 在多无人机系统的网络拓扑结构模型中,只有有限个数的无人机可以直接获取点p对点的参考轨迹r ,其他无人机则通过邻接无人机获取跟踪信息。用对角矩阵P来表示第i无人机能否直接获取点对点的参考轨迹,它的元素pii表示为:
[0056]
[0057] 第六步、提出点对点迭代学习控制的最小能量问题设计框架:
[0058] 选择控制能量作为目标代价函数:
[0059]
[0060] 最小能量的设计目的是迭代地寻找一个输入信号Uk,相应的输出Yk,以及一个跟踪时间点分布Γk,满足:
[0061]
[0062] 其中,Y*表示准确地经过点对点的参考轨迹Rp,同时U*,Γ*是如下问题的优化解:
[0063]
[0064] 通过先优化输入信号U,再优化跟踪时间点分布Γ,将优化问题(23)分为两个优化问题:
[0065]
[0066]
[0067] 其中,U*(Γ)是优化问题(24)的解析解;由于目标代价函数(21)是凸函数,所以可*以保证解析解U(Γ)是唯一的全局最优解。
[0068] 第七步、设计多无人机系统的集中式点对点迭代学习最小能量控制算法:
[0069] 为了满足实际工业问题设计要求,此处考虑了多无人机系统的拓扑通信结构、点对点跟踪误差及控制信号批次间变化,设计如下全局性能指标:
[0070] Jk+1(U)=q1||LEp||2+q2||PEp||2+q3||U‑Uk||2   (26)
[0071] 其中, 数q1,q2,q3表示权重。通过优化这个性能指标函数(26),得到分布式的点对点迭代学习控制律为:
[0072]
[0073] 其中, IMS是维度为MS×MS的单位矩阵。
[0074] 根据控制律(27),为了获取稳态控制输入,令k→∞,并且初始的输入信号U0=0,则:
[0075]
[0076] 为了解决优化问题(24),引入Language乘子λ,构造Language函数:
[0077]
[0078] 令U*(Γ)为Language函数的全局最优解,则:
[0079]
[0080] 将 代入式(30),则:
[0081]
[0082] 当且仅当 不等式(31)成立,并且满足跟踪条件则有:
[0083]
[0084] 由范数优化迭代学习控制律生成的稳态控制输入U∞就是优化问题(24)的全局最*优解U(Γ);
[0085] 将优化问题(24)的全局最优解表达式(28)代入优化问题(25),则有:
[0086]
[0087] 由于集合Θ在离散系统中是有限的,令初始跟踪时间点分布为Γ0,所以优化问题(33)通过坐标下降法解决,表达式为:
[0088]
[0089] 其中 表示坐标下降的次数;每个跟踪时间点经过函数更新:
[0090]
[0091] 其中 是如下优化问题的解:
[0092]
[0093] 基于式(34)生成的序列{h(Γj)},向下收敛到极限h*;
[0094] 给定线性离散时不变系统,初始跟踪时间点分布Γ0以及集合Θ,点对点的参考轨p迹R ,选定权矩阵 和 趋近于零的常数ε>0和δ>0,则集中式点对点迭代学习最小能量控制算法设计包括:
[0095] 步骤7.1:初始跟踪时间点分布为Γ0时,执行范数优化迭代学习控制律(27)直到*系统收敛,即 记录稳态控制输入U(Γ0)以及初始控制能量
[0096] 步骤7.2:执行坐标下降法(34),令j→j+1;
[0097] 步骤7.3:令跟踪时间点分布Γ=Γj时,执行范数优化迭代学习控制律(27)直到*系统收敛,即 记录稳态控制输入U (Γj)以及相应的控制能量
[0098] 步骤7.4:重复执行步骤7.2和步骤7.3,直到|h(Γj)‑h(Γj‑1)|<δ|h(Γj‑1)|;
[0099] 步骤7.5:记录最优跟踪时间点分布Γ*以及相应的最小能量
[0100] 第八步、设计多无人机系统的分布式点对点迭代学习控制算法:
[0101] 利用ADMM实现对多无人机系统的分布式控制,式(26)等价于:
[0102]
[0103] 是第i个无人机的局部性能指标,定义为:
[0104]
[0105] 其中, 是将第i个无人机和邻接无人机的输入作为局部变量。
[0106] 比如说 则
[0107] ADMM用于优化以下优化问题:
[0108]
[0109] 其中, 是局部变量, 表示全局变量, 表示一个将全局变量映射到对应维度全局变量的矩阵,全局变量的组成部分zi对应于局部变量 的组成部分对于优化问题(39),构造增广拉格朗日函数为:
[0110]
[0111] ADMM采用三个步骤通过迭代求解,定义为:
[0112]
[0113]
[0114]
[0115] 其中,o∈[1,...,S], 表示局部变量 中ui出现的次数, 表示含有ui的局部变量 的编号集合。ADMM的目的就是通过迭代的方法,在第k+1批次优化局部变量 得到控制输入ui,以迫近于性能指标函数(26)的解析解,即集中式的控制律(27)。
[0116] 给定线性离散时不变系统,对角矩阵P和拉普拉斯矩阵L,各个无人机的点对点跟p踪轨迹r ,权重参数q1,q2,q3,最大ILC迭代次数kmax,最大ADMM迭代次数υmax,步长ρ,设置初始ILC迭代次数k=0,初始ADMM迭代次数υ=0,初始计数i=0,则分布式点对点迭代学习控制算法设计包括:
[0117] 步骤8.1:设置i=i+1,分别执行优化步骤(41)(42)(43)最小化 直至i=S;
[0118] 步骤8.2:设置υ=υ+1,重复执行步骤8.1,直至υ=υmax,从优化局部 变量中提取ui,k+1;
[0119] 步骤8.3:设置k=k+1,重复执行步骤8.2,直至k=kmax;
[0120] 步骤8.4:获取每个无人机的最优输入ui,kmax;
[0121] 第九步、设计多无人机系统的分布式点对点迭代学习最小能量控制算法:
[0122] 多无人机系统的最优控制,就是优化性能指标函数(26),可以直接获取解析解,即集中式控制律(27)。利用ADMM实现分布式控制,优化等价的性能指标函数(39),通过迭代的方式,迫近集中式的解析解。
[0123] 在集中式控制中,由范数优化迭代学习控制律生成的稳态控制输入U∞就是优化问*题(24)的全局最优解U(Γ)。那么在分布式控制中,改写优化问题(24)和(25):
[0124]
[0125]
[0126] 其中, 是优化问题(44)的解析解。可以得到,只要经过足够的ADMM迭代次数,则最终分布式迭代学习控制的稳态输入ui,∞就是优化问题(44)的全局最优解[0127] 优化问题(45)同样通过坐标下降法解决,表达式为:
[0128]
[0129] 其中 表示坐标下降的次数;每个跟踪时间点经过函数更新:
[0130]
[0131] 其中 是如下优化问题的解:
[0132]
[0133] 给定线性离散时不变系统,初始跟踪时间点分布Γ0以及集合Θ,对角矩阵P和拉p普拉斯矩阵L,各个无人机的点对点跟踪轨迹r ,权重参数q1,q2,q3,最大ILC迭代次数kmax,最大ADMM迭代次数υmax,步长ρ,设置初始ILC迭代次数k=0,初始ADMM迭代次数υ=0,初始计数i=0,趋近于零的常数ε>0和δ>0,则分布式点对点迭代学习最小能量控制算法设计包括:
[0134] 步骤9.1:初始跟踪时间点分布为Γ0时,执行分布式点对点迭代学习控制算法步骤8.1到步骤8.4直到系统收敛,即 记录稳态控制输入 以及初始控制能量
[0135] 步骤9.2:执行坐标下降法(46),令j→j+1;
[0136] 步骤9.3:令跟踪时间点分布Γ=Γj时,执行分布式点对点迭代学习控制算法步骤8.1到步骤8.4直到系统收敛,即 记录稳态控制输入 以及相应的控制能量
[0137] 步骤9.4:重复执行步骤9.2和步骤9.3,直到|h*(Γj)‑h*(Γj‑1)|<δ|h*(Γj‑1)|;
[0138] 步骤9.5:记录最优跟踪时间点分布Γ*以及相应的最小能量
[0139] 本发明的有益技术效果是:
[0140] 本申请公开了针对具有重复运动特征和线性化模型的多无人机系统,将该多无人机系统作为被控对象,分别提出集中式与分布式控制方法,并且针对点对点跟踪任务中能量损耗问题,将范数优化点对点迭代学习控制与坐标下降方法相结合,提出了点对点迭代学习控制的最小能量问题设计框架,并在该框架下设计可实现的迭代学习控制算法,通过坐标下降方法改变跟踪时间点的分布从而减少系统能量损耗。

实施方案

[0153] 下面结合附图对本发明的具体实施方式做进一步说明。
[0154] 如图1所示,是多无人机系统的网络拓扑结构模型,以四个无人机构成多无人机系统为例说明,箭头表示信息传输方向,从而得到参数如下:
[0155]
[0156]
[0157] 如图2所示,第k批次的控制输入信号为Uk,将其作用于多无人机系统得到第k批次系统的输出信号Yk。针对点对点跟踪问题,将存储在跟踪时间点分布存储器中第j批次的Γj作用于转换模块,通过转换模块将输出信号Yk转换成其点对点输出信号 之后,将点对点p输出信号 与存储在点对点期望轨迹存储器的设定期望值R进行比较,得到点对点跟踪误差 若误差精度没有达到所设定的精度,则将点对点跟踪误差 与当前控制器输入Uk传递到范数优化迭代学习控制器生成下一批次的控制器输入Uk+1,如此循环运行直至系统实际输出与期望值之间的误差达到精度要求,则停止ILC迭代,此时的控制器输入即为最优控*
制输入U (Γj)。若最优控制输入没有达到所设定的要求|h(Γj)‑h(Γj‑1)|<δ|h(Γj‑1)|,则*
将最优控制输入U (Γj)与当前跟踪时间点分布存储器中的Γj作用于坐标下降法生成下一批次的跟踪时间点分布Γj+1,如此循环运行直至满足精度要求,则停止坐标迭代,此时的跟*
踪时间点分布存储器中是最优跟踪时间点分布Γ,以及相应的最小输入能量
[0158] 如图3所示,多无人机系统局部变量 与全局变量zi之间的映射关系图,其中局部性能指标优化函数的形式是图1多无人机系统的网络拓扑结构模型决定。
[0159] 如图4所示,多无人机系统实现分布式控制时的系统框图,和图1相对应,每个圈表示优化的局部变量,和图3相对应。并且每个无人机具有相同的动力学方程,取传递函数的参数值为kn=775.3207,ωn=4.5994和ζ=0.7218。可以得到每个无人机的状态空间表达式为:
[0160]
[0161] 系统仿真时间设定为T=10s,采样时间设定为Ts=0.1s,则系统的离散状态空间方程的参数矩阵分别为:
[0162]
[0163] C=[1 0 0].
[0164] 在多无人机系统运行过程中,需要系统的在竖直方向的位移处于几个关键位置。因此,本例选取5个关键跟踪时间点,点对点期望轨迹设置为:
[0165] rp=[5 4 ‑4 ‑6 3]T,
[0166] 初始跟踪时间点分布设置为:
[0167] Γ0=[5 25 45 65 85]T。
[0168] 选取权重参数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时,分布式控制产生的误差曲线与集中式控制产生的误差曲线相重合。
[0169] 将范数优化迭代学习控制结合坐标下降法,实现减小能量损耗的目的,这就是最小能量控制方法。图9和图10分别示出了多无人机系统跟踪时间点变化图与输入能量变化* T图,跟踪时间点分布存储器中的最优跟踪时间分布为Γ=[21265362100] ,以及相应的最小输入能量为 图11示出了多无人机系统在初始跟踪时间点分布Γ0与
最终跟踪时间点分布Γ50处的实际输入曲线图,可以直观地看出在最终跟踪时间点分布处的输入能量小于在初始跟踪时间点分布处的输入能量。图12示出了多无人机系统在初始跟踪时间点分布Γ0与最终跟踪时间点分布Γ50处的实际输出曲线图,系统的输出满足点对点跟踪任务。
[0170] 以上所述的仅是本申请的优选实施方式,本发明不限于以上实施例。可以理解,本领域技术人员在不脱离本发明的精神和构思的前提下直接导出或联想到的其他改进和变化,均应认为包含在本发明的保护范围之内。

附图说明

[0141] 图1是本申请提供的多无人机系统的网络拓扑结构模型。
[0142] 图2是本申请提供的多无人机系统的集中式范数优化点对点最小能量控制方法的流程框图。
[0143] 图3是本申请提供的多无人机系统局部变量与全局变量之间的映射关系图。
[0144] 图4是本申请提供的多无人机系统实现分布式控制时的系统框图。
[0145] 图5是本申请提供的多无人机系统在第1批次时系统的输出曲线图。
[0146] 图6是本申请提供的多无人机系统在第9批次时系统的输出曲线图。
[0147] 图7是本申请提供的多无人机系统在第30批次时系统的输出曲线图。
[0148] 图8是本申请提供的多无人机系统集中式与分布式控制的误差曲线图。
[0149] 图9是本申请提供的多无人机系统跟踪时间点变化图。
[0150] 图10是本申请提供的多无人机系统输入能量变化图。
[0151] 图11是本申请提供的多无人机系统在初始跟踪时间点分布与最终跟踪时间点分布处的实际输入曲线图。
[0152] 图12是本申请提供的多无人机系统在初始跟踪时间点分布与最终跟踪时间点分布处的实际输出曲线图。
版权所有:盲专网 ©2023 zlpt.xyz  蜀ICP备2023003576号