本发明涉及无人飞行器技术领域,具体涉及到四旋翼无人飞行器的飞行控制方法。
背景技术:
四旋翼飞行器有6个自由度,通过四个独立电机驱动螺旋桨产生升力、推力,从而使四旋翼飞行器实现空中悬停和改变飞行姿态,是一类多输入多输出、强耦合、欠驱动非线性系统。且飞行系统要求无超调(或超调量较小)并且能够快速的跟踪输入指令,稳态时无静态误差,具有较强的抗干扰能力和对系统参数变化时,要有较强的鲁棒性。PID控制(Proportional-integral-derivative Control)因其简单,稳定性好,较好的鲁棒性且技术相对其他控制算法比较成熟,仍然是目前大多数飞行器首选的控制算法。但是由于四旋翼飞行器本身系统的不确定性以及飞行过程中受到外部的影响等,使PID控制中的参数无法自调整,从而影响飞行器的飞行姿态,且PID控制中飞行器系统的跟踪精度较低。
技术实现要素:
本发明旨在解决现有技术中存在的技术问题。
提供一种行之有效的控制方法,使得飞行器在受到外部干扰时能够实时的对飞行器的飞行姿态进行自调整,提高并改善飞行系统的跟踪精度。
本发明目的在于解决四旋翼无人机的飞行姿态控制方法中常规PID算法的PID参数的自调整过程误差大,以及跟踪精度不足的问题,提出了基于重复控制补偿神经模糊自整定PID的控制方法,以期提高四旋翼飞行器的飞行性能。
为实现上述目的,本发明提出的一种基基于重复控制补偿神经模糊PID四旋翼飞行器的控制方法,包括如下步骤:
S10:建立四旋翼无人机的动力学模型
根据四旋翼飞行器的飞行姿态,通过牛顿-欧拉方程和坐标转换矩阵建立飞行器的动力学的数学模型,其中动力学方程如式(1):
式中,m为四旋翼飞行器的质量,g为重力加速度,μx、μy、μz为X轴、Y轴、Z轴三个方向的空气阻力系数,Jx、Jz、Jz为四旋翼飞行器绕X轴、Y轴、Z轴的转动惯量,Ir为四旋翼飞行器的旋翼相对于旋转轴的转动惯量,l为旋翼中心点到坐四旋翼飞行器质量中心的距离w1、w2、w3为飞行器的角速度,x、y、z为飞行器的位置,Ωi(i=1,2,3,4)为各个旋翼的转速,θ、φ、ψ为飞行器的3个姿态角(俯仰、滚转、偏航)。
由式(1)的四旋翼飞行器的动力学方程转换成四个独立的控制通道Ui(i=1,2,3,4),通过控制这四个独立的控制通道,这四个通道分别由高度重复控制补偿神经模糊PID,翻滚重复控制补偿神经模糊PID,俯仰重复控制补偿神经模糊PID,偏航重复控制补偿神经模糊PID组成;
S20:基于重复补偿神经模糊PID控制
S21:设计由神经网络生成模糊推理(规则)并能够自调整PID参数的网络结构
设计一个双输入、单输出的神经网络模糊系统,并设定其使用单向传播的多层前向神经网络,它的输入数据从输入层,先后依次经过各隐含层节点,最后从输出层的输出节点得到输出数据,其中各层之间限定如下:
第一层为神经元节点,表示模糊控制器的输入信号,完成对误差e以及误差变化率ec的接受;
第二层表示输入信号语言变量的语言值,是对输入数据的模糊化,即将输入数据转换成模糊量,表达为一个隶属函数;
第三层和第四层完成模糊系统的模糊推理的过程,这两层表示模糊控制规则,其中,第三层完成模糊规则的模糊前件,第四层完成模糊规则的后件,进行模糊推理并输出模糊量;
第五层完成去模糊化,将模糊量清晰化,并输出控制量;
神经模糊自调整PID根据输入信号偏差e和ec的大小、方向以及变化趋势特征,通过神经模糊推理做出相应决策,在线调整PID参数kp,ki,kd以满足不同时刻对参数的不同要求,其中PID控制器为参数增量式控制器,在初始化PID控制器参数的基础上加上神经模糊控制器对PID参数在线调整,由以上算法确定PID控制所需要的最佳的kp,ki,kd参数,从而实现了参数自整定;
S22:重复补偿控制
将基于内模原理的重复控制嵌入到基于神经网络生成模糊推理自调整PID闭环控制中,形成基于重复补偿神经模糊PID控制。
本方法通过四旋翼飞行器的动力学方程转换成四个独立的控制通道,并通过设计由神经网络生成模糊推理(规则)并能够自调整PID参数的网络结构实现对PID控制所需的最佳kp,ki,kd参数自整定;通过重复补偿控制可以消除输出信号的跟踪误差,继而使系统在负载的控制输出下不会出现畸变,提升飞行器的姿态控制稳定性和控制精度。
具体的,所述基于内模原理的重复控制中,除了加到被控对象上的当前时刻的误差信号外还叠加了上一时刻的误差信号,形成具有时滞环节的正反馈,在时滞环节串联一低通滤波器,同时以期减小重复控制作用在高频段的增益。
再进一步的,所述重复控制得到的控制信号需经过延迟时间t后才输出,设置重复补偿控制器在所述延迟时间t内对低通滤波器的输出经过重复PID后再输出,且在再输出前进行补偿。
本发明的基于重复控制补偿神经模糊PID四旋翼飞行器的控制方法,基于内模原理的重复控制通过对控制误差的补偿,来减小误差,从而降低控制系统的稳态误差,抑制负载的扰动,重复控制系统中除了加到被控对象上的当前时刻的误差信号外还叠加了上一时刻的误差信号。由于重复控制是由具有时滞环节的正反馈构成的,系统的开环传递函数在虚轴上含有无数个极点,故系统对任何输入信号和干扰信号的系统误差趋于零,鲁棒性较强,而在时滞环节串联一个低通滤波器,同时以期减小重复控制作用在高频段的增益,进而保证了系统稳定性,即便系统内部出现干扰,在解除干扰对输出信号的影响所需要经过延迟的那段时间t内,将基于内模原理的重复控制嵌入到基于神经网络生成模糊推理自调整PID闭环控制中,形成基于重复补偿神经模糊PID控制,使得系统仍然处于闭环状态,干扰出现后的延迟时间t内,神经模糊PID对输出误差进行实时的控制调节,系统在稳定状态下时,重复补偿控制器的主要作用是进行调节,从而使稳态状态下输出信号能够很好地跟踪输入信号,当有较大的干扰时神经模糊PID能够调节输入信号,从而使信号误差减小,提升飞行器系统的跟踪精度。
附图说明
本发明的上述和/或附加的方面和优点从结合下面附图对实施例的描述中将变得明显和容易理解,其中:
图1为本发明的四旋翼无人飞行器整体结构示意图;
图2为本发明的四旋翼无人飞行器主要模块构成示意图;
图3为本发明的四旋翼飞行器控制方法中的神经网络模糊系统结构图;
图4为本发明的四旋翼飞行器控制方法中的神经模糊PID控制系统结构原理图;
图5为本发明的四旋翼飞行器控制方法中的重复控制系统原理图;
图6为本发明的四旋翼飞行器控制方法中的基于重复补偿的神经模糊PID控制系统框图;
图7为本发明的四旋翼飞行器控制方法中的四旋翼飞行器滚转角系统仿真框图;
图8为无干扰常规PID、神经模糊PID、重复补偿神经模糊PID控制下的滚转角的阶跃响应对比图;
图9为有持续干扰下常规PID、神经模糊PID、重复补偿神经模糊PID控制下的滚转角的阶跃响应自整定下飞行器的姿态角对比图;
图10为常规PID、神经模糊PID、重复补偿神经模糊PID跟踪性测试对比图;
图11为本发明的四旋翼飞行器控制方法的重复补偿神经模糊PID鲁棒性测试图;
图12为四旋翼飞行器姿态PID控制方法的PID鲁棒性测试图;
图13为四旋翼飞行器姿态神经模糊PID控制方法的神经模糊PID鲁棒性测试图。
具体实施方式
为了能够更清楚地理解本发明的上述目的、特征和优点,下面结合附图和具体实施方式对本发明进行进一步的详细描述。需要说明的是,在不冲突的情况下,本申请的实施例及实施例中的特征可以相互组合。
在下面的描述中阐述了很多具体细节以便于充分理解本发明,但是,本发明还可以采用其他不同于在此描述的方式来实施,因此,本发明的保护范围并不受下面公开的具体实施例的限制。
下面参照图1-2对本发明实施例的四旋翼无人飞行器做进一步的描述。
如图1和图2所示,四旋翼无人飞行器100包括机体10和固定在机体10上的飞行器控制模块20,还包括固定在机体10四个悬臂上的电机驱动模块60及由电机驱动的旋翼70,另外,如图2所示,四旋翼无人飞行器还包括安装在所述机体10上并分别与所述飞行器控制模块20连接的导航、惯性测量单元40、电源模块,还包括与飞行器控制模块20通信连接的通信模块30以及为飞行器控制模块供电的电源模块50;导航、惯性测量单元40采用高精度的GPS导航对四旋翼无人飞行器100进行跟踪定位,并向所述主控制器模块20提供位置信息并导航,且在导航过程中修改和固化波特率,另外还可以保存波特率的设置过程,惯性测量部分包括分别与所述主控制模块20连接的三轴加速度计、惯陀螺仪和磁力计,所述惯性测量单元用于检测飞行器的三轴线加速度、翻滚角速率、俯仰角速率、偏航角速率信息和地磁强度信息,这些信息共同构成四旋翼飞行器的飞行姿态数据;所述通信模块30主要是实时与地面站进行控制信号与状态信号数据交换,其包括遥控器、PPM解码器和PPM接收机,所述PPM编码器与所述遥控器连接,遥控器的四个通道控制信号将通过PPM编码器编码后无线传递给所述PPM接收机,所述PPM接收机与所述控制模块连接;所述电机驱动模块60包括用于驱动飞行器上四个旋翼70的四个电机以及分别控制所述四个电机(电机1、电机2、电机3和电机4)工作的电调(电子调速器),所述电调与所述飞行控制模块20连接以接收电机控制信号,所述电机驱动模块60根据飞行器控制模块20给电调的控制量,进而控制4个电机的转速,并实时测量4个电机的转速,通过电机转速的改变使4个旋翼产生的升力和转矩产生相应的变化。
导航、惯性测量单元40可以提供四旋翼无人机当前的位置信息以及三轴线加速度、翻滚角速率、俯仰角速率和偏航角速率等组成的姿态信息,飞行器控制模块20是四旋翼无人机100控制系统的核心部分,其作用是负责采集飞行器的姿态信息并实时解算,再根据检测到由遥控器所发出的飞行信息,结合基于重复控制补偿神经模糊PID四旋翼飞行器的控制方法的控制方案,计算实际的输出电机控制信号至电调,然后电调根据获得的控制信号控制4个电机的转速,从而实现对4个旋翼产生的升力和转矩的控制,电机可以通过PWM控制其转速从而达到对每个旋翼所产生的力和力矩的大小进行控制。
所述四旋翼无人飞行器的控制模块基于重复控制补偿神经模糊PID四旋翼飞行器的控制方法综合计算实时姿态信息和控制信号信息后输出电机控制信号以控制无人飞行器的方法包括以下步骤:
S10:建立四旋翼无人机的动力学模型
根据四旋翼飞行器的飞行姿态,通过牛顿-欧拉方程和坐标转换矩阵建立飞行器的动力学的数学模型,其中动力学方程如式(1):
式中,m为四旋翼飞行器的质量,g为重力加速度,μx、μy、μz为X轴、Y轴、Z轴三个方向的空气阻力系数,Jx、Jz、Jz为四旋翼飞行器绕X轴、Y轴、Z轴的转动惯量,Ir为四旋翼飞行器的旋翼相对于旋转轴的转动惯量,l为旋翼中心点到坐四旋翼飞行器质量中心的距离w1、w2、w3为飞行器的角速度,x、y、z为飞行器的位置,Ωi(i=1,2,3,4)为各个旋翼的转速,θ、φ、ψ为飞行器的3个姿态角(俯仰、滚转、偏航)。
由式(1)的四旋翼飞行器的动力学方程转换成四个独立的控制通道Ui(i=1,2,3,4),通过控制这四个独立的控制通道,这四个通道分别由高度重复控制补偿神经模糊PID,翻滚重复控制补偿神经模糊PID,俯仰重复控制补偿神经模糊PID,偏航重复控制补偿神经模糊PID组成;
S20:基于重复补偿神经模糊PID控制
S21:设计由神经网络生成模糊推理(规则)并能够自调整PID参数的网络结构
如图3所示,设计一个双输入、单输出的神经网络模糊系统,并设定其使用单向传播的多层前向神经网络,它的输入数据从输入层,先后依次经过各隐含层节点,最后从输出层的输出节点得到输出数据,其中各层之间限定如下:
第一层为神经元节点,表示模糊控制器的输入信号,完成对误差e以及误差变化率ec的接受;
第二层表示输入信号语言变量的语言值,是对输入数据的模糊化,即将输入数据转换成模糊量,表达为一个隶属函数;
第三层和第四层完成模糊系统的模糊推理的过程,这两层表示模糊控制规则,其中,第三层完成模糊规则的模糊前件,第四层完成模糊规则的后件,进行模糊推理并输出模糊量;
第五层完成去模糊化,将模糊量清晰化,并输出控制量;
如图4所示,神经模糊自调整PID根据误差e以及误差变化率ec输入信号的大小、方向以及变化趋势特征,通过神经模糊推理做出相应决策,在线调整PID参数kp,ki,kd以满足不同时刻对参数的不同要求,其中PID控制器为参数增量式控制器,在初始化PID控制器参数的基础上加上神经模糊控制器对PID参数在线调整,由以上算法确定PID控制所需要的最佳的kp,ki,kd参数,从而实现了参数自整定;
S22:重复补偿控制
将基于内模原理的重复控制嵌入到基于神经网络生成模糊推理自调整PID闭环控制中,形成基于重复补偿神经模糊PID控制。重复控制是Inoue基于内模原理在1981年提出来的,如图5所示,内模原理简单来说就是假如输入信号包含在一个稳定的闭环系统,被控对象的输出可以无误差的跟踪输入信号,重复控制具有较好的跟踪信号能力和鲁棒性,基于内模原理的重复控制对控制误差的补偿,来减小误差,从而降低控制系统的稳态误差,抑制负载的扰动。重复控制系统中除了加到被控对象上的当前时刻的误差信号外还叠加了上一时刻的误差信号,既图中的过去偏差。由于重复控制是由具有时滞环节的正反馈构成的,系统的开环传递函数在虚轴上含有无数个极点,故系统对任何输入信号和干扰信号的系统误差趋于零,鲁棒性较强,但是稳定性难以保证;另外尽管重复控制能够使输出信号跟踪输入信号,可其本身也存在问题,图6所示,重复控制得到的控制信号不是立刻输出,而是延迟某一时间才输出,假设系统内部有干扰,解除干扰对输出信号的影响则至少要经过延迟的那段时间。干扰出现后的延迟时间内,系统不会调节,在这段延迟时间内系统处于开环状态。把重复控制嵌入到基于神经网络生成模糊推理自调整PID闭环控制中,如图6所示,在神经网络生成模糊推理自调整PID闭环控制中加入一个重复补偿控制器,形成基于重复补偿神经模糊PID控制,在时滞环节串联一个带有延时环节的低通滤波器Q(s)*e-L,同时以期减小重复控制作用在高频段的增益,r为遥控器向飞行器控制模块的输入信号、e误差、de/dt误差变化量,e1为误差经过带有延时环节的低通滤波器的输出、e2为e1经过重复PID的输出、ue为重复控制的输出、up神经模糊PID控制的输出、u为飞行器控制模块20的控制输出,y为惯性测量单元40检测到的四旋翼无人飞行器当前姿态信息,补偿器T(s)*e-L将重复控制的输出ue进行正反馈。图6中重复补偿控制器可以消除输出信号的跟踪误差,继而使系统在负载的输出下不会出现畸变,神经模糊PID则对输出误差进行实时的控制调节;系统在稳定状态下时,重复补偿控制器的主要作用是进行调节,从而使稳态状态下输出信号能够很好地跟踪输入信号,当有较大的干扰时神经模糊PID能够调节输入信号,从而使信号误差减小。
为了验证本发明提出的控制方案效果可行性,利用搭建的四旋翼飞行器控制系统进行仿真验证。下面结合图9至13进一步说明本发明的效果。
控制性能对比实验
设计了相应的常规PID控制器和神经模糊PID控制器,与本发明提出的基于重复补偿神经模糊自整定PID控制下的四旋翼飞行器进行对比实验。在实验中,首先完成了在无干扰的情况下,重复补偿神经模糊自整定PID控制和常规PID控制以及神经模糊PID控制下的四旋翼飞行器滚转角的阶跃响应实验,滚转角系统仿真过程框图如图7所示。对应的仿真实验结果如图8所示。然后进行在有持续干扰下,重复补偿神经模糊自整定PID控制和常规PID控制以及神经模糊PID控制下的四旋翼飞行器抗扰性能对比,如图9所示。重复补偿神经模糊自整定PID控制和常规PID控制以及神经模糊PID控制下的四旋翼飞行器鲁棒性能对比,如图11、12、13所示。在正弦信号的输入下检测以上三种控制算法下四旋翼飞行器的跟踪性能测试,测试结果如图10所示。
在无干扰下对比仿真结果,如图8所示,可以看出,重复补偿神经模糊PID控制的超调量明显小于神经模糊PID的超调量以及常规PID控制的超调量,且其调节时间小于神经模糊PID的调节时间以及常规PID控制的调节时间,通过仿真对比结果可知,重复补偿控制神经模糊PID控制具有较好的响应动态性能。
在有干扰下对比仿真结果,如图9所示,可以看出,当加入持续性干扰时重复补偿神经模糊PID控制相对于神经模糊PID控制的扰动要小,而PID控制受扰动的影响的变化明显,因此重复补偿神经模糊PID具有较好的抗干扰性。
在正弦输入,三种控制器的仿真结果,如图10所示,重复补偿神经模糊PID的控制精度优于神经模糊PID的控制精度且明显优于常规PID的控制精度。因而重复补偿神经模糊PID控制器具有较好的跟踪性能在改变系统参数下。通过仿真观察重复补偿神经模糊PID控制器的鲁棒性,如图11、12、13所示,通过仿真实验对比可以得知重复补偿神经模糊PID控制器的鲁棒性明显优于常规PID控制器的鲁棒性。
通过仿真实验可知,在重复补偿神经模糊自整定PID控制下飞行系统的超调量较小并且能够快速的跟踪输入指令,稳态时无静态误差,具有较强的抗干扰能力和对系统参数变化时,有较好的鲁棒性。
以上仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的创造性精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。