[实用新型]一种机械臂力觉临场感的主从遥操作控制系统

说明书

技术领域

本实用新型涉及一种机械臂力觉临场感的主从遥操作控制系统。

背景技术

随着对海洋、宇宙资源的开发，核电站废料的清理，高压带电作业、显微外科手术等这些高危、高压、强辐射、精细工作需求的不断提高，主从遥操作的研究显得更加迫切。

对于难以接近或者对人有害的危险的非结构化环境，操作者通过控制位于安全场所的主手来远距离控制从手进入危险区进行作业，从手跟随主手运动的同时将与环境的作用力传递给操作者。只有给操作者提供真实的视觉和力觉信息，操作者才能完成复杂精细的作业任务。

现有的主从机器人系统存在以下缺点：

(1)采用双向位置反馈来实现位置跟踪和力觉再现，但由于主从手间无法消除的位置误差，使系统在自由空间运动也显得十分“迟滞”，直接影响系统的操作性能；

(2)利用将主从手两侧的位置和力信息采用不同融合方式，实现多传感器的信息融合，构成不同的控制策略，但是，当从机器人的力直接作用在主机器人上，当从机器人从自由运动到突然接触较大刚体的物体时，会对主机器人有较大的冲击。

实用新型内容

本实用新型为了解决上述问题，提出了一种机械臂力觉临场感的主从遥操作控制系统，本系统在主从机器人上安装无线通信模块，实现控制指令与传感器信号的无线传输，实现主从隔离，该控制策略能够实现主从的跟踪与主机械臂很好的力觉感，通过主从控制的方式完成复杂作业，并通过各种传感器采集的信息，提高其操作性能。

为了实现上述目的，本实用新型采用如下技术方案：

一种机械臂力觉临场感的主从遥操作控制系统，包括主机械臂控制系统、主控制系统和从机械臂控制系统，其中：

所述主机械臂控制系统包括编码器、压力传感器、力矩电机、马达驱动器和第一无线模块，所述编码器连接第一无线模块，所述第一无线模块与马达驱动器连接，马达驱动器连接安装于主机械臂各关节处的力矩电机，第一无线模块与主机械臂上安设的压力传感器连接；

所述从机械臂控制系统包括电位器、压力传感器、伺服电机、马达驱动器和第四无线模块，所述电位器安装于从机械臂的各个关节处，且连接第四无线模块，所述第四无线模块与马达驱动器连接，马达驱动器连接伺服电机，第四无线模块与从机械臂上的压力传感器连接；

所述主控制系统，包括第二无线模块、第三无线模块、第一控制器、第二控制器、位置比较模块、PID控制器和压力比较模块，其中，第二无线模块与所述第一无线模块通信，第三无线模块连接所述第四无线模块，压力比较模块连接第二无线模块、第三无线模块和第一控制器，所述位置比较模块连接PID控制器、第二无线模块和第三无线模块，PID控制器连接第二控制器，第二控制器连接第三无线模块。

所述主机械臂控制系统安装有急停、校对的按钮。

所述主机械臂与从机械臂的结构一致，且两者尺寸呈比例关系。

所述编码器内置于主机械臂上，采集主机械臂的位置、速度信号，并对其进行滤波处理后，传输给第一无线模块。

所述电位器安装于从机械臂的各个关节上，采集从机械臂的位置、速度信号，并对其进行滤波处理后，传输给第四无线模块。

基于上述主从遥操作控制系统的控制方法，包括以下步骤：

(1)操作机械臂运动时，主机械臂上的压力传感器检测到作用力为f₀，同时主机械臂编码器检测主机械臂产生的位移x_m，通过第一无线模块传输给压力比较模块和位置比较模块，从机械臂的压力传感器检测从机械臂与环境的作用力f_e，从机械臂的移动位移x_s，并通过第四无线模块传输给压力比较模块和位置比较模块；

(2)压力比较模块得到力误差信号传输到第一控制器，位置比较模块得到位置误差信号后结合主、从机械臂尺寸比例，将处理结果传输给PID控制器，PID控制器对其进行调节后将调节信号传输给第一控制器和第二控制器，第一控制器和第二控制器根据调节信号产生相应的驱动力，分别通过第二无线模块和第三无线模块传输给第一无线模块和第四无线模块；

(3)主机械臂控制系统和从机械臂控制系统的马达驱动器接受各自的驱动信号，驱动力矩电机、伺服电机工作，使主、从机械臂执行相应运动。

所述步骤(2)中，压力比较模块得出力误差信号为f₀-f_e。

所述步骤(2)中，位置比较模块得出位置误差信号x_m-x_s。

所述步骤(2)中，第一控制器产生的驱动力为：