CN110032205A - 一种具有抗干扰能力的无人机姿态控制方法 - Google Patents
一种具有抗干扰能力的无人机姿态控制方法 Download PDFInfo
- Publication number
- CN110032205A CN110032205A CN201910354439.7A CN201910354439A CN110032205A CN 110032205 A CN110032205 A CN 110032205A CN 201910354439 A CN201910354439 A CN 201910354439A CN 110032205 A CN110032205 A CN 110032205A
- Authority
- CN
- China
- Prior art keywords
- formula
- unmanned plane
- finite
- uav attitude
- attitude
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 19
- 239000011159 matrix material Substances 0.000 claims description 9
- 230000005540 biological transmission Effects 0.000 claims description 3
- 238000013178 mathematical model Methods 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 claims 1
- 230000008569 process Effects 0.000 abstract description 3
- 206010008531 Chills Diseases 0.000 abstract 1
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 230000005611 electricity Effects 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000005457 optimization Methods 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(ω)为斜对称矩阵,即
无人机姿态运动学方程通常为:
公式(2)中为无人机的四元数,
公式(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),无人机姿态控制***的数学模型可以改写为:
公式(4)中干扰
D(t)=[D1(t),D2(t),D3(t)]T=J-1[d1(t),d2(t),d3(t)]T;
(3)、设计有限时间观测器并将传感器时时采集到的位置数据传输到有限时间控制算法模块中,使得无人机姿态实现在有限时间内镇定到由***的平衡点组成的集合;
针对步骤(1)中的公式(1)、(2),设计有限时间控制器:
公式(5)中,其中k1、k2、k3为常数,且k3>0, 1<p=p1/p2<2,p1和p2为互质的正奇数,则公式(1)、(2)和(5)***关于平衡点集合
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(ω)为斜对称矩阵,即
无人机姿态运动学方程通常为:
公式(2)中为无人机的四元数,
公式(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),无人机姿态控制***的数学模型可以改写为:
公式(4)中干扰
D(t)=[D1(t),D2(t),D3(t)]T=J-1[d1(t),d2(t),d3(t)]T;
(3)、设计有限时间观测器并将传感器时时采集到的位置数据传输到有限时间控制算法模块中,使得无人机姿态实现在有限时间内镇定到由***的平衡点组成的集合;
针对步骤(1)中的公式(1)、(2),设计有限时间控制器:
公式(5)中,其中k1、k2、k3为常数,且k3>0, 1<p=p1/p2<2,p1和p2为互质的正奇数,则公式(1)、(2)和(5)***关于平衡点集合
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(ω)为斜对称矩阵,即
无人机姿态运动学方程为:
公式(2)中为无人机的四元数,
公式(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),无人机姿态控制***的数学模型改写为:
公式(4)中干扰
D(t)=[D1(t),D2(t),D3(t)]T=J-1[d1(t),d2(t),d3(t)]T;
(3)、设计有限时间观测器并将传感器时时采集到的位置数据传输到有限时间控制算法模块中,使得无人机姿态实现在有限时间内镇定到由***的平衡点组成的集合;
针对步骤(1)中的公式(1)、(2),设计有限时间控制器:
公式(5)中,其中k1、k2、k3为常数,且k3>0, 1<p=p1/p2<2,p1和p2为互质的正奇数,则公式(1)、(2)和(5)***关于平衡点集合
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 true CN110032205A (zh) | 2019-07-19 |
CN110032205B 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) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113342033A (zh) * | 2021-05-26 | 2021-09-03 | 南京航空航天大学 | 基于固定时间技术的固定翼无人机姿态同步容错控制方法 |
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 |
---|
CHUNYANG FU 等: "Finite-time trajectory tracking control for a 12-rotor unmanned aerial vehicle with input saturation", 《ISA TRANSACTIONS》 * |
QIANG QU 等: "Fault tolerant control for UAV with finite-time convergence", 《THE 26TH CHINESE CONTROL AND DECISION CONFERENCE (2014 CCDC)》 * |
丁世宏 等: "有限时间控制问题综述", 《控制与决策》 * |
周映江 等: "基于滑模方法的分布式多无人机编队控制", 《信息与控制》 * |
朱文武 等: "基于有限时间姿态控制算法的四旋翼飞行器悬停控制", 《***科学与数学》 * |
王世峰 等: "基于有限时间收敛ESO的四旋翼无人机控制", 《中南大学学报(自然科学版)》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113342033A (zh) * | 2021-05-26 | 2021-09-03 | 南京航空航天大学 | 基于固定时间技术的固定翼无人机姿态同步容错控制方法 |
CN113342033B (zh) * | 2021-05-26 | 2022-10-04 | 南京航空航天大学 | 基于固定时间技术的固定翼无人机姿态同步容错控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110032205B (zh) | 2021-09-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105479459B (zh) | 机器人零力控制方法以及*** | |
CN105911866B (zh) | 四旋翼无人飞行器的有限时间全阶滑模控制方法 | |
CN107479370A (zh) | 一种基于非奇异终端滑模的四旋翼无人机有限时间自适应控制方法 | |
CN108037662B (zh) | 一种基于积分滑模障碍李雅普诺夫函数的四旋翼飞行器输出受限反步控制方法 | |
CN107479371A (zh) | 一种基于快速非奇异终端滑模的四旋翼无人机有限时间自适应控制方法 | |
CN104850122B (zh) | 基于可变船长比的抵抗侧风无人水面艇直线路径跟踪方法 | |
CN107688295A (zh) | 一种基于快速终端滑模的四旋翼飞行器有限时间自适应控制方法 | |
CN107831670B (zh) | 一种基于非对称时不变障碍李雅普诺夫函数的四旋翼飞行器输出受限反步控制方法 | |
CN104571120A (zh) | 四旋翼无人机的姿态非线性自适应控制方法 | |
CN114265308B (zh) | 一种自主水面航行器的抗饱和无模型预设性能轨迹跟踪控制方法 | |
CN113359459B (zh) | 旋翼飞行器滑模变结构的姿态控制方法 | |
CN110673611A (zh) | 一种基于事件触发方案和t-s模糊***的欠驱动无人艇控制方法 | |
CN103433924A (zh) | 串联机器人高精度位置控制方法 | |
CN105353790B (zh) | 一种空间绳系机器人目标抓捕后复合体稳定控制方法 | |
CN111874266A (zh) | 一种刚体航天器的抗退绕滑模姿态机动控制方法及*** | |
CN110543184A (zh) | 一种刚性飞行器的固定时间神经网络控制方法 | |
CN103389650A (zh) | 四通道遥操作***的双边未知死区自适应控制*** | |
CN111496796A (zh) | 基于指令滤波器的机械臂轨迹跟踪控制方法及装置 | |
CN110032205A (zh) | 一种具有抗干扰能力的无人机姿态控制方法 | |
CN111413996B (zh) | 一种基于事件触发eso的四旋翼保性能轨迹跟踪控制方法 | |
CN114200949A (zh) | 一种液体火箭三发动机摆动布局方法及控制方法 | |
CN107831775A (zh) | 基于挠性航天器无角速度测量的姿态控制方法 | |
CN115951693B (zh) | 一种欠驱动水下机器人鲁棒轨迹跟踪控制方法 | |
CN112305917A (zh) | 充液航天器的固定时间终端滑模鲁棒容错控制方法及装置 | |
CN109752957B (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 |