1、BEN 测速编码器在智能车舵机控制中的应用21 舵机工作原理舵机在 6 V 电压下正常工作，而大赛组委会统一提供的标准电源输出电压为 72 V，则需一个外围电压转换电路将电源电压转换为舵机的工作电压 6 V。图 2 为舵机供电电路。 舵机由舵盘、位置反馈电位计、减速齿轮组、直流动电机和控制电路组成，内部位置反馈减速齿轮组由直流电动机驱动，其输出轴带动一个具有线性比例特性的位置反馈电位器作为位置检测。当电位器转角线性地转换为电压并反馈给控制电路时，控制电路将反馈信号与输入的控制脉冲信号相比较，产生纠正脉冲，控制并驱动直流电机正向或反向转动，使减速齿轮组输出的位置与期望值相符。从而达到舵机精确控制
2、转向角度的目的。舵机工作原理框图如图 3 所示。22 舵机的安装与调节舵机的控制脉宽与转角在-45+45范围内线性变化。对于对速度有一定要求的智能车，舵机的响应速度和舵机的转向传动比直接影响车模能否以最佳速度顺利通过弯道。车模在赛道上高速行驶，特别是对于前瞻性不够远的红外光电检测智能车，舵机的响应速度及其转向传动比将直接影响车模行驶的稳定性，因此必须细心调试，逐一解决。由于舵机从执行转动指令到响应输出需占用一定的时间，因而产生舵机实时控制的滞后。虽然车模在进入弯道时能够检测到黑色路线的偏转方向，但由于舵机的滞后性，使得车模在转弯过程中时常偏离跑道，且速度越快，偏离越远，极大限制车模在连续弯道上
3、行驶的最大时速，使得车模全程赛道速度很难进一步提高。为了减小舵机响应时间，在遵守比赛规则不允许改造舵机结构的前提下，利用杠杆原理，采用加长舵机力臂的方案来弥补这一缺陷，加长舵机力臂示意图如图 4 所示。图 4 中，R 为舵机力臂； 为舵机转向角度；F 为转向所需外力； 为外力同力臂的夹角。在舵机输出盘上增加长方形杠杆，在杠杆的末端固定转向传动连杆，其表达式为：加长力臂后欲使前轮转动相同角度时，在舵机角速度 相同的条件下舵机力臂加长后增大了线速度 v，最终使得舵机的转向角度 减小。舵机输出转角 减小，舵机的响应时间t 也会变短。同时由式(1)可推出线速度口增大后，前轮转向所需的时间 t 相应也会
4、变短，其表达式为：t=dsdv (2)此外，当舵机连杆水平且与舵机力臂垂直时，得到力矩 M，可由式(3)表示：M=FRsin (3)说明当舵机连杆和舵机力臂垂直时 =900，此时 sin 得到最大值。在舵机力臂 R 一定和外力 F 相同条件下，舵机产生的力矩 M 最大，实现前轮转向的时间最短。在实际调试车模时发现，这种方法对提高舵机的响应速度也具有局限性：当在舵机输出力矩相同的条件下，力臂越长，作用力越小。在转向遇到较大转向阻力时，会影响舵机对转向轮控制的精度，甚至使转向轮的响应速度变慢；另外，舵机机械结构精度产生的空程差也会在力臂加长中放大。使得这一非线性环节对控制系统的不利影响增大。因此，
5、舵机安装的高度具有最佳范围，仍需通过试验反复测试。 3 霍尔传感器的应用由于在赛前比赛赛道的几何图形是未公开的。赛前车模训练的路线与实际比赛的路线相差甚远，若车模自适应性调整不好，车模会在连续弯道处频繁的偏转。赛道的变更给车模的适应性和稳定性带来了一定挑战。为了使得车模能够平稳地沿着赛道行驶，除控制前轮转向舵机以外，还需要控制好各种路况的车速，使得车模在急转弯和下坡时不会因速度过快而冲出赛道。因此，利用霍尔传感器检测车模瞬时速度，实现对车模速度的闭环反馈控制，小车的 PC9S12 控制板能够根据赛道路况变化而相应执行软件给定的加速、减速、刹车等指令，在最短的时间内由当前速度转变为期望的速度，使
6、得车模快速平稳行驶。基于霍尔效应，固定在转盘附近的霍尔传感器便可在每个小钢磁通过时产生一个相应的脉冲，检测出单位时间的脉冲数，便可知被测转速。霍尔传感测速装置示意图如图 5 所示。显然不是安装小钢磁越多越好，在一定的条件允许范围内，磁性转盘上小钢磁的数目越多，确定传感器测量转速的分辨率也越高，速度控制也越精确。一般 48 片是最佳范围。4 结束语为了参加第四届“精芬”杯全国大学生智能汽车竞赛，此设计方案在校级代表队资格选拔赛中表现完美，最终跑出 197 s 的好成绩，成功入选。实践证明了智能车舵机控制转向和霍尔控制测速优化方案具有可行性和实用性。检查原图（大图）加长力臂后欲使前轮转动类似角度时
7、，在舵机角速度 类似的条件下舵机力臂加长后增大了线速度v，结尾使得舵机的转向角度 减小。舵机输出转角 减小，舵机的照应时间 t 也会变短。同时由式(1)可推出线速度口增大后，前轮转向所需的时间 t 相应也会变短，其表达式为：t=dsdv (2)此外，当舵机连杆水平且与舵机力臂垂直时，得到力矩 M，可由式(3)示意：M=FRsin (3)标明当舵机连杆和舵机力臂垂直时 =900，此时 sin 得到最大值。在舵机力臂 R 必须和外力 F 类似条件下，舵机发生的力矩 M 最大，完成前轮转向的时间最短。在实践调试车模时发觉，这种办法对提高舵机的照应速度也具有局限性：当在舵机输出力矩类似的条件下，力臂越
8、长，作用力越小。在转向遇到较大转向阻力时，会影响舵机对转向轮控制的精度，甚至使转向轮的照应速度变慢；另外，舵机机械构造精度发生的空程差也会在力臂加长中扩大。使得这一非线性环节对控制系统的不利影响增大。因而，舵机装置的高度具有最好范围，仍需议决实验反复测试。 3 霍尔传感器的使用由于在赛前竞赛赛道的几何图形是未公示的。赛前车模训练的路途与实践竞赛的路途相差甚远，若车模自顺应性调整不好，车模会在延续弯道处频繁的偏转。赛道的变卦给车模的顺应性和固定性带来了必须挑衅。为了使得车模能够颠簸地沿着赛道行驶，除控制前轮转向舵机以外，还须要控制好各种路况的车速，使得车模在急转弯和下坡时不会因速渡过快而冲出赛道
9、。因而，使用霍尔传感器检测车模瞬时速度，完成对车模速度的闭环反应控制，小车的 PC9S12 控制板能够依据赛路途况改动而相应执行软件给定的加快、放慢、刹车等指令，在最短的时间内由现在速度转变为希冀的速度，使得车模高速颠簸行驶。基于霍尔效应，固定在转盘附近的霍尔传感器便可在每个小钢磁议决时发生一个相应的脉冲，检测出单位时间的脉冲数，便可知被测转速。霍尔传感测速装置示意图如图 5 所示。显然不是装置小钢磁越多越好，在必须的条件准许范围内，磁性转盘上小钢磁的数目越多，确定传感器测量转速的分辨率也越高，速度控制也越精确。普通 48 片是最好范围。电机的位置检测在电机控制中是十分重要的，特别是需要根据精
10、确转子位置控制电机运动状态的应用场合，如位置伺服系统。电机控制系统中的位置检测通常有：微电机解算元件，光电元件，磁敏元件，电磁感应元件等。这些位置检测传感器或者与电机的非负载端同轴连接，或者直接安装在电机的特定的部位。其中光电元件的测量精度较高，能够准确的反应电机的转子的机械位置，从而间接的反映出与电机连接的机械负载的准确的机械位置，从而达到精确控制电机位置的目的。在本文中我将主要介绍高精度的光电编码器的内部结构、工作原理与位置检测的方法。一、BEN 编码器的介绍：光电编码器是通过读取光电编码盘上的图案或编码信息来表示与光电编码器相连的电机转子的位置信息的。根据光电编码器的工作原理可以将光电编
11、码器分为绝对式光电编码器与增量式光电编码器，下面我就这两种光电编码器的结构与工作原理做介绍。（一）、BEN 编码器绝对式光电编码器如图所示，他是通过读取编码盘上的二进制的编码信息来表示绝对位置信息的。编码盘是按照一定的编码形式制成的圆盘。图 1 是二进制的编码盘，图中空白部分是透光的，用“0”来表示;涂黑的部分是不透光的，用“1” 来表示。通常将组成编码的圈称为码道，每个码道表示二进制数的一位，其中最外侧的是最低位，最里侧的是最高位。如果编码盘有 4 个码道，则由里向外的码道分别表示为二进制的 23、22、21 和 20，4 位二进制可形成 16 个二进制数，因此就将圆盘划分 16 个扇区，每
12、个扇区对应一个 4 位二进制数，如 0000、0001、1111 。电机的位置检测在电机控制中是十分重要的，特别是需要根据精确转子位置控制电机运动状态的应用场合，如位置伺服系统。电机控制系统中的位置检测通常有：微电机解算元件，光电元件，磁敏元件，电磁感应元件等。这些位置检测传感器或者与电机的非负载端同轴连接，或者直接安装在电机的特定的部位。其中光电元件的测量精度较高，能够准确的反应电机的转子的机械位置，从而间接的反映出与电机连接的机械负载的准确的机械位置，从而达到精确控制电机位置的目的。在本文中我将主要介绍高精度的光电编码器的内部结构、工作原理与位置检测的方法。一、BEN 编码器的介绍：光电编
13、码器是通过读取光电编码盘上的图案或编码信息来表示与光电编码器相连的电机转子的位置信息的。根据光电编码器的工作原理可以将光电编码器分为绝对式光电编码器与增量式光电编码器，下面我就这两种光电编码器的结构与工作原理做介绍。（一）、BEN 编码器绝对式光电编码器如图所示，他是通过读取编码盘上的二进制的编码信息来表示绝对位置信息的。编码盘是按照一定的编码形式制成的圆盘。图 1 是二进制的编码盘，图中空白部分是透光的，用“0”来表示;涂黑的部分是不透光的，用“1” 来表示。通常将组成编码的圈称为码道，每个码道表示二进制数的一位，其中最外侧的是最低位，最里侧的是最高位。如果编码盘有 4 个码道，则由里向外的
14、码道分别表示为二进制的 23、22、21 和 20，4 位二进制可形成 16 个二进制数，因此就将圆盘划分 16 个扇区，每个扇区对应一个 4 位二进制数，如 0000、0001、1111 。按照码盘上形成的码道配置相应的光电传感器，包括光源、透镜、码盘、光敏二极管和驱动电子线路。当码盘转到一定的角度时，扇区中透光的码道对应的光敏二极管导通，输出低电平“0”，遮光的码道对应的光敏二极管不导通，输出高电平“1” ，这样形成与编码方式一致的高、低电平输出，从而获得扇区的位置脚。（二）、增量式 BEN 编码器增量式 BEN 编码器是码盘随位置的变化输出一系列的脉冲信号，然后根据位置变化的方向用计数器
15、对脉冲进行加/减计数，以此达到位置检测的目的。它是由光源、透镜、主光栅码盘、鉴向盘、光敏元件和电子线路组成。增量式 BEN 光电编码器的工作原理是是由旋转轴转动带动在径向有均匀窄缝的主光栅码盘旋转，在主光栅码盘的上面有与其平行的鉴向盘，在鉴向盘上有两条彼此错开 90o相位的窄缝，并分别有光敏二极管接收主光栅码盘透过来的信号。工作时，鉴向盘不动，主光栅码盘随转子旋转，光源经透镜平行射向主光栅码盘，通过主光栅码盘和鉴向盘后由光敏二极管接收相位差 90o 的近似正弦信号，再由逻辑电路形成转向信号和计数脉冲信号。为了获得绝对位置角，在增量式光电编码器有零位脉冲，即主光栅每旋转一周，输出一个零位脉冲，使
16、位置角清零。利用增量式光电编码器可以检测电机的位置和速度。二、BEN 编码器的测量方法：光电编码器在电机控制中可以用来测量电机转子的磁场位置和机械位置以及转子的磁场和机械位置的变化速度与变化方向。下面就我就光电编码器在这几方面的应用方法做一下介绍。（一）、使用 BEN 编码器来测量电机的转速可以利用定时器/计数器配合光电编码器的输出脉冲信号来测量电机的转速。具体的测速方法有 M 法、T 法和 M/T 法 3 种。M 法又称之为测频法，其测速原理是在规定的检测时间 Tc 内，对光电编码器输出的脉冲信号计数的测速方法，如图 2 所示，例如光电编码器是 N 线的，则每旋转一周可以有 4N个脉冲，因为
17、两路脉冲的上升沿与下降沿正好使编码器信号 4 倍频。现在假设检测时间是Tc，计数器的记录的脉冲数是 M1，则电机的每分钟的转速为在实际的测量中，时间 Tc 内的脉冲个数不一定正好是整数，而且存在最大半个脉冲的误差。如果要求测量的误差小于规定的范围，比如说是小于百分之一，那么 M1 就应该大于 50。在一定的转速下要增大检测脉冲数 M1 以减小误差，可以增大检测时间 Tc 单考虑到实际的应用检测时间很短，例如伺服系统中的测量速度用于反馈控制，一般应在 0.01秒以下。由此可见，减小测量误差的方法是采用高线数的光电编码器。M 法测速适用于测量高转速，因为对于给定的光电编码器线数 N 机测量时间 T
18、c 条件下，转速越高，计数脉冲 M1 越大，误差也就越小。T 法也称之为测周法，该测速方法是在一个脉冲周期内对时钟信号脉冲进行计数的方法，如图 3 所示。例如时钟频率为 fclk,计数器记录的脉冲数为 M2，光电编码器是 N 线的，每线输出 4N 个脉冲，那么电机的每分钟的转速为为了减小误差，希望尽可能记录较多的脉冲数，因此 T 法测速适用于低速运行的场合。但转速太低，一个编码器输出脉冲的时间太长，时钟脉冲数会超过计数器最大计数值而产生溢出;另外，时间太长也会影响控制的快速性。与 M 法测速一样，选用线数较多的光电编码器可以提高对电机转速测量的快速性与精度。M/T 法测速是将 M 法和 T 法
19、两种方法结合在一起使用，在一定的时间范围内，同时对光电编码器输出的脉冲个数 M1 和 M2 进行计数，则电机每分钟的转速为实际工作时，在固定的 Tc 时间内对光电编码器的脉冲计数，在第一个光电编码器上升沿定时器开始定时，同时开始记录光电编码器和时钟脉冲数，定时器定时 Tc 时间到，对光电编码器的脉冲停止计数，而在下一个光电编码器的上升沿到来时刻，时钟脉冲才停止记录。采用 M/T 法既具有 M 法测速的高速优点，又具有 T 法测速的低速的优点，能够覆盖较广的转速范围，测量的精度也较高，在电机的控制中有着十分广泛的应用。（二）使用增量式光电编码器来判别电机转速方向的原理增量式光电编码器输出两路相位
20、相差 90o 的脉冲信号 A 和 B，当电机正转时，脉冲信号 A 的相位超前脉冲信号 B 的相位 90o，此时逻辑电路处理后可形成高电平的方向信号 Dir。当电机反转时，脉冲信号 A 的相位滞后脉冲信号 B 的相位 90o，此时逻辑电路处理后的方向信号 Dir 为低电平。因此根据超前与滞后的关系可以确定电机的转向。其转速辩相的原理如图 4 所示图 4 转向判别原理图（三）、增量式 BEN 光电编码器的反馈脉冲的四倍频原理在使用增量式编码器时，通过计相位相差 90o 的两路正交脉冲信号 A 和 B 的上升沿与下降沿已达到将增量式编码器的反馈脉冲四倍频的目的。这样在不增加增量式光电编码器的线数的情
21、况下，就可以获得更精度高的位置脉冲信息，以实现对电机位置的精确控制。其工作原理与脉冲的相位关系如图 5 所示图 5 脉冲四倍频相位关系图结束语：光电式 BEN 编码器有着良好的抗干扰特性与应用的可靠性，在电机控制这种有着极高电磁感染的应用环境下有着广阔的应用前景。相信在不久的将来光电式编码器一定会在电机控制领域发挥更为重要的作用。而我们对于光电式编码器的研究也就显得格外的重要。实验一 增量式码盘原理及应用一、实验目的：1、 掌握光电编码器的工作原理与使用方法。2、 掌握 T 法测速的基本原理。二、实验设备：1、 BE EM400 教学设备一台。2、 计算机一台。3、 双踪示波器一台。三、实验原
22、理：（一） BEN 编码器原理以最常用的增量式光电编码器说明其原理（如图 1-1）：图 1-1 增量式 BEN 编码器的工作原理1 发光二极管 2 光电圆盘 3 转盘缝隙 4 遮光板 A B C 光敏元件光电圆盘与被测轴连接，光线通过光电圆盘和遮光板的缝隙，在光电元件上形成明暗交替变化的条纹，在 A、 B 光敏元件上产生近似于正弦波的电流信号，经放大整形电路变成相位相差 90的方波信号，如图 1-2 所示。轴每转动一圈，只产生一个 C相脉冲，用做参考零位的标志脉冲，在数控机床的进给控制中，C 相脉冲用来产生机床的基准点。A 相和 B 相的相位差可用作电机的旋转方向判别，若 A 相超前于 B 相
23、，对应电机作正向运动；反之，对应电机作反向运动。该方波的前沿或后沿产生的计数脉冲，可以形成代表正向和反向位置的脉冲序列。此外，在实际应用中，为了提高编码器信号的传输能力和抗干扰能力，每一相都以差分形式输出，如 A 相有 A 和 A/一起差动输出。图 1-2 光电编码器输出波形（二） BEN 编码器测速原理：在闭环伺服系统中，根据脉冲计数来测量转速的方法有以下三种：（1）在规定时间内测量所产生的脉冲个数来获得被测速度，称为 M 法测速；（2）测量相邻两个脉冲的时间来测量速度，称为 T 法测速；（3）同时测量检测时间和在此时间内脉冲发生器发出的脉冲个数来测量速度，称为 M/T 法测速。以上三中测速
24、方法中，M 法适合于测量较高的速度，能获得较高分辨率；T 法适合于测量较低的速度，这时能获得较高的分辨率；而 M/T 法则无论高速低速都适合测量。由于 PMAC 控制器采用的是 T 法测速，所以以下只对 T 法测速进行介绍。T 法测速的原理是用一已知频率 fc（此频率一般都比较高）的时钟脉冲向一计数器发送脉冲，计数器的起停由码盘反馈的相邻两个脉冲来控制，原理图见图 1-3。若计数器读数为 m1，则电机每分钟转速为nM=60fc/Pm1(r/min) （1）图 1-3 T 法测速原理其中 P 为码盘一圈发出的脉冲个数即码盘线数。m 1= M106-Y:$C000,0,24,U 为脉冲个数fc=1
25、0MHz（注意：此时需设置 PMAC 卡上的跳线E34A=OFF，E34=ON，E35 ， E36，E37=OFF）测速分辨率：当对应转速由 n1 变为 n2 时则分辨率 Q 的定义为 Q=n2-n1，Q 值越小说明测量装置对转速变化越敏感即分辨率越高。因此可以得到 T 法测速的分辨率为Q=60fc/Pm1-60fc/P（m 1+1）= n2M P/（60f c+ nMP） （2）由上式可见随着转速 nM 的降低，Q 值越小，即 T 法测速在低速时有较高的分辨率。四、注意事项： 1、 按要求正确接线。2、 正确使用双踪示波器。3、 编码器是精密的光电元件，应避免强烈振动。五、实验内容与步骤：内
26、容一：编码器辨向及 T 法测速实验1、 将 EM400 控制柜的所有电缆同 X-Y 平台连接好（包括电机动力线、码盘反馈线、限位回零线、光栅反馈线），将 EM400 控制柜的串口与计算机的串口连接好，确定无误后打开控制箱电源和计算机电源。2、 调整好示波器，将其中一路连接到 X 轴的 A+和 GND 上，将另一路连接到 B+和GND 上准备观察。3、 运行 PEWIN32PRO32pro 软件，分别点击 VIEW 菜单下的 position、Watch window、Jog Ribbon 子菜单，打开位置窗口、监视窗口和手动（Jog）控制窗口。4、 在 Terminal 窗口中定义 M106-
27、Y:$C000,0,24,U，用鼠标点击监视窗口，按INSERT 键，加入 M106 变量对它进行监视，m 1= M106 存放的即相邻两个脉冲之间计数器的读数。5、 在 Jog Ribbon 窗口选择 1 号电机（对应 X 轴）。6、 分别按 “Jog minus”、“Jog plus”按钮让 X 轴电机来回运动起来，在运动的同时注意查看以下几个地方：M106 的数值，示波器中双路波形之间的相位关系，并在数值稳定后做相应记录，填写表 1-1（注意为了不让工作台超出行程范围，可以先让工作台处在中间位置，然后交替按“Jog minus”、“Jog plus”按钮）。7、 X 轴电机停转后，在 T
28、erminal 窗口键入“I122=10”并回车，（I122 为 X 轴手动速度，单位 cts/ms，I122*1000*60/P 后单位变为转/ 分，其中 P 为码盘反馈线数），重复步骤 6。然后将 I122 的数值逐步增大，幅度为 510。再次重复步骤 6 两次后填写表 1-2。8、 总结观测到的数据得出相应的结论。内容二：编码器倍频译码1、 接上一实验，将 X 方向平台运行到中间位置。2、 在 Jog Ribbon 窗口中选中 Jog Incrementally,在 increment 后的文本框中输入10000，按“Jog minus”或“Jog plus”向 X 轴电机发送 1000
29、0 个计数，让电机转动，并查看工作台移动的距离或电机转动圈数。3、 在 Terminal 窗口中键入 “I900”查看 X 轴电机码盘译码方式及倍频关系，当 I900为 3 或 7 时，编码器经过了 4 倍频译码（假设电机编码器反馈到 PMAC 的线数为2500 线，则电机转一圈需要 2500*4=10000 个指令脉冲）。4、 将 I900 号参数改为 2 或 6（注意如果原来为 3 就改成 2，原来为 7 就改为 6，切不可搞错，否则电机将因为编码器译码方向错误而开环失去控制），使 X 轴码盘的译码方式变成 2 倍频正交译码。5、 重复步骤 2，让电机转动并记录工作台移动距离或电机转动圈数
30、。6、 将 I900 号参数改为 1 或 5（注意如果原来为 2 就改成 1，原来为 6 就改为 5，切不可搞错，理由同步骤 7），使 X 轴码盘的译码方式变成 1 倍频正交译码。7、 重复步骤 2，让电机转动并记录工作台移动距离或电机转动圈数，填写表 1-3。内容三：编码器 C 信号作用1、 在 PEWIN32PRO Terminal 窗口键入“I902=1”，选择编码器 C 信号上升沿进行回原点（此时，I903 的值被忽略）。2、 将 X 轴平台运行到中央，按 Jog Ribbon 窗口中的 home 按钮，将 X 轴回到原点，观察工作台是否能在行程中间停止。若工作台能自行停止，则表示其能
31、回到原点，此时请记录原点位置。在 PEWIN32PRO Terminal 窗口键入“I123”（回原点的速度），查看 X 轴回原点的速度并记录。3、 只更改 I123 的符号，重复步骤 2。4、 更改 I123 的值和符号，再次重复步骤，并观察回原点的结果与 I123 的值和符号有何关系？具体咨询上海 021 精芬机电 39536219 实验二 半闭环系统 PID 调整一、 实验目的：1、 理解 PID 调整对系统的意义。2、 理解 P、I 、D 参数的含义。3、 掌握控制环调整的方法和步骤。4、 掌握控制环特性的评估方法。二、 实验设备：1、 BE EM400 教学设备一台。2、 计算机一台
32、。3、 Pewin32Pro 软件。三、 实验原理： 一旦机电模型确定后，为了达到稳定、快速、准确的控制效果，所有的闭环控制系统都要对系统进行校正，如果不对系统进行任何校正是很难达到满意的控制效果的。现在校正的方式方法很多，但使用的最普遍的还是 PID 反馈控制+前馈控制，PID 校正用于反馈通道上，而前馈控制用于前向通道上。增大比例系数 P 将加快系统的响应，它的作用于输出值较快，能有效的克服扰动的影响，但不能消除误差，且过大的比例系数会使系统有比较大的超调，并产生振荡，使稳定性变坏。积分能在比例的基础上消除误差。微分具有超前作用，它可以使系统超调量减小，稳定性增加，对于提高系统的动态性能指
33、标，有着显著效果。PMAC 卡为用户提供了 PID+速度/加速度前馈+NOTCH 滤波的控制环算法，能够满足大部分应用场合的要求，用户可以根据自己系统的要求来调整其中的相关参数。PMAC 控制算法的原理如图 2-1 所示。图 2-1 PMAC 控制算法的原理图中的 Kp、Kd、Kvff、KI、IM、Kaff 是 PMAC 控制器的 PID+速度/加速度前馈调节器的参数，通过调节这些参数能够解决大部分的系统特性问题，这些参数的含义、作用及调整范围如表 2-1 和表 2-2 所示。表 2-1 PID 参数变量 参数 作用 调整值域 数值影响IX30 P 参数，比例增益提供系统所需的刚性（快速性）-
34、83886088388607缺省为 2000数值越大，系统刚性越好，但太大会产生振荡。太小系统会反应迟缓。IX33 I 参数，积分增益用于消除稳态误差（准确性）08388607缺省为 1280与 IX63 时间积分误差有关；如果输出饱满，IX33 无效。IX34 积分模式决定积分增益是全程有效还是只在速度为 0 时才有效0缺省为 1IX34=0 积分增益全程有效IX34=1 积分增益只在速度为 0 时有效IX31 D 参数，微分增益用于提供足够的阻尼以保证系统稳定（稳定性）-83886088388607缺省为 1280数值越大，阻尼越大，系统越稳定表 2-2 前馈参数变量 参数 作用 调整值域
35、 数值影响IX32 速度前馈减小由于微分增益的引入所引起的跟随误差08388607缺省为 1280对电流环，IX32 应等于或略大于 IX31。对速度环，IX32 应远大于 IX31。IX35 加速度前馈减小由于系统惯性所带来的跟随误差08388607缺省为 0反应滞后特别明显时，增加 IX35表 2-3 其他相关参数变量 参数 作用 调整值域 数值影响IX29 模拟量输出偏差校正 PMAC 的模拟量输出与放大器模拟输入之间的误差-3276832767缺省为 0数值上应与修正电压计的模拟输出相等IX69 模拟量输出极限用于限制 PMAC中模拟量输出的大小032767缺省为 20480如果控制环
36、送出的模拟量大于该值，则模拟量输出大小将被它限制Pewin32Pro 软件为用户提供了调节的工具，即可使用自动调整 PID 参数的功能，又可手动输入参数，通过分析系统的阶跃响应和正弦曲线响应来评估系统特性，其中阶跃响应曲线用于评估 PID 参数得调整，正弦曲线响应用来评估前馈参数的调整。以下简要的说明手动调节 PID 参数的指导原则。运行 Pewin32Pro 软件后，点击 Tool 菜单下的 Pmac tuning pro 菜单打开 Pmac tuning 程序，弹出如图 2-2 所示窗口。其中的 AUTO 按钮和INTER 按钮分别对应自动调整和手动调整对话框，调整这些对话框中的参数以后，
37、就可以执行阶跃响应过程或正弦波响应过程。通过按键盘上的“PageUp”和“PageDown” 键来选择你要调整的电机。注意，系统执行 PID 调整的过程是首先将所有运行的运动程序和 PLC 程序停止，然后下载自己的一小段程序，让电机转动，采集实时数据，绘制脉冲或正弦波响应曲线，让用户通过响应曲线来判断系统的特性。在调整结束的时候，Pewin32Pro 将下载到 PMAC 上的程序删掉。图 2-2 PID 调整界面下面是关于阶跃响应曲线和相关参数的关系，按照以下原则对参数进行修改和反复调整，一般情况下都可以得到理想的系统特性。图 2-3 阶跃响应曲线图 2-3 是阶跃响应曲线，其中红色（理想方波
38、）为代表位置的指令脉冲信号，兰色（不规则图形）为位置响应曲线。如果响应曲线较命令曲线整体上移或者下移，说明系统有一定的偏置存在，可以调整 IX29 来调整这个偏置。通过以上原则你就可以对 PID 参数进行调整，以求达到最佳效果。在每次调整结束后弹出的响应曲线中，图形旁边会计算显示“ 上升时间”、“ 峰值时间” 、“ 超调率” 、“阻尼比”、“ 系统固有频率” 等，每次调整结束后请仔细查看这些值的大小并做记录。“阻尼比” 调整范围一般在 0.5-0.8 左右为合适。四、注意事项： 1、 理解 PID 控制算法的各参数含义。2、 在进行伺服环调整的时候注意不要一开始就将比例增益加到很大，以免引起机
39、械本体振荡。五、实验内容与步骤：1、 连接好平台和机箱之间的电缆线以及 PMAC 和控制机箱之间的连线。2、 打开机箱和计算机电源。3、 在计算机上运行 Pewin32Pro 执行软件。4、 在 Pewin32Pro 的 Tool 菜单下的点击 Pmac Tuning Pro 菜单，出现 PMAC Tuning对话框。5、 点击 INTER 按钮，在弹出的对话框中输入参数。对上述参数执行阶跃响应，得到位置跟随曲线，按照实验原理所提到的一些指导方针（图 2-3）修改参数，重复执行阶跃响应过程，直到得到的响应曲线让自己满意为止，并将该曲线绘制下来，记录响应曲线旁边的上升时间、峰值时间、自然频率、超
40、调量、阻尼值等相关参数值。填写表 2-3、2-4。注意在调整的过程中感受各参数的实际含义。六、BEN 编码器具有稳定可靠，精度高。JFSH 品牌 BEN 测速编码器，精度高稳定性好，BEN 编码器输出可选：SSI 、4-20MA、RS485，profibus-dp、DEVicenet、并行、二进制码、BiSS 、ISI、CANopen 、Endat 。型号号：BE420SM58-NO11K2R,BE622SM58-N011K2R,BE1822SM58-N011K1R07，BE1322SM58-N011K2RR13,BE122SM58-N011K1R2，BE1622SM58 ， BE322SM58，BEH26M
