CN114488816B - 一种旋转翼-倾斜混合式无人机非线性模型预测控制方法 - Google Patents
一种旋转翼-倾斜混合式无人机非线性模型预测控制方法 Download PDFInfo
- Publication number
- CN114488816B CN114488816B CN202210099139.0A CN202210099139A CN114488816B CN 114488816 B CN114488816 B CN 114488816B CN 202210099139 A CN202210099139 A CN 202210099139A CN 114488816 B CN114488816 B CN 114488816B
- Authority
- CN
- China
- Prior art keywords
- mpc
- control
- vector
- unmanned aerial
- aerial vehicle
- 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.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及一种旋转翼‑倾斜混合式无人机非线性模型预测控制方法,包括步骤:定义无人机重要参数;设计基于导航MPC算法的非线性模型;设计控制分配算法;设计无人机飞行实验。本发明的有益效果是:本发明设计一种基于非线性模型预测控制(model predictive control,MPC)方法,并应用于旋转翼‑倾斜混合式无人机,推导建立无人机的非线性模型,设计多级控制分配算法;本发明考虑无人机非线性动力学特征,建立非线性MPC算法方程,导航MPC模块根据参考速度计算最优驱动力、倾斜角度和扭矩三类控制输入量,实现RW模式和FW模式的自动相互转换;本发明应用的无人机在机械结构上可以实现任意飞行角度。
Description
技术领域
本发明属于混合式无人机控制领域,尤其涉及一种旋转翼-倾斜混合式无人机非线性模型预测控制方法。
背景技术
旋转翼-倾斜混合式无人机(UAV)同时具备旋转翼(rotary-wing,RW)垂直起飞和着陆(VTOL)功能,以及固定翼(fixed-wing,FW)高效前飞功能。该类型无人机配置的控制器必须处理高度非线性的动态行为,在两种飞行模式转换过程中,实现控制权限的自由转换。
目前,常用的控制方法是为飞行全轨迹中各个配平点设计一组稳定的控制器,并设计增益调度(GS)或多种控制器,为不同的飞行目的选择适当的控制规则。多数研究设计的控制器结构均基于线性模型,没有考虑空气动力学动态特征,且线性模型采样点数量有限,不能跟踪无人机的飞行全轨迹。有学者提出非线性控制模型,但是仅仅应用于仿真实验,在实际应用中存在模型干扰和不确定性问题。
发明内容
本发明的目的是克服现有技术中的不足,提供一种旋转翼-倾斜混合式无人机非线性模型预测控制方法。
这种旋转翼-倾斜混合式无人机非线性模型预测控制方法,包括以下步骤:
步骤1、定义无人机重要参数;步骤1中无人机包括11个驱动自由度,驱动自由度由四个螺旋桨角速度矢量w1,w2,w3,w4,五个控制面和两个倾斜角χr、χl组成;/>为参数维度,姿态四元数/>q0和/>为姿态四元数组成向量,H为Hamilton空间;
步骤2、设计基于导航MPC算法的非线性模型;非线性模型包括导航MPC模块、姿态控制器和控制分配模块;建立旋转翼-倾斜混合式无人机动力学方程,计算无人机EoM最优结果,建立无人机目标函数并进行优化,建立非线性模型控制方法的约束条件;
步骤3、设计控制分配算法:基于当前空气速度va Β,va Β=vW Β-vΒ,导航MPC算法、姿态控制器驱动力Tmpc、倾斜角度和无人机实际扭矩,结合公式(6)和公式(7),反演计算得到11个驱动自由度状态向量对应的执行器指令;引入两步法菊花链算法,分配控制面偏转,分配旋转速度和倾斜角度;
步骤4、设计无人机飞行实验:设定无人机飞行实验场地、风速范围、MPC解算器采样时间、预测控制算法步进范围、解算器收敛时间;如果解算器不收敛,将根据无人机当前姿态重新初始化解算器。
作为优选,步骤2中基于导航MPC算法的非线性模型的总输入向量为下标ref表示参考量;上标γ表示惯性系;上标Β表示固定系向量;/>表示惯性系γ的参考质心速度;姿态控制器的输入向量为qγΒ,mpc,其中带下标mpc的参数表示导航MPC模块的输出量;姿态控制器的输出向量为固定系向量Β中的姿态力矩/>导航MPC模块同时输出姿态力矩/>将/>与/>叠加,作为控制分配模块的输入向量/>将控制分配模块的输出向量/>作为无人机的控制输入量,其中带下标cmd的参数表示控制分配模块的输出量;将无人机的实时状态向量x作为反馈量输入导航MPC模块。
作为优选,步骤2具体包括以下步骤:
步骤2-1、建立非线性模型:在预测控制算法(控制器是算法的载体)的每次迭代过程中,建立如式(1)至式(5)所示的非线性模型:
1xn=x(t) (3)
上式中,n为方向向量;为状态向量;un为控制输入向量;t时刻系统状态值为x(t);1xn为预测阶段1的初始值,jxn表示预测阶段j的状态向量,jxn的最小值和最大值区间为[xmin,xmax];jun表示预测阶段j的控制输入向量,jun的最小值和最大值区间为[umin,umax];jΔx和jΔx表示MPC预测阶段j预测值和期望值之间的偏差值;N为预测控制算法步长,h()为成本函数,hN+1()为预测阶段N+1的成本函数;表达式/>表示状态向量导数,f()为非线性函数;
步骤2-2、根据公式(2),建立旋转翼-倾斜混合式无人机动力学方程,计算无人机EoM最优结果;简化非线性模型,通过降低非线性模型复杂度来减少导航MPC模块内的MPC解算器收敛时间。
作为优选,步骤2-2具体包括如下步骤:
步骤2-2-1、简化非线性模型;
上式中,Mn Β、Mr Β和Mδ Β分别为固定系向量Β中的控制扭矩、螺旋桨力矩和控制面力矩;di Β为固定系Β原点到第i个螺旋桨的方向向量;Qi Β为固定系B中第i个螺旋桨抗扭矩贡献值,Ti Β为固定系B中第i个螺旋桨驱动力贡献值;
步骤2-2-2、螺旋桨驱动力矢量结合方向向量D()上的单个驱动力Tn和单个倾斜角χn,建立固定系向量Β中的虚拟受力公式:
根据公式(6)和公式(7),将导航MPC模块的状态向量重新表示为xn=(vn γTχn qγΒ,n T(ωγΒ,n Β)T)T;vn γT、qγΒ,n T分别为惯性系γ中的质心速度转置和姿态四元数转置,ωγΒ,n Β为固定系Β中的相对角速度;下标n用于区分MPC变量和预测控制算法状态量;
步骤2-2-3、导航MPC模块的控制输入向量为其中倾斜角χn,cmd为控制分配模块的输出状态量,倾斜角χn,cmd的变化率/>作为控制输入量,作为控制模式切换最短持续时间的限制因素;旋转翼-倾斜混合式无人机的动力学方程为公式(8)至公式(11):
作为优选,步骤3具体包括以下步骤:
由于参数ωγΒ的大小比空气速度v小,忽略ωγΒ对空气速度的影响;建立控制面扭矩,公式为:
上式中,ρ为空气密度,va Β为当前空气速度,CA,CR,CE分别为控制面A、R、E的空气阻力;在满足式(15)至式(17)的制动器约束条件下,建立如式(19)的配置公式,式(19)将最大数量的力矩分配给不同的空气动力学控制面:
Mtot,resΒ=MtotΒ-Aδδcmd (20)
步骤3-2、分配旋转速度和倾斜角度:菊花链算法的第二步是分配旋转速度和倾斜角度,根据公式(21),计算右侧倾斜角度χr和左侧倾斜角度χl:
上式中,Δχr为右侧倾斜角度偏离值,Δχl为左侧倾斜角度偏离值,χmpc为导航MPC算法倾斜角度;
忽略已分配的控制面扭矩Mδ,利用公式(22)的驱动力-旋转速度关系式和扭矩-旋转速度关系式,将公式(6)和(7)重写为公式(23):
上式中,cr和cQ分别为驱动力系数和扭矩系数,方向向量D(χi)满足D(χi)=(-sinχi0 cosχi)T,wi为第i个螺旋桨角速度矢量。Tmpc为导航MPC输出的驱动力,A为分配矩阵,w1,w2,w3,w4为4个螺旋桨角速度矢量;
根据公式(24),完成旋转速度和倾斜角的两步分配:第一步,伪逆矩阵将表达式vTv进行最小化,最小化后的值等于旋转速度的平方和;旋转速度v的计算公式为第二步,利用v=(v1,…,v8)T得出倾斜角的控制指令,如式(25)至式(27):
式中,Δχr,cmd为右侧倾斜角偏差值的控制分配向量,Δχl,cmd为左侧倾斜角偏差值的控制分配向量,v1,…,v8为8个速度值,χr,cmd和χl,cmd分别为右侧倾斜角和左侧倾斜角的控制分配向量,χmpc为导航MPC输出倾斜角矢量;
螺旋桨角速度控制分配向量公式为:
式中,w1,cmd,w2,cmd,w3,cmd,w4,cmd为4个螺旋桨角速度控制分配矢量,下标r表示无人机右侧,下标l表示无人机左侧,下标cmd表示控制分配模块输出量。
作为优选,步骤4中飞行实验场地设置为室外,风速范围为5km/h~10km/h,MPC解算器采样时间为TMPC=50ms,预测控制算法步进为N=20;解算器算法在Raspberry Pi 3 B上运行,平均收敛时间为40ms,频率为20Hz,采样时间内为计算误差值提供缓冲时间。
本发明的有益效果是:
本发明设计一种基于非线性模型预测控制(model predictive control,MPC)方法,并应用于旋转翼-倾斜混合式无人机,推导建立无人机的非线性模型,设计多级控制分配算法;本发明考虑无人机非线性动力学特征,建立非线性MPC算法方程,导航MPC模块根据参考速度计算最优驱动力、倾斜角度和扭矩三类控制输入量,实现RW模式和FW模式的自动相互转换;本发明应用的无人机在机械结构上可以实现任意飞行角度;
本发明增加高频姿态控制器,提高控制系统的稳定性和跟踪性能;引入菊花链控制分配算法,处理不断变化的控制权限和最优能量分配;本发明的方法在整个飞行轨迹有效期内不需要进行控制器切换或设计调度策略,能实现无人机的飞行全轨迹跟踪、VTOL功能和前飞功能的优化利用。
附图说明
图1为本发明基于导航MPC算法的控制流程图。
具体实施方式
下面结合实施例对本发明做进一步描述。下述实施例的说明只是用于帮助理解本发明。应当指出,对于本技术领域的普通人员来说,在不脱离本发明原理的前提下,还可以对本发明进行若干修饰,这些改进和修饰也落入本发明权利要求的保护范围内。
实施例一
本申请实施例一提供了一种如图1所示旋转翼-倾斜混合式无人机非线性模型预测控制方法:
步骤1、定义无人机重要参数;步骤1中无人机在机械结构上可以实现任意飞行角度,包括11个驱动自由度,驱动自由度由四个螺旋桨角速度矢量w1,w2,w3,w4,五个控制面δE和两个倾斜角χr、χl组成;/>为参数维度,姿态四元数q0和/>为姿态四元数组成向量,H为Hamilton空间;
步骤2、旋转翼-倾斜混合式无人机的控制器必须能够处理控制权限变化问题,需要建立高度非线性模型,设计基于导航MPC算法(guidance-MPC)的非线性模型;非线性模型包括导航MPC模块、姿态控制器和控制分配模块;建立旋转翼-倾斜混合式无人机动力学方程,计算无人机EoM最优结果,建立无人机目标函数并进行优化,建立非线性模型控制方法的约束条件;
基于导航MPC算法的非线性模型的总输入向量为下标ref表示参考量;上标γ表示惯性系;上标Β表示固定系向量;/>表示惯性系γ的参考质心速度;姿态控制器的输入向量为qγΒ,mpc,其中带下标mpc的参数表示导航MPC模块的输出量;姿态控制器的输出向量为固定系向量Β中的姿态力矩/>导航MPC模块同时输出姿态力矩/>将/>与/>叠加,作为控制分配模块的输入向量/>将控制分配模块的输出向量/>作为无人机的控制输入量,其中带下标cmd的参数表示控制分配模块的输出量;将无人机的实时状态向量x作为反馈量输入导航MPC模块。
步骤2-1、建立非线性模型:在预测控制算法的每次迭代过程中,建立如式(1)至式(5)所示的非线性模型:
1xn=x(t) (3)
上式中,n为方向向量;为状态向量;un为控制输入向量;t时刻系统状态值为x(t);jxn表示预测阶段j的状态向量,jxn的最小值和最大值区间为[xmin,xmax];jun表示预测阶段j的控制输入向量,jun的最小值和最大值区间为[umin,umax];jΔx和jΔx表示MPC预测阶段j预测值和期望值之间的偏差值;N为预测控制算法步长,h()为成本函数,hN+1()为预测阶段N+1的成本函数;表达式/>表示状态向量导数,f()为非线性函数;
步骤2-2、根据公式(2),建立旋转翼-倾斜混合式无人机动力学方程,计算无人机EoM最优结果;简化非线性模型,通过降低非线性模型复杂度来减少导航MPC模块内的MPC解算器收敛时间。
步骤2-2-1、简化非线性模型;
上式中,Mn Β、Mr Β和Mδ Β分别为固定系向量Β中的控制扭矩、螺旋桨力矩和控制面力矩;di Β为固定系Β原点到第i个螺旋桨的方向向量;Qi Β为固定系B中第i个螺旋桨抗扭矩贡献值,Ti Β为固定系B中第i个螺旋桨驱动力贡献值;
步骤2-2-2、螺旋桨驱动力矢量结合方向向量D()上的单个驱动力Tn和单个倾斜角χn,建立固定系向量Β中的虚拟受力公式:
根据公式(6)和公式(7),将导航MPC模块的状态向量重新表示为xn=(vn γTχn qγΒ,n T(ωγΒ,n Β)T)T;vn γT、qγΒ,n T分别为惯性系γ中的质心速度转置和姿态四元数转置,ωγΒ,n Β为固定系Β中的相对角速度;下标n用于区分MPC变量和预测控制算法状态量;
步骤2-2-3、导航MPC模块的控制输入向量为其中倾斜角χn,cmd为控制分配模块的输出状态量,倾斜角χn,cmd的变化率/>作为控制输入量,作为控制模式切换最短持续时间的限制因素;旋转翼-倾斜混合式无人机的动力学方程为公式(8)至公式(11):
上式中,为速度导数,/>为四元数导数,g为重力常数,ed为惯性系坐标方向之一,上标γ表示惯性系向量,m为质量惯性矩阵,RγΒ,n为旋转矩阵,满足Rodrigues旋转矩阵公式,其它参数定义如表1所示;/>
表1无人机控制方法的重要参数表
步骤3、设计控制分配算法:基于当前空气速度va Β,va Β=vW Β-vΒ,导航MPC算法、姿态控制器驱动力Tmpc、倾斜角度和无人机实际扭矩,结合公式(6)和公式(7),反演计算得到11个驱动自由度状态向量对应的执行器指令;引入两步法菊花链算法,分配控制面偏转,分配旋转速度和倾斜角度;有效解决过度驱动和控制权限变化问题;
由于参数ωγΒ的大小比空气速度v小,忽略ωγΒ对空气速度的影响;建立控制面扭矩,公式为:
上式中,ρ为空气密度,va Β为当前空气速度,CA,CR,CE分别为控制面A、R、E的空气阻力;在满足式(15)至式(17)的制动器约束条件下,建立如式(19)的配置公式,式(19)将最大数量的力矩分配给不同的空气动力学控制面:
Mtot,res Β=Mtot Β-Aδδcmd (20)
步骤3-2、分配旋转速度和倾斜角度:菊花链算法的第二步是分配旋转速度和倾斜角度,根据公式(21),计算右侧倾斜角度χr和左侧倾斜角度χl:
χr=χmpc+Δχr
χl=χmpc+Δχl (21)
上式中,Δχr为右侧倾斜角度偏离值,Δχl为左侧倾斜角度偏离值,χmpc为导航MPC算法倾斜角度;
忽略已分配的控制面扭矩Mδ,利用公式(22)的驱动力-旋转速度关系式和扭矩-旋转速度关系式,将公式(6)和(7)重写为公式(23):
上式中,cr和cQ分别为驱动力系数和扭矩系数,方向向量D(χi)满足D(χi)=(-sinχi0 cosχi)T,wi为第i个螺旋桨角速度矢量。Tmpc为导航MPC输出的驱动力,A为分配矩阵,w1,w2,w3,w4为4个螺旋桨角速度矢量;
根据公式(24),完成旋转速度和倾斜角的两步分配:第一步,伪逆矩阵将表达式vTv进行最小化,最小化后的值等于旋转速度的平方和;旋转速度v的计算公式为第二步,利用v=(v1,…,v8)T得出倾斜角的控制指令,如式(25)至式(27):
式中,Δχr,cmd为右侧倾斜角偏差值的控制分配向量,Δχl,cmd为左侧倾斜角偏差值的控制分配向量,v1,…,v8为8个速度值,χr,cmd和χl,cmd分别为右侧倾斜角和左侧倾斜角的控制分配向量,χmpc为导航MPC输出倾斜角矢量;
螺旋桨角速度控制分配向量公式为:
式中,w1,cmd,w2,cmd,w3,cmd,w4,cmd为4个螺旋桨角速度控制分配矢量,下标r表示无人机右侧,下标l表示无人机左侧,下标cmd表示控制分配模块输出量;
步骤4、设计无人机飞行实验:飞行实验场地设置为室外,风速范围为5km/h~10km/h,MPC解算器采样时间为TMPC=50ms,预测控制算法步进为N=20;解算器算法在Raspberry Pi 3 B上运行,平均收敛时间为40ms,频率为20Hz,采样时间内为计算误差值提供缓冲时间;下表2为飞行实验中使用的MPC权重参数和权重值,如果解算器不收敛,将根据无人机当前姿态重新初始化解算器。
表2飞行实验中使用的MPC权重表
实施例二
在实施例一的基础上,本申请实施例二提供了实施例一中旋转翼-倾斜混合式无人机非线性模型预测控制方法的验证方法:
实验结果1
验证控制分配算法,根据公式(23)和制动器指令,重构实际产生的驱动力和扭矩矢量fact,并与初始推力和扭矩矢量的期望值fdes进行比较。下表3为实验产生的驱动力和扭矩与期望值之间相对误差平均值μ和标准偏差σ统计结果。结果表明,相对误差平均值μ和标准偏差σ在不同坐标轴方向上,数值基本相同,标准偏差σ控制在10%以内。验证本发明提出的控制方法的精确性和有效性。
表3实验产生的驱动力和扭矩与期望值之间相对误差的平均值μ和标准偏差σ统计结果表
实验结果2
采用算法效率验证,利用MATLAB的非线性优化器,计算得到公式(24)-公式(27)的最优解,最小范数为旋转速度平方值。下表4给出最优解wopt,χopt和指令值wcmd,χcmd之间相对误差的平均值和标准偏差。
结果表明:平均值μ和标准偏差σ均控制在1.6%以内;旋转速度误差值中,er(ω3)最大,其余误差值相近;倾斜角度偏差值er(χl)大于er(χr);自定义分配输出量是执行器的最优解,该值说明在悬停实验中可以基于倾斜角参数确定偏航旋转模式。
表4最优解ωopt,χopt和指令值ωcmd,χcmd之间的相对误差er的平均值μ和标准偏差σ统计结果表
e<sub>r</sub> | μ | σ |
e<sub>r</sub>(w<sub>1</sub>) | 0.3% | 0.8% |
e<sub>r</sub>(w<sub>2</sub>) | 0.3% | 0.7% |
e<sub>r</sub>(w<sub>3</sub>) | 0.4% | 1.4% |
e<sub>r</sub>(w<sub>4</sub>) | 0.4% | 0.7% |
e<sub>r</sub>(χ<sub>r</sub>) | 0.7% | 1.1% |
e<sub>r</sub>(χ<sub>l</sub>) | 0.9% | 1.6% |
Claims (6)
1.一种旋转翼-倾斜混合式无人机非线性模型预测控制方法,其特征在于,包括以下步骤:
步骤1、定义无人机重要参数;步骤1中无人机包括11个驱动自由度,驱动自由度由四个螺旋桨角速度矢量w1,w2,w3,w4,五个控制面δE和两个倾斜角χr、χl组成;为参数维度,姿态四元数q0和为姿态四元数组成向量,H为Hamilton空间;
步骤2、设计基于导航MPC算法的非线性模型;非线性模型包括导航MPC模块、姿态控制器和控制分配模块;建立旋转翼-倾斜混合式无人机动力学方程,计算无人机EoM最优结果,建立无人机目标函数并进行优化,建立非线性模型控制方法的约束条件;
步骤3、设计控制分配算法:基于当前空气速度va B,va B=vW B-vB,导航MPC算法、姿态控制器驱动力Tmpc、倾斜角度和无人机实际扭矩,结合固定系向量B中的控制扭矩公式和虚拟受力公式,反演计算得到11个驱动自由度状态向量对应的执行器指令;引入两步法菊花链算法,分配控制面偏转,分配旋转速度和倾斜角度;
步骤4、设计无人机飞行实验:设定无人机飞行实验场地、风速范围、MPC解算器采样时间、预测控制算法步进范围、解算器收敛时间;如果解算器不收敛,将根据无人机当前姿态重新初始化解算器。
3.根据权利要求2所述旋转翼-倾斜混合式无人机非线性模型预测控制方法,其特征在于,步骤2具体包括以下步骤:
步骤2-1、建立非线性模型:在预测控制算法的每次迭代过程中,建立如式(1)至式(5)所示的非线性模型:
s.t.
1xn=x(t) (3)
上式中,n为方向向量;为状态向量;un为控制输入向量;t时刻系统状态值为x(t);1xn为预测阶段1的初始值,jxn表示预测阶段j的状态向量,jxn的最小值和最大值区间为[xmin,xmax];jun表示预测阶段j的控制输入向量,jun的最小值和最大值区间为[umin,umax];jΔx和jΔu表示MPC预测阶段j预测值和期望值之间的偏差值;N为预测控制算法步长,h()为成本函数,hN+1()为预测阶段N+1的成本函数;表达式表示状态向量导数,f()为非线性函数;
步骤2-2、根据公式(2),建立旋转翼-倾斜混合式无人机动力学方程,计算无人机EoM最优结果;简化非线性模型,通过降低非线性模型复杂度来减少导航MPC模块内的MPC解算器收敛时间。
4.根据权利要求3所述旋转翼-倾斜混合式无人机非线性模型预测控制方法,其特征在于,步骤2-2具体包括如下步骤:
步骤2-2-1、简化非线性模型;
上式中,Mn B、Mr B和Mδ B分别为固定系向量B中的控制扭矩、螺旋桨力矩和控制面力矩;di B为固定系B原点到第i个螺旋桨的方向向量;Qi B为固定系B中第i个螺旋桨抗扭矩贡献值,Ti B为固定系B中第i个螺旋桨驱动力贡献值;
步骤2-2-2、螺旋桨驱动力矢量结合方向向量D()上的单个驱动力Tn和单个倾斜角χn,建立固定系向量B中的虚拟受力公式:
根据公式(6)和公式(7),将导航MPC模块的状态向量重新表示为xn=(vn γTχn qγB,n T(ωγB,n B)T)T;vn γT、qγB,n T分别为惯性系γ中的质心速度转置和姿态四元数转置,ωγB,n B为固定系B中的相对角速度;下标n用于区分MPC变量和预测控制算法状态量;
步骤2-2-3、导航MPC模块的控制输入向量为其中倾斜角χn,cmd为控制分配模块的输出状态量,倾斜角χn,cmd的变化率作为控制输入量,作为控制模式切换最短持续时间的限制因素;旋转翼-倾斜混合式无人机的动力学方程为公式(8)至公式(11):
5.根据权利要求4所述旋转翼-倾斜混合式无人机非线性模型预测控制方法,其特征在于,步骤3具体包括以下步骤:
由于参数ωγB的大小比空气速度v小,忽略ωγB对空气速度的影响;建立控制面扭矩,公式为:
上式中,ρ为空气密度,va B为当前空气速度,CA,CR,CE分别为控制面A、R、E的空气阻力;在满足式(15)至式(17)的制动器约束条件下,建立如式(19)的配置公式,式(19)将最大数量的力矩分配给不同的空气动力学控制面:
Mtot,res B=Mtot B-Aδδcmd (20)
步骤3-2、分配旋转速度和倾斜角度:菊花链算法的第二步是分配旋转速度和倾斜角度,根据公式(21),计算右侧倾斜角度χr和左侧倾斜角度χl:
χr=χmpc+Δχr
χl=χmpc+Δχl (21)
上式中,Δχr为右侧倾斜角度偏离值,Δχl为左侧倾斜角度偏离值,χmpc为导航MPC算法倾斜角度;
忽略已分配的控制面扭矩Mδ,利用公式(22)的驱动力-旋转速度关系式和扭矩-旋转速度关系式,将公式(6)和(7)重写为公式(23):
上式中,cr和cQ分别为驱动力系数和扭矩系数,方向向量D(χi)满足D(χi)=(-sinχi 0cosχi)T,wi为第i个螺旋桨角速度矢量;Tmpc为导航MPC输出的驱动力,A为分配矩阵,w1,w2,w3,w4为4个螺旋桨角速度矢量;
根据公式(24),完成旋转速度和倾斜角的两步分配:第一步,伪逆矩阵将表达式vTv进行最小化,最小化后的值等于旋转速度的平方和;旋转速度v的计算公式为第二步,利用v=(v1,...,v8)T得出倾斜角的控制指令,如式(25)至式(27):
式中,Δχr,cmd为右侧倾斜角偏差值的控制分配向量,Δχl,cmd为左侧倾斜角偏差值的控制分配向量,v1,...,v8为8个速度值,χr,cmd和χl,cmd分别为右侧倾斜角和左侧倾斜角的控制分配向量,χmpc为导航MPC输出倾斜角矢量;
螺旋桨角速度控制分配向量公式为:
式中,w1,cmd,w2,cmd,w3,cmd,w4,cmd为4个螺旋桨角速度控制分配矢量,下标r表示无人机右侧,下标l表示无人机左侧,下标cmd表示控制分配模块输出量。
6.根据权利要求1所述旋转翼-倾斜混合式无人机非线性模型预测控制方法,其特征在于:步骤4中飞行实验场地设置为室外,风速范围为5km/h~10km/h,MPC解算器采样时间为TMPC=50ms,预测控制算法步进为N=20;解算器算法在Raspberry Pi 3 B上运行,平均收敛时间为40ms,频率为20Hz,采样时间内为计算误差值提供缓冲时间。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210099139.0A CN114488816B (zh) | 2022-01-27 | 2022-01-27 | 一种旋转翼-倾斜混合式无人机非线性模型预测控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210099139.0A CN114488816B (zh) | 2022-01-27 | 2022-01-27 | 一种旋转翼-倾斜混合式无人机非线性模型预测控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114488816A CN114488816A (zh) | 2022-05-13 |
CN114488816B true CN114488816B (zh) | 2023-03-24 |
Family
ID=81476571
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210099139.0A Active CN114488816B (zh) | 2022-01-27 | 2022-01-27 | 一种旋转翼-倾斜混合式无人机非线性模型预测控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114488816B (zh) |
Family Cites Families (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6377906B1 (en) * | 2000-02-03 | 2002-04-23 | Independence Technology, L.L.C. | Attitude estimation in tiltable body using modified quaternion data representation |
US20160202670A1 (en) * | 2015-01-08 | 2016-07-14 | Northwestern University | System and method for sequential action control for nonlinear systems |
DE102016222139A1 (de) * | 2016-11-11 | 2018-05-17 | Robert Bosch Gmbh | Verfahren zum Betreiben einer Axialkolbenmaschine in Schrägscheibenbauweise |
CN106647783B (zh) * | 2016-11-22 | 2019-07-16 | 天津大学 | 倾转式三旋翼无人机姿态与高度自适应鲁棒控制方法 |
CN111656673A (zh) * | 2017-09-15 | 2020-09-11 | 安德烈斯·贝洛大学 | 针对两个或更多个控制目标,首先求解成本函数,然后求解第二成本函数的顺序预测控制方法 |
CN109116860B (zh) * | 2018-08-29 | 2022-05-03 | 天津大学 | 三旋翼无人机的非线性鲁棒控制方法 |
CN110320932B (zh) * | 2019-06-21 | 2021-08-31 | 西安电子科技大学 | 一种基于微分进化算法的编队队形重构方法 |
CN111443721A (zh) * | 2020-01-03 | 2020-07-24 | 莆田学院 | 一种四旋翼无人机姿态动态面控制方法及存储介质 |
CN111904486A (zh) * | 2020-05-18 | 2020-11-10 | 吉林大学 | 螺旋型血管机器人姿轨一体化自适应滑模跟踪控制方法 |
CN111984020B (zh) * | 2020-07-21 | 2023-06-16 | 广东工业大学 | 基于sdre的倾转四旋翼无人机过渡飞行模式自适应最优滑模控制方法 |
-
2022
- 2022-01-27 CN CN202210099139.0A patent/CN114488816B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN114488816A (zh) | 2022-05-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Raffo et al. | Nonlinear H∞ controller for the quad-rotor helicopter with input coupling | |
Colorado et al. | Mini-quadrotor attitude control based on Hybrid Backstepping & Frenet-Serret theory | |
CN112034871B (zh) | 一种可倾转多旋翼飞行器的全向控制方法 | |
Tang et al. | Nonlinear dynamic modeling and hybrid control design with dynamic compensator for a small-scale UAV quadrotor | |
Zhang et al. | Control allocation framework for a tilt-rotor vertical take-off and landing transition aircraft configuration | |
CN111538255B (zh) | 一种反蜂群无人机的飞行器控制方法及系统 | |
Di Francesco et al. | Incremental nonlinear dynamic inversion and control allocation for a tilt rotor UAV | |
Bulka et al. | Autonomous control of agile fixed-wing UAVs performing aerobatic maneuvers | |
Casau et al. | Autonomous transition flight for a vertical take-off and landing aircraft | |
Anglade et al. | Automatic control of convertible fixed-wing drones with vectorized thrust | |
Chakraborty et al. | Development of a modeling, flight simulation, and control analysis capability for novel vehicle configurations | |
CN112130457A (zh) | 一种变体无人机栖落机动的模糊飞行控制方法 | |
CN114721266B (zh) | 飞机舵面结构性缺失故障情况下的自适应重构控制方法 | |
CN114879739A (zh) | 一种基于零空间的可倾转四旋翼无人机控制分配方法及系统 | |
Hably et al. | Global stabilization of a four rotor helicopter with bounded inputs | |
CN111897219B (zh) | 基于在线逼近器的倾转四旋翼无人机过渡飞行模式最优鲁棒控制方法 | |
CN114488816B (zh) | 一种旋转翼-倾斜混合式无人机非线性模型预测控制方法 | |
Chen et al. | Adaptive attitude control for a coaxial tilt-rotor UAV via immersion and invariance methodology | |
CN116203840A (zh) | 可重复使用运载器自适应增益调度控制方法 | |
Latif et al. | Lateral parameter-varying modelling and control of a uav on-ground | |
CN112506046B (zh) | 一种针对翼尖铰接组合式飞行平台的增稳控制方法 | |
Panish et al. | A Generalized Full-Envelope Outer-Loop Feedback Linearization Control Strategy for Transition VTOL Aircraft | |
CN114063447B (zh) | 基于动力学分析的双倾转旋翼无人机模式过渡控制方法 | |
Xi et al. | Design of transition mode attitude controller for a tilt-rotor uav based on mpc method | |
Cheng et al. | A corridor-based flight mode transition strategy for agile ducted-fan tail-sitter UAV: Altitude-hold transition |
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 |