一种防爆电动夹爪及其控制方法与流程

摘要: 本发明涉及危险环境用电动夹持设备,具体涉及一种防爆电动夹爪及其控制方法。背景技术:1、军工药柱在生产、转运或加工过程中需要由夹持装置抓取。该类被夹持物通常具有直...
一种防爆电动夹爪及其控制方法与流程

本发明涉及危险环境用电动夹持设备,具体涉及一种防爆电动夹爪及其控制方法。

背景技术:

1、军工药柱在生产、转运或加工过程中需要由夹持装置抓取。该类被夹持物通常具有直径规格多、表面不宜承受过大局部压力以及作业环境对电气设备安全等级要求高等特点。气动夹爪依赖气源、阀组和气路,在需要精细调节夹持过程时,气体可压缩性及管路状态会影响控制一致性。电动夹爪能够通过电机位置和扭矩反馈调整开合过程,因而适于构成长行程夹持装置。

2、电动平行夹爪通过电机驱动正反牙丝杆,使两夹爪相向或相背移动。为了适应不同直径的柱状物,采用同步带、减速机构和较长的滚珠丝杆扩大开合范围,并以直线导轨承受夹爪偏载。电机编码器能够准确反映电机轴位置,但编码器位于传动链输入侧,编码器位置与夹爪实际开度之间还受到减速机构间隙、同步带弹性、丝杆螺母副摩擦、换向回差和装配误差的影响。行程较长时,上述影响还可能随夹爪位置、运动方向和速度发生变化。

3、现有电动夹爪还可以通过限制电机扭矩防止持续增夹,并通过位移传感器检查夹爪位置。然而,电机扭矩升高既可能由夹爪接触被夹持物引起,也可能由导轨或丝杆卡滞引起;电机侧位置与负载侧位置产生差异,既可能是传动链受力后的正常弹性变形,也可能是同步带跳齿、连接松脱或传感器异常造成。若仅采用固定位置差阈值,阈值过小容易在换向或高摩擦区间误报,阈值过大又难以及时发现传动异常。若发生异常后统一停止或立即张开,在夹爪已经承载药柱时还可能造成药柱失去支承。

4、因此,本领域需要一种与正反牙丝杆夹爪的实际传动关系相适配的控制方式,使无载标定、接触识别、接触后负载作用限制和故障处置形成连续的控制链,在不增加夹爪端力传感器的情况下减小传动摩擦、回差和弹性变形对药柱夹持判断的干扰。

技术实现思路

1、本发明的目的在于提供一种防爆电动夹爪及其控制方法,以区分夹持对象的有效接触与传动异常,限制有效接触后的负载侧实际压缩量、累积机械作用和瞬时驱动力,并在故障时根据夹爪是否已经承载夹持对象执行不同安全动作。

2、为实现上述目的,本发明提供如下技术方案:

3、一种防爆电动夹爪,包括基座、左夹爪、右夹爪、防爆伺服电机、减速机构、同步带机构、正反牙滚珠丝杆、电机编码器、拉绳位移传感器和控制器,所述防爆伺服电机经所述减速机构以及所述同步带机构驱动所述正反牙滚珠丝杆转动,以等量反向运动方式改变左夹爪和右夹爪之间形成的两夹爪总开度,所述左夹爪和所述右夹爪分别与所述正反牙滚珠丝杆的正牙螺纹副和反牙螺纹副连接,所述左夹爪和所述右夹爪分别与所述基座滑动连接,所述拉绳位移传感器的本体端与所述基座固定连接,所述拉绳位移传感器的拉绳端与所述左夹爪或所述右夹爪固定连接;

4、所述控制器分别与所述电机编码器、所述拉绳位移传感器以及所述防爆伺服电机电性连接,所述控制器能够读取伺服扭矩反馈或根据电流反馈确定伺服扭矩,用于根据所述电机编码器的输出确定电机侧理论总开度,并根据所述拉绳位移传感器的输出及所述等量反向运动方式确定负载侧实际总开度;

