CN107368091A - 一种基于有限时间神经动力学的多旋翼无人飞行器的稳定飞行控制方法 - Google Patents

一种基于有限时间神经动力学的多旋翼无人飞行器的稳定飞行控制方法 Download PDF

Info

Publication number
CN107368091A
CN107368091A CN201710650246.7A CN201710650246A CN107368091A CN 107368091 A CN107368091 A CN 107368091A CN 201710650246 A CN201710650246 A CN 201710650246A CN 107368091 A CN107368091 A CN 107368091A
Authority
CN
China
Prior art keywords
mrow
msub
mover
msup
phi
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.)
Granted
Application number
CN201710650246.7A
Other languages
English (en)
Other versions
CN107368091B (zh
Inventor
张智军
郭琦
郑陆楠
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
South China University of Technology SCUT
Original Assignee
South China University of Technology SCUT
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by South China University of Technology SCUT filed Critical South China University of Technology SCUT
Priority to CN201710650246.7A priority Critical patent/CN107368091B/zh
Priority to PCT/CN2017/109484 priority patent/WO2019024303A1/zh
Priority to US16/636,011 priority patent/US11378983B2/en
Publication of CN107368091A publication Critical patent/CN107368091A/zh
Application granted granted Critical
Publication of CN107368091B publication Critical patent/CN107368091B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0808Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
    • G05D1/0816Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
    • G05D1/0825Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using mathematical models
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64CAEROPLANES; HELICOPTERS
    • B64C39/00Aircraft not otherwise provided for
    • B64C39/02Aircraft not otherwise provided for characterised by special use
    • B64C39/024Aircraft not otherwise provided for characterised by special use of the remote controlled vehicle type, i.e. RPV
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64UUNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
    • B64U10/00Type of UAV
    • B64U10/10Rotorcrafts
    • B64U10/13Flying platforms
    • B64U10/16Flying platforms with five or more distinct rotor axes, e.g. octocopters
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0808Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
    • G05D1/0858Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft specially adapted for vertical take-off of aircraft
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/10Simultaneous control of position or course in three dimensions
    • G05D1/101Simultaneous control of position or course in three dimensions specially adapted for aircraft
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/10Simultaneous control of position or course in three dimensions
    • G05D1/101Simultaneous control of position or course in three dimensions specially adapted for aircraft
    • G05D1/102Simultaneous control of position or course in three dimensions specially adapted for aircraft specially adapted for vertical take-off of aircraft
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06NCOMPUTING ARRANGEMENTS BASED ON SPECIFIC COMPUTATIONAL MODELS
    • G06N3/00Computing arrangements based on biological models
    • G06N3/02Neural networks
    • G06N3/08Learning methods
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64UUNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
    • B64U2201/00UAVs characterised by their flight controls
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64UUNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
    • B64U2201/00UAVs characterised by their flight controls
    • B64U2201/10UAVs characterised by their flight controls autonomous, i.e. by navigating independently from ground or air stations, e.g. by using inertial navigation systems [INS]

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Mathematical Physics (AREA)
  • Theoretical Computer Science (AREA)
  • Pure & Applied Mathematics (AREA)
  • Mathematical Optimization (AREA)
  • Mathematical Analysis (AREA)
  • Algebra (AREA)
  • Computing Systems (AREA)
  • General Health & Medical Sciences (AREA)
  • General Engineering & Computer Science (AREA)
  • Software Systems (AREA)
  • Biophysics (AREA)
  • Artificial Intelligence (AREA)
  • Molecular Biology (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Health & Medical Sciences (AREA)
  • Biomedical Technology (AREA)
  • Evolutionary Computation (AREA)
  • Data Mining & Analysis (AREA)
  • Computational Linguistics (AREA)
  • Mechanical Engineering (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Feedback Control In General (AREA)
  • External Artificial Organs (AREA)

Abstract

本发明公开了一种基于有限时间神经动力学的多旋翼无人飞行器的稳定飞行控制方法,实现过程如下:1)通过机载传感器获取飞行实时方位和姿态数据,并通过机载处理器对飞行器的运动学问题进行解析处理,建立飞行器动力学模型;2)根据有限时间变参收敛微分神经动力学设计方法,设计有限时间变参收敛微分神经网络求解器;3)利用获取的实时方位和姿态数据,通过有限时间变参收敛微分神经网络求解器求解飞行器各个电机输出控制量;4)将求解结果传递给飞行器各个电机调速器以控制无人飞行器运动。本发明基于有限时间变参收敛微分神经动力学方法,可快速、准确、实时地逼近问题正确解,可以很好地解决矩阵、向量、代数以及优化等多种时变问题。

Description

