CN112394644B - 一种绳系多无人机协同操作系统的预设时间控制方法 - Google Patents
一种绳系多无人机协同操作系统的预设时间控制方法 Download PDFInfo
- Publication number
- CN112394644B CN112394644B CN202011409655.6A CN202011409655A CN112394644B CN 112394644 B CN112394644 B CN 112394644B CN 202011409655 A CN202011409655 A CN 202011409655A CN 112394644 B CN112394644 B CN 112394644B
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicle
- tether
- tension
- cooperative operation
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 26
- 230000008878 coupling Effects 0.000 claims abstract description 8
- 238000010168 coupling process Methods 0.000 claims abstract description 8
- 238000005859 coupling reaction Methods 0.000 claims abstract description 8
- 238000005457 optimization Methods 0.000 claims description 15
- 239000000126 substance Substances 0.000 claims description 15
- 239000000725 suspension Substances 0.000 claims description 15
- 239000011159 matrix material Substances 0.000 claims description 9
- 238000004088 simulation Methods 0.000 claims description 4
- 230000001133 acceleration Effects 0.000 claims description 3
- 230000010354 integration Effects 0.000 claims description 3
- 238000012886 linear function Methods 0.000 claims description 3
- 238000005312 nonlinear dynamic Methods 0.000 claims description 3
- 241001394244 Planea Species 0.000 claims 1
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 description 2
- 239000000463 material Substances 0.000 description 2
- 238000012544 monitoring process Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000007123 defense Effects 0.000 description 1
- 230000009977 dual effect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 229910052500 inorganic mineral Inorganic materials 0.000 description 1
- 239000011707 mineral Substances 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive 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/042—Adaptive 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
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
- G05D1/0816—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
- G05D1/0825—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using mathematical models
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
- G05D1/104—Simultaneous control of position or course in three dimensions specially adapted for aircraft involving a plurality of aircrafts, e.g. formation flying
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Remote Sensing (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Medical Informatics (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Software Systems (AREA)
- Health & Medical Sciences (AREA)
- Algebra (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Mathematical Physics (AREA)
- Pure & Applied Mathematics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种绳系多无人机协同操作系统的预设时间控制方法。首先基于Udwadia‑Kalaba方程，建立绳系多无人机协同操作系统的非线性耦合动力学模型；然后基于拉力优化分配的规划无人机航迹；接下来基于固定时间收敛定理设计固定时间非奇异终端滑模面；最后基于滑模面，设计预设时间协同跟踪控制律。本发明方法能够解决绳系多无人机协同操作系统的鲁棒快速稳定控制问题，并能够解决具有快速收敛性能要求的控制问题。
Description
技术领域
本发明属于机器人领域，具体涉及一种无人机控制方法。
背景技术
旋翼无人机因为其强机动性、垂直起飞降落以及成本低廉等特性，受到国内外科研工作者的广泛研究。旋翼无人机已经成功应用于商业表演、影视拍摄、安保监视、国防军事等领域，在货物运输、灾害救援等领域的应用研究也取得了显著的成果。近年来，受直升机系绳悬挂式救援、物资运输等操作，绳驱并联机器人等应用的启发，以及旋翼无人机技术的成熟，绳系多无人机协同操作系统应运而生。绳系多无人机协同操作系统具有广阔的应用前景，比如城市高楼火灾救援，物资定点投放，搜救，环境监视，矿产资源勘探等。绳系多无人机协同操作系统由无人机、系绳、悬挂重物三部分组成，其中无人机和悬挂重物通过系绳互相连接。因此，绳系多无人机协同操作系统是一种高度非线性、强耦合以及双重欠驱动系统，实现其快速稳定控制具有理论和实际意义。
绳系多无人机协同操作系统的参数几何构型设计、旋量可行工作空间分析、运动规划以及动力学控制方面受到一定研究并取得了一些进展。在动力学控制方面，主要有两种设计思路：1)、根据绳系多无人机协同操作系统的运动学或者利用哈密顿原理得到协同操作系统广义坐标(包含悬挂载荷的位姿状态)与无人机升力之间的动力学关系，实现悬挂载荷的主动位姿控制；2)、将悬挂载荷通过系绳对无人机产生的拉力视为对无人机的外界扰动，通过主动控制无人机的位姿，实现悬挂载荷位姿的间接控制。第一种设计思路需要测量悬挂载荷的位姿以及系绳的姿态角，且设计的控制律是集中式的，基于该方法绳系多无人机协同操作系统在室外应用不现实。第二种设计思路忽视了绳系多无人机协同操作系统的强耦合性以及欠驱动特性，不能有效抑制悬挂载荷的振动。并且，现有关于绳系多无人机协同操作系统的控制普遍采用渐进收敛方法。绳系多无人机协同操作系统往往要求在预定时间内完成操作任务，且由于系绳单向力特性导致悬挂载荷控制鲁棒性低。
发明内容
为了克服现有技术的不足，本发明提供了一种绳系多无人机协同操作系统的预设时间控制方法。首先基于Udwadia-Kalaba方程，建立绳系多无人机协同操作系统的非线性耦合动力学模型；然后基于拉力优化分配的规划无人机航迹；接下来基于固定时间收敛定理设计固定时间非奇异终端滑模面；最后基于滑模面，设计预设时间协同跟踪控制律。本发明方法能够解决绳系多无人机协同操作系统的鲁棒快速稳定控制问题，并能够解决具有快速收敛性能要求的控制问题。
本发明解决其技术问题所采用的技术方案包括以下步骤：
步骤1：基于Udwadia-Kalaba方程，建立绳系多无人机协同操作系统的非线性耦合动力学模型；
建立OXYZ地面惯性系，OX轴指向东，OZ轴竖直向上，OY轴与其他两个轴满足右手螺旋定理；建立oixiyizi为ith无人机本体坐标系，设定原点oi位于ith无人机质心处，oixi轴沿无人机运动方向，oizi轴垂直于无人竖直向上，oiyi轴与其他两个轴满足右手螺旋定理；
假定：1)、飞行阶段系绳处于张紧状态；2)、系统惯性参数变化忽略不计；3)、系绳质量忽略不计且不可拉伸；4)、悬挂载荷为质点；5)、系绳连接在无人机的质心处；
根据牛顿-欧拉法，得到系统中悬挂载荷的动力学模型如式(1)所示：
其中，mL为悬挂载荷的质量，rL为悬挂载荷在地面惯性系OXYZ下的位置，
为rL的二阶导数，g为重力加速度，e3为OZ轴方向的单位向量，Ti为系绳i的拉力，ξi为沿悬挂载荷到原点oi的系绳i的方向向量，N为无人机数量；
根据牛顿-欧拉法，得到系统中ith无人机的动力学模型如下所示：
其中，mi为无人机i的质量，ri为无人机i在惯性系OXYZ下的位置，
为ri的二阶导数，fi为无人机的升力，Ri为无人机本体系oixiyizi到惯性系OXYZ的旋转矩阵；
Ri矩阵表达如下：
其中，s和c分别是正弦函数sin和余弦函数cos的简写；φi，θi和ψi分别是无人机i的滚转角、俯仰角和偏航角；
系绳连接在无人机的质心处，因此无人机的转动动力学在整个系统中处于解耦状态；ith无人机的转动动力学方程为：
其中，
和
分别是φi、θi和ψi的一阶导数，
和
分别是φi、θi和ψi的二阶导数，li是电机中心到ith无人机本体系oixiyizi原点之间的距离，u2i，u3i和u4i分别是无人机姿态控制三个方向的输入，Ixi、Iyi和Izi分别是无人机沿本体系三个方向轴的转动惯量；
无人机的跟踪控制采用内外环的双环控制模式，外环为位置控制环，使无人机实现对期望轨迹的跟踪，并且产生内环的期望姿态信号；内环为姿态控制环，实现外环期望的升力指向；根据式(2)和式(3)，得到内环跟踪指令：
其中，fi,d、φi,d、θi,d和ψi,d分别是fi、φi、θi和ψi的期望值；ui＝fiRie3＝[uxi；uyi；uzi]；
对于一个绳系多无人机协同操作系统，所有无人机通过系绳与一个共同的悬挂载荷相连；因此，式(1)和(2)中的系绳拉力Tiξi是一个与无人机和悬挂载荷运动参数都相关的高度非线性动态函数；利用Udwadia-Kalaba方程计算总的系绳拉力为：
其中，
M＝diag[m1,…,mN,mL]，Π＝[Π1；…；ΠN]，
rL,i＝ri-rL，
是rL,i的转置；(*)+表示Moore-Penrose伪逆；
是rL,i的一阶导数，
是
的转置；
符号
表示直积运算；
由于仿真数值积分运算存在累积误差，导致系绳长度存在漂移现象，即：
其中，Li表示ith系绳的长度；
定义
采用状态反馈方法，解决系绳长度漂移问题：
其中，
和
分别是RLi的二阶和一阶导数，α和β是补偿反馈增益；
因此，总的系绳拉力式(6)进一步改进为：
步骤2：基于拉力优化分配的无人机航迹规划；
对于绳系多无人机协同操作系统，假设悬挂载荷期望轨迹为rLd；通过系绳拉力优化分配以及系统运动学关系求取无人机的期望轨迹，实现悬挂载荷跟踪期望轨迹；
根据式(1)，悬挂载荷跟踪期望轨迹的期望旋量
为：
系统运动学关系为：
ri＝rL+Liξi (11)
根据运动学关系式(11)知，求得系绳方向向量，就能得到无人机的期望轨迹；对于式(10)来说，当不共面的张紧系绳不少于3根时，悬挂载荷的位置控制通过调节系绳拉力来实现，且式(10)的解不唯一；通过优化的方法来求系绳的拉力，使得拉力最小且满足约束，同时避免无人机之间的碰撞；拉力优化问题归纳为：
其中，‖*‖表示向量的二范数，φ表示系绳之间避碰允许的最小夹角，Ti,max和Ti,min分别是系绳允许的最大和最小拉力，利用序列最小二次规划求解上面的优化问题，得到Tiξi，i＝1,…,N；因此，无人机的期望轨迹为：
其中，rid为ith无人机的期望轨迹；
步骤3：基于固定时间收敛定理设计固定时间非奇异终端滑模面；
根据步骤1中无人机的动力学模型(2)，得到无人机的位置跟踪误差动力学模型：
其中，
是ei的二阶导数，
是rid的二阶导数，ei＝ri-rid；
根据无人机位置跟踪误差动力学模型(14)，设计一个固定时间非奇异终端滑模面si：
其中，
是ei的一阶导数，m和n是正奇数，满足关系
π是圆周率，Ts是正常数，diag(ei)是以向量ei的元素为对角元的对角矩阵，cosh(*)表示双曲余弦函数；
步骤4：基于步骤3设计的滑模面，设计预设时间协同跟踪控制律；
基于步骤3中设计的固定时间非奇异终端滑模面si，设计预设时间协同跟踪控制律ui如下：
其中，Tr是正常数；sinh(*)表示双曲正弦函数；θ和
是正奇数，满足关系
r表示无人机位置状态的维数；ki是一个正常数；sign(*)表示符号函数；
非线性函数ξτ定义为：
其中，τ是一个正常数；|x|表示x的绝对值；
基于Lyapunov稳定性理论证明无人机在固定时间内实现期望轨迹的跟踪，收敛时间估计如下：
其中，
是一个关于τ的函数，当τ取很小时，
趋近于0；考虑到式(18)中收敛时间T的估计存在保守性，因此收敛时间的上界估计为2Ts/π+Tr。
本发明提出了一种绳系多无人机协同操作系统的预设时间控制方法，带来了如下有益效果：
1、本发明能够解决绳系多无人机协同操作系统的鲁棒快速稳定控制问题。
2、本发明能够解决具有快速收敛性能要求的控制问题。
附图说明
图1是本发明为绳系多无人机协同操作系统示意图。
具体实施方式
下面结合附图和实施例对本发明进一步说明。
针对强非线性、强耦合的绳系多无人机协同操作系统具有快速收敛性能要求的稳定跟踪控制问题，设计了一种绳系多无人机协同操作系统的预设时间控制方法，包括以下步骤：
步骤1：基于Udwadia-Kalaba方程，建立绳系多无人机协同操作系统的非线性耦合动力学模型；
如图1所示，建立OXYZ地面惯性系，OX轴指向东，OZ轴竖直向上，OY轴与其他两个轴满足右手螺旋定理；建立oixiyizi为ith无人机本体坐标系，设定原点oi位于ith无人机质心处，oixi轴沿无人机运动方向，oizi轴垂直于无人竖直向上，oiyi轴与其他两个轴满足右手螺旋定理；
假定：1)、飞行阶段系绳处于张紧状态；2)、系统惯性参数变化忽略不计；3)、系绳质量忽略不计且不可拉伸；4)、悬挂载荷为质点；5)、系绳连接在无人机的质心处；
根据牛顿-欧拉法，得到系统中悬挂载荷的动力学模型如式(1)所示：
其中，mL为悬挂载荷的质量，rL为悬挂载荷在地面惯性系OXYZ下的位置，
为rL的二阶导数，g为重力加速度，e3为OZ轴方向的单位向量，Ti为系绳i的拉力，ξi为沿悬挂载荷到原点oi的系绳i的方向向量，N为无人机数量；
根据牛顿-欧拉法，得到系统中ith无人机的动力学模型如下所示：
其中，mi为无人机i的质量，ri为无人机i在惯性系OXYZ下的位置，
为ri的二阶导数，fi为无人机的升力，Ri为无人机本体系oixiyizi到惯性系OXYZ的旋转矩阵；
Ri矩阵表达如下：
其中，s和c分别是正弦函数sin和余弦函数cos的简写；φi，θi和ψi分别是无人机i的滚转角、俯仰角和偏航角；
系绳连接在无人机的质心处，因此无人机的转动动力学在整个系统中处于解耦状态；ith无人机的转动动力学方程为：
其中，
和
分别是φi、θi和ψi的一阶导数，
和
分别是φi、θi和ψi的二阶导数，li是电机中心到ith无人机本体系oixiyizi原点之间的距离，u2i，u3i和u4i分别是无人机姿态控制三个方向的输入，Ixi、Iyi和Izi分别是无人机沿本体系三个方向轴的转动惯量；
无人机的跟踪控制采用内外环的双环控制模式，外环为位置控制环，使无人机实现对期望轨迹的跟踪，并且产生内环的期望姿态信号；内环为姿态控制环，实现外环期望的升力指向；根据式(2)和式(3)，得到内环跟踪指令：
其中，fi,d、φi,d、θi,d和ψi,d分别是fi、φi、θi和ψi的期望值；ui＝fiRie3＝[uxi；uyi；uzi]；
对于一个绳系多无人机协同操作系统，所有无人机通过系绳与一个共同的悬挂载荷相连；因此，式(1)和(2)中的系绳拉力Tiξi是一个与无人机和悬挂载荷运动参数都相关的高度非线性动态函数；为了后续仿真研究，需要计算系绳拉力Tiξi；这种多体耦合系统产生的内部系绳拉力可以利用Udwadia-Kalaba方程计算，总的系绳拉力为：
其中，
N＝diag[m1,…,mN,mL]，Π＝[Π1；…；ΠN]，
rL,i＝ri-rL，
是rL,i的转置；(*)+表示Moore-Penrose伪逆；
是rL,i的一阶导数，
是
的转置；
符号
表示直积运算；
由于仿真数值积分运算存在累积误差，导致系绳长度存在漂移现象，即：
其中，Li表示ith系绳的长度；
定义
采用状态反馈方法，解决系绳长度漂移问题：
其中，
和
分别是RLi的二阶和一阶导数，α和β是补偿反馈增益；
因此，总的系绳拉力式(6)进一步改进为：
步骤2：基于拉力优化分配的无人机航迹规划；
对于绳系多无人机协同操作系统，假设悬挂载荷期望轨迹为rLd；通过系绳拉力优化分配以及系统运动学关系求取无人机的期望轨迹，实现悬挂载荷跟踪期望轨迹；
根据式(1)，悬挂载荷跟踪期望轨迹的期望旋量
为：
系统运动学关系为：
ri＝rL+Liξi (11)
根据运动学关系式(11)知，求得系绳方向向量，就能得到无人机的期望轨迹；对于式(10)来说，当不共面的张紧系绳不少于3根时，悬挂载荷的位置控制通过调节系绳拉力来实现，且式(10)的解不唯一；通过优化的方法来求系绳的拉力，使得拉力最小且满足约束，同时避免无人机之间的碰撞；拉力优化问题归纳为：
其中，‖*‖表示向量的二范数，φ表示系绳之间避碰允许的最小夹角，Ti,max和Ti,min分别是系绳允许的最大和最小拉力，利用序列最小二次规划求解上面的优化问题，得到Tiξi，i＝1,…,N；因此，无人机的期望轨迹为：
其中，rid为ith无人机的期望轨迹；
步骤3：基于固定时间收敛定理设计固定时间非奇异终端滑模面；
根据步骤1中无人机的动力学模型(2)，得到无人机的位置跟踪误差动力学模型：
其中，
是ei的二阶导数，
是rid的二阶导数，ei＝ro-rid；
根据无人机位置跟踪误差动力学模型(14)，设计一个固定时间非奇异终端滑模面si：
其中，
是ei的一阶导数，m和n是正奇数，满足关系
π是圆周率，Ts是正常数，diag(ei)是以向量ei的元素为对角元的对角矩阵，cosh(*)表示双曲余弦函数；
步骤4：基于步骤3设计的滑模面，设计预设时间协同跟踪控制律；
基于步骤3中设计的固定时间非奇异终端滑模面si，设计预设时间协同跟踪控制律ui如下：
其中，Tr是正常数；sinh(*)表示双曲正弦函数；θ和
是正奇数，满足关系
r表示无人机位置状态的维数；ki是一个正常数；sign(*)表示符号函数；
非线性函数ξτ定义为：
其中，τ是一个正常数；|x|表示x的绝对值；
基于Lyapunov稳定性理论证明无人机在固定时间内实现期望轨迹的跟踪，收敛时间估计如下：
其中，
是一个关于τ的函数，当τ取很小时，
趋近于0；考虑到式(18)中收敛时间T的估计存在保守性，因此收敛时间的上界估计为2Ts/π+Tr。
Claims (1)
1.一种绳系多无人机协同操作系统的预设时间控制方法，其特征在于，包括以下步骤：
步骤1：基于Udwadia-Kalaba方程，建立绳系多无人机协同操作系统的非线性耦合动力学模型；
建立OXYZ地面惯性系，OX轴指向东，OZ轴竖直向上，OY轴与其他两个轴满足右手螺旋定理；建立oixiyizi为ith无人机本体坐标系，设定原点oi位于ith无人机质心处，oixi轴沿无人机运动方向，oizi轴垂直于无人竖直向上，oiyi轴与其他两个轴满足右手螺旋定理；
假定：1)、飞行阶段系绳处于张紧状态；2)、系统惯性参数变化忽略不计；3)、系绳质量忽略不计且不可拉伸；4)、悬挂载荷为质点；5)、系绳连接在无人机的质心处；
根据牛顿-欧拉法，得到系统中悬挂载荷的动力学模型如式(1)所示：
其中，mL为悬挂载荷的质量，rL为悬挂载荷在地面惯性系OXYZ下的位置，
为rL的二阶导数，g为重力加速度，e3为OZ轴方向的单位向量，Ti为系绳i的拉力，ξi为沿悬挂载荷到原点oi的系绳i的方向向量，N为无人机数量；
根据牛顿-欧拉法，得到系统中ith无人机的动力学模型如下所示：
其中，mi为无人机i的质量，ri为无人机i在惯性系OXYZ下的位置，
为ri的二阶导数，fi为无人机的升力，Ri为无人机本体系oixiyizi到惯性系OXYZ的旋转矩阵；
Ri矩阵表达如下：
其中，s和c分别是正弦函数sin和余弦函数cos的简写；φi，θi和ψi分别是无人机i的滚转角、俯仰角和偏航角；
系绳连接在无人机的质心处，因此无人机的转动动力学在整个系统中处于解耦状态；ith无人机的转动动力学方程为：
其中，
和
分别是φi、θi和ψi的一阶导数，
和
分别是φi、θi和ψi的二阶导数，li是电机中心到ith无人机本体系oixiyizi原点之间的距离，u2i，u3i和u4i分别是无人机姿态控制三个方向的输入，Ixi、Iyi和Izi分别是无人机沿本体系三个方向轴的转动惯量；
无人机的跟踪控制采用内外环的双环控制模式，外环为位置控制环，使无人机实现对期望轨迹的跟踪，并且产生内环的期望姿态信号；内环为姿态控制环，实现外环期望的升力指向；根据式(2)和式(3)，得到内环跟踪指令：
其中，fi,d、φi,d、θi,d和ψi,d分别是fi、φi、θi和ψi的期望值；ui＝fiRie3＝[uxi；uyi；uzi]；
对于一个绳系多无人机协同操作系统，所有无人机通过系绳与一个共同的悬挂载荷相连；因此，式(1)和(2)中的系绳拉力Tiξi是一个与无人机和悬挂载荷运动参数都相关的高度非线性动态函数；利用Udwadia-Kalaba方程计算总的系绳拉力为：
其中，
M＝diag[m1,…,mN,mL]，Π＝[Π1；…；ΠN]，
rL,i＝ri-rL，
是rL,i的转置；(*)+表示Moore-Penrose伪逆；
是rL,i的一阶导数，
是
的转置；
符号
表示直积运算；
由于仿真数值积分运算存在累积误差，导致系绳长度存在漂移现象，即：
其中，Li表示ith系绳的长度；
定义
采用状态反馈方法，解决系绳长度漂移问题：
其中，
和
分别是RLi的二阶和一阶导数，α和β是补偿反馈增益；
因此，总的系绳拉力式(6)进一步改进为：
步骤2：基于拉力优化分配的无人机航迹规划；
对于绳系多无人机协同操作系统，假设悬挂载荷期望轨迹为rLd；通过系绳拉力优化分配以及系统运动学关系求取无人机的期望轨迹，实现悬挂载荷跟踪期望轨迹；
根据式(1)，悬挂载荷跟踪期望轨迹的期望旋量
为：
系统运动学关系为：
ri＝rL+Liξi (11)
根据运动学关系式(11)知，求得系绳方向向量，就能得到无人机的期望轨迹；对于式(10)来说，当不共面的张紧系绳不少于3根时，悬挂载荷的位置控制通过调节系绳拉力来实现，且式(10)的解不唯一；通过优化的方法来求系绳的拉力，使得拉力最小且满足约束，同时避免无人机之间的碰撞；拉力优化问题归纳为：
其中，‖*‖表示向量的二范数，φ表示系绳之间避碰允许的最小夹角，Ti,max和Ti,min分别是系绳允许的最大和最小拉力，利用序列最小二次规划求解上面的优化问题，得到Tiξi，i＝1,…,N；因此，无人机的期望轨迹为：
其中，rid为ith无人机的期望轨迹；
步骤3：基于固定时间收敛定理设计固定时间非奇异终端滑模面；
根据步骤1中无人机的动力学模型(2)，得到无人机的位置跟踪误差动力学模型：
其中，
是ei的二阶导数，
是rid的二阶导数，ei＝ri-rid；
根据无人机位置跟踪误差动力学模型(14)，设计一个固定时间非奇异终端滑模面si：
其中，
是ei的一阶导数，m和n是正奇数，满足关系
π是圆周率，Ts是正常数，diag(ei)是以向量ei的元素为对角元的对角矩阵，cosh(*)表示双曲余弦函数；
步骤4：基于步骤3设计的滑模面，设计预设时间协同跟踪控制律；
基于步骤3中设计的固定时间非奇异终端滑模面si，设计预设时间协同跟踪控制律ui如下：
其中，Tr是正常数；sinh(*)表示双曲正弦函数；θ和
是正奇数，满足关系
r表示无人机位置状态的维数；ki是一个正常数；sign(*)表示符号函数；
非线性函数ξτ定义为：
其中，τ是一个正常数；|x|表示x的绝对值；
基于Lyapunov稳定性理论证明无人机在固定时间内实现期望轨迹的跟踪，收敛时间估计如下：
其中，
是一个关于τ的函数，当τ取很小时，
趋近于0；考虑到式(18)中收敛时间T的估计存在保守性，因此收敛时间的上界估计为2Ts/π+Tr。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202011409655.6A CN112394644B (zh) | 2020-12-03 | 2020-12-03 | 一种绳系多无人机协同操作系统的预设时间控制方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202011409655.6A CN112394644B (zh) | 2020-12-03 | 2020-12-03 | 一种绳系多无人机协同操作系统的预设时间控制方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN112394644A CN112394644A (zh) | 2021-02-23 |
| CN112394644B true CN112394644B (zh) | 2022-09-02 |
Family
ID=74604297
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202011409655.6A Active CN112394644B (zh) | 2020-12-03 | 2020-12-03 | 一种绳系多无人机协同操作系统的预设时间控制方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN112394644B (zh) |
Families Citing this family (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113031595B (zh) * | 2021-02-26 | 2023-02-03 | 北京卫星制造厂有限公司 | 一种基于多智能体协同转运实时在线位姿补偿控制方法 |
| CN113325861B (zh) * | 2021-06-02 | 2023-03-24 | 上海海事大学 | 一种非奇异预设时间四旋翼无人机姿态跟踪控制方法 |
| CN117891281A (zh) * | 2024-03-15 | 2024-04-16 | 天目山实验室 | 一种基于嵌套双模态的二阶非奇异终端滑模飞行控制方法 |
Family Cites Families (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN107765553B (zh) * | 2017-11-02 | 2020-10-23 | 天津大学 | 针对旋翼无人机吊挂运输系统的非线性控制方法 |
| CN109976366B (zh) * | 2019-03-27 | 2022-03-29 | 天津大学 | 旋翼无人机吊挂负载系统非线性轨迹跟踪控制方法 |
| CN110221542B (zh) * | 2019-06-04 | 2021-09-17 | 西北工业大学 | 一种二阶非线性多智能体系统固定时间协同跟踪控制方法 |
| CN111190430B (zh) * | 2020-01-15 | 2022-07-05 | 西北工业大学 | 一种利用系绳旋翼协调的无人机吊挂负载控制方法 |
| CN111625019B (zh) * | 2020-05-18 | 2021-11-26 | 天津大学 | 基于强化学习的四旋翼无人机悬挂空运系统轨迹规划方法 |
-
2020
- 2020-12-03 CN CN202011409655.6A patent/CN112394644B/zh active Active
Also Published As
| Publication number | Publication date |
|---|---|
| CN112394644A (zh) | 2021-02-23 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN112394644B (zh) | 一种绳系多无人机协同操作系统的预设时间控制方法 | |
| CN109884895B (zh) | 基于饱和受限情况下的无人机自适应跟踪控制算法 | |
| Bernard et al. | Generic slung load transportation system using small size helicopters | |
| Crowther et al. | Kinematic analysis and control design for a nonplanar multirotor vehicle | |
| CN111766899A (zh) | 一种基于干扰观测器的四旋翼无人机集群抗干扰编队控制方法 | |
| CN113342025B (zh) | 一种基于线性自抗扰控制的四旋翼无人机姿态控制方法 | |
| Bernard et al. | Load transportation system based on autonomous small size helicopters | |
| Kui et al. | Sliding mode control for a quadrotor slung load system | |
| CN109725643B (zh) | 一种基于主动建模的旋翼飞行器非平衡负载吊运系统的控制方法 | |
| Fang et al. | Adaptive backstepping control of an indoor micro-quadrotor | |
| CN113359459A (zh) | 旋翼飞行器滑模变结构的姿态控制方法 | |
| Sun et al. | Nonlinear robust compensation method for trajectory tracking control of quadrotors | |
| Pi et al. | A simple six degree-of-freedom aerial vehicle built on quadcopters | |
| CN111650951B (zh) | 一种四旋翼无人机复杂轨迹的全回路复合动态逆跟踪控制方法 | |
| CN113156995A (zh) | 一种执行器故障下的无人直升机姿态控制方法 | |
| CN109976364B (zh) | 一种六旋翼飞行器姿态解耦控制方法 | |
| CN108427426B (zh) | 空中吊车负载振荡控制方法和系统 | |
| CN116301009B (zh) | 一种变构型无人机的抗干扰安全控制方法 | |
| CN106933237B (zh) | 一种平流层飞艇的被动容错控制方法 | |
| Nishio et al. | Design, control, and motion-planning for a root-perching rotor-distributed manipulator | |
| Du et al. | Advanced quadrotor takeoff control based on incremental nonlinear dynamic inversion and integral extended state observer | |
| CN113820950B (zh) | 一种绳系连接飞行器稳定控制方法 | |
| CN114967724A (zh) | 一种四旋翼无人机目标环绕抗干扰控制方法 | |
| CN111338369B (zh) | 一种基于非线性逆补偿的多旋翼飞行控制方法 | |
| Lu et al. | ADRC based attitude control system design for unmanned helicopter |
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 | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |