CN107209515A - 定位和地图绘制装置及方法 - Google Patents
定位和地图绘制装置及方法 Download PDFInfo
- Publication number
- CN107209515A CN107209515A CN201580058177.XA CN201580058177A CN107209515A CN 107209515 A CN107209515 A CN 107209515A CN 201580058177 A CN201580058177 A CN 201580058177A CN 107209515 A CN107209515 A CN 107209515A
- Authority
- CN
- China
- Prior art keywords
- region
- probability
- positioning
- value
- module
- 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 15
- 238000012545 processing Methods 0.000 claims abstract description 18
- 230000004888 barrier function Effects 0.000 claims abstract description 12
- 238000010606 normalization Methods 0.000 claims description 13
- 239000002131 composite material Substances 0.000 claims description 12
- 238000013507 mapping Methods 0.000 claims description 10
- 230000006870 function Effects 0.000 description 7
- 230000004807 localization Effects 0.000 description 3
- 238000005259 measurement Methods 0.000 description 3
- 238000012986 modification Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 3
- 238000001514 detection method Methods 0.000 description 2
- 230000015572 biosynthetic process Effects 0.000 description 1
- 235000013399 edible fruits Nutrition 0.000 description 1
- 230000008447 perception Effects 0.000 description 1
- 230000035939 shock Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/93—Lidar systems specially adapted for specific applications for anti-collision purposes
- G01S17/931—Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- 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
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- Electromagnetism (AREA)
- Optics & Photonics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Traffic Control Systems (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Radar Systems Or Details Thereof (AREA)
- Image Analysis (AREA)
Abstract
本发明涉及一种定位和地图绘制装置,其意图用于被安装于在包括多个区域的环境中的移动车辆中,该装置具有:接收模块(11),其被设计成接收障碍物相对于车辆的位置数据(d(a));处理模块(12、14),其被设计成,根据所接收的数据(d(a))并且对于相对于车辆定位的多个区域,确定测量值(M_SCANt,i),其分别代表有关区域被考虑区域的占用可能性、有关区域被考虑区域的未占用可能性和有关区域被考虑区域的未知可能性;地图绘制模块(18、20),其被设计成,对于环境的所述多个区域中的每个区域,建立值(M_GRIt,k),其分别代表有关区域被考虑区域的占用可能性、有关区域被考虑区域的未占用可能性和有关区域被考虑区域的未知可能性;和定位模块(16),其被设计成确定使得测量值(M_SCANt,i)和建立值(M_GRIt,k)之间的对应的量度最大化的车辆在环境中的位置。本发明还描述相关的方法。
Description
技术领域
本发明涉及由在环境中移动的机器使用的定位和地图绘制技术。
更加具体地,本发明涉及用于装配到这样的移动机器的定位和地图绘制装置和方法。
在传感器提供关于障碍物相对于移动机器的定位的定位数据的情形中,本发明的应用是特别有利的。
背景技术
存在已知的定位和地图绘制装置,其被设计成被装配到移动机器(诸如机器人),以便在移动机器的环境中定位移动机器,同时也生成该环境的地图。
这些装置通常被叫做SLAM,来自“同时定位和地图绘制(SimultaneousLocalization and Mapping)”的英文缩写。
它们一般基于概率方法。在一些方案中,例如,覆盖环境的网格的每个单元格的占用概率被确定为由传感器供应的数据的函数。关于智能计算机通信和处理的IEEE第五届国际会议,2009,ICCP 2009,2009,410-408页中的文章"Online localization and mappingwith moving objects detection in dynamic outdoor environments"可以查阅该主题.
发明内容
在本文中,本发明的提出一种定位和地图绘制装置,用于装配到在包括多个区域的环境中移动的移动机器,该定位和地图绘制装置具有:接收模块,接收模块被设计成接收关于障碍物相对于机器的定位的定位数据;处理模块,处理模块被设计成,作为接收到的数据的函数和针对相对于机器定位的多个区域,确定分别代表有关区域的占用概率、有关区域的未占用概率和有关区域的未知概率的测量值;地图绘制模块,地图绘制模块被设计成,针对环境中的所述多个区域中的每个区域,构建分别代表有关区域的占用概率、有关区域的未占用概率和有关区域的未知概率的值;和定位模块,定位模块被设计成确定使得测量值和构建值之间的匹配量度最大化的、机器在环境中的定位。
因而,通过寻找测量值和构建值之间的最佳匹配来确定移动机器的位置,所述测量值是基于在给定瞬间从传感器接收到的定位数据生成的,所述构件值描述在先前迭代中由装置产生的地图。
然而,这些值不限于在环境的各个区域中的障碍物的存在或不存在的概率的估计,如在传统概率方法中那样,但是通过使用代表一些区域的未知概率的值,也允许这些区域的信息的缺失。
应注意的是,代表区域的占用概率和区域的未占用概率的值也受到有关区域的信息缺失的影响,由于前述原因,***值(占用概率、未占用概率和未知概率),在下文中叫做“可能性”,通常具有固定和(通常等于1).
根据可选的(并因此非限制性的)其它特性:
-定位模块被设计成通过使用测量值和构建值之间的冲突量度来确定匹配的量度;
-匹配量度指示代表占用概率的测量值的空间分布和代表占用概率的构建值的空间分布之间的匹配;
-定位模块被设计成,使用与环境的给定区域相关联的每个项的和,确定用于移动机器的给定定位的匹配量度,并且通过使用代表与机器的给定定位的给定区域对应的区域的占用概率的测量值和代表给定区域的占用概率的构建值的乘积来计算每一项。
-定位模块被设计成,通过使用冲突因子来计算每一项,所述冲突因子使用代表与所述机器的所述给定定位的给定区域对应的区域的占用概率的测量值与代表所述给定区域的未占用概率的构建值的乘积和代表与所述机器的所述给定定位的给定区域对应的区域的未占用概率的测量值与代表所述给定区域的占用概率的构建值的乘积的和;
-所述地图绘制模块包括组合模块,所述组合模块被设计成,对于每个区域,通过将与有关区域相关的所述测量值和在先前迭代中对于有关区域由地图绘制模块构建的值组合,确定分别代表有关区域的占用概率、有关区域的未占用概率、有关区域的未知概率和有关区域中的冲突概率的原始值;
-所述地图绘制模块包括归一化模块,所述归一化模块被设计成,作为所述原始值的函数,确定所述构建值;
-所述处理模块包括转换模块,所述转换模块被设计成,对于相对于所述机器定位的所述多个区域中的每个区域,作为在极坐标网格中被分配到与所述有关区域对应的单元格的对应值的函数,确定与所述有关区域相关的所述测量值。
本发明也提出一种***,所述***包括上述定位和地图绘制装置和被设计成生成所述定位数据的传感器。该传感器例如是激光雷达传感器,但是其可以是另一类型的传感器,诸如雷达传感器。
本发明也提出与上述相关的一种定位和地图绘制方法,所述方法被在包括多个区域的环境中移动的机器使用,所述方法包括以下步骤:
-接收关于障碍物相对于所述机器的定位的定位数据;
-作为所接收的数据的函数并且对于相对于所述机器定位的多个区域,确定分别代表有关区域的占用概率、有关区域的未占用概率和有关区域的未知概率的测量值;
-对于所述环境的所述多个区域中的每一个区域,构建分别代表有关区域的占用概率、有关区域的未占用概率和有关区域的未知概率的值;
-通过确定使得所述测量值和所述构建值之间的匹配量度最大化的、所述机器在所述环境中的定位,来定位所述机器。
该方法可以视需要包括以下步骤:通过将与有关区域相关的所述测量值和在先前迭代中对于有关区域由所述地图绘制模块构建的值组合,以便生成分别代表有关区域的占用概率、有关区域的未占用概率、有关区域的未知概率和有关区域中的冲突概率的原始值。
关于定位和地图绘制装置的上述可选特征也可以被应用到这些方法。
附图说明
参考通过非限制示例提供的附图,以下描述将解释本发明的本质和应用。
在附图中:-图1示出包括传感器和根据本发明的定位和地图绘制装置的示例的***;
-图2以功能形式示出有图1中的定位和地图绘制装置执行的处理;
-图3示出基于从传感器接收到的定位数据构建的极坐标网格。
具体实施方式
图1示意性地示出包括定位和地图绘制装置10的***的主要元件。
该***被装配到在环境中移动的机器,例如,机动车辆或机器人。如从以下说明显而易见的,配备有定位和地图绘制装置的、有时被称为SLAM(英文表达“SimultaneousLocalization And Mapping”的缩写)的***能被同时用于在环境中定位***(并由此定位移动机器)和用于确定环境的地图。
图1的***包括传感器2,传感器2生成关于环境中存在的障碍物(相对于***)的定位的定位数据。传感器2是例如激光雷达型的;在该情形中,对于相对于***的基准方向的多个取向α,定位数据代表在与该取向α相关的方向上遇到第一障碍物(距离***)的距离d(α)。
在变型中,可以使用另一类型的传感器,诸如雷达传感器。
图1的***也包括定位和地图绘制装置10,定位和地图绘制装置10在它的输入端接收由传感器2生成的定位数据,并且在每个时刻t在它的输出端处生成关于***(并且因此关于装配有该***的移动机器)的位置信息Xt以及地图绘制信息GRI。
该地图绘制信息GRI例如是占用网格(如在英文中已知的),其以网格的形式描述已经检测到的障碍物在环境中的位置。
在这里所描述的情形中,以二维方式绘制环境,位置信息Xt包括例如***在绘图方案中的坐标x、y(更具体地,它的横坐标x和它的纵坐标y)以及它的航向(heading)(如在英文中已知)θ。相对于按照惯例定义的初始坐标x0、y0和初始航向θ0(例如,假设x0=0,y0=0并且θ0=0),如下所述确定该位置信息X。
为了执行下述处理,在此情形中,定位和地图绘制装置10包括处理器4(例如,微处理器)和存储器件6(例如,硬盘)。
处理器4被设计成,特别是参照图2,例如通过执行存储在存储器件6中的计算机程序指令,执行下述处理。在变型中,可以通过被嵌入在定位和地图绘制装置10中的专用集成电路(如在英文中已知的)或ASIC执行这些处理。
存储器件6也可以被用于存储在下述处理中使用的数据,特别是代表概率或可信性(下文中也称为“可能性(masses)”)的数据。
图2以功能形式示出由定位和地图绘制装置10执行的处理,以便基于由传感器2生成的定位数据d(α)确定位置信息Xt和地图绘制信息GRI。
因而,由定位和地图绘制装置10执行的不同处理在图2中被示出成被不同的模块11、12、14、16、18、20、22执行,但是在实践中,可以作为由同一处理器4执行指令的结果来执行这些处理。
定位和地图绘制装置10包括接收模块11,接收模块11被连接到传感器2,并且因而接收由传感器2生成的定位数据d(α),并且然后将它们传输到极坐标网格构建模块12。
作为在时刻t在它的输入端处接收的定位数据d(α)的函数,极坐标网格构建模块12为极坐标网格的每个单元格确定以下三个参数:
-占用可能性M_POLt,j(O)(英文中的“占用可能性”);
-未占用可能性M_POLt,j(F)(英文中的“未占用可能性”);
-未知可能性M_POLt,j(U)(英文中的“未知可能性”)。
对于每个单元格j,与该单元格相关的不同可能性的和等于1。
如图3所示,极坐标网格是一组环境的单元格(这里以二维方式示出),其中每个单元格对应于距离***(或者更精确地距传感器2)的距离的给定范围并且对应于给定角度的扇区(角度被相对于前述的***的基准方向测量)。
根据一定信息,在此情形中根据在时刻t从传感器2接收的定位数据,占用可能性M_POLt,j(O)代表极坐标网格中的有关单元格j被占用的概率。因此占用可能性M_POLt,j(O)代表该单元格j的占用概率或可信性。
根据一定信息,在此情形中根据在时刻t从传感器2接收的定位数据,未占用可能性M_POLt,j(F)代表极坐标网格中的有关单元格j未被占用的概率。因此未占用可能性M_POLt,j(F)代表该单元格j的未占用概率或可信性。
未知可能性M_POLt,j(U)代表有关单元格j还没有被探究的可能性,换言之,根据可用信息(在此情形中为定位数据),对与该单元格j,没有可用的知识。未知可能性M_POLt,j(O)因此代表单元格j未知的概率或可信性。
对于位于与方向θ对应的角度扇区中的单元格j,例如,不同可能性被如下确定:
-对于位于距***距离d(θ)的单元格j(在图3中黑色阴影)(也就是说,如果传感器2是激光雷达传感器,则是其中障碍物被图3中的虚线所示的激光束撞到的单元格),
M_POLt,j(O)=ICONF,M_POLt,j(F)=0,M_POLt,j(U)=1-ICONF,其中ICONF是传感器2的置信度指数(例如,由传感器2预先定义或提供),通常在0.5至1的范围中。
-对于位于小于距离d(θ)的距离处的单元格j(即,在激光传感器的情形中激光束已经经过的那些单元格),
M_POLt,j(O)=0,M_POLt,j(F)=ICONF,M_POLt,j(U)=1-ICONF;
-对于位于大于距离d(θ)的距离处的单元格j(即,在激光雷达的情形中位于激光束的撞击以外的那些单元格,在图3中被示出为带阴影线),
M_POLt,j(O)=0,M_POLt,j(F)=0,M_POLt,j(U)=1。
如果传感器提供用于极坐标网格的同一角度扇区的多个定位数据d(θ)(例如,如果激光雷达传感器提供用于多个高度或层的数据,或者如果激光传感器的分辨率比极坐标网格的分辨率更精细),则例如最小距离d(θ)被选择用于确定如上所述的可能性。
极坐标网格构建模块12将由此确定的所有可能性参数M_POLt,j发送到转换模块14,对于极坐标网格的每个单元格j,转换模块14把针对该单元格j确定的可能性分配到笛卡尔坐标中的测量网格的一个(或多个)对应单元格i(表达成在t时刻相对于***的当前位置)。
换言之,当测量网格与极坐标网格的单元格j匹配时,对于任意A{O,F,U},M_SCANt,i(A)=M_POLt,j(A)。
因而,对于测量网格的每个单元格i,做出以下限定:
-每个单元格i的占用可能性M_SCANt,i(O),其代表(根据在时刻t处由传感器2提供的定位数据的)单元格i的占用概率(或可信性);
-每个单元格i的未占用可能性M_SCANt,i(F),其代表(根据在时刻t处由传感器2提供的定位数据的)单元格i的未占用概率;
-每个单元格i的未知可能性M_SCANt,i(U),其代表(根据在时刻t处由传感器2提供的定位数据的)单元格i的未知概率。
对于每个单元格i,与该单元格相关的不同可能性的和等于1。
术语“处理模块”这里被应用到由极坐标构建模块12和转换模块14形成的组件。处理模块因而能够基于定位数据d(θ)来确定可能性M_SCANt,j(A)。
如在图2中可见的,对于测量网格的不同单元格i由转换模块16产生的不同的可能性M_SCANt,i(A)(其中A{O,F,U})一方面被输送到定位模块16并且另一方面被输送到组合模块18。
定位模块16在其输入端还接收以下信息,其由组合模块18和归一化模块20在先前迭代t-1(如以下针对当前迭代t所解释的)中产生并且与代表环境的网格的单元格k相关(在笛卡尔坐标中与固定基准诸如***的初始位置相关):
-对于每个单元格k,占用可能性M_GRIt-1,k(O),其代表,作为直到时刻t1所执行的处理的结果,由装置10构建的单元格k的占用概率;
-对于每个单元格k,未占用可能性M_GRIt-1,k(F),其代表,作为直到时刻t1所执行的处理的结果,由装置10构建的单元格k的未占用概率;
-对于每个单元格k,未知可能性M_GRIt-1,k(U),其代表,作为直到时刻t1所执行的处理的结果,由装置10构建的单元格k的未知概率。
应指出的是,该信息在第一次迭代中是不可用的。然而,在第一次迭代中不要求处理:此时,定位模块16仅仅指示当前位置(由坐标x、y和航向θ限定)等于前述初始位置(由坐标x0、y0和航向θ0限定)。
对于其它迭代,定位模块16确定***(和因此移动机器)的位置Xt,其由坐标x、y和航向θ限定,这使得同(被相对于***的位置定位的)测量网格相关的值与同代表环境的固定网格相关的值之间的匹配量度最大化。
例如,以下量度被用于该目的,其对于位置Z被定义为:
其中i(k,Z)是与当***在位置Z处时固定网格的单元格k对应的(相对于***定位的,即相对于如上所提及的移动机器定位的)测量网格的单元格,并且其中Mt,k,Z(C)度量分子中使用的信息之间的冲突:
Mt,k,Z(C)=M_GRIt-1,k(F).M_SCANt,i(k,Z)(O)+M_GRIt-1,k(O).M_SCANt,i(k,Z)(F)。
因而使用匹配量度,其量化测量网格中的占用概率的空间分布(在单元格内)与在固定网格中的占用概率的空间分布之间的匹配。
通过使用分母(1-Mt,k,Z(C)),可以在单元格的和中施加权重,其与在分子中使用的信息相反,以便允许以可取的方式对此进行考虑。
在变型中,对于前述和中的每一项,可以使用另一合并运算符以便将(经由归一化模块20)从组合模块18接收到的可能性M_GRIt-1,k和从转换模块14接收到的可能性M_SCANt,i(k,Z)组合,例如合并运算符,诸如在证据理论(也称登普斯特—谢菲尔理论)中使用的那些。
因此,在这种情形中,由定位模块16提供的值Xt是使量度N(Z)最大化的Z的值:X使得N(X)=maxZ N(Z)。
例如,这是在实践中通过计算多个位置Z的量度N(Z)来确定的。在下文中,符号zx、zy、zθ分别表示限定位置Z的横坐标、纵坐标和航向。
根据第一可能实施例,对于一组(离散的)位置Z,计算测量值,对于所述位置Z:
|zx–xt-1|≤Sx,|zy-yt-1|≤Sy,|zθ-θt-1|≤Sθ
其中,xt-1、yt-1、θt-1是限定在先前迭代中确定的位置Xt-1的横坐标、纵坐标和航向(或者在t=1的迭代中的初始横坐标、纵坐标和航向),并且其中Sx、Sy、Sθ是预定阈值。
将坐标表达成固定网格的间隔的数目(这里在固定网格和测量网格中单元格尺寸相同),或者表达成航向的度数,例如,我们使用Sx=Sy=5和Sθ=10°,并且:
zx{xt-1-5;|t-1-4;xt-1-3;xt-1-2;xt-1-1;xt-1;xt-1+1;xt-1+2;xt-1+3;xt|t-1+4;xt|t-1+5}
zy{yt-1-5;yt-1-4;yt-1-3;yt-1-2;yt-1-1;yt-1;yt-1+1;yt-1+2;yt-1+3;yt-1+4;yt-1+5}
zθ{θt-1-10°;θt-1-8°;θt-1-6°;θt-1-4°;θt-1-2°;θt-1;θt-1+2°;θt-1+4°;θt-1+6°;θt-1+8°;θt-1+10°},
也就是说,对于1331个可能位置Z计算量度N(Z)。
根据第二可能实施例,我们使用从在先前迭代中确定出的位置Xt-1基于恒定速度模型推导出的先验(priori)位置Xt|t-1=(xt|t-1,yt|t-1,θt|t-1):
其中,是在时刻t-1处的位置Xt-1的导数:
然后,对于一组(离散的)位置Z可计算量度N(Z),对于所述位置Z:
|zx–xt|t-1|≤Sx,|zy-yt|t-1|≤Sy,|zθ-θt|t-1|≤Sθ
其中Sx、Sy、Sθ是预定阈值。
将坐标表达成固定网格的间隔的数目(这里在固定网格和测量网格中单元格尺寸相同),例如,我们使用Sx=Sy=5和Sθ=10°,并且:
zx{xt|t-1-5;xt|t-1-4;xt|t-1-3;xt|t-1-2;xt|t-1-1;xt|t-1;xt|t-1+1;xt|t-1+2;xt|t-1+3;xt|t-1+4;xt|t-1+5}
zy{yt|t-1-5;yt|t-1-4;yt|t-1-3;yt|t-1-2;yt|t-1-1;yt|t-1;yt|t-1+1;yt|t-1+2;yt|t-1+3;yt|t-1+4;yt|t-1+5}
zθ{θt|t-1-10°;θt|t-1-8°;θt|t-1-6°;θt|t-1-4°;θt|t-1-2°;θt|t-1;θt|t-1+2°;θt|t-1+4°;θt|t-1+6°;θt|t-1+8°;θt|t-1+10°},
也就是说,对于基于恒定速度模型确定出的先验位置Xt|t-1周围的1331个可能位置Z计算量度N(Z)。
在这个问题上,可以参考J.Xie、F.Nashashibi、M.N.Parent和O.Garcia-Favrot在2010年ITS世界大会中的文章“A real-time robust SLAM for large-scale outdoorenvironments”。
由定位模块16确定的位置Xt被传递到组合模块18,如上所述,组合模块18在其输入端处还接收由转换模块14对于测量网格中的不同单元格i产生的不同可能性M_SCANt,i(A)(其中A{O,F,U}),以及对于固定网格的单元格k在先前迭代t-1中由归一化模块20如上所述解释那样产生的不同可能性M_GRIt-1,k(A)(其中A{O,F,U})。
组合模块18然后将在时刻t处由传感器2提供的信息(由可能性M_SCANt,i(A)表示)和直到时刻t-1由装置10构建的信息(由可能性M_GRIt-1,k(A)表示)组合,以便从其中推断出代表在时刻t处固定网格的了解状态的原始可能性M_COMBt,k(A),例如,通过将以下类型的公式应用到固定网格的每个单元格k:
M_COMBt,k=M_GRIt-1,k∩M_SCANt,i(k,Xt)
其中,i(k,Xt)是当***在位置Xt时与固定网格的单元格k对应的测量网格的单元格,并且其中∩是合取(conjunction)运算符,例如被限定在如下文章中,即,IEEE机器人与自动化国际会议(ICRA2011),第84-89页,2011,作者J.Moras、V.Cherfaoui和P.Bonnifait,“Credibilist occupancy grids for vehicle perception in dynamic environments”。
弄清被执行为该运算符∩的结果的计算,对于每个单元格k,我们因此获得:
-原始占用可能性M_COMBt,k(O),其代表单元格k的占用概率,其通过以下得出:
M_COMBt,k(O)=M_GRIt-1,k(O).M_SCANt,i(k,Xt)(O)
+M_GRIt-1,k(U).M_SCANt,i(k,Xt)(O)+M_GRIt-1,k(O).M_SCANt,i(k,Xt)(U);
-原始未占用可能性M_COMBt,k(F),其代表单元格k的未占用概率,其通过以下得出:
M_COMBt,k(F)=M_GRIt-1,k(F).M_SCANt,i(k,Xt)(F)
+M_GRIt-1,k(U).M_SCANt,i(k,Xt)(F)+M_GRIt-1,k(F).M_SCANt,i(k,Xt)(U);
-原始未知可能性M_COMBt,k(F),其代表单元格k的未知概率,其通过以下得出:
M_COMBt,k(U)=M_GRIt-1,k(U).M_SCANt,i(k,Xt)(U);
-原始冲突可能性M_COMBt,k(C),其代表关于该单元格k(由传感器2提供的信息和由装置10构建的信息之间直到时刻t-1)的冲突概率,其通过以下得出:
M_COMBt,k(C)=M_GRIt-1,k(F).M_SCANt,i(k,Xt)(O)+M_GRIt-1,k(O).M_SCANt,i(k,Xt)(F)。
对于每个单元格k,与该单元格相关的不同原始可能性的和等于1。
由组合模块18产生的原始可能性M_COMBt,k被传递到归一化模块20,如果不受移动障碍物干扰,归一化模块20(在每个单元格中)保持占用、未占用和未知可能性的分布,但是使得冲突可能性的概念消失。根据可行的实施例,每个不同的单元格k的原始冲突可能性M_COMBt,k(C)可以被存储以在检测移动障碍物中使用。
归一化模块20因而计算以下可能性(在归一化之后):
对于任意A{O,F,U}并且对于所有单元格k,M_GRIt,k(A)=M_COMBt,k(A)/(1-M_COMBt,k(C))。
因而,对于每个单元格k,我们获得占用可能性M_GRIt,k(O)、未占用可能性M_GRIt,k(F)和未知可能性M_GRIt,k(U),在该情形中,其形成由装置10提供的地图绘制信息GRI。因为归一化,对于每个单元格k,关于该单元格的不同可能性M_GRIt,k(O)、M_GRIt,k(F)、M_GRIt,k(U)的和等于1。
术语“地图绘制模块”这里被应用到由组合模块18和归一化模块20形成的组件。
该信息然后可以例如被呈现在地图上(例如,被显示在移动机器的屏幕上),如果需要的话将每个单元格k以根据与该单元格k相关的可能性M_GRIt,k(O)、M_GRIt,k(F)、M_GRIt,k(U)的函数限定的颜色显示;例如,对于单元格k,使用这样的颜色,该颜色在RGB基准坐标系中的三色坐标是:M_GRIt,k(O)、M_GRIt,k(F)、M_GRIt,k(U)。
如上所提及的,在归一化模块20的出口端处产生的可能性M_GRIt,k(通过迭代延迟装置22)被传递到定位模块16和组合模块18,以在下一迭代中使用。
Claims (12)
1.一种定位和地图绘制装置(10),所述定位和地图绘制装置(10)被装配到在包括多个区域的环境中移动的机器,所述定位和地图绘制装置(10)具有:
-接收模块(11),所述接收模块(11)被设计成接收关于障碍物相对于所述机器的定位的定位数据(d(α));
-处理模块(12、14),所述处理模块(12、14)被设计成,作为所接收的数据(d(α))的函数并且对于相对于所述机器定位的多个区域,确定分别代表有关区域的占用概率、有关区域的未占用概率和有关区域的未知概率的测量值(M_SCANt,i);
-地图绘制模块(18、20),所述地图绘制模块(18、20)被设计成,对于所述环境的所述多个区域中的每一个区域,构建分别代表有关区域的占用概率、有关区域的未占用概率和有关区域的未知概率的值(M_GRIt,k);和
-定位模块(16),所述定位模块(16)被设计成确定使得所述测量值(M_SCANt,i)和所述构建值(M_GRIt,k)之间的匹配量度最大化的、所述机器在所述环境中的定位。
2.根据权利要求1所述的定位和地图绘制装置,其中所述定位模块(16)被设计成通过使用所述测量值(M_SCANt,i)和所述构建值(M_GRIt,k)之间的冲突量度来确定所述匹配量度。
3.根据权利要求1或2所述的定位和地图绘制装置,其中所述匹配量度指示代表所述占用概率的所述测量值(M_SCANt,i)的空间分布和代表所述占用概率的所述构建值(M_GRIt,k)的空间分布之间的匹配。
4.根据权利要求1至3中的任一项所述的定位和地图绘制装置,其中所述定位模块(16)被设计成使用与所述环境的给定区域相关联的每个项的和来确定所述移动机器的给定定位的匹配量度,并且通过使用代表与所述机器的所述给定定位的给定区域对应的区域的占用概率的所述测量值(M_SCANt,i)和代表所述给定区域的占用概率的所述构建值(M_GRIt,k)的乘积来计算每一项。
5.根据权利要求4所述的定位和地图绘制装置,其中所述定位模块(16)被设计成通过将前述乘积除以冲突因子来计算每一项,所述冲突因子使用代表与所述机器的所述给定定位的给定区域对应的区域的占用概率的测量值(M_SCANt,i)与代表所述给定区域的未占用概率的构建值(M_GRIt,k)的乘积和代表与所述机器的所述给定定位的给定区域对应的区域的未占用概率的测量值(M_SCANt,i)与代表所述给定区域的占用概率的构建值(M_GRIt,k)的乘积的和。
6.根据权利要求1至5中的任一项所述的定位和地图绘制装置,其中所述地图绘制模块(18、20)包括组合模块(18),所述组合模块(18)被设计成,对于每个区域,通过将与有关区域相关的所述测量值(M_SCANt,i)和在先前迭代中对于有关区域由地图绘制模块(18、20)构建的值(M_GRIt-1,k)组合,确定分别代表有关区域的占用概率、有关区域的未占用概率、有关区域的未知概率和有关区域中的冲突概率的原始值(M_COMBt,k)。
7.根据权利要求6所述的定位和地图绘制装置,其中所述地图绘制模块(18、20)包括归一化模块(20),所述归一化模块(20)被设计成作为所述原始值(M_COMBt,k)的函数确定所述构建值(M_GRIt,k)。
8.根据权利要求1至7中的任一项所述的定位和地图绘制装置,其中所述处理模块(12、14)包括转换模块(14),所述转换模块(14)被设计成,对于相对于所述机器定位的所述多个区域中的每个区域,作为在极坐标网格中被分配到与所述有关区域对应的单元格的对应值(M_POLt,j)的函数,确定与所述有关区域相关的所述测量值(M_SCANt,i)。
9.一种***,所述***包括根据权利要求1至8中的任一项所述的定位和地图绘制装置(10)和被设计成生成所述定位数据(d(α))的传感器(2)。
10.根据权利要求9所述的***,其中所述传感器2是激光雷达传感器。
11.一种定位和地图绘制方法,所述方法被在包括多个区域的环境中移动的机器使用,所述方法包括以下步骤:
-接收关于障碍物相对于所述机器的定位的定位数据(d(α));
-作为所接收的数据(d(α))的函数并且对于相对于所述机器定位的多个区域,确定分别代表有关区域的占用概率、有关区域的未占用概率和有关区域的未知概率的测量值(M_SCANt,i);
-对于所述环境的所述多个区域中的每一个区域,构建分别代表有关区域的占用概率、有关区域的未占用概率和有关区域的未知概率的值(M_GRIt,k);
-通过确定使得所述测量值(M_SCANt,i)和所述构建值(M_GRIt,k)之间的匹配量度最大化的、所述机器在所述环境中的定位,来定位所述机器。
12.根据权利要求11所述方法,包括以下步骤:对于所述环境中的每个区域,通过将与有关区域相关的所述测量值(M_SCANt,i)和在先前迭代中对于有关区域由所述地图绘制模块构建的值(M_GRIt-1,k)组合,以便生成分别代表有关区域的占用概率、有关区域的未占用概率、有关区域的未知概率和有关区域中的冲突概率的原始值(M_COMBt,k)。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
FR1401938A FR3025325B1 (fr) | 2014-09-01 | 2014-09-01 | Dispositif et procede de localisation et de cartographie |
FR14/01938 | 2014-09-01 | ||
PCT/EP2015/069787 WO2016034516A2 (fr) | 2014-09-01 | 2015-08-28 | Dispositif et procédé de localisation et de cartographie |
Publications (1)
Publication Number | Publication Date |
---|---|
CN107209515A true CN107209515A (zh) | 2017-09-26 |
Family
ID=52423742
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201580058177.XA Pending CN107209515A (zh) | 2014-09-01 | 2015-08-28 | 定位和地图绘制装置及方法 |
Country Status (6)
Country | Link |
---|---|
US (1) | US10379542B2 (zh) |
EP (1) | EP3189389B1 (zh) |
JP (1) | JP6682508B2 (zh) |
CN (1) | CN107209515A (zh) |
FR (1) | FR3025325B1 (zh) |
WO (1) | WO2016034516A2 (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112581613A (zh) * | 2020-12-08 | 2021-03-30 | 纵目科技(上海)股份有限公司 | 一种栅格地图的生成方法、***、电子设备及存储介质 |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11505292B2 (en) | 2014-12-31 | 2022-11-22 | FLIR Belgium BVBA | Perimeter ranging sensor systems and methods |
US10093021B2 (en) * | 2015-12-02 | 2018-10-09 | Qualcomm Incorporated | Simultaneous mapping and planning by a robot |
US10613541B1 (en) * | 2016-02-16 | 2020-04-07 | AI Incorporated | Surface coverage optimization method for autonomous mobile machines |
WO2019068214A1 (en) * | 2017-10-03 | 2019-04-11 | Intel Corporation | NETWORK OCCUPANCY MAPPING USING ERROR RANGE DISTRIBUTION |
FR3081598A1 (fr) * | 2018-06-15 | 2019-11-29 | Orange | Cartographie et localisation simultanee d'un objet dans un environnement interieur |
US11442171B2 (en) * | 2019-07-26 | 2022-09-13 | 6 Watch, Inc. | Threat detection and notification system for public safety vehicles |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2008005659A2 (en) * | 2006-07-05 | 2008-01-10 | Battelle Energy Alliance, Llc | Robotic follow system and method |
WO2011067887A1 (ja) * | 2009-12-02 | 2011-06-09 | 村田機械株式会社 | 自律移動装置 |
EP2343615A1 (en) * | 2008-10-01 | 2011-07-13 | Murata Machinery, Ltd. | Autonomous movement device |
CN102576228A (zh) * | 2009-08-31 | 2012-07-11 | Neato机器人技术公司 | 移动机器人环境的同时定位和地图绘制的方法和设备 |
EP2619742A1 (en) * | 2010-09-24 | 2013-07-31 | Evolution Robotics, Inc. | Systems and methods for vslam optimization |
CN103558856A (zh) * | 2013-11-21 | 2014-02-05 | 东南大学 | 动态环境下服务动机器人导航方法 |
CN103901891A (zh) * | 2014-04-12 | 2014-07-02 | 复旦大学 | 一种基于层次结构的动态粒子树slam算法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000292538A (ja) * | 1999-04-07 | 2000-10-20 | Mitsubishi Electric Corp | 車両用障害物検出装置 |
JP4061596B2 (ja) * | 2004-05-20 | 2008-03-19 | 学校法人早稲田大学 | 移動制御装置、環境認識装置及び移動体制御用プログラム |
US8577538B2 (en) * | 2006-07-14 | 2013-11-05 | Irobot Corporation | Method and system for controlling a remote vehicle |
JP4788722B2 (ja) * | 2008-02-26 | 2011-10-05 | トヨタ自動車株式会社 | 自律移動ロボット、自己位置推定方法、環境地図の生成方法、環境地図の生成装置、及び環境地図のデータ構造 |
JP5298741B2 (ja) * | 2008-10-01 | 2013-09-25 | 村田機械株式会社 | 自律移動装置 |
JP6506279B2 (ja) * | 2014-06-16 | 2019-04-24 | 株式会社日立製作所 | 地図生成システム及び地図生成方法 |
-
2014
- 2014-09-01 FR FR1401938A patent/FR3025325B1/fr active Active
-
2015
- 2015-08-28 US US15/506,973 patent/US10379542B2/en active Active
- 2015-08-28 EP EP15763237.3A patent/EP3189389B1/fr active Active
- 2015-08-28 CN CN201580058177.XA patent/CN107209515A/zh active Pending
- 2015-08-28 WO PCT/EP2015/069787 patent/WO2016034516A2/fr active Application Filing
- 2015-08-28 JP JP2017511921A patent/JP6682508B2/ja active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2008005659A2 (en) * | 2006-07-05 | 2008-01-10 | Battelle Energy Alliance, Llc | Robotic follow system and method |
EP2343615A1 (en) * | 2008-10-01 | 2011-07-13 | Murata Machinery, Ltd. | Autonomous movement device |
CN102576228A (zh) * | 2009-08-31 | 2012-07-11 | Neato机器人技术公司 | 移动机器人环境的同时定位和地图绘制的方法和设备 |
CN104699099A (zh) * | 2009-08-31 | 2015-06-10 | Neato机器人技术公司 | 移动机器人环境的同时定位和地图绘制的方法和设备 |
WO2011067887A1 (ja) * | 2009-12-02 | 2011-06-09 | 村田機械株式会社 | 自律移動装置 |
EP2619742A1 (en) * | 2010-09-24 | 2013-07-31 | Evolution Robotics, Inc. | Systems and methods for vslam optimization |
CN103558856A (zh) * | 2013-11-21 | 2014-02-05 | 东南大学 | 动态环境下服务动机器人导航方法 |
CN103901891A (zh) * | 2014-04-12 | 2014-07-02 | 复旦大学 | 一种基于层次结构的动态粒子树slam算法 |
Non-Patent Citations (2)
Title |
---|
JULIEN MORAS 等: "Credibilist Occupancy Grids for Vehicle Perception in Dynamic Environments", 《IEEE》 * |
QADEER BAIG 等: "Online Localization and Mapping with Moving Objects Detection in Dynamic Outdoor Environments", 《IEEE》 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112581613A (zh) * | 2020-12-08 | 2021-03-30 | 纵目科技(上海)股份有限公司 | 一种栅格地图的生成方法、***、电子设备及存储介质 |
Also Published As
Publication number | Publication date |
---|---|
JP6682508B2 (ja) | 2020-04-15 |
FR3025325B1 (fr) | 2016-12-30 |
US10379542B2 (en) | 2019-08-13 |
EP3189389A2 (fr) | 2017-07-12 |
JP2017526083A (ja) | 2017-09-07 |
EP3189389B1 (fr) | 2021-09-08 |
WO2016034516A2 (fr) | 2016-03-10 |
FR3025325A1 (fr) | 2016-03-04 |
WO2016034516A3 (fr) | 2016-05-26 |
US20170261996A1 (en) | 2017-09-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107209515A (zh) | 定位和地图绘制装置及方法 | |
KR102126724B1 (ko) | 포인트 클라우드 데이터를 복구하기 위한 방법 및 장치 | |
US10549430B2 (en) | Mapping method, localization method, robot system, and robot | |
CN110927740A (zh) | 一种移动机器人定位方法 | |
Zhao et al. | Learning-based bias correction for time difference of arrival ultra-wideband localization of resource-constrained mobile robots | |
CN108983781A (zh) | 一种无人车目标搜索***中的环境探测方法 | |
CN110189366B (zh) | 一种激光粗配准方法、装置、移动终端及存储介质 | |
CN105865449A (zh) | 基于激光和视觉的移动机器人的混合定位方法 | |
CN111536967A (zh) | 一种基于ekf的多传感器融合温室巡检机器人跟踪方法 | |
WO2022095473A1 (zh) | 一种地图融合的方法及装置、服务器、存储介质 | |
Tully et al. | Leap-frog path design for multi-robot cooperative localization | |
WO2021219023A1 (zh) | 定位方法、装置、电子设备及存储介质 | |
CN111932612B (zh) | 基于二阶隐马尔科夫模型的智能车视觉定位方法及装置 | |
CN111309035B (zh) | 多机器人协同移动与动态避障方法、装置、设备及介质 | |
Ishihara et al. | Deep radio-visual localization | |
Jia et al. | An advanced distributed MDS-MAP localization algorithm with improved merging strategy | |
CN107463871A (zh) | 一种基于角特征加权的点云匹配方法 | |
Karpov et al. | Multi-robot exploration and mapping based on the subdefinite models | |
Feng et al. | Floorplannet: Learning topometric floorplan matching for robot localization | |
CN103983270B (zh) | 一种声纳数据的图像化处理方法 | |
Youssefi et al. | Visual and light detection and ranging-based simultaneous localization and mapping for self-driving cars | |
CN112747752B (zh) | 基于激光里程计的车辆定位方法、装置、设备和存储介质 | |
CN114815899A (zh) | 基于3d激光雷达传感器的无人机三维空间路径规划方法 | |
Kubertschak et al. | Fusion routine independent implementation of advanced driver assistance systems with polygonal environment models | |
Li et al. | Set‐theoretic localization for mobile robots with infrastructure‐based sensing |
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 | ||
WD01 | Invention patent application deemed withdrawn after publication | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20170926 |