一种基于虚拟现实带电作业机械臂防碰撞保护方法技术

本发明专利技术提出一种基于虚拟现实带电作业机械臂防碰撞保护方法，根据真实作业场景建立虚拟作业场景，虚拟场景中机械臂模型的尺寸略大于机械臂实际尺寸，在虚拟场景中进行虚拟碰撞检测，以判断机械臂是否会发生碰撞；所述虚拟碰撞检测采用基于包围盒的虚拟碰撞检测方法。本发明专利技术能够使得机器人在带电作业时，多机械臂之间协调工作，互相配合、互不干扰，有序高效安全地完成带电作业。

Anti-collision protection method for live working mechanical arm based on virtual reality

The invention provides an anti-collision protection method for live working manipulator based on virtual reality, virtual scene based on real scene operation operation, the mechanical arm model in the virtual scene size is slightly larger than the actual size of the mechanical arm, a virtual collision detection in virtual scene, to determine whether the mechanical arm collision; the virtual collision detection using virtual collision detection method based on bounding box. The invention can make the robot work in coordination with the multi robot arm in the live work, cooperate with each other and do not interfere with each other, and perform the live work in an orderly, efficient and safe way.

【技术实现步骤摘要】
一种基于虚拟现实带电作业机械臂防碰撞保护方法
本专利技术属于电力
，具体涉及一种基于虚拟现实带电作业机械臂防碰撞保护方法。
技术介绍
采用机器人自主完成带电作业，不仅可以将工作人员从危险的、繁重的、精神紧张的工作中解放出来，有效避免带电作业时人员伤亡事故的发生，使带电作业更加安全，提高作业效率；同时还可以提高电网的运行质量，进一步减少供电系统的人员投入，降低人员成本，具有巨大的经济效益和社会效益。带电作业时采用多机械臂共同完成带电作业，如果没有系统、安全、可靠的防碰撞方法，那么多机械臂必然无法协调完成带电作业，甚至引发安全事故，给机器人和操作人员带来危害。
技术实现思路
本专利技术提出一种基于虚拟现实带电作业机械臂防碰撞保护方法，能够使得机器人在带电作业时，多机械臂之间协调工作，互相配合、互不干扰，有序高效安全地完成带电作业。为了解决上述技术问题，本专利技术提供一种基于虚拟现实带电作业机械臂防碰撞保护方法，根据真实作业场景建立虚拟作业场景，虚拟场景中机械臂模型的尺寸略大于机械臂实际尺寸，在虚拟场景中进行虚拟碰撞检测，以判断机械臂是否会发生碰撞；所述虚拟碰撞检测采用基于包围盒的虚拟碰撞检测方法，具体为：步骤1，预处理阶段，对参与碰撞检测的机械臂模型进行特征采样，将构成机械臂模型的基本集合元素的包围盒的中心点作为特征采样点，根据两个待检测包围盒的特征对建立二维离散搜索空间；步骤2，碰撞检测阶段，包括以下步骤：步骤2-1，采用粒子群算法进行搜索，得到距离小于一定碰撞检测阈值的特征对；步骤2-2，判断以上距离小于一定碰撞检测阈值的特征对所对应的包围盒是否相交，若包围盒不相交，则进入步骤2-4；若包围盒相交，则继续步骤2-3；步骤2-3，判断机械臂的基本几何元素是否相交，若基本几何元素不相交，进入步骤2-4；若基本几何元素相交，则做出碰撞响应。进一步，步骤2-1具体为：步骤2-1-1，将两个机械臂基本几何元素的包围盒特征作为粒子，初始化粒子群，包括群体规模、每个粒子的位置和速度；步骤2-1-2，计算每个粒子的适应度值；步骤2-1-3，对每个粒子，比较其适应度值和个体极值pbest，如果适应度值小于粒子当前的个体极值pbest，则更新个体极值pbest；否则不更新；步骤2-1-4，对每个粒子，比较其适应度值和全局极值gbest，如果适应度值小于粒子当前的全局极值gbest则更新全局极值gbest；否则不更新；步骤2-1-5，根据以下公式更新粒子的速度和位置；其中，k为迭代代次数；c1,c2为学习因子；r1,r2为均匀分布在[0,1]之间的两个随机数；ω为惯性权重；为粒子i的当前位置；Vik+1为粒子i的当前飞行速度；Pi是粒子i经历的最优位置，称为个体最优位置；Pg是到目前时间段为止，群体中所有粒子经历的最优位置，称为全局最优位置；步骤2-1-6，判断是否满足粒子群算法结束条件，若满足，输出距离小于一定碰撞检测阈值的特征对，若不满足，则返回步骤2-1-2。本专利技术与现有技术相比，其显著优点在于：(1)本专利技术针对自主带电作业机器人，采用基于虚拟碰撞检测的防碰撞保护方法和基于深度传感器的防碰撞保护方法，多种方法结合，更好地监控机械臂安全、协调地完成带电作业；(2)将粒子群算法应用到带电作业的虚拟碰撞检测中，可以实时地检测到发生干涉的元素，从而及时避免碰撞事故；(3)虚拟场景中所建立的机械臂模型外围尺寸比实际机械臂大一些，首先在虚拟场景中检测到碰撞，然后及时对碰撞做出响应，避免真实场景中的机械臂发生碰撞。(4)带电作业机器人作业时分为人工遥操作方式和机器人自主方式，当机器人自主作业时，采用本专利技术的机械臂防碰撞保护方法；当人工遥操作时，一方面操作者通过监控画面实时观测机械臂状态，另一方面，如果计算机检测到机械臂即将发生碰撞，立即干预人工操作，停止机械臂的一切动作。附图说明图1为本专利技术中带电作业机器人一种实施例的整体结构示意图；图2为本专利技术中机器人平台的结构示意图；图3为本专利技术的带电作业虚拟碰撞检测的流程图；图4为采用粒子群算法的流程图。具体实施方式容易理解，依据本专利技术的技术方案，在不变更本专利技术的实质精神的情况下，本领域的一般技术人员可以想象出本专利技术基于虚拟现实带电作业机械臂防碰撞保护方法的多种实施方式。因此，以下具体实施方式和附图仅是对本专利技术的技术方案的示例性说明，而不应当视为本专利技术的全部或者视为对本专利技术技术方案的限制或限定。结合附图，带电作业机器人包括绝缘斗臂车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、通信模块供电。专用工具箱47是放置抓具、扳手等作业工具的场所。机械臂末端安装有工具快换装置。机械臂根据作业任务的类型到专用工具箱47中使用工具快换装置获取作业工具。控制室2中第一主操作手、第二主操作手以及辅助主操作手是一种用于人工远程操作机械臂的操作装置，他们与第一机械臂43、第二机械臂44和辅助机械臂42构成主从操作关系。机械臂和主操作手具有相同的结构，只是主操作手尺寸规格比机械臂小，以便于操作人员操作。机械臂和主操作手拥有六个关节，每个关节都有光电编码器采集角度数据，各主操作手的微型控制器通过串口将六个关节的角度数据发送给第二工控机。为了防止上述带电作业机器人各机械臂发生碰撞，本专利技术提出一种基于虚拟现实带电作业机械臂防碰撞保护方法，包括基于虚拟碰撞检测的防碰撞保护方法和基于深度传感器的防碰撞保护方法。所述虚拟碰撞检测，即建立机械臂的运动虚拟场景，在虚拟场景中机械臂交互和运动时不可避免会发生碰撞，系统必须实时地检测到这些碰撞，避免场景中机械臂在运动过程中发生穿透等现象。虚拟场景中机械臂外围尺寸比实际机械臂大一些，当虚拟机械臂检测到碰撞时，实际机械臂还未发生碰撞，此时虚拟机械臂进行碰撞响应，一个机械臂向反方向移动，另一个物体(机械臂或带电作业现场其他物体)保持静止，从而有效避免了机械臂发生碰撞。进一步，虚拟碰撞检测分为两个步骤：步骤1，预处理阶段，对参与碰撞检测的机械臂模型进本文档来自技高网...

