一种用于协作机器人关节模组的调试系统及方法与流程

摘要: 本发明涉及机器人,具体的说是一种用于协作机器人关节模组的调试系统及方法。背景技术:1、协作机器人因其安全、柔性的特点,在智能制造、医疗、服务等领域得到广泛应用。...
一种用于协作机器人关节模组的调试系统及方法与流程

本发明涉及机器人,具体的说是一种用于协作机器人关节模组的调试系统及方法。

背景技术:

1、协作机器人因其安全、柔性的特点,在智能制造、医疗、服务等领域得到广泛应用。典型协作机器人由多个旋转关节模组串联构成,每个关节模组内集成有无框电机、减速器、驱动板等。在研发、生产及维护阶段,常常需要对驱动板进行参数调整、固件升级、故障诊断等底层调试操作。

2、现有技术中,驱动板通常封闭在关节外壳内部,调试接口仅以板上焊盘或内部接插件形式存在。操作人员调试时必须打开机器人外壳,逐一连接每个关节的调试接口。该方式存在以下问题:

3、一、操作繁琐,维护效率低:开盖需要专用工具,且对于已部署在生产线或狭小空间的机器人,拆装外壳极为不便,导致较长的停机时间;

4、二、信号易衰减,长距离不可靠:关节之间的线缆长度,累计可达2~3米,普通数字调试信号在长线传输后上升沿变缓、幅值下降,易产生误码。

5、三、安全性不足:调试过程中,若忘记切断无框电机功率,调试命令可能意外使无框电机转动,造成人身伤害或设备损坏。即使手动断电,也需额外操作,不符合协作机器人本质安全理念。

6、文献号为cn111360814a的发明专利公开了一种协作机器人控制系统及方法,关节驱动器用于控制所述协作机器人关节电机运转,采集所述协作机器人关节的位置数据进;系统io板用于获取所述协作机器人各传感器采集的数据,并将数据上传至rc控制器;工业接口板用于控制所述协作机器人的上电状态,以令协作机器人执行启停动作;rc控制器用于:向关节驱动器发送运动控制数据,以令所述协作机器人根据该运动控制数据执行相应的动作;以及,根据系统io板反馈的数据进行分析处理,当传感器采集的数据不符合预设的数据条件时,通过工业接口板控制所述协作机器人执行安全急停动作。本发明系统结构不区分动力电和控制电,而且抱闸由关节驱动器实现分布式控制,大大降低了关节抱闸维修难度。

7、根据上述现有技术记载可知,其虽然在维修方面有所改进,但针对维修实际的拆装等问题并未得到解决,且故障时,误码以及安全性问题也未得到解决。因此,需要一种无需开盖、信号可靠、故障容错且安全的协作机器人关节模组调试系统及方法。

技术实现思路

1、现为了满足上述针对具备无需开盖、信号可靠、故障容错且安全的性能需求,本发明提出了一种用于协作机器人关节模组的调试系统及方法。

2、本发明所要解决的技术问题采用以下技术方案来实现:

3、一种用于协作机器人关节模组调试系统,包括调试连接器以及多个关节模组;

4、调试连接器,用于与外部的调试主机连接,提供统一的调试总线接口;

5、多个关节模组,每个关节模组内具有驱动板、无框电机以及调试处理单元;

6、所述调试处理单元包含:信号再生模块、数字隔离模块、故障检测与旁路模块、逻辑控制模块以及安全互锁模块;

7、所有关节模组的调试处理单元通过菊花链方式串联,j1轴的调试处理单元连接至调试连接器,终端开路;

8、所述调试主机通过调试连接器发送包含目标地址的调试命令,各关节模组根据地址匹配情况选择执行命令并返回响应,或再生后转发命令。

9、一种用于协作机器人关节模组的调试方法,包括以下步骤:

10、步骤一:调试主机通过调试连接器发送枚举命令,沿菊花链依次获取每个关节模组的节点地址;

11、步骤二:调试主机通过模式选择线激活所有关节模组的安全互锁模块,切断各关节驱动板的功率电源;

12、步骤三:调试主机发送带目标地址的命令帧,目标关节执行命令并返回响应,非目标关节再生后转发;

13、步骤四:若某关节模组内部故障,其故障检测与旁路模块自动闭合旁路开关,使命令帧绕过该关节继续传递。

14、本发明的有益效果是:

15、(1)免开盖集中调试:所有关节的调试接口统一到调试连接器,一次连接即可访问全部驱动板,大幅提升调试和维护效率。

16、(2)长距离可靠通信:每个关节主动再生信号,有效克服长线缆引起的信号衰减,支持较高时钟频率无误码。

17、(3)本质安全设计:调试模式由独立硬件信号线控制,强制切断无框电机功率电,无需软件参与,安全性能较好。

18、(4)单点故障容错:任一关节的调试电路损坏,其旁路机制可自动跳过,其余关节仍可正常调试,避免整机不可维护,同时也可以快速识别故障关节。

1.一种用于协作机器人关节模组调试系统,其特征在于:包括:

2.根据权利要求1所述的用于协作机器人关节模组调试系统,其特征在于:所述调试总线至少包括调试数据输入线、调试数据输出线、时钟线、模式选择线以及地线。

3.根据权利要求2所述的用于协作机器人关节模组调试系统,其特征在于:所述模式选择线在调试模式下由调试主机(100)拉低,所述安全互锁模块(315)响应于该低电平切断所有关节模组(300)中驱动板(320)的功率电源。

4.根据权利要求1所述的用于协作机器人关节模组调试系统,其特征在于:所述故障检测与旁路模块(314)在检测到本关节模组(300)的调试处理单元(310)内部故障时,自动将输入调试信号直接导通至输出端,跳过本关节模组(300)。

5.根据权利要求1所述的用于协作机器人关节模组调试系统,其特征在于:所述信号再生模块(311)采用施密特触发器缓冲器,对输入的时钟和数据信号进行波形整形。

6.根据权利要求1所述的用于协作机器人关节模组调试系统,其特征在于:所述数字隔离模块(312)为电容隔离芯片,将调试总线地与驱动板(320)控制地隔离。

7.根据权利要求1所述的用于协作机器人关节模组调试系统,其特征在于:所述逻辑控制模块(313)包括节点地址存储器,用于存储本关节的唯一标识,并解析调试命令中的目标地址。

8.一种用于协作机器人关节模组调试方法,根据权利要求1至7中任意一项所述的用于协作机器人关节模组调试系统,其特征在于:包括以下步骤:

9.根据权利要求8所述的用于协作机器人关节模组调试方法,其特征在于:所述的步骤三中所述命令帧格式包括:帧头、目标地址、命令码、数据长度、数据体、crc校验。

10.根据权利要求8所述的用于协作机器人关节模组调试方法,其特征在于:所述的步骤二中所述模式选择线为独立硬件信号线,所有关节并联检测,调试模式生效时同时切断功率电。