发明名称 一种移动机器人基于激光测距仪的线特征地图创建方法
摘要 本发明公开了一种移动机器人基于激光测距仪的线特征地图创建方法,属于移动机器人地图创建技术领域,包括以下步骤:首先启动激光测距仪对外部环境进行扫描,再对扫描的激光数据采用均值滤波的方法进行预处理滤除噪声点;利用指数分布来近似激光数据点的后验分布,通过动态阈值法对激光测量数据点集进行区域分割,激光测量数据点经过区域分割后分为N个区域块,对区域内的数据点利用黄金分割的方法进行线段拟合;通过Hough变换结合面积阈值的方法对特征墙角进行提取,实现从图像空间到参数空间的转换建立局部环境地图,通过采用扇形匹配方法实现局部地图的融合。本发明具有计算简单准确度高,提升算法执行的快速性的优点。
申请公布号 CN103198751B 申请公布日期 2015.03.04
申请号 CN201310069985.9 申请日期 2013.03.06
申请人 南京邮电大学 发明人 梁志伟;邵长勉
分类号 G09B29/00(2006.01)I;G06T5/00(2006.01)I;G06T7/00(2006.01)I 主分类号 G09B29/00(2006.01)I
代理机构 南京经纬专利商标代理有限公司 32200 代理人 朱小兵
主权项 一种移动机器人基于激光测距仪的线特征地图创建方法,其特征在于,包括以下步骤:步骤(1),首先启动激光测距仪对外部环境进行扫描,再对扫描的激光数据进行预处理滤除噪声点后得到激光测量数据点集;步骤(2),通过动态阈值法对激光测量数据点集进行区域分割,激光测量数据点集经过区域分割后分为N个区域块,其中N为大于1的自然数;步骤(3),对各区域块内的数据点采用构建激光数据的后验指数分布,以黄金分割的方法进行数据的迭代进行拟合;具体步骤为:步骤(31):取出一帧数据中的一个区域,对该区域中的n个数据点进行编号:X<sub>1</sub>X<sub>2</sub>…X<sub>n‑1</sub>X<sub>n</sub>;步骤(32):连接点X<sub>1</sub>,X<sub>n</sub>建立线段L<sub>1</sub>,假设数据点X<sub>2</sub>…X<sub>n</sub>满足指数分布,则点X<sub>i</sub>的概率为p<sub>i</sub>=1‑e<sup>‑λd(i‑1)</sup>,i=2...n,n代表数据点的个数,λ为分布参数,d为相邻点之间的距离;步骤(33):根据<img file="FDA0000617738410000011.GIF" wi="364" he="117" />计算点X<sub>2</sub>…X<sub>n‑1</sub>X<sub>n</sub>的不确定度H,取出当前环境中的一条已知线段,通过激光测距仪扫描后计算出直线上的数据点数m,利用公式<img file="FDA0000617738410000012.GIF" wi="346" he="126" />计算出此时的不确定度阈值h,以此时的阈值h作为标准值,当H&lt;h时,区域线段拟合用线段L<sub>1</sub>近似;当H&gt;h时,直线拟合失败,转到步骤(34);步骤(34):对线段L<sub>1</sub>进行黄金分割,截取线段L<sub>1</sub>的0.618长度时,找出离此时线段L<sub>1</sub>末端点最近的点X<sub>i</sub>,连接点X<sub>1</sub>和X<sub>i</sub>建立直线L<sub>2</sub>完成区域线段拟合;步骤(35):循环步骤(32)‑步骤(34),直至分割的所有区域块内的数据点完成拟合;步骤(4),通过对特征墙角进行提取实现从图像空间到参数空间的转换,建立局部环境地图,通过匹配把局部环境地图融合到全局地图中以构建全局环境地图。
地址 210003 江苏省南京市鼓楼区新模范马路66号