CN105652872A - 变电站激光导航巡检机器人智能云台自动跟踪定位方法 - Google Patents
变电站激光导航巡检机器人智能云台自动跟踪定位方法 Download PDFInfo
- Publication number
- CN105652872A CN105652872A CN201610107530.5A CN201610107530A CN105652872A CN 105652872 A CN105652872 A CN 105652872A CN 201610107530 A CN201610107530 A CN 201610107530A CN 105652872 A CN105652872 A CN 105652872A
- Authority
- CN
- China
- Prior art keywords
- robot
- cloud terrace
- coordinate
- crusing robot
- coordinates
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 30
- 238000006243 chemical reaction Methods 0.000 claims description 7
- 230000004888 barrier function Effects 0.000 claims description 4
- 230000007613 environmental effect Effects 0.000 claims description 4
- 238000012423 maintenance Methods 0.000 claims description 3
- 238000007598 dipping method Methods 0.000 claims description 2
- 238000012544 monitoring process Methods 0.000 abstract description 4
- 238000010586 diagram Methods 0.000 description 4
- 230000000694 effects Effects 0.000 description 3
- 238000007689 inspection Methods 0.000 description 2
- 238000012546 transfer Methods 0.000 description 2
- 230000002411 adverse Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000003384 imaging method Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000001105 regulatory effect Effects 0.000 description 1
- 230000011664 signaling Effects 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
- G05D1/0248—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means in combination with a laser
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Multimedia (AREA)
- Electromagnetism (AREA)
- Optics & Photonics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Length Measuring Devices By Optical Means (AREA)
Abstract
本发明属于变电站巡视监测设备领域,具体涉及一种变电站激光导航巡检机器人智能云台自动跟踪定位方法,包括观测站,巡检机器人,巡检机器人上安装有智能云台,智能云台能够监拍,所述该方法的具体步骤为:1、设定坐标原点和各个被观测仪表的坐标;2、巡检机器人计算自身实时坐标,并推算出智能云台的坐标;3、智能云台根据被测目标的坐标自动导航到目标位置(U,V,W);4、利用公式<maths num="0001"></maths>分别计算云台水平转动角度P、垂直转动角度T、镜头放大倍率Z;5、抓取仪表图像并把图像实时传回观测站。本发明提出的巡检机器人自动巡检仪表的方法,摒弃了传统的示教方法,增强了巡检机器人巡检过程中更加智能和自主的能力,大大提高了机器人的工作效率和准确性,对后期仪表识别环节有很大的帮助。
Description
技术领域
本发明属于变电站巡视监测设备领域,具体涉及一种变电站激光导航巡检机器人智能云台自动跟踪定位方法。
背景技术
随着科技进步和电力体制改革的不断深入和发展,电力系统自动化程度已有了很大提高,许多变电站实现了遥测、遥信、遥控、遥调功能,为少人或无人值班变电站,但一定程度上都还存在因无人在现场及时监视、巡视而带来的一系列问题甚至留下隐患。为此,中国专利号zL200420040968.9,名称为“变配电设备巡检机器人”的专利中提出了一种采用机器人自动巡检变电站中变配电设备运行状况的技术方案。该方案采用GPS全球定位系统和激光测距传感器组成导航信息传递单元,但在变电站强电磁环境中,该导航信息传递单元中的GPS设备易受变电站内强电磁场干扰,导致其导航定位精度降低甚至失效,影响机器人完成巡检工作质量。
目前,巡检机器人在变电站等恶劣环境下发挥了巨大的作用,为保证巡检机器人顺利完成日常仪表巡检任务,需在巡检机器人巡检过程中,设置若干测站,并在测站位置对周围仪表进行检测,准确抓取仪表图像,再实时监测仪表表值是否正常。
基于激光导航的巡检机器人依托激光作为感知外部环境的传感器,在ROS操作系统下对机器人进行实时监控,机器人实时运行过程中,可进行实时自定位,实时反馈位置坐标(X,Y,Z)和方向Yaw(Yaw为机器人与y轴的夹角,顺时针方向,范围为(-π,π))信息。
云台控制参数:P,水平转动角(顺时针旋转,范围[0,2π));
T,垂直转动角(俯为正仰为负,范围
Z,放大倍率(范围[0,160])。
坐标系:机器人坐标系,ROS中主要有两种坐标系:
(1)固定坐标系:用于表示世界的参考坐标系;
(2)目标坐标系:相对于摄像机视角的参考坐标系。
但是,需要手工示教,所谓手工示教即在每个巡检机器人停靠点,手动旋转云台,使仪表位于图像中心,当仪表在视野中大小合适并清晰成像时,将此时云台参数作为预置位存储其P,T,Z值。示教过程步骤繁琐,工作量大,人为影响因子较大,需在每个巡检点对所有仪表进行观测,记录每个仪表此时云台的P、T、Z参数,也就是一个仪表在多个巡检点上时需要重复示教多次。
发明内容
本发明针对现有技术存在示教过程步骤繁琐,工作量大,人为影响因子较大,需在每个巡检点对所有仪表进行观测,记录每个仪表此时云台的P、T、Z参数,也就是一个仪表在多个巡检点上时需要重复示教多次等问题,提出一种电站激光导航巡检机器人智能云台自动跟踪定位方法。
本发明的技术方案是:变电站激光导航巡检机器人智能云台自动跟踪定位方法,包括观测站,巡检机器人,巡检机器人上安装有智能云台,智能云台能够监拍,所述该方法的具体步骤为:
步骤一:建立坐标系,设定坐标原点和测量出被观测仪表的三维坐标;
步骤二:巡检机器人计算自身实时坐标(X,Y,Z),并推算出智能云台的坐标;
步骤三:智能云台根据被测目标的坐标自动导航到测站位置(U,V,W);
步骤四:利用公式计算云台水平转动角度P,利用公式 计算云台垂直转动角度T,利用公式 计算云台镜头放大倍率Z,其中,Z0为云台倍率系数;
步骤五:根据所解算出的P/T/Z数据,自动控制云台旋转观测目标仪表,并把图像实时传回观测站。
所述的变电站激光导航巡检机器人智能云台自动跟踪定位方法,所述步骤一具体为:建立一个坐标系,设定坐标系原点,手工测量出被观测仪表的三维坐标,并且储存在巡检机器人的数据库中。
所述的变电站激光导航巡检机器人智能云台自动跟踪定位方法,所述步骤二中,巡检机器人利用激光导航传感器首先检测其所处环境中的障碍物,并实时记录环境信息,再通过周围环境信息计算得到机器人自身二维平面空间中的位置和航向,再经过转换后就得到机器人导航所需位置(x,y,z)及航向数据(yaw)。
所述的变电站激光导航巡检机器人智能云台自动跟踪定位方法,所述步骤四具体为:已知机器人实时位置坐标(X,Y,Z),以及机器人方向Yaw,经过坐标转换,换算出云台中心位置坐标(X云,Y云,Z云),保持云台零位方向与机器人方向保持一致;再从数据库中实时读取仪表坐标(u,v,w),利用以下公式进行计算:
云台水平转角:
云台垂直转角:
云台缩放倍率:其中,Z0为云台倍率系数。
本发明的有益效果是:本发明提出的基于激光传感器的巡检机器人自动巡检仪表的方法,摒弃了传统的示教方法,增强了巡检机器人巡检过程中更加智能和自主的能力,大大提高了机器人的工作效率和准确性,对后期仪表识别环节有很大的帮助。激光传感器固定于机器人前部,其安装位置相对于机器人底盘位置固定。当机器人运行时,激光导航传感器首先检测其所处环境中的障碍物,并实时记录环境信息,再通过周围环境信息计算得到机器人自身二维平面空间中的位置和航向,再经过转换后就得到机器人导航所需位置(x,y,z)及航向数据(yaw),极大的提高了巡视效率。
附图说明
图1为坐标系定义规则示意图;
图2为云台水平转角示意图;
图3为云台竖直转角示意图;
图4为方法路程图。
具体实施方式
实施例1:结合图1-图4,一种变电站激光导航巡检机器人智能云台自动跟踪定位方法,包括观测站,巡检机器人,巡检机器人上安装有智能云台,智能云台能够监拍,所述该方法的具体步骤为:
步骤一:建立坐标系,设定坐标原点和测量出被观测仪表的三维坐标;建立一个坐标系,确定坐标系原点,确定各个仪器的坐标,并且储存在巡检机器人的数据库中;由于以机器人后轮轮轴中心为坐标原点定义坐标系,激光反馈数据经计算得出的为机器人轮轴中心的坐标,由于云台并非安装在坐标原点位置,需对云台坐标进行转换。X云=X机+ΔX,Y云=Y机+DY,Z云=Z机+ΔZ,其中云指云台位置,机指机器人。
步骤二:巡检机器人计算自身实时坐标(X,Y,Z),并推算出智能云台的坐标;巡检机器人利用激光导航传感器首先检测其所处环境中的障碍物,并实时记录环境信息,再通过周围环境信息计算得到机器人自身二维平面空间中的位置和航向,再经过转换后就得到机器人导航所需位置(x,y,z)及航向数据(yaw)。
步骤三:智能云台根据被测目标的坐标自动导航到测站位置(U,V,W);步骤四:利用公式计算云台水平转动角度P,利用公式 计算云台垂直转动角度T,利用公式 计算云台镜头放大倍率Z,Z0为云台倍率系数;其中,已知机器人实时位置坐标(X,Y,Z),以及机器人方向Yaw,经过坐标转换,换算出云台中心位置坐标(X云,Y云,Z云),保持云台零位方向与机器人方向保持一致;再从数据库中实时读取仪表坐标(u,v,w),利用以下公式进行计算:
云台水平转角:
云台垂直转角:
云台缩放倍率:其中,Z0为云台倍率系数。
步骤五:根据所解算出的P/T/Z数据,自动控制云台旋转观测目标仪表,并把图像实时传回观测站。
Claims (4)
1.变电站激光导航巡检机器人智能云台自动跟踪定位方法,包括观测站,巡检机器人,巡检机器人上安装有智能云台,智能云台能够监拍,其特征在于:
所述该方法的具体步骤为:
步骤一:建立坐标系,设定坐标原点和测量出被观测仪表的三维坐标;
步骤二:巡检机器人计算自身实时坐标(X,Y,Z),并推算出智能云台的坐标;
步骤三:智能云台根据被测目标的坐标自动导航到测站位置(U,V,W);
步骤四:利用公式计算云台水平转动角度P,利用公式计算云台垂直转动角度T,利用公式计算云台镜头放大倍率Z,其中,Z0为云台倍率系数;
步骤五:根据所解算出的P/T/Z数据,自动控制云台旋转观测目标仪表,并把图像实时传回观测站。
2.根据权利要求1所述的变电站激光导航巡检机器人智能云台自动跟踪定位方法,其特征在于:所述步骤一具体为:建立一个坐标系,设定坐标系原点,手工测量出被观测仪表的三维坐标,并且储存在巡检机器人的数据库中。
3.根据权利要求1所述的变电站激光导航巡检机器人智能云台自动跟踪定位方法,其特征在于:所述步骤二中,巡检机器人利用激光导航传感器首先检测其所处环境中的障碍物,并实时记录环境信息,再通过周围环境信息计算得到机器人自身二维平面空间中的位置和航向,再经过转换后就得到机器人导航所需位置(x,y,z)及航向数据(yaw)。
4.根据权利要求1所述的变电站激光导航巡检机器人智能云台自动跟踪定位方法,其特征在于:所述步骤四具体为:已知机器人实时位置坐标(X,Y,Z),以及机器人方向Yaw,经过坐标转换,换算出云台中心位置坐标(X云,Y云,Z云),保持云台零位方向与机器人方向保持一致;再从数据库中实时读取仪表坐标(u,v,w),利用以下公式进行计算:
云台水平转角:
云台垂直转角:
云台缩放倍率:其中,Z0为云台倍率系数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610107530.5A CN105652872B (zh) | 2016-02-26 | 2016-02-26 | 变电站激光导航巡检机器人智能云台自动跟踪定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610107530.5A CN105652872B (zh) | 2016-02-26 | 2016-02-26 | 变电站激光导航巡检机器人智能云台自动跟踪定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105652872A true CN105652872A (zh) | 2016-06-08 |
CN105652872B CN105652872B (zh) | 2018-07-31 |
Family
ID=56489827
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610107530.5A Active CN105652872B (zh) | 2016-02-26 | 2016-02-26 | 变电站激光导航巡检机器人智能云台自动跟踪定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105652872B (zh) |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108614482A (zh) * | 2018-05-07 | 2018-10-02 | 哈工大(张家口)工业技术研究院 | 一种基于bim、gis和iot的地下管廊信息系统 |
CN109115204A (zh) * | 2018-09-30 | 2019-01-01 | 四川福德机器人股份有限公司 | 一种用于导航车的精定位系统和方法 |
CN109739239A (zh) * | 2019-01-21 | 2019-05-10 | 天津迦自机器人科技有限公司 | 一种用于巡检机器人的不间断仪表识别的规划方法 |
CN109946564A (zh) * | 2019-03-15 | 2019-06-28 | 山东鲁能智能技术有限公司 | 一种配网架空线路巡检数据采集方法及巡检系统 |
CN111113394A (zh) * | 2019-12-19 | 2020-05-08 | 珠海格力电器股份有限公司 | 机械手定位方法 |
CN111540077A (zh) * | 2020-05-12 | 2020-08-14 | 中国电建集团福建省电力勘测设计院有限公司 | 基于三维模型坐标定位的换流站阀厅移动式智能巡检方法 |
CN112113150A (zh) * | 2020-08-11 | 2020-12-22 | 苏州辰航致远智能科技有限公司 | 一种基于5g通信的管道检测系统及其远程控制方法 |
CN112833338A (zh) * | 2021-01-26 | 2021-05-25 | 武汉阿卡瑞思光电自控有限公司 | 一种基于实景三维的油气场站泄漏监测方法及系统 |
CN114598816A (zh) * | 2022-03-04 | 2022-06-07 | 深圳市千乘机器人有限公司 | 一种用于巡检机器人采集目标物图像的方法 |
CN115355993A (zh) * | 2022-10-19 | 2022-11-18 | 成都诺比侃科技有限公司 | 一种变电站设备智能检测方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8019506B2 (en) * | 2005-08-18 | 2011-09-13 | Sauer-Danfoss Aps | Method of calibrating and steering a vehicle provided with a positioning system |
CN102221831A (zh) * | 2011-04-20 | 2011-10-19 | 福建省电力有限公司福州电业局 | 可移动式远程遥控视觉机器巡检系统 |
CN102591366A (zh) * | 2012-02-17 | 2012-07-18 | 广州盈可视电子科技有限公司 | 一种云台控制的方法及装置 |
CN102722166A (zh) * | 2012-06-29 | 2012-10-10 | 山东电力集团公司电力科学研究院 | 变电站设备智能视觉检测系统及状态检测方法 |
CN102999051A (zh) * | 2011-09-19 | 2013-03-27 | 广州盈可视电子科技有限公司 | 一种云台控制的方法及装置 |
CN103905792A (zh) * | 2014-03-26 | 2014-07-02 | 武汉烽火众智数字技术有限责任公司 | 一种基于ptz监控摄像机的3d定位方法及装置 |
-
2016
- 2016-02-26 CN CN201610107530.5A patent/CN105652872B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8019506B2 (en) * | 2005-08-18 | 2011-09-13 | Sauer-Danfoss Aps | Method of calibrating and steering a vehicle provided with a positioning system |
CN102221831A (zh) * | 2011-04-20 | 2011-10-19 | 福建省电力有限公司福州电业局 | 可移动式远程遥控视觉机器巡检系统 |
CN102999051A (zh) * | 2011-09-19 | 2013-03-27 | 广州盈可视电子科技有限公司 | 一种云台控制的方法及装置 |
CN102591366A (zh) * | 2012-02-17 | 2012-07-18 | 广州盈可视电子科技有限公司 | 一种云台控制的方法及装置 |
CN102722166A (zh) * | 2012-06-29 | 2012-10-10 | 山东电力集团公司电力科学研究院 | 变电站设备智能视觉检测系统及状态检测方法 |
CN103905792A (zh) * | 2014-03-26 | 2014-07-02 | 武汉烽火众智数字技术有限责任公司 | 一种基于ptz监控摄像机的3d定位方法及装置 |
Non-Patent Citations (1)
Title |
---|
陈双叶等: "PTZ摄像机跟踪运动目标的智能控制算法的研究", 《计算机科学》 * |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108614482A (zh) * | 2018-05-07 | 2018-10-02 | 哈工大(张家口)工业技术研究院 | 一种基于bim、gis和iot的地下管廊信息系统 |
CN109115204A (zh) * | 2018-09-30 | 2019-01-01 | 四川福德机器人股份有限公司 | 一种用于导航车的精定位系统和方法 |
CN109115204B (zh) * | 2018-09-30 | 2024-04-02 | 四川福德机器人股份有限公司 | 一种用于导航车的精定位系统和方法 |
CN109739239A (zh) * | 2019-01-21 | 2019-05-10 | 天津迦自机器人科技有限公司 | 一种用于巡检机器人的不间断仪表识别的规划方法 |
CN109946564A (zh) * | 2019-03-15 | 2019-06-28 | 山东鲁能智能技术有限公司 | 一种配网架空线路巡检数据采集方法及巡检系统 |
CN111113394A (zh) * | 2019-12-19 | 2020-05-08 | 珠海格力电器股份有限公司 | 机械手定位方法 |
CN111540077A (zh) * | 2020-05-12 | 2020-08-14 | 中国电建集团福建省电力勘测设计院有限公司 | 基于三维模型坐标定位的换流站阀厅移动式智能巡检方法 |
CN111540077B (zh) * | 2020-05-12 | 2022-04-19 | 中国电建集团福建省电力勘测设计院有限公司 | 基于三维模型坐标定位的换流站阀厅移动式智能巡检方法 |
CN112113150A (zh) * | 2020-08-11 | 2020-12-22 | 苏州辰航致远智能科技有限公司 | 一种基于5g通信的管道检测系统及其远程控制方法 |
CN112833338A (zh) * | 2021-01-26 | 2021-05-25 | 武汉阿卡瑞思光电自控有限公司 | 一种基于实景三维的油气场站泄漏监测方法及系统 |
CN114598816A (zh) * | 2022-03-04 | 2022-06-07 | 深圳市千乘机器人有限公司 | 一种用于巡检机器人采集目标物图像的方法 |
CN115355993A (zh) * | 2022-10-19 | 2022-11-18 | 成都诺比侃科技有限公司 | 一种变电站设备智能检测方法 |
Also Published As
Publication number | Publication date |
---|---|
CN105652872B (zh) | 2018-07-31 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105652872A (zh) | 变电站激光导航巡检机器人智能云台自动跟踪定位方法 | |
CN107042511A (zh) | 基于视觉反馈的巡视机器人云台调整方法 | |
CN110246175A (zh) | 全景相机与云台相机结合的变电站巡检机器人图像检测系统及方法 | |
CN104184995A (zh) | 一种实现联网视频监控系统实时联动监控的方法及系统 | |
CN104842362A (zh) | 一种机器人抓取物料包的方法和机器人抓取装置 | |
CN105551032B (zh) | 一种基于视觉伺服的杆塔图像采集系统及其方法 | |
CN104793637B (zh) | 一种移动设备的实时跟踪系统及跟踪方法 | |
CN111220120B (zh) | 一种动平台双目测距自校准方法及装置 | |
CN103148832B (zh) | 摄像机安装倾角的检测方法 | |
CN102353355A (zh) | 一种基于视频差异的输电线路杆塔倾斜的测量方法 | |
CN106403900B (zh) | 飞行物追踪定位系统及方法 | |
US10655291B2 (en) | Real-time monitoring system for float-over installation | |
CN107509055A (zh) | 一种旋转式全景焦点识别光电跟踪仪及其实施方法 | |
CN113900436B (zh) | 巡检控制方法、装置、设备和存储介质 | |
CN113177918B (zh) | 一种无人机对电力杆塔的智能精准巡检方法及系统 | |
CN104410839A (zh) | 一种移动式输电线杆塔区域山火与山体滑坡灾害在线监测系统与监测方法 | |
CN102980517A (zh) | 一种监控测量方法 | |
CN105607652A (zh) | 一种变电站巡检机器人检测目标自动定位装置 | |
CN203397213U (zh) | 一种发电厂巡检装置及系统 | |
CN113240747A (zh) | 一种基于计算机视觉的户外结构振动位移自动化监测方法 | |
CN113246787A (zh) | 一种新能源汽车电池定位方法及装置 | |
CN114071008A (zh) | 一种图像采集装置和图像采集方法 | |
CN210036886U (zh) | 一种基于co2激光与热像仪的高炉料面三维检测装置 | |
CN115019254A (zh) | 一种输电区域异物入侵检测方法、装置、终端及存储介质 | |
CN114862809A (zh) | 一种基于移动终端与图像处理的振动监测方法和装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
TR01 | Transfer of patent right | ||
TR01 | Transfer of patent right |
Effective date of registration: 20190620 Address after: Room F-3 on the fifth floor of incubator skirt building No.1, Jinan Innovation Valley, Jinan Hi-tech Zone, Jinan City, Shandong Province Patentee after: Shandong Jinhui Tatsu Intelligent Manufacturing Technology Co. Ltd. Address before: 450000 Flame Building B, Block 3, 8 Guohuai Street, Zhengzhou High-tech Development Zone, Henan Province Patentee before: Zhengzhou Jinhui Computer System Engineering Co., Ltd. |