插补原理,速度控制

2012.05西南石油大学机电工程学院数控技术2第四章插补原理、刀补原理及速度控制4-1插补原理4-2刀具半径补偿4-3速度及加减速控制3输入预处理插补位置控制电机CNC装置的基本控制流程译码伺服放大机床PLC处理I/O位置反馈4.1.1概述概述4管理CNC装置软件控制译码输入I/O处理显示诊断刀具补偿速度处理插补位置控制本章内容概述5插补原理•1.插补的定义根据给定轨迹方程（直线、圆弧或高次函数）和已知点坐标（起点、终点、圆心坐标）计算中间点坐标的过程。A(10,5)OXYOA(Xe,Ye)M(Xi,Yi)XY“数据点的密化”插补是整个CNC系统控制软件的核心插补对数控机床必须是实时的插补运算速度直接影响到系统的控制速度插补计算精度又影响到整个CNC系统的精度62.实现插补的方法：硬件插补、软件插补、软硬件插补3.插补方法脉冲增量插补法数字增量插补法逐点比较法数字积分法时间分割法（用于开环系统）（用于闭环系统）扩展DDA法插补原理71.逐点比较法基本原理：被控对象按给定轨迹运动时，每走一步（一个脉冲当量）都要与规定的轨迹比较，根据比较的结果（偏差）决定下一步运动方向（朝逼近给定轨迹方向）。特点：运算直观，插补误差最大值，输出脉冲均匀XYO脉冲增量插补8进给方向判别当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逐点比较法插补9当Fi,j0新加工点坐标为:Xi+1=Xi+1,Yi+1=Yi新偏差为:Fi+1,i=XeYi-(Xi+1)Yi=Fi,i-Ye当Fi,j0新加工点坐标为:Xi+1=Xi,Yi+1=Yi+1新偏差为:Fi,i+1=Xe(Yi+1)-XiYe＝Fi,i+Xe终点判别方法：设置减法计数器(XeX，YeY;或Xe+Ye;max(Xe,Ye))，进给一步减1，直至减到0为止偏差判别函数的递推形式设当前切削点M(Xi,Yi)的偏差为F=Fi,i=XeYi-XiYe逐点比较法插补10插补结束插补开始偏差判别坐标进给偏差计算终点判别YN插补步骤逐点比较法插补11逐点比较法直线插补示例逐点比较法插补12Fm≥0Fm＜0线型进给方向偏差计算线型进给方向偏差计算L1,L4+XFm+1=Fm-yeL1,L2+YFm+1=Fm+xeL2,L3-XL3,L4-Y四个象限直线插补计算逐点比较法插补13第一象限直线插补程序框图逐点比较法插补14二、逐点比较法圆弧插补当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逐点比较法圆弧插补15当Fi,i0新加工点坐标为:Xi+1=Xi-1,Yi+1=Yi新偏差为:当Fi,j0新加工点坐标为:Xi+1=Xi,Yi+1=Yi+1新偏差为:终点判别方法：|Xe-X0|+|Ye-Y0|偏差判别函数的递推形式设当前切削点M(Xi,Yi)的偏差为则根据偏差公式222,iiijFXYR222,1,(1)21iiiiiiiFXYRFX222,,1(1)21iiiiiiiFXYRFY逐点比较法圆弧插补16逐点比较法圆弧插补示例246246810Y8B(6,8)逐点比较法圆弧插补17脉冲个数偏差判别进给方向偏差计算坐标计算终点判别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＜N逐点比较法圆弧插补18四象限圆弧插补进给方向偏差大于等于零向圆内进给，偏差小于零向圆外进给逐点比较法圆弧插补19四象限圆弧插补计算表逐点比较法圆弧插补20第一象限逆圆弧插补程序框图逐点比较法圆弧插补21逐点比较法圆弧插补逐点比较法的速度分析式中：L—直线长度；V—刀具进给速度；N—插补循环数；f—插补脉冲的频率。所以：刀具进给速度与插补时钟频率f和与X轴夹角有关fNVLsincosLLYXNeecossinfV22数字积分法又称数字微分分析法DDA(DigitaldifferentialAnalyzer)，是在数字积分器的基础上建立起来的一种插补算法。数字积分法的优点是，易于实现多坐标联动，较容易地实现二次曲线、高次曲线的插补，并具有运算速度快，应用广泛等特点。特点：运算速度快，脉冲分配均匀，易于多坐标联动数字积分法插补23OtYt0t1t2ti-1titnYi-1YiY=f(t)一、数字积分法的工作原理函数在[t0,tn]的定积分，即为函数在该区间的面积：如果从t=0开始，取自变量t的一系列等间隔值为△t，当△t足够小时，可得如果△t=1，即一个脉冲当量δ，则数字积分法插补24函数的积分运算变成了变量的累加运算，如果δ足够小时，则累加求和运算代替积分运算所引入的误差可以不超过所允许的误差。JV：被积函数寄存器JR：累加寄存器(又称余数寄存器)QJ：全加器一般设余数寄存器JR的容量作为一个单位面积值，累加值超过一个单位面积，即产生一个溢出脉冲。△t(JV)+(JR)△S数字积分器的工作原理数字积分法插补积分值=溢出脉冲数+积分余数25二、数字积分法直线插补OXYA(Xe,Ye)VxVyVM积分累加数字积分法直线插补26若取t为一个时间脉冲时间间隔，即t=1,则选择k时应使每次增量△x和△y均小于1，以使在各坐标轴每次分配进给脉冲时不超过一个脉冲（即每次增量只移动一个脉冲当量），即Xe及Ye的最大允许值，受到寄存器容量限制，设寄存器的字长为N，则Xe及Ye的最大允许值为：2N-1数字积分法直线插补27若要满足则若取则由于n为累加次数注：设t=1数字积分法直线插补28实现直线插补的积分器X轴被积函数寄存器（Xe）X轴积分累加器Y轴积分累加器Y轴被积函数寄存器（Ye）tX轴溢出脉冲Y轴溢出脉冲插补控制脉冲被积函数寄存器的函数值本应为xe/2N和ye/2N，但从累加溢出原理来说，存放xe和ye仅相当于小数点左移N位，其插补结果等效。程序框图数字积分法直线插补29数字积分法直线插补插补开始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插补结束NYNYNY30数字积分法直线插补示例设要加工直线OA，起点O（0，0），终点A（5，2）。若被积函数寄存器JV、余数寄存器JR和终点计数器JE的容量均为三位二进制寄存器，则累加次数n＝23＝8，插补前JE、JRx、JRy均清零。数字积分法直线插补31累加次数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数字积分法直线插补运算过程（前五步）数字积分法直线插补32三、数字积分法圆弧插补OXYA(X0,Y0)B(Xe,Ye)M(Xi,Yi)VVxVyXiYiR第一象限逆圆插补图中参数有下述相似关系公式对照则设数字积分法圆弧插补33X轴被积函数寄存器（Yi）X轴积分累加器Y轴积分累加器Y轴被积函数寄存器（Xi）tX轴溢出脉冲Y轴溢出脉冲插补控制脉冲+1-1数字积分圆弧插补框图数字积分法圆弧插补34统计进给脉冲总数判别终点；直线插补圆弧插补统计累加次数判别终点；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。数字积分直线插补与圆弧插补的区别数字积分法圆弧插补35第一象限逆圆弧插补计算举例OXYA(5,0)B(0,5)余数寄存器容量至少3位，故累加至n=2N=8，将有脉冲溢出。终点判别总步数为:|Xe-X0|+|Ye-Y0|=10数字积分法圆弧插补36积分运算积分修正坐标计算终点判别脉冲个数X+JXXY+JYY进给方向X-2nXY-2nYJX+1JXJY-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=05数字积分法圆弧插补37数字积分插补的终点判别直线插补终点判别：不论被积函数有多大，对于n位寄存器，必须累加2n次才能到达终点圆弧插补终点判别：用两个终点判别计数器累计两个坐标的进给脉冲数，也可以用一个终点判别计数器累计两个坐标进给脉冲总数。38硬件数字积分插补的合成进给速度当X，Y坐标分量为小于2n－1的X，Y值时，X坐标方向的平均进给比率为X/2n,Y坐标方向的平均进给比率为Y/2n,其合成的轮廓进给比率为，从而合成的轮廓进给速度为nYX222ngngLfYXfV26026022弧插补时为圆弧半径时为直线段的长度，圆程序段行程，直线插补脉冲源输出脉冲的频率::Lfg39改善插补速度的措施：左移规格化提高插补精度的措施：预加载1/21221min(2)02nnL左移规格化处理的结果使寄存器中的数值变化范围变小，可能的最小数为可能的最大数为由此得到的合成速度的最小值和最大值分别为nnnL22)12()12(2/122max)60(5.022601mingnngffV)60(414.122260maxgnngffV40数据采样插补法（又称为数字增量插补法）基本原理用一系列首尾相连的微小直线段来逼近给定轨迹。这些微小直线段是根据程编进给速度（F指令），将给定轨迹按每个插补周期TS对应的进给量（轮廓步长或进给步长ΔL）来分割的。每个TS内计算出下一个周期各坐标进给位移增量(ΔX,ΔY)，即下一插补点的指令位置；CNC装置按给定采样周期TC（位置控制周期）对各坐标实际位置进行采样，并将其与指令位