一种采用串级自抗扰控制技术的四旋翼飞行器悬停控制方法技术

一种采用串级自抗扰控制技术的四旋翼飞行器悬停控制方法，包括以下步骤：1)根据欧拉及牛顿定理建立四旋翼飞行器的动力学模型，并解耦为双回路、多子系统的结构；2)其次，根据四旋翼飞行器系统的自身结构特点，设计串级自抗扰控制器，为获取较好的内环输入信号，对外环设计线性ADRC控制器；同时，设计内环非线性ARDC控制器以获得更好的跟踪性能；3)针对系统内部参数摄动和存在外部干扰等不确定性，引入扩张状态观测器对系统的状态和内外扰动进行实时估计，并利用非线性误差反馈控制率进行补偿，消除了内外扰动的影响。本发明专利技术对针对四旋翼飞行器系统内部参数摄动和存在外部干扰等不确定性均具有很强的抑制能力。

【技术实现步骤摘要】
一种采用串级自抗扰控制技术的四旋翼飞行器悬停控制方法
本专利技术应用于无人机控制领域，涉及到四旋翼飞行器的悬停控制问题，尤其是如何消除系统内部参数摄动和存在外部干扰扰动对四旋翼飞行器悬停控制系统性能的影响，实现一种有效的实时控制方法。
技术介绍
四旋翼飞行器是四桨非共轴多旋翼飞行器的简称。作为非共轴多旋翼飞行器的代表，与固定翼无人机相比，具有结构简单、体积小、隐蔽性强、载荷高、可垂直起降、定点悬停和低速飞行等优势，能执行各种危险的特殊任务，比如航拍、灾害现场监视与求援、低空侦探与检测等，在民用领域和军事领域均体现出极高的研究和应用价值。本专利技术主要考虑如何降低甚至消除系统内部参数摄动和存在外部干扰扰动对四旋翼飞行器悬停控制系统性能的影响。针对四旋翼飞行器悬停控制问题，目前使用的方法主要有PID控制、反步控制、嵌套饱和控制等。基于PID的四旋翼飞行器悬停控制器将控制系统分为几个独立的通道，分别设计相应的PID控制算法，该方法具有控制技术成熟、易于实现的特点，但是其抗干扰性较差，如环境改变即要重新调整参数。基于反步法的四旋翼飞行器悬停控制器通过系统的状态方程设计虚拟控制，构造合适的Lyapunov函数来求控制律，具有良好的跟踪性能、且具有无超调、调节时间快的优点，但是该方法针对满足严格反馈控制结构的系统，对系统要求高。基于嵌套饱和的四旋翼飞行器悬停控制具有计算量小、鲁棒性强和全局渐近稳定的优点，但是应用该方法需要将四旋翼动力学模型转化为严格的前馈级联结构，而针对四旋翼飞行器这种欠驱动系统只能局部反馈线性化，不能完全反馈线性化。
技术实现思路
本专利技术要克服上述提到的现有控制方法的局限性，采用串级自抗扰技术设计四旋翼飞行器悬停控制策略，可以有效地将系统的模型不确定性和系统内外部扰动估计用扩张状态观测器实时估计并补偿，此方法对系统内外扰动以及模型不确定性均具有很强的抑制能力。本专利技术解决其技术问题所采用的技术方案：一种采用串级自抗扰控制技术的四旋翼飞行器悬停控制方法，包括以下步骤：步骤1)建立四旋翼飞行器的动力学模型：四旋翼飞行器是一个多变量、高耦合、非线性的欠驱动系统，要对其设计控制器，首先要建立合理而准确的动力学模型。四旋翼飞行器的飞行姿态由三个角度描述，飞行位置由(x,y,z)描述。根据欧拉及牛顿定理建立小型四旋翼飞行器的动力学模型为对螺旋桨的角速度的控制量u如下：其中，m为四旋翼飞行器的质量，l为四旋翼的旋翼臂展，Ixx、Iyy、Izz分别为x轴、y轴和z轴的惯量，Ω1、Ω2、Ω3和Ω4为螺旋桨的角速度，b是推力系数，d是阻力系数。选择状态向量X为则将(1)表示为状态空间模型为其中，步骤2)设计串级ADRC控制器，过程包括：根据其建模动力学方程双回路、多子系统的结构的特点，可以将悬停控制器设计为串级结构，内环为姿态环，外环为位置环。2.1)外环控制器设计四旋翼飞行器的外环为位置环，外环控制分为3个独立的回路，分为x轴控制回路、y轴控制回路和z轴控制回路。自抗扰控制器由跟踪控制器、扩张状态观测器、线性状态误差反馈。(211)跟踪微分器，用来安排过渡过程，给定信号v0作为参考输入其中，参数r0为跟踪微分器的快速因子。(212)扩张状态观测器，对系统的状态和扰动进行实时估计与补偿其中，β01、β02、β03为一组待整定的参数，参数的选取可以通过极点配置取β1＝3ω0,β2＝3ω02,β3＝ω03。(213)状态误差反馈控制律其中，k1和k2分别为比例和微分系数，可以通过极点配置取k1＝ωc2,k2＝2ωc。2.2)内环控制器的设计四旋翼飞行器的内环为姿态环，分为3个独立的控制回路，横滚角控制回路、俯仰角控制回路和偏航角控制回路。自抗扰控制器包括跟踪微分器、扩张状态观测器、状态误差反馈控制律三部分，其设计过程如下：(221)安排过渡过程，给定信号v0作为参考输入其中，fhan(e,v2,r0,h0)为最速跟踪控制综合函数，参数r0为跟踪微分器的快速因子，参数h0为跟踪微分器的滤波因子,h为积分步长。(222)扩张状态观测器，对系统的状态和扰动进行实时估计与补偿其中，fal(e,0.25,δ)为非线性函数，δ、β01、β02、β03为一组待整定的参数。(223)状态误差反馈控制律其中，参数c为阻尼因子，fhan(e1,ce2,r,h)为最速跟踪控制综合函数，其表达式为非线性函数fal(e,a,δ)为：与现有技术相比，本专利技术的优点在于：(1)针对系统内部参数摄动和存在外部干扰等不确定性，引入扩张状态观测器对系统的状态和内外扰动进行实时估计，并利用非线性误差反馈控制率进行补偿，消除了内外扰动的影响。(2)根据四旋翼飞行器系统的自身结构特点，设计串级自抗扰控制器，为获取较好的内环输入信号，对外环设计线性ADRC控制器；同时，设计内环非线性ARDC控制器以获得更好的跟踪性能。附图说明图1是本专利技术的四旋翼飞行器串级ADRC控制框图。图2是本专利技术的四旋翼飞行器外环控制框图。图3是本专利技术的四旋翼飞行器内环控制框图。具体实施方式为了使本专利技术的技术方案、设计思路能更加清晰，下面结合附图再进行详尽的描述。一种采用串级自抗扰控制技术的四旋翼飞行器悬停控制方法，包括以下步骤：步骤1)建立四旋翼飞行器的动力学模型：四旋翼飞行器是一个多变量、高耦合、非线性的欠驱动系统，要对其设计控制器，首先要建立合理而准确的动力学模型。四旋翼飞行器的飞行姿态由三个角度描述，飞行位置由(x,y,z)描述。根据欧拉及牛顿定理建立小型四旋翼飞行器的动力学模型为对螺旋桨的角速度的控制量u如下：其中，m为四旋翼飞行器的质量，l为四旋翼的旋翼臂展，Ixx、Iyy、Izz分别为x轴、y轴和z轴的惯量，Ω1、Ω2、Ω3和Ω4为螺旋桨的角速度，b是推力系数，d是阻力系数。选择状态向量X为则将(1)表示为状态空间模型为其中，步骤2)设计串级ADRC控制器，过程包括：根据其建模动力学方程双回路、多子系统的结构的特点，可以将悬停控制器设计为串级结构，内环为姿态环，外环为位置环。2.1)外环控制器设计四旋翼飞行器的外环为位置环，外环控制分为3个独立的回路，分为x轴控制回路、y轴控制回路和z轴控制回路。自抗扰控制器由跟踪控制器、扩张状态观测器、线性状态误差反馈。(211)跟踪微分器，用来安排过渡过程，给定信号v0作为参考输入其中，参数r0为跟踪微分器的快速因子。(212)扩张状态观测器，对系统的状态和扰动进行实时估计与补偿其中，β01、β02、β03为一组待整定的参数，参数的选取可以通过极点配置取β1＝3ω0,β2＝3ω02,β3＝ω03。(213)状态误差反馈控制律其中，k1和k2分别为比例和微分系数，可以通过极点配置取k1＝ωc2,k2＝2ωc。2.2)内环控制器的设计四旋翼飞行器的内环为姿态环，分为3个独立的控制回路，横滚角控制回路、俯仰角控制回路和偏航角控制回路。自抗扰控制器包括跟踪微分器、扩张状态观测器、状态误差反馈控制律三部分，其设计过程如下：(224)安排过渡过程，给定信号v0作为参考输入其中，fhan(e,v2,r0,h0)为最速跟踪控制综合函数，参数r0为跟踪微分器的快速因子，参数h0为跟踪微分器的滤波因子,h为积分步长。(225)扩张状态观测器，对系统的状态和扰本文档来自技高网...

