CN104218865B - 一种永磁电机转子位置计算方法 - Google Patents

Abstract

本发明提出了一种永磁电机转子位置计算方法，具体是利用增量式光电编码器的Z脉冲信号来使转子位置计算使用的A、B正交脉冲信号计数值误差限制在一圈以内，其特征是：增量式编码器安装到电机转轴后，电机转子初始位置与增量式光电编码器Z信号位置角度差无须另外测量，由控制器第一次捕获到Z信号时刻控制器位置计数寄存器的值确定；在利用Z脉冲信号消除转子位置角误差的过程中，对控制器的位置计数寄存器不产生影响；可将计算转子位置角度使用的A、B正交信号计数值误差限制在一圈以内。根据编码器一圈的脉冲数，则脉冲数与转子位置角度值存在对应关系，得到A、B正交脉冲信号计数值后，便可得到相应的电机转子角度值。

Description

一种永磁电机转子位置计算方法

技术领域

本发明涉及永磁电机转子位置计算领域，尤其是利用增量式光电编码器Z信号减少转子位置计算误差的方法。

背景技术

在永磁电机矢量控制系统中，转子位置角度值是矢量控制解耦的必要条件，转子位置检测的准确于否，直接影响矢量控制的控制效果。目前，永磁同步电机转子位置检测所用到的方法总体上分为两类：有位置传感器位置检测法和无位置传感器位置检测法。无位置传感器检测法主要通过测量电机定子侧电流和端电压算出转子位置，相比较于有位置传感器位置检测法，该方法成本低、可靠性较高。但是，无位置传感器检测法的检测精度受电机参数影响较大，且相关算法较为复杂，增加了控制器的处理负担。有位置传感器检测法通过在电机上安装传感器，控制器对传感器输出的信号进行解算，得到电机转子的位置信息。永磁电机转子位置检测所用的传感器主要有旋转变压器和光电编码器(绝对式和增量式)。增量式光电编码器的输出包含三路信号：A、B正交脉冲信号和Z信号。实际应用中，由于外部接线、控制器性能以及编码器自身误差等影响，控制器对A、B正交脉冲信号的计数会存在误差，如果不进行及时的修正，误差会随运行的圈数进行累加，最终造成控制系统不能正常工作。当编码器安装固定后，编码器的Z信号位置和电机转子初始位置的角度差便固定下来，可以利用Z信号对转子角度值进行修正。现有的修正方法中，往往需要事先测得编码器Z信号位置与转子初始位置的角度差值，作为修正算法中Z信号初始时转子的角度值，在位置修正时，往往需要对控制器位置计数寄存器的值进行修改，影响位置计数寄存器在其他程序中的应用。同时，由于电机存在正、反转两种运行模式，如果采用事先测量编码器Z信号位置与转子初始位置的角度差值的方法，则需要测量正、反转两种情况下Z信号位置与转子初始位置的角度差。在光电编码器和电机转轴的安装位置发生变化后，还需重新进行测量，不仅浪费时间，而且通用性不强，对不同的控制系统需要做相应角度差值的修改。

综上所述，目前急需一种通用性强、计算结果误差小、对控制器位置计数寄存器无影响的基于增量式光电编码器的永磁电机转子位置计算方法。

发明内容

技术问题：本发明的目的是提出一种通用性强、计算结果误差小、对控制器位置计数寄存器无影响的基于增量式光电编码器的永磁电机转子位置计算方法。

技术方案：本发明的一种永磁电机转子位置计算方法具体实现步骤如下：

增量式光电编码器一圈的脉冲数为M，无其他方式对A、B正交脉冲信号进行倍频计数，即光电编码器转一圈的脉冲计数值为M，对应的机械角度弧度值为2π，控制器位置计数寄存器的最大计数值为N，N大于等于M且小于等于位置计数寄存器允许的最大值，同时N必须为M的整数倍，用x代表位置计数寄存器的值：

1)上电后，使电机转子位于初始位置，同时，对控制器位置计数寄存器的值清零，当电机转子开始转动，在到达第一个Z信号位置之前，即未发生Z信号捕获，Z信号捕获标志位Z_flag＝0，转子位置角度θ计算直接使用位置计数寄存器的值x，即θ＝x*2π/M；

2)发生第一次Z信号捕获时，对Z信号捕获标志位Z_flag进行置位，即Z_flag＝1；

3)更新Z信号捕获次数值，对Z信号捕获次数进行计数，每发生一次Z信号捕获，捕获次数Cap_count加一，即Cap_count++；

其中，Z信号捕获次数用于对特定捕获次数位置计数寄存器值的提取，只需对第一次Z信号捕获时位置计数寄存器的值进行提取，为了防止Cap_count的值溢出，在程序中设置，只在Cap_count的值小于一定值W时，执行语句Cap_count++；W大于1且小于Cap_count的最大值；

4)设置一中间变量Cap，在每次发生Z信号捕获的时刻，将此时位置计数寄存器的值x存入变量Cap，即Cap＝x；

5)对Z信号捕获次数Cap_count进行判断，当Cap_count＝＝1时，即发生第一次Z信号捕获时，将此时位置计数寄存器的值x赋给变量C₁，所述C₁代表永磁电机转子初始位置与光电编码器Z信号位置角度差值所对应的脉冲信号计数值，即通过对第一次Z信号捕获发生时位置计数寄存器值的提取，来获得永磁电机转子初始位置与光电编码器Z信号位置角度差值，所述C₁的数值为A、B正交脉冲信号的计数脉冲值，C₁对应一角度弧度值θ₁，θ₁＝C₁*2π/M，将θ₁作为永磁电机转子初始位置与光电编码器Z信号位置角度差值，即后面再捕获到Z信号的时候，转子的角度值赋值为θ₁；

6)由于电机一直处于旋转状态，位置计数寄存器的值亦在实时变化，用x代表位置计数寄存器的值，发生Z信号捕获后，则在第n次捕获Z信号后与第n+1次捕获Z信号前，其中n>0。

所述电机转子角度θ的计算方法为：

当电机正转时，控制器位置计数寄存器的值x随着A、B脉冲信号递增，位置计数寄存器的值x达到最大值N后从最小值0重新开始计数，当位置计数寄存器的值x大于第n次捕获Z信号时位置计数寄存器的值Cap时，电机转子角度θ＝(C₁+x-Cap)*2π/M；当位置计数寄存器的值x小于等于第n次捕获Z信号时位置计数寄存器的值Cap时，θ＝(C₁+x-Cap+N)*2π/M；

当电机反转时，控制器位置计数寄存器的值x随着A、B脉冲信号递减，位置计数寄存器的值x达到最小值0后从最大值N重新开始计数，当位置计数寄存器的值x大于第n次捕获Z信号时位置计数寄存器的值Cap时，电机转子角度θ＝(C₁+x-N-Cap)*2π/M；当位置计数寄存器的值x小于等于第n次捕获Z信号时位置计数寄存器的值Cap时，θ＝(C₁+x-Cap)*2π/M。

控制器位置计数寄存器的最大计数值必须设置为光电编码器旋转一圈对应的A、B脉冲计数值的整数倍。

有益效果：本发明适用于安装有增量式光电编码器的永磁电机转子位置计算，能够有效的减少转子位置计算误差。具体到本发明的技术方案，具有以下优点：

1、通用性强。对增量式光电编码器与电机转轴的安装位置无要求，且两者的安装位置变动后，对算法无影响。对不同的永磁电机(位置传感器为增量式光电编码器)控制系统也适用。

2、计算结果误差小。通过Z信号来使转子位置计算使用的A、B正交脉冲信号计数值误差限制在一圈以内。

3、对控制器位置寄存器无影响。在转子角度计算的过程中，不改变控制器位置计数寄存器的值，不影响位置计数寄存器在其他算法中的使用。

附图说明

图1是电机正转时位置计数寄存器值大于Cap值的计数示意图；

图2是电机正转时位置计数寄存器值小于Cap值的计数示意图；

图3是本发明Z信号捕获中断服务子程序流程图；

图4是本发明永磁电机转子位置计算流程图。

具体实施方式

本发明的永磁电机转子位置计算方法，通过控制器对增量式光电编码器每圈出现的Z信号进行捕获，实现永磁电机转子初始位置与光电编码器Z信号位置角度差值的获取及将用于计算转子角度的A、B脉冲信号计数值误差限制在一圈以内。具体来说，上述方法的实现包括以下步骤(增量式光电编码器一圈的脉冲数为M，无其他方式对A、B正交脉冲信号进行倍频计数，即光电编码器转一圈的脉冲计数值为M，对应的机械角度弧度值为2π。控制器位置计数寄存器的最大计数值设为N，N大于等于M且小于等于位置计数寄存器允许的最大值，同时N必须为M的整数倍。用x代表位置计数寄存器的值)：

1)上电后，使电机转子位于初始位置，同时，对控制器位置计数寄存器的值清零。当电机转子开始转动，在到达第一个Z信号位置之前，即未发生Z信号捕获，Z信号捕获标志位Z_flag＝0，转子位置角度θ计算直接使用位置计数寄存器的值x，即θ＝x*2π/M；

2)发生第一次Z信号捕获时，对Z信号捕获标志位Z_flag进行置位，即Z_flag＝1；

3)更新Z信号捕获次数值，对Z信号捕获次数进行计数，每发生一次Z信号捕获，捕获次数Cap_count加一，即Cap_count++；

其中，Z信号捕获次数用于对特定捕获次数位置计数寄存器值的提取，本发明算法只需对第一次Z信号捕获时位置计数寄存器的值进行提取，因此，为了防止Cap_count的值溢出，可在程序中设置，只在Cap_count的值小于一定值W(W大于1且小于Cap_count的最大值)时，执行语句Cap_count++；

4)设置一中间变量Cap，在每次发生Z信号捕获的时刻，将此时位置计数寄存器的值x存入变量Cap，即Cap＝x；

5)对Z信号捕获次数Cap_count进行判断，当Cap_count＝＝1时，即发生第一次Z信号捕获时，将此时位置计数寄存器的值x赋给变量C₁(所述C₁代表永磁电机转子初始位置与光电编码器Z信号位置角度差值所对应的脉冲信号计数值)。即通过对第一次Z信号捕获发生时位置计数寄存器值的提取，来获得永磁电机转子初始位置与光电编码器Z信号位置角度差值。所述C₁的数值为A、B正交脉冲信号的计数脉冲值，C₁对应一角度弧度值θ₁，θ₁＝C₁*2π/M，将θ₁作为永磁电机转子初始位置与光电编码器Z信号位置角度差值，即后面再捕获到Z信号的时候，转子的角度值赋值为θ₁；

6)由于电机一直处于旋转状态，因此位置计数寄存器的值亦在实时变化，用x代表位置计数寄存器的值。发生Z信号捕获后，则在第n(n>0)次捕获Z信号后与第n+1次捕获Z信号前，电机转子角度θ的计算方法为：

当电机正转时，控制器位置计数寄存器的值x随着A、B脉冲信号递增，位置计数寄存器的值x达到最大值N后从最小值0重新开始计数。当位置计数寄存器的值x大于第n次捕获Z信号时位置计数寄存器的值Cap时，θ＝(C₁+x-Cap)*2π/M；当位置计数寄存器的值x小于等于第n次捕获Z信号时位置计数寄存器的值Cap时，θ＝(C₁+x-Cap+N)*2π/M；

当电机反转时，控制器位置计数寄存器的值x随着A、B脉冲信号递减，位置计数寄存器的值x达到最小值0后从最大值N重新开始计数。当位置计数寄存器的值x大于第n次捕获Z信号时位置计数寄存器的值Cap时，θ＝(C₁+x-N-Cap)*2π/M；当位置计数寄存器的值x小于等于第n次捕获Z信号时位置计数寄存器的值Cap时，θ＝(C₁+x-Cap)*2π/M。

下面结合具体实施例和附图来详细说明本发明。

具体举例来说：增量式光电编码器一圈脉冲数为1024，控制器为DSP28355，eQEP模块工作于正交计数模式，对输入的A、B正交脉冲信号进行4倍频计数，则光电编码器沿同一方向旋转一圈，控制器的脉冲计数值为4096，4096对应机械角度弧度值为2π。eQEP最大位置计数寄存器的值设为4096，即EQep1Regs.QPOSMAX＝4096。控制器eCAP模块工作于捕捉模式，用于捕获Z信号。定义变量Z_flag用于表明是否发生Z信号捕获，Z_flag＝＝0时，表示未发生Z信号捕获，Z_flag＝＝1时，表示发生Z信号捕获。定义变量Cap_count用于存放Z信号捕获次数，程序初始化时，Z_flag与Cap_count均赋值0。

本发明方法包括两个功能模块，即Z信号捕获后处理功能模块与转子角度计算功能模块。Z信号捕获后处理功能模块实现三个功能：Z信号捕获标志位的置位；转子初始位置与Z信号位置角度差值C1的获取；Cap值得更新，即每次Z信号捕获时，将此时的位置计数寄存器值赋给变量Cap。转子角度计算功能模块实现电机转子角度的计算。应用于DSP28335，则通过2个中断服务子程序实现上述两个功能模块，即eCAP捕获中断和控制算法所在的中断。本发明方法应用于DSP28355的实现步骤如下：

1)上电后，使电机转子位于初始位置，同时，对控制器位置计数寄存器的值清零。当电机转子开始转动，在到达第一个Z信号位置之前，即未发生Z信号捕获，Z信号捕获标志位Z_flag＝0，转子位置角度θ计算直接使用位置计数寄存器的值EQep1Regs.QPOSCNT，即θ＝EQep1Res.QPOSCNT*2π/4096；

2)发生第一次Z信号捕获时，对Z信号捕获标志位Z_flag进行置位，即Z_flag＝1；

3)更新Z信号捕获次数值，对Z信号捕获次数进行计数，每发生一次Z信号捕获，捕获次数Cap_count加一，即Cap_count++；

其中，Z信号捕获次数用于对特定捕获次数位置计数寄存器值的提取，本发明算法只需对第一次Z信号捕获时位置计数寄存器的值进行提取，因此，为了防止Cap_count的值溢出，可在程序中设置，只在Cap_count的值小于一定值W(W大于1且小于Cap_count的最大值)时，执行语句Cap_count++；

4)设置一中间变量Cap，在每次发生Z信号捕获的时刻，将此时位置计数寄存器的值EQep1Regs.QPOSCNT存入变量Cap，即Cap＝EQep1Regs.QPOSCNT；

5)对Z信号捕获次数Cap_count进行判断，当Cap_count＝＝1时，即发生第一次Z信号捕获时，将此时位置计数寄存器的值EQep1Regs.QPOSCNT赋给变量C1(所述C1代表永磁电机转子初始位置与光电编码器Z信号位置角度差值所对应的脉冲信号计数值)。即通过对第一次Z信号捕获发生时位置计数寄存器值的提取，来获得永磁电机转子初始位置与光电编码器Z信号位置角度差值。所述C₁的数值为A、B正交脉冲信号的计数脉冲值，C1对应一角度弧度值θ₁，θ₁＝C₁*2π/4096，将θ₁作为永磁电机转子初始位置与光电编码器Z信号位置角度差值，即后面再捕获到Z信号的时候，转子的角度值赋值为θ₁；

6)由于电机一直处于旋转状态，因此位置计数寄存器的值亦在实时变化，用x代表位置计数寄存器的值。发生Z信号捕获后，则在第n(n>0)次捕获Z信号后与第n+1次捕获Z信号前，电机转子角度θ的计算方法为：

当电机正转时，控制器位置计数寄存器的值x随着A、B脉冲信号递增，位置计数寄存器的值EQep1Regs.QPOSCNT达到最大值4096后从最小值0重新开始计数。当Cap<EQep1Regs.QPOSCNT时，此时位置计数寄存器值未到达最大值4096，示意图如图1所示，转子角度θ＝(C₁+EQep1Res.QPOSCNT-Cap)*2π/4096；当Cap≥EQep1Regs.QPOSCNT时，位置计数寄存器值已经过最大值点，重新从0开始计数，示意图如图2所示，转子角度θ＝(C₁+EQep1Res.QPOSCNT-Cap+4096)*2π/4096；

当电机反转时，控制器位置计数寄存器的值x随着A、B脉冲信号递减，位置计数寄存器的值x达到最小值0后从最大值4096重新开始计数。当Cap<EQep1Regs.QPOSCNT时，此时位置计数寄存器的值已经过最小值点，重新从4096开始计数(与电机正转的分析过程类似，此处不再附计数过程示意图赘述)，转子角度θ＝(C₁+EQep1Res.QPOSCNT-4096-Cap)*2π/4096；当Cap≥EQep1Regs.QPOSCNT，此时位置计数寄存器值还未到达最小值0，转子角度θ＝(C₁+EQep1Res.QPOSCNT-Cap)*2π/4096。

