减速器的转动圈数确定方法、关节模组、灵巧手和机器人与流程

摘要: 本申请涉及机器人,特别涉及一种减速器的转动圈数确定方法、关节模组、灵巧手和机器人。背景技术:1、在相关技术中,减速器在工业自动化、机器人等领域有着广泛应用,可以...
减速器的转动圈数确定方法、关节模组、灵巧手和机器人与流程

本申请涉及机器人,特别涉及一种减速器的转动圈数确定方法、关节模组、灵巧手和机器人。

背景技术:

1、在相关技术中,减速器在工业自动化、机器人等领域有着广泛应用,可以起到增大输出转矩、提高控制精度等作用。在很多应用中,为了保证控制精度,会在减速器输入和输出侧都安装一个编码器,输入侧编码器用于电机控制,输出侧编码器用于定位,通过输入侧和输出侧反馈角度还可以检测减速器形变,从而估计出减速器的输出扭矩。

2、对于单圈绝对式编码器,在正常工作时,可以通过角度变化情况计算转动的圈数,例如,如果角度从突变为0时,则表明转动圈数增加了一圈,如果角度从0突变为,则表明转动圈数减少了一圈。但如果单圈绝对式编码器断电重新上电后,则无法获知断电前已经转动的圈数,即圈数会丢失,因此,单圈绝对式编码器无法满足一些必须提供转动圈数的应用要求。

技术实现思路

1、本申请旨在至少解决现有技术中存在的技术问题之一。为此,本申请提出一种减速器的转动圈数确定方法、关节模组、灵巧手和机器人,能够在编码器掉电后估计出减速器输入侧和输出侧已经转动的圈数,满足一些必须提供转动圈数的应用要求。

2、第一方面,本申请实施例提供了一种减速器的转动圈数确定方法,所述减速器的输入侧和输出侧均设置有单圈绝对式编码器,所述方法包括:

3、通过所述单圈绝对式编码器获取所述减速器的输入侧角度和输出侧角度;

4、确定所述减速器的减速比、初始偏差角度以及输出侧圈数的候选取值范围;

5、对于所述候选取值范围中的每一个输出侧圈数候选值,根据所述输入侧角度、所述输出侧角度、所述减速比、所述初始偏差角度和所述输出侧圈数候选值,确定所述减速器的输入侧圈数候选值;

6、确定每一个所述输入侧圈数候选值的可靠度,从多个所述可靠度中筛选出目标可靠度;

7、根据所述目标可靠度确定所述减速器的输入侧历史转动圈数和/或输出侧历史转动圈数。

8、根据本申请的一些实施例,所述单圈绝对式编码器包括设置于所述减速器输入侧的第一单圈绝对式编码器以及设置于所述减速器输出侧的第二单圈绝对式编码器;所述通过所述单圈绝对式编码器获取所述减速器的输入侧角度和输出侧角度,包括:

9、获取所述第一单圈绝对式编码器的第一反馈以及所述第二单圈绝对式编码器的第二反馈;

10、根据所述第一反馈和所述第一单圈绝对式编码器的第一分辨率,确定所述输入侧角度;

11、根据所述第二反馈和所述第二单圈绝对式编码器的第二分辨率,确定所述输出侧角度。

12、根据本申请的一些实施例,包括如下之一:

13、所述输入侧角度由所述第一反馈与所述第一分辨率的比值确定得到,其中,所述第一反馈大于等于零并且小于所述第一分辨率,所述输入侧角度大于等于零并且小于2;

14、所述输出侧角度为所述第二反馈与所述第二分辨率的比值确定得到,其中,所述第二反馈大于等于零并且小于所述第二分辨率,所述输出侧角度大于等于零并且小于2。

15、根据本申请的一些实施例,所述候选取值范围通过如下步骤确定得到:

16、根据所述减速比确定所述减速器的减速比分子和减速比分母,其中,所述减速比为所述减速比分子和所述减速比分母的比值,并且所述减速比分子和所述减速比分母均为正整数;

17、基于所述减速比分母确定所述减速器的输出侧圈数的候选取值范围,其中,所述候选取值范围为大于等于零并且小于所述减速比分母的取值范围。

18、根据本申请的一些实施例,所述初始偏差角度为在所述减速器的输出侧的角度位置和圈数均为零的情况下,所述减速器的输入侧所处的角度位置。

19、根据本申请的一些实施例,所述根据所述输入侧角度、所述输出侧角度、所述减速比、所述初始偏差角度和所述输出侧圈数候选值,确定所述减速器的输入侧圈数候选值,包括:

20、确定所述减速器在所述输出侧圈数候选值和所述输出侧角度下的输出侧累计转动角度;

21、根据所述输出侧累计转动角度和所述减速比确定所述减速器的输入侧累计转动角度;

22、根据所述输入侧累计转动角度、所述输入侧角度和所述初始偏差角度确定所述减速器的输入侧圈数候选值。

23、根据本申请的一些实施例,所述确定每一个所述输入侧圈数候选值的可靠度,包括:

24、对所述输入侧圈数候选值进行舍入运算,得到舍入值;

25、确定所述输入侧圈数候选值和所述舍入值的差值绝对值;

26、根据差值绝对值确定所述输入侧圈数候选值的可靠度。

27、根据本申请的一些实施例,所述从多个所述可靠度中筛选出目标可靠度,包括:从多个所述可靠度中筛选出数值最大的所述可靠度作为目标可靠度。

28、根据本申请的一些实施例,所述根据所述目标可靠度确定所述减速器的输入侧历史转动圈数和/或输出侧历史转动圈数,包括:将所述目标可靠度所对应的所述输入侧圈数候选值的所述舍入值作为所述输入侧历史转动圈数,和/或,将所述目标可靠度在所述候选取值范围中所对应的取值作为所述输出侧历史转动圈数。

29、第二方面,本申请实施例提供了一种关节模组,包括电机、减速器和控制器,所述电机的输出端连接至所述减速器,所述减速器的输入侧和输出侧均设置有单圈绝对式编码器,所述控制器连接至所述单圈绝对式编码器,所述控制器用于执行如上述第一方面的减速器的转动圈数确定方法。

30、第三方面,本申请实施例提供了一种灵巧手,包括电机、减速器和控制器,所述电机的输出端连接至所述减速器,所述减速器的输入侧和输出侧均设置有单圈绝对式编码器,所述控制器连接至所述单圈绝对式编码器,所述控制器用于执行如上述第一方面的减速器的转动圈数确定方法。

31、第四方面,本申请实施例提供了一种机器人,包括上述第二方面的关节模组,和/或,上述第三方面的灵巧手。

32、根据本申请实施例的技术方案,至少具有如下有益效果:本申请实施例能够通过单圈绝对式编码器获取读取上电后的输入侧角度和输出侧角度,并且根据减速比、初始偏差角度和输出侧圈数候选值推算出对应的输入侧圈数候选值,接着,再通过输入侧圈数候选值的可靠度对比和筛选反推出过往的累计转动圈数。因此,本申请实施例能够在一定程度上解决单圈绝对编码器断电重启后历史转动圈数丢失的缺陷,无需加装其他掉电不丢失的编码器就能还原减速器的转动圈数,不但保留了单圈绝对编码器上电无需机械回零、不会产生脉冲累积位置漂移的优势,而且还能够提供完整准确的圈数参数,保障机器人与自动化设备重启后定位精度、扭矩测算结果可以正常接续使用,并且降低了整体的硬件成本。

33、本申请的附加方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本申请的实践了解到。

1.一种减速器的转动圈数确定方法,其特征在于,所述减速器的输入侧和输出侧均设置有单圈绝对式编码器,所述方法包括:

2.根据权利要求1所述的方法,其特征在于,所述单圈绝对式编码器包括设置于所述减速器输入侧的第一单圈绝对式编码器以及设置于所述减速器输出侧的第二单圈绝对式编码器;所述通过所述单圈绝对式编码器获取所述减速器的输入侧角度和输出侧角度,包括:

3.根据权利要求2所述的方法,其特征在于,包括如下之一:

4.根据权利要求1所述的方法,其特征在于,所述候选取值范围通过如下步骤确定得到:

5.根据权利要求1所述的方法,其特征在于,所述初始偏差角度为在所述减速器的输出侧的角度位置和圈数均为零的情况下,所述减速器的输入侧所处的角度位置。

6.根据权利要求1所述的方法,其特征在于,所述根据所述输入侧角度、所述输出侧角度、所述减速比、所述初始偏差角度和所述输出侧圈数候选值,确定所述减速器的输入侧圈数候选值,包括:

7.根据权利要求1所述的方法,其特征在于,所述确定每一个所述输入侧圈数候选值的可靠度,包括:

8.根据权利要求7所述的方法,其特征在于,所述从多个所述可靠度中筛选出目标可靠度,包括:从多个所述可靠度中筛选出数值最大的所述可靠度作为目标可靠度。

9.根据权利要求7或8所述的方法,其特征在于,所述根据所述目标可靠度确定所述减速器的输入侧历史转动圈数和/或输出侧历史转动圈数,包括:将所述目标可靠度所对应的所述输入侧圈数候选值的所述舍入值作为所述输入侧历史转动圈数,和/或,将所述目标可靠度在所述候选取值范围中所对应的取值作为所述输出侧历史转动圈数。

10.一种关节模组,其特征在于,包括电机、减速器和控制器,所述电机的输出端连接至所述减速器,所述减速器的输入侧和输出侧均设置有单圈绝对式编码器,所述控制器连接至所述单圈绝对式编码器,所述控制器用于执行如权利要求1至9中任意一项所述的减速器的转动圈数确定方法。

11.一种灵巧手,其特征在于,包括电机、减速器和控制器,所述电机的输出端连接至所述减速器,所述减速器的输入侧和输出侧均设置有单圈绝对式编码器,所述控制器连接至所述单圈绝对式编码器,所述控制器用于执行如权利要求1至9中任意一项所述的减速器的转动圈数确定方法。

12.一种机器人,其特征在于,包括权利要求10所述的关节模组,和/或,权利要求11所述的灵巧手。