【技术保护点】
一种采用串级自抗扰控制技术的四旋翼飞行器悬停控制方法，包括以下步骤：步骤1)建立四旋翼飞行器的动力学模型：四旋翼飞行器的飞行姿态由三个角度描述，飞行位置由(x,y,z)描述；根据欧拉及牛顿定理建立小型四旋翼飞行器的动力学模型为对螺旋桨的角速度的控制量u如下：u=u1u2u3u4=b(Ω12+Ω22+Ω32+Ω42)b(-Ω22+Ω42)b(Ω12-Ω32)d(-Ω12+Ω22-Ω32+Ω42)---(2)]]>其中，m为四旋翼飞行器的质量，l为四旋翼的旋翼臂展，Ixx、Iyy、Izz分别为x轴、y轴和z轴的惯量，Ω1、Ω2、Ω3和Ω4为螺旋桨的角速度，b是推力系数，d是阻力系数；选择状态向量X为则将(1)表示为状态空间模型为其中，a1=Iyy-IzzIxx,a2=Izz-IxxIyy,a3=Ixx-IyyIzz,b1=lIxx,b2=lIyy,b3=lIyy,]]>b4=1m,]]>步骤2)设计串级ADRC控制器，过程包括：根据其建模动力学方程双回路、多子系统的结构的特点，可以将悬停控制器设计为串级结构，内环为姿态环，外环为位置环；2.1)外环控制器设计；四旋翼飞行器的外环为位置环，外环控制分为3个独立的回路，分为x轴控制回路、y轴控制回路和z轴控制回路；自抗扰控制器由跟踪控制器、扩张状态观测器、线性状态误差反馈；(211)跟踪微分器，用来安排过渡过程，给定信号v0作为参考输入fh=-r02(v1-v0)-2r0v2v·1=v2v·2=fh---(5)]]>其中，参数r0为跟踪微分器的快速因子；(212)扩张状态观测器，对系统的状态和扰动进行实时估计与补偿e=z1-yz·1=z2-β01ez·2=z3-β02e+b0uz·3=-β03e---(6)]]>其中，β01、β02、β03为一组待整定的参数，参数的选取可以通过极点配置取β1＝3ω0,β2＝3ω02,β3＝ω03；(213)状态误差反馈控制律；e1=v1-z1,e2=v2-z2u0=k1e+k2e·u=u0-z3/b0---(7)]]>其中，k1和k2分别为比例和微分系数，可以通过极点配置取k1＝ωc2,k2＝2ωc；2.2)内环控制器的设计；四旋翼飞行器的内环为姿态环，分为3个独立的控制回路，横滚角控制回路、俯仰角控制回路和偏航角控制回路；自抗扰控制器包括跟踪微分器、扩张状态观测器、状态误差反馈控制律三部分，其设计过程如下：(221)安排过渡过程，给定信号v0作为参考输入e=v1-v0fh=fhan(e,v2,r0,h0)v1=v1+hv2v2=v2+hfh---(8)]]>其中，fhan(e,v2,r0,h0)为最速跟踪控制综合函数，参数r0为跟踪微分器的快速因子，参数h0为跟踪微分器的滤波因子,h为积分步长；(222)扩张状态观测器，对系统的状态和扰动进行实时估计与补偿，e=z1-yfe=fal(e,0.5,δ)fe1=fal(e,0.25,δ)z1=z1+h(z2-β01e)z2=x2+h(z3-β02fe+b0u)z3=z3+h(-β03fe1)---(9)]]>其中，fal(e,0.25,δ)为非线性函数，δ、β01、β02、β03为一组待整定的参数；(223)状态误差反馈控制律e1=v1-z1e2=v2-z2u0q=-fhan(e1,ce2,r,h)uq=u0q-z3/b0---(10)]]>其中，参数c为阻尼因子，fhan(e1,ce2,r,h)为最速跟踪控制综合函数，其表达式为d=rhd0=hdy=x1+hx2a0=d2+8r|y|a=x2+(a0-d)2sign,|y|>d0x2+yh,|y|≤d0flan=rsign(a),|a|>drad,|a|≤d---(11)]]>非线性函数fal(e,a,δ)为：fal(e,a,δ)=eδa-1,|e|≤δ|e|asign(e)|e|>δ---(12)]]>...

