首页 / 专利库 / 人工智能 / 位姿 / 姿态 / 一种三自由度直升机抗饱和姿态跟踪控制方法

一种三自由度直升机抗饱和姿态跟踪控制方法

阅读:37发布:2020-05-11

专利汇可以提供一种三自由度直升机抗饱和姿态跟踪控制方法专利检索,专利查询,专利分析的服务。并且一种三 自由度 直升机 抗饱和 姿态 跟踪 控制方法,步骤如下:(一)给定期望跟踪值:期望姿态 角 xd=[ρd εd]T;(二)姿态角跟踪误差计算:期望姿态角与实际姿态角之间的误差z1=x‑xd;(三)虚拟控制律设计:设计vd并求其对时间的导数作为神经网络中状态量;(四)神经网络设计:逼近3‑DOF直升机动 力 学方程中的不确定项;(五)辅助控制系统设计:设计状态量解决输入饱和问题;(六)模型控制律设计:利用辅助控制系统状态量修正姿态 角速度 跟踪误差项,结合神经网络估计不确定项,最终得到模型控制律;(七)将模型控制律应用于3‑DOF直升机非线性模型,进行姿态角跟踪仿真。该方法能够逼近模型不确定项、抑制外界扰动影响、抗执行机构饱和,跟踪任意期望姿态,保证系统渐近稳定,简化计算过程。,下面是一种三自由度直升机抗饱和姿态跟踪控制方法专利的具体信息内容。

1.一种三自由度直升机抗饱和姿态跟踪控制方法,其具体步骤如下:
步骤一给定期望姿态xd=[ρd εd]T;
步骤二姿态跟踪误差计算:计算期望姿态角与实际姿态角之间的误差z1=x-xd;
步骤三设计虚拟控制律vd;
在步骤三中所述的虚拟控制律vd,其设计方法如下:
1)给出3-DOF直升机的动学方程
3-DOF直升机的动力学方程为:
其中Jρ,Jε分别为3-DOF直升机体轴系下的俯仰轴、滚转轴转动惯量;ρ,ε分别为3-DOF直升机体轴系下的俯仰角、滚转角;La,Lh分别为模型中的力臂;Lw为模型中的力臂;Ff和Fb分别是前后螺旋桨的输出电压;Kf是电压和力之间的转换系数;Mf,Mb和Mw分别是前后螺旋桨和配重质量;将3-DOF直升机动力学模型整理成如下控制学模型形式:
其中, x=[ρ ε]T∈R2是地面坐标系下的俯仰角速度、滚转角速
度;v=[q p]T∈R2为3-DOF直升机体轴系下的俯仰角速度、滚转角速度;q、p分别为3-DOF直升机体轴系下的俯仰角速度、滚转角速度; 为系
统未知的质量矩阵;
为系统未知的重力惯量,其中m=Mwg·Lw-(Mf+Mb)
g·La;D(v,x,t)∈R2是附加的系统未知干扰;u=[u1 u2]T=[Ff-Fsat Fb-Fsat]T为控制输入矢量,前螺旋桨输出电压Ff∈(0,2Fsat),后螺旋桨输出电压Fb∈(0,2Fsat);Fsat为控制量所限定的最大值;y为观测输出;
2)设计虚拟控制律vd
虚拟控制率vd及其对时间的倒数 作为神经网络中的变量,在本方法中选择定义矩阵K1∈R2×2, 为期望姿态角对时间求导数;将虚拟控制律vd对时
间求导数,可得到
为期望姿态角对时间求二阶导数; 为雅克比矩阵的逆对时间求导数;为姿态角跟踪误差对时间求导数;
步骤四神经网络设计: 为神经网络权向量,S(Z)为基函数向量,逼近
3-DOF直升机动力学方程中的不确定项;
设计神经网络 逼近3-DOF直升机动力学方程中的不确项,其具体方法
如下:
1)神经网络变量Z
将地轴系下实际姿态角x、3-DOF直升机体轴系下实际角速度v、虚拟控制律vd及其对时间的导数 作为神经网络中的变量;
2)神经网络权向量
其中,对于给定的Λi∈R2×2, βi>0; i=1,2的计算方法如下
将 对时间积分迭代可得到 最终得到
3)基函数向量
步骤五辅助控制系统设计:设计状态量 解决输入饱和问题;
辅助控制系统设计:设计状态量 解决输入饱和问题,其具体计算方法如下:状态量的设计方法如下
其中,μ是一个很小的正值;K2∈R2×2, Δu=u-u0为实际输入量与控制律的偏差量;z2T为实际直升机体轴系下的俯仰角速度、滚转角速度与期望直升机体轴系下的俯仰角速度、滚转角速度差值矩阵的转置;
将 积分迭代可得到 利用辅助控制系统参数 修正姿态角速度跟踪误差项,解决系统输入饱和问题;
步骤六模型控制律设计:利用辅助控制系统状态量 修正姿态角速度跟踪误差项,结合神经网络估计不确定项,最终得到模型控制律;
设计模型控制律,其计算方法如下:
1)对输入矢量限幅,其计算方法如下:
其中,输入矢量u=[u1 u2]T,-Fsat≤ui≤Fsat,i=1,2;-Fsat为控制量所限定的最小值,Fsat为控制量所限定的最大值;u0i是控制律u0的第i维分量;
2)利用辅助控制系统修正姿态角速度跟踪误差项,其设计方法如下:
其中,K3∈R2×2,K3=K3T>0;
步骤七将模型控制律应用于3-DOF直升机非线性模型,进行姿态角跟踪仿真。
2.根据权利要求1所述的一种三自由度直升机抗饱和姿态跟踪控制方法,其特征在于:
在步骤一中所述的给定期望姿态角包括:期望姿态角为xd=[ρd εd]T,可以是时间的函数xd(t),也可以是定值xd(c)。
3.根据权利要求1所述的一种三自由度直升机抗饱和姿态跟踪控制方法,其特征在于:
在步骤二中所述的姿态角跟踪误差z1,其计算方法如下:
1)当期望姿态角为时间的函数xd(t)时,姿态角跟踪误差z1为
z1=x-xd(t)
2)当期望姿态角为定值xd(c)时,姿态角跟踪误差z1为
z1=x-xd(c)。
4.根据权利要求1所述的一种三自由度直升机抗饱和姿态跟踪控制方法,其特征在于:
将模型控制律应用于3-DOF直升机非线性模型,进行姿态角跟踪仿真。

