专利名称：一种实时数据融合的移动机器人栅格地图创建方法
技术领域：
本发明属于机器人和人工智能技术领域，涉及一种实时数据融合的移动机器人栅格 地图创建方法。
背景技术：
近20年来，人工智能技术和计算机技术的飞速发展，自主智能移动机器人研究取 得了重大关注。它要求能通过自身所载的传感器如测距仪、摄像机、红外等自动获取周 围环境信息，建立空间环境模型和识别自身当前位置，沿自动规划的有效路径移动，从 而完成特定任务。目前智能移动机器人广泛应用于工农业、交通运输、军事、医疗卫生 等行业，解决危险环境下工作问题和取代人类繁重工作。为提高移动机器人在未知环境 下的工作能力和应用范围，把环境表示为适合机器人"理解"的地图，即地图创建是急 需解决的关键难题。
移动机器人的工作环境一般可以简化为二维模型，并用占用栅格加以描述。该模型 将机器人所在空间环境划分为若干规则栅格，通过提取每个栅格单元的状态(障碍物、 空闲、未知)来确定环境表示。该模型表示直观，易于创建和维护。在未知环境中，机 器人不了解任何先验信息，例如环境规模和障碍物的大小、形状、位置等，且环境中不 存在诸如路标、灯塔等人为设定的参照物。机器人创建地图只能依赖于其传感器所获得 的信息，如里程仪、声纳、激光等等。建立地图的过程，实际上就是机器人根据传感器 的感知自主地对其活动环境建模的过程。由于传感器自身的限制，感知信息存在不同程 度的不确定性，通常需要对感知信息再处理。地图创建中的信息处理可归纳为以下三个 问题
(1) 如何描述感知信息的不确定性；
(2) 如何依据对信息的不确定性描述创建地图，地图中不仅要反映感知信 息，还要反映信息的不确定性；
(3) 当对同一目标地点有了新的感知信息时，如何处理旧信息与新信息的，即更新地图。
在移动机器人导航中，声纳传感器由于其廉价、简单易用、数据处理方便等特点， 因此在移动机器人领域取得广泛应用，但声纳传感器本身也存在多重反射、镜面反射、 角精度低等缺陷，其感知信息存在较大的不确定性。目前在地图创建的研究中，模糊逻 辑和概率理论是具有代表性的两种用于描述和处理不确定信息的方法。前者通过定义模 糊集表示环境中的空、非空区域与状态不确定，对各栅格单元根据测量结果计算相应的 隶属度;后者对各栅格单元给出其为障碍物占有的概率，根据贝叶斯法则进行信息融合。 分析与实验表明，基于概率的方法产生的地图精度较高，轮廓清楚，但对错误信息过于 敏感，误判率高；而模糊逻辑方法则具有较高的鲁棒性，在信息不确定程度高时仍然稳 定，但精度低，产生的地图不清晰。
发明内容
本发明的所要解决的技术问题是提供一种实时数据融合的移动机器人栅格地图创 建方法，本发明移动机器人利用声纳测距仪获取环境信息，完成环境建模，从而为移动 机器人后续的自主导航提供可靠的依据。
为解决上述技术问题，本发明所采用的技术方案为
一种实时数据融合的移动机器人栅格地图创建方法，其特征在于，包括以下步骤
1) 将局部栅格地图坐标(i， j)初始化，并通过移动机器人上的多个传感器获 取的障碍物与移动机器人之间的距离值；
2) 将所述的距离值中的数值最小的3个距离值用模糊逻辑及概率理论解释排 列为一维数组；即对每一个距离值建立3个模糊集{0、 E、 U)来表示地图中栅格的占用、
空闲和未知状态；定义模糊向量r-(/v /V //J表示每个栅格处于3种状态的可信
度，栅格属于3种状态的隶属度和为1;
凡0^)， //￡(〃，力为栅格g (i， j)距传感器距离r在不同区域的栅格占用隶属度
函数和空闲隶属度函数；//。，￡("，^表示不同的波束轴线角的隶属度函数，/^￡(。表示
不同测量距离的隶属度函数；
每个栅格单元被占用的隶属度函数A。(r,a)，栅格空闲隶属度函数/^(r，a)以及栅格状态不确定隶属度函数/^(r，a)按以下计算所得:
<formula>formula see original document page 7</formula>
其中，M。表示栅格单元被占用的最大可能性，取值为小于l;其中S为传感器距 离测量值，As是对障碍物距离S的误差估计范围，a为r相对于波束中轴线的夹角；々
表示波束的锥形宽度半角；i 表示传感器的最大探测距离；
栅格g (ij)是被占用或空闲的概率分别用P (占用)和P (空闲)表示，计算方法
如下
<formula>formula see original document page 7</formula>
P(占用H1-P(空闲)；
每一个距离值对应5个元素(/z。(r，a)， //￡0% )， /^(r,a)， P (占用)；P (空闲)},对于3个距离值，则所述的一维数组具有15个元素。
3) 将所述的一维数组经神经网络处理，输出为条件概率向量 0 = [<^，0，,<9_]，分别表示栅格单元g(x, y)对应三种可能状态(障碍物，空区域，
不确定)的概率值。
4) 根据坐标变换，将栅格单元g (i， j)从局部坐标系投影到全局坐标系对应 的栅格单元g(X,y);然后利用贝叶斯概率方法分别实现三种可能状态的概率更新，根据
最大值法则，取可能状态的最大值为当前栅格的置信度。
5) 坐标更新到下一个栅格单元，如果栅格状态没有更新完，返回步骤1);如 果栅格状态更新完，则栅格地图创建己经完成。
所述的神经网络解释模型共包括三层输入层、隐含层和输出层；其中输入层的输 入向量为所述的一维所组；所述的隐含层神经元的传递函数采用S型正切函数；所述的 输出层采用的传递函数为S型对数函数，节点输出为[O， l]范围的概率值。
所述的贝叶斯概率方法为
对于栅格单元附w的三种可能状态的初始概率均为1/3，则经过测量数据序列
5 = ^(1),...^(7))后，其中sW表示三个与当前计算栅格最相关的传感器测量值序列，对 应集成概率分别如下
"(占用t) = 0。cc 尸(占用w)+0呻 户(空闲w)+ouce 尸(不确定,一)
"(占用M) +《卿"(空闲J + 0鮮，尸(不确定,J
尸(不确定,)=
O咖一(空闲M)
式中，p(占用t)、 p(空闲t)、 p(不确定t)为考虑历史信息与当前信息后的最终栅格状态
值，0。w，0，，0^为当前神经网络数据融合输出，？(占用,J、尸(空闲J、尸(不确定t.,)
为上一时刻最终栅格状态值，即先验概率，当1=1时，P(占用t.,)、 P(空闲t.J、 P(不确定w) 的值即为约定的初始概率1/3;
最后对尸(占用t)、 P(空闲t)、尸(不确定t)取最大值，即为当前栅格的置信度。所述的传感器为8个。
8个传感器的相对于机器人前向的位置为±10°、 ±30°、 ±50°和±90°。 作为改进，取M。 =0.95。
本发明所具有的有益效果-
本发明提出一种实时数据融合的移动机器人栅格地图创建方法，用于描述移动机器 人所处环境的空与非空区域。首先人为将环境划分为若干个等大小的栅格，通过安装在 移动机器人前端的声纳传感器得到距离信息；提取与当前计算栅格单元距离最近的三个 声纳传感器在同一时刻的测量值，分别采用模糊逻辑和概率理论解释单个声纳数据，即 根据距离信息用模糊逻辑表示某个栅格的占用、空和不确定，用概率理论表示某个栅格 中出现障碍物占有的概率和空的概率。由此可得到一组特征向量，并作为神经网络的输 入向量进行数据融合，神经网络的输出值为栅格空闲、被占用或不确定状态。最后采用 贝叶斯规则更新栅格的状态。本发明移动机器人利用声纳测距仪获取环境信息，完成环 境建模，从而为移动机器人后续的自主导航提供可靠的依据。
与现有技术相比，本发明的优点就在于-
① 由于神经网络的训练基于样本，对新环境具有很快地自适应性；
② 对模糊逻辑、概率理论分别解释声纳数据的结果进行融合，有效结合了模糊逻 辑解释模型鲁棒性高、概率理论解释模型精度高的优势；
◎可同时处理多个传感器信息，考虑了多个传感器对同一栅格的测量结果的影响， 联合周围传感器信息可生成更为精确的结果，可很好地解决镜面反射以及其它 不确定性问题。
图1本发明栅格地图创建方法原理图； 图2移动机器人前向声纳环配置； 图3声纳传感器t莫型； 图4神经网络数据融合创建栅格地图； 图5训练样本环境；图6占用栅格获取样本样例。
具体实施例方式
以下结合附图对本发明作进一步说明。 实施例1 -
本发明提出一种实时数据融合的移动机器人栅格地图创建方法，其系统原理图如图 1所示。采用神经网络对概率理论、模糊逻辑解释的声纳数据不确定性进行信息融合， 并考虑了多个声纳的空间相关性对同一栅格状态的影响，以建立环境栅格地图。
图1中S0、 Sl、…、S7为安装在移动机器人前端的声纳传感器测距值，0，{x，y}、
0。Jx,力、0_{1,力分别为当前计算的栅格空闲概率、障碍物概率和不确定状态概率。 移动机器人采用超声波测距传感器来完成环境建模，其前端安装有八个声纳测距传 感器。图2中移动机器人声纳传感器的位置为±10°、 ±30°、 ±50°和±卯°，用于探测
各自方向上障碍物的信息。
当移动机器人在环境探索遍历过程中， 一次采集声纳传感器测量数据序列和对应的 机器人全局位置信息。然后以机器人为中心建立局部参考坐标系，基于声纳传感器测量 数据创建局部地图。在局部地图创建中，对局部地图的某一特定栅格单元cell(i，j)，首 先根据相应的该几何单元对应的空间位置信息选择方向最为相关的三个连续声纳传感 器，以三个声纳传感器测距信息分别用模糊逻辑(模糊集{占用，空，不确定}描述)和 概率理论(概率{障碍物，空}描述)解释可以得到15个解释数据，以此作为神经网络 的输入。经过神经网络的解释处理后(如图4所示)，其对应神经网络的输出为条件概 率向量0^0^,《w，0^]，分别表示栅格单元g(x, y)对应三种可能状态(障碍物，空
区域，不确定)的概率值。在此基础上，根据坐标变换，将栅格单元g(i,j)从局部坐标 系投影到全局坐标系对应得栅格单元g (x，y)。然后利用Bayesian概率模型分别实现三种 可能状态的概率更新。
声纳传感器模型、模糊逻辑解释声纳不确定性模型、概率理论解释声纳不确定性模 型、神经网络融合创建栅格地图算法和贝叶斯更新栅格分别在l、 2、 3、 4、 5小节中阐 述。1、 声纳传感器模型
说明单束声纳基本模型视野由-和i 确定，-表示锥形宽度半角，i 表示最大探
测距离。视野可以投影到一个正则网格上，由于网格每个单元都记录有对应的空间位置 是空闲还是被占用信息，故叫做占用网格，也称占用栅格。如图3所示，视野可以分为 三个区域。
区域I:相关元素可能被占用；
区域II:相关元素可能是空；
区域III:相关元素情况未知；
对于给定的距离读数，区域II的"空闲"比区域I "被占用"具有更大的可能性。 无论是"空闲"还是"被占用"，沿着声波轴线方向的数据比朝着两边方向的数据更准 确，部分原因是沿障碍物的一个边可能对声束产生镜面反射或者造成其他距离感知错 误。
虽然图3中的传感器模型是一种普遍选择，但在如何把模型转换为置信度数据方面 却有很大的不同，下面分别介绍模糊逻辑、概率理论进行相关转换过程，便于后续神经 网络进行数据融合。
2、 模糊逻辑解释声纳不确定性模型
说明模糊逻辑解释声纳不确定性模型的基本思想是建立3个模糊集{0、 E、 U} 来表示地图中所有栅格的占用、空闲和未知状态。定义模糊向量r-(//。， /V //J表示
每个栅格处于3种状态的信度，栅格属于3种状态的隶属度和为1。 算法
对于图3中，设声纳距离测量值为s， Ay是对障碍物距离s的误差估计范围。对于 波束覆盖范围内的任一栅格单元g (U)到传感器的距离用r表示，相对于波束中轴线的 夹角为a。以下公式(1) (4)中，//。(r，力，/^(r,力为距传感器距离r在不同区域
的栅格占用隶属度函数和空闲隶属度函数。/i。^(a,/ )表示不同的波束轴线角的隶属度
函数，//。，￡(。表示不同测量距离的隶属度函数。
每个栅格单元被占用的隶属度函数/z。(r,a)，栅格空闲隶属度函数/^(r,a)以及栅格状态不确定隶属度函数/^(r,a)可由公式(5) (7)计算所得。
<formula>formula see original document page 12</formula>式(5)中的M。表示栅格单元被占用的最大可能性，由于栅格被占用的可能性不会 为100%，因此取M。 =0.95。 3、概率理论解释声纳不确定性模型
说明用概率函数来表示栅格被占用或空闲状态。
声纳只能观察一个事件元素g Oj)是被占用或空闲。这可以写为 // = {占用，空闲}。 H事件真实发生的概率用P(H)表示
0 S P问《1
概率的一个重要性质是如果知道P(H)，那么H没有发生概率P(-H)也就知道了， 这可以表示为1-P(H) = P(-H)
P(H)和P(-H)形式的概率叫做无条件概率，仅仅提供一个先验信息，而没有考虑传 感器读数s。对机器人来说，能根据传感器读数计算区域g(ij)空闲或被占用概率的函数 更加有用，这种概率叫条件概率。P(Hls)就是给定传感器具体读数s时，H事件实际发
生的概率。条件概率也有这样的性质P(H|s) + P(-H|s) = l。 对于图3区域I中每一个栅格单元
(R-r) + ("- )
P(占用)^
R
2 - (8)
P(空闲)4-P(占用) (9)
r、 a的含义与模糊逻辑解释声纳不确定性模型中的一致，M,表示被占用单元读数
永远不会使占用置信度为100%，取M, =0.98。 对于图3区域II中每一个栅格单元 P(占用)-l-P(空闲)
(10)
(R-r) + (/ -")
P(空闲)
R
2
(11)
与区域I栅格单元不同，区域II元素空闲概率可达到1。 4、神经网络数据融合创建栅格地图
说明在栅格地图创建中，声纳传感器的测量数据必须解释映射为相关位置单元
g(x,y)的置信度。然而，声纳传感器存在多重反射、镜面反射、角精度低等问题，很难 建立精确的数学模型用于解释声纳数据。由于训练后的多层神经网络可逼近任何概率分 布，因此可利用训练后的神经网络实现声纳测量数据到栅格概率的映射。
1)神经网络结构
如图4所示，本发明提出的神经网络解释模型共包括三层输入层、 一个隐含层和
输出层。以下详细讨论各层的设计与实现。(1) 输入层
神经网络的输入向量包含15个元素。对于给定栅格单元g(ij)，选择以机器人中心与 栅格单元中心线方向最相关的左右共三个声纳传感器同一时刻获取到的3个声纳测量数
据。然后，按照单声纳传感器的模糊逻辑解释模型计算每个声纳测量数据对栅格单元
g(ij)的解释，共三组模糊集表示栅格的状态，即r,^。,， &， /^}、
&={/^2， /^2， /^3}、 K={;"。3， >"￡3， /^/3};按照单声纳传感器的概率理论解释模型 计算每个声纳测量数据对栅格单元g(ij)的状态，共三组概率值表示栅格的状态，即 S-W。" AJ、尸2={尸。2， &2}、尸3={尸。3，几3}。将这六组数据共15个元素作为神经 网络的输入，如下
P = (/^01，/^l， A71， A92，/^2,/^t/2， /^93，/^3 ，/^/3,尸。1，尸。2 ，尸￡2尸。3尸￡3 }
(2) 隐含层
隐含层的神经元个数设计为31个，隐含层的神经元个数并不是固定的，在实际训练 中根据需要调整。隐含层神经元的传递函数采用S型正切函数。
(3) 输出层
输出层有3个节点，输出值分别为0 =
，表示栅格单元对应的三种可 能状态。其中第一个输出节点表示栅格单元为占用状态的概率值为0_，第二个输出节 点表示栅格单元为空闲状态的概率值为O，，第三个输出节点表示栅格单元为不确定状 态的概率值为<9_。该网络层所采用的传递函数为S型对数函数，节点输出仍为[O， 1]
范围的概率值。
2)神经网络训练
神经网络训练是神经网络的非常重要的步骤， 一旦网络训练完成，由于神经网络自 身的鲁棒性和自适应性，即可用于多种不同的环境中。以下详细介绍关于声纳解释网络 所涉及的训练样本和训练算法。 (1)训练样本
根据图4所示的神经网络模型，训练数据样本的形式如下
<,， Am , /^02 ，， /^/2,， /^￡3 ，，尸Ol ，尸￡1 ，尸02 ，尸五2 ,尸。3 ,尸五3 , 。。cc , 0， ， O譜>其中〈;"。i,/^i,A;i >、 </"。2，/"￡2,/^2 >、 <>"。3，/^3，/^/3 >分别表示机器人中心与栅
格单元中心线方向最相关的左右共三个声纳传感器同一时刻获取的3个声纳测量数据， 按照单声纳传感器的模糊逻辑解释模型计算每个声纳测量数据对栅格单元g(ij)的解释； 〈尸。i，i^〉、 <尸。2，&2>、 <尸。3,&3>分别表述用概率理论对上述三个传感器同一时刻
获取到的3个声纳测量数据的解释；栅格单元g(i,j)的期望输出用〈C^，0，,C^ 〉表示，
分别对应于占用、空闲与不确定状态的输出，其可能输出值为[l,O,O],[O,l,O],[O，O，l]。
训练样本的采集过程如下。将机器人放入已知室内环境下(即机器人位置、周围障 碍物位置已知)，通过机器人直线运动、旋转运动，随机连续多次采集机器人位姿和声 纳传感器测量数据，而<0^，0，,0^ >为考虑到栅格单元与障碍物空间信息计算所得
cell(ij)的真实空间状态对应输出。
图5为实际训练环境表示。采用的声纳测距范围为R-300cm，波束角- = 15°，公差 为15cm,栅格大小定为10cmX10cm。
下面通过例子说明样本的获取。
如图6所示占用栅格覆盖了一个30X24单位的区域，也就可以表示为一个30X24 的二维数组，考虑特定栅格g[7][11](图中黑圆点所示)，机器人位置在g[27][11](图 中黑方点所示)，即产200cm。同一时刻获取8个声纳的测量数据，与特定栅格g[7][11]
位置最相关的声纳数据为图2中位于±10°、 30。的声纳数据(也可以用位置在-30°的 声纳数据替换位置在3(T的声纳所获取数据，因为此时栅格与这两个传感器等距)。 *对于位置为10'的声纳，所得到距离信息为s=210cm， a = -10°，其中 ^， r^s土公差，栅格单元在声纳模型夹角的区域内，同时在距离读数上限范围 内，属于测量值影响范围内。
套用公式(1) (7)可得到对此声纳数据用模糊逻辑表示的该栅格状态为 7; ={0.367,0.475,0.158};因为处于区域I，套用公式(8) (9)用概率理论表示的该栅格状态为A = {0.327,0.673}。
*对于位置为-10°的声纳，所得到距离信息为205cm, " = 10°，其中
|"|—"|， A"2S土公差，栅格单元在声纳模型夹角的区域内，同时在距离读数上限范围
内，属于测量值影响范围内。套用公式(1) (7)可得到对此声纳数据用模糊逻辑表 示的该栅格状态为712 ={0.475,0.367,0.158};因为处于区域I，套用公式(8) (9)用
概率理论表示的该栅格状态为A = {0.327,0.673}。
*对于位置为30"的声纳，所得到距离信息为110cm， a = -3(T。其中
|a|>|々|， r〈;y +公差，虽然在距离读数上限范围内，但栅格单元在声纳模型夹角的区
域外，故不属于测量值影响范围内，对于此声纳数据用模糊逻辑表示的该网格状态为 r3 = {0，0，1}，用概率理论表示的该栅格状态为尸3 = {0，1}。
*实际中此栅格为占用，故有<9 = [1，0，0]。
这样得到一个样本数据，由t;、 r2、 r3、 pP尸2、尸3、 o组成，如下所示
< 0.367,0.475,0.158,0.475,0.367,0.158.0，0,1,0.327,0.673,0.327,0.673,0,1,1，0,0 >
其余样本可以由相同方法产生。 (2)神经网络训练算法 在本文神经网络训练中，采用经典的Levenberg-Marquardt算法对神经网络进行训
练，学习率为O.Ol,选用通用的近似均方差函数作为性能指标函数，当误差为2.5xl0—s时
训练结束。
5、贝叶斯更新栅格
当神经网络训练结束后，移动机器人在空间环境中沿障碍物边缘行走遍历，获取空 间环境信息，并利用神经网络对所采集的传感器阵列进行解释。因此对同一栅格单元， 可能存在不同时刻的多个解释。为获得更为准确的解释，需要对这些数据进行集成。为 避免计算的复杂性，保证地图创建算法的增进式处理，集成方式仍采用Bayesian (贝叶 斯)集成模型。
由于本神经网络模型同时输出关于栅格单元三种状态的概率，因此在地图创建过程中，分别对栅格单元的三种状态概率历史数据进行集成。对于栅格单元m,力.的三种可能
状态的初始概率均为1/3，则经过测量数据序列S-(^",…^m)后(其中^w表示三个与 当前计算栅格最相关的传感器测量值序列)，对应集成概率分别如下
<formula>formula see original document page 17</formula>
式中，尸(占用》、P(空闲》、P(不确定t)考虑历史信息与当前信息后的最终栅格状态值，
0。^0，，0 为当前神经网络数据融合输出，户(占用w)、尸(空闲tJ、尸(不确定t.,)为上
一时刻最终栅格状态值，即先验概率，当t^时(第一次计算)，尸(占用,.i)、尸(空闲t.,)、
P(不确定w)的值即为约定的初始概率1/3。
最后对P(占用t)、 P(空闲t)、尸(不确定t)取最大值，即为当前栅格的置信度。
权利要求
1. 一种实时数据融合的移动机器人栅格地图创建方法，其特征在于，包括以下步骤1)将局部栅格地图坐标(i，j)初始化，并通过移动机器人上的多个传感器获取的障碍物与移动机器人之间的距离值；2)将所述的距离值中的数值最小的3个距离值用模糊逻辑及概率理论解释排列为一维数组；即对每一个距离值建立3个模糊集{O、E、U}来表示地图中栅格的占用、空闲和未知状态；定义模糊向量T＝{μO，μE，μU}表示每个栅格处于3种状态的可信度，栅格属于3种状态的隶属度和为1；μo(r，s)，μE(r，s)为栅格g(i，j)距传感器距离r在不同区域的栅格占用隶属度函数和空闲隶属度函数；μo，E(α，β)表示不同的波束轴线角的隶属度函数，μO，E(r)表示不同测量距离的隶属度函数；每个栅格单元被占用的隶属度函数μo(r，α)，栅格空闲隶属度函数μE(r，α)以及栅格状态不确定隶属度函数μU(r，α)按以下计算所得μo(r，α)＝M0[μo(r，s)+μo，E(α，β)+μo，E(r)]/3；μE(r，α)＝[μE(r，s)+μO，E(α，β)+μO，E(r)]/3；μU(r，α)＝1-μO(r，α)-μE(r，α)；其中，M0表示栅格单元被占用的最大可能性，取值为小于1；其中s为传感器距离测量值，Δs是对障碍物距离S的误差估计范围，α为r相对于波束中轴线的夹角；β表示波束的锥形宽度半角；R表示传感器的最大探测距离；栅格g(i，j)是被占用或空闲的概率分别用P(占用)和P(空闲)表示，计算方法如下P(占用)＝1-P(空闲)；每一个距离值对应5个元素{μo(r，α)，μE(r，α)，μU(r，α)，P(占用)；P(空闲)}，对于3个距离值，则所述的一维数组具有15个元素。3)将所述的一维数组经神经网络处理，输出为条件概率向量O＝[Oocc，Oemp，Ouce]，分别表示栅格单元g(i，j)对应三种可能状态(障碍物，空区域，不确定)的概率值。4)根据坐标变换，将栅格单元g(i，j)从局部坐标系投影到全局坐标系对应的栅格单元g(x，y)；然后利用贝叶斯概率方法分别实现三种可能状态的概率更新，根据最大值法则，取可能状态的最大值为当前栅格的置信度。5)坐标更新到下一个栅格单元，如果栅格状态没有更新完，返回步骤1)；如果栅格状态更新完，则栅格地图创建已经完成。
2. 根据权利要求1所述的实时数据融合的移动机器人栅格地图创建方法，其特 征在于，所述的神经网络解释模型共包括三层输入层、隐含层和输出层；其中输入层 的输入向量为所述的一维所组；所述的隐含层神经元的传递函数采用S型正切函数；所 述的输出层采用的传递函数为S型对数函数，节点输出为[O， l]范围的概率值。
3. 根据权利要求1所述的实时数据融合的移动机器人栅格地图创建方法，其特 征在于，所述的贝叶斯概率方法为对于栅格单元/n,力.的三种可能状态的初始概率均为1/3，则经过测量数据序列 S-(W"，…，^n)后，其中^w表示三个与当前计算栅格最相关的传感器测量值序列，对应集成概率分别如下(9。？P(占用w)尸(占用)=0。cc 尸(占用")+ O， 尸(空闲w) +《ce 户(不确定,—!)《呵"(空闲M)尸(不确定t)=化？尸(占用w) + o， 尸(空闲w) + o咖 户(不确定w)式中，尸(占用t)、尸(空闲,)、尸(不确定t)为考虑历史信息与当前信息后的最终栅格状态值，0。 ，0，,6^为当前神经网络数据融合输出，尸(占用w)、尸(空闲")、尸(不确定,.,) 为上一时刻最终栅格状态值，即先验概率，当t^时，尸(占用t.,)、户(空闲w)、尸(不确定t》的值即为约定的初始概率1/3;最后对户(占用t)、户(空闲t)、户(不确定t)取最大值，即为当前栅格的置信度。
4. 根据权利要求1所述的实时数据融合的移动机器人栅格地图创建方法，其特 征在于，所述的传感器为8个。
5. 根据权利要求4所述的实时数据融合的移动机器人栅格地图创建方法，其特征在于，所述8个传感器的相对于机器人前向的位置为±10°、 ±30°、 ±50°和±90'。
6. 根据权利要求1至5任一项所述的实时数据融合的移动机器人栅格地图创建 方法，其特征在于，取M。-0.95。
全文摘要
本发明提出一种实时数据融合的移动机器人栅格地图创建方法，首先人为将环境划分为若干个等大小的栅格，通过安装在移动机器人前端的声纳传感器得到距离信息；提取与当前计算栅格单元距离最近的三个声纳传感器在同一时刻的测量值，分别采用模糊逻辑和概率理论解释单个声纳数据，由此可得到一组特征向量，并作为神经网络的输入向量进行数据融合，神经网络的输出值为栅格空闲、被占用和不确定状态。最后采用贝叶斯规则更新栅格的状态。本发明移动机器人利用声纳测距仪获取环境信息，完成环境建模，从而为移动机器人后续的自主导航提供可靠的依据。
文档编号G01C21/28GK101413806SQ20081014353
公开日2009年4月22日 申请日期2008年11月7日 优先权日2008年11月7日
发明者余洪山, 孙程鹏, 伟 宁, 江 朱, 王耀南, 淼 胡, 许海霞, 霞 邓 申请人:湖南大学