一种基于有限时间神经动力学的多旋翼无人飞行器的稳定飞 行控制方法
技术领域
本发明涉及无人飞行器的飞行控制技术领域,具体涉及一种基于有限时间神经动力学的多旋翼无人飞行器的方位和姿态稳定飞行控制方法。
背景技术
近些年来,随着科技的日益发展,多旋翼无人飞行器因为它成本低,飞行灵活并且具有简单的机械结构等特点,已经广泛运用在军事、农业、监视任务、探测等诸多领域。在对多旋翼无人飞行器的研究领域中,一个重要的出发点就是其方位稳定以及姿态角稳定控制器的设计。在实际运用中,位置和角度的稳定意义重大,一般在远程操作的情况下,无人飞行器通常是由操作人员手动遥控,并不断控制调整位置,高度,俯仰角,横滚角和偏航角等状态,以达到目标位置和姿态或是完成目标任务。很明显,在这一过程之中,不但需要操作人员有着丰富的远程操作经验,更是要求无人机具有良好的方位和姿态角稳定性和抗干扰能力。这也是吸引越来越多的学者和研究人员深入学习无人机稳定控制器设计方法的初衷。虽然小型多旋翼无人飞行器控制较为简单方便,但其方位和角度稳定控制器的设计方法是复杂多样且迷人的。随着研究的深入,在实现了对无人机进行简单的方位及姿态控制之后,为了满足在一些复杂特殊任务的需求,让无人飞行器具有能够跟随时变目标值的能力是有意义也是有实际应用价值的。例如,当无人机应用在航拍领域中时,经常需要让飞行器在预定轨道以固定的飞行姿态进行拍摄,又或是在预定轨道对同一物体进行360°拍摄等。因此,无人机的控制器要具对时变目标的跟随能力,也就是说,控制器需要具备很强的鲁棒性,较快的收敛速度以及稳定性,这样才能以保证飞行器可以有效的完成对时变目标的跟随。
发明内容
本发明的目的是为了解决现有技术中的上述缺陷,提供一种多旋翼无人飞行器的稳定飞行控制方法。
本发明的目的可以通过采取如下技术方案达到:
一种基于有限时间神经动力学的多旋翼无人飞行器的稳定飞行控制方法,所述的控制方法包括如下步骤:
S1、通过多旋翼无人机的传感器获取自身的飞行实时方位和姿态数据,并通过所搭载的处理器对飞行器的运动学问题进行相应的解析处理,建立飞行器动力学模型;
S2、根据有限时间变参收敛微分神经动力学设计方法,设计多旋翼飞行器动力学模型的有限时间变参收敛微分神经网络求解器;
S3、利用获取的飞行器实时方位和姿态数据,通过有限时间变参收敛微分神经网络求解器求解飞行器电机的各个输出控制量;
S4、将求解出的各个输出控制量传递给飞行器各个电机调速器以控制无人飞行器运动。
进一步地,所述的步骤S1中通过所搭载的处理器对飞行器的运动学问题进行相应的解析处理,建立飞行器动力学模型具体包括:
忽略飞行器所受空气阻力作用,针对飞行器***可以建立物理模型:
其中,m为飞行器的总质量,I为3×3单位矩阵,J为飞行器转动惯量矩阵,v和w为飞行器地面坐标系的速度矢量以及角速度矢量,F和G分别为飞行器电机输出合力轴向分力矢量和重力的轴向分力矢量,T为飞行器转动力矩矢量;
建立地面坐标系XG以及飞行器机体坐标系XU,其中地面坐标系和机体坐标系之间存在以下关系:XU=KXG,转换关系中,K为地面坐标系以及机体坐标系之间的旋转变换矩阵,可以表示为
其中Cθ表示cosθ(t),Sθ表示sinθ(t),θ(t)为俯仰角,ψ(t)为偏航角,φ(t)为横滚角;
根据坐标变换理论,在飞行器的平动方向以及转动方向上,根据以上物理模型可以获得如下在飞行器机体坐标系上的动力学方程
其中,x,y,z分别为飞行器在世界坐标系中的位置坐标,Jx,Jy和Jz分别为飞行器在x轴、y轴和z轴方向的转动惯量,l为臂长,g为重力加速度,合成控制量u1~u4由飞行器电机的输出推力以及合成转矩构成,u1(t)为飞行器垂直上升方向上的合力,u2(t)为横滚角方向合力,u3(t)为俯仰角方向合力,u4(t)为偏航角方向合成转矩。
进一步地,所述的步骤S2中根据有限时间变参收敛微分神经动力学设计方法,设计多旋翼飞行器动力学模型的有限时间变参收敛微分神经网络求解器具体包括:
通过有限时间变参收敛微分神经动力学设计方法,分别由z轴高度z(t)、横滚角φ(t)、俯仰角θ(t)和偏航角ψ(t)出发,设计关于输出控制量u1~u4的有限时间变参收敛微分神经网络的***参数偏差函数;
分别根据所求出的关于输出控制量u1~u4的有限时间变参收敛微分神经网络的***参数偏差函数,设计有限时间变参收敛微分神经网络求解器。
进一步地,所述的通过有限时间变参收敛微分神经动力学设计方法,分别由z轴高度z(t)、横滚角φ(t)、俯仰角θ(t)和偏航角ψ(t)出发,设计关于输出控制量u1~u4的有限时间变参收敛微分神经网络的***参数偏差函数的步骤具体包括:
S201、针对z轴高度z(t),根据z轴方向上的设定目标高度值以及实际高度值zT(t),在位置层上可以定义关于实际高度值z(t)偏差函数ez1为:ez1(t)=z(t)-zT(t),为了使实际值z(t)能够收敛到时变目标值zT(t),根据有限时间变参收敛微分神经动力学设计方法,设计基于偏差函数的神经动力学方程其中γ(t)=p+tp为时变参数,表示收敛率调节因子;
根据偏差函数ez1(t)=z(t)-zT(t),可以得到将ez1(t)=z(t)-zT(t)以及代入可得也即
位置层z(t)能够在有限时间内以超指数收敛到时变目标值zT(t),但是由于等式(3)不包含关于控制量u1~u4的相关信息,无法实现对控制量的求解,故需要再进一步设计包含速度层以及加速度层的偏差函数,于是定义根据有限时间变参收敛微分神经网络设计方法,可以设计基于偏差函数的动力学方程其中γ(t)=p+tp
根据已知偏差函数ez2(t)的导数为:将以上关于ez2(t)以及的方程代入等式可以获得如下函数式:
当等式(4)成立时,速度层将在有限时间内以超指数收敛到据此,可以考虑偏差函数
为获得神经网络的实际模型,结合动力学方程(2),等式(5)能够被改写为
Ez(t)=az(t)u1(t)+bz(t), (6)
其中
也即获得了关于输出控制量u1(t)的偏差函数;
S202、针对横滚角φ(t),为了达到的目标角度φT(t),首先定义误差函数eφ1=φ(t)-φT(t)根据偏差函数eφ1(t)=φ(t)-φT(t),可以得到由于在角度层求解,根据有限时间变参微分神经动力学设计方法可得其中γ(t)=p+tp为时变参数,表示收敛率调节因子,
将误差函数eφ1(t)=φ(t)-φT(t)和代入方程可得
φ(t)将在有限时间内以超指数收敛到目标角度φT(t);由于已知需要求解出含有的方程;为了得到含有的方程,利用同样方法设误差函数其中γ(t)=p+tp为时变参数,表示收敛率调节因子,
将以上关于eφ2(t)以及的方程代入等式可以获得如下函数式:
当等式(8)成立时,速度层将在有限时间内以超指数收敛到据此,可以考虑偏差函数
飞行器达到目标状态,根据所述的动力学模型方程,偏差函数可以进一步转化为
其中
也即获得了关于输出控制量u2(t)的偏差函数;
S203、针对俯仰角θ(t),为了达到的目标角度θT(t),首先定义误差函数eθ1=θ(t)-θT(t)根据偏差函数eθ1(t)=θ(t)-θT(t),可以得到由于在角度层求解,根据有限时间变参微分神经动力学设计方法可得其中γ(t)=p+tp为时变参数,表示收敛率调节因子,
将误差函数eθ1(t)=θ(t)-θT(t)和代入方程可得
θ(t)将在有限时间内以超指数收敛到目标角度θT(t);由于已知需要求解出含有的方程;为了得到含有的方程,利用同样方法设误差函数其中γ(t)=p+tp为时变参数,表示收敛率调节因子,
将以上关于eθ2(t)以及的方程代入等式可以获得如下函数式:
当等式(12)成立时,速度层将在有限时间内以超指数收敛到据此,可以考虑偏差函数
飞行器达到目标状态,根据所述的动力学模型方程,偏差函数可以进一步转化为
其中
,也即获得了关于输出控制量u3(t)的偏差函数;
S204、针对偏航角ψ(t),为了达到的目标角度ψT(t),首先定义误差函数eψ1=ψ(t)-ψT(t)根据偏差函数eψ1(t)=ψ(t)-ψT(t),可以得到由于在角度层求解,根据有限时间变参微分神经动力学设计方法可得其中γ(t)=p+tp为时变参数,表示收敛率调节因子,
将误差函数eψ1(t)=ψ(t)-ψT(t)和代入方程可得
ψ(t)将在有限时间内以超指数收敛到目标角度ψT(t);由于已知需要求解出含有的方程;为了得到含有的方程,利用同样方法设误差函数
其中γ(t)=p+tp为时变参数,表示收敛率调节因子,
将以上关于eψ2(t)以及的方程代入等式可以获得如下函数式:
当等式(16)成立时,速度层将在有限时间内以超指数收敛到据此,可以考虑偏差函数
飞行器达到目标状态,根据所述的动力学模型方程,偏差函数可以进一步转化为
其中
,也即获得了关于输出控制量u4(t)的偏差函数;
进一步地,所述的分别根据所求出的关于输出控制量u1~u4的有限时间变参收敛微分神经网络的***参数偏差函数,设计有限时间变参收敛微分神经网络求解器的步骤具体包括:
S211、对于z轴高度z(t),利用有限时间变参收敛微分神经网络设计方法,设计将等式(6)以及其导数代入方程可得到有限时间变参收敛微分神经网络的隐式动力学方程
位置z(t)和速度将在有限时间内以超指数的形式分别收敛到目标位置zT(t)和目标速度
S212、针对横滚角φ(t),根据有限时间变参收敛微分神经动力学设计方法,设计将等式(10)以及其导数代入方程可得到有限时间变参收敛微分神经网络的隐式动力学方程
横滚角φ(t)和速度将在有限时间内以超指数的形式分别收敛到目标位置φT(t)和目标速度
S213、针对俯仰角θ(t),根据有限时间变参收敛微分神经动力学设计方法,设计将等式(14)以及其导数代入方程可得到有限时间变参收敛微分神经网络的隐式动力学方程
俯仰角θ(t)和速度将在有限时间内以超指数的形式分别收敛到目标位置θT(t)和目标速度
S214、针对偏航角ψ(t),根据有限时间变参收敛微分神经动力学设计方法,设计将等式(18)以及其导数代入方程可得到有限时间变参收敛微分神经网络的隐式动力学方程
俯仰角ψ(t)和速度将在有限时间内以超指数的形式分别收敛到目标位置ψT(t)和目标速度
S215、求解合成控制量u1~u4即为对应飞行器飞行需求的控制量,根据等式(19),(20),(21),(22)分别获得控制量u1~u4的神经网络方程,具体分别如下:
将求解出的控制量u1~u4根据不同旋翼飞行器的结构以及电机数目进行不同的输出控制分配。
本发明相对于现有技术具有如下的优点及效果:
本发明基于变参收敛微分神经动力学方法,采用普遍存在的隐动力学模型进行描述,可从方法和***层面上充分利用各时变参数的导数信息,对问题求解具有一定预测能力,可快速、准确、实时地逼近问题正确解,可以很好地解决矩阵、向量、代数以及优化等多种时变问题。
附图说明
图1是本发明公开的基于有限时间神经动力学的多旋翼无人飞行器的稳定飞行控制方法的流程图;
图2是本发明的多旋翼飞行器结构侧视图;
图3是本发明的多旋翼飞行器结构俯视图;
图4是本发明的多旋翼飞行器结构三维视图;
图5是多旋翼飞行器机体坐标系图;
图6(a)-图6(d)是神经网络控制器位置层仿真控制效果,图6(a)为横滚角φ(t)位置层仿真结果,图6(b)为俯仰角θ(t)位置层仿真结果,图6(c)为偏航角ψ(t)位置层仿真结果,图6(d)为z轴高度z(t)位置层仿真结果;
图7(a)-图7(d)是神经网络控制器速度层仿真控制效果,图7(a)为横滚角φ(t)速度层仿真结果,图7(b)为俯仰角θ(t)速度层仿真结果,图7(c)为偏航角ψ(t)速度层仿真结果,图7(d)为z轴高度z(t)速度层仿真结果。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
实施例
图1为本发明的公开的基于有限时间神经动力学的多旋翼无人飞行器的稳定飞行控制方法的流程图,通过图示步骤能够完成飞行器神经网络控制器的设计:
如图所示,一种基于有限时间神经动力学的多旋翼无人飞行器的稳定飞行控制方法,包括如下步骤:
S1、通过多旋翼无人飞行器上机载的姿态传感器以及相应的高度与位置传感器获取飞行器自身的飞行实时运行数据,建立飞行器动力学模型,并通过多旋翼无人飞行器所搭载的处理器对飞行器的运动学问题进行相应的解析处理;
S2、根据有限时间变参收敛微分神经动力学设计方法,设计多旋翼飞行器动力学模型的有限时间变参收敛微分神经网络求解器;
S3、利用步骤S1中获取的飞行器实时运行数据与目标姿态数据,通过步骤S2所设计的有限时间变参收敛微分神经网络求解器求解飞行器电机的输出控制量;
S4、将步骤S3的求解结果传递给飞行器电机调速器控制多旋翼无人飞行器运动。
图2、图3以及图4所示的机构为多旋翼飞行器中的一种旋翼飞行器结构。该结构为六旋翼飞行器机构模型,该机构模型由多旋翼飞行器螺旋桨1、无刷电机2、旋翼臂3与机身4组成。其中,六个电机的输出合力以及合成旋转转矩构成多旋翼飞行器的控制量u1~u4。而本发明的控制设计在于通过所设计的有限时间变参收敛微分神经网络求解多旋翼飞行器的控制量,从而控制飞行器飞行,实现飞行器的稳定控制。其中,图3和图4中的旋转箭头方向指示电机的旋转方向,而图示旋转方向顺时针与逆时针组合目的为实现电机转矩的相互抵消,实现稳定的转向控制。
图5所示为多旋翼飞行器所在的机体坐标系示意图。根据机体坐标系做出如下定义:
(1)、按照顺时针方向定义六旋翼飞行器六个电机分别为①号到⑥号;
(2)、x轴沿①号旋翼臂方向,通过机体重心指向飞行器前进方向;
(3)、y轴沿②、③号旋翼臂的对称轴方向,通过机体重心指向飞行器右侧运动方向;
(4)、z轴垂直于六旋翼平面向上,通过机体重心指向飞行器爬升方向;
(5)、俯仰角θ(t)为机体x轴与大地水平面间所夹角度,设定向下为正;
(6)、横滚角φ(t)为机体z轴与过机体x轴的大地竖直平面之间的夹角,飞机向右时为正;
(7)、偏航角ψ(t)为机体x轴在大地水平面上的投影与大地坐标系中x轴之间所夹角度,机头向左为正。
图6(a)-6(d)、图7(a)-7(d)为所设计飞行器神经网络控制器所获得的仿真控制效果曲线。实验仿真为从初始位置x=0,y=0,z=0以及初始姿态φ=0,θ=0,ψ=0开始,利用基于有限时间变参收敛微分神经网络的飞行器控制器使飞行器运行并达到目标位置xT=0,yT=0,zT=30+5sin 3t以及目标状态φT=-0.3+0.05sin 3t,θT=0.3+0.05sin 3t,ψT=0.15+0.05sin 3t;神经网络的调节因子γ(t)取γ=1.5+t1.5,r=0.4,k1=0.1,k2=30,k3=0.1。其中图6(a)-6(d)为位置层仿真结果,曲线均能够快速收敛到目标状态。图7(a)-7(d)为速度层仿真结果,在做出控制调整后各速度层参数能够再此收敛到目标速度。根据流程图的相关步骤,针对本发明进行详细的算法解析。首先,通过上述飞行器姿态变量的定义,本发明利用四元素算法以及卡尔曼滤波等算法,可以实现利用多旋翼飞行器上搭载的陀螺仪与加速度计等传感器获取飞行器的实时姿态数据θ(t),φ(t)以及ψ(t),利用高度传感器以及位置传感器获取飞行器在三维空间中的位置数据x(t),y(t)与z(t)。以上完成流程图传感器数据获取1的相关内容。
基于前面的物理模型分析过程,根据不同旋翼飞行器模型,建立针对该飞行器的物理模型等式以及动力学方程,可以通过如下飞行器动力学建模步骤完成动力学分析:
忽略飞行器所受空气阻力作用,针对飞行器***可以建立物理模型:
其中,m为飞行器的总质量,I为3×3单位矩阵,J为飞行器转动惯量矩阵,v和w为飞行器地面坐标系的速度矢量以及角速度矢量,F和G分别为飞行器电机输出合力轴向分力矢量和重力的轴向分力矢量,T为飞行器转动力矩矢量;
建立地面坐标系XG以及飞行器机体坐标系XU,其中地面坐标系和机体坐标系之间存在以下关系:XU=KXG,转换关系中,K为地面坐标系以及机体坐标系之间的旋转变换矩阵,可以表示为
其中为了书写方便Cθ表示cosθ(t),Sθ表示sinθ(t),θ(t)为俯仰角,ψ(t)为偏航角,φ(t)为横滚角;
根据坐标变换理论,在飞行器的平动方向以及转动方向上,根据以上物理模型可以获得如下在飞行器机体坐标系上的动力学方程
其中x,y,z分别为飞行器在世界坐标系中的位置坐标;Jx,Jy和Jz分别为飞行器在x轴、y轴和z轴方向的转动惯量;l为臂长;g为重力加速度;合成控制量u1~u4由飞行器电机的输出推力以及合成转矩构成,u1(t)为飞行器垂直上升方向上的合力,u2(t)为横滚角方向合力,u3(t)为俯仰角方向合力,u4(t)为偏航角方向合成转矩。
其中,步骤S2中根据有限时间变参收敛微分神经动力学设计方法,设计多旋翼飞行器动力学模型的有限时间变参收敛微分神经网络求解器具体包括:
通过有限时间变参收敛微分神经动力学设计方法,分别由z轴高度z(t)、横滚角φ(t)、俯仰角θ(t)和偏航角ψ(t)出发,设计关于输出控制量u1~u4的有限时间变参收敛微分神经网络的***参数偏差函数;
分别根据所求出的关于输出控制量u1~u4的有限时间变参收敛微分神经网络的***参数偏差函数,设计有限时间变参收敛微分神经网络求解器。
其中,步骤S3中通过有限时间变参收敛微分神经动力学设计方法,分别由z轴高度z(t)、横滚角φ(t)、俯仰角θ(t)和偏航角ψ(t)出发,设计关于输出控制量u1~u4的有限时间变参收敛微分神经网络的***参数偏差函数的步骤具体包括:
针对z轴高度z(t),根据z轴方向上的设定目标高度值以及实际高度值zT(t),在位置层上可以定义关于实际高度值z(t)偏差函数ez1为:ez1(t)=z(t)-zT(t),为了使实际值z(t)能够收敛到时变目标值zT(t),根据有限时间变参收敛微分神经动力学设计方法,可以设计基于偏差函数的神经动力学方程其中γ(t)=p+tp为时变参数,表示收敛率调节因子;
根据偏差函数ez1(t)=z(t)-zT(t),可以得到将ez1(t)=z(t)-zT(t)以及代入可得也即
位置层z(t)能够在有限时间内以超指数收敛到时变目标值zT(t),但是由于等式(3)不包含关于控制量u1~u4的相关信息,无法实现对控制量的求解,故需要再进一步设计包含速度层以及加速度层的偏差函数,于是定义根据有限时间变参收敛微分神经网络设计方法,可以设计基于偏差函数的动力学方程其中γ(t)=p+tp
根据已知偏差函数ez2(t)的导数为:将以上关于ez2(t)以及的方程代入等式可以获得如下函数式:
当等式(4)成立时,速度层将在有限时间内以超指数收敛到据此,可以考虑偏差函数
为获得神经网络的实际模型,结合动力学方程(2),等式(5)能够被改写为
Ez(t)=az(t)u1(t)+bz(t), (6)
其中
也即获得了关于输出控制量u1(t)的偏差函数;
针对横滚角φ(t),为了达到的目标角度φT(t),首先定义误差函数eφ1=φ(t)-φT(t)根据偏差函数eφ1(t)=φ(t)-φT(t),可以得到由于在角度层求解,根据有限时间变参微分神经动力学设计方法可得其中γ(t)=p+tp为时变参数,表示收敛率调节因子,
将误差函数eφ1(t)=φ(t)-φT(t)和代入方程可得
φ(t)将在有限时间内以超指数收敛到目标角度φT(t);由于已知需要求解出含有的方程;为了得到含有的方程,利用同样方法设误差函数其中γ(t)=p+tp为时变参数,表示收敛率调节因子,
将以上关于eφ2(t)以及的方程代入等式可以获得如下函数式:
当等式(8)成立时,速度层将在有限时间内以超指数收敛到据此,可以考虑偏差函数
飞行器达到目标状态,根据所述的动力学模型方程,偏差函数可以进一步转化为
其中
,也即获得了关于输出控制量u2(t)的偏差函数;
针对俯仰角θ(t),为了达到的目标角度θT(t),首先定义误差函数eθ1=θ(t)-θT(t)根据偏差函数eθ1(t)=θ(t)-θT(t),可以得到由于在角度层求解,根据有限时间变参微分神经动力学设计方法可得其中γ(t)=p+tp为时变参数,表示收敛率调节因子,
将误差函数eθ1(t)=θ(t)-θT(t)和代入方程可得
θ(t)将在有限时间内以超指数收敛到目标角度θT(t);由于已知需要求解出含有的方程;为了得到含有的方程,利用同样方法设误差函数
其中γ(t)=p+tp为时变参数,表示收敛率调节因子,
将以上关于eθ2(t)以及的方程代入等式可以获得如下函数式:
当等式(12)成立时,速度层将在有限时间内以超指数收敛到据此,可以考虑偏差函数
飞行器达到目标状态,根据所述的动力学模型方程,偏差函数可以进一步转化为
其中
,也即获得了关于输出控制量u3(t)的偏差函数;
针对偏航角ψ(t),为了达到的目标角度ψT(t),首先定义误差函数eψ1=ψ(t)-ψT(t)根据偏差函数eψ1(t)=ψ(t)-ψT(t),可以得到由于在角度层求解,根据有限时间变参微分神经动力学设计方法可得其中γ(t)=p+tp为时变参数,表示收敛率调节因子,
将误差函数eψ1(t)=ψ(t)-ψT(t)和代入方程可得
ψ(t)将在有限时间内以超指数收敛到目标角度ψT(t);由于已知需要求解出含有的方程;为了得到含有的方程,利用同样方法设误差函数
其中γ(t)=p+tp为时变参数,表示收敛率调节因子,
将以上关于eψ2(t)以及的方程代入等式可以获得如下函数式:
当等式(16)成立时,速度层将在有限时间内以超指数收敛到据此,可以考虑偏差函数
飞行器达到目标状态,根据所述的动力学模型方程,偏差函数可以进一步转化为
其中
,也即获得了关于输出控制量u4(t)的偏差函数;
其中,步骤S4中分别根据所求出的关于输出控制量u1~u4的有限时间变参收敛微分神经网络的***参数偏差函数,设计有限时间变参收敛微分神经网络求解器的步骤具体包括:
对于z轴高度z(t),利用有限时间变参收敛微分神经网络设计方法,可以设计将等式(6)以及其导数
代入方程可得到有限时间变参收敛微分神经网络的隐式动力学方程
位置z(t)和速度将在有限时间内以超指数的形式分别收敛到目标位置zT(t)和目标速度
针对横滚角φ(t),根据有限时间变参收敛微分神经动力学设计方法,可以设计将等式(10)以及其导数代入方程可得到有限时间变参收敛微分神经网络的隐式动力学方程
横滚角φ(t)和速度将在有限时间内以超指数的形式分别收敛到目标位置φT(t)和目标速度
针对俯仰角θ(t),根据有限时间变参收敛微分神经动力学设计方法,可以设计将等式(14)以及其导数代入方程可得到有限时间变参收敛微分神经网络的隐式动力学方程
俯仰角θ(t)和速度将在有限时间内以超指数的形式分别收敛到目标位置θT(t)和目标速度
针对偏航角ψ(t),根据有限时间变参收敛微分神经动力学设计方法,可以设计将等式(18)以及其导数代入方程可得到有限时间变参收敛微分神经网络的隐式动力学方程
俯仰角ψ(t)和速度将在有限时间内以超指数的形式分别收敛到目标位置ψT(t)和目标速度
求解合成控制量u1~u4即为对应飞行器飞行需求的控制量,根据等式(19),(20),(21),(22)可以分别获得控制量u1~u4的神经网络方程,具体分别如下:
将求解出的控制量u1(t)~u4(t)根据不同旋翼飞行器的结构以及电机数目进行不同的输出控制分配。
根据上述神经网络求解过程所求出的控制量u1~u4,针对不同飞行器的结构以及电机数目,通过相应的电机控制量分配实现每个电机的控制,综上完成流程图电机控制量分配以及电机控制。根据上述步骤可以完成本发明。
综上所述,本发明首先通过多旋翼无人机的传感器获取自身的飞行实时方位和姿态数据,并通过所搭载的处理器对飞行器的运动学问题进行相应的解析处理,建立飞行器动力学模型;然后根据有限时间变参收敛微分神经动力学设计方法,设计多旋翼飞行器动力学模型的有限时间变参收敛微分神经网络求解器;接着利用获取的飞行器实时方位和姿态数据,通过有限时间变参收敛微分神经网络求解器求解飞行器电机的各个输出控制量;最后将求解结果传递给飞行器各个电机调速器以控制无人飞行器运动。本发明基于有限时间变参收敛微分神经动力学方法,可快速、准确、实时地逼近问题正确解,可以很好地解决矩阵、向量、代数以及优化等多种时变问题。
上述实施例为本发明较佳的实施方式,但本发明的实施方式并不受上述实施例的限制,其他的任何未背离本发明的精神实质与原理下所作的改变、修饰、替代、组合、简化,均应为等效的置换方式,都包含在本发明的保护范围之内。