说明书全文

一种三自由度直升机抗饱和姿态跟踪控制方法

技术领域

[0001] 本发明提供一种三自由度(3-DOF)直升机抗饱和姿态跟踪控制方法,它为三自由度直升机提供一种抑制外界扰动影响、抗执行机构输入饱和的跟踪期望姿态的新控制方法,属于自动控制技术领域。

背景技术

[0002] 直升机是一种以动装置驱动的旋翼作为主要升力及动力来源,能垂直起降及前后、左右机动飞行的航空飞行器,不管是在军事还是民用上面都有很广泛的应用。3-DOF直升机是一类常见的欠驱动、高阶次、多入多出(MIMO)的非线性系统,并且具有较强的通道耦合特性,可以实现对实际直升机飞行控制系统较为真实全面和客观的模拟,是一台验证各种控制算法有效性的非常理想的科研平台。然而,在3-DOF实现姿态跟踪的过程中,当3-DOF模型本身存在不确定性,或在飞行时受到外界扰动干扰时,将会导致系统不稳定;此外,由于3-DOF直升机模型执行机构存在限位设置,从而出现执行机构饱和等问题。
[0003] 因此发明“一种三自由度直升机抗饱和姿态跟踪控制方法”是把以上问题作为切入点,而提出的有针对性、基于抗输入饱和的3-DOF直升机模型的姿态跟踪控制理论,可利用神经网络逼近3-DOF直升机模型的不确定项,抑制外界扰动对系统的影响,改善执行机构的饱和问题,保证系统的渐进稳定性,实现模型的有效姿态跟踪,为3-DOF直升机的姿态跟踪控制工程提供了一种高效可行的设计手段。

发明内容

[0004] (1)目的:本发明的目的在于提供一种3-DOF直升机抗饱和姿态跟踪控制方法,控制工程师可以在结合实际参数的同时,按照该方法实现3-DOF直升机抗不确定项、抗扰动、抗执行机构饱和问题的姿态跟踪控制。
[0005] (2)技术方案:本发明“一种三自由度直升机抗饱和姿态跟踪控制方法”,其主要内容及步骤是:先由给定的姿态期望跟踪值进行误差计算;然后根据姿态运动学方程进行姿态运动学控制计算得到虚拟控制律;利用神经网络逼近3-DOF直升机模型中的不确定项,设计辅助控制系统解决执行机构饱和问题,随后基于3-DOF直升机动力学方程得到控制量;最终将此控制量用于3-DOF直升机模型。在实际应用当中,3-DOF直升机的姿态、速度等状态量由组合惯导等传感器测量得到,而由该方法计算得到的控制量将传输至机和螺旋桨等执行机构,即可实现3-DOF直升机抗不确定项、抗扰动、抗执行机构饱和问题的姿态跟踪控制功能。
[0006] 本发明“一种三自由度直升机抗饱和姿态跟踪控制方法”,其具体步骤如下:
[0007] 步骤一给定期望姿态xd=[ρd εd]T。
[0008] 步骤二姿态角跟踪误差计算:计算期望姿态角与实际姿态角之间的误差z1=x-xd。
[0009] 步骤三设计虚拟控制律vd。
[0010] 步骤四神经网络设计: 逼近3-DOF直升机动力学方程中的不确定项。
[0011] 步骤五辅助控制系统设计:设计状态量 解决输入饱和问题。
[0012] 步骤六模型控制律设计:利用辅助控制系统状态量 修正姿态角速度跟踪误差项,结合神经网络估计不确定项,最终得到模型控制律。
[0013] 步骤七将模型控制律应用于3-DOF直升机非线性模型,进行姿态角跟踪仿真。
[0014] 其中,在步骤一中所述的给定期望姿态角包括:期望姿态角为xd=[ρd εd]T,可以是时间的函数xd(t),也可以是定值xd(c),期望姿态角的二个分量分别是地轴系下的俯仰角、滚转角。
[0015] 其中,在步骤二中所述的姿态角跟踪误差的计算方法如下:
[0016] z1=x-xd
[0017] 其中,x为3-DOF直升机的实际姿态角,x=[ρ ε]T,其中,实际姿态角的二个分量分别是地轴系下的俯仰角、滚转角。
[0018] 其中,在步骤三中所述的虚拟控制律vd,其计算方法如下:
[0019] 1)给出3-DOF直升机的动力学方程
[0020] 根据附图2得到3-DOF直升机的动力学方程为:
[0021]
[0022] 其中Jρ,Jε分别为3-DOF直升机体轴系下的俯仰轴、滚转轴转动惯量;ρ,ε分别为3-DOF直升机体轴系下的俯仰角、滚转角;ρ,ε分别为3-DOF直升机体轴系下的俯仰角、滚转角;La,Lh分别为模型中的力臂;Ff和Fb分别是前后螺旋桨的输出电压;Kf是电压和力之间的转换系数;
[0023] Mf,Mb和Mw分别是前后螺旋桨和配重质量
[0024] 将3-DOF直升机动力学模型整理成如下控制学模型形式:
[0025]
[0026] 其中, x=[ρ ε]T∈R2是地面坐标系下的俯仰角速度、滚转T 2
角速度;v=[q p]∈R为3-DOF直升机体轴系下的俯仰角速度、滚转角速度;
[0027] 为系统未知的质量矩阵;
[0028]2
为系统未知的重力惯量,其中m=Mwg·Lw-(Mf+Mb)g·La;D(v,x,t)∈R是附加的系统未知干扰;u=[u1 u2]T=[Ff-Fsat Fb-Fsat]T为控制输入矢量,前螺旋桨输出电压Ff∈(0,2Fsat),后螺旋桨输出电压Fb∈(0,2Fsat);y为观测输出。
[0029] 2)设计虚拟控制律vd
[0030] 其设计方法如下:
[0031]
[0032] 其中,K1∈R2×2, 将vd对时间求导数,从而得到
[0033]
[0034] 其中,在步骤四中所述的神经网络,其设计方法如下:
[0035] 用神经网络逼近3-DOF直升机动力学方程中的不确定项:
[0036]
[0037] 其中
[0038] 系统未知干扰:
[0039] |Di(v,x,t)|≤pi(v,x)+qi(t)
[0040] 其中,p(x,v)=[p1(x,v),p2(x,v)]T, z2=v-vd;
[0041] Sgn(z2):=diag{sgn(z2j)},j=1,2。
[0042] 本专利中采用径向基神经网络进行不确定项估计,其计算方法如下::
[0043]
[0044] 神经网络权向量:
[0045]
[0046]
[0047] 其中,Λi∈R2×2, βi>0; i=1,2。
[0048] 将 积分迭代可得到 最终得到
[0049] 基函数向量:
[0050]
[0051] 其中,在步骤五中所述的辅助控制系统,其状态量的计算方法如下:
[0052]
[0053] 其中,μ是一个很小的正值;K2∈R2×2, Δu=u-u0为实际输入量与控制律的偏差量。
[0054] 将 积分迭代可得到 利用辅助控制系统参数 修正姿态角速度跟踪误差项,解决系统输入饱和问题。
[0055] 其中,在步骤六中所述的模型控制律,其计算方法如下:
[0056] 1)对输入矢量限幅,其计算方法如下:
[0057]
[0058] 其中,输入矢量u=[u1 u2]T,-Fsat≤ui≤Fsat,i=1,2;-Fsat为控制量所限定的最小值,Fsat为控制量所限定的最大值;u0i是控制律u0的第i维分量。
[0059] 2)利用辅助控制系统修正姿态角速度跟踪误差项,其设计方法如下:
[0060]
[0061] 其中,K3∈R2×2,K3=K3T>0。
[0062] 其中,在步骤七中所述的将模型控制律应用于3-DOF直升机非线性模型,进行姿态角跟踪仿真,
[0063] 其方法如下:
[0064] 将经过限幅和辅助控制系统修正过的输入量u0,即为3-DOF直升机非线性模型的控制量。
[0065] (3)优点及效果:
[0066] 本发明“一种三自由度直升机抗饱和姿态跟踪控制方法”,与现有技术比,其优点是:
[0067] 1)本方法避免模型线性化,可直接应用于非线性模型,步骤简洁高效,并能保证系统的渐次稳定性;
[0068] 2)本方法利用神经网络,从而良好的抑制了模型不确定性和外界扰动对系统的干扰影响;
[0069] 3)本方法采用辅助控制系统解决饱和问题,使得执行机构饱和问题得到了大幅度改善;
[0070] 4)本方法算法结构简单,响应速度快,易于工程实现。
[0071] 在应用过程中,控制工程师可以根据实际要求给定3-DOF直升机任意期望姿态角,并将由该方法计算得到的控制量直接传输至执行机构实现姿态跟踪控制的功能。

