CN105652664A - 一种基于鸽群优化的四旋翼无人机显式预测控制方法 - Google Patents
一种基于鸽群优化的四旋翼无人机显式预测控制方法 Download PDFInfo
- Publication number
- CN105652664A CN105652664A CN201610113345.7A CN201610113345A CN105652664A CN 105652664 A CN105652664 A CN 105652664A CN 201610113345 A CN201610113345 A CN 201610113345A CN 105652664 A CN105652664 A CN 105652664A
- Authority
- CN
- China
- Prior art keywords
- centerdot
- phi
- psi
- theta
- omega
- 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
Links
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
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)
- Peptides Or Proteins (AREA)
- Feedback Control In General (AREA)
Abstract
一种基于启发式仿生鸽群优化的四旋翼无人机显式预测控制方法,包括如下步骤:1、根据空气动力学和运动学建立四旋翼无人机模型,并给定控制量和状态量之间的关系。2、初始化鸽群优化算法,给定线性化轨迹中要求取样点点的个数D。3、设计代价函数;4、利用地图罗盘因子进行寻优;5、利用鸽群优化地标算子进行寻优;6、得到鸽群优化过的样本目标点,构造线性插值函数;7、将鸽群优化后的插值函数应用于前面得到的模型形成:8、进行仿真或实验,得到相关结果并验证。通过该方法可以降低控制复杂难度,克服了显式预测控制对轨迹要求高,难以应用的问题,避免在线优化过程,节约了大量时间,降低了控制成本。
Description
【技术领域】
本发明是一种基于启发式仿生鸽群优化的四旋翼无人机显式预测控制方法,属于飞行器控制领域。
【背景技术】
无人机(UnmannedAerialVehicle,UAV)在当今军事行动中扮演越来越重要的角色,能够有效完成复杂和危险的侦查和作战任务。UAV虽然在军事和民用等领域已有广泛应用,但其自身的很多关键技术尚有待进一步研究和应用。而四旋翼作为一种更便宜可靠性更高,可以垂直起降的一种无人机,正被广泛的商业和军事运用,然而由于四旋翼的多维度性,由四个马达控制起飞悬停转向,因此其对控制率要求比较高。
模型预测控制可以实现对被控对象的精确控制,但有些模型预测控制依赖在线的优化过程,比较耗时。对于有些线性模型预测控制问题来说,可以求取其最优控制的显式解,但对于非线性问题,求取显式解比较困难。显示非线性模型预测控制(ExplicitNonlinearModelPredictiveControl,ENMPC)应用泰勒展开原理,可以求取非线性模型预测控制的显式解。其主要控制思想是要求轨迹——逆推预测控制量——输出轨迹。而本专利申请将通过简化轨迹来简化预测过程,从而大大降低复杂难度。但是其自身有一定的复杂度,而且对于复杂轨迹和散点轨迹并不能进行微分操作。所以我们可以通过插值方法求其估计的线性轨迹。
群体智能是仿生智能的一个重要分支,人们通过对自然界生物群体的观察,受到自然界中生物群体行为的启发,在此基础上总体提升,将其行为模式用数学的方式描述出来。在群体智能模型的基础上,人们提出了群体智能优化算法的概念,用生物群体的行为模式来求解优化问题。启发式仿生鸽群优化算法(PigeonInspiredOptimization,PIO)是HaibinDuan和PeixinQiao在2014年提出的一种新型的启发式群智能优化算法,该算法受到鸽子群体行为的启发,根据鸽子在寻找目标的过程中,先后依据磁场和地标作为指示的行为特点,建立起地图罗盘和地标两种算法机制。
鸽群在寻找目的地的过程中,会先参照太阳和磁场进行初步定位,然后依照地标进行精确定位,根据这一特性,鸽群优化算法提出了两种相对应的算子,分别为地图罗盘算子和地标机制,来模拟鸽群的这种特性,并将这两种算子结合起来解决优化问题。
传统的控制方式主要是通过将模型线性化来进行控制,而显式预测控制可以实现非线性模型的控制,但是复杂度较高,而本方法保持模型原样而将要求轨迹线性化来实现控制,大大降低控制预测模型控制难度,而又很好的保持了模型的方程。
(1)非线性显式预测控制
在非线性显式预测中,是通过将非线性部分泰勒展开,用***要求量来进行控制,其主要思想如下:
对于一个非线性模型:
其中,x代表状态量,y代表输出量,f(x,u),h(x)为两个函数。
设ρi代表经过微分在状态方程中出现第i个控制量的次数,用r代表输入的序号。对上式每个变量分别进行泰勒展开可以得到
τ是预测控制中的预测时间,是第i个估计量,t是当前时刻,ρi为第i个控制量出现在状态中需要泰勒展开的阶数,r为继续展开的相对阶数。为泰勒展开的系数矩阵,yi(t)为第i个控制量在t时刻的值,Yi(t)为由yi(t)及其各阶导数组成的矩阵。
将多个变量和在一个矩阵中,于是上式整理为:
其中为第i个量的泰勒展开系数。
将有控制量的和没有控制量的状态变量分离,重新整理矩阵,可以得到下式:
其中符号定义如下:
而其中在多次微分后出现控制量的部分,可以将其展开如下:
其中为对第i个没有输入控制量的ρi次微分,A(x)为控制量到状态量的函数,u为控制输入。i=1,2,...,n;
将上式对时间进行微分,可以得到如下:
其中p1(x,u)为非线性部分的输入。
用该方法反复进行微分如下,直到出现控制量:
同样的方法,可以对输出量ω(t)进行预测,并将含有控制量量和不含控制量的部分分离,为实际输出量构成的矩阵:
同理,也将控制量u进行泰勒展开,于是可以得到控制量u的预测值
为了使输出y尽可能地接近w,可以用如下方法估计误差,其中J为误差指标,Q为决定各个状态量误差权重的矩阵,为估计输出值,w为实际输出值:
理论上当达到最优时,条件为:
于是可以得到控制量的预测值
其中K又误差要求矩阵Q决定,Mρ,Mi由以下定义:
其中为估计输出量构成的矩阵。
(2)启发式仿生鸽群优化算法
第一步:通过地图罗盘算子寻优
给定鸽群数量Np,,最大迭代次数t1max,以及地图罗盘算子R,进化方法可以由如下给出:
其中xg为当前全局最优解,即为当前迭代中代价函数fitness最大或者最小的鸽群位置,vi(t)为第i个鸽子在第t次迭代时的速度,xi(t)为第i个鸽子在第t次迭代时的位置,rand为一个0到1之间的随机数。
用此种方法迭代,得到迭代t1imax步之后的鸽群的速度,以及局部和全局和局部最优解。
第二步:通过地标算子寻优
由于鸽子在寻找目的地的后期,主要依靠的是地标来进行目标的导引,为此根据其行为特性提出地标算子。所以将上部经过地图罗盘算子寻优的结果继续通过改方法迭代。该算子规定,每一代的鸽群数目减半,为了更快的到达目的地,剩下的鸽子直接飞向目的地。具体的更新准则如下式所示:
Xi(t)=Xi(t-1)+rand·(Xc(t)-Xi(t-1))(20)
在上式中,Np为鸽群的数目,fitness是鸽子位置信息的代价函数,为了求得代价函数的最小值,可以取fmin作为目标函数,Xc是鸽群的加权位置中心。通过该种方法,由于个群数量呈指数型下降而且每次选取最优的一部分,所以可以很快的找到最优值。
鸽群优化算法示意图如图3所示,下次迭代的速度由当前速度和目标速度矢量合成。
【发明内容】
1、发明目的:
本发明提出了一种基于启发式仿生鸽群优化的四旋翼无人机显式预测控制方法,其目的是提供一种具有较高可靠性四旋翼无人机控制方法。
该方法采用鸽群算法对轨迹进行插值,并应用于显式非线性模型预测控制,可以克服非线性模型预测控制对轨迹要求高,复杂轨迹难以应用的问题,避免了非线性模型预测控制中求多次导数的问题,节省了控制成本。
2、技术方案:
基于启发式仿生鸽群优化的四旋翼无人机显式预测控制方法的步骤如下:
步骤一:根据空气动力学和运动学建立四旋翼无人机模型,并给定控制量和状态量之间的关系。并给定要求的控制轨迹。对控制模型(四旋翼无人机)的状态量进行微分直至出现控制量的部分,并根据状态方程中出现控制量的那一阶微分反解控制量,得到相关逆推控制量的模块。把要求的轨迹的预测微分量和状态量作为反解控制量模块的输入,把反解出的控制量应用于原模型,建立显示预测控制模型。形成
预测微分量——反解控制量——控制量应用于原模型——结果的模型。
步骤二:始化鸽群优化算法,给定线性化轨迹中要求取样点点的个数D,点的个数即为鸽群优化算法中鸽子位置的维数。
定鸽群数量Np,,最大迭代次数t1max,以及地图罗盘算子R。
步骤三:设计代价函数
代价函数的确定是智能优化算法的核心,决定目标检测的准确性。本方法中,采用误差累计法,即要求轨迹和误差轨迹的多点之间函数值差值绝对值的求和。
步骤四:利用地图罗盘因子进行寻优
利用初始化的群***置和速度,根据初始的个体的代价函数值选取全局最优位置Xg。根据公式(17)中的公式更新每个个体的位置Xi,计算新生成鸽子的代价函数值,如果新鸽子的代价函数值比全局最优位置的代价函数值更低,则把新生成的鸽子位置定义为新的全局最优位置Xg。反复应用地图罗盘算子进行寻优,直到运行代数大于地图罗盘算子最大代数t1max时停止。
步骤五:利用鸽群优化地标算子进行寻优
利用地图罗盘算子寻优的结果作为地标算子的初始群体,根据公式(18)~(20)中的公式更新每个个体的速度Vi和位置Xi,计算新生成鸽子的代价函数值,如果新鸽子的代价函数值比全局最优位置的代价函数值更低,则把新生成的鸽子位置定义为新的全局最优位置Xg。根据公式(18)计算新种群的群体数量,根据公式(18)计算的结果舍弃群体中代价函数较小的一部分个体,选择当前群体中较优的群体作为保留群体进行下一轮寻优,反复应用地标算子进行寻优,直到运行代数大于地标算子最大代数t2max时停止。
步骤六:得到鸽群优化过的样本目标点,构造线性插值函数。
步骤七:将鸽群优化后的插值函数应用于前面得到的模型形成:
鸽群优化后的轨迹——预测轨迹——逆推控制量——输入到模型——结果
这样的结构模型
步骤八:进行仿真或实验,得到相关结果并验证
3、优点及效果:
本发明提出了一种基于启发式仿生鸽群优化的四旋翼无人机显式预测控制方法。通过启发式仿生鸽群优化算法将要求经行线性化可以降低控制复杂难度,克服了显式预测控制对轨迹要求高,复杂轨迹难以应用的问题,避免在线优化过程,节约了大量时间,降低了控制成本,可以很好的应用于四旋翼或多旋翼控制领域。
【附图说明】
图1为四旋翼无人机示意图。
图2为显式预测控制示意图。
图3为鸽群优化算法示意图。
图4为实验四旋翼显示与预测控制模拟示意图。
图5为鸽群优化拟合曲线。
图6为常规等距插值方法拟合曲线。
图7为误差收敛曲线。
图8为本发明流程图。
图9为最终实际输出轨迹与鸽群优化后轨迹对比。
图10为最终实际输出轨迹与最初要求轨迹对比。
图中标号及符号说明如下:
F—升力;φ,θ,Ψ—无人机角速度;M—显式预测控制中的反馈矩阵;
K—显式预测控制中比例系数,由误差要求决定;U—控制量;
-A(x)-1—通过要求量逆推控制量的矩阵;
【具体实施方式】
下面通过一个具体的无人机目标检测实例来验证本发明所提出的设计方法的有效性。本实验计算机配置为i7-4710MQ处理器,2.50Ghz主频,4G内存,软件为MATLAB2014a版本。
本实例的具体实现步骤如下:
步骤一:建立四旋翼无人机模型和控制量,给定要求轨迹,并建立显示预测控制模型。四旋翼无人机简化图如附图1,图中定义机体坐标系xyz与地面坐标系XYZ,欧拉角定义如附图2。
其中欧拉角定义如下:
偏航角Ψ:Ox在平面OXY中投影与X轴的夹角
俯仰角θ:Oz在平面OXZ中投影与Z轴的夹角
滚转角φ:Oy在平面OYZ中投影与Y轴的夹角
由此可以得到机体坐标系到地面坐标系的转移矩阵:
Rx,Ry,Rz分别为相对x,y,z的转动变换。
为简化模型,做如下假设:
1.四旋翼无人机是个均匀对称的刚体。
2.最初的机体坐标的原点在无人机中心。
3.空气阻力不随无人机高度变化。
因此可以根据牛顿第二定律建立如下方程:
其中F为无人机所受力,m为无人机质量,V为无人机速度,t为时间,M为无人机转动惯量,H为无人机所受动量矩。
可以进一步得到具体量的方程:
G为重力,g为重力加速度,Di为每个旋翼的阻力,Ti为每个旋翼的升力。Dd为空气阻力系数,Dt为空气升力系数。ωi为发动机转速。
将上述所有式子整理,可以得到位置的状态方程和角度的状态方程:
其中Ix,Iy,Iz为三个轴的转动惯量,x,y,z为坐标位置,为三个方向加速度,p,q,r为三个方向角速度,Fx,Fy,Fz为x,y,z方向的合外力,kt为升力系数,k1,k2,k3为阻力系数Mx,My,Mz可由下式可得:
为了便于控制,将控制量定义如下:
其中U1为高度通道控制量,U2为滚转通道控制量,U3为俯仰通道控制量,U4为偏航通道控制量。ωi代表马达转速,Fi为各个发动机的升力。
在低速条件下,可以忽略空气阻力,并假设:
于是可以得到无人机的非线性模型以及逆推方式如下:
本例中Ix=Iy=0.8kg.m2Iz=1kg.m2l=0.15mm=1kg.
将数据代入得到无人机模型以及反解方程:
由于控制量出现在二阶导数中,所以需要预测二阶导数来反解控制量,这样就可以按照显示预测控制方法建立显示预测模型,并在simulink中完成搭建。而由于的方法中由于优化后轨迹为线性轨迹,因此二阶导数输入为0。整体模型附图,图2为显式预测控制示意图,图4为整体实现图。本例中以只控制角度为例。
步骤二:初始化鸽群优化算法,给定线性化要求点的个数,点的个数即为鸽群优化算法中鸽子位置的维数。
(1)初始化优化参数维数D
本例中将会寻找八个最优点(非端点)经行线性插值,所以D为8。
(2)初始化种群数量Np
群智能优化算法的种群数量Np对优化效果影响很大,选择一个适当的种群数量,保证算法的准确性和快速性。本方法去Np为100。
(4)初始化种群位置和速度
在搜索空间没设定群体的位置上限Pmax=100和位置下限Pmin=0,给种群中的每个粒子都初始化一个初始的位置Xi和初始的速度Vi。本例中上限即为函数的区间上限,下限即为函数的区间下限。其中rand为0到1的一个随机数。
Vi(t)=rand
xi(t)=rand(100-0)(29)
(5)设置算法代数
鸽群优化算法有两个算子,分别是地图罗盘算子和地标算子,算法运算前需要分别设定两个算法运行的最大代数NC1=50和NC2=8。
步骤三:设计代价函数
代价函数的确定是智能优化算法的核心,决定目标检测的准确性。本方法中,采用误差累计法,即要求轨迹和误差轨迹的多点之间函数值差值绝对值的求和。
因为显式预测控制对模型函数要求比较高,因此考虑将轨迹线性化,在函数段上取D个点,分别在每段上将轨迹线性化。
即给定一个区间[a,b],将选择xi作为样本点,其中xi≠a,b。(i=1,2,3,..N)
将选择区间x∈[xi,xi+1]或x∈[a,x1]或x∈[xn,b],并定义估计值如下:
之后将平局取n个误差误差取样点,误差取样点之间距离d定义如下:
于是每个误差取样点可这样得到:XXi=a+id
于是可以得到累积误差:
本例中误差取样点数为100,所以n=100。
而累计误差E即为代价函数fitness。
步骤四:利用地图罗盘因子进行寻优
利用初始化的群***置和速度,根据初始的个体的代价函数值选取全局最优位置Xg。根据公式(17)中的公式更新每个个体的位置Xi,计算新生成鸽子的代价函数值,如果新鸽子的代价函数值比全局最优位置的代价函数值更低,则把新生成的鸽子位置定义为新的全局最优位置Xg。反复应用地图罗盘算子进行寻优,直到运行代数大于地图罗盘算子最大代数t1max时停止。
迭代公式如下:本例中R=0.2,带入如下
vi(t)=vi(t-1)·e-Rt+rand·(xg-xi(t-1))(30)
xi(t)=xi(t-1)+vi(t)
本例中R=0.2,带入如下
Vi(t)=Vi(t-1)·e-0.2*t+rand·(xg-xi(t-1))(31)
xi(t)=xi(t-1)+Vi(t)
步骤五:利用鸽群地标算子进行寻优
利用地图罗盘算子寻优的结果作为地标算子的初始群体,根据公式(18)~(20)中的公式更新每个个体的速度Vi和位置Xi,计算新生成鸽子的代价函数值,如果新鸽子的代价函数值比全局最优位置的代价函数值更低,则把新生成的鸽子位置定义为新的全局最优位置Xg。根据公式(18)计算新种群的群体数量,根据公式(18)计算的结果舍弃群体中代价函数较小的一部分个体,选择当前群体中较优的群体作为保留群体进行下一轮寻优,反复应用地标算子进行寻优,直到运行代数大于地标算子最大代数t2max时停止。
步骤六:得到D个最佳插值取样点,并根据这些点的函数值建立线性插值,这个插值即为应用于显式预测控制的轨迹。
步骤七:将鸽群优化过的线性轨迹用于显示预测控制,构造
鸽群优化优化结果——预测轨迹——逆推控制量——结果
的模型,如附图4.
步骤八:得到最终结果,进行验证,最终结果如附图10所示
通过附图5和附图6的对比,我们可以看出,与常用的等距插值相比,通过鸽群优化进行的非线性插值可以更好的复原原函数,而且具有更小的累积误差。而从附图7可看出鸽群优化具有良好的收敛特性,可以很快的求出最优值并使误差很小。
由附图10可知,通过该方法,我们最后的输出轨迹可以很好的跟踪原始复杂轨迹,而且本方法通过简化轨迹避免了轨迹起伏严重,并降低了控制成本。通过鸽群优化进行线性插值的方法也可以很好的应用于散点轨迹,从而实现对离散点轨迹要求的控制,可以用于避障,路径规划,避开雷达监测等方面的应用。
Claims (6)
1.一种基于鸽群优化的四旋翼无人机显式预测控制方法,其特征在于:该控制方法的步骤如下:
步骤一:根据空气动力学和运动学建立四旋翼无人机模型,并给定控制量和状态量之间的关系;并给定要求的控制轨迹;对四旋翼无人机的状态量进行微分直至出现控制量的部分,并根据状态方程中出现控制量的那一阶微分反解控制量,得到相关逆推控制量的模块;把要求的轨迹的预测微分量和状态量作为反解控制量模块的输入,把反解出的控制量应用于原模型,建立显示预测四旋翼无人机;形成预测微分量——反解控制量——控制量应用于原模型——结果的模型;
步骤二:初始化鸽群优化算法,给定线性化轨迹中要求取样点点的个数D,点的个数即为鸽群优化算法中鸽子位置的维数;给定鸽群数量Np,,最大迭代次数t1max,以及地图罗盘算子R;
步骤三:设计代价函数
代价函数的确定是智能优化算法的核心,决定目标检测的准确性;采用误差累计法,即要求轨迹和误差轨迹的多点之间函数值差值绝对值的求和;
步骤四:利用地图罗盘因子进行寻优
利用初始化的群***置和速度,根据初始的个体的代价函数值选取全局最优位置Xg;根据公式(1)中的公式更新每个个体的位置Xi,计算新生成鸽子的代价函数值,如果新鸽子的代价函数值比全局最优位置的代价函数值低,则把新生成的鸽子位置定义为新的全局最优位置Xg;反复应用地图罗盘算子进行寻优,直到运行代数大于地图罗盘算子最大代数t1max时停止;
其中xg为当前全局最优解,即为当前迭代中代价函数fitness最大或者最小的鸽群位置,vi(t)为第i个鸽子在第t次迭代时的速度,xi(t)为第i个鸽子在第t次迭代时的位置,rand为一个0到1之间的随机数;
步骤五:利用鸽群优化地标算子进行寻优
利用地图罗盘算子寻优的结果作为地标算子的初始群体,根据公式(2)~(4)中的公式更新每个个体的速度Vi和位置Xi,计算新生成鸽子的代价函数值,如果新鸽子的代价函数值比全局最优位置的代价函数值更低,则把新生成的鸽子位置定义为新的全局最优位置Xg;根据公式(2)计算新种群的群体数量,根据公式(2)计算的结果舍弃群体中代价函数小的一部分个体,选择当前群体中较优的群体作为保留群体进行下一轮寻优,反复应用地标算子进行寻优,直到运行代数大于地标算子最大代数t2max时停止;
Xi(t)=Xi(t-1)+rand·(Xc(t)-Xi(t-1))(4)
在上式中,Np为鸽群的数目,fitness是鸽子位置信息的代价函数,为了求得代价函数的最小值,取fmin作为目标函数,Xc是鸽群的加权位置中心;由于个群数量呈指数型下降而且每次选取最优的一部分,所以很快的找到最优值;
步骤六:得到鸽群优化过的样本目标点,构造线性插值函数;
步骤七:将鸽群优化后的插值函数应用于前面得到的模型形成:
鸽群优化后的轨迹——预测轨迹——逆推控制量——输入到模型——结果;
步骤八:进行仿真或实验,得到相关结果并验证。
2.根据权利要求1所述的一种基于鸽群优化的四旋翼无人机显式预测控制方法,其特征在于:在步骤一中,定义四旋翼无人机机体坐标系xyz与地面坐标系XYZ;欧拉角定义如下:
偏航角ψ:Ox在平面OXY中投影与X轴的夹角;
俯仰角θ:Oz在平面OXZ中投影与Z轴的夹角;
滚转角φ:Oy在平面OYZ中投影与Y轴的夹角;
得到机体坐标系到地面坐标系的转移矩阵:
Rx,Ry,Rz分别为相对x,y,z的转动变换。
3.根据权利要求1所述的一种基于鸽群优化的四旋翼无人机显式预测控制方法,其特征在于:简化模型,做如下假设:
1.四旋翼无人机是个均匀对称的刚体;
2.最初的机体坐标的原点在无人机中心;
3.空气阻力不随无人机高度变化;
因此根据牛顿第二定律建立如下方程:
其中,F为无人机所受力,m为无人机质量,V为无人机速度,t为时间,M为无人机转动惯量,H为无人机所受动量矩;
进一步得到具体量的方程:
G为重力,g为重力加速度,Di为每个旋翼的阻力,Ti为每个旋翼的升力;Dd为空气阻力系数,Dt为空气升力系数;ωi为发动机转速;
整理得到位置的状态方程和角度的状态方程:
其中Ix,Iy,Iz为三个轴的转动惯量,x,y,z为坐标位置,为三个方向加速度,p,q,r为三个方向角速度,Fx,Fy,Fz为x,y,z方向的合外力,kt为升力系数,k1,k2,k3为阻力系数Mx,My,Mz由下式得到:
为了便于控制,将控制量定义如下:
其中U1为高度通道控制量,U2为滚转通道控制量,U3为俯仰通道控制量,U4为偏航通道控制量;ωi代表马达转速,Fi为各个发动机的升力;
在低速条件下,忽略空气阻力,并假设:
于是得到无人机的非线性模型以及逆推方式如下:
Ix=Iy=0.8kg.m2Iz=1kg.m2l=0.15mm=1kg;
将数据代入得到无人机模型以及反解方程:
由于控制量出现在二阶导数中,所以需要预测二阶导数来反解控制量,这样就按照显示预测控制方法建立显示预测模型,并在simulink中完成搭建;由于优化后轨迹为线性轨迹,因此二阶导数输入为0。
4.根据权利要求1所述的一种基于鸽群优化的四旋翼无人机显式预测控制方法,其特征在于:在步骤二中,设置D为8;Np为100;设定种群的位置上限Pmax=100和位置下限Pmin=0,给种群中的每个粒子都初始化一个初始的位置Xi和初始的速度Vi;上限即为函数的区间上限,下限即为函数的区间下限;其中rand为0到1的一个随机数;
5.根据权利要求1所述的一种基于鸽群优化的四旋翼无人机显式预测控制方法,其特征在于:在步骤三中,将轨迹线性化,在函数段上取D个点,分别在每段上将轨迹线性化;
即给定一个区间[a,b],将选择xi作为样本点,其中xi≠a,b;i=1,2,3,..N;
将选择区间x∈[xi,xi+1]或x∈[a,x1]或x∈[xn,b],并定义估计值如下:
之后将平局取n个误差误差取样点,误差取样点之间距离d定义如下:
于是每个误差取样点这样得到:XXi=a+id
于是得到累积误差:
n=100;E为代价函数fitness。
6.据权利要求1所述的一种基于鸽群优化的四旋翼无人机显式预测控制方法,其特征在于:在步骤四中,R=0.2。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610113345.7A CN105652664B (zh) | 2016-02-29 | 2016-02-29 | 一种基于鸽群优化的四旋翼无人机显式预测控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610113345.7A CN105652664B (zh) | 2016-02-29 | 2016-02-29 | 一种基于鸽群优化的四旋翼无人机显式预测控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105652664A true CN105652664A (zh) | 2016-06-08 |
CN105652664B CN105652664B (zh) | 2018-05-11 |
Family
ID=56492693
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610113345.7A Active CN105652664B (zh) | 2016-02-29 | 2016-02-29 | 一种基于鸽群优化的四旋翼无人机显式预测控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105652664B (zh) |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106441308A (zh) * | 2016-11-10 | 2017-02-22 | 沈阳航空航天大学 | 一种基于自适应权重鸽群算法的无人机航路规划方法 |
CN106950833A (zh) * | 2017-03-28 | 2017-07-14 | 南京航空航天大学 | 基于改进pio算法的卫星姿态动态规划方法 |
CN108107911A (zh) * | 2017-12-28 | 2018-06-01 | 北京航空航天大学 | 一种太阳能飞机自主寻优航迹规划方法 |
CN110069075A (zh) * | 2019-04-19 | 2019-07-30 | 北京航空航天大学 | 一种仿鸽群应急避障机制的集群超机动避障方法 |
CN110109477A (zh) * | 2019-05-10 | 2019-08-09 | 北京航空航天大学 | 基于鸽群智能反向学习的无人机集群多目标控制优化方法 |
CN112327669A (zh) * | 2020-11-14 | 2021-02-05 | 大连理工大学 | 一种航空发动机显式预测控制器的设计方法 |
CN112953330A (zh) * | 2021-04-02 | 2021-06-11 | 浙江大学 | 一种基于显式模型预测的四旋翼多电机转速协同控制方法 |
CN116300478A (zh) * | 2023-05-22 | 2023-06-23 | 上海友道智途科技有限公司 | 基于变量分离微分动态规划的轨迹生成方法、介质及设备 |
CN117873299A (zh) * | 2024-01-02 | 2024-04-12 | 江苏锦花电子股份有限公司 | 一种基于大数据的设备供能数据监测方法及*** |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104850009A (zh) * | 2015-03-17 | 2015-08-19 | 北京航空航天大学 | 一种基于捕食逃逸鸽群优化的多无人飞行器编队协调控制方法 |
CN105022881A (zh) * | 2015-07-22 | 2015-11-04 | 北京航空航天大学 | 一种基于鸽群优化的舰载机自主着舰导引律设计方法 |
-
2016
- 2016-02-29 CN CN201610113345.7A patent/CN105652664B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104850009A (zh) * | 2015-03-17 | 2015-08-19 | 北京航空航天大学 | 一种基于捕食逃逸鸽群优化的多无人飞行器编队协调控制方法 |
CN105022881A (zh) * | 2015-07-22 | 2015-11-04 | 北京航空航天大学 | 一种基于鸽群优化的舰载机自主着舰导引律设计方法 |
Non-Patent Citations (3)
Title |
---|
HONGHAO LI等: "Bloch Quantum-behaved Pigeon-Inspired Optimization for Continuous Optimization Problems", 《PROCEEDINGS OF 2014 IEEE CHINESE GUIDANCE, NAVIGATION AND CONTROL CONFERENCE》 * |
RAN HAO等: "Multiple UAVs Mission Assignment Based on Modified Pigeon-Inspired Optimization Algorithm", 《PROCEEDINGS OF 2014 IEEE CHINESE GUIDANCE, NAVIGATION AND CONTROL CONFERENCE》 * |
XIAOMIN ZHANG等: "Pigeon-Inspired Optimization Approach to Multiple UAVs Formation Reconfiguration Controller Design", 《PROCEEDINGS OF 2014 IEEE CHINESE GUIDANCE, NAVIGATION AND CONTROL CONFERENCE》 * |
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106441308A (zh) * | 2016-11-10 | 2017-02-22 | 沈阳航空航天大学 | 一种基于自适应权重鸽群算法的无人机航路规划方法 |
CN106441308B (zh) * | 2016-11-10 | 2019-11-29 | 沈阳航空航天大学 | 一种基于自适应权重鸽群算法的无人机航路规划方法 |
CN106950833A (zh) * | 2017-03-28 | 2017-07-14 | 南京航空航天大学 | 基于改进pio算法的卫星姿态动态规划方法 |
CN106950833B (zh) * | 2017-03-28 | 2019-06-14 | 南京航空航天大学 | 基于改进pio算法的卫星姿态动态规划方法 |
CN108107911A (zh) * | 2017-12-28 | 2018-06-01 | 北京航空航天大学 | 一种太阳能飞机自主寻优航迹规划方法 |
CN110069075B (zh) * | 2019-04-19 | 2020-06-09 | 北京航空航天大学 | 一种仿鸽群应急避障机制的集群超机动避障方法 |
CN110069075A (zh) * | 2019-04-19 | 2019-07-30 | 北京航空航天大学 | 一种仿鸽群应急避障机制的集群超机动避障方法 |
CN110109477B (zh) * | 2019-05-10 | 2020-07-07 | 北京航空航天大学 | 基于鸽群智能反向学习的无人机集群多目标控制优化方法 |
CN110109477A (zh) * | 2019-05-10 | 2019-08-09 | 北京航空航天大学 | 基于鸽群智能反向学习的无人机集群多目标控制优化方法 |
CN112327669A (zh) * | 2020-11-14 | 2021-02-05 | 大连理工大学 | 一种航空发动机显式预测控制器的设计方法 |
CN112327669B (zh) * | 2020-11-14 | 2022-02-18 | 大连理工大学 | 一种航空发动机显式预测控制器的设计方法 |
CN112953330A (zh) * | 2021-04-02 | 2021-06-11 | 浙江大学 | 一种基于显式模型预测的四旋翼多电机转速协同控制方法 |
CN112953330B (zh) * | 2021-04-02 | 2022-04-05 | 浙江大学 | 一种基于显式模型预测的四旋翼多电机转速协同控制方法 |
CN116300478A (zh) * | 2023-05-22 | 2023-06-23 | 上海友道智途科技有限公司 | 基于变量分离微分动态规划的轨迹生成方法、介质及设备 |
CN116300478B (zh) * | 2023-05-22 | 2023-08-18 | 上海友道智途科技有限公司 | 基于变量分离微分动态规划的轨迹生成方法、介质及设备 |
CN117873299A (zh) * | 2024-01-02 | 2024-04-12 | 江苏锦花电子股份有限公司 | 一种基于大数据的设备供能数据监测方法及*** |
Also Published As
Publication number | Publication date |
---|---|
CN105652664B (zh) | 2018-05-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105652664A (zh) | 一种基于鸽群优化的四旋翼无人机显式预测控制方法 | |
Karimi et al. | Optimal maneuver-based motion planning over terrain and threats using a dynamic hybrid PSO algorithm | |
CN111538241B (zh) | 一种平流层飞艇水平轨迹智能控制方法 | |
CN105607473B (zh) | 小型无人直升机的姿态误差快速收敛自适应控制方法 | |
CN109614633A (zh) | 一种复合式旋翼飞行器非线性建模方法及配平方法 | |
CN107368085B (zh) | 基于模型预测的风场中平流层飞艇高度控制方法 | |
CN104932514B (zh) | 小型无人直升机的姿态非线性自适应控制方法 | |
Nie et al. | Three‐Dimensional Path‐Following Control of a Robotic Airship with Reinforcement Learning | |
CN103853157A (zh) | 一种基于自适应滑模的飞行器姿态控制方法 | |
CN103853050A (zh) | 一种四旋翼飞行器的pid优化控制方法 | |
CN114840020A (zh) | 一种基于改进鲸鱼算法的无人机飞行轨迹规划方法 | |
CN109145451A (zh) | 一种高速滑翔飞行器的运动行为识别与航迹估计方法 | |
CN111427379A (zh) | 观测驱动的多无人机协同standoff目标跟踪方法 | |
CN111813146A (zh) | 基于bp神经网络预测航程的再入预测-校正制导方法 | |
CN106091817B (zh) | 末制导段的标控脱靶量解析制导方法 | |
Yu et al. | Design and Implementation of a Hardware‐in‐the‐Loop Simulation System for a Tilt Trirotor UAV | |
CN116560384A (zh) | 一种基于深度强化学习的变体飞行器鲁棒控制方法 | |
CN115576341A (zh) | 基于函数微分和自适应变增益的无人机轨迹跟踪控制方法 | |
CN116225055A (zh) | 一种复杂环境下基于状态分解的无人机自主航迹规划算法 | |
CN105116905A (zh) | 一种飞行器姿态控制方法 | |
CN105843040A (zh) | 无人直升机动力学参数的辨识方法和装置 | |
Houghton et al. | Path planning: Differential dynamic programming and model predictive path integral control on VTOL aircraft | |
CN110654386B (zh) | 弯道下多智能电动汽车协作式巡航纵横向综合控制方法 | |
Zhou et al. | Nonlinear system identification and trajectory tracking control for a flybarless unmanned helicopter: theory and experiment | |
CN112161626B (zh) | 一种基于航路跟踪映射网络的高可飞性航路规划方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |