一种磁编码器及其精细电角度值计算方法与流程
本发明涉及编码器,特别涉及一种磁编码器及其精细电角度值计算方法。
背景技术:
1、在工业自动控制、机器人关节驱动及高精度数控机床等应用领域中,编码器作为一种将机械位移(包括角位移和直线位移)转换为电信号输出的传感装置,被广泛应用于位置检测与速度反馈环节。
2、根据信号读取方式,编码器可区分为接触式与非接触式两类;按信号输出机理划分,编码器常规分为增量式编码器与绝对式编码器两大类型。其中,绝对式编码器则采用唯一性数字码与空间位置一一对应的编码方式,其输出值直接反映当前所处绝对位置,测量结果仅取决于起始与终止位置的码值,而与中间运动过程无关,故具备断电记忆能力和抗干扰优势。
3、磁电式编码器是一种利用磁场变化来实现位置感测的非接触式编码器。典型结构包括固定于转动轴上的磁环转子以及与其相对布置的磁敏感元件,所述磁敏感元件可选用霍尔效应元件或各类磁阻传感器(如各向异性磁阻、巨磁阻等)。当转轴带动磁环转子旋转时,其周围空间内的磁场矢量(包括方向与幅值)发生周期性变化;磁敏感元件实时检测该磁场波动,并输出与之呈函数关系的正弦/余弦模拟电压信号。上述模拟信号经由后续信号调理电路进行放大、滤波、偏置补偿,再经模数转换及数字信号处理(如计数、查表或cordic算法解码),最终输出表征当前位移状态的数字量数据。
4、为满足伺服控制、协作机器人等高端应用对单圈绝对角度高分辨率(例如达到24位及以上)的严苛需求,目前常采用将磁环均匀划分为三个120°扇区并充以互质极对数(如11、12、13对磁极对)的方案,利用游标卡尺原理解算。然而,该方案存在三大缺陷:其一,均匀扇区导致边界处磁极截断,引发磁场畸变和谐波,使正弦/余弦信号失真,由于反正切解算函数对幅值扰动极为敏感,故在边界处会产生不可补偿的跳变误差,该跳变误差随转速及温度漂移,无法通过静态标定或滤波有效补偿,将严重制约磁编码器的精度;其二,边界畸变形成角度模糊点,严重降低线性度和重复定位精度;其三,传统解算依赖浮点运算和查找表,实时性差,难以满足30khz以上高速输出需求。因此,亟需解决均匀扇区划分带来的边界畸变、角度模糊及解算效率低下的问题。
技术实现思路
1、本发明的目的在于解决磁编码器的磁环采用均匀扇区划分导致的边界磁极截断与磁场畸变、扇区边界处角度模糊点、以及高分辨率与高实时性解算难以兼顾的技术问题。本发明提出了一种磁编码器及其精细电角度值计算方法,实现了对磁编码器的边界磁场畸变的有效抑制、角度模糊点的消除以及高分辨率下高速实时解算,从而显著提升了编码器的绝对精度和动态响应性能。
2、第一方面,为解决上述技术问题,本发明的实施方式公开了一种磁编码器,包括:电路板;磁环转子,所述电路板和所述磁环转子沿轴向间隔设置,所述磁环转子沿周向包括第一扇区、第二扇区和第三扇区;其中,所述第一扇区设置有多对第一磁极对,所述多对第一磁极对沿所述周向分布,所述第一扇区具有第一机械角;所述第二扇区设置有多对第二磁极对,所述多对第二磁极对沿所述周向分布,所述第二扇区具有第二机械角;所述第三扇区设置有多对第三磁极对,所述多对第三磁极对沿所述周向分布,所述第三扇区具有第三机械角,所述第一机械角、所述第二机械角以及所述第三机械角互不相等。
3、采用上述技术方案,通过将所述第一机械角、所述第二机械角以及所述第三机械角设置为互不相等,使各采样信号的空间相位彼此错开,避免了三路信号落入磁极周期的过零点附近,进而避免了传统方案中120°均匀划分时部分扇区边界处产生的磁极截断现象,从物理层面消除了角度模糊点,为实现高线性度、高重复精度的绝对角度测量奠定了基础。
4、根据本发明的另一种具体实施方式,所述第一机械角为130°;所述第二机械角为120°;所述第三机械角为110°。
5、根据本发明的另一种具体实施方式,所述第一扇区设置有11对磁极对,所述第二扇区设置有12对磁极对,所述第三扇区设置有13对磁极对,其中,所述第一磁极对的宽度、所述第二磁极对的宽度和所述第三磁极对的宽度互不相等。
6、根据本发明的另一种具体实施方式,所述电路板上设置有第一磁敏传感器对、第二磁敏传感器对和第三磁敏传感器对;其中,所述第一磁敏传感器对在空间位置上与所述第一扇区对应;所述第二磁敏传感器对在空间位置上与所述第二扇区对应;所述第三磁敏传感器对在空间位置上与所述第三扇区对应。
7、采用上述技术方案,仅需在电路板上布设三对磁敏传感器(即六个磁敏传感元件),相较于现有技术中需要布设八个磁敏传感元件的布置,有效缩减了电路板的布板面积,有利于编码器整体结构向小型化、轻量化方向发展,且有效降低了生产成本。
8、根据本发明的另一种具体实施方式,所述第一磁敏传感器对设置在所述第一扇区和所述第二扇区连接的位置;所述第二磁敏传感器对设置在所述第二扇区和所述第三扇区连接的位置;所述第三磁敏传感器对设置在所述第三扇区和所述第一扇区连接的位置。
9、根据本发明的另一种具体实施方式,所述第一磁敏传感器对设置在所述磁环转子的上方、下方或者外围;所述第二磁敏传感器对设置在所述磁环转子的上方、下方或者外围;所述第三磁敏传感器对设置在所述磁环转子的上方、下方或者外围。
10、根据本发明的另一种具体实施方式,所述第一磁敏传感器对中的任一磁敏传感器为隧道磁阻角度传感器或各向异性磁阻传感器;所述第二磁敏传感器对中的任一磁敏传感器为隧道磁阻角度传感器或各向异性磁阻传感器;所述第三磁敏传感器对中的任一磁敏传感器为隧道磁阻角度传感器或各向异性磁阻传感器。
11、第二方面,本发明的实施方式公开了一种磁编码器的精细电角度值计算方法,所述磁编码器包括电路板和磁环转子,所述磁环转子沿周向包括第一扇区、第二扇区和第三扇区,其中,所述第一扇区具有第一机械角,所述第二扇区具有第二机械角,所述第三扇区具有第三机械角,所述第一机械角、所述第二机械角以及所述第三机械角互不相等;获取所述第一扇区的第一电角度值;获取所述第二扇区的第二电角度值;获取所述第三扇区的第三电角度值;确定所述第一电角度值和所述第二电角度值的第一电角度差,以及所述第二电角度值和所述第三电角度值的第二电角度差;根据所述第一电角度差和/或所述第二电角度差,确定粗角度值;确定所述粗角度值所在的目标扇区,所述目标扇区是第一扇区、第二扇区和第三扇区中的任意一个,并基于所述目标扇区的电角度值和磁极对数量对所述粗角度值进行校正,得到精细电角度值。
12、采用上述技术方案,本发明首先获取三个扇区的三个电角度值,再通过计算第一电角度差和/或第二电角度差确定粗角度值,进一步地,根据该粗角度值判定其所属的目标扇区,并选用该目标扇区自身的电角度值及其磁极对数进行精细校正,得到精细电角度值,有效避免了传统均匀扇区方案中边界磁场畸变对粗定位的干扰,消除了角度模糊点,从而显著提升了编码器的绝对精度和动态响应性能。
13、根据本发明的另一种具体实施方式,所述电路板上设置有第一磁敏传感器对、第二磁敏传感器对和第三磁敏传感器对,其中,所述第一磁敏传感器对在空间位置上与所述第一扇区对应;所述第二磁敏传感器对在空间位置上与所述第二扇区对应;所述第三磁敏传感器对在空间位置上与所述第三扇区对应;
14、采集所述第一磁敏传感器对输出的第一正交传感信号;对所述第一正交传感信号进行模数转换和反正切处理,得到所述第一扇区的第一初始电角度值;获取所述第一扇区的第一相位零点补偿值,并基于所述第一相位零点补偿值对所述第一初始电角度值取模和归一化处理,得到所述第一扇区的所述第一电角度值;
15、采集所述第二磁敏传感器对输出的第二正交传感信号;对所述第二正交传感信号进行模数转换和反正切处理,得到所述第二扇区的第二初始电角度值;获取所述第二扇区的第二相位零点补偿值,并基于所述第二相位零点补偿值对所述第二初始电角度值取模和归一化处理,得到所述第二扇区的所述第二电角度值;
16、采集所述第三磁敏传感器对输出的第三正交传感信号;对所述第三正交传感信号进行模数转换和反正切处理,得到所述第三扇区的第三初始电角度值;获取所述第三扇区的第三相位零点补偿值,并基于所述第三相位零点补偿值对所述第三初始电角度值取模和归一化处理,得到所述第三扇区的所述第三电角度值。
17、根据本发明的另一种具体实施方式,根据所述第一电角度差和所述第二电角度差,通过二分查找法确定粗角度值;或者,根据所述第一电角度差查询预先生成并存储的一维查找表,获得所述粗角度值;或者,据所述第二电角度差查询预先生成并存储的一维查找表,获得所述粗角度值。
18、采用上述技术方案,在全部磁敏传感器都正常工作时,根据所述第一电角度差和所述第二电角度差,通过二分查找法确定粗角度值;当任一扇区对应的磁敏传感器对失效时,仍可凭借剩余的有效电角度差独立查询一维查找表获得粗角度值并完成完整角度输出,能够满足正常工况和异常工况下的高精度解算。
19、根据本发明的另一种具体实施方式,获取所述目标扇区的起始角度值和磁极对数量;根据所述粗角度值和所述起始角度值进行数据处理得到实际电角度值;基于所述实际电角度值和所述磁极对数量进行数据处理得到理想电角度值;基于所述实际电角度值与所述理想电角度值归一化处理得到修正值,并根据所述修正值对所述粗角度值进行校正,得到所述精细电角度值。
20、根据本发明的另一种具体实施方式,所述得到精细电角度值之后,获取当前精细角度值、前一精细角度值和滞回阈值,所述滞回阈值包括第一滞回阈值和第二滞回阈值;当所述前一精细角度值大于所述第一滞回阈值且所述当前精细角度值小于所述第二滞回阈值时,圈数加1;当所述前一精细角度值小于所述第二滞回阈值且所述当前精细角度值大于所述第一滞回阈值时,所述圈数减1;基于当前累积圈数值和所述当前精细角度值确定绝对位置值。
21、采用上述技术方案,本发明通过设置由电池持续供电的圈数寄存器,在编码器断电后仍能实时记录因外力转动等情况引起的圈数变化,重新上电时无需执行找零位操作;同时,通过设置第一滞回阈值和第二滞回阈值构成防抖窗口,仅在当前精细角度值可靠地跨越整圈边界时才触发圈数累加或累减,避免了因机械振动或电磁干扰导致电角度值在临界点附近抖动而引发的误计数,进而确保了多圈绝对位置值的准确性和稳定性。
22、第三方面,本发明的实施方式还公开了一种计算机存储介质,包括存储器和处理器,所述存储器适于存储计算机指令,所述处理器适于在运行所述计算机指令时,执行如上述任一项所述的磁编码器的精细电角度值计算方法。
23、第四方面,本发明的实施方式还公开了一种计算机程序产品,包括计算机程序/指令,所述计算机程序/指令被处理器执行时实现如上述任一项所述的磁编码器的精细电角度值计算方法。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com