CN114600054A - 计算机实施的创建用于运行移动智能体的环境地图的方法 - Google Patents
计算机实施的创建用于运行移动智能体的环境地图的方法 Download PDFInfo
- Publication number
- CN114600054A CN114600054A CN202080077334.2A CN202080077334A CN114600054A CN 114600054 A CN114600054 A CN 114600054A CN 202080077334 A CN202080077334 A CN 202080077334A CN 114600054 A CN114600054 A CN 114600054A
- Authority
- CN
- China
- Prior art keywords
- manhattan
- orientation
- mobile agent
- pose
- determined
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 44
- 230000004807 localization Effects 0.000 claims abstract description 3
- 238000001514 detection method Methods 0.000 claims description 18
- 230000033001 locomotion Effects 0.000 claims description 11
- 238000005259 measurement Methods 0.000 claims description 9
- 238000011524 similarity measure Methods 0.000 claims description 7
- 230000008859 change Effects 0.000 claims description 6
- 238000010606 normalization Methods 0.000 claims description 5
- 238000004590 computer program Methods 0.000 claims 3
- 239000003795 chemical substances by application Substances 0.000 description 73
- 238000005457 optimization Methods 0.000 description 10
- 230000009466 transformation Effects 0.000 description 10
- 238000010586 diagram Methods 0.000 description 7
- 238000013459 approach Methods 0.000 description 3
- 230000010354 integration Effects 0.000 description 3
- 230000007613 environmental effect Effects 0.000 description 2
- 239000011159 matrix material Substances 0.000 description 2
- 239000000523 sample Substances 0.000 description 2
- 230000007704 transition Effects 0.000 description 2
- 238000009825 accumulation Methods 0.000 description 1
- 238000004140 cleaning Methods 0.000 description 1
- 238000005094 computer simulation Methods 0.000 description 1
- 238000007796 conventional method Methods 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000009826 distribution Methods 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000007781 pre-processing Methods 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 230000000717 retained effect Effects 0.000 description 1
- 238000000926 separation method Methods 0.000 description 1
- 230000003595 spectral effect Effects 0.000 description 1
- 238000001228 spectrum Methods 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
- 238000013519 translation Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/0274—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
- G05D1/024—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
-
- 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
- G01C21/206—Instruments for performing navigational calculations specially adapted for indoor navigation
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/20—Control system inputs
- G05D1/24—Arrangements for determining position or orientation
- G05D1/242—Means based on the reflection of waves generated by the vehicle
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/20—Control system inputs
- G05D1/24—Arrangements for determining position or orientation
- G05D1/246—Arrangements for determining position or orientation using environment maps, e.g. simultaneous localisation and mapping [SLAM]
- G05D1/2464—Arrangements for determining position or orientation using environment maps, e.g. simultaneous localisation and mapping [SLAM] using an occupancy grid
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D2109/00—Types of controlled vehicles
- G05D2109/10—Land vehicles
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D2111/00—Details of signals used for control of position, course, altitude or attitude of land, water, air or space vehicles
- G05D2111/10—Optical signals
- G05D2111/17—Coherent light, e.g. laser signals
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Optics & Photonics (AREA)
- Electromagnetism (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及一种计算机实施的用于基于环境中的移动智能体(1)的姿态来运行该移动智能体(1)的方法,其中为了运行移动智能体(1),利用下列步骤来执行对该移动智能体(1)的定位:‑检测(S1)关于位于环境中的墙壁(2)和/或对象(3)的传感器数据,其中所述传感器数据说明墙壁(2)和/或对象(3)在相对于智能体固定的智能体坐标系(A)中的对齐和距离;‑在考虑曼哈顿定向的情况下,借助SLAM算法确定(S11‑S18)所述环境中的移动智能体(1)的姿态。
Description
技术领域
本发明涉及自主控制在运动区域之内的移动智能体(eines mobilen Agenten)的领域。尤其是,本发明涉及用于对环境中的移动智能体进行定位的方法。
背景技术
移动智能体对于许多应用而言是已知的。在此,移动智能体要在配备有界限(墙壁)和障碍物(对象)的环境中独立运动。这样的移动智能体例如可以包括机器人、车辆、自主清洁机器人、自主割草机和这一类的。
如下能力是针对在通过传感器数据定义的环境之内的运动路径的轨迹规划的基础:确定在该环境中的移动智能体的准确姿态(位置和定向),和确定与准确姿态关联的环境地图。
用于创建环境地图的传统行为方式设置了,使用移动智能体的环境检测传感装置,所述环境检测传感装置例如可以包括激光雷达系统、摄像机、惯性传感装置、量距传感装置(Odometriesensorik)和这一类的。为了创建环境地图,移动智能体在通常情况下以受控的方式或者自动地运动,并对环境检测传感装置的传感器数据进行评估,以便创建环境地图。
用于创建环境地图的传统方法设置了,应用所谓的SLAM算法,该SLAM算法处理环境检测传感装置的所记录的数据,并据此确定移动智能体的姿态,而且确定相对应的环境地图。
发明内容
根据本发明,设置了根据权利要求1所述的一种用于定位在环境之内的移动智能体的方法,以及设置了根据并列的权利要求所述的一种用于定位移动智能体的设备、一种用于控制环境中的移动智能体的设备以及一种移动智能体。
其他构建方案在从属权利要求中予以说明。
根据第一方面,设置了一种用于基于环境中的移动智能体的姿态来运行该移动智能体的方法,其中利用下列步骤来执行对移动智能体的定位:
- 检测关于位于环境中的墙壁和/或对象的传感器数据,其中所述传感器数据说明墙壁和/或对象在相对于智能体固定的(agentenfesten)智能体坐标系中的对齐和距离;
- 在考虑曼哈顿定向(Manhattan-Orientierung)的情况下,借助SLAM算法确定环境中的移动智能体的姿态。
用于定位移动智能体的SLAM算法、也就是说用于确定在环境之内的移动智能体的绝对姿态的SLAM算法的根本缺点在于,所检测到的传感器数据的漂移累积。尤其是,由于耦合,关于所确定的定向的检测误差造成移动智能体的被耦合的位置的极大漂移。虽然定向漂移可以通过直接测量对齐来得到补偿,可是这种直接测量对齐在通常情况下只通过罗盘仪测量而是可能的,所述罗盘仪测量在很多情形下是不可用的,尤其是在应用在建筑物中或者在由于杂散磁场而强烈地被加负荷的环境中是不可用的。
上述的方法设置了,将SLAM算法与曼哈顿世界的假设相结合。曼哈顿世界概念在于,许多人工环境都具有规则的结构,尤其是许多墙壁彼此平行或者成直角,并且墙壁通常在较长路段上直线地伸展,而且是平坦的。例如,曼哈顿世界概念在出版文献B. Beasley等人的“Accurate On-Line 3D Occupancy Grids Using Manhattan World Constraints”(2012年,IEEE/RSJ International Conference on Intelligent Robots and Systems,维拉摩拉(Vilamoura),第5283至5290页)中是已知的。
此外,SLAM算法可以设置与传感器数据的测量误差有关的误差函数的最小化,所述误差函数与曼哈顿定向有关。
根据一个实施形式,SLAM算法可以对应于基于具有节点和边的SLAM图的基于图的SLAM算法,其中所述SLAM图具有分别说明移动智能体的从传感器数据中确定的姿态的姿态节点,并且具有在各两个姿态节点之间的变换边,其中变换边说明在与各两个姿态节点关联的姿态之间的从传感器数据中所确定的姿态变化,其中根据曼哈顿定向,添加曼哈顿节点和在该曼哈顿节点与姿态节点之一之间的至少一个曼哈顿边。
此外,SLAM算法可以使用从SLAM图中确定的误差函数,与节点和边关联的误差概率考虑所述误差函数,其确定与SLAM图的节点关联的经过修正的姿态。
原则上,本方法设置了,对用于2D环境的传统SLAM算法进行改进。传统SLAM算法可以构建为基于图的SLAM算法,并设置了创建如下图:所述图具有姿态节点和在各两个姿态节点之间的变换边。姿态节点表示移动智能体的通过环境检测传感装置检测到的姿态,并且变换边表示在移动智能体的两个不同姿态之间的所测量的姿态变化。关于参考坐标系来说明姿态,所述参考坐标系关于环境是位置固定的。
由于噪声或者另外的测量误差,不可能的是,确切地分解这些图,使得移动智能体的通过姿态节点说明的姿态与移动智能体的通过变换边说明的所测量的运动相一致。替代于此地,所确定的姿态和运动利用误差概率来说明,并且为了确定移动智能体的确切姿态而使误差函数最小化,所述误差函数关于所有变换边求和。尤其是,借助传统的优化方法、如例如高斯-牛顿(Gauss-Newton)或者莱文贝格-马夸特(Levenberg-Marquardt),进行最小化。
基于曼哈顿世界概念,可以给图添加其他节点和边。针对在检测步骤中的有效的曼哈顿定向的每次确定,可以将曼哈顿节点和在姿态节点之一与所涉及的曼哈顿节点之间的曼哈顿边插入到SLAM图中。那么,随后的用于最小化误差的优化算法使用附加的边界条件,所述附加的边界条件通过曼哈顿定向预先给定,以便不仅确定每个姿态节点的姿态。那么,参考坐标系统可以被对齐到曼哈顿定向上。
上述的方法能够实现,在每个检测周期中探测曼哈顿定向,以便确定曼哈顿定向作为在从-45°直至+45°的范围中的角度。
尤其是,上述的方法不需要参考之前的检测周期,并且也可以被应用于仅部分对应于曼哈顿世界的环境中。通过明确地图示曼哈顿定向,可能的是,将参考坐标系对齐到曼哈顿定向上,以便这样提供与参考坐标系对齐的环境地图。通过不断地重新评价传感器数据,取消用于找到与之前的检测周期的配对物的方法。
此外,可以从传感器数据中确定点集,所述点集说明所检测到的墙壁和/或对象的坐标,其中该点集中的点被联合成彼此相邻的局部单元,其中曼哈顿归一化被应用到如下那些单元:所述单元具有带有直线的或者90°结构的单元定向,其中曼哈顿定向根据在局部单元中的直线结构的主导定向来确定。
尤其是,为了确定这些单元的主导定向,可以针对一个单元的每个单元定向都确定与所有另外的单元定向的相似性,并且针对每个单元确定相似性度量(例如作为L2间距),尤其是确定为由相应的单元关于其余单元的相似性构成的和,其中曼哈顿定向对应于这些单元中的根据相似性度量所选择的一个单元的单元定向,尤其是该单元的相似性度量是最大的。
此外,根据在单元定向中的各两个单元定向之间的经过曼哈顿归一化的定向差,可以执行相似性的确定,其中尤其是根据负的经过曼哈顿归一化的差的指数函数来确定这些相似性。
可以设置,只有当这些单元的预先给定数目以上的单元定向位于经过曼哈顿归一化的与确定的曼哈顿定向的定向差之内,那么才考虑所述确定的曼哈顿定向。
根据一个实施形式,可以借助移动智能体的当前姿态来确定环境地图,其中移动智能体根据环境地图来运行。例如,环境地图和移动智能体的姿态可被用于根据轨迹规划问题进行轨迹规划。
根据其他方面,设置了一种用于基于环境中的移动智能体的姿态来运行该移动智能体的设备、尤其是控制单元,其中该设备构造为,利用下列步骤来执行对移动智能体的定位:
- 检测关于位于环境中的墙壁和/或对象的传感器数据,其中所述传感器数据说明墙壁和/或对象在相对于智能体固定的智能体坐标系中的对齐和距离;
- 在考虑曼哈顿定向的情况下,借助SLAM算法确定环境中的移动智能体的姿态。
根据其他方面,设置了一种移动智能体,该移动智能体具有上述设备、用于提供传感器数据的环境检测传感装置并且具有运动致动装置,所述运动致动装置构造为,以便使移动智能体运动。
附图说明
随后,依据所附的附图更详细地阐述了实施形式。
图1示出了在要检测的环境之内的移动智能体的示意图;
图2示出了用于阐明用于确定在环境之内的移动智能体的姿态的方法的流程图;
图3示出了如下图的示意图:所述图在SLAM算法的范围中被创建,以便确定移动智能体的姿态;
图4示出了用于阐明曼哈顿定向的确定的流程图;
图5a示出了通过传统的SLAM算法检测环境地图的示意图,以及
图5b示出了在考虑曼哈顿世界概念的情况下基于SLAM算法的所检测到的环境地图的图示。
具体实施方式
图1示出了在利用墙壁2和对象3定义的环境中的移动智能体1的示意图。该环境对应于典型的环境,如其对于室内房间、工厂车间或者城市地区常见的那样,并且具有彼此平行地和/或彼此成直角地伸展的墙壁和/或对象边。
移动智能体1具有控制单元11,以便控制该移动智能体1。此外,移动智能体1具有环境检测传感装置12,以便关于智能体坐标系A来检测围绕着的墙壁和对象2、3的方向和间距。此外,移动智能体1具有运动致动装置13,以便使移动智能体1根据要实施的功能在环境之内运动。
环境传感装置12可以具有下列传感器装置中的至少一种:激光雷达装置、雷达装置、激光扫描装置、摄像机、惯性传感装置、量距传感装置和这一类的。根据视所使用的传感器装置而定的预处理,在控制单元11中处理传感器数据,使得关于智能体坐标系A可以确定并提供墙壁或者对象2、3的对齐和距离。为了确定环境地图,确定移动智能体1相对于位置固定的参考坐标系K的姿态。接着,从在移动智能体1的智能体坐标系A与参考坐标系K之间的位置偏移中,并且从在智能体坐标系与参考坐标系之间的旋转差中,得到移动智能体1的姿态。
从移动智能体1在参考坐标系中的姿态中,接着可以基于传感器数据来确定墙壁2和对象3在智能体坐标系中的经过修正的位置。
为了确定说明墙壁2和对象3在参考坐标系中的位置的环境地图,并且为了确定移动智能体1的当前姿态,在控制单元11中实施如结合图2的流程图更详细地阐述的方法。该方法可以实施为控制设备中的软件和/或硬件算法。在下文,示例性地针对二维环境来描述该方法。
在步骤S1中,借助环境检测传感装置12,在检测步骤中检测传感器数据,所述传感器数据从移动智能体1的角度说明一个或者多个墙壁和对象2、3的方位(关于代理坐标系的距离和定向)。传感器数据逐点地说明与墙壁2和障碍物/对象3在相应的定向上的距离的测量坐标,使得可以从(相对于代理坐标系的)对齐角度和距离中确定所涉及的墙壁或者所涉及的对象3关于移动代理1的相对位置。例如借助激光雷达检测和量距检测,可以确定传感器数据。
在步骤S2中,选择或更新参考坐标系。参考坐标系根据可参数化的标准来选择。为此,当已发生了移动智能体的运动时,更新参考坐标系。通过选择参考坐标系,传感器数据可以与固定的位置关联。优选地,只有当已发生了移动智能体的运动时,那么才更新参考坐标系。
起初,参考坐标系可以通过移动智能体1的起始姿态来定义。当移动智能体1相对于当前的、最后有效的参考坐标系的姿态变化超过阈值(例如2m或者60度)时,重新选择参考坐标系。接着,经过更新的参考坐标系处于移动智能体1的当前姿态中。
随后,创建或扩展SLAM图,如其示例性地在图3中示出的那样。创建SLAM图,以便通过优化来确定每个姿态节点的最佳姿态。
为此,在步骤S3中,在选择了参考坐标系之后,姿态节点P(椭圆)被添加给SLAM图。姿态节点P表示移动智能体1相对于所选择的参考坐标系的所测量的姿态。通过移动智能体1的在智能体坐标系中确定的姿态和在智能体坐标系与参考坐标系之间的变换(智能体坐标系的原点的位置及其定向),确定所测量的姿态。变换例如可以通过旋转矩阵
给SLAM图添加变换边TK,所述变换边TK可以从量距测量和对已经启动的姿态的查明中得到。所述变换边TK示出在两个姿态节点P之间的所测量的相对变换,尤其是示出SLAM图中的在当前姿态节点P与一个或者多个以前达到的姿态节点之间的所测量的相对变换。
此外,在识别出移动智能体1的以前驶向的(angefahrenen)位置时,环路边S(环形闭合(Loop-Closure)边)可被插入在两个相对应的姿态节点P之间,同一位置和/或定向可以与所述两个相对应的姿态节点P关联。环路边S可以相对应地说明如下变换:所述变换对应于为0的位置变化和为0°的旋转变化。
这种环路可以以多级的方法来识别。在第一步骤中,标识出如下节点:例如当所述节点的间距未超出阈值(例如1米)时,所述节点根据其当前的所估计的姿态是环路边的潜在候选节点。在第二步骤中,通过扫描匹配方法(Scan Matching Methode),确定在潜在候选节点之间的最优变换。在第三步骤中,例如通过谱聚类(Spectra Clustering)方法,检查所有到目前为止确定的潜在候选节点的相互一致性。只有在检查成功时,潜在候选节点才作为环路边被插入到图中。该方法的示例性实施方案例如在Edwin B. Olson的(2008年)“Robust and Efficient Robotic Mapping”(博士学位论文(Ph. D. Dissertation),麻省理工学院(Massachusetts Institute of Technology),剑桥(Cambridge),MA,USA)中予以详尽地描述。
在步骤S5中检查,是否可探测到曼哈顿定向。为此,实施如结合图4的流程图随后更详尽地示出的方法。根据对曼哈顿定向的探测,给SLAM图添加曼哈顿节点MK和曼哈顿边M。
在步骤S6中,执行SLAM图的优化,如例如在Grisetti,G.等人的“A Tutorial onGraph-Based SLAM”(IEEE Intelligent Transportation Systems Magazine,2.4(2010),第31至43页)中所描述的那样。执行优化方法是必要的,因为传感器数据带有噪声或者带有测量误差,使得不存在针对SLAM图的确切的解决方案。替代于此,误差函数被最小化,所述误差函数对应于关于所有边的和函数,其中例如对于每个边i、j,误差函数被定义为,其中、对应于姿态节点i、j的姿态,并且对应于变换边ij的运动测量。总误差函数对应于
借助传统的优化算法,如例如高斯-牛顿或者莱文贝格-马夸特,使误差函数最小化。优化方法的结果是移动智能体1的针对该图的姿态节点经过修正的姿态。因此,移动智能体1在参考坐标系中的当前姿态可以从最后添加的姿态节点P中来确定,并且必要时可以基于传感器数据来创建环境地图。现在,基于环境地图和移动智能体1的当前姿态,可以以本身已知的方式进行轨迹规划。
在图4中是流程图,用于阐明将曼哈顿世界概念整合到前面描述的方法中,以在参考坐标系K和环境地图的位置中定位移动智能体1。
在步骤S11中检验,是否存在曼哈顿定向。为此,传感器数据被分组为单元中的墙壁2或者对象3的检测位置的点云。例如,这些单元可以具有为例如1m×1m或者这一类的预先给定的大小。对于所有这样的包含至少三个检测点的单元,计算这些点的平均值和协方差矩阵。这基于本身已知的方法进行,并且例如作为用于所谓的基于NDT的扫描匹配方法的基础而在Biber, W.等人的“The normal distributions transform:A new approach tolaser scan matching”(Proceedings 2003,IEEE/RSJ International Conference onIntelligent Robots and Systems(IROS 2003),第3卷,2003年)中予以描述。
在步骤S12中,确定具有有棱角的结构的单元。为此,确定协方差矩阵的特征值。只有在最大特征值与最小特征值之间的比大于预先给定的阈值(如例如100)的单元被保留为所选出的单元。
在步骤S13中检验,这些所选出的单元的数目是否小于预先给定的阈值。如果情况如此(替选地:是),则该方法结束,而无需确定曼哈顿定向,并且随着跳转到步骤S5而继续图2的方法。要不然(替选地:否),以步骤S14继续该方法。
在步骤S14中,所述单元的定向从其相应的特征向量(Ex,Ey)中来计算,根据最大特征向量被计算为a=atan2(Ey,Ex)。
接着,在步骤S15中,定向被归一化到从-45°直至+45°的中间范围上。这种归一化在通常情况下被称为曼哈顿归一化,并且通过加上或者减去90°角或者其多倍进行。
在步骤S16中,从所选出的单元的所计算出的单元定向的组中计算出曼哈顿定向作为主导定向。这可以利用各种方法进行。
例如,根据一种方法,可以为每个单元定向计算与另外的定向的相似性s。在所选出的单元的定向之间的相似性分别被计算,例如根据被计算为在所述单元的经过曼哈顿归一化的定向之间的角间距d,其中σ可以是所选择的参数。紧接着,通过对所有相似性s求和,确定关于一个单元的相似性值。
具有最高相似性值的单元定向被规定为针对该检测周期的曼哈顿定向。
在步骤S17中,如果预先给定的数目以上的单元定向在距所计算出的曼哈顿定向的所定义的经过曼哈顿归一化的间距之内,则所计算出的曼哈顿定向被视为有效。曼哈顿定向表示环境的一个优选方向,所述优选方向与参考坐标系固定相关。
在步骤S18中,与所计算出的曼哈顿定向相对应的曼哈顿节点被添加给SLAM图。那么,给针对预先给定的最小数目的所检测到的曼哈顿定向探测添加曼哈顿边,所述曼哈顿边将相对应的姿态节点与新添加的曼哈顿节点相连,所述相对应的姿态节点与该探测相对应。
曼哈顿误差函数与曼哈顿边关联,该曼哈顿误差函数定义为
其中对应于姿态节点的定向,对应于探测到的曼哈顿定向,对应于曼哈顿节点的状态,并且manhattan_normalize对应于曼哈顿归一化函数,该曼哈顿归一化函数将所述定向归一化到在-45°到45°之间的范围上。
每个曼哈顿边都配备有具有适当的带宽(例如0.1)的稳健内核。稳健内核允许针对如下情况精确估计正确的曼哈顿角:具有带有误差的测量的数条边包含在图中。该技术对应于现有技术,并且例如在Agarwal, P.、Tipaldi, G. D.、Spinello, L.、Stachniss,C.和Burgard, W.的(2013年五月)“Robust map optimization using dynamiccovariance scaling”(2013 IEEE International Conference on Robotics andAutomation(第62-69页))中予以描述。
紧接着,该方法以图2的方法的步骤S6来继续。
在图5a中,示出通过传统的SLAM算法检测环境地图的示意图。与此相比,图5b示出了在考虑曼哈顿世界概念的情况下基于SLAM算法的所检测到的环境地图的图示。
通过经过曼哈顿节点和曼哈顿边来扩展SLAM图,给优化问题添加另一组要优化的变量。此外,针对每个曼哈顿边产生附加的误差项,其在优化问题中必须被考虑。
上面描述的方法能够实现将曼哈顿世界概念整合到基于图的SLAM算法中。进行整合,使得不必参考之前检测到的传感器数据。仅仅给SLAM图补充有从对曼哈顿世界概念的认识中得到的信息。
Claims (13)
1.一种计算机实施的用于基于环境中的移动智能体(1)的姿态来运行所述移动智能体(1)的方法,其中为了运行所述移动智能体(1),利用下列步骤来执行对所述移动智能体(1)的定位:
- 检测(S1)关于位于环境中的墙壁(2)和/或对象(3)的传感器数据,其中所述传感器数据说明所述墙壁(2)和/或对象(3)在相对于智能体固定的智能体坐标系(A)中的对齐和距离;
- 在考虑曼哈顿定向的情况下,借助SLAM算法来确定(S11-S18)所述环境中的所述移动智能体(1)的所述姿态。
2.根据权利要求1所述的方法,其中,所述SLAM算法设置与所述传感器数据的测量误差有关的误差函数的最小化,其与所述曼哈顿定向有关。
3.根据权利要求1或者2所述的方法,其中,所述SLAM算法对应于基于具有节点(P)和变换边(TK,M)的SLAM图的基于图的SLAM算法,其中姿态节点(P)分别说明所述移动智能体的从所述传感器数据中确定的姿态,并且其中在各两个姿态节点(P)之间具有所述变换边(TK),其中所述变换边(TK)说明在与所述各两个姿态节点(P)关联的姿态之间的从所述传感器数据中确定的姿态改变,其中根据所述曼哈顿定向,添加曼哈顿节点(MK)和在所述曼哈顿节点(MK)与所述姿态节点(P)之一之间的至少一个曼哈顿边(M)。
4.根据权利要求3所述的方法,其中,所述SLAM算法使用从所述SLAM图中确定的误差函数,所述误差函数考虑与所述节点(P,MK)和边(TK,M)关联的误差概率,其确定与所述SLAM图的所述节点(P,MK)关联的经过修正的姿态。
5.根据权利要求1至4中任一项所述的方法,其中,从所述传感器数据中确定点集,所述点集说明所检测到的所述墙壁(2)和/或对象(3)的坐标,其中所述点集中的点被联合成彼此相邻的局部单元,其中曼哈顿归一化被应用到如下那些单元:所述单元具有带有直线的或者90°结构的单元定向,其中所述曼哈顿定向根据所述局部单元中的直线结构的主导定向来确定。
6.根据权利要求5所述的方法,其中,为了确定所述单元的所述主导定向,针对一个单元的每个单元定向都确定与所有另外的单元定向的相似性,并且针对每个单元确定相似性度量,尤其是确定为由相应的单元关于其余单元的所述相似性构成的和,其中所述曼哈顿定向对应于所述单元中的根据所述相似性度量选择的一个单元的单元定向,尤其是所述单元的相似性度量是最大的。
7.根据权利要求6所述的方法,其中,根据经过曼哈顿归一化的在所述单元定向中的各两个单元定向之间的定向差,执行所述相似性的确定,其中尤其是根据负的经过曼哈顿归一化的差的指数函数来确定所述相似性。
8.根据权利要求5至7中任一项所述的方法,其中,只有当所述单元的预先给定的数目以上的单元定向位于经过曼哈顿归一化的与确定的曼哈顿定向的定向差之内,那么才考虑所述确定的曼哈顿定向。
9.根据权利要求1至8中任一项所述的方法,其中,根据所确定的姿态来运行所述移动智能体(1),和/或其中借助所述移动智能体(1)的当前姿态来确定环境地图,并且根据所述环境地图来运行所述移动智能体(1)。
10.一种用于基于环境中的移动智能体(1)的姿态来运行所述移动智能体(1)的设备、尤其是控制单元(11),其中所述设备构造为,利用下列步骤执行对所述移动智能体(1)的定位:
- 检测(S1)关于位于环境中的墙壁(2)和/或对象(3)的传感器数据,其中所述传感器数据说明所述墙壁(2)和/或对象(3)在相对于智能体固定的智能体坐标系(A)中的对齐和距离;
- 在考虑曼哈顿定向的情况下,借助SLAM算法来确定(S11-S18)所述环境中的所述移动智能体(1)的所述姿态。
11.一种移动智能体(1),其具有根据权利要求10所述的设备、用于提供传感器数据的环境检测传感装置(12)并且具有运动致动装置(13),所述运动致动装置(13)构造为,以便使所述移动智能体(1)运动。
12.一种计算机程序,其具有程序代码装置,所述计算机程序设立为,当所述计算机程序在计算单元上实施时,实施根据权利要求1至9中任一项所述的方法。
13.一种机器可读的存储介质,其具有存储在所述机器可读的存储介质上的根据权利要求11所述的计算机程序。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
DE102019217160.5A DE102019217160A1 (de) | 2019-11-07 | 2019-11-07 | Computer-implementiertes Verfahren zum Erstellen einer Umgebungskarte für das Betreiben eines mobilen Agenten |
DE102019217160.5 | 2019-11-07 | ||
PCT/EP2020/076742 WO2021089231A1 (de) | 2019-11-07 | 2020-09-24 | Computer-implementiertes verfahren zum erstellen einer umgebungskarte für das betreiben eines mobilen agenten |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114600054A true CN114600054A (zh) | 2022-06-07 |
Family
ID=72659234
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202080077334.2A Pending CN114600054A (zh) | 2019-11-07 | 2020-09-24 | 计算机实施的创建用于运行移动智能体的环境地图的方法 |
Country Status (5)
Country | Link |
---|---|
US (1) | US20220374025A1 (zh) |
EP (1) | EP4055459B1 (zh) |
CN (1) | CN114600054A (zh) |
DE (1) | DE102019217160A1 (zh) |
WO (1) | WO2021089231A1 (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113311452B (zh) * | 2021-05-26 | 2022-12-30 | 上海新纪元机器人有限公司 | 一种基于多传感器的定位方法及其系统 |
DE102021130631A1 (de) * | 2021-11-23 | 2023-05-25 | Still Gesellschaft Mit Beschränkter Haftung | Verfahren und System zur Navigation eines Flurförderzeugs |
Family Cites Families (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR100466321B1 (ko) * | 2002-10-31 | 2005-01-14 | 삼성광주전자 주식회사 | 로봇청소기와, 그 시스템 및 제어방법 |
KR101503903B1 (ko) * | 2008-09-16 | 2015-03-19 | 삼성전자 주식회사 | 이동 로봇의 지도 구성 장치 및 방법 |
US9075938B2 (en) * | 2009-02-27 | 2015-07-07 | Sri International | Method and apparatus for mapping of multiple-floor structures |
US9020637B2 (en) * | 2012-11-02 | 2015-04-28 | Irobot Corporation | Simultaneous localization and mapping for a mobile robot |
US9888215B2 (en) * | 2013-04-26 | 2018-02-06 | University Of Washington | Indoor scene capture system |
JP6221158B2 (ja) * | 2014-08-27 | 2017-11-01 | 本田技研工業株式会社 | 自律行動ロボット、及び自律行動ロボットの制御方法 |
US9870617B2 (en) * | 2014-09-19 | 2018-01-16 | Brain Corporation | Apparatus and methods for saliency detection based on color occurrence analysis |
CN104850615A (zh) * | 2015-05-14 | 2015-08-19 | 西安电子科技大学 | 一种基于g2o的SLAM后端优化算法方法 |
US10175688B2 (en) * | 2016-01-20 | 2019-01-08 | Yujin Robot Co., Ltd. | Apparatus and system for remotely controlling a moving robot and method thereof |
US10203209B2 (en) * | 2016-05-25 | 2019-02-12 | Regents Of The University Of Minnesota | Resource-aware large-scale cooperative 3D mapping using multiple mobile devices |
US20180299899A1 (en) * | 2017-04-13 | 2018-10-18 | Neato Robotics, Inc. | Localized collection of ambient data |
US11423508B2 (en) * | 2018-02-26 | 2022-08-23 | Intel Corporation | Method and system of point cloud registration for image processing |
CN108416840B (zh) * | 2018-03-14 | 2020-02-18 | 大连理工大学 | 一种基于单目相机的三维场景稠密重建方法 |
KR102047303B1 (ko) * | 2018-06-01 | 2019-11-21 | 엘지전자 주식회사 | 저조도 영상 내 소실점에 기반하여 방향을 추정하는 로봇 및 방법 |
CN109634287B (zh) * | 2019-01-22 | 2022-02-01 | 重庆火虫创新科技有限公司 | 割草机路径规划方法及系统 |
US11074706B2 (en) * | 2019-04-12 | 2021-07-27 | Intel Corporation | Accommodating depth noise in visual slam using map-point consensus |
-
2019
- 2019-11-07 DE DE102019217160.5A patent/DE102019217160A1/de active Pending
-
2020
- 2020-09-24 WO PCT/EP2020/076742 patent/WO2021089231A1/de unknown
- 2020-09-24 US US17/770,215 patent/US20220374025A1/en active Pending
- 2020-09-24 EP EP20780666.2A patent/EP4055459B1/de active Active
- 2020-09-24 CN CN202080077334.2A patent/CN114600054A/zh active Pending
Also Published As
Publication number | Publication date |
---|---|
DE102019217160A1 (de) | 2021-05-12 |
EP4055459A1 (de) | 2022-09-14 |
US20220374025A1 (en) | 2022-11-24 |
WO2021089231A1 (de) | 2021-05-14 |
EP4055459B1 (de) | 2024-05-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Diosi et al. | Laser scan matching in polar coordinates with application to SLAM | |
Jensfelt | Approaches to mobile robot localization in indoor environments | |
Nieto et al. | Recursive scan-matching SLAM | |
Boniardi et al. | Robust LiDAR-based localization in architectural floor plans | |
Bellekens et al. | A benchmark survey of rigid 3D point cloud registration algorithms | |
Lindstrom et al. | Detecting and tracking moving objects from a mobile platform using a laser range scanner | |
MacKenzie et al. | Precise positioning using model-based maps | |
Boniardi et al. | Robot navigation in hand-drawn sketched maps | |
Pinto et al. | A localization method based on map-matching and particle swarm optimization | |
Kuo et al. | A light-and-fast slam algorithm for robots in indoor environments using line segment map | |
Lee et al. | Vision-based kidnap recovery with SLAM for home cleaning robots | |
Iocchi et al. | Hough localization for mobile robots in polygonal environments | |
Martinelli | Simultaneous localization and mapping using the phase of passive UHF-RFID signals | |
CN114600054A (zh) | 计算机实施的创建用于运行移动智能体的环境地图的方法 | |
Ranganathan et al. | Topological navigation and qualitative localization for indoor environment using multi-sensory perception | |
Ravankar et al. | Line segment extraction and polyline mapping for mobile robots in indoor structured environments using range sensors | |
Drews et al. | Fast and adaptive 3d change detection algorithm for autonomous robots based on gaussian mixture models | |
Park et al. | Global localization for mobile robots using reference scan matching | |
Sohn et al. | A robust localization algorithm for mobile robots with laser range finders | |
Choi et al. | Metric SLAM in home environment with visual objects and sonar features | |
Agunbiade et al. | A review: simultaneous localization and mapping in application to autonomous robot | |
Sohn et al. | VecSLAM: an efficient vector-based SLAM algorithm for indoor environments | |
Watanabe et al. | Robust localization with architectural floor plans and depth camera | |
Cupec et al. | Global localization based on 3d planar surface segments | |
Cupec et al. | Fast pose tracking based on ranked 3D planar patch correspondences |
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 |