[发明专利]一种机器人关节末端单圈磁编码器的多圈使用方法

说明书

本发明公开了一种机器人关节末端单圈磁编码器的多圈使用方法，属于机器人术领域，建立参数读取模块、位置分析模块、计算模块和存储模块；解决了单圈磁编码器无法进行多圈判断的技术问题，本发明硬件少，易于实现，成本低，精度高。

技术领域

本发明属于机器人技术领域，尤其涉及一种机器人关节末端单圈磁编码器的多圈使用方法。

背景技术

目前机器人关节上的使用的均是绝对式磁编码器，用于控制关节位置，但是大多数磁编码器都是单圈(即只可以感知一圈之内的绝对角位置)。而对于某些应用场合，比如转动的角度超过360度时，单圈不能满足要求，而采用多圈磁编码器，其成本会大大增加。

发明内容

本发明的目的是提供一种机器人关节末端单圈磁编码器的多圈使用方法，解决了单圈磁编码器无法进行多圈判断的技术问题。

为实现上述目的，本发明采用如下技术方案：

一种机器人关节末端单圈磁编码器的多圈使用方法，包括如下步骤：

步骤1：建立参数读取模块、位置分析模块、计算模块和存储模块；参数读取模块用于读取单圈磁编码器的位置编码数据Q_t，其中Q为位置编码数据，t为时间戳；位置分析模块用于分析位置编码数据Q_t；计算模块用于对当前位置编码数据进行圈数计算；

步骤2：参数读取模块按时间顺序读取单圈磁编码器的位置编码数据；

步骤3：位置分析模块根据当前的位置编码数据Q_t和前一时刻的位置编码数据Q_t-1之差来计算出位置变化参数；

步骤4：位置分析模块设定一个位置变化常量，判断位置变化参数是否大于位置变化常量：是，则执行步骤5；否，则执行步骤6；

步骤5：位置分析模块判定此时单圈磁编码器为反转，记录转动圈数减一，执行步骤7；

步骤6：位置分析模块判定此时单圈磁编码器为正转，记录转动圈数加一，执行步骤7；

步骤7：计算模块根据以下公式计算连续的位置数据Q_m：

Q_m＝N_loop×65535+Q_t；

其中，N_loop为转动圈数，Q_t为单圈磁编码器的位置编码数据；

步骤8：将计算出的连续的位置数据Q_m作为位置PID的反馈值，参与到机器人关节末端单圈磁编码器的多圈检测计算中；

步骤9：记录转动圈数N_loop，并存储到存储模块中，下次上电后，读取存储模块中的圈数值参与计算模块对连续的位置数据Q_m的计算。

优选的，所述存储模块为EEPROM模块。

优选的，在执行步骤4时，所述位置变化常量的值不大于单圈磁编码器输出的最大编码值。

本发明所述的一种机器人关节末端单圈磁编码器的多圈使用方法，解决了单圈磁编码器无法进行多圈判断的技术问题，本发明硬件少，易于实现，成本低，精度高。

附图说明

图1是本发明的流程图。

具体实施方式

如图1所示的一种机器人关节末端单圈磁编码器的多圈使用方法，包括如下步骤：