[发明专利]基于游标码道的绝对式磁编码器的角度校准方法在审
申请号: | 202010885893.8 | 申请日: | 2020-08-28 |
公开(公告)号: | CN111964707A | 公开(公告)日: | 2020-11-20 |
发明(设计)人: | 倪风雷;林鹏飞;刘宏;蒋再男;金明河 | 申请(专利权)人: | 哈尔滨工业大学 |
主分类号: | G01D18/00 | 分类号: | G01D18/00;G01D5/14 |
代理公司: | 哈尔滨华夏松花江知识产权代理有限公司 23213 | 代理人: | 岳昕 |
地址: | 150001 黑龙*** | 国省代码: | 黑龙江;23 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 基于 游标 绝对 编码器 角度 校准 方法 | ||
1.基于游标码道的绝对式磁编码器的角度校准方法,其特征在于,该方法包括以下步骤:
步骤一:获得敏感芯片的主码道和游标码道的原始数据;
步骤二:对步骤一获得的原始数据进行截取,获得一个完整圆周内的数据;
步骤三:根据所获得的完整圆周内的数据,计算出各个用于解算绝对位置的中间变量的偏差值;
步骤四:利用步骤三计算出的偏差值,分别获得校准各个中间变量的校准值;
步骤五:利用步骤四获得的校准值分别对各中间变量进行校准,获得校准后的中间变量;根据校准后的中间变量获得绝对位置数据;
所述步骤一的具体过程为:
关节单方向旋转时,按照预定的采样周期采集原始数据pj,j=0,1,2,…,k-1,pj代表采集的第j个原始数据,k代表采集的绝对式磁编码器的原始数据个数;
根据采集的原始数据,计算得到主尺原始数据mj和游标尺原始数据nj;
所述步骤二的具体过程为:
主尺原始数据mj和游标尺原始数据nj组成原始数据序列(mj,nj),j=0,1,2,…,k-1,对原始数据序列作游标解算,获得未校准位置序列pos_rawj,j=0,1,2,…,k-1;
从未校准位置序列中截取角度值在0度到360度范围内的子序列posj′,j′=j0,j0+1,…,j1,j0为所截取的圆周内第一个位置值为0度的下标,j1为最后一个位置为360度的下标,则截取出的子序列posj′对应的原始数据子序列为(mj′,nj′),将截取出的子序列的下标重新记为j′=0,1,2,…,k1-1,k1=j1–j0+1,k1为子序列中元素个数;
原始数据子序列中的全部数据即为一个完整圆周内的数据;
所述步骤三的具体过程为:
tolj′=mj′-nj′*N/(N-1)
其中,tolj′代表用于解算绝对位置的第j′个中间变量,N为主尺磁极对数;
检测mj′的数据突变获得mj′所在的极对序数bj′,则第j′个中间变量tolj′的理论值tol_cj′为:tol_cj′=bj′*D,D为定值,D=360°/(N-1),第j′个中间变量的偏差值εj′为:εj′=tolj′-tol_cj′;
所述步骤四的具体过程为:
在步骤二的完整圆周上取16个点xi,i=0,1,2…15,将一个完整圆周的数据划分为16个区间,分别对每个区间中包含的中间变量的偏差值做线性拟合,得到16条拟合线段Li,i=0,1,2…15;
xi点对应的校准值Ci=(Li(xi)+Li-1(xi))/2,Li(xi)为拟合线段Li在端点xi处的值,Li-1(xi)为拟合线段Li-1在端点xi处的值,(x0,C0)、(x1,C1)、…、(x15,C15)顺次连接获得一条补偿折线;
各个中间变量的校准值的计算方法为:根据中间变量所在区间的上个端点校准值和下个端点校准值,利用线性插补的方法获得;
所述步骤五的具体过程为:
将中间变量与其对应的校准值做差,得到校准后的中间变量;对校准前的中间变量进行游标解算获得未校准前的位置数据pos_ref,对校准后的中间变量进行游标解算获得校准后的位置数据;
利用pos_ref与获得的校准后位置数据计算补偿值δ;其具体过程为:
对于当前第j′个中间变量tolj′,补偿值δj′为:
其中,x为中间变量tolj′的未校准前的位置,x0为中间变量tolj′的未校准前位置所在区间上个端点位置,x1为中间变量tolj′的未校准前位置所在区间下个端点位置,tol0为中间变量tolj′的校准后位置所在区间上个端点的校准值,tol1为中间变量tolj′的校准后位置所在区间下个端点的校准值;
则当前第j′个中间变量所在极对序数bj′′为:
bj′′=mod(tolj′-δj′,D)
解算出的当前绝对位置数据posj′为:
posj′=mj′+bj′′*W
其中,W为磁极宽度。
2.根据权利要求1所述的基于游标码道的绝对式磁编码器的角度校准方法,其特征在于,所述绝对式磁编码器的码盘旋转方向分为如下两种情况:
一)若原始数据mj在每个磁极对区间内增大,则校准值从前往后处理;
二)若原始数据mj在每个磁极对区间内减小,则校准值从后往前处理。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于哈尔滨工业大学,未经哈尔滨工业大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202010885893.8/1.html,转载请声明来源钻瓜专利网。