专利汇可以提供有限单元地图的移动机器人路径规划方法专利检索,专利查询,专利分析的服务。并且本 发明 公开一种有限单元地图的移动 机器人 路径规划方法,首先将连续的可行域离散为有限的单元组合体,用有限单元地图的 节点 集合与长度不相等的单元边的集合建立赋权无向循环图,然后根据赋权无向循环图用Dijkstra搜索 算法 搜索从起始 位置 到结束位置的所有目标点,通过DouglasPeucker算法对属于冗余节点的非转 角 点的边缘节点进行删除,提取关键路标,最后用三次自然样条函数拟合提取到的关键路标得到机器人的移动路径。本发明方法能够根据机器人所处运行环境的障碍物位置的不同,找到规划的机器人的无碰撞移动路径,与实际更相符,尤其适用于在狭长通道的地图上进行机器人移动路径规划。,下面是有限单元地图的移动机器人路径规划方法专利的具体信息内容。
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算法提取关键路标点。
标题 | 发布/更新时间 | 阅读量 |
---|---|---|
一种基于近似度加权平均插值法的机器人精度补偿方法 | 2021-10-04 | 0 |
点焊系统 | 2021-01-25 | 2 |
一种基于ORBSLAM2的八叉树建图方法 | 2022-06-26 | 2 |
一种基于图像内容理解的视频防抖方法 | 2021-03-08 | 2 |
用于辅助的患者定位的系统和方法 | 2022-01-10 | 2 |
穿梭车式仓储系统 | 2023-06-12 | 0 |
重量のある作業機を傾斜を有するベースにおいて移送する方法および移送機構 | 2020-05-19 | 3 |
開き戸 | 2020-09-12 | 1 |
遠隔作業システムの非常回収装置及びその非常回収方法 | 2020-09-12 | 1 |
車両の動力伝達装置 | 2020-10-15 | 1 |
高效检索全球专利专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台,是提供专利分析,专利查询,专利检索等数据服务功能的知识产权数据服务商。
我们的产品包含105个国家的1.26亿组数据,免费查、免费专利分析。
专利汇分析报告产品可以对行业情报数据进行梳理分析,涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度,系统通过AI智能系统对图表进行解读,只需1分钟,一键生成行业专利分析报告。