基于改进A*算法的路径规划方法、装置及机器人制造方法及图纸

本发明专利技术公开了基于改进A*算法的路径规划方法、装置及机器人，其中路径规划方法包括初始化步骤、扩展步骤、搜索步骤、判断步骤和路径生成步骤；在扩展步骤中采用24邻域进行扩展，在搜索步骤中依据24邻域进行搜索，在路径生成步骤中采用消除共线节点和消除冗余转折点的方法使路径优化；减少了路径代价，减小搜索时间，加快路径规划进程，且使最终路径更平滑。

Path planning method, device and robot based on improved a * algorithm

【技术实现步骤摘要】
基于改进A*算法的路径规划方法、装置及机器人
本专利技术涉及自动机器人领域，特别是基于改进A*算法的路径规划方法、装置及机器人。
技术介绍
A*算法本质上是一种具有启发式特征的搜索算法，兼具灵活性和对适应不同路况的能力，在路径规划搜索中非常流行。但A*算法在节点选取时固定采用8邻域扩展方式，周围至多只能选择8个运动方向，且运动角度限制为π/4的整数倍，不利于机器人转向，导致产生更多冗余节点，且无对冗余节点进行优化，使最终路径转折点多、不平滑。
技术实现思路
本专利技术的目的在于至少解决现有技术中存在的技术问题之一，提供基于改进A*算法的路径规划方法、装置及机器人。本专利技术解决其问题所采用的技术方案是：本专利技术的第一方面，基于改进A*算法的路径规划方法，包括以下步骤：初始化步骤：建立OPEN表和CLOSE表，将起始节点纳入所述OPEN表；扩展步骤:将OPEN表中具有最小f值的节点作为当前节点向周围扩展得到两层扩展节点，处于内圈的扩展节点共8个，处于外圈的扩展节点共16个；搜索步骤：先判断处于内圈的扩展节点是否为障碍节点，若不是则向外圈扩展；判断处于外圈的扩展节点是否为障碍节点和当前节点至扩展节点途径的途经点是否在CLOSE表中，若判断失败则将该扩展节点纳入OPEN表中；以当前节点作为父节点更新OPEN表中的所有节点的g值；判断步骤：将OPEN表中g值变小的节点作为当前节点执行扩展步骤，将扩展节点纳入CLOSE表，然后判断OPEN表中的所有节点是否包含目标节点，若不包含则执行搜索步骤，若包含则执行路径生成步骤；路径生成步骤：将起始节点、搜索步骤中得到的父节点和目标节点依次经消除共线节点和消除冗余转折点后相连得到最优路径。根据本专利技术的第一方面，所述消除共线节点具体为：对于依次相连的三个节点S1、S2和S3，计算S1与S2连线的斜率KS1S2和S2与S3连线的斜率KS2S3，若KS1S2＝KS2S3，则消除节点S2。根据本专利技术的第一方面，所述消除冗余转折点具体为：对于依次相连的三个节点P1、P2和P3，若P1和P3间的连线无经过障碍节点，则消除节点P2。根据本专利技术的第一方面，f值为始节点至终节点的总代价，g值为始节点至现节点的真实代价，满足f＝g+h，其中h值为现节点至终节点的预估代价。本专利技术的第二方面，基于改进A*算法的路径规划装置，包括：初始化模块，用于建立OPEN表和CLOSE表，将起始节点纳入所述OPEN表；扩展模块，用于将OPEN表中具有最小f值的节点作为当前节点向周围扩展得到两层扩展节点，处于内圈的扩展节点共8个，处于外圈的扩展节点共16个；搜索模块，用于判断处于内圈的扩展节点是否为障碍节点，若不是则向外圈扩展，判断处于外圈的扩展节点是否为障碍节点和当前节点至扩展节点途径的途经点是否在CLOSE表中，若判断失败则将该扩展节点纳入OPEN表中，以当前节点作为父节点更新OPEN表中的所有节点的g值；判断模块，用于将OPEN表中g值变小的节点作为当前节点执行扩展步骤，将扩展节点纳入CLOSE表，然后判断OPEN表中的所有节点是否包含目标节点，若不包含则执行搜索模块，若包含则执行路径生成模块；路径生成模块，用于将起始节点、搜索步骤中得到的父节点和目标节点依次经消除共线节点和消除冗余转折点后相连得到最优路径。根据本专利技术的第二方面，所述路径生成模块包括第一消除模块，所述第一消除模块用于消除共线节点；所述消除共线节点具体为：对于依次相连的三个节点S1、S2和S3，计算S1与S2连线的斜率KS1S2和S2与S3连线的斜率KS2S3，若KS1S2＝KS2S3，则消除节点S2。根据本专利技术的第二方面，所述路径生成模块包括第二消除模块，所述第二消除模块用于消除冗余转折点；所述消除冗余转折点具体为：对于依次相连的三个节点P1、P2和P3，若P1和P3间的连线无经过障碍节点，则消除节点P2。根据本专利技术的第二方面，f值为始节点至终节点的总代价，g值为始节点至现节点的真实代价，满足f＝g+h，其中h值为现节点至终节点的预估代价。本专利技术的第三方面，一种机器人，执行如本专利技术第一方面所述的基于改进A*算法的路径规划方法得到最优路径，并按照最优路径行走。上述的技术方案至少具有以下的有益效果:在传统的8邻域扩展搜索方式上进行扩展增至24邻域，增加了对路径方向的选择性，减少了路径代价，减小搜索时间，加快路径规划进程；同时通过消除共线节点和消除冗余转折点的方式进一步减少冗余的节点，使路径进一步优化，更平滑。本专利技术的附加方面和优点将在下面的描述中部分给出，部分将从下面的描述中变得明显，或通过本专利技术的实践了解到。附图说明下面结合附图和实例对本专利技术作进一步说明。图1是本专利技术实施例基于改进A*算法的路径规划方法的步骤图；图2是消除共线节点的原理图；图3是消除冗余转折点的原理图。具体实施方式本部分将详细描述本专利技术的具体实施例，本专利技术之较佳实施例在附图中示出，附图的作用在于用图形补充说明书文字部分的描述，使人能够直观地、形象地理解本专利技术的每个技术特征和整体技术方案，但其不能理解为对本专利技术保护范围的限制。在本专利技术的描述中，需要理解的是，涉及到方位描述，例如上、下、前、后、左、右等指示的方位或位置关系为基于附图所示的方位或位置关系，仅是为了便于描述本专利技术和简化描述，而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作，因此不能理解为对本专利技术的限制。在本专利技术的描述中，若干的含义是一个或者多个，多个的含义是两个以上，大于、小于、超过等理解为不包括本数，以上、以下、以内等理解为包括本数。如果有描述到第一、第二只是用于区分技术特征为目的，而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量或者隐含指明所指示的技术特征的先后关系。本专利技术的描述中，除非另有明确的限定，设置、安装、连接等词语应做广义理解，所属
技术人员可以结合技术方案的具体内容合理确定上述词语在本专利技术中的具体含义。参照图1，本专利技术的实施例，基于改进A*算法的路径规划方法，包括以下步骤：步骤S10、初始化步骤：建立OPEN表和CLOSE表，将起始节点纳入所述OPEN表；步骤S20、扩展步骤:将OPEN表中具有最小f值的节点作为当前节点向周围扩展得到两层扩展节点，处于内圈的扩展节点共8个，处于外圈的扩展节点共16个；步骤S30、搜索步骤：先判断处于内圈的扩展节点是否为障碍节点，若不是则向外圈扩展；判断处于外圈的扩展节点是否为障碍节点和当前节点至扩展节点途径的途经点是否在CLOSE表中，若判断失败则将该扩展节点纳入OPEN表中；以当前节点作为父节点更新OPEN表中的所有节点的g值；步骤S40、判断步骤：将OPEN表中g值变小的节点作为当前节点执行扩展步骤，将扩展节点纳入CLOSE表，然后判断OP本文档来自技高网...

