[发明专利]一种电机转速检测方法

说明书

本发明公开了一种电机转速的检测方法。通过定时器数脉冲方式得到速度大小，以及与定时器计数值单位时间的变化量极值比较；如果电机转数差值的绝对值小于或等于该极值，则认为得到的相邻两次获取的电机转数为电机转速的真实数值；如果电机转速差值的绝对值大于该极值，则认为得到的相邻两次获取的电机转数错误并进行修正。通过对数据的有效分析也可以准确无误的判断出电机转速的方向为速度检测在软件层面提供保障，能够彻底解决电机转速测量过程中遇到如电机编码器波形抖动、部分变形或者电磁干扰造成硬件层面(如外置计数器)产生的测速错误。

技术领域

本发明涉及伺服运动控制检测技术，尤其涉及电机转速的检测。

背景技术

在伺服运动控制领域，常常使用电机作为机械结构运动的驱动装置，通过控制电机的运动就能够精确控制伺服结构的运动，电机的控制最根本的是转速的控制，通过经典的自动控制原理我们可以知道，控制电机转速是通过电机的速度环路实现的，需要在电机转动过程中去实时检测电机的当前转速，和设定转速进行对比，然后进行跟速度环的一些算法(如经典的PID控制算法)，最后达到稳定转速的目的。

检测电机速度有很多种办法，比较常见的是给电机加上编码器，如增量式编码器。一般增量式编码器输出有A相、B相和Z相，当电机轴转动时带动编码器转动，编码器会输出脉冲波形，转速越高，单位时间类输出的脉冲数量越多，而电机转动方向则通过A相脉冲和B相脉冲相位来表示，正转时A相脉冲领先B相90°，反转时B相脉冲领先A相90°，而Z相脉冲是电机每转动一周周期性地输出一个脉冲。电机的转速是一个矢量，包含方向和转速大小，两个量必须都正确，才能表示一个速度。转速大小可通过定时器数脉冲的方式得到，对于高转速电机，一般几个脉冲的误差，对于速度大小的影响可以忽略，但是如果转速方向测量出现错误，可能带来速度环失效，尤其是当速度值比较大时搞错方向会使程序认为给定速度和测量转速差值很大，发出错误的控制指令，使电机错误动作，甚至失控造成机械结构的振荡。电机作为一个电磁元件，其内部一般都有换向电刷，工作起来电磁干扰比较严重，有可能对编码器的输出脉冲波形产生干扰，有时候编码器由于振动也会造成原始输出也会错误，如果过度依赖编码器的输出波形的稳定性，在硬件层面需要会对编码器波形进行滤波，但是是否完全滤除干扰无法得到保证，即使绝大部分干扰都能滤除，只要有硬件层面滤波失效可能转速方向判断失误，就有可能造成电机不正常工作异常，但如果编码器本身输出问题，硬件电路是无法补偿的。

故需要一种新的技术方案以解决上述问题。

发明内容

发明目的：本发明提供一种电机转速检测方法，通过对电机转速数据的分析判断出电机转速的方向为速度检测在软件层面提供保障，能够解决电机转速测量过程中遇到如波形抖动或者电磁干扰造成测速错误的技术问题。

技术方案：本发明电机转速检测方法可采用以下技术方案，包括以下步骤：

一种电机转速检测方法，包括以下步骤：

(1)、通过电机增量式编码器连续获取单位时间内的电机转数，即本次计数值和上次技术值，并得到相邻两次获取的电机转数差值；电机增量式编码器的分辨率为1024线，即电机轴每转一圈就会输出1024个脉冲波形，通过脉冲数的变化量来计算转速；

(2)、确定定时器计数值单位时间的变化量极值，该极值为1024*单位时间内电机理论转数最大值；如果电机转数差值的绝对值小于或等于该极值，则认为得到的相邻两次获取的电机转数为电机转速的真实数值；如果电机转速差值的绝对值大于该极值，则认为得到的相邻两次获取的电机转数错误，进入步骤(3)；

(3)、如果电机转数差值小于等于0，则单位时间内的转数增量＝本次计数值+2¹⁶-上次计数值；如果电机转数差值大于0，则单位时间内的转数增量＝上次计数值+2¹⁶-本次计数值；通过以上任意的单位时间内的转数增量的绝对值除以单位时间，得到的电机转数作为真实数值。