Claims (5)

1.一种基于有限时间神经动力学的多旋翼无人飞行器的稳定飞行控制方法,其特征在于,所述的控制方法包括如下步骤:
S1、通过多旋翼无人机的传感器获取自身的飞行实时方位和姿态数据,并通过所搭载的处理器对飞行器的运动学问题进行相应的解析处理,建立飞行器动力学模型;
S2、根据有限时间变参收敛微分神经动力学设计方法,设计多旋翼飞行器动力学模型的有限时间变参收敛微分神经网络求解器;
S3、利用获取的飞行器实时方位和姿态数据,通过有限时间变参收敛微分神经网络求解器求解飞行器电机的各个输出控制量;
S4、将求解出的各个输出控制量传递给飞行器各个电机调速器以控制无人飞行器运动。
2.根据权利要求1所述的一种基于有限时间神经动力学的多旋翼无人飞行器的稳定飞行控制方法,其特征在于,所述的步骤S1中通过所搭载的处理器对飞行器的运动学问题进行相应的解析处理,建立飞行器动力学模型具体包括:
忽略飞行器所受空气阻力作用,针对飞行器***可以建立物理模型:
其中,m为飞行器的总质量,I为3×3单位矩阵,J为飞行器转动惯量矩阵,v和w为飞行器地面坐标系的速度矢量以及角速度矢量,F和G分别为飞行器电机输出合力轴向分力矢量和重力的轴向分力矢量,T为飞行器转动力矩矢量;
建立地面坐标系XG以及飞行器机体坐标系XU,其中地面坐标系和机体坐标系之间存在以下关系:XU=KXG,转换关系中,K为地面坐标系以及机体坐标系之间的旋转变换矩阵,可以表示为
其中Cθ表示cosθ(t),Sθ表示sinθ(t),θ(t)为俯仰角,ψ(t)为偏航角,φ(t)为横滚角;
根据坐标变换理论,在飞行器的平动方向以及转动方向上,根据以上物理模型可以获得如下在飞行器机体坐标系上的动力学方程
其中,x,y,z分别为飞行器在世界坐标系中的位置坐标,Jx,Jy和Jz分别为飞行器在x轴、y轴和z轴方向的转动惯量,l为臂长,g为重力加速度,合成控制量u1~u4由飞行器电机的输出推力以及合成转矩构成,u1(t)为飞行器垂直上升方向上的合力,u2(t)为横滚角方向合力,u3(t)为俯仰角方向合力,u4(t)为偏航角方向合成转矩。
3.根据权利要求2所述的一种基于有限时间神经动力学的多旋翼无人飞行器的稳定飞行控制方法,其特征在于,所述的步骤S2中根据有限时间变参收敛微分神经动力学设计方法,设计多旋翼飞行器动力学模型的有限时间变参收敛微分神经网络求解器具体包括:
通过有限时间变参收敛微分神经动力学设计方法,分别由z轴高度z(t)、横滚角φ(t)、俯仰角θ(t)和偏航角ψ(t)出发,设计关于输出控制量u1~u4的有限时间变参收敛微分神经网络的***参数偏差函数;
分别根据所求出的关于输出控制量u1~u4的有限时间变参收敛微分神经网络的***参数偏差函数,设计有限时间变参收敛微分神经网络求解器。
4.根据权利要求3所述的一种基于有限时间神经动力学的多旋翼无人飞行器的稳定飞行控制方法,其特征在于,所述的通过有限时间变参收敛微分神经动力学设计方法,分别由z轴高度z(t)、横滚角φ(t)、俯仰角θ(t)和偏航角ψ(t)出发,设计关于输出控制量u1~u4的有限时间变参收敛微分神经网络的***参数偏差函数的步骤具体包括:
S201、针对z轴高度z(t),根据z轴方向上的设定目标高度值以及实际高度值zT(t),在位置层上可以定义关于实际高度值z(t)偏差函数ez1为:ez1(t)=z(t)-zT(t),为了使实际值z(t)能够收敛到时变目标值zT(t),根据有限时间变参收敛微分神经动力学设计方法,设计基于偏差函数的神经动力学方程其中γ(t)=p+tp为时变参数,表示收敛率调节因子;
<mrow> <mi>&amp;Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>z</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>k</mi> <mn>1</mn> </msub> <mo>|</mo> <msub> <mi>e</mi> <mrow> <mi>z</mi> <mn>1</mn> </mrow> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <msup> <mo>|</mo> <mi>r</mi> </msup> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>z</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>k</mi> <mn>2</mn> </msub> <msub> <mi>e</mi> <mrow> <mi>z</mi> <mn>1</mn> </mrow> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>k</mi> <mn>3</mn> </msub> <mo>|</mo> <msub> <mi>e</mi> <mrow> <mi>z</mi> <mn>1</mn> </mrow> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <msup> <mo>|</mo> <mfrac> <mn>1</mn> <mi>r</mi> </mfrac> </msup> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>z</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>)</mo> </mrow> </mrow>
根据偏差函数ez1(t)=z(t)-zT(t),可以得到将ez1(t)=z(t)-zT(t)以及代入可得也即
<mrow> <mover> <mi>z</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mover> <mi>z</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>T</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mrow> <mo>(</mo> <msup> <mi>t</mi> <mi>p</mi> </msup> <mo>+</mo> <mi>p</mi> <mo>)</mo> </mrow> <mi>&amp;Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>z</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mn>0</mn> <mo>;</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>3</mn> <mo>)</mo> </mrow> </mrow>
位置层z(t)能够在有限时间内以超指数收敛到时变目标值zT(t),但是由于等式(3)不包含关于控制量u1~u4的相关信息,无法实现对控制量的求解,故需要再进一步设计包含速度层以及加速度层的偏差函数,于是定义根据有限时间变参收敛微分神经网络设计方法,可以设计基于偏差函数的动力学方程其中γ(t)=p+tp
<mrow> <mi>&amp;Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>z</mi> <mn>2</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>k</mi> <mn>1</mn> </msub> <mo>|</mo> <msub> <mi>e</mi> <mrow> <mi>z</mi> <mn>2</mn> </mrow> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <msup> <mo>|</mo> <mi>r</mi> </msup> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>z</mi> <mn>2</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>k</mi> <mn>2</mn> </msub> <msub> <mi>e</mi> <mrow> <mi>z</mi> <mn>2</mn> </mrow> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>k</mi> <mn>3</mn> </msub> <mo>|</mo> <msub> <mi>e</mi> <mrow> <mi>z</mi> <mn>2</mn> </mrow> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <msup> <mo>|</mo> <mfrac> <mn>1</mn> <mi>r</mi> </mfrac> </msup> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mn>2</mn> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>)</mo> </mrow> </mrow>
根据已知偏差函数ez2(t)的导数为:将以上关于ez2(t)以及的方程代入等式可以获得如下函数式:
<mrow> <mover> <mi>z</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mover> <mi>z</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mi>T</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mrow> <mo>(</mo> <mi>p</mi> <mo>+</mo> <msup> <mi>t</mi> <mi>p</mi> </msup> <mo>)</mo> </mrow> <mover> <mi>&amp;Phi;</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>z</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mi>&amp;Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>z</mi> <mn>2</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msup> <mi>pt</mi> <mrow> <mi>p</mi> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mi>&amp;Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>z</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mn>0</mn> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>4</mn> <mo>)</mo> </mrow> </mrow>
当等式(4)成立时,速度层将在有限时间内以超指数收敛到据此,可以考虑偏差函数
<mrow> <msub> <mi>E</mi> <mi>z</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mover> <mi>z</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mover> <mi>z</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mi>T</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mrow> <mo>(</mo> <mi>p</mi> <mo>+</mo> <msup> <mi>t</mi> <mi>p</mi> </msup> <mo>)</mo> </mrow> <mover> <mi>&amp;Phi;</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>z</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mi>&amp;Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>z</mi> <mn>2</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msup> <mi>pt</mi> <mrow> <mi>p</mi> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mi>&amp;Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>z</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>5</mn> <mo>)</mo> </mrow> </mrow>
为获得神经网络的实际模型,结合动力学方程(2),等式(5)能够被改写为
Ez(t)=az(t)u1(t)+bz(t), (6)
其中
也即获得了关于输出控制量u1(t)的偏差函数;
S202、针对横滚角φ(t),为了达到的目标角度φT(t),首先定义误差函数eφ1=φ(t)-φT(t)根据偏差函数eφ1(t)=φ(t)-φT(t),可以得到由于在角度层求解,根据有限时间变参微分神经动力学设计方法可得其中γ(t)=p+tp为时变参数,表示收敛率调节因子,
<mrow> <mi>&amp;Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;phi;</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>k</mi> <mn>1</mn> </msub> <mo>|</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;phi;</mi> <mn>1</mn> </mrow> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <msup> <mo>|</mo> <mi>r</mi> </msup> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;phi;</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>k</mi> <mn>2</mn> </msub> <msub> <mi>e</mi> <mrow> <mi>&amp;phi;</mi> <mn>1</mn> </mrow> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>k</mi> <mn>3</mn> </msub> <mo>|</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;phi;</mi> <mn>1</mn> </mrow> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <msup> <mo>|</mo> <mfrac> <mn>1</mn> <mi>r</mi> </mfrac> </msup> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;phi;</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>;</mo> </mrow>
将误差函数eφ1(t)=φ(t)-φT(t)和代入方程可得
<mrow> <mover> <mi>&amp;phi;</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mover> <mi>&amp;phi;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>T</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mrow> <mo>(</mo> <msup> <mi>t</mi> <mi>p</mi> </msup> <mo>+</mo> <mi>p</mi> <mo>)</mo> </mrow> <mi>&amp;Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;phi;</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mn>0</mn> <mo>,</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>7</mn> <mo>)</mo> </mrow> </mrow>
φ(t)将在有限时间内以超指数收敛到目标角度φT(t);由于已知需要求解出含有的方程;为了得到含有的方程,利用同样方法设误差函数其中γ(t)=p+tp为时变参数,表示收敛率调节因子,
<mrow> <mi>&amp;Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;phi;</mi> <mn>2</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>k</mi> <mn>1</mn> </msub> <mo>|</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;phi;</mi> <mn>2</mn> </mrow> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <msup> <mo>|</mo> <mi>r</mi> </msup> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;phi;</mi> <mn>2</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>k</mi> <mn>2</mn> </msub> <msub> <mi>e</mi> <mrow> <mi>&amp;phi;</mi> <mn>2</mn> </mrow> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>k</mi> <mn>3</mn> </msub> <mo>|</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;phi;</mi> <mn>2</mn> </mrow> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <msup> <mo>|</mo> <mfrac> <mn>1</mn> <mi>r</mi> </mfrac> </msup> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;phi;</mi> <mn>2</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>;</mo> </mrow>
将以上关于eφ2(t)以及的方程代入等式可以获得如下函数式:
<mrow> <mover> <mi>&amp;phi;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mover> <mi>&amp;phi;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mi>T</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mrow> <mo>(</mo> <mi>p</mi> <mo>+</mo> <msup> <mi>t</mi> <mi>p</mi> </msup> <mo>)</mo> </mrow> <mover> <mi>&amp;Phi;</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;phi;</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mi>&amp;Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;phi;</mi> <mn>2</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msup> <mi>pt</mi> <mrow> <mi>p</mi> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mi>&amp;Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;phi;</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mn>0</mn> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>8</mn> <mo>)</mo> </mrow> </mrow>
当等式(8)成立时,速度层将在有限时间内以超指数收敛到据此,可以考虑偏差函数
<mrow> <msub> <mi>E</mi> <mi>&amp;phi;</mi> </msub> <mo>=</mo> <mover> <mi>&amp;phi;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mover> <mi>&amp;phi;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mi>T</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mrow> <mo>(</mo> <mi>p</mi> <mo>+</mo> <msup> <mi>t</mi> <mi>p</mi> </msup> <mo>)</mo> </mrow> <mover> <mi>&amp;Phi;</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;phi;</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mi>&amp;Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;phi;</mi> <mn>2</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msup> <mi>pt</mi> <mrow> <mi>p</mi> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mi>&amp;Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;phi;</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>9</mn> <mo>)</mo> </mrow> </mrow>
飞行器达到目标状态,根据所述的动力学模型方程,偏差函数可以进一步转化为
<mrow> <msub> <mi>E</mi> <mi>&amp;phi;</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mfrac> <mi>l</mi> <msub> <mi>J</mi> <mi>x</mi> </msub> </mfrac> <msub> <mi>u</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>b</mi> <mi>&amp;phi;</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>,</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>10</mn> <mo>)</mo> </mrow> </mrow>
其中
<mrow> <msub> <mi>b</mi> <mi>&amp;phi;</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mfrac> <mrow> <mo>(</mo> <msub> <mi>J</mi> <mi>y</mi> </msub> <mo>-</mo> <msub> <mi>J</mi> <mi>z</mi> </msub> <mo>)</mo> <mover> <mi>&amp;psi;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <msub> <mi>J</mi> <mi>x</mi> </msub> </mfrac> <mo>-</mo> <msub> <mover> <mi>&amp;phi;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mi>T</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mrow> <mo>(</mo> <mi>p</mi> <mo>+</mo> <msup> <mi>t</mi> <mi>p</mi> </msup> <mo>)</mo> </mrow> <mover> <mi>&amp;Phi;</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;phi;</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msup> <mi>pt</mi> <mrow> <mi>p</mi> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mi>&amp;Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;phi;</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mrow> <mo>(</mo> <mi>p</mi> <mo>+</mo> <msup> <mi>t</mi> <mi>p</mi> </msup> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <mi>&amp;Phi;</mi> <mo>(</mo> <mrow> <msub> <mi>e</mi> <mrow> <mi>&amp;phi;</mi> <mn>2</mn> </mrow> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>,</mo> <mi>t</mi> </mrow> <mo>)</mo> <mo>)</mo> </mrow> </mrow>
也即获得了关于输出控制量u2(t)的偏差函数;
S203、针对俯仰角θ(t),为了达到的目标角度θT(t),首先定义误差函数eθ1=θ(t)-θT(t)根据偏差函数eθ1(t)=θ(t)-θT(t),可以得到由于在角度层求解,根据有限时间变参微分神经动力学设计方法可得其中γ(t)=p+tp为时变参数,表示收敛率调节因子,
<mrow> <mi>&amp;Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;theta;</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>k</mi> <mn>1</mn> </msub> <mo>|</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;theta;</mi> <mn>1</mn> </mrow> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <msup> <mo>|</mo> <mi>r</mi> </msup> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;theta;</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>k</mi> <mn>2</mn> </msub> <msub> <mi>e</mi> <mrow> <mi>&amp;theta;</mi> <mn>1</mn> </mrow> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>k</mi> <mn>3</mn> </msub> <mo>|</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;theta;</mi> <mn>1</mn> </mrow> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <msup> <mo>|</mo> <mfrac> <mn>1</mn> <mi>r</mi> </mfrac> </msup> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;theta;</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>;</mo> </mrow>
将误差函数eθ1(t)=θ(t)-θT(t)和代入方程可得
<mrow> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>T</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mrow> <mo>(</mo> <msup> <mi>t</mi> <mi>p</mi> </msup> <mo>+</mo> <mi>p</mi> <mo>)</mo> </mrow> <mi>&amp;Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;theta;</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mn>0</mn> <mo>,</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>11</mn> <mo>)</mo> </mrow> </mrow>
θ(t)将在有限时间内以超指数收敛到目标角度θT(t);由于已知需要求解出含有的方程;为了得到含有的方程,利用同样方法设误差函数其中γ(t)=p+tp为时变参数,表示收敛率调节因子,
<mrow> <mi>&amp;Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;theta;</mi> <mn>2</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>k</mi> <mn>1</mn> </msub> <mo>|</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;theta;</mi> <mn>2</mn> </mrow> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <msup> <mo>|</mo> <mi>r</mi> </msup> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;theta;</mi> <mn>2</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>k</mi> <mn>2</mn> </msub> <msub> <mi>e</mi> <mrow> <mi>&amp;theta;</mi> <mn>2</mn> </mrow> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>k</mi> <mn>3</mn> </msub> <mo>|</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;theta;</mi> <mn>2</mn> </mrow> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <msup> <mo>|</mo> <mfrac> <mn>1</mn> <mi>r</mi> </mfrac> </msup> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;theta;</mi> <mn>2</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>;</mo> </mrow>
将以上关于eθ2(t)以及的方程代入等式可以获得如下函数式:
<mrow> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mi>T</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mrow> <mo>(</mo> <mi>p</mi> <mo>+</mo> <msup> <mi>t</mi> <mi>p</mi> </msup> <mo>)</mo> </mrow> <mover> <mi>&amp;Phi;</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;theta;</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mi>&amp;Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;theta;</mi> <mn>2</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msup> <mi>pt</mi> <mrow> <mi>p</mi> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mi>&amp;Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;theta;</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mn>0</mn> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>12</mn> <mo>)</mo> </mrow> </mrow>
当等式(12)成立时,速度层将在有限时间内以超指数收敛到据此,可以考虑偏差函数
<mrow> <msub> <mi>E</mi> <mi>&amp;theta;</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mi>T</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mrow> <mo>(</mo> <mi>p</mi> <mo>+</mo> <msup> <mi>t</mi> <mi>p</mi> </msup> <mo>)</mo> </mrow> <mover> <mi>&amp;Phi;</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;theta;</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mi>&amp;Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;theta;</mi> <mn>2</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msup> <mi>pt</mi> <mrow> <mi>p</mi> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mi>&amp;Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;theta;</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>13</mn> <mo>)</mo> </mrow> </mrow>
飞行器达到目标状态,根据所述的动力学模型方程,偏差函数可以进一步转化为
<mrow> <msub> <mi>E</mi> <mi>&amp;theta;</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mfrac> <mi>l</mi> <msub> <mi>J</mi> <mi>y</mi> </msub> </mfrac> <msub> <mi>u</mi> <mn>3</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>b</mi> <mi>&amp;theta;</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>,</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>14</mn> <mo>)</mo> </mrow> </mrow>
其中
<mrow> <msub> <mi>b</mi> <mi>&amp;theta;</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mfrac> <mrow> <mo>(</mo> <msub> <mi>J</mi> <mi>z</mi> </msub> <mo>-</mo> <msub> <mi>J</mi> <mi>x</mi> </msub> <mo>)</mo> <mover> <mi>&amp;psi;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mover> <mi>&amp;phi;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <msub> <mi>J</mi> <mi>y</mi> </msub> </mfrac> <mo>-</mo> <msub> <mover> <mi>&amp;phi;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mi>T</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mrow> <mo>(</mo> <mi>p</mi> <mo>+</mo> <msup> <mi>t</mi> <mi>p</mi> </msup> <mo>)</mo> </mrow> <mover> <mi>&amp;Phi;</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;theta;</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msup> <mi>pt</mi> <mrow> <mi>p</mi> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mi>&amp;Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;theta;</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mrow> <mo>(</mo> <mi>p</mi> <mo>+</mo> <msup> <mi>t</mi> <mi>p</mi> </msup> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <mi>&amp;Phi;</mi> <mo>(</mo> <mrow> <msub> <mi>e</mi> <mrow> <mi>&amp;theta;</mi> <mn>1</mn> </mrow> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>,</mo> <mi>t</mi> </mrow> <mo>)</mo> <mo>)</mo> </mrow> </mrow>
也即获得了关于输出控制量u3(t)的偏差函数;
S204、针对偏航角ψ(t),为了达到的目标角度ψT(t),首先定义误差函数eψ1=ψ(t)-ψT(t)根据偏差函数eψ1(t)=ψ(t)-ψT(t),可以得到由于在角度层求解,根据有限时间变参微分神经动力学设计方法可得其中γ(t)=p+tp为时变参数,表示收敛率调节因子,
<mrow> <mi>&amp;Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;psi;</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>k</mi> <mn>1</mn> </msub> <mo>|</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;psi;</mi> <mn>1</mn> </mrow> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <msup> <mo>|</mo> <mi>r</mi> </msup> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;psi;</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>k</mi> <mn>2</mn> </msub> <msub> <mi>e</mi> <mrow> <mi>&amp;psi;</mi> <mn>1</mn> </mrow> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>k</mi> <mn>3</mn> </msub> <mo>|</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;psi;</mi> <mn>1</mn> </mrow> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <msup> <mo>|</mo> <mfrac> <mn>1</mn> <mi>r</mi> </mfrac> </msup> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;psi;</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>;</mo> </mrow>
将误差函数eψ1(t)=ψ(t)-ψT(t)和代入方程可得
<mrow> <mover> <mi>&amp;psi;</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mover> <mi>&amp;psi;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>T</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mrow> <mo>(</mo> <msup> <mi>t</mi> <mi>p</mi> </msup> <mo>+</mo> <mi>p</mi> <mo>)</mo> </mrow> <mi>&amp;Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;psi;</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mn>0</mn> <mo>,</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>15</mn> <mo>)</mo> </mrow> </mrow>
ψ(t)将在有限时间内以超指数收敛到目标角度ψT(t);由于已知需要求解出含有的方程;为了得到含有的方程,利用同样方法设误差函数
<mrow> <msub> <mover> <mi>e</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mi>&amp;psi;</mi> <mn>2</mn> </mrow> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mover> <mi>&amp;psi;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mover> <mi>&amp;psi;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mi>T</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mrow> <mo>(</mo> <mi>p</mi> <mo>+</mo> <msup> <mi>t</mi> <mi>p</mi> </msup> <mo>)</mo> </mrow> <mover> <mi>&amp;Phi;</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;psi;</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msup> <mi>pt</mi> <mrow> <mi>p</mi> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mi>&amp;Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;psi;</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>,</mo> </mrow>
其中γ(t)=p+tp为时变参数,表示收敛率调节因子,
<mrow> <mi>&amp;Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;psi;</mi> <mn>2</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>k</mi> <mn>1</mn> </msub> <mo>|</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;psi;</mi> <mn>2</mn> </mrow> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <msup> <mo>|</mo> <mi>r</mi> </msup> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;psi;</mi> <mn>2</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>k</mi> <mn>2</mn> </msub> <msub> <mi>e</mi> <mrow> <mi>&amp;psi;</mi> <mn>2</mn> </mrow> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>k</mi> <mn>3</mn> </msub> <mo>|</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;psi;</mi> <mn>2</mn> </mrow> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <msup> <mo>|</mo> <mfrac> <mn>1</mn> <mi>r</mi> </mfrac> </msup> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;psi;</mi> <mn>2</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>;</mo> </mrow>
将以上关于eψ2(t)以及的方程代入等式可以获得如下函数式:
<mrow> <mover> <mi>&amp;psi;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mover> <mi>&amp;psi;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mi>T</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mrow> <mo>(</mo> <mi>p</mi> <mo>+</mo> <msup> <mi>t</mi> <mi>p</mi> </msup> <mo>)</mo> </mrow> <mover> <mi>&amp;Phi;</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;psi;</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mi>&amp;Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;psi;</mi> <mn>2</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msup> <mi>pt</mi> <mrow> <mi>p</mi> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mi>&amp;Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;psi;</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mn>0</mn> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>16</mn> <mo>)</mo> </mrow> </mrow>
当等式(16)成立时,速度层将在有限时间内以超指数收敛到据此,可以考虑偏差函数
<mrow> <msub> <mi>E</mi> <mi>&amp;psi;</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mover> <mi>&amp;psi;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mover> <mi>&amp;psi;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mi>T</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mrow> <mo>(</mo> <mi>p</mi> <mo>+</mo> <msup> <mi>t</mi> <mi>p</mi> </msup> <mo>)</mo> </mrow> <mover> <mi>&amp;Phi;</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;psi;</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mi>&amp;Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;psi;</mi> <mn>2</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msup> <mi>pt</mi> <mrow> <mi>p</mi> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mi>&amp;Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;psi;</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>17</mn> <mo>)</mo> </mrow> </mrow>
飞行器达到目标状态,根据所述的动力学模型方程,偏差函数可以进一步转化为
<mrow> <msub> <mi>E</mi> <mi>&amp;psi;</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mfrac> <mn>1</mn> <msub> <mi>J</mi> <mi>z</mi> </msub> </mfrac> <msub> <mi>u</mi> <mn>4</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>b</mi> <mi>&amp;psi;</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>,</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>18</mn> <mo>)</mo> </mrow> </mrow>
其中
<mrow> <msub> <mi>b</mi> <mi>&amp;psi;</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mfrac> <mrow> <mo>(</mo> <msub> <mi>J</mi> <mi>x</mi> </msub> <mo>-</mo> <msub> <mi>J</mi> <mi>y</mi> </msub> <mo>)</mo> <mover> <mi>&amp;phi;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <msub> <mi>J</mi> <mi>z</mi> </msub> </mfrac> <mo>-</mo> <msub> <mover> <mi>&amp;psi;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mi>T</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mrow> <mo>(</mo> <mi>p</mi> <mo>+</mo> <msup> <mi>t</mi> <mi>p</mi> </msup> <mo>)</mo> </mrow> <mover> <mi>&amp;Phi;</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;psi;</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msup> <mi>pt</mi> <mrow> <mi>p</mi> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mi>&amp;Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>&amp;psi;</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mrow> <mo>(</mo> <mi>p</mi> <mo>+</mo> <msup> <mi>t</mi> <mi>p</mi> </msup> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <mi>&amp;Phi;</mi> <mo>(</mo> <mrow> <msub> <mi>e</mi> <mrow> <mi>&amp;psi;</mi> <mn>2</mn> </mrow> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>,</mo> <mi>t</mi> </mrow> <mo>)</mo> <mo>)</mo> </mrow> </mrow>
也即获得了关于输出控制量u4(t)的偏差函数。
5.根据权利要求4所述的一种基于有限时间神经动力学的多旋翼无人飞行器的稳定飞行控制方法,其特征在于,所述的分别根据所求出的关于输出控制量u1~u4的有限时间变参收敛微分神经网络的***参数偏差函数,设计有限时间变参收敛微分神经网络求解器的步骤具体包括:
S211、对于z轴高度z(t),利用有限时间变参收敛微分神经网络设计方法,设计将等式(6)以及其导数代入方程可得到有限时间变参收敛微分神经网络的隐式动力学方程
<mrow> <msub> <mi>a</mi> <mi>z</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <msub> <mover> <mi>u</mi> <mo>&amp;CenterDot;</mo> </mover> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mo>-</mo> <mrow> <mo>(</mo> <msub> <mi>a</mi> <mi>z</mi> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <msub> <mi>u</mi> <mn>1</mn> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>+</mo> <msub> <mover> <mi>b</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>z</mi> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>+</mo> <mi>&amp;gamma;</mi> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mi>&amp;Phi;</mi> <mo>(</mo> <mrow> <msub> <mi>E</mi> <mi>z</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>,</mo> <mi>t</mi> </mrow> <mo>)</mo> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>19</mn> <mo>)</mo> </mrow> </mrow>
位置z(t)和速度将在有限时间内以超指数的形式分别收敛到目标位置zT(t)和目标速度
S212、针对横滚角φ(t),根据有限时间变参收敛微分神经动力学设计方法,设计将等式(10)以及其导数代入方程可得到有限时间变参收敛微分神经网络的隐式动力学方程
<mrow> <mfrac> <mi>l</mi> <msub> <mi>J</mi> <mi>x</mi> </msub> </mfrac> <msub> <mover> <mi>u</mi> <mo>&amp;CenterDot;</mo> </mover> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mo>-</mo> <mrow> <mo>(</mo> <msub> <mover> <mi>b</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>&amp;phi;</mi> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>+</mo> <mi>&amp;gamma;</mi> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mi>&amp;Phi;</mi> <mo>(</mo> <mrow> <msub> <mi>E</mi> <mi>&amp;phi;</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>,</mo> <mi>t</mi> </mrow> <mo>)</mo> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>20</mn> <mo>)</mo> </mrow> </mrow>
横滚角φ(t)和速度将在有限时间内以超指数的形式分别收敛到目标位置φT(t)和目标速度
S213、针对俯仰角θ(t),根据有限时间变参收敛微分神经动力学设计方法,设计将等式(14)以及其导数代入方程可得到有限时间变参收敛微分神经网络的隐式动力学方程
<mrow> <mfrac> <mi>l</mi> <msub> <mi>J</mi> <mi>y</mi> </msub> </mfrac> <msub> <mover> <mi>u</mi> <mo>&amp;CenterDot;</mo> </mover> <mn>3</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mo>-</mo> <mrow> <mo>(</mo> <msub> <mover> <mi>b</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>&amp;theta;</mi> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>+</mo> <mi>&amp;gamma;</mi> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mi>&amp;Phi;</mi> <mo>(</mo> <mrow> <msub> <mi>E</mi> <mi>&amp;theta;</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>,</mo> <mi>t</mi> </mrow> <mo>)</mo> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>21</mn> <mo>)</mo> </mrow> </mrow>
俯仰角θ(t)和速度将在有限时间内以超指数的形式分别收敛到目标位置θT(t)和目标速度
S214、针对偏航角ψ(t),根据有限时间变参收敛微分神经动力学设计方法,设计将等式(18)以及其导数代入方程可得到有限时间变参收敛微分神经网络的隐式动力学方程
<mrow> <mfrac> <mn>1</mn> <msub> <mi>J</mi> <mi>z</mi> </msub> </mfrac> <msub> <mover> <mi>u</mi> <mo>&amp;CenterDot;</mo> </mover> <mn>4</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mo>-</mo> <mrow> <mo>(</mo> <msub> <mover> <mi>b</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>&amp;psi;</mi> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>+</mo> <mi>&amp;gamma;</mi> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mi>&amp;Phi;</mi> <mo>(</mo> <mrow> <msub> <mi>E</mi> <mi>&amp;psi;</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>,</mo> <mi>t</mi> </mrow> <mo>)</mo> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>22</mn> <mo>)</mo> </mrow> </mrow>
俯仰角ψ(t)和速度将在有限时间内以超指数的形式分别收敛到目标位置ψT(t)和目标速度
S215、求解合成控制量u1~u4即为对应飞行器飞行需求的控制量,根据等式(19),(20),(21),(22)分别获得控制量u1~u4的神经网络方程,具体分别如下:
将求解出的控制量u1~u4根据不同旋翼飞行器的结构以及电机数目进行不同的输出控制分配。
CN201710650246.7A 2017-08-02 2017-08-02 一种基于有限时间神经动力学的多旋翼无人飞行器的稳定飞行控制方法 Active CN107368091B (zh)

