[发明专利]一种力/位混合柔顺控制的夹持装置、手操设备以及夹持装置和手操设备的控制方法

摘要

一种力/位混合柔顺控制的夹持装置、手操设备以及夹持装置和手操设备的控制方法，涉及具有遥控力反馈手操的力/位混合柔顺控制夹持技术。目的是为了适应工业机器人的发展需求。操作人员转动手操设备的手轮时，二号编码器记录手轮的转动位移，转动位移信号作为夹持位置指令通过现场总线传送到夹持装置的一号处理器中。一号处理器控制V型定位夹持臂移动到指令位置。同时，一号处理器还将压力信息通过现场总线传送到手动操作设备的二号处理器中。二号处理器根据压力信息调整磁粉制动器的驱动电流，进而调整操作手轮上的阻尼力矩。本发明具有远程操作功能，且遥控操作者能够感知夹持力的大小，适用于绝大多数需要远程控制的精确柔性夹持的应用场合。

主权项

一种力/位混合柔顺控制的夹持装置，该夹持装置包括底板(1)、电机支架(2)、电机(3)、一号编码器(4)、减速器(5)、滑台(6)、双向螺杆(7)、两个V型定位夹持臂(8)、螺杆支架(10)、一号处理器、驱动电路(12)、一号差分/TTL电平转换电路和信号调理电路；电机支架(2)用于将电机(3)固定在底板(1)上，螺杆支架(10)用于将双向螺杆(7)固定在底板(1)上，且双向螺杆(7)能够绕其轴线转动，电机(3)用于通过减速器(5)带动双向螺杆(7)转动；滑台(6)固定在底板(1)上，且滑台(6)的上表面设置有凹槽，该凹槽的长度方向与双向螺杆(7)的轴线平行；两个V型定位夹持臂(8)相对设置，每个V型定位夹持臂(8)的夹持面均设置有硅橡胶贴装层(9)，且其中一个硅橡胶贴装层(9)内埋有压力传感器；两个V型定位夹持臂(8)分别与双向螺杆(7)的两端螺纹连接，两个V型定位夹持臂(8)的底部均位于滑台(6)上的凹槽内，并能够沿该凹槽的长度方向移动；一号处理器的控制信号输出端通过驱动电路(12)连接电机(3)的控制信号输入端，一号编码器(4)用于检测电机(3)输出轴的角位移，一号编码器(4)的信号输出端通过一号差分/TTL电平转换电路连接一号处理器的电机角位移信号输入端，一号处理器的CAN总线接口用于接收位置指令以及发送力反馈信号，压力传感器的检测信号输出端通过信号调理电路连接一号处理器的夹持力反馈信号输入端；其特征在于，一号处理器内嵌入夹持控制模块，所述夹持控制模块包括以下单元：位置指令接收单元：接收位置指令；压力采集单元：采集压力传感器发来的压力信号；压力信号发送单元：将压力传感器发来的压力信号发送给手操设备；力反馈等效位移获得单元：利用力/位移转换函数将采集到的压力信号转换为力反馈等效位移；夹持臂当前位置获得单元：将一号编码器(4)发来的信号转换为夹持臂当前位置信息；位移偏差计算单元：计算位移偏差，所述位移偏差＝位置指令－力反馈等效位移－夹持臂当前位置；电机控制信号发送单元：利用闭环控制算法将所述位移偏差转换为电机控制信号，并将该电机控制信号发送给驱动电路(12)。