一种绳系多无人机协同操作系统的预设时间控制方法与流程

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


背景技术：

[0002]
旋翼无人机因为其强机动性、垂直起飞降落以及成本低廉等特性，受到国内外科研工作者的广泛研究。旋翼无人机已经成功应用于商业表演、影视拍摄、安保监视、国防军事等领域，在货物运输、灾害救援等领域的应用研究也取得了显著的成果。近年来，受直升机系绳悬挂式救援、物资运输等操作，绳驱并联机器人等应用的启发，以及旋翼无人机技术的成熟，绳系多无人机协同操作系统应运而生。绳系多无人机协同操作系统具有广阔的应用前景，比如城市高楼火灾救援，物资定点投放，搜救，环境监视，矿产资源勘探等。绳系多无人机协同操作系统由无人机、系绳、悬挂重物三部分组成，其中无人机和悬挂重物通过系绳互相连接。因此，绳系多无人机协同操作系统是一种高度非线性、强耦合以及双重欠驱动系统，实现其快速稳定控制具有理论和实际意义。
[0003]
绳系多无人机协同操作系统的参数几何构型设计、旋量可行工作空间分析、运动规划以及动力学控制方面受到一定研究并取得了一些进展。在动力学控制方面，主要有两种设计思路：1)、根据绳系多无人机协同操作系统的运动学或者利用哈密顿原理得到协同操作系统广义坐标(包含悬挂载荷的位姿状态)与无人机升力之间的动力学关系，实现悬挂载荷的主动位姿控制；2)、将悬挂载荷通过系绳对无人机产生的拉力视为对无人机的外界扰动，通过主动控制无人机的位姿，实现悬挂载荷位姿的间接控制。第一种设计思路需要测量悬挂载荷的位姿以及系绳的姿态角，且设计的控制律是集中式的，基于该方法绳系多无人机协同操作系统在室外应用不现实。第二种设计思路忽视了绳系多无人机协同操作系统的强耦合性以及欠驱动特性，不能有效抑制悬挂载荷的振动。并且，现有关于绳系多无人机协同操作系统的控制普遍采用渐进收敛方法。绳系多无人机协同操作系统往往要求在预定时间内完成操作任务，且由于系绳单向力特性导致悬挂载荷控制鲁棒性低。


技术实现要素：

