一种基于改进A*算法的无人机航路规划方法技术

本发明专利技术提出使用基于改进A*算法的无人机路径规划算法对运动路径进行优化，通过对路径轨迹进行放大，细化等操作来减少实际运动路径轨迹长度，达到减少路径长度的目的。具体步骤如下：首先是生成模拟环境地图，根据无人机运动场景的信息进行建模，生成所要执行的模拟环境地图；然后是确定路径轨迹，建立无人机活动的起始点与目标点，将无人机走过的路线连接起来，确定路径轨迹；接下来进行特征选择，将确定的路径轨迹，在变换方向时将存在一定角度的两段轨迹夹角周围进行弧线代替；最后是连接新生成的路径，将部分替换路径与原始未变路径连接，得到改进后的新路径。

【技术实现步骤摘要】
一种基于改进A*算法的无人机航路规划方法
本专利技术提出一种基于改进A*算法的无人机航迹规划算法研究，在保证无人机飞行中安全避障的前提下，提出将路径轨迹在允许范围内用弧段代替，从而进一步缩短实际运动路径长度目的。
技术介绍
随着现代技术的发展，飞行器的种类不断变多，其在应用中也日趋专一化，完善化，如专门用作植保的大疆PS-X625无人机，用作街景拍摄与监控巡察用的宝鸡行翼航空科技的X8无人机，以及用作水下救援的白鲨MIX水下无人机等，决定飞行器性能的主要是内部的飞控系统和外部的路径规划问题。就路径问题而言，在具体实施任务时仅仅靠操作员手中的遥控器来控制无人飞行器执行相应的工作，可能会对操作员心理以及技术提出极高的要求，为了避免个人操作失误，进而造成飞行器损坏的危险。因此，一种解决问题的方法就是对飞行器进行航迹规划。飞行器的测量精度，航迹路径的合理规划，飞行器工作时的稳定性，安全性等这些变化使得对飞行器的的综合控制系统要求越来越高。无人机航路规划是为了保证无人机完成特定的飞行任务，并且能够在完成任务的过程中躲避各种障碍、威胁区域而设计出最优航迹路线的问题。常见的航迹规划算法包括两类：基于控制论的优化算法、基于几何学的搜索算法。其中在几何学中又分为两大类，随机型搜索和确定型搜索，随机型搜索有遗传算法、神经网络算法、粒子算法、模拟退火算法等，确定型算法有动态规划算法，迪杰斯特拉算法，A*算法，D*算法等，其中A*算法是一种静态路网中求解路径最有效的直接搜索方法，也是许多其他问题的常用启发式算法。专利
技术实现思路
本专利技术的目的是为了解决无人机在路径规划过程中使用A*算法不能找到最优路径的问题，提出使用基于改进A*算法的无人机路径规划算法对运动路径进行优化，通过对路径轨迹进行放大，细化等操作来减少实际运动路径轨迹长度，为了实现上述目的，本专利技术的步骤如下：步骤一：生成模拟环境地图，根据无人机运动场景的信息进行建模，生成模拟环境地图；步骤二：确定路径轨迹，建立无人机活动的起始点与目标点，将无人机走过的路线连接起来，确定路径轨迹；步骤三：特征选择，将确定的路径轨迹，在变换方向时将存在一定角度的两段轨迹夹角周围进行弧线代替；步骤四：连接新生成的路径，将部分替换路径与原始未变路径连接，得到改进后的新路径。所述步骤一中的具体情况如下：根据无人机的活动场地建立合适的位置参考系，将模拟的地图在二维平面内满足无人机能够到达的最远位置，以及对无人机在运动中的障碍物进行规则化的处理，在二维平面内用坐标表示无人机的各个状态的位置，在二维坐标系将环境布置的一目了然。所述步骤二中的具体情况如下：（1）确定无人机的运动起点与终点：在模拟的环境地图中要尽可能的将运动目标的起点与终点选在地图的两侧，这样生成的路径就会显示在地图的醒目位置；（2）在A*算法中通过定义代价函数来确定路径，其中是初始状态到目标状态的代价估计，是初始状态到当前状态的代价函数，是当前状态到目标状态的估计代价。其中，最短路径就是求满足要求的最小值，其中求的关键在于的大小。即在当前状态到目标状态的满足最优距离λ，其中λ的大小为：其中寻找下一状态的的过程为：①以当前状态点为中心，寻找下一状态点为当前状态点的八个方向，其中创建开始节点START，目标节点TARGET，OPEN列表，CLOSE列表初始为空；②将START加入到OPEN列表中；③检查OPEN列表中的节点，若列表为空，则无可行路径；若不为空，选择值最小的节点k；④将节点k从OPEN中去除，并将其添加到CLOSE中，并判断节点k是否是目标节点TARGET，若是则说明找到路径；若不是，则继续扩展节点k，生成k节点的子节点集，设q为k的子节点集，对所有节点q计算相应的值，并选择值最小的节点，将该节点加入到CLOSE列表中；⑤跳到③，直到算法获得可行路径或无解退出；（3）连接各状态点，组成无人机的规划路径轨迹。所述步骤三中的具体情况如下：（1）确定改进航段，在组成的航迹段中，找到存在方向变化时存在一定夹角的两段航迹，此时用航迹的内切弧代替初始航迹；（2）确定弧段圆心，将规划的路径按一定的比例放大，在实际允许的情况下，路径细化后存在一定的夹角，在两段航迹交点处，以及距离A最近的左右两侧各一个航迹点，；分别作以A点与P点上一状态航迹点连线的垂直平分线，在另一侧作A点与Q点下一状态的航迹点连线的垂直平分线，垂足分别为P，Q。两线相较于一点C，其中C即为所求圆心；（3）找到圆心角，确定弧段长度。在P，Q，C三点确定的圆，用内切劣弧PQ代替PA与QA，此时找出圆心角α的大小，以及劣弧所对应的半径R大小，此时计算劣弧PQ的长度为：其中,由两段组成的存在一定角度的线段的长度长于其内切弧的长度，，分别是线段PA与QA的长度。所述步骤四中的具体情况如下：（1）检查区域改进轨迹，在存在变向的两段航迹段之间找到新生成的规划航迹段，确定更新的航迹段，并在航迹地图上着重的标出来；（2）将存在的航迹段与改进更新后的航迹段连接，得到满足要求的新的规划航迹，此时得到新的规划航迹线路。本专利技术还包括这样一些特征：相比较传统的启发式A*算法在考虑代价函数时未能将实际情况存在的障碍物的特征，以及在运动目标通过障碍物时的运动取向等情况考虑在内，本专利技术针对上述存在的问题进行了算法上的改进，改进后的路径长度相比较传统的路径长度减少，从而间接的减少的运动目标的运动时间。相比较其它的关于改进A*算法上，本专利技术所提出的基于改进A*算法的无人机航路规划方法上，将几何学知识应用到算法中，得出的路径长度相对于传统路径长度更短，更易于理解，计算更加方便简单。附图说明图1为本专利技术的方法流程图；图2为航迹段相交夹角图。具体实施方式对于本领域技术人员来说，附图说明中某些公知结构及其说明可能省略是可以理解的。下面结合附图和实现步骤对本专利技术作进一步的描述。本专利技术提出使用基于改进A*算法的无人机路径规划算法对运动路径进行优化，通过对路径轨迹进行放大，细化等操作来减少实际运动路径轨迹长度，达到减少路径长度的目的。图1为本专利技术的方法流程图，首先是生成模拟环境地图，根据无人机运动场景的信息进行建模，生成所要执行的模拟环境地图；然后是确定路径轨迹，建立无人机活动的起始点与目标点，将无人机走过的路线连接起来，确定路径轨迹；接下来进行特征选择，将确定的路径轨迹，在变换方向时将存在一定角度的两段轨迹夹角周围进行弧线代替；最后是连接新生成的路径，将部分替换路径与原始未变路径连接，得到改进后的新路径。具体的实现步骤为：Step1根据无人机的活动场地建立合适的位置参考系，将模拟的地图在二维平面内满足无人机能够到达的最远位置，以及对无人机在运动本文档来自技高网...

【技术保护点】
1.一种基于改进A*算法的无人机航路规划方法，其特征在于，包括以下步骤：/nStep1：生成模拟环境地图，根据无人机运动场景的信息进行建模，生成模拟环境地图；/nStep2：确定路径轨迹，建立无人机活动的起始点与目标点，将无人机走过的路线连接起来，确定路径轨迹；/nStep3：特征选择，将确定的路径轨迹，在变换方向时将存在一定角度的两段轨迹夹角周围进行弧线代替；/nStep4：连接新生成的路径，将部分替换路径与原始未变路径连接，得到改进后的新路径。/n

【技术特征摘要】
1.一种基于改进A*算法的无人机航路规划方法，其特征在于，包括以下步骤：
Step1：生成模拟环境地图，根据无人机运动场景的信息进行建模，生成模拟环境地图；
Step2：确定路径轨迹，建立无人机活动的起始点与目标点，将无人机走过的路线连接起来，确定路径轨迹；
Step3：特征选择，将确定的路径轨迹，在变换方向时将存在一定角度的两段轨迹夹角周围进行弧线代替；
Step4：连接新生成的路径，将部分替换路径与原始未变路径连接，得到改进后的新路径。


2.根据权利要求1所述的一种基于改进A*算法的无人机航路规划方法，其特征在于，所述Step1中的具体过程如下：
Step1根据无人机的活动场地建立合适的位置参考系，将模拟的地图在二维平面内满足无人机能够到达的最远位置，以及对无人机在运动中的障碍物进行规则化的处理，在二维平面内用坐标表示无人机的各个状态的位置，在二维坐标系将环境布置的一目了然。


3.根据权利要求1所述的一种基于改进A*算法的无人机航路规划方法，其特征在于，所述Step2中的具体过程如下：
Step2.1确定无人机的运动起点与终点：在模拟的环境地图中要尽可能的将运动目标的起点与终点（1）选在地图的两侧，这样生成的路径就会显示在地图的醒目位置；
Step2.2在A*算法中通过定义代价函数来确定路径，其中是初始状态到目标状态的代价估计，是初始状态到当前状态的代价函数，是当前状态到目标状态的估计代价；其中，最短路径就是求满足要求的最小值，其中求的关键在于的大小，即在当前状态到目标状态的满足最优距离λ，其中λ的大小为：



其中寻找下一状态的的过程为：
Step2.2.1以当前状态点为中心，寻找下一状态点为当前状态点的八个方向，其中创建开始节点START，目标节点TARGET，OPEN列表，CLOSE列表初始为空；
Step2.2.2将START加入到OPEN列表中；
Step2.2.3检查OPEN列表中的节点，若...

【专利技术属性】
技术研发人员：宋宇，顾海蛟，郭昕刚，
申请(专利权)人：长春工业大学，
类型：发明
国别省市：吉林;22