【技术保护点】
1.基于改进A*算法的路径规划方法，其特征在于，包括以下步骤：/n初始化步骤：建立OPEN表和CLOSE表，将起始节点纳入所述OPEN表；/n扩展步骤:将OPEN表中具有最小f值的节点作为当前节点向周围扩展得到两层扩展节点，处于内圈的扩展节点共8个，处于外圈的扩展节点共16个；/n搜索步骤：先判断处于内圈的扩展节点是否为障碍节点，若不是则向外圈扩展；判断处于外圈的扩展节点是否为障碍节点和当前节点至扩展节点途径的途经点是否在CLOSE表中，若判断失败则将该扩展节点纳入OPEN表中；以当前节点作为父节点更新OPEN表中的所有节点的g值；/n判断步骤：将OPEN表中g值变小的节点作为当前节点执行扩展步骤，将扩展节点纳入CLOSE表，然后判断OPEN表中的所有节点是否包含目标节点，若不包含则执行搜索步骤，若包含则执行路径生成步骤；/n路径生成步骤：将起始节点、搜索步骤中得到的父节点和目标节点依次经消除共线节点和消除冗余转折点后相连得到最优路径。/n

【技术特征摘要】
1.基于改进A*算法的路径规划方法，其特征在于，包括以下步骤：
初始化步骤：建立OPEN表和CLOSE表，将起始节点纳入所述OPEN表；
扩展步骤:将OPEN表中具有最小f值的节点作为当前节点向周围扩展得到两层扩展节点，处于内圈的扩展节点共8个，处于外圈的扩展节点共16个；
搜索步骤：先判断处于内圈的扩展节点是否为障碍节点，若不是则向外圈扩展；判断处于外圈的扩展节点是否为障碍节点和当前节点至扩展节点途径的途经点是否在CLOSE表中，若判断失败则将该扩展节点纳入OPEN表中；以当前节点作为父节点更新OPEN表中的所有节点的g值；
判断步骤：将OPEN表中g值变小的节点作为当前节点执行扩展步骤，将扩展节点纳入CLOSE表，然后判断OPEN表中的所有节点是否包含目标节点，若不包含则执行搜索步骤，若包含则执行路径生成步骤；
路径生成步骤：将起始节点、搜索步骤中得到的父节点和目标节点依次经消除共线节点和消除冗余转折点后相连得到最优路径。


2.根据权利要求1所述的基于改进A*算法的路径规划方法，其特征在于，所述消除共线节点具体为：对于依次相连的三个节点S1、S2和S3，计算S1与S2连线的斜率KS1S2和S2与S3连线的斜率KS2S3，若KS1S2＝KS2S3，则消除节点S2。


3.根据权利要求1所述的基于改进A*算法的路径规划方法，其特征在于，所述消除冗余转折点具体为：对于依次相连的三个节点P1、P2和P3，若P1和P3间的连线无经过障碍节点，则消除节点P2。


4.根据权利要求1至3任一项所述的基于改进A*算法的路径规划方法，其特征在于，f值为始节点至终节点的总代价，g值为始节点至现节点的真实代价，满足f＝g+h，其中h值为现节点至终节点的预估代价。


5.基于改进A*算法的路径规划装置，其特征在于，包括：
初始化模块，用于建立OPEN表和CLOSE表，将起始节点纳入所述OPEN表；<...

【专利技术属性】
技术研发人员：黄辉，邹安安，邹媛媛，胡鹏，蔡庆荣，江励，王宏民，王琼瑶，汤健华，梁艳阳，王广龙，
申请(专利权)人：五邑大学，
类型：发明
国别省市：广东;44