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

1、 0 eijeyxyx0 eijeyxyxeeijxyxy 0 eijeyxyxeeijxyxy eijeiyxyxFeeijxyxy 点在直线下方点在直线下方点在直线上方点在直线上方点在直线上点在直线上0000 ijF0 ijF0 ijF1iF1iF eijeyxyx)1( eeijeyyxyxeiyF eijeyxyx)1( eeijexyxyxeixF 0iF0iFeiiyFF1eiixFF11 终终EEjieijeiyxyxFx y 0)()(202202 yyxxji0)()(202202 yyxxji202022yxyxji 0)()(202202 yyxxji202022yxyx

2、ji)()(202202yyxxFjii202022yxyxji 点点在在圆圆弧弧内内点点在在圆圆弧弧外外点点在在圆圆弧弧上上0001iF1iF11 iixx11 jjyyjjyy iixx 0iF0iF0iF 202202) 1(yyxxji12 iixF 202202) 1(yyxxji12jiyF0iF0iF121iiixFF121iiiyFF1 终终EEji11 iixxiiyy111iiyyiixx ）（）（202202yyxxFjiix y 0iF0iF121iiixFF121jiiyFFeiiyFF1eiixFF10iF0iFx y y x F0: 应往应往X轴绝对值增大方向走轴

3、绝对值增大方向走步步;F0: 应往应往Y轴绝对值增大方向走步。轴绝对值增大方向走步。 逐点比较法插补的象限处理应遵循以下逐点比较法插补的象限处理应遵循以下原则：原则： 一、是靠近待加工轨迹。 二、是跟踪待加工轨迹走向。5.3数字积分法数字积分法 数字积分法：数字微分分析器（数字积分法：数字微分分析器（Digital Differential Analyzer，简称，简称DDA）。）。优点：优点：运算速度快、脉冲分配均匀、运算速度快、脉冲分配均匀、易于实现多坐易于实现多坐标联动标联动或多坐标空间曲线的插补。或多坐标空间曲线的插补。求函数求函数y=f（x）对）对x的积分运算，是求函数的积分运算，是

4、求函数曲线与曲线与X轴在积分区间所包围的面积轴在积分区间所包围的面积 F。 yi+1yiy=f (x)Oxn=bXYyixi+1x0=axi求面积求面积F可转化成可转化成 数字运算时，一般取数字运算时，一般取x为为单位单位“1”，即一个脉，即一个脉冲当量，则冲当量，则xyFFniinii101010niiyF函数的积分运算变成了对变量的求和运算函数的积分运算变成了对变量的求和运算起点起点O（0,0），终点），终点A（xe , ye），设进给速度），设进给速度V是均匀的，直线长度是均匀的，直线长度L，则有，则有kyVxVLVeyexeyexkyVkxVXOYVVxVyA(xe、ye)5.3.1

5、DDA法直线插补法直线插补t时间内，时间内，X和和Y方向移动的微小增量方向移动的微小增量x、y ：tkytVytkxtVxeyex动点从原点走向终点，可看作是各坐标每经过一动点从原点走向终点，可看作是各坐标每经过一个个 t 分别以增量分别以增量 kxe、kye 累加的结果。累加的结果。设经过设经过 m 次累加次累加X和和Y方向到达方向到达A（xe , ye），则：），则： tmkytkyytmkxtkxxemieeemiee)()(11取取t1， 则则 eeeemkyymkxxeekyykxxtmkytkyytmkxtkxxemieeemiee)()(11tkytVytkxtVxeyexmk=

6、1km1m 是整数，所以是整数，所以 k为小数。选取为小数。选取 k 时考虑：时考虑：11eekyykxxxe 、ye最大值（寄存器位数最大值（寄存器位数 n）为为2n1，所以，所以一般取一般取 nk21说明：说明：DDADDA直线插补整个过程需要直线插补整个过程需要2 2n n次累加能到达终点。次累加能到达终点。 121nkk（2n1）111eekyykxx，则：，则： m2n思考：当思考：当k=1/2n时，对二进制数来说，时，对二进制数来说， kxe与与xe有何不一样有何不一样? ?只在于小数点的位置不同，将只在于小数点的位置不同，将xe的小数点的小数点左移左移n位即为位即为kxe。 n

7、位内存中存放位内存中存放xe 和和kxe的数字是相同的，认的数字是相同的，认为后者小数点出现在最高位数为后者小数点出现在最高位数 n 的前面。的前面。对对kxe、kye的累加转变为对的累加转变为对xe 与与ye的累加。的累加。 X XY Y平面的平面的DDADDA直线插补器的示意图：直线插补器的示意图：00t Y 轴溢出脉冲轴溢出脉冲X 轴溢出脉冲轴溢出脉冲+ +被积函数寄存器被积函数寄存器 JVY（ye）Y积分累加器积分累加器JRYX积分累加器积分累加器 J RX被积函数寄存器被积函数寄存器 JVX（xe）+ +插补迭代插补迭代控制脉冲控制脉冲 xyyx直线插补直线插补终点判别终点判别：m

8、=2n 为终点判别依据为终点判别依据插插补补第第一一象象限限直直线线流流程程图图YNYNYNMm- 1 Xe XeXeYe YeYe初 始 化xeXe，yeYe，累 加 次 数mM， Xe、Ye清 零M = 0吗 ？Ye有 溢 出 吗 ？Xe有 溢 出 吗 ？+Y向 走 一 步+X向 走 一 步结 束m m2 24 41616。插补计算过插补计算过程见表，轨程见表，轨迹如图示。迹如图示。 A(8,6)插 补 轨 迹理 想 轨 迹8756123456O1234YX例例5-4 直线起点直线起点O（0，0），终点），终点A（8，6），），用四位寄存器，写出直线用四位寄存器，写出直线DDA插补过程并画

9、出插补过程并画出插补轨迹。插补轨迹。插补其他象限直线：插补其他象限直线： 把坐标与脉冲进给方向分开；把坐标与脉冲进给方向分开； 取取终点坐标的绝对值存入被积函数寄终点坐标的绝对值存入被积函数寄存器存器，插补计算公式与插补第一象限直线插补计算公式与插补第一象限直线时一样；时一样； 脉冲进给方向是直线终点坐标绝对值脉冲进给方向是直线终点坐标绝对值增加的方向增加的方向。?VyVxVARYOXP(xi,yj)B(xe,ye)kxVyVRViyjxiyjxkxVkyV5.3.2 DDA法圆弧插补法圆弧插补 （第一象限逆圆弧）（第一象限逆圆弧）刀具沿圆弧切线方向匀速进给，可认为比刀具沿圆弧切线方向匀速进给

10、，可认为比例常数例常数 k 为常数。为常数。在一个单位时间间隔在一个单位时间间隔 t 内，内，x、y为为 ：tkxtVytkytVxiyjx用两个积分用两个积分器实现圆弧器实现圆弧插补，插补，k 的的省略原因和省略原因和直线时类同。直线时类同。 -1-1+1+1 J VY插补迭代控制脉冲插补迭代控制脉冲tY轴溢出脉冲轴溢出脉冲X轴溢出脉冲轴溢出脉冲+ +Y积分累加器积分累加器JRYX积分累加器积分累加器JRXJVX+ +xy(yi)(xi)DDA第一象限逆第一象限逆圆弧插补与直线插补的区别圆弧插补与直线插补的区别：1xi，yj 存入存入JVX、JVY的对应关系与直线不同，恰好位的对应关系与直线

11、不同，恰好位置互调，即置互调，即 yj 存入存入JVX，而，而xi 存入存入JVY 中；中；2直线插补时直线插补时 JVX、JVY寄存的是常数（寄存的是常数（ xe或或 ye）；圆）；圆弧插补时寄存的是变量（动点弧插补时寄存的是变量（动点 xi 或或 yj）。）。起点时起点时JVX、JVY寄存寄存y0、x0；插补时插补时JRY每溢出一个每溢出一个y脉冲，脉冲，JVX加加“1”；反之，；反之，JRX溢出一个溢出一个x脉冲时，脉冲时，JVY减减“1”。减减“1”的原因：刀具作逆圆运动时的原因：刀具作逆圆运动时 x 坐标作负方向进坐标作负方向进给，动点坐标不断减少给，动点坐标不断减少 3 3圆弧插补

12、终点判别用圆弧插补终点判别用2 2个计数器；直线迭代个计数器；直线迭代2 2n n 次次DDADDA法圆弧插补的法圆弧插补的终点判别：终点判别：各轴各设一个终点判别计数器，当各轴终点各轴各设一个终点判别计数器，当各轴终点判别计数器都减为判别计数器都减为 0 时，停止插补。时，停止插补。根据根据JVX、JVY的存数判断是否到达终点，如的存数判断是否到达终点，如果果JVX中存数是中存数是ye、JVY中存数是中存数是xe，则到终点。，则到终点。例例5-5 第一象限逆圆弧，第一象限逆圆弧，起点起点A（5，0），终点），终点B（0，5），用三位寄），用三位寄存器，写出存器，写出DDA插补过插补过程，画出

13、轨迹图。程，画出轨迹图。EX5，EY5，X和和Y积分器有溢出时，积分器有溢出时， EX、EY减减“1”，均为，均为0时结时结束。束。插补计算过程见表，轨插补计算过程见表，轨迹如图。迹如图。A512341 2 3 4 5XOBYA（0，5）B（5，0）n=3EX5，EY5练习：练习：B5123412345XOAY其它象限顺、逆圆插补过程基本与第一象限逆圆其它象限顺、逆圆插补过程基本与第一象限逆圆弧一致，区别是控制弧一致，区别是控制x、y进给方向不同；修进给方向不同；修改改Jvx、Jvy内容是加内容是加“1”还是减还是减“1”，由，由xi和和yj坐坐标值的增减而定。标值的增减而定。A(0,-5)B

14、(5,0)JvxJRyJRxJvyExEy505500555500545005745112+1543512525245625371+1+1514324714463+1+1.练习：练习：进给速度受被加工直线长度和圆弧半径影进给速度受被加工直线长度和圆弧半径影响。（响。（为什么？为什么？）DDA法直线插补，不论法直线插补，不论JVX中存数大小中存数大小( (不不论行程长短论行程长短) )，完成，完成 m2n 次累加到达终次累加到达终点；直线短，进给慢，速度低；直线长，点；直线短，进给慢，速度低；直线长，进给快，速度高。加工短直线生产效率低；进给快，速度高。加工短直线生产效率低；加工长直线零件表面质

15、量差。加工长直线零件表面质量差。1 1进给速度均匀化措施进给速度均匀化措施左移规格化左移规格化5.3.3 提高提高DDA法插补质量的措施法插补质量的措施DDA法是脉冲源每产生一个脉冲，作一次累加计法是脉冲源每产生一个脉冲，作一次累加计算，如果脉冲源频率（算，如果脉冲源频率（插补脉冲频率）插补脉冲频率）为为f，插插补直线的终点坐标为补直线的终点坐标为E（Xe，Ye），则），则X，Y方方向平均进给频率向平均进给频率fx，fy为为fmYffmXfeyexmYffVmXffVeyyexxnyxLfmLfVVV222nRfmRfV2累加次数V与与L或或R成正比成正比插补脉冲频率插补脉冲频率脉冲当量进给速

16、度进给速度为使溢出脉冲均匀，并提高溢出速度，常采用为使溢出脉冲均匀，并提高溢出速度，常采用设置进给速率数设置进给速率数FRN（Feed Rate Number）或）或左移规格化（常用）左移规格化（常用）等措施。等措施。（1 1）设置进给速率数）设置进给速率数FRNFRN G93fRVFRNfLVFRNnn2121通过通过FRN调整调整f，使，使其与其与V V 相协调，消除相协调，消除L与与R 对对V V 的影响。的影响。（2）左移规格化）左移规格化一般规定：寄存器中的数，若最高位为一般规定：寄存器中的数，若最高位为“1”，称为规格化数；最高位为称为规格化数；最高位为“0”，称为非规格，称为非规

17、格化数。化数。对规格化数，累加运算两次必有一次溢出；对规格化数，累加运算两次必有一次溢出；对非规格化数，作两次甚至多次累加运算才对非规格化数，作两次甚至多次累加运算才有溢出。有溢出。1）直线插补的左移规格化）直线插补的左移规格化直线插补时直线插补时，将，将JVX、JVY中非规格化数中非规格化数xe 、ye同时左移，直到同时左移，直到JVX、JVY中中至少至少有一个有一个数是规格化数为止，称为左移规格化。数是规格化数为止，称为左移规格化。每左移一位，数值增大一倍，即乘每左移一位，数值增大一倍，即乘2，kxe或或 kye的的 k改为改为k=1/2n1，所以，所以 m2n1次，减次，减小一半。若左移

18、小一半。若左移s位，则位，则m=? 左移规格化的同时，终点判别计数器中的数左移规格化的同时，终点判别计数器中的数相应从最高位输入相应从最高位输入“1”右移，例：右移，例： 左移前左移前 左移一位左移一位 左移三位左移三位JVX 000011 000110 011000JVY 000101 001010 101000 E 000000 100000 111000m2ns例：第一象限一直线，起点原点，终点例：第一象限一直线，起点原点，终点A（7，5），），寄存器寄存器4位。位。左移规格化前寄存器的数左移规格化前寄存器的数0111及及0101，累加运算，累加运算16次。次。左移规格化后寄存器的数左移

19、规格化后寄存器的数1110及及1010，需累加运算，需累加运算8次。次。XY123455123467764321554321XYOOA（7，5）A（7，5）2）圆弧插补的左移规格化）圆弧插补的左移规格化JVX、JVY中的数，随加工的进行寄存数可能不中的数，随加工的进行寄存数可能不断增加（加断增加（加“1”修正），如取最高位为修正），如取最高位为“1”作规格化数，有可能加作规格化数，有可能加“1”修正后溢出。修正后溢出。圆弧插补的左移规格化圆弧插补的左移规格化使坐标值最大的被积使坐标值最大的被积函数寄存器的函数寄存器的次高位次高位为为1，将，将JVX、JVY寄存器寄存器中中次高位次高位为为“1”

20、的数称为规格化数。的数称为规格化数。规格化数提前一位产生，寄存器的容量规格化数提前一位产生，寄存器的容量2R2R左移左移s位，位，X、Y方向坐标值扩大方向坐标值扩大2s倍，即倍，即JVX、JVY中的数分别为中的数分别为 2syj 及及 2sxi，当，当JRY 有溢出有溢出y时，时，JVX中的数改为中的数改为 2syj 2s（yj1）2syj 2sJVX增加增加 2s，不是加，不是加 1，即，即JVX第第 s1位加位加“l”。同理，若同理，若JRX溢出一个脉冲时，溢出一个脉冲时，JVY减小减小 2s，即，即第第 s1位减位减“l”。 直线插补时，规格化后最大坐标值可能为直线插补时，规格化后最大坐

21、标值可能为111111，每次迭代有溢出；最小值可能为，每次迭代有溢出；最小值可能为100000，每两次迭代有溢出，可见溢出速，每两次迭代有溢出，可见溢出速率相差率相差1 1倍；倍；圆弧插补时，规格化后最大坐标值可能为圆弧插补时，规格化后最大坐标值可能为011111，可能的最小值为，可能的最小值为010000，其溢，其溢出速率也相差一倍。出速率也相差一倍。左移规格化后，不仅提高溢出速度，且使溢左移规格化后，不仅提高溢出速度，且使溢出脉冲较均匀，加工效率和质量大为提高。出脉冲较均匀，加工效率和质量大为提高。2提高插补精度的措施提高插补精度的措施余数寄存器预置数余数寄存器预置数DDA直线插补误差直线

22、插补误差1 1个脉冲当量，但圆弧插个脉冲当量，但圆弧插补误差可能补误差可能1 1个脉冲当量，原因：个脉冲当量，原因：一积分器被积函数寄存器中的值接近零一积分器被积函数寄存器中的值接近零几乎没有溢出，几乎没有溢出，另一积分器被积函数寄存器中的值接近最大另一积分器被积函数寄存器中的值接近最大值（圆弧半径）值（圆弧半径）可能连续溢出可能连续溢出两个积分器的溢出脉冲速率相差很大，致使两个积分器的溢出脉冲速率相差很大，致使插补轨迹偏离理论曲线插补轨迹偏离理论曲线措施：增加积分器位数，从而增加迭代次措施：增加积分器位数，从而增加迭代次数。但进给速度却降低了。数。但进给速度却降低了。常用常用“余数寄存器预置

23、数余数寄存器预置数” 的方法，即：的方法，即：插补前，插补前，JRX、JRY预置某一数值（不是零），预置某一数值（不是零），可以是可以是2n1（111111），称为，称为全加载全加载，可可以以是小于最大容量的某个数，如是小于最大容量的某个数，如2n2 （100000），），称为称为半加载半加载。“半加载半加载”可使直线插补的误差减小到半个可使直线插补的误差减小到半个脉冲当量内。脉冲当量内。例：对直线例：对直线O OA（15，1）进行插补）进行插补未 经 半 加 载 半 加 载 后理 论 曲 线1 6124681 01 21 4XOYA对圆弧插补进行对圆弧插补进行“半加载半加载”、 “全加全加载

24、载”未经未经 半加载半加载 半加载半加载 后后理论曲线理论曲线Y5 51 12 23 34 41 12 23 34 45 5OX全加载被积函数值较被积函数值较小、不能很快小、不能很快产生溢出脉冲产生溢出脉冲时，通过时，通过“全全加载加载”、 “半半加载加载”，使脉，使脉冲提前溢出，冲提前溢出，改变溢出脉冲改变溢出脉冲的时间分布，的时间分布，以减少插补误以减少插补误差。差。为方便，可通过对方程求导数（全微分）将增为方便，可通过对方程求导数（全微分）将增量量x、y、t直接写成微分形式直接写成微分形式dx、dy、dt：标准椭圆标准椭圆方程方程 12222byaxxdtbdyydtadx22双曲线双曲

25、线标准方程标准方程 12222byax抛物线抛物线标准方程标准方程 22axy xdtdydtadx22xdtbdyydtadx225.3.4其它函数的其它函数的DDA插补运算插补运算 设设X和和Y轴位移增量分别为轴位移增量分别为x、y。插补时，。插补时，取增量大的作长轴，增量小的为短轴，要求取增量大的作长轴，增量小的为短轴，要求X和和Y轴的速度保持一定比例，且同时到达终点。轴的速度保持一定比例，且同时到达终点。 5.4.1 直线函数法（弦线法）直线插补直线函数法（弦线法）直线插补 yyyxxxxyxyxLlxiiiiieeiiei11XYE（xe, ye)Pl5.4.2 直线函数法圆弧插补直

