CN106094860B - 四旋翼飞行器及其控制方法 - Google Patents
四旋翼飞行器及其控制方法 Download PDFInfo
- Publication number
- CN106094860B CN106094860B CN201610753026.2A CN201610753026A CN106094860B CN 106094860 B CN106094860 B CN 106094860B CN 201610753026 A CN201610753026 A CN 201610753026A CN 106094860 B CN106094860 B CN 106094860B
- Authority
- CN
- China
- Prior art keywords
- fuzzy
- layer
- control
- quadrotor
- pid
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 28
- 210000002569 neuron Anatomy 0.000 claims abstract description 47
- 230000001105 regulatory effect Effects 0.000 claims abstract description 22
- 230000001133 acceleration Effects 0.000 claims description 18
- 230000006870 function Effects 0.000 claims description 18
- 230000004913 activation Effects 0.000 claims description 12
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 claims description 9
- 238000013528 artificial neural network Methods 0.000 claims description 7
- 238000006243 chemical reaction Methods 0.000 claims description 6
- 230000005484 gravity Effects 0.000 claims description 6
- 230000008569 process Effects 0.000 claims description 5
- 230000001537 neural effect Effects 0.000 claims description 4
- 238000013461 design Methods 0.000 claims description 3
- 230000009977 dual effect Effects 0.000 claims description 3
- 238000013178 mathematical model Methods 0.000 claims description 3
- 239000011159 matrix material Substances 0.000 claims description 3
- 238000005096 rolling process Methods 0.000 claims description 3
- 210000005036 nerve Anatomy 0.000 claims 1
- 238000004891 communication Methods 0.000 abstract description 11
- 230000000694 effects Effects 0.000 abstract description 6
- 230000005611 electricity Effects 0.000 description 8
- 238000010586 diagram Methods 0.000 description 6
- 230000005389 magnetism Effects 0.000 description 6
- 238000005259 measurement Methods 0.000 description 5
- 238000002474 experimental method Methods 0.000 description 4
- 230000002045 lasting effect Effects 0.000 description 4
- 238000012360 testing method Methods 0.000 description 4
- 230000008901 benefit Effects 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 230000000052 comparative effect Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 230000006978 adaptation Effects 0.000 description 1
- 230000003044 adaptive effect Effects 0.000 description 1
- 230000001276 controlling effect Effects 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000004069 differentiation Effects 0.000 description 1
- 230000036039 immunity Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004044 response Effects 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
-
- 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/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
Abstract
本发明提供一种四旋翼飞行器及其控制方法,所述四旋翼飞行器包括机体和飞行器控器模块,还包括分别与所述飞行器控模块连接的导航与惯性测量模块、电源模块、通信模块和电机驱动模块,所述主控制器模块综合计算所述导航与惯性测量模块所反馈的实时飞行姿态信息和通信模块的控制信息后输出电机控制信号以控制电机驱动模块。本发明的四旋翼飞行器能够自动适应外界环境的变化以调制飞行参数来达到预定的控制效果,其中的控制方法主要由飞行控制器模块采用基于神经模糊自整定PID控制方案,计算实际的输出控制量,以提高飞行器的飞行鲁棒性。
Description
技术领域
本发明涉及飞行器技术领域,具体涉及到四旋翼飞行器及其控制方法。
背景技术
四旋翼飞行器有6个自由度,通过四个独立电机驱动螺旋桨产生升力、推力,从而使四旋翼飞行器实现空中悬停和改变飞行姿态,是一类多输入多输出、强耦合、欠驱动非线性***。PID控制因其简单,稳定性好,较好的鲁棒性且技术相对其他控制算法比较成熟,仍然是目前大多数飞行器首选的控制算法。但是由于四旋翼飞行器本身的不确定性以及飞行过程中外部的干扰等,使PID控制中的参数无法自调整,从而影响飞行器的飞行姿态,难以达到实际的预期。
发明内容
本发明旨在解决现有技术中存在的技术问题。
为此,本发明提供一种四旋翼飞行器及其控制方法,其是基于神经网络生成模糊规则与PID(Proportion Integration Differentiation)控制相结合的控制方法来控制四旋翼飞行器,使得飞行器抗干扰能力得到加强,自身鲁棒性得到提高,在受到外部干扰时能够实时的对飞行器的飞行姿态进行自调整。
一种四旋翼飞行器,包括机体和飞行控制器模块还包括分别与所述飞行控制模块连接的导航与惯性测量模块、电源模块、通信模块和电机驱动模块,其特征在于所述电源模块为飞行器提供电能;所述导航与测量模块包括卫星导航***、三轴加速度计、陀螺仪和磁力计,所述卫星导航***对飞行器的实时位置进行测量定位,所述三轴加速度计用于测量飞行器的线加速度,所述陀螺仪用于测量飞行器的角加速度,所述磁力计用于测量飞行器所处位置的地磁强度;所述通信模块还用于与地面控制站进行数据交换;所述飞行器控制模块获取飞行器的所述线加速度、角加速度、实时位置及磁力强度数据信息以及获取由地面控制站通过所述通信模块输入的控制信息后并计算转换成电机控制信号输出以控制所述电机驱动模块,所述电机驱动模块包括电调和电机,所述电调接收所述电机控制信号以控制所述电机工作。
本发明提供的四旋翼飞行器中,主控制器模块是控制***的核心部分,其作用是是每个控制周期内实时采集处理导航与惯性测量单元的线加速度、角加速度、实时位置及磁力强度数据信息以及获取由地面控制站通过所述通信模块输入的控制信息,并根据预定的信号处理算法,求解出飞行器当前的位置与姿态角,而后结合神经模糊自整定PID控制方案,计算每个电机的实际的驱动量,进而通过电调控制4个电机的转速,通过电机转速的改变使4个旋翼产生的升力和转矩产生相应的变化,从而使飞行器能够结合外部的干扰进行自适应调整以实现稳定飞行,达到预期的飞行效果。
进一步的,所述飞行器控制***还将飞行器的所述线加速度、角加速度、实时位置及磁力强度数据信息通过所述通信模块发送至地面控制中心。如此,可以方便地面控制中心的控制人员实时掌握当前的飞行参数信息,为进一步控制飞行器提供参照。
所述四旋翼飞行器的飞行控制方法,主要由所述飞行控制器模块来执行,具体包括以下步骤:
S10:建立四旋翼飞行器的动力学模型,设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,θ、φ、ψ分别为飞行器的俯仰姿态角、滚转姿态角、偏航姿态角,通过牛顿-欧拉方程和坐标转换矩阵建立飞行器的动力学的数学模型如式(1)
S20:设计基于神经模糊自整定PID控制方式,
由四旋翼飞行器的动力学方程(1)转换成四个独立的控制通道,该飞行控制器控制这四个独立的控制通道,这四个通道分别由高度神经模糊PID、翻滚神经模糊PID、俯仰神经模糊PID、偏航神经模糊PID组成,经过控制量的转换控制,调节四个旋翼的转速来达到飞行姿态的控制;具体为
设一个双输入、单输出的神经网络模糊***,其使用的是单向传播的多层前向神经网络,它的输入数据从输入层,先后依次经过各隐含层节点,最后从输出层的输出节点得到输出数据,因此
设神经网络输入层有2个节点,第二层有6个节点第三层有9个节点,第二层有5个节点;设f表示节点的净输入,a为激活值函数即节点输出,则
第一层为神经元节点表示模糊控制器的输入信号,完成对误差e以及误差变化率ec的接受;连接权重那么
a=f
第二层表示输入信号语言变量的语言值,是对输入数据的模糊化,即将输入数据转换成模糊量,表达为一个隶属函数。对于第一层的两个输入x1、x2每个都定义了三个语言值(模糊子集),则每个神经元的输出相对应的是隶属函数,该层节点的激活函数为可微的高斯函数
a=ef
式中cij、σij表示第i个输入xi的语言变量的第j个语言值的高斯隶属函数的中心和宽度,把第二层的权重作为cij;
第三层、第四层完成模糊***的模糊推理的过程,以表示模糊控制规则,由于,两个输入的语言变量分别定义了三个语言值,故有3×3=9条规则,而输出语言变量则定义了五个语言变量,如PB、PS、ZO、NS、NB,每个语言变量分别表示正大、正小、零、负小、负大,其规则如下:
if x1 is P1 and x2 is P2 then y is NB
if x1 is P1 and x2 is Z2 then y is NS
……
if x1 is N1 and x2 is N2 then y is PB
其中,第三层完成模糊规则的模糊前件,当输入分别为x′1和x′2,则前两层即可计算出分别对两个输入的各模糊子集的隶属度:P1(x′1)、Z1(x′1)、N1(x′1)和P2(x′2),Z2(x′2),N2(x′2),形成第一条规则的激活强度为:
min[P1(x′1),P2(x′2)]或者P1(x′1)P2(x′2)
设有p个输入信号,则第三层节点也有p输入,即:
a=f
定义该层的连接权重为1;
第四层完成模糊规则的后件,把输入到第四层同一个神经元的激活规则进行综合,同时输出模糊量
a=min(1,f)
定义该层连接权重为1;
第五层完成去模糊化,将模糊量清晰化,并输出控制量,定义第四层第i个神经元代表的模糊子集隶属函数的中心和宽度分别为ci和σi,采用重心法进行解模糊:
神经模糊自调整PID根据输入信号偏差e和ec的大小、方向以及变化趋势等特征,通过模糊推理做出相应决策,在线调整PID参数kp,ki,kd以满足不同时刻对参数的不同要求,其中控制器为参数增量式PID控制器,在初始化PID控制器参数的基础上加上神经模糊控制器对PID参数在线调整,即
这样由以上公式确定了PID控制所需要的最佳的kp,ki,kd参数,从而实现了参数自整定。
将最佳的Kp、Ki、Kd参数输送到电调以控制电机调节四个旋翼的转速。
本发明的四旋翼飞行器采用基于神经模糊自整定PID的控制方法可以随外界干扰变化的影响,实时更新整定Kp、Ki、Kd参数,实现参数自整定,解决了传统PID控制不能实时自适应参数调整的缺陷,更好地实现飞行器飞行中受到外部环境干扰下的姿态控制,提高了***的抗扰性和鲁棒性。
附图说明
本发明的上述和/或附加的方面和优点从结合下面附图对实施例的描述中将变得明显和容易理解,其中:
图1为本发明的四旋翼飞行器整体结构示意图。
图2为本发明的四旋翼飞行器主要模块构成示意图。
图3为本发明的四旋翼飞行器控制方法中的神经网络模糊***结构示意图
图4为本发明的四旋翼飞行器控制方法中的飞行控制关系示意图。
图5为本发明的四旋翼飞行器控制方法的控制过程示意图。
图6为本发明的四旋翼飞行器无干扰神经模糊PID自整定下的姿态角。
图7为本发明的四旋翼飞行器为有持续干扰下神经模糊PID自整定下飞行器的姿态角。
图8为本发明的四旋翼飞行器无干扰常规PID自整定下的姿态角。
图9为本发明的四旋翼飞行器有持续干扰下常规PID自整定下飞行器的姿态角。
图10为本发明的四旋翼飞行器控制方法下的鲁棒性测试对比。
图11现有四旋翼飞行器在常规PID控制方法下的鲁棒性测试对比。
具体实施方式
为了能够更清楚地理解本发明的上述目的、特征和优点,下面结合附图和具体实施方式对本发明进行进一步的详细描述。需要说明的是,在不冲突的情况下,本申请的实施例及实施例中的特征可以相互组合。
在下面的描述中阐述了很多具体细节以便于充分理解本发明,但是,本发明还可以采用其他不同于在此描述的方式来实施,因此,本发明的保护范围并不受下面公开的具体实施例的限制。
下面参照图1-2对本发明实施例的四旋翼飞行器做进一步的描述。
如图1和图2所示,四旋翼飞行器100包括机体10和固定在机体10上的飞行器控制模块20,还包括固定在机体10的四个悬臂上的四个电机驱动模块60及由电机驱动模块的电机驱动的旋翼70,另外,如图2所示,四旋翼飞行器还包括分别与所述飞行器控制模块20连接的导航、惯性测量模块40、电源模块50、通信模块30和电机驱动模块60,其中所述电源模块50与所述飞行控制器模块20连接并为飞行器提供电能;所述导航、测量模块40包括GPS导航、三轴加速度计、陀螺仪和磁力计,所述GPS导航对飞行器的实时位置进行测量定位,所述三轴加速度计用于测量飞行器的线加速度,所述陀螺仪用于测量飞行器的角加速度,所述磁力计用于测量飞行器所处位置的地磁强度;所述通信模块30与所述飞行控制模块20连接,并与地面控制站进行数据交换;所述飞行器控制模块20还分别与所述导航、惯性测量单元40及电机驱动模块60连接,所述飞行器控制模块获取飞行器的所述线加速度、角加速度、实时位置及磁力强度数据信息以及获取由地面控制站通过所述通信模块输入的控制信息并计算转换成电机控制信号输出以控制所述电机驱动模块60,所述电机驱动模块60包括1个四合一电调(电机调速器)和4个无刷电机,所述电调接收所述电机控制信号后控制所述电机工作,即通过根据飞行器主控制器模块20给电子调速器的控制量,进而控制4个电机的转速,通过分别改变电机转速使得4个旋翼产生的升力和转矩产生相应的变化。
四旋翼飞行器的飞行器控制模块的计算中心,其作用是每个控制周期内实时采集处理导航、惯性测量单元的线加速度、角加速度、实时位置及磁力强度数据,根据预定的信号处理算法,求解出飞行器当前的位置与姿态角,而后结合神经模糊自整定PID控制方案,计算每个电机的实际的驱动量,从而使飞行器能够稳定飞行。
一个具体的实施例,其中飞行器控制***20还将飞行器的所述线加速度、角加速度、实时位置及磁力强度数据信息通过所述通信模块发送至地面控制中心.。
所述四旋翼飞行器的飞行控制模块综合计算实时姿态信息和控制信号信息后输出电机控制信号以控制飞行器飞行的方法包括以下步骤:
S10:建立四旋翼飞行器的动力学模型,设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,θ、φ、ψ分别为飞行器的俯仰姿态角、滚转姿态角、偏航姿态角,通过牛顿-欧拉方程和坐标转换矩阵建立飞行器的动力学的数学模型如式(1)
S20:设计基于神经模糊自整定PID控制方式,
由四旋翼飞行器的动力学方程(1)转换成四个独立的控制通道,该飞行控制器控制这四个独立的控制通道,这四个通道分别由高度神经模糊PID、翻滚神经模糊PID、俯仰神经模糊PID、偏航神经模糊PID组成,经过控制量的转换控制,调节四个旋翼的转速来达到飞行姿态的控制;具体为设一个双输入、单输出的神经网络模糊***,其使用的是单向传播的多层前向神经网络,它的输入数据从输入层,先后依次经过各隐含层节点,最后从输出层的输出节点得到输出数据,因此如图3所示,设神经网络输入层有2个节点,第二层有6个节点第三层有9个节点,第二层有5个节点;设f表示节点的净输入,a为激活值函数即节点输出,则
第一层为神经元节点表示模糊控制器的输入信号,完成对误差e以及误差变化率ec的接受;连接权重那么
a=f
第二层表示输入信号语言变量的语言值,是对输入数据的模糊化,即将输入数据转换成模糊量,表达为一个隶属函数。对于第一层两个输入x1、x2每个都定义了三个语言值(模糊子集),则每个神经元的输出相对应的是隶属函数,该层节点的激活函数为可微的高斯函数
a=ef
式中cij、σij表示第i个输入xi的语言变量的第j个语言值的高斯隶属函数的中心和宽度,把第二层的权重作为cij;
第三层、第四层完成模糊***的模糊推理的过程,以表示模糊控制规则,由于,两个输入的语言变量分别定义了三个语言值,故有3×3=9条规则,而输出语言变量则定义了五个语言变量,如PB、PS、ZO、NS、NB,每个语言变量分别表示正大、正小、零、负小、负大,其规则如下:
if x1 is P1 and x2 is P2 then y is NB
if x1 is P1 and x2 is Z2 then y is NS
……
if x1 is N1 and x2 is N2 then y is PB
其中,第三层完成模糊规则的模糊前件,当输入分别为x′1和x′2,则前两层计算出它们分别对两个输入的各模糊子集的隶属度:P1(x′1)、Z1(x′1)、N1(x′1)和P2(x′2),Z2(x′2),N2(x′2),形成第一条规则的激活强度为:
min[P1(x′1),P2(x′2)]或者P1(x′1)P2(x′2)
设有p个输入信号,则第三层节点也有p输入,即:
a=f
定义该层的连接权重为1;
第四层完成模糊规则的后件,把输入到第四层同一个神经元的激活规则进行综合,同时输出模糊量
a=min(1,f)
定义该层连接权重为1;
第五层完成去模糊化,将模糊量清晰化,并输出控制量,定义第四层第i个神经元代表的模糊子集隶属函数的中心和宽度分别为ci和σi,采用重心法进行解模糊:
如图5所示神经模糊自调整PID根据输入信号偏差e和ec的大小、方向以及变化趋势等特征,通过模糊推理做出相应决策,在线调整PID参数kp,ki,kd以满足不同时刻对参数的不同要求,其中控制器为参数增量式PID控制器,在初始化PID控制器参数的基础上加上神经模糊控制器对PID参数在线调整,即
这样由以上公式确定了PID控制所需要的最佳的kp,ki,kd参数,从而实现了参数自整定。
将最佳的Kp、Ki、Kd参数输送到电调以控制电机调节四个旋翼的转速。
图4为为四旋翼飞行器控制方法中的飞行控制关系示意图,利用MATLAB的simulink仿真模块搭建的四旋翼飞行器的姿态控制模型,利用该模型检验验证神经模糊PID控制算法对四旋翼飞行器姿态控制的性能,如***的阶跃响应并以此观察***动稳态性能,***的抗干扰性,***的鲁棒性,且通过与常规PID控制对比来说明神经模糊PID控制的优越性。
为了验证本发明提出的四旋翼飞行器及其控制方法的控制效果,利用搭建的四旋翼飞行器样机进行实验。分别进行了多个方案实验,具体如下:
控制性能对比实验:
设计了相应的常规PID控制器,与本发明提出的基于神经模糊自整定PID控制下的四旋翼飞行器控制方法进行对比实验。在实验中,首先完成了在无干扰的情况下,神经模糊自整定PID控制和常规PID控制下的四旋翼飞行器姿态角的跟踪实验。对应的飞行效果如图6,图8所示。然后进行在有持续干扰下,神经模糊自整定PID控制和常规PID控制下的四旋翼飞行器抗扰性能对比,如图7,图9所示。基于神经网络生成模糊规则自整定PID控制和常规PID控制下的四旋翼飞行器鲁棒性能对比,如图10和图11所示。
通过仿真可知,神经模糊能够自调整kp,ki,kd参数,寻找到最优参数,从而使被控对象能够很快达到跟踪值。通过仿真验证与计算,神经模糊自整定PID控制下飞行器姿态角(偏航角、俯仰角、滚转角)的超调分别为14%、5%、6%比常规PID控制下飞行器的姿态角(偏航角、俯仰角、滚转角)分别为30%、13%、10.9%要小,且神经模糊PID控制下***姿态角的上升时间和调节时间分别为0.8、0.2、0.2和1.63、0.3、0.36,而常规PID控制下的***姿态角的上升时间和调节时间分别为1.8、0.24、0.32和1.14、1.05、1.06,故神经模糊PID控制***的***动态性能更好。从图7,图9可知,当加入持续的干扰信号时,神经模糊PID控制下的姿态角出现轻微变化,相对于常规PID控制下的姿态角的变化要弱得很,故神经模糊PID控制的抗扰性要优于常规PID控制。从图10,图11可知,当改变***参数时神经模糊PID控制下***的姿态角的变化不是很明显,而常规PID的变化则相对明显,变化比较大,故神经模糊PID控制***的鲁棒性要优于常规PID控制。
综上,神经模糊PID控制下的四旋翼飞行器的姿态稳定性优于传统PID控制。
以上仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的创造性精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (1)
1.一种四旋翼飞行器的飞行控制方法,包括以下步骤:
S10:建立四旋翼飞行器的动力学模型,设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,θ、φ、ψ分别为飞行器的俯仰姿态角、滚转姿态角、偏航姿态角,通过牛顿-欧拉方程和坐标转换矩阵建立飞行器的动力学的数学模型如式(1)
S20:设计基于神经模糊自整定PID控制方式,
由四旋翼飞行器的动力学方程(1)转换成四个独立的控制通道,该飞行控制器控制这四个独立的控制通道,这四个通道分别由高度神经模糊PID、翻滚神经模糊PID、俯仰神经模糊PID、偏航神经模糊PID组成,经过控制量的转换控制,调节四个旋翼的转速来达到飞行姿态的控制;具体为
设一个双输入、单输出的神经网络模糊***,其使用的是单向传播的多层前向神经网络,它的输入数据从输入层,先后依次经过各隐含层节点,最后从输出层的输出节点得到输出数据,因此
设神经网络输入层有2个节点,第二层有6个节点第三层有9个节点,第二层有5个节点;设f表示节点的净输入,a为激活值函数即节点输出,则
第一层为神经元节点表示模糊控制器的输入信号,完成对误差e以及误差变化率ec的接受;连接权重那么
其中,i=1,2
a=f
第二层表示输入信号语言变量的语言值,是对输入数据的模糊化,即将输入数据转换成模糊量,表达为一个隶属函数,对于第一层的两个输入x1、x2每个都定义了三个语言值即模糊子集,则每个神经元的输出相对应的是隶属函数,该层节点的激活函数为可微的高斯函数
a=ef
式中cij、σij表示第i个输入xi的语言变量的第j个语言值的高斯隶属函数的中心和宽度,把第二层的权重作为cij;
第三层、第四层完成模糊***的模糊推理的过程,以表示模糊控制规则,由于,两个输入的语言变量分别定义了三个语言值,故有3×3=9条规则,而输出语言变量则定义了五个语言变量,如PB、PS、ZO、NS、NB,每个语言变量分别表示正大、正小、零、负小、负大,其规则如下:
if x1is P1and x2is P2then y is NB
if x1is P1and x2is Z2then y is NS
……
if x1is N1and x2is N2then y is PB
其中,第三层完成模糊规则的模糊前件,当输入分别为x′1和x′2,则前两层计算出它们分别对两个输入的各模糊子集的隶属度:P1(x′1)、Z1(x′1)、N1(x′1)和P2(x′2),Z2(x′2),N2(x′2),形成第一条规则的激活强度为:
min[P1(x′1),P2(x′2)]或者P1(x′1)P2(x′2)
设有p个输入信号,则第三层节点也有p输入,即:
a=f
定义该层的连接权重为1;
第四层完成模糊规则的后件,把输入到第四层同一个神经元的激活规则进行综合,同时输出模糊量
a=min(1,f)
定义该层连接权重为1;
第五层完成去模糊化,将模糊量清晰化,并输出控制量,定义第四层第i个神经元代表的模糊子集隶属函数的中心和宽度分别为ci和σi,采用重心法进行解模糊:
神经模糊自调整PID根据输入信号偏差e和ec的大小、方向以及变化趋势等特征,通过模糊推理做出相应决策,在线调整PID参数kp,ki,kd以满足不同时刻对参数的不同要求,其中控制器为参数增量式PID控制器,在初始化PID控制器参数的基础上加上神经模糊控制器对PID参数在线调整,即
这样由以上公式确定了PID控制所需要的最佳的kp,ki,kd参数,从而实现了参数自整定。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610753026.2A CN106094860B (zh) | 2016-08-29 | 2016-08-29 | 四旋翼飞行器及其控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610753026.2A CN106094860B (zh) | 2016-08-29 | 2016-08-29 | 四旋翼飞行器及其控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106094860A CN106094860A (zh) | 2016-11-09 |
CN106094860B true CN106094860B (zh) | 2019-02-19 |
Family
ID=57223844
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610753026.2A Active CN106094860B (zh) | 2016-08-29 | 2016-08-29 | 四旋翼飞行器及其控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106094860B (zh) |
Families Citing this family (21)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106483968B (zh) * | 2016-12-13 | 2023-05-05 | 桂林理工大学南宁分校 | 一种用于无人机自动降落的地表面识别装置 |
CN106595577B (zh) * | 2016-12-29 | 2019-12-31 | 中国航天电子技术研究院 | 一种强风条件下四旋翼无人机高度测量方法 |
CN107054675B (zh) * | 2017-03-15 | 2019-07-05 | 上海交通大学 | 一种微型叠层式四旋翼飞行控制器 |
CN107145154B (zh) * | 2017-05-17 | 2020-04-07 | 北京理工大学 | 一种用于控制飞行器姿态角的控制***及其控制方法 |
CN112520051A (zh) * | 2017-09-11 | 2021-03-19 | 深圳市大疆创新科技有限公司 | 云台相机及具有该云台相机的无人机 |
CN107607112A (zh) * | 2017-09-13 | 2018-01-19 | 哈尔滨工业大学 | 飞行器用低成本位姿测量装置及测量方法 |
CN108803641B (zh) * | 2018-06-08 | 2022-08-05 | 深圳臻迪信息技术有限公司 | 飞行控制方法及飞行器 |
CN109062049B (zh) * | 2018-08-20 | 2019-09-24 | 西北工业大学 | 基于集总复合估计的严格反馈***神经网络控制方法 |
CN108762098B (zh) * | 2018-08-20 | 2019-11-01 | 西北工业大学 | 基于复合学习的非最小相位飞行器神经网络控制方法 |
CN108828957B (zh) * | 2018-08-20 | 2019-11-05 | 西北工业大学 | 基于切换机制的飞行器全局有限时间神经网络控制方法 |
CN109062234B (zh) * | 2018-08-20 | 2019-11-05 | 西北工业大学 | 一种非最小相位飞行器复合学习滑模控制方法 |
CN108897227B (zh) * | 2018-08-20 | 2019-09-24 | 西北工业大学 | 非线性严格反馈***全局有限时间神经网络控制方法 |
CN108663940B (zh) * | 2018-08-20 | 2019-09-24 | 西北工业大学 | 基于集总复合估计的飞行器神经网络学习控制方法 |
CN109495199B (zh) * | 2018-10-30 | 2021-07-13 | 航天恒星科技有限公司 | 一种基于半实物仿真的fpga参数调试*** |
CN109358654B (zh) * | 2018-11-16 | 2022-03-29 | 江苏科技大学 | 一种水空两栖搜救支援无人飞行器*** |
CN110333733A (zh) * | 2019-08-02 | 2019-10-15 | 南京信息工程大学 | 一种四旋翼飞行器的串级变论域模糊pid姿态控制***及方法 |
CN110723309A (zh) * | 2019-08-27 | 2020-01-24 | 广东工业大学 | 一种四旋翼无人机转动惯量测量方法 |
CN110690918B (zh) * | 2019-09-28 | 2021-09-03 | 西南电子技术研究所(中国电子科技集团公司第十研究所) | 航天测控链路参数调整的方法 |
CN111221346A (zh) * | 2020-02-28 | 2020-06-02 | 中国人民解放军陆军军事交通学院汽车士官学校 | 人群搜索算法优化pid控制四旋翼飞行器飞行的方法 |
CN111781820B (zh) * | 2020-07-24 | 2023-06-02 | 滨州学院 | 基于重心动力学的航模pid算法控制方法 |
CN112306069A (zh) * | 2020-10-22 | 2021-02-02 | 杭州瓦屋科技有限公司 | 一种植保无人机高程航线控制优化方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102830622A (zh) * | 2012-09-05 | 2012-12-19 | 北京理工大学 | 一种四旋翼飞行器自抗扰自动飞行控制方法 |
CN103853156A (zh) * | 2014-02-07 | 2014-06-11 | 中山大学 | 一种基于机载传感器的小型四旋翼飞行器控制***及方法 |
CN103868521A (zh) * | 2014-02-20 | 2014-06-18 | 天津大学 | 基于激光雷达的四旋翼无人机自主定位及控制方法 |
CN105242679A (zh) * | 2015-10-22 | 2016-01-13 | 电子科技大学 | 一种四旋翼飞行器的控制***设计方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8060340B2 (en) * | 2002-04-18 | 2011-11-15 | Cleveland State University | Controllers, observers, and applications thereof |
-
2016
- 2016-08-29 CN CN201610753026.2A patent/CN106094860B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102830622A (zh) * | 2012-09-05 | 2012-12-19 | 北京理工大学 | 一种四旋翼飞行器自抗扰自动飞行控制方法 |
CN103853156A (zh) * | 2014-02-07 | 2014-06-11 | 中山大学 | 一种基于机载传感器的小型四旋翼飞行器控制***及方法 |
CN103868521A (zh) * | 2014-02-20 | 2014-06-18 | 天津大学 | 基于激光雷达的四旋翼无人机自主定位及控制方法 |
CN105242679A (zh) * | 2015-10-22 | 2016-01-13 | 电子科技大学 | 一种四旋翼飞行器的控制***设计方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106094860A (zh) | 2016-11-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106094860B (zh) | 四旋翼飞行器及其控制方法 | |
CN106647781B (zh) | 基于重复控制补偿神经模糊pid四旋翼飞行器的控制方法 | |
Madani et al. | Adaptive control via backstepping technique and neural networks of a quadrotor helicopter | |
Castillo et al. | Real-time stabilization and tracking of a four-rotor mini rotorcraft | |
CN105159305B (zh) | 一种基于滑模变结构的四旋翼飞行控制方法 | |
CN108445766A (zh) | 基于rpd-smc和rise的无模型四旋翼无人机轨迹跟踪控制器及方法 | |
Zhang et al. | Three-dimensional fuzzy control of mini quadrotor UAV trajectory tracking under impact of wind disturbance | |
CN106054922A (zh) | 一种无人机‑无人车联合编队协同控制方法 | |
CN109597303A (zh) | 一种复合式旋翼飞行器全模式飞行控制方法 | |
CN104765272A (zh) | 一种基于pid神经元网络控制(pidnn)的四旋翼飞行器控制方法 | |
CN106707749B (zh) | 一种针对仿生扑翼飞行机器人的控制方法 | |
CN106200665A (zh) | 携带不确定负载的四轴飞行器的建模与自适应控制方法 | |
Lin et al. | Adaptive flight control design for quadrotor UAV based on dynamic inversion and neural networks | |
Yildiz et al. | Adaptive nonlinear hierarchical control of a quad tilt-wing UAV | |
Yacef et al. | Adaptive fuzzy backstepping control for trajectory tracking of unmanned aerial quadrotor | |
CN108638068A (zh) | 一种携带冗余度机械臂的飞行机器人控制***设计方法 | |
Sun et al. | Nonlinear robust compensation method for trajectory tracking control of quadrotors | |
CN111459188A (zh) | 一种基于四元数的多旋翼非线性飞行控制方法 | |
Willis et al. | State-dependent LQR control for a tilt-rotor UAV | |
dos Santos et al. | An experimental validation of reinforcement learning applied to the position control of UAVs | |
CN106292297B (zh) | 基于pid控制器和l1自适应控制器的姿态控制方法 | |
Al-Younes et al. | Attitude stabilization of quadrotor UAV using backstepping fuzzy logic & backstepping least-mean-square controllers | |
CN113867374A (zh) | 基于滑模控制的四旋翼无人机参数预测和扰动的自适应轨迹跟踪控制器及其设计方法 | |
Xu et al. | Modelling and hovering control of a novel multi-tandem ducted fan vehicle | |
CN111897219A (zh) | 基于在线逼近器的倾转四旋翼无人机过渡飞行模式最优鲁棒控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |