磁编码器校准方法及系统与流程

文档序号:20584053发布日期:2020-04-29 01:40阅读:来源:国知局

技术特征:

1.一种磁编码器校准方法,其特征在于,包括:

获取磁编码器测量获得的电机关节角角度;

结合角度对应关系表和线性插值算法对测量获得的电机关节角角度进行修正,得到修正后的电机关节角角度;

其中,角度对应关系表通过如下步骤建立:

选取校准角度范围,根据所述校准角度范围设置采样点数,并根据采样点数及校准角度范围设置每一采样点对应的目标欧拉角度;

控制旋转设备的安装有磁编码器的旋转轴根据采样点依序转动至所有目标欧拉角度,获取并记录该旋转轴转动至各个目标欧拉角度时旋转轴上的磁编码器测量获得的对应的电机关节角角度,建立角度对应关系表。

2.如权利要求1所述的磁编码器校准方法,其特征在于,所述控制旋转设备的安装有磁编码器的旋转轴根据采样点依序转动至所有目标欧拉角度,获取并记录该旋转轴转动至各个目标欧拉角度时旋转轴上的磁编码器测量获得的对应的电机关节角角度,建立角度对应关系表的步骤具体包括:

步骤s121、控制旋转设备的安装有磁编码器的旋转轴绕对应的轴向转动至相应的目标欧拉角度,更新转动次数;

步骤s122、获取所述旋转轴转动至所述目标欧拉角度时对应的磁编码器测量获得的电机关节角角度,记录所述目标欧拉角度及与其对应的电机关节角角度;

步骤s123、判断更新后的转动次数是否达到所述采样点数,若是,执行步骤s124;否则,返回执行步骤s121;

步骤s124、根据所述采样点数,结合所有的目标欧拉角度及其对应的电机关节角角度,建立角度对应关系表。

3.如权利要求1所述的磁编码器校准方法,其特征在于,所述获取磁编码器测量获得的电机关节角角度的步骤具体为:

控制旋转设备的安装有磁编码器的旋转轴转动至一预设角度;

获取该旋转轴上的磁编码器测量获得的电机关节角角度。

4.如权利要求1所述的磁编码器校准方法,其特征在于,所述结合角度对应关系表和线性插值算法对测量获得的电机关节角角度进行修正,得到修正后的电机关节角角度的步骤具体包括:

根据旋转轴上的磁编码器测量获得的电机关节角角度结合所述角度对应关系表,获取该电机关节角角度所在的关节角区间,利用以下计算式根据所述关节角区间的端点及其对应的目标欧拉角度通过线性插值算法获取修正后的电机关节角角度:

当a<a1时,

当a1≤a<an时,

当a≥an时,

式中,a表示旋转轴上的磁编码器测量获得的电机关节角角度,表示修正后的电机关节角角度,i表示采样点序号,ai及ai+1分别表示电机关节角角度a所在的关节角区间的端点,a1、a2、an-1及an分别表示角度对应关系表中第1个采样点、第2个采样点、第n-1个采样点及第n个采样点对应的电机关节角角度,b1、b2、bn-1及bn分别表示第1个采样点、第2个采样点、第n-1个采样点及第n个采样点对应的目标欧拉角度,bi及bi+1分别表示该所述关节角区间端点对应的目标欧拉角度。

5.一种磁编码器校准系统,用于校准具有旋转轴的旋转设备的磁编码器,所述旋转轴上设置有用于控制旋转轴转动的电机,所述磁编码器安装于所述旋转设备的旋转轴上,用于测量获取对应的电机的电机关节角角度,其特征在于,所述磁编码器校准系统包括:

采集模块,用于获取磁编码器测量获得的电机关节角角度;

校正模块,用于结合角度对应关系表和线性插值算法对测量获得的电机关节角角度进行修正,得到修正后的电机关节角角度;

设置模块,用于选取校准角度范围,根据所述校准角度范围设置采样点数,并根据采样点数及校准角度范围设置每一采样点对应的目标欧拉角度;

角度对应处理模块,用于控制旋转设备的安装有磁编码器的旋转轴根据采样点依序转动至所有目标欧拉角度,获取并记录该旋转轴转动至各个目标欧拉角度时旋转轴上的磁编码器测量获得的对应的电机关节角角度,建立角度对应关系表。

6.如权利要求5所述的磁编码器校准系统,其特征在于,所述角度对应处理模块包括:

转动控制单元,用于控制旋转设备的安装有磁编码器的旋转轴绕对应的轴向转动至相应的目标欧拉角度;

采样记录单元,与所述磁编码器连接,用于获取所述旋转轴转动至所述目标欧拉角度时对应的磁编码器测量获得的电机关节角角度,记录所述目标欧拉角度及其对应的电机关节角角度;

转动计数器,用于统计转动轴的转动次数;

建表单元,用于根据所述采样点数,结合所有的目标欧拉角度及其对应的电机关节角角度,建立角度对应关系表。

7.如权利要求5所述的磁编码器校准系统,其特征在于,所述校正模块包括:

处理单元,用于根据旋转轴上的磁编码器测量获得的电机关节角角度结合所述角度对应关系表,获取该电机关节角角度所在的关节角区间,利用以下计算式根据所述关节角区间的端点及其对应的目标欧拉角度通过线性插值算法获取修正后的电机关节角角度:

当a<a1时,

当a1≤a<an时,

当a≥an时,

式中,a表示旋转轴上的磁编码器测量获得的电机关节角角度,表示修正后的电机关节角角度,i表示采样点序号,ai及ai+1分别表示电机关节角角度a所在的关节角区间的端点,a1、a2、an-1及an分别表示角度对应关系表中第1个采样点、第2个采样点、第n-1个采样点及第n个采样点对应的电机关节角角度,b1、b2、bn-1及bn分别表示第1个采样点、第2个采样点、第n-1个采样点及第n个采样点对应的目标欧拉角度,bi及bi+1分别表示该所述关节角区间端点对应的目标欧拉角度。

8.如权利要求5所述的磁编码器校准系统,其特征在于,所述采集模块包括有:

转动单元,用于控制旋转设备的安装有磁编码器的旋转轴转动至一预设角度;

采样单元,用于获取该旋转轴上的磁编码器测量获得的电机关节角角度。


技术总结
本发明公开一种磁编码器校准方法及系统。该方法包括:获取磁编码器测量获得的电机关节角角度;结合角度对应关系表和线性插值算法对测量获得的电机关节角角度进行修正;角度对应关系表通过如下步骤建立:选取校准角度范围,根据校准角度范围设置采样点数,并根据采样点数及校准角度范围设置每一采样点对应的目标欧拉角度;控制旋转设备的安装有磁编码器的旋转轴根据采样点依序转动至所有目标欧拉角度,获取并记录该旋转轴转动至各个目标欧拉角度时磁编码器测量获得的对应的电机关节角角度,建立角度对应关系表。本发明通过将磁编码器安装于旋转设备的旋转轴上直接进行校准,利用磁编码器测量获得的电机关节角角度映射为真实的角度,操作简单快捷。

技术研发人员:王冲;杭丽君;何远彬;沈磊;闫东;韩晓明;虞航斌;黄龙
受保护的技术使用者:杭州电子科技大学;睿魔智能科技(深圳)有限公司
技术研发日:2019.12.30
技术公布日:2020.04.28
当前第2页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1