[0004]
为了克服现有技术的不足，本发明提供了一种绳系多无人机协同操作系统的预设时间控制方法。首先基于udwadia-kalaba方程，建立绳系多无人机协同操作系统的非线性耦合动力学模型；然后基于拉力优化分配的规划无人机航迹；接下来基于固定时间收敛定理设计固定时间非奇异终端滑模面；最后基于滑模面，设计预设时间协同跟踪控制律。本发明方法能够解决绳系多无人机协同操作系统的鲁棒快速稳定控制问题，并能够解决具有快速收敛性能要求的控制问题。
[0005]
本发明解决其技术问题所采用的技术方案包括以下步骤：
[0006]
步骤1：基于udwadia-kalaba方程，建立绳系多无人机协同操作系统的非线性耦合动力学模型；
[0007]
建立oxyz地面惯性系，ox轴指向东，oz轴竖直向上，oy轴与其他两个轴满足右手螺
旋定理；建立o
i
x
i
y
i
z
i
为i
th
无人机本体坐标系，设定原点o
i
位于i
th
无人机质心处，o
i
x
i
轴沿无人机运动方向，o
i
z
i
轴垂直于无人竖直向上，o
i
y
i
轴与其他两个轴满足右手螺旋定理；
[0008]
假定：1)、飞行阶段系绳处于张紧状态；2)、系统惯性参数变化忽略不计；3)、系绳质量忽略不计且不可拉伸；4)、悬挂载荷为质点；5)、系绳连接在无人机的质心处；
[0009]
根据牛顿-欧拉法，得到系统中悬挂载荷的动力学模型如式(1)所示：
[0010][0011]
其中，m
l
为悬挂载荷的质量，r
l
为悬挂载荷在地面惯性系oxyz下的位置，为r
l
的二阶导数，g为重力加速度，e3为oz轴方向的单位向量，t
i
为系绳i的拉力，ξ
i
为沿悬挂载荷到原点o
i
的系绳i的方向向量，n为无人机数量；
[0012]
根据牛顿-欧拉法，得到系统中i
th
无人机的动力学模型如下所示：
[0013][0014]
其中，m
i
为无人机i的质量，r
i
为无人机i在惯性系oxyz下的位置，为r
i
的二阶导数，f
i
为无人机的升力，r
i
为无人机本体系o
i
x
i
y
i
z
i
到惯性系oxyz的旋转矩阵；
[0015]
r
i
矩阵表达如下：
[0016][0017]
其中，s和c分别是正弦函数sin和余弦函数cos的简写；φ
i
，θ
i
和ψ
i
分别是无人机i的滚转角、俯仰角和偏航角；
[0018]
系绳连接在无人机的质心处，因此无人机的转动动力学在整个系统中处于解耦状态；i
th
无人机的转动动力学方程为：
[0019][0020]
其中，和分别是φ
i
、θ
i
和ψ
i
的一阶导数，和分别是φ
i
、θ
i
和ψ
i
的二阶导数，l
i
是电机中心到i
th
无人机本体系o
i
x
i
y
i
z
i
原点之间的距离，u
2i
，u
3i
和u
4i
分别是无人机姿态控制三个方向的输入，i
xi
、i
yi
和i
zi
分别是无人机沿本体系三个方向轴的转动惯量；
[0021]
无人机的跟踪控制采用内外环的双环控制模式，外环为位置控制环，使无人机实现对期望轨迹的跟踪，并且产生内环的期望姿态信号；内环为姿态控制环，实现外环期望的升力指向；根据式(2)和式(3)，得到内环跟踪指令：
[0022][0023]
其中，f
i,d
、φ
i,d
、θ
i,d
和ψ
i,d
分别是f
i
、φ
i
、θ
i
和ψ
i
的期望值；u
i
＝f
i
r
i
e3＝[u
xi
；u
yi
；u
zi
]；
[0024]
对于一个绳系多无人机协同操作系统，所有无人机通过系绳与一个共同的悬挂载荷相连；因此，式(1)和(2)中的系绳拉力t
i
ξ
i
是一个与无人机和悬挂载荷运动参数都相关的高度非线性动态函数；利用udwadia-kalaba方程计算总的系绳拉力为：
[0025][0026]
其中，m＝diag[m1,
…
,m
n
,m
l
]，π＝[π1；
…
；π
n
]，r
l,i
＝r
i-r
l
，是r
l,i
的转置；(*)
+
表示moore-penrose伪逆；是r
l,i
的一阶导数，是的转置；符号表示直积运算；
[0027]
由于仿真数值积分运算存在累积误差，导致系绳长度存在漂移现象，即：
[0028][0029]
其中，l
i
表示i
th
系绳的长度；
[0030]
定义采用状态反馈方法，解决系绳长度漂移问题：
[0031][0032]
其中，和分别是r
li
的二阶和一阶导数，α和β是补偿反馈增益；
[0033]
因此，总的系绳拉力式(6)进一步改进为：
[0034][0035]
步骤2：基于拉力优化分配的无人机航迹规划；
[0036]
对于绳系多无人机协同操作系统，假设悬挂载荷期望轨迹为r
ld
；通过系绳拉力优化分配以及系统运动学关系求取无人机的期望轨迹，实现悬挂载荷跟踪期望轨迹；
[0037]
根据式(1)，悬挂载荷跟踪期望轨迹的期望旋量为：
[0038][0039]
系统运动学关系为：
[0040]
r
i
＝r
l
+l
i
ξ
i
ꢀꢀꢀ
(11)
[0041]
根据运动学关系式(11)知，求得系绳方向向量，就能得到无人机的期望轨迹；对于式(10)来说，当不共面的张紧系绳不少于3根时，悬挂载荷的位置控制通过调节系绳拉力来实现，且式(10)的解不唯一；通过优化的方法来求系绳的拉力，使得拉力最小且满足约束，
同时避免无人机之间的碰撞；拉力优化问题归纳为：
[0042][0043]
其中，‖*‖表示向量的二范数，φ表示系绳之间避碰允许的最小夹角，t
i,max
和t
i,min
分别是系绳允许的最大和最小拉力，利用序列最小二次规划求解上面的优化问题，得到t
i
ξ
i
，i＝1,
…
,n；因此，无人机的期望轨迹为：
[0044][0045]
其中，r
id
为i
th
无人机的期望轨迹；
[0046]
步骤3：基于固定时间收敛定理设计固定时间非奇异终端滑模面；
[0047]
根据步骤1中无人机的动力学模型(2)，得到无人机的位置跟踪误差动力学模型：
[0048][0049]
其中，是e
i
的二阶导数，是r
id
的二阶导数，e
i
＝r
i-r
id
；
[0050]
根据无人机位置跟踪误差动力学模型(14)，设计一个固定时间非奇异终端滑模面s
i
：
[0051][0052]
其中，是e
i
的一阶导数，m和n是正奇数，满足关系π是圆周率，t
s
是正常数，diag(e
i
)是以向量e
i
的元素为对角元的对角矩阵，cosh(*)表示双曲余弦函数；
[0053]
步骤4：基于步骤3设计的滑模面，设计预设时间协同跟踪控制律；
[0054]
基于步骤3中设计的固定时间非奇异终端滑模面s
i
，设计预设时间协同跟踪控制律u
i
如下：
[0055][0056]
其中，t
r
是正常数；sinh(*)表示双曲正弦函数；θ和是正奇数，满足关系r表示无人机位置状态的维数；k
i
是一个正常数；sign(*)表示符号函数；
[0057]
非线性函数ξ
τ
定义为：
[0058][0059]
其中，τ是一个正常数；|x|表示x的绝对值；
[0060]
基于lyapunov稳定性理论证明无人机在固定时间内实现期望轨迹的跟踪，收敛时间估计如下：
[0061][0062]
其中，是一个关于τ的函数，当τ取很小时，趋近于0；考虑到式(18)中收敛时间t的估计存在保守性，因此收敛时间的上界估计为2t
s
/π+t
r
。
[0063]
本发明提出了一种绳系多无人机协同操作系统的预设时间控制方法，带来了如下有益效果：
[0064]
1、本发明能够解决绳系多无人机协同操作系统的鲁棒快速稳定控制问题。
[0065]
2、本发明能够解决具有快速收敛性能要求的控制问题。
附图说明
[0066]
图1是本发明为绳系多无人机协同操作系统示意图。
具体实施方式
[0067]
下面结合附图和实施例对本发明进一步说明。
[0068]
针对强非线性、强耦合的绳系多无人机协同操作系统具有快速收敛性能要求的稳定跟踪控制问题，设计了一种绳系多无人机协同操作系统的预设时间控制方法，包括以下步骤：
[0069]
步骤1：基于udwadia-kalaba方程，建立绳系多无人机协同操作系统的非线性耦合动力学模型；
[0070]
如图1所示，建立oxyz地面惯性系，ox轴指向东，oz轴竖直向上，oy轴与其他两个轴满足右手螺旋定理；建立o
i
x
i
y
i
z
i
为i
th
无人机本体坐标系，设定原点o
i
位于i
th
无人机质心处，o
i
x
i
轴沿无人机运动方向，o
i
z
i
轴垂直于无人竖直向上，o
i
y
i
轴与其他两个轴满足右手螺旋定理；
[0071]
假定：1)、飞行阶段系绳处于张紧状态；2)、系统惯性参数变化忽略不计；3)、系绳质量忽略不计且不可拉伸；4)、悬挂载荷为质点；5)、系绳连接在无人机的质心处；
[0072]
根据牛顿-欧拉法，得到系统中悬挂载荷的动力学模型如式(1)所示：
[0073][0074]
其中，m
l
为悬挂载荷的质量，r
l
为悬挂载荷在地面惯性系oxyz下的位置，为r
l
的二阶导数，g为重力加速度，e3为oz轴方向的单位向量，t
i
为系绳i的拉力，ξ
i
为沿悬挂载荷到原点o
i
的系绳i的方向向量，n为无人机数量；
[0075]
根据牛顿-欧拉法，得到系统中i
th
无人机的动力学模型如下所示：
[0076][0077]
其中，m
i
为无人机i的质量，r
i
为无人机i在惯性系oxyz下的位置，为r
i
的二阶导数，f
i
为无人机的升力，r
i
为无人机本体系o
i
x
i
y
i
z
i
到惯性系oxyz的旋转矩阵；
[0078]
r
i
矩阵表达如下：
[0079][0080]
其中，s和c分别是正弦函数sin和余弦函数cos的简写；φ
i
，θ
i
和ψ
i
分别是无人机i的滚转角、俯仰角和偏航角；
[0081]
系绳连接在无人机的质心处，因此无人机的转动动力学在整个系统中处于解耦状态；i
th
无人机的转动动力学方程为：
[0082][0083]
其中，和分别是φ
i
、θ
i
和ψ
i
的一阶导数，和分别是φ
i
、θ
i
和ψ
i
的二阶导数，l
i
是电机中心到i
th
无人机本体系o
i
x
i
y
i
z
i
原点之间的距离，u
2i
，u
3i
和u
4i
分别是无人机姿态控制三个方向的输入，i
xi
、i
yi
和i
zi
分别是无人机沿本体系三个方向轴的转动惯量；
[0084]
无人机的跟踪控制采用内外环的双环控制模式，外环为位置控制环，使无人机实现对期望轨迹的跟踪，并且产生内环的期望姿态信号；内环为姿态控制环，实现外环期望的升力指向；根据式(2)和式(3)，得到内环跟踪指令：
[0085][0086]
其中，f
i,d
、φ
i,d
、θ
i,d
和ψ
i,d
分别是f
i
、φ
i
、θ
i
和ψ
i
的期望值；u
i
＝f
i
r
i
e3＝[u
xi
；u
yi
；u
zi
]；
[0087]
对于一个绳系多无人机协同操作系统，所有无人机通过系绳与一个共同的悬挂载荷相连；因此，式(1)和(2)中的系绳拉力t
i
ξ
i
是一个与无人机和悬挂载荷运动参数都相关的高度非线性动态函数；为了后续仿真研究，需要计算系绳拉力t
i
ξ
i
；这种多体耦合系统产生的内部系绳拉力可以利用udwadia-kalaba方程计算，总的系绳拉力为：
[0088][0089]
其中，n＝diag[m1,
…
,m
n
,m
l
]，π＝[π1；
…
；π
n
]，r
l,i
＝r
i-r
l
，是r
l,i
的转置；(*)
+
表示moore-penrose伪逆；是r
l,i
的一阶导数，是的转置；符号表示直积运算；
[0090]
由于仿真数值积分运算存在累积误差，导致系绳长度存在漂移现象，即：
[0091][0092]
其中，l
i
表示i
th
系绳的长度；
[0093]
定义采用状态反馈方法，解决系绳长度漂移问题：
[0094][0095]
其中，和分别是r
li
的二阶和一阶导数，α和β是补偿反馈增益；
[0096]
因此，总的系绳拉力式(6)进一步改进为：
[0097][0098]
步骤2：基于拉力优化分配的无人机航迹规划；
[0099]
对于绳系多无人机协同操作系统，假设悬挂载荷期望轨迹为r
ld
；通过系绳拉力优化分配以及系统运动学关系求取无人机的期望轨迹，实现悬挂载荷跟踪期望轨迹；
[0100]
根据式(1)，悬挂载荷跟踪期望轨迹的期望旋量为：
[0101][0102]
系统运动学关系为：
[0103]
r
i
＝r
l
+l
i
ξ
i
ꢀꢀꢀ
(11)
[0104]
根据运动学关系式(11)知，求得系绳方向向量，就能得到无人机的期望轨迹；对于式(10)来说，当不共面的张紧系绳不少于3根时，悬挂载荷的位置控制通过调节系绳拉力来
实现，且式(10)的解不唯一；通过优化的方法来求系绳的拉力，使得拉力最小且满足约束，同时避免无人机之间的碰撞；拉力优化问题归纳为：
[0105][0106]
其中，‖*‖表示向量的二范数，φ表示系绳之间避碰允许的最小夹角，t
i,max
和t
i,min
分别是系绳允许的最大和最小拉力，利用序列最小二次规划求解上面的优化问题，得到t
i
ξ
i
，i＝1,
…
,n；因此，无人机的期望轨迹为：
[0107][0108]
其中，r
id
为i
th
无人机的期望轨迹；
[0109]
步骤3：基于固定时间收敛定理设计固定时间非奇异终端滑模面；
[0110]
根据步骤1中无人机的动力学模型(2)，得到无人机的位置跟踪误差动力学模型：
[0111][0112]
其中，是e
i
的二阶导数，是r
id
的二阶导数，e
i
＝r
o-r
id
；
[0113]
根据无人机位置跟踪误差动力学模型(14)，设计一个固定时间非奇异终端滑模面s
i
：
[0114][0115]
其中，是e
i
的一阶导数，m和n是正奇数，满足关系π是圆周率，t
s
是正常数，diag(e
i
)是以向量e
i
的元素为对角元的对角矩阵，cosh(*)表示双曲余弦函数；
[0116]
步骤4：基于步骤3设计的滑模面，设计预设时间协同跟踪控制律；
[0117]
基于步骤3中设计的固定时间非奇异终端滑模面s
i
，设计预设时间协同跟踪控制律u
i
如下：
[0118][0119]
其中，t
r
是正常数；sinh(*)表示双曲正弦函数；θ和是正奇数，满足关系r表示无人机位置状态的维数；k
i
是一个正常数；sign(*)表示符号函数；
[0120]
非线性函数ξ
τ
定义为：
[0121][0122]
其中，τ是一个正常数；|x|表示x的绝对值；
[0123]
基于lyapunov稳定性理论证明无人机在固定时间内实现期望轨迹的跟踪，收敛时间估计如下：
[0124][0125]
其中，是一个关于τ的函数，当τ取很小时，趋近于0；考虑到式(18)中收敛时间t的估计存在保守性，因此收敛时间的上界估计为2t
s
/π+t
r
。