一种力/位混合柔顺控制的夹持装置、手操设备以及夹持装置和手操设备的控制方法制造方法及图纸

一种力/位混合柔顺控制的夹持装置、手操设备以及夹持装置和手操设备的控制方法，涉及具有遥控力反馈手操的力/位混合柔顺控制夹持技术。目的是为了适应工业机器人的发展需求。操作人员转动手操设备的手轮时，二号编码器记录手轮的转动位移，转动位移信号作为夹持位置指令通过现场总线传送到夹持装置的一号处理器中。一号处理器控制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总线接口用于接收位置指令以及发送力反馈信号，压力传感器的检测信号输出端通过信号调理电路连接一号处理器的夹持力反馈信号输入端。与上述夹持装置相配合的手操设备包括手轮15、二号编码器16、磁粉制动器19、齿形带20、三号齿轮21、四号齿轮22、二号处理器、二号差分/TTL电平转换电路、H桥驱动器25和霍尔电流传感器；三号齿轮21套固在手轮15的转轴上，四号齿轮22套固在磁粉制动器19上，四号齿轮22用于通过齿形带20带动三号齿轮21转动；二号处理器的二号编码器16用于检测手轮15转轴的角位移，二号编码器16的信号输出端通过二号差分/TTL电平转换电路连接二号处理器的手轮角位移信号输入端，二号处理器的控制信号输出端通过H桥驱动器25连接磁粉制动器19的控制信号输入端，霍尔电流传感器用于检测磁粉制动器19的驱动电流，霍尔电流传感器的电流检测信号输出端连接二号处理器的电流反馈信号输入端，二号处理器的CAN总线接口用于发送位置指令以及接收力反馈信号。上述夹持装置的控制方法由嵌入在一号处理器内的软件实现，所述方法包括以下步骤：位置指令接收步骤：接收位置指令；压力采集步骤：采集压力传感器发来的压力信号；压力信号发送步骤：将压力传感器发来的压力信号发送给手操设备；力反馈等效位移获得步骤：利用力/位移转换函数将采集到的压力信号转换为力反馈等效位移；夹持臂当前位置获得步骤：将一号编码器4发来的信号转换为夹持臂当前位置信息；位移偏差计算步骤：计算位移偏差，所述位移偏差＝位置指令－力反馈等效位移－夹持臂当前位置；电机控制信号发送步骤：利用闭环控制算法(如PID控制算法)将所述位移偏差转换为电机控制信号，并将该电机控制信号发送给驱动电路12。上述手操设备的控制方法由嵌入在二号处理器内的软件实现，所述方法包括以下步骤：位置指令发送步骤：将二号编码器16发来的信号转换为两个V型定位夹持臂8的位置指令，并向夹持装置发送该位置指令；压力信号接收步骤：接收夹持装置发来的压力信号，所述压力信号即为阻尼力矩指令；等效阻尼力矩获得步骤：采集霍尔电流传感器发来的电流信号，并根据磁粉制动器19的电流-阻尼力矩关系曲线将所述电流信号转换为等效阻尼力矩；力矩偏差计算步骤：计算力矩偏差计，所述力矩偏差计＝阻尼力矩指令－等效阻尼力矩；磁粉制动器控制信号发送步骤：利用闭环控制算法(如PID控制算法)将所述力矩偏差转换为磁粉制动器控制信号，并将该磁粉制动器控制信号发送给H桥驱动器25。本专利技术所述的夹持装置与手动操作设备所构成的系统，能够在远程夹持物体过程中模仿人手的功能，实现夹持过程的柔顺控制。上述夹持装置具有简单紧凑的机械结构，V型定位柔性夹持臂从结构角度完成柔性夹持和无预应力的压力反馈；双向螺杆驱动使驱动具有自锁功能；压力传感器信号除了给夹持控制端提供力反馈信号外，还通过现场总线传输到远程操作端，作为操控装置阻尼控制指令。夹持装置的控制方法利用闭环控制算法实现V型定位柔性夹持臂精确柔顺控制。上述手操设备采用磁粉制动器作为产生可变阻尼的执行机构，为防止阻尼力过大以及滑差速率过低对造成的力矩不连续，本专利技术在手轮与磁粉制动器输入轴之间采用齿轮皮带传动结构，通过调整传动比改善磁粉制动器的输出阻尼力矩的平滑性。与电机类力反馈执行装置相比，磁粉制动器是阻尼器件，不会产生反向力矩，通过调节激磁电流可实现阻尼力矩的连续可调；手操设备的控制方法根据现场压力信号，闭环调节磁粉制动器的输出电流，进而控制阻尼力矩，使操作者能在远程控制端感知现场的夹持压力状态。本专利技术具有操作、控制简单方便，无需提供丝筒、钢丝、转盘、弹簧等辅助机构等优点，具有远程操作功能，且遥控操作者能够感知夹持力的大小，适用于绝大多数需要远程控制的精确柔性夹持的应用场合。附图说明图1为实施方式一中的夹持装置与手动操作设备构成的系统的总体结构示意图，其中夹持控制电路为夹持装置中的电气部分，手操控制电路为手操设备中的电气部分；图2为实施方式一所述的夹持装置的机械结构示意图；图3为实施方式一中的两个V型定位夹持臂的结构示意图，图中黑色填充部分为压力传感器；图4为实施方式一中所述的夹持装置的电气结构示意图；图5为实施方式二中的控制模块的工作原理示意图；图6为实施方式二中的力/位混合柔顺控制原理框图；图7为实施方式三中的力/位移转换函数关系；图8为实施方式八所述的手操设备的机械结构示意图，该图为侧视图；图9为实施方式八所述的手操设备的电气结构示意图；图10为实施方式九中的控制模块的工作原理示意图；图11为实施方式九中的控制模块的工作流程图。具体实施方式具体实施方式一：结合图1至图4说明本实施方式，本实施方式所述的一种力/位混合柔顺控制的夹持装置包括底板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的夹持面均设置有硅本文档来自技高网...

