变电站端子箱门的机械臂自主开闭方法及自主开闭装置与流程
本发明涉及电网运维,具体地涉及变电站端子箱门的机械臂自主开闭方法及自主开闭装置。
背景技术:
1、变电站、配电房内布置有大量端子箱,用于容纳二次回路端子排、温感与信号回路等。此类箱体具有以下共同特点,使"开门"这一看似简单的动作难以自动化:1.箱体为带电设备的一部分。端子箱内为二次回路与端子排,人工开箱进行巡检、测温、接线作业时须严格执行停电、验电、接地、挂牌上锁(loto)与工作票制度;部分端子箱所接回路还与其他系统联锁(例如接入温感回路的箱体,误碰可能触发消防或泡沫喷淋动作)。因此作业窗口紧、等待停电的代价高,且对操作规范性要求高。2.门轴位置不可知且会变化。端子箱门板多为1.5–2 mm 冷轧钢板,由两个竖直合页承载,长期使用后合页易出现间隙增大、下沉与轻微扭曲;箱体本身安装位置亦难以在不同站点间精确复现。若采用预先示教门轴位置的方式控制力方向,一旦门轴或箱体位置变化,力控方向即出现误差,可能造成门板变形或夹爪脱出。现场逐台重新示教则不具备可实施性——端子箱数量多、分布广。3.锁具为旋转式,且朝向随站点而异。端子箱门多采用旋钮式凸轮锁(转动约 90° 解锁),把手轴向在空间中的朝向随箱体安装方向、开门方向而变化。两指夹爪若要转动旋钮,需先确定把手轴向;辨识错误会造成别劲并使力矩骤升。因此,需要一种变电站端子箱门的机械臂自主开闭方法及自主开闭装置,能够克服现有困难,完成端子箱门的自主开闭。
技术实现思路
1、本发明实施例的目的是提供变电站端子箱门的机械臂自主开闭方法及自主开闭装置,该机械臂自主开闭方法能够可降低变电站端子箱开箱作业的带电作业风险,免去在被操作设备上加装标记的实施障碍,实现端子箱门的自主开合。
2、为了实现上述目的,本发明实施例提供一种变电站端子箱门的机械臂自主开闭方法,所述机械臂自主开闭方法包括:
3、机械臂移动至搜索位置,在所述机械臂的末端的相机采集关于所述门板的区域的图像和深度信息,以在所述门板所在区域内识别把手;
4、对识别出的把手进行几何拟合,并确定所述把手在相机坐标系下的轴向与抓握中心位置;
5、基于相机在机械臂当前关节角下的相对位置,转换得到所述把手在机械臂基座坐标系下的位姿;
6、基于所述把手的位姿构造所述夹爪的抓握位姿,以使得所述夹爪所在的工具坐标系的一个坐标轴与所述把手的轴向重合,且使得所述工具坐标系的接近轴与所述门板的外法线方向相反;
7、机械臂控制驱动所述夹爪夹紧把手,并绕与把手轴向重合的工具坐标轴按预设角度与预设符号旋转,以解除锁具的锁定;
8、机械臂控制夹爪沿把手绕铰链轴的圆弧轨迹运动以开门,其中由开门过程中采集的接触力与末端位姿在线估计铰链轴的位置,不使用预先示教或预先给定的门轴参数;
9、在门板达到目标的开门角后,根据需要按照上述控制相反的顺序进行关门和反向转锁;
10、门板封闭以后机械臂控制所述夹爪松开把手并沿接近方向的反方向撤离,从而完成对门板的自主开闭。
11、可选地,还包括:
12、获取门板的宽度、把手至铰链轴的距离、把手高度以及机械臂基座相对门板的门面的摆放位置,以构造把手绕铰链轴扫过开门角区间的圆弧;
13、沿所述圆弧逐点求解逆运动学,在所述圆弧上的点以上一成功解和/或可达包络引导种子作为迭代初值,以求取机械臂能够连续跟踪的最大开门角;
14、获取连续跟踪的最大开门角,并在连续的最大开门角小于目标开门角时,拒绝执行开门任务,并输出把手不可达或可抓握但无法跟完圆弧两个失败原因。
15、可选地,还包括:
16、获取连续跟踪的最大开门角,并获取超过连续跟踪上限的最大开门角,以构造在对应角度下的把手的抓握位姿;
17、对在当前最大开门角的情况下在其他开门角上已求得的解、由采样可达包络按位姿接近程度选取的位姿、以及随机生成的关节角组成的多个独立的初值求解逆运动学;
18、在任一初值求解成功的情况下,确定超过连续跟踪上限的最大开门角能够松手后重新抓握达到;
19、在全部失败的情况下,确定连续跟踪上限的最大开门角为抓握位姿可达集的边界。
20、可选地,对识别出的把手进行几何拟合,并确定所述把手在相机坐标系下的轴向与抓握中心位置,包括:
21、依据所述把手为回转体的形状先验,对所述把手所在区域的深度点云进行圆柱面拟合;
22、将拟合所得的圆柱轴线的方向作为把手轴向,以轴线上与抓握高度相对应的点作为抓握中心;
23、对所述抓握中心进行坐标系转换,以得到把手在相机坐标系下的轴向与抓握中心位置;
24、将圆柱面拟合的残差作为识别可靠性的度量以提升所述把手拟合的精度。
25、可选地,将圆柱面拟合的残差作为识别可靠性的度量以提升所述把手拟合的精度,包括:
26、获取拟合的残差,并在残差超过预设阈值或者把手所在区域内的有效深度点数量低于预设下限时,确定当前识别不可靠;
27、在确定当前识别不可靠的情况下,调整机械臂的搜索位姿并重新采集图像识别直至得到符合要求的拟合结果,或;
28、基于彩色图像对把手的区域进行检测并结合把手尺寸先验估计其位姿。
29、可选地,基于所述把手的位姿构造所述夹爪的抓握位姿时,抓握位姿的接近方向通过公式:approach=(r_h·axis)确定,其中r_h表示把手位姿的旋转矩阵,axis表示拟合得到的把手轴向的单位矢量,approach表示接近方向。
30、可选地,开门角的计算建立在转锁完成之后的位姿t_contact上,具体通过公式θ=|log(r_cur·r_contact)|计算得到,其中θ表示开门角,r_cur表示当前的旋转矩阵,用于描述当前时刻物体的姿态,r_contact表示目标旋转矩阵的转置。
31、可选地,在所述门板所在区域内识别把手,包括由深度阈值与平面分割算法确定门板的区域,再在门板的区域内依据把手的形状或颜色特征定位把手的区域。
32、可选地,沿所述圆弧逐点求解时,步长的设置需要使得相邻角度间隔小于可能存在的不可达角度空洞的宽度,以避免跨越空洞而产生虚假的可行结论。
33、另一方面,本发明还可以提供一种变电站端子箱门自主开闭装置,包括机械臂,所述机械臂设置在变电站端子箱门前方,安装于机械臂末端的两指夹爪和相机,以及控制器,所述控制器用于执行如上述所述的变电站端子箱门的机械臂自主开闭方法。
34、通过上述技术方案,本发明提供的变电站端子箱门的机械臂自主开闭方法及自主开闭装置能够通过机械臂对变电站端子箱门进行自主开闭。该变电站端子箱门可以包括通过竖直铰链承载并绕铰链轴转动的门板,以及门板上的旋转式的把手。在该机械臂的末端可以安装有夹爪和相机。该机械臂自主开闭方法可以控制机械臂移动至搜索位置,在机械臂的末端的相机采集关于门板的区域的图像和深度信息,以在门板所在区域内识别把手,然后可以对识别出的把手进行几何拟合,并可以确定把手在相机坐标系下的轴向与抓握中心位置。基于相机在机械臂当前关节角下的相对位置,可以转换得到把手在机械臂基座坐标系下的位姿。基于该把手的位姿可以构造夹爪的抓握位姿,以使得夹爪所在的工具坐标系的一个坐标轴可以与把手的轴向重合,且可以使得工具坐标系的接近轴与门板的外法线方向相反。机械臂可以控制驱动夹爪夹紧把手,并绕与把手轴向重合的工具坐标轴按预设角度与预设符号旋转,以解除锁具的锁定。机械臂控制夹爪沿把手绕铰链轴的圆弧轨迹运动以开门,其中由开门过程中采集的接触力与末端位姿在线估计铰链轴的位置,不使用预先示教或预先给定的门轴参数。在门板达到目标的开门角后,可以根据需要按照上述控制相反的顺序进行关门和反向转锁。门板封闭以后机械臂可以控制夹爪松开把手并沿接近方向的反方向撤离,从而完成对门板的自主开闭。该机械臂自主开闭方法能够可降低变电站端子箱开箱作业的带电作业风险,免去在被操作设备上加装标记的实施障碍,实现端子箱门的自主开合。
35、本发明实施例的其它特征和优点将在随后的具体实施方式部分予以详细说明。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com