[发明专利]一种无人机和无人车组成的异构多智能体系统编队控制中执行器故障的自适应补偿方法有效
申请号: | 202110256086.4 | 申请日: | 2021-03-09 |
公开(公告)号: | CN112947086B | 公开(公告)日: | 2022-10-04 |
发明(设计)人: | 马亚杰;王娟;姜斌;冒泽慧;陆宁云 | 申请(专利权)人: | 南京航空航天大学 |
主分类号: | G05B13/04 | 分类号: | G05B13/04 |
代理公司: | 南京经纬专利商标代理有限公司 32200 | 代理人: | 楼然 |
地址: | 210016 江*** | 国省代码: | 江苏;32 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 无人机 无人 车组 异构多 智能 体系 统编 控制 执行 故障 自适应 补偿 方法 | ||
1.一种无人机和无人车组成的异构多智能体系统编队控制中执行器故障的自适应补偿方法,其特征在于,包括如下步骤:
步骤1、多智能体系统包括由M个无人车和(N-M)个无人机,无人车模型采用两轮移动机器人,无人机模型采用四旋翼无人机,分别对其建模并简化,得到二阶无人车模型和二阶无人机模型;
步骤2、考虑多智能体系统发生执行器部分失效故障,分别对发生故障后的无人地面车辆和无人机位置子系统的XOY平面模型以及无人机位置子系统的Z轴模型建模,同时实现无人机-无人车编队控制;
步骤3、确定多智能体系统通信拓扑为强连通图;
步骤4、针对发生执行器故障的无人地面车辆和无人机位置子系统的XOY平面模型,利用backstepping法,设计在自适应律更新故障估计参数下的控制律,实现编队控制;
步骤5、针对发生执行器故障的四旋翼无人机Z轴模型,利用backstepping法,设计在自适应律更新故障估计参数下的控制律,实现一致性;
在所述的步骤1中,假设每个无人车的方向已固定且相同,即χi(t)=χ;则角速度ωi(t)=0;简化后的第i个两轮移动机器人模型的动力学方程为:
其中,表示前端点的坐标,Ldi是手部点和两个车轮中间点之间的距离,Fi(t),τi(t)为输入力和输入力矩,Mgi,Jgi分别表示第i个无人车的质量及转动惯量;
因四旋翼无人机的模型比较复杂,存在耦合问题,如考虑扰动,模型将变得更加复杂;在此忽略风扰动,同时假设每个无人机的姿态已固定且相同,即φi(t)=φ,θi(t)=θ,ψi(t)=ψ;则第i个无人机模型的动力学方程为:
其中,pi(t)=[pxi(t),pyi(t),pzi(t)]T表示位置状态,Mai表示第i个无人机的质量,表示控制输入;
同时,考虑实现无人机和无人地面车辆XOY二维模型的协同编队控制,并单独对无人机Z轴模型进行控制。
2.根据权利要求1所述的一种无人机和无人车组成的异构多智能体系统编队控制中执行器故障的自适应补偿方法,其特征在于,在步骤2中,考虑在乘性执行器故障的情况下,简化了的无人地面车辆和无人机位置子系统的XOY平面模型可用以下二阶系统表示:
其中,xi(t)∈R2,vi(t)∈R2,ui(t)∈R2分别表示位置信息,速度信息以及控制输入,0<ρi≤1;
简化后的无人机位置子系统的Z轴模型在发生执行器乘性故障时可用以下二阶系统表示:
其中,xi(t)∈R,vi(t)∈R,ui(t)∈R分别表示位置信息,速度信息以及控制输入;0<ρi≤1;
期望的时变编队为其中hi(t)=[hxi(t),hvi(t)]T;如果如下的两个等式能够成立,则可以认为多智能体系统实现了编队控制:
3.根据权利要求1所述的一种无人机和无人车组成的异构多智能体系统编队控制中执行器故障的自适应补偿方法,其特征在于,在步骤3中,考虑多智能体通信拓扑为以下性质的强连通图:
1)强连通图的拉普拉斯矩阵L有一个特征值为0,其余特征值的实部均为正;
2)可以找到一个正定向量满足其中
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于南京航空航天大学,未经南京航空航天大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202110256086.4/1.html,转载请声明来源钻瓜专利网。
- 上一篇:一种农业种植用农作物施肥装置
- 下一篇:一种具有折叠功能的扩展坞