CN108598990A - 一种基于力反馈主从控制技术的带电作业机器人架空地线更换修补方法 - Google Patents
一种基于力反馈主从控制技术的带电作业机器人架空地线更换修补方法 Download PDFInfo
- Publication number
- CN108598990A CN108598990A CN201810319663.8A CN201810319663A CN108598990A CN 108598990 A CN108598990 A CN 108598990A CN 201810319663 A CN201810319663 A CN 201810319663A CN 108598990 A CN108598990 A CN 108598990A
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- main manipulator
- data
- arm
- manipulator
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Classifications
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02G—INSTALLATION OF ELECTRIC CABLES OR LINES, OR OF COMBINED OPTICAL AND ELECTRIC CABLES OR LINES
- H02G1/00—Methods or apparatus specially adapted for installing, maintaining, repairing or dismantling electric cables or lines
- H02G1/02—Methods or apparatus specially adapted for installing, maintaining, repairing or dismantling electric cables or lines for overhead lines or cables
Landscapes
- Manipulator (AREA)
Abstract
本发明提出一种基于力反馈主从控制技术的带电作业机器人架空地线更换修补方法。机械臂、主操作手以及工控机构成力反馈主从控制系统,工控机根据机械臂末端受力数据,计算出主操作手各个关节的扭矩数据,通过主操作手的控制接口,控制主操作手各关节输出扭矩,使主操作手反馈受力,操作人员根据主操作手的反馈受力确认机械臂的力度;操作人员改变主操作末端位姿,工控机根据主操作手各旋转关节的角度数据,计算出机械臂末端速度矢量的期望值,通过机械臂的控制接口,按照所述期望值控制机械臂运动,以改变机械臂的力度。本发明提高了作业临场感,可以更加精准地判断各项操作是否精准到位。
Description
技术领域
本发明属于电力技术领域,具体涉及一种基于力反馈主从控制技术的带电作业机器人架空地线更换修补方法。
背景技术
输电线路的架空地线在运行过程中,由于地线质量、雷击、外力破坏等多种原因常常会发生断股现象,断股后的地线在张力及扭力作用下发生散股。散股后的地线给线路安全运行带来了极为不利的影响,一是与带电导线之间的安全距离满足不了线路运行的设计要求;二是如不及时处理极有可能发生线路接地事故,造成线路被迫停运。
目前,国内处理断股架空地线主要有三种方法:(1)作业人员在线路带电运行情况下,使用飞车或滑车沿地线进入断股处进行处理。但系统内老旧线路架空地线线径普遍为50平方毫米,而根据电力安全工作规程,地线钢绞线承受人员攀登作业的最小截面是50平方毫米,当发生断股后是不允许攀登作业的,所以这种方法不适用于50平方毫米及以下地线;(2)采用绝缘直梯作业法,作业人员沿绝缘直梯到断股点进行处理,但这种方法劳动强度大且受到的限制太多,如地形、地势、地线高度、天气等,开展难度比较大;(3)线路被迫停运将地线放至地面进行处理,这样既造成了线路停电,又给电网的可靠运行带来很大的威胁,但是人工的导线带电修补,作业人员将在高压带电线路附近作业,具有一定的安全隐患。
作业人员可以通过主操作手远程遥控机器人的带电作业机器人,可保证作业人员与高压电场隔离;远程遥控操作时,操作人员根据作业场景监控系统监控作业过程,对机器臂与作业对象之间、机械臂之间、作业对象与作业环境之间的相对位置的判断更精确,且不会存在视觉死角,操作精度更高,可以防止碰撞发生,提高了作业安全性。但是,在使用前述带电作业机器人进行精确定位的带电操作时,例如拆接隔离刀闸、跌落式熔断器及避雷器两端导线等,主要通过观察作业环境图像(包括实时图像和3D建模图像)来判断机械臂是否操作到位,对于机械臂与操作对象之间以及机械臂与机械臂之间接触力度大小并无感知,难以判断操作精度是否符合操作要求。如果操作人员或者控制系统能够感知机械臂与操作对象之间以及机械臂与机械臂之间接触力度大小,则可以更加精准地判断各项操作是否精准到位。
由于力反馈主手能够同时实现多个自由度的位置控制与力反馈,把力反馈主手应用到带电作业机器人主从控制的需求非常强烈。
发明内容
本发明解决的技术问题是,提出一种基于力反馈主从控制的带电作业机器人支接引线搭接方法,提高了作业临场感,可以更加精准地判断各项操作是否精准到位。
为了解决上述技术问题,本发明提供一种基于力反馈主从控制的带电作业机器人架空地线更换修补方法,带电作业机器人具有设置在机器人平台上的机械臂,包括第一机械臂、第二机械臂以及辅助机械臂,第一机械臂、第二机械臂以及辅助机械臂完成以下工作:
辅助机械臂使用夹持工具夹持地线线卡;第一机械臂和第二机械臂将线卡的槽口卡入架空地线;
辅助机械臂夹持安装器;第一机械臂和第二机械臂移动至专用工具上方,并夹持一根绝缘操作绳,然后将根绝缘固定在安装器的操作手柄上,并使绝缘操作绳垂至地面;
辅助机械臂夹持牵引器,第一机械臂和第二机械臂打开牵引器上的两片半圆形钢管并将架空地线套住,再从牵引器上的牵引孔固定另外一根绝缘牵引绳至地面;第一机械臂和第二机械臂移动至专用工具上方,夹持固定销子,然后固定住钢管;
第一机械臂和第二机械臂从牵引器上的牵引孔固定另外一根绝缘牵引绳至地面,第一机械臂和第二机械臂将安装器上的固定孔和牵引器上的固定孔用连接绳进行连接;
辅助机械臂拉动绝缘牵引绳带动牵引器,牵引器同时推动地线线夹和安装器一同沿地线开始滑动,当整套装置滑动至架空地线断股点附近位置处时停止牵引;
第一机械臂和第二机械臂拉下安装器上的绝缘操作绳,绝缘操作绳带动安装器操作手柄上的顶针下落,此时原先由顶针压缩的线卡上的弹簧储能释放,地线线卡卡住断股地线;当起连接作用的顶针下落时,安装器与地线线卡自动脱离;安装器上有一带滑轮的返回装置,当安装器与线卡脱离后,返回装置上的滑轮自动落在架空地线上;
辅助机械臂通过拉动牵引器上绝缘牵引绳,牵引绳带动牵引器以及与之用固定绳相连的安装器一同滑行,直至将牵引器和安装器一道牵引至杆塔处;
第一机械臂和第二机械臂拆除牵引器、安装器、绝缘牵引绳、绝缘操作绳、固定绳,并夹持各部件放回专用工具箱;
在上述过程中,工控机根据机械臂末端受力数据,计算出主操作手各个关节的扭矩数据,通过主操作手的控制接口,控制主操作手各关节输出扭矩,使主操作手反馈受力,操作人员根据主操作手的反馈受力确认机械臂的力度;
在上述过程中,操作人员改变主操作末端位姿,工控机根据主操作手各旋转关节的角度数据,计算出机械臂末端速度矢量的期望值,通过机械臂的控制接口,按照所述期望值控制机械臂运动。
进一步,所述机械臂末端受力数据由安装在机械臂末端的六自由度力/力矩传感器采集获得,其标量为六自由度力/力矩数据。
进一步,所述械臂末端受力数据的标量为六自由度力/力矩数据,其由工控机根据机械臂的末端位姿数据和末端速度数据,使用基于虚拟现实技术计算获得,具体过程为:
步骤1,运用八分法对机械臂作业场景对应的虚拟现实场景进行逐步划分,构建八叉树;
步骤2,获取机械臂末端位姿数据,以该末端位姿数据为球心,创建包围球,设置包围球的半径为所需碰撞检测的距离;
步骤3,对步骤2的包围球与步骤1的八叉树进行碰撞检测,若没有发生碰撞,则机械臂末端的六自由度力/力矩数据为零,若发生碰撞,则获取虚拟现实场景中发生碰撞的数据点,根据发生碰撞的数据点坐标与机械臂末端位姿数据,计算碰撞深度矢量;
步骤4,根据碰撞深度矢量计算机械臂末端六自由度力/力矩数据,即采用弹簧阻尼模型计算反馈力,
F=-kx-cv
其中,k为弹簧系数,x为碰撞深度矢量,c为阻尼系数,v为机械臂末端速度矢量,F为反馈力,其标量为六自由度力/力矩数据。
进一步,对主操作手静力学建模,得到机械臂末端六自由度力/力矩数据到主操作手各个关节扭矩数据的转换关系,工控机根据所述转换关系计算出主操作手各个关节的扭矩数据。
进一步,获取机械臂末端速度矢量期望值的方法为:运用D-H建模方法对主操作手建模,得出主操作手的各个旋转关节的角度数据到主操作手末端位姿数据的转换关系;工控机接收主操作手发送的各个旋转关节的角度数据,根据所述转换关系计算得到主操作手末端位姿数据,然后将主操作手末端位姿数据通过微分运算得到主操作手末端速度数据;根据主操作手末端位姿数据和末端速度数据,使用速度前馈PID控制器,计算得到机械臂末端速度矢量期望值。
进一步,在作业前,第一机械臂和第二机械臂端部安装夹持工具,用夹持工具夹持绝缘遮蔽材料对标记的带电体进行绝缘遮蔽;在作业完毕后,第一机械臂和第二机械臂端部安装夹持工具,用夹持工具清除覆盖在带电体上的绝缘遮蔽材料。
进一步,主操作手包括第一主操作手、第二主操作手和辅助主操作手;第一主操作手、第二主操作手和辅助主操作手分别与第一机械臂、第二机械臂和辅助机械臂对应,构成主从操作关系。
进一步,所述绝缘斗臂车上设置有控制室,所述数据处理和控制系统包括工控机、显示屏和主操作手,工控机内置图像处理器,显示屏和主操作手位于控制室内;机器人平台上设置有摄像机,所述摄像机采集的作业场景图像发送给工控机,图像处理器对作业场景图像进行处理后获的3D虚拟作业场景,并送显示器显示。
本发明与现有技术相比,其显著优点在于:
(1)操作人员通过操控主操作手的末端,带电作业机械臂的末端能够跟随主操作手末端的姿态,操作人员看到的主操作手的姿态也是带电作业机械臂的姿态,这使得操作直观、灵活;
(2)力反馈功能的引入使得遥操作不再是单一的姿态给定,操作人员能够感受带电作业机械臂与环境的接触力,拥有更好的操作临场感,从而提高操作机械臂的便捷性和精确度;另外,通过力觉反馈能够发现机械臂与环境的碰撞,从而减小危险的发生,弥补仅靠视觉操作的不足;
(3)本发明通过构建好的虚拟现实场景,运用碰撞检测技术,在机械臂碰撞前输出反馈力,使得操作人员感受到反馈力,从而限制操作人员的操作行为,提高系统的安全性;本发明进一步为了避免主从操作导致机械臂与高压带电设备碰撞,通过力反馈的方式提醒与限制操作人员进一步操作。
(4)本发明整体上提高了机器人作业的自动化和作业精度,同时提高了作业安全性。
附图说明
图1为本发明带电作业机器人一种实施例的整体结构示意图。
图2为本发明中绝缘斗臂车的系统组成框图。
图3为本发明中机器人平台的结构示意图。
图4为本发明中机械臂的结构示意图。
图5是本发明方法流程图。
图6是本发明中的安装器示意图;
图7是本发明中的地线线卡示意图;
图8是本发明中的牵引器示意图。
图9为本发明中力反馈主从控制系统的框图;
图10为本发明中机械臂位姿闭环控制器的框图;
图11是本发明中基于虚拟现实技术的反馈力计算方法示意图。
具体实施方式
容易理解,依据本发明的技术方案,在不变更本发明的实质精神的情况下,本领域的一般技术人员可以想象出基于力反馈主从控制技术的带电作业机器人架空地线更换修补方法的多种实施方式。因此,以下具体实施方式和附图仅是对本发明的技术方案的示例性说明,而不应当视为本发明的全部或者视为对本发明技术方案的限制或限定。
结合附图,带电作业机器人包括绝缘斗臂车1、控制室2、伸缩臂3、机器人平台4。其中,绝缘斗臂车1上架设控制室2和伸缩臂3,伸缩臂3末端连接机器人平台4,机器人平台4与控制室2之间采用光纤以太网通信或者无线网络通信。
绝缘斗臂车1可供操作人员驾驶,从而将机器人平台4运输到作业现场。绝缘斗臂车1上装有支撑腿,支撑腿可以展开,从而将绝缘斗臂车1与地面稳固支撑。绝缘斗臂车1上装有发电机,从而给控制室2及伸缩臂3供电。
伸缩臂3设有沿伸缩方向的驱动装置,操作人员可以通过控制驱动装置,从而将机器人平台4升降到作业高度。该伸缩臂3由绝缘材料制成,用于实现机器人平台4与控制室2的绝缘。在本发明中,伸缩臂3可有由剪叉式升降机构或其他机构代替。
作为一种实施方式,控制室2中设置有第二工控机、显示屏、第一主操作手、第二主操作手、辅助主操作手以及通信模块等。
作为一种实施方式,机器人平台4包括绝缘子46、第一机械臂43、第二机械臂44、辅助机械臂42、第一工控机48、双目摄像头45、全景摄像头41、深度摄像头410、蓄电池49、专用工具箱47、通信模块。
机器人平台4的绝缘子46用于支撑第一机械臂43、第二机械臂44、辅助机械臂42,将这三个机械臂的外壳与机器人平台4绝缘。
蓄电池49为第一工控机48、第一机械臂43、第二机械臂44、辅助机械臂42、全景摄像头41、双目摄像头45、深度摄像头410、通信模块供电。
作为一种实施方式,双目摄像头45一共有三个,分别安装在第一机械臂43、第二机械臂44和辅助机械臂42的腕关节437上,负责采集作业场景的图像数据,并将图像数据发送给第二工控机。双目摄像头45由两个光轴平行的工业相机组成,平行光轴之间的距离固定。
深度摄像头410安装在机器人平台4正对作业场景的侧面,负责采集作业场景的景深数据,将景深数据发送给第二工控机。
全景摄像头41通过支架安装在机器人平台4的上方,负责采集作业场景的全景图像数据,将图像数据发送给第二工控机,并显示在显示器上,作业人员可以通过全景图像监控作业场景。
专用工具箱47是放置抓具、扳手等作业工具的场所。机械臂末端安装有工具快换装置。机械臂根据作业任务的类型到专用工具箱47中使用工具快换装置获取作业工具。
控制室2中第一主操作手、第二主操作手以及辅助主操作手是一种用于人工远程操作机械臂的操作装置,他们与第一机械臂43、第二机械臂44和辅助机械臂42构成主从操作关系。机械臂和主操作手具有相同的结构,只是主操作手尺寸规格比机械臂小,以便于操作人员操作。机械臂和主操作手拥有六个关节,每个关节都有光电编码器采集角度数据,各主操作手的微型控制器通过串口将六个关节的角度数据发送给第二工控机。
作为本发明一个实施例,所述机械臂为六自由度机构,包括基座431,旋转轴方向与基座平面垂直的腰关节432,与腰关节432连接的肩关节433,与肩关节433连接的大臂434,与大臂434连接的肘关节435,与肘关节435连接的小臂436,与小臂436连接的腕关节437,腕关节437由三个旋转关节组成,分别为腕俯仰关节、腕摇摆关节和腕旋转关节;所述六自由度机构中各个关节均具有相应的正交旋转编码器31和伺服驱动电机,正交旋转编码器31用于采集各个关节的角度数据,伺服驱动电机用于控制各关节的运动;第一工控机根据所述机械臂的空间路径解算出各关节的运动角度,控制伺服驱动电机按照所述运动角度控制机械臂各关节运动。
作为一种实施方式,机器人平台4与控制室2之间的数据传输通过光纤有线传输,或者使用无线网络传输。机器人平台4上的通信模块是光纤收发器,光纤收发器用于实现光纤中的光信号与双绞线中的电信号的相互转换,从而在通信上实现机器人平台4与控制室2的电气隔离。控制室2中的通信模块是光纤收发器,光纤收发器用于实现光纤中的光信号与双绞线中的电信号的相互转换,从而在通信上实现机器人平台4与控制室2的电气隔离。
作为一种实施方式,第二工控机可以完成以下任务:
建立动作序列库。预先将各项带电作业任务分解为作用序列,组成动作序列库,存储在第二工控机中,用于机械臂路径规划。
建立作业对象模型库。预先制作各项带电作业任务所涉及的作业对象的三维模型和目标识别模型,例如,根据电力塔杆、电线、金属氧化物避雷器、隔离刀闸、避雷器等器件实物,制作三维模型和目标识别模型,用于带电作业机器人自动识别作业对象,构建作业场景三维虚拟场景。
建立机械臂和专用工具模型库。预先制作机械臂和专用工具的三维模型和目标识别模型,例如,扳手等,用于带电作业机器人自动构建作业场景三维虚拟场景,规划机械臂空间路径。
获取图像数据。获取全景图像、深度图像和双目图像的数据信息。
根据图像数据识别和跟踪作业目标。
获取主操作手的角度、角速度和角加速度数据,获取机械臂的角度、角速度和角加速度数据。
对相关图像数据进行处理和计算,获取机械臂位置,获取作业对象的位置,获取机械臂与作业对象之间的相对位置,并根据相对位置和作业任务规划机械臂的空间路径。
根据图像数据构建作业对象三维场景,根据机械臂角度信息和作业对象三维场景获得机械臂与作业对象的相对位置,并根据相对位置和作业任务规划机械臂的空间路径。
对相关图像数据进行处理和计算,构建3D虚拟作业场景,送显示器显示,操作人员根据3D虚拟作业场景监控作业过程。与全景图像相比,3D虚拟作业场景综合和深度图像信息和双目图像信息,对机器臂与作业对象之间、机械臂之间、作业对象与作业环境之间的相对位置的判断更精确,且不会存在视觉死角。因此,操作人员通过3D虚拟作业场景进行作业监控,操作精度更高,可以防止碰撞发生,提高了安全性。同时,3D虚拟作业场景显示在控制室2中的显示器上,远离机械臂作业现场,提高了人作业人员的人身安全。
作为一种实施方式,第一工控机可以完成以下任务:
根据第二工控机发送的主操作手各关节的角度信息,控制机械臂各关节的运动。
获取第二工控机发送的机械臂的空间路径数据,根据作业任务的动作序列,解算出机械臂各关节的角度数据运动量,并控制机械臂各关节运动。
本发明中,第一机械臂和第二机械臂相互配合,可以模仿人的两个手的作业顺序完成带电作业。考虑到灵活性,可以再增加一个强壮的辅助机械臂,此时,辅助机械臂专司器件夹持等力道大的动作,第一机械臂和第二机械臂则进行相关业务操作。
本发明带电作业机器人可以由作业人员进行远程操控主操作手从而使用机械臂完成带电作业。在带电作业机器人在更换、修补架空地线的过程中,会涉及机械臂作业效果的确认工作,例如使用绝缘材料是否防止到位,器件是否固定稳妥、机械臂夹持是否到位、机械臂夹持力度是否过大等,这些需要确认效果的操作,实际上涉及到机械臂与周围环境接触时的力反馈检测,并基于力反馈检测的结果确认操作效果,并进一步调整操作人员对主操作手的控制,即本发明所述的力反馈主从控制。为了实现力反馈主从控制,本发明对现有技术做了一下改进。
在上述带点作业机器人中,主操作手、机械臂和工控机组成带电作业机器人力反馈主从控制系统。
所述主操作手为一个或者多个自由度串联机械臂结构,能够采集每个旋转关节的角度数据,每个旋转关节具备力矩电机,能够输出扭矩,从而实现力反馈功能。作为一种实施方式,可以采用六自由度串联机械臂结构,能够采集六个旋转关节的角度数据,每个旋转关节具备力矩电机,能够输出扭矩,从而实现力反馈功能。
所述机械臂与主操作手相通或者相似,为一个或者多个自由度机械臂结构,能够实时发送机械臂末端位姿数据,机械臂末端安装有六自由度力/力矩传感器,六自由度力/力矩传感器用于采集机械臂与环境接触时产生的六个方向的受力数据。作为一种实施方式,可以采用六自由度机械臂,机械臂末端安装六自由度力/力矩传感器,力/力矩传感器用于采集机械臂与环境接触产生的受力数据。
工控机接收主操作手发送的六个旋转关节的角度数据,根据力反馈主从控制方法,计算出机械臂末端速度矢量的期望值,通过机械臂的控制接口,控制机械臂运动;所述工控机接收机械臂发送的六自由度力/力矩数据,根据力反馈主从控制方法,计算出主操作手六个关节的扭矩数据,通过主操作手的控制接口,控制主操作手输出扭矩。
本发明所述力反馈主从控制包括两个方面,一是机械臂位姿控制方法,即根据主操作手各旋转关节的角度数据,计算出机械臂末端速度矢量的期望值作为控制量,通过机械臂的控制接口,控制机械臂运动;二是主操作手力反馈控制方法,即根据械臂发送的六自由度力/力矩数据,计算出主操作手各个关节的扭矩数据,通过主操作手的控制接口,控制主操作手输出扭矩。
下面以六自由度主操作手和机械臂为例,说明力反馈主从控制过程。
机械臂位姿控制方法,即根据主操作手发送的六个旋转关节的角度数据,实时计算出机械臂末端位置与姿态的控制量,所述控制量为机械臂末端速度矢量。具体地,机械臂位姿控制方法分为以下步骤:
步骤1,主操作手运动学建模,运用D-H建模方法对主操作手建模,得出主操作手的六个旋转关节的角度数据到主操作手末端位姿数据的转换关系。
步骤2,根据步骤1得到的转换关系,工控机接收主操作手发送的六个旋转关节的角度数据,计算得到主操作手末端位姿数据,将主操作手末端位姿数据通过微分运算得到主操作手末端速度数据。
步骤3,设计机械臂位姿闭环控制器,采用速度前馈PID控制器。将步骤2得到的主操作手末端位姿数据和末端速度数据,根据速度前馈PID控制器,计算得到机械臂控制量,即机械臂末端速度矢量,工控机将机械臂末端速度矢量发送给机械臂的控制接口,控制机械臂运动。
主操作手力反馈控制方法,即根据机械臂发送的六自由度力/力矩数据,实时计算出主操作手六个关节的扭矩数据。具体地,主操作手力反馈控制方法分为以下步骤:
步骤1,主操作手静力学建模,运用虚功原理对主操作手静力学建模,得到机械臂末端六自由度力/力矩数据到主操作手六个关节扭矩数据的转换关系。
步骤2,根据步骤1得到的转换关系,工控机接收由六自由度力/力矩传感器采集的机械臂与环境接触时产生的受力数据,计算得到主操作手六个关节的扭矩数据,工控机将扭矩数据发送给主操作手的力反馈控制接口,使主操作手反馈受力。自由度力/力矩传感器采集的机械臂与环境接触时产生的受力数据的标量为六自由度力/力矩数据。
作用另一种实施方式,机械臂与环境接触时产生的受力数据可以不使用六自由度力/力矩传感器采集,而是使用基于虚拟现实技术的反馈力计算方法计算获得。具体过程为:
步骤1,运用八分法对机械臂作业场景对应的虚拟现实场景进行逐步划分,构建八叉树。本步骤进一步分为以下步骤:
步骤1-1,找出虚拟现实场景数据中最小与最大的x坐标值、y坐标值、z坐标值,从而确定包围所有虚拟现实场景数据的最小立方体,将该立方体作为八叉树的根节点;
步骤1-2,对该立方体八等分,形成8个子立方体,作为该立方体的子节点;
步骤1-3,对于每个子立方体,判断其空间内数据的个数。若个数为0,则把该节点的值设置为空,不再继续构造;若个数为1,则把该节点的值置为这个点的坐标,并不再继续构造;若个数大于1,则对该子立方体重复步骤1-2。
步骤1-4,经过以上步骤构造出的八叉树,其每个子节点代表一个数据点或者为空。
步骤2,获取机械臂末端位姿数据,以该末端位姿数据为球心,创建包围球,设置包围球的半径为所需碰撞检测的距离,即判断机械臂与周围环境是否发生接触的最小距离,当机械臂末端与周围环境的距离小于该最小距离时,视为机械臂与周围环境发生了接触或者碰撞。
步骤3,对步骤2的包围球与步骤1的八叉树进行碰撞检测,若没有发生碰撞,那么机械臂的六自由度力/力矩数据为零,若发生碰撞,得到虚拟现实场景中发生碰撞的数据点,根据发生碰撞的数据点坐标与机械臂末端位姿数据,计算碰撞深度矢量。
步骤4,根据碰撞深度矢量计算机械臂末端六自由度力/力矩数据,即采用弹簧阻尼模型计算反馈力,该反馈力F为六维矢量,其标量为机械臂末端六自由度力/力矩数据。
F=-kx-cv
其中,k为弹簧系数,x为碰撞深度矢量,c为阻尼系数,v为机械臂末端速度矢量,F为反馈力。
基于前述力反馈主从控制的带电作业机器人架空地线更换修补的过程为:
一、准备阶段
工作人员进行带电作业机器人搭接支接引线的作业准备,检查气象条件、核对杆塔号,在工作现场设置安全护栏、作业标志、和相关警示标志。
绝缘斗臂车驾驶员将绝缘斗臂车1驶入杆塔100附近位置并布置现场。作业位置具体为待作业杆塔100的附近位置并避开附近电力线和障碍物,避免停放在沟道盖板上,绝缘斗臂车1支腿顺序为先伸出水平支腿,再伸出垂直支腿,支撑到位后车辆前后左右呈水平。控制室2内操作人员根据显示器上显示的实景图像,操作操作摇杆控制伸缩臂3,将机器人平台4移动至进入作业位置附近。控制室2内操作人员根据机械臂上双目摄像头45返回的实景图像对作业范围内在绝缘安全距离内的带电体进行标记。
二、作业阶段
第一机械臂43、第二机械臂44以及辅助机械臂42响应于控制数据完成以下工作:
第一机械臂43和第二机械臂44端部安装夹持工具,用夹持工具夹持绝缘遮蔽材料对标记的带电体,例如导线,绝缘子串,横担103进行绝缘遮蔽。绝缘遮蔽材料如绝缘护套、环氧玻璃布等。进行遮蔽后,需要通过力反馈功能确定绝缘遮蔽材料的遮蔽效果,此时,根据主操作手发送的六个旋转关节的角度数据,通过速度前馈PID控制器,计算得到机械臂的控制量,工控机将控制量发送给机械臂的控制接口,控制机械臂触碰遮蔽物,触碰后,根据机械臂与绝缘遮蔽材料接触时产生的受力数据,即机械臂末端的六自由度力/力矩数据计算得到主操作手六个关节的扭矩数据,工控机将扭矩数据发送给主操作手的力反馈控制接口,控制主操作手各关节输出扭矩,使主操作手反馈受力,操作人员根据力反馈的大小确定遮蔽效果。
辅助机械臂42使用夹持工具夹持地线线卡141。夹持过程中,可以根据前述力反馈控制过程,通过机械臂反馈的夹持阻力,使主操作手受力,操作人员根据受力大小,用主操作手调节夹持力度,避免损坏元器件。第一机械臂43和第二机械臂44将线卡的槽口卡入架空地线。
辅助机械臂夹持安装器140,夹持效果可通过上述力反馈过程确定;第一机械臂43和第二机械臂44移动至专用工具47上方,并夹持一根绝缘操作绳,然后将根绝缘固定在安装器140的操作手柄上,并使绝缘操作绳垂至地面;
辅助机械臂42夹持牵引器142,夹持效果可通过上述力反馈过程确定,第一机械臂43和第二机械臂44打开牵引器上142的两片半圆形钢管并将架空地线套住,再从牵引器142上的牵引孔固定另外一根绝缘牵引绳至地面。第一机械臂43和第二机械臂44移动至专用工具47上方,夹持固定销子,夹持效果可通过上述力反馈过程确定,然后固定住钢管。固定过程中,工控机根据机械臂末端的六自由度力/力矩数据,计算得到主操作手六个关节的扭矩数据,工控机将扭矩数据发送给主操作手的力反馈控制接口,使主操作手反馈受力,操作人员根据反馈力的大小确定固定效果。
第一机械臂43和第二机械臂44从牵引器142上的牵引孔固定另外一根绝缘牵引绳至地面,第一机械臂43和第二机械臂44将安装器140上的固定孔和牵引器142上的固定孔用连接绳进行连接。
辅助机械臂42拉动绝缘牵引绳带动牵引器142,牵引器142同时推动地线线夹和安装器140一同沿地线开始滑动,当整套装置滑动至架空地线断股点约10厘米处时停止牵引。
第一机械臂43和第二机械臂44拉下安装器140上的绝缘操作绳,绝缘操作绳带动安装器140操作手柄上的顶针下落,此时原先由顶针压缩的线卡上的弹簧储能释放,新型地线线卡141就可紧紧卡住断股地线,这样断股地线缺陷就不会扩大,保证了输电线路的安全运行。当起连接作用的顶针下落时,安装器140与地线线卡141就会自动脱离。安装器140上有一带滑轮的返回装置,当安装器140与线卡141脱离后,返回装置上的滑轮自动落在架空地线上。
辅助机械臂42通过拉动牵引器142上绝缘牵引绳,牵引绳带动牵引器142以及与之用固定绳相连的安装器140一同滑行,直至将牵引器142和安装器140一道牵引至杆塔处。
第一机械臂43和第二机械臂44拆除牵引器142、安装器140、绝缘牵引绳、绝缘操作绳、固定绳等。并夹持各部件放回专用工具箱47。拆除过程中,主操作手接收机械臂发送的六自由度力/力矩数据,计算得到主操作手六个关节的扭矩数据,工控机将扭矩数据发送给主操作手的力反馈控制接口,使主操作手反馈受力,操作人员根据反馈力判断拆除状态,进而辅助摄像头判断现场情况。
在上述过程中,各种固定、拆装、夹持的力道和效果,以及力道的调整都可以根据前述力反馈控制过程进行确定。
Claims (8)
1.一种基于力反馈主从控制的带电作业机器人架空地线更换修补方法,其特征在于,带电作业机器人具有设置在机器人平台上的机械臂,包括第一机械臂、第二机械臂以及辅助机械臂,第一机械臂、第二机械臂以及辅助机械臂完成以下工作:
辅助机械臂使用夹持工具夹持地线线卡;第一机械臂和第二机械臂将线卡的槽口卡入架空地线;
辅助机械臂夹持安装器;第一机械臂和第二机械臂移动至专用工具上方,并夹持一根绝缘操作绳,然后将根绝缘固定在安装器的操作手柄上,并使绝缘操作绳垂至地面;
辅助机械臂夹持牵引器,第一机械臂和第二机械臂打开牵引器上的两片半圆形钢管并将架空地线套住,再从牵引器上的牵引孔固定另外一根绝缘牵引绳至地面;第一机械臂和第二机械臂移动至专用工具上方,夹持固定销子,然后固定住钢管;
第一机械臂和第二机械臂从牵引器上的牵引孔固定另外一根绝缘牵引绳至地面,第一机械臂和第二机械臂将安装器上的固定孔和牵引器上的固定孔用连接绳进行连接;
辅助机械臂拉动绝缘牵引绳带动牵引器,牵引器同时推动地线线夹和安装器一同沿地线开始滑动,当整套装置滑动至架空地线断股点附近位置处时停止牵引;
第一机械臂和第二机械臂拉下安装器上的绝缘操作绳,绝缘操作绳带动安装器操作手柄上的顶针下落,此时原先由顶针压缩的线卡上的弹簧储能释放,地线线卡卡住断股地线;当起连接作用的顶针下落时,安装器与地线线卡自动脱离;安装器上有一带滑轮的返回装置,当安装器与线卡脱离后,返回装置上的滑轮自动落在架空地线上;
辅助机械臂通过拉动牵引器上绝缘牵引绳,牵引绳带动牵引器以及与之用固定绳相连的安装器一同滑行,直至将牵引器和安装器一道牵引至杆塔处;
第一机械臂和第二机械臂拆除牵引器、安装器、绝缘牵引绳、绝缘操作绳、固定绳,并夹持各部件放回专用工具箱;
在上述过程中,工控机根据机械臂末端受力数据,计算出主操作手各个关节的扭矩数据,通过主操作手的控制接口,控制主操作手各关节输出扭矩,使主操作手反馈受力,操作人员根据主操作手的反馈受力确认机械臂的力度;
在上述过程中,操作人员改变主操作末端位姿,工控机根据主操作手各旋转关节的角度数据,计算出机械臂末端速度矢量的期望值,通过机械臂的控制接口,按照所述期望值控制机械臂运动。
2.如权利要求1所述架空地线更换修补方法,其特征在于,所述机械臂末端受力数据由安装在机械臂末端的六自由度力/力矩传感器采集获得,其标量为六自由度力/力矩数据。
3.如权利要求1所述架空地线更换修补方法,其特征在于,所述械臂末端受力数据的标量为六自由度力/力矩数据,其由工控机根据机械臂的末端位姿数据和末端速度数据,使用基于虚拟现实技术计算获得,具体过程为:
步骤1,运用八分法对机械臂作业场景对应的虚拟现实场景进行逐步划分,构建八叉树;
步骤2,获取机械臂末端位姿数据,以该末端位姿数据为球心,创建包围球,设置包围球的半径为所需碰撞检测的距离;
步骤3,对步骤2的包围球与步骤1的八叉树进行碰撞检测,若没有发生碰撞,则机械臂末端的六自由度力/力矩数据为零,若发生碰撞,则获取虚拟现实场景中发生碰撞的数据点,根据发生碰撞的数据点坐标与机械臂末端位姿数据,计算碰撞深度矢量;
步骤4,根据碰撞深度矢量计算机械臂末端六自由度力/力矩数据,即采用弹簧阻尼模型计算反馈力,
F=-kx-cv
其中,k为弹簧系数,x为碰撞深度矢量,c为阻尼系数,v为机械臂末端速度矢量,F为反馈力,其标量为六自由度力/力矩数据。
4.如权利要求1所述架空地线更换修补方法,其特征在于,对主操作手静力学建模,得到机械臂末端六自由度力/力矩数据到主操作手各个关节扭矩数据的转换关系,工控机根据所述转换关系计算出主操作手各个关节的扭矩数据。
5.如权利要求1所述架空地线更换修补方法,其特征在于,获取机械臂末端速度矢量期望值的方法为:运用D-H建模方法对主操作手建模,得出主操作手的各个旋转关节的角度数据到主操作手末端位姿数据的转换关系;工控机接收主操作手发送的各个旋转关节的角度数据,根据所述转换关系计算得到主操作手末端位姿数据,然后将主操作手末端位姿数据通过微分运算得到主操作手末端速度数据;根据主操作手末端位姿数据和末端速度数据,使用速度前馈PID控制器,计算得到机械臂末端速度矢量期望值。
6.如权利要求1所述架空地线更换修补方法,其特征在于,在作业前,第一机械臂和第二机械臂端部安装夹持工具,用夹持工具夹持绝缘遮蔽材料对标记的带电体进行绝缘遮蔽;在作业完毕后,第一机械臂和第二机械臂端部安装夹持工具,用夹持工具清除覆盖在带电体上的绝缘遮蔽材料。
7.如权利要求1所述架空地线更换修补方法,其特征在于,主操作手包括第一主操作手、第二主操作手和辅助主操作手;第一主操作手、第二主操作手和辅助主操作手分别与第一机械臂、第二机械臂和辅助机械臂对应,构成主从操作关系。
8.如权利要求7所述架空地线更换修补方法,其特征在于,绝缘斗臂车上设置有控制室,数据处理和控制系统包括工控机、显示屏和主操作手,工控机内置图像处理器,显示屏和主操作手位于控制室内;机器人平台上设置有摄像机,所述摄像机采集的作业场景图像发送给工控机,图像处理器对作业场景图像进行处理后获的3D虚拟作业场景,并送显示器显示。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810319663.8A CN108598990A (zh) | 2018-04-11 | 2018-04-11 | 一种基于力反馈主从控制技术的带电作业机器人架空地线更换修补方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810319663.8A CN108598990A (zh) | 2018-04-11 | 2018-04-11 | 一种基于力反馈主从控制技术的带电作业机器人架空地线更换修补方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN108598990A true CN108598990A (zh) | 2018-09-28 |
Family
ID=63621555
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810319663.8A Pending CN108598990A (zh) | 2018-04-11 | 2018-04-11 | 一种基于力反馈主从控制技术的带电作业机器人架空地线更换修补方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108598990A (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112928570A (zh) * | 2021-01-27 | 2021-06-08 | 山东建筑大学 | 一种接地线作业工具、挂拆接地线系统及方法 |
CN114614397A (zh) * | 2022-04-25 | 2022-06-10 | 国网山东省电力公司烟台供电公司 | 一种中间电位消除架空输电线路引流板发热缺陷的带电作业机器人及其作业方法 |
CN115986627A (zh) * | 2023-03-20 | 2023-04-18 | 国网山东省电力公司潍坊供电公司 | 一种用于带电更换架空地线的工具及其使用方法 |
CN116073279A (zh) * | 2023-02-21 | 2023-05-05 | 南京汉启智能科技有限公司 | 一种三角形排列主导线的中相带电接引线作业方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101834416A (zh) * | 2010-05-21 | 2010-09-15 | 安徽省电力公司滁州供电公司 | 带电修补输电线路断股架空地线的设备及施工方法 |
CN104057450A (zh) * | 2014-06-20 | 2014-09-24 | 哈尔滨工业大学深圳研究生院 | 一种针对服务机器人的高维操作臂遥操作方法 |
CN106826756A (zh) * | 2016-12-09 | 2017-06-13 | 南京理工大学 | 一种基于高压带电作业机器人的导线修补方法 |
-
2018
- 2018-04-11 CN CN201810319663.8A patent/CN108598990A/zh active Pending
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101834416A (zh) * | 2010-05-21 | 2010-09-15 | 安徽省电力公司滁州供电公司 | 带电修补输电线路断股架空地线的设备及施工方法 |
CN104057450A (zh) * | 2014-06-20 | 2014-09-24 | 哈尔滨工业大学深圳研究生院 | 一种针对服务机器人的高维操作臂遥操作方法 |
CN106826756A (zh) * | 2016-12-09 | 2017-06-13 | 南京理工大学 | 一种基于高压带电作业机器人的导线修补方法 |
Non-Patent Citations (2)
Title |
---|
牛永志,屈以军: "《带电修补输电线路断股架空地线的新方法》", 《安徽电气工程职业技术学院学报》 * |
马孝林: "《高压带电作业机器人作业机械臂的设计及优化》", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112928570A (zh) * | 2021-01-27 | 2021-06-08 | 山东建筑大学 | 一种接地线作业工具、挂拆接地线系统及方法 |
CN114614397A (zh) * | 2022-04-25 | 2022-06-10 | 国网山东省电力公司烟台供电公司 | 一种中间电位消除架空输电线路引流板发热缺陷的带电作业机器人及其作业方法 |
CN116073279A (zh) * | 2023-02-21 | 2023-05-05 | 南京汉启智能科技有限公司 | 一种三角形排列主导线的中相带电接引线作业方法 |
CN116073279B (zh) * | 2023-02-21 | 2023-09-26 | 南京汉启智能科技有限公司 | 一种三角形排列主导线的中相带电接引线作业方法 |
CN115986627A (zh) * | 2023-03-20 | 2023-04-18 | 国网山东省电力公司潍坊供电公司 | 一种用于带电更换架空地线的工具及其使用方法 |
CN115986627B (zh) * | 2023-03-20 | 2023-06-27 | 国网山东省电力公司潍坊供电公司 | 一种用于带电更换架空地线的工具及其使用方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106493708B (zh) | 一种基于双机械臂和辅助臂的带电作业机器人控制系统 | |
CN107053188A (zh) | 一种带电作业机器人支接引线搭接方法 | |
CN108582031A (zh) | 一种基于力反馈主从控制的带电作业机器人支接引线搭接方法 | |
CN106826756A (zh) | 一种基于高压带电作业机器人的导线修补方法 | |
CN108598990A (zh) | 一种基于力反馈主从控制技术的带电作业机器人架空地线更换修补方法 | |
CN108462108A (zh) | 一种基于力反馈主从控制的带电作业机器人耐张绝缘子更换方法 | |
CN106786140B (zh) | 一种带电作业机器人耐张绝缘子更换方法 | |
CN107030693B (zh) | 一种基于双目视觉的带电作业机器人目标跟踪方法 | |
CN106595762B (zh) | 一种带电作业机器人耐张绝缘子检测方法 | |
CN206840057U (zh) | 一种基于双机械臂和辅助臂的带电作业机器人控制系统 | |
CN106695883B (zh) | 一种带电作业机器人真空断路器检测方法 | |
CN108789416B (zh) | 用于控制双机械臂柔性带电作业的系统及方法 | |
CN108858121A (zh) | 带电作业机器人及其控制方法 | |
CN206510017U (zh) | 一种带电作业机器人 | |
CN108683050A (zh) | 一种带电作业机器人接引线方法 | |
CN205219121U (zh) | 一种攀爬巡检机器人 | |
CN108284425A (zh) | 一种带电作业机器人机械臂协作力反馈主从控制方法及系统 | |
CN106771805A (zh) | 一种带电作业机器人金属氧化物避雷器检测方法 | |
CN108616077B (zh) | 一种带电作业机器人断引线方法 | |
CN108297068A (zh) | 一种基于力反馈主从控制的带电作业机器人专用工具更换方法 | |
CN108565793A (zh) | 一种基于力反馈主从控制的带电作业机器人导线修补方法 | |
CN108527305A (zh) | 一种基于虚拟现实技术的带电作业机器人力反馈主从控制方法及系统 | |
CN106737862A (zh) | 一种带电作业机器人数据通信系统 | |
CN108994820A (zh) | 用于带电作业的机器人系统及作业场景构建方法 | |
CN110421558A (zh) | 面向配电网作业机器人的通用型遥操作系统及方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
WD01 | Invention patent application deemed withdrawn after publication | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20180928 |