WO2020233724A1 - Visual slam-based grid operating environment map construction method and system - Google Patents

Visual slam-based grid operating environment map construction method and system Download PDF

Info

Publication number
WO2020233724A1
WO2020233724A1 PCT/CN2020/092144 CN2020092144W WO2020233724A1 WO 2020233724 A1 WO2020233724 A1 WO 2020233724A1 CN 2020092144 W CN2020092144 W CN 2020092144W WO 2020233724 A1 WO2020233724 A1 WO 2020233724A1
Authority
WO
WIPO (PCT)
Prior art keywords
sub
map
maps
operating environment
key frame
Prior art date
Application number
PCT/CN2020/092144
Other languages
French (fr)
Chinese (zh)
Inventor
彭林
于海
王鹤
钱堃
徐敏
侯战胜
王刚
鲍兴川
韩海韵
何志敏
朱亮
Original Assignee
全球能源互联网研究院有限公司
国家电网有限公司
国网江苏省电力有限公司
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by 全球能源互联网研究院有限公司, 国家电网有限公司, 国网江苏省电力有限公司 filed Critical 全球能源互联网研究院有限公司
Publication of WO2020233724A1 publication Critical patent/WO2020233724A1/en

Links

Images

Classifications

    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T17/00Three dimensional [3D] modelling, e.g. data description of 3D objects
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T3/00Geometric image transformations in the plane of the image
    • G06T3/40Scaling of whole images or parts thereof, e.g. expanding or contracting
    • G06T3/4038Image mosaicing, e.g. composing plane images from plane sub-images
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T2210/00Indexing scheme for image generation or computer graphics
    • G06T2210/32Image data format

Definitions

  • the invention relates to the technical field of three-dimensional map construction, in particular to a method and system for constructing a power grid operating environment map based on visual SLAM.
  • the internal structure of the substation is highly integrated, and the logical relationship is more complicated, which leads to the continuous increase of the difficulty of the operation of the operators.
  • a three-dimensional map of the substation can be established, the operation content and experience knowledge can be integrated into the three-dimensional map to provide intuitive and convenient operation guidance for the operators. It is beneficial to improve the work quality, efficiency and safety level of on-site operation of the power grid.
  • using the wearable equipment of inspection workers to simultaneously establish a three-dimensional model of the substation operating environment in daily inspection work is an effective way to build maps.
  • Visual SLAM is a technology that uses a camera as the only external sensor to locate itself in an unknown environment and create an environment map at the same time. Due to the complex environment and large mapping scale in the indoor substation operation environment, traditional visual SLAM methods often have large mapping errors and even mapping failures in this environment.
  • the embodiments of the present invention provide a method and system for constructing a power grid operating environment map based on visual SLAM to overcome the traditional SLAM method in the prior art that often has large mapping errors or even large errors in the indoor substation operating environment.
  • the problem of failed map creation is a problem of failed map creation.
  • the embodiment of the present invention provides a method for constructing a power grid operating environment map based on visual SLAM, including: acquiring each sub-map of the power grid operating environment established in stages and the key frame image corresponding to each sub-map; Perform closed-loop detection on the key frame images corresponding to the sub-maps to generate overlapping images between the sub-maps; calculate the corresponding poses of the sub-maps in the global coordinate system according to the overlapping images, and Sub-map splicing is performed on the sub-maps according to the poses corresponding to the sub-maps to generate a global map of the power grid operating environment.
  • the closed-loop detection of the key frame images corresponding to the sub-maps to generate overlapping images between the sub-maps includes: using the DBoW2 algorithm to perform the key frame images corresponding to the sub-maps Perform closed-loop detection to generate pairs of closed-loop matching feature points; screen each pair of closed-loop matching feature points by using an anti-polar geometric constraint method, and eliminate each of the closed-loop matching feature points that do not meet the requirements of the anti-polar geometric constraint method Yes; according to each of the selected closed-loop matching feature point pairs, the overlapping images are generated.
  • the respectively calculating the corresponding poses of the sub-maps in the global coordinate system according to the overlapping images includes: generating, according to the overlapping images, a three-dimensional image of the overlapping area between the sub-maps Point cloud; according to the three-dimensional point cloud of the overlapping area between the sub-maps, the point cloud registration algorithm is used to calculate the transformation relationships between the sub-maps; the sub-maps are calculated separately according to the transformation relationships Corresponding poses in the global coordinate system, and sub-map splicing the sub-maps according to the poses corresponding to the sub-maps to generate the global map.
  • the generating a three-dimensional point cloud of the overlapping area between the sub-maps according to the overlapping image includes: acquiring each of the key frame images including the overlapping image, and acquiring each of the key frames The pose information corresponding to the image; the three-dimensional point cloud of a single frame image is generated according to each key frame image; the three-dimensional point cloud corresponding to each key frame image is calculated according to the pose information corresponding to each key frame image The clouds are spliced to generate a three-dimensional point cloud of the overlapping area.
  • the respectively calculating the corresponding poses of the sub-maps in the global coordinate system according to the transformation relations includes: constructing the directed weighted graphs of the sub-maps according to the transformation relations. ; Depth-first traversal is performed on each of the directed weighted maps respectively, and the pose corresponding to each sub-map in the global coordinate system is calculated.
  • the method for constructing a power grid operating environment map based on visual SLAM further includes: acquiring operating information of the power grid operating environment; adding the operating information to the global map to generate a complete global map .
  • the method for constructing a map of the power grid operating environment based on visual SLAM further includes: comparing the complete global map, each sub-map, each key frame image, each overlapping image, and each sub-map corresponding pose Store it.
  • the embodiment of the present invention also provides a system for constructing a grid operating environment map based on visual SLAM, including: an information acquisition module for acquiring sub-maps of the grid operating environment established in stages, and corresponding sub-maps Key frame image; overlapping image generation module, used to respectively perform closed-loop detection on the key frame image corresponding to each sub-map, and generate each overlapping image between each sub-map; global map construction module, used to generate each sub-map according to the Each overlapping image calculates the corresponding pose of each sub-map in the global coordinate system, and stitches each sub-map into sub-maps according to the pose corresponding to each sub-map to generate the global operating environment of the power grid. map.
  • An embodiment of the present invention also provides an electronic device, including: a memory and a processor, the memory and the processor are communicatively connected to each other, the memory is stored with computer instructions, and the processor executes the The computer instructions are used to execute the method for constructing a visual SLAM-based power grid operating environment map provided by the embodiment of the present invention.
  • the embodiment of the present invention also provides a computer-readable storage medium that stores computer instructions, and the computer instructions are used to make the computer execute the visual SLAM-based Construction method of power grid operating environment map.
  • the embodiment of the present invention provides a method for constructing a power grid operating environment map based on visual SLAM.
  • each key frame image Perform closed-loop detection to obtain overlapping images between each sub-map, and then calculate the pose of each sub-map in the global coordinate system based on the overlapping image, and stitch each sub-map according to the pose to generate a global map of the power grid operating environment, thereby
  • the pose of each sub-map in the global coordinate system can be calculated, and then each local
  • the sub-maps are spliced together to form a complete global map, thereby avoiding the problem of large mapping errors or even failure of mapping in the indoor substation operation environment with complex mapping and large scale in the existing visual SLAM method, and improving the power grid operation environment
  • the accuracy of map construction has greatly converting the process of establishing a global map to the establishment of local sub-maps in stages, and then through the image overlap relationship between each sub-map, the pose of each sub-map in the global coordinate system can be calculated, and then each local
  • FIG. 1 is a flowchart of a method for constructing a power grid operating environment map based on visual SLAM in an embodiment of the present invention
  • FIG. 2A is a schematic diagram of the topological relationship between different sub-maps in an embodiment of the present invention.
  • 2B is another schematic diagram of the topological relationship between different submaps in an embodiment of the present invention.
  • FIG. 3 is a schematic structural diagram of a system for constructing a power grid operating environment map based on visual SLAM in an embodiment of the present invention
  • Fig. 4 is a schematic structural diagram of an electronic device in an embodiment of the present invention.
  • the embodiment of the present invention provides a method for constructing a power grid operating environment map based on visual SLAM.
  • the method for constructing a power grid operating environment map based on visual SLAM specifically includes:
  • Step S1 Obtain each sub-map of the power grid operating environment established in stages, and the key frame image corresponding to each sub-map.
  • workers in the power grid operating environment can scan the power grid operating environment in sections by equipping RGB-D sensors to obtain environmental images at different locations and stages in the power grid operating environment, and create an environment based on these acquired images
  • the various sub-maps of different locations save relevant map data of the sub-map for positioning, such as: equipment information and operation information in the power grid operating environment, and the RGB-D image of the key frame in each sub-map.
  • the creation process of each sub-map can be implemented by using a map construction method suitable for small-scale in the prior art to obtain a more accurate sub-map.
  • the selected specific implementation The method, the present invention is not limited to this.
  • Step S2 Perform closed-loop detection on the key frame images corresponding to each sub-map, and generate overlapping images between each sub-map.
  • step S2 performing closed-loop detection on the key frame image corresponding to each sub-map to generate each overlapping image between each sub-map specifically includes the following steps:
  • Step S21 Use the DBoW2 algorithm to perform closed-loop detection on the key frame image corresponding to each sub-map, and generate each closed-loop matching feature point pair.
  • the specific process of using the DBoW2 algorithm to achieve closed-loop detection between sub-maps is: first extract features from a set of training images, which are composed of key frame images between two different sub-maps, and then extract The features of is clustered by k-means++ algorithm, and the description subspace is divided into k categories. Then in each divided subspace, continue to use the k-means++ algorithm to do clustering, until the descriptor is generated into a tree structure with the number of layers L.
  • L 1 -score s (V 1 , V 2) represents a measure of similarity between the vectors V 1 and V 2 are the L1 norm
  • v i represents the value of the vector V 1 of a dimension
  • v 'i represents the vector Values of the same dimension in V 2 .
  • Step S22 Use the antipolar geometric constraint method to screen each closed-loop matching feature point pair, and eliminate each closed-loop matching feature point pair that does not meet the requirements of the antipolar geometric constraint method.
  • the DBoW2 algorithm itself does not use the spatial proximity relationship of the feature points, it is easy to produce false loops in this environment.
  • erroneous loops are eliminated through epipolar geometric constraints to ensure that all closed-loop matching feature point pairs are accurate. Since the epipolar geometric constraints require that the matching feature points in the two images need to meet a certain transformation relationship, the wrong closed loop cannot satisfy this transformation relationship and is therefore excluded. This eliminates the error loop and improves the subsequent global construction. The accuracy of the graph.
  • Step S23 Generate overlapping images according to the selected closed-loop matching feature point pairs.
  • the image area contained in the filtered closed-loop matching feature point pair in the two key frame images is the overlapping image between the two sub-maps corresponding to the two key frame images.
  • Step S3 Calculate the corresponding poses of each sub-map in the global coordinate system according to the overlapping images, and stitch the sub-maps according to the poses corresponding to the sub-maps to generate a global map of the power grid operating environment.
  • step S3 the corresponding poses of each sub-map in the global coordinate system are calculated according to each overlapping image, which specifically includes the following steps:
  • Step S31 Generate a three-dimensional point cloud of the overlapping area between the sub-maps according to the overlapping images.
  • f x and f y represent the focal length of the camera on the x and y axes
  • c x and c y are the coordinates of the camera's aperture center
  • s represents the scale factor of the depth map.
  • the three-dimensional space coordinates of each point in the image can be restored according to the color and depth images, and then the space coordinates can be projected into the global coordinates to obtain the three-dimensional points of all the pixels contained in the overlapping area between the sub-maps cloud.
  • Step S32 According to the three-dimensional point cloud of the overlapping area between the sub-maps, a point cloud registration algorithm is used to calculate each transformation relationship between the sub-maps.
  • the specific calculation process of the transformation relationship is as follows: Assume that the coordinates of the two sub-maps M 1 and M 2 in the world coordinate system are W 1 and W 2 respectively , and the transformation relationship between the two sub-maps is Since there is an overlapping area between the two sub-maps, assuming that a point P can be observed in both sub-maps, They are the coordinates of the point P in the W 1 , W 2 coordinate system, and the coordinates of the point P are known
  • ICP Intelligent Closest Point, an algorithm used for point cloud registration
  • Step S33 Calculate the corresponding pose of each sub-map in the global coordinate system according to each transformation relationship, and perform sub-map splicing on each sub-map according to the pose corresponding to each sub-map to generate a global map.
  • calculating the corresponding poses of each sub-map in the global coordinate system according to each transformation relationship includes the following steps:
  • Step S331 Construct a directed weighted graph of each sub-map according to each transformation relationship.
  • Step S332 Depth-first traversal is performed on each directed weighted map respectively, and the corresponding pose of each sub-map in the global coordinate system is calculated.
  • the topological relationship between different sub-maps can be constructed.
  • M 1 , M 2 , M 3 ... are three established sub-maps, They are represented as the key frame images inside the sub-maps M 1 , M 2 , and M 3.
  • the topological relationship constructed is shown in Figure 2A.
  • the solid lines in the figure represent the key frame images that belong to the same sub-map, and the dashed lines represent detected Loops between sub-maps.
  • the transformation matrix between the submaps M i and M j, topological map can be simplified as shown in FIG. 2B weighted graph has the form of FIG.
  • the traversal of the weighted directed graph is implemented through a depth-first traversal algorithm. In practical applications, other algorithms may also be used to implement it, and the present invention is not limited thereto.
  • the above-mentioned method for constructing a visual SLAM-based power grid operating environment map further includes:
  • Step S4 Obtain operation information of the grid operation environment.
  • the job information includes information about the device and the operating environment.
  • the device information specifically includes the ID, name, location, status, and historical data of the device, and the operating environment information includes the type information of the area.
  • Step S5 Add the job information to the global map to generate a complete global map.
  • the created global map should also contain the information of the devices existing in the map and some operation information of the map environment.
  • Step S6 Store the complete global map, each sub-map, each key frame image, each overlapping image, and the pose corresponding to each sub-map.
  • a hierarchical map data structure can be used to store map-related data.
  • the stored map data is divided into two parts: the global map and each sub-map.
  • the sub-map is created and saved when the map is created.
  • the map is calculated and generated after the mapping is completed.
  • each sub-map also contains map data, job information, and key frame image and position relationship information.
  • the data of the map may include the following content: (1) MapPoints, specifically including the number of MapPoints and their spatial locations. (2) KeyFrames.
  • the operation information includes the information of the equipment and the information of the operating environment.
  • the information of the equipment includes the ID, name, location, status, and historical data of the equipment.
  • the operating environment information includes the type information of the area and the information of the area.
  • the method for constructing a power grid operating environment map based on visual SLAM obtains the sub-maps of the power grid operating environment established in stages and the key frame images corresponding to each sub-map. Perform closed-loop detection on each key frame image to obtain the overlapping image between each sub-map, and then calculate the pose of each sub-map in the global coordinate system based on the overlapping image, and stitch each sub-map according to the pose to generate a power grid job A global map of the environment, by converting the process of establishing a global map to the establishment of a staged local sub-map, and then calculating the pose of each sub-map in the global coordinate system through the image overlap relationship between the sub-maps.
  • the local sub-maps are spliced together to form a complete global map, thereby avoiding the problem of large mapping errors or even failure of the existing visual SLAM method in the indoor power substation operation environment with complex mapping and large scale. It improves the accuracy of mapping the power grid operating environment, greatly shortens the mapping time, and improves the mapping efficiency.
  • the embodiment of the present invention also provides a system for constructing a grid operation environment map based on visual SLAM.
  • the system for constructing a grid operation environment map based on visual SLAM includes:
  • the information acquisition module 1 is used to acquire the sub-maps of the power grid operating environment established in stages and the key frame images corresponding to each sub-map. For details, please refer to the related description of step S1 in the above method embodiment, which will not be repeated here.
  • the overlapping image generating module 2 is used to perform closed-loop detection on the key frame images corresponding to each sub-map, and generate each overlapping image between each sub-map.
  • step S2 in the above method embodiment, which will not be repeated here.
  • the global map building module 3 is used to calculate the corresponding poses of each sub-map in the global coordinate system according to the overlapping images, and to splice each sub-map according to the poses corresponding to each sub-map to generate the grid operating environment Global map.
  • step S3 in the above method embodiment, which will not be repeated here.
  • the visual SLAM-based power grid operating environment map construction system obtains each sub-map of the power grid operating environment established in stages and the key frame image corresponding to each sub-map , Perform closed-loop detection on each key frame image to obtain the overlapping image between each sub-map, and then calculate the pose of each sub-map in the global coordinate system based on the overlapping image, and stitch each sub-map according to the pose to generate a power grid
  • the global map of the working environment by converting the process of establishing the global map to the establishment of phased local sub-maps, and then calculating the position and pose of each sub-map in the global coordinate system through the image overlap relationship between each sub-map, and then
  • the local sub-maps can be spliced together to form a complete global map according to the pose, thereby avoiding the problem of large mapping errors or even failure of the existing visual SLAM method in the indoor substation operation environment with complex mapping and large scale. , Improve the accuracy
  • an electronic device may include a processor 901 and a memory 902, where the processor 901 and the memory 902 may be connected by a bus or in other ways. Take the bus connection as an example.
  • the processor 901 may be a central processing unit (Central Processing Unit, CPU).
  • the processor 901 may also be other general-purpose processors, digital signal processors (Digital Signal Processor, DSP), Application Specific Integrated Circuit (ASIC), Field-Programmable Gate Array (Field-Programmable Gate Array, FPGA), or Chips such as other programmable logic devices, discrete gates or transistor logic devices, discrete hardware components, or a combination of the above types of chips.
  • DSP Digital Signal Processor
  • ASIC Application Specific Integrated Circuit
  • FPGA Field-Programmable Gate Array
  • Chips such as other programmable logic devices, discrete gates or transistor logic devices, discrete hardware components, or a combination of the above types of chips.
  • the memory 902 as a non-transitory computer-readable storage medium, can be used to store non-transitory software programs, non-transitory computer executable programs and modules, such as the construction of a visual SLAM-based power grid operating environment map in the embodiment of the present invention
  • the program instruction/module corresponding to the method.
  • the processor 901 executes various functional applications and data processing of the processor by running the non-transient software programs, instructions, and modules stored in the memory 902, that is, realizes the visual SLAM-based power grid operating environment map in the foregoing method embodiment The construction method.
  • the memory 902 may include a program storage area and a data storage area.
  • the program storage area may store an operating system and an application program required by at least one function; the data storage area may store data created by the processor 901 and the like.
  • the memory 902 may include a high-speed random access memory, and may also include a non-transitory memory, such as at least one magnetic disk storage device, a flash memory device, or other non-transitory solid-state storage devices.
  • the memory 902 may optionally include memories remotely provided with respect to the processor 901, and these remote memories may be connected to the processor 901 via a network. Examples of the aforementioned networks include, but are not limited to, the Internet, corporate intranets, local area networks, mobile communication networks, and combinations thereof.
  • One or more modules are stored in the memory 902, and when executed by the processor 901, the method for constructing a visual SLAM-based power grid operating environment map in the foregoing method embodiment is executed.
  • the program can be stored in a computer readable storage medium.
  • the storage medium can be magnetic disk, optical disk, read-only memory (Read-Only Memory, ROM), random access memory (RAM), flash memory (Flash Memory), hard disk (Hard Disk Drive) , Abbreviation: HDD) or solid-state drive (Solid-State Drive, SSD), etc.; the storage medium may also include a combination of the foregoing types of memories.

