CN108628309B - 一种复杂地形的自动寻址方法 - Google Patents
一种复杂地形的自动寻址方法 Download PDFInfo
- Publication number
- CN108628309B CN108628309B CN201810385943.9A CN201810385943A CN108628309B CN 108628309 B CN108628309 B CN 108628309B CN 201810385943 A CN201810385943 A CN 201810385943A CN 108628309 B CN108628309 B CN 108628309B
- Authority
- CN
- China
- Prior art keywords
- module
- node
- unmanned aerial
- aerial vehicle
- robot
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 12
- 230000005540 biological transmission Effects 0.000 claims description 7
- 230000000007 visual effect Effects 0.000 claims description 7
- 210000003717 douglas' pouch Anatomy 0.000 claims description 4
- 230000004888 barrier function Effects 0.000 description 6
- 230000000694 effects Effects 0.000 description 3
- 239000000523 sample Substances 0.000 description 3
- 238000010276 construction Methods 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 210000000056 organ Anatomy 0.000 description 2
- 230000002567 autonomic effect Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- DMBHHRLKUKUOEG-UHFFFAOYSA-N diphenylamine Chemical compound C=1C=CC=CC=1NC1=CC=CC=C1 DMBHHRLKUKUOEG-UHFFFAOYSA-N 0.000 description 1
- 238000007689 inspection Methods 0.000 description 1
- 238000011835 investigation Methods 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 239000000700 radioactive tracer Substances 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 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/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/0255—Control of position or course in two dimensions specially adapted to land vehicles using acoustic signals, e.g. ultra-sonic singals
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Aviation & Aerospace Engineering (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Optics & Photonics (AREA)
- Electromagnetism (AREA)
- Acoustics & Sound (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种复杂地形的自动寻址方法,涉及消防、救援技术领域,包括建立树的节点模型、识别节点、判断移动方向以及重新规划路线等步骤,本发明由于采用了测距避障的技术方案,可在室内无GPS信号的情况下,实现无人机或机器人自己搜索规划复杂地形(矿洞,施工建筑等)的路径,自动寻路和监察,代替人工到一些复杂地形环境下作业(危险、狭小、复杂、未知区域),可避免人员的伤亡,提高了作业效率和智能化水平。
Description
技术领域
本发明涉及消防、救援技术领域,具体涉及一种复杂地形的自动寻址方法。
背景技术
无人机和机器人等因可以代替人工到一些复杂地形环境下作业,如矿洞的自动勘探搜索和搜救、公路铁路电力的自动巡线、地下水管道和建筑通风口自动巡检等越来越多的应用在多个领域。然而,现有的利用无人机或机器人进行巡检作业等一般依靠指挥中心遥控控制作业路径,但在室内或矿洞、地下管道等一些特殊环境下GPS信号弱或没有,需要依靠无人机或机器人自动实时避开障碍物规划路径,目前的自动寻迹避障没有把树的思想结合到复杂的环境中,在无人机或机器人领域并没有得到广泛应用和研究。
中国专利公开号为CN106444803A公开了一种用于管道机器人定位的无人机导航***及方法,属于无人机自动导航领域。它由无人机***、管道机器人装置、地面控制平台组成。针对管道的不同铺设情况,工作中,地面控制平台确定无人机工作模式,同时发送跟踪指令,无人机接到指令后根据设定的导航模式进行导航飞行。导航飞行中的速度开始有工作人员根据需要设定,当监测到管道机器人时,无人机导航***根据机器人的状态,自动调整无人机的导航飞行速度,同时把管道机器人坐标信息发送到地面控制平台。该种导航***实现用于管道机器人定位的无人机的导航飞行,为管道机器人进行实时快速定位和跟踪提供了保证,适应性强,自动化水平较高。
中国专利公开号为CN205404813U公开了一种基于无人机寻址警示辅助追踪装置,包括遥控器和无人机飞行器,所述无人机飞行器上安装有目标追踪***、高清摄像头和强光灯头;所述目标追踪***、高清摄像头和强光灯头均电连接到控制器;所述高清摄像头与无线发送模块通信连接;所述目标追踪***包括三维布置的红外线探头和热敏感应探头。该种基于无人机寻址警示辅助追踪装置,在无人机用于侦察或搜救失踪人员时,通过三维布置的红外线探头和热敏感应,能够实现红外和热敏快速搜索和定位目标,其既能够满足秘密侦查任务,同时,也能够减小电能损耗。
上述两种方案均提供了无人机或机器人的目标定位和搜寻方法,但是并不具有自主学习能力,人工干预的程度较大,智能化程度较低。
发明内容
本发明的目的在于提供一种复杂地形的自动寻址方法,以解决现有技术中导致的上述多项缺陷。
一种复杂地形的自动寻址方法,包括如下步骤:
(1)建立树的节点模型;利用无人机或机器人在目标区域内移动,并携带定位模块,对无人机或机器人经过的每一个拐点、岔路口和死胡同出口点作为节点创建并进行连接,得到树状图;
(2)识别节点;室外可用定位模块来记录坐标系,定位模块无信号或信号弱时可根据检测得到的距离建立坐标系来唯一的识别每个节点并把每一个节点的前后左右距离和各个方向的路有没有走过标记起来;
(3)判断移动方向;
当前方没有障碍并且没有走过的时候向前;当前方不满足时判断往左边;
当左边没有障碍并且没有走过的时候向左;当左边不满足时判断往右边;
当右边没有障碍并且没有走过的时候向右;当右边不满足时判断往后方;
当后方没有障碍并且没有走过的时候后方;如果都不满足就执行路径规划;
(4)按照上述步骤(3)中的规则走,发现当某个节点无法通过,这时需要遍历树中有哪些节点的方向还有路可以走,在遍历的时候就可以找到有岔路并没有走过的目标节点,并得到很多通往该目标节点的路径,通过每个节点保存的坐标计算出每条路劲的长短得到一条最短的路径。
优选的,所述无人机或机器人上设置有测距模块和避障模块,所述测距模块具体为超声波测距模块或激光测距模块,避障模块与测距模块连接,并通过分析测距模块传来的距离信息选择是否改变移动方向。
优选的,所述定位模块为GPS定位模块、北斗定位模块中的任意一种。
优选的,所述无人机或机器人上还搭载有视觉模块,所述视觉模块具体为红外摄像头。
优选的,所述视觉模块连接有无线传输模块,并通过无线传输模块将图像信息发送至远端控制台。
优选的,所述无人机或机器人上还搭载有报警模块,所述报警模块包括蜂鸣器和报警灯,当出现紧急情况时,远端控制台操控报警模块启动,发出报警信息,起到辅助救援的作用。
本发明的优点在于:本发明由于采用了测距避障的技术方案,可在室内无GPS信号的情况下,实现无人机或机器人自己搜索规划复杂地形(矿洞,施工建筑等)的路径,自动寻路和监察,代替人工到一些复杂地形环境下作业(危险、狭小、复杂、未知区域),可避免人员的伤亡,提高了作业效率和智能化水平。
附图说明
图1为本发明中复杂地形的自动寻址方法的流程图。
图2为本发明中步骤(3)的流程图。
具体实施方式
为使本发明实现的技术手段、创作特征、达成目的与功效易于明白了解,下面结合具体实施方式,进一步阐述本发明。
实施例1
如图1和图2所示,一种复杂地形的自动寻址方法,包括如下步骤:
(1)建立树的节点模型;利用无人机或机器人在目标区域内移动,并携带定位模块,对无人机或机器人经过的每一个拐点、岔路口和死胡同出口点作为节点创建并进行连接,得到树状图;
(2)识别节点;室外可用定位模块来记录坐标系,定位模块无信号或信号弱时可根据检测得到的距离建立坐标系来唯一的识别每个节点并把每一个节点的前后左右距离和各个方向的路有没有走过标记起来;
(3)判断移动方向;
当前方没有障碍并且没有走过的时候向前;当前方不满足时判断往左边;
当左边没有障碍并且没有走过的时候向左;当左边不满足时判断往右边;
当右边没有障碍并且没有走过的时候向右;当右边不满足时判断往后方;
当后方没有障碍并且没有走过的时候后方;如果都不满足就执行路径规划;
(4)按照上述步骤(3)中的规则走,发现当某个节点无法通过,这时需要遍历树中有哪些节点的方向还有路可以走,在遍历的时候就可以找到有岔路并没有走过的目标节点,并得到很多通往该目标节点的路径,通过每个节点保存的坐标计算出每条路劲的长短得到一条最短的路径。
值得注意的是,所述无人机或机器人上设置有测距模块和避障模块,所述测距模块具体为超声波测距模块或激光测距模块,避障模块与测距模块连接,并通过分析测距模块传来的距离信息选择是否改变移动方向。
在本实施例中,所述定位模块为GPS定位模块、北斗定位模块中的任意一种。
实施例2
如图1和图2所示,一种复杂地形的自动寻址方法,包括如下步骤:
(1)建立树的节点模型;利用无人机或机器人在目标区域内移动,并携带定位模块,对无人机或机器人经过的每一个拐点、岔路口和死胡同出口点作为节点创建并进行连接,得到树状图;
(2)识别节点;室外可用定位模块来记录坐标系,定位模块无信号或信号弱时可根据检测得到的距离建立坐标系来唯一的识别每个节点并把每一个节点的前后左右距离和各个方向的路有没有走过标记起来;
(3)判断移动方向;
当前方没有障碍并且没有走过的时候向前;当前方不满足时判断往左边;
当左边没有障碍并且没有走过的时候向左;当左边不满足时判断往右边;
当右边没有障碍并且没有走过的时候向右;当右边不满足时判断往后方;
当后方没有障碍并且没有走过的时候后方;如果都不满足就执行路径规划;
(4)按照上述步骤(3)中的规则走,发现当某个节点无法通过,这时需要遍历树中有哪些节点的方向还有路可以走,在遍历的时候就可以找到有岔路并没有走过的目标节点,并得到很多通往该目标节点的路径,通过每个节点保存的坐标计算出每条路劲的长短得到一条最短的路径。
在本实施例中,所述无人机或机器人上设置有测距模块和避障模块,所述测距模块具体为超声波测距模块或激光测距模块,避障模块与测距模块连接,并通过分析测距模块传来的距离信息选择是否改变移动方向,所述定位模块为GPS定位模块、北斗定位模块中的任意一种。
在本实施例中,所述无人机或机器人上还搭载有视觉模块,所述视觉模块具体为红外摄像头,所述视觉模块连接有无线传输模块,并通过无线传输模块将图像信息发送至远端控制台,所述无人机或机器人上还搭载有报警模块,所述报警模块包括蜂鸣器和报警灯,当出现紧急情况时,远端控制台操控报警模块启动,发出报警信息,起到辅助救援的作用。
基于上述,本发明由于采用了测距避障的技术方案,可在室内无GPS信号的情况下,实现无人机或机器人自己搜索规划复杂地形(矿洞,施工建筑等)的路径,自动寻路和监察,代替人工到一些复杂地形环境下作业(危险、狭小、复杂、未知区域),可避免人员的伤亡,提高了作业效率和智能化水平。
由技术常识可知,本发明可以通过其它的不脱离其精神实质或必要特征的实施方案来实现。因此,上述公开的实施方案,就各方面而言,都只是举例说明,并不是仅有的。所有在本发明范围内或在等同于本发明的范围内的改变均被本发明包含。
Claims (1)
1.一种复杂地形的自动寻址方法,其特征在于,包括如下步骤:
(1)建立树的节点模型;利用无人机或机器人在目标区域内移动,并携带定位模块,对无人机或机器人经过的每一个拐点、岔路口和死胡同出口点作为节点创建并进行连接,得到树状图;
(2)识别节点;室外可用定位模块来记录坐标系,定位模块无信号或信号弱时可根据检测得到的距离建立坐标系来唯一的识别每个节点并把每一个节点的前后左右距离和各个方向的路有没有走过标记起来;
(3)判断移动方向;
当前方没有障碍并且没有走过的时候向前;当前方不满足时判断往左边;
当左边没有障碍并且没有走过的时候向左;当左边不满足时判断往右边;
当右边没有障碍并且没有走过的时候向右;当右边不满足时判断往后方;
当后方没有障碍并且没有走过的时候后方;如果都不满足就执行路径规划;
(4)按照上述步骤(3)中的规则走,发现当某个节点无法通过,这时需要遍历树中有哪些节点的方向还有路可以走,在遍历的时候就可以找到有岔路并没有走过的目标节点,并得到很多通往该目标节点的路径,通过每个节点保存的坐标计算出每条路劲的长短得到一条最短的路径;
所述无人机或机器人上设置有测距模块和避障模块,所述测距模块具体为超声波测距模块或激光测距模块,避障模块与测距模块连接,并通过分析测距模块传来的距离信息选择是否改变移动方向,所述定位模块为GPS定位模块、北斗定位模块中的任意一种,所述无人机或机器人上还搭载有视觉模块,所述视觉模块具体为红外摄像头,所述视觉模块连接有无线传输模块,并通过无线传输模块将图像信息发送至远端控制台,所述无人机或机器人上还搭载有报警模块,所述报警模块包括蜂鸣器和报警灯,当出现紧急情况时,远端控制台操控报警模块启动,发出报警信息,起到辅助救援的作用。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810385943.9A CN108628309B (zh) | 2018-04-26 | 2018-04-26 | 一种复杂地形的自动寻址方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810385943.9A CN108628309B (zh) | 2018-04-26 | 2018-04-26 | 一种复杂地形的自动寻址方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108628309A CN108628309A (zh) | 2018-10-09 |
CN108628309B true CN108628309B (zh) | 2021-01-12 |
Family
ID=63694681
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810385943.9A Active CN108628309B (zh) | 2018-04-26 | 2018-04-26 | 一种复杂地形的自动寻址方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108628309B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114847810B (zh) * | 2022-07-08 | 2022-09-20 | 深圳市云鼠科技开发有限公司 | 基于lds激光的清洁机器人越障方法、装置、设备及介质 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102799178A (zh) * | 2012-07-03 | 2012-11-28 | 航天科工深圳(集团)有限公司 | 一种管道巡检机器人自主巡径算法及具有该算法的机器人 |
CN204989973U (zh) * | 2015-07-29 | 2016-01-20 | 长沙理工大学 | 可自动搜寻迷宫最短路径的电脑鼠 |
CN105629970A (zh) * | 2014-11-03 | 2016-06-01 | 贵州亿丰升华科技机器人有限公司 | 一种基于超声波的机器人定位避障方法 |
CN106054889A (zh) * | 2016-06-28 | 2016-10-26 | 旗瀚科技股份有限公司 | 一种机器人自主避障方法和装置 |
CN106371445A (zh) * | 2016-11-17 | 2017-02-01 | 浙江大学 | 一种基于拓扑地图的无人车规划控制方法 |
CN206085076U (zh) * | 2016-09-30 | 2017-04-12 | 南京信息工程大学 | 一种基于树莓派的救灾机器人 |
CN107677269A (zh) * | 2017-08-28 | 2018-02-09 | 广东工业大学 | 一种基于拓扑地图的弱信号区域智能导航方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7634336B2 (en) * | 2005-12-08 | 2009-12-15 | Electronics And Telecommunications Research Institute | Localization system and method of mobile robot based on camera and landmarks |
-
2018
- 2018-04-26 CN CN201810385943.9A patent/CN108628309B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102799178A (zh) * | 2012-07-03 | 2012-11-28 | 航天科工深圳(集团)有限公司 | 一种管道巡检机器人自主巡径算法及具有该算法的机器人 |
CN105629970A (zh) * | 2014-11-03 | 2016-06-01 | 贵州亿丰升华科技机器人有限公司 | 一种基于超声波的机器人定位避障方法 |
CN204989973U (zh) * | 2015-07-29 | 2016-01-20 | 长沙理工大学 | 可自动搜寻迷宫最短路径的电脑鼠 |
CN106054889A (zh) * | 2016-06-28 | 2016-10-26 | 旗瀚科技股份有限公司 | 一种机器人自主避障方法和装置 |
CN206085076U (zh) * | 2016-09-30 | 2017-04-12 | 南京信息工程大学 | 一种基于树莓派的救灾机器人 |
CN106371445A (zh) * | 2016-11-17 | 2017-02-01 | 浙江大学 | 一种基于拓扑地图的无人车规划控制方法 |
CN107677269A (zh) * | 2017-08-28 | 2018-02-09 | 广东工业大学 | 一种基于拓扑地图的弱信号区域智能导航方法 |
Non-Patent Citations (1)
Title |
---|
基于笛卡儿坐标系的迷宫路径规划算法;袁洁 等;《微计算机信息》;20071231;第23卷(第4-3期);第185-187页 * |
Also Published As
Publication number | Publication date |
---|---|
CN108628309A (zh) | 2018-10-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106909145B (zh) | 无人航道测量船障碍物实时感知避障***与方法 | |
CN109358636B (zh) | 用于管道机器人定位的无人机导航***及其导航方法 | |
CN109760837B (zh) | 一种电缆沟与隧道巡检无人机*** | |
US9975632B2 (en) | Aerial vehicle system | |
EP2169503B1 (en) | Multi-vehicle high intensity perception | |
EP2169498B1 (en) | Vehicle with high integrity perception system | |
US8478493B2 (en) | High integrity perception program | |
EP2169507B1 (en) | Distributed knowledge base method for vehicular localization and work-site management | |
EP2169505B1 (en) | Distributed knowledge base for vehicular localization and work-site management | |
US8818567B2 (en) | High integrity perception for machine localization and safeguarding | |
CN110531764A (zh) | 一种无人驾驶拖拉机控制***及控制方法 | |
EP2194435A2 (en) | Garment worn by the operator of a semi-autonomous machine | |
WO2015180021A1 (zh) | 剪枝机器人*** | |
CN111624641A (zh) | 一种防爆型油库区智能巡检机器人 | |
CN113325837A (zh) | 一种用于多信息融合采集机器人的控制***及方法 | |
CN113730860A (zh) | 一种未知环境下的消防机器人自主灭火方法 | |
CN211741929U (zh) | 一种基于视觉导航的自动行走机器人 | |
CN108593213A (zh) | 无人机地下矿巡检及气味追踪装置 | |
JP2007178240A (ja) | 離隔距離測定装置及び自走測定装置 | |
CN113050685A (zh) | 一种煤矿井下无人机自主巡检的方法 | |
CN114023035A (zh) | 一种全天候全自动森林火灾早期探测***及探测方法 | |
CN115793649A (zh) | 一种电缆沟自动巡检装置及巡检方法 | |
CN108628309B (zh) | 一种复杂地形的自动寻址方法 | |
CN110487281A (zh) | 一种探测障碍物的智能导航*** | |
CN108089595B (zh) | 一种基于无人机避障的寻址***及方法 |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
TR01 | Transfer of patent right | ||
TR01 | Transfer of patent right |
Effective date of registration: 20240105 Address after: Building 1, Building A, 3rd Floor, No. 268 Shiniu Road, Nanmingshan Street, Liandu District, Lishui City, Zhejiang Province, China (Lishui Yonglian Intelligent Manufacturing Industrial Park) Patentee after: Zhejiang Rongqi Technology Co.,Ltd. Address before: 518131 Longhua Office, Longhua New District, Shenzhen City, Guangdong Province Patentee before: GUANGDONG RONGQE INTELLIGENT TECHNOLOGY Co.,Ltd. |