5、所述控制器被配置为:利用无载运动建立所述电机侧理论总开度与所述负载侧实际总开度之间的开度映射、无载扭矩基准以及与行程位置和运动方向关联的位置残差容差包络;在夹持接近过程中,依据所述伺服扭矩相对于所述无载扭矩基准的变化、所述电机侧理论总开度和所述负载侧实际总开度的变化状态以及由所述开度映射确定的位置残差是否处于所述位置残差容差包络内,确认与夹持对象的有效接触;在确认有效接触后,将负载侧实际压缩量、扣除无载传动消耗和传动弹性储能后的负载作用能量表征量以及所述伺服扭矩分别与对应阈值比较,任一达到对应阈值时停止继续增夹;在所述位置残差超出所述位置残差容差包络或者所述伺服扭矩与所述电机侧理论总开度、所述负载侧实际总开度的变化关系异常时,依据所述电机侧理论总开度、所述负载侧实际总开度和所述伺服扭矩的变化确定故障指纹,并根据故障发生前是否已确认有效接触选择空载安全动作或带载安全动作。

6、作为优选,所述基座设有至少两个相互平行的直线导轨,每个直线导轨上设有至少两个与其滑动连接的滑块,所述左夹爪上设有左夹爪安装板,所述右夹爪上设有右夹爪安装板,所述左夹爪安装板和所述右夹爪安装板分别通过所述滑块与所述直线导轨滑动连接。

7、作为优选,所述控制器按照下式确定所述负载作用能量表征量:

8、;

9、其中,el为所述负载作用能量表征量,wm为自确定有效接触起由伺服扭矩和电机转角增量确定的电机机械功,wb为根据所述无载扭矩基准确定的对应运动区段的无载传动消耗,ws为根据所述传动残差与传动弹性储能的标定关系确定的传动弹性储能变化量;当wm-wb-ws的值小于零时,将el置为零。

10、作为优选,所述空载安全动作指令包括停止闭合并向安全开度张开的指令;所述带载安全动作指令包括停止继续增夹、输出释放禁止信号和外部支承请求信号的指令,所述控制器仅在接收到外部支承确认信号后解除所述释放禁止信号。

11、一种如上任一项所述的防爆电动夹爪的控制方法,该控制方法包括以下步骤:

12、s1、在无载状态下驱动所述左夹爪和所述右夹爪运动,根据所述电机编码器的输出确定电机侧理论总开度,根据所述拉绳位移传感器的输出及所述等量反向运动方式确定负载侧实际总开度,建立所述电机侧理论总开度与所述负载侧实际总开度之间的开度映射、无载扭矩基准以及与行程位置和运动方向关联的位置残差容差包络;

13、s2、在夹持接近过程中,读取伺服扭矩反馈或根据电流反馈确定伺服扭矩,并根据所述伺服扭矩相对于所述无载扭矩基准的变化、所述电机侧理论总开度与所述负载侧实际总开度的变化状态,以及由所述开度映射确定的位置残差是否处于所述位置残差容差包络内,确认与夹持对象的有效接触;

14、s3、以确认有效接触的时刻为起点,根据所述负载侧实际总开度的减小量确定负载侧实际压缩量,根据电机侧理论闭合量与负载侧实际闭合量之差确定传动残差,并根据接触后的电机机械功扣除对应运动区段的无载传动消耗和与所述传动残差对应的传动弹性储能,确定负载作用能量表征量;

15、s4、将所述负载侧实际压缩量、所述负载作用能量表征量和所述伺服扭矩分别与对应阈值比较,在任一达到对应阈值时停止继续增夹;

16、s5、在步骤s2-s4的任一期间,当所述位置残差超出所述位置残差容差包络,或者所述伺服扭矩与所述电机侧理论总开度、所述负载侧实际总开度的变化关系异常时,根据所述电机侧理论总开度、所述负载侧实际总开度和所述伺服扭矩的变化方向、变化率及持续时间确定故障指纹,并根据故障发生前是否已确认有效接触,分别执行空载安全动作或带载安全动作。

17、作为优选,步骤s1包括分别沿闭合方向和张开方向,在多个行程位置记录所述开度映射、所述无载扭矩基准和所述位置残差容差包络;在换向区段中,根据所述电机侧理论总开度已发生变化而所述负载侧实际总开度尚未发生对应变化的区间确定传动回差;并在至少两个速度档下分别记录标定数据,使所述位置残差容差包络与行程位置、运动方向和速度档关联,且在夹持作业期间调用通过一致性校验后冻结的标定数据,而不扩大所述位置残差容差包络。

