[发明专利]基于给定时间的四旋翼无人机高精度姿态跟踪控制方法有效
申请号: | 201810097850.6 | 申请日: | 2018-01-31 |
公开(公告)号: | CN108181920B | 公开(公告)日: | 2021-08-31 |
发明(设计)人: | 田栢苓;刘丽红;马宇昕;崔婕 | 申请(专利权)人: | 天津大学 |
主分类号: | G05D1/08 | 分类号: | G05D1/08 |
代理公司: | 天津市北洋有限责任专利代理事务所 12201 | 代理人: | 刘国威 |
地址: | 300072*** | 国省代码: | 天津;12 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 基于 给定 时间 四旋翼 无人机 高精度 姿态 跟踪 控制 方法 | ||
1.一种基于给定时间的四旋翼无人机高精度姿态跟踪控制方法,其特征是,步骤如下:
第一部分,面向控制的四旋翼无人机姿态模型建立:考虑四旋翼无人机的固有特性及飞行中的动力学因素,建立四旋翼无人机的姿态数学模型,对模型进行增广处理,获得基于增广系统的四旋翼无人机面向控制模型;
第二部分,给定时间时变滑模面设计:设计基于给定时间和姿态跟踪误差初值的时变高阶多项式,为了保证姿态跟踪收敛时间的可控性,通过求解多项式参数,使得时变高阶多项式及其各阶导数在给定时间内收敛到零,在此基础上,构建基于时变高阶多项式和四旋翼无人机姿态跟踪误差的时变滑模面,使得四旋翼无人机姿态跟踪系统的初始状态位于时变滑模面上;
第三部分,给定时间高精度连续控制器设计:对时变滑模面求导,综合利用等速趋近律和幂次趋近律推导四旋翼无人机的虚拟姿态控制律,确保无人机姿态跟踪误差在给定时间内快速收敛,为获得实际工程应用的连续控制律,对设计的给定时间虚拟姿态控制律进行零初始条件下积分,得到用于四旋翼无人机控制的连续控制律。
2.如权利要求1所述的基于给定时间的四旋翼无人机高精度姿态跟踪控制方法,其特征是,
第一步,面向控制的四旋翼无人机姿态模型建立,考虑四旋翼无人机的固有特性,无人机在飞行过程中的动力学因素及受力平衡关系,建立四旋翼无人机的姿态数学模型如下
其中,表示无人机的姿态角向量,φ为俯仰角,θ为滚转角,为偏航角;Ω=[ωx,ωy,ωz]T表示无人机的姿态角速度;I=diag[Ixx,Iyy,Izz]表示无人机惯性矩阵参数,τ=[τ1,τ2,τ3]T为无人机控制力矩,△模拟无人机实际飞行过程中可能遇到的外界风干扰,变换矩阵W定义如下
针对式(1),引入中间变量
x1=Θ,x2=WΩ (2)
假定无人机飞行过程中的期望姿态角定义姿态角跟踪误差向量
由式(1)、(2)及(3)可知,四旋翼无人机姿态跟踪误差的动态系统表示为
其中,τ'为待设计的四旋翼无人机虚拟姿态控制律,△'为系统的综合干扰,为了获得满足工程应用的连续控制信号,对姿态误差模型进行增广处理,引入中间变量
e3=τ'+△' (5)
由此可以得到基于增广系统的四旋翼无人机误差动态系统
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于天津大学,未经天津大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201810097850.6/1.html,转载请声明来源钻瓜专利网。