[发明专利]一种基于虚拟现实技术的带电作业机器人机械臂协作力反馈主从控制方法及系统

摘要

本发明提出一种基于虚拟现实技术的带电作业机器人机械臂协作力反馈主从控制方法及系统。包括操作手、机械臂和工控机；主操作手力反馈控制时，工控机根据机械臂末端的受力数据，计算出主操作手各个关节的扭矩数据，通过主操作手的控制接口，控制主操作手各关节输出扭矩；所述械臂末端受力数据的标量为六自由度力/力矩数据，包括两部分：一部分来自于机械臂与环境接触时产生的受力数据，另一部分来自于机械臂之间相互碰撞而产生的受力数据；前述两部分受力数据均采用基于虚拟现实的技术获得。本发明可以精确、高效、安全地完成带电作业。

主权项

1.一种基于虚拟现实技术的带电作业机器人机械臂协作力反馈主从控制方法，其特征在于，操作手、机械臂和工控机组成带电作业机器人力反馈主从控制系统；主操作手力反馈控制时，工控机根据机械臂末端的受力数据，计算出主操作手各个关节的扭矩数据，通过主操作手的控制接口，控制主操作手各关节输出扭矩；所述械臂末端受力数据的标量为六自由度力/力矩数据，包括两部分：一部分来自于机械臂与环境接触时产生的受力数据，另一部分来自于机械臂之间相互碰撞而产生的受力数据；前述两部分受力数据均采用基于虚拟现实的技术获得，其中，获得机械臂之间相互碰撞而产生的受力数据的过程为：步骤1，获取第二机械臂六个关节的角度数据，根据第二机械臂外型模型数据，生成第二机械臂的虚拟现实数据；步骤2，运用第二机械臂的基坐标系到第一机械臂的基坐标系的转换矩阵，将第二机械臂的虚拟现实数据转换到第一机械臂的基坐标系中；步骤3，运用八分法对第二机械臂的虚拟现实数据进行逐步划分，构建八叉树；步骤4，获取第一机械臂末端位姿数据，以该末端位姿数据为球心，创建包围球，该包围球的半径为所需碰撞检测的距离；步骤5，对步骤4的包围球与步骤3的八叉树进行碰撞检测，若没有发生碰撞，则机械臂之间的受力数据为零，若发生碰撞，则获得虚拟现实场景中发生碰撞的数据点，根据发生碰撞的数据点坐标与第一机械臂末端位姿数据，计算碰撞深度矢量，然后进入步骤6；步骤6，采用弹簧模型计算第一机械臂末端受力数据，F＝‑kx其中，k为弹簧系数，x为碰撞深度矢量，F为受力数据，F为六维矢量，其标量为六自由度力/力矩数据；步骤7，将步骤6获得的六自由度力/力矩数据符号取反获得第二机械臂末端的六自由度力/力矩数据。