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

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

调整了。在以PMAC为核心控制器的系统中，通过调节它提供的PID+速度/加速度前馈调节器的参数能解决大部分的系统特性问题，这些参数包括比例增益(proportional)、积分增益(integral)、微分增益(differential)(即PID控制)；速度、加速度前馈(feedforward)；摩擦增益等等。典型PID伺服环，如图2所示。■URwor■URwor图2典型PID伺服环Pewin32提供了两种信号源(脉冲和正弦波信号)进行PID调整，脉冲响应过程主要是用来调整系统的P、I、D等参数，而正弦波响应主要是用来调整系统的动态特性。PID调整过程首先将所有运行的运动程序和PLC程序停止，然后下载自己一段小程序，让电机转动，实时采集数据，绘制出脉冲或正弦响应曲线，让用户通过响应曲线来判断系统的特性。PID调整必须在了解各参数的具体作用，并不断的实验，最好是先作脉冲响应调整，主要调整比例、积分、微分增益，在脉冲响应曲线调整最好的状态下，不要更改比例、积分、微分增益，作正弦响应调整，正弦响应调整主要调整速度、加速度前馈和摩擦增益等参数，以下对转台空载的PID进行调整，在经多次调整后我们得出了各参数的最优化设定值。各参数意义及设定值，如表1所示。表1PID调节参数意义及设定值作用设定值比刚瑕益提高系施餉刚性12(X1积分增益消除稱态渓徑8000431微分增益提供足够的狙尼以燥证乖统福宦1432速度前慷裁小由于嶺分增益的引入航引起的跟陆舷100001435拥還嵐前慢議小由于垂统惯性所带来的跟斷误差fXMXX)皿9模拟輸出极限模拟爲输出禺限在该参数下，得出脉冲响应和正弦响应曲线，如图3所示。从图中可以看出，脉冲响应曲线中，命令位置和实际位置基本重合，正弦响应曲线中指令速度曲线和时间速度曲线已经完全重合，速度跟随误差很下，幅值只有±4个脉冲。在该种调试状态下，我们用数控程序运行转台时其跟随误差只有1个脉冲计数，相当在圆周上0.5s角度的误差，其动态响应已经相当快了。图3PID调整曲线3结论对转台的调试过程中，一般会遇到许多的问题，总结起来在调