CN110032205B - 一种具有抗干扰能力的无人机姿态控制方法 - Google Patents
一种具有抗干扰能力的无人机姿态控制方法 Download PDFInfo
- Publication number
- CN110032205B CN110032205B CN201910354439.7A CN201910354439A CN110032205B CN 110032205 B CN110032205 B CN 110032205B CN 201910354439 A CN201910354439 A CN 201910354439A CN 110032205 B CN110032205 B CN 110032205B
- Authority
- CN
- China
- Prior art keywords
- aerial vehicle
- unmanned aerial
- finite time
- formula
- attitude control
- 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 22
- 239000011159 matrix material Substances 0.000 claims description 9
- 238000013178 mathematical model Methods 0.000 claims description 3
- 230000000694 effects Effects 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 2
- 238000005034 decoration Methods 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 239000007921 spray Substances 0.000 description 1
Classifications
-
- 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
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Pure & Applied Mathematics (AREA)
- Mathematical Optimization (AREA)
- Mathematical Physics (AREA)
- Mathematical Analysis (AREA)
- Algebra (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种具有抗干扰能力的无人机姿态控制方法,姿态控制过程分为以下几步:(1)建立无人机姿态控制***模型;(2)在无人机上安装一台传感器,用于时时传输无人机在运动过程中的位置;(3)设计有限时间观测器并将传感器时时采集到的位置数据传输到有限时间控制算法模块中,使得无人机姿态实现在有限时间内镇定到由***的平衡点组成的集合。本发明的一种基于有限时间的无人机姿态控制方法,控制速度快、不会产生抖颤现象、节省能量,对硬件设备要求较低,运动鲁棒性高,实用性强,易于商业化。
Description
技术领域
本发明涉及无人机姿态控制的技术领域,具体涉及一种具有抗干扰能力的无人机姿态控制方法。
背景技术
传统的姿态机动方法是利用欧拉角作反馈信号,用喷管或发动机摆角来进行控制。这类推力矢量机构提供的作用力是非线性的,有些还具有开与关的切换特点,类似于继电;器控制作用,因而采用直接的非线性控制方案效果会比较好,并较易于实现。因此,对***参数摄动和外部干扰具有鲁棒性的变结构控制方法受到了极大重视。
目前针对无人机姿态的控制算法大致有三种:(1)自适应控制方法,(2)最优化方法,(3)鲁棒控制方法;但是这些算法计算复杂、计算量大、对***的实时性要求高,这将增加算法实现成本,不利于实际应用。
因此,为解决上述问题,需要提出一种稳定性好、实时性强、成本低,利用实际应用的无人机姿态控制算法。
发明内容
本发明提供一种具有抗干扰能力的无人机姿态控制方法,该算法稳定性好、实时性强、成本低、便于实际应用。
本发明通过采取如下技术方案得到:
一种具有抗干扰能力的无人机姿态控制方法,包括下列步骤:
(1)、一般无人机姿态控制***由姿态动力学和姿态运动组成;建立无人机姿态控制***模型,模型中包括姿态动力学和姿态运动学,无人机姿态动力学方程可由微分方程公式(1)描述:
公式(1)中,J=diag(J1,J2,J3)为惯量矩阵,ω=[ω1,ω2,ω3]T为角速度向量,u=[u1,u2,u3]T为控制输入信号,d(t)=[d1(t),d2(t),d3(t)]T为外部扰动,且存在常数l满足|di(t)|≤l,l>0,i=1,2,3,s(ω)为斜对称矩阵,即
无人机姿态运动学方程通常为:
公式(3)中,I3为3×3的单位矩阵,q0=cos(Φ/2),qi=ei sin(Φ/2),i=1,2,3.,其中Φ为欧拉转角,e为转轴的单位矢量,ei,i=1,2,3.为e在参考坐标系中的三个方向余弦,且有成立,则成立;
(2)、在无人机上安装上用于传输位置信息的传感器;为有限时间控制器提供反馈信息,用于时时传输无人机在运动过程中的位置;
结合公式(1)、(2),无人机姿态控制***的数学模型可以改写为:
D(t)=[D1(t),D2(t),D3(t)]T=J-1[d1(t),d2(t),d3(t)]T;
(3)、设计有限时间观测器并将传感器时时采集到的位置数据传输到有限时间控制算法模块中,使得无人机姿态实现在有限时间内镇定到由***的平衡点组成的集合;
针对步骤(1)中的公式(1)、(2),设计有限时间控制器:
M1={(-1,0,0,0,0,0,0),(1,0,0,0,0,0,0)}
为有限时间稳定,即无人机姿态在有限时间内镇定。
本发明相对于现有控制技术具有以下的优点和效果:
本发明提出的具有抗干扰能力的无人机姿态控制算法基于有限时间选择的参数简单、物理含义清晰;运动过程中无人机运动稳定性好,鲁棒性高。
具体实施方式
一种具有抗干扰能力的无人机姿态控制方法,包括下列步骤:
(1)、一般无人机姿态控制***由姿态动力学和姿态运动组成;建立无人机姿态控制***模型,模型中包括姿态动力学和姿态运动学;无人机姿态动力学方程可由微分方程公式(1)描述:
公式(1)中,J=diag(J1,J2,J3)为惯量矩阵,ω=[ω1,ω2,ω3]T为角速度向量,u=[u1,u2,u3]T为控制输入信号,d(t)=[d1(t),d2(t),d3(t)]T为外部扰动,且且存在常数l满足|di(t)|≤l,l>0,i=1,2,3,s(ω)为斜对称矩阵,即
无人机姿态运动学方程通常为:
公式(3)中,I3为3×3的单位矩阵,q0=cos(Φ/2),qi=ei sin(Φ/2),i=1,2,3.,其中Φ为欧拉转角,e为转轴的单位矢量,ei,i=1,2,3.为e在参考坐标系中的三个方向余弦,且有成立,则成立;
(2)、在无人机上安装上用于传输位置信息的传感器;为有限时间控制器提供反馈信息,用于时时传输无人机在运动过程中的位置;
结合公式(1)、(2),无人机姿态控制***的数学模型可以改写为:
D(t)=[D1(t),D2(t),D3(t)]T=J-1[d1(t),d2(t),d3(t)]T;
(3)、设计有限时间观测器并将传感器时时采集到的位置数据传输到有限时间控制算法模块中,使得无人机姿态实现在有限时间内镇定到由***的平衡点组成的集合;
针对步骤(1)中的公式(1)、(2),设计有限时间控制器:
M1={(-1,0,0,0,0,0,0),(1,0,0,0,0,0,0)}
为有限时间稳定,即无人机姿态在有限时间内镇定。
本发明相对于现有控制技术具有以下的优点和效果:
本发明提出的具有抗干扰能力的无人机姿态控制算法基于有限时间选择的参数简单、物理含义清晰;运动过程中无人机运动稳定性好,鲁棒性高。
以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。
Claims (1)
1.一种具有抗干扰能力的无人机姿态控制方法,其特征在于包括下列步骤:
(1)、建立无人机姿态控制***模型,模型中包括姿态动力学和姿态运动学;
无人机姿态动力学方程由微分方程公式(1)描述:
公式(1)中,J=diag(J1,J2,J3)为惯量矩阵,ω=[ω1,ω2,ω3]T为角速度向量,u=[u1,u2,u3]T为控制输入信号,d(t)=[d1(t),d2(t),d3(t)]T为外部扰动,且存在常数l满足|di(t)|≤l,l>0,i=1,2,3,s(ω)为斜对称矩阵,即
无人机姿态运动学方程为:
公式(3)中,I3为3×3的单位矩阵,q0=cos(Φ/2),qi=ei sin(Φ/2),i=1,2,3,其中Φ为欧拉转角,e为转轴的单位矢量,ei,i=1,2,3为e在参考坐标系中的三个方向余弦,且有成立,则成立;
(2)、在无人机上安装上用于传输位置信息的传感器,为有限时间控制器提供反馈信息,用于时时传输无人机在运动过程中的位置;
结合公式(1)、(2),无人机姿态控制***的数学模型改写为:
D(t)=[D1(t),D2(t),D3(t)]T=J-1[d1(t),d2(t),d3(t)]T;
(3)、设计有限时间观测器并将传感器时时采集到的位置数据传输到有限时间控制算法模块中,使得无人机姿态实现在有限时间内镇定到由***的平衡点组成的集合;
针对步骤(1)中的公式(1)、(2),设计有限时间控制器:
M1={(-1,0,0,0,0,0,0),(1,0,0,0,0,0,0)}
为有限时间稳定,即无人机姿态在有限时间内镇定。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910354439.7A CN110032205B (zh) | 2019-04-29 | 2019-04-29 | 一种具有抗干扰能力的无人机姿态控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910354439.7A CN110032205B (zh) | 2019-04-29 | 2019-04-29 | 一种具有抗干扰能力的无人机姿态控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110032205A CN110032205A (zh) | 2019-07-19 |
CN110032205B true CN110032205B (zh) | 2021-09-28 |
Family
ID=67240818
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910354439.7A Active CN110032205B (zh) | 2019-04-29 | 2019-04-29 | 一种具有抗干扰能力的无人机姿态控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110032205B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113342033B (zh) * | 2021-05-26 | 2022-10-04 | 南京航空航天大学 | 基于固定时间技术的固定翼无人机姿态同步容错控制方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106774373A (zh) * | 2017-01-12 | 2017-05-31 | 哈尔滨工业大学 | 一种四旋翼无人机有限时间姿态跟踪控制方法 |
CN106802660A (zh) * | 2017-03-09 | 2017-06-06 | 北京航天自动控制研究所 | 一种复合强抗扰姿态控制方法 |
CN107490966A (zh) * | 2017-08-22 | 2017-12-19 | 浙江工业大学 | 一种基于改进幂次趋近律的飞行器有限时间自适应姿态控制方法 |
CN107577144A (zh) * | 2017-08-22 | 2018-01-12 | 浙江工业大学 | 一种基于增强型指数趋近律的飞行器有限时间自适应姿态控制方法 |
CN107608367A (zh) * | 2017-09-06 | 2018-01-19 | 天津大学 | 多变量干扰补偿四旋翼无人机轨迹与姿态协同控制方法 |
CN108363298A (zh) * | 2018-01-17 | 2018-08-03 | 合肥工业大学 | 一种基于四元数描述的四旋翼无人机快速收敛控制方法 |
WO2019055025A1 (en) * | 2017-09-15 | 2019-03-21 | Sanyal Amit K | INTEGRATED GUIDE AND FEEDBACK CONTROL FOR AUTONOMOUS VEHICLE |
-
2019
- 2019-04-29 CN CN201910354439.7A patent/CN110032205B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106774373A (zh) * | 2017-01-12 | 2017-05-31 | 哈尔滨工业大学 | 一种四旋翼无人机有限时间姿态跟踪控制方法 |
CN106802660A (zh) * | 2017-03-09 | 2017-06-06 | 北京航天自动控制研究所 | 一种复合强抗扰姿态控制方法 |
CN107490966A (zh) * | 2017-08-22 | 2017-12-19 | 浙江工业大学 | 一种基于改进幂次趋近律的飞行器有限时间自适应姿态控制方法 |
CN107577144A (zh) * | 2017-08-22 | 2018-01-12 | 浙江工业大学 | 一种基于增强型指数趋近律的飞行器有限时间自适应姿态控制方法 |
CN107608367A (zh) * | 2017-09-06 | 2018-01-19 | 天津大学 | 多变量干扰补偿四旋翼无人机轨迹与姿态协同控制方法 |
WO2019055025A1 (en) * | 2017-09-15 | 2019-03-21 | Sanyal Amit K | INTEGRATED GUIDE AND FEEDBACK CONTROL FOR AUTONOMOUS VEHICLE |
CN108363298A (zh) * | 2018-01-17 | 2018-08-03 | 合肥工业大学 | 一种基于四元数描述的四旋翼无人机快速收敛控制方法 |
Non-Patent Citations (6)
Title |
---|
Fault tolerant control for UAV with finite-time convergence;Qiang Qu 等;《The 26th Chinese Control and Decision Conference (2014 CCDC)》;20140714;全文 * |
Finite-time trajectory tracking control for a 12-rotor unmanned aerial vehicle with input saturation;Chunyang Fu 等;《ISA Transactions》;20181031;全文 * |
基于有限时间姿态控制算法的四旋翼飞行器悬停控制;朱文武 等;《***科学与数学》;20170430;全文 * |
基于有限时间收敛ESO的四旋翼无人机控制;王世峰 等;《中南大学学报(自然科学版)》;20150731;全文 * |
基于滑模方法的分布式多无人机编队控制;周映江 等;《信息与控制》;20180331;全文 * |
有限时间控制问题综述;丁世宏 等;《控制与决策》;20110228;全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN110032205A (zh) | 2019-07-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108445892B (zh) | 一种欠驱动无人船编队控制器结构及设计方法 | |
CN106325291B (zh) | 基于滑模控制律和eso的四旋翼飞行器姿态控制方法及*** | |
CN105404304B (zh) | 基于归一化神经网络的航天器容错姿态协同跟踪控制方法 | |
CN107703952B (zh) | 一种刚性飞行器的非奇异固定时间自适应姿态控制方法 | |
Zheng | Moving path following control for a surface vessel with error constraint | |
CN107577144A (zh) | 一种基于增强型指数趋近律的飞行器有限时间自适应姿态控制方法 | |
Hernandez-Gonzalez et al. | Decentralized discrete-time neural control for a Quanser 2-DOF helicopter | |
Imado | Some aspects of a realistic three-dimensional pursuit-evasion game | |
CN110865539A (zh) | 一种随机干扰下的无人艇跟踪误差约束控制方法 | |
CN107479370A (zh) | 一种基于非奇异终端滑模的四旋翼无人机有限时间自适应控制方法 | |
CN113589689B (zh) | 一种基于多参数自适应神经网络的滑模控制器设计方法 | |
Ma et al. | Event-triggered fuzzy control of networked nonlinear underactuated unmanned surface vehicle | |
Zhang et al. | Neuro-adaptive trajectory tracking control of underactuated autonomous surface vehicles with high-gain observer | |
CN109062240B (zh) | 一种基于神经网络估计的刚性飞行器固定时间自适应姿态跟踪控制方法 | |
CN110488603B (zh) | 一种考虑执行器受限问题的刚性飞行器自适应神经网络跟踪控制方法 | |
CN110471438A (zh) | 一种刚性飞行器的固定时间自适应姿态跟踪控制方法 | |
CN109164819B (zh) | 刚体航天器的反步自适应滑模大角度姿态机动控制方法 | |
Guo et al. | Development and control of a vectored water-jet-based spherical underwater vehicle | |
CN114442640A (zh) | 一种水面无人艇轨迹跟踪控制方法 | |
Qi | Spatial target path following control based on Nussbaum gain method for underactuated underwater vehicle | |
CN110032205B (zh) | 一种具有抗干扰能力的无人机姿态控制方法 | |
CN110275542B (zh) | 一种基于自适应有限时间控制的四旋翼飞行器控制方法 | |
CN110488854B (zh) | 一种基于神经网络估计的刚性飞行器固定时间姿态跟踪控制方法 | |
CN109739249A (zh) | 一种速度状态缺失条件下的多uuv编队协调控制方法 | |
CN115079698A (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 |