专利名称：一种基于前瞻-滤波技术的多程序段连续加减速控制方法
技术领域：
本发明涉及一种高速数控系统控制技术，具体的说是一种基于前瞻-滤波技术的多程序段连续加减速控制方法。
背景技术：
高速高精是数控系统当前的发展趋势，加减速控制是高速数控系统的核心技术之 一。常用的加减速控制方法有直线加减速(速度连续)、S形曲线加减速(加速度连续)以 及加速度平滑加减速(加加速连续)等。其中，直线加减速控制方法因其计算量小，编程简 单而得到广泛使用，但是由于其在加减速阶段存在加速度突变现象，导致机床产生振动，不 适合用于数控机床的高速高精加工。S形曲线加减速方法，加速度连续但加加速不连续，依 然存在轻微的机床振动。加速度平滑加减速方法，加加速连续，解决了加工中的机床振动问 题，满足高速高精加工的要求。S形曲线加减速和加速度平滑加减速虽然可以解决机床振动 问题，但计算量巨大，编程复杂，对CPU性能要求高。目前，国内的S形曲线或加速度平滑加减速控制方法都是局限于单程序段规划， 并未实现多程序段连续规划，在中国发明专利《一种基于滤波技术的数控系统加减速控制 方法》(专利号ZL200610155810. X)中，提出运用直线加减速和滤波技术结合的规划方法， 并证明此方法可以得到和S形曲线或加速度平滑加减速相同的效果。然而，该专利也只局 限于单程序段规划，并未实现多程序段连续规划。前瞻技术是数控系统的关键技术之一。其目的主要是为了实现多程序段连续加 工，以实现高速加工的目标。此技术特点在于通过适当地确定加减速规划方案，并综合考虑 多方因素来确定程序段转接点的非零速度值等运动控制参数，结合实时插补时的速度控制 方法，便可以在程序段连接处实现连续加工。若将前瞻技术和滤波技术相结合，可在达到高 速加工目标的同时，使加工过程更加平滑，工件加工效果更好。具有将前瞻技术、滤波技术 以及改进的直线加减速方法相结合的多程序段连续加减速控制技术尚未见报道。
发明内容
针对现有技术中运用直线加减速和滤波技术结合的规划方法只局限于单程序段 规划的不足之处，本发明要解决的技术问题是提供一种简单、光滑、平稳、高速、连续的基于 前瞻_滤波技术的多程序段连续加减速控制方法。为解决上述技术问题，本发明采用的技术方案是本发明一种基于前瞻_滤波技术的多程序段连续加减速控制方法包括以下步骤根据输入的工件加工程序数据进行前瞻规划，确定各程序段的前瞻规划参数；利 用上述各程序段的规划参数进行相应的直线加减速规划，并对速度值进行插补；对各段插 补后的速度值进行分段滑动平均滤波，得到新的速度值。所述对输入工件加工程序数据进行前瞻规划计算包括以下步骤根据工件加工程序数据，按照转接点算法确定各程序段间的转接点速度；按照规划参数求解算法完成对各程序段规划参数的确定，其中规划参数包括最大速度、直线加减 速加速段和减速段的加速度以及滤波项数；按照位移补偿算法确定直线加减速规划时的新位移。所述转接点算法为初始化程序标号为0 ；当当前程序段末端初始速度Vp大于当前程序段始端速度Vs时，直接判断当前实际 位移L是否大于第1阈值Stl，否则将当前程序段末端初始速度Vp的值与当前程序段始端速 度Vs的值互换，并将程序标号赋值为1，再判断当前实际位移L是否大于第1阈值Stl;如果实际位移L大于第1阈值Stl时，则根据公式⑵求得加速过程中的勻加速段 插补周期T的个数，即为中间变量k
-b + ^b2-IamaxT2(S0-L) k=-- ⑵
max丄式中，b为中间变量4 = VsT + 3ma^2 , m为初始滤波项数，afflax为最大加速度；再根据公式(3)求得最大可达末端速度V' p ；V' ρ = Vs+(m+k) Tafflax(3)判断程序标号是否为1，如为1则将当前程序段末端初始速度Vp与当前程序段始 端速度Vs互换；当当前程序段始端速度Vs大于最大可达转接点速度V' p时，调整当前程序段始 端速度Vs的值为最大可达转接点速度V' p，转接点的初始速度Vp不需调整，端点速度确定 完毕；如果当前程序段始端速度Vs不大于最大可达转接点速度V' p，则转接点的初始速 度Vp不需调整，端点速度确定完毕；或者，如果程序标号不为1，则当转接点的初始速度Vp大于最大可达转接点速度V' p时，调整转接点的初始速 度Vp等于最大可达转接点速度V' p，端点速度确定完毕；当转接点的初始速度Vp不大于最大可达转接点速度V' p时，转接点的初始速度 Vp不需调整，端点速度确定完毕；或者，当实际位移L不大于第1阈值Stl时，利用公式(4)求得加加速阶段插补周 期个数，即为中间变量η:
/ N2 , \ 3W \2 7 \3
+ +fzl +^1-JM + zI(4)
\ 2 ^(UJ UJ \ 2 ^lUJ UJ
2VTJ其中，ρ、q为中间变量，P = #，9 = ，J为加加速；若η彡1，则利用公式(5)计算最大可达转接点速度V' ρV' p = Vs+(nT)2J(5)
接续判断程序标号是否为1步骤；或者，若！! < 1，则令η = 1,V p = Vp，再利用公式(6)重新计算当前程序段始端 速度Vs:Vs = Vp-J(nT)2, Ve = Vp(6)其中，Ve为当前程序段末端速度；端点速度确定完毕。所述规划参数求解算法为当当前程序段末端速度Ve小于该段始端速度Vs时，按 照公式(7)确定第2阈值Ltl
<formula>formula see original document page 9</formula>其中，V' p为大可达转接点速度，Vs为当前程序段始端速度，Ve为当前程序段末端 速度，Vfflax为最大速度，Bfflax为最大加速度，J为加加速，T为插补周期，m为加速段减速段初 始滤波项数，a为加速段减速段初始加速度；当实际位移L大于第2阈值Ltl时，在第2阈值Ltl的加减速规划模式的前提下，按 照公式(8)确定勻加速段的时间周期数，即为中间变量k:
<formula>formula see original document page 9</formula>其中，b为中间变量，b = 2VsT+3maT2将加速段滤波项数Hi1、减速度滤波项数m2赋值为初始滤波项数m，将加速段加速度 ^、减速段加速度a2赋值为初始加速度a ；按照公式(9)确定最大可达速度Vm Vm = Vs+m(m+k)T2J(9)判断最大可达速度Vm是否大于系统给定的最大速度Vmax，如果不大于，则此次规划 结束；或者，当实际位移L不大于第2阈值Ltl时，在第2阈值Ltl的加减速规划模式的前 提下，按照公式(10)确定加速段、勻速段的周期数，即为中间变量η:
<formula>formula see original document page 9</formula>
其中，b为中间变量<formula>formula see original document page 9</formula>
将加速段滤波项数Hi1赋值为n，减速度滤波项数m2赋值为初始滤波项数m，将加速 段加速度^、减速段加速度a2赋值为初始加速度a ；
按照公式(11)可确定最大可达速度Vm <formula>formula see original document page 10</formula>(11)判断最大可达速度Vm是否大于系统给定的最大速度Vmax，如果不大于，则此次规划 结束；或者，当当前程序段末端速度\不小于该段始端速度Vs时，按照公式(12)确定第 2阈值L0
<formula>formula see original document page 10</formula><formula>formula see original document page 10</formula>(12)<formula>formula see original document page 10</formula>当实际位移L大于第2阈值Ltl时，在第2阈值Ltl的加减速规划模式的前提下，按 照公式(13)确定勻加速段的插补周期数，即为中间变量k:
<formula>formula see original document page 10</formula>⑴)其中，b为中间变量，<formula>formula see original document page 10</formula>将加速段滤波项数Hi1、减速段滤波项数m2赋值为初始滤波项数m，加速段加速度 ^、减速段加速度a2赋值为加速度a ；按照公式(14)确定最大可达速度Vm <formula>formula see original document page 10</formula>(14)判断最大可达速度Vm是否大于系统给定的最大速度Vmax，如果不大于，则此次规划 结束；或者，当实际位移L不大于第2阈值Ltl时，在第2阈值Ltl的加减速规划模式的前 提下，按照公式(15)确定减速段、稳定段的周期数，即为中间变量η:
<formula>formula see original document page 10</formula>其中，b为中间变量<formula>formula see original document page 10</formula>；将加速段滤波项数Hi1赋值为初始滤波项数m，减速段滤波项数m2赋值为n，加速段 加速度^赋值为初始加速度a，减速段加速度a2赋值为JnT ；按照公式(16)确定最大可达速度Vm <formula>formula see original document page 10</formula>(16)判断最大可达速度Vm是否大于系统给定的最大速度Vmax，如果不大于，则此次规划 结束；如果上述求解得到的最大可达速度Vm大于系统给定的最大速度Vmax，则令最大可达速度Vm等于系统给定的最大速度Vmax ；按公式(17)、(18)求解新的加速段减速段初始滤波项数m和加速度a <formula>formula see original document page 11</formula>则此次规划结束。所述确定直线加减速规划时的新位移为对指令位移补偿后再进行加减速规划， 使滤波后的实际位移等于指令位移，补偿后的位移即为规划位移S'<formula>formula see original document page 11</formula>其中，L为实际位移，Hi1为规划参数中加速段滤波项数、m2为规划参数中减速段滤 波项数，Vffl为最大可达速度，Ve为当前程序段末端速度，Vs为当前程序段始端速度，T为插 补周期。所述直线加减速规划包括在传统的直线加减速规划模式的末端，添加一段勻速 段，该勻速段速度为程序段的末端速度，时间长度为勻速段之前的加减速段的滤波项数与 插补周期的乘积。所述分段滑动平均滤波是对M个数据做累加平均，得到新的滤波值；第一个滤波值等于原始值，即<formula>formula see original document page 11</formula>
最后一个滤波值为:<formula>formula see original document page 11</formula>
式中，加速段和勻速段的滤波项数M = Hi1,而减速段和稳定段滤波项数M = m2，其 中，Hl1为规划参数中加速段滤波项数、Hl2为规划参数中减速段滤波项数-X ^为滤波后的第 一个速度值，V0为滤波前的初始速度值，N为滤波的速度值个数。所述对速度值进行插补时，各程序段的时间均是插补周期的整数倍；根据此整周 期加工的要求，利用剩余位移补偿方法消除加减速规划过程中的剩余位移误差；所述的剩余位移补偿方法根据公式(20)求得剩余位移Δ S
<formula>formula see original document page 11</formula>其中钇为运动时间，T为插补周期，、.为勻速段的插补周期个数；根据公式(21) 求出可以在一个插补周期内补偿剩余位移的速度\<formula>formula see original document page 11</formula>当减速至第一个小于\的速度Vi时，按Vi勻速规划一个插补周期，再继续减速规 划；根据公式(22)得到新的剩余位移AS'<formula>formula see original document page 11</formula>
重复上述剩余位移的补偿过程，直至剩余位移小于当前程序段末端速度与一个插 补周期的乘积为止；当前程序段最终的剩余位移并入下一程序段的位移中进行规划计算，直至最后一 个程序段为止。本发明具有以下有益效果及优点1.速度快，效率高。多程序段连续加工的实现，可以省去单段加工时用于启停的时 间，平均加工运动速度得到提高，提高了加工效率；另一方面，本发明的小计算量也可节省 计算时间，提高了系统的计算效率。2.平滑性好。程序段连接处的速度光滑，加速度连续，使加工效果更平滑。如果采 用滑动加权滤波，可使加速度光滑。3.易于实现。简单的直线加减速规划方法和简单的滤波技术的结合，使得算法复 杂度相比同等效果的S形曲线加减速和加速度光滑加减速要小的多。4.解决了数控机床在运动中的振动问题。多程序段连续加工减少了机床运动的 启停次数，使得机床产生振动的几率降低；同时由于滤波方法的引入，使得机床运行更加平 稳，可以较好地解决机床运动中的振动问题。5.灵活智能。本发明提供的各程序段的滤波项数是独立的，且各程序段中加速段 和减速段的滤波项数也是相互独立的，根据各程序段路径特点可以确定其加速段和减速段 可行的滤波项数和加速度，并保证加加速度有界。
图1为“加_勻-减_稳”速度曲线分析图；图2为滤波前后速度曲线分析图；图3为第1图解；图4为总体规划流程图；图5为转接点速度求解流程图；图6为加减速规划流程图；图7为滤波算法流程图。
具体实施例方式本发明一种基于前瞻_滤波技术的多程序段连续加减速控制方法采用基于前瞻 技术、滤波技术以及改进的直线加减速相结合的控制方法，实现S型或加速度平滑的多程 序段连续加工加减速控制。本发明方案如图4所示1)根据输入的工件加工程序数据进行前瞻规划，确定各程序段的前瞻规划参数；2)利用上述各程序段的规划参数进行相应的直线加减速规划，并对速度值进行插 补；3)对各段插补后的速度值进行分段滑动平均滤波，得到新的速度值。所述对输入工件加工程序数据进行前瞻规划计算包括以下步骤1. 1)根据工件加工程序数据，按照转接点算法确定各程序段间的转接点速度；1. 2)按照规划参数求解算法完成对各程序段规划参数的确定，其中规划参数包括最大速度Vm、直线加减速加速段和减速段的加速度ai、a2以及滤波项数H^m2 ；1.3)按照位移补偿算法确定直线加减速规划时的新位移S'。一般的基于滤波的加减速方法中，整个程序段采用一个滤波项数，直线加减速中的加速段和减速段采用相同的加速度。如步骤1.2)中所述，本发明中加速段和减速段采用 了不同的加速度和滤波项数，这一点和一般的加减速规划参数的设计有所不同。之所以如 此规划，是为了保证在滤波后加速段和减速段的加加速不超过允许值；同时，加减速规划方 式整体也更加灵活。步骤1.3)中所述的确定规划位移S'是指计算直线加减速规划的位移。因为要实 现多段连续加工，程序段末端速度不为零，因此，滤波后的位移与直线加减速规划的位移不 相同，需要重新计算规划位移。如图1所示，步骤2)中所述改进的直线加减速规划是通过在直线加减速的未端保 持一段固定长度的勻速段(称为稳定段)来实现的。此稳定段的速度为程序段的末端速度， 时间为稳定段前的加减速段滤波项数和插补周期T的乘积。改进的直线加减速规划方法还要求各运动段(加速段，勻速段，减速段，稳定段) 的时间均为插补周期的整数倍，这一点在实际速度规划中很难得到保证，因而使程序段在 速度规划后存在剩余位移，该剩余位移小于勻速段速度一个插补周期的位移。剩余位移通 过如下方式进行补偿根据剩余位移AS，求出可以在一个插补周期内补偿AS的速度VJ有Kt < Vffl)，当减速至第一个小于等于\的速度Vi时，则按Vi勻速规划一个插补周期，再继续减 速规划。重复这一补偿方式，直至该程序段规划结束，最终的剩余位移将小于程序段未端速 度一个插补周期的位移，将该剩余位移并入下一程序段进行规划。步骤3)中，所述分段滑动平均滤波是源于加速段和减速段相异的滤波项数这一 特点，即加速段和减速段分别采用不同的滤波项数完成速度滤波。步骤1. 1)转接点速度确定方案如图5所示设规划程序段的实际位移为L，始端速度为Vs，末端初始速度为Vp，满足滤波要求 的最大可达转接点速度为V' p，末端速度为\，系统限定的最大进给速度为Vmax，加加速为 J，最大加速度为amax，加加速阶段周期数(初始滤波项数)为m，插补周期为T。通过确定第1阈值Stl(如图3所示)来判定程序段的加速过程，其中，Stl为加速阶 段的加速度可以达到最大加速度amax，且加速过程仅有加加速与减加速阶段而无勻加速阶 段的最小实际位移，进而根据该程序段的加速过程求解相应的V' p。所述转接点算法为初始化程序标号为0，即line = 0 ；当当前程序段末端初始速度Vp大于当前程序段始端速度Vs时，直接判断当实际位 移L是否大于第1阈值Stl，否则将当前程序段末端初始速度Vp的值与当前程序段始端速度 Vs的值互换，并将程序标号赋值为1，再判断当前实际位移L是否大于第1阈值Stl ；如果实际位移L大于第1阈值Stl时，表示加速过程有勻加速段，Stl根据公式(1) 求得S0 = 2VsmT+amax(mT)2(1)
其中<formula>formula see original document page 14</formula>根据公式⑵求得加速过程中的勻加速段插补周期T的个数，即为中间变量k <formula>formula see original document page 14</formula>式中，b为中间变量j = VsT + Ima^rl，m为初始滤波项数，afflax为最大加速度；再根据公式(3)求得最大可达末端速度V' p ；V' ρ = Vs+(m+k) Tafflax(3)判断程序标号是否为1，如为1则将当前程序段末端初始速度Vp与当前程序段始 端速度Vs互换；当当前程序段始端速度Vs大于最大可达转接点速度V' p时，调整当前程序段始 端速度Vs的值为最大可达转接点速度V' p，转接点的初始速度Vp不需调整，端点速度确定 完毕；如果当前程序段始端速度Vs不大于最大可达转接点速度V' p，则转接点的初始速 度Vp不需调整，端点速度确定完毕；或者，如果程序标号不为1，则当转接点的初始速度Vp大于最大可达转接点速度V' p时，调整转接点的初始速 度Vp等于最大可达转接点速度V' p，端点速度确定完毕；当转接点的初始速度Vp不大于最大可达转接点速度V' p时，转接点的初始速度 Vp不需调整，端点速度确定完毕；或者，当实际位移L不大于第1阈值Stl时，表示加速过程无勻加速段，且加速度达 不到amax，即加加速阶段插补周期数小于m。设加加速阶段插补周期数为n，则该阶段的加速 度为a = nTJ，位移为L = 2TVS · n+T3J · η3求解上述三次方程，得到公式(4)；利用公式(4)求得加加速阶段插补周期个数，即为中间变量η
<formula>formula see original document page 14</formula>其中，ρ、q为中间变量，ρ = ^ ^ = ，J为加加速；若η彡1，则利用公式(5)计算最大可达转接点速度V' ρV' p = Vs+(nT)2J(5)接续判断程序标号是否为1步骤；或者，若！! < 1，则令η = 1,V p = Vp，再利用公式(6)重新计算当前程序段始端 速度Vs:Vs = Vp-J(nT)2, Ve = Vp(6)
其中，Ve为当前程序段末端速度；端点速度确定完毕。步骤1. 2)规划参数确定方案如图6所示滤波后的位移是实际位移，直线加减速的规划位移和滤波后的位移值不相同。设 指令位移为L，直线加减速的规划位移为S'，加速段滤波项数为Hi1，减速段滤波项数为m2， 插补周期为T，程序段始端速度和末端速度分别为Vs与\，直线加减速规划的最大速度为 V…如图1所示，整个过程可描述为程序段始端速度Vs以加速度ai加速至Vm，以最大 速度Vm勻速运动至少HI1个插补周期，由最大速度Vm以加速度a2减速至末端速度I，然后以 速度\勻速运动m2个插补周期。其中，最后的勻速段过程称为稳定段。为确定各程序段的规划参数，设定一个“加_勻-减_稳”规划方式的位移阈值k。所述规划参数求解算法为当当前程序段末端速度Ve等于最大可达转接点速度V' p时，整个过程仅有加速 段和稳定段，无需计算k。加速段和减速段的滤波项数mi、m2和加速度^、％的取值如下
2VTL其中，中间变量p、q的值为:P = ~J^,q = _J^.’B1 = Jm1T, a2 = 0此次规划结束；当当前程序段始端速度Vs等于最大可达转接点速度r p时，整个过程仅有减速 段和稳定段，无需计算k。加速段和减速段的滤波项数mi、m2和加速度^、％的取值如下
I/ \2 / "TT I Ii λ2 X λ3
_ —H-彻书H-f-彻+K
2VTL其中，中间变量p、q的值为:P =卞=B1 = 0, a2 = Jm2T此次规划结束；当当前程序段末端速度Ve小于该段始端速度Vs时，按照公式(7)确定第2阈值 Ltl，Ltl对应的规划方式的加速段、勻速段、稳定段均设为m个插补周期，加速段和减速段的加 速度均设为a，其中，m为加速段减速段初始滤波项数，a是达到最大可达速度的最大可达加 速度，m、a以及Ltl的求解公式如下
V JT2JT
vLJ /a = JmT(7)
L0 = d2 + (VrK}nT + (冗 + ^ >τ + 2顏炉
2α2、其中，V' ρ为大可达转接点速度，Vs为当前程序段始端速度，Ve为当前程序段末端 速度，Vfflax为最大速度，Bfflax为最大加速度，J为加加速，T为插补周期；当实际位移L大于第2阈值Ltl时，将多出的位移L-Ltl添加到加速段，减速段以及 勻速段中，使得加速段减速段插补周期数均增加k个，稳定段周期数不变。在第2阈值Ltl的 加减速规划模式的前提下，按照公式(8)确定勻加速段的时间周期数，即为中间变量k:
”-^- ⑷
其中，b为中间变量，b = 2VsT+3maT2将加速段滤波项数HI1、减速度滤波项数m2赋值为加速段减速段初始滤波项数m，将 加速段加速度^、减速段加速度a2赋值为初始加速度a ；按照公式(9)确定最大可达速度Vm Vm = Vs+m(m+k)T2J(9)判断最大可达速度Vm是否大于系统给定的最大速度Vmax，如果不大于，则此次规划 结束；或者，当实际位移L不大于第2阈值Ltl时，需从加速段，减速段，勻速段共减去Ltl-L 大小的位移，使得加速段、勻速段、减速段的插补周期数均减少k个，稳定段周期数不变。在 第2阈值Ltl的加减速规划模式的前提下，按照公式(10)确定加速段、勻速段的周期数，即 为中间变量η:
, .'「一δ —^/δ2—6αΓ2(丄1/ …η = m-k,/c = mm -^-- ,m(10)
3aT
VJ其中，b为中间变量，
2将加速段滤波项数Hi1赋值为n，减速度滤波项数m2赋值为初始滤波项数m，将加速 段加速度^、减速段加速度a2赋值为初始加速度a ；按照公式(11)可确定最大可达速度Vm Vm = Vs+(Hi1T)2J(11)判断最大可达速度Vm是否大于系统给定的最大速度Vmax，如果不大于，则此次规划 结束；或者，当当前程序段末端速度Ve不小于该段始端速度Vs时，按照公式(12)确定第 2阈值L0
. lmin(Vp’VimJ-K amax 1
m = mm J----r-
V JT2JT
VLJ Ja = JmT(12)<formula>formula see original document page 17</formula>当实际位移L大于第2阈值Ltl时，将多出的位移L-Ltl添加到加速段，减速段以及 勻速段中，使得加速段减速段插补周期数均增加k个，稳定段周期数不变。在第2阈值Ltl的 加减速规划模式的前提下，按照公式(13)确定增加的插补周期数，即为中间变量k:
<formula>formula see original document page 17</formula>
其中，b为中间变量，b = 2VeT+3maT2将加速段滤波项数Hi1、减速段滤波项数m2赋值为初始滤波项数m，加速段加速度 ^、减速段加速度a2赋值为加速段减速段初始加速度a ；按照公式(14)确定最大可达速度Vm Vm = Ve+m(m+k)T2J(14)判断最大可达速度Vm是否大于系统给定的最大速度Vmax，如果不大于，则此次规划 结束；或者，当实际位移L不大于第2阈值Ltl时，需从加速段，减速段，勻速段以及稳定 段共减去Ltl-L大小的位移，使得加速段、减速段、稳定段的插补周期数均减少k个，勻速段 周期数不变。在第2阈值Ltl的加减速规划模式的前提下，按照公式(15)确定减速段、稳定 段的周期数，即为中间变量η:
, .!"一δ —JZ)2—1/ 1C χη = m-k, A: = min ---；---- ,m( 15 )
3aT2
VJ其中，b为中间变量，6 =^^
2将加速段滤波项数Hi1赋值为加速段减速段初始滤波项数m，减速段滤波项数m2赋 值为n，加速段加速度ai赋值为加速段减速段初始加速度a，减速段加速度a2赋值为JnT ；按照公式(16)确定最大可达速度Vm Vm = Ve+(Hi2T)2J(16)综上，如果上述过程中求得的最大可达速度Vm大于系统给定的最大速度Vmax，则令 最大可达速度Vm等于系统给定的最大速度Vmax ；按公式(17)、(18)求解新的加速段减速段初始滤波项数m和加速度a
〔 --、f I--ΛW1=Hiin max ”￥χ ,^l m = min Ess^zIl(17)
ι^ JT2 JT tV JT2 JT
VLJ JVLJ /B1 = Jm1T, a2 = Jm2T(18)则此次规划结束。步骤2)采用改进的直线加减速规划方案，具体为在确定了程序段的规划参数后，对其进行直线加减速规划。此处的直线加减速是 指改进后的直线加减速方案，所述直线加减速规划包括在传统的直线加减速规划模式的 末端，添加一段勻速段，该勻速段速度为程序段的末端速度，时间长度为勻速段之前的加减速段的滤波项数与插补周期的乘积。上述改进方法可确定直线加减速规划时的新位移为对指令位移补偿后再进行加 减速规划，使滤波后的实际位移等于指令位移，补偿后的位移即为规划位移S'<formula>formula see original document page 18</formula>当进行直线加减速规划时，利用上述公式对实际位移适当修正得到规划位移，则 保证滤波后的位移正好是目标路径的实际位移。上述位移补偿方法和滤波方法相结合，保 证了滤波前后程序段的始末速度一致，且滤波后的位移同程序段的实际位移一致。规划方案要求程序段的各个运动阶段(加速段，勻速段，减速段，稳定段)的时间 均应为插补周期的整数倍。此整周期要求会使得程序段在对各运动段(加速段、勻速段、减 速段、稳定段)规划时产生一定的剩余位移。该剩余位移可通过如下方案进行补偿以完成 该程序段规划由于已知规划程序段的加速段和减速段的滤波项数m” m2以及加速度 、a2,最大 速度Vm，则可以确定加速段、减速段以及稳定段的规划位移，假设剩余的规划位移全部用作 最大速度的勻速运动，则勻速段加工时间无法保证是插补周期的整数倍。根据整周期加工 的要求，必会有一段长度小于VmT的位移剩余。设勻速段的运动时间为、，插补周期为T，则勻速段的插补周期个数为*，可得
剩余的位移为
<formula>formula see original document page 18</formula>根据Δ S，求出可以在一个插补周期内补偿剩余位移的速度1 (Ve ^Vr< Vffl)，当减 速至第一个小于\的速度Vi时，按Vi勻速规划一个插补周期(后称为小勻速段)，再继续 减速规划。Vr求解公式如下<formula>formula see original document page 18</formula>
同时，可得到新的剩余位移<formula>formula see original document page 18</formula>
重复上述剩余位移的补偿过程，直至AS < VeT为止。上述补偿过程结束后，当前程序段最终的剩余位移Δ S将向后计算至下一程序段 的位移中进行规划。步骤3)中的分段滑动平均滤波如图7所示滤波即指在直线加减速规划完毕之后，串联一个滑动平均滤波器，对速度值进行 滑动平均滤波。若滤波项数为Μ，通过对前M个速度值的累加平均求出新的速度值，然后随 着新的规划数据的加入，老的速度规划值被移出滤波器。本发明采用的滤波方式为分段的 滑动平均滤波，具体的滤波方式如下设滤波项数为Μ，滤波的速度值个数为N，直线加减速规划速度为Vi (i = 0，1，…， N)。其中，M有两种取值选择，加速段和勻速段的滤波项数M = Hi1，而减速段和稳定段滤波项数M = m2，采用下列公式进行滤波，能够保证始末速度均为规划速度，而且由于滤波产生 的滞后位移可以在稳定段得到补偿。具体公式如式(23)所示<formula>formula see original document page 19</formula>根据滤波后的速度f可得位置增量为Δ孓=，则程序段实际位移为<formula>formula see original document page 19</formula>/=1滤波前后的速度曲线图如图2所示，图中直线段图形表示为滤波前的速度曲线， 曲线段图形为滤波后的速度曲线。图2表明，经过滤波后的速度曲线较滤波前的直线加减 速速度曲线平滑性好。
权利要求
一种基于前瞻-滤波技术的多程序段连续加减速控制方法，其特征在于包括以下步骤根据输入的工件加工程序数据进行前瞻规划，确定各程序段的前瞻规划参数；利用上述各程序段的规划参数进行相应的直线加减速规划，并对速度值进行插补；对各段插补后的速度值进行分段滑动平均滤波，得到新的速度值。
2.按权利要求1所述的基于前瞻_滤波技术的多程序段连续加减速控制方法，其特征 在于所述对输入工件加工程序数据进行前瞻规划计算包括以下步骤根据工件加工程序数据，按照转接点算法确定各程序段间的转接点速度；按照规划参 数求解算法完成对各程序段规划参数的确定，其中规划参数包括最大速度、直线加减速加 速段和减速段的加速度以及滤波项数；按照位移补偿算法确定直线加减速规划时的新位移。
3.按权利要求2所述的基于前瞻_滤波技术的多程序段连续加减速控制方法，其特征 在于所述转接点算法为初始化程序标号为0 ；当当前程序段末端初始速度vp大于当前程序段始端速度vs时，直接判断当前实际位移 L是否大于第1阈值&，否则将当前程序段末端初始速度Vp的值与当前程序段始端速度Vs 的值互换，并将程序标号赋值为1，再判断当前实际位移L是否大于第1阈值& ；如果实际位移L大于第1阈值&时，则根据公式(2)求得加速过程中的勻加速段插补 周期T的个数，即为中间变量k:<formula>formula see original document page 2</formula>式中，b为中间变量，<formula>formula see original document page 2</formula>m为初始滤波项数，afflax为最大加速度；再根据公式(3)求得最大可达末端速度V' p ；<formula>formula see original document page 2</formula>判断程序标号是否为1，如为1则将当前程序段末端初始速度Vp与当前程序段始端速 度Vs互换；当当前程序段始端速度^大于最大可达转接点速度V' 5时，调整当前程序段始端速度 Vs的值为最大可达转接点速度V' p，转接点的初始速度Vp不需调整，端点速度确定完毕；如果当前程序段始端速度Vs不大于最大可达转接点速度V' p，则转接点的初始速度\ 不需调整，端点速度确定完毕； 或者，如果程序标号不为1，则当转接点的初始速度\大于最大可达转接点速度V' p时，调整转接点的初始速度Vp 等于最大可达转接点速度V' p，端点速度确定完毕；当转接点的初始速度\不大于最大可达转接点速度V' p时，转接点的初始速度Vp不 需调整，端点速度确定完毕；或者，当实际位移L不大于第1阈值&时，利用公式(4)求得加加速阶段插补周期个数，即为中间变量n<formula>formula see original document page 3</formula>其中，P、q为中间变量…=<formula>formula see original document page 3</formula>，J为加加速； 若n彡1，则利用公式(5)计算最大可达转接点速度V' p V' p = Vs+(nT)2J(5)接续判断程序标号是否为1步骤；或者，若11 < 1，则令n = 1，V' p = Vp，再利用公式(6)重新计算当前程序段始端速度Vs = Vp-J(nT)2,Ve = Vp(6)其中，\为当前程序段末端速度； 端点速度确定完毕。
4.按权利要求2所述的基于前瞻_滤波技术的多程序段连续加减速控制方法，其特征 在于所述规划参数求解算法为当当前程序段末端速度\小于该段始端速度Vs时，按照公 式(7)确定第2阈值L。<formula>formula see original document page 3</formula>其中，V' p为大可达转接点速度，vs为当前程序段始端速度，ve为当前程序段末端速 度，v_为最大速度，afflax为最大加速度，J为加加速，T为插补周期，m为加速段减速段初始 滤波项数，a为加速段减速段初始加速度；当实际位移L大于第2阈值k时，在第2阈值k的加减速规划模式的前提下，按照公式(8)确定勻加速段的时间周期数，即为中间变量 <formula>formula see original document page 3</formula>其中，b为中间变量，b = 2VsT+3maT2将加速段滤波项数mi、减速度滤波项数m2赋值为初始滤波项数m，将加速段加速度^、 减速段加速度a2赋值为初始加速度a ； 按照公式(9)确定最大可达速度Vm Vm = Vs+m(m+k)T2J(9)判断最大可达速度\是否大于系统给定的最大速度V_，如果不大于，则此次规划结束；或者，当实际位移L不大于第2阈值k时，在第2阈值k的加减速规划模式的前提下，按照公式(10)确定加速段、勻速段的周期数，即为中间变量 <formula>formula see original document page 4</formula>其中，b为中间变量，<formula>formula see original document page 4</formula>(10)将加速段滤波项数mi赋值为n，减速度滤波项数m2赋值为初始滤波项数m，将加速段加 速度^、减速段加速度a2赋值为初始加速度a ； 按照公式(11)可确定最大可达速度Vm : Vm = Vs+(mJ)2J(11)判断最大可达速度\是否大于系统给定的最大速度V_，如果不大于，则此次规划结束；或者，当当前程序段末端速度\不小于该段始端速度Vs时，按照公式(12)确定第2阈 值L0:<formula>formula see original document page 4</formula>当实际位移L大于第2阈值k时，在第2阈值k的加减速规划模式的前提下，按照公 式(13)确定勻加速段的插补周期数，即为中间变量k:<formula>formula see original document page 4</formula>(13)其中，b为中间变量，b = 2VeT+3maT2将加速段滤波项数％、、减速段滤波项数m2赋值为初始滤波项数m，加速段加速度ai、减 速段加速度a2赋值为加速度a ；按照公式(14)确定最大可达速度Vm Vm = Ve+m(m+k)T2J(14)判断最大可达速度\是否大于系统给定的最大速度V_，如果不大于，则此次规划结束；或者，当实际位移L不大于第2阈值k时，在第2阈值k的加减速规划模式的前提下， 按照公式(15)确定减速段、稳定段的周期数，即为中间变量n:<formula>formula see original document page 4</formula>(15)其中，b为中间变量，<formula>formula see original document page 4</formula>将加速段滤波项数mi赋值为初始滤波项数m，减速段滤波项数m2赋值为n，加速段加速 度^赋值为初始加速度a，减速段加速度a2赋值为JnT ；按照公式(16)确定最大可达速度\ <formula>formula see original document page 5</formula>判断最大可达速度\是否大于系统给定的最大速度V_，如果不大于，则此次规划结束。
5.按权利要求4中所述的基于前瞻_滤波技术的多程序段连续加减速控制方法，其特 征在于如果上述求解得到的最大可达速度Vm大于系统给定的最大速度Vmax，则令最大可达 速度等于系统给定的最大速度vmax ；按公式(17)、(18)求解新的加速段减速段初始滤波项数m和加速度a:<formula>formula see original document page 5</formula>则此次规划结束。
6.按权利要求2所述的基于前瞻_滤波技术的多程序段连续加减速控制方法，其特征 在于所述确定直线加减速规划时的新位移为对指令位移补偿后再进行加减速规划，使 滤波后的实际位移等于指令位移，补偿后的位移即为规划位移S'<formula>formula see original document page 5</formula>其中，L为实际位移，mi为规划参数中加速段滤波项数、m2为规划参数中减速段滤波项 数，Vm为最大可达速度，Ve为当前程序段末端速度，Vs为当前程序段始端速度，T为勻加速 段插补周期。
7.按权利要求1所述的基于前瞻_滤波技术的多程序段连续加减速控制方法，其特征 在于所述直线加减速规划包括在传统的直线加减速规划模式的末端，添加一段勻速段， 该勻速段速度为程序段的末端速度，时间长度为勻速段之前的加减速段的滤波项数与插补 周期的乘积。
8.按权利要求1所述的基于前瞻_滤波技术的多程序段连续加减速控制方法，其特征 在于所述分段滑动平均滤波是对M个数据做累加平均，得到新的滤波值； 第一个滤波值等于原始值，即Vo‘＝M个Vo+…Vo/M;最后一个滤波值为:V'N=VN-M+1+…+VN;/M； 式中，加速段和勻速段的滤波项数M = mi，而减速段和稳定段滤波项数M = m2，其中，mi 为规划参数中加速段滤波项数、m2为规划参数中减速段滤波项数-V'o为滤波后的第一个 速度值，V0为滤波前的初始速度值，N为滤波的速度值个数。
9.按权利要求1所述的基于前瞻_滤波技术的多程序段连续加减速控制方法，其特征 在于所述对速度值进行插补时，各程序段的时间均是插补周期的整数倍；根据此整周期 加工的要求，利用剩余位移补偿方法消除加减速规划过程中的剩余位移误差；所述的剩余位移补偿方法根据公式(20)求得剩余位移AS <formula>formula see original document page 5</formula>其中、为运动时间，T为插补周期，、为勻速段的插补周期个数；根据公式(21)求出可以在一个插补周期内补偿剩余位移的速度V"<formula>formula see original document page 6</formula>(21)当减速至第一个小于\的速度Vi时，按Vi勻速规划一个插补周期，再继续减速规划；根据公式(22)得到新的剩余位移AS'<formula>formula see original document page 6</formula>(22)重复上述剩余位移的补偿过程，直至剩余位移小于当前程序段末端速度与一个插补周 期的乘积为止；当前程序段最终的剩余位移并入下一程序段的位移中进行规划计算，直至最后一个程 序段为止。
全文摘要
本发明涉及一种基于前瞻-滤波技术的多程序段连续加减速控制方法，步骤为根据输入的工件加工程序数据进行前瞻规划，确定各程序段的前瞻规划参数；利用各程序段的规划参数进行相应的直线加减速规划，并对速度值进行插补；对各段插补后的速度值进行分段滑动平均滤波，得到新的速度值；对输入工件加工程序数据进行前瞻规划计算包括根据工件加工程序数据，按照转接点算法确定各程序段间的转接点速度；按照规划参数求解算法完成对各程序段规划参数的确定；按照位移补偿算法确定直线加减速规划时的新位移。本发明方法将改进的直线加减速规划方法和滤波技术以及前瞻技术相结合，实现了多程序段连续规划，提高了加工效率和计算效率，平滑性好，易于实现。
文档编号G05B19/416GK101833306SQ20101016965
公开日2010年9月15日 申请日期2010年5月12日 优先权日2010年5月12日
发明者刘明烈, 李鸥, 杨东升, 鲍玉凤 申请人:中国科学院沈阳计算技术研究所有限公司;沈阳高精数控技术有限公司