CN109343523A - 可绘制3d地图并实时传输图像的洞穴探测爬行机器人 - Google Patents
可绘制3d地图并实时传输图像的洞穴探测爬行机器人 Download PDFInfo
- Publication number
- CN109343523A CN109343523A CN201811160827.3A CN201811160827A CN109343523A CN 109343523 A CN109343523 A CN 109343523A CN 201811160827 A CN201811160827 A CN 201811160827A CN 109343523 A CN109343523 A CN 109343523A
- Authority
- CN
- China
- Prior art keywords
- module
- real
- robot
- control chip
- main control
- 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
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J11/00—Manipulators not otherwise provided for
Abstract
本发明公开了一种可绘制3D地图并实时传输图像的洞穴探测爬行机器人，包括固定板支架和四条支腿，所述的支腿包括上部舵机、大臂连杆、中部舵机、小臂连杆、下部舵机和钳部；所述的固定底板支架上分别安装嵌入式控制模块、无线通信模块、运动模块、超声波测距模块和机器视觉模块。本发明通过让运动灵活的爬行机器人载有超声波测距器进入洞穴的未知区域中，在机器人的运动过程中，将超声波测距器测得的距离数据通过无线通信模块实时传输回上位机，利用上位机中的绘图软件处理后，实现了三维地图的实时绘制。本发明通过让运动灵活的爬行机器人载有机器视觉模块openMV进入被测区域中，实现了操作人员对未知区域的同步监测。
Description
技术领域
本发明涉及陆地四足仿生爬行机器人领域，特别是一种可绘制3D地图并实时传输图像的洞穴探测爬行机器人。
背景技术
爬行机器人是移动机器人的一种，其对应于普通车轮机器人或履带机器人，具有更适应变化地形的特点。目前，爬行机器人多用于管道监测，可实现对于管网施工单位的工程自检，随时抽检施工动态，避免施工漏洞，为施工项目的竣工验收提供评估依据和在役管道的普查、养护、检修以及各种储罐、箱体等内部情况的检测，是水利、燃气、铁道通信、市政建设、工矿、基建等单位进行改造、维修、普查管线的必备设备之一。
由于管道内的工作面较为平坦、波动较小，因此，应用于管道内的的爬行机器人对地形的适应性通常较低；并且，管道机器人通常是在已知管道的构造以及走向的情况下，对管道进行监测检修，并不具有采集地形地貌实时信息及搜寻绘图的能力，所以在科研考古的洞穴探测中针对一些未知地形的探测时，现有的管道爬行机器人技术还不足以满足研究人员的使用要求。
发明内容
为解决现有技术存在的上述问题，本发明要设计一种能探测未知环境并绘制实时3D地图，传输实时图像的可绘制3D地图并实时传输图像的洞穴探测爬行机器人。
为了实现上述目的，本发明的技术方案是：可绘制3D地图并实时传输图像的洞穴探测爬行机器人，包括固定板支架和四条支腿，四条支腿分别安装在固定板支架的四个角上；四条支腿结构相同；所述的支腿包括上部舵机、大臂连杆、中部舵机、小臂连杆、下部舵机和钳部；所述的上部舵机依次与大臂连杆、中部舵机、小臂连杆、下部舵机和钳部串联，形成三关节三连杆的结构；所述的上部舵机与固定底板支架的一个角相连接。
所述的固定底板支架上分别安装嵌入式控制模块、无线通信模块、运动模块、超声波测距模块和机器视觉模块；
所述的嵌入式控制模块作为机器人的主控芯片，包括嵌入式微处理器、存储器、通用设备接口、I/O接口、电源电路、时钟电路和存储器电路。
所述的运动模块包括四个上部舵机、四个中部舵机、四个下部舵机，每个舵机分别与主控芯片连接，主控芯片对所有舵机的转角进行控制。
所述的超声波测距模块有三个，分别安装在固定底板支架的上部和左右两侧，每个超声波测距模块结构相同，均包括超声波发射器、超声波接收器和测距控制电路。上部的超声波测距模块用于测量机器人中心到洞穴顶壁的距离；左右两侧的超声波测距模块分别用于测量机器人中心到洞穴左右侧壁的距离；三个超声波测距模块均与主控芯片相连，接受主控芯片的命令、向主控芯片反馈距离数据信息，主控芯片再通过无线通信模块将数据发送给上位机进行处理，通过labview软件进行3D地图绘制。
所述的机器视觉模块，包括openMV专用摄像头、摄像头底座和控制芯片，所述的控制芯片与主控芯片连接，openMV专用摄像头通过摄像头底座安装在固定底板支架上、朝向机器人运动的正前方，将机器人行走前方的道路图像进行实时传输，将视觉识别结果反馈给主控芯片，主控芯片通过无线通信模块将机器人接收到的图像结果发送给上位机进行处理，进行实时监控洞穴内部情况及机器人运动情况。
进一步地，所述的上位机中安装的软件包含机器人运动控制界面、超声波测量数据绘图实时显示界面和实时图像信息回传界面；机器人通过计算机远程操纵爬行进入待测区域中，操作人员在安全地区对其进行运动控制，通过openMV摄像头监控爬行机器人视觉，如果有具体的探测对象，则利用openMV摄像头进行物体识别与搜寻，进入待测区后，超声波测距仪开始传送机器人上方、左侧和右侧距离数据给上位机，上位机通过软件处理，得到实时绘制的3D地图图像，实现采集洞穴结构信息的目的。
进一步地，所述的主控芯片和控制芯片均为为低功耗、低电压、高性能、高实时性的STM32芯片。
进一步地，所述的无线通信模块是低功耗局域网协议模块，采用通用的、低功耗的近距离无线组网通讯技术ZigBee。
进一步地，所述的超声波测距模块为超声波测距器HY-SRF05。
与现有技术比，本发明具有以下有益效果：
1、本发明通过让运动灵活的爬行机器人载有超声波测距器进入洞穴的未知区域中，在机器人的运动过程中，将超声波测距器测得的距离数据通过无线通信模块实时传输回上位机，利用上位机中的绘图软件处理后，实现了三维地图的实时绘制。
2、本发明通过让运动灵活的爬行机器人载有机器视觉模块openMV进入被测区域中，利用摄像头的实时传输图像功能，通过无线通信模块将图像传输到上位机，实现了操作人员对未知区域的同步监测。
3、本发明用到的openMV是一种多功能多优势的摄像头装置，但在实际的应用中开发量甚少，因此本发明不仅采用openMV实时采集图像信息并回传，还可以做到利用openMV的物体识别功能，对洞穴等未知区域特定物体的识别与搜寻。
附图说明
图1是本发明的结构示意图。
图2是本发明支腿的侧视结构图(四条支腿均相同)。
图3是本发明的信号传递关系图。
图4是本发明的工作流程图(箭头方向代表信息传输方向)。
图中：1-超声波测距模块；2-机器视觉模块；3-主控芯片；4-上部舵机；5-大臂连杆；6-中部舵机；7-小臂连杆；8-下部舵机；9-钳部。
具体实施方式
下面结合附图对本发明进行进一步地描述。
如图1-3所示，一种可绘制3D地图并实时传输图像的洞穴探测爬行机器人，包括固定板支架和四条支腿，四条支腿分别安装在固定板支架的四个角上；四条支腿结构相同；所述的支腿包括上部舵机4、大臂连杆5、中部舵机6、小臂连杆7、下部舵机8和钳部9；所述的上部舵机4依次与大臂连杆5、中部舵机6、小臂连杆7、下部舵机8和钳部9串联，形成三关节三连杆的结构；所述的上部舵机4与固定底板支架的一个角相连接。
所述的固定底板支架上分别安装嵌入式控制模块、无线通信模块、运动模块、超声波测距模块1和机器视觉模块2；
所述的嵌入式控制模块作为机器人的主控芯片3，包括嵌入式微处理器、存储器、通用设备接口、I/O接口、电源电路、时钟电路和存储器电路。
所述的运动模块包括四个上部舵机4、四个中部舵机6、四个下部舵机8，每个舵机分别与主控芯片3连接，主控芯片3对所有舵机的转角进行控制。
所述的超声波测距模块1有三个，分别安装在固定底板支架的上部和左右两侧，每个超声波测距模块1结构相同，均包括超声波发射器、超声波接收器和测距控制电路。上部的超声波测距模块1用于测量机器人中心到洞穴顶壁的距离；左右两侧的超声波测距模块1分别用于测量机器人中心到洞穴左右侧壁的距离；三个超声波测距模块1均与主控芯片3相连，接受主控芯片3的命令、向主控芯片3反馈距离数据信息，主控芯片3再通过无线通信模块将数据发送给上位机进行处理，通过labview软件进行3D地图绘制。
所述的机器视觉模块2，包括openMV专用摄像头、摄像头底座和控制芯片，所述的控制芯片与主控芯片3连接，openMV专用摄像头通过摄像头底座安装在固定底板支架上、朝向机器人运动的正前方，将机器人行走前方的道路图像进行实时传输，将视觉识别结果反馈给主控芯片3，主控芯片3通过无线通信模块将机器人接收到的图像结果发送给上位机进行处理，进行实时监控洞穴内部情况及机器人运动情况。
进一步地，所述的上位机中安装的软件包含机器人运动控制界面、超声波测量数据绘图实时显示界面和实时图像信息回传界面；机器人通过计算机远程操纵爬行进入待测区域中，操作人员在安全地区对其进行运动控制，通过openMV摄像头监控爬行机器人视觉，如果有具体的探测对象，则利用openMV摄像头进行物体识别与搜寻，进入待测区后，超声波测距仪开始传送机器人上方、左侧和右侧距离数据给上位机，上位机通过软件处理，得到实时绘制的3D地图图像，实现采集洞穴结构信息的目的。
进一步地，所述的主控芯片3和控制芯片均为为低功耗、低电压、高性能、高实时性的STM32芯片。
进一步地，所述的无线通信模块是低功耗局域网协议模块，采用通用的、低功耗的近距离无线组网通讯技术ZigBee。
进一步地，所述的超声波测距模块1为超声波测距器HY-SRF05。
如图1-4所示，本发明的工作方法如下：本发明的上位机中安装的软件包含爬行机器人运动控制界面、超声波测量数据绘图实时显示界面、实时图像信息回传界面。
操作人员在安全地区通过无线通信模块利用电脑远程向机器人主控芯片3发出前行后退转弯等命令，主控芯片3则向十二个舵机发出合适的角度弯曲代码指令，操纵机器人爬行进入待测区域中。然后，通过openMV摄像头的芯片STM32和机器人的主控芯片3的信息交互，可以传送回机器人视觉于远程的上位机，如果有具体的探测对象，则还可以利用openMV进行物体识别与搜寻。同时，进入待测区后，主控芯片3发出开始命令，控制超声波测距仪启动，三个测距器分别开始传送洞穴上部、左壁、右壁的距离数据给主控芯片3，再传回上位机，通过labview软件处理，得到实时绘制的3D-MAP图像，则可以实现采集洞穴结构信息的目的。
整个过程完成了爬行机器人的克服障碍运动、对洞穴图像实时传输、三维地图绘制、以及目标识别的工作，也是人工智能的体现。
Claims (5)
1.可绘制3D地图并实时传输图像的洞穴探测爬行机器人，其特征在于：包括固定板支架和四条支腿，四条支腿分别安装在固定板支架的四个角上；四条支腿结构相同；所述的支腿包括上部舵机(4)、大臂连杆(5)、中部舵机(6)、小臂连杆(7)、下部舵机(8)和钳部(9)；所述的上部舵机(4)依次与大臂连杆(5)、中部舵机(6)、小臂连杆(7)、下部舵机(8)和钳部(9)串联，形成三关节三连杆的结构；所述的上部舵机(4)与固定底板支架的一个角相连接；
所述的固定底板支架上分别安装嵌入式控制模块、无线通信模块、运动模块、超声波测距模块(1)和机器视觉模块(2)；
所述的嵌入式控制模块作为机器人的主控芯片(3)，包括嵌入式微处理器、存储器、通用设备接口、I/O接口、电源电路、时钟电路和存储器电路；
所述的运动模块包括四个上部舵机(4)、四个中部舵机(6)、四个下部舵机(8)，每个舵机分别与主控芯片(3)连接，主控芯片(3)对所有舵机的转角进行控制；
所述的超声波测距模块(1)有三个，分别安装在固定底板支架的上部和左右两侧，每个超声波测距模块(1)结构相同，均包括超声波发射器、超声波接收器和测距控制电路；上部的超声波测距模块(1)用于测量机器人中心到洞穴顶壁的距离；左右两侧的超声波测距模块(1)分别用于测量机器人中心到洞穴左右侧壁的距离；三个超声波测距模块(1)均与主控芯片(3)相连，接受主控芯片(3)的命令、向主控芯片(3)反馈距离数据信息，主控芯片(3)再通过无线通信模块将数据发送给上位机进行处理，通过labview软件进行3D地图绘制；
所述的机器视觉模块(2)，包括openMV专用摄像头、摄像头底座和控制芯片，所述的控制芯片与主控芯片(3)连接，openMV专用摄像头通过摄像头底座安装在固定底板支架上、朝向机器人运动的正前方，将机器人行走前方的道路图像进行实时传输，将视觉识别结果反馈给主控芯片(3)，主控芯片(3)通过无线通信模块将机器人接收到的图像结果发送给上位机进行处理，进行实时监控洞穴内部情况及机器人运动情况。
2.根据权利要求1所述的可绘制3D地图并实时传输图像的洞穴探测爬行机器人，其特征在于：所述的上位机中安装的软件包含机器人运动控制界面、超声波测量数据绘图实时显示界面和实时图像信息回传界面；机器人通过计算机远程操纵爬行进入待测区域中，操作人员在安全地区对其进行运动控制，通过openMV摄像头监控爬行机器人视觉，如果有具体的探测对象，则利用openMV摄像头进行物体识别与搜寻，进入待测区后，超声波测距仪开始传送机器人上方、左侧和右侧距离数据给上位机，上位机通过软件处理，得到实时绘制的3D地图图像，实现采集洞穴结构信息的目的。
3.根据权利要求1所述的可绘制3D地图并实时传输图像的洞穴探测爬行机器人，其特征在于：所述的主控芯片(3)和控制芯片均为为低功耗、低电压、高性能、高实时性的STM32芯片。
4.根据权利要求1所述的可绘制3D地图并实时传输图像的洞穴探测爬行机器人，其特征在于：所述的无线通信模块是低功耗局域网协议模块，采用通用的、低功耗的近距离无线组网通讯技术ZigBee。
5.根据权利要求1所述的可绘制3D地图并实时传输图像的洞穴探测爬行机器人，其特征在于：所述的超声波测距模块(1)为超声波测距器HY-SRF05。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201811160827.3A CN109343523A (zh) | 2018-09-30 | 2018-09-30 | 可绘制3d地图并实时传输图像的洞穴探测爬行机器人 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201811160827.3A CN109343523A (zh) | 2018-09-30 | 2018-09-30 | 可绘制3d地图并实时传输图像的洞穴探测爬行机器人 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN109343523A true CN109343523A (zh) | 2019-02-15 |
Family
ID=65307748
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201811160827.3A Pending CN109343523A (zh) | 2018-09-30 | 2018-09-30 | 可绘制3d地图并实时传输图像的洞穴探测爬行机器人 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN109343523A (zh) |
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN112192561A (zh) * | 2020-08-25 | 2021-01-08 | 国科微城市智能科技(南京)有限责任公司 | 一种机器人的行动纠偏系统及其方法 |
| CN114894167A (zh) * | 2022-04-06 | 2022-08-12 | 西北工业大学 | 一种基于多传感器技术的洞穴自动测绘系统及方法 |
| CN116163651A (zh) * | 2023-04-24 | 2023-05-26 | 北京欧钻科技有限公司 | 旋挖钻机 |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102867432A (zh) * | 2012-09-24 | 2013-01-09 | 西安石油大学 | 基于GPS和Zigbee的双备份无线车辆定位系统 |
| CN104986241A (zh) * | 2015-06-29 | 2015-10-21 | 山东大学（威海） | 四足机器人及其步态规划方法 |
| CN106227202A (zh) * | 2016-09-19 | 2016-12-14 | 吉林大学 | 一种兼具自主导航及远程遥控的六足机器人 |
| CN108161887A (zh) * | 2018-01-22 | 2018-06-15 | 东莞理工学院 | 带机械手的两轮视觉机器人 |
| KR20180103612A (ko) * | 2017-03-10 | 2018-09-19 | (주)디엠비에이치 | 스카라 로봇의 다종 부품 교체 매뉴얼 제공 방법 및 시스템 |
-
2018
- 2018-09-30 CN CN201811160827.3A patent/CN109343523A/zh active Pending
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102867432A (zh) * | 2012-09-24 | 2013-01-09 | 西安石油大学 | 基于GPS和Zigbee的双备份无线车辆定位系统 |
| CN104986241A (zh) * | 2015-06-29 | 2015-10-21 | 山东大学（威海） | 四足机器人及其步态规划方法 |
| CN106227202A (zh) * | 2016-09-19 | 2016-12-14 | 吉林大学 | 一种兼具自主导航及远程遥控的六足机器人 |
| KR20180103612A (ko) * | 2017-03-10 | 2018-09-19 | (주)디엠비에이치 | 스카라 로봇의 다종 부품 교체 매뉴얼 제공 방법 및 시스템 |
| CN108161887A (zh) * | 2018-01-22 | 2018-06-15 | 东莞理工学院 | 带机械手的两轮视觉机器人 |
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN112192561A (zh) * | 2020-08-25 | 2021-01-08 | 国科微城市智能科技(南京)有限责任公司 | 一种机器人的行动纠偏系统及其方法 |
| CN114894167A (zh) * | 2022-04-06 | 2022-08-12 | 西北工业大学 | 一种基于多传感器技术的洞穴自动测绘系统及方法 |
| CN114894167B (zh) * | 2022-04-06 | 2024-01-30 | 西北工业大学 | 一种基于多传感器技术的洞穴自动测绘系统及方法 |
| CN116163651A (zh) * | 2023-04-24 | 2023-05-26 | 北京欧钻科技有限公司 | 旋挖钻机 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN108877296B (zh) | 一种基于物联网的防碰撞系统 | |
| US20210396842A1 (en) | Multi-scale inspection and intelligent diagnosis system and method for tunnel structural defects | |
| CN109343523A (zh) | 可绘制3d地图并实时传输图像的洞穴探测爬行机器人 | |
| CN113189977B (zh) | 一种用于机器人的智能导航路径规划系统及方法 | |
| CN106679661B (zh) | 搜救机器人手臂辅助同时定位及构建环境地图系统及方法 | |
| CN108536145A (zh) | 一种使用机器视觉进行智能跟随的机器人系统及运行方法 | |
| CN206709853U (zh) | 一种多旋翼无人机室内同步定位与建图系统 | |
| CN109737981B (zh) | 基于多传感器的无人车目标搜索装置及方法 | |
| CN105222760A (zh) | 一种基于双目视觉的无人机自主障碍物检测系统及方法 | |
| CN110988871B (zh) | 一种无人机载穿墙雷达高层建筑墙体健康离线检测系统及检测方法 | |
| CN106898249B (zh) | 一种针对地震灾区通信失效区域的地图构建方法 | |
| CN214520204U (zh) | 一种基于深度相机和激光雷达的港区智能巡检机器人 | |
| CN208953962U (zh) | 一种机器人感知系统及机器人 | |
| CN108093038A (zh) | 一种机场鸟情智能探测防控装置、系统及方法 | |
| CN108844543A (zh) | 基于uwb定位及航位推算的室内agv导航控制方法 | |
| CN104122890A (zh) | 城市地下轨道巡检机器人系统及检测方法 | |
| CN207649604U (zh) | 一种基于无人机的智能地形勘测系统 | |
| CN109001756A (zh) | 基于嵌入式设备的多线激光雷达障碍物检测系统及方法 | |
| CN109283930A (zh) | 一种球状智能巡检机器人 | |
| CN103723161A (zh) | 列车装载安全的实时自动检测设备 | |
| CN105898698A (zh) | 一种基于uwb的船舶靠泊辅助方法和系统 | |
| CN107671864B (zh) | 一种排爆机器人智能控制系统 | |
| CN106767698B (zh) | 基于北斗ⅱ姿态测量的输电线路杆塔倾斜度监测系统及监测方法 | |
| CN114815890A (zh) | 基于无人机的动态目标追踪系统设计 | |
| CN111638487B (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 | ||
| WD01 | Invention patent application deemed withdrawn after publication | ||
| WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20190215 |