Priority Applications (3)

Application Number Priority Date Filing Date Title
CN201710650246.7A CN107368091B (zh) 2017-08-02 2017-08-02 一种基于有限时间神经动力学的多旋翼无人飞行器的稳定飞行控制方法
PCT/CN2017/109484 WO2019024303A1 (zh) 2017-08-02 2017-11-06 一种基于有限时间神经动力学的多旋翼无人飞行器的稳定飞行控制方法
US16/636,011 US11378983B2 (en) 2017-08-02 2017-11-06 Stable flight control method for multi-rotor unmanned aerial vehicle based on finite-time neurodynamics

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710650246.7A CN107368091B (zh) 2017-08-02 2017-08-02 一种基于有限时间神经动力学的多旋翼无人飞行器的稳定飞行控制方法

Publications (2)

Publication Number Publication Date
CN107368091A true CN107368091A (zh) 2017-11-21
CN107368091B CN107368091B (zh) 2019-08-20

Family

ID=60309522

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710650246.7A Active CN107368091B (zh) 2017-08-02 2017-08-02 一种基于有限时间神经动力学的多旋翼无人飞行器的稳定飞行控制方法

Country Status (3)

Country Link
US (1) US11378983B2 (zh)
CN (1) CN107368091B (zh)
WO (1) WO2019024303A1 (zh)

