基于改进MPC-PID的四旋翼飞行器控制方法技术

本发明专利技术提出了一种基于改进MPC‑PID的四旋翼飞行器控制方法，其步骤为：首先，根据四旋翼飞行器结构及力学原理建立四旋翼飞行器的动力学模型，并结合小扰动原理在悬停点对动力学模型进行线性化转化为状态空间形式；其次，设计四旋翼飞行器的控制系统，包括改进MPC控制器和不完全微分PID控制器，并根据不同通道分别设计相应的控制器；最后，利用本发明专利技术的控制系统对四旋翼飞行器进行仿真实验，使机体稳定飞行至预先设定的空间位置。本发明专利技术根据不同通道采用改进MPC控制的外环控制器和不完全微分PID控制的内环控制器，使得控制器具有更快的响应速度与动态性能，更够更好的应用于实际工程。

Control Method of Four-Rotor Aircraft Based on Improved MPC-PID

【技术实现步骤摘要】
基于改进MPC-PID的四旋翼飞行器控制方法
本专利技术涉及自动控制
，特别是指一种基于改进MPC-PID的四旋翼飞行器控制方法。
技术介绍
四旋翼飞行器具有灵活性高，安全性强，控制方式多样等优点，随着近年来传感器技术和微处理器的不断发展，四旋翼飞行器也越来越广泛的应用到各个行业之中，如航拍摄影、违章拍照、仪器检测、疑犯追踪等。而上述应用场景均对四旋翼飞行器的稳定控制有着基本要求，由于四旋翼飞行器各个通道之间相互耦合，且工作环境易受到阵风干扰，因此四旋翼飞行器的位姿控制是其能否广泛应用的关键一环。串级PID控制是目前四旋翼飞行器最为常用的控制方法之一，其设计简单、应用场景多且易于实现，但PID控制也有着动态性能较差，易引起超调等等，在对四旋翼飞行器性能要求较高的场景下无法使用。
技术实现思路
针对现有的四旋翼飞行器的控制方法存在的动态性能较差的技术问题，本专利技术提出一种基于改进MPC-PID的四旋翼飞行器控制方法，通过外环采用改进模型预测控制方法，内环采用PID控制方法，能够提供一种动态性能好、响应速度快且精度高的控制方法，实现对四旋翼飞行器的稳定控制。本专利技术的技术方案是这样实现的：一种基于改进MPC-PID的四旋翼飞行器控制方法，其步骤如下：S1、根据四旋翼飞行器结构及力学原理，建立四旋翼飞行器的动力学模型；S2、结合小扰动原理，在悬停点将四旋翼飞行器的动力学模型转化为线性化模型，并将线性化模型转化为状态空间方程；S3、将机体的状态空间方程通过矩阵转化得到各个通道的传递函数，通道包括高度z通道、水平x通道、水平y通道、俯仰θ通道、横滚通道和偏航ψ通道；S4、设计MPC控制器，并通过引入比例函数和加权平均系数对MPC控制器进行改进，得到改进MPC控制器模型，设计PID控制器，将低通滤波器与PID控制器串联得到不完全微分PID控制器；S5、设置四旋翼飞行器的高度z通道、水平x通道和水平y通道的期望值，初始化偏航ψ通道的期望值和输出值，初始化高度z通道、水平x通道、水平y通道、俯仰θ通道和横滚通道的输出值；S6、计算高度z通道的期望值与其当前值的误差z1、水平x通道的期望值与其当前值的误差x1、水平y通道的期望值与其当前值的误差y1、偏航ψ通道的期望值与其当前值的误差ψ1；S7、将步骤S6中得到的误差z1输入改进MPC控制器模型中得到油门输入量t1，将步骤S6中得到的误差x1输入改进MPC控制器模型中得到俯仰θ通道的期望值，将步骤S6中得到的误差y1输入改进MPC控制器模型中得到横滚通道的期望值，将步骤S6中得到的误差ψ1输入改进MPC控制器中得到油门输入量t4；S8、计算步骤S7中得到的俯仰θ通道的期望值与其当前值的误差θ1、步骤S7中得到的横滚通道的期望值与其当前值的误差S9、将步骤S8中得到误差θ1输入不完全微分PID控制器得到油门输入量t2，将步骤S8中得到的误差输入不完全微分PID控制器得到油门输入量t3；S10、将油门输入量t1、油门输入量t2、油门输入量t3和油门输入量t4通过矩阵转换得到力矩U1,U2,U3,U4，并将力矩U1,U2,U3,U4输入四旋翼动力学模型中更新步骤S5中的高度z通道、水平x通道、水平y通道、俯仰θ通道、横滚通道和偏航ψ通道的输出值；S11、循环执行步骤S6至S10直到各个通道的输出值稳定在各个通道的期望值时结束循环。优选地，步骤S1中建立的四旋翼飞行器的动力学模型为：其中，(x,y,z)为四旋翼飞行器空间坐标，为x对时间的导数，为y对时间的导数，为z对时间的导数，u、v、w分别为x方向、y方向和z方向上的线速度，为u对时间的导数，为v对时间的导数，为w对时间的导数，θ、ψ均为四旋翼的姿态角，p为姿态角θ的角速度，q为姿态角的角速度，r为姿态角ψ的角速度，b为电机拉力系数，d为电机阻力系数，Ix、Iy、Iz分别为x方向、y方向和z方向上的扭矩，U1,U2,U3,U4分别为高度z通道、水平x通道、水平y通道和偏航ψ通道上的力矩，ωi为电机转速，为电机加速度，i＝1,2,3,4，Ts为电机时间常数，k为电机增益系数，Vi为电机占空比，g为重力加速度。优选地，所述步骤S2的线性化模型为：其中，X为状态向量，X包含空间坐标x、y、z，线速度u、v、w，姿态角θ、ψ和角速度p、q、r组成的向量，为X对时间的导数，t为四旋翼飞行器的动力学模型的油门输入量；对线性化模型进行泰勒展开并保留一次项即可得到四旋翼飞行器的状态空间方程：其中，A、B均为函数矩阵，A＝[ΔXf1,…,ΔXfn]T，B＝[Δtf1,…,Δtfn]T，X＝Xe，t＝te，Xe为平衡点的状态量，te为平衡点的油门输入量，ΔXfn是函数fn关于X一次项微分算子的行向量，Δtfn是函数fn关于t一次项微分算子的行向量，n为函数矩阵的大小。优选地，所述对状态空间方程进行Laplace变换得到步骤S3中的传递函数模型：G(s)＝(sI-A)-1B，其中，A、B均为函数矩阵，I为单位矩阵。优选地，所述水平x通道对应的改进MPC控制器模型的设计方法为：S51、对水平x通道的传递函数模型进行Laplace反变换，得到离散脉冲响应序列形式的脉冲响应模型：其中，y(k+1)为k+1时刻系统的输出，u(k)为k时刻系统的输入，l1,l2,...,lN为系统脉冲响应序列值，ζ(k+1)为k+1时刻系统的随机干扰，N为脉冲响应序列长度；系统的输入为k时刻的俯仰角θ的期望值，系统的输出为k+1时刻的水平x通道的输出值，系统和MPC控制器构成反馈回路；S52、根据步骤S51的脉冲响应模型可得水平x通道对应的MPC控制器模型为：y1(k+j)＝lj(z-1)u(k+j-1)(8)，其中，j＝1,2,...,P，P为预测时域；将MPC控制器模型展开，得到：其中，M为控制时域，M≤P≤N；由于控制时域为M，则在经历过k+M-1个时刻后，控制量不再发生变化，因此公式(9)可变为：Y1(k+1)＝DU(k)+GU(k-1)(10)，其中，为预测未来P个时刻的系统输出，U(k)为待求P-M+1个控制量，U(k-1)为N-1个已知控制量，S53、增加MPC控制器模型输出误差项对MPC控制器模型进行改进：其中，Y2(k+1)为系统输出预测矢量，e(k)为k时刻预测模型输出误差，y(k)为k时刻系统输出，a＝[a1,a2...ap]T为输出误差矩阵；S54、选择对控制量加权的二次型性能指标评价MPC控制器模型的性能：其中，r(k+j)为水平x方向的期望值，qj为输出误差加权系数，rm为控制误差加权系数；将性能指标转化为矩阵形式：其中，Q＝diag[q1,q2...qP]为输出加权矩阵，R＝diag[r1,r2...rM]为控制加权矩阵，U(k)待求控制量矩阵；S55、对性能指标的矩阵形式中的U(k)进行求导，令可得：U(k)＝(DTQD+R)-1DTQ[R(k+1)-GU(k-1)-ae(k)](14)，利用第一个控制量替代M个控制量作为有效值去控制系统，则公式(14)可转化为：其中，dT＝(1,0,...)(DTQD+R)-1DTQ＝(d1,d2,...,dP)，u(k)为待求控制量；S56、比例函数为：F(x)＝L[r(k)-y(k)]/r(k本文档来自技高网...

【技术保护点】
1.一种基于改进MPC‑PID的四旋翼飞行器控制方法，其特征在于，其步骤如下：S1、根据四旋翼飞行器结构及力学原理，建立四旋翼飞行器的动力学模型；S2、结合小扰动原理，在悬停点将四旋翼飞行器的动力学模型转化为线性化模型，并将线性化模型转化为状态空间方程；S3、将机体的状态空间方程通过矩阵转化得到各个通道的传递函数，通道包括高度z通道、水平x通道、水平y通道、俯仰θ通道、横滚

【技术特征摘要】
1.一种基于改进MPC-PID的四旋翼飞行器控制方法，其特征在于，其步骤如下：S1、根据四旋翼飞行器结构及力学原理，建立四旋翼飞行器的动力学模型；S2、结合小扰动原理，在悬停点将四旋翼飞行器的动力学模型转化为线性化模型，并将线性化模型转化为状态空间方程；S3、将机体的状态空间方程通过矩阵转化得到各个通道的传递函数，通道包括高度z通道、水平x通道、水平y通道、俯仰θ通道、横滚通道和偏航ψ通道；S4、设计MPC控制器，并通过引入比例函数和加权平均系数对MPC控制器进行改进，得到改进MPC控制器模型，设计PID控制器，将低通滤波器与PID控制器串联得到不完全微分PID控制器；S5、设置四旋翼飞行器的高度z通道、水平x通道和水平y通道的期望值，初始化偏航ψ通道的期望值和输出值，初始化高度z通道、水平x通道、水平y通道、俯仰θ通道和横滚通道的输出值；S6、计算高度z通道的期望值与其当前值的误差z1、水平x通道的期望值与其当前值的误差x1、水平y通道的期望值与其当前值的误差y1、偏航ψ通道的期望值与其当前值的误差ψ1；S7、将步骤S6中得到的误差z1输入改进MPC控制器模型中得到油门输入量t1，将步骤S6中得到的误差x1输入改进MPC控制器模型中得到俯仰θ通道的期望值，将步骤S6中得到的误差y1输入改进MPC控制器模型中得到横滚通道的期望值，将步骤S6中得到的误差ψ1输入改进MPC控制器中得到油门输入量t4；S8、计算步骤S7中得到的俯仰θ通道的期望值与其当前值的误差θ1、步骤S7中得到的横滚通道的期望值与其当前值的误差S9、将步骤S8中得到误差θ1输入不完全微分PID控制器得到油门输入量t2，将步骤S8中得到的误差输入不完全微分PID控制器得到油门输入量t3；S10、将油门输入量t1、油门输入量t2、油门输入量t3和油门输入量t4通过矩阵转换得到力矩U1,U2,U3,U4，并将力矩U1,U2,U3,U4输入四旋翼动力学模型中更新步骤S5中的高度z通道、水平x通道、水平y通道、俯仰θ通道、横滚通道和偏航ψ通道的输出值；S11、循环执行步骤S6至S10直到各个通道的输出值稳定在各个通道的期望值时结束循环。2.根据权利要求1所述的基于改进MPC-PID的四旋翼飞行器控制方法，其特征在于，步骤S1中建立的四旋翼飞行器的动力学模型为：其中，(x,y,z)为四旋翼飞行器空间坐标，为x对时间的导数，为y对时间的导数，为z对时间的导数，u、v、w分别为x方向、y方向和z方向上的线速度，为u对时间的导数，为v对时间的导数，为w对时间的导数，θ、ψ均为四旋翼的姿态角，p为姿态角θ的角速度，q为姿态角的角速度，r为姿态角ψ的角速度，b为电机拉力系数，d为电机阻力系数，Ix、Iy、Iz分别为x方向、y方向和z方向上的扭矩，U1,U2,U3,U4分别为高度z通道、水平x通道、水平y通道和偏航ψ通道上的力矩，ωi为电机转速，为电机加速度，i＝1,2,3,4，Ts为电机时间常数，k为电机增益系数，Vi为电机占空比，g为重力加速度。3.根据权利要求1所述的基于改进MPC-PID的四旋翼飞行器控制方法，其特征在于，所述步骤S2的线性化模型为：其中，X为状态向量，X包含空间坐标x、y、z，线速度u、v、w，姿态角θ、ψ和角速度p、q、r组成的向量，为X对时间的导数，t为四旋翼飞行器的动力学模型的油门输入量；对线性化模型进行泰勒展开并保留一次项即可得到四旋翼飞行器的状态空间方程：其中，A、B均为函数矩阵，A＝[ΔXf1,…,ΔXfn]T，B＝[Δtf1,…,Δtfn]T，X＝Xe，t＝te，Xe为平衡点的状态量，te为平衡点的油门输入量，ΔXfn是函数fn关于X一次项微分算子的行向量，Δtfn是函数fn关于t一次项微分算子的行向量，n为函数矩阵的大小。4.根据权利要求1或3所述的基于改进MPC-PID的四旋翼飞行器控制方法，其特征在于，所述对状态空间方程进行Laplace变换得到步骤S3中的传递函数模型：G(s)＝(sI-A)-1B，其中，A、B均为函数矩阵，I为单位矩阵。5.根据权利要求4所述的基于改进MPC-PID的四旋翼飞行器控制方法，其特征在于，所述水平x通道对应的改进...

【专利技术属性】
技术研发人员：王辉，王建辉，王晟硕，张九江，刘红霞，王才东，张德海，吴深，费致根，肖艳秋，
申请(专利权)人：郑州轻工业学院，
类型：发明
国别省市：河南,41