附图说明

[0072] 图1为纵列式直升机实物图;
[0073] 图2为本发明3-DOF直升机模型图;
[0074] 符号说明如下:
[0075] u         u为系统控制量;
[0076] u0        u0为系统控制律;
[0077] -Fsat      -Fsat为系统控制量所限定的最小值;
[0078] Fsat       Fsat为系统控制量所限定的最大值;
[0079]          为辅助控制系统参数;
[0080] vd        vd为虚拟控制律;
[0081] S(Z)      S(Z)为神经网络中基函数向量;
[0082]         为神经网络权向量;
[0083] y         y为系统观测输出;
[0084] R(x)      R(x)为3-DOF直升机体轴系和地面坐标系的转换矩阵;
[0085] z1        z1为期望姿态角与实际姿态角之间的误差;

具体实施方式

[0086] 下面对本发明中的各部分设计方法作进一步的说明:
[0087] 本发明“一种三自由度直升机抗饱和姿态跟踪控制方法”,见图1、图2所示,其具体步骤如下:
[0088] 步骤一:给定期望跟踪值
[0089] 1)如图2所示,以3-DOF直升机实验模型中的质量块为原点,以俯仰、偏航、滚转三个轴为坐标轴建立3-DOF直升机机体坐标系;
[0090] 2)给定的期望姿态角为xd=[ρd εd]T,可以是时间的函数xd(t),也可以是定值xd(c)。
[0091] 步骤二:计算姿态角跟踪误差z1
[0092] 当期望姿态角为时间的函数xd(t)时,姿态角跟踪误差z1为
[0093] z1=x-xd(t)
[0094] 当期望姿态角为定值xd(c)时,姿态角跟踪误差z1为
[0095] z1=x-xd(c)
[0096] 步骤三:设计虚拟控制律vd
[0097] 1)给出3-DOF直升机的动力学方程
[0098] 根据附图2得到3-DOF直升机的动力学方程为:
[0099]
[0100] 其中Jρ,Jε分别为3-DOF直升机体轴系下的俯仰轴、滚转轴的转动惯量;ρ,ε分别为3-DOF直升机体轴系下的俯仰角、滚转角;La,Lh分别为模型中的力臂;Ff和Fb分别是前后螺旋桨的输出电压;Kf是电压和力之间的转换系数;Mf,Mb和Mw分别是前后螺旋桨和配重块的质量。
[0101] 将3-DOF直升机动力学模型整理成如下控制模型形式:
[0102]
[0103] 其中, x=[ρ ε]T∈R2是地面坐标系下的俯仰角速度、滚转角速度;
[0104] v=[q p]T∈R2为3-DOF直升机体轴系下的俯仰角速度、滚转角速度;
[0105] 为系统未知的质量矩阵;
[0106]为系统未知的重力惯量,其中m=Mwg·Lw-(Mf+Mb)g·La;D(v,x,t)∈R2是附加的系统未知干T T
扰;u=[u1 u2] =[Ff-Fsat Fb-Fsat]为控制输入矢量,前螺旋桨输出电压Ff∈(0,2Fsat),后螺旋桨输出电压Fb∈(0,2Fsat);y为观测输出。
[0107] 2)设计虚拟控制律vd
[0108] 虚拟控制律vd及其对时间的导数 作为神经网络中的变量,在本方法中选择[0109]
[0110] 定义矩阵K1∈R2×2, 为期望姿态角对时间求导数;将虚拟控制律vd对时间求导数,可得到
[0111]
[0112] 为期望姿态角对时间求二阶导数; 为雅克比矩阵的逆对时间求导数;为姿态角跟踪误差对时间求导数。
[0113] 步骤四:设计神经网络
[0114] 利用神经网络逼近3-DOF直升机动力学方程中的不确定项,神经网络方法有多种形式,在本方法中选择径向基神经网络(RBFNN),其形式为
[0115]
[0116] 1)神经网络变量Z
[0117]
[0118] 将地轴系下实际姿态角x、3-DOF直升机体轴系下实际角速度v、虚拟控制律vd及其对时间的导数 作为神经网络中的变量;
[0119] 2)神经网络权向量
[0120]
[0121] 其中,对于给定的Λi∈R2×2, βi>0; i=1,2的计算方法如下
[0122]
[0123] 将 对时间积分迭代可得到 最终得到
[0124] 3)基函数向量
[0125]
[0126] 步骤五:辅助控制系统设计:设计状态量 解决输入饱和问题
[0127] 状态量 的设计方法如下
[0128]
[0129] 其中,μ是一个很小的正值;K2∈R2×2, Δu=u-u0为实际输入量与控制律的偏差量。
[0130] 将 积分迭代可得到 利用辅助控制系统参数 修正姿态角速度跟踪误差项,解决系统输入饱和问题。
[0131] 步骤六:设计模型控制律
[0132] 1)对输入矢量限幅,其计算方法如下:
[0133]
[0134] 其中,输入矢量u=[u1 u2]T,-Fsat≤ui≤Fsat,i=1,2;-Fsat为控制量所限定的最小值,Fsat为控制量所限定的最大值;u0i是控制律u0的第i维分量2)利用辅助控制系统修正姿态角速度跟踪误差项,其设计方法如下:
[0135]
[0136] 其中,K3∈R2×2,K3=K3T>0。
[0137] 步骤七:将模型控制律应用于3-DOF直升机非线性模型,进行姿态角跟踪仿真
高效检索全球专利

专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台,是提供专利分析,专利查询,专利检索等数据服务功能的知识产权数据服务商。

我们的产品包含105个国家的1.26亿组数据,免费查、免费专利分析。

申请试用

分析报告

专利汇分析报告产品可以对行业情报数据进行梳理分析,涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度,系统通过AI智能系统对图表进行解读,只需1分钟,一键生成行业专利分析报告。

申请试用

QQ群二维码
意见反馈