Landscapes

  • Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • General Physics & Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • Computer Graphics (AREA)
  • Geometry (AREA)
  • Software Systems (AREA)
  • Processing Or Creating Images (AREA)

Abstract

The present invention provides a visual SLAM-based grid operating environment map construction method and system. The method comprises: obtaining grid operating environment sub-maps created in stages, and key frame images corresponding to the sub-maps; respectively performing closed-loop detection on the key frame images corresponding to the sub-maps to generate superimposed images among the sub-maps; and respectively calculating, according to the superimposed images, attitudes corresponding to the sub-maps in a global coordinate system, and connecting the sub-maps according to the attitudes corresponding to the sub-maps to generate a grid operating environment global map. By means of the implementation of the present invention, the process of creating the global map is converted into the creation of local sub-maps in stages so as to avoid the problem of large mapping error even mapping failure of the existing visual SLAM method in the indoor substation operating environment having complex environment and large mapping scale, improve the accuracy of mapping in the grid operating environment, greatly shorten the mapping time, and improve the mapping efficiency.

Description

一种基于视觉SLAM的电网作业环境地图的构建方法及系统Method and system for constructing power grid operating environment map based on visual SLAM 技术领域Technical field
本发明涉及三维地图构建技术领域,具体涉及一种基于视觉SLAM的电网作业环境地图的构建方法及系统。The invention relates to the technical field of three-dimensional map construction, in particular to a method and system for constructing a power grid operating environment map based on visual SLAM.
背景技术Background technique
随着工业自动化,智能化的不断发展,变电站内部结构高度集成,逻辑关系更加复杂,导致作业人员的作业难度不断增加。如果能够建立变电站的三维地图,在三维地图中融合作业内容和经验知识就可以为作业人员提供直观便捷的作业指导。有利于提升电网现场作业的工作质量、效率以及安全水平。其中,利用巡检工人的穿戴式设备,在日常巡检工作中同时建立变电站作业环境的三维模型是建图的一种有效途径。With the continuous development of industrial automation and intelligence, the internal structure of the substation is highly integrated, and the logical relationship is more complicated, which leads to the continuous increase of the difficulty of the operation of the operators. If a three-dimensional map of the substation can be established, the operation content and experience knowledge can be integrated into the three-dimensional map to provide intuitive and convenient operation guidance for the operators. It is beneficial to improve the work quality, efficiency and safety level of on-site operation of the power grid. Among them, using the wearable equipment of inspection workers to simultaneously establish a three-dimensional model of the substation operating environment in daily inspection work is an effective way to build maps.
视觉SLAM是一种以相机作为唯一的外部传感器,在未知环境中进行自身定位并且同时创建环境地图的一种技术。由于室内变电作业环境中具有环境复杂,建图尺度大等特点,传统的视觉SLAM方法在该环境下常常出现建图误差大甚至建图失败的情况。Visual SLAM is a technology that uses a camera as the only external sensor to locate itself in an unknown environment and create an environment map at the same time. Due to the complex environment and large mapping scale in the indoor substation operation environment, traditional visual SLAM methods often have large mapping errors and even mapping failures in this environment.
发明内容Summary of the invention
有鉴于此,本发明实施例提供了一种基于视觉SLAM的电网作业环境地图的构建方法及系统,以克服现有技术中传统的SLAM方法在室内变电作业环境下常常出现建图误差大甚至建图失败的问题。In view of this, the embodiments of the present invention provide a method and system for constructing a power grid operating environment map based on visual SLAM to overcome the traditional SLAM method in the prior art that often has large mapping errors or even large errors in the indoor substation operating environment. The problem of failed map creation.
本发明实施例提供了一种基于视觉SLAM的电网作业环境地图的构建方法,包括:获取分阶段建立的电网作业环境的各子地图,以及所述各子地图对应的关键帧图像;分别对所述各子地图对应的关键帧图像进行闭环检测,生成所述 各子地图之间的各重叠图像;根据所述各重叠图像分别计算所述各子地图在全局坐标系下对应的位姿,并根据所述各子地图对应的位姿将所述各子地图进行子地图拼接,生成所述电网作业环境的全局地图。The embodiment of the present invention provides a method for constructing a power grid operating environment map based on visual SLAM, including: acquiring each sub-map of the power grid operating environment established in stages and the key frame image corresponding to each sub-map; Perform closed-loop detection on the key frame images corresponding to the sub-maps to generate overlapping images between the sub-maps; calculate the corresponding poses of the sub-maps in the global coordinate system according to the overlapping images, and Sub-map splicing is performed on the sub-maps according to the poses corresponding to the sub-maps to generate a global map of the power grid operating environment.
可选地,所述对所述各子地图对应的关键帧图像进行闭环检测,生成所述各子地图之间的各重叠图像,包括:采用DBoW2算法对所述各子地图对应的关键帧图像进行闭环检测,生成各闭环匹配特征点对;采用对极几何约束方法对所述各闭环匹配特征点对进行筛选,并剔除不满足所述对极几何约束方法要求的各所述闭环匹配特征点对;根据筛选后的各所述闭环匹配特征点对,生成所述各重叠图像。Optionally, the closed-loop detection of the key frame images corresponding to the sub-maps to generate overlapping images between the sub-maps includes: using the DBoW2 algorithm to perform the key frame images corresponding to the sub-maps Perform closed-loop detection to generate pairs of closed-loop matching feature points; screen each pair of closed-loop matching feature points by using an anti-polar geometric constraint method, and eliminate each of the closed-loop matching feature points that do not meet the requirements of the anti-polar geometric constraint method Yes; according to each of the selected closed-loop matching feature point pairs, the overlapping images are generated.
可选地,所述根据所述各重叠图像分别计算所述各子地图在全局坐标系下对应的位姿,包括:根据所述各重叠图像生成所述各子地图之间的重叠区域的三维点云;根据所述各子地图之间的重叠区域的三维点云采用点云配准算法计算各所述子地图之间的各变换关系;根据所述各变换关系分别计算所述各子地图在全局坐标系下对应的位姿,并根据所述各子地图对应的位姿将所述各子地图进行子地图拼接,生成所述全局地图。Optionally, the respectively calculating the corresponding poses of the sub-maps in the global coordinate system according to the overlapping images includes: generating, according to the overlapping images, a three-dimensional image of the overlapping area between the sub-maps Point cloud; according to the three-dimensional point cloud of the overlapping area between the sub-maps, the point cloud registration algorithm is used to calculate the transformation relationships between the sub-maps; the sub-maps are calculated separately according to the transformation relationships Corresponding poses in the global coordinate system, and sub-map splicing the sub-maps according to the poses corresponding to the sub-maps to generate the global map.
可选地,所述根据所述重叠图像生成所述各子地图之间的重叠区域的三维点云,包括:获取包含所述重叠图像的各所述关键帧图像,并获取各所述关键帧图像对应的位姿信息;分别根据各所述关键帧图像生成单帧图像的三维点云;根据各所述关键帧图像对应的位姿信息,将各所述关键帧图像对应的所述三维点云进行拼接,生成所述重叠区域的三维点云。Optionally, the generating a three-dimensional point cloud of the overlapping area between the sub-maps according to the overlapping image includes: acquiring each of the key frame images including the overlapping image, and acquiring each of the key frames The pose information corresponding to the image; the three-dimensional point cloud of a single frame image is generated according to each key frame image; the three-dimensional point cloud corresponding to each key frame image is calculated according to the pose information corresponding to each key frame image The clouds are spliced to generate a three-dimensional point cloud of the overlapping area.
可选地,所述根据所述各变换关系分别计算所述各子地图在全局坐标系下对应的位姿,包括:根据所述各变换关系分别构建所述各子地图的有向带权图;分别对各所述有向带权图进行深度优先遍历,计算所述各子地图在全局坐标系下对应的所述位姿。Optionally, the respectively calculating the corresponding poses of the sub-maps in the global coordinate system according to the transformation relations includes: constructing the directed weighted graphs of the sub-maps according to the transformation relations. ; Depth-first traversal is performed on each of the directed weighted maps respectively, and the pose corresponding to each sub-map in the global coordinate system is calculated.
可选地,所述的基于视觉SLAM的电网作业环境地图的构建方法,还包括:获取所述电网作业环境的作业信息;将所述作业信息添加至所述全局地图中,生成完整的全局地图。Optionally, the method for constructing a power grid operating environment map based on visual SLAM further includes: acquiring operating information of the power grid operating environment; adding the operating information to the global map to generate a complete global map .
可选地,所述的基于视觉SLAM的电网作业环境地图的构建方法,还包括:对所述完整的全局地图、各子地图、各关键帧图像、各重叠图像及各子地图对应的位姿进行存储。Optionally, the method for constructing a map of the power grid operating environment based on visual SLAM further includes: comparing the complete global map, each sub-map, each key frame image, each overlapping image, and each sub-map corresponding pose Store it.
本发明实施例还提供了一种于视觉SLAM的电网作业环境地图的构建系统,包括:信息获取模块,用于获取分阶段建立的电网作业环境的各子地图,以及所述各子地图对应的关键帧图像;重叠图像生成模块,用于分别对所述各子地图对应的关键帧图像进行闭环检测,生成所述各子地图之间的各重叠图像;全局地图构建模块,用于根据所述各重叠图像分别计算所述各子地图在全局坐标系下对应的位姿,并根据所述各子地图对应的位姿将所述各子地图进行子地图拼接,生成所述电网作业环境的全局地图。The embodiment of the present invention also provides a system for constructing a grid operating environment map based on visual SLAM, including: an information acquisition module for acquiring sub-maps of the grid operating environment established in stages, and corresponding sub-maps Key frame image; overlapping image generation module, used to respectively perform closed-loop detection on the key frame image corresponding to each sub-map, and generate each overlapping image between each sub-map; global map construction module, used to generate each sub-map according to the Each overlapping image calculates the corresponding pose of each sub-map in the global coordinate system, and stitches each sub-map into sub-maps according to the pose corresponding to each sub-map to generate the global operating environment of the power grid. map.
本发明实施例还提供了一种电子设备,包括:存储器和处理器,所述存储器和所述处理器之间互相通信连接,所述存储器中存储有计算机指令,所述处理器通过执行所述计算机指令,从而执行本发明实施例提供所述的基于视觉SLAM的电网作业环境地图的构建方法。An embodiment of the present invention also provides an electronic device, including: a memory and a processor, the memory and the processor are communicatively connected to each other, the memory is stored with computer instructions, and the processor executes the The computer instructions are used to execute the method for constructing a visual SLAM-based power grid operating environment map provided by the embodiment of the present invention.
本发明实施例还提供了一种计算机可读存储介质,所述计算机可读存储介质存储计算机指令,所述计算机指令用于使所述计算机执行执行本发明实施例提供所述的基于视觉SLAM的电网作业环境地图的构建方法。The embodiment of the present invention also provides a computer-readable storage medium that stores computer instructions, and the computer instructions are used to make the computer execute the visual SLAM-based Construction method of power grid operating environment map.
本发明技术方案,具有如下优点:The technical scheme of the present invention has the following advantages:
本发明实施例提供了一种基于视觉SLAM的电网作业环境地图的构建方法,通过获取分阶段建立的电网作业环境的各子地图,以及各子地图对应的关键帧 图像,分别对各个关键帧图像进行闭环检测以得到各个子地图之间的重叠图像,然后根据重叠图像计算各个子地图在全局坐标系下的位姿,并根据位姿将各个子地图拼接起来生成电网作业环境的全局地图,从而通过将全局地图的建立过程转换为分阶段局部子地图的建立,然后通过各个子地图之间的图像重叠关系,计算各个子地图在全局坐标系下的位姿,进而可以根据位姿将各个局部子地图拼接起来形成完整的全局地图,从而避免了现有的视觉SLAM方法在环境复杂建图尺度大的室内变电作业环境中建图误差大甚至建图失败的问题,提高了对电网作业环境进行建图的准确性,并大大缩短了建图时间,提高了建图效率。The embodiment of the present invention provides a method for constructing a power grid operating environment map based on visual SLAM. By acquiring each sub-map of the power grid operating environment established in stages and the key frame image corresponding to each sub-map, each key frame image Perform closed-loop detection to obtain overlapping images between each sub-map, and then calculate the pose of each sub-map in the global coordinate system based on the overlapping image, and stitch each sub-map according to the pose to generate a global map of the power grid operating environment, thereby By converting the process of establishing a global map to the establishment of local sub-maps in stages, and then through the image overlap relationship between each sub-map, the pose of each sub-map in the global coordinate system can be calculated, and then each local The sub-maps are spliced together to form a complete global map, thereby avoiding the problem of large mapping errors or even failure of mapping in the indoor substation operation environment with complex mapping and large scale in the existing visual SLAM method, and improving the power grid operation environment The accuracy of map construction has greatly shortened the construction time and improved the efficiency of map construction.
附图说明Description of the drawings
为了更清楚地说明本发明具体实施方式或现有技术中的技术方案,下面将对具体实施方式或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图是本发明的一些实施方式,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。In order to explain the specific embodiments of the present invention or the technical solutions in the prior art more clearly, the following will briefly introduce the drawings that need to be used in the specific embodiments or the description of the prior art. Obviously, the appendix in the following description The drawings are some embodiments of the present invention. For those of ordinary skill in the art, other drawings can be obtained based on these drawings without creative work.
图1为本发明实施例中的基于视觉SLAM的电网作业环境地图的构建方法的流程图;FIG. 1 is a flowchart of a method for constructing a power grid operating environment map based on visual SLAM in an embodiment of the present invention;
图2A为本发明实施例中的不同子地图之间的拓扑关系的示意图;2A is a schematic diagram of the topological relationship between different sub-maps in an embodiment of the present invention;
图2B为本发明实施例中的不同子地图之间的拓扑关系的另一示意图;2B is another schematic diagram of the topological relationship between different submaps in an embodiment of the present invention;
图3为本发明实施例中的基于视觉SLAM的电网作业环境地图的构建系统的结构示意图;3 is a schematic structural diagram of a system for constructing a power grid operating environment map based on visual SLAM in an embodiment of the present invention;
图4为本发明实施例中的电子设备的结构示意图。Fig. 4 is a schematic structural diagram of an electronic device in an embodiment of the present invention.
具体实施方式Detailed ways
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明 实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。In order to make the objectives, technical solutions, and advantages of the embodiments of the present invention clearer, the technical solutions in the embodiments of the present invention will be described clearly and completely in conjunction with the accompanying drawings in the embodiments of the present invention. Obviously, the described embodiments It is a part of the embodiments of the present invention, not all the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by those skilled in the art without creative work shall fall within the protection scope of the present invention.
下面所描述的本发明不同实施方式中所涉及的技术特征只要彼此之间未构成冲突就可以相互结合。The technical features involved in the different embodiments of the present invention described below can be combined with each other as long as they do not conflict with each other.
本发明实施例提供了一种基于视觉SLAM的电网作业环境地图的构建方法,如图1所示,该基于视觉SLAM的电网作业环境地图的构建方法具体包括:The embodiment of the present invention provides a method for constructing a power grid operating environment map based on visual SLAM. As shown in FIG. 1, the method for constructing a power grid operating environment map based on visual SLAM specifically includes:
步骤S1:获取分阶段建立的电网作业环境的各子地图,以及各子地图对应的关键帧图像。Step S1: Obtain each sub-map of the power grid operating environment established in stages, and the key frame image corresponding to each sub-map.
具体地,在实际应用中,电网作业环境的工作人员可以通过配备RGB-D传感器,分段扫描电网的作业环境,得到电网作业环境中不同位置阶段的环境图像,并且根据这些获取的图像创建环境的不同位置的各个子地图。在创建环境各个子地图的同时,保存用于定位的子地图的相关地图数据例如:电网作业环境中的设备信息及作业信息等以及每一各子地图中的关键帧的RGB-D图像。需要说明的是,在本发明实施例中个,每个子地图的创建过程可以采用现有技术中的适用于小尺度的地图构建方法来实现,以得到较为精确的子地图,所选择的具体实现方法,本发明并不以此为限。Specifically, in practical applications, workers in the power grid operating environment can scan the power grid operating environment in sections by equipping RGB-D sensors to obtain environmental images at different locations and stages in the power grid operating environment, and create an environment based on these acquired images The various sub-maps of different locations. While creating each sub-map of the environment, save relevant map data of the sub-map for positioning, such as: equipment information and operation information in the power grid operating environment, and the RGB-D image of the key frame in each sub-map. It should be noted that, in the embodiment of the present invention, the creation process of each sub-map can be implemented by using a map construction method suitable for small-scale in the prior art to obtain a more accurate sub-map. The selected specific implementation The method, the present invention is not limited to this.
步骤S2:分别对各子地图对应的关键帧图像进行闭环检测,生成各子地图之间的各重叠图像。Step S2: Perform closed-loop detection on the key frame images corresponding to each sub-map, and generate overlapping images between each sub-map.
具体地,在一实施例中,上述的步骤S2中,对各子地图对应的关键帧图像进行闭环检测,生成各子地图之间的各重叠图像,具体包括如下步骤:Specifically, in an embodiment, in the above step S2, performing closed-loop detection on the key frame image corresponding to each sub-map to generate each overlapping image between each sub-map specifically includes the following steps:
步骤S21:采用DBoW2算法对各子地图对应的关键帧图像进行闭环检测, 生成各闭环匹配特征点对。在实际应用中,采用DBoW2算法实现子地图间的闭环检测的具体过程为:首先从一组训练图像中提取特征,该组训练图像由两个不同子地图间的关键帧图像组成,再将提取的特征用k-means++算法聚类,将描述子空间划分成k类。然后在划分的每个子空间中,继续利用k-means++算法做聚类,直至将描述子生成为层数为L的树形结构。Step S21: Use the DBoW2 algorithm to perform closed-loop detection on the key frame image corresponding to each sub-map, and generate each closed-loop matching feature point pair. In practical applications, the specific process of using the DBoW2 algorithm to achieve closed-loop detection between sub-maps is: first extract features from a set of training images, which are composed of key frame images between two different sub-maps, and then extract The features of is clustered by k-means++ algorithm, and the description subspace is divided into k categories. Then in each divided subspace, continue to use the k-means++ algorithm to do clustering, until the descriptor is generated into a tree structure with the number of layers L.
那么,有两帧待回环的关键帧I和I′,对图像进行特征检测与特征描述,将每个特征通过树形结构的词典,得到BoW2向量V 1=[v 1,…,v n]和V 2=[v′ 1,…,v′ n],根据BoW2向量可以得到I和I′之间的图像相似度公式参见如下公式: Then, there are two key frames I and I'to be looped back. Perform feature detection and feature description on the image. Pass each feature through a tree structured dictionary to obtain the BoW2 vector V 1 =[v 1 ,…,v n ] And V 2 =[v′ 1 ,…,v′ n ], according to the BoW2 vector, the image similarity formula between I and I′ can be obtained, see the following formula:
Figure PCTCN2020092144-appb-000001
Figure PCTCN2020092144-appb-000001
其中,L 1-score s(V 1,V 2)表示用L1范数衡量向量V 1和V 2之间的相似度,v i表示向量V 1中某一维度的值,v′ i表示向量V 2中同一维度的值。需要说明的是,上述采用DBoW2算法实现子地图间的闭环检测的具体过程仅为简单说明,具体详细过程参见现有技术中采用DBoW2算法进行闭环检测的方案,在此不再进行赘述。 Wherein, L 1 -score s (V 1 , V 2) represents a measure of similarity between the vectors V 1 and V 2 are the L1 norm, v i represents the value of the vector V 1 of a dimension, v 'i represents the vector Values of the same dimension in V 2 . It should be noted that the above-mentioned specific process of implementing the closed-loop detection between sub-maps by using the DBoW2 algorithm is only a simple description. For the specific detailed process, refer to the solution of using the DBoW2 algorithm for closed-loop detection in the prior art, which will not be repeated here.
步骤S22:采用对极几何约束方法对各闭环匹配特征点对进行筛选,并剔除不满足对极几何约束方法要求的各闭环匹配特征点对。在实际应用中,在室内变电站环境中,由于存在着大量相似的特征,而DBoW2算法本身并没有利用特征点的空间邻近关系,因此在这种环境中容易产生错误的回环。在本发明实施例中,通过对极几何约束来排除掉错误的回环,保障所有的闭环匹配特征点对都是准确的。由于对极几何约束要求两个图像中匹配的特征点需要满足一定的变换关系,因而错误的闭环不能满足这种变换关系因此被排除,从而实现了对错误回环的剔除,进而提高了后续全局建图的准确性。Step S22: Use the antipolar geometric constraint method to screen each closed-loop matching feature point pair, and eliminate each closed-loop matching feature point pair that does not meet the requirements of the antipolar geometric constraint method. In practical applications, in the indoor substation environment, due to the existence of a large number of similar features, and the DBoW2 algorithm itself does not use the spatial proximity relationship of the feature points, it is easy to produce false loops in this environment. In the embodiment of the present invention, erroneous loops are eliminated through epipolar geometric constraints to ensure that all closed-loop matching feature point pairs are accurate. Since the epipolar geometric constraints require that the matching feature points in the two images need to meet a certain transformation relationship, the wrong closed loop cannot satisfy this transformation relationship and is therefore excluded. This eliminates the error loop and improves the subsequent global construction. The accuracy of the graph.
步骤S23:根据筛选后的各闭环匹配特征点对,生成各重叠图像。在实际 应用中,两个关键帧图像中经过筛选后的闭环匹配特征点对所包含的图像区域,即为这两个关键帧图像所对应的两个子地图之间的重叠图像。Step S23: Generate overlapping images according to the selected closed-loop matching feature point pairs. In practical applications, the image area contained in the filtered closed-loop matching feature point pair in the two key frame images is the overlapping image between the two sub-maps corresponding to the two key frame images.
步骤S3:根据各重叠图像分别计算各子地图在全局坐标系下对应的位姿,并根据各子地图对应的位姿将各子地图进行子地图拼接,生成电网作业环境的全局地图。Step S3: Calculate the corresponding poses of each sub-map in the global coordinate system according to the overlapping images, and stitch the sub-maps according to the poses corresponding to the sub-maps to generate a global map of the power grid operating environment.
具体地,在一实施例中,上述的步骤S3中,根据各重叠图像分别计算各子地图在全局坐标系下对应的位姿,具体包括如下步骤:Specifically, in an embodiment, in the above step S3, the corresponding poses of each sub-map in the global coordinate system are calculated according to each overlapping image, which specifically includes the following steps:
步骤S31:根据各重叠图像生成各子地图之间的重叠区域的三维点云。在实际应用中,三维点云的具体生成原理为:根据相机的投影模型,假设空间中任意一点p在相机坐标系下的三维坐标为p c=[x,y,z] T,其在图像中的成像点坐标为p=[u,v,d] T(其中,u,v表示图像坐标系下像素点的坐标位置,d表示该像素点的深度值),则它们之间的对应关系如下公式所示: Step S31: Generate a three-dimensional point cloud of the overlapping area between the sub-maps according to the overlapping images. In practical applications, the specific generation principle of the 3D point cloud is as follows: According to the projection model of the camera, assume that the 3D coordinates of any point p in the space in the camera coordinate system are p c =[x,y,z] T , which is in the image The coordinates of the imaging point in is p=[u,v,d] T (where u,v represents the coordinate position of the pixel in the image coordinate system, and d represents the depth value of the pixel), then the corresponding relationship between them As shown in the following formula:
Figure PCTCN2020092144-appb-000002
Figure PCTCN2020092144-appb-000002
Figure PCTCN2020092144-appb-000003
Figure PCTCN2020092144-appb-000003
d=z·sd=z·s
其中,f x和f y表示相机在x,y两个轴上的焦距,c x和c y为相机的光圈中心的坐标,s表示深度图的尺度因子。 Among them, f x and f y represent the focal length of the camera on the x and y axes, c x and c y are the coordinates of the camera's aperture center, and s represents the scale factor of the depth map.
因此,可以根据彩色和深度图像恢复图像中每一点的三维空间坐标,即可得到将再将空间坐标投影到全局坐标当中,得到各子地图之间的重叠区域中所包含所有像素点的三维点云。Therefore, the three-dimensional space coordinates of each point in the image can be restored according to the color and depth images, and then the space coordinates can be projected into the global coordinates to obtain the three-dimensional points of all the pixels contained in the overlapping area between the sub-maps cloud.
步骤S32:根据各子地图之间的重叠区域的三维点云采用点云配准算法计算各子地图之间的各变换关系。在实际应用中,该变换关系的具体计算过程为:假设两幅子地图M 1,M 2在世界坐标系下的坐标分别为W 1,W 2,两幅子地图之 间的变换关系为
Figure PCTCN2020092144-appb-000004
由于两幅子地图间具有重叠区域,因此,假设两幅子地图中都能观察到一点P,
Figure PCTCN2020092144-appb-000005
分别为点P在W 1,W 2坐标系下的坐标,在已知该点P的坐标
Figure PCTCN2020092144-appb-000006
的情况下,通过利用ICP(Iterative Closest Point迭代最近点算法,一种用于点云配准的算法)来计算这两幅子地图之间的变换关系
Figure PCTCN2020092144-appb-000007
使得其满足
Figure PCTCN2020092144-appb-000008
的变换关系,在具体应用过程中,可能由于子地图M 1,M 2往往相距较远使得不能准确的计算
Figure PCTCN2020092144-appb-000009
那么选取在子地图M 1选取能够观察到P点的关键帧图像K 1,以及在子地图M 2选取能够观察到P点的关键帧图像K 2,则可以得到如下公式:
Step S32: According to the three-dimensional point cloud of the overlapping area between the sub-maps, a point cloud registration algorithm is used to calculate each transformation relationship between the sub-maps. In practical applications, the specific calculation process of the transformation relationship is as follows: Assume that the coordinates of the two sub-maps M 1 and M 2 in the world coordinate system are W 1 and W 2 respectively , and the transformation relationship between the two sub-maps is
Figure PCTCN2020092144-appb-000004
Since there is an overlapping area between the two sub-maps, assuming that a point P can be observed in both sub-maps,
Figure PCTCN2020092144-appb-000005
They are the coordinates of the point P in the W 1 , W 2 coordinate system, and the coordinates of the point P are known
Figure PCTCN2020092144-appb-000006
In the case of ICP (Iterative Closest Point, an algorithm used for point cloud registration) to calculate the transformation relationship between the two sub-maps
Figure PCTCN2020092144-appb-000007
Make it satisfy
Figure PCTCN2020092144-appb-000008
In the specific application process, it may be that the sub-maps M 1 and M 2 are often far apart, which makes it impossible to accurately calculate
Figure PCTCN2020092144-appb-000009
Then selecting the map selected in the sub M 1 to the point P can be observed key frame image K 1, and the key frame image in the sub-select the map M 2 can be observed at point P K 2, the following equation can be obtained:
Figure PCTCN2020092144-appb-000010
Figure PCTCN2020092144-appb-000010
Figure PCTCN2020092144-appb-000011
Figure PCTCN2020092144-appb-000011
Figure PCTCN2020092144-appb-000012
Figure PCTCN2020092144-appb-000012
其中,
Figure PCTCN2020092144-appb-000013
表示坐标系W 1在坐标系K 1下的坐标,
Figure PCTCN2020092144-appb-000014
表示坐标系K 2在坐标系K 1下的坐标,即关键帧K 2与K 1之间的变换关系,
Figure PCTCN2020092144-appb-000015
表示表示坐标系W 2在坐标系K 2下的坐标。
among them,
Figure PCTCN2020092144-appb-000013
Represents the coordinates of the coordinate system W 1 in the coordinate system K 1 ,
Figure PCTCN2020092144-appb-000014
Represents the coordinates of the coordinate system K 2 in the coordinate system K 1 , that is, the transformation relationship between the key frames K 2 and K 1 ,
Figure PCTCN2020092144-appb-000015
Indicates the coordinates of the coordinate system W 2 in the coordinate system K 2 .
因此,可以根据上述公式首先求得
Figure PCTCN2020092144-appb-000016
即相邻较近的两个关键帧图像K 1,K 2在全局坐标系下的变换关系,继而可以求得两幅子地图M 1,M 2之间的变换关系
Figure PCTCN2020092144-appb-000017
Therefore, we can first obtain
Figure PCTCN2020092144-appb-000016
That is, the transformation relationship between two adjacent key frame images K 1 and K 2 in the global coordinate system, and then the transformation relationship between the two sub-maps M 1 and M 2 can be obtained
Figure PCTCN2020092144-appb-000017
步骤S33:根据各变换关系分别计算各子地图在全局坐标系下对应的位姿,并根据各子地图对应的位姿将各子地图进行子地图拼接,生成全局地图。Step S33: Calculate the corresponding pose of each sub-map in the global coordinate system according to each transformation relationship, and perform sub-map splicing on each sub-map according to the pose corresponding to each sub-map to generate a global map.
具体地,在一实施例中,上述的步骤S33中,根据各变换关系分别计算各子地图在全局坐标系下对应的位姿,具体包括如下步骤:Specifically, in one embodiment, in the above step S33, calculating the corresponding poses of each sub-map in the global coordinate system according to each transformation relationship includes the following steps:
步骤S331:根据各变换关系分别构建各子地图的有向带权图。Step S331: Construct a directed weighted graph of each sub-map according to each transformation relationship.
步骤S332:分别对各有向带权图进行深度优先遍历,计算各子地图在全局坐标系下对应的位姿。Step S332: Depth-first traversal is performed on each directed weighted map respectively, and the corresponding pose of each sub-map in the global coordinate system is calculated.
在实际应用中,根据上述步骤S32计算得到的变换关系,可以构建出不同子地图之间的拓扑关系,假设M 1、M 2、M 3……为建立的三个子地图,
Figure PCTCN2020092144-appb-000018
Figure PCTCN2020092144-appb-000019
分别代表为子地图M 1、M 2、M 3内部的关键帧图像,所构建的拓扑关系如图2A所示,图中实线表示同属于相同子地图的关键帧图像,虚线表示检测到的各子地图之间的回环。根据回环检测的结果计算得到子地图之间的转换关系
Figure PCTCN2020092144-appb-000020
为在全局坐标系下,子地图M i与M j之间的变换矩阵,拓扑地图可以简化为如图2B所示的图中带权有向图的形式。通过对此图的遍历,可以计算得到所有子地图在全局坐标下的位姿。需要说明的是,在本发明实施例中对带权有向图的遍历是通过深度优先遍历算法实现的,在实际应用中,也可以采用其他算法实现,本发明并不以此为限。
In practical applications, according to the transformation relationship calculated in the above step S32, the topological relationship between different sub-maps can be constructed. Assume that M 1 , M 2 , M 3 ... are three established sub-maps,
Figure PCTCN2020092144-appb-000018
Figure PCTCN2020092144-appb-000019
They are represented as the key frame images inside the sub-maps M 1 , M 2 , and M 3. The topological relationship constructed is shown in Figure 2A. The solid lines in the figure represent the key frame images that belong to the same sub-map, and the dashed lines represent detected Loops between sub-maps. Calculate the conversion relationship between sub-maps based on the results of loopback detection
Figure PCTCN2020092144-appb-000020
As the global coordinate system, the transformation matrix between the submaps M i and M j, topological map can be simplified as shown in FIG. 2B weighted graph has the form of FIG. By traversing this graph, the poses of all sub-maps in global coordinates can be calculated. It should be noted that, in the embodiment of the present invention, the traversal of the weighted directed graph is implemented through a depth-first traversal algorithm. In practical applications, other algorithms may also be used to implement it, and the present invention is not limited thereto.
具体地,在一实施例中,上述的基于视觉SLAM的电网作业环境地图的构建方法还包括:Specifically, in an embodiment, the above-mentioned method for constructing a visual SLAM-based power grid operating environment map further includes:
步骤S4:获取电网作业环境的作业信息。在实际应用中,该作业信息包含了设备的信息与作业环境的信息,设备的信息具体包含设备的ID、名称、位置、状态与历史数据等信息,作业环境信息则是包含了区域的类型信息与该区域的一些注意事项,例如是否为危险区域等信息。Step S4: Obtain operation information of the grid operation environment. In practical applications, the job information includes information about the device and the operating environment. The device information specifically includes the ID, name, location, status, and historical data of the device, and the operating environment information includes the type information of the area. Some precautions related to the area, such as whether it is a dangerous area or not.
步骤S5:将作业信息添加至全局地图中,生成完整的全局地图。在实际应用中,为了便于用户使用,在创建的全局地图中除了包含地图的用于定位和位置坐标之外,还应该包含在地图中存在的设备的信息以及地图环境的一些作业信息。Step S5: Add the job information to the global map to generate a complete global map. In practical applications, in order to facilitate the user's use, in addition to the location and location coordinates of the map, the created global map should also contain the information of the devices existing in the map and some operation information of the map environment.
步骤S6:对完整的全局地图、各子地图、各关键帧图像、各重叠图像及各 子地图对应的位姿进行存储。在实际应用中,可以采用分层的地图数据结构来对地图相关数据进行存储,所存储的地图数据分为全局地图和各个子地图两个部分,子地图在建图的时候创建并保存,全局地图在建图结束后计算并生成。其中,各个子地图又包含有地图的数据,作业信息以及关键帧的图像与位置关系等信息。地图的数据例如可以包括以下内容:(1)MapPoints,具体包含MapPoints的数量以及它们的空间位置。(2)KeyFrames。具体包含KeyFrame的数量,每一帧图像的位姿,每一帧中所有特征点的特征描述并保存这些特征点与MapPoint的对应关系。(3)不同帧图像间关系,即保存每一帧关键的父关键帧以及与之相连的关键帧。通过保存以上信息,可以恢复出完整地图。其中,作业信息包含了设备的信息与作业环境的信息,设备的信息具体包含设备的ID、名称、位置、状态与历史数据等信息,作业环境信息则是包含了区域的类型信息与该区域的一些注意事项,例如是否为危险区域等。Step S6: Store the complete global map, each sub-map, each key frame image, each overlapping image, and the pose corresponding to each sub-map. In practical applications, a hierarchical map data structure can be used to store map-related data. The stored map data is divided into two parts: the global map and each sub-map. The sub-map is created and saved when the map is created. The map is calculated and generated after the mapping is completed. Among them, each sub-map also contains map data, job information, and key frame image and position relationship information. For example, the data of the map may include the following content: (1) MapPoints, specifically including the number of MapPoints and their spatial locations. (2) KeyFrames. Specifically, it includes the number of KeyFrame, the pose of each frame of image, the feature description of all the feature points in each frame, and the corresponding relationship between these feature points and MapPoint is saved. (3) The relationship between different frame images, that is, the parent key frame of each key frame and the key frame connected to it are saved. By saving the above information, a complete map can be recovered. Among them, the operation information includes the information of the equipment and the information of the operating environment. The information of the equipment includes the ID, name, location, status, and historical data of the equipment. The operating environment information includes the type information of the area and the information of the area. Some precautions, such as whether it is a hazardous area, etc.
通过上述步骤S1至步骤S6,本发明实施例提供的基于视觉SLAM的电网作业环境地图的构建方法,通过获取分阶段建立的电网作业环境的各子地图,以及各子地图对应的关键帧图像,分别对各个关键帧图像进行闭环检测以得到各个子地图之间的重叠图像,然后根据重叠图像计算各个子地图在全局坐标系下的位姿,并根据位姿将各个子地图拼接起来生成电网作业环境的全局地图,从而通过将全局地图的建立过程转换为分阶段局部子地图的建立,然后通过各个子地图之间的图像重叠关系,计算各个子地图在全局坐标系下的位姿,进而可以根据位姿将各个局部子地图拼接起来形成完整的全局地图,从而避免了现有的视觉SLAM方法在环境复杂建图尺度大的室内变电作业环境中建图误差大甚至建图失败的问题,提高了对电网作业环境进行建图的准确性,并大大缩短了建图时间,提高了建图效率。Through the above steps S1 to S6, the method for constructing a power grid operating environment map based on visual SLAM provided by the embodiment of the present invention obtains the sub-maps of the power grid operating environment established in stages and the key frame images corresponding to each sub-map. Perform closed-loop detection on each key frame image to obtain the overlapping image between each sub-map, and then calculate the pose of each sub-map in the global coordinate system based on the overlapping image, and stitch each sub-map according to the pose to generate a power grid job A global map of the environment, by converting the process of establishing a global map to the establishment of a staged local sub-map, and then calculating the pose of each sub-map in the global coordinate system through the image overlap relationship between the sub-maps. According to the pose, the local sub-maps are spliced together to form a complete global map, thereby avoiding the problem of large mapping errors or even failure of the existing visual SLAM method in the indoor power substation operation environment with complex mapping and large scale. It improves the accuracy of mapping the power grid operating environment, greatly shortens the mapping time, and improves the mapping efficiency.
本发明实施例还提供了一种基于视觉SLAM的电网作业环境地图的构建系统,如图3所示,该基于视觉SLAM的电网作业环境地图的构建系统包括:The embodiment of the present invention also provides a system for constructing a grid operation environment map based on visual SLAM. As shown in FIG. 3, the system for constructing a grid operation environment map based on visual SLAM includes:
信息获取模块1,用于获取分阶段建立的电网作业环境的各子地图,以及各子地图对应的关键帧图像。详细内容参见上述方法实施例中步骤S1的相关描述,在此不再进行赘述。The information acquisition module 1 is used to acquire the sub-maps of the power grid operating environment established in stages and the key frame images corresponding to each sub-map. For details, please refer to the related description of step S1 in the above method embodiment, which will not be repeated here.
重叠图像生成模块2,用于分别对各子地图对应的关键帧图像进行闭环检测,生成各子地图之间的各重叠图像。详细内容参见上述方法实施例中步骤S2的相关描述,在此不再进行赘述。The overlapping image generating module 2 is used to perform closed-loop detection on the key frame images corresponding to each sub-map, and generate each overlapping image between each sub-map. For details, please refer to the relevant description of step S2 in the above method embodiment, which will not be repeated here.
全局地图构建模块3,用于根据各重叠图像分别计算各子地图在全局坐标系下对应的位姿,并根据各子地图对应的位姿将各子地图进行子地图拼接,生成电网作业环境的全局地图。详细内容参见上述方法实施例中步骤S3的相关描述,在此不再进行赘述。The global map building module 3 is used to calculate the corresponding poses of each sub-map in the global coordinate system according to the overlapping images, and to splice each sub-map according to the poses corresponding to each sub-map to generate the grid operating environment Global map. For details, please refer to the relevant description of step S3 in the above method embodiment, which will not be repeated here.
通过上述各个组成部分的协同合作,本发明实施例提供的基于视觉SLAM的电网作业环境地图的构建系统,通过获取分阶段建立的电网作业环境的各子地图,以及各子地图对应的关键帧图像,分别对各个关键帧图像进行闭环检测以得到各个子地图之间的重叠图像,然后根据重叠图像计算各个子地图在全局坐标系下的位姿,并根据位姿将各个子地图拼接起来生成电网作业环境的全局地图,从而通过将全局地图的建立过程转换为分阶段局部子地图的建立,然后通过各个子地图之间的图像重叠关系,计算各个子地图在全局坐标系下的位姿,进而可以根据位姿将各个局部子地图拼接起来形成完整的全局地图,从而避免了现有的视觉SLAM方法在环境复杂建图尺度大的室内变电作业环境中建图误差大甚至建图失败的问题,提高了对电网作业环境进行建图的准确性,并大大缩短了建图时间,提高了建图效率。Through the collaboration of the above-mentioned various components, the visual SLAM-based power grid operating environment map construction system provided by the embodiment of the present invention obtains each sub-map of the power grid operating environment established in stages and the key frame image corresponding to each sub-map , Perform closed-loop detection on each key frame image to obtain the overlapping image between each sub-map, and then calculate the pose of each sub-map in the global coordinate system based on the overlapping image, and stitch each sub-map according to the pose to generate a power grid The global map of the working environment, by converting the process of establishing the global map to the establishment of phased local sub-maps, and then calculating the position and pose of each sub-map in the global coordinate system through the image overlap relationship between each sub-map, and then The local sub-maps can be spliced together to form a complete global map according to the pose, thereby avoiding the problem of large mapping errors or even failure of the existing visual SLAM method in the indoor substation operation environment with complex mapping and large scale. , Improve the accuracy of mapping the operating environment of the power grid, and greatly shorten the mapping time and improve the efficiency of mapping.
根据本发明实施例还提供了一种电子设备,如图4所示,该电子设备可以包括处理器901和存储器902,其中处理器901和存储器902可以通过总线或者其他方式连接,图4中以通过总线连接为例。According to an embodiment of the present invention, an electronic device is also provided. As shown in FIG. 4, the electronic device may include a processor 901 and a memory 902, where the processor 901 and the memory 902 may be connected by a bus or in other ways. Take the bus connection as an example.
处理器901可以为中央处理器(Central Processing Unit,CPU)。处理器901还可以为其他通用处理器、数字信号处理器(Digital Signal Processor,DSP)、专用集成电路(Application Specific Integrated Circuit,ASIC)、现场可编程门阵列(Field-Programmable Gate Array,FPGA)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件等芯片,或者上述各类芯片的组合。The processor 901 may be a central processing unit (Central Processing Unit, CPU). The processor 901 may also be other general-purpose processors, digital signal processors (Digital Signal Processor, DSP), Application Specific Integrated Circuit (ASIC), Field-Programmable Gate Array (Field-Programmable Gate Array, FPGA), or Chips such as other programmable logic devices, discrete gates or transistor logic devices, discrete hardware components, or a combination of the above types of chips.
存储器902作为一种非暂态计算机可读存储介质,可用于存储非暂态软件程序、非暂态计算机可执行程序以及模块,如本发明实施例中的基于视觉SLAM的电网作业环境地图的构建方法所对应的程序指令/模块。处理器901通过运行存储在存储器902中的非暂态软件程序、指令以及模块,从而执行处理器的各种功能应用以及数据处理,即实现上述方法实施例中的基于视觉SLAM的电网作业环境地图的构建方法。The memory 902, as a non-transitory computer-readable storage medium, can be used to store non-transitory software programs, non-transitory computer executable programs and modules, such as the construction of a visual SLAM-based power grid operating environment map in the embodiment of the present invention The program instruction/module corresponding to the method. The processor 901 executes various functional applications and data processing of the processor by running the non-transient software programs, instructions, and modules stored in the memory 902, that is, realizes the visual SLAM-based power grid operating environment map in the foregoing method embodiment The construction method.
存储器902可以包括存储程序区和存储数据区,其中,存储程序区可存储操作系统、至少一个功能所需要的应用程序;存储数据区可存储处理器901所创建的数据等。此外,存储器902可以包括高速随机存取存储器,还可以包括非暂态存储器,例如至少一个磁盘存储器件、闪存器件、或其他非暂态固态存储器件。在一些实施例中,存储器902可选包括相对于处理器901远程设置的存储器,这些远程存储器可以通过网络连接至处理器901。上述网络的实例包括但不限于互联网、企业内部网、局域网、移动通信网及其组合。The memory 902 may include a program storage area and a data storage area. The program storage area may store an operating system and an application program required by at least one function; the data storage area may store data created by the processor 901 and the like. In addition, the memory 902 may include a high-speed random access memory, and may also include a non-transitory memory, such as at least one magnetic disk storage device, a flash memory device, or other non-transitory solid-state storage devices. In some embodiments, the memory 902 may optionally include memories remotely provided with respect to the processor 901, and these remote memories may be connected to the processor 901 via a network. Examples of the aforementioned networks include, but are not limited to, the Internet, corporate intranets, local area networks, mobile communication networks, and combinations thereof.
一个或者多个模块存储在存储器902中,当被处理器901执行时,执行上述方法实施例中的基于视觉SLAM的电网作业环境地图的构建方法。One or more modules are stored in the memory 902, and when executed by the processor 901, the method for constructing a visual SLAM-based power grid operating environment map in the foregoing method embodiment is executed.
上述电子设备具体细节可以对应参阅上述方法实施例中对应的相关描述和效果进行理解,此处不再赘述。The specific details of the above electronic device can be understood by referring to the corresponding related description and effect in the above method embodiment, and will not be repeated here.
本领域技术人员可以理解,实现上述实施例方法中的全部或部分流程,是 可以通过计算机程序来指令相关的硬件来完成,的程序可存储于一计算机可读取存储介质中,该程序在执行时,可包括如上述各方法的实施例的流程。其中,存储介质可为磁碟、光盘、只读存储记忆体(Read-Only Memory,ROM)、随机存储记忆体(Random Access Memory,RAM)、快闪存储器(Flash Memory)、硬盘(Hard Disk Drive,缩写:HDD)或固态硬盘(Solid-State Drive,SSD)等;存储介质还可以包括上述种类的存储器的组合。Those skilled in the art can understand that all or part of the processes in the above-mentioned embodiments can be implemented by instructing relevant hardware through a computer program. The program can be stored in a computer readable storage medium. At this time, it may include the procedures of the above-mentioned method embodiments. Among them, the storage medium can be magnetic disk, optical disk, read-only memory (Read-Only Memory, ROM), random access memory (RAM), flash memory (Flash Memory), hard disk (Hard Disk Drive) , Abbreviation: HDD) or solid-state drive (Solid-State Drive, SSD), etc.; the storage medium may also include a combination of the foregoing types of memories.
虽然结合附图描述了本发明的实施例,但是本领域技术人员可以在不脱离本发明的精神和范围的情况下作出各种修改和变型,这样的修改和变型均落入由所附权利要求所限定的范围之内。Although the embodiments of the present invention have been described in conjunction with the accompanying drawings, those skilled in the art can make various modifications and variations without departing from the spirit and scope of the present invention, and such modifications and variations fall into the appended claims. Within the limited range.

Claims (10)

  1. 一种基于视觉SLAM的电网作业环境地图的构建方法,其特征在于,包括:A method for constructing a power grid operating environment map based on visual SLAM, which is characterized in that it includes:
    获取分阶段建立的电网作业环境的各子地图,以及所述各子地图对应的关键帧图像;Acquiring each sub-map of the power grid operating environment established in stages and the key frame image corresponding to each sub-map;
    分别对所述各子地图对应的关键帧图像进行闭环检测,生成所述各子地图之间的各重叠图像;Performing closed-loop detection on the key frame images corresponding to the sub-maps to generate overlapping images between the sub-maps;
    根据所述各重叠图像分别计算所述各子地图在全局坐标系下对应的位姿,并根据所述各子地图对应的位姿将所述各子地图进行子地图拼接,生成所述电网作业环境的全局地图。Calculate the corresponding poses of the sub-maps in the global coordinate system according to the overlapping images, and perform sub-map splicing on the sub-maps according to the poses corresponding to the sub-maps to generate the power grid operation Global map of the environment.
  2. 根据权利要求1所述的基于视觉SLAM的电网作业环境地图的构建方法,其特征在于,所述对所述各子地图对应的关键帧图像进行闭环检测,生成所述各子地图之间的各重叠图像,包括:The method for constructing a power grid operating environment map based on visual SLAM according to claim 1, wherein the closed-loop detection of the key frame images corresponding to the sub-maps is performed to generate each sub-map. Overlapping images, including:
    采用DBoW2算法对所述各子地图对应的关键帧图像进行闭环检测,生成各闭环匹配特征点对;Using the DBoW2 algorithm to perform closed-loop detection on the key frame images corresponding to each sub-map, and generate each closed-loop matching feature point pair;
    采用对极几何约束方法对所述各闭环匹配特征点对进行筛选,并剔除不满足所述对极几何约束方法要求的各所述闭环匹配特征点对;Screening the closed-loop matching feature point pairs by adopting an antipolar geometric constraint method, and rejecting each closed-loop matching feature point pair that does not meet the requirements of the antipolar geometric constraint method;
    根据筛选后的各所述闭环匹配特征点对,生成所述各重叠图像。According to the filtered pairs of closed-loop matching feature points, the overlapping images are generated.
  3. 根据权利要求1所述的基于视觉SLAM的电网作业环境地图的构建方法,其特征在于,所述根据所述各重叠图像分别计算所述各子地图在全局坐标系下对应的位姿,包括:The method for constructing a power grid operating environment map based on visual SLAM according to claim 1, wherein said calculating the respective poses of said sub-maps in a global coordinate system according to said overlapping images respectively comprises:
    根据所述各重叠图像生成所述各子地图之间的重叠区域的三维点云;Generating a three-dimensional point cloud of the overlapping area between the sub-maps according to the overlapping images;
    根据所述各子地图之间的重叠区域的三维点云采用点云配准算法计算各所 述子地图之间的各变换关系;Using a point cloud registration algorithm to calculate the transformation relations between the sub-maps according to the three-dimensional point cloud of the overlapping area between the sub-maps;
    根据所述各变换关系分别计算所述各子地图在全局坐标系下对应的位姿,并根据所述各子地图对应的位姿将所述各子地图进行子地图拼接,生成所述全局地图。Calculate the corresponding poses of the sub-maps in the global coordinate system according to the transformation relations, and perform sub-map splicing on the sub-maps according to the poses corresponding to the sub-maps to generate the global map .
  4. 根据权利要求3所述的基于视觉SLAM的电网作业环境地图的构建方法,其特征在于,所述根据所述重叠图像生成所述各子地图之间的重叠区域的三维点云,包括:The method for constructing a power grid operating environment map based on visual SLAM according to claim 3, wherein the generating a three-dimensional point cloud of the overlapping area between the sub-maps according to the overlapping image comprises:
    获取包含所述重叠图像的各所述关键帧图像,并获取各所述关键帧图像对应的位姿信息;Acquiring each of the key frame images including the overlapping images, and acquiring the pose information corresponding to each of the key frame images;
    分别根据各所述关键帧图像生成单帧图像的三维点云;Generating a three-dimensional point cloud of a single frame image according to each of the key frame images;
    根据各所述关键帧图像对应的位姿信息,将各所述关键帧图像对应的所述三维点云进行拼接,生成所述重叠区域的三维点云。According to the pose information corresponding to each of the key frame images, the three-dimensional point clouds corresponding to each of the key frame images are spliced to generate a three-dimensional point cloud of the overlapping area.
  5. 根据权利要求3所述的基于视觉SLAM的电网作业环境地图的构建方法,其特征在于,所述根据所述各变换关系分别计算所述各子地图在全局坐标系下对应的位姿,包括:The method for constructing a power grid operating environment map based on visual SLAM according to claim 3, wherein the calculation of the corresponding poses of the sub-maps in the global coordinate system according to the transformation relations includes:
    根据所述各变换关系分别构建所述各子地图的有向带权图;Constructing the directed weighted graph of each sub-map according to the transformation relations;
    分别对各所述有向带权图进行深度优先遍历,计算所述各子地图在全局坐标系下对应的所述位姿。Depth-first traversal is performed on each of the directed weighted maps respectively, and the pose corresponding to each sub-map in the global coordinate system is calculated.
  6. 根据权利要求1-5任一项所述的基于视觉SLAM的电网作业环境地图的构建方法,其特征在于,还包括:The method for constructing a power grid operating environment map based on visual SLAM according to any one of claims 1 to 5, further comprising:
    获取所述电网作业环境的作业信息;Obtaining operation information of the grid operation environment;
    将所述作业信息添加至所述全局地图中,生成完整的全局地图。The job information is added to the global map to generate a complete global map.
  7. 根据权利要求6所述的基于视觉SLAM的电网作业环境地图的构建方法,其特征在于,还包括:The method for constructing a power grid operating environment map based on visual SLAM according to claim 6, characterized in that it further comprises:
    对所述完整的全局地图、各子地图、各关键帧图像、各重叠图像及各子地图对应的位姿进行存储。Store the complete global map, each sub-map, each key frame image, each overlapping image, and the pose corresponding to each sub-map.
  8. 一种基于视觉SLAM的电网作业环境地图的构建系统,其特征在于,包括:A visual SLAM-based power grid operating environment map construction system is characterized in that it includes:
    信息获取模块,用于获取分阶段建立的电网作业环境的各子地图,以及所述各子地图对应的关键帧图像;An information acquisition module for acquiring each sub-map of the power grid operating environment established in stages, and the key frame image corresponding to each of the sub-maps;
    重叠图像生成模块,用于分别对所述各子地图对应的关键帧图像进行闭环检测,生成所述各子地图之间的各重叠图像;The overlapping image generating module is configured to perform closed-loop detection on the key frame images corresponding to the sub-maps to generate overlapping images between the sub-maps;
    全局地图构建模块,用于根据所述各重叠图像分别计算所述各子地图在全局坐标系下对应的位姿,并根据所述各子地图对应的位姿将所述各子地图进行子地图拼接,生成所述电网作业环境的全局地图。The global map construction module is used to calculate the corresponding poses of the sub-maps in the global coordinate system according to the overlapping images, and perform sub-maps on the sub-maps according to the poses corresponding to the sub-maps Splicing to generate a global map of the grid operating environment.
  9. 一种电子设备,其特征在于,包括:An electronic device, characterized in that it comprises:
    存储器和处理器,所述存储器和所述处理器之间互相通信连接,所述存储器中存储有计算机指令,所述处理器通过执行所述计算机指令,从而执行权利要求1-7任一项所述的基于视觉SLAM的电网作业环境地图的构建方法。A memory and a processor, the memory and the processor are communicatively connected to each other, the memory is stored with computer instructions, and the processor executes the computer instructions by executing any one of claims 1-7 The construction method of power grid operating environment map based on visual SLAM is described.
  10. 一种计算机可读存储介质,其特征在于,所述计算机可读存储介质存储有计算机指令,所述计算机指令用于使所述计算机从而执行权利要求1-7任一项所述的基于视觉SLAM的电网作业环境地图的构建方法。A computer-readable storage medium, wherein the computer-readable storage medium stores computer instructions, and the computer instructions are used to enable the computer to execute the vision-based SLAM according to any one of claims 1-7. Method of constructing a map of the power grid operating environment.