18、作为优选,步骤s2中,当所述伺服扭矩相对于所述无载扭矩基准的增量或变化率达到接触判据,所述电机侧理论总开度和所述负载侧实际总开度的闭合变化率均相对于夹持接近阶段下降,并且在接触确认时间窗内所述位置残差持续处于所述位置残差容差包络内时,确认有效接触;当所述伺服扭矩上升而所述位置残差已超出所述位置残差容差包络时,不确认有效接触并转入步骤s5。

19、作为优选,步骤s3中,通过所述左夹爪和所述右夹爪接触刚性标定件或专用限位件的受控加载过程,建立所述传动残差与传动弹性储能的标定关系;根据所述伺服扭矩和接触后的电机转角增量计算所述电机机械功,根据同一运动区段的所述无载扭矩基准计算所述无载传动消耗,再从所述电机机械功中扣除所述无载传动消耗和所述传动弹性储能的变化量,计算所述负载作用能量表征量,且在扣除所得的值小于零时将所述负载作用能量表征量置为零。

20、作为优选,步骤s5中,在闭合指令持续存在的观察时间窗内,当所述电机侧理论总开度和所述负载侧实际总开度均未产生超过对应变化阈值的闭合变化且所述伺服扭矩上升时,确定机械卡滞指纹;当所述电机侧理论总开度产生超过对应变化阈值的闭合变化、所述负载侧实际总开度未产生对应变化且所述伺服扭矩未达到机械卡滞判定区间时,确定传动失联指纹;当所述电机侧理论总开度未产生超过对应变化阈值的变化而所述负载侧实际总开度产生超过对应变化阈值的变化时,确定负载侧外力位移或传动松脱指纹。

21、作为优选,步骤s5中,在尚未确认有效接触时出现故障指纹,停止闭合,并在张开路径正常时使所述左夹爪和所述右夹爪向安全开度张开;在已确认有效接触后出现故障指纹,停止继续增夹,输出释放禁止信号和外部支承请求信号,在接收到外部支承确认信号后允许所述左夹爪和所述右夹爪受控释放;故障复位后且再次夹持前,执行无载一致性检查,并在所述同步带机构、所述正反牙滚珠丝杆、所述拉绳位移传感器或所述电机编码器维修或更换后重新执行步骤s1。

22、与现有技术相比,本发明具有以下优点:

23、本发明的一种防爆电动夹爪及其控制方法,将电机编码器、拉绳位移传感器和伺服扭矩的反馈用于同一夹持过程,使无载标定、有效接触确认、接触后增夹限制以及故障处置相互衔接,减小传动误差对夹持状态判断的干扰;

24、本发明中,正反牙滚珠丝杆驱动左夹爪和右夹爪等量反向运动,使拉绳位移传感器检测到的单侧位移能够换算为两夹爪总开度,控制器可分别取得电机侧理论总开度和负载侧实际总开度,识别电机侧运动与夹爪实际运动之间的差异,控制器通过无载运动建立开度映射、无载扭矩基准以及与行程位置和运动方向关联的位置残差容差包络,使夹持接近过程中的伺服扭矩变化和位置差异具有相应的比较基准。有效接触的确认同时依据伺服扭矩变化、电机侧理论总开度与负载侧实际总开度的变化状态以及位置残差是否处于位置残差容差包络内,因而可降低仅凭伺服扭矩升高而将传动受阻误判为夹持对象接触的风险;

25、本发明中,控制器分别以负载侧实际压缩量、扣除无载传动消耗和传动弹性储能后的负载作用能量表征量以及伺服扭矩限制继续增夹,这三个控制量分别对应夹持对象侧的几何压缩、累积机械作用和瞬时驱动作用;任一达到对应阈值即停止继续增夹,避免仅依赖单一伺服扭矩阈值控制夹持过程;当位置残差超出位置残差容差包络,或者伺服扭矩与电机侧理论总开度、负载侧实际总开度的变化关系异常时,控制器依据上述反馈的变化确定故障指纹,并根据故障发生前是否已确认有效接触选择空载安全动作或带载安全动作。由此,异常处置能够考虑夹爪是否已经接触夹持对象,避免对不同负载状态一律执行相同动作。