CN103400416B - 一种基于概率多层地形的城市环境机器人导航方法 - Google Patents
一种基于概率多层地形的城市环境机器人导航方法 Download PDFInfo
- Publication number
- CN103400416B CN103400416B CN201310358592.XA CN201310358592A CN103400416B CN 103400416 B CN103400416 B CN 103400416B CN 201310358592 A CN201310358592 A CN 201310358592A CN 103400416 B CN103400416 B CN 103400416B
- Authority
- CN
- China
- Prior art keywords
- grid
- value
- landform
- height
- heap
- 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.)
- Expired - Fee Related
Links
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种基于概率多层地形的城市环境机器人导航方法,首先通过安装在云台上的低成本激光传感器对地形进行扫描、滤波和概率变换以获得全局坐标下的概率化点云表示;其次通过网格化地形划分方法,把点云数据关联到相应的若干网格之中;然后对网格内关联的点云数据进行概率融合,形成可表示多层次地形的堆数据,完成地形的建模过程;最后对得到的多层概率地形进行穿越性分析以形成安全有效的机器人行走路径。本发明在保证实时性的前提下,通过概率化处理和引入多层堆结构实现了对城市地形环境的精确建模和导航,对于城市立体化导航服务、侦察救援、GIS***等相关领域均具有非常重要的经济价值和应用前景。
Description
技术领域
本发明涉及一种基于概率多层地形的城市环境机器人导航方法,特别是大尺度城市化环境移动机器人的地形精确建模和导航方法,属于城市立体化导航服务、地面或空中无人自主平台技术、地理信息***(GIS)等应用领域。
背景技术
随着无人自主驾驶、军事侦察和救援、无人机、城市立体化导航服务等应用领域的日益扩展,针对于特定城市环境中移动机器人的地形建模和导航能力的相关应用研究正日益成为业界的热点问题,并逐渐产生了较为广泛的经济需求。这些需求不同于现有的室内移动机器人建模方法,对于非结构化环境的精确表达和实时导航能力提出了更高的要求,其安全性和效率指标更难得到满足。
目前常用的室外三维环境感知方法多采用声纳、激光、单目视觉、立体视觉等方式解决,其中二维扫描激光由于其低成本、高精度、处理快等突出特点受到业界的广泛关注和青睐,围绕其开发的地形建模方法主要包括点云图、voxel图和高程地图等。其中点云图直接采用原始地形测量信息表示,方法简明直接,但只适用于稀疏特征地形表示,且不便于后期导航处理;voxel图在点云图的基础上作了一定的压缩处理操作,可产生致密地形表示,但地形的创建和更新处理速度将随环境尺度的增大而急剧下降;数字高程地图来自地理信息领域,通过二维网格划分对原始地形数据进行融合处理以降低计算复杂度,但相应地形表达方式较粗糙,所能反映的地形特征极为有限,无法用于复杂的城市环境。
总的来说,上述常用的室外地形环境建模方法在应用与城市化环境导航中存在以下问题:1)未考虑激光传感器测量过程中的各种不确定性因素影响,因而导致所建立的地形模型和相应导航方法缺乏容错性,易受环境干扰,只能针对特定应用实施;2)所采用的地形环境过于简单,无法深刻反映现实环境的复杂性和多样性,特别是无法对城市环境中所存在的各种垂直结构(墙体等)或多层次结构(例如树、桥梁、山洞等)进行精确描述,大范围导航性能受到制约,甚至无法找到正确有效的导航路径。
发明内容
本发明的目的是为了克服已有的技术缺陷,解决特定城市化环境中移动机器人的建模和自主导航方法所存在的易受各种不确定性干扰影响、对城市环境的表达不充分等缺陷导致的相应自主导航能力弱、缺乏容错性和鲁棒性的问题,提出了一种基于概率多层地形的城市环境机器人导航方法,实现城市地形环境的安全可靠导航。
本发明采用的技术方案为:一种基于概率多层地形的城市环境机器人导航方法,首先通过安装在云台上的低成本激光传感器对地形进行扫描、滤波和概率变换以获得全局坐标下的概率化点云表示。其次通过网格化地形划分方法,把点云数据关联到相应的若干网格之中。然后对网格内关联的点云数据进行概率融合,形成可表示多层次地形的堆数据,完成地形的建模过程。最后对得到的多层概率地形进行穿越性分析以形成安全有效的机器人行走路径。
(1)三维地形信息的获取和概率化点云的生成:首先通过安装在激光云台上的二维激光传感器获得机器人周围环境的测量信息;考虑到激光测量数据、里程计和GPS测量数据的误差,把激光的测量数据、里程计和GPS测量数据进行高斯模型概率化;然后采用卡尔曼滤波的方法对里程计和GPS数据进行融合,以获得机器人当前位置的全局坐标;最后通过结合机器人当前的全局坐标,通过坐标变换得到测量值在全局坐标下的概率化点云表示。
(2)地形网格的划分和相应点云数据的关联:首先把地面划分成网格;然后对已经得到的测量值在全局坐标下的概率表示,采用高斯分布的3σ值作为不确定性边界关联到多个网格中并且计算出测量值属于这个网格的概率大小。
(3)多层地形堆结构的融合和更新:每个网格上可能关联多个测量值,首先计算每个测量值在网格上的高度的高斯概率分布,其次把测量值分配到堆上,通过判断已有的堆与刚分配堆之间的垂直距离大小来进行融合。
(4)地形可穿越性分析和导航路径生成:在构建出多层地形的基础上,对每层的地形进行平坦性分析,考虑到机器人自身机械结构特征和其穿越能力分割出可行进区域与障碍区域,最后得到机器人的行走路径。
有益效果:本发明采用低成本的激光扫描装置有效地解决了特定城市化环境中大尺度地形环境的表示和导航问题,通过概率化多层地形模型的创建和相应穿越性能的分析,提高了地形建模的精度,保证了整体算法在实际应用中的实时性。此方法简单高效,能够满足移动机器人在城市立体化导航、军事侦察和救援、无人机、GIS地理信息***等领域的广泛需求,具有广阔的应用前景和良好的经济效益。
附图说明
图1为:算法总体流程图;
图2为:三维地形数据获取流程图;
图3为:激光扫描感知示意图;
图4为:数据关联到网格流程图;
图5为:高斯椭球投影示意图;
图6为:多层结构堆示意图;
图7为:堆的处理和融合流程图;
图8-11为:堆融合示意图;
具体实施方式
下面结合附图和具体实施方式对本发明做进一步说明。
图1为本专利所提出的基于概率多层地形的城市环境机器人导航方法的总体流程图,算法的具体步骤如下:
1、三维地形信息的获取和概率化点云的生成
环境三维数据的获取是进行后续地形建模的前提,首先通过二维激光传感器获得周围环境的距离信息;其次把激光的测量数据、里程计和GPS数据通过高斯模型进行概率化;然后采用卡尔曼滤波的方法,利用里程计和GPS数据对机器人进行融合定位,以获得机器人当前位置的全局坐标;最后通过结合机器人当前的全局坐标,通过坐标变换得到测量值在全局坐标下的概率化点云表示。算法的流程图如图2所示,具体步骤包括:
第一步:获得距离信息。由安装在激光云台上的二维激光传感器,通过激光云台的俯仰、旋转获得地形感知的原始距离数据。
第二步:激光数据的高斯概率化。由于激光传感器本身的测量误差,为提高地形建模的精度,对这些测量信息用高斯模型建模。假设激光传感器得到的距离信息为r, 其中表示方差,表示真实值。
第三步:里程计和GPS测量数据的概率化。由于里程计和GPS测量数据的误差的存在,对这些测量信息也用高斯模型建模。里程计和GPS得到的测量信息为x,y,θ,L,B,H,记为p,,其中表示真实值。
第四步:机器人的定位。采用里程计和GPS进行Kalman滤波组合定位。GPS数据消除里程计定位的累计误差。机器人存在平动速度v和转动速度ω,其位姿状态量为pr=(x,y,θ)T,则可建立其离散的运动学模型为:
第五步:转化成三维坐标。如图3所示,测量数据转化成三维坐标涉及到多个坐标变换。首先求得测量数据在X1O1Y1中的坐标(x1,y1),然后将(x1,y1)变换到ORXRYRZR坐标中(xR,yR,zR),最后利用里程计和GPS得到的机器人在全局坐标中的坐标,最终得到测量点的全局坐标(xw,yw,zw)用x表示,转化过程记为:
第六步:计算测量值的概率化点云表示。对上式(1)进行线性化可得:
其中和表示f相对于的雅克比矩阵。由此测量点的三维坐标的概率表示近似为高斯分布
其中QP和Qr分别表示p和r的均方差矩阵。
2、地形网格的划分和相应点云数据的关联
首先把地面划分成网格;然后对已经得到的测量值在全局坐标下的概率表示,采用高斯分布的3σ值作为不确定性边界关联到多个网格中并且计算出测量值属于这个网格的概率大小。算法的流程图见图4,具体步骤包括:
第一步:划分网格。将地面划分成大小为cell_size的方格,每个网格用中心点坐标表示即为(xi,yi)。划分网格时要综合考虑路径规划的精度、实时性等要求。网格的划分不宜太大,否则影响精度,而如果划分太小又会影响实时性。
第二步:计算高斯椭球在平面上的投影。计算(xw,yw)的联合概率分布,(xw,yw)直接从(xw,yw,zw)中得到,可以从P中取左上角的2×2维矩阵得到。
第三步:确定x,y方向的边界,取3σ作为其投影的边界。 如图5所示。
第四步:根据边界确定关联的网格。关联的网格用集合S表示。
第五步:针对每一个网格计算关联概率。计算概率用黎曼和(RiemannSum)近似,即所求的概率p为网格的面积乘以椭球面在网格中心处投影高度。
3、多层地形堆结构的融合和更新
多层结构的堆示意图如图6所示,每个网格上可能关联多个测量值,首先计算每个测量值在网格上的高度的高斯概率分布,其次把测量值分配到堆上,然后通过判断已有的堆与刚分配堆之间的垂直距离大小来进行融合。算法的流程图如图7所示,具体步骤包括:
第一步:计算测量值高度的概率分布。每个测量值属于不同网格的概率,其表述为那么这个测量数据在某个网格上的高度的概率分布计算实际上是一个条件分布,即已知(xw,yw)属于某个网格,求h的分布。所求的h的分布为计算式如下:
其协方差为:
第二步:测量分配到堆上。测量值分配到堆上要考虑测量值与该网格上已经存在的堆的高度关系。激光测量与网格中所有高度堆之间的融合方式可以分为以下四种情况:
1)测量值恰好在某堆中。
如图8所示,P1表示网格已存在的高度堆,P1对应的高度值为u1,厚度值为d1,此时测量的高度估计h恰好分布在堆中间,因此无需对多层信息进行更新。
2)测量与某一堆融合
如图9所示,P1和P1表示网格已存在的高度堆,P1对应的高度值为u1,厚度值为d1,P2对应的高度值为u2,厚度值为d2。此时测量的高度估计h不在任何堆中。其中Δh1大于设定的阈值hm(hm的设定要考虑机器人的高度),而Δh2小于设定的阈值,这时将p2与h进行融合成一个堆。新堆的高度为厚度为d2+Δh2。
3)测量与某两堆融合
如图10所示,P1和P1表示网格已存在的高度堆,P1对应的高度值为u1,厚度值为d1,P2对应的高度值为u2,厚度值为d2。此时测量的高程估计h并不在任何堆中。其中Δh1和Δh2都小于设定的阈值hm,这时将这三个堆融合成一个堆。新堆的高度为u1,厚度为d1+d2+Δh1+Δh2。
4)测量单独成堆
如图11所示,P1表示网格已存在的高度堆,P1对应的高度值为u1,厚度值为d1,P2对应的高度值为u2,厚度值为d2。此时测量的高程估计h并不在堆中,其中Δh1和Δh2都大于设定的阈值hm,这时不进行任何的融合。测量所对应的堆的高度为厚度为
4、地形可穿越性分析和导航路径生成
在构建出多层地形的基础上,对每层的地形进行平坦性分析,考虑到机器人自身机械结构特征和其穿越能力分割出可行进区域与障碍区域。
第一步:计算某一网格梯度。网格的梯度采用式(8)进行计算。
其中g(m,n)代表在一高度层中网格(m,n)上相应地形高度变化梯度的模,即对一个3×3的栅格区域进行分析,并取邻近高度差最大变化值作为近似的梯度模值。
第二步:计算某一网格的可穿越性。网格的可穿越性分析采用式(9)。
在上述分析的基础上运用式(9)对环境的可行进区域与障碍区域进行估计,其中map(m,n)表示地形的可穿越性,map(m,n)=0表示该网格是可以穿越,map(m,n)=1表示该网格不可穿越。zm是根据机器人的高度设定的阈值。
第三步:形成行走路径。计算出所有网格的可穿越性之后,采用A*算法进行路径的规划形成机器人的最短有效行走路径。
应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。本实施例中未明确的各组成部分均可用现有技术加以实现。
Claims (1)
1.一种基于概率多层地形的城市环境机器人导航方法,其特征在于:包括以下步骤:
(1)通过安装在激光云台上的二维激光传感器获得机器人周围环境的测量信息;考虑到激光测量数据、里程计和GPS测量数据的误差,把测量数据进行高斯模型概率化;然后采用卡尔曼滤波对里程计和GPS数据进行融合,以获得机器人当前位置的全局坐标;最后通过结合机器人当前的全局坐标,通过坐标变换得到测量值在全局坐标下的概率化点云表示;
(2)把地面划分成网格;然后对已经得到的测量值在全局坐标下的概率表示,采用高斯分布的3σ值作为不确定性边界关联到多个网格中并且计算出测量值属于这个网格的概率大小;
(3)每个网格上可能关联多个测量值,首先计算每个测量值在网格上的高度的高斯概率分布,其次把测量值分配到堆上,通过判断该测量值与网格中已有的高度堆之间的垂直距离大小来进行融合;激光测量值与网格中所有高度堆之间的融合方式可以分为以下四种情况:
1)测量值恰好落在某堆中:此时无需对多层信息进行更新;
2)测量值与某一堆融合:P1和P2表示网格已存在的高度堆,P1对应的高度值为u1,厚度值为d1,P2对应的高度值为u2,厚度值为d2;此时测量的高度估计h不在任何堆中,与两个堆的距离分别为Δh1和Δh2;其中Δh1大于设定的阈值hm,而Δh2小于设定的阈值,这时将P2与h进行融合成一个堆;
3)测量值与某两堆融合:P1和P2表示网格已存在的高度堆,P1对应的高度值为u1,厚度值为d1,P2对应的高度值为u2,厚度值为d2;此时测量的高程估计h并不在任何堆中,与两个堆的距离分别为Δh1和Δh2;其中Δh1和Δh2都小于设定的阈值hm,这时将测量值与高度堆P1和P2融合成一个堆;新堆的高度为u1,厚度为d1+d2+Δh1+Δh2;
4)测量值单独成堆:P1表示网格已存在的高度堆,P1对应的高度值为u1,厚度值为d1,P2对应的高度值为u2,厚度值为d2;此时测量的高程估计h并不在堆中,与两个堆的距离分别为Δh1和Δh2;其中Δh1和Δh2都大于设定的阈值hm,这时不进行任何的融合;
(4)在构建出多层地形的基础上,对每层的地形进行平坦性分析,考虑到机器人自身机械结构特征和其穿越能力分割出可行进区域与障碍区域,从而形成机器人的行走路径;
第一步:计算某一网格梯度;网格的梯度计算为
g(m,n)≈max{|z(m,n)-z(m+i,n+j)|i,j=-1,0,1}
其中g(m,n)代表在一高度层中网格(m,n)上相应地形高度变化梯度的模,即对一个3×3的栅格区域进行分析,并取邻近高度差最大变化值作为近似的梯度模值;
第二步:计算某一网格的可穿越性;网格的可穿越性分析采用下式:
在上述分析的基础上运用上式对环境的可行进区域与障碍区域进行估计,其中map(m,n)表示地形的可穿越性,map(m,n)=0表示该网格是可以穿越,map(m,n)=1表示该网格不可穿越;zm是根据机器人的高度设定的阈值;
第三步:形成行走路径;计算出所有网格的可穿越性之后,采用A*算法进行路径的规划形成机器人的最短有效行走路径。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310358592.XA CN103400416B (zh) | 2013-08-15 | 2013-08-15 | 一种基于概率多层地形的城市环境机器人导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310358592.XA CN103400416B (zh) | 2013-08-15 | 2013-08-15 | 一种基于概率多层地形的城市环境机器人导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103400416A CN103400416A (zh) | 2013-11-20 |
CN103400416B true CN103400416B (zh) | 2016-01-13 |
Family
ID=49564027
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310358592.XA Expired - Fee Related CN103400416B (zh) | 2013-08-15 | 2013-08-15 | 一种基于概率多层地形的城市环境机器人导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103400416B (zh) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104457566A (zh) * | 2014-11-10 | 2015-03-25 | 西北工业大学 | 一种无须示教机器人***的空间定位方法 |
CN106325268A (zh) * | 2015-06-30 | 2017-01-11 | 芋头科技(杭州)有限公司 | 一种移动控制装置及移动控制方法 |
CN105608417B (zh) * | 2015-12-15 | 2018-11-06 | 福州华鹰重工机械有限公司 | 交通信号灯检测方法及装置 |
CN105573318B (zh) * | 2015-12-15 | 2018-06-12 | 中国北方车辆研究所 | 基于概率分析的环境构建方法 |
CN108241365B (zh) * | 2016-12-27 | 2021-08-24 | 法法汽车(中国)有限公司 | 估计空间占据的方法和装置 |
CN106802668B (zh) * | 2017-02-16 | 2020-11-17 | 上海交通大学 | 基于双目与超声波融合的无人机三维避撞方法及*** |
CN108334080B (zh) * | 2018-01-18 | 2021-01-05 | 大连理工大学 | 一种针对机器人导航的虚拟墙自动生成方法 |
CN108415035B (zh) * | 2018-02-06 | 2019-08-02 | 北京三快在线科技有限公司 | 一种激光点云数据的处理方法及装置 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102087530A (zh) * | 2010-12-07 | 2011-06-08 | 东南大学 | 基于手绘地图和路径的移动机器人视觉导航方法 |
CN102831646A (zh) * | 2012-08-13 | 2012-12-19 | 东南大学 | 一种基于扫描激光的大尺度三维地形建模方法 |
CN102359784B (zh) * | 2011-08-01 | 2013-07-24 | 东北大学 | 一种室内移动机器人自主导航避障***及方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10088317B2 (en) * | 2011-06-09 | 2018-10-02 | Microsoft Technologies Licensing, LLC | Hybrid-approach for localization of an agent |
-
2013
- 2013-08-15 CN CN201310358592.XA patent/CN103400416B/zh not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102087530A (zh) * | 2010-12-07 | 2011-06-08 | 东南大学 | 基于手绘地图和路径的移动机器人视觉导航方法 |
CN102359784B (zh) * | 2011-08-01 | 2013-07-24 | 东北大学 | 一种室内移动机器人自主导航避障***及方法 |
CN102831646A (zh) * | 2012-08-13 | 2012-12-19 | 东南大学 | 一种基于扫描激光的大尺度三维地形建模方法 |
Non-Patent Citations (2)
Title |
---|
Rapid Traversability Assesment in 2.5 D Grid;Gu J et al.;《Internationl Journal of Advanced》;20081231;第5卷(第4期);第389-394页 * |
基于激光扫描的移动机器人3D室外环境实时建模;周波等;《机器人》;20120531;第34卷(第3期);第321-328页第2,4节 * |
Also Published As
Publication number | Publication date |
---|---|
CN103400416A (zh) | 2013-11-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103400416B (zh) | 一种基于概率多层地形的城市环境机器人导航方法 | |
CN111551958B (zh) | 一种面向矿区无人驾驶的高精地图制作方法 | |
CN107356252B (zh) | 一种融合视觉里程计与物理里程计的室内机器人定位方法 | |
CN102506824B (zh) | 一种城市低空无人机***生成数字正射影像图的方法 | |
CN101509781B (zh) | 基于单目摄像头的步行机器人定位*** | |
CN102042835B (zh) | 自主式水下机器人组合导航*** | |
CN102831646A (zh) | 一种基于扫描激光的大尺度三维地形建模方法 | |
CN102288176B (zh) | 基于信息融合的煤矿救灾机器人导航***及方法 | |
CN103412565B (zh) | 一种具有全局位置快速估计能力的机器人定位方法 | |
CN104330090A (zh) | 机器人分布式表征智能语义地图创建方法 | |
CN103017739A (zh) | 基于激光雷达点云与航空影像的真正射影像的制作方法 | |
CN105043396A (zh) | 一种移动机器人室内自建地图的方法和*** | |
CN106887020A (zh) | 一种基于LiDAR点云的道路纵横断面获取方法 | |
CN105783810A (zh) | 基于无人机摄影技术的工程土方量测量方法 | |
CN110220502A (zh) | 一种基于立体监测技术的涉水建筑动态监测方法 | |
CN112100715A (zh) | 一种基于三维倾斜摄影技术的土方优化方法及*** | |
CN104406589B (zh) | 一种飞行器穿越雷达区的飞行方法 | |
CN102155913A (zh) | 基于图像和激光的煤堆体积自动测量方法及装置 | |
CN109975817A (zh) | 一种变电站巡检机器人定位导航方法及*** | |
CN101858730A (zh) | 一种自动测量煤堆体积的方法及其专用装置 | |
CN107607093A (zh) | 一种基于无人艇的湖泊动态库容的监测方法及装置 | |
CN108387236A (zh) | 一种基于扩展卡尔曼滤波的偏振光slam方法 | |
CN104457691A (zh) | 一种建筑物主体高程信息获取方法 | |
CN106652030A (zh) | 三维数字航道图的生成与发布方法 | |
Wang et al. | Micro aerial vehicle navigation with visual-inertial integration aided by structured light |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20160113 Termination date: 20210815 |
|
CF01 | Termination of patent right due to non-payment of annual fee |