水下用机器人遥操作模式下主从端设备空间映射控制算法研究

Research on Space Mapping Control Algorithm of Master-slave Equipment in Teleoperation Mode of Underwater Robot

为了安全高效地完成水下清洗工作,提出了一种核电厂水下用机器人清洗装置,该装置基于UR5水下用串联机器人实现。通过介绍该机器人的控制系统组成,分析了主从端的关节空间和工作空间。同时在遥操作模式下,分析主从端关节空间映射算法和工作空间映射算法,并基于两种映射控制算法进行遥操作试验,综合对比试验结果。最后根据核电厂水下清洗任务需要,主要采取响应速度较快的关节空间映射算法用于遥操作模式下的主从端控制。

In order to complete the underwater cleaning work safely and efficiently,this paper proposes an underwater robot cleaning device for nuclear power plants,which is based on UR5 underwater serial robot.The control system of the robot is introduced,and the joint space and workspace of the master and slave are analyzed.At the same time,in the teleoperation mode,the master-slave joint space mapping algorithm and workspace mapping algorithm are analyzed,and teleoperation experiments are carried out based on the two mapping control algorithms,and the test results are compared comprehensively.Finally,according to the needs of the underwater cleaning task of the nuclear power plant,the joint space mapping algorithm with fast response is selected for the master-slave control in the teleoperation mode.