第五章数控装置的轨迹控制原理.

1第五章数控装置的轨迹控制原理5.1脉冲增量插补5.2数据采样插补5.3数控装置的进给速度控制2CNC装置的基本控制流程输入预处理插补位置控制电机译码伺服放大机床PLC处理I/O位置反馈概述3管理CNC装置软件控制译码输入I/O处理显示诊断刀具补偿速度处理插补位置控制本章内容4•1.插补的定义根据给定轨迹方程（直线、圆弧或高次函数）和已知点坐标（起点、终点、圆心坐标）计算中间点坐标的过程。A(10,5)OXYOA(Xe,Ye)M(Xi,Yi)XY“数据点的密化”插补是整个CNC系统控制软件的核心插补对数控机床必须是实时的插补运算速度直接影响到系统的控制速度插补计算精度又影响到整个CNC系统的精度52.实现插补的方法：硬件插补、软件插补、软硬件插补3.插补方法脉冲增量插补法数字采样插补法逐点比较法数字积分法时间分割法（用于开环系统）（用于闭环系统）扩展DDA法61.逐点比较法基本原理：被控对象按给定轨迹运动时，每走一步（一个脉冲当量）都要与规定的轨迹比较，根据比较的结果（偏差）决定下一步运动方向（朝逼近给定轨迹方向）。特点：运算直观，插补误差最大值，输出脉冲均匀XYO5.1脉冲增量插补7进给方向判别当F0，则沿+X方向进给一步当F0，则沿+Y方向进给一步。ieieYYXXeiieFXYXY0OA(Xe,Ye)M(Xi,Yi)XYF0F0F=0···一、逐点比较法直线插补偏差判别函数当M在OA上，即F=0当M在OA上方，即F0时；当M在OA下方，即F0eiieFXYXY0eiieYYXXieieFXYXY0ieieYYXX8当Fi0新加工点坐标为:Xi+1=Xi+1,Yi+1=Yi新偏差为:Fi+1=XeYi-(Xi+1)Ye=Fi-Ye当Fi0新加工点坐标为:Xi+1=Xi,Yi+1=Yi+1新偏差为:Fi+1=Xe(Yi+1)-XiYe＝Fi+Xe终点判别方法：设置减法计数器(XeX，YeY;或Xe+Ye;max(Xe,Ye))，进给一步减1，直至减到0为止偏差判别函数的递推形式设当前切削点M(Xi,Yi)的偏差为F=Fi,Fi=XeYi-XiYe9插补结束插补开始偏差判别坐标进给偏差计算终点判别YN插补步骤10逐点比较法直线插补示例11Fm≥0Fm＜0线型进给方向偏差计算线型进给方向偏差计算L1,L4+XFm+1=Fm-yeL1,L2+YFm+1=Fm+xeL2,L3-XL3,L4-Y四个象限直线插补计算12第一象限直线插补程序框图13二、逐点比较法圆弧插补当M(Xi,Yi)在圆弧上，则F=0；当M(Xi,Yi)在圆弧外，则F0；当M(Xi,Yi)在圆弧内，则F0；进给方向判别当F0，则沿-X方向进给一步当F0，则沿+Y方向进给一步YOXA(X0,Y0)RRiM(Xi,Yi)B(Xe,Ye)F0F0F=0偏差判别式222,iiiiFXYR14当Fi0新加工点坐标为:Xi+1=Xi-1,Yi+1=Yi新偏差为:当Fi0新加工点坐标为:Xi+1=Xi,Yi+1=Yi+1新偏差为:终点判别方法：|Xe-X0|+|Ye-Y0|偏差判别函数的递推形式设当前切削点M(Xi,Yi)的偏差为则根据偏差公式222,iiijFXYR12)1(12221iiiiiiXFFRYXF12)1(12221iiiiiiYFFRYXF15逐点比较法圆弧插补示例246246810Y8B(6,8)16脉冲个数偏差判别进给方向偏差计算坐标计算终点判别0F0=0X0=XA=10Y0=YA=0n=0；N=121F0=0-XF1=F0–2X0+1=0-2×10+1=-19X1=X0-1=9Y1=Y0=0n=1＜N2F1=-19＜0+YF2=F1+2Y1+1=-19+2×0+1=-18X2=X1=9Y2=Y1+1=1n=2＜N3F2=-18＜0+YF3=F2+2Y2+1=-18+2×1+1=-15X3=X2=9Y3=Y2+1=2n=3＜N4F3=-15＜0+YF4=F3+2Y3+1=-15+2×2+1=-10X4=X3=9Y4=Y3+1=3n=4＜N5F4=-10＜0+YF5=F4+2Y4+1=-10+2×3+1=-3X5=X4=9Y5=Y4+1=4n=5＜N17四象限圆弧插补进给方向偏差大于等于零向圆内进给，偏差小于零向圆外进给18四象限圆弧插补计算表19第一象限逆圆弧插补程序框图20数字积分法又称数字微分分析法DDA(DigitaldifferentialAnalyzer)，是在数字积分器的基础上建立起来的一种插补算法。数字积分法的优点是，易于实现多坐标联动，较容易地实现二次曲线、高次曲线的插补，并具有运算速度快，应用广泛等特点。特点：运算速度快，脉冲分配均匀，易于多坐标联动21OtYt0t1t2ti-1titnYi-1YiY=f(t)一、数字积分法的工作原理函数在[t0,tn]的定积分，即为函数在该区间的面积：如果从t=0开始，取自变量t的一系列等间隔值为△t，当△t足够小时，可得如果△t=1，即一个脉冲当量δ，则22函数的积分运算变成了变量的累加运算，如果δ足够小时，则累加求和运算代替积分运算所引入的误差可以不超过所允许的误差。JV：被积函数寄存器JR：累加寄存器(又称余数寄存器)QJ：全加器一般设余数寄存器JR的容量作为一个单位面积值，累加值超过一个单位面积，即产生一个溢出脉冲。△t(JV)+(JR)△S数字积分器的工作原理积分值=溢出脉冲数+积分余数23二、数字积分法直线插补OXYA(Xe,Ye)VxVyVM积分累加24若取t为一个时间脉冲时间间隔，即t=1,则选择k时应使每次增量△x和△y均小于1，以使在各坐标轴每次分配进给脉冲时不超过一个脉冲（即每次增量只移动一个脉冲当量），即Xe及Ye的最大允许值，受到寄存器容量限制，设寄存器的字长为N，则Xe及Ye的最大允许值为：2N-125若要满足则若取则由于n为累加次数注：设t=126实现直线插补的积分器X轴被积函数寄存器（Xe）X轴积分累加器Y轴积分累加器Y轴被积函数寄存器（Ye）tX轴溢出脉冲Y轴溢出脉冲插补控制脉冲被积函数寄存器的函数值本应为xe/2N和ye/2N，但从累加溢出原理来说，存放xe和ye仅相当于小数点左移N位，其插补结果等效。程序框图27插补开始m0JXXe,X0JYYe,Y0XX+JXX/2N1X方向进给XX-2NYY+JYY/2N1Y方向进给YY-2Nmm+1m=2N插补结束NYNYNY28数字积分法直线插补示例设要加工直线OA，起点O（0，0），终点A（5，2）。若被积函数寄存器JV、余数寄存器JR和终点计数器JE的容量均为三位二进制寄存器，则累加次数n＝23＝8，插补前JE、JRx、JRy均清零。29累加次数X积分器Y积分器终点计数器JRx+JVx溢出△xJRy+JVy溢出△yJe10+101=10100+010=01000002101+101=0101010+010=10000013010+101=1110100+010=11000014111+101=1001110+010=00010115100+101=00110+010=0100100数字积分法直线插补运算过程（前五步）30三、数字积分法圆弧插补OXYA(X0,Y0)B(Xe,Ye)M(Xi,Yi)VVxVyXiYiR第一象限逆圆插补图中参数有下述相似关系则设31X轴被积函数寄存器（Yi）X轴积分累加器Y轴积分累加器Y轴被积函数寄存器（Xi）tX轴溢出脉冲Y轴溢出脉冲插补控制脉冲+1-1数字积分圆弧插补框图32统计进给脉冲总数判别终点；直线插补圆弧插补统计累加次数判别终点；X、Y方向插补时分别对Xe,Ye累加；X、Y方向插补时分别对Yi和Xi累加；X、Y方向进给（发进给脉冲）后，被积函数寄存器Jx、Jy内容(Xe,Ye)不变；X、Y方向进给（发进给脉冲）后，被积函数寄存器Jx、Jy内容(Yi,Xi)必须修正，即当X方向发脉冲时，Y轴被积函数寄存器Jy内容(Xi)减1（∵NR1）,当Y方向发脉冲时，X轴被积函数寄存器Jx内容(Yi)加1。数字积分直线插补与圆弧插补的区别33第一象限逆圆弧插补计算举例OXYA(5,0)B(0,5)余数寄存器容量至少3位，故累加至n=2N=8，将有脉冲溢出。终点判别总步数为:|Xe-X0|+|Ye-Y0|=1034脉冲个数累加器进给方向积分修正寄存器终点判别X+JXXY+JYYX-2nXY-2nYJY+1JXJX-1JYNXNY0000510+0=00+5=520+0=05+5=10+Y10-8=20+1=15130+1=12+5=741+1=27+5=12+Y12-8=41+1=25252+2=44+5=9+Y9-8=12+1=35364+3=71+5=677+3=106+5=11-X,+Y10-8=211-8=33+1=45-1=41482+4=63+4=796+4=107+4=11-X,+Y10-8=211-8=34+1=54-1=325102+5=7117+5=12-X12-8=453-1=23124+5=9-X9-8=152-1=14131+5=6146+5=11-X11-8=351-1=0535数字积分插补的终点判别直线插补终点判别：不论被积函数有多大，对于n位寄存器，必须累加2N次才能到达终点圆弧插补终点判别：用两个终点判别计数器累计两个坐标的进给脉冲数，也可以用一个终点判别计数器累计两个坐标进给脉冲总数。36数据采样插补法（又称为数字增量插补法）基本原理用一系列首尾相连的微小直线段来逼近给定轨迹。这些微小直线段是根据程编进给速度（F指令），将给定轨迹按每个插补周期TS对应的进给量（轮廓步长或进给步长ΔL）来分割的。每个TS内计算出下一个周期各坐标进给位移增量(ΔX,ΔY)，即下一插补点的指令位置；CNC装置按给定采样周期TC（位置控制周期）对各坐标实际位置进行采样，并将其与指令位置比较，得出位置跟随误差，由此对伺服系统进行控制。伺服电机工作台速度控制单元传动机构位置控制检测反馈插补器5.2数据采样插补法37常用时间分割插补算法——把加工一段直线或圆弧的整段时间分为许多相等的时间间隔，该时间间隔T称为单位时间间隔，也即插补周期。插补周期T内的合成进给量f称为一次插补进给量。若进给速度v的单位取mm/min，插补周期T的单位取ms，插补进给量的单位取μm，则一次插补进给量：例：ＦＡＮＵＣ７Ｍ系统设F为程序编制中给定的速度指令（单位为mm/min)；插补周期T为８ｍｓ；f为一个插补周期的进给量(单位为μm);则100082()60100015FFfm1000601000vTf38时间分割插补算法要解决的关键问题插补周期T的选择插补周期内各坐标轴进给量的计算插补周期T的选择1、插补周期T与插补运算时间的关系插补周期T必须大于插补运算时间与完成其它实时任务（插补及位置误差计算、显示、监控、I/O处理）所需时间之和2、插补周期T与位置反馈采样的关系插补周期T与位置反馈采样周期可以相同，也可以不同。如果不同，则一般插补周期应是采样周期的整数倍。393、插补周期与精度、速度的关系在直线插补中，插补所形成的每个直线段与给定的直线重合，不会造成轨迹误差。在圆弧插补时，一般用内接弦线或内外均差弦线来逼近圆弧，这种逼近必然会造成轨迹误差。最大半径误差eR与步距角δ的关系eR=R(1-cos(δ/2)）最大径向误差：eR=(FT)2/8R当给定R、f和eR，则应有T=(8ReR)1/2/FfYOReRR40插补周期内各坐标轴进给量的计算设给定直线OA，动点Mi-1(Xi-1,Yi-1)，程编进给速度F，插补周期T，插补进给量f（进给步长）f＝FT由图可得如下关系：Xi-1A(Xe,Ye)OXiYi-1YiMi-