[发明专利]一种基于自适应有限时间控制的四旋翼飞行器控制方法有效
| 申请号: | 201910516347.4 | 申请日: | 2019-06-14 |
| 公开(公告)号: | CN110275542B | 公开(公告)日: | 2022-04-08 |
| 发明(设计)人: | 都海波;吴笛;周俊;温广辉;朱文武;程盈盈;金小峥 | 申请(专利权)人: | 合肥工业大学 |
| 主分类号: | G05D1/08 | 分类号: | G05D1/08;G05D1/10 |
| 代理公司: | 合肥和瑞知识产权代理事务所(普通合伙) 34118 | 代理人: | 王挺;李伟 |
| 地址: | 230009 *** | 国省代码: | 安徽;34 |
| 权利要求书: | 查看更多 | 说明书: | 查看更多 |
| 摘要: | |||
| 搜索关键词: | 一种 基于 自适应 有限 时间 控制 四旋翼 飞行器 方法 | ||
1.一种基于自适应有限时间控制的四旋翼飞行器控制方法,其特征在于,包括以下步骤:
S1、建立四旋翼飞行器系统模型,所述四旋翼飞行器系统模型包括位置子系统模型和姿态子系统模型;
S2、设计四旋翼飞行器自适应有限时间位置控制器;
S3、设计四旋翼飞行器自适应有限时间姿态控制器;
S4、根据所设计的位置控制器、姿态控制器来控制飞行器的电机转速从而控制飞行器的飞行;
S1的具体操作步骤包括:
S11、通过下述方程对位置子系统模型进行描述:
χ=(x,y,z)T∈R3表示四旋翼飞行器的实际位置,Φ=(φ,θ,ψ)T∈R3表示四旋翼飞行器的实际欧拉角姿态,R3表示三维的向量空间,其中,
x表示四旋翼飞行器的x坐标,表示x的一阶导数,表示x的二阶导数;y表示四旋翼飞行器的y坐标,表示y的一阶导数,表示y的二阶导数;z表示四旋翼飞行器的z坐标,表示z的一阶导数,表示z的二阶导数;φ表示四旋翼飞行器的横滚角,θ表示四旋翼飞行器的俯仰角,ψ表示四旋翼飞行器的偏航角;m表示四旋翼飞行器的质量,g表示重力加速度,T表示由四旋翼飞行器产生的总的升力,K1,K2,K3表示空气动力阻尼系数;
S12、通过下述方程对姿态子系统模型进行描述:
其中,表示φ的一阶导数,表示φ的二阶导数;表示θ的一阶导数,表示θ的二阶导数;表示ψ的一阶导数,表示ψ的二阶导数;
l表示四旋翼飞行器中心到电机轴线之间的距离,c为恒定的力矩系数,τ=(τ1,τ2,τ3)∈R3表示由电机转动产生的力矩,K4,K5,K6表示空气动力阻尼系数,d=(d1(t),d2(t),d3(t))∈R3表示未知的时变外部扰动,J1,J2,J3表示转动惯量;
S2包括如下具体操作步骤:
通过下述公式对自适应有限时间位置控制器进行描述:
其中,ux为x通道的虚拟控制信号,uy为y通道的虚拟控制信号,uz为z通道的虚拟控制信号;xd表示四旋翼无人机的x轴期望位置,yd表示四旋翼无人机的y轴期望位置,zd表示四旋翼无人机的z轴期望位置;为xd的一阶导数,为xd的二阶导数,为yd的一阶导数,为yd的二阶导数,为zd的一阶导数,为zd的二阶导数,α1、α2、kp、kd均为控制器参数,且0<α1<1,α2=2α1/(1+α1),kp>0,kd>0;
γ1,γ2,λ1,λ2为控制器参数,0.5<γ1<1,γ2=2γ1-1,λ1,λ2是合适的正增益,分别是对坐标x,y,z的估计值,分别是的一阶导数,分别是的一阶导数,为空气动力阻尼系数的估计值;
m表示四旋翼飞行器的质量,g表示重力加速度,T表示由四旋翼飞行器产生的总的升力;
S3的具体操作步骤包括:
通过下述公式对自适应有限时间姿态控制器进行描述:
其中,φ表示四旋翼飞行器的横滚角,表示φ的一阶导数,表示φ的二阶导数;θ表示四旋翼飞行器的俯仰角,表示θ的一阶导数,表示θ的二阶导数;ψ表示四旋翼飞行器的偏航角,表示ψ的一阶导数,表示ψ的二阶导数;φd为期望的横滚角,θd为期望的俯仰角,ψd=0为期望的偏航角;
l表示飞行器中心到电机轴线之间的距离,c为恒定的力矩系数,τ=(τ1,τ2,τ3)∈R3表示由电机转动产生的力矩,是空气动力阻尼系数的已知部分,是转动惯量的已知部分;
为φd的一阶导数,为φd的二阶导数,为θd的一阶导数,为θd的二阶导数,为ψd的一阶导数,为ψd的二阶导数,β1、β2、ap、ad均为控制器参数,且0<β1<1,β2=2β1/(1+β1),ap>0,ad>0;
ρ1,ρ2为控制器参数,ρ2>L2,0<p<1为常数,L2为正常数,且满足分别是对的观测值,分别是φ,θ,ψ的一阶导数,是对总干扰di,i=φ,θ,ψ,的观测值,是的一阶导数。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于合肥工业大学,未经合肥工业大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201910516347.4/1.html,转载请声明来源钻瓜专利网。
- 上一篇:利用自动起飞改进噪声的优化轨迹
- 下一篇:一种基于多旋翼无人机避障方法





