专利名称：基于无线传感器网络的低成本移动机器人导航方法
技术领域：
本发明涉及的是一种移动机器人在无线传感器网络中的导航方法，移动机器人仅依靠接收信号强度(RSSI)和里程计信息，就能实现在无线传感器网络中的自主导航，无需任何先验的位置信息。具体涉及基于无线传感器网络的低成本移动机器人导航方法。
背景技术：
混合传感器网络近年来开始出现并引起业界的广泛关注。将移动机器人引入静态无线传感器网络，不仅降低了系统成本，而且改善了对动态环境的适应性。当静态节点探测到异常，并通过无线网络上报给移动机器人，移动机器人则立即前往事发地点执行更加复杂和具体的任务，如对事件进行深入的探测分析，修补网络和灾难现场紧急救援等。如何开发相关技术以实现移动机器人的自主导航是混合传感器网络研究领域首先要解决的关键问题之一。目前很多研究人员采用基于无线传感器网络的方法进行移动机器人的自主导航。可是这种基于网络中静态节点的方法不同于传统的导航方法，传统的方法往往会提供给移动机器人具体的位置和路径信息，机器人很容易地从一个位置移动到另一个位置。而在无线传感器网络的应用中，通常节点是随机部署的，很难获得每一个节点的具体位置信息，因此即使机器人知道该往哪一个静态导航节点移动，如果没有位置信息，机器人也不知道该如何移动过去。如果给节点加装GPS�？椋虺杀靖撸芎拇螅以谝恍┯τ贸『希薹ㄊ褂肎PS功能，如室内或封闭环境。因此一些研究人员对于预先未知节点位置信息的移动机器人导航，进行了深入的研究，Ettore Ferranti和Niki Trigoni在《The ComputerJournal》上 2011 年 I 月发表的 “Practical Issues in Deploying Mobile Agents toExplore a Sensor-1nstrumented Environment”一文，提出的解决方案是移动机器人利用照相技术定位周边的静态节点，并引导机器人朝静态导航节点运动。这种类似的方案需要给机器人加装额外的传感器，系统结构较为复杂。目前，基于RSSI的方法是最为廉价的WSN节点间测距和定位方式，不需要额外的硬件开销。但是由于无线信号对于复杂环境的适应能力较弱，信号传输过程中存在多路衰减、背景噪声和不规则信号的传播特性等因素的影响，使得通过测量的RSSI值来计算距离会有较大的误差，基于RSSI的测距精度非常有限。Jehn-Ruey Jiang等在《International Journal of Ad Hoc and Ubiquitous Computing》上 2011 年 7 月发表了 “Mobile Robot Coordination and navigation with directionalantennas in positionless Wireless Sensor Networks”。该文在移动机器人上面安装了两个天线一个全向天线和一个可旋转的有向天线。机器人移动每一步时，首先旋转它的有向天线，然后选择导航目标节点的RSS最强的方向作为下一步的移动方向。该方法具有一定的抗干扰能力，但其操作效率很低，因为机器人每移动一步都需要停下来旋转它的有向天线
发明内容
针对现有技术中的缺陷，本发明提出一种新颖的低成本的基于无线传感器网络的导航方法，可以使移动机器人从初始位置沿由静态节点组成的路径移动到异常事件地点。和其它基于无线传感器网络的导航方法相比，本发明仅仅需要用到移动机器人与静态导航节点间的RSS和里程计信息。因此，移动机器人仅需要装备一个带有全向天线的无线传感器�？楹捅嗦肫鳎湍芙械己剑恍枰钔獾纳璞福哂械统杀镜挠攀疲挥捎诓捎昧说畲蠛笱楣兰扑惴ǎ哂幸欢ǖ目垢扇拍芰Γ涣硗猓蔡诘愫鸵贫魅硕疾恍枰妊榈奈恢眯畔ⅲ欣诠ぷ飨殖〔渴�。本发明的一个优选方案中的导航方法如下首先，静态节点监测到异常事件，然后发出“HELP”信息给移动节点，移动节点收到“HELP”信息后，通过AODV或DSR算法得到由静态节点组成的从当前位置到事发地点的最小跳数的路径。移动机器人先到达第一个静态节点，它只须重复以前的步骤就能够以逐跳的方式到达事发地点。具体地，根据本发明的一个方面，提供一种基于无线传感器网络的低成本移动机器人导航方法，在二维平面无线传感网络区域内，移动机器人利用RF射频芯片的RSSI和里程计信息，通过迭代最大后验估计算法，在无线传感器网络内实现自主导航的方法，具体包括以下步骤步骤1:为无线静态节点和移动机器人装备全向天线，为移动机器人装备编码器；步骤2 :静态节点监测到异常事件后发出HELP信息给移动机器人，移动机器人收到HELP信息后，通过路由算法得到由静态节点组成的从当前位置到事发地点的基于最小跳数的路径；步骤3 :移动机器人运用迭代的最大后验估计算法，利用RSSI和里程计信息到达它的静态邻居节点，然后移 动机器人运用迭代的最大后验估计算法，利用RSSI和里程计信息到达它的静态邻居节点以逐跳的方式到达事发地点。优选地,所述步骤3包括如下步骤步骤3.1 :移动机器人记录下在初始位置的状态测量Ztl ；步骤3. 2 :移动机器人沿初始航向以步长Lenp■移动一步，并记录该位置的状态测Sz1 ；步骤3. 3 :移动机器人根据状态测量Ztl和Z1，利用最大后验估计算法，得到两个静态导航节点的估计坐标，随机选取一个计算移动方向；步骤3. 4 :每当获得一个新的状态测量Zk，则将状态测量Zk存入移动机器人的采样缓冲区，移动机器人根据采样缓冲区中的样本集合，利用最大后验估计算法，计算静态导航节点的新的估计位置和转向角，然后沿计算的方向移动；步骤3. 5 :重复执行步骤3. 4，直到移动机器人到达目标节点位置为止优选地，所述迭代最大后验估计算法，具体地，移动机器人在第k步时的状态测量Zk为Zi ={Xl,Rk]，其中，X； =|xf>:| X和Rk分别表示移动机器人在第k步时的坐标和静态导航节点的RSSI。优选地，所述采样缓冲区是一个最大长度为Lenqu-的环形缓冲区，当新样本加入时，最旧的样本就被替换掉。优选地，移动机器人在第k步时的坐标X!，由里程计信息计算得到。
通过阅读参照以下附图对非限制性实施例所作的详细描述，本发明的其它特征、目的和优点将会变得更明显图1为本发明的系统框图；图2为本发明中迭代最大后验估计算法的原理图；图3为本发明中迭代最大后验估计算法的伪语言描述。
具体实施例方式下面结合 具体实施例对本发明进行详细说明。以下实施例将有助于本领域的技术人员进一步理解本发明，但不以任何形式限制本发明。应当指出的是，对本领域的普通技术人员来说，在不脱离本发明构思的前提下，还可以做出若干变形和改进。这些都属于本发明的保护范围。我们假设一个由静态和动态节点组成的混合传感器网络被部署在一个户外的平面监测区域内。本发明的导航方法如下如图1所示，首先，静态节点监测到异常事件，然后发出“HELP”信息给移动节点，移动节点收到“HELP”信息后，通过AODV或DSR算法得到由静态节点组成的从当前位置到事发地点的最小跳数的路径。移动机器人到达第一个静态节点后，它只须重复以前的步骤就能够以逐跳的方式到达事发地点。因此本发明的重点就是在没有任何先验位置信息的前提下，移动机器人如何仅利用RSSI和里程计信息到达它的静态邻居节点，并且具有一定的噪声抑制能力。以一个静态节点为例，说明移动机器人到达静态邻居节点的步骤我们假设机器人只做直线和转向运动，机器人通过运动和测量，来估计静态邻居导航节点的位置。如图2所示，首先我们定义机器人的初始位置和航向分别为坐标原点和沿X轴方向。设Xi = W,y丨、0k、&、4={疋為|分别表示移动机器人在第1^步时的坐标、航向角、静态导航节点的RSSI和状态测量，则第O到第k步的状态测量集合表示为Z0:k, X= (x, y)表示被估计的静态导航节点的坐标。移动机器人的坐标和航向角可以通过里程计信息计算得到。接下来，我们详细描述基于迭代最大后验估计的静态导航节点坐标估计方法。如图2所示第一步，机器人记录下在初始位置的测量Ztl ；第二步，机器人沿初始航向以步长Lenpara移动一步，并记录该位置的测量Z1 ；第三步，机器人根据测量值Ztl和Z1，利用最大后验估计算法，得到两个静态导航节点的估计坐标，我们随机选取一个计算移动方向。第四步，如图2所示，在机器人移动两步后，根据，静态节点N的坐标被估计为N’氏奶，航向角为θ2，则机器人可以通过方程⑴得到转向角α
权利要求
1.一种基于无线传感器网络的低成本移动机器人导航方法，其特征在于，在二维平面无线传感网络区域内，移动机器人利用RF射频芯片的RSSI和里程计信息，通过迭代最大后验估计算法，在无线传感器网络内实现自主导航的方法，具体包括以下步骤 步骤1:为无线静态节点和移动机器人装备全向天线，为移动机器人装备编码器； 步骤2 :静态节点监测到异常事件后发出HELP信息给移动机器人，移动机器人收到HELP信息后，通过路由算法得到由静态节点组成的从当前位置到事发地点的基于最小跳数的路径； 步骤3 :移动机器人运用迭代的最大后验估计算法，利用RSSI和里程计信息到达它的静态邻居节点，然后移动机器人运用迭代的最大后验估计算法，利用RSSI和里程计信息以逐跳的方式到达事发地点。
2.根据权利要求1所述的基于无线传感器网络的低成本移动机器人导航方法，其特征在于，所述步骤3包括如下步骤 步骤3.1 :移动机器人记录下在初始位置的状态测量Ztl ； 步骤3. 2 :移动机器人沿初始航向以步长Lenp.移动一步，并记录该位置的状态测量Z1; 步骤3. 3 :移动机器人根据状态测量Ztl和Z1，利用最大后验估计算法，得到两个静态导航节点的估计坐标，随机选取一个计算移动方向； 步骤3. 4 :每当获得一个新的状态测量Zk，则将状态测量Zk存入移动机器人的采样缓冲区，移动机器人根据采样缓冲区中的样本集合，利用最大后验估计算法，计算静态导航节点的新估计位置和转向角，然后沿计算的方向移动； 步骤3. 5 :重复执行步骤3. 4，直到移动机器人到达目标节点位置为止。
3.根据权利要求2所述的基于无线传感器网络的低成本移动机器人导航方法，其特征在于，所述迭代最大后验估计算法，具体地，移动机器人在第k步时的状态测量Zk为Z, = ■其中，χ；=Κ,λ1 A和Rk分别表示移动机器人在第k步时的坐标和静态导航节点的RSSI。
4.根据权利要求2所述的基于无线传感器网络的低成本移动机器人导航方法，其特征在于，所述采样缓冲区是一个最大长度为Lenqu_的环形缓冲区，当新样本加入时，最旧的样本就被替换掉。
5.根据权利要求3所述的基于无线传感器网络的低成本移动机器人导航方法，其特征在于，移动机器人在第k步时的坐标X，由里程计信息计算得到。
全文摘要
本发明提出一种基于无线传感器网络的低成本移动机器人导航方法，包括以下步骤首先，静态节点监测到异常事件，然后发出“HELP”信息给移动机器人，移动机器人收到“HELP”信息后，通过路由算法得到由静态节点组成的基于最小跳数的路径。移动机器人运用迭代最大后验估计算法，仅利用RSSI和里程计信息就能够以逐跳的方式到达事发地点。本发明拥有以下优势移动机器人仅须装备一个带有全向天线的无线传感器�？楹捅嗦肫骶湍芙械己剑恍枰钔獾纳璞福哂械统杀镜挠攀疲痪蔡投诘愣疾恍枰妊榈奈恢眯畔ⅲ欣诠ぷ飨殖〔渴穑桓梅椒ɑ咕哂幸欢ǖ目垢扇拍芰�。
文档编号G01S5/14GK103064058SQ20121058658
公开日2013年4月24日 申请日期2012年12月28日 优先权日2012年12月28日
发明者陈佳品, 张铮, 张大伟, 唐晓宁, 李振波 申请人:上海交通大学
专业数控铣床产品供应商
20年生产经验，实力工厂，精工品质，质量有保障
