关键词:
双码道多磁极编码器
硬件设计
误差仿真与校正
算法设计与优化
摘要:
编码器(Position Sensor)作为机器人运动控制的核心传感器,在机器人关节精准定位和运动控制中扮演着至关重要的角色。磁编码器因其体积小、成本低、抗震动等优点,成为机器人领域广泛应用的编码器。然而,当前国内多磁极编码器的位置检测仍依赖国外进口芯片,如IC-haus等,而国外磁编码器芯片的价格昂贵,给国内多磁编码器发展带来了阻碍。为此,本文聚焦于多磁极编码器,旨在利用成本低廉的线性霍尔设计多磁极磁编码器,为多磁极编码器提供一种高精度绝对位置检测方法。主要工作内容如下:
(1)针对双码道多磁极磁栅的磁极宽度窄,导致的磁场信息的检测困难问题,本文设计了检测多磁极编码器磁场信息的硬件结构。本文采用的多磁极磁栅的单个磁极宽度小于2.0mm,而线性霍尔的宽度为1.5±0.2mm,导致相邻两个线性霍尔无法被安装在传统距离上的0.5个磁极宽度位置。因此,本文将相邻两个线性霍尔设置在相距1.5个磁极宽度位置,两个码道上共计四个线性霍尔来检测磁场信息。然后,选用STM32F103作为主控模块以及ADS1256作为ADC采样模块,用于采集四个线性霍尔输出的波形并计算磁栅位置信息。最后,搭建实验平台,包括伺服电机、磁栅安装码盘、光学滑台、对照组编码器等,用于后续实验安装测试。
(2)针对线性霍尔输出波形的零点漂移、振幅不相等、相位不正交等问题,在研究内容(1)的基础上,利用MATLAB建立理想状态下的线性霍尔输出波形,并模拟误差校正。首先,通过MATLAB建立理想状态下的四个线性霍尔输出波形,利用CORDIC算法和游标码道算法对四个线性霍尔波形解码,得出理想状态下编码器输出位置角度结果。然后,根据线性霍尔的物理安装误差推导公式校正。最后,在MATLAB中利用理想波形模拟误差并验证公式校正的有效性。
(3)在研究内容(2)的基础上,开展嵌入式软件算法的设计与优化。首先,对CORDIC算法就行优化以适应嵌入式平台上的浮点运算。其次针对游标码道算法在计算磁栅磁极对周期数时震荡问题,对游标码道算法进行了优化,使得编码器输出的结果更加稳定可靠。然后,在研究内容(1)基础上,通过调节光学滑台x-y-z三个方向,模拟轴向误差与径向误差,验证了本文设计的编码器在抵抗安装误差方面优越性能。最后,实验结果表明,本文设计的编码器重复精度为0.017°,符合设计要求。