CN110057362A - 有限单元地图的移动机器人路径规划方法 - Google Patents
有限单元地图的移动机器人路径规划方法 Download PDFInfo
- Publication number
- CN110057362A CN110057362A CN201910342026.7A CN201910342026A CN110057362A CN 110057362 A CN110057362 A CN 110057362A CN 201910342026 A CN201910342026 A CN 201910342026A CN 110057362 A CN110057362 A CN 110057362A
- Authority
- CN
- China
- Prior art keywords
- node
- matrix
- map
- unit
- robot
- 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
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开一种有限单元地图的移动机器人路径规划方法,首先将连续的可行域离散为有限的单元组合体,用有限单元地图的节点集合与长度不相等的单元边的集合建立赋权无向循环图,然后根据赋权无向循环图用Dijkstra搜索算法搜索从起始位置到结束位置的所有目标点,通过DouglasPeucker算法对属于冗余节点的非转角点的边缘节点进行删除,提取关键路标,最后用三次自然样条函数拟合提取到的关键路标得到机器人的移动路径。本发明方法能够根据机器人所处运行环境的障碍物位置的不同,找到规划的机器人的无碰撞移动路径,与实际更相符,尤其适用于在狭长通道的地图上进行机器人移动路径规划。
Description
技术领域
本发明涉及路径规划领域,尤其涉及一种有限单元地图的移动机器人路径规划方法。
背景技术
机器人路径规划是机器人研究的一个重要领域,也是机器人技术的重要组成部分。机器人路径规划问题的重点是寻找从初始配置到目标配置的无碰撞路径。近年来,该问题通过路线图、单元分解、势场方法、基于抽样的规划和智能算法得到了很好的解决,但在不同的地图上,特别是在狭长通道的地图上,往往不能很好地解决这一问题。
为此,本发明给出一种有限单元地图的移动机器人路径规划方法,为得到最优的无碰撞路径,建立的有限单元地图模型,让其能够无碰撞地通过长而窄的通道,与实际情况更相符,为移动机器人逃脱各种障碍,规划最优路径提供了一种新思路。
发明内容
本发明的目的在于提供一种有限单元地图的移动机器人路径规划方法,用于寻找从初始配置到目标配置的无碰撞路径,为寻找最优的机器人移动路径提供了保障。
为了达成上述目的,本发明的解决方案是:
有限单元地图的移动机器人路径规划方法,包括以下步骤(1)~(7):
(1)机器人运行环境是一个二维封闭平面空间,将机器人可以自由移动的除去障碍物及边缘的区域称为可行域,记为C,平面空间C中的障碍物集合为CObs={Obstacle(1),Obstacle(2),…,Obstacle(n)},其中,n为障碍物个数;
(2)按照步骤(1)中可行域集合形状的变化,用普通三角形将连续的可行域离散为有限的单元组合体,用单元边的集合表示机器人的可行路径,建立有限单元地图,将单元地图中的节点及单元进行编号,并将节点编号转为节点坐标;
(3)根据步骤(2)中有限单元地图对各个单元进行组装,将单元矩阵元素按照相关节点的编号放到整体节点关联矩阵中,用有限单元地图的节点集合与长度不相等的单元边的集合建立赋权无向循环图;
(4)根据步骤(3)中的赋权无向循环图将路径节点分为网格地图边缘节点和网格地图内部节点,网格地图边缘节点又分为处于转角位置的节点和处于非转角位置的节点;
(5)根据步骤(3)中的赋权无向循环图,任意确定初始位姿点B1和终点Bu,用Dijkstra搜索算法依次求取点B2,B3……一直到Bu-1,然后依次连接目标点B1,B2,B3……一直到Bu其中,u为确定的搜索出的目标点的个数;
(6)根据步骤(5)中搜索出的目标点,采用Douglas-Peucker算法提取机器人行走的关键路标K1,K2……Ka,其中步骤(4)中非转角点的边缘节点是通常是冗余节点,不作为关键路标,直接剔除,a为提取的关键路标的个数;
(7)采用三次自然样条函数拟合步骤(6)中提取的关键路标,得到机器人的移动路径。
本发明的有限单元地图的移动机器人路径规划方法,所述步骤(2)中用普通三角形将连续的可行域离散为有限的单元组合体,其中,三角形剖分的有限单元地图用节点矩阵及单元连接矩阵表示,记剖分后的可行域有m个节点和k个单元,第i个节点Pi的坐标为(xi,yi),则节点矩阵P可以表示为单元连接矩阵可以表示为其中表示第j个单元的第i个节点的编号。此外单元连接矩阵还表示单元连接节点的关系,即在第j个单元中,与连接,与连接,与连接。
本发明的有限单元地图的移动机器人路径规划方法,所述步骤(3)将单元矩阵元素按照相关节点的编号放到整体节点关联矩阵中,由单元连接矩阵,构造节点关联矩阵T与S,T=[t1 t2…tn],S=[s1 s2…sn],节点连接矩阵T与S中的元素均是网格节点编号,T中的第i个节点ti与S中的第i个节点si相互关联,且表示节点ti与节点si连接,由于任意两节点之间的距离不同,故定关联矩阵T与S的距离矩阵D=[d1 d2…dn],D中的元素di表示节点关联矩阵T中的第i个节点ti与S中的第i节点si的距离,节点关联矩阵T、S与节点距离矩阵D可以构成稀疏矩阵表示的赋权无向连通矩阵G=sparse(Τ,S,D),基于有限单元的地图矩阵map表示为节点矩阵P与无向连通图矩阵组成的关联矩阵map=(P,G)。
本发明的有限单元地图的移动机器人路径规划方法,所述步骤(6)中从权利要求1中步骤(4)得到的非转角点的边缘节点是通常是冗余节点,不作为关键路标,直接剔除,对剔除非转角点后的边缘集合点采用Douglas-Peucker算法提取关键路标点,Douglas-Peucker算法为现有成熟方法,此处不再赘述。
附图说明
图1是有限单元地图的移动机器人路径规划方法流程图。图2与图3分别是用本发明方法得到的实验结果图。
具体实施方式
下面结合附图对本发明的技术方案进行详细说明。
本发明提供一种有限单元地图的移动机器人路径规划方法,其总体思路为:首先将有限单元地图离散建立赋权无向循环图,然后使用Dijkstra搜索算法搜索出从初始位姿点B1到目标点Bu的目标点,通过Douglas-Peucker算法在搜索出的目标点之间提取关键路标,最后采用三次自然样条函数对关键路标进行拟合,得到无碰撞的光滑规划路径。
如图1所示,本发明的有限单元地图的移动机器人路径规划方法,具体实施包括以下步骤(1)~(7):
(1)机器人运行环境是一个二维封闭平面空间,将机器人可以自由移动的除去障碍物及边缘的区域称为可行域,记为C,平面空间C中的障碍物集合为CObs={Obstacle(1),Obstacle(2),…,Obstacle(n)},其中,n为障碍物个数。
(2)按照步骤(1)中可行域集合形状的变化,用普通三角形将连续的可行域离散为有限的单元组合体,用单元边的集合表示机器人的可行路径,建立有限单元地图,将单元地图中的节点及单元进行编号,并将节点编号转为节点坐标;具体实现为:
用普通三角形将连续的可行域离散为有限的单元组合体,其中,三角形剖分的有限单元地图用节点矩阵及单元连接矩阵表示,记剖分后的可行域有m个节点和k个单元,第i个节点Pi的坐标为(xi,yi),则节点矩阵P可以表示为单元连接矩阵可以表示为其中表示第j个单元的第i个节点的编号。此外单元连接矩阵还表示单元连接节点的关系,即在第j个单元中,与连接,与连接,与连接。
(3)根据步骤(2)中有限单元地图对各个单元进行组装,将单元矩阵元素按照相关节点的编号放到整体节点关联矩阵中,用有限单元地图的节点集合与长度不相等的单元边的集合建立赋权无向循环图;具体实现为:
将单元矩阵元素按照相关节点的编号放到整体节点关联矩阵中,由单元连接矩阵,构造节点关联矩阵T与S,T=[t1 t2…tn],S=[s1 s2…sn],节点连接矩阵T与S中的元素均是网格节点编号,T中的第i个节点ti与S中的第i个节点si相互关联,且表示节点ti与节点si连接,由于任意两节点之间的距离不同,故定关联矩阵T与S的距离矩阵D=[d1 d2…dn],D中的元素di表示节点关联矩阵T中的第i个节点ti与S中的第i节点si的距离,节点关联矩阵T、S与节点距离矩阵D可以构成稀疏矩阵表示的赋权无向连通矩阵G=sparse(Τ,S,D),基于有限单元的地图矩阵map表示为节点矩阵P与无向连通图矩阵组成的关联矩阵map=(P,G)。
(4)根据步骤(3)中的赋权无向循环图将路径节点分为网格地图边缘节点和网格地图内部节点,网格地图边缘节点又分为处于转角位置的节点和处于非转角位置的节点。
(5)根据步骤(3)中的赋权无向循环图,任意确定初始位姿点B1和终点Bu,用Dijkstra搜索算法依次求取点B2,B3……一直到Bu-1,然后依次连接目标点B1,B2,B3……一直到Bu其中,u为确定的搜索出的目标点的个数。
(6)根据步骤(5)中搜索出的目标点,采用Douglas-Peucker算法提取机器人行走的关键路标K1,K2……Ka,其中步骤(4)中非转角点的边缘节点是通常是冗余节点,不作为关键路标,直接剔除,a为提取的关键路标的个数;具体实现为:
从权利要求1中步骤(4)得到的非转角点的边缘节点是通常是冗余节点,不作为关键路标,直接剔除,对剔除非转角点后的边缘集合点采用Douglas-Peucker算法提取关键路标点,Douglas-Peucker算法为现有成熟方法,此处不再赘述。
(7)采用三次自然样条函数拟合步骤(6)中提取的关键路标,得到机器人的移动路径。
以上实施例仅为说明本发明的技术思想,不能以此限定本发明的保护范围,凡是按照本发明提出的技术思想,在技术方案基础上所做的任何改动,均落入本发明保护范围之内。
Claims (4)
1.一种有限单元地图的移动机器人路径规划方法,其特征在于,包括以下步骤:
(1)机器人运行环境是一个二维封闭平面空间,将机器人可以自由移动的除去障碍物及边缘的区域称为可行域,记为C,平面空间C中的障碍物集合为CObs={Obstacle(1),Obstacle(2),…,Obstacle(n)},其中,n为障碍物个数;
(2)按照步骤(1)中可行域集合形状的变化,用普通三角形将连续的可行域离散为有限的单元组合体,用单元边的集合表示机器人的可行路径,建立有限单元地图,将单元地图中的节点及单元进行编号,并将节点编号转为节点坐标;
(3)根据步骤(2)中有限单元地图对各个单元进行组装,将单元矩阵元素按照相关节点的编号放到整体节点关联矩阵中,用有限单元地图的节点集合与长度不相等的单元边的集合建立赋权无向循环图;
(4)根据步骤(3)中的赋权无向循环图将路径节点分为网格地图边缘节点和网格地图内部节点,网格地图边缘节点又分为处于转角位置的节点和处于非转角位置的节点;
(5)根据步骤(3)中的赋权无向循环图,任意确定初始位姿点B1和终点Bu,用Dijkstra搜索算法依次求取点B2,B3……一直到Bu-1,然后依次连接目标点B1,B2,B3……一直到Bu其中,u为确定的搜索出的目标点的个数;
(6)根据步骤(5)中搜索出的目标点,采用Douglas-Peucker算法提取机器人行走的关键路标K1,K2……Ka,其中步骤(4)中非转角点的边缘节点是通常是冗余节点,不作为关键路标,直接剔除,a为提取的关键路标的个数;
(7)采用三次自然样条函数拟合步骤(6)中提取的关键路标,得到机器人的移动路径。
2.如权利要求1所述有限单元地图的移动机器人路径规划方法,其特征在于,所述步骤(2)中用普通三角形将连续的可行域离散为有限的单元组合体,其中,三角形剖分的有限单元地图用节点矩阵及单元连接矩阵表示,记剖分后的可行域有m个节点和k个单元,第i个节点Pi的坐标为(xi,yi),则节点矩阵P可以表示为单元连接矩阵可以表示为其中表示第j个单元的第i个节点的编号;此外单元连接矩阵还表示单元连接节点的关系,即在第j个单元中,与连接,与连接,与连接。
3.如权利要求1所述有限单元地图的移动机器人路径规划方法,其特征在于,所述步骤(3)将单元矩阵元素按照相关节点的编号放到整体节点关联矩阵中,由单元连接矩阵,构造节点关联矩阵T与S,T=[t1 t2 … tn],S=[s1 s2 … sn],节点连接矩阵T与S中的元素均是网格节点编号,T中的第i个节点ti与S中的第i个节点si相互关联,且表示节点ti与节点si连接,由于任意两节点之间的距离不同,故定关联矩阵T与S的距离矩阵D=[d1 d2 … dn],D中的元素di表示节点关联矩阵T中的第i个节点ti与S中的第i节点si的距离,节点关联矩阵T、S与节点距离矩阵D可以构成稀疏矩阵表示的赋权无向连通矩阵G=sparse(Τ,S,D),基于有限单元的地图矩阵map表示为节点矩阵P与无向连通图矩阵组成的关联矩阵map=(P,G)。
4.如权利要求1所述基于有限单元地图的移动机器人路径规划方法,其特征在于,所述步骤(6)中从权利要求1中步骤(4)得到的非转角点的边缘节点是通常是冗余节点,不作为关键路标,直接剔除,对剔除非转角点后的边缘集合点采用Douglas-Peucker算法提取关键路标点。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910342026.7A CN110057362B (zh) | 2019-04-26 | 2019-04-26 | 有限单元地图的移动机器人路径规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910342026.7A CN110057362B (zh) | 2019-04-26 | 2019-04-26 | 有限单元地图的移动机器人路径规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110057362A true CN110057362A (zh) | 2019-07-26 |
CN110057362B CN110057362B (zh) | 2022-09-16 |
Family
ID=67320998
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910342026.7A Active CN110057362B (zh) | 2019-04-26 | 2019-04-26 | 有限单元地图的移动机器人路径规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110057362B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113280819A (zh) * | 2021-05-21 | 2021-08-20 | 广东美房智高机器人有限公司 | 一种移动机器人的作业路径数据的压缩方法 |
WO2021179409A1 (zh) * | 2020-03-09 | 2021-09-16 | 江苏大学 | 一种非规则形状移动机器人的路径规划方法 |
CN113804209A (zh) * | 2021-05-27 | 2021-12-17 | 中国人民解放军战略支援部队信息工程大学 | 一种四角格网高精度长距离越野路径规划方法 |
CN114115298A (zh) * | 2022-01-25 | 2022-03-01 | 北京理工大学 | 一种无人车路径平滑方法及系统 |
CN115016458A (zh) * | 2022-05-05 | 2022-09-06 | 安徽理工大学 | 一种基于rrt算法的地洞勘探机器人路径规划方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102708423A (zh) * | 2012-06-06 | 2012-10-03 | 上海第二工业大学 | 引入偏微分方程求解移动机器人路径规划的方法 |
CN106020194A (zh) * | 2016-06-20 | 2016-10-12 | 武汉理工大学 | 一种基于传热分析的工业机器人路径优化方法及系统 |
US20180285516A1 (en) * | 2017-04-04 | 2018-10-04 | Humanetics Innovative Solutions, Inc. | Customized response finite element model for crash test dummy and method |
CN109164810A (zh) * | 2018-09-28 | 2019-01-08 | 昆明理工大学 | 一种基于蚁群-聚类算法的机器人自适应动态路径规划方法 |
US20190079523A1 (en) * | 2017-09-11 | 2019-03-14 | Baidu Usa Llc | Dp and qp based decision and planning for autonomous driving vehicles |
-
2019
- 2019-04-26 CN CN201910342026.7A patent/CN110057362B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102708423A (zh) * | 2012-06-06 | 2012-10-03 | 上海第二工业大学 | 引入偏微分方程求解移动机器人路径规划的方法 |
CN106020194A (zh) * | 2016-06-20 | 2016-10-12 | 武汉理工大学 | 一种基于传热分析的工业机器人路径优化方法及系统 |
US20180285516A1 (en) * | 2017-04-04 | 2018-10-04 | Humanetics Innovative Solutions, Inc. | Customized response finite element model for crash test dummy and method |
US20190079523A1 (en) * | 2017-09-11 | 2019-03-14 | Baidu Usa Llc | Dp and qp based decision and planning for autonomous driving vehicles |
CN109164810A (zh) * | 2018-09-28 | 2019-01-08 | 昆明理工大学 | 一种基于蚁群-聚类算法的机器人自适应动态路径规划方法 |
Non-Patent Citations (1)
Title |
---|
贾茜等: "基于混沌反控制的动态路径规划研究", 《计算机应用与软件》 * |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2021179409A1 (zh) * | 2020-03-09 | 2021-09-16 | 江苏大学 | 一种非规则形状移动机器人的路径规划方法 |
CN113280819A (zh) * | 2021-05-21 | 2021-08-20 | 广东美房智高机器人有限公司 | 一种移动机器人的作业路径数据的压缩方法 |
CN113280819B (zh) * | 2021-05-21 | 2024-03-08 | 广东美房智高机器人有限公司 | 一种移动机器人的作业路径数据的压缩方法 |
CN113804209A (zh) * | 2021-05-27 | 2021-12-17 | 中国人民解放军战略支援部队信息工程大学 | 一种四角格网高精度长距离越野路径规划方法 |
CN113804209B (zh) * | 2021-05-27 | 2024-01-09 | 中国人民解放军战略支援部队信息工程大学 | 一种四角格网高精度长距离越野路径规划方法 |
CN114115298A (zh) * | 2022-01-25 | 2022-03-01 | 北京理工大学 | 一种无人车路径平滑方法及系统 |
CN115016458A (zh) * | 2022-05-05 | 2022-09-06 | 安徽理工大学 | 一种基于rrt算法的地洞勘探机器人路径规划方法 |
CN115016458B (zh) * | 2022-05-05 | 2024-04-16 | 安徽理工大学 | 基于rrt算法的地洞勘探机器人路径规划方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110057362B (zh) | 2022-09-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110057362A (zh) | 有限单元地图的移动机器人路径规划方法 | |
CN104143194B (zh) | 一种点云分割方法及装置 | |
CN104252489B (zh) | 一种根据经纬度数据快速获得位置文字描述信息的方法 | |
CN109144072A (zh) | 一种基于三维激光的机器人智能避障方法 | |
Lin et al. | Intelligent generation of indoor topology (i-GIT) for human indoor pathfinding based on IFC models and 3D GIS technology | |
CN105066997B (zh) | 一种面向室内导航的动态路径生成方法 | |
Peucker et al. | Digital representation of threedimensional surfaces by Triangulated Irregular Networks (TIN)(Revised) | |
CN108536923A (zh) | 一种基于建筑cad图的室内拓扑地图生成方法及系统 | |
CN108320323A (zh) | 一种建筑物三维建模方法及装置 | |
CN106017476A (zh) | 一种生成室内定位导航图模型的方法 | |
CN106126816A (zh) | 重复建筑自动感知下的大规模als建筑点云建模方法 | |
CN105844224A (zh) | 一种车载LiDAR 道路点云快速有序化方法 | |
CN110213710A (zh) | 一种基于随机森林的高性能室内定位方法、室内定位系统 | |
CN116518960B (zh) | 路网更新方法、装置、电子设备和存储介质 | |
CN109472416B (zh) | 基于自动路网数据提取的室内路径规划方法及装置、客户端 | |
Zhang et al. | Delimited stroke oriented algorithm-working principle and implementation for the matching of road networks | |
CN107169080A (zh) | 一种基于gis和空间数据库相结合的地理空间分析系统 | |
CN106844642A (zh) | 一种基于gis计算路网网格中人口密度的方法 | |
CN103575272A (zh) | 森林环境中移动机器人自然路标提取方法 | |
CN113989447A (zh) | 一种三维模型室内外一体化构建方法及系统 | |
Touya et al. | Generalising unusual map themes from OpenStreetMap | |
CN114509085B (zh) | 一种结合栅格和拓扑地图的快速路径搜索方法 | |
CN115143980A (zh) | 基于剪枝Voronoi图的增量式拓扑地图构建方法 | |
Sun et al. | Study on safe evacuation routes based on crowd density map of shopping mall | |
Wang et al. | Automatic deformation extraction method of buildings in mining areas based on TLS point clouds |
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 |