【技术特征摘要】
1.一种采用串级自抗扰控制技术的四旋翼飞行器悬停控制方法，包括以下步骤：步骤1)建立四旋翼飞行器的动力学模型：四旋翼飞行器的飞行姿态由三个角度描述，飞行位置由(x,y,z)描述；根据欧拉及牛顿定理建立小型四旋翼飞行器的动力学模型为对螺旋桨的角速度的控制量u如下：其中，m为四旋翼飞行器的质量，l为四旋翼的旋翼臂展，Ixx、Iyy、Izz分别为x轴、y轴和z轴的惯量，Ω1、Ω2、Ω3和Ω4为螺旋桨的角速度，b是推力系数，d是阻力系数；选择状态向量X为则将(1)表示为状态空间模型为其中，步骤2)设计串级ADRC控制器，过程包括：根据其建模动力学方程双回路、多子系统的结构的特点，将悬停控制器设计为串级结构，内环为姿态环，外环为位置环；2.1)外环控制器设计；四旋翼飞行器的外环为位置环，外环控制分为3个独立的回路，分为x轴控制回路、y轴控制回路和z轴控制回路；自抗扰控制器由跟踪控制器、扩张状态观测器、线性状态误差反馈；(211)跟踪微分器，用来安排过渡过程，给定信号v0作为参考输入其中，参数r0为跟踪微分器的快速因子；(212)扩张状态观测器，对系统的状态和扰动进行实时估计与补偿其中，β01、β02、β03为一组待整定的参数，参数的选取通过极点配置取β1＝3ω0,β2＝3ω02,β3＝ω03；(213)状态误差反馈控制律；

【专利技术属性】
技术研发人员：张丹，叶孝璐，肖紫阳，
申请(专利权)人：浙江工业大学，
类型：发明
国别省市：浙江;33