CN110456816B - 一种基于连续终端滑模的四旋翼轨迹跟踪控制方法 - Google Patents
一种基于连续终端滑模的四旋翼轨迹跟踪控制方法 Download PDFInfo
- Publication number
- CN110456816B CN110456816B CN201910602826.8A CN201910602826A CN110456816B CN 110456816 B CN110456816 B CN 110456816B CN 201910602826 A CN201910602826 A CN 201910602826A CN 110456816 B CN110456816 B CN 110456816B
- Authority
- CN
- China
- Prior art keywords
- sliding mode
- control
- rotor
- attitude
- variable
- 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
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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
Abstract
一种基于连续终端滑模的四旋翼轨迹跟踪控制方法,属于多旋翼直升机的自主飞行控制技术领域。本发明针对四旋翼变量的耦合问题以及系统控制信号不连续问题,设计了一种基于连续非奇异终端滑模算法的四旋翼轨迹跟踪控制方法。该方法采用内环控制姿态和外环控制位置的控制方式,通过对CNTSMA的滑模切换面进行补偿和滑模参数自适应处理操作,有效解决了四旋翼系统飞行控制中的非线性、欠驱动和强耦合问题,并改善系统响应所产生的抖振现象,从而提高四旋翼无人机的轨迹跟踪控制精度和收敛速度。
Description
技术领域
本发明属于多旋翼直升机的自主飞行控制技术领域,具体涉及一种基于连续终端滑模的 四旋翼轨迹跟踪控制方法。
背景技术
四旋翼无人飞行器是小型无人机的典型代表,是融合了自动控制技术、人工智能技术、 传感器技术、计算机技术、导航和通信技术、空气动力学等诸多技术的综合机器人系统。四 旋翼无人机是一种能够携带有效载荷,比如通信设备、影像采集设备、杀伤性武器等等,依 靠对称分布在机体四周的旋翼和电机提供飞行动力,进行自主飞行或者遥控飞行完成指定任 务,并且可收回重复使用的无人机。与固定翼相比,四旋翼无人机能够进行垂直起降(Vertical Take-Off and Landing,VTOL)和悬停,不需要利用跑道进行起飞和降落,更加节省空间。 四旋翼以其超强的机动性、灵活性、携带负载能力和多样的飞行方式,吸引了各界专家学者 的广泛关注,成为控制领域的研究热点。
四旋翼系统因其非线性、欠驱动性、强耦合性以及不确定性,对控制带来一定程度的困 难。目前针对系统的非线性以及强耦合性,学者常采用滑模控制(Sliding ModelControl,SMC) 方案。这种控制策略使得系统处于动态变化过程中,根据系统当前状态(偏差及各阶导数) 有目的的不断变化,迫使系统按照预定“滑动模态”的状态轨迹运动,由于滑动模态可以设 计且与对象参数及扰动无关,这种控制方式具有快速响应、对参数变化及扰动不灵敏,相比 工程中常用的比例-积分-微分(Proportion Integral Differential,PID)控制器来说,SMC具有 很强的鲁棒性。但将该方法用于四旋翼系统时会在滑模切换面上产生抖振,导致滑模控制的 收敛速度较慢,控制精度下降。并且,传统滑模控制信号具有不连续性,不适合工程中采用。
针对现阶段存在的问题,本发明提供了一种基于连续非奇异终端滑模算法(Continuous Nonsingular Terminal Sliding Model Algorithm,CNTSMA)的四旋翼轨迹跟踪控制方法。该方 法采用内环控制姿态和外环控制位置的控制方式,通过对CNTSMA的滑模切换面进行补偿 和滑模参数自适应处理操作,有效解决了四旋翼系统飞行控制中的非线性、欠驱动和强耦合 问题,并改善系统响应所产生的抖振现象,从而提高四旋翼无人机的轨迹跟踪控制精度和收 敛速度。
发明内容
本发明的目的在于提供一种基于连续终端滑模的四旋翼轨迹跟踪控制方法,解决四旋翼 系统控制中的非线性、欠驱动和强耦合问题,从而提高四旋翼无人机的轨迹跟踪控制精度和 收敛速度。
本发明的目的是这样实现的:
一种基于连续终端滑模的四旋翼轨迹跟踪控制方法,包括如下步骤:
步骤1:根据四旋翼动力学方程的姿态位置耦合特性,将四旋翼系统划分为内环控制姿 态和外环控制位置两个子系统;
步骤2:引入虚拟控制变量处理外环位置控制变量的欠驱动特性,并计算虚拟控制变量 与外环控制变量的关系;
步骤3:对外环的位置控制变量设计基于连续终端滑模的控制率,考虑到xy方向的耦合 问题,对设计过程进行滑模面补偿和参数自适应;
步骤4:对内环的姿态控制变量设计基于连续终端滑模的控制率;
步骤5:向四旋翼系统输入参考位置和姿态角,然后将步骤3和步骤4所设计的位置控 制率和姿态控制率输入系统,得到系统下一时刻的位置和姿态;
步骤6:重复步骤3-5,使得四旋翼能持续进行轨迹跟踪。
所述步骤3中采用连续非奇异终端滑模算法设计位置虚拟控制变量的滑模切换面,并对 切换面进行补偿:
位置控制率为:
其中,xN,yN是x和y方向的补偿滑模切换面;zN是z轴的滑模切换面; ex=x-xd,ey=y-yd,ez=z-zd是位置变量与参考位置的误差变量; k1x,k2x,k3x,k1y,k2y,k3y,k1z,k2z,k3z是三轴的终端滑模系数,ax,ay是滑模补偿系数,
所述滑模控制率的自适应参数为:
其中,κ,α>0是自适应比例系数;μ是自适应均值系数;r>0是自适应指数。
所述步骤3中三轴的终端滑模系数选取规则为:
所述步骤4中对内环的姿态控制变量设计基于连续终端滑模的控制率,采用连续非奇异 终端滑模算法设计姿态控制变量的滑模切换面:
姿态控制率:
其中,φN,θN,ψN是三轴姿态的滑模切换面;eφ=φ-φd,eθ=θ-θd,eψ=ψ-ψd是姿态变量 与参考姿态角的误差变量,k1φ,k2φ,k3φ,k1θ,k2θ,k3θ,k1ψ,k2ψ,k3ψ是三轴的终端滑模系数。
所述步骤4中三轴的终端滑模系数选取规则为:
本发明有益效果在于:
(1)引入内环加外环控制结构处理系统的姿态和位置变量耦合特点,使得四旋翼系统得 到有效控制;
(2)引入虚拟控制变量控制系统的位置变量,可以有效解决四旋翼系统的欠驱动问题, 提高了系统的控制精度;
(3)运用了连续非奇异终端滑模控制算法(CNTSMA),可以有效解决四旋翼控制中的 超调和抖振问题,进一步提高系统的控制精度。
附图说明
图1为四旋翼的动力学模型;
图2为四旋翼的内外环控制结构;
图3(a)为Qball-X4在使用本发明方法与PID和STA时在x轴方向的方波跟踪轨迹;
图3(b)为Qball-X4在使用本发明方法与PID和STA时在y轴方向的方波跟踪轨迹;
图3(c)为Qball-X4在使用本发明方法与PID和STA时在z轴方向的方波跟踪轨迹;
图4(a)为Qball-X4使用本发明方法跟踪方波时的航偏角ψ变化曲线;
图4(b)为Qball-X4使用本发明方法跟踪方波时的横滚角φ变化曲线;
图4(c)为Qball-X4使用本发明方法跟踪方波时的俯仰角θ变化曲线;
图5(a)为Qball-X4在使用本发明方法与PID和STA时在x轴方向的正弦波跟踪轨迹;
图5(b)为Qball-X4在使用本发明方法与PID和STA时在y轴方向的正弦波跟踪轨迹;
图5(c)为Qball-X4在使用本发明方法与PID和STA时在z轴方向的正弦波跟踪轨迹;
图6(a)为Qball-X4使用本发明方法跟踪正弦波时的航偏角ψ变化曲线;
图6(b)为Qball-X4使用本发明方法跟踪正弦波时的横滚角φ变化曲线;
图6(c)为Qball-X4使用本发明方法跟踪正弦波时的俯仰角θ变化曲线。
具体实施方式
下面结合附图对本发明做更进一步描述。
本发明是通过以下步骤来实现的:
步骤1:根据四旋翼动力学方程的姿态位置耦合特性,将四旋翼系统划分为内环控制姿 态和外环控制位置两个子系统;
步骤2:引入虚拟控制变量处理外环位置控制变量的欠驱动特性,并计算虚拟控制变量 与外环控制变量的关系;
步骤3:对外环的位置控制变量设计基于连续终端滑模的控制率,考虑到xy方向的耦合 问题,对设计过程进行滑模面补偿和参数自适应;
步骤4:对内环的姿态控制变量设计基于连续终端滑模的控制率。
步骤5:向四旋翼系统输入参考位置和姿态角,然后将步骤3和步骤4所设计的位置控 制率和姿态控制率输入系统,得到系统下一时刻的位置和姿态;
步骤6:重复步骤3-5,使得四旋翼能持续进行轨迹跟踪。
在步骤3中,首先利用基于连续终端滑模设计四旋翼外环子系统的控制变量,然后考虑 xy方向的耦合问题,设计补偿滑模切换面并对滑模参数进行自适应处理。
本发明是一种基于连续终端滑模的四旋翼轨迹跟踪控制,其具体实施方式为:
步骤1:结合图1所示四旋翼的动力学模型,根据四旋翼动力学方程的姿态位置耦合特 性,将四旋翼系统划分为内环控制姿态和外环控制位置两个子系统。
根据四旋翼系统的动力学方程:
其中,J=[Jx,Jy,Jz]T是四旋翼的惯性矩阵;Ω=-ω1+ω2-ω3+ω4是四旋翼总的角速度(ω1,ω2,ω3,ω4分别是四个旋翼的角速度);Jp是旋翼围绕转轴旋转的转动惯量。
由式(1)所示四旋翼的动力学方程可知,该系统是一个二阶的6自由度4控制变量的欠 驱动、强耦合系统。包括系统位置变量p=[x,y,z]T、系统姿态变量η=[φ,θ,ψ]T和系统输 入控制变量u=[u,τ]T=[u,τφ,τθ,τψ]T。将其分解为外环控制和内环控制。其中,外环控制 位置,即用控制变量u控制系统位置变量,将位置变量引导至参考位置;然后进行姿态角解 算,解算出参考横滚角φd和参考俯仰角θd,同时将参考航向角ψd输入给内环,作为内环的参 考姿态;内环控制姿态,即用控制变量[τφ,τθ,τψ]T控制系统的姿态变量,将姿态变量引导至 参考姿态。四旋翼系统的控制结构如图2所示。
步骤2:引入虚拟控制变量处理外环位置控制变量的欠驱动特性,并计算虚拟控制变量 与外环控制变量的关系。
位置控制器中引入的虚拟变量为ν=[νxνyνz]T,外环虚拟控制变量外环控制变量之间 关系及姿态角解算过程如下:
式(2)中,φd,θd是需要根据虚拟控制变量解算的参考横滚角和参考俯仰角,加上给定 的参考航偏角ψd,得到系统的参考姿态角输入给内环控制。
步骤3:对外环的位置控制变量设计基于连续终端滑模的控制率,考虑到xy方向的耦合 问题,对设计过程进行滑模面补偿和参数自适应;
采用CNTSMA设计位置虚拟控制变量的滑模切换面,并对切换面进行补偿:
和控制率:
其中,xN,yN是x和y方向的补偿滑模切换面;zN是z轴的滑模切换面;ex=x-xd,ey=y-yd,ez=z-zd是位置变量与参考位置的误差变量; k1x,k2x,k3x,k1y,k2y,k3y,k1z,k2z,k3z是三轴的终端滑模系数,按以下规则选取:
ax,ay是滑模补偿系数,满足:
式(4)中,滑模控制率的参数采用以下自适应参数:
其中,κ,α>0是自适应比例系数;μ是自适应均值系数;r>0是自适应指数。
步骤4:对内环的姿态控制变量设计基于连续终端滑模的控制率。
采用CNTSMA设计姿态控制变量的滑模切换面:
和控制率:
式(5)中,φN,θN,ψN是三轴姿态的滑模切换面;eφ=φ-φd,eθ=θ-θd,eψ=ψ-ψd是姿态变量与参考姿态角的误差变量。
式(6)中的k1φ,k2φ,k3φ,k1θ,k2θ,k3θ,k1ψ,k2ψ,k3ψ是三轴的终端滑模系数,按以下规则选 取:
步骤5:向四旋翼系统输入参考位置和姿态角,然后将步骤3和步骤4所设计的位置控 制率和姿态控制率输入系统,得到系统下一时刻的位置和姿态;
步骤6:重复步骤3-5,使得四旋翼能够持续进行轨迹跟踪。
本发明的效果通过如下方法得到验证:
利用MATLAB仿真实验对本发明进行验证,该次试验是在次实验是在MATLABR2016a 环境下进行的。设计两种使用四旋翼进行跟踪的参考轨迹:
(1)方波轨迹(设置xd=5,yd=5,zd=5,ψd=π/4),用于考察算法的稳态误差和收敛速 度;
(2)正弦轨迹(设置xd=2sin(0.1πt)+2,yd=2sin(0.1πt)+5,zd=2sin(0.1πt)+5,ψd=π/4 ),用于考察算法的动态特性和跟踪精度。
采用加拿大Concordia大学和QUANSER公司联合开发的Qball-X4四旋翼实验平台参数, 利用本发明对该平台进行轨迹跟踪控制。工程常用的PID控制和超螺旋滑模算法(Super Twisting Algorithm,STA)作为对照算法,试验结果分别如图3(a)、图3(b)、图3(c)、 图4(a)、图4(b)、图4(c)、图5(a)、图5(b)、图5(c)、图6(a)、图6(b)、图6 (c)所示。其中3(a)、图3(b)、图3(c)、图4(a)、图4(b)、图4(c)是跟踪方波时 的位置和姿态变化曲线,图5(a)、图5(b)、图5(c)、图6(a)、图6(b)、图6(c)是 跟踪正弦波时的位置和姿态变化曲线。
从3(a)、图3(b)、图3(c)、图4(a)、图4(b)、图4(c)、图5(a)、图5(b)、 图5(c)、图6(a)、图6(b)、图6(c)可以看出,本发明算法的稳态误差为0且没有抖振, 具有良好的动态特性和跟踪精度,能够有效地跟踪方波和正弦波;且与传统控制算法相比, 本发明算法具有更快的收敛速度和更高的跟踪精度。综上所述,本发明提供的方法具有更加 精确的轨迹跟踪精度,可以有效地提高四旋翼的轨迹跟踪能力。
本发明针对四旋翼变量的耦合问题以及系统控制信号不连续问题,设计了一种基于连续 非奇异终端滑模算法(Continuous Nonsingular Terminal Sliding ModelAlgorithm,CNTSMA) 的四旋翼轨迹跟踪控制方法。该方法采用内环控制姿态和外环控制位置的控制方式,通过对 CNTSMA的滑模切换面进行补偿和滑模参数自适应处理操作,有效解决了四旋翼系统飞行控 制中的非线性、欠驱动和强耦合问题,并改善系统响应所产生的抖振现象,从而提高四旋翼 无人机的轨迹跟踪控制精度和收敛速度。
Claims (3)
1.一种基于连续终端滑模的四旋翼轨迹跟踪控制方法,其特征在于,包括:
步骤一、根据四旋翼动力学方程的姿态位置耦合特性,将四旋翼系统划分为内环控制姿态和外环控制位置两个子系统;
步骤二、引入虚拟控制变量处理外环位置控制变量的欠驱动特性,并计算虚拟控制变量与外环控制变量的关系;
步骤三、对外环的位置控制变量设计基于连续终端滑模的控制率,考虑到xy方向的耦合问题,对设计过程进行滑模面补偿和参数自适应;
采用CNTSMA设计位置虚拟控制变量的滑模切换面,并对切换面进行补偿:
xN=sx+axsy
yN=sy+aysx
位置控制率为:
其中,xN,yN是x和y方向的补偿滑模切换面;zN是z轴的滑模切换面;ex=x-xd,ey=y-yd,ez=z-zd是位置变量与参考位置的误差变量;k1x,k2x,k3x,k1y,k2y,k3y,k1z,k2z,k3z是三轴的终端滑模系数,按以下规则选取:
ax,ay是滑模补偿系数,满足:
滑模控制率的参数采用以下自适应参数:
其中,κ,α>0是自适应比例系数;μ是自适应均值系数;r>0是自适应指数;
步骤四、对内环的姿态控制变量设计基于连续终端滑模的控制率;
步骤五、向四旋翼系统输入参考位置和姿态角,然后将步骤三和步骤四所设计的位置控制率和姿态控制率输入系统,得到系统下一时刻的位置和姿态;
步骤六、重复步骤三到步骤五,使得四旋翼能持续进行轨迹跟踪。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910602826.8A CN110456816B (zh) | 2019-07-05 | 2019-07-05 | 一种基于连续终端滑模的四旋翼轨迹跟踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910602826.8A CN110456816B (zh) | 2019-07-05 | 2019-07-05 | 一种基于连续终端滑模的四旋翼轨迹跟踪控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110456816A CN110456816A (zh) | 2019-11-15 |
CN110456816B true CN110456816B (zh) | 2022-10-28 |
Family
ID=68482228
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910602826.8A Active CN110456816B (zh) | 2019-07-05 | 2019-07-05 | 一种基于连续终端滑模的四旋翼轨迹跟踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110456816B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111026160B (zh) * | 2019-12-26 | 2020-12-08 | 华中科技大学 | 一种四旋翼无人机轨迹跟踪控制方法 |
CN112527015B (zh) * | 2020-12-04 | 2023-05-05 | 广东工业大学 | 一种基于事件触发的消防无人机编队滑模控制方法 |
CN113568419B (zh) * | 2021-05-18 | 2023-09-12 | 南京邮电大学 | 一种变载四旋翼无人机容错控制方法 |
CN113867374B (zh) * | 2021-07-23 | 2023-12-01 | 福州大学 | 基于滑模控制的四旋翼无人机参数预测和扰动的自适应轨迹跟踪控制器及其设计方法 |
CN113485127B (zh) * | 2021-08-24 | 2022-05-31 | 中国科学院长春光学精密机械与物理研究所 | 一种提高光电测量设备对动态目标跟踪性能的方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102679980A (zh) * | 2011-11-15 | 2012-09-19 | 哈尔滨工程大学 | 一种基于多尺度维分解的目标跟踪方法 |
CN108594837A (zh) * | 2018-02-12 | 2018-09-28 | 山东大学 | 基于pd-smc和rise的无模型四旋翼无人机轨迹跟踪控制器及方法 |
CN109901605A (zh) * | 2019-04-11 | 2019-06-18 | 大连海事大学 | 一种四旋翼飞行器跟踪无人水面船的控制方法 |
-
2019
- 2019-07-05 CN CN201910602826.8A patent/CN110456816B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102679980A (zh) * | 2011-11-15 | 2012-09-19 | 哈尔滨工程大学 | 一种基于多尺度维分解的目标跟踪方法 |
CN108594837A (zh) * | 2018-02-12 | 2018-09-28 | 山东大学 | 基于pd-smc和rise的无模型四旋翼无人机轨迹跟踪控制器及方法 |
CN109901605A (zh) * | 2019-04-11 | 2019-06-18 | 大连海事大学 | 一种四旋翼飞行器跟踪无人水面船的控制方法 |
Non-Patent Citations (4)
Title |
---|
Nonlinear Robust Adaptive Tracking Control of a Quadrotor UAV Via Immersion and Invariance Methodology;zhao bo等;《 IEEE Transactions on Industrial Electronics》;20141024;全文 * |
基于滑模控制器的四旋翼飞行器控制;杨兴明等;《合肥工业大学学报(自然科学版)》;20160728(第07期);全文 * |
基于滑模理论的四旋翼飞行器轨迹跟踪控制;杨建华;《计算机与数字工程》;20170920;第1740-1743页 * |
微型四旋翼飞行器TSMC控制方法研究;薛劭哲等;《电子设计工程》;20130805(第15期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN110456816A (zh) | 2019-11-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110456816B (zh) | 一种基于连续终端滑模的四旋翼轨迹跟踪控制方法 | |
CN107608367B (zh) | 多变量干扰补偿四旋翼无人机轨迹与姿态协同控制方法 | |
CN108181920B (zh) | 基于给定时间的四旋翼无人机高精度姿态跟踪控制方法 | |
CN109597303B (zh) | 一种复合式旋翼飞行器全模式飞行控制方法 | |
CN107562068B (zh) | 一种四旋翼飞行器姿态的动态面输出调节控制方法 | |
CN109634299B (zh) | 基于多模态控制的飞翼无人机机动飞行控制方法 | |
Kada et al. | Robust PID controller design for an UAV flight control system | |
CN106774400B (zh) | 一种基于逆动力学的无人机三维轨迹制导方法 | |
CN112346470A (zh) | 一种基于改进自抗扰控制的四旋翼姿态控制方法 | |
CN110673623B (zh) | 一种基于双环pd控制算法控制的四旋翼无人机着陆方法 | |
CN102163059A (zh) | 推力变向无人机的姿态控制系统及控制方法 | |
CN112198885A (zh) | 一种满足机动平台自主降落需求的无人机控制方法 | |
CN114942649B (zh) | 一种基于反步法的飞机俯仰姿态与航迹角解耦控制方法 | |
CN115202349A (zh) | 基于通信干扰的多移动机器人协同编队控制方法、装置、设备及存储介质 | |
CN114637203A (zh) | 一种针对中高速、大机动无人机的飞行控制系统 | |
Shen et al. | Adaptive Neural Network Extended State Observer-Based Finite-Time Convergent Sliding Mode Control for a Quad Tiltrotor UAV | |
CN113961010A (zh) | 基于抗饱和有限时间自适应神经网络容错技术的四旋翼植保无人机跟踪控制方法 | |
CN116203840A (zh) | 可重复使用运载器自适应增益调度控制方法 | |
CN113220031A (zh) | 基于抗饱和有限时间的旋翼式植保无人机姿态跟踪控制方法 | |
Zhang et al. | Trajectory optimization and finite-time control for unmanned helicopters formation | |
Xie et al. | Disturbance observer based control of multirotor helicopters based on a universal model with unstructured uncertainties | |
CN116300988A (zh) | 一种基于分数阶滑模的先进布局无人机抗干扰控制策略 | |
CN113625776B (zh) | 一种基于中值偏差的多无人机滑模编队控制方法 | |
CN115343949A (zh) | 一种固定翼无人机跟踪制导律设计方法及验证平台 | |
CN112835372B (zh) | 四旋翼无人机的固定时间控制方法 |
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 |