基于蚁群算法的磁电编码器角度值跳点抑制方法及装置
文献发布时间:2023-06-19 19:28:50
技术领域:
本发明属于编码器制造领域,具体涉及基于蚁群算法的磁电编码器角度值跳点抑制方法及装置。
背景技术:
磁电编码器是一种新型的测量装置,可以用于测量电机转角以及位移,按照其工作方式可以分为绝对式磁电编码器和增量式磁电编码器。磁电编码器通常由磁钢、霍尔元件、编码器信号解算板等组成,磁电编码器同其他的编码器相比,不易受外界环境的干扰,具有抗振动、抗腐蚀、抗污染、抗干扰等特性,可应用于传统的编码器不能适应的领域,所以磁电编码器很适用于高精密、工作环境恶劣的场合。
目前在广泛使用的磁电编码器中,无论是单对极还是多对极都各自存在一些缺点,因此将单对极与多对极的磁电编码器组合在一起使用。虽然组合式的磁电编码器与之前相比精度明显提高,但是在磁电编码器配合使用时,角度值放大的过程中存在着噪声问题,这种噪声会对角度值的放大精度产生影响,特别是在多对极角度值处在前一个周期与后一个周期的过渡阶段,由于噪声的影响,会使得多对极角度值在确定当前具体的多对极极数的时候产生错误,使原本是前一周期的多对极角度值误判成了下一个周期的角度值。这样会使得放大后的多对极角度值中产生很多的跳点,这种因为在前后周期过零点处的极数误判所产生的角度值跳点问题对于提升多对极角度值的精度具有极大的影响。
发明内容
针对上述问题,本发明提出一种方案,目的是解决磁电编码器角度值在过零时产生跳点的问题。利用单对极磁钢与多对极磁钢组合而成的磁电编码器,收集信号,再通过霍尔元件将采集到的单对极与多对极磁场信号通过反正切算法转换成角度值,再进行重新排序,在多对极角度值基础上附加域值x、确定区域上下限、形成极数判断区间等处理后,用限定后的极对数对多对极角度值进行角度细分计算,并进行差分处理,将蚁群算法与之结合,不断代入域值x进行迭代计算,用来抑制在多极对角度值过零时往复跳动而引起的极数误判问题,从而抑制跳点的产生,提高磁电编码器的分辨率。
本发明公布了基于蚁群算法的磁电编码器角度值跳点抑制方法及装置,包括以下步骤。
步骤一:当电机主轴转动时,径向充磁的单对极磁钢会产生径向磁场,经过导磁体,然后单对极霍尔a1、单对极霍尔a2采集单对极角度值信号A+、A-,电机主轴转动时,轴向充磁的多对极磁钢会产生轴向磁场,多对极霍尔b1、多对极霍尔b2采集多对极角度值信号B+、B-;然后通过单片机内置的模数转换通道对单对极角度值信号A+、A-与多对极角度值信号B+、B-进行数字转换,得到数字信号HA+、HA-、HB+、HB-;通过反正切公式求解出单对极角度值θ
步骤二:以单对极角度值θ
其中θ
步骤三:将排序后的单对极角度值θ
θ
其中θ
对压缩取整后的单对极角度值θ
θ
其中θ
步骤四:按照单对极差分后的得到的数列changdu_sift的顺序,对多对极的多对极角度值θ
排序结束后,再对θ
θ
其中θ
步骤五:将得到的三组多对极极数值进行整理;若θ
θ
其中θ
步骤六:定义函数:
n=td
D=td
其中函数td
其中
本发明的有益效果为:
1.本发明使用极对数为24对极的多对极磁钢,经过本发明的算法解算,提高了磁电编码器的角度分辨率。
2.本发明使用的磁电编码器中的单对极磁钢的磁场为径向磁场,通过导磁体改变其磁场方向,这样既可以屏蔽外界噪声对信号的影响,还可以避免电机主轴轴向窜动产生的误差。
3.本发明将蚁群算法与磁电编码器高分辨率解算方法进行结合,能够依托蚁群算法收敛速度快、计算能力大、运行效率高等优势,实现准确快速的找到没有跳点产生的域值x,是一种能快速、便捷的抑制多对极角度值细分后跳点的影响的算法。
附图说明
为了易于说明,本发明由下述的具体实施及附图作以详细描述:
图1为本发明所述新型编码器的总体结构示意图;
图2为本发明所述新型编码器的内部结构示意图;
图3为本发明所述新型编码器的磁钢结构分布示意图;
图4为本发明所述编码器解算板示意图;
图5为本发明所述导磁体结构示意图;
图6为本发明所述按升序排序的角度值示意图;
图7为本发明所述区域上限、下限、原始的多对极角度值示意图;
图8为本发明所述映射后的区域上限、下限、原始的多对角度值示意图;
图9为本发明所述分辨率提高放大的多对极角度值示意图;
图10为本发明所述蚁群算法确定域值与跳点关系的示意图;
图中,1、电机主轴;2、轴承;3、法兰盘;4、支撑板;5、多对极磁钢;5-1、多对极霍尔b1;5-2多对极霍尔b2;6、磁场屏蔽环;7、单对极磁钢;7-1、单对极霍尔a1;7-2、单对极霍尔a2;8、导磁体;8-1、单对极霍尔槽c1;8-2、单对极霍尔槽c2;9、编码器端盖;10、编码器信号解算板;11、单片机。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚明了,下面通过附图中示出的具体实施例来描述本发明。但是应该理解,这些描述只是示例性的,而并非要限制本发明的范围。此外,在以下说明中,省略了对公知结构和技术的描述,以避免不必要地混淆本发明的概念。
本发明的结构组成如图1、图2、图3、图4、图5所示,结合附图进一步说明本发明的具体结构及具体实施方式。
所述的磁电编码器结构如图2所示,其特征在于:所述的编码器结构,它包括电机主轴(1)、轴承(2)、法兰盘(3)、支撑板(4)、多对极磁钢(5)、磁场屏蔽环(6)、单对极磁钢(7)、导磁体(8)、编码器端盖(9)、编码器信号解算板(10)、单片机(11);其中编码器信号解算板(10)上焊锡焊接直插式的单对极霍尔a1(7-1)与单对极霍尔a2(7-2)、贴片式的多对极霍尔b1(5-1)与多对极霍尔b2(5-2)、单片机(11),单对极霍尔a1(7-1)与单对极霍尔a2(7-2)在同一圆周上呈90°放置,多对极霍尔b1(5-1)与多对极霍尔b2(5-2)在同一圆周上呈90°放置,导磁体(8)上有单对极霍尔槽c1(8-1)、单对极霍尔槽c2(8-2),单对极霍尔槽c1(8-1)与单对极霍尔槽c2(8-2)在同一圆周上呈90°放置,其中支撑板(4)与电机主轴(1)胶接,轴向充磁方式的多对极磁钢(5)与支撑板(4)胶接,磁场屏蔽环(6)与支撑板(4)胶接,径向充磁方式的单对极磁钢(7)与电机主轴(1)胶接,导磁体(8)与编码器信号解算板(10)胶接,导磁体(8)上的单对极霍尔槽c1(8-1)、单对极霍尔槽c2(8-2)中插入单对极霍尔a1(7-1)、单对极霍尔a2(7-2),编码器信号解算板(10)与编码器端盖(9)胶接,编码器端盖(9)与法兰盘(3)采用螺栓、螺母连接。当电机主轴(1)开始旋转时,带动支撑板(4)、多对极磁钢(5)、磁场屏蔽环(6)、单对极磁钢(7)一同旋转。单对极磁钢(7)的径向磁场经过胶接在编码器信号解算板(10)上的导磁体(8)改变磁场方向后由编码器信号解算板(10)上的单对极霍尔接收单对极磁场信号,多对极霍尔位于多对极磁钢(5)的正上方,用来接收多对极磁场信号。
基于蚁群算法的磁电编码器角度值跳点抑制方法及装置,所述方法的具体实现过程为:
步骤一:当电机主轴转动时,径向充磁方式的单对极磁钢会产生径向磁场,经过导磁体,然后单对极霍尔a1、单对极霍尔a2采集单对极角度值信号A+、A-,电机主轴转动时,轴向充磁方式的多对极磁钢会产生轴向磁场,多对极霍尔b1、多对极霍尔b2采集多对极角度值信号B+、B-;然后通过单片机内置的模数转换通道对单对极角度值信号A+、A-与多对极角度值信号B+、B-进行数字转换,得到数字信号HA+、HA-、HB+、HB-;通过反正切公式求解出单对极角度值θ
步骤二:以单对极角度值θ
其中θ
步骤三:将排序后的单对极角度值θ
θ
其中θ
对压缩取整后的单对极角度值θ
θ
其中θ
步骤四:按照单对极差分后的得到的数列changdu_sift的顺序,对多对极的多对极角度值θ
排序结束后,再对θ
θ
其中θ
步骤五:将得到的三组多对极极数值进行整理;若θ
θ
其中θ
步骤六:定义函数:
n=td
D=td
其中函数td
/>
其中
设置目标函数n=td
以上显示和描述了本发明的基本原理和主要特征和本发明的优点。本行业的技术人员应该了解,本发明不受上述实施例的限制,上述实施例和说明书中描述的只是说明本发明的原理,在不脱离本发明精神和范围的前提下,本发明还会有各种变化和改进,这些变化和改进都落入要求保护的本发明范围内。本发明要求保护范围由所附的权利要求书及其等效物界定。