基于时间分割法与数字积分法混合实现的空间直线插补方法

本发明涉及运动控制中的控制技术,具体涉及运动控制器的基于时间分割法与数字积分法混合实现的空间直线插补方法。
在多轴连续轨迹加工中,在满足位置精度要求的条件下实现平滑的进给速度是运动控制器的重要目标,对于提高加工表面的光洁度有着重要意义。通常的运动控制器是采用基于粗、精二级插补、插补周期固定的时间分割法进行直线插补,其特点是先采用软件计算进行粗插补,将每一段直线划分为长度与期望的进给速度对应的小直线段,然后再采用硬件进行精插补,在固定的插补周期内对小直线段根据固定的累加脉冲时钟采用数字积分法进行各轴进给脉冲的均匀发送。
在加工由大量微小直线段组成的加工代码时,采用上述方法易出现表面存在马赛克、层次分界线明显、光洁度不均匀等影响加工表面光洁度的问题,在排除机床机械误差、刀具磨损等因素之外,其产生的主要原因是没有保持平滑的进给速度,实现各轴进给脉冲序列的均匀发送。这与运动控制器的插补方法有着直接的关系,因为基于粗、精二级差补、插补周期固定的时间分割法虽然具有原理简单、便于控制进给速度等优点,但存在下列缺陷(1)在离散化表示加工代码的情况下插补过程中会出现难以处理的零头距离,导致进给速度的不均匀;(2)通过复杂的加减速控制可以达到消除零头距离,提高进给速度均匀性的目的,但会导致加工效率的降低和频繁的加减速;(3)在直线段对应的各轴进给量相差较大时会由于细分直线段带来插补误差的增大。
本发明所要解决的问题是克服时间分割法插补的不足,消除零头距离,提高进给速度的平滑性,同时提高加工效率,不因细分直线段而增大插补误差。
为解决上述问题,本发明提出一种基于时间分割法和数字积分法混合实现的空间直线插补方法,它是采用时间分割法中的时间分割的原理,对数字积分法中的累加溢出过程按照进给速度的要求采用可控的插补周期进行时间分割。
本发明的技术解决方案如下一种基于时间分割法与数字积分法混合实现的空间直线插补方法,其特征在于,它采用如下步骤进行(1)、先根据直线插补的起点与终点进行插补前初始化,得到空间各轴总的进给量,并按照硬件累加器的宽度进行左移规格化,得到各轴的累加数和总的累加次数;(2)、按照期望的进给速度采用长度可变的插补周期对空间直线进行粗插补根据当前期望的进给速度V,当前期望的进给步长F,默认插补周期T0,插补起点Ps(Xs,Ys,Zs)到终点Pe(Xe,Ye,Ze)的总距离S,当前插补点Pc(Xc,Yc,Zc)到终点Pe(Xe,Ye,Ze)的距离Srem,以及剩余的累加次数Cremaddsum,通过对默认的插补周期进行修正以及对总累加次数进行划分来确定下一个点的插补周期Tc,以及在Tc内的累加次数CaddTc=T0,V=FTc=T0×FV,VF,Cadd=Caddsum×FSrem,FSremCadd=Cremaddsum,F=Srem---(1)]]其中,T0为默认插补周期,(1)式中的速度以T0为时间单位。
根据得到的下一个点的插补周期Tc和在该插补周期内要求完成的累加次数Cadd,得到对应的累加时钟的频率并表示为系统时钟的分频系数Fadd=Fclk_sys(Cadd/Tc)---(2)]]其中,Fclk_sys为系统时钟的频率;
(3)、对(2)式得到的粗插补数据按照预定的分频系数Fadd采用数字积分法的方式进行精插补,实现各轴进给脉冲的均匀发送。
所述的精插补是对系统时钟按照预定的分频系数Fadd进行分频产生累加时钟,然后根据累加时钟在三轴硬件累加器中进行累加溢出进行均匀发送实现三轴脉冲的均匀发送,同时对系统时钟进行计数以实现预定的下一点的插补周期。
有益效果与现有的时间分割法相比,本发明提出的基于时间分割法和数字积分法混合实现的空间直线插补方法的优点和积极效果是(1)本发明提出的基于时间分割法和数字积分法混合实现的空间直线插补方法,可以完全消除零头距离,实现各轴进给脉冲的均匀协调发送;(2)本发明提出的基于时间分割法和数字积分法混合实现的空间直线插补方法,不需要采用复杂的加减速控制来消除零头距离,可以提高加工效率;(3)本发明提出的基于时间分割法和数字积分法混合实现的空间直线插补方法,在直线段对应的各轴进给量相差较大的情况下,不会由于细分直线段带来插补误差的增大。
采用本发明提出的基于时间分割法和数字积分法混合实现的空间直线插补方法进行各种零件的轮廓加工,可以达到速度不均匀系数平均值≤0.5%,插补误差平均值为≤0.00005mm的高性能指标。在三自由度加工制造业具有广阔的应用市场。
图1是空间直线是空间直线的插补点序列示意图;图4是本发明实施例1的速度不均匀系数曲线的插补误差曲线的插补点序列示意图;图7是本发明实施例2的速度不均匀系数曲线的插补误差曲线图;
本发明提出的基于时间分割法和数字积分法混合实现的空间直线插补方法具体计算方法为,如图1所示为空间直线插补示意图,设直线插补的起点为Ps(Xs,Ys,Zs),终点为Pe(Xe,Ye,Ze),当前插补点为Pc(Xc,Yc,Zc)。如图2所示为空间直线插补结构图,包括插补前初始化、粗插补和精插补三个部分,设硬件累加器Xbuf、Ybuf与zbuf的数据宽度均为m位(即累加到大于等于2m时产生一次溢出)。
根据上述数字积分法的原理,每次插补时的累加次数实际与每次插补时的进给步长是成正比的,比例系数为S/Caddsum,那么通过控制每次插补时的累加次数,实际就控制了每次插补时的进给步长。因此进行粗插补时,根据当前期望的进给速度V,当前期望的进给步长F,默认的插补周期T0,插补起点Ps(Xs,Ys,Zs)到终点Pe(Xe,Ye,Ze)的总距离S,当前插补点Pc(Xc,Yc,Zc)到终点Pe(Xe,Ye,Ze)的距离Srem,以及剩余的累加次数Cremaddsum,通过对默认的插补周期进行修正以及对总累加次数进行划分来确定下一个点的插补周期Tc,以及在Tc内的累加次数CaddTc=T0,V=FTc=T0×FV,VF,Cadd=Caddsum×FS,FSremCadd=Cremaddsum,F=Srem---(1)]]其中,T0为默认的插补周期,(1)式中的速度以T0为时间单位。
由(1)式可见,在当前期望的进给步长F等于当前期望的进给速度V时,下一个点的插补周期Tc则为默认的插补周期T0;当前期望的进给步长F大于或小于当前期望的进给速度V时,下一个点的插补周期Tc则会在默认的插补周期T0的基础上相应地延长或缩短,从而确保了实际进给速度的平滑,通过根据期望进给步长占总步长的比例对应地划分累加次数,可以准确地实现期望的进给步长。
由下一个点的插补周期Tc和在Tc内的累加次数Cadd就可以计算得到累加时钟的频率,由于在硬件累加发送模块中通过对系统时钟进行分频可以得到近似的满足频率要求的累加时钟信号,因此累加时钟的频率可以用对系统时钟的分频系数来表示Fadd=Fclk_sys(Cadd/Tc)---(2)]]
得到了下一个插补周期内的累加次数Cadd和累加时钟的分频系数Fadd,可以在硬件中根据由系统时钟分频生成的累加时钟信号进行累加溢出实现精插补,在期望的插补周期内实时完成累加溢出任务,实现期望的进给速度和进给步长。
这样,在存在零头距离,即当前期望的进给速度V大于当前期望的进给步长F时,可以根据(1)式通过缩短下一个点的插补周期Tc来实现脉冲的均匀发送。在直线总距离S小于当前期望的进给速度V时,则可以通过令当前期望的进给步长F等于S,然后根据(1)式通过缩短下一个点的插补周期Tc来实现脉冲的均匀发送。这样就解决了在时间分割法中存在的零头距离以及由于零头距离带来的进给速度不平滑和加工效率低的问题。
对于在直线插补中各轴进给量相差大并且需要多次插补完成的情况下,本方法不需要改变每次插补时各轴累加器的累加数,只需要按照期望进给速度计算当前插补对应的累加次数与累加脉冲频率,从而消除了常规时间分割法中每次细分直线段时会改变各轴累加器的累加数会带来插补误差扩大的问题。
本发明可应用于运动控制器的插补器部分使用。使用本发明进行了大量空间直线的插补处理,实际工作结果表明,插补过程与结果正确可靠。以下给出几个具体的插补实例例1设空间直线.555,-9.214,-1.692),期望进给速度为3000mm/min,默认插补周期为1ms,对应的零头距离则为0.042mm。采用本发明得到的结果为直线,速度不均匀系数平均值为0.5%,插补误差平均值为0.00003mm。
例2设空间直线,-2.247,-5.016),期望进给速度为3000mm/min,默认插补周期为1ms,对应的零头距离则为0.036mm。采用本发明得到的结果为直线,速度不均匀系数平均值为0.5%,插补误差平均值为0.00004mm。
1.一种基于时间分割法与数字积分法混合实现的空间直线插补方法,其特征在于,它采用如下步骤进行(1)、先根据直线插补的起点与终点进行插补前初始化,得到空间各轴总的进给量,并按照硬件累加器的宽度进行左移规格化,得到各轴的累加数和总的累加次数;(2)、按照期望的进给速度采用长度可变的插补周期对空间直线进行粗插补根据当前期望的进给速度V,当前期望的进给步长F,默认的插补周期T0,插补起点PS(XS,YS,ZS)到终点Pe(Xe,Ye,Ze)的总距离S,当前插补点Pc(Xc,Yc,Zc)到终点Pe(Xe,Ye,Ze)的距离Srem,以及剩余的累加次数Cremaddsum,通过对默认的插补周期进行修正以及对总累加次数进行划分来确定下一个点的插补周期Tc,以及在Tc内的累加次数Cadd{Tc=T0×FV,VFTc=T0,V=F,{Cadd=Cremaddsum,F=SremCadd=Caddsum×FS,FSrem---(1)]]其中,T0为默认的插补周期,(1)式中的速度以T0为时间单位;根据得到的下一个点的插补周期Tc和在该插补周期内要求完成的累加次数Cadd,得到对应的累加时钟的频率并表示为系统时钟的分频系数Fadd=Fclk_sys(Cadd/Tc)---(2)]]其中,Fclk_sys为系统时钟的频率;(3)、对(2)式得到的粗插补数据按照预定的分频系数Fadd采用数字积分法的方式进行精插补,实现各轴进给脉冲的均匀发送。
2.根据权利要求1所述的,其特征在于精插补是对系统时钟按照预定的分频系数Fadd进行分频产生累加时钟,然后根据累加时钟在三轴硬件累加器中进行累加溢出进行均匀发送实现三轴脉冲的均匀发送,同时对系统时钟进行计数以实现预定的下一个点的插补周期。
基于时间分割法与数字积分法混合实现的空间直线插补方法,涉及运动控制空间直线插补中的控制技术。其特点是在时间分割法与数字积分法的基础上,采用可控的插补周期按照累加脉冲次数对空间直线进行粗插补,然后对得到的粗插补数据按照预定的分频系数采用数字积分法的方式进行精插补。
针对现有液晶玻璃点胶装置定位不精准、依赖人工操作导致效率低的问题,提出一种自动化点胶结构。通过激光定位器实时检测玻璃位置,配合可移动储胶盒与滑轨系统,实现胶水精准均匀点涂,替代人工调整,提升加...
针对工业机器人插补算法精度低、多轴联动协调难的问题,提出一种主从随动的高精度控制方法。通过选择位移最长轴为主轴,结合逐点比较法与最小偏差法,实现主轴速度规划与从轴函数关系随动,简化联动控制,提...
发现传统数控插补方法难以高效处理任意空间平面圆锥曲线,存在误差大、通用性差的问题。提出一种基于统一常系数微分方程的通用插补算法,结合参考点校正技术,实现任意起终点、任意空间平面圆锥曲线的高精度...
针对传统打磨轨迹使用直线和圆弧拟合导致精度低、加速度突变的问题,提出基于B样条的轨迹生成方法。通过建立CAD模型提取关键路径点,利用B样条插值生成具有连续一阶和二阶导数的曲线,确保运动平稳性与...
针对传统数控加工中刀具路径规划无法自适应曲面曲率变化、导致加工效率与精度不足的问题,提出一种等弓高误差变步长切线插补方法。通过动态调整加工步长,使各逼近直线段的弓高误差均匀一致,实现加工步长在...
针对传统多轴插补算法复杂、成本高、效率低的问题,提出基于ARM/DSP微处理器的插补装置。通过脉冲发生器与并联脉冲输出电路结合,利用计数器和或门电路实现多轴脉冲信号的高效生成,将插补周期缩短至...
针对工业机器人多轴插补算法复杂、效率低、成本高的问题,提出基于ARM/DSP芯片的硬件实现方案。通过计数器、脉冲发生器与或门协同控制,结合加减速处理和周期优化,将插补周期缩短至125μs/25...
针对传统数控系统仅支持二维圆弧插补的局限性,提出一种高精度快速空间圆弧插补方法。通过定义包含法矢信息的代码格式,结合几何参数计算与进给速度规划,实现任意空间平面内圆弧的高精度插补,减少代码量并...
针对传统数控机床加工薄壁曲面时弓高误差大、加工精度低、效率差等问题,提出一种新型CNC插补装置。通过Θ轴、Φ轴、P轴三轴联动控制,结合弧形刀架导向轨道、蜗杆传动和滚珠丝杠补偿结构,实现刀具回转...
1.振动信号时频分析理论与测试系统设计 2.汽车检测系统设计 3.汽车电子控制系统设计