CN113686883B - Device and method for detecting roadway blind area - Google Patents
Device and method for detecting roadway blind area Download PDFInfo
- Publication number
- CN113686883B CN113686883B CN202111145433.2A CN202111145433A CN113686883B CN 113686883 B CN113686883 B CN 113686883B CN 202111145433 A CN202111145433 A CN 202111145433A CN 113686883 B CN113686883 B CN 113686883B
- Authority
- CN
- China
- Prior art keywords
- scanning
- control device
- blind area
- degree
- information
- 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
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01N—INVESTIGATING OR ANALYSING MATERIALS BY DETERMINING THEIR CHEMICAL OR PHYSICAL PROPERTIES
- G01N21/00—Investigating or analysing materials by the use of optical means, i.e. using sub-millimetre waves, infrared, visible or ultraviolet light
- G01N21/84—Systems specially adapted for particular applications
- G01N21/88—Investigating the presence of flaws or contamination
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01J—MEASUREMENT OF INTENSITY, VELOCITY, SPECTRAL CONTENT, POLARISATION, PHASE OR PULSE CHARACTERISTICS OF INFRARED, VISIBLE OR ULTRAVIOLET LIGHT; COLORIMETRY; RADIATION PYROMETRY
- G01J5/00—Radiation pyrometry, e.g. infrared or optical thermometry
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01N—INVESTIGATING OR ANALYSING MATERIALS BY DETERMINING THEIR CHEMICAL OR PHYSICAL PROPERTIES
- G01N21/00—Investigating or analysing materials by the use of optical means, i.e. using sub-millimetre waves, infrared, visible or ultraviolet light
- G01N21/01—Arrangements or apparatus for facilitating the optical investigation
-
- 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
-
- 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
-
- 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/0242—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using non-visible light signals, e.g. IR or UV signals
-
- 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/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01J—MEASUREMENT OF INTENSITY, VELOCITY, SPECTRAL CONTENT, POLARISATION, PHASE OR PULSE CHARACTERISTICS OF INFRARED, VISIBLE OR ULTRAVIOLET LIGHT; COLORIMETRY; RADIATION PYROMETRY
- G01J5/00—Radiation pyrometry, e.g. infrared or optical thermometry
- G01J2005/0077—Imaging
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01N—INVESTIGATING OR ANALYSING MATERIALS BY DETERMINING THEIR CHEMICAL OR PHYSICAL PROPERTIES
- G01N21/00—Investigating or analysing materials by the use of optical means, i.e. using sub-millimetre waves, infrared, visible or ultraviolet light
- G01N21/01—Arrangements or apparatus for facilitating the optical investigation
- G01N2021/0106—General arrangement of respective parts
- G01N2021/0112—Apparatus in one mechanical, optical or electronic block
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Electromagnetism (AREA)
- Chemical & Material Sciences (AREA)
- Immunology (AREA)
- Pathology (AREA)
- General Health & Medical Sciences (AREA)
- Biochemistry (AREA)
- Analytical Chemistry (AREA)
- Life Sciences & Earth Sciences (AREA)
- Health & Medical Sciences (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Multimedia (AREA)
- Spectroscopy & Molecular Physics (AREA)
- Optical Radar Systems And Details Thereof (AREA)
- Traffic Control Systems (AREA)
Abstract
本申请涉及一种用于巷道盲区检测的设备及方法,该设备包括:移动装置,多自由度运动装置,控制装置以及扫描装置;控制装置根据预先对巷道壁进行扫描得到的初始点云信息及栅格地图信息确定盲区的位置信息,并基于所述位置信息确定盲区行进路径,发送相应的驱动信号至移动装置;移动装置根据驱动信号移动至盲区;控制装置向多自由度运动装置发送与盲区相对应的位姿指令;多自由度运动装置根据位姿指令调整位姿;控制装置发送扫描信号至扫描装置,扫描装置根据扫描信号对盲区进行扫描,得到盲区扫描信息,将盲区扫描信息反馈至控制装置。本申请能够实现对巷道盲区的扫描。
The present application relates to a device and method for lane blind spot detection, the device comprising: a mobile device, a multi-degree-of-freedom motion device, a control device and a scanning device; the control device determines the position information of the blind spot according to the initial point cloud information and grid map information obtained by scanning the lane wall in advance, determines the blind spot travel path based on the position information, and sends a corresponding drive signal to the mobile device; the mobile device moves to the blind spot according to the drive signal; the control device sends a posture instruction corresponding to the blind spot to the multi-degree-of-freedom motion device; the multi-degree-of-freedom motion device adjusts the posture according to the posture instruction; the control device sends a scanning signal to the scanning device, the scanning device scans the blind spot according to the scanning signal, obtains the blind spot scanning information, and feeds the blind spot scanning information back to the control device. The present application can realize the scanning of lane blind spots.
Description
技术领域Technical Field
本申请涉及巷道扫描技术领域,尤其是涉及一种用于巷道盲区检测的设备及方法。The present application relates to the technical field of lane scanning, and in particular to a device and method for lane blind spot detection.
背景技术Background Art
对于井巷工程,在对巷道进行点云扫描的过程中,很容易因为一些障碍物的格挡而造成扫描盲区,而目前用于矿井巷道工程以及隧道工程的三维激光扫描装置,多数为地面静站式及移动式三维激光扫描,均无法解决上述盲区扫描的问题。对于地面静站式三维激光扫描设备,存在以下缺陷:1、由于自身条件限制,无法在扫描过程中移动扫描仪,缺乏自主扫描能力。2、由于设置位置受限,无法针对一些激光扫描的盲区,进行扫描。对于移动式三维激光扫描设备,存在以下缺陷:由于移动式三维扫描设备只能沿隧道中线移动,因此针对激光扫描的盲区,无法进行扫描。For shaft and tunnel engineering, in the process of point cloud scanning of the tunnel, it is easy to cause scanning blind spots due to the obstruction of some obstacles. At present, most of the 3D laser scanning devices used in mine tunnel engineering and tunnel engineering are ground static and mobile 3D laser scanning, which cannot solve the above-mentioned blind spot scanning problem. For ground static 3D laser scanning equipment, there are the following defects: 1. Due to its own conditions, it is impossible to move the scanner during the scanning process and lacks autonomous scanning capabilities. 2. Due to the limited setting position, it is impossible to scan some blind spots of laser scanning. For mobile 3D laser scanning equipment, there are the following defects: Since the mobile 3D scanning equipment can only move along the center line of the tunnel, it is impossible to scan the blind spots of laser scanning.
发明内容Summary of the invention
有鉴于此,本申请提供一种用于巷道盲区检测的设备及方法,用以解决无法扫描巷道盲区的技术问题。In view of this, the present application provides a device and method for lane blind spot detection to solve the technical problem of being unable to scan lane blind spots.
为了解决上述问题,第一方面,本申请提供一种用于巷道盲区检测的设备,包括移动装置,多自由度运动装置,控制装置以及扫描装置,其中:In order to solve the above problems, in a first aspect, the present application provides a device for lane blind spot detection, including a mobile device, a multi-degree-of-freedom motion device, a control device and a scanning device, wherein:
所述多自由度运动装置一端固定安装在所述移动装置上,所述多自由度运动装置另一端连接于所述扫描装置,所述控制装置与所述移动装置、多自由度运动装置、扫描装置均固定连接;所述控制装置用于根据预先对巷道进行扫描得到的初始点云信息及栅格地图信息确定巷道盲区的位置信息,并基于所述位置信息确定盲区行进路径;One end of the multi-degree-of-freedom motion device is fixedly mounted on the mobile device, and the other end of the multi-degree-of-freedom motion device is connected to the scanning device. The control device is fixedly connected to the mobile device, the multi-degree-of-freedom motion device, and the scanning device. The control device is used to determine the position information of the blind area of the lane according to the initial point cloud information and grid map information obtained by scanning the lane in advance, and determine the travel path of the blind area based on the position information;
所述控制装置还用于根据所述盲区行进路径发送相应的驱动信号至所述移动装置;所述移动装置根据所述驱动信号移动至所述盲区;The control device is also used to send a corresponding driving signal to the mobile device according to the blind spot travel path; the mobile device moves to the blind spot according to the driving signal;
所述控制装置还用于根据所述盲区行进路径发送相应的位姿指令至所述多自由度运动装置;所述多自由度运动装置根据所述位姿指令调整位姿;The control device is also used to send corresponding posture instructions to the multi-degree-of-freedom motion device according to the blind spot travel path; the multi-degree-of-freedom motion device adjusts the posture according to the posture instructions;
所述控制装置还用于根据所述盲区行进路径发送相应的扫描信号至所述扫描装置;所述扫描装置根据所述扫描信号对盲区进行扫描,得到盲区扫描信息,并将所述盲区扫描信息反馈至所述控制装置。The control device is also used to send a corresponding scanning signal to the scanning device according to the blind spot travel path; the scanning device scans the blind spot according to the scanning signal, obtains blind spot scanning information, and feeds back the blind spot scanning information to the control device.
可选的,所述用于巷道盲区检测的设备还包括设置于所述移动装置前端的导航装置,且所述导航装置中安装有深度相机:Optionally, the device for lane blind spot detection further includes a navigation device disposed at the front end of the mobile device, and a depth camera is installed in the navigation device:
所述导航装置与所述控制装置连接,所述导航装置用于在所述移动装置移动过程中,通过所述深度相机获取实时图像数据信息,并将所述实时图像数据信息发送至所述控制装置;The navigation device is connected to the control device, and the navigation device is used to obtain real-time image data information through the depth camera during the movement of the mobile device, and send the real-time image data information to the control device;
所述控制装置还用于,根据所述实时图像数据信息分析所述移动装置前方有无障碍物,若有,则向所述多自由度运动装置发送避障位姿指令;所述多自由度运动装置还用于根据所述避障位姿指令调整位姿以避开障碍物。The control device is also used to analyze whether there is an obstacle in front of the mobile device based on the real-time image data information. If so, it sends an obstacle avoidance posture instruction to the multi-degree-of-freedom motion device; the multi-degree-of-freedom motion device is also used to adjust its posture according to the obstacle avoidance posture instruction to avoid the obstacle.
可选的,所述移动装置包括移动平台、伺服减速电机及移动控制模块,所述伺服减速电机及移动控制模块固定安装在所述移动平台内,所述移动控制模块与所述控制装置连接,所述伺服减速电机用于为所述移动装置提供动力,所述移动控制模块包括伺服减速电机驱动单元及第一嵌入式处理单元,所述第一嵌入式处理单元用于接收所述控制装置发送的驱动信号,并根据所述驱动信号控制所述伺服减速电机驱动单元驱动所述伺服减速电机工作以使所述移动装置移动。Optionally, the mobile device includes a mobile platform, a servo reduction motor and a mobile control module, the servo reduction motor and the mobile control module are fixedly installed in the mobile platform, the mobile control module is connected to the control device, the servo reduction motor is used to provide power for the mobile device, the mobile control module includes a servo reduction motor drive unit and a first embedded processing unit, the first embedded processing unit is used to receive a drive signal sent by the control device, and control the servo reduction motor drive unit to drive the servo reduction motor to work according to the drive signal to move the mobile device.
可选的,所述多自由度运动装置包括多自由度运动平台、多自由度机械臂及多自由度运动控制模块,所述多自由度运动平台固定在所述移动平台顶部,所述多自由度运动控制模块安装于所述多自由度运动平台内,所述多自由度机械臂一端设置在所述多自由度运动平台内,所述多自由度机械臂另一端与所述扫描装置连接;所述多自由度运动控制模块分别与所述控制装置、所述多自由度机械臂连接;所述多自由度运动控制模块包括第二嵌入式处理单元,所述第二嵌入式处理单元用于接收所述控制装置发送的位姿指令,并根据所述位姿指令控制所述多自由度机械臂调整位姿。Optionally, the multi-degree-of-freedom motion device includes a multi-degree-of-freedom motion platform, a multi-degree-of-freedom robotic arm and a multi-degree-of-freedom motion control module, the multi-degree-of-freedom motion platform is fixed on the top of the mobile platform, the multi-degree-of-freedom motion control module is installed in the multi-degree-of-freedom motion platform, one end of the multi-degree-of-freedom robotic arm is arranged in the multi-degree-of-freedom motion platform, and the other end of the multi-degree-of-freedom robotic arm is connected to the scanning device; the multi-degree-of-freedom motion control module is respectively connected to the control device and the multi-degree-of-freedom robotic arm; the multi-degree-of-freedom motion control module includes a second embedded processing unit, the second embedded processing unit is used to receive the posture command sent by the control device, and control the multi-degree-of-freedom robotic arm to adjust the posture according to the posture command.
可选的,所述用于巷道盲区检测的设备还包括:Optionally, the device for lane blind spot detection further includes:
设置于所述多自由度运动装置与所述扫描装置之间的扫描设备切换装置,所述扫描设备切换装置还与所述控制装置连接,所述扫描设备切换装置中安装有伺服电机;A scanning device switching device is arranged between the multi-degree-of-freedom motion device and the scanning device, the scanning device switching device is also connected to the control device, and a servo motor is installed in the scanning device switching device;
所述扫描装置包括三维激光扫描仪、CCD相机、红外热成像仪,所述三维激光扫描仪、CCD相机、红外热成像仪分别固定安装在所述扫描设备切换装置末端,所述三维激光扫描仪、CCD相机、红外热成像仪分别与所述控制装置连接;The scanning device includes a three-dimensional laser scanner, a CCD camera, and an infrared thermal imager, which are respectively fixedly mounted at the ends of the scanning device switching device, and are respectively connected to the control device;
所述扫描设备切换装置用于接收所述控制装置发送的切换信号,并根据所述切换信号驱动所述伺服电机运转以针对所述扫描装置中的三维激光扫描仪、CCD相机、红外热成像仪进行切换。The scanning device switching device is used to receive the switching signal sent by the control device, and drive the servo motor to operate according to the switching signal to switch the three-dimensional laser scanner, CCD camera, and infrared thermal imager in the scanning device.
第二方面,本申请提供一种如上所述的用于巷道盲区检测的设备的巷道盲区扫描方法,该巷道盲区扫描方法包括:In a second aspect, the present application provides a lane blind spot scanning method of the device for lane blind spot detection as described above, the lane blind spot scanning method comprising:
控制装置根据预先对巷道进行扫描得到的初始点云信息及栅格地图信息确定巷道盲区的位置信息,基于所述位置信息确定盲区行进路径,并根据所述盲区行进路径发送相应的驱动信号至移动装置;The control device determines the position information of the blind spot of the lane according to the initial point cloud information and the grid map information obtained by scanning the lane in advance, determines the blind spot travel path based on the position information, and sends a corresponding driving signal to the mobile device according to the blind spot travel path;
所述移动装置根据驱动信号移动至所述盲区;The mobile device moves to the blind area according to the driving signal;
所述控制装置向多自由度运动装置发送与所述盲区相应的位姿指令;The control device sends a posture instruction corresponding to the blind spot to the multi-degree-of-freedom motion device;
所述多自由度运动装置根据所述位姿指令调整位姿;The multi-degree-of-freedom motion device adjusts the posture according to the posture instruction;
所述控制装置发送扫描信号至扫描装置;所述扫描装置根据扫描信号对所述盲区进行扫描,得到盲区扫描信息,并将所述盲区扫描信息反馈至所述控制装置。The control device sends a scanning signal to the scanning device; the scanning device scans the blind area according to the scanning signal, obtains blind area scanning information, and feeds back the blind area scanning information to the control device.
可选的,所述控制装置根据预先对巷道进行扫描得到的初始点云信息及栅格地图信息确定巷道盲区的位置信息,基于所述位置信息确定盲区行进路径,包括:Optionally, the control device determines the position information of the blind spot of the lane according to the initial point cloud information and grid map information obtained by scanning the lane in advance, and determines the blind spot travel path based on the position information, including:
所述控制装置控制所述移动装置按预设初始路径移动,并获取导航装置中深度相机发送的实时图像数据信息;The control device controls the mobile device to move along a preset initial path and obtains real-time image data information sent by a depth camera in the navigation device;
所述控制装置根据所述实时图像数据信息分析所述移动装置前方有无障碍物;The control device analyzes whether there is an obstacle in front of the mobile device according to the real-time image data information;
若有,则所述控制装置向多自由度运动装置发送位姿变换指令;所述多自由度运动装置还用于根据所述位姿变换指令调整位姿以达到预设初始扫描位姿;所述控制装置分析得出避障路径,并控制所述移动装置按所述避障路径继续移动,所述控制装置控制扫描装置对巷道壁进行扫描,得到初始点云信息及栅格地图信息;If yes, the control device sends a posture change instruction to the multi-degree-of-freedom motion device; the multi-degree-of-freedom motion device is also used to adjust the posture according to the posture change instruction to achieve a preset initial scanning posture; the control device analyzes and obtains an obstacle avoidance path, and controls the mobile device to continue moving along the obstacle avoidance path, and the control device controls the scanning device to scan the tunnel wall to obtain initial point cloud information and raster map information;
所述控制装置对所述初始点云信息进行三维重构,获取初始巷道模型,并根据所述栅格地图信息构建巷道栅格地图;The control device performs three-dimensional reconstruction on the initial point cloud information to obtain an initial lane model, and constructs a lane grid map according to the grid map information;
所述控制装置根据所述初始巷道模型确定出巷道的盲区三维坐标,并根据所述巷道栅格地图进行盲区行进路径规划。The control device determines the three-dimensional coordinates of the blind area of the lane according to the initial lane model, and plans a travel path in the blind area according to the lane grid map.
可选的,所述盲区包括扫描盲区或孔洞病害区域,所述控制装置发送扫描信号至扫描装置;扫描装置根据扫描信号对所述盲区进行扫描,得到盲区点云信息,并将盲区点云信息反馈至控制装置,包括:Optionally, the blind area includes a scanning blind area or a hole disease area, and the control device sends a scanning signal to the scanning device; the scanning device scans the blind area according to the scanning signal to obtain the blind area point cloud information, and feeds back the blind area point cloud information to the control device, including:
所述控制装置发送扫描信号至扫描装置中的三维激光扫描仪,所述三维激光扫描仪对扫描盲区或孔洞病害区域进行扫描,得到扫描盲区或孔洞病害区域点云信息并将扫描盲区或孔洞病害区域点云信息反馈至所述控制装置。The control device sends a scanning signal to the three-dimensional laser scanner in the scanning device, and the three-dimensional laser scanner scans the scanning blind area or the hole disease area to obtain the point cloud information of the scanning blind area or the hole disease area and feeds back the point cloud information of the scanning blind area or the hole disease area to the control device.
可选的,所述盲区还包括渗水病害区域,所述控制装置发送扫描信号至扫描装置;扫描装置根据扫描信号对所述盲区进行扫描,得到盲区点云信息,并将盲区点云信息反馈至控制装置,包括:Optionally, the blind area also includes a water seepage disease area, and the control device sends a scanning signal to the scanning device; the scanning device scans the blind area according to the scanning signal to obtain the blind area point cloud information, and feeds back the blind area point cloud information to the control device, including:
所述控制装置发送切换信号至扫描设备切换装置,所述扫描设备切换装置驱动伺服电机运转将所述扫描装置中的三维激光扫描仪切换为红外热成像仪;The control device sends a switching signal to the scanning device switching device, and the scanning device switching device drives the servo motor to operate to switch the three-dimensional laser scanner in the scanning device to an infrared thermal imager;
所述控制装置发送扫描信号至所述扫描装置中的红外热成像仪,所述红外热成像仪对渗水病害区域进行扫描,得到渗水病害图像信息并将所述渗水病害图像信息反馈至所述控制装置。The control device sends a scanning signal to the infrared thermal imager in the scanning device, and the infrared thermal imager scans the water seepage disease area to obtain water seepage disease image information and feeds back the water seepage disease image information to the control device.
可选的,所述盲区还包括管道裂缝病害区域,所述控制装置发送扫描信号至扫描装置;扫描装置根据扫描信号对所述盲区进行扫描,得到盲区点云信息,并将盲区点云信息反馈至控制装置,包括:Optionally, the blind area also includes a pipeline crack disease area, and the control device sends a scanning signal to the scanning device; the scanning device scans the blind area according to the scanning signal to obtain the blind area point cloud information, and feeds back the blind area point cloud information to the control device, including:
所述控制装置发送切换信号至扫描设备切换装置,扫描设备切换装置驱动伺服电机运转将所述扫描装置中的三维激光扫描仪切换为CCD相机;The control device sends a switching signal to the scanning device switching device, and the scanning device switching device drives the servo motor to operate to switch the three-dimensional laser scanner in the scanning device to a CCD camera;
所述控制装置发送扫描信号至所述扫描装置中的CCD相机,所述CCD相机对管道裂缝病害区域进行扫描,得到管道裂缝病害图像信息并将所述管道裂缝病害图像信息反馈至所述控制装置。The control device sends a scanning signal to the CCD camera in the scanning device, and the CCD camera scans the pipeline crack disease area to obtain pipeline crack disease image information and feeds back the pipeline crack disease image information to the control device.
采用上述实施例的有益效果是:通过控制装置确定出巷道的盲区相关三维坐标及路径规划,移动装置移动至盲区,多自由度运动装置调整位姿后,所述扫描信号对盲区进行扫描,得到盲区扫描信息。由于能由控制装置在预先对巷道壁进行扫描后发现并确定巷道的盲区相关信息,并移动至盲区,在与扫描装置连接的多自由度运动装置调整位姿后,扫描装置即可对盲区进行扫描,从而实现对巷道盲区的扫描。The beneficial effect of adopting the above embodiment is that the three-dimensional coordinates and path planning related to the blind area of the lane are determined by the control device, the mobile device moves to the blind area, and after the multi-degree-of-freedom motion device adjusts its posture, the scanning signal scans the blind area to obtain blind area scanning information. Since the control device can find and determine the relevant information of the blind area of the lane after scanning the lane wall in advance, and move to the blind area, after the multi-degree-of-freedom motion device connected to the scanning device adjusts its posture, the scanning device can scan the blind area, thereby realizing the scanning of the blind area of the lane.
附图说明BRIEF DESCRIPTION OF THE DRAWINGS
图1为本申请提供的用于巷道盲区检测的设备一实施例的结构示意图;FIG1 is a schematic structural diagram of an embodiment of a device for lane blind spot detection provided by the present application;
图2为本申请提供的用于巷道盲区检测的设备一实施例的结构主视图;FIG2 is a structural front view of an embodiment of a device for lane blind spot detection provided by the present application;
图3为本申请提供的用于巷道盲区检测的设备一实施例的结构俯视图;FIG3 is a top view of the structure of an embodiment of a device for lane blind spot detection provided by the present application;
图4为本申请提供的用于巷道盲区检测的设备一实施例的结构左视图;FIG4 is a left side view of the structure of an embodiment of a device for lane blind spot detection provided by the present application;
图5为本申请提供的用于巷道盲区检测的设备一实施例的结构剖视图;FIG5 is a structural cross-sectional view of an embodiment of a device for lane blind spot detection provided by the present application;
图6为本申请提供的巷道盲区扫描方法一实施例的方法流程图。FIG6 is a method flow chart of an embodiment of a lane blind area scanning method provided in the present application.
具体实施方式DETAILED DESCRIPTION
下面结合附图来具体描述本申请的优选实施例,其中,附图构成本申请一部分,并与本申请的实施例一起用于阐释本申请的原理,并非用于限定本申请的范围。The preferred embodiments of the present application are described in detail below in conjunction with the accompanying drawings, wherein the accompanying drawings constitute a part of the present application and are used together with the embodiments of the present application to illustrate the principles of the present application, and are not used to limit the scope of the present application.
在本申请的描述中,“多个”的含义是两个或两个以上,除非另有明确具体的限定。In the description of the present application, “plurality” means two or more than two, unless otherwise clearly and specifically defined.
在本文中提及“实施例”意味着,结合实施例描述的特定特征、结构或特性可以包含在本申请的至少一个实施例中。在说明书中的各个位置出现该短语并不一定均是指相同的实施例,也不是与其它实施例互斥的独立的或备选的实施例。本领域技术人员显式地和隐式地理解的是,本文所描述的实施例可以与其它实施例相结合。Reference to "embodiments" herein means that a particular feature, structure, or characteristic described in conjunction with the embodiments may be included in at least one embodiment of the present application. The appearance of the phrase in various locations in the specification does not necessarily refer to the same embodiment, nor is it an independent or alternative embodiment that is mutually exclusive with other embodiments. It is explicitly and implicitly understood by those skilled in the art that the embodiments described herein may be combined with other embodiments.
本申请提供了一种用于巷道盲区检测的设备,参照图1所示,图1是本申请提供的用于巷道盲区检测的设备一实施例的结构示意图。所述用于巷道盲区检测的设备包括:The present application provides a device for lane blind spot detection, as shown in FIG1 , which is a schematic diagram of the structure of an embodiment of a device for lane blind spot detection provided by the present application. The device for lane blind spot detection includes:
移动装置101,多自由度运动装置102,控制装置103,扫描装置104;其中,所述多自由度运动装置102一端固定在所述移动装置103上,所述多自由度运动装置102另一端连接所述扫描装置104,所述控制装置103与所述移动装置101、多自由度运动装置102、扫描装置104连接。A mobile device 101, a multi-degree-of-freedom motion device 102, a control device 103, and a scanning device 104; wherein one end of the multi-degree-of-freedom motion device 102 is fixed on the mobile device 103, and the other end of the multi-degree-of-freedom motion device 102 is connected to the scanning device 104, and the control device 103 is connected to the mobile device 101, the multi-degree-of-freedom motion device 102, and the scanning device 104.
所述控制装置103根据预先对巷道壁进行扫描得到的初始点云信息及栅格地图信息确定出盲区相关三维坐标及路径规划,并发送相应的驱动信号至所述移动装置101;所述移动装置101根据所述驱动信号移动至盲区;所述控制装置103向所述多自由度运动装置102发送与盲区相对应的位姿指令;所述多自由度运动装置102根据所述位姿指令调整位姿;所述控制装置103发送扫描信号至所述扫描装置104,所述扫描装置104根据所述扫描信号对盲区进行扫描,得到盲区扫描信息,并将所述盲区扫描信息反馈至所述控制装置103。The control device 103 determines the three-dimensional coordinates and path planning related to the blind spot based on the initial point cloud information and grid map information obtained by pre-scanning the tunnel wall, and sends a corresponding driving signal to the mobile device 101; the mobile device 101 moves to the blind spot according to the driving signal; the control device 103 sends a posture instruction corresponding to the blind spot to the multi-degree-of-freedom motion device 102; the multi-degree-of-freedom motion device 102 adjusts its posture according to the posture instruction; the control device 103 sends a scanning signal to the scanning device 104, and the scanning device 104 scans the blind spot according to the scanning signal to obtain blind spot scanning information, and feeds back the blind spot scanning information to the control device 103.
本实施例通过控制装置103确定出巷道的盲区相关三维坐标及路径规划,移动装置101移动至盲区,多自由度运动装置102调整位姿后,所述扫描信号对盲区进行扫描,得到盲区扫描信息。由于能由控制装置103在预先对巷道壁进行扫描后发现并确定巷道的盲区相关信息,并移动至盲区,在与扫描装置104连接的多自由度运动装置102调整位姿后,扫描装置104即可对盲区进行扫描,从而实现对巷道盲区的扫描。In this embodiment, the control device 103 determines the three-dimensional coordinates and path planning related to the blind area of the lane, the mobile device 101 moves to the blind area, and after the multi-degree-of-freedom motion device 102 adjusts its posture, the scanning signal scans the blind area to obtain blind area scanning information. Since the control device 103 can find and determine the relevant information of the blind area of the lane after scanning the lane wall in advance, and move to the blind area, after the multi-degree-of-freedom motion device 102 connected to the scanning device 104 adjusts its posture, the scanning device 104 can scan the blind area, thereby realizing the scanning of the blind area of the lane.
具体地,参照图2、图3、图4、图5所示,在一可选的实施方式中,Specifically, referring to FIG. 2 , FIG. 3 , FIG. 4 , and FIG. 5 , in an optional embodiment,
所述移动装置101包括移动平台201、移动控制模块202,所述多自由度运动装置102包括多自由度运动平台203、多自由度机械臂204及多自由度运动控制模块205,所述用于巷道盲区检测的设备还包括:导航装置206、扫描设备切换装置207。The mobile device 101 includes a mobile platform 201 and a mobile control module 202. The multi-degree-of-freedom motion device 102 includes a multi-degree-of-freedom motion platform 203, a multi-degree-of-freedom robotic arm 204 and a multi-degree-of-freedom motion control module 205. The equipment for lane blind spot detection also includes: a navigation device 206 and a scanning device switching device 207.
具体地,所述移动平台201内部存有较大空间,所述空间用于安装蓄电池装置、移动控制模块202及四个伺服减速电机;移动平台201四周安装有4个麦克纳姆轮。在本实施方式中,所述四个伺服减速电机,用于给所述移动平台201提供动力;所述麦克纳姆轮通过联轴器固定在所述伺服减速电机末端,在其他可选的实施方式中,所述麦克纳姆轮可通过履带方式等固定在所述伺服减速电机末端。Specifically, there is a large space inside the mobile platform 201, which is used to install the battery device, the mobile control module 202 and four servo reduction motors; four Mecanum wheels are installed around the mobile platform 201. In this embodiment, the four servo reduction motors are used to provide power to the mobile platform 201; the Mecanum wheel is fixed to the end of the servo reduction motor through a coupling, and in other optional embodiments, the Mecanum wheel can be fixed to the end of the servo reduction motor by a crawler or the like.
所述多自由度运动平台203设置在所述移动平台201顶部;所述多自由度运动平台203包括多自由度机械臂204例如六轴机械臂;所述多自由度运动平台203内部存有较大空间,所述空间用于安装控制装置103、多自由度运动控制模块205。具体地,在本实施方式中,所述多自由度运动平台203通过螺栓固定在所述移动平台201上部;所述控制装置103通过螺栓固定在所述多自由度运动平台203内部。所述多自由度运动控制模块205通过螺栓固定在所述多自由度运动平台203内部。所述多自由度机械臂204例如六轴机械臂通过螺栓固定在所述移动平台201上部。The multi-degree-of-freedom motion platform 203 is arranged on the top of the mobile platform 201; the multi-degree-of-freedom motion platform 203 includes a multi-degree-of-freedom mechanical arm 204, such as a six-axis mechanical arm; there is a large space inside the multi-degree-of-freedom motion platform 203, and the space is used to install the control device 103 and the multi-degree-of-freedom motion control module 205. Specifically, in this embodiment, the multi-degree-of-freedom motion platform 203 is fixed to the upper part of the mobile platform 201 by bolts; the control device 103 is fixed to the inside of the multi-degree-of-freedom motion platform 203 by bolts. The multi-degree-of-freedom motion control module 205 is fixed to the inside of the multi-degree-of-freedom motion platform 203 by bolts. The multi-degree-of-freedom mechanical arm 204, such as a six-axis mechanical arm, is fixed to the upper part of the mobile platform 201 by bolts.
所述移动控制模块202设置在所述移动平台201内部;所述移动控制模块202包括选择开关、四路伺服减速电机驱动单元以及嵌入式处理单元。具体地,所述移动控制模块202通过螺栓固定设置在所述移动平台201内;所述选择开关通过螺栓固定设置在所述移动平台201外部;所述四路伺服减速电机驱动单元通过螺栓固定设置在所述移动平台201内;所述嵌入式处理单元通过螺栓固定设置在所述移动平台201内,通过嵌入式处理单元I/O输出高低电平控制四路伺服减速电机驱动单元。The mobile control module 202 is set inside the mobile platform 201; the mobile control module 202 includes a selection switch, a four-way servo reduction motor drive unit and an embedded processing unit. Specifically, the mobile control module 202 is fixedly set inside the mobile platform 201 by bolts; the selection switch is fixedly set outside the mobile platform 201 by bolts; the four-way servo reduction motor drive unit is fixedly set inside the mobile platform 201 by bolts; the embedded processing unit is fixedly set inside the mobile platform 201 by bolts, and the four-way servo reduction motor drive unit is controlled by the high and low levels of the embedded processing unit I/O output.
所述多自由度运动控制模块205设置在所述多自由度运动平台203内部;所述多自由度运动控制模块205包括选择开关以及嵌入式处理单元。具体地,所述多自由度运动控制模块205通过螺栓固定设置在所述多自由度运动平台203内;所述选择开关通过螺栓固定设置在所述多自由度运动平台203外部;所述嵌入式处理单元通过螺栓固定设置在所述多自由度运动平台203内,所述嵌入式处理单元输出信号控制所述六轴机械臂装置。The multi-degree-of-freedom motion control module 205 is arranged inside the multi-degree-of-freedom motion platform 203; the multi-degree-of-freedom motion control module 205 includes a selection switch and an embedded processing unit. Specifically, the multi-degree-of-freedom motion control module 205 is fixedly arranged inside the multi-degree-of-freedom motion platform 203 by bolts; the selection switch is fixedly arranged outside the multi-degree-of-freedom motion platform 203 by bolts; the embedded processing unit is fixedly arranged inside the multi-degree-of-freedom motion platform 203 by bolts, and the embedded processing unit outputs a signal to control the six-axis robotic arm device.
所述扫描设备切换装置207包括伺服电机;所述扫描设备切换装置207设置在所述多自由度运动平台203末端,位于所述六轴机械臂末端;所述扫描切换装置207通过法兰盘与所述多自由度运动平台203末端连接;所述伺服电机通过螺栓固定设置在所述扫描设备切换装置207内部。The scanning device switching device 207 includes a servo motor; the scanning device switching device 207 is arranged at the end of the multi-degree-of-freedom motion platform 203, located at the end of the six-axis robotic arm; the scanning switching device 207 is connected to the end of the multi-degree-of-freedom motion platform 203 through a flange; the servo motor is fixed inside the scanning device switching device 207 by bolts.
所述导航装置206包括深度相机;所述深度相机通过螺栓固定在所述移动平台201外部;所述深度相机通过USB3.0接口与所述控制装置103连接。The navigation device 206 includes a depth camera; the depth camera is fixed to the outside of the mobile platform 201 by bolts; the depth camera is connected to the control device 103 via a USB 3.0 interface.
所述扫描装置104包括:三维激光扫描设备,所述三维激光扫描设备通过法兰盘螺栓固定在所述扫描设备切换装置207末端,所述三维激光扫描设备通过千兆网线接口RJ-45与所述控制装置103连接;高精度CCD相机,所述高精度CCD相机通过法兰盘螺栓固定在所述扫描设备切换装置207末端,所述高精度CCD相机通过千兆网线接口RJ-45与所述控制装置103连接;红外热成像仪,所述红外热成像仪通过法兰盘螺栓固定在所述扫描设备切换装置207末端,所述红外热成像仪通过千兆网线接口RJ-45与所述控制装置103连接。The scanning device 104 includes: a three-dimensional laser scanning device, which is fixed to the end of the scanning device switching device 207 by flange bolts, and the three-dimensional laser scanning device is connected to the control device 103 via a gigabit network cable interface RJ-45; a high-precision CCD camera, which is fixed to the end of the scanning device switching device 207 by flange bolts, and the high-precision CCD camera is connected to the control device 103 via a gigabit network cable interface RJ-45; an infrared thermal imager, which is fixed to the end of the scanning device switching device 207 by flange bolts, and the infrared thermal imager is connected to the control device 103 via a gigabit network cable interface RJ-45.
所述用于巷道盲区检测的设备还包括蓄电池装置,所述蓄电池装置包括蓄电池,所述蓄电池固定设置在所述移动平台201内部。具体地,在本实施方式中,所述蓄电池通过螺栓固定设置在所述移动平台201内,在其它可选的实施方式中,所述蓄电池可通过其它方式如轴销等固定设置在所述移动平台201内。所述充电线与所述蓄电池连接,所述充电线给所述蓄电池充电,使移动平台201不受空间限制。The device for lane blind spot detection also includes a battery device, the battery device includes a battery, and the battery is fixedly arranged inside the mobile platform 201. Specifically, in this embodiment, the battery is fixedly arranged inside the mobile platform 201 by bolts, and in other optional embodiments, the battery can be fixedly arranged inside the mobile platform 201 by other means such as axle pins. The charging line is connected to the battery, and the charging line charges the battery, so that the mobile platform 201 is not limited by space.
控制装置103,设置在多自由度运动平台203内部,分别与所述蓄电装置、移动控制模块202、所述多自由度运动控制模块205、所述扫描设备切换装置207、所述导航装置206和所述扫描装置104连接,用于控制移动平台201和多自由度运动平台203的运行,以及控制扫描设备切换装置207,采集、处理分析所述导航装置206导航信息以及所述扫描装置104点云信息,以及发送障碍物、病害和盲区位置信息。The control device 103 is arranged inside the multi-degree-of-freedom motion platform 203, and is respectively connected to the power storage device, the mobile control module 202, the multi-degree-of-freedom motion control module 205, the scanning device switching device 207, the navigation device 206 and the scanning device 104, and is used to control the operation of the mobile platform 201 and the multi-degree-of-freedom motion platform 203, and control the scanning device switching device 207, collect, process and analyze the navigation information of the navigation device 206 and the point cloud information of the scanning device 104, and send obstacle, disease and blind spot location information.
在一种可选的实施方式中,所述控制装置103包括:1、运动控制单元,与所述移动控制模块202通过UART以串口通信协议连接;与所述多自由度运动控制模块205通过网线接口RJ-45以TCP/IP协议连接;与所述扫描设备切换装置207通过IO口连接。2、测量控制单元,与所述导航装置206通过USB3.0接口连接;所述扫描装置104通过上述扫描装置104中所介绍连接方式连接。3、信息处理单元,所述信息处理单元通过螺栓设置在所述多自由度运动平台203内部。4、数据存储单元,所述数据存储装置通过螺栓设置在所述多自由度运动平台203内部,与所述信息处理单元通过USB3.0接口连接。In an optional embodiment, the control device 103 includes: 1. A motion control unit, connected to the mobile control module 202 via UART with a serial communication protocol; connected to the multi-degree-of-freedom motion control module 205 via a network cable interface RJ-45 with a TCP/IP protocol; and connected to the scanning device switching device 207 via an IO port. 2. A measurement control unit, connected to the navigation device 206 via a USB3.0 interface; the scanning device 104 is connected via the connection method described in the above scanning device 104. 3. An information processing unit, the information processing unit is arranged inside the multi-degree-of-freedom motion platform 203 by bolts. 4. A data storage unit, the data storage device is arranged inside the multi-degree-of-freedom motion platform 203 by bolts, and connected to the information processing unit via a USB3.0 interface.
参照图6为本申请提供的用于巷道盲区检测的设备的巷道盲区扫描方法一实施例的方法流程图,该用于巷道盲区检测的设备的具体结构参照上述实施例,在此不再赘述,该巷道盲区扫描方法包括下述步骤:6 is a method flow chart of an embodiment of a lane blind area scanning method of a device for lane blind area detection provided by the present application. The specific structure of the device for lane blind area detection refers to the above embodiment and will not be repeated here. The lane blind area scanning method includes the following steps:
步骤S601、控制装置根据预先对巷道进行扫描得到的初始点云信息及栅格地图信息确定巷道盲区的位置信息,基于所述位置信息确定盲区行进路径,并根据所述盲区行进路径发送相应的驱动信号至移动装置;Step S601: The control device determines the position information of the blind spot of the lane according to the initial point cloud information and the grid map information obtained by scanning the lane in advance, determines the blind spot travel path based on the position information, and sends a corresponding driving signal to the mobile device according to the blind spot travel path;
步骤S602、所述移动装置根据驱动信号移动至所述盲区;Step S602: the mobile device moves to the blind area according to the driving signal;
步骤S603、所述控制装置向多自由度运动装置发送与所述盲区相对应的位姿指令;Step S603: the control device sends a posture instruction corresponding to the blind spot to the multi-degree-of-freedom motion device;
步骤S604、所述多自由度运动装置根据所述位姿指令调整位姿;Step S604, the multi-degree-of-freedom motion device adjusts the posture according to the posture instruction;
步骤S605、所述控制装置发送扫描信号至扫描装置;所述扫描装置根据扫描信号对所述盲区进行扫描,得到盲区扫描信息,并将所述盲区扫描信息反馈至所述控制装置。Step S605: the control device sends a scanning signal to the scanning device; the scanning device scans the blind area according to the scanning signal, obtains blind area scanning information, and feeds back the blind area scanning information to the control device.
本实施例通过控制装置确定出巷道的盲区相关三维坐标及路径规划,移动装置移动至盲区,多自由度运动装置调整位姿后,所述扫描信号对盲区进行扫描,得到盲区扫描信息。由于能由控制装置在预先对巷道壁进行扫描后发现并确定巷道的盲区相关信息,并移动至盲区,在与扫描装置连接的多自由度运动装置调整位姿后,扫描装置即可对盲区进行扫描,从而实现对巷道盲区的扫描。In this embodiment, the control device determines the three-dimensional coordinates and path planning related to the blind area of the lane, the mobile device moves to the blind area, and after the multi-degree-of-freedom motion device adjusts its posture, the scanning signal scans the blind area to obtain blind area scanning information. Since the control device can find and determine the relevant information of the blind area of the lane after scanning the lane wall in advance, and move to the blind area, after the multi-degree-of-freedom motion device connected to the scanning device adjusts its posture, the scanning device can scan the blind area, thereby realizing the scanning of the blind area of the lane.
进一步地,在一实施例中,步骤S601包括:Further, in one embodiment, step S601 includes:
所述控制装置根据预先对巷道壁进行扫描得到的初始点云信息及栅格地图信息确定出盲区相关三维坐标及路径规划,包括:The control device determines the three-dimensional coordinates and path planning related to the blind area based on the initial point cloud information and grid map information obtained by scanning the tunnel wall in advance, including:
所述控制装置控制所述移动装置按预设初始路径移动,并获取导航装置中深度相机发送的实时图像数据信息;The control device controls the mobile device to move along a preset initial path and obtains real-time image data information sent by a depth camera in the navigation device;
所述控制装置根据所述实时图像数据信息分析所述移动装置前方有无障碍物;The control device analyzes whether there is an obstacle in front of the mobile device according to the real-time image data information;
若有,则所述控制装置向多自由度运动装置发送位姿变换指令;所述多自由度运动装置还用于根据所述位姿变换指令调整位姿以达到预设初始扫描位姿;所述控制装置分析得出避障路径,并控制所述移动装置按所述避障路径继续移动,所述控制装置控制扫描装置对巷道壁进行扫描,得到初始点云信息及栅格地图信息;If yes, the control device sends a posture change instruction to the multi-degree-of-freedom motion device; the multi-degree-of-freedom motion device is also used to adjust the posture according to the posture change instruction to achieve a preset initial scanning posture; the control device analyzes and obtains an obstacle avoidance path, and controls the mobile device to continue moving along the obstacle avoidance path, and the control device controls the scanning device to scan the tunnel wall to obtain initial point cloud information and grid map information;
所述控制装置对所述初始点云信息进行三维重构,获取初始巷道模型,并根据所述栅格地图信息构建巷道栅格地图;The control device performs three-dimensional reconstruction on the initial point cloud information to obtain an initial lane model, and constructs a lane grid map according to the grid map information;
所述控制装置根据所述初始巷道模型确定出巷道的盲区三维坐标,并根据所述巷道栅格地图进行盲区行进路径规划。The control device determines the three-dimensional coordinates of the blind area of the lane according to the initial lane model, and plans a travel path in the blind area according to the lane grid map.
具体地,当需要对巷道进行扫描时,首先通过充电线对蓄电池进行充电,充电线插头接入220V市电进行充电,蓄电池充满后,可取下充电线。按下位于移动平台的选择开关以及位于多自由度运动平台的选择开光,蓄电池开始向移动平台中移动控制模块和四个伺服减速电机供电,向多自由度运动平台中多自由度运动控制模块供电和六轴机械臂供电,向扫描设备切换装置中伺服电机供电,向导航装置中深度相机供电,向扫描装置中三维激光扫描装置、高精度CCD相机和红外热成像仪供电,向控制装置中信息处理单元与数据存储单元供电。Specifically, when the lane needs to be scanned, the battery is first charged through the charging cable, and the charging cable plug is connected to the 220V mains for charging. After the battery is fully charged, the charging cable can be removed. Press the selection switch on the mobile platform and the selection switch on the multi-degree-of-freedom motion platform, and the battery starts to supply power to the mobile control module and four servo reduction motors in the mobile platform, to the multi-degree-of-freedom motion control module and the six-axis robotic arm in the multi-degree-of-freedom motion platform, to the servo motor in the scanning device switching device, to the depth camera in the navigation device, to the three-dimensional laser scanning device, the high-precision CCD camera and the infrared thermal imager in the scanning device, and to the information processing unit and the data storage unit in the control device.
控制装置按照指定程序运行,获取导航装置中深度相机传递的图像数据信息,并将图像数据信息存储在数据存储单元中,控制装置通过对传递的图像数据信息进行分析判断,确定前方有无障碍物,若没有障碍物,控制装置向移动控制模块发送驱动信号,移动控制模块驱动四个伺服减速电机运转,使得移动平台向指定规划好的方向运动,若有障碍物,控制装置进行分析得出避障路径,向移动控制模块发送驱动信号,移动控制模块驱动四个伺服减速电机运转,使得移动平台向指定方向运动;同时控制装置向多自由度运动控制模块发送位姿变换指令,多自由度运动控制模块驱动六轴机械臂实现位姿变换,达到预定扫描位姿。The control device runs according to the specified program, obtains the image data information transmitted by the depth camera in the navigation device, and stores the image data information in the data storage unit. The control device determines whether there is an obstacle in front by analyzing and judging the transmitted image data information. If there is no obstacle, the control device sends a driving signal to the mobile control module, and the mobile control module drives the four servo reduction motors to operate, so that the mobile platform moves in the specified planned direction. If there is an obstacle, the control device analyzes and obtains the obstacle avoidance path, and sends a driving signal to the mobile control module. The mobile control module drives the four servo reduction motors to operate, so that the mobile platform moves in the specified direction; at the same time, the control device sends a posture transformation instruction to the multi-degree-of-freedom motion control module, and the multi-degree-of-freedom motion control module drives the six-axis robot arm to realize posture transformation to achieve the predetermined scanning posture.
控制装置向三维激光扫描设备发送扫描信号,三维激光扫描设备开始扫描巷道壁,将点云信息发送给控制装置,控制装置将点云信息存储在数据存储单元中。The control device sends a scanning signal to the three-dimensional laser scanning device, and the three-dimensional laser scanning device starts to scan the tunnel wall and sends the point cloud information to the control device, and the control device stores the point cloud information in the data storage unit.
重复上述各步骤,实现对巷道的粗扫描以及巷道工程的栅格地图的信息采集。Repeat the above steps to achieve a rough scan of the tunnel and information collection of the raster map of the tunnel project.
控制装置,通过信息处理单元,读取数据存储单元中的点云信息,通过三维重构,完成对巷道模型的构建,此外,读取数据存储单元中的巷道栅格地图信息,完成巷道栅格地图的构建。之后,信息处理单元,通过对巷道模型的分析,找出目前粗扫描模型存在的盲区包括扫描盲区、病害区域等,得到扫描盲区、病害区域的三维坐标信息。The control device reads the point cloud information in the data storage unit through the information processing unit, completes the construction of the lane model through three-dimensional reconstruction, and also reads the lane grid map information in the data storage unit to complete the construction of the lane grid map. Afterwards, the information processing unit analyzes the lane model to find out the blind areas existing in the current rough scanning model, including scanning blind areas, diseased areas, etc., and obtains the three-dimensional coordinate information of the scanning blind areas and diseased areas.
控制装置,根据分析栅格地图完成到盲区、病害区域的路径规划,控制装置向移动控制模块发送控制信号,移动控制模块驱动移动平台向指定盲区、病害位置运动,到达目标区域。The control device completes the path planning to the blind spot and the diseased area according to the analysis grid map. The control device sends a control signal to the mobile control module, and the mobile control module drives the mobile platform to move to the designated blind spot and the diseased location to reach the target area.
进一步地,所述盲区包括扫描盲区、孔洞病害区域、渗水病害区域、管道裂缝病害区域,针对不同类型区域的扫描步骤如下:Furthermore, the blind area includes scanning blind area, hole disease area, water seepage disease area, pipeline crack disease area, and the scanning steps for different types of areas are as follows:
针对扫描盲区的扫描,控制装置向多自由度运动控制模块发送相应的位姿指令,多自由度运动控制模块向六轴机械臂发送相应的控制信号,避开障碍物所遮挡的盲区,控制装置向扫描装置中三维激光扫描设备发送扫描信号,将扫描装置得到的盲区的点云信息发送给控制装置,控制装置将盲区的点云信息存储到数据存储单元中,之后分析盲区点云信息数据,完成对巷道模型的补全。For scanning blind spots, the control device sends corresponding posture instructions to the multi-degree-of-freedom motion control module, and the multi-degree-of-freedom motion control module sends corresponding control signals to the six-axis robotic arm to avoid blind spots blocked by obstacles. The control device sends scanning signals to the three-dimensional laser scanning device in the scanning device, and sends the point cloud information of the blind spots obtained by the scanning device to the control device. The control device stores the point cloud information of the blind spots in the data storage unit, and then analyzes the point cloud information data of the blind spots to complete the completion of the lane model.
针对巷道壁裂缝、孔洞病害区域的扫描,控制装置向多自由度运动控制模块发送相应的位姿指令,多自由度运动控制模块向六轴机械臂发送相应的控制信号,到达巷道壁裂缝、孔洞病害区域所在位置,控制装置向扫描装置中三维激光扫描设备发送扫描信号,将扫描装置得到的巷道壁裂缝、孔洞病害区域的点云信息发送给控制装置,控制装置将得到的点云信息存储到数据存储单元中,之后分析巷道壁裂缝、孔洞病害区域点云信息数据,得到对巷道壁裂缝、孔洞病害的详细病害信息。For scanning of the tunnel wall cracks and hole disease areas, the control device sends corresponding posture instructions to the multi-degree-of-freedom motion control module, and the multi-degree-of-freedom motion control module sends corresponding control signals to the six-axis robotic arm to reach the location of the tunnel wall cracks and hole disease areas. The control device sends a scanning signal to the three-dimensional laser scanning device in the scanning device, and sends the point cloud information of the tunnel wall cracks and hole disease areas obtained by the scanning device to the control device. The control device stores the obtained point cloud information in the data storage unit, and then analyzes the point cloud information data of the tunnel wall cracks and hole disease areas to obtain detailed disease information of the tunnel wall cracks and hole diseases.
针对渗水病害区域的扫描,控制装置向多自由度运动控制模块发送相应的位姿指令,多自由度运动控制模块向六轴机械臂发送相应的控制信号,到达渗水病害区域所在位置,控制装置向扫描设备切换装置发送控制信号,扫描设备切换装置驱动电机运转,实现由三维激光扫描设备到红外热成像仪的切换,控制装置向扫描装置中红外热成像仪发送扫描信号,将扫描装置得到的渗水病害区域的图像信息发送给控制装置,控制装置将得到的图像信息存储到数据存储单元中,之后分析渗水病害区域的图像信息数据,得到对渗水病害区域的详细病害信息。For scanning of the water seepage disease area, the control device sends corresponding posture instructions to the multi-degree-of-freedom motion control module, and the multi-degree-of-freedom motion control module sends corresponding control signals to the six-axis robotic arm to reach the location of the water seepage disease area. The control device sends a control signal to the scanning device switching device, and the scanning device switching device drives the motor to operate to realize the switch from the three-dimensional laser scanning device to the infrared thermal imager. The control device sends a scanning signal to the infrared thermal imager in the scanning device, and sends the image information of the water seepage disease area obtained by the scanning device to the control device. The control device stores the obtained image information in the data storage unit, and then analyzes the image information data of the water seepage disease area to obtain detailed disease information of the water seepage disease area.
针对管道裂缝、破裂病害区域的扫描,控制装置向多自由度运动控制模块发送相应的位姿指令,多自由度运动控制模块向六轴机械臂发送相应的控制信号,到达管道裂缝、破裂病害区域所在位置,控制装置向扫描设备切换装置发送控制信号,扫描设备切换装置驱动电机运转,实现由三维激光扫描设备到高精度CCD相机的切换,控制装置向扫描装置中高精度CCD相机发送扫描信号,将扫描装置得到的管道裂缝、破裂病害区域的图像信息发送给控制装置,控制装置将得到的图像信息存储到数据存储单元中,之后分析管道裂缝、破裂病害区域的图像信息数据,得到对管道裂缝、破裂病害的详细病害信息。For scanning of pipeline crack and rupture disease areas, the control device sends corresponding posture instructions to the multi-degree-of-freedom motion control module, and the multi-degree-of-freedom motion control module sends corresponding control signals to the six-axis robot arm to reach the location of the pipeline crack and rupture disease area. The control device sends a control signal to the scanning device switching device, and the scanning device switching device drives the motor to operate to realize the switch from the three-dimensional laser scanning device to the high-precision CCD camera. The control device sends a scanning signal to the high-precision CCD camera in the scanning device, and sends the image information of the pipeline crack and rupture disease area obtained by the scanning device to the control device. The control device stores the obtained image information in the data storage unit, and then analyzes the image information data of the pipeline crack and rupture disease area to obtain detailed disease information of the pipeline crack and rupture disease.
本实施例可以实现自主巷道路径规划,完成巷道三维模型以及栅格地图的构建,在此基础上完成对巷道病害区域的识别以及完成对盲区点云信息的获取,实现对巷道三维模型的补全以及对病害区域进行详细检测与扫描。This embodiment can realize autonomous tunnel path planning, complete the construction of tunnel three-dimensional model and grid map, and on this basis complete the identification of tunnel diseased areas and the acquisition of blind spot point cloud information, realize the completion of tunnel three-dimensional model and detailed detection and scanning of diseased areas.
应理解,上述实施例中各步骤的序号的大小并不意味着执行顺序的先后,各过程的执行顺序应以其功能和内在逻辑确定,而不应对本申请实施例的实施过程构成任何限定。It should be understood that the size of the serial numbers of the steps in the above embodiments does not mean the order of execution. The execution order of each process should be determined by its function and internal logic, and should not constitute any limitation on the implementation process of the embodiments of the present application.
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的计算机程序可存储于一非易失性计算机可读取存储介质中,该计算机程序在执行时,可包括如上述各方法的实施例的流程。A person of ordinary skill in the art can understand that all or part of the processes in the above-mentioned embodiment methods can be implemented by instructing related hardware through a computer program. The computer program can be stored in a non-volatile computer-readable storage medium. When the computer program is executed, it can include the processes of the embodiments of the above-mentioned methods.
本申请所提供的各实施例中所使用的对存储器、存储、数据库或其它介质的任何引用,均可包括非易失性和/或易失性存储器。非易失性存储器可包括只读存储器(ROM)、可编程ROM(PROM)、电可编程ROM(EPROM)、电可擦除可编程ROM(EEPROM)或闪存。易失性存储器可包括随机存取存储器(RAM)或者外部高速缓冲存储器。作为说明而非局限,RAM以多种形式可得,诸如静态RAM(SRAM)、动态RAM(DRAM)、同步DRAM(SDRAM)、双数据率SDRAM(DDRSDRAM)、增强型SDRAM(ESDRAM)、同步链路(Synchlink)DRAM(SLDRAM)、存储器总线(Rambus)直接RAM(RDRAM)、直接存储器总线动态RAM(DRDRAM)、以及存储器总线动态RAM(RDRAM)等。Any reference to memory, storage, database or other media used in the embodiments provided herein may include non-volatile and/or volatile memory. Non-volatile memory may include read-only memory (ROM), programmable ROM (PROM), electrically programmable ROM (EPROM), electrically erasable programmable ROM (EEPROM) or flash memory. Volatile memory may include random access memory (RAM) or external cache memory. As an illustration and not limitation, RAM is available in various forms, such as static RAM (SRAM), dynamic RAM (DRAM), synchronous DRAM (SDRAM), double data rate SDRAM (DDRSDRAM), enhanced SDRAM (ESDRAM), synchronous link (Synchlink) DRAM (SLDRAM), memory bus (Rambus) direct RAM (RDRAM), direct memory bus dynamic RAM (DRDRAM), and memory bus dynamic RAM (RDRAM).
以上所述,仅为本申请较佳的具体实施方式,但本申请的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本申请揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本申请的保护范围之内。The above is only a preferred specific implementation of the present application, but the protection scope of the present application is not limited thereto. Any changes or substitutions that can be easily conceived by any technician familiar with the technical field within the technical scope disclosed in the present application should be covered within the protection scope of the present application.
Claims (10)
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202111145433.2A CN113686883B (en) | 2021-09-28 | 2021-09-28 | Device and method for detecting roadway blind area |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202111145433.2A CN113686883B (en) | 2021-09-28 | 2021-09-28 | Device and method for detecting roadway blind area |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN113686883A CN113686883A (en) | 2021-11-23 |
| CN113686883B true CN113686883B (en) | 2024-09-13 |
Family
ID=78587308
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202111145433.2A Active CN113686883B (en) | 2021-09-28 | 2021-09-28 | Device and method for detecting roadway blind area |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN113686883B (en) |
Citations (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN216696092U (en) * | 2021-09-28 | 2022-06-07 | 江汉大学 | Equipment for detecting blind areas of roadway |
Family Cites Families (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN106527424B (en) * | 2016-09-20 | 2023-06-09 | 深圳银星智能集团股份有限公司 | Mobile robot and navigation method for mobile robot |
| CN112102151B (en) * | 2020-07-27 | 2024-05-14 | 广州视源电子科技股份有限公司 | Method, device, mobile smart device and storage medium for generating raster map |
-
2021
- 2021-09-28 CN CN202111145433.2A patent/CN113686883B/en active Active
Patent Citations (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN216696092U (en) * | 2021-09-28 | 2022-06-07 | 江汉大学 | Equipment for detecting blind areas of roadway |
Non-Patent Citations (1)
| Title |
|---|
| 框架式支架车驾驶员视线盲区人员保护系统设计与应用;李国军;科学技术创新;20221231;全文 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN113686883A (en) | 2021-11-23 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| Hu et al. | Robot-assisted mobile scanning for automated 3D reconstruction and point cloud semantic segmentation of building interiors | |
| CN112248835B (en) | Charging mechanical arm control method and system | |
| CN109656251B (en) | Inspection robot and working method for soil detection in abandoned land in mining area | |
| CN111923011B (en) | Execution method and device for live work and live work system | |
| CN211104017U (en) | Transformer substation inspection robot | |
| CN101067557A (en) | A Monocular Vision Navigation Approach to Environment Perception for Autonomous Moving Vehicles | |
| CN113478483B (en) | Mobile robot welding method and system based on stainless steel storage tank | |
| CN219486175U (en) | A self-driving, precise positioning drilling robot | |
| CN102304932A (en) | Land leveler leveling control system, control method and land leveler | |
| CN112157662B (en) | Blasting robot | |
| CN114273282B (en) | Tunnel bottom accumulated slag cleaning method and system based on robot operation | |
| CN216696092U (en) | Equipment for detecting blind areas of roadway | |
| WO2024179487A1 (en) | Mapping method, device, computer storage medium, and control method for self-moving robot | |
| CN118023798B (en) | A humanoid welding robot intelligent welding method | |
| CN113686883B (en) | Device and method for detecting roadway blind area | |
| CN115178400A (en) | Intelligent guniting robot, guniting system and method | |
| CN115476213A (en) | Polishing method, polishing apparatus, polishing device and storage medium | |
| CN210133030U (en) | Vehicle automatic charging equipment and mobile charging trolley | |
| CN218110798U (en) | A mine-used six-axis anchor removal robot | |
| CN114856660B (en) | A method for withdrawing anchor in a mine | |
| CN120057134A (en) | Track inspection device and method for autonomously planning path | |
| CN113513021A (en) | An automatic positioning system and method for a pile driver | |
| US20230272671A1 (en) | Automated system for face drill machines | |
| CN117032235A (en) | A mobile robot inspection and remote monitoring method in complex indoor scenes | |
| JP2005308613A (en) | 3D shape measurement method |
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: 20250807 Address after: 430056 Hubei Province, Wuhan City, Wuhan Economic and Technological Development Zone, No. 8 Jiaosan Lake Road Patentee after: JIANGHAN University Country or region after: China Patentee after: Wuhan Chewang Zhilian Technology Co.,Ltd. Address before: 430056 No. 8 Xinjiang road, Zhuankou economic and Technological Development Zone, Wuhan, Hubei Patentee before: JIANGHAN University Country or region before: China |