本实用新型专利技术公开了一种机械臂力觉临场感的主从遥操作控制系统，系统包括主机械臂控制系统、主控制系统和从机械臂控制系统，通过该系统的控制策略性能稳定可靠、信息处理平滑稳定，满足主从控制作业任务的要求。本实用新型专利技术的构思是在主从机器人上安装无线通信模块，实现控制指令与传感器信号的无线传输，通过主从隔离，实现主从的跟踪与主手很好的力觉感；本实用新型专利技术通过主从控制的方式完成复杂作业，并通过各种传感器采集的信息，提高其操作性能。
【技术实现步骤摘要】
本技术涉及一种机械臂力觉临场感的主从遥操作控制系统。
技术介绍
随着对海洋、宇宙资源的开发，核电站废料的清理，高压带电作业、显微外科手术 等这些高危、高压、强辐射、精细工作需求的不断提高，主从遥操作的研宄显得更加迫切。 对于难以接近或者对人有害的危险的非结构化环境，操作者通过控制位于安全场 所的主手来远距离控制从手进入危险区进行作业，从手跟随主手运动的同时将与环境的作 用力传递给操作者。只有给操作者提供真实的视觉和力觉信息，操作者才能完成复杂精细 的作业任务。 现有的主从机器人系统存在以下缺点： (1)采用双向位置反馈来实现位置跟踪和力觉再现，但由于主从手间无法消除的 位置误差，使系统在自由空间运动也显得十分"迟滞"，直接影响系统的操作性能； (2)利用将主从手两侧的位置和力信息采用不同融合方式，实现多传感器的信息 融合，构成不同的控制策略，但是，当从机器人的力直接作用在主机器人上，当从机器人从 自由运动到突然接触较大刚体的物体时，会对主机器人有较大的冲击。
技术实现思路
本技术为了解决上述问题，提出了一种机械臂力觉临场感的主从遥操作控制 系统，本系统在主从机器人上安装无线通信模块，实现控制指令与传感器信号的无线传输， 实现主从隔离，该控制策略能够实现主从的跟踪与主机械臂很好的力觉感，通过主从控制 的方式完成复杂作业，并通过各种传感器采集的信息，提高其操作性能。 为了实现上述目的，本技术采用如下技术方案： -种机械臂力觉临场感的主从遥操作控制系统，包括主机械臂控制系统、主控制 系统和从机械臂控制系统，其中： 所述主机械臂控制系统包括编码器、压力传感器、力矩电机、马达驱动器和第一无 线模块，所述编码器连接第一无线模块，所述第一无线模块与马达驱动器连接，马达驱动器 连接安装于主机械臂各关节处的力矩电机，第一无线模块与主机械臂上安设的压力传感器 连接； 所述从机械臂控制系统包括电位器、压力传感器、伺服电机、马达驱动器和第四无 线模块，所述电位器安装于从机械臂的各个关节处，且连接第四无线模块，所述第四无线模 块与马达驱动器连接，马达驱动器连接伺服电机，第四无线模块与从机械臂上的压力传感 器连接； 所述主控制系统，包括第二无线模块、第三无线模块、第一控制器、第二控制器、位 置比较模块、PID控制器和压力比较模块，其中，第二无线模块与所述第一无线模块通信，第 三无线模块连接所述第四无线模块，压力比较模块连接第二无线模块、第三无线模块和第 一控制器，所述位置比较模块连接PID控制器、第二无线模块和第三无线模块，PID控制器 连接第二控制器，第二控制器连接第三无线模块。 所述主机械臂控制系统安装有急停、校对的按钮。 所述主机械臂与从机械臂的结构一致，且两者尺寸呈比例关系。 所述编码器内置于主机械臂上，采集主机械臂的位置、速度信号，并对其进行滤波 处理后，传输给第一无线模块。 所述电位器安装于从机械臂的各个关节上，采集从机械臂的位置、速度信号，并对 其进行滤波处理后，传输给第四无线模块。 基于上述主从遥操作控制系统的控制方法，包括以下步骤： (1)操作机械臂运动时，主机械臂上的压力传感器检测到作用力为fQ，同时主机械 臂编码器检测主机械臂产生的位移Xm，通过第一无线模块传输给压力比较模块和位置比较 模块，从机械臂的压力传感器检测从机械臂与环境的作用力f；，从机械臂的移动位移Xs，并 通过第四无线模块传输给压力比较模块和位置比较模块； (2)压力比较模块得到力误差信号传输到第一控制器，位置比较模块得到位置误 差信号后结合主、从机械臂尺寸比例，将处理结果传输给PID控制器，PID控制器对其进行 调节后将调节信号传输给第一控制器和第二控制器，第一控制器和第二控制器根据调节信 号产生相应的驱动力，分别通过第二无线模块和第三无线模块传输给第一无线模块和第四 无线模块； (3)主机械臂控制系统和从机械臂控制系统的马达驱动器接受各自的驱动信号， 驱动力矩电机、伺服电机工作，使主、从机械臂执行相应运动。 所述步骤⑵中，压力比较模块得出力误差信号为fQ-f；。 所述步骤⑵中，位置比较模块得出位置误差信号xm-xs。 所述步骤（2)中，第一控制器产生的驱动力为：【主权项】1. 一种机械臂力觉临场感的主从遥操作控制系统，其特征是：包括主机械臂控制系 统、主控制系统和从机械臂控制系统，其中： 所述主机械臂控制系统包括编码器、压力传感器、力矩电机、马达驱动器和第一无线 模块，所述编码器连接第一无线模块，所述第一无线模块与马达驱动器连接，马达驱动器连 接安装于主机械臂各关节处的力矩电机，第一无线模块与主机械臂上安设的压力传感器连 接； 所述从机械臂控制系统包括电位器、压力传感器、伺服电机、马达驱动器和第四无线模 块，所述电位器安装于从机械臂的各个关节处，且连接第四无线模块，所述第四无线模块与 马达驱动器连接，马达驱动器连接伺服电机，第四无线模块与从机械臂上的压力传感器连 接； 所述主控制系统，包括第二无线模块、第三无线模块、第一控制器、第二控制器、位置比 较模块、PID控制器和压力比较模块，其中，第二无线模块与所述第一无线模块通信，第三无 线模块连接所述第四无线模块，压力比较模块连接第二无线模块、第三无线模块和第一控 制器，所述位置比较模块连接PID控制器、第二无线模块和第三无线模块，PID控制器连接 第二控制器，第二控制器连接第三无线模块。2. 如权利要求1所述的一种机械臂力觉临场感的主从遥操作控制系统，其特征是：所 述主机械臂控制系统安装有急停、校对的按钮。3. 如权利要求1所述的一种机械臂力觉临场感的主从遥操作控制系统，其特征是：所 述主机械臂与从机械臂的结构一致，且两者尺寸呈比例关系。4. 如权利要求1所述的一种机械臂力觉临场感的主从遥操作控制系统，其特征是：所 述编码器内置于主机械臂上，采集主机械臂的位置、速度信号，并对其进行滤波处理后，传 输给第一无线模块。5. 如权利要求1所述的一种机械臂力觉临场感的主从遥操作控制系统，其特征是：所 述电位器安装于从机械臂的各个关节上，采集从机械臂的位置、速度信号，并对其进行滤波 处理后，传输给第四无线模块。【专利摘要】本技术公开了一种机械臂力觉临场感的主从遥操作控制系统，系统包括主机械臂控制系统、主控制系统和从机械臂控制系统，通过该系统的控制策略性能稳定可靠、信息处理平滑稳定，满足主从控制作业任务的要求。本技术的构思是在主从机器人上安装无线通信模块，实现控制指令与传感器信号的无线传输，通过主从隔离，实现主从的跟踪与主手很好的力觉感；本技术通过主从控制的方式完成复杂作业，并通过各种传感器采集的信息，提高其操作性能。【IPC分类】B25J13-00, B25J3-04【公开号】CN204546505【申请号】CN201520265986【专利技术人】谭林, 慕世友, 任杰, 傅孟潮, 鲁守银, 李健, 王振利, 吕曦晨, 李建祥, 赵金龙, 陈强, 赵亚博 【申请人】山东鲁能智能技术有限公司【公开日】2015年8月12日【申请日】2015年4月28日本文档来自技高网...
【技术保护点】
一种机械臂力觉临场感的主从遥操作控制系统，其特征是：包括主机械臂控制系统、主控制系统和从机械臂控制系统，其中：所述主机械臂控制系统包括编码器、压力传感器、力矩电机、马达驱动器和第一无线模块，所述编码器连接第一无线模块，所述第一无线模块与马达驱动器连接，马达驱动器连接安装于主机械臂各关节处的力矩电机，第一无线模块与主机械臂上安设的压力传感器连接；所述从机械臂控制系统包括电位器、压力传感器、伺服电机、马达驱动器和第四无线模块，所述电位器安装于从机械臂的各个关节处，且连接第四无线模块，所述第四无线模块与马达驱动器连接，马达驱动器连接伺服电机，第四无线模块与从机械臂上的压力传感器连接；所述主控制系统，包括第二无线模块、第三无线模块、第一控制器、第二控制器、位置比较模块、PID控制器和压力比较模块，其中，第二无线模块与所述第一无线模块通信，第三无线模块连接所述第四无线模块，压力比较模块连接第二无线模块、第三无线模块和第一控制器，所述位置比较模块连接PID控制器、第二无线模块和第三无线模块，PID控制器连接第二控制器，第二控制器连接第三无线模块。
【技术特征摘要】
【专利技术属性】
技术研发人员：谭林，慕世友，任杰，傅孟潮，鲁守银，李健，王振利，吕曦晨，李建祥，赵金龙，陈强，赵亚博，
申请(专利权)人：山东鲁能智能技术有限公司，
类型：新型
国别省市：山东;37
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。