26、线函数法圆弧插补 以以内接弦进给代替弧线内接弦进给代替弧线进给，进给，提高了圆弧插补的精度。提高了圆弧插补的精度。 O B (Xi+ 1,Yi+ 1) E A (Xi,Yi) G D Y Y x C M H i+1 i X P CDOCHMDHODDMtgi21sin2cos2lylxtgii采用采用sin45和和cos45来取代来取代sin和和cos近似求近似求解解tg，这样造成的，这样造成的tg的偏差最小，即的偏差最小，即45sin245cos2lylxtgii再由关系式再由关系式 211costg进而求得：进而求得：coslx 为使偏差不造成插补点离开圆弧轨迹，为使偏差不造成插补点离开圆

27、弧轨迹，y的计算的计算不能采用不能采用 lsin，而由下式计算：，而由下式计算：yyxxxyii21)21(的插补点坐标的插补点坐标 ：yyyxxxiiii11采用近似计算引起的偏差能够保证圆弧插补的每一插补采用近似计算引起的偏差能够保证圆弧插补的每一插补点位于圆弧轨迹上，仅造成每次插补轮廓步长点位于圆弧轨迹上，仅造成每次插补轮廓步长 l 的微小的微小变化，所造成的进给速度误差变化，所造成的进给速度误差指令速度的指令速度的1，在加，在加工中是允许的，可认为插补速度仍是均匀的。工中是允许的，可认为插补速度仍是均匀的。 2222yyxxyxiiii在数字积分原理的基础上，将用切线逼近在数字积分原理

28、的基础上，将用切线逼近圆弧的方法改进为圆弧的方法改进为用割线逼近用割线逼近，减小了逼，减小了逼近误差，提高了圆弧插补精度。近误差，提高了圆弧插补精度。5.5 扩展数字积分法（进给速率法）扩展数字积分法（进给速率法）5.5.1 扩展扩展DDA直线插补直线插补5.5 扩展数字积分法（进给速率法）扩展数字积分法（进给速率法）VYXYVVYXXVeeeyeeex2222ededyyxxyyyxxxiiii11eteteeteeetyeteteeteeetxyFRNyyxVVyxyVyxFRNxyxVVyxxVx22222222采样周期5.5.1 扩展扩展DDA圆弧插补圆弧插补5.5 扩展数字积分法（进

29、给速率法）扩展数字积分法（进给速率法） x y2221sin21Rllylxi222121RlRxlylxii5.5 扩展数字积分法（进给速率法）扩展数字积分法（进给速率法）ttdFRNRVididxyx21其中其中ididyxy21同理5.6曲面直接插补曲面直接插补 多数多数CNC系统只有直线、圆弧轨迹控制功能，曲面系统只有直线、圆弧轨迹控制功能，曲面加工时，要将其离散成庞大的微小直线段、由外部加工时，要将其离散成庞大的微小直线段、由外部编程，程序制作、校验时间是加工时间的数倍；编程，程序制作、校验时间是加工时间的数倍；零件程序是外部编制，一经确定无法修改，当加工零件程序是外部编制，一经确定无法修改，当加工余量或刀具尺寸改变时，只有重新编程；余量或刀具尺寸改变时，只有重新编程；CNC内存有限，零件程序不能一次装入，高速加工内存有限，零件程序不能一次装入，高速加工时普通外设（磁盘和普通时普通外设（磁盘和普通DNC）无法工作，需高速）无法工作，需高速DNC或将程序分块后进行加工。或将程序分块后进行加工。国外高档国外高档CNC采用高速多处理器结构和大容