CN108803639A - 一种基于反步法的四旋翼飞行器飞行控制方法 - Google Patents
一种基于反步法的四旋翼飞行器飞行控制方法 Download PDFInfo
- Publication number
- CN108803639A CN108803639A CN201810530155.4A CN201810530155A CN108803639A CN 108803639 A CN108803639 A CN 108803639A CN 201810530155 A CN201810530155 A CN 201810530155A CN 108803639 A CN108803639 A CN 108803639A
- Authority
- CN
- China
- Prior art keywords
- quadrotor
- control
- flight
- backstepping
- angle
- 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.)
- Pending
Links
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 title claims abstract description 30
- 238000000034 method Methods 0.000 title claims abstract description 27
- 230000004044 response Effects 0.000 claims abstract description 21
- 230000001133 acceleration Effects 0.000 claims abstract description 20
- 230000005484 gravity Effects 0.000 claims abstract description 12
- 238000010276 construction Methods 0.000 claims abstract description 6
- 238000004458 analytical method Methods 0.000 claims description 9
- 230000007246 mechanism Effects 0.000 claims description 3
- 239000000203 mixture Substances 0.000 claims description 2
- 230000008901 benefit Effects 0.000 abstract description 3
- 238000013461 design Methods 0.000 description 14
- 230000001105 regulatory effect Effects 0.000 description 7
- 238000004088 simulation Methods 0.000 description 7
- 238000012360 testing method Methods 0.000 description 6
- 230000008878 coupling Effects 0.000 description 5
- 238000010168 coupling process Methods 0.000 description 5
- 238000005859 coupling reaction Methods 0.000 description 5
- 230000001276 controlling effect Effects 0.000 description 4
- 238000010586 diagram Methods 0.000 description 4
- 238000001914 filtration Methods 0.000 description 3
- 230000004927 fusion Effects 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 238000005096 rolling process Methods 0.000 description 3
- 238000012795 verification Methods 0.000 description 3
- 238000009795 derivation Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- FFBHFFJDDLITSX-UHFFFAOYSA-N benzyl N-[2-hydroxy-4-(3-oxomorpholin-4-yl)phenyl]carbamate Chemical compound OC1=C(NC(=O)OCC2=CC=CC=C2)C=CC(=C1)N1CCOCC1=O FFBHFFJDDLITSX-UHFFFAOYSA-N 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 239000002131 composite material Substances 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 239000003337 fertilizer Substances 0.000 description 1
- 238000007667 floating Methods 0.000 description 1
- 238000007689 inspection Methods 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000013178 mathematical model Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
- G05D1/0816—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
- G05D1/0825—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using mathematical models
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Algebra (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Mathematical Physics (AREA)
- Pure & Applied Mathematics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种基于反步法的四旋翼飞行器飞行控制方法。方法步骤为:首先、根据飞行力学原理和空气动力学原理,建立四旋翼飞行器动力学模型,并对模型进行简化:设定飞行器是刚体、机体结构完全对称、飞行器重心与机体中心重合、把地面坐标系当作惯性坐标系、忽略地球曲率和重力加速度的变化;然后、根据四旋翼飞行器动力学模型,分析飞行器控制***的耦合关系,并构建***控制结构图;最后、根据四旋翼飞行器动力学模型和***控制结构图,使用反步法并结合Lyapunov稳定性原理,确定***的反馈补偿控制量。本发明方法能够对四旋翼飞行器的位置和姿态进行稳定控制,具有轨迹跟踪精度高、响应速度快和抗干扰能力强的优点。
Description
技术领域
本发明属于自动化控制技术领域,特别是一种基于反步法的四旋翼飞行器飞行控制方法。
背景技术
无人飞行器又称无人机,通常是指无人驾驶、可以进行遥控操作或者自主飞行、完成一定任务、可重复使用的飞行器。无人飞行器可以用于电力线路检查、桥梁勘测、农业施肥、森林火灾检测等场合,应用前景十分广阔,因此具有很大的研究价值。
无人飞行器分为固定翼无人机、无人直升机和多旋翼飞行器三类。固定翼无人机的机翼形状固定,主要靠流过机翼的风提供升力,具有续航时间长、飞行效率高、载荷大的特点,但其起飞时需要助力,降落时需要滑行,且造价昂贵。无人直升机可以垂直起降,续航和载荷能力中等,机械结构复杂导致其维护成本较高。多旋翼飞行器的螺旋桨对称地分布在其机身周围,机械结构简单、成本低廉,不仅能实现垂直起飞和降落,还可以实现多种飞行姿态,具有优秀的机动能力和悬停能力。多旋翼飞行器根据其所带螺旋桨的个数,分为三旋翼飞行器、四旋翼飞行器、六旋翼飞行器、八旋翼飞行器等。旋翼越多则载荷越大,抗干扰能力越强,但同时单位时间内的功耗就越大。
目前对多旋翼飞行器研究的难点和热点是对飞行器的建模及其控制算法。工程上广泛采用常规的PID控制方法设计的常规控制器,该常规控制器对四旋翼飞行器模型的精度无太大要求,忽略四旋翼飞行器模型中的不确定项的影响,然而这种近似只在四旋翼处于近悬停状态成立,当四旋翼进行大机动飞行时,常规控制器性能急剧变差,存在潜在的安全隐患;同时,常规控制器仅为控制***输出提供反馈通道,控制律设计过程简单,控制精度低和控制性能差,难以应对飞行过程中的强耦合、四旋翼飞行器模型的不确定性和外界干扰,如四旋翼执行航迹跟踪任务时,常规的PID控制器,难以同时满足轨迹跟踪精度高、相应快速和抗干扰能力强的要求。
发明内容
本发明的目的在于提供一种跟踪精度高、响应速度快和抗干扰能力强的基于反步法的四旋翼飞行器飞行控制方法,对四旋翼飞行器的位置和姿态进行稳定控制。
实现本发明目的的技术解决方案为:一种基于反步法的四旋翼飞行器飞行控制方法,包括以下步骤:
步骤1,根据飞行力学原理和空气动力学原理,建立四旋翼飞行器动力学模型;
步骤2,根据四旋翼飞行器动力学模型,分析飞行器控制***的耦合关系,构建***控制结构图;
步骤3,根据四旋翼飞行器动力学模型和***控制结构图,使用反步法并结合Lyapunov稳定性原理,确定***的反馈补偿控制量,对四旋翼飞行器进行飞行控制。
进一步地,步骤1所述的根据飞行力学原理和空气动力学原理,建立四旋翼飞行器动力学模型,具体如下:
设定:
(1)飞行器是刚体;
(2)机体结构是完全对称的;
(3)飞行器重心与机体中心重合;
(4)把地面坐标系当作惯性坐标系;
(5)忽略地球曲率和重力加速度的变化;
四旋翼飞行器进行飞行力学分析和空气动力学分析,建立动力学模型;根据四旋翼飞行器的运动机理,选取变量u1,u2,u3,u4作为控制量,则控制量u1,u2,u3,u4的表达式为:
其中T1,T2,T3,T4分别为旋翼1,2,3,4提供的动力,d为不平衡扭矩系数,Ωr为剩余螺旋桨角速度代数和;
四旋翼飞行器的状态变量用状态向量X表示为:
其中φ为滚转角,θ为俯仰角,ψ为偏航角,x,y,z分别为飞行器质心沿地面坐标系x轴、y轴和z轴的位置。
进一步地,步骤1中所述的建立四旋翼飞行器动力学模型,具体如下:
四旋翼飞行器动力学模型包括表示四旋翼飞行器动力学模型的力矩方程组、运动方程组和位置方程组;
所述力矩方程组表示如下:
其中,p,q,r分别表示滚转角速度、俯仰角速度和偏航角速度,分别表示滚转角加速度、俯仰角加速度和偏航角加速度,Ix,Iy,Iz分别表示飞行器绕机体坐标系x轴、y轴和z轴的转动惯量,l表示旋翼中心到机体中心的距离,Jr表示旋转惯量,Ωr表示剩余螺旋桨角速度代数和;
所述的运动方程组表示如下:
所述的位置方程组表示如下:
其中,分别表示飞行器质心沿地面坐标系x轴、y轴和z轴的加速度,分别表示外界不确定性De沿地面坐标系x轴、y轴和z轴的分量,g表示重力加速度,m表示飞行器的质量。
进一步地,步骤2所述的根据四旋翼飞行器动力学模型,分析飞行器控制***的耦合关系,构建***控制结构图,具体如下:
所述飞行器的控制***包括:姿态角控制和高度与水平位置控制;
根据角运动和位置运动的半耦合关系,将四旋翼飞行器的整个控制***分为内环控制***和外环控制***,其中内环控制***控制***的姿态角,称为快回路;外环控制***控制***的位置,包括四旋翼飞行器的高度和水平位置,称为慢回路;快回路比慢回路的响应频率快;
在飞行速度小于下限或悬停时,姿态角的正弦、正切值为0,余弦值为1,根据式(3),简化为:
外界干扰为空气阻力,四旋翼飞行器的力矩方程组(2)和位置方程组(4)简化为:
其中,f是空气阻力系数。
进一步地,步骤3所述的根据四旋翼飞行器动力学模型和***控制结构图,使用反步法并结合Lyapunov稳定性原理,确定***的反馈补偿控制量,对四旋翼飞行器进行飞行控制,具体如下:
建立四旋翼飞行器动力学模型的状态空间,设计基于反步法的姿态角控制***和位置控制***,求得反馈补偿控制量;
四旋翼飞行器动力学模型的状态空间中的输入向量U和状态向量为:
U=[u1,u2,u3,u4]T (7)
状态空间的展开式为:
将状态空间中的常系数用字母来表示,表达式为:
进一步地,所述的建立四旋翼飞行器动力学模型的状态空间,具体如下:
将四旋翼飞行器的姿态位置控制,解耦成单通道的姿态角或位置控制,再使用反步法将高阶***分解成低阶***,逐步递推地设计Lyapunov函数和中间虚拟变量,确定***的单通道反馈补偿控制量,包括滚转角的反馈控制量、俯仰角的反馈控制量、偏航角的反馈控制量和高度的反馈控制量,其中:
滚转角的反馈控制量为:
其中z1=x1d-x1,x1d为期望的滚转角,为x1d的二阶导数,k1和k2为可调整的控制***参数,且k1>0,k2>0;
俯仰角的反馈控制量为:
其中z3=x3d-x3,x3d为期望的俯仰角,为x3d的二阶导数,k3和k4为可调整的控制***参数,且k3>0,k4>0;
偏航角的反馈控制量为:
其中z5=x5d-x5,x5d为期望的偏航角,为x5d的二阶导数,k5和k6为可调整的控制***参数,且k5>0,k6>0;
高度的反馈控制量为:
其中z7=x7d-x7,x7d为期望的俯仰角,为x7d的二阶导数,k7和k8为可调整的控制***参数,且k7>0,k8>0。
本发明与现有技术相比,其显著优点在于:(1)根据四旋翼飞行力学和空气动力学原理,忽略次要因素的影响,建立四旋翼飞行器动力学模型包括,减少了计算量,提高了控制效率;(2)将四旋翼的整个***分为内环控制和外环控制,内环控制器控制***的姿态角,外环控制控制***的位置,能够对四旋翼飞行器的位置和姿态实现稳定控制,保证了飞行器能够平稳飞行;(3)可以减少强耦合、外界干扰和不确定性对飞行过程造成的干扰,改善四旋翼飞行器模型的控制精度和控制性能,从而提高了四旋翼飞行器模型的飞行安全性和可操作性,具有轨迹跟踪精度高、响应速度快和抗干扰能力强的优点。
附图说明
图1为本发明基于反步法的四旋翼飞行器飞行控制方法的流程示意图。
图2为本发明实施例中的四旋翼飞行器的结构示意图。
图3为本发明实施例中的飞行控制结构图。
图4为本发明实施例中的simulink平台仿真框图。
图5为本发明实施例中采用阶跃输入时的姿态响应验证效果图,其中(a)为姿态角响应曲线图,(b)为姿态角控制量曲线图。
图6为本发明实施例中采用阶跃输入时的位置响应验证效果图。
图7为本发明实施例中位置跟中飞行测试时位置“回”形航迹跟踪飞行测试效果图,其中(a)为跟踪“回”形航迹曲线图,(b)为航迹在XOY平面投影图,(c)为三轴实时误差图,(d)为实时误差图。
图8为本发明实施例中姿态跟踪飞行测试时位置“螺旋”形航迹跟踪飞行测试效果图,(a)为跟踪“螺旋”形航迹曲线图,(b)为航迹在XOY平面投影图,(c)为航迹在YOZ平面投影图,(d)为实时误差图。
具体实施方式
结合图1,本发明基于反步法的四旋翼无人机飞行控制方法,包括:
步骤1,根据飞行力学原理和空气动力学原理,忽略次要因素的影响,建立四旋翼飞行器动力学模型;
步骤2,根据四旋翼飞行器动力学模型,分析飞行器控制***的耦合关系,并结合实例给出***控制结构图;
步骤3,根据四旋翼飞行器动力学模型和***控制结构图,使用反步法并结合Lyapunov稳定性原理,确定***的反馈补偿控制量。
作为一种具体示例,步骤1所述的根据飞行力学原理和空气动力学原理,忽略次要因素的影响,建立四旋翼飞行器动力学模型,具体如下:
设定:
(1)飞行器是刚体;
(2)机体结构是完全对称的;
(3)飞行器重心与机体中心重合;
(4)把地面坐标系当作惯性坐标系;
(5)忽略地球曲率和重力加速度的变化;
对四旋翼飞行器进行飞行力学分析和空气动力学分析,建立动力学模型;根据四旋翼飞行器的运动机理,选取变量u1,u2,u3,u4作为控制量,则控制量u1,u2,u3,u4的表达式为:
其中T1,T2,T3,T4分别为旋翼1,2,3,4提供的动力,d为不平衡扭矩系数,Ωr为剩余螺旋桨角速度代数和;
四旋翼飞行器的状态变量用状态向量表示为:
其中φ为滚转角,θ为俯仰角,ψ为偏航角,x,y,z分别为飞行器质心沿地面坐标系x轴、y轴和z轴的位置。
进一步地,步骤1中所述的建立四旋翼飞行器动力学模型,具体如下:
四旋翼飞行器动力学模型包括表示四旋翼飞行器动力学模型的力矩方程组、运动方程组和位置方程组;
所述力矩方程组表示如下:
其中,p,q,r分别表示滚转角速度、俯仰角速度和偏航角速度,分别表示滚转角加速度、俯仰角加速度和偏航角加速度,Ix,Iy,Iz分别表示飞行器绕机体坐标系x轴、y轴和z轴的转动惯量,l表示旋翼中心到机体中心的距离,Jr表示旋转惯量,Ωr表示剩余螺旋桨角速度代数和;
所述的运动方程组表示如下:
所述的位置方程组表示如下:
其中,分别表示飞行器质心沿地面坐标系x轴、y轴和z轴的加速度,分别表示外界不确定性De沿地面坐标系x轴、y轴和z轴的分量,g表示重力加速度,m表示飞行器的质量。
作为一种具体示例,步骤2所述的根据四旋翼飞行器动力学模型,分析飞行器控制***的耦合关系,并结合实例给出***控制结构图,具体如下:
所述飞行器的控制***包括:姿态角控制和高度与水平位置控制;
根据角运动和位置运动的半耦合关系,将四旋翼飞行器的整个控制***分为内环控制***和外环控制***,其中内环控制***控制***的姿态角,响应频率比较快,称为快回路;外环控制***控制***的位置,包括四旋翼飞行器的高度和水平位置,响应频率比较慢,称为慢回路;
在慢速飞行或悬停时,姿态角很小,角速度变化也很小,姿态角的正弦、正切值约为0,余弦值约为1,根据式(3),可简化为:
外界干扰为空气阻力,四旋翼飞行器的力矩方程组(2)和位置方程组(4)可简化为:
其中f是空气阻力系数。
作为一种具体示例,步骤3所述的根据四旋翼飞行器动力学模型和***控制结构图,使用反步法并结合Lyapunov稳定性原理,确定***的反馈补偿控制量,具体如下:
建立四旋翼飞行器动力学模型的状态空间,设计基于反步法的姿态角控制***和位置控制***,求得反馈补偿控制量;
四旋翼飞行器动力学模型的状态空间中的输入向量和状态向量为:
U=[u1,u2,u3,u4]T (7)
状态空间的展开式为:
将状态空间中的常系数用字母来表示,表达式为:
建立四旋翼飞行器动力学***的状态空间,具体方法如下:
将四旋翼飞行器的姿态位置控制,解耦成单通道的姿态角或位置控制,再使用反步法将高阶***分解成低阶***,逐步递推地设计Lyapunov函数和中间虚拟变量,确定***的单通道反馈补偿控制量,包括滚转角的反馈控制量、俯仰角的反馈控制量、偏航角的反馈控制量和高度的反馈控制量,其中:
滚转角的反馈控制量为:
其中z1=x1d-x1,x1d为期望的滚转角,为x1d的二阶导数,k1和k2为可调整的控制***参数,且k1>0,k2>0;
俯仰角的反馈控制量为:
其中z3=x3d-x3,x3d为期望的俯仰角,为x3d的二阶导数,k3和k4为可调整的控制***参数,且k3>0,k4>0;
偏航角的反馈控制量为:
其中z5=x5d-x5,x5d为期望的偏航角,为x5d的二阶导数,k5和k6为可调整的控制***参数,且k5>0,k6>0;
高度的反馈控制量为:
其中z7=x7d-x7,x7d为期望的俯仰角,为x7d的二阶导数,k7和k8为可调整的控制***参数,且k7>0,k8>0。
实施例1
本发明实施例所述的基于反步法的四旋翼无人机飞行控制方法,首先通过四旋翼飞行力学和空气动力学原理,忽略次要因素的影响,建立四旋翼飞行器模型,然后根据所述四旋翼飞行器动力学模型分析飞行器控制***的耦合关系,并结合实例给出***的控制结构图,最后根据所述四旋翼飞行器动力学模型和***的控制结构图,应用反步法并结合Lyapunov稳定性原理确定***的反馈补偿控制器。这样可以减少强耦合、外界干扰和不确定性对飞行过程造成的干扰,改善四旋翼飞行器模型的控制精度和控制性能,从而提高了四旋翼飞行器模型的飞行安全性和可操作性。
可选地,根据所述四旋翼飞行器数学模型和精度要求,建立四旋翼飞行器模型包括:
四旋翼飞行器的参数采用EPFL的OS4(“十”字形四旋翼飞行器),其机体结构如图2所示。其固有参数如表1所示,单个舵机所能提供的最大升力为260g。
表1
所述的控制量包括:u1,u2,u3,u4。其表达式为:
其中T1,T2,T3,T4分别为旋翼1,2,3,4提供的动力,d为不平衡扭矩系数,Ωr剩余螺旋桨角速度代数和。
所述状态变量用状态向量表示为
其中φ表示滚转角,θ表示俯仰角,ψ表示偏航角,x,y,z分别表示飞行器质心沿地面坐标系x轴,y轴和z轴的位置。
本实施例中,基于飞行力学和空气动力学原理,根据控制性能要求,对四旋翼飞行器进行受力分析,并结合运动学相关知识,通过如下步骤确定四旋翼飞行器动力学模型,包括表示四旋翼飞行器动力学模型的力矩方程组,运动方程组和位置方程组;
所述力矩方程组表示如下:
其中,p,q,r分别表示滚转角速度,俯仰角速度和偏航角速度,分别表示滚转角加速度,俯仰角加速度和偏航角加速度,Ix,Iy,Iz分别表示飞行器绕机体坐标系x轴,y轴和z轴的转动惯量,l表示旋翼中心到机体中心的距离,Jr表示旋转惯量,Ωr表示剩余螺旋桨角速度代数和。
所述的运动方程组表示如下:
所述的位置方程组表示如下:
其中,分别表示飞行器质心沿地面坐标系x轴,y轴和z轴的加速度,分别表示外界不确定性De沿地面坐标系x轴,y轴和z轴的分量,g表示重力加速度,m表示飞行器的质量。
所述飞行器的控制***包括姿态角控制和高度与水平位置控制。
根据角运动和位置运动的半耦合关系,将多旋翼的整个控制***分为内环控制***和外环控制***,内环控制***控制***的姿态角,外环控制***控制***的位置。
在慢速飞行或悬停时,姿态角很小,角速度变化也很小,姿态角的正弦、正切值约为0,余弦值约为1,根据式(3),可简化为:
忽略外界干扰,多旋翼飞行器的力矩方程组(2)和位置方程组(4)可简化为:
根据所述四旋翼飞行器动力学模型分析飞行器控制***的耦合关系,并结合实例给出***的控制结构图,如图3所示。
根据所述四旋翼飞行器动力学模型和***的控制结构图,使用反步法并结合Lyapunov稳定性原理确定***的反馈补偿控制器,包括建立四旋翼飞行器动力学模型的状态空间,设计基于反步法的姿态角控制器和位置控制器,求得反馈补偿控制量。
所述四旋翼飞行器动力学模型的状态空间中的输入向量和状态向量表示为:
U=[u1,u2,u3,u4]T (7)
状态空间表达式的展开式表示为:
将状态空间中的常系数用字母来表示,表达式为:
本实施例中,根据确定的四旋翼飞行器动力学模型的状态空间表示形式,结合四旋翼飞行器模型的不确定性,外界干扰,控制性能要求,四旋翼飞行器的前驱动、强耦合特性,位置、姿态不同的响应特性,并基于内外环控制思想,对四旋翼飞行器的位置、姿态控制解耦城单通道的位姿控制,再对单通道的二阶子***进行反步法补偿控制律设计,对四旋翼飞行器模型的不确定性和外界干扰进行补偿。
本实施例中,反步法补偿控制器的设计步骤如下:
先为滚转通道设计基于反步法的补偿控制器:
其***表达式为:
其中,α1是虚拟控制量,z1是跟踪误差,x1d是期望的滚转角,V1是Lyapunov能量函数,对V1求导:
令虚拟控制量其中k1>0,则有所以负定。
其中z2是虚拟控制跟踪误差,V2是Lyapunov函数,对V2求导:
令k2>0,则有所以负定。
故反馈控制量为:
其中z1=x1d-x1,x1d为期望的滚转角,为x1d的二阶导数,k1和k2为可调整的控制器参数(k1>0,k2>0)。本实施例中,俯仰角、偏航角和z位置子***的控制器设计步骤和滚转角类似,使用同样的步骤可以得到:
俯仰角的反馈控制量为:
其中z3=x3d-x3,x3d为期望的俯仰角,为x3d的二阶导数,k3和k4为可调整的控制器参数(k3>0,k4>0)。
偏航角的反馈控制量为:
其中z5=x5d-x5,x5d为期望的偏航角,为x5d的二阶导数,k5和k6为可调整的控制器参数(k5>0,k6>0)。
高度的反馈控制量为:
其中z7=x7d-x7,x7d为期望的俯仰角,为x7d的二阶导数,k7和k8为可调整的控制器参数(k7>0,k8>0)。
本实施例中,四旋翼飞行器沿水平方向的运动不仅与u1有关,而且是与姿态角动态耦合在一起的。在u1已知的情况下,不妨以关于姿态角的函数ux、uy作为X和Y方向的控制量,表达式如下:
利用反步法得到水平位置X方向的控制量表达式如下式所示:
其中z9=x9d-x9,x9d为期望的俯仰角,为x9d的二阶导数,k9和k10为可调整的控制器参数(k9>0,k10>0)。
Y方向的控制量表达式如下式所示:
其中z11=x11d-x11,x11d为期望的俯仰角,为x11d的二阶导数,k11和k12为可调整的控制器参数(k11>0,k12>0)。
因为水平位置的控制是通过改变姿态角来实现的,所以水平位置控制器输出的是期望的滚转角φd和俯仰角θd,并且作为姿态角控制器的输入。由式(18)可得下式:
为保证三角函数求逆有意义,对Uxsinx5-Uycosx5和(Uxcosx5+Uysinx5)/cosx1限幅处理。同时考虑实际情况对φd和θd限幅处理,一般小于20°。由式(21)得到的表达式如下:
至此,综合式(14)~(17),(19),(20),(22),完成反步法补偿控制器的设计工作。
可选地,所述方法还包括:在实践工程中,对四旋翼飞行器机载的传感器采集的四旋翼飞行器的飞行信息进行滤波融合处理,具体包括;
通过四旋翼飞行器机载的传感器采集四旋翼飞行器的飞行信息;
通过低通滤波器对采集的四旋翼飞行器的飞行信息进行低通滤波处理,其中,所述低通滤波器是结合实践工程中的四旋翼飞行器确定的;
通过卡尔曼滤波器冗余机制对不同传感器采集的隐含同类型的经过低通滤波处理后的飞行信息进行数据融合,得到目标观测信息;
其中,数据融合包括:陀螺仪传感器、加速度计传感器、磁力计传感器、GPS传感器、超声波传感器、气压计传感器采集的并经过低通滤波后的信息,及建立在此基础上的角速度、欧拉角内环信息、速度、位置外环信息。
本发明实施例中,利用上述设计的反步法补偿控制器,在simulink仿真平台上搭建四旋翼飞行器仿真模型,在理论研究和实践工程中,分析四旋翼飞行器控制***的状态并依此调节反步法补偿控制器的调节参数,使***性能(包括响应时间、超调、抗干扰能力等)满足预期要求。***性能的评测主要在理想干净环境下(Simulink仿真平台),反步法补偿控制器的响应速度超调量、静态误差等指标。
本实施例中,图4所示为反步法补偿控制器的simulink平台仿真框图。
在本实施例中,首先验证反步法对姿态的控制,设多旋翼飞行器姿态角及其角速度初始状态为0,位置及其速度也为0。期望姿态角为5°。Lyapunov直接法所提出的构造的Lyapunov函数实际上是一个能量函数,若***能量随时间的推移而衰减,则***最终会达到平衡状态。所以理论上讲Lyapunov函数导数越小,能量的衰减速度就越快,收敛到平衡点的时间就越短,即ki,i=1…6取值越大越好。在仿真过程中多次调节参数,当k1=k2=k3=k4=12,k5=k6=15时,姿态角响应曲线如图5(a)所示,姿态角调节时间为0.41秒,满足调节时间满足小于0.5秒的要求。另外在调节参数的过程中发现,对某一姿态角的控制,互换两个参数,姿态响应曲线不变,如图5(b)所示。
对于高度和水平位置的仿真实验,采用与姿态控制相同的仿真步骤。首先跟踪幅值为2的阶跃信号,逐步调节高度、水平位置控制器的参数,使其满足跟踪性能要求。
首先调节高度控制器的参数,经过多次调节测试,当k7,k8大于等于8时,则不能跟踪阶跃信号,且误差线性增大。取k7=k8=7.5时,高度控制器调节时间约为1.1秒。然后调节水平位置控制器参数,当k9~k12大于5时,响应曲线就会发生超调,为了使***不发生超调,同时使调节时间小于2秒,取k9=…=k12=4.5,调节时间约为1.2秒。按照上述的参数,同时在三个方向给幅值为2的阶跃信号,仿真响应曲线如图6所示。高度的调节时间约为1.5秒,水平位置X调节时间约为1.1秒,水平位置Y调节时间约为1.2秒,且均无超调。所以基本能满足***的控制要求。
在本发明实施例中,验证反步法控制器对四旋翼飞行器按给定航迹飞行的跟踪特性。以“回”形和“螺旋”形航迹为例。
“回”形轨迹的起飞点为(0,0,0),中间先后经过(0,0,2)、(2,0,2)、(2,2,2)、(0,2,2,)、(0,0,2)后,最后返回起飞点(0,0,0),航点飞行响应曲线如图7(a)所示。从其三维空间飞行轨迹来看,航迹在XOY的平面的投影比较接近目标航迹,实时误差的收敛速度,高度约为1.2秒,水平位置约为1.5秒,如图7(b)~(d)所示。仿真结果表明:设计的反步法控制器能有效跟踪“回”形航迹指令。
“螺旋”形轨迹如式(23)所示。
x=2·sin(ωt),y=2·cos(ωt),z=t/2 (23)
其中角频率ω=π/45,即三角信号周期为90秒。飞行器初始状态中除了位置y0=2,其他全部为零。
仿真时间为200秒,响应曲线如图8(a)~(d)所示。从响应曲线来看,从航迹曲线和航迹在XOY、YOZ平面的投影来看,飞行器能按指定的螺旋航迹飞行,且实际飞行航迹和目标航迹的实时误差约为0.38米。
本发明实施例中,根据确定的反步法补偿控制器,建立四旋翼飞行器仿真模型,并调节反步法补偿控制器的调节参数,直至控制性能满足控制要求,对基于反步法补偿控制器的四旋翼飞行器仿真模型进行初步验证,其中所述控制性能包括:响应时间超调、抗干扰能力。
Claims (6)
1.一种基于反步法的四旋翼飞行器飞行控制方法,其特征在于,包括以下步骤:
步骤1,根据飞行力学原理和空气动力学原理,建立四旋翼飞行器动力学模型;
步骤2,根据四旋翼飞行器动力学模型,分析飞行器控制***的耦合关系,构建***控制结构图;
步骤3,根据四旋翼飞行器动力学模型和***控制结构图,使用反步法并结合Lyapunov稳定性原理,确定***的反馈补偿控制量,对四旋翼飞行器进行飞行控制。
2.根据权利要求1所述的基于反步法的四旋翼飞行器飞行控制方法,其特征在于,步骤1所述的根据飞行力学原理和空气动力学原理,建立四旋翼飞行器动力学模型,具体如下:
设定:
(1)飞行器是刚体;
(2)机体结构是完全对称的;
(3)飞行器重心与机体中心重合;
(4)把地面坐标系当作惯性坐标系;
(5)忽略地球曲率和重力加速度的变化;
四旋翼飞行器进行飞行力学分析和空气动力学分析,建立动力学模型;根据四旋翼飞行器的运动机理,选取变量u1,u2,u3,u4作为控制量,则控制量u1,u2,u3,u4的表达式为:
其中T1,T2,T3,T4分别为旋翼1,2,3,4提供的动力,d为不平衡扭矩系数,Ωr为剩余螺旋桨角速度代数和;
四旋翼飞行器的状态变量用状态向量X表示为:
其中φ为滚转角,θ为俯仰角,ψ为偏航角,x,y,z分别为飞行器质心沿地面坐标系x轴、y轴和z轴的位置。
3.根据权利要求1或2所述的基于反步法的四旋翼飞行器飞行控制方法,其特征在于,步骤1中所述的建立四旋翼飞行器动力学模型,具体如下:
四旋翼飞行器动力学模型包括表示四旋翼飞行器动力学模型的力矩方程组、运动方程组和位置方程组;
所述力矩方程组表示如下:
其中,p,q,r分别表示滚转角速度、俯仰角速度和偏航角速度,分别表示滚转角加速度、俯仰角加速度和偏航角加速度,Ix,Iy,Iz分别表示飞行器绕机体坐标系x轴、y轴和z轴的转动惯量,l表示旋翼中心到机体中心的距离,Jr表示旋转惯量,Ωr表示剩余螺旋桨角速度代数和;
所述的运动方程组表示如下:
所述的位置方程组表示如下:
其中,分别表示飞行器质心沿地面坐标系x轴、y轴和z轴的加速度,分别表示外界不确定性De沿地面坐标系x轴、y轴和z轴的分量,g表示重力加速度,m表示飞行器的质量。
4.根据权利要求3所述的基于反步法的四旋翼飞行器飞行控制方法,其特征在于,步骤2所述的根据四旋翼飞行器动力学模型,分析飞行器控制***的耦合关系,构建***控制结构图,具体如下:
所述飞行器的控制***包括:姿态角控制和高度与水平位置控制;
根据角运动和位置运动的半耦合关系,将四旋翼飞行器的整个控制***分为内环控制***和外环控制***,其中内环控制***控制***的姿态角,称为快回路;外环控制***控制***的位置,包括四旋翼飞行器的高度和水平位置,称为慢回路;快回路比慢回路的响应频率快;
在飞行速度小于下限或悬停时,姿态角的正弦、正切值为0,余弦值为1,根据式(3),简化为:
外界干扰为空气阻力,四旋翼飞行器的力矩方程组(2)和位置方程组(4)简化为:
其中,f是空气阻力系数。
5.根据权利要求3所述的基于反步法的四旋翼飞行器飞行控制方法,其特征在于,步骤3所述的根据四旋翼飞行器动力学模型和***控制结构图,使用反步法并结合Lyapunov稳定性原理,确定***的反馈补偿控制量,对四旋翼飞行器进行飞行控制,具体如下:
建立四旋翼飞行器动力学模型的状态空间,设计基于反步法的姿态角控制***和位置控制***,求得反馈补偿控制量;
四旋翼飞行器动力学模型的状态空间中的输入向量U和状态向量为:
U=[u1,u2,u3,u4]T (7)
状态空间的展开式为:
将状态空间中的常系数用字母来表示,表达式为:
6.根据权利要求5所述的基于反步法的四旋翼飞行器飞行控制方法,其特征在于,所述的建立四旋翼飞行器动力学模型的状态空间,具体如下:
将四旋翼飞行器的姿态位置控制,解耦成单通道的姿态角或位置控制,再使用反步法将高阶***分解成低阶***,逐步递推地设计Lyapunov函数和中间虚拟变量,确定***的单通道反馈补偿控制量,包括滚转角的反馈控制量、俯仰角的反馈控制量、偏航角的反馈控制量和高度的反馈控制量,其中:
滚转角的反馈控制量为:
其中z1=x1d-x1,x1d为期望的滚转角,为x1d的二阶导数,k1和k2为可调整的控制***参数,且k1>0,k2>0;
俯仰角的反馈控制量为:
其中z3=x3d-x3,x3d为期望的俯仰角,为x3d的二阶导数,k3和k4为可调整的控制***参数,且k3>0,k4>0;
偏航角的反馈控制量为:
其中z5=x5d-x5,x5d为期望的偏航角,为x5d的二阶导数,k5和k6为可调整的控制***参数,且k5>0,k6>0;
高度的反馈控制量为:
其中z7=x7d-x7,x7d为期望的俯仰角,为x7d的二阶导数,k7和k8为可调整的控制***参数,且k7>0,k8>0。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810530155.4A CN108803639A (zh) | 2018-05-29 | 2018-05-29 | 一种基于反步法的四旋翼飞行器飞行控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810530155.4A CN108803639A (zh) | 2018-05-29 | 2018-05-29 | 一种基于反步法的四旋翼飞行器飞行控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN108803639A true CN108803639A (zh) | 2018-11-13 |
Family
ID=64090692
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810530155.4A Pending CN108803639A (zh) | 2018-05-29 | 2018-05-29 | 一种基于反步法的四旋翼飞行器飞行控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108803639A (zh) |
Cited By (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109432724A (zh) * | 2018-12-13 | 2019-03-08 | 福州大学 | 新型健身飞行器及其控制方法 |
CN109635388A (zh) * | 2018-11-29 | 2019-04-16 | 中国航空工业集团公司沈阳飞机设计研究所 | 一种全机加速度参数测算方法 |
CN109901606A (zh) * | 2019-04-11 | 2019-06-18 | 大连海事大学 | 一种用于四旋翼精确轨迹跟踪的混合有限时间控制方法 |
CN109976364A (zh) * | 2019-03-26 | 2019-07-05 | 中南大学 | 一种六旋翼飞行器姿态解耦控制方法 |
CN110208842A (zh) * | 2019-05-28 | 2019-09-06 | 长安大学 | 一种车联网环境下车辆高精度定位方法 |
CN110609567A (zh) * | 2019-09-16 | 2019-12-24 | 中国人民解放军国防科技大学 | 一种面向四旋翼无人机的卫星惯性组合导航终端欺骗方法 |
CN111338369A (zh) * | 2020-03-19 | 2020-06-26 | 南京理工大学 | 一种基于非线性逆补偿的多旋翼飞行控制方法 |
CN111413994A (zh) * | 2020-03-13 | 2020-07-14 | 浙江树人学院(浙江树人大学) | 一种四旋翼无人机直接自适应模糊控制方法 |
CN111781820A (zh) * | 2020-07-24 | 2020-10-16 | 滨州学院 | 基于重心动力学的航模pid算法控制方法 |
CN111984024A (zh) * | 2020-08-25 | 2020-11-24 | 福州大学 | 基于作业型飞行机器人的扰动和不确定性控制方法 |
CN113448339A (zh) * | 2020-03-25 | 2021-09-28 | 中国人民解放军海军工程大学 | 一种基于虚拟反演的飞行器攻角跟踪控制方法 |
CN114510065A (zh) * | 2021-12-24 | 2022-05-17 | 湖北航天飞行器研究所 | 一种多旋翼无人机地面目标跟踪控制方法 |
CN115327916A (zh) * | 2022-08-30 | 2022-11-11 | 北京京航计算通讯研究所 | 一种高机动飞机气动参数摄动的自适应补偿控制方法 |
CN115556111A (zh) * | 2022-10-26 | 2023-01-03 | 哈尔滨工业大学 | 基于变惯性参数建模的飞行机械臂耦合扰动控制方法 |
CN117452859A (zh) * | 2023-11-21 | 2024-01-26 | 南开大学 | 一种自主飞行的航空器的控制***及其方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104865968A (zh) * | 2015-04-22 | 2015-08-26 | 浙江工业大学 | 一种采用串级自抗扰控制技术的四旋翼飞行器悬停控制方法 |
CN111459188A (zh) * | 2020-04-29 | 2020-07-28 | 南京理工大学 | 一种基于四元数的多旋翼非线性飞行控制方法 |
-
2018
- 2018-05-29 CN CN201810530155.4A patent/CN108803639A/zh active Pending
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104865968A (zh) * | 2015-04-22 | 2015-08-26 | 浙江工业大学 | 一种采用串级自抗扰控制技术的四旋翼飞行器悬停控制方法 |
CN111459188A (zh) * | 2020-04-29 | 2020-07-28 | 南京理工大学 | 一种基于四元数的多旋翼非线性飞行控制方法 |
Non-Patent Citations (4)
Title |
---|
JIANXIN LIU 等: "Dynamic surface back-stepping control of multi rotor aircraft", 《IEEE》 * |
丁锁辉: "基于Backstepping和H_∞回路成形方法的微小型四旋翼飞行器控制器设计", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 * |
牛洪芳 等: "基于反步法的四旋翼飞行器滑动模态控制", 《高技术通讯》 * |
石川: "基于积分反步法的四旋翼飞行器轨迹跟踪控制", 《四川理工学院学报(自然科学版)》 * |
Cited By (22)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109635388A (zh) * | 2018-11-29 | 2019-04-16 | 中国航空工业集团公司沈阳飞机设计研究所 | 一种全机加速度参数测算方法 |
CN109432724A (zh) * | 2018-12-13 | 2019-03-08 | 福州大学 | 新型健身飞行器及其控制方法 |
CN109976364B (zh) * | 2019-03-26 | 2021-04-23 | 中南大学 | 一种六旋翼飞行器姿态解耦控制方法 |
CN109976364A (zh) * | 2019-03-26 | 2019-07-05 | 中南大学 | 一种六旋翼飞行器姿态解耦控制方法 |
CN109901606A (zh) * | 2019-04-11 | 2019-06-18 | 大连海事大学 | 一种用于四旋翼精确轨迹跟踪的混合有限时间控制方法 |
CN110208842A (zh) * | 2019-05-28 | 2019-09-06 | 长安大学 | 一种车联网环境下车辆高精度定位方法 |
CN110609567A (zh) * | 2019-09-16 | 2019-12-24 | 中国人民解放军国防科技大学 | 一种面向四旋翼无人机的卫星惯性组合导航终端欺骗方法 |
CN111413994A (zh) * | 2020-03-13 | 2020-07-14 | 浙江树人学院(浙江树人大学) | 一种四旋翼无人机直接自适应模糊控制方法 |
CN111413994B (zh) * | 2020-03-13 | 2023-08-08 | 浙江树人学院(浙江树人大学) | 一种四旋翼无人机直接自适应模糊控制方法 |
CN111338369B (zh) * | 2020-03-19 | 2022-08-12 | 南京理工大学 | 一种基于非线性逆补偿的多旋翼飞行控制方法 |
CN111338369A (zh) * | 2020-03-19 | 2020-06-26 | 南京理工大学 | 一种基于非线性逆补偿的多旋翼飞行控制方法 |
CN113448339B (zh) * | 2020-03-25 | 2022-07-01 | 中国人民解放军海军工程大学 | 一种基于虚拟反演的飞行器攻角跟踪控制方法 |
CN113448339A (zh) * | 2020-03-25 | 2021-09-28 | 中国人民解放军海军工程大学 | 一种基于虚拟反演的飞行器攻角跟踪控制方法 |
CN111781820B (zh) * | 2020-07-24 | 2023-06-02 | 滨州学院 | 基于重心动力学的航模pid算法控制方法 |
CN111781820A (zh) * | 2020-07-24 | 2020-10-16 | 滨州学院 | 基于重心动力学的航模pid算法控制方法 |
CN111984024A (zh) * | 2020-08-25 | 2020-11-24 | 福州大学 | 基于作业型飞行机器人的扰动和不确定性控制方法 |
CN114510065A (zh) * | 2021-12-24 | 2022-05-17 | 湖北航天飞行器研究所 | 一种多旋翼无人机地面目标跟踪控制方法 |
CN115327916A (zh) * | 2022-08-30 | 2022-11-11 | 北京京航计算通讯研究所 | 一种高机动飞机气动参数摄动的自适应补偿控制方法 |
CN115556111A (zh) * | 2022-10-26 | 2023-01-03 | 哈尔滨工业大学 | 基于变惯性参数建模的飞行机械臂耦合扰动控制方法 |
CN115556111B (zh) * | 2022-10-26 | 2023-08-18 | 哈尔滨工业大学 | 基于变惯性参数建模的飞行机械臂耦合扰动控制方法 |
CN117452859A (zh) * | 2023-11-21 | 2024-01-26 | 南开大学 | 一种自主飞行的航空器的控制***及其方法 |
CN117452859B (zh) * | 2023-11-21 | 2024-06-25 | 南开大学 | 一种自主飞行的航空器的控制***及其方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108803639A (zh) | 一种基于反步法的四旋翼飞行器飞行控制方法 | |
CN107368091B (zh) | 一种基于有限时间神经动力学的多旋翼无人飞行器的稳定飞行控制方法 | |
Lozano | Unmanned aerial vehicles: Embedded control | |
Jung et al. | Development and application of controller for transition flight of tail-sitter UAV | |
Bulka et al. | Automatic control for aerobatic maneuvering of agile fixed-wing UAVs | |
CN111399531B (zh) | 高超声速飞行器滑翔段制导与姿态控制一体化设计方法 | |
CN108873929B (zh) | 一种固定翼飞机自主着舰方法及*** | |
CN103885450A (zh) | 无人直升机姿态非线性控制方法及验证平台 | |
CN105151292A (zh) | 分布式矢量推进*** | |
CN109703768B (zh) | 一种基于姿态/轨迹复合控制的软式空中加油对接方法 | |
CN108445895A (zh) | 用于倾转式三旋翼无人机位置控制的鲁棒控制方法 | |
CN111813133B (zh) | 一种基于相对精密单点定位的无人机舰船自主着陆方法 | |
Jithu et al. | Quadrotor modelling and control | |
Jung et al. | A comprehensive flight control design and experiment of a tail-sitter UAV | |
Garcia et al. | Attitude stabilization with real-time experiments of a tail-sitter aircraft in horizontal flight | |
Kita et al. | Transition between level flight and hovering of a tail-sitter vertical takeoff and landing aerial robot | |
CN106020222A (zh) | 一种三自由度直升机姿态的自抗扰控制方法 | |
Hegde et al. | Transition flight modeling and robust control of a VTOL unmanned quad tilt-rotor aerial vehicle | |
CN107678442B (zh) | 一种基于双模型下的四旋翼自主着船控制方法 | |
Yayla et al. | An adaptive flight controller design for a tilt-prop fixed wing UAV for all flight modes | |
Kumar et al. | Position and attitude control by rotor tilt and rotor speed synchronization for single axis tilting-rotor quadcopter | |
CN109634110A (zh) | 一种基于非线性干扰观测器的尾座式无人机过渡段鲁棒控制方法 | |
Rice et al. | Control performance analysis for autonomous close formation flight experiments | |
Balmer | Modelling and control of a fixed-wing uav for landings on mobile landing platforms | |
Kowalik et al. | A mathematical model for controlling a quadrotor UAV |
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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20181113 |
|
RJ01 | Rejection of invention patent application after publication |