本发明Z信号捕获中断(eCAP捕获中断)服务子程序流程图如图3所示。永磁电机转子位置角度计算方法流程图如图4所示。其中，W为大于1且小于Cap_count最大值的一定值；x代表位置计数寄存器的实时值。在本实施例中，x代表EQep1Regs.QPOSCNT，M＝4096，N＝4096。

以上所述仅为本发明的一种实施方式，本发明的保护范围并不以上述实施方式为限，但凡本领域普通技术人员根据本发明所揭示内容所作的等效修饰或变化，皆应纳入权利要求书中记载的保护范围内。

Claims (2)

1.一种永磁电机转子位置计算方法，其特征是永磁电机转子位置计算方法具体实现步骤如下：增量式光电编码器一圈的脉冲数为M，即光电编码器转一圈的脉冲计数值为M，对应的机械角度弧度值为2π，控制器位置计数寄存器的最大计数值为N，N大于等于M且小于等于位置计数寄存器允许的最大值，同时N必须为M的整数倍，用x代表位置计数寄存器的值：

1)上电后，使电机转子位于初始位置，同时，对控制器位置计数寄存器的值清零，当电机转子开始转动，在到达第一个Z信号位置之前，即未发生Z信号捕获，Z信号捕获标志位Z_flag＝0，电机转子角度θ计算直接使用位置计数寄存器的值x，即θ＝x*2π/M；

2)发生第一次Z信号捕获时，对Z信号捕获标志位Z_flag进行置位，即Z_flag＝1；

3)更新Z信号捕获次数值，对Z信号捕获次数进行计数，每发生一次Z信号捕获，捕获次数Cap_count加一，即Cap_count++；

其中，Z信号捕获次数用于对特定捕获次数位置计数寄存器值的提取，只需对第一次Z信号捕获时位置计数寄存器的值进行提取，为了防止Cap_count的值溢出，在程序中设置，只在Cap_count的值小于一定值W时，执行语句Cap_count++；W大于1且小于Cap_count的最大值；

4)设置一中间变量Cap，在每次发生Z信号捕获的时刻，将此时位置计数寄存器的值x存入变量Cap，即Cap＝x；

5)对Z信号捕获次数Cap_count进行判断，当Cap_count＝＝1时，即发生第一次Z信号捕获时，将此时位置计数寄存器的值x赋给变量C₁，所述C₁代表永磁电机转子初始位置与光电编码器Z信号位置角度差值所对应的脉冲信号计数值，即通过对第一次Z信号捕获发生时位置计数寄存器值的提取，来获得永磁电机转子初始位置与光电编码器Z信号位置角度差值，所述C₁的数值为A、B正交脉冲信号的计数脉冲值，C₁对应一角度弧度值θ₁，θ₁＝C₁*2π/M，将θ₁作为永磁电机转子初始位置与光电编码器Z信号位置角度差值，即后面再捕获到Z信号的时候，转子的角度值赋值为θ₁；

6)由于电机一直处于旋转状态，位置计数寄存器的值亦在实时变化，用x代表位置计数寄存器的值，发生Z信号捕获后，则在第n次捕获Z信号后与第n+1次捕获Z信号前，其中n>0；

所述电机转子角度θ的计算方法为：

当电机正转时，控制器位置计数寄存器的值x随着A、B脉冲信号递增，位置计数寄存器的值x达到最大值N后从最小值0重新开始计数，当位置计数寄存器的值x大于第n次捕获Z信号时位置计数寄存器的值Cap时，电机转子角度θ＝(C₁+x-Cap)*2π/M；当位置计数寄存器的值x小于等于第n次捕获Z信号时位置计数寄存器的值Cap时，θ＝(C₁+x-Cap+N)*2π/M；

当电机反转时，控制器位置计数寄存器的值x随着A、B脉冲信号递减，位置计数寄存器的值x达到最小值0后从最大值N重新开始计数，当位置计数寄存器的值x大于第n次捕获Z信号时位置计数寄存器的值Cap时，电机转子角度θ＝(C₁+x-N-Cap)*2π/M；当位置计数寄存器的值x小于等于第n次捕获Z信号时位置计数寄存器的值Cap时，θ＝(C₁+x-Cap)*2π/M。

2.根据权利要求1所述的电机转子位置计算方法，所述的控制器位置计数寄存器的最大计数值必须设置为光电编码器旋转一圈对应的A、B脉冲计数值的整数倍。