【技术保护点】
一种基于虚拟现实带电作业机械臂防碰撞保护方法，其特征在于，根据真实作业场景建立虚拟作业场景，虚拟场景中机械臂模型的尺寸略大于机械臂实际尺寸，在虚拟场景中进行虚拟碰撞检测，以判断机械臂是否会发生碰撞；所述虚拟碰撞检测采用基于包围盒的虚拟碰撞检测方法，具体为：步骤1，预处理阶段，对参与碰撞检测的机械臂模型进行特征采样，将构成机械臂模型的基本集合元素的包围盒的中心点作为特征采样点，根据两个待检测包围盒的特征对建立二维离散搜索空间；步骤2，碰撞检测阶段，包括以下步骤：步骤2‑1，采用粒子群算法进行搜索，得到距离小于一定碰撞检测阈值的特征对；步骤2‑2，判断以上距离小于一定碰撞检测阈值的特征对所对应的包围盒是否相交，若包围盒不相交，则进入步骤2‑4；若包围盒相交，则继续步骤2‑3；步骤2‑3，判断机械臂的基本几何元素是否相交，若基本几何元素不相交，进入步骤2‑4；若基本几何元素相交，则做出碰撞响应。

【技术特征摘要】
1.一种基于虚拟现实带电作业机械臂防碰撞保护方法，其特征在于，根据真实作业场景建立虚拟作业场景，虚拟场景中机械臂模型的尺寸略大于机械臂实际尺寸，在虚拟场景中进行虚拟碰撞检测，以判断机械臂是否会发生碰撞；所述虚拟碰撞检测采用基于包围盒的虚拟碰撞检测方法，具体为：步骤1，预处理阶段，对参与碰撞检测的机械臂模型进行特征采样，将构成机械臂模型的基本集合元素的包围盒的中心点作为特征采样点，根据两个待检测包围盒的特征对建立二维离散搜索空间；步骤2，碰撞检测阶段，包括以下步骤：步骤2-1，采用粒子群算法进行搜索，得到距离小于一定碰撞检测阈值的特征对；步骤2-2，判断以上距离小于一定碰撞检测阈值的特征对所对应的包围盒是否相交，若包围盒不相交，则进入步骤2-4；若包围盒相交，则继续步骤2-3；步骤2-3，判断机械臂的基本几何元素是否相交，若基本几何元素不相交，进入步骤2-4；若基本几何元素相交，则做出碰撞响应。2.如权利要求1所述基于虚拟现实带电作业机械臂防碰撞保护方法，其特征在于，步骤2-1具体为：步骤2-1-1，将两个机械臂基本几何元素的包围盒特征作为粒子，初始化粒子群，包括群体规模、每个粒子的位置和速...

【专利技术属性】
技术研发人员：郭毓，黄颖，郭健，吴巍，苏鹏飞，吴禹均，韩昊一，李光彦，汤冯炜，林立斌，
申请(专利权)人：南京理工大学，
类型：发明
国别省市：江苏,32