Cited By (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108663940A (zh) * 2018-08-20 2018-10-16 西北工业大学 基于集总复合估计的飞行器神经网络学习控制方法
CN108762098A (zh) * 2018-08-20 2018-11-06 西北工业大学 基于复合学习的非最小相位飞行器神经网络控制方法
CN108828957A (zh) * 2018-08-20 2018-11-16 西北工业大学 基于切换机制的飞行器全局有限时间神经网络控制方法
CN108897227A (zh) * 2018-08-20 2018-11-27 西北工业大学 非线性严格反馈***全局有限时间神经网络控制方法
CN109062234A (zh) * 2018-08-20 2018-12-21 西北工业大学 一种非最小相位飞行器复合学习滑模控制方法
CN109062049A (zh) * 2018-08-20 2018-12-21 西北工业大学 基于集总复合估计的严格反馈***神经网络控制方法
CN110254741A (zh) * 2019-05-17 2019-09-20 李泽波 一种飞行控制***的设计方法
CN110456642A (zh) * 2019-07-24 2019-11-15 西北工业大学 基于奇异摄动分析的弹性飞行器鲁棒有限时间控制方法
CN110703603A (zh) * 2019-10-28 2020-01-17 华南理工大学 一种无人机多层递归收敛神经网络控制器的控制方法
CN111506959A (zh) * 2020-03-06 2020-08-07 青岛山景虚拟现实研究院 一种用于飞行模拟训练通用型飞控***及方法
CN111857171A (zh) * 2020-07-30 2020-10-30 华南理工大学 一种基于质量自适应多层神经网络的无人机控制方法
CN112233785A (zh) * 2020-07-08 2021-01-15 华南理工大学 一种帕金森症的智能识别方法
CN112346474A (zh) * 2020-10-20 2021-02-09 南京航空航天大学 一种有限时间收敛的微分对策制导律的设计方法
CN113359440A (zh) * 2021-05-24 2021-09-07 华南理工大学 基于多层积分神经动力学的多旋翼无人机控制器设计方法
CN113505525A (zh) * 2021-06-22 2021-10-15 清华大学 基于微分神经网络的电力***动态元件建模方法及装置
WO2022000154A1 (zh) * 2020-06-28 2022-01-06 拓攻(南京)机器人有限公司 一种多旋翼无人机电机倾角及安装公差约束确定方法
CN114237297A (zh) * 2021-12-21 2022-03-25 电子科技大学 一种基于神经网络训练学习的无人机群飞行控制方法
CN116650979A (zh) * 2023-07-28 2023-08-29 深圳市好盈科技股份有限公司 飞行器控制方法和装置

Families Citing this family (23)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109885074B (zh) * 2019-02-28 2022-02-15 天津大学 四旋翼无人机有限时间收敛姿态控制方法
CN110275542B (zh) * 2019-06-14 2022-04-08 合肥工业大学 一种基于自适应有限时间控制的四旋翼飞行器控制方法
CN110456805B (zh) * 2019-06-24 2022-07-19 深圳慈航无人智能***技术有限公司 一种无人机智能循迹飞行***及方法
CN110879602B (zh) * 2019-12-06 2023-04-28 安阳全丰航空植保科技股份有限公司 基于深度学习的无人机控制律参数调节方法及***
CN111168680B (zh) * 2020-01-09 2022-11-15 中山大学 一种基于神经动力学方法的软体机器人控制方法
CN111399527B (zh) * 2020-03-27 2023-08-04 浙江华奕航空科技有限公司 一种基于扩展观测器的无人直升机姿态鲁棒控制方法
CN112486141B (zh) * 2020-11-26 2022-09-02 南京信息工程大学 一种基于时间自动机的无人机飞控程序建模与验证方法
CN112527008B (zh) * 2020-12-21 2023-05-02 福州大学 基于低复杂度规定性能的作业型飞行机器人控制方法
CN113238572B (zh) * 2021-05-31 2022-11-22 上海海事大学 基于预设性能控制的预设时间四旋翼无人机姿态跟踪方法
CN113359472B (zh) * 2021-07-02 2024-04-19 北京理工大学 一种四旋翼无人机自适应鲁棒轨迹跟踪控制方法
CN114114904B (zh) * 2021-10-22 2024-04-12 杭州电子科技大学 一种有限时间和固定时间分布式事件触发一致性方法
CN113985916B (zh) * 2021-10-26 2024-04-05 西安电子科技大学 基于压强闭环控制的飞行器变推力发动机控制分配方法、***、装置及存储介质
CN113885358B (zh) * 2021-10-27 2023-09-26 中国民航管理干部学院 一种混合构型固定翼无人机机动仿真控制律设计方法
CN113995629B (zh) * 2021-11-03 2023-07-11 中国科学技术大学先进技术研究院 基于镜像力场的上肢双臂康复机器人导纳控制方法及***
CN114200826B (zh) * 2021-11-09 2023-06-23 西北工业大学 一种超音速大机动靶标持续大过载机动高度稳定控制方法
CN114253137B (zh) * 2021-12-16 2023-07-25 郑州大学 基于控制分配的无人机***故障诊断与容错控制方法
CN114510065A (zh) * 2021-12-24 2022-05-17 湖北航天飞行器研究所 一种多旋翼无人机地面目标跟踪控制方法
CN114489100B (zh) * 2022-01-18 2023-07-04 中国地质大学(北京) 基于姿态同步的超视距无人机遥控***
CN114935277B (zh) * 2022-03-05 2023-08-04 南京理工大学 一种滑翔增程制导炮弹理想弹道的在线规划方法
CN114781132A (zh) * 2022-03-31 2022-07-22 西北核技术研究所 一种D-dot传感器的制作方法
CN114859950B (zh) * 2022-04-17 2024-05-10 西北工业大学 考虑控制死区的弹性飞行器智能控制方法
CN115480583B (zh) * 2022-09-22 2024-06-07 福州大学 飞行作业机器人的视觉伺服跟踪与阻抗控制方法
CN117163281B (zh) * 2023-08-30 2024-03-08 南京航空航天大学 滑翔飞行器执行器故障情况下的容错控制方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104637370A (zh) * 2014-12-23 2015-05-20 河南城建学院 一种摄影测量与遥感综合教学的方法及***
CN105607473A (zh) * 2015-11-20 2016-05-25 天津大学 小型无人直升机的姿态误差快速收敛自适应控制方法
CN106155076A (zh) * 2016-08-23 2016-11-23 华南理工大学 一种多旋翼无人飞行器的稳定飞行控制方法
CN106647584A (zh) * 2017-01-17 2017-05-10 南京航空航天大学 一种基于最优滑模的四旋翼飞行器的容错控制方法
CN106945041A (zh) * 2017-03-27 2017-07-14 华南理工大学 一种冗余度机械臂重复运动规划方法

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9087301B2 (en) 2012-12-21 2015-07-21 International Business Machines Corporation Hardware architecture for simulating a neural network of neurons
US20150220829A1 (en) 2014-02-04 2015-08-06 Qualcomm Incorporated Equivalent delay by shaping postsynaptic potentials
US10679511B2 (en) * 2016-09-30 2020-06-09 Sony Interactive Entertainment Inc. Collision detection and avoidance

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104637370A (zh) * 2014-12-23 2015-05-20 河南城建学院 一种摄影测量与遥感综合教学的方法及***
CN105607473A (zh) * 2015-11-20 2016-05-25 天津大学 小型无人直升机的姿态误差快速收敛自适应控制方法
CN106155076A (zh) * 2016-08-23 2016-11-23 华南理工大学 一种多旋翼无人飞行器的稳定飞行控制方法
CN106647584A (zh) * 2017-01-17 2017-05-10 南京航空航天大学 一种基于最优滑模的四旋翼飞行器的容错控制方法
CN106945041A (zh) * 2017-03-27 2017-07-14 华南理工大学 一种冗余度机械臂重复运动规划方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
孙明轩等: "终态神经计算:有限时间收敛性与相关应用", 《浙江工业大学学报》 *

Cited By (27)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109062234B (zh) * 2018-08-20 2019-11-05 西北工业大学 一种非最小相位飞行器复合学习滑模控制方法
CN108762098A (zh) * 2018-08-20 2018-11-06 西北工业大学 基于复合学习的非最小相位飞行器神经网络控制方法
CN108828957A (zh) * 2018-08-20 2018-11-16 西北工业大学 基于切换机制的飞行器全局有限时间神经网络控制方法
CN108897227A (zh) * 2018-08-20 2018-11-27 西北工业大学 非线性严格反馈***全局有限时间神经网络控制方法
CN109062234A (zh) * 2018-08-20 2018-12-21 西北工业大学 一种非最小相位飞行器复合学习滑模控制方法
CN109062049A (zh) * 2018-08-20 2018-12-21 西北工业大学 基于集总复合估计的严格反馈***神经网络控制方法
CN108663940A (zh) * 2018-08-20 2018-10-16 西北工业大学 基于集总复合估计的飞行器神经网络学习控制方法
CN109062049B (zh) * 2018-08-20 2019-09-24 西北工业大学 基于集总复合估计的严格反馈***神经网络控制方法
CN108897227B (zh) * 2018-08-20 2019-09-24 西北工业大学 非线性严格反馈***全局有限时间神经网络控制方法
CN108663940B (zh) * 2018-08-20 2019-09-24 西北工业大学 基于集总复合估计的飞行器神经网络学习控制方法
CN108762098B (zh) * 2018-08-20 2019-11-01 西北工业大学 基于复合学习的非最小相位飞行器神经网络控制方法
CN108828957B (zh) * 2018-08-20 2019-11-05 西北工业大学 基于切换机制的飞行器全局有限时间神经网络控制方法
CN110254741A (zh) * 2019-05-17 2019-09-20 李泽波 一种飞行控制***的设计方法
CN110456642A (zh) * 2019-07-24 2019-11-15 西北工业大学 基于奇异摄动分析的弹性飞行器鲁棒有限时间控制方法
CN110703603A (zh) * 2019-10-28 2020-01-17 华南理工大学 一种无人机多层递归收敛神经网络控制器的控制方法
CN111506959A (zh) * 2020-03-06 2020-08-07 青岛山景虚拟现实研究院 一种用于飞行模拟训练通用型飞控***及方法
WO2022000154A1 (zh) * 2020-06-28 2022-01-06 拓攻(南京)机器人有限公司 一种多旋翼无人机电机倾角及安装公差约束确定方法
CN112233785A (zh) * 2020-07-08 2021-01-15 华南理工大学 一种帕金森症的智能识别方法
CN111857171A (zh) * 2020-07-30 2020-10-30 华南理工大学 一种基于质量自适应多层神经网络的无人机控制方法
CN112346474B (zh) * 2020-10-20 2021-12-07 南京航空航天大学 一种有限时间收敛的微分对策制导律的设计方法
CN112346474A (zh) * 2020-10-20 2021-02-09 南京航空航天大学 一种有限时间收敛的微分对策制导律的设计方法
CN113359440A (zh) * 2021-05-24 2021-09-07 华南理工大学 基于多层积分神经动力学的多旋翼无人机控制器设计方法
CN113359440B (zh) * 2021-05-24 2023-06-20 华南理工大学 基于多层积分神经动力学的多旋翼无人机控制器设计方法
CN113505525A (zh) * 2021-06-22 2021-10-15 清华大学 基于微分神经网络的电力***动态元件建模方法及装置
CN114237297A (zh) * 2021-12-21 2022-03-25 电子科技大学 一种基于神经网络训练学习的无人机群飞行控制方法
CN116650979A (zh) * 2023-07-28 2023-08-29 深圳市好盈科技股份有限公司 飞行器控制方法和装置
CN116650979B (zh) * 2023-07-28 2023-10-24 深圳市好盈科技股份有限公司 飞行器控制方法和装置

Also Published As

Publication number Publication date
US20210141395A1 (en) 2021-05-13
US11378983B2 (en) 2022-07-05
CN107368091B (zh) 2019-08-20
WO2019024303A1 (zh) 2019-02-07

Similar Documents

Publication Publication Date Title
CN107368091B (zh) 一种基于有限时间神经动力学的多旋翼无人飞行器的稳定飞行控制方法
CN106249745B (zh) 四轴无人机的控制方法
Lozano Unmanned aerial vehicles: Embedded control
US11721219B2 (en) Method for controlling steady flight of unmanned aircraft
CN106155076B (zh) 一种多旋翼无人飞行器的稳定飞行控制方法
Hoffmann et al. Quadrotor helicopter flight dynamics and control: Theory and experiment
Castillo et al. Modelling and control of mini-flying machines
Castillo et al. Real-time stabilization and tracking of a four-rotor mini rotorcraft
Tayebi et al. Attitude stabilization of a VTOL quadrotor aircraft
Jung et al. Development and application of controller for transition flight of tail-sitter UAV
CN108803639A (zh) 一种基于反步法的四旋翼飞行器飞行控制方法
Rodić et al. Modeling and simulation of quad-rotor dynamics and spatial navigation
CN106933104A (zh) 一种基于dic‑pid的四旋翼飞行器姿态与位置的混合控制方法
CN104765272A (zh) 一种基于pid神经元网络控制(pidnn)的四旋翼飞行器控制方法
CN105151292A (zh) 分布式矢量推进***
Salazar-Cruz et al. Real-time stabilization of a small three-rotor aircraft
Zemalache et al. Control of an under-actuated system: application a four rotors rotorcraft
Salazar‐Cruz et al. Embedded control system for a four‐rotor UAV
Jafari et al. An optimal guidance law applied to quadrotor using LQR method
Walid et al. Modeling and control of a quadrotor UAV
Sureshkumar Autonomous control of a quadrotor UAV using fuzzy logic
Tahar et al. Control of an under-actuated x4-flyer using integral backstepping controller
Yin et al. Research on modeling and stability control of micro unmanned helicopter
Sánchez et al. Simple real-time stabilization of vertical takeoff and landing aircraft with bounded signals
CN111857171A (zh) 一种基于质量自适应多层神经网络的无人机控制方法

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant