PMAC控制下的高精度转台双闭环伺服系统调试

PMAC控制下的高精度转台双闭环伺服系统调试DebuggingofhighprecisionrevolvingtabledualcloseloopservosystemcontrolledbyPMACCHENDong-sheng（InstiuteofMechanicalManufacturingTechnologyofCAEP，Mianyang621900，China）【摘要】简要概述了PMAC的特点，介绍了PMAC控制下转台伺服系统的设计，重点对系统调试过程中遇到的问题进行了讨论，主要有转台单方向漂移、转台闭环后来回漂移、PID调节等。关键词：PMAC；转台；伺服系统；调试【Abstract】ItsummarizesthecharacteristicofPMAC，introducesthedesignofrevolvingtableservosystemcontrolledbyPMAC，discussessomequestionsaboutsystemdebuggingemphatically，includingsin－gledirectionexcursionofrevolvingtable、excursionbackandforthaftercloseloop、PIDadjustingandsoon.Keywords：PMAC；Revolvingtable；Servosystem；Debugging图分类号：TH16，TM571文献标识码：APMAC是一个开放式的运动控制器，它有多种型号，系统使用的是TURBOPMACⅡ型卡，该卡在国内的使用不多。用PMAC控制转台闭环伺服系统，从理论上来讲，伺服环内各元件误差以及运动中造成的误差都可以得到补偿，因而可以达到很高的跟随精度和定位精度，但由于受机械变形、温度变化、振动及其它因素的影响，要实现高精度、良好的稳定性和快速的动态响应特性，闭环系统的调试有一定的难度。就PMAC控制的转台闭环系统进行调试过程中遇到的几个问题进行分析，并提出解决办法，以供大家借鉴。1伺服系统的设计1.1PMAC概述美国DeltaTau公司的可编程多轴运动器（PMAC）是世界上功能强大的运动控制器之一，它借助于Motorola的DSP56001/56002数字信号处理器，可以同时操纵1～8个轴。而且它还可以自动对任务进行优先等级判别，从而进行实时的多任务处理，这使得它在处理时间和任务切换这方面大大减轻主机和编程器的负担，提高了整个控制系统的运行速度和控制精度。PMAC具有开放平台，不仅可以用G代码，而且可以用C或BASIC语言编程，它能够对存储在它内部的程序进行单独的运算，执行运动程序、PLC程序，并可进行伺服环更新，并以串口、总线两种方式与主计算机进行通讯。1.2转台控制系统设计该控制系统由PC（上位机）、PMAC控制器（下位机）、Dy－naserv驱动器、PARK的高精度旋转工作台、测量与反馈系统组成。其控制原理，如图1所示。PARK的高精度旋转工作台与一般工作台不同，它的电机是无刷直接驱动电机，回转工作台的台面是电机的转子，没有了传动机构，这样就减少了传动误差。该系统是一个双闭环系统，由于该系统中执行机构采用的是直接驱动电机，其双闭环系统不同于通常的双闭环，其速度环和位置环共用圆光栅位置反馈信号，内环是速度环，外环是位置环。速度环由速度控制单元、F/V转换、速度反馈电路组成，它可以实现速度恒值控制。位置环由PMAC中位置控制模块、速度控制单元、位置检测及位置反馈电路组成。由于没有了传动机构，因此安装在转子上的圆光栅所反馈的值既反映了转台的实际位置，又反映了电机的输出，速度环中该值通过F/V转换成速度量，F/V转换是通过计数的频率来转换成模拟电压（一般是以25kHZ/V的速率转换）。反馈信号是增量式A/B相正交脉冲信号。控制转台的是PMACⅡ型卡，系统中的圆盘光栅尺精度高，可达655360线/转，当PMAC四倍频后，其分辨率可达到2621440脉冲数/转。2系统调试对双闭环系统的调试，不但要对控制卡进行参数设置，而且要对驱动器进行参数设置，系统调试中会遇到很多问题，本节只就其中几个问题进行分析讨论。2.1转台单方向漂移的问题在完成系统连接后，我们用PMAC的调试软件Pewin32进行调试，上电后，转台开始出现单方向漂移的现象：转台沿顺时针方向以很小的速度移动。在设置了常用的PMAC参数后，单方向漂移问题仍然存在。为解决这个问题，我们对有可能的原因一一分析。首先我们怀疑是硬件系统连接引起的，在核对控制线路图、重新检查硬件连线后该现象仍然存在。然后我们怀疑是驱动器的设置有问题，由于在出厂前其驱动器dynaserv可能设置了一些参数，为此，我们用park自带的调试软件DRVGⅡ进行调试，上电后，转台没有出现单方向漂移的现象。由此可以推断出不是驱动器参数设置的问题，而确定为PMAC与转台之间的匹配或PMAC参数设置的问题。经仔细查找，发现编码器I变量I7mn6（转台轴对于伺服卡号m为2，通道数n为4，即为I7246）的设置有可能不正确，I7mn6是控制TURBOPMACⅡ型卡中编码器接口通道n的命令输出信号线的输出模式，该变量的值可取（0～3），默认值是0，表示第n通道编码器信号A、B和C是三相直流PWM（脉宽调制）格式输出。而该系统的编码最后还是回到PMAC控制上来考虑，PMAC与转台之间的匹配没有设置正确。经过认真的分析排除，最后得出有可能是伺服IC的I变量设置不正确，I7mn0，它是控制在TURBOPMACⅡ型卡中伺服IC号为m，通道数为n上的编码器输入信号如何译码成脉冲数。转台对应的是变量是I7240：伺服IC2、4通道编码器译码，其值可取0～15，默认设置是7，指四倍频反时针译码。在正交译码模式中，PMAC希望在CHA和CHB有两路波形输入，每一路能有大约50％的占空比，且彼此之间有大约四分之一周期的相差，四倍频译码使每一个周期提供四个脉冲数，我们一直认为设置为7没有错，因为需要四倍频译码后获得最大的分辨率。PMACⅡ型卡提供了编码器译码方式可以是内部脉冲＋方向，其译码器输出的脉冲＋方向信号是由n通道中的脉冲频率调节器（PFM）输出电路产生的。它可以产生一个假想的闭环来驱动开环步进系统。我们分析如果将转台的编码器译码方式设置为内部脉冲＋方向，其译码输出由内部脉冲频率调节器（PFM）输出电路产生，这样可以避免一些PMAC与驱动器间的不匹配。在将I7240设置为8（内部脉冲＋方向）后，我们将转台闭环后，来回漂动现象消除了，用“j＝10000”运行（手动走到绝对位置为10000counts处）后编码器反馈显示为10000counts，没有了抖动，并且在设置为内部脉冲＋方向后，根据运行结果看，其编码器反馈进入PMAC后也进行了四倍频，分辨率达到2621440脉冲数/转。到此，该故障得以排除。2.2闭环后转台漂移问题在Pewin32中让转台闭环手动运行，用“j/”结束运行后，转台不能完全停止，而是沿着某个位置来回的漂动，通过编码器反馈显示，其漂动值在±100个脉冲左右。执行“HM”命令使转台回零，回零运动也不能完成，出现同样的现象。将手放在转台上能够感知到转台在左右抖动。在开环运行时没有这种情况出现。根据以上的现象，排除系统连接引起的故障，初步得出是转台闭环系反馈引起的漂移。由于我们的调试环境不是很好，首先我们想到的是电磁干扰引起编码器的读数不准确，从而使得伺服系统驱动转台一直在目标位置左右来回移动。但我们在没有给电机使能时，通过Pewin32观察编码器反馈显示，其值稳定，如果电磁干扰能引起编码器的输出不确定，则电机没有使能时，编码器反馈显示应不稳定，故排除了环境影响引起故障。在寻求技术支持时，产品供方提出有可能是驱动器内硬件滤波器引起。但经分析，因为滤波器应该是必须的，觉得硬件滤波器引起的可能性不大。2.3PID调节在系统中，为了获得良好的稳态特性和动态特性，需要对系统的控制环进行校正和调整，所以当系统的基本特性（包括机械传动、电机选型等）确立后，就需要对系统的控制环进行调整了。在以PMAC为核心控制器的系统中，通过调节它提供的PID＋速度/加速度前馈调节器的参数能解决大部分的系统特性问题，这些参数包括比例增益（proportional）、积分增益（integral）、微分增益（differential）（即PID控制）；速度、加速度前馈（feedforward）；摩擦增益等等。