CN104898429B - 一种基于自抗扰控制的三旋翼姿态控制方法 - Google Patents
一种基于自抗扰控制的三旋翼姿态控制方法 Download PDFInfo
- Publication number
- CN104898429B CN104898429B CN201510279597.2A CN201510279597A CN104898429B CN 104898429 B CN104898429 B CN 104898429B CN 201510279597 A CN201510279597 A CN 201510279597A CN 104898429 B CN104898429 B CN 104898429B
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- mtd
- mtr
- rotor
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 54
- 230000000694 effects Effects 0.000 claims abstract description 16
- 230000008569 process Effects 0.000 claims description 8
- 230000001133 acceleration Effects 0.000 claims description 5
- 230000001052 transient effect Effects 0.000 claims description 5
- 238000013016 damping Methods 0.000 claims description 4
- 238000012544 monitoring process Methods 0.000 claims description 4
- 230000005611 electricity Effects 0.000 claims description 3
- WHXSMMKQMYFTQS-UHFFFAOYSA-N Lithium Chemical compound [Li] WHXSMMKQMYFTQS-UHFFFAOYSA-N 0.000 claims description 2
- 230000005540 biological transmission Effects 0.000 claims description 2
- 230000008859 change Effects 0.000 claims description 2
- 230000003111 delayed effect Effects 0.000 claims description 2
- 238000006073 displacement reaction Methods 0.000 claims description 2
- 230000004927 fusion Effects 0.000 claims description 2
- 230000005484 gravity Effects 0.000 claims description 2
- 230000010354 integration Effects 0.000 claims description 2
- 229910052744 lithium Inorganic materials 0.000 claims description 2
- 238000012545 processing Methods 0.000 claims description 2
- 101710163391 ADP-ribosyl cyclase/cyclic ADP-ribose hydrolase Proteins 0.000 claims 1
- 230000001629 suppression Effects 0.000 claims 1
- 230000007704 transition Effects 0.000 claims 1
- 238000013461 design Methods 0.000 abstract description 4
- 238000011160 research Methods 0.000 description 4
- 230000032683 aging Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 230000008901 benefit Effects 0.000 description 2
- 238000010276 construction Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 241000208340 Araliaceae Species 0.000 description 1
- 235000005035 Panax pseudoginseng ssp. pseudoginseng Nutrition 0.000 description 1
- 235000003140 Panax quinquefolius Nutrition 0.000 description 1
- 230000003044 adaptive effect Effects 0.000 description 1
- 230000002411 adverse 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
- 230000007812 deficiency Effects 0.000 description 1
- 235000008434 ginseng Nutrition 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 230000009897 systematic effect Effects 0.000 description 1
Landscapes
- Feedback Control In General (AREA)
Abstract
一种基于自抗扰控制的三旋翼姿态控制方法,该方法包括确定三旋翼飞行器的数学模型;确定模型合适的输入输出变量;跟踪微分器的设计,扩张状态观测器的建立,非线性误差反馈率的选择。本发明采用的是基于Atmega2560的核心控制板作为执行模块通过驱动电路给电机供电,通过PWM波可以调节电机转速的大小;并且将一组由三轴陀螺仪传感器、加速度计、GPS、数字罗盘构成;而电源模块通过电源分配模块给各个模块提供合适的电压进行供电。针对三旋翼飞行器模型,通过调整各模块的参数使自抗扰控制方法有一个良好的效果。本发明通过一种自抗扰控制***,通过各个模块的设计及其参数的调整使三旋翼在空中能够保持一个良好的飞行状态。
Description
技术领域
本发明涉及一种三旋翼飞行器姿态控制的方法,具体涉及一种基于自抗扰控制技术的针对三旋翼模型的姿态控制的方法。
背景技术
在多旋翼飞行器姿态控制中,姿态控制方法的选取与设计无疑发挥着核心作用,并且控制方法的控制效果直接影响着姿态控制的精准度。但是,由于控制算法的不精确性、冗余以及工程范畴的影响,使得多旋翼飞行器在高空飞行各姿态中无法达到理想的状态,从而对自主航行与定位产生不利的影响。因此,如何在旋翼飞行器姿态控制上设计出合适的控制方法成为旋翼飞行器姿态控制上至关重要的一步。目前,针对具有对称结构的飞行器姿态控制问题主要有以下几种控制方法:PID控制法,LQR控制法,鲁棒控制法,Backstepping控制法,自适应控制法等。但是,针对不对称结构的多旋翼飞行器控制方法技术的研究还处于起步阶段,在工程上应用广泛的仍旧是PID控制方法,PID控制方法具有参数精简,时效性好,控制效果明显等优点,但是对于非线性模型,PID控制方法也有它的局限性,对于微小的角度时效性控制以及一些随机发生的外部干扰的控制不具有特别好的效果。所以,对于非线性模型,尤其是针对旋翼飞行器的控制方法的研究在当下成为多旋翼飞行器姿态控制研究的关键技术。
1988年韩京清先生正式提出ADRC(自抗扰控制技术)思想,目前已有大量学者积极致力于将ADRC应用于实际应用中,用其来解决实际控制工程的问题,同时,关于ADRC的内在机理和理论分析也在同步地不断深入研究。ADRC是基于经典PID的控制思想发展而来的,它汲取了PID控制思想精髓,并对其不足做出了改进:采用TD提取给定信号的微分信号;采用ESO对***不确定性(包括***未建模部分以及内外扰动)进行估计;根据ESO估计得出的不确定性对控制量进行实时补偿;ADRC可以处理大范围以及非线性、时变、耦合等复杂结构形式的不确定性***,控制器结构简单,并且可以保证闭环***良好的动态性能将状态误差以非线性加权形式进行组合。
发明内容
本发明的目的是提出一种基于ADRC(自抗扰控制技术),目的是为了针对一种结构的三旋翼在原有PID控制方法的基础上引入跟踪微分器(TD),扩张状态观测器(ESO),非线性误差反馈率(NLSEF)建立一套完整的三旋翼姿态控制方法。该方法既能对***模型中的不确定因素和外部干扰进行动态观测,又不影响控制器的控制品质,具有良好的鲁棒性和适应能力。
一种基于自抗扰控制技术的三旋翼姿态控制的方法,流程图如图1所示,包括以下步骤:
步骤一,三旋翼模型的机械结构确定,将这三旋翼模型的机械结构作为被控对象进行分析,确定被控对象的输入输出量及控制量:
式中,x、y、z表示飞行器在X,Y,Z轴上的位移偏移量,表示当前飞行器在X,Y,Z三个轴上角度的偏移量,即分别表示俯仰角,横滚角,偏移角;相应的,表示在X,Y,Z三个轴上的位移加速度,表示飞行器绕着三轴上的角加速度。u(1),u(2),u(3),u(4)则表示z轴和解耦后三个电机通过线性组合后对于三轴上姿态改变的直接输入量;Ix,Iy,Iz表示飞行器在X,Y,Z三个轴上的转动惯量;m,g分别表示飞行器的质量以及地球的重力加速度。
步骤二,通过自抗扰控制技术中的跟踪微分器(TD)对被控对象的参考输入安排过渡过程并提取它的微分信号;
式中分别表示跟踪微分器经过跟踪输入信号得出的两个输出跟踪信号;a为速度因子,a越大,其跟踪微分器输出x1就越接近原始信号,当a大到一定程度时候,微分输出x2会出现抖动的现象。γ和h为需要调节的参数,γ影响TD的跟踪速度,γ加大则跟踪加快,但是如果γ过大则跟踪的微分信号会出现超调,h为微积分步长,步长越小跟踪越精确。
步骤三,通过自抗扰控制技术中的扩张状态观测器(ESO)对三旋翼飞行器飞行状态中的不确定因素和外部干扰进行动态观测与估计;
为避免高频颤振现象的出现,式中取得函数fal(e,α,δ)在原点附近具有线性段的连续的幂次函数:
式中,y为控制***最后的输出值,z1,z2,z3为扩张状态观测器观测的三个输出值,α为0到1之间的常数,α越小,跟踪越快,但滤波效果会变差;δ为影响滤波效果的常数,δ越大,滤波效果越好;β01,β02,β03为可选取的参数。适当的增大β01可以抑制过渡过程中出现的超调,适当的增大β02可以加快响应速度,缩短过渡过程,β03还决定着对扰动估计滞后的大小,β03越大则扰动就越小,但β03过大的话会引起估计值振荡。通过对自抗扰控制器的每个模块进行设计和参数整定之后,用来控制飞行器的姿态。
步骤四,通过自抗扰控制中的非线性状态误差反馈律(NLSEF)来构成***的控制量。
为了更有效地把fhan(x1,x2,γ,h)用于状态反馈中,引入阻尼因子c来把fhan(x1,x2,γ,h)中的变量x2改成cx2,得fhan(x1,cx2,γ,h)。
步骤五,在控制过程中对各部分的参数进行调整,从而对三旋翼模型姿态控制有一个良好的效果。
在实施方法的过程中,在三旋翼飞行器上的惯导模块测量出飞行器此时的俯仰、横滚、偏航角,如图2所示,通过扩张状态观测器得出z1、z2、z3,z1、z2作为反馈量与输入量经过跟踪微分器的v1、v2的差值经过非线性状态误差反馈律运算与z3的差值通过倍数b0,得到模型的输入量,输入量通过PWM波控制三个电机的转速,对于已经解耦的三旋翼模型中,可以通过俯仰,横滚,偏航三个通道对于三旋翼模型实施姿态上的调整,从而达到理想的目标状态。
与现有技术相比,本发明的优点在于:
(1)本发明相比于传统的PID控制方法,自抗扰控制方法具有更好的跟踪信号的优势;并且针对于随机的白噪声抗干扰信号具有很好的抗干扰性;
(2)本发明对未知模型的***,以及非对称旋翼飞行器的姿态控制具有一定的有效性和时效性,通过跟踪微分器,非线性反馈率和扩张状态观测器的设计和运用从而提高了算法的自主性。
附图说明
图1为本发明所涉及的自抗扰控制器的结构图;
图2为本发明三通道解耦后基于ADRC控制方法示意图;
图3为本发明的模型的机械结构图;
图4为本发明硬件部分构成图;
图5为本发明执行机构工作示意图;
图中:1、螺旋桨,2、电机,3、机身,4、机盖,5、惯导模块,6、核心板,7、电池,8、电池架,9、支架。
具体实施方式
下面结合附图和具体实施方式对本发明做进一步说明。
图3为三旋翼模型的机械结构图,三旋翼外接圆的半径约为17cm,质量约2.0kg;三旋翼模型的机械结构包括螺旋桨(1)、电机(2)、机身(3)、机盖(4)、惯导模块(5)、核心板(6)、电池(7)、电池架(8)、支架(9);螺旋桨(1)与电机(2)相连;电机(2)安装在机身(3)上;螺旋桨(1)与电机(2)组成一组旋翼,布置在机身(3)上的三个旋翼中心与机身(3)的中心连线各成120度;电池(7)安装在机身(3)的底部;惯导模块(5)安装在机身(3)的顶部;核心板(6)安装在机身(3)的顶部中心;电池架(8)设置在机身(3)的底部四周。
本发明所述方法的硬件部分的示意图如图4所示,主要包括以下几个部分:
惯导模块用以实时监测飞行器在飞行过程中的位置和姿态,惯导模块由三轴陀螺仪传感器、GPS、罗盘、加速度计组成,其中三轴陀螺仪传感器和加速度计确定飞行器在飞行状态下的姿态,GPS和罗盘通过定位飞行器当前的绝对位置,实时监控飞行器的动向和相对位置。
执行模块的核心处理器为AVR公司的微型处理器Atmega2560,Atmega2560驱动电路通过发出PWM波使驱动电路驱动电机,使得电机灵活改变当前的转速从而调节飞行器的姿态。
电源模块锂电池供电,再通过电源分配模块使惯导模块、Atmega2560、驱动电路供电,针对不同模块采取不同电压值的供给,从而有效的使每个模块都能正常工作。
地面站通过3DRradio数据传输模块对于飞行器的当前位姿进行传输,再基于missionplanner的地面站显示当前飞行器的状态,地面站可以通过惯导模块所获得的当前飞行器的姿态的数据通过模块内部的位姿数据的融合监测飞行器当前的位姿以及供电***的电压电流的情况,并且可以通过地面站发出指令使飞行器飞到预定的地点。
工作原理如图5所示,当三旋翼飞行器在空中飞行时,为了保持其当前姿态(假设为悬停),此时,规定其三轴的预定的理想的角度,采集当前的三轴的角度,作为接下来进行自抗扰控制的模型数据,读取目标理想的悬停三轴角度作为控制***的输入值,针对当前采用ADRC的方法对当前三轴角进行控制方法的处理,获得每个电机需要增加或者减小的转速,每个输出量通过PWM波的形式来调整各个的转速,从而调整三旋翼飞行器的姿态。
类似于PID控制方法的P,I,D三个参数的调整,自抗扰控制方法也有参数调整的过程,首先调节状态观测器中的参数β01,β02,β03,再在微分***中,选择合适的过程曲线,使得微分***可以给出连续,无超调的跟踪信号;最后,选择合适的积分步长h,速度因子γ,阻尼因子c,最终可以获得较为满意的控制效果。
Claims (8)
1.一种基于自抗扰控制的三旋翼姿态控制方法,其特征在于:包括以下步骤,
步骤一,三旋翼模型的机械结构确定,将这三旋翼模型的机械结构作为被控对象进行分析,确定被控对象的输入输出量及控制量:
式中,x,y,z表示飞行器在X,Y,Z轴上的位移偏移量,θ,ψ表示当前飞行器在X,Y,Z三个轴上角度的偏移量,即分别表示俯仰角,横滚角,偏航角;相应的,表示在X,Y,Z三个轴上的位移加速度,表示飞行器绕着三轴上的角加速度;u(1),u(2),u(3),u(4)则表示Z轴和解耦后三个电机通过线性组合后对于三轴上姿态改变的直接输入量;Ix,Iy,Iz表示飞行器在X,Y,Z三个轴上的转动惯量;m,g分别表示飞行器的质量以及地球的重力加速度;
步骤二,通过自抗扰控制技术中的跟踪微分器TD对被控对象的参考输入安排过渡过程并提取它的微分信号;
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>d</mi>
<mo>=</mo>
<msup>
<mi>&gamma;h</mi>
<mn>2</mn>
</msup>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>a</mi>
<mn>0</mn>
</msub>
<mo>=</mo>
<msub>
<mi>hx</mi>
<mn>2</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>y</mi>
<mo>=</mo>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mi>a</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>a</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<msqrt>
<mrow>
<mi>d</mi>
<mrow>
<mo>(</mo>
<mi>d</mi>
<mo>+</mo>
<mn>8</mn>
<mo>|</mo>
<mi>y</mi>
<mo>|</mo>
<mo>)</mo>
</mrow>
</mrow>
</msqrt>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>a</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<msub>
<mi>a</mi>
<mn>0</mn>
</msub>
<mo>+</mo>
<mi>s</mi>
<mi>i</mi>
<mi>g</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>y</mi>
<mo>)</mo>
</mrow>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>a</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<mi>d</mi>
<mo>)</mo>
</mrow>
<mo>/</mo>
<mn>2</mn>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>a</mi>
<mo>=</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>a</mi>
<mn>0</mn>
</msub>
<mo>+</mo>
<mi>y</mi>
<mo>)</mo>
</mrow>
<mi>f</mi>
<mi>s</mi>
<mi>g</mi>
<mrow>
<mo>(</mo>
<mi>y</mi>
<mo>,</mo>
<mi>d</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>a</mi>
<mn>2</mn>
</msub>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<mi>f</mi>
<mi>s</mi>
<mi>g</mi>
<mo>(</mo>
<mrow>
<mi>y</mi>
<mo>,</mo>
<mi>d</mi>
</mrow>
<mo>)</mo>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>f</mi>
<mi>h</mi>
<mi>a</mi>
<mi>n</mi>
<mo>=</mo>
<mo>-</mo>
<mi>&gamma;</mi>
<mo>(</mo>
<mi>a</mi>
<mo>/</mo>
<mi>d</mi>
<mo>&CenterDot;</mo>
<mi>f</mi>
<mi>s</mi>
<mi>g</mi>
<mrow>
<mo>(</mo>
<mrow>
<mi>a</mi>
<mo>,</mo>
<mi>d</mi>
</mrow>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mi>&gamma;</mi>
<mi>s</mi>
<mi>i</mi>
<mi>g</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>a</mi>
<mo>)</mo>
</mrow>
<mrow>
<mo>(</mo>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>f</mi>
<mi>s</mi>
<mi>g</mi>
<mrow>
<mo>(</mo>
<mrow>
<mi>a</mi>
<mo>,</mo>
<mi>d</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>7</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>v</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>=</mo>
<msub>
<mover>
<mi>v</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>v</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<mi>f</mi>
<mi>h</mi>
<mi>a</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>,</mo>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mo>,</mo>
<mi>&gamma;</mi>
<mo>,</mo>
<mi>h</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>8</mn>
<mo>)</mo>
</mrow>
</mrow>
式中分别表示跟踪微分器经过跟踪输入信号得出的两个输出跟踪信号;a为速度因子,a越大,其跟踪微分器输出x1就越接近原始信号,当a大到一定程度时候,微分输出x2会出现抖动的现象;γ和h为需要调节的参数,γ影响TD的跟踪速度,γ加大则跟踪加快,但是如果γ过大则跟踪的微分信号会出现超调,h为微积分步长,步长越小跟踪越精确;
步骤三,通过自抗扰控制技术中的扩张状态观测器对三旋翼飞行器飞行状态中的不确定因素和外部干扰进行动态观测与估计;
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>e</mi>
<mo>=</mo>
<msub>
<mi>z</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<mi>y</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>z</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>=</mo>
<msub>
<mi>z</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mi>&beta;</mi>
<mn>01</mn>
</msub>
<mi>f</mi>
<mi>a</mi>
<mi>l</mi>
<mrow>
<mo>(</mo>
<mi>e</mi>
<mo>,</mo>
<mi>&alpha;</mi>
<mo>,</mo>
<mi>&delta;</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>z</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>=</mo>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
<mo>-</mo>
<msub>
<mi>&beta;</mi>
<mn>02</mn>
</msub>
<mi>f</mi>
<mi>a</mi>
<mi>l</mi>
<mrow>
<mo>(</mo>
<mi>e</mi>
<mo>,</mo>
<mi>&alpha;</mi>
<mo>,</mo>
<mi>&delta;</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>b</mi>
<mn>0</mn>
</msub>
<mi>u</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>z</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>3</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>&beta;</mi>
<mn>03</mn>
</msub>
<mi>f</mi>
<mi>a</mi>
<mi>l</mi>
<mrow>
<mo>(</mo>
<mi>e</mi>
<mo>,</mo>
<mi>&alpha;</mi>
<mo>,</mo>
<mi>&delta;</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>9</mn>
<mo>)</mo>
</mrow>
</mrow>
为避免高频颤振现象的出现,式中取得函数fal(e,α,δ)在原点附近具有线性段的连续的幂次函数:
<mrow>
<mi>f</mi>
<mi>a</mi>
<mi>l</mi>
<mrow>
<mo>(</mo>
<mi>e</mi>
<mo>,</mo>
<mi>&alpha;</mi>
<mo>,</mo>
<mi>&delta;</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>e</mi>
<mo>/</mo>
<msup>
<mi>&delta;</mi>
<mrow>
<mi>&alpha;</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
</mrow>
</mtd>
<mtd>
<mrow>
<mrow>
<mo>|</mo>
<mi>e</mi>
<mo>|</mo>
</mrow>
<mo><</mo>
<mo>=</mo>
<mi>&delta;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<mrow>
<mo>|</mo>
<mi>e</mi>
<mo>|</mo>
</mrow>
<mi>&alpha;</mi>
</msup>
<mi>s</mi>
<mi>i</mi>
<mi>g</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>e</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mrow>
<mo>|</mo>
<mi>e</mi>
<mo>|</mo>
</mrow>
<mo>></mo>
<mi>&delta;</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>10</mn>
<mo>)</mo>
</mrow>
</mrow>
式中,y为控制***最后的输出值,z1,z2,z3为扩张状态观测器观测的三个输出值,α为0到1之间的常数,α越小,跟踪越快,但滤波效果会变差;δ为影响滤波效果的常数,δ越大,滤波效果越好;β01,β02,β03为选取的参数;适当的增大β01抑制过渡过程中出现的超调,适当的增大β02加快响应速度,缩短过渡过程,β03还决定着对扰动估计滞后的大小,β03越大则扰动就越小,但β03过大的话会引起估计值振荡;通过对自抗扰控制器的每个模块进行设计和参数整定之后,用来控制飞行器的姿态;
步骤四,通过自抗扰控制中的非线性状态误差反馈律来构成***的控制量;
为了更有效地把fhan(x1,x2,γ,h)用于状态反馈中,引入阻尼因子c来把fhan(x1,x2,γ,h)中的变量x2改成cx2,得fhan(x1,cx2,γ,h);
步骤五,在控制过程中对各部分的参数进行调整,从而对三旋翼模型姿态控制有一个良好的效果;
在三旋翼飞行器上的惯导模块测量出飞行器此时的俯仰角、横滚角、偏航角,通过扩张状态观测器得出z1、z2、z3,z1、z2作为反馈量与输入量经过跟踪微分器的v1、v2的差值经过非线性状态误差反馈律运算与z3的差值通过倍数b0,得到模型的输入量,输入量通过PWM波控制三个电机的转速,对于已经解耦的三旋翼模型中,通过俯仰,横滚,偏航三个通道对于三旋翼模型实施姿态上的调整,从而达到理想的目标状态。
2.根据权利要求1所述的一种基于自抗扰控制的三旋翼姿态控制方法,其特征在于:三旋翼模型的机械结构包括螺旋桨(1)、电机(2)、机身(3)、机盖(4)、惯导模块(5)、核心板(6)、电池(7)、电池架(8)、支架(9);螺旋桨(1)与电机(2)相连;电机(2)安装在机身(3)上;螺旋桨(1)与电机(2)组成一组旋翼,布置在机身(3)上的三个旋翼中心与机身(3)的中心连线各成120度;电池(7)安装在机身(3)的底部;惯导模块(5)安装在机身(3)的顶部;核心板(6)安装在机身(3)的顶部中心;电池架(8)设置在机身(3)的底部四周。
3.根据权利要求2所述的一种基于自抗扰控制的三旋翼姿态控制方法,其特征在于:惯导模块用以实时监测飞行器在飞行过程中的位置和姿态,惯导模块由三轴陀螺仪传感器、GPS、罗盘、加速度计组成,其中三轴陀螺仪传感器和加速度计确定飞行器在飞行状态下的姿态,GPS和罗盘通过定位飞行器当前的绝对位置,实时监控飞行器的动向和相对位置。
4.根据权利要求2所述的一种基于自抗扰控制的三旋翼姿态控制方法,其特征在于:还包括执行模块,执行模块的核心处理器为AVR公司的微型处理器Atmega2560,Atmega2560驱动电路通过发出PWM波使驱动电路驱动电机,使得电机灵活改变当前的转速从而调节飞行器的姿态。
5.根据权利要求4所述的一种基于自抗扰控制的三旋翼姿态控制方法,其特征在于:电池(7)由锂电池供电,再通过电源分配模块使惯导模块、Atmega2560、驱动电路供电,针对不同模块采取不同电压值的供给,从而有效的使每个模块都能正常工作。
6.根据权利要求1所述的一种基于自抗扰控制的三旋翼姿态控制方法,其特征在于:地面站通过3DR radio数据传输模块对于飞行器的当前位姿进行传输,再基于missionplanner的地面站显示当前飞行器的状态,地面站通过惯导模块所获得的当前飞行器的姿态的数据通过模块内部的位姿数据的融合监测飞行器当前的位姿以及供电***的电压电流的情况,并且通过地面站发出指令使飞行器飞到预定的地点。
7.根据权利要求1所述的一种基于自抗扰控制的三旋翼姿态控制方法,其特征在于:当三旋翼飞行器在空中飞行时,为了保持其当前姿态,此时,规定其三轴的预定的理想的角度,采集当前的三轴的角度,作为接下来进行自抗扰控制的模型数据,读取目标理想的悬停三轴角度作为控制***的输入值,针对当前采用ADRC的方法对当前三轴角进行控制方法的处理,获得每个电机需要增加或者减小的转速,每个输出量通过PWM波的形式来调整各个的转速,从而调整三旋翼飞行器的姿态。
8.根据权利要求1所述的一种基于自抗扰控制的三旋翼姿态控制方法,其特征在于:类似于PID控制方法的P,I,D三个参数的调整,自抗扰控制方法也有参数调整的过程,首先调节状态观测器中的参数β01,β02,β03,再在微分***中,选择合适的过程曲线,使得微分***给出连续,无超调的跟踪信号;最后,选择合适的积分步长h,速度因子γ,阻尼因子c,最终获得较为满意的控制效果。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510279597.2A CN104898429B (zh) | 2015-05-27 | 2015-05-27 | 一种基于自抗扰控制的三旋翼姿态控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510279597.2A CN104898429B (zh) | 2015-05-27 | 2015-05-27 | 一种基于自抗扰控制的三旋翼姿态控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104898429A CN104898429A (zh) | 2015-09-09 |
CN104898429B true CN104898429B (zh) | 2017-09-22 |
Family
ID=54031148
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510279597.2A Expired - Fee Related CN104898429B (zh) | 2015-05-27 | 2015-05-27 | 一种基于自抗扰控制的三旋翼姿态控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104898429B (zh) |
Families Citing this family (30)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105867400A (zh) * | 2016-04-20 | 2016-08-17 | 北京博瑞爱飞科技发展有限公司 | 无人机的飞行控制方法和装置 |
CN106292273A (zh) * | 2016-09-26 | 2017-01-04 | 长春理工大学 | 针对大滞后温度***的滞后时间削弱的自抗扰控制方法 |
CN106444812A (zh) * | 2016-10-26 | 2017-02-22 | 华南智能机器人创新研究院 | 一种基于四旋翼无人机的姿态控制的方法及其*** |
CN106325816B (zh) * | 2016-11-09 | 2018-12-25 | 烟台中飞海装科技有限公司 | 一种微分信号的提取方法及微分器 |
CN106647783B (zh) * | 2016-11-22 | 2019-07-16 | 天津大学 | 倾转式三旋翼无人机姿态与高度自适应鲁棒控制方法 |
CN106842916B (zh) * | 2016-12-23 | 2018-12-21 | 中国科学院数学与***科学研究院 | 一种三维位置伺服***的预测自抗扰控制方法 |
CN106985139B (zh) * | 2017-04-12 | 2020-04-14 | 西北工业大学 | 基于扩展状态观测与补偿的空间机器人自抗扰协调控制方法 |
CN107134965B (zh) * | 2017-04-27 | 2019-08-27 | 滨州学院 | 内嵌式永磁同步电机转子位置角估计方法 |
CN107300925B (zh) * | 2017-07-12 | 2020-05-12 | 西北工业大学 | 基于改进鱼群算法的四旋翼无人机姿控参数整定方法 |
CN107491080B (zh) * | 2017-07-12 | 2020-04-03 | 西北工业大学 | 一种基于非线性反馈和微分跟踪的飞行器姿态控制方法 |
US10144504B1 (en) * | 2017-09-01 | 2018-12-04 | Kitty Hawk Corporation | Decoupled hand controls for aircraft with vertical takeoff and landing and forward flight capabilities |
CN108037764B (zh) * | 2017-11-01 | 2021-02-23 | 杭州睿杰智能空中机器人科技有限公司 | 一种无人直升机自抗扰飞行位置控制方法 |
CN110069012A (zh) * | 2018-01-23 | 2019-07-30 | 北京京东尚科信息技术有限公司 | 用于抑制噪声的控制量确定方法和装置、姿态控制*** |
CN108429286A (zh) * | 2018-04-02 | 2018-08-21 | 武汉理工大学 | 一种基于自抗扰控制的并网电流调节器 |
CN108646778B (zh) * | 2018-07-18 | 2019-08-06 | 哈尔滨工业大学 | 一种垂直起降重复使用运载器的非线性自抗扰控制方法 |
CN109189085B (zh) * | 2018-07-25 | 2021-06-08 | 西北工业大学 | 基于事件触发的航天器网络化***姿态控制方法 |
CN109116860B (zh) * | 2018-08-29 | 2022-05-03 | 天津大学 | 三旋翼无人机的非线性鲁棒控制方法 |
CN109343551A (zh) * | 2018-10-29 | 2019-02-15 | 北京理工大学 | 一种旋翼机协调转弯控制方法及*** |
CN109976364B (zh) * | 2019-03-26 | 2021-04-23 | 中南大学 | 一种六旋翼飞行器姿态解耦控制方法 |
CN110751270A (zh) * | 2019-10-23 | 2020-02-04 | 广东工业大学 | 一种无人机电线故障检测方法、***及设备 |
CN110794877B (zh) * | 2019-11-22 | 2020-10-13 | 北京理工大学 | 一种车载摄像头云台伺服***及控制方法 |
CN111897226B (zh) * | 2020-08-20 | 2022-11-22 | 北京爱宾果科技有限公司 | 一种mems陀螺仪的输出反馈控制方法和装置 |
CN112099350B (zh) * | 2020-08-20 | 2022-10-28 | 北京爱宾果科技有限公司 | 一种mems陀螺仪动态逆控制方法和装置 |
CN112034871B (zh) * | 2020-08-25 | 2022-05-24 | 南京航空航天大学 | 一种可倾转多旋翼飞行器的全向控制方法 |
CN112162570B (zh) * | 2020-10-10 | 2022-12-06 | 中国人民解放军海军航空大学 | 一种四旋翼直升飞机小范围动态跟踪的方法 |
CN112286053B (zh) * | 2020-10-16 | 2021-08-27 | 北京航空航天大学 | 一种高机动微型无人机的制导控制一体化方法 |
CN112346470A (zh) * | 2020-10-29 | 2021-02-09 | 中国地质大学(武汉) | 一种基于改进自抗扰控制的四旋翼姿态控制方法 |
CN112783190A (zh) * | 2021-01-22 | 2021-05-11 | 滨州学院 | 一种三旋翼无人机鲁棒跟踪控制器控制方法 |
CN112965505A (zh) * | 2021-01-29 | 2021-06-15 | 广东汇天航空航天科技有限公司 | 载人飞行器飞行姿态控制方法、***及载人飞行器 |
CN113885543B (zh) * | 2021-09-29 | 2022-09-06 | 哈尔滨工业大学 | 一种复杂海况干扰下的航行体自抗扰横滚控制器的设计方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3516232B2 (ja) * | 2000-06-19 | 2004-04-05 | 京清 韓 | 最適かつ自動的に外乱を排除するフィードバック制御を実現するための方法及び装置 |
CN102830622B (zh) * | 2012-09-05 | 2014-10-01 | 北京理工大学 | 一种四旋翼飞行器自抗扰自动飞行控制方法 |
-
2015
- 2015-05-27 CN CN201510279597.2A patent/CN104898429B/zh not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN104898429A (zh) | 2015-09-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104898429B (zh) | 一种基于自抗扰控制的三旋翼姿态控制方法 | |
CN102830622B (zh) | 一种四旋翼飞行器自抗扰自动飞行控制方法 | |
CN106249745B (zh) | 四轴无人机的控制方法 | |
CN109062042B (zh) | 一种旋翼飞行器的有限时间航迹跟踪控制方法 | |
CN110531777A (zh) | 基于自抗扰控制技术的四旋翼飞行器姿态控制方法和*** | |
CN110531776B (zh) | 基于自抗扰控制技术的四旋翼飞行器位置控制方法和*** | |
CN106647781A (zh) | 基于重复控制补偿神经模糊pid四旋翼飞行器的控制方法 | |
Derafa et al. | Super twisting control algorithm for the four rotors helicopter attitude tracking problem | |
CN104765272A (zh) | 一种基于pid神经元网络控制(pidnn)的四旋翼飞行器控制方法 | |
CN112346470A (zh) | 一种基于改进自抗扰控制的四旋翼姿态控制方法 | |
CN104950901A (zh) | 无人直升机姿态误差有限时间收敛非线性鲁棒控制方法 | |
CN110673623B (zh) | 一种基于双环pd控制算法控制的四旋翼无人机着陆方法 | |
CN103869817A (zh) | 一种倾转四旋翼无人机垂直起降控制方法 | |
CN107491083A (zh) | 一种基于饱和自适应滑模控制的四旋翼自主着船方法 | |
Subudhi et al. | Modeling and trajectory tracking with cascaded PD controller for quadrotor | |
CN109343551A (zh) | 一种旋翼机协调转弯控制方法及*** | |
CN109976364B (zh) | 一种六旋翼飞行器姿态解耦控制方法 | |
Zhang et al. | Quadrotor aircraft control without velocity measurements | |
Xu et al. | Learning pugachev's cobra maneuver for tail-sitter uavs using acceleration model | |
Yayla et al. | An adaptive flight controller design for a tilt-prop fixed wing UAV for all flight modes | |
CN106292297A (zh) | 基于pid控制器和l1自适应控制器的姿态控制方法 | |
Liu et al. | Quaternion-based robust attitude control for quadrotors | |
Quan et al. | Lifting-wing quadcopter modeling and unified control | |
Bonci et al. | The Double Propeller Ducted-Fan, an UAV for safe Infrastructure inspection and human-interaction | |
González-Hernández et al. | Super-twisting control scheme for a miniature quadrotor aircraft: Application to trajectory-tracking problem |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20170922 |