[发明专利]基于FPGA的伺服电机实时转速检测模块

说明书

技术领域

本发明涉及一种转速检测模块，尤其涉及一种用于伺服系统的伺服电机实时转速检测模块。

背景技术

伺服系统(servomechanism)是使物体的位置、方位、状态等输出被控量能够跟随输入目标(或给定值)的任意变化的自动控制系统。在现代高精度伺服控制系统如数控机床、引线键合机上，通常采用增量式光电编码器作为位置传感器。光电编码器是一种集光学、机械、电子为一体的数字化角度传感器，它一般安装在机械设备的旋转轴上或者通过联轴器与旋转轴连接，通过光电转换，将旋转轴的角度位移量实时转换为数字化编码脉冲，并传输给计算机或其它与编码器相连接的数字控制设备，为机电系统的闭环控制提供位置反馈信息。不仅如此，在数字控制系统中，将旋转轴位置信息与时间信息结合，还可以对伺服电机的转速进行精确检测，为速度闭环控制系统提供速度反馈。

在实际应用中，由于成本原因，往往只能采用低精度的编码器作为反馈器件。同时，微分或差分运算将不可避免地将位置信息中包含的噪声放大，导致计算出的速度、加速度严重偏离真实值。光电编码器在制造过程中引起的各种误差，如刻线不均、偏心等，会在实际应用时，导致控制系统读取的位置信息以及相应记录的时间信息产生偏差，进而严重影响速度、加速度测量的精度。另一方面，控制系统在进行闭环运算时，需要获得的是电机或旋转轴实时的位置、速度、加速度信息。然而在编码器实际工作时，电机或旋转轴转速的变化会引起输出的脉冲频率的相应变化，而由数字系统的采样周期通常是固定的，再加上编码器输出与数字系统的采样不会同步，系统获得的位置信息就可能会有一定滞后，而通过微分或差分运算，得到的也将是电机或旋转轴过往某一时刻的转速。这一测量上的滞后，也会对控制系统的性能产生不利的影响。

常用的转速检测方法，诸如M法、T法、M/T法直接采用了编码器反馈的位置信息与控制系统获得的时间信息进行差分运算。对于线数少、误差大的低精度编码器，这些方法有的精度差，有的在不同转速条件下测量效果相差很大，有的测量延时现象严重，都难以满足高精度伺服控制系统的要求，故而需要设计合适的转速检测手段，以减小测量误差，提高伺服系统的转速检测的实时响应性能。

因此，本领域的技术人员致力于开发一种伺服电机的实时转速检测模块，在伺服系统中实时获得伺服电机的当前转速。

发明内容

有鉴于现有技术的上述缺陷，本发明所要解决的技术问题是提供一种伺服电机的实时转速检测模块，通过对伺服电机的转角和时间进行多项式拟合，实时计算获得伺服电机的转速。

为实现上述目的，本发明提供了一种伺服电机的实时转速检测模块，其特征在于，包括：

信号预处理单元，其与光电编码器相连以接收所述光电编码器发出的信号，并输出对应于所述光电编码器发出的所述信号的伺服电机的转角和时间；

数据拟合单元，其接收所述信号预处理单元输出的所述转角和所述时间，并对所述转角关于所述时间进行多项式拟合以获得所述伺服电机的转速。

进一步地，所述信号预处理单元和所述数据拟合单元皆由FPGA芯片构造。

进一步地，所述多项式拟合采用n阶多项式：

y＝f(t)＝p_ntⁿ+p_n-1t^n-1+L+p₁t+p₀；   (1)

其中，y是所述转角，t是所述时间，p₀、p₁、…、p_n是所述n阶多项式的参数。

这样，对于所述光电编码器发出的m个所述信号，通过式(1)可以得到m个方程：

p_nt₁ⁿ+p_n-1t₁^n-1+L+p₁t₁+p₀＝y₁

p_nt₂ⁿ+p_n-1t₂^n-1+L+p₁t₂+p₀＝y₂。     (2)

L L L L