无人机访问多目标点的航迹规划方法及装置与流程

文档序号:11229779阅读:735来源:国知局
无人机访问多目标点的航迹规划方法及装置与流程
本发明实施例涉及无人机
技术领域
,具体涉及一种无人机访问多目标点的航迹规划方法及装置。
背景技术
:当前,无人机uav(unmannedaerialvehicle)在军民领域有着广泛的应用,可完成目标侦察、目标跟踪、情报收集、震后救援和地质勘探等多种类型任务。例如在多架uav协同侦察目标时,既要最合理地为每架uav分配其所需侦察的目标,还要为其规划最优的飞行航迹。该问题是一个受多因素约束的任务分配与航迹规划联合优化问题,也是非确定性问题。随着uav研究的深入,环境因素被逐渐纳入问题的研究,特别是uav任务分配、航迹规划和飞行控制等问题中,在环境因素的影响下如何降低耗能、控制uav的飞行状态从而使uav消耗最少的燃料执行最多的任务、具备更好的任务执行状态和更高的安全性是当前uav研究的主要工作。当前常用于解决uav任务分配与任务规划问题的模型有:tsp模型,top模型和vrp模型,其中,tsp模型是在只有单一旅行者的条件下,使得旅行者通过所有给定的目标点之后,从而使其路径成本最小的模型;top模型是在存在多个成员的条件下,使得每个成员尽可能访问更多的目标点,从而使得所有成员的总收益最大的模型;vrp模型是在车辆数量固定的条件下,使得车辆访问一定数量目标点,且在此过程中每个目标点只能被访问一次,最终使得uav航行的总距离或总时间最短的模型。在实现本发明实施例的过程中,发明人发现现有的技术方案在实际操作中,一般是假设模型中在恒定时间内无人机的速度是恒定的。然而这个假设显然是不现实的,导致模型无法精确模拟出无人机的实际运动状态,进而无法进行最优的航迹规划。技术实现要素:本发明实施例的一个目的是解决现有技术由于在进行航迹规划是设定无人机的速度是恒定的,导致模型无法精确模拟出无人机的实际运动状态,进而无法给出的最优的航迹规划。本发明实施例提出了一种无人机访问多目标点的航迹规划方法,包括:s1、获取无人机和多个目标点的位置信息,无人机地速航向角离散度以及所述无人机和风场的运动参数;s2、根据所述无人机和所述多个目标点的位置信息,无人机地速航向角离散度和预设遗传算法,构建以dubins飞行路径为个体的初始种群;s3、根据所述初始种群和风场参数确定无人机飞行状态和无人机完成dubins飞行路径的航迹段的航行时间,根据所述航迹段的航行时间和suav-vs-dvrp模型获取初始种群中染色体对应的航行时间;s4、基于遗传算法,对初始种群中染色体进行交叉、变异处理,并在达到预定迭代次数后,选取航行时间最短的染色体对应的dubins飞行路径作为所述无人机的最优飞行路径。可选的,根据所述无人机和所述多个目标点的位置信息,结合无人机地速航向角离散度和预设遗传算法,构建初始种群包括:根据预设遗传算法的编码方式进行染色体编码生成预定规模的初始种群;所述染色体由目标点信息和无人机地速航向角信息组成;其中所述目标点属于集合t0表示uavs的起点,无人机地速航向角属于集合ng表示无人机地速航向角离散度;所述染色体第一行为所述目标点的随机全排列,第二行为根据无人机航向角离散度为每个目标点随机选取对应的地速航向角。可选的,所述初始种群和风场参数确定无人机飞行状态和无人机完成dubins飞行路径的航迹段的航行时间,根据所述航迹段的航行时间和suav-vs-dvrp模型获取初始种群中染色体对应的航行时间包括:对每个染色体对应的dubins飞行路径进行航向角变化的分析,并根据分析结果将所述dubins飞行路径分为多个航迹段;根据每个航迹段对应的起始点的坐标和航向角以及终止点的坐标和航向角,结合风场参数确定无人机飞行状态,进而获取所述无人机完成所述航迹段的航行时间;根据每个航迹段对应的航行时间获取所述染色体对应的航行时间。可选的,所述根据每个航迹段对应的起始点的坐标和航向角以及终止点的坐标和航向角,结合风场参数确定无人机飞行状态,进而获取所述无人机完成所述航迹段的航行时间包括:采用以下公式计算获取无人机以地速航向角βgj由目标点tj出发并以地速航向角βgk飞至目标点tk航迹段的航行时间:其中,tj为起始点,βgj为无人机在起始点的航向角,tk为终止点,βgk为无人机在终止点的航向角,t表示目标点的集合,rmin为无人机最小转弯半径,vg为无人机的地速;采用以下公式计算获取无人机的地速:其中,va表示空速大小,βa表示空速航向角,vg表示地速的大小,βg表示地速航向角,vw表示风速大小,βw表示风向。可选的,根据所述航迹段的航行时间和suav-vs-dvrp模型获取初始种群中染色体对应的航行时间包括:根据suav-vs-dvrp模型获取航行时间:其约束条件为:其中,βgj、βgk分别表示uav在tj、tk两目标点的航向角;表示无人机以地速航向角βgj由目标点tj出发并以地速航向角βgk飞至目标点tk的航行时间;是一个二元决策变量,若uavs以地速航向角βgj由目标点tj出发并以地速航向角βgk飞至目标点tk时,否则nt表示目标点的数量,ng表示无人机地速航向角离散度。可选的,基于遗传算法,对初始种群中染色体进行交叉、变异处理,并在达到预定迭代次数后,选取航行时间最短的染色体对应的dubins飞行路径作为所述无人机的最优飞行路径,包括:步骤1、使用所述编码方法生成初始解,并生成预定规模的初始种群并根据种群中每个染色体对应的航行时间计算其适应度;步骤2、使用轮盘赌方法选择父代种群中的两个个体(a,b)进行交叉,交叉规则为先随机选择个体a中交叉位置,然后查找个体b中与个体a交叉位置第一行相同的基因,将染色体a和b中交叉位置基因进行替换得到新的染色体c和d,判断染色体c和d是否满足suav-vs-dvrp模型的约束条件,若满足则利用染色体c和d替换种群中染色体a和b,否则结束,然后不断迭代更新步骤1种群,得到新的子代种群;步骤3、使用轮盘赌方法选择步骤2种群中一条染色体进行变异,对所述染色体进行变异的方式为下述变异方式中的至少一种,包括:对染色体第一行进行目标点变异;对染色体第二行进行无人机地速航向角变异;整个染色体变异的步骤包括:首先,若染色体的第一行顺序变异,则随机选取当前染色体的两个基因位并交换对应基因位的目标点编码;再选择第二行是否变异及变异位置,若变异则随机生成变异的有异于当前位置无人机地速航向角编码的值替换原值;判断变异后的染色体是否满足suav-vs-dvrp模型的约束条件,若满足则替换种群中染色体,否则结束替换并不断迭代更新步骤2种群,得到新的子代种群;步骤4、计算子代种群适应度并选取本次迭代中所有解中的最优解;步骤5、判断当前的迭代次数是否达到预设值,若判断否,则对步骤3中的子代种群和父代种群按照一定比例组合形成新的父代种群返回步骤2;若判断为是,则结束迭代,将最终获得的最优解作为无人机的任务分配与航迹规划结果。本发明实施例提出了一种无人机访问多目标点的航迹规划装置,包括:获取模块,用于获取无人机和多个目标点的位置信息,无人机地速航向角离散度以及所述无人机和风场的运动参数;第一处理模块,用于根据所述无人机和所述多个目标点的位置信息,无人机地速航向角离散度和预设遗传算法,构建以dubins飞行路径为个体的初始种群;第二处理模块,用于根据所述初始种群和风场参数确定无人机飞行状态和无人机完成dubins飞行路径的航迹段的航行时间,根据所述航迹段的航行时间和suav-vs-dvrp模型获取初始种群中染色体对应的航行时间;第三处理模块,用于基于遗传算法,对初始种群中染色体进行交叉、变异处理,并在达到预定迭代次数后,选取航行时间最短的染色体对应的dubins飞行路径作为所述无人机的最优飞行路径。可选的,所述第一处理模块,用于结合无人机地速航向角离散度和预设遗传算法,构建初始种群,其步骤为:根据预设遗传算法的编码方式进行染色体编码;所述染色体由目标点信息和无人机地速航向角信息组成;其中所述目标点属于集合t0表示uavs的起点,无人机地速航向角属于集合ng表示无人机地速航向角离散度;所述染色体第一行为所述目标点的随机全排列,第二行为根据无人机航向角离散度为每个目标点随机选取对应的地速航向角。可选的,所述第二处理模块,用于对每个染色体对应的dubins飞行路径进行航向角变化的分析,并根据分析结果将所述dubins飞行路径分为多个航迹段;执行第一步骤和第二步骤;所述第一步骤包括:采用以下公式计算获取无人机以地速航向角βgj由目标点tj出发并以地速航向角βgk飞至目标点tk航迹段的航行时间:其中,tj为起始点,βgj为无人机在起始点的航向角,tk为终止点,βgk为无人机在终止点的航向角,t表示目标点的集合,rmin为无人机最小转弯半径,vg为无人机的地速。采用以下公式计算获取无人机的地速:其中,va表示空速大小,βa表示空速航向角,vg表示地速的大小,βg表示地速航向角,vw表示风速大小,βw表示风向。所述第二步骤包括:根据suav-vs-dvrp模型获取航行时间:其约束条件为:其中,βgj、βgk分别表示uav在tj、tk两目标点的航向角;表示无人机以地速航向角βgj由目标点tj出发并以地速航向角βgk飞至目标点tk的航行时间;是一个二元决策变量,若uavs以地速航向角βgj由目标点tj出发并以地速航向角βgk飞至目标点tk时,否则nt表示目标点的数量,ng表示无人机地速航向角离散度。可选的,所述第三处理模块,用于执行以下步骤:步骤1、使用所述编码方法生成初始解,并生成预定规模的初始种群并根据种群中每个染色体对应的航行时间计算其适应度;步骤2、使用轮盘赌方法选择父代种群中的两个个体(a,b)进行交叉,交叉规则为先随机选择个体a中交叉位置,然后查找个体b中与个体a交叉位置第一行相同的基因,将染色体a和b中交叉位置基因进行替换得到新的染色体c和d,判断染色体c和d是否满足suav-vs-dvrp模型的约束条件,若满足则利用染色体c和d替换种群中染色体a和b,否则结束,然后不断迭代更新步骤1种群,得到新的子代种群;步骤3、使用轮盘赌方法选择步骤2种群中一条染色体进行变异,对所述染色体进行变异的方式为下述变异方式中的至少一种,包括:对染色体第一行进行目标点变异;对染色体第二行进行无人机地速航向角变异;整个染色体变异的步骤包括:首先,若染色体的第一行顺序变异,则随机选取当前染色体的两个基因位并交换对应基因位的目标点编码;再选择第二行是否变异及变异位置,若变异则随机生成变异的有异于当前位置无人机地速航向角编码的值替换原值;判断变异后的染色体是否满足suav-vs-dvrp模型的约束条件,若满足则替换种群中染色体,否则结束替换并不断迭代更新步骤2种群,得到新的子代种群;步骤4、计算子代种群适应度并选取本次迭代中所有解中的最优解;步骤5、判断当前的迭代次数是否达到预设值,若判断否,则对步骤3中的子代种群和父代种群按照一定比例组合形成新的父代种群返回步骤2;若判断为是,则结束迭代,将最终获得的最优解作为无人机的任务分配与航迹规划结果。由上述技术方案可知,本发明实施例提出的一种无人机访问多目标点的航迹规划方法及装置首先通过对风场和无人机的运动参数进行分析,获取无人机在风场中的实际飞行状态,然后基于实际飞行状态进行飞行路径的规划,与现有技术中设定无人机速度恒定的方案相比,能根据不确定环境中风场的状态精确计算无人机在所有可能飞行路径上的航行时间,进而选择出最优的飞行路径。附图说明通过参考附图会更加清楚的理解本发明的特征和优点,附图是示意性的而不应理解为对本发明进行任何限制,在附图中:图1示出了本发明一实施例提供的一种风影响下无人机访问多目标点的航迹规划方法的流程示意图;图2示出了本发明一实施例提供的计算dubins飞行路径的航行时间的流程示意图;图3示出了本发明一实施例提供的遗传算法的流程示意图;图4a-图4c示出了本发明一实施例提供遗传算法中的算子的示意图;图5示出了本发明一实施例提供的风向示意图;图6示出了本发明一实施例提供的速度矢量关系示意图;图7示出了本发明一实施例提供的uav由a飞往c点受风场影响的分析示意图;图8示出了本发明一实施例提供的对飞行路径进行分段的示意图;图9a-图9d示出了本发明一实施例提供的uav在西风、南风东风、北风影响下的最短飞行路径的示意图;图10示出了本发明一实施例提供的一种风影响下无人机访问多目标点的航迹规划的结构示意图。具体实施方式为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明的一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动的前提下所获得的所有其他实施例,都属于本发明保护的范围。图1示出了本发明一实施例提供的一种无人机访问多目标点的航迹规划的流程示意图,参见图1,该方法可由处理器实现,具体包括如下步骤:110、获取无人机和多个目标点的位置信息,无人机地速航向角离散度以及所述无人机和风场的运动参数;需要说明的是,在进行任务分配和航迹规划之前,技术人员可设定或者根据实际情况测出无人机和多个目标点的位置信息,然后将其输入至处理器中;而地速航向角离散度可根据实际需要进行配置。另外,无人机的运动参数可以是技术人员根据实际飞行需要设定的,风场的运动参数可以是技术人员测量得出或者是根据实际情况设定的。120、据所述无人机和所述多个目标点的位置信息,无人机地速航向角离散度和预设遗传算法,构建以dubins飞行路径为个体的初始种群;不难理解的是,无人机在风场中飞行时,必然会受到风场的影响,影响因素举例为:风场的风向和风速,因此,为了得到精确的无人机的实际飞行状态,本实施例基于无人机自身的运动参数和风场的运动参数计算获取无人机的实际飞行状态,以为后续的航迹规划提供精确的数据基础。详细地,所述无人机的运动参数包括:空速;所述风场的运动参数包括:风速;进而根据所述无人机的空速和所述风场的风速获取所述无人机的地速。另外,不难理解的是,在没有约束条件下,两点之间的飞行路径可能存在无限多个情况,因此,本发明实施例为了降低计算量,在尽可能不影响航迹规划的前提下,通过预先设置约束条件的方式,例如:约束无人机飞行的航向角、飞行的高度等等;然后结合预设遗传算法构建染色体数量有限的初始种群,其中,每个染色体对应一条dubins飞行路径。不难理解的是,构建飞行路径的方式有多种,此处使用的是dubinscarmodel(dubins车模型)。130、根据所述初始种群和风场参数确定无人机飞行状态和无人机完成dubins飞行路径的航迹段的航行时间,根据所述航迹段的航行时间和suav-vs-dvrp模型获取初始种群中染色体对应的航行时间;140、基于遗传算法,对初始种群中染色体进行交叉、变异处理,并在达到预定迭代次数后,选取航行时间最短的染色体对应的dubins飞行路径作为所述无人机的最优飞行路径。不难理解的是,每次交叉、变异的迭代可能都有新的个体的出现,然后基于步骤130对新的染色体进行的航行时间的计算,因此,每个dubins飞行路径对应一个航行时间。可见,本实施例首先通过对风场和无人机的运动参数进行分析,获取无人机在风场中的实际飞行状态,然后基于实际飞行状态进行飞行路径的规划,与现有技术相比,本实施例将无人机航迹规划问题与无人机实际飞行环境相结合,使规划得到的最优飞行路径方案优于无人机速度恒定的方案,进而达到能精确计算无人机在所有可能飞行路径上的航行时间,进而选择出最优的飞行路径。下面对本发明实施例中的各步骤进行详细说明:首先,对步骤120进行详细说明:结合无人机地速航向角离散度和预设遗传算法,构建初始种群,其步骤为:根据预设遗传算法的编码方式进行染色体编码;所述染色体由目标点信息和无人机地速航向角信息组成;其中所述目标点属于集合t0表示uavs的起点,无人机地速航向角属于集合ng表示无人机地速航向角离散度;需要说明的是,无人机的航向角为360°,而为了减少处理器需要处理的数据量,提高航迹规划的效率,此处的航向角离散度可以为无人机到达个目标点的航向角必须为10的倍数,例如:10度、20度...360度等。所述染色体第一行为所述目标点的随机全排列,第二行为根据无人机航向角离散度为每个目标点随机选取对应的地速航向角。然后,参见图2,下面对步骤130进行详细说明:210、对每个染色体对应的dubins飞行路径进行航向角变化的分析,并根据分析结果将所述dubins飞行路径分为多个航迹段;220、根据每个航迹段对应的起始点的坐标和航向角以及终止点的坐标和航向角,结合风场参数确定无人机飞行状态,进而获取所述无人机完成所述航迹段的航行时间;230、根据每个航迹段对应的航行时间获取所述染色体对应的航行时间。需要说明的是,在构建完成所有的dubins飞行路径后,处理器根据角度变化将dubins飞行路径分为若干段,然后根据每一段飞行路径两端的起始点和终止点的坐标以及无人机到达起始点和终止点的航向角,结合预建立的计算模型,计算获取每一段飞行路径的航行时间,进而获取这一dubins飞行路径的航行时间,同理,可计算获取各dubins飞行路径的航行时间。其中,步骤220包括:采用以下公式计算获取无人机以地速航向角βgj由目标点tj出发并以地速航向角βgk飞至目标点tk航迹段的航行时间:其中,tj为起始点,βgj为无人机在起始点的航向角,tk为终止点,βgk为无人机在终止点的航向角,t表示目标点的集合,rmin为无人机最小转弯半径,vg为无人机的地速。采用以下公式计算获取无人机的地速:其中,va表示空速大小,βa表示空速航向角,vg表示地速的大小,βg表示地速航向角,vw表示风速大小,βw表示风向。其中,步骤230包括:根据suav-vs-dvrp模型获取航行时间:其约束条件为:其中,βgj、βgk分别表示uav在tj、tk两目标点的航向角;表示无人机以地速航向角βgj由目标点tj出发并以地速航向角βgk飞至目标点tk的航行时间;是一个二元决策变量,若uavs以地速航向角βgj由目标点tj出发并以地速航向角βgk飞至目标点tk时,否则nt表示目标点的数量,ng表示无人机地速航向角离散度。下面对步骤140进行详细说明:步骤1、使用所述编码方法生成初始解,并生成预定规模的初始种群并根据种群中每个染色体对应的航行时间计算其适应度;步骤2、使用轮盘赌方法选择父代种群中的两个个体(a,b)进行交叉,交叉规则为先随机选择个体a中交叉位置,然后查找个体b中与个体a交叉位置第一行相同的基因,将染色体a和b中交叉位置基因进行替换得到新的染色体c和d,判断染色体c和d是否满足suav-vs-dvrp模型的约束条件,若满足则利用染色体c和d替换种群中染色体a和b,否则结束,然后不断迭代更新步骤1种群,得到新的子代种群;步骤3、使用轮盘赌方法选择步骤2种群中一条染色体进行变异,对所述染色体进行变异的方式为下述变异方式中的至少一种,包括:对染色体第一行进行目标点变异;对染色体第二行进行无人机地速航向角变异;整个染色体变异的步骤包括:首先,若染色体的第一行顺序变异,则随机选取当前染色体的两个基因位并交换对应基因位的目标点编码;再选择第二行是否变异及变异位置,若变异则随机生成变异的有异于当前位置无人机地速航向角编码的值替换原值;判断变异后的染色体是否满足suav-vs-dvrp模型的约束条件,若满足则替换种群中染色体,否则结束替换并不断迭代更新步骤2种群,得到新的子代种群;步骤4、计算子代种群适应度并选取本次迭代中所有解中的最优解;步骤5、判断当前的迭代次数是否达到预设值,若判断否,则对步骤3中的子代种群和父代种群按照一定比例组合形成新的父代种群返回步骤2;若判断为是,则结束迭代,将最终获得的最优解作为无人机的任务分配与航迹规划结果。下面参见图3对本发明的采用的遗传算法的原理进行详细说明:1、开启;2、基于技术人员的设定,生成包括指定数量染色体的种群,指定数量可具体为100个;其中,每个染色体与图1对应实施例中的步骤130中的dubins飞行路径一一对应。需要说明的是,染色体编码代表了问题的一种可行的解决方案。在suav-dvs-vrp问题中一个可行的解决方案是由uav访问目标点的顺序和访问目标点的uav航向角两部分组成。同样的,染色体的编码也由两部分组成,分别为:目标点编号和航向角编号。其中,目标点编号属于集合航向角编号属于集合如图4a所示,染色体a表示在稳定风场下uav访问三个目标点的一种可行方案,即一号uav从起始点s(0,0)出发,访问目标点3后返回,二号uav从起始点s(0,0)出发,访问目标点1后,再访问目标点2,最终返回。编码中第二行代表uav访问对应目标点时的航向角编码,即i,可根据其编码解码得到对应的航向角βg。3、计算每个染色体的适应度;需要说明的是,采用图1对应实施例中的步骤140的计算方法,计算无人机完成每个dubins飞行路径的航行时间,并基于航行时间计算染色体的适应度,例如:航行时间与适应度成反比关系。不难理解的是,按照上述步骤2中的编码方式生成规定数量的种群后进行适应度的计算,本文发明中适应度的计算以目标函数为依据,其计算过程如下:4、选择操作根据j’通过轮盘赌的方法进行选择操作。5、交叉操作通过对父代染色体进行交叉,可以继承父代中比较优良的基因,获得更优的子代。针对suav-dvs-vrp问题本文针对当前的编码方式采用单点映射的方法,即随机产生父代染色体a交叉的基因位,在父代染色体b中找到同一目标点对应的基因位,交叉产生子染色体a、b。参见图4b,有父代parenta和parentb,在parenta上随机产生进行交叉的基因位为3,找到parentb上对应相同目标点的基因位,经过交叉后产生子染色体offspringa和offspringb。6、变异操作变异是为了防止遗传算法陷入局部最优。针对求解suav-dvs-vrp模型的遗传算法,染色体变异存在两种情况:目标点编码变异和航向角编码变异。根据变异概率,染色体中可发生多次变异也可不发生变异。其中,目标点编码变异采用双基因位变异,即在染色体的第一行随机产生两个进行变异的基因位,并将两个基因位上的值互换,该方法满足了模型中每个目标点只被访问一次的约束,保证了子染色体的可行性,航向角编码采用均匀变异。如图4c所示,有父代parenta,在parenta上分别进行目标点变异和航向角变异,在进行变异前首先判断两种变异是否发生,在判断得到目标点变异发生时,随机选取进行编译的基因位,本例中选取的基因位是1和3,随后将被选取的基因位上的目标值进行交换,得到新的目标点访问顺序;在判断得到航向角变异发生时,随机选取进行编译的基因位,本例中选取的基因位是2,随机生成与当前航向角不同的航向角替换当前值,得到新的无人机访问对应目标点的航向角状态。7、更新操作8、选取最优分配方案9、判断是否终止10、获得最优分配方案11、结束需要说明的是,上述步骤与图1对应实施例中的部分步骤相对应,故,相似之处此处不再赘述,具体请查看图1对应的实施例中的相关内容。下面结合上述的遗传算法对本发明的设计原理进行详细说明:步骤一,为避免问题过于复杂,本发明采用区域固定风场进行风场建模,即在规定区域内,其风场的风速和风向是不变的。已知区域的风场状态可表示为:其中,vw表示风场中的风速,βw表示风向。风速vw是指风相对于地面单位时间内移动的距离,单位为m/s;风向βw是指风吹来的方向,风向的测量单位一般用方位来表示,如陆地上,一般用16个方位表示,海上多用36个方位表示,而在高空则用角度表示,即把圆周分成360度,本文规定西风(w)是0度(即360度),南风(s)是90度,东风(e)是180度,北风(n)是270度,如图5所示。步骤二,配置uav以u表示uav,固定翼uav在空中的配置定义为:q=(x,y,ψ)(4)其中,其中,和表示的是一架uav在笛卡尔惯性参考系中的坐标;vg表示uav的地速;是指uav的角速度;|c|≤1,表示uav的转角指令;ωmax是uav的最大旋转角速度。需要注意的是,其中,rmin表示uav最小转弯半径,vg为固定翼uav的地速,因而在风影响下的多uav任务分配与航迹规划联合优化问题中,uav的最大旋转角速度需满足以下条件:其中,rmin的值固定不变。为使问题简化,本文提出以下关于uav在执行任务过程中需满足的运动约束的假设:(1)uav最小转弯半径不变为rmin;(2)uav在固定的高度飞行;(3)根据uav的飞行包线,uav在指定高度固定载荷下的飞行速度存在上下界[21],即va_min和va_max分别表示在某高度下uav空速的最小值和最大值;(4)uav由出发点出发并在执行完成任务后不返回出发点。步骤三,计算uav的实际飞行状态考虑风影响的uav实际速度定义为uav的地速大小为vg,此时uav的航向角为βg,uav地速矢量将不考虑风影响的uav理论速度定义为uav的空速大小为va,此时uav的航向角为βa,uav空速矢量uav空速地速与风场中风速的矢量关系如图6所示。上述速度与角度关系为:在无风时,即uav空速与地速相等。可通过对uav航向角的离散化降低问题的复杂性,即uav航向角可表示为其中nψ表示航向角的离散度。由于uav以其地速为依据进行航迹规划,因而本文提出改变uav空速航向角βa使uav地速航向角βg满足上述航向角集合的要求,即在nψ=36时,可将实验误差控制在可接受的范围内。下面结合图7进行实例说明:uav由a(50,300)飞往c(150,350),该uav所处的环境是风速为5m/s、风向为南风(vw=5m/s,βw=90°),uav在位置点x(85,324)时,根据式(9)和(11)可得到其空速和地速如表4-1所示。表4-1固定翼uav在x(85,324)点,无风与南风环境下空速、地速对比表步骤四,目标点配置nt个目标点的集合可表示为:其中,集合中所有的目标点的位置和任务量均已知。在本发明中,每一个目标点上都可能有不同类型的任务需要被uav执行,且在此过程中每架uav只能执行一个目标点上的一个任务,即每个目标点都要被不同的uav访问,每架uav只能访问某个目标点一次。步骤五,计算航行时间在以飞行时间作为目标函数的uav任务分配与航迹规划问题中,uav的任务分配方案决定uav访问目标点的顺序,根据uav目标点访问顺序进行航迹规划,由航迹规划的结果计算uav飞行时间进而由uav飞行时间决定当前uav任务分配与航迹规划方案是否优于已知方案。考虑到uav地速为变量的情况,本发明采用积分的方式计算uav的飞行时间。以表示以航向角βψj由tj出发并以航向角βψk飞至tk的时间,其计算公式为:上式中表示,将uav由tj到tk的路径根据角度变化分为若干段,如图8所示,并将每一段起点的地速vg作为本段的飞行速度,从而得到uav在两点间的航行时间根据固定翼uav的空间配置可将其定义为dubinscarmodel。根据dubins路径的产生原理,两点间最短dubins路径可以由弧段路径和直线段路径组合生成,存在以下六种情况:d={lsl,rsr,rsl,lsr,rlr,lrl}其中,l表示uav以半径rmin向左转弯的一段弧,r表示uav向以半径rmin右转弯的一段弧,s表示uav以直线方式飞行。从而,可根据公式(14)计算uav在任意目标点间dubins路径的航行时间。其中,表示uavui在tj、tk两点航向角分别为βψj、βψk的航行时间,由(13)计算得到,其约束符合(8);是一个二元决策变量,即当uavu经tj飞行至tk时,则的值为1,否则的值为0;j中j、k值取0表示uav由起始点出发或路径末端指向起始点。在求解过程中,还需满足预设的约束条件,具体包括:上述条件保证所有的目标点都能被访问到且只能被访问一次。上述条件保证有一条无人机航向由起始点出发,并有一条无人机航线回到终止点。上述条件在其它约束条件的基础上保证uav的航行轨迹是一条有序的路线,并最终回到起始点。可见,基于上式可得到每个飞行路径的航行时间,进而从中选取出航行时间最短的飞行路径。下面对本发明进行具体实例的详细说明:首先,所有的仿真实验均是在4g内存、3.4ghzcpu的硬件上、在matlabr2014a的环境中运行的。具体说明如下:uav模型基于小型固定翼uav的数学模型,其空速为10米/秒,最小转弯半径为200米,航向角离散度为36,固定翼uav均从出发点s(0,0)处以航向角90°起飞,在完成访问任务后以航向角90°返回点s(0,0);风场环境是固定风场,即在一次实验过程中风速和风向都是不变的,并且为了保证uav能够安全飞行,风速大小不超过9米/秒,风向取西、南、东和北,即0°、90°、180°和270°四个方向,uav需要访问的三个目标点坐标分别为:a(50,300)、b(100,150)和c(150,350)。根据上述本发明提出的模型和算法,本文分别在风、南风、东风和北风的风场环境和试验场景下进行实验,并得到各风场环境下无人机飞行时间最短的任务分配与航迹规划方案如表3-1所示(依次参见图9a-图9d)。3-1风场环境无人机任务分配与航迹规划方案飞行时间西风环境b(50°)→c(110°)→a(120°)143.7南风环境c(20°)→a(270°)→b(310°)154.4东风环境b(30°)→a(310°)→c(270°)141.9北风环境a(40°)→c(20°)→b(110°)118.4对于方法实施方式,为了简单描述,故将其都表述为一系列的动作组合,但是本领域技术人员应该知悉,本发明实施方式并不受所描述的动作顺序的限制,因为依据本发明实施方式,某些步骤可以采用其他顺序或者同时进行。其次,本领域技术人员也应该知悉,说明书中所描述的实施方式均属于优选实施方式,所涉及的动作并不一定是本发明实施方式所必须的。图10示出了本发明一实施例提供的一种无人机访问多目标点的航迹规划装置的结构示意图,参见图10,该装置包括:获取模块101、第一处理模块102、第二处理模块103以及第三处理模块104,其中:获取模块101,用于获取无人机和多个目标点的位置信息,无人机地速航向角离散度以及所述无人机和风场的运动参数;第一处理模块102,用于根据所述无人机和所述多个目标点的位置信息,无人机地速航向角离散度和预设遗传算法,构建以dubins飞行路径为个体的初始种群;第二处理模块103,用于根据所述初始种群和风场参数确定无人机飞行状态和无人机完成dubins飞行路径的航迹段的航行时间,根据所述航迹段的航行时间和suav-vs-dvrp模型获取初始种群中染色体对应的航行时间;第三处理模块104,用于基于遗传算法,对初始种群中染色体进行交叉、变异处理,并在达到预定迭代次数后,选取航行时间最短的染色体对应的dubins飞行路径作为所述无人机的最优飞行路径。可见,本实施例首先通过对风场和无人机的运动参数进行分析,获取无人机在风场中的实际飞行状态,然后基于实际飞行状态进行飞行路径的规划,与现有技术相比,本实施例将无人机航迹规划问题与无人机实际飞行环境相结合,使规划得到的最优飞行路径方案优于无人机速度恒定的方案,进而达到能精确计算无人机在所有可能飞行路径上的航行时间,进而选择出最优的飞行路径。下面对本装置的各功能模块进行详细说明:第一处理模块102,用于结合无人机地速航向角离散度和预设遗传算法,构建初始种群,其步骤为:根据预设遗传算法的编码方式进行染色体编码;所述染色体由目标点信息和无人机地速航向角信息组成;其中所述目标点属于集合t0表示uavs的起点,无人机地速航向角属于集合ng表示无人机地速航向角离散度;所述染色体第一行为所述目标点的随机全排列,第二行为根据无人机航向角离散度为每个目标点随机选取对应的地速航向角。第二处理模块103,用于对每个染色体对应的dubins飞行路径进行航向角变化的分析,并根据分析结果将所述dubins飞行路径分为多个航迹段;执行第一步骤和第二步骤;所述第一步骤包括:采用以下公式计算获取无人机以地速航向角βgj由目标点tj出发并以地速航向角βgk飞至目标点tk航迹段的航行时间:其中,tj为起始点,βgj为无人机在起始点的航向角,tk为终止点,βgk为无人机在终止点的航向角,t表示目标点的集合,rmin为无人机最小转弯半径,vg为无人机的地速。采用以下公式计算获取无人机的地速:其中,va表示空速大小,βa表示空速航向角,vg表示地速的大小,βg表示地速航向角,vw表示风速大小,βw表示风向。所述第二步骤包括:根据suav-vs-dvrp模型获取航行时间:其约束条件为:其中,βgj、βgk分别表示uav在tj、tk两目标点的航向角;表示无人机以地速航向角βgj由目标点tj出发并以地速航向角βgk飞至目标点tk的航行时间;是一个二元决策变量,若uavs以地速航向角βgj由目标点tj出发并以地速航向角βgk飞至目标点tk时,否则nt表示目标点的数量,ng表示无人机地速航向角离散度。第三处理模块104,用于执行以下步骤:步骤1、使用所述编码方法生成初始解,并生成预定规模的初始种群并根据种群中每个染色体对应的航行时间计算其适应度;步骤2、使用轮盘赌方法选择父代种群中的两个个体(a,b)进行交叉,交叉规则为先随机选择个体a中交叉位置,然后查找个体b中与个体a交叉位置第一行相同的基因,将染色体a和b中交叉位置基因进行替换得到新的染色体c和d,判断染色体c和d是否满足suav-vs-dvrp模型的约束条件,若满足则利用染色体c和d替换种群中染色体a和b,否则结束,然后不断迭代更新步骤1种群,得到新的子代种群;步骤3、使用轮盘赌方法选择步骤2种群中一条染色体进行变异,对所述染色体进行变异的方式为下述变异方式中的至少一种,包括:对染色体第一行进行目标点变异;对染色体第二行进行无人机地速航向角变异;整个染色体变异的步骤包括:首先,若染色体的第一行顺序变异,则随机选取当前染色体的两个基因位并交换对应基因位的目标点编码;再选择第二行是否变异及变异位置,若变异则随机生成变异的有异于当前位置无人机地速航向角编码的值替换原值;判断变异后的染色体是否满足suav-vs-dvrp模型的约束条件,若满足则替换种群中染色体,否则结束替换并不断迭代更新步骤2种群,得到新的子代种群;步骤4、计算子代种群适应度并选取本次迭代中所有解中的最优解;步骤5、判断当前的迭代次数是否达到预设值,若判断否,则对步骤3中的子代种群和父代种群按照一定比例组合形成新的父代种群返回步骤2;若判断为是,则结束迭代,将最终获得的最优解作为无人机的任务分配与航迹规划结果。对于装置实施方式而言,由于其与方法实施方式基本相似,所以描述的比较简单,相关之处参见方法实施方式的部分说明即可。应当注意的是,在本发明的装置的各个部件中,根据其要实现的功能而对其中的部件进行了逻辑划分,但是,本发明不受限于此,可以根据需要对各个部件进行重新划分或者组合。本发明的各个部件实施方式可以以硬件实现,或者以在一个或者多个处理器上运行的软件模块实现,或者以它们的组合实现。本装置中,pc通过实现因特网对设备或者装置远程控制,精准的控制设备或者装置每个操作的步骤。本发明还可以实现为用于执行这里所描述的方法的一部分或者全部的设备或者装置程序(例如,计算机程序和计算机程序产品)。这样实现本发明的程序可以存储在计算机可读介质上,并且程序产生的文件或文档具有可统计性,产生数据报告和cpk报告等,能对功放进行批量测试并统计。应该注意的是上述实施方式对本发明进行说明而不是对本发明进行限制,并且本领域技术人员在不脱离所附权利要求的范围的情况下可设计出替换实施方式。在权利要求中,不应将位于括号之间的任何参考符号构造成对权利要求的限制。单词“包含”不排除存在未列在权利要求中的元件或步骤。位于元件之前的单词“一”或“一个”不排除存在多个这样的元件。本发明可以借助于包括有若干不同元件的硬件以及借助于适当编程的计算机来实现。在列举了若干装置的单元权利要求中,这些装置中的若干个可以是通过同一个硬件项来具体体现。单词第一、第二、以及第三等的使用不表示任何顺序。可将这些单词解释为名称。最后应说明的是:以上实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。当前第1页12
当前第1页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1