[发明专利]一种绳系多无人机协同操作系统的预设时间控制方法

说明书

本发明公开了一种绳系多无人机协同操作系统的预设时间控制方法。首先基于Udwadia‑Kalaba方程，建立绳系多无人机协同操作系统的非线性耦合动力学模型；然后基于拉力优化分配的规划无人机航迹；接下来基于固定时间收敛定理设计固定时间非奇异终端滑模面；最后基于滑模面，设计预设时间协同跟踪控制律。本发明方法能够解决绳系多无人机协同操作系统的鲁棒快速稳定控制问题，并能够解决具有快速收敛性能要求的控制问题。

技术领域

本发明属于机器人领域，具体涉及一种无人机控制方法。

背景技术

旋翼无人机因为其强机动性、垂直起飞降落以及成本低廉等特性，受到国内外科研工作者的广泛研究。旋翼无人机已经成功应用于商业表演、影视拍摄、安保监视、国防军事等领域，在货物运输、灾害救援等领域的应用研究也取得了显著的成果。近年来，受直升机系绳悬挂式救援、物资运输等操作，绳驱并联机器人等应用的启发，以及旋翼无人机技术的成熟，绳系多无人机协同操作系统应运而生。绳系多无人机协同操作系统具有广阔的应用前景，比如城市高楼火灾救援，物资定点投放，搜救，环境监视，矿产资源勘探等。绳系多无人机协同操作系统由无人机、系绳、悬挂重物三部分组成，其中无人机和悬挂重物通过系绳互相连接。因此，绳系多无人机协同操作系统是一种高度非线性、强耦合以及双重欠驱动系统，实现其快速稳定控制具有理论和实际意义。

绳系多无人机协同操作系统的参数几何构型设计、旋量可行工作空间分析、运动规划以及动力学控制方面受到一定研究并取得了一些进展。在动力学控制方面，主要有两种设计思路：1)、根据绳系多无人机协同操作系统的运动学或者利用哈密顿原理得到协同操作系统广义坐标(包含悬挂载荷的位姿状态)与无人机升力之间的动力学关系，实现悬挂载荷的主动位姿控制；2)、将悬挂载荷通过系绳对无人机产生的拉力视为对无人机的外界扰动，通过主动控制无人机的位姿，实现悬挂载荷位姿的间接控制。第一种设计思路需要测量悬挂载荷的位姿以及系绳的姿态角，且设计的控制律是集中式的，基于该方法绳系多无人机协同操作系统在室外应用不现实。第二种设计思路忽视了绳系多无人机协同操作系统的强耦合性以及欠驱动特性，不能有效抑制悬挂载荷的振动。并且，现有关于绳系多无人机协同操作系统的控制普遍采用渐进收敛方法。绳系多无人机协同操作系统往往要求在预定时间内完成操作任务，且由于系绳单向力特性导致悬挂载荷控制鲁棒性低。

发明内容

为了克服现有技术的不足，本发明提供了一种绳系多无人机协同操作系统的预设时间控制方法。首先基于Udwadia-Kalaba方程，建立绳系多无人机协同操作系统的非线性耦合动力学模型；然后基于拉力优化分配的规划无人机航迹；接下来基于固定时间收敛定理设计固定时间非奇异终端滑模面；最后基于滑模面，设计预设时间协同跟踪控制律。本发明方法能够解决绳系多无人机协同操作系统的鲁棒快速稳定控制问题，并能够解决具有快速收敛性能要求的控制问题。

本发明解决其技术问题所采用的技术方案包括以下步骤：

步骤1：基于Udwadia-Kalaba方程，建立绳系多无人机协同操作系统的非线性耦合动力学模型；

建立OXYZ地面惯性系，OX轴指向东，OZ轴竖直向上，OY轴与其他两个轴满足右手螺旋定理；建立o_ix_iy_iz_i为i^th无人机本体坐标系，设定原点o_i位于i^th无人机质心处，o_ix_i轴沿无人机运动方向，o_iz_i轴垂直于无人竖直向上，o_iy_i轴与其他两个轴满足右手螺旋定理；

假定：1)、飞行阶段系绳处于张紧状态；2)、系统惯性参数变化忽略不计；3)、系绳质量忽略不计且不可拉伸；4)、悬挂载荷为质点；5)、系绳连接在无人机的质心处；

根据牛顿-欧拉法，得到系统中悬挂载荷的动力学模型如式(1)所示：