PCT/CN2020/092144 2019-05-23 2020-05-25 Visual slam-based grid operating environment map construction method and system WO2020233724A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN201910438134.4A CN110276826A (en) 2019-05-23 2019-05-23 A kind of construction method and system of electric network operation environmental map
CN201910438134.4 2019-05-23

Publications (1)

Publication Number Publication Date
WO2020233724A1 true WO2020233724A1 (en) 2020-11-26

Family

ID=67960135

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2020/092144 WO2020233724A1 (en) 2019-05-23 2020-05-25 Visual slam-based grid operating environment map construction method and system

Country Status (2)

Country Link
CN (1) CN110276826A (en)
WO (1) WO2020233724A1 (en)

Cited By (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112380371A (en) * 2020-11-27 2021-02-19 广东电网有限责任公司肇庆供电局 Closed loop detection method based on local and convolutional neural network characteristics
CN112614185A (en) * 2020-12-29 2021-04-06 浙江商汤科技开发有限公司 Map construction method and device and storage medium
CN112630745A (en) * 2020-12-24 2021-04-09 深圳市大道智创科技有限公司 Environment mapping method and device based on laser radar
CN112668653A (en) * 2020-12-30 2021-04-16 北京百度网讯科技有限公司 Loop detection method, device, equipment and medium based on laser radar map
CN113012212A (en) * 2021-04-02 2021-06-22 西北农林科技大学 Depth information fusion-based indoor scene three-dimensional point cloud reconstruction method and system
CN113192174A (en) * 2021-04-06 2021-07-30 中国计量大学 Mapping method and device and computer storage medium
CN113674409A (en) * 2021-07-20 2021-11-19 中国科学技术大学先进技术研究院 Vision-based multi-robot instant positioning and synchronous drawing establishing method, system and medium
CN113701766A (en) * 2020-05-20 2021-11-26 浙江欣奕华智能科技有限公司 Robot map construction method, robot positioning method and device
CN114442621A (en) * 2022-01-17 2022-05-06 浙江大学 Autonomous exploration and mapping system based on quadruped robot
EP4207070A1 (en) * 2021-12-30 2023-07-05 Virnect, Co., Ltd. Method and system for map target tracking
CN116481516A (en) * 2023-06-21 2023-07-25 深圳市普渡科技有限公司 Robot, map creation method, and storage medium
CN117315170A (en) * 2023-09-12 2023-12-29 华大天元(北京)科技股份有限公司 Construction method, device, equipment and medium of power grid operation environment map

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110276826A (en) * 2019-05-23 2019-09-24 全球能源互联网研究院有限公司 A kind of construction method and system of electric network operation environmental map
CN110704563B (en) * 2019-09-27 2022-06-28 Oppo广东移动通信有限公司 Map fusion method and device, equipment and storage medium
CN110849380B (en) * 2019-10-28 2022-04-22 北京影谱科技股份有限公司 Map alignment method and system based on collaborative VSLAM
CN110968429B (en) * 2019-12-20 2022-11-11 北京百度网讯科技有限公司 Method, device, equipment and storage medium for loop detection in directed graph
CN111174799B (en) * 2019-12-24 2023-02-17 Oppo广东移动通信有限公司 Map construction method and device, computer readable medium and terminal equipment
CN112614171B (en) * 2020-11-26 2023-12-19 厦门大学 Air-ground integrated dynamic environment sensing system for engineering machinery cluster operation
CN113674351B (en) * 2021-07-27 2023-08-08 追觅创新科技(苏州)有限公司 Drawing construction method of robot and robot

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE19839397A1 (en) * 1998-08-29 2000-03-02 Readymix Betonbauteile Gmbh Computer based construction of surface surrounding three dimensional object, based upon processing of digital data obtained from scanning of a three dimensional photograph
US7457658B2 (en) * 2002-03-07 2008-11-25 Medtronic, Inc. Algorithm for accurate three-dimensional reconstruction of non-linear implanted medical devices in VIVO
CN105843223A (en) * 2016-03-23 2016-08-10 东南大学 Mobile robot three-dimensional mapping and obstacle avoidance method based on space bag of words model
CN106272423A (en) * 2016-08-31 2017-01-04 哈尔滨工业大学深圳研究生院 A kind of multirobot for large scale environment works in coordination with the method for drawing and location
CN106940186A (en) * 2017-02-16 2017-07-11 华中科技大学 A kind of robot autonomous localization and air navigation aid and system
CN107796397A (en) * 2017-09-14 2018-03-13 杭州迦智科技有限公司 A kind of Robot Binocular Vision localization method, device and storage medium
CN110276826A (en) * 2019-05-23 2019-09-24 全球能源互联网研究院有限公司 A kind of construction method and system of electric network operation environmental map

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106595659A (en) * 2016-11-03 2017-04-26 南京航空航天大学 Map merging method of unmanned aerial vehicle visual SLAM under city complex environment
KR102647351B1 (en) * 2017-01-26 2024-03-13 삼성전자주식회사 Modeling method and modeling apparatus using 3d point cloud
CN107515891A (en) * 2017-07-06 2017-12-26 杭州南江机器人股份有限公司 A kind of robot cartography method, apparatus and storage medium
CN108090958B (en) * 2017-12-06 2021-08-27 上海阅面网络科技有限公司 Robot synchronous positioning and map building method and system

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE19839397A1 (en) * 1998-08-29 2000-03-02 Readymix Betonbauteile Gmbh Computer based construction of surface surrounding three dimensional object, based upon processing of digital data obtained from scanning of a three dimensional photograph
US7457658B2 (en) * 2002-03-07 2008-11-25 Medtronic, Inc. Algorithm for accurate three-dimensional reconstruction of non-linear implanted medical devices in VIVO
CN105843223A (en) * 2016-03-23 2016-08-10 东南大学 Mobile robot three-dimensional mapping and obstacle avoidance method based on space bag of words model
CN106272423A (en) * 2016-08-31 2017-01-04 哈尔滨工业大学深圳研究生院 A kind of multirobot for large scale environment works in coordination with the method for drawing and location
CN106940186A (en) * 2017-02-16 2017-07-11 华中科技大学 A kind of robot autonomous localization and air navigation aid and system
CN107796397A (en) * 2017-09-14 2018-03-13 杭州迦智科技有限公司 A kind of Robot Binocular Vision localization method, device and storage medium
CN110276826A (en) * 2019-05-23 2019-09-24 全球能源互联网研究院有限公司 A kind of construction method and system of electric network operation environmental map

Cited By (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113701766A (en) * 2020-05-20 2021-11-26 浙江欣奕华智能科技有限公司 Robot map construction method, robot positioning method and device
CN112380371A (en) * 2020-11-27 2021-02-19 广东电网有限责任公司肇庆供电局 Closed loop detection method based on local and convolutional neural network characteristics
CN112630745A (en) * 2020-12-24 2021-04-09 深圳市大道智创科技有限公司 Environment mapping method and device based on laser radar
CN112614185A (en) * 2020-12-29 2021-04-06 浙江商汤科技开发有限公司 Map construction method and device and storage medium
CN112614185B (en) * 2020-12-29 2022-06-21 浙江商汤科技开发有限公司 Map construction method and device and storage medium
CN112668653A (en) * 2020-12-30 2021-04-16 北京百度网讯科技有限公司 Loop detection method, device, equipment and medium based on laser radar map
CN113012212A (en) * 2021-04-02 2021-06-22 西北农林科技大学 Depth information fusion-based indoor scene three-dimensional point cloud reconstruction method and system
CN113012212B (en) * 2021-04-02 2024-04-16 西北农林科技大学 Depth information fusion-based indoor scene three-dimensional point cloud reconstruction method and system
CN113192174B (en) * 2021-04-06 2024-03-26 中国计量大学 Picture construction method and device and computer storage medium
CN113192174A (en) * 2021-04-06 2021-07-30 中国计量大学 Mapping method and device and computer storage medium
CN113674409A (en) * 2021-07-20 2021-11-19 中国科学技术大学先进技术研究院 Vision-based multi-robot instant positioning and synchronous drawing establishing method, system and medium
EP4207070A1 (en) * 2021-12-30 2023-07-05 Virnect, Co., Ltd. Method and system for map target tracking
CN114442621A (en) * 2022-01-17 2022-05-06 浙江大学 Autonomous exploration and mapping system based on quadruped robot
CN116481516B (en) * 2023-06-21 2023-10-13 深圳市普渡科技有限公司 Robot, map creation method, and storage medium
CN116481516A (en) * 2023-06-21 2023-07-25 深圳市普渡科技有限公司 Robot, map creation method, and storage medium
CN117315170A (en) * 2023-09-12 2023-12-29 华大天元(北京)科技股份有限公司 Construction method, device, equipment and medium of power grid operation environment map
CN117315170B (en) * 2023-09-12 2024-04-05 华大天元(北京)科技股份有限公司 Construction method, device, equipment and medium of power grid operation environment map

Also Published As

Publication number Publication date
CN110276826A (en) 2019-09-24

Similar Documents

Publication Publication Date Title
WO2020233724A1 (en) Visual slam-based grid operating environment map construction method and system
US10970864B2 (en) Method and apparatus for recovering point cloud data
CN112894832B (en) Three-dimensional modeling method, three-dimensional modeling device, electronic equipment and storage medium
WO2020206903A1 (en) Image matching method and device, and computer readable storage medium
WO2021004416A1 (en) Method and apparatus for establishing beacon map on basis of visual beacons
WO2023273169A1 (en) Vision and laser-fused 2.5d map construction method
WO2019196476A1 (en) Laser sensor-based map generation
WO2021036587A1 (en) Positioning method and system for electric power patrol scenario
TWI768776B (en) Indoor positioning system and indoor positioning method
Kopsida et al. BIM registration methods for mobile augmented reality-based inspection
CN116109684B (en) Online video monitoring two-dimensional and three-dimensional data mapping method and device for variable electric field station
CN114202632A (en) Grid linear structure recovery method and device, electronic equipment and storage medium
Wen et al. Cooperative indoor 3D mapping and modeling using LiDAR data
Wen et al. CAE-RLSM: Consistent and efficient redundant line segment merging for online feature map building
Wang et al. mvil-fusion: Monocular visual-inertial-lidar simultaneous localization and mapping in challenging environments
CN113034347A (en) Oblique photographic image processing method, device, processing equipment and storage medium
Ma et al. Semantic geometric fusion multi-object tracking and lidar odometry in dynamic environment
Liu et al. Visual odometry algorithm based on deep learning
Zhang et al. A Vision-Centric Approach for Static Map Element Annotation
Li et al. SLAM of mobile robot based on the joint optimization of LiDAR and camera
Xue et al. A new approach for the bundle adjustment problem with fixed constraints in stereo vision
Chen et al. A Model of Real-time Pose Estimation Fusing Camera and LiDAR in Simultaneous Localization and Mapping by a Geometric Method.
Guan et al. Laser measurements registration algorithm for hull blocks with shipbuilding constraints
CN116823954B (en) Pose estimation method and device of articulated vehicle, vehicle and storage medium
Mengiste et al. Automated integration of as-is point cloud information with as-planned BIM for interior construction

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 20810714

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 20810714

Country of ref document: EP

Kind code of ref document: A1