【技术保护点】
一种力/位混合柔顺控制的夹持装置，其特征在于，该夹持装置包括底板(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总线接口用于接收位置指令以及发送力反馈信号，压力传感器的检测信号输出端通过信号调理电路连接一号处理器的夹持力反馈信号输入端。...

【技术特征摘要】
1.一种力/位混合柔顺控制的夹持装置，该夹持装置包括底板(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)。2.根据权利要求1所述的一种力/位混合柔顺控制的夹持装置，其特征在于，力反馈等效位移获得单元中的力/位移转换函数为：其中，d为力反馈等效位移，f为V型定位夹持臂(8)所承受的压力，k1、k2和k3分别为欠压力夹持区、压力夹持区和过压力夹持区的增益系数，f0为欠压力夹持区的压力上限，f1为过压力夹持区的压力下限。3.根据权利要求1所述的一种力/位混合柔顺控制的夹持装置，其特征在于，所述夹持控制模块还包括：压力阈值比较单元：判断采集到的压力信号是否超出阈值，并在判断结果为是时结束所述夹持控制模块的运行，在判断结果为否时重新启动压力阈值比较单元。4.根据权利要求1所述的一种力/位混合柔顺控制的夹持装置，其特征在于，所述夹持控制模块还包括：位置阈值比较单元：根据夹持臂当前位置信息判断夹持臂当前位置是否超出夹持臂的位置限制，并在判断结果为是时结束所述夹持控制模块的运行，在判断结果为否时重新启动位置阈值比较单元。5.根据权利要求1所述的一种...

【专利技术属性】
技术研发人员：于占东，张鹏，于震，张宇峰，
申请(专利权)人：渤海大学，
类型：发明
国别省市：辽宁;21