CN1945351B - 一种机器人导航定位系统及导航定位方法 - Google Patents
一种机器人导航定位系统及导航定位方法 Download PDFInfo
- Publication number
- CN1945351B CN1945351B CN2006100969769A CN200610096976A CN1945351B CN 1945351 B CN1945351 B CN 1945351B CN 2006100969769 A CN2006100969769 A CN 2006100969769A CN 200610096976 A CN200610096976 A CN 200610096976A CN 1945351 B CN1945351 B CN 1945351B
- Authority
- CN
- China
- Prior art keywords
- robot
- sensor network
- wireless sensor
- navigation
- wireless
- 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
Images
Landscapes
- Manipulator (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种机器人导航定位系统及导航定位方法。系统包括应用于机器人导航定位系统的无线传感器网络和机器人,无线传感器网络节点由传感单元、处理单元、定位单元、无线模块和电源模块组成,机器人具有移动能力,其上安置有无线定位模块;导航定位方法为:将无线传感器网络节点布撒于监控区域,各节点通过自组网形成无线传感器网络,机器人根据无线传感器网络提供的位置和环境信息进行置信度判断和校正,进而进行环境建模、定位、路径规划和导航。该发明能够单独或与惯性导航、视觉导航等方式进行组合实现移动机器人高精度定位和导航,可广泛地用于各种不能或不宜使用GPS的场合,对移动机器人、运动车辆和人员进行导航定位。
Description
技术领域本发明涉及机器人定位导航领域,特别涉及一种机器人导航定位系统及导航定位方法。
背景技术机器人在许多场合被寄予了替代人类自动执行某些日常性与危险性任务的厚望。机器人自主导航与定位技术是移动机器人的关键技术。目前,移动机器人常用的导航方法有惯性导航、视觉导航、基于传感器数据导航,卫星导航等以及它们的组合。
专利公告号CN1569558A,名称为“基于图像表现特征的移动机器人视觉导航方法”中公开了一种基于图像特征的机器人视觉导航方法。该发明通过移动机器人的视觉传感器-摄像头,获取机器人所处位置的场景图像,再根据已经构建好的场景地图,在已知初始位置和目标位置的情况下,完成基于视觉的导航任务。移动机器人自动检测自然标识物,对当前图像与场景样本库中的图像进行匹配,以确定当前位置。该发明适合于在超声波、激光、红外等传统导航方式较难适应的非结构场景的环境下,进行移动机器人的自定位。该发明将场景标识物检测和场景图像表现分析相结合,避免了对场景标识的精确分割和定位过程。然而,上述发明的导航方法的是基于视觉的机器人导航方法,该方法分为学习和工作两个过程。使用在学习过程中获得的场景地图、建立的场景样本库等先验知识进行导航。且在多数情况下,这些先验知识的获取是有一定难度的。
惯性导航是最基本也是最常用的导航方式,它利用机器人装配的惯性导航器件,计算机器人航程,从而推知机器人当前的位置和下一步的目的地。惯性导航的优点是可以提供完全的自主性和完备的导航信息(位置、速度、姿态等),但最大的缺点是随着机器人航程的增长,定位的精度就会下降,而且定位误差会随航程的增长无限制地增加。引入外部信息可以限制惯性导航系统INS的固有漂移。目前最理想的外部信息是全球卫星定位系统GPS,GPS/INS组合系统可获得相当高的导航精度。但GPS是由美国国防部控制的,对非美国国防部授权的用户,其所能获得的定位导航精度较低,且在战场环境下GPS并非总是可靠的。特别是关系到国家安全的军事等应用无法得到保障。因此,研究新的不依赖GPS的高精度定位导航系统和方法就显得尤为迫切和重要。
发明内容本发明的目的在于避免上述现有技术中的不足之处,提供一种基于无线传感反应网络的、不依赖GPS对机器人进行导航定位的新系统和方法,即一种机器人导航定位系统及导航定位方法。该系统和方法使用无线传感器网络实现移动机器人的导航定位,并能根据无线传感反应网络提供的实时环境信息对机器人的路径规划提供决策支持,使机器人在运动时能及时避开危险区域、选择优化路径。
本发明的技术方案是:一种机器人导航定位系统及导航定位方法,包括无线传感器网络和机器人,其特征在于:无线传感器网络是由布撒于监控区域的无线传感器网络节点构成;无线传感器网络节点由具有感应、处理、通讯、定位功能的传感单元、处理单元、定位模块、无线模块和第一电源模块组成;机器人具有移动能力,其上安置有无线定位模块,并置于布置了无线传感器网络的区域中;无线定位模块由具有处理、通讯和定位功能的处理单元、定位模块、无线模块和第二电源模块组成。
无线传感器网络节点可以具有温度、湿度、振动、光照、辐照和气体等对所处环境进行监测的传感器;无线传感器网络节点的布撒可以采用事先空投、抛撒和发射等方式,也可以由机器人边行进边布撒。
机器人可以是配置无线定位模块的移动机器人、人员和车辆;无线定位模块,也可以具有传感功能,以检测机器人的状态及其所处的环境信息,其通讯方式是无线电、声、超声和光等无线传输方式。
无线传感器网络节点和无线定位模块的定位功能可以通过测量跳数、信号强度、到达时间、到达时间差、到达角度等方式实现。
一种机器人导航定位系统及导航定位方法,是一种不依赖GPS对移动机器人进行导航和定位的方法,该方法同样适用于外星探测车辆、人员和装备的导航与定位。其特征在于是按以下步骤完成的:
将无线传感器网络节点布撒于监控区域;
已布撒的无线传感器网络节点根据设定的网络结构,自动组网构建无线传感器网络;
无线传感器网络使用定位模块给各无线传感器网络节点初步定位;
无线传感器网络获取各无线传感器网络节点收集的环境信息;
无线传感器网络使用一些簇头节点来对环境信息筛选和融合;
无线传感器网络结合融合后的环境信息有温度、湿度、坡度给各无线传感器网络节点二次定位;
无线传感器网络将筛选和融合后的各无线传感器网络节点的环境信息和位置信息传给机器人;
机器人对接收到的无线传感器网络的环境信息进行置信度判断,误差校正;
机器人根据校正后的环境信息进行环境建模;
机器人根据无线传感器网络的信息及自己的环境模型进行机器人定位、路径规划和导航;
网络结构和环境发生变化时,进行网络维护,并重新环境建模、机器人定位、路径规划和导航。
网络结构和环境不发生变化时,随着机器人的移动,重新进行机器人的定位,并根据先前的规划进行导航。
相对于现有技术的有益效果是:
其一,现有技术中用于的导航定位的GPS是由美国国防部控制的,对非美国国防部授权的用户,其所能获得的定位导航精度较低,且在战场环境下GPS并非总是可靠的。特别是关系到国家安全的军事等应用无法得到保障。本发明研制的一种机器人导航定位系统,包括无线传感器网络和机器人,特别是无线传感器网络是由布撒于监控区域的无线传感器网络节点构成;无线传感器网络节点由具有感应、处理、通讯、定位功能的传感单元、处理单元、定位模块、无线模块和第一电源模块组成;机器人具有移动能力,其上安置有无线定位模块,并置于布置了无线传感器网络的区域中;无线定位模块由具有处理、通讯和定位功能的处理单元、定位模块、无线模块和第二电源模块组成。因此,该系统使用无线传感器网络的信息进行导航定位,不依赖GPS等外部信息,在不能或不宜使用GPS的情况下,特别是军事等敏感应用领域,能够代替GPS,并能够和惯性导航、视觉导航等方式进行组合实现移动机器人高精度定位和导航;该系统还可应用于外星球探测车与人员、设备等的导航与定位;该系统具有成本低、可靠性高、布置容易等优点。
其二,在本发明中,一种机器人导航定位系统的导航定位方法是按以下步骤完成的:将无线传感器网络节点布撒于监控区域;已布撒的无线传感器网络节点根据设定的网络结构,自动组网形成无线传感器网络;无线传感器网络将各无线传感器网络节点的位置信息和收集的环境信息传给机器人;机器人根据无线传感器网络的信息进行环境建模、定位、路径规划和导航。因此,该方法可利用无线传感器网络获取的各种环境信息,如温度、湿度、坡度等,为机器人导航与路径规划提供决策支持,使机器人在路径规划时能避开危险区域、选择优化路径。
其三,现有技术中基于视觉的导航方法,通常包括学习和工作两个过程。使用在学习过程中获得的场景地图、建立的场景样本库等先验知识进行导航。且在多数情况下,这些先验知识的获取是有一定难度的。本发明的一种机器人导航定位系统及导航定位方法,相对于现有技术中基于视觉的导航方法无须学习过程,直接通过传感器节点获取的信息,针对可能实时变化的环境信息,进行实时环境建模和机器人定位导航,环境适应性强、使用简单。
附图说明下面结合附图对本发明作进一步的详细说明。
图1是本发明的系统结构示意图。
图2是无线传感器网络节点结构示意图。
图3是无线定位模块结构示意图。
图4是系统导航定位方法流程图。
在图1中,图1是本发明的系统结构示意图,1为无线传感器网络节点;2为无线传感器网络;3为机器人;4为无线定位模块。
图2中,图2是无线传感器网络节点结构示意图,5为传感单元;6为处理单元;7为定位模块;8为无线模块;9为第一电源模块。
图3中,图3是无线定位模块结构示意图,10为处理单元;11为定位模块;12为无线模块;13为第二电源模块。
具体实施方式
图1是本发明的系统结构示意图。图中的无线传感器网络节点1被大量随机抛撒于监控区域,通过自组网,形成无线传感器网络2;机器人3处于无线传感器网络2中;无线传感器网络2将各无线传感器网络节点1的位置信息及其收集的环境信息做一定的筛选与融合后传给机器人3;机器人3通过无线定位模块4和无线传感器网络2通讯,并根据无线传感器网络2的信息实现环境建模、定位、路径规划和导航。
图2是无线传感器网络节点结构示意图。图中的传感单元5负责环境信息的采集;处理单元6负责数据处理、通讯协议和定位算法的实现及各单元模块的管理;定位模块7负责节点定位功能的实现;无线模块8负责网络的无线通讯;第一电源模块9负责节点的电源供应。
图3是无线定位模块结构示意图。图中的处理单元10可以根据需要选用处理能力更强的处理器,其它部分可以和无线传感器网络节点1相同。
图4是系统导航定位方法流程图。参见图4,系统的导航定位方法和工作流程如下:
这种机器人定位导航,首先在监控的区域布撒无线传感器网络节点(步骤100),布撒的无线传感器网络节点和附近的其他节点通讯,根据协议规定的网络拓扑结构进行自组网,构建无线传感器网络(步骤110),无线传感器网络中的各节点根据节点定位模块提供的定位算法初步确定自身的位置(步骤120),无线传感器网络中的各节点通过自身携带的传感器获取环境信息(步骤130),并通过无线传感器网络的一些簇头节点来对获取的环境信息进行初步的筛选和融合(步骤140),根据融合后的环境信息如温度、湿度、坡度等对无线传感器网络二次定位(步骤150),无线传感器网络将筛选融合后的各节点的位置信息和环境信息传给机器人(步骤160),机器人对接收到的无线传感器网络的环境信息进行置信度判断、误差校正(步骤170),机器人根据校正后的环境信息,进行环境建模(步骤180),机器人根据其和网络节点的位置关系及以建立的环境模型,进行自身定位(步骤190),机器人根据环境模型、当前位置和目标进行路径规划和导航(步骤200),系统自动检查网络结构和环境是否发生变化(步骤210),当检查到网络和环境发生变化时,自动进行网络维护(步骤220),并转到步骤170,重新进行环境信息置信度判断以及环境建模,否则直接转至步骤190继续进行机器人导航定位。
Claims (8)
1.一种机器人导航定位系统,包括无线传感器网络(2)和机器人(3),其特征在于:所述无线传感器网络(2)是由布撒于监控区域的无线传感器网络节点(1)构成;所述无线传感器网络节点(1)由具有感应、处理、通讯、定位功能的传感单元(5)、处理单元(6)、定位模块(7)、无线模块(8)和第一电源模块(9)组成;所述机器人(3),具有移动能力,其上安置有无线定位模块(4),并置于布置了无线传感器网络(2)的区域中;所述无线定位模块(4)由具有处理、通讯和定位功能的处理单元(10)、定位模块(11)、无线模块(12)和第二电源模块(13)组成,该系统能够代替GPS实现移动机器人高精度定位和导航。
2.根据权利要求1所述的一种机器人导航定位系统,其特征是:所说无线传感器网络节点(1)具有温度、湿度、振动、光照、辐照和气体对所处环境进行监测的传感器;且无线传感器网络节点(1)的布撒采用事先空投、抛撒和发射方式,或由机器人(3)边行进边布撒。
3.根据权利要求1所述的一种机器人导航定位系统,其特征是:所说机器人(3)是配置无线定位模块的移动机器人、人员和车辆。
4.根据权利要求1所述的一种机器人导航定位系统,其特征是:所说的无线定位模块(4)具有传感功能,以检测机器人(3)及其所处的环境信息,其通讯方式是无线电、声、超声和光。
5.根据权利要求1所述的一种机器人导航定位系统,所说无线传感器网络节点(1)中的定位模块(7)定位功能通过测量跳数、信号强度、到达时间、到达时间差、到达角度实现。
6.一种机器人导航定位系统的导航定位方法,其特征在于:是按以下步骤完成的:
将无线传感器网络节点(1)布撒于监控区域;
已布撒的无线传感器网络节点(1)根据设定的网络结构,自动组网构建无线传感器网络(2);
无线传感器网络(2)使用定位模块(7)给各无线传感器网络节点(1)初步定位;
无线传感器网络(2)获取各无线传感器网络节点(1)收集的环境信息;
无线传感器网络(2)使用一些簇头节点来对环境信息筛选和融合;
无线传感器网络(2)结合融合后的环境信息有温度、湿度、坡度给各无线传感器网络节点(1)二次定位;
无线传感器网络(2)将筛选和融合后的各无线传感器网络节点(1)的环境信息和位置信息传给机器人(3);
机器人(3)对接收到的无线传感器网络(2)的环境信息进行置信度判断,误差校正;
机器人(3)根据校正后的环境信息进行环境建模;
机器人(3)根据无线传感器网络(2)的信息及自己的环境模型进行机器人定位、路径规划和导航;
网络结构和环境发生变化时,进行网络维护,并重新环境建模、机器人定位、路径规划和导航;
网络结构和环境不发生变化时,随着机器人(3)的移动,重新进行机器人(3)的定位,并根据先前的规划进行导航。
7.根据权利要求6所述一种机器人导航定位系统的导航定位方法,其特征是:该方法是一种不依赖GPS对移动机器人(3)进行导航和定位的方法。
8.根据权利要求6所述一种机器人导航定位系统的导航定位方法,其特征是:该方法同样适用于外星探测车辆、人员和装备的导航与定位。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2006100969769A CN1945351B (zh) | 2006-10-21 | 2006-10-21 | 一种机器人导航定位系统及导航定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2006100969769A CN1945351B (zh) | 2006-10-21 | 2006-10-21 | 一种机器人导航定位系统及导航定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN1945351A CN1945351A (zh) | 2007-04-11 |
CN1945351B true CN1945351B (zh) | 2010-06-02 |
Family
ID=38044840
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2006100969769A Expired - Fee Related CN1945351B (zh) | 2006-10-21 | 2006-10-21 | 一种机器人导航定位系统及导航定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN1945351B (zh) |
Families Citing this family (26)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101126808B (zh) * | 2007-08-02 | 2011-07-27 | 中国科学院自动化研究所 | 一种机器人导航系统及导航方法 |
CN101216546B (zh) * | 2008-01-15 | 2011-06-01 | 华南理工大学 | 一种无线传感器网络目标定位的位置估计方法 |
CN101315422B (zh) * | 2008-07-09 | 2012-07-25 | 南京邮电大学 | 无线传感器网络定位方法 |
CN101739027B (zh) * | 2009-12-01 | 2015-02-18 | 蒋平 | 基于分布式视觉传感网络的移动导航系统 |
EP2758905A4 (en) * | 2011-09-22 | 2015-07-29 | Aethon Inc | MONITORING, DIAGNOSTIC AND MONITORING TOOL FOR AUTONOMOUS MOBILE ROBOTS |
CN103217976B (zh) * | 2012-01-19 | 2017-09-26 | 苏州宝时得电动工具有限公司 | 自驱动移动装置 |
CN102662159B (zh) * | 2012-04-25 | 2014-01-15 | 东北大学 | 一种反射式室内定位的方法及系统 |
CN102689310A (zh) * | 2012-05-29 | 2012-09-26 | 华北电力大学 | 一种基于核辐射的核电站机器人定位方法 |
GB201212621D0 (en) * | 2012-07-16 | 2012-08-29 | Aledain Fze | Method of marking a line |
CN102914967B (zh) * | 2012-09-21 | 2015-01-28 | 浙江工业大学 | 采摘机器人的自主导航和人机协同采摘作业系统 |
CN102914303B (zh) * | 2012-10-11 | 2015-01-21 | 江苏科技大学 | 多移动机器人的智能空间系统及导航信息获取方法 |
CN103869814B (zh) * | 2012-12-17 | 2017-04-19 | 联想(北京)有限公司 | 一种终端定位和导航方法以及可移动的终端 |
CN104035067A (zh) * | 2014-06-13 | 2014-09-10 | 重庆大学 | 一种基于无线传感器网络的移动机器人自动定位算法 |
CN104849692A (zh) * | 2015-05-08 | 2015-08-19 | 深圳市华颖泰科电子技术有限公司 | 一种校准方法 |
CN105080014A (zh) * | 2015-07-13 | 2015-11-25 | 李占平 | 消防机器人定位导航系统及其定位导航方法 |
CN105352521B (zh) * | 2015-10-30 | 2018-05-08 | 小米科技有限责任公司 | 平衡车导航方法及装置 |
CN106131955B (zh) * | 2016-07-12 | 2017-12-26 | 安徽工程大学 | 一种基于移动机器人辅助的无线传感器网络节点定位方法 |
CN106142086B (zh) * | 2016-08-04 | 2018-06-22 | 河海大学常州校区 | 一种无线多媒体传感网融合的作业机器人定位跟踪系统及方法 |
CN107891423B (zh) * | 2017-11-08 | 2024-01-26 | 石家庄铁道大学 | 基于多传感器融合检测的智能探索机器人及其检测方法 |
CN109976325A (zh) * | 2017-12-27 | 2019-07-05 | 深圳市优必选科技有限公司 | 机器人管理物品的方法、装置及设备 |
CN108344970B (zh) * | 2018-02-01 | 2022-03-15 | 感知智能科技新加坡有限公司 | 一种使用移动机器人的无线定位自动校准方法 |
CN108521629A (zh) * | 2018-04-02 | 2018-09-11 | 深圳大图科创技术开发有限公司 | 一种引导准确的室内机器人引导系统 |
CN109645892B (zh) * | 2018-12-12 | 2021-05-28 | 深圳乐动机器人有限公司 | 一种障碍物的识别方法及清洁机器人 |
JP7234724B2 (ja) * | 2019-03-20 | 2023-03-08 | 株式会社リコー | ロボットおよび制御システム |
CN110308720B (zh) * | 2019-06-21 | 2021-02-23 | 北京三快在线科技有限公司 | 一种无人配送装置及其导航定位方法、装置 |
DE102020101482B3 (de) * | 2020-01-22 | 2021-04-15 | Sick Ag | Sicherheitssystem und Verfahren |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1235503A (zh) * | 1998-06-23 | 1999-11-17 | 时曦 | 全自动无线网定线车辆信息系统 |
CN1399734A (zh) * | 1999-11-24 | 2003-02-26 | 个人机器人技术公司 | 自主多平台机器人系统 |
CN1524204A (zh) * | 2001-05-25 | 2004-08-25 | 位置与通信系统及方法 |
-
2006
- 2006-10-21 CN CN2006100969769A patent/CN1945351B/zh not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1235503A (zh) * | 1998-06-23 | 1999-11-17 | 时曦 | 全自动无线网定线车辆信息系统 |
CN1399734A (zh) * | 1999-11-24 | 2003-02-26 | 个人机器人技术公司 | 自主多平台机器人系统 |
CN1524204A (zh) * | 2001-05-25 | 2004-08-25 | 位置与通信系统及方法 |
Non-Patent Citations (4)
Title |
---|
卢韶芳,刘大维,陈秉聪.自主式移动机器人分布视觉组合导航多摄像机标定方法.吉林大学学报36 3.2006,36(3),387-392. |
卢韶芳,刘大维,陈秉聪.自主式移动机器人分布视觉组合导航多摄像机标定方法.吉林大学学报36 3.2006,36(3),387-392. * |
董再励,郝颖明,朱枫.一种基于视觉的移动机器人定位系统.中国图象图形学报5 8.2000,5(8),688-692. |
董再励,郝颖明,朱枫.一种基于视觉的移动机器人定位系统.中国图象图形学报5 8.2000,5(8),688-692. * |
Also Published As
Publication number | Publication date |
---|---|
CN1945351A (zh) | 2007-04-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN1945351B (zh) | 一种机器人导航定位系统及导航定位方法 | |
CN109029422B (zh) | 一种多无人机协作构建三维调查地图的方法和装置 | |
Zeng et al. | Seamless pedestrian navigation methodology optimized for indoor/outdoor detection | |
CN110057373A (zh) | 用于生成高精细语义地图的方法、装置和计算机存储介质 | |
CN106444843B (zh) | 无人机相对方位控制方法及装置 | |
US9921069B2 (en) | Map data creation device, autonomous movement system and autonomous movement control device | |
CN106406320A (zh) | 机器人路径规划方法及规划路线的机器人 | |
CN101750972A (zh) | 用于靠近自动机器使用的衣服 | |
CN110174105A (zh) | 一种复杂环境下智能体自主导航算法及系统 | |
KR20170137636A (ko) | 탑승자 모니터링에 기초한 정보 획득 시스템 | |
Akula et al. | Integration of infrastructure based positioning systems and inertial navigation for ubiquitous context-aware engineering applications | |
CN106501829A (zh) | 一种无人机导航方法和装置 | |
CN103718062A (zh) | 用于确保个人导航设备的服务的持续性的方法及其设备 | |
CN107942363A (zh) | 基于建筑结构图计算的消防员用室内导航系统及其方法 | |
Liu et al. | Xyz indoor navigation through augmented reality: a research in progress | |
US20220329988A1 (en) | System and method for real-time indoor navigation | |
CN111263308A (zh) | 定位数据采集方法及系统 | |
CN106606407A (zh) | 一种室内高精度盲人导航系统 | |
CN114485619A (zh) | 基于空地协同的多机器人定位和导航方法及装置 | |
CN109556634A (zh) | 车辆定位能力的检测方法、装置、设备及可读存储介质 | |
CN109084760A (zh) | 一种楼宇间导航系统 | |
CN107065027A (zh) | 泄漏源的探测系统、方法、装置及设备 | |
CN117130392B (zh) | 基于bim数据进行室内定位导航的无人机及控制方法 | |
CN105973223A (zh) | 一种室内导航的方法和装置 | |
North et al. | Enhanced mobile robot outdoor localization using INS/GPS integration |
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: 20100602 Termination date: 20141021 |
|
EXPY | Termination of patent right or utility model |