[go: up one dir, main page]

CN114596260B - 一种输电导线断点坐标获取方法、装置、设备及存储介质 - Google Patents

一种输电导线断点坐标获取方法、装置、设备及存储介质 Download PDF

Info

Publication number
CN114596260B
CN114596260B CN202210087263.5A CN202210087263A CN114596260B CN 114596260 B CN114596260 B CN 114596260B CN 202210087263 A CN202210087263 A CN 202210087263A CN 114596260 B CN114596260 B CN 114596260B
Authority
CN
China
Prior art keywords
coordinate system
coordinates
breakpoint
camera
acquiring
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
Application number
CN202210087263.5A
Other languages
English (en)
Other versions
CN114596260A (zh
Inventor
谌昕
周军
骆锟
代飞
陈瑞红
周晨宇
谌旻宸
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Wuhan Luojia Tianming Electric Power Technology Co ltd
Original Assignee
Wuhan Luojia Tianming Electric Power Technology Co ltd
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 Wuhan Luojia Tianming Electric Power Technology Co ltd filed Critical Wuhan Luojia Tianming Electric Power Technology Co ltd
Priority to CN202210087263.5A priority Critical patent/CN114596260B/zh
Publication of CN114596260A publication Critical patent/CN114596260A/zh
Application granted granted Critical
Publication of CN114596260B publication Critical patent/CN114596260B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00—Image analysis
    • G06T7/0002—Inspection of images, e.g. flaw detection
    • G06T7/0004—Industrial image inspection
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00—Image analysis
    • G06T7/80—Analysis of captured images to determine intrinsic or extrinsic camera parameters, i.e. camera calibration
    • G06T7/85—Stereo camera calibration
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T2207/00—Indexing scheme for image analysis or image enhancement
    • G06T2207/10—Image acquisition modality
    • G06T2207/10004—Still image; Photographic image
    • G06T2207/10012—Stereo images

Landscapes

  • Engineering & Computer Science (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • Quality & Reliability (AREA)
  • Length Measuring Devices By Optical Means (AREA)

Abstract

本发明公开一种输电导线断点坐标获取方法、装置、设备及存储介质，方法包括：建立机器人坐标系、左相机坐标系和右相机坐标系；建立归一化后的左图像坐标系和右图像坐标系；获取所述断点在所述左图像坐标系下和右图像坐标系下的成像点的坐标；获取所述断点在所述左相机坐标系或右相机坐标系下的坐标；获取所述断点在所述机器人坐标系下的坐标。本发明解决了现有技术中由于无法准确识别输电导线断点的坐标、而导致不能正确实现断点修补的技术问题。

Description

一种输电导线断点坐标获取方法、装置、设备及存储介质
技术领域
本发明涉及导线修补技术领域，具体涉及一种输电导线断点坐标获取方法、装置、设备及存储介质。
背景技术
输电线路主要承担电能输送任务，是国家电网的重要组成部分。由于输电线路架设面积广，途经地区的地形和气候复杂多变，因而在外界环境的长时间影响下，输电导线容易产生导线断股、导线破损等故障。
目前，随着无人机技术的发展，一般都是采用无人机进行输电导线断点的识别，然后采用采用人工对断点进行修补，此种修补方式不仅工作效率低，而且安全性不高，虽然目前也有利用导线修补机器人对断点进行自动修补的方式，但是由于导线修补机器人不能准确识别输电导线断点的坐标，导致经常不能正确的实现对断点的修补。
发明内容
本发明的目的在于克服上述技术不足，提供一种输电导线断点坐标获取方法、装置、设备及存储介质，解决现有技术中由于无法准确识别输电导线断点的坐标、而导致不能正确实现断点修补的技术问题。
为达到上述技术目的，本发明采取了以下技术方案：
第一方面，本发明提供一种输电导线断点坐标获取方法，包括如下步骤：
建立机器人坐标系、左相机坐标系和右相机坐标系；
分别根据所述左相机坐标系及左相机的焦距和右相机坐标系及右相机的焦距，建立归一化后的左图像坐标系和右图像坐标系；
分别根据断点在所述左相机坐标系和右相机坐标系下的坐标，获取所述断点在所述左图像坐标系下和右图像坐标系下的成像点的坐标；
根据所述左相机的内参数和右相机的内参数、所述断点在所述左图像坐标系下和右图像坐标系下的成像点的坐标，获取所述断点在所述左相机坐标系或右相机坐标系下的坐标；
根据所述左相机的内参数和所述断点在所述左相机坐标系的坐标或者所述右相机的内参数和所述断点在右相机坐标系下的坐标，获取所述断点在所述机器人坐标系下的坐标。
优选的，所述的输电导线断点坐标获取方法中，所述机器人坐标系的原点为所述机器人的作业机械臂与本体移动机构相连的纵向旋转关节蜗轮蜗杆中心，所述左相机坐标系的原点为所述左相机的光心，所述右相机坐标系的原点为所述右相机的光心，且所述左相机和右相机的光轴均与所述输电导线平行。
优选的，所述的输电导线断点坐标获取方法中，所述断点在所述左图像坐标系下的成像点的坐标的获取方法为：
其中，(ul,vl)为所述断点在所述左图像坐标系下的坐标，为所述断点在所述左图像坐标系下的成像点的坐标，(ulo,vlo)为所述左相机的光轴线在所述左图像坐标系所处的成像平面上的交点的坐标，kl为第一放大系数；
所述断点在所述右图像坐标系下的成像点的坐标的获取方法为：
其中，(ur,vr)为所述断点在所述右图像坐标系下的坐标，为所述断点在所述右图像坐标系下的成像点的坐标，(uro,vro)为所述右相机的光轴线在所述右图像坐标系所处的成像平面上的交点的坐标，kr为第二放大系数。
优选的，所述的输电导线断点坐标获取方法中，所述根据所述左相机的内参数和右相机的内参数、所述断点在所述左图像坐标系下和右图像坐标系下的成像点的坐标，获取所述断点在所述左相机坐标系或右相机坐标系下的坐标，包括：
获取所述左相机的内参数和右相机的内参数；
基于所述左相机的内参数和右相机的内参数，将所述断点在所述右图像坐标系下的成像点的坐标转换为在左图像坐标系下的转换坐标；
根据所述断点在所述左图像坐标系下的成像点的坐标以及所述转换坐标，获取所述断点在所述左相机坐标系下的坐标。
优选的，所述的输电导线断点坐标获取方法中，所述转换坐标的获取方法为：
其中，为转换坐标，为右相机的光轴中心点在左相机坐标系中的位置向量。
优选的，所述的输电导线断点坐标获取方法中，所述断点在所述左相机坐标系下的坐标为：
其中，(x，y，z)为所述断点在所述左相机坐标系下的坐标，d为右边相机的光轴中心点在左边相机坐标系中位置偏移量。
优选的，所述的输电导线断点坐标获取方法中，所述断点在所述机器人坐标系下的坐标为：
其中，(xw,yw,zw)为所述断点在所述机器人坐标系下的坐标，R和P为所述左相机的外参数。
第二方面，本发明还提供一种输电导线断点坐标获取装置，包括：
第一坐标系建立模块，用于建立机器人坐标系、左相机坐标系和右相机坐标系；
第二坐标系建立模块，用于分别根据所述左相机坐标系及左相机的焦距和右相机坐标系及右相机的焦距，建立归一化后的左图像坐标系和右图像坐标系；
第一坐标获取模块，用于分别根据断点在所述左相机坐标系和右相机坐标系下的坐标，获取所述断点在所述左图像坐标系下和右图像坐标系下的成像点的坐标；
第二坐标获取模块，用于根据所述左相机的内参数和右相机的内参数、所述断点在所述左图像坐标系下和右图像坐标系下的成像点的坐标，获取所述断点在所述左相机坐标系或右相机坐标系下的坐标；
第三坐标获取模块，用于根据所述左相机的内参数和所述断点在所述左相机坐标系的坐标或者所述右相机的内参数和所述断点在右相机坐标系下的坐标，获取所述断点在所述机器人坐标系下的坐标。
第三方面，本发明还提供一种输电导线断点坐标获取设备，包括：处理器和存储器；
所述存储器上存储有可被所述处理器执行的计算机可读程序；
所述处理器执行所述计算机可读程序时实现如上所述的输电导线断点坐标获取方法中的步骤。
第四方面，本发明还提供一种计算机可读存储介质，所述计算机可读存储介质存储有一个或者多个程序，所述一个或者多个程序可被一个或者多个处理器执行，以实现如上所述的输电导线断点坐标获取方法中的步骤。
与现有技术相比，本发明提供的输电导线断点坐标获取方法、装置、设备及存储介质中，导线断股修补机器人沿线路行驶定位到断股分叉位置后，停止移动并利用导线夹爪锁紧机器人本体移动机构与输电导线。为了控制作业机械臂将断股分叉铝线捋直复位并包裹，本发明通过构建平行双目视觉测量系统，结合相机内、外参数变换矩阵，计算出线路断点在机器人坐标系下的三维坐标，和与末端执行器的相对位置，从而可以准确识别输电导线断点的坐标，使机器人能够正确的实现断点的修补。
附图说明
图1是小孔成像的原理图；
图2是图像点对应的不同空间点坐标的示意图；
图3是本发明提供的输电导线断点坐标获取方法的一较佳实施例的流程图；
图4是本发明双目视觉系统测距的模型示意图；
图5是本发明提供的输电导线断点坐标获取装置的一较佳实施例的示意图；
图6是本发明输电导线断点坐标获取程序的较佳实施例的运行环境示意图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对本发明进行进一步详细说明。应当理解，此处所描述的具体实施例仅仅用以解释本发明，并不用于限定本发明。
相机成像一般采用小孔成像原理，如图1所示。OC为相机光轴中心点，光轴垂直于目标点平面E1、成像平面F′1和与F′1同比例、反向的映射平面F1。F′1上分布着感光器件，将照射到该平面的光信号转变成电信号输出，但其与真实目标点平面上下、左右方向相反，进而相机实际输出信号为成像平面实像的映射平面F1。以相机光轴中心点建立相机坐标系，相机光轴设为Z轴，并以相机到目标点为正方向，X轴方向与图像坐标系(也即成像平面F′1)相同。设目标点P2坐标为(x2,y2,z2)，P2在成像平面F1下的点P1坐标为(x1,y1,z1)。
由三角形相似定理，则有：
式(1)是笛卡尔空间的目标点与相机成像点之间的关系。其中，f为相机的焦距，f＝z1。
相机内参数描述的是图像坐标系和相机坐标系的关系。将成像平面上的成像点(x1,y1)经放大转换成为图像坐标系的点(u,v)，且相机光轴线在成像平面上的交点记为图像坐标(u0,v0)，则：
式中：ax和ay分别为成像平面到图像坐标平面在X轴和Y轴方向的放大系数。
将式(2)代入式(1)，得：
将式(3)改写成矩阵形式，则有：
式中：kx＝axf是X轴方向的放大系数；ky＝ayf是Y轴方向的放大系数；Min称为内参数矩阵，(x2,y2,z2)是目标点在相机坐标系下的坐标。
一般地，将目标点在相机坐标系下的坐标用(xc,yc,zc)表示，即式(4)改为：
如图2所示几何原理可知，直线OP上所有点具有相同的图像坐标，即图像坐标系内一个点可以对应若干个不同的空间点。
当z＝f时，点(xc,yc,zc)为图像点在成像平面上的成像点坐标。根据摄像机内参数，可以求出图像点在焦距归一化成像平面上的成像点坐标：
利用焦距归一化成像平面上的成像点坐标和光轴中心点，可以确定景物点所在的空间直线。
相机外参数描述的是机器人物理作业场景坐标系和相机坐标系的转换关系。如图1所示，构成相机外参数矩阵，将坐标系OWXWYWZW在坐标系OCXCYCZC中表示出：
式中：(xc,yc,zc)表示景物点在相机坐标系OCXCYCZC中的坐标；(xw,yw,zw)是景物点在机器人坐标系OWXWYWZW中的坐标；cMw是外参数矩阵；n＝[nx ny nz]T是XW轴在相机坐标系OCXCYCZC的方向向量；o＝[ox oy oz]T是YW轴在相机坐标系OCXCYCZC的方向向量；a＝[ax ayaz]T是ZW轴在相机坐标系OCXCYCZC的方向向量；p＝[px py pz]T是OWXWYWZW的坐标原点在相机坐标系OCXCYCZC的位置。
基于上述分析，本发明实施例提供了一种输电导线断点坐标获取方法，包括如下步骤：
S100、建立机器人坐标系、左相机坐标系和右相机坐标系；
S200、分别根据所述左相机坐标系及左相机的焦距和右相机坐标系及右相机的焦距，建立归一化后的左图像坐标系和右图像坐标系；
S300、分别根据断点在所述左相机坐标系和右相机坐标系下的坐标，获取所述断点在所述左图像坐标系下和右图像坐标系下的成像点的坐标；
S400、根据所述左相机的内参数和右相机的内参数、所述断点在所述左图像坐标系下和右图像坐标系下的成像点的坐标，获取所述断点在所述左相机坐标系或右相机坐标系下的坐标；
S500、根据所述左相机的内参数和所述断点在所述左相机坐标系的坐标或者所述右相机的内参数和所述断点在右相机坐标系下的坐标，获取所述断点在所述机器人坐标系下的坐标。
本实施例中，导线断股修补机器人沿线路行驶定位到断股分叉位置后，停止移动并利用导线夹爪锁紧机器人本体移动机构与输电导线。为了控制作业机械臂将断股分叉铝线捋直复位并包裹，本发明通过构建平行双目视觉测量系统，结合相机内、外参数变换矩阵，计算出线路断点在机器人坐标系下的三维坐标，和与末端执行器的相对位置，从而可以准确识别输电导线断点的坐标，使机器人能够正确的实现断点的修补。
如图4所示，本实施例中，所述机器人坐标系的原点为所述机器人的作业机械臂与本体移动机构相连的纵向旋转关节蜗轮蜗杆中心，所述左相机坐标系的原点为所述左相机的光心，所述右相机坐标系的原点为所述右相机的光心，且所述左相机和右相机的光轴均与所述输电导线平行。
具体的，本发明实施例将作业机械臂与本体移动机构相连的纵向旋转关节蜗轮蜗杆中心作为双目视觉系统机器人坐标系Ow-xwywzw的原点，Ocl-xclyclzcl、Ocr-xcrycrzcr为左右相机坐标系，Ol-xlyl、Or-xryr为焦距归一化后左右图像坐标系。
左右相机光心Ocl和Ocr相距d，且相机光轴与导线相互平行，OclOl和OcrOr之间的距离为归一化焦距f＝1。点P为机器人坐标系的一个目标点，Pl和Pr分别是点P在焦距归一化后左、右图像上的成像点。
在一些实施例中，所述断点在所述左图像坐标系下的成像点的坐标的获取方法为：
其中，(ul,vl)为所述断点在所述左图像坐标系下的坐标，为所述断点在所述左图像坐标系下的成像点的坐标，(ulo,vlo)为所述左相机的光轴线在所述左图像坐标系所处的成像平面上的交点的坐标，kl为第一放大系数；
所述断点在所述右图像坐标系下的成像点的坐标的获取方法为：
其中，(ur,vr)为所述断点在所述右图像坐标系下的坐标，为所述断点在所述右图像坐标系下的成像点的坐标，(uro,vro)为所述右相机的光轴线在所述右图像坐标系所处的成像平面上的交点的坐标，kr为第二放大系数。
本实施例中，由空间点P在相机cl的图像坐标(ul,vl)，可以计算出点P在相机cl的焦距归一化成像平面的成像点的坐标，空间点P在相机cl的光轴中心点与点构成的直线上，即符合方程：
同样的，由空间点P在相机cr的图像坐标(ur,vr)，可以计算出点P在相机cr的焦距归一化成像平面的成像点的坐标，空间点P也在相机cr的光轴中心点与点构成的直线上。
在一些实施例中，所述步骤S400具体包括：
获取所述左相机的内参数和右相机的内参数；
基于所述左相机的内参数和右相机的内参数，将所述断点在所述右图像坐标系下的成像点的坐标转换为在左图像坐标系下的转换坐标；
根据所述断点在所述左图像坐标系下的成像点的坐标以及所述转换坐标，获取所述断点在所述左相机坐标系下的坐标。
具体的，所述转换坐标的获取方法为：
其中，为转换坐标，为右相机的光轴中心点在左相机坐标系中的位置向量，可根据两相机的内参数获得，由图4双目视觉的几何关系可知，式中只有坐标值变成因此，该直线方程可表示为式(12)：
式中：px、py和pz构成的位置偏移量，px＝d、py和pz等于0，因两相机相同tr＝tl。
上述两条直线的交点，即为空间点P。因此，可求解出空间点P在相机cl坐标系中的三维坐标。根据图4中双目视觉模型可以计算出目标点P在相机cl坐标系中的坐标(x,y,z)为：
其中，(x，y，z)为所述断点在所述左相机坐标系下的坐标，d为右边相机的光轴中心点在左边相机坐标系中位置偏移量。
进一步的，利用相机坐标系与机器人坐标系之间外参数，则可以由点P在相机cl坐标系中的三维坐标和式(7)矩阵变换计算出点P在机器人坐标系中的三维坐标：
其中，(xw,yw,zw)为所述断点在所述机器人坐标系下的坐标，R和P为所述左相机的外参数。
当得到了断点在所述机器人坐标系下的坐标后，即可驱动末端修补作业机械臂开始捋线和包裹断股导线，从而保证导线修补的准确性。
基于上述输电导线断点坐标获取方法，请参阅图5，本发明实施例还相应的提供一种输电导线断点坐标获取装置600，包括：
第一坐标系建立模块610，用于建立机器人坐标系、左相机坐标系和右相机坐标系；
第二坐标系建立模块620，用于分别根据所述左相机坐标系及左相机的焦距和右相机坐标系及右相机的焦距，建立归一化后的左图像坐标系和右图像坐标系；
第一坐标获取模块630，用于分别根据断点在所述左相机坐标系和右相机坐标系下的坐标，获取所述断点在所述左图像坐标系下和右图像坐标系下的成像点的坐标；
第二坐标获取模块640，用于根据所述左相机的内参数和右相机的内参数、所述断点在所述左图像坐标系下和右图像坐标系下的成像点的坐标，获取所述断点在所述左相机坐标系或右相机坐标系下的坐标；
第三坐标获取模块650，用于根据所述左相机的内参数和所述断点在所述左相机坐标系的坐标或者所述右相机的内参数和所述断点在右相机坐标系下的坐标，获取所述断点在所述机器人坐标系下的坐标。
本实施例中，导线断股修补机器人沿线路行驶定位到断股分叉位置后，停止移动并利用导线夹爪锁紧机器人本体移动机构与输电导线。为了控制作业机械臂将断股分叉铝线捋直复位并包裹，本发明通过构建平行双目视觉测量系统，结合相机内、外参数变换矩阵，计算出线路断点在机器人坐标系下的三维坐标，和与末端执行器的相对位置，从而可以准确识别输电导线断点的坐标，使机器人能够正确的实现断点的修补。
由于上文已对输电导线断点坐标获取方法进行详细描述，在此不再赘述。
如图6所示，基于上述输电导线断点坐标获取方法，本发明还相应提供了一种输电导线断点坐标获取设备，所述输电导线断点坐标获取设备可以是移动终端、桌上型计算机、笔记本、掌上电脑及服务器等计算设备。该输电导线断点坐标获取设备包括处理器10、存储器20及显示器30。图6仅示出了输电导线断点坐标获取设备的部分组件，但是应理解的是，并不要求实施所有示出的组件，可以替代的实施更多或者更少的组件。
所述存储器20在一些实施例中可以是所述输电导线断点坐标获取设备的内部存储单元，例如输电导线断点坐标获取设备的硬盘或内存。所述存储器20在另一些实施例中也可以是所述输电导线断点坐标获取设备的外部存储设备，例如所述输电导线断点坐标获取设备上配备的插接式硬盘，智能存储卡(Smart Media Card,SMC)，安全数字(SecureDigital,SD)卡，闪存卡(Flash Card)等。进一步地，所述存储器20还可以既包括输电导线断点坐标获取设备的内部存储单元也包括外部存储设备。所述存储器20用于存储安装于所述输电导线断点坐标获取设备的应用软件及各类数据，例如所述安装输电导线断点坐标获取设备的程序代码等。所述存储器20还可以用于暂时地存储已经输出或者将要输出的数据。在一实施例中，存储器20上存储有输电导线断点坐标获取程序40，该输电导线断点坐标获取程序40可被处理器10所执行，从而实现本申请各实施例的输电导线断点坐标获取方法。
所述处理器10在一些实施例中可以是一中央处理器(Central Processing Unit,CPU)，微处理器或其他数据处理芯片，用于运行所述存储器20中存储的程序代码或处理数据，例如执行所述输电导线断点坐标获取方法等。
所述显示器30在一些实施例中可以是LED显示器、液晶显示器、触控式液晶显示器以及OLED(Organic Light-Emitting Diode，有机发光二极管)触摸器等。所述显示器30用于显示在所述输电导线断点坐标获取设备的信息以及用于显示可视化的用户界面。所述输电导线断点坐标获取设备的部件10-30通过系统总线相互通信。
在一实施例中，当处理器10执行所述存储器20中输电导线断点坐标获取程序40时实现如上所述的输电导线断点坐标获取方法中的步骤。
综上所述，本发明提供的输电导线断点坐标获取方法、装置、设备及存储介质中，导线断股修补机器人沿线路行驶定位到断股分叉位置后，停止移动并利用导线夹爪锁紧机器人本体移动机构与输电导线。为了控制作业机械臂将断股分叉铝线捋直复位并包裹，本发明通过构建平行双目视觉测量系统，结合相机内、外参数变换矩阵，计算出线路断点在机器人坐标系下的三维坐标，和与末端执行器的相对位置，从而可以准确识别输电导线断点的坐标，使机器人能够正确的实现断点的修补。
当然，本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程，是可以通过计算机程序来指令相关硬件(如处理器，控制器等)来完成，所述的程序可存储于一计算机可读取的存储介质中，该程序在执行时可包括如上述各方法实施例的流程。其中所述的存储介质可为存储器、磁碟、光盘等。
以上所述本发明的具体实施方式，并不构成对本发明保护范围的限定。任何根据本发明的技术构思所做出的各种其他相应的改变与变形，均应包含在本发明权利要求的保护范围内。

Claims (10)

1.一种输电导线断点坐标获取方法，其特征在于，包括如下步骤：
建立机器人坐标系、左相机坐标系和右相机坐标系；
分别根据所述左相机坐标系及左相机的焦距和右相机坐标系及右相机的焦距，建立归一化后的左图像坐标系和右图像坐标系；
分别根据断点在所述左相机坐标系和右相机坐标系下的坐标，获取所述断点在所述左图像坐标系下和右图像坐标系下的成像点的坐标；
根据所述左相机的内参数和右相机的内参数、所述断点在所述左图像坐标系下和右图像坐标系下的成像点的坐标，获取所述断点在所述左相机坐标系或右相机坐标系下的坐标；
根据所述左相机的内参数和所述断点在所述左相机坐标系的坐标或者所述右相机的内参数和所述断点在右相机坐标系下的坐标，获取所述断点在所述机器人坐标系下的坐标。
2.根据权利要求1所述的输电导线断点坐标获取方法，其特征在于，所述机器人坐标系的原点为所述机器人的作业机械臂与本体移动机构相连的纵向旋转关节蜗轮蜗杆中心，所述左相机坐标系的原点为所述左相机的光心，所述右相机坐标系的原点为所述右相机的光心，且所述左相机和右相机的光轴均与所述输电导线平行。
3.根据权利要求1所述的输电导线断点坐标获取方法，其特征在于，所述断点在所述左图像坐标系下的成像点的坐标的获取方法为：
其中，(ul,vl)为所述断点在所述左图像坐标系下的坐标，为所述断点在所述左图像坐标系下的成像点的坐标，(ulo,vlo)为所述左相机的光轴线在所述左图像坐标系所处的成像平面上的交点的坐标，kl为第一放大系数；
所述断点在所述右图像坐标系下的成像点的坐标的获取方法为：
其中，(ur,vr)为所述断点在所述右图像坐标系下的坐标，为所述断点在所述右图像坐标系下的成像点的坐标，(uro,vro)为所述右相机的光轴线在所述右图像坐标系所处的成像平面上的交点的坐标，kr为第二放大系数。
4.根据权利要求3所述的输电导线断点坐标获取方法，其特征在于，所述根据所述左相机的内参数和右相机的内参数、所述断点在所述左图像坐标系下和右图像坐标系下的成像点的坐标，获取所述断点在所述左相机坐标系或右相机坐标系下的坐标，包括：
获取所述左相机的内参数和右相机的内参数；
基于所述左相机的内参数和右相机的内参数，将所述断点在所述右图像坐标系下的成像点的坐标转换为在左图像坐标系下的转换坐标；
根据所述断点在所述左图像坐标系下的成像点的坐标以及所述转换坐标，获取所述断点在所述左相机坐标系下的坐标。
5.根据权利要求4所述的输电导线断点坐标获取方法，其特征在于，所述转换坐标的获取方法为：
其中，为转换坐标，为右相机的光轴中心点在左相机坐标系中的位置向量。
6.根据权利要求5所述的输电导线断点坐标获取方法，其特征在于，所述断点在所述左相机坐标系下的坐标为：
其中，(x，y，z)为所述断点在所述左相机坐标系下的坐标，d为右边相机的光轴中心点在左边相机坐标系中位置偏移量。
7.根据权利要求6所述的输电导线断点坐标获取方法，其特征在于，所述断点在所述机器人坐标系下的坐标为：
其中，(xw,yw,zw)为所述断点在所述机器人坐标系下的坐标，R和P为所述左相机的外参数。
8.一种输电导线断点坐标获取装置，其特征在于，包括：
第一坐标系建立模块，用于建立机器人坐标系、左相机坐标系和右相机坐标系；
第二坐标系建立模块，用于分别根据所述左相机坐标系及左相机的焦距和右相机坐标系及右相机的焦距，建立归一化后的左图像坐标系和右图像坐标系；
第一坐标获取模块，用于分别根据断点在所述左相机坐标系和右相机坐标系下的坐标，获取所述断点在所述左图像坐标系下和右图像坐标系下的成像点的坐标；
第二坐标获取模块，用于根据所述左相机的内参数和右相机的内参数、所述断点在所述左图像坐标系下和右图像坐标系下的成像点的坐标，获取所述断点在所述左相机坐标系或右相机坐标系下的坐标；
第三坐标获取模块，用于根据所述左相机的内参数和所述断点在所述左相机坐标系的坐标或者所述右相机的内参数和所述断点在右相机坐标系下的坐标，获取所述断点在所述机器人坐标系下的坐标。
9.一种输电导线断点坐标获取设备，其特征在于，包括：处理器和存储器；
所述存储器上存储有可被所述处理器执行的计算机可读程序；
所述处理器执行所述计算机可读程序时实现如权利要求1-7任意一项所述的输电导线断点坐标获取方法中的步骤。
10.一种计算机可读存储介质，其特征在于，所述计算机可读存储介质存储有一个或者多个程序，所述一个或者多个程序可被一个或者多个处理器执行，以实现如权利要求1-7任意一项所述的输电导线断点坐标获取方法中的步骤。
CN202210087263.5A 2022-01-25 2022-01-25 一种输电导线断点坐标获取方法、装置、设备及存储介质 Active CN114596260B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210087263.5A CN114596260B (zh) 2022-01-25 2022-01-25 一种输电导线断点坐标获取方法、装置、设备及存储介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210087263.5A CN114596260B (zh) 2022-01-25 2022-01-25 一种输电导线断点坐标获取方法、装置、设备及存储介质

Publications (2)

Publication Number Publication Date
CN114596260A CN114596260A (zh) 2022-06-07
CN114596260B true CN114596260B (zh) 2025-01-17

Family

ID=81806107

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210087263.5A Active CN114596260B (zh) 2022-01-25 2022-01-25 一种输电导线断点坐标获取方法、装置、设备及存储介质

Country Status (1)

Country Link
CN (1) CN114596260B (zh)

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105206109A (zh) * 2015-08-13 2015-12-30 长安大学 一种基于红外ccd的车辆雾天识别预警系统及方法
CN109272570A (zh) * 2018-08-16 2019-01-25 合肥工业大学 一种基于立体视觉数学模型的空间点三维坐标求解方法

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9188973B2 (en) * 2011-07-08 2015-11-17 Restoration Robotics, Inc. Calibration and transformation of a camera system's coordinate system
CN109934878B (zh) * 2019-03-25 2020-11-27 合肥工业大学 一种基于相机坐标系的线性标定系统及其方法
CN110962127B (zh) * 2019-12-10 2020-09-01 南京航空航天大学 一种用于机械臂末端位姿辅助标定装置及其标定方法
CN113496511A (zh) * 2020-04-03 2021-10-12 山东理工大学 基于光线交点的立体视觉深度计算方法

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105206109A (zh) * 2015-08-13 2015-12-30 长安大学 一种基于红外ccd的车辆雾天识别预警系统及方法
CN109272570A (zh) * 2018-08-16 2019-01-25 合肥工业大学 一种基于立体视觉数学模型的空间点三维坐标求解方法

Also Published As

Publication number Publication date
CN114596260A (zh) 2022-06-07

Similar Documents

Publication Publication Date Title
EP3621036A1 (en) Method and apparatus for generating three-dimensional data, device, and storage medium
JP4191080B2 (ja) 計測装置
CN113370221B (zh) 机器人tcp标定系统、方法、装置、设备及存储介质
EP4393655A1 (en) Coordinate system calibration method, apparatus and system for robot, and medium
CN114952856A (zh) 机械臂手眼标定方法、系统、计算机及可读存储介质
CN108627178A (zh) 机器人手眼标定方法和系统
WO2020047713A1 (en) Method and apparatus for managing robot system
CN115284279B (zh) 一种基于混叠工件的机械臂抓取方法、装置及可读介质
CN114098980B (zh) 相机位姿调整方法、空间注册方法、系统和存储介质
CN114596260B (zh) 一种输电导线断点坐标获取方法、装置、设备及存储介质
CN117428791B (zh) 一种用于肩部四轴康复机器人的逆运动学求解方法及系统
CN114193444A (zh) 一种机器人手眼标定方法、系统、设备及介质
US20100070243A1 (en) Wire Harness Unfolding
WO2025060849A1 (zh) 全向测量设备系统装置、配准方法、电子设备和存储介质
CN113963069A (zh) 一种跳线与铁塔间的测距方法、系统、计算机及存储介质
CN110827337B (zh) 确定车载相机的姿态的方法、装置和电子设备
CN110853098A (zh) 机器人定位方法、装置、设备及存储介质
CN117140517A (zh) 一种高精度的机械臂自动手眼标定方法及系统
CN110675445B (zh) 一种视觉定位方法、装置及存储介质
CN115063489A (zh) 一种外参标定方法、装置、设备和存储介质
CN110842917B (zh) 串并联机械的机械参数的标定方法、电子装置及存储介质
CN114170323A (zh) 图像拍摄装置的参数标定方法、设备及存储介质
CN117405027B (zh) 一种基于单目相机的测距方法及终端
CN115570562B (zh) 机器人装配位姿确定方法、装置、机器人及存储介质
CN119478044A (zh) 基于视觉特征匹配的虚实映射方法、介质、设备及装置

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant