专利名称：基于滤波技术的速度前瞻控制方法
技术领域：
本发明涉及数控系统的速度控制技术，具体地说是一种加工复杂路径 的基于滤波技术的速度前瞻控制方法。
背景技术：
在复杂曲面的数控加工中，CAD/CAM系统的后置处理器将复杂路径用一 系列由直线或圆弧组成的微小路径段以允许的误差来逼近，再由数控系统 对每一个路径段进行插补运算。为实现高速加工，要求刀具沿工件轮廓表 面的进给速度大幅度提高，在短时间内需要走过大量微小路径段。此时如 果按照常规速度控制方法进行控制，釆用每一个路径段进行加速、匀速、 减速三个阶段运动，由于拟合复杂曲线的路径段非常短，致使加工过程中 加、减速极度频繁，由此造成速度曲线不平滑，加工效率低下，加工质量 差。并且当遇到轮廓表面急拐弯时，将产生巨大的加速度，不仅会造成很 大的轮廓误差，而且产生的冲击将使机床机构无法承受。
解决此问题一种有效的方法就是前瞻控制。它是一种提前发现轨迹突 变，并对进给速度进行有效控制的方法。从高速加工的特点可知，当以很 高的进给速度加工复杂工件表面时，如果轮廓突变，造成加工轨迹急转弯， 必须将进给速度减小到允许范围内。但由于数控机床的进给速度不能产生 突变，要将很高进给速度降低到较低值，必须需要一定的加工长度。因此 就需要使进给速度随加工路径变化自适应的调节，为实现这一要求，必须 要求数控系统具有前瞻控制能力。
从现有的国内外技术发展状况来看，只是将直线加速策略或S曲线加 减速策略引入到前瞻控制中，建立速度衔接数学模型，并且采用路径段单 独规划，段间进行速度衔接。虽然从理论上实现了轨迹的连续加工，但仍 然存在以下问题若前瞻处理釆用直线加减速策略，插补过程中不可避免 的存在加速度突变，速度曲线不平滑，不适合高速加工；若前瞻处理釆用S 曲线加减速策略，由于S曲线加减速方法本生就是利用多项式将速度规划 分为5个段或7个段，计算量巨大，编程复杂。如果再按此方法进行迭代 计算转接速度，必然不能满足高速加工高釆样频率的要求；当路径段实际 运行的时间不满足插补周期的整数倍时，按照速度衔接数学模型不能计算 出衔接速度。
发明内容
针对现有技术中存在的上述不足之处，本发明要解决的技术问题是提 供一种不存在加速度突变、速度曲线平滑且适合高速加工的基于滤波技术 的速度前瞻控制方法。为解决上述问题，本发明釆用的技术方案是本发明基于滤波技术的速度前瞻控制方法包括以下步骤将加工曲线的路径段链接成路径链，前瞻计算出加工曲线拐角处最大加速度约束速度和轮廓误差约東速度；根据各约束速度计算出拐角处速度；对路径链按直线加减速策略进行前瞻整体速度规划得到路径链前瞻规划速度，用拐角处速度与路径链前瞻规划速度的差值作为插补过程中是否提前减速的判据；如果上述差值超过规定的阀值，则计算路径链中减速段长度,反向递推路径链中的减速路径段，设置减速路径段的要求进给速度；按照基于滤波技术的加减速策略对路径链进行轨迹规划，并通过调节减速路径段的要求进给速度来实现加工速度随加工路径几何形态变化而自适应调节。
所述拐角处最大加速度约東速度和拐角处轮廓误差约束速度根据以下公式计算
其中or/W^/为拐角处最大加速度约束速度，~max为各轴最大加速度
"xmax、"戶ax、":腿的总描述，Af为数控系统插补周期，乂,W代表前一路
径段u，z轴的坐标，代表后 一 路径段x,r,z轴的坐标，
V^7^7^7为前一路径段的长度，+,+1,2+^,2+;+1,2为后一路径段
的长度；
mw^Ke/为拐角处轮廓误差约東速度，五为最大轮廓误差限制，《为两相邻路径段之间的夹角，Af为数控系统插补周期；
通过求取上述拐角处最大加速度约東速度和拐角处轮廓误差约東速度中的最小值得到第i - 1路径段最优拐角处要求速度。
所述前瞻规划出的第i - 1路径段拐角处所能达到的进给速度通过以下公式计算其中a为数控系统预先设置的加速度；A^为数控系统插补周期；S为路径链的总长度；r^^/,—i为第i-l路径段的要求进给速度；cw;re"^《"为
第i - n路径段拐角处即时速度；为第i _ 1路径段拐角处所能达到的实际进给速度，即前瞻规划速度；"r"w^/,j为第i-2路径段的拐角处要求速度；/ewg^一为第i-l路径段的路径长度。
所述计算路径链中减速段长度、反向递推路径链中的减速路径段以及设置减速路径段的要求进给速度包括以下过程
若第i - 1路径段拐角处所能达到的速度小于等于第i - 1路径段的拐角处要求速度，则不需要在插补过程中对路径链进行减速处理；
若第i-1路径段拐角处所能达到的速度大于第i-1路径段的拐角处要求速度，需要在轨迹规划过程中对路径链进行减速处理，计算出减速段长
度；
通过减速段长度递推计算路径链中需要减速的路径段和路径段中的减
速点；根据减速点调节减速路径段的要求进给速度，来实现轨迹规划过程中路径链进给速度的自适应调节；
若减速段长度小于等于第i - 1路径段长度，则第i - l路径段能够完成整个减速过程，设置第i - 1路径段减速点之后的要求进给速度为第i - 1路径段的拐角处要求速度，计算出第i - 1路径段的减速点；
若减速段长度大于第i - 1路径段长度，则第i -1路径段长度不能够完成减速过程，需要逆向递推减速路径段和段内减速点；设置第i-l路径段减速点为0和第i - 1路径段减速点之后的要求进给速度为第i - 1路径段的拐角处要求速度，重新计算剩余减速段长度和第i-2路径段拐角处速度
若减速段长度小于等于第i - 2路径段长度，设置第i - 2路径段的减速点为和第i - 2路径段减速点之后的要求进给速度为为第i - 2路径段的拐角处要求速度；
若减速段长度仍大于第i-2路径段长度，向前递推一路径段，重复减
速段长度和路径段长度判断过程，直到减速段长度小于等于路径段长度停止。
基于滤波技术的加减速策略对路径链进行轨迹规划包括以下步骤根据读入路径链总长度及上一周期速度计算出路径链的即时速度，计
算当前路径段本次行程和已运行长度；将路径段本次行程与前瞻规划出的对应路径段减速点进行比较；
若本次行程大于等于对应路径段减速点，且即时速度大于当前路径段减速点之后的要求进给速度，令即时速度等于该即时速度减去 一个插补周期内的速度变化最大值，放入滑动滤波器进行滤波延迟补偿，重新计算当前路径段本次行程并输出。
若本次行程大于等于对应路径段减速点，且即时速度小于等于当前路径段减速点之后的要求进给速度，将路径链的即时速度放入滑动滤波器进行滤波延迟补偿，重新计算当前路径段本次行程和已运行长度。
若本次行程小于对应路径段减速点，且即时速度大于要求进给速度，则令即时速度等于要求进给速度，将路径链的即时速度放入滑动滤波器进行滤波延迟补偿，重新计算当前路径段本次行程和已运行长度。
若本次行程小于对应路径段减速点，且即时速度小于等于要求进给速度，将路径链的即时速度放入滑动滤波器进行滤波延迟补偿，重新计算当前路径段本次行程和已运行长度。
本发明具有以下有益效果及优点
1. 具有柔性自适应控制能力。在使用本发明方法的加工过程中，刀具进给速度随路径变化自适应地调节，当遇到轨迹急拐弯情况时，釆用进给速度约東，避免了由于产生巨大加速度而造成的轮廓误差和机床结构无法承受的冲击；
2. 适应性强。应用本发明方法的进给速度调节仅与路径形状有关，与路径段大小无关，避免了微小路径段加工过程中存在的加减速极度频繁的问题；
3. 执行效率高。本发明方法在前瞻处理中釆用直线加减速策略进行整体规划和递推减速路径段，避免了在前瞻处理中釆用S型加减速策略带来的计算复杂性；
4. 速度平滑性好。本发明方法在轨迹规划过程中将基于滤波技术的加减速特性和路径链整体速度规划、路径段内进给速度调整方法相结合，确保了整个加工过程中进给速度的平滑。
图1为应用本发明方法的数控系统运动控制器的结构图2为本发明方法路径段间最大加速度约東图3为本发明方法路径段间轮廓误差约東图4为本发明方法路径段内进给速度处理图5为本发明方法前瞻规划流程图6为本发明方法轨迹规划流程图7为加工路径测试图8A为使用传统速度控制方法速度曲线图(10路径段)；图8B为使用本发明方法的速度曲线图(IO路径段)；图8C为使用传统速度控制方法速度曲线图(20路径段)；
图8D为使用本发明速度控制方法速度曲线图(20路径段)；
图9A为使用传统速度控制方法加速度曲线图(10路径段)；
图9B为使用本发明方法加速度曲线图(IO路径段)；
图9C为使用传统速度控制方法加速度曲线图(20路径段)；
图9D为使用本发明方法加速度曲线图(20路径段)。
具体实施例方式
下面结合附图对本发明作进一步说明。
本实施例中，硬件平台釆用全数字控制方式，标准工业级IPC板卡，PM-lGHz CPU作为数控系统控制器，轴釆用MECHATROLINK总线控制方式。基于该平台开发的开放数控系统作为集成一体化的数控系统，充分发挥了其运算速度快，功能强大等特点，并通过软件完成显示、插补计算、运动控制等功能。在该数控系统中，运动控制器是核心，釆用基于滤波技术的速度前瞻控制方法后，其运动控制器的组件结构如图l所示。
本发明方法基于滤波技术的加减速特性，根据滑动滤波器原理，将第/个插补周期按直线加减速方法规划出来的速度值v,放入长度为丄(丄是滑动平均滤波器的阶次)和加权系数为^的滑动滤波器中，通过与前丄个速度值做累加平均(初始时滤波器初始值全为零)和归一化处理，,着新规划速度的加入，旧的规划速度被移出滑动滤波器，滤波后的速度5为
v, = + [ Wv, + +…+ wtv"+1 ] = y S甲" (l)
其中A表示被加权的数是滤波器中的第A:个数；^是权系数，G是归一化增益因子，并且满足^ = g4t)，根据滤波后的速度K可以计算出在加
速过程中(0&、丄)的加速度和加加速为
5 — K ， Ga
Af 丄
(2)
=o
., 《.—a,—, Go , .、 / ,、
yer夂—~^-^ —-一) ( 3 )
Af 丄Af
假设路径段按直线加减速需要7V个周期规划完，同理可以求出在减速过程中(7VSK7V +丄)的减速度和减减速为
S -巧—,—Ga
丄
.2>, (4)
^ert:—2-^ =->v_ (5)
Af 边 '"
通过(2)、 (3)、 (4)、 (5)等式可以发现基于滤波技术的加减速具有通过控制加加速度的大小和形状来避免加减速过程中的加速度突变的特性，并且对直线加减速规划进行滤波和直线加减速规划的位置是相等的。因此，在前瞻控制过程中釆用直线加减速策略反向逆推减速路径段，不会在轨迹规划过程中引起路径链的加速度突变，保证了整个加工过程中进给速度曲线连续光滑。
如图1所示，本发明方法应用于数控系统中，基于上述滤波技术的加
减速特性，其将加工曲线的路径段进行前瞻速度控制，并输出至伺服驱动
器，具体方法包括以下步骤
将加工曲线的路径段链接成路径链，前瞻计算出加工曲线拐角处最大
加速度约東速度和轮廓误差约東速度；根据各个约東速度计算出拐角处速度。
对路径链按直线加减速策略进行前瞻整体速度规划得到路径链前瞻规划速度，用拐角处速度与路径链前瞻规划速度的差值作为插补过程中是否
提前减速的判据；如果上述差值超过规定的阀值，则计算路径链中减速段长度，反向递推路径链中的减速路径段，设置减速路径段的要求进给速度；
按照基于滤波技术的加减速策略(现有技术)对路径链进行轨迹规划，并通过调节减速路径段的要求进给速度来实现加工速度随加工路径几何形态变化而自适应调节。
所述拐角处最大加速度约東速度和拐角处轮廓误差约東速度根据以下公式计算
—— 序--
人-1 /,.+!/'
"-l +Z'.'-l "^"+l/. +5+1/
2五* 57'wa
(7)
五
60。 Sa <1800
a<60。
2A/ * cosa * s/Ma (11)其中a;a'^ ^/为拐角处最大加速度约東速度，~max为各轴最大加速度"，ax、 "y、 ":_的总描述，"为数控系统插补周期，y'"w分别代表前一路径段X义Z轴的坐标.7,分别代表后 一 路径段U,Z轴的坐标，
V^7^7^7为前一路径段的长度，Vd、,为后-路径段
的长度；
wrarWFe/为拐角处轮廓误差约東速度，五为最大轮廓误差要求，a为
两相邻路径段之间的夹角，"为数控系统插补周期。
上述拐角处最大加速度约東速度计算公式的推导过程如下如图2U)所示，在刀具从f点运动到p,+,点过程中，为避免机床结构200710159295.7
说明书第7/12页
承受过大的动力冲击，必须限制拐角f处的进给速度，即f处的进给速度变化必须满足最大加速度的约東。在前瞻处理过程中计算出f处最大加速度约東速度。
用( 、.， )表示在曲线拐角前的切线矢
5+l
(、+1， )表示曲线拐角后的切线矢量。图中标记的黑点是规划出
的轨迹点，图2 (b)是折射到各轴上的速度点。从图2(b)中可以看出，y轴在相邻路径段的拐角处有速度跳跃。根据最大加速度约束，进给速度变化应小于a皿Af。
假设数控系统插补周期为A/,在f处的最大加速度的约東速度和各轴最大加速度分别为"x/^ J^/、 axmax、 max、 fl__max,根据几何知识可以求出
向量^和向量^巧在坐标轴的单位分量分别为
/2 2 2
)、
力一1
/乂
力一l
7+1/
)。为保
+_y,+I,
证单位周期进给速度变化不超过其最大加速能力，必须满足以下不等式:
X-
+ll
+zw
4
《一 +3^4 +4
+4
4
/《,"4十34"4 V《+k'
根据不等式组(6)可以求出约東速度为
(6)
油巧腿"
(7)
由此，当前瞻规划出拐角f处的进给速度大于加速度的约東速度，需要在轨迹规划过程中进行提前减速处理。
上述拐角处轮廓误差约東速度计算公式的推导过程如下为解决在轨迹规划过程中插补时间不满足插补周期的整数倍问题，可以在转接处插入过度段。该过度段的起点在前一路径段，终止点在下一路径段，长度为一个插补周期内的行程，但需要通过限制拐角处速度来控制产生的轮廓误差。
如图3所示，JS为路径段p,p,—,剩余距离，^C为单位插补周期的步长
也就是实际加工中的路径，由此产生轮廓误差MSC。假设JB与BC之间
的夹角大小为a，插补周期为&,设最大轮廓误差要求为五，轮廓误差约
東速度mw,e/ 。
首先，根据点积公式求出夹角a的值为
户,，P x 户户
'+1 ' ' '—1 (8)
若60。^ct〈180。
w肌
n , e/rwi Fe/ A"l + msec) , ^ 、
￡《-^-1 (9)
若a <60。
五< 2e/Tor/ Fe/ Az cosa w'wa (10) 根据等式(9)、 (10)可以求出轮廓误差约東速度为
'胸""，60。^ 〈180。 A"l+co a) ( 11 )
ct < 60"
在拐角S处引入过渡段会带来轮廓误差，必须通过限制拐角《处的进给 速度来保证轮廓精度达到要求。因此当前瞻规划出拐角《处的进给速度大 于轮廓误差约東速度，需要在轨迹规划过程中进行提前减速处理。
通过求取上述拐角处最大加速度约東速度和拐角处轮廓误差约東速度 中的最小值得到最优拐角要求速度，即
co/7 er Fe/M = m/w(ox/si Fe/卜j, e/rori Ke/^ ) (12)
所述前瞻规划出的第i - 1路径段拐角处所能达到的实际进给速度通过 以下公式计算
-^-^- 2 /化胸卜i
2
Aj2^/ew祸一+ccv7erF^2 》 , (13 )
上述第i - 1路径段拐角处所能达到的实际进给速度推导过程如下 如图4所示，考虑"为数控系统预先设置的加速度；Af为数控系统插 补周期；S为从路径链的总长度；re^e/,—,为第i - 1路径段的要求进给速度； c/7""gl^/,一为第i - 1路径段; ,—2jp,_,减速点之后的要求进给速度；po&"为第i - 1路径段;v2iV,的减速点；丄为减速段的长度；cw""ZFe/,— 为第i -n路径段A— 处的即时速度；cw"w^/,-,为第i _ 1路径段的拐角处要求速度； /aCe/^为第i- 1路径段拐角处所能达到的实际进给速度，即前瞻规划速 度；ox/WFe"为轴最大加速度约束速度；em ri J/e/,—,为轮廓误差约東速度； COr"er&/,_2为第i - 2路径段的拐角处要求速度；/^^/^为第i - 1路径段 的路径长度。
首先，根据前瞻计算出的拐角；v,处加速度约東速度欲/^ ^"、轮廓 误差约東速度,可以求出/ M处拐角处要求速度cw7^K/M为 cower = m /" (ox/si,e;rori ,) (12) 然后，前瞻规划出路径链在/^处所能达到的进给速度/"c/^"为
-^-^- > /oc恥"
2
^2a./^gf/^+09^eH^/^2 》 ( 13 )
如图5所示，计算路径链中减速段长度、反向递推路径链中的减速路 径段以及设置减速路径段的要求进给速度包括以下过程；
若第i- 1路径段拐角处所能达到的速度小于等于第i- 1路径段的拐角
处要求速度，即/aCOcor^^d ,则不需要在插补过程中对路径链进 行减速处理；
若第i - 1路径段拐角处所能达到的速度大于第i - 1路径段的拐角处要 求速度，即/aCe/,—一cw"w&"，需要在轨迹规划过程中对路径链进行减 速处理，计算出减速段长度L为
丄 ^C《,-come7^/二 (14)
通过减速段长度丄递推计算路径链中需要减速的路径段和路径段中的 减速点；根据减速点调节减速路径段的要求进给速度，来实现轨迹规划过 程中路径链进给速度的自适应调节；
若减速段长度小于等于第i-l路径段长度，即丄^
i一 1
路径段p,—^—2能够完成整个减速过程，设置第i - 1路径段减速点之后的要 求进给速度c/^"gKe/,一为第i-l路径段的拐角处要求速度con^rFe/,一，计 算出第i _ 1路径段,/v2的减速点po/""为
-丄 (15)
戶zd若减速段长度大于第i- l路径段长度，即丄>^^=，则第i-l路径 段P,-,A-2长度不能够完成减速过程，需要逆向递推减速路径段和段内减速
点；设置第i _ 1路径段2减速点，&仏为0 (整个路径段都在进行减
速)和第i - 1路径段减速点之后的要求进给速度C/Z^7g^/,—,为第i - 1路径
段的拐角处要求速度con^^e"，重新计算剩余减速长度和第i-2路径段 A—3拐角处速度为
若减速段长度小于等于第i-2路径段长度，即丄<
(16)
(17)
设置第
2路径段^_2/ ,_3的减速点； o/" ,—2为
!一3
-丄和第i-2路径段减速点之
后的要求进给速度为A"wgFe/,^为第i-2路径段的拐角处要求速度 若减速段长度仍大于第i-2路径段长度，即丄〉
向前递推-
路径段，即/ = /_1,重复减速段长度和路径段长度判断过程，直到减速段 长度小于等于路径段长度停止。确保在轨迹规划过程中在任何拐角处的实 际进给速度小于等于拐角处要求速度。
如图6所示，基于滤波技术的加减速策略对路径链进行轨迹规划包括 以下步骤
基于滤波技术的加减速策略对路径链进行轨迹规划包括以下步骤 根据读入路径链总长度及上一周期速度计算出路径链的即时速度
cwre^Fe/，计算当前路径段本次行程和已运行长度 pragma ;
将路径段本次行程pragre^与前瞻规划出的对应路径段减速点po/"/
进行比较；
若pragma 2 po/"/ ，且即时速度cw/rewfFe/大于当前路径段减速点之后 的要求进给速度W"Mg^/ ，为确保在减速过程中速度变化不超出机床所能 承受的最大加速度，令即时速度cwreWFe/等于cwrew^e/-aAf ，将即时速 度cwrew,e/ - aAZ放入滑动滤波器进行滤波延迟补偿，重新计算当前路径 段本次行程和已运行长度；
若pragraw 2 po/W ,且即时速度cwre"fFe/小于等于当前路径段减速点
之后的要求进给速度c/za"gFe/ ,将路径链的即时速度cre^Fe/放入滑动滤
波器进行滤波延迟补偿，重新计算当前路径段本次行程和已运行长度；
若pragma < po/W ,且即时速度cw^^7fFe/大于要求进给速度阳g Fe/,
则令即时速度cre",e/等于要求进给速度m《J^/ ,将路径链的即时速度a^7^^^/放入滑动滤波器进行滤波延迟补偿，重新计算当前路径段本次行 程和已运行长度；
若pragma < ; &"/1 ,且即时速度c^rew/F"e/小于等于要求进给速度 re《Fe/ ，将路径链的即时速度cwre^Fe/放入滑动滤波器进行滤波延迟补
偿，重新计算当前路径段本次行程和已运行长度。
本实施例中，硬件平台采用全数字控制方式，标准工业级IPC板卡， PM-lGHz CPU作为数控系统控制器，轴釆用MECHATROLINK总线控制 方式。基于该平台开发的开放数控系统作为集成一体化的数控系统，充分 发挥了其运算速度快，功能强大等特点，并通过软件完成显示、插补计算、 运动控制等功能。在该数控系统中，运动控制器是核心，釆用基于滤波技 术的速度前瞻控制方法后，其运动控制器的组件结构如图1所示。运动控 制的实现包括四个方面，前瞻规划路径链计算出拐角处各个约東速度，设 置路径链中路径段的要求进给速度；釆用基于滤波技术的减速方法实现路 径链的运动轨迹规划；基于三次样条完成各个轴插补功能；釆用具有前馈 环节的PID算法，实现各轴的伺服控制。
本发明方法测试是在三坐标铣床上，通过加工具有代表性的工件测试 程序来完成的。测试系统釆用编码器反馈，形成全闭环控制系统，驱动通 过交流伺服电机。测试环境的主要技术参数如下
驱动安川电机2II系列交流伺服电机；数控系统CPU PM-lGHz、 RAM-512M、 FLASH-2G、 1/0-32/24、编码器输入-4， D/A输出-4、显示-10.4" 彩色液晶显示；编码器输入比例16384;最大进给率=10000mm/min;最 大加速度=200mm/s2;最大加加速度=500mm/s3;插补周期=0.002秒； 伺服周期=0.0005秒；任务协调执行周期=0.0005秒。
为了验证本发明的有效性做了如下实验，图7是从模具加工常用的 CAD/CAM软件CIMETRON中导出的加工路径图，该路径具有不同尖锐程 度的拐角，并且分别采用由IO个和20个的微小路径段组成。其实验条件 和结果分别如下
(1 )传统速度控制:以进给速度F:10m/min,轮廓误差五《0.001mm, 加工由10个和20个微小路径段组成如图7 - 1所示的路径；
(2)本发明方法基于滤波技术的前瞻速度控制以进给速度 F二10w/min,插补周期Af = 2ww ，轮廓误差五S O.OOlm附，加工由10个和 20个微小路径段组成如图7所示的路径。
比较图8A 8D的速度曲线和9A 9D的加速度曲线可以得到以下结论 第一、观察图8B和图8D中的速度曲线可看出基于滤波技术的速度前 瞻控制方法可以自动识别加工路径拐角，根据拐角尖锐程度不同，按照轮 廓误差要求完成进给速度调节；
第二、对比图8A与图8B以及图8C与图8D中的速度曲线，可以发现 加工过程中进给速度曲线仅于路径形状有关与构成路径的路径段的长短和数目无关。因此解决了由于拟合复杂曲线的路径段非常短，致使加工过程 中加、减速极度频繁的问题；
第三、对比图9A与图9B以及图9C与图9D中的加速度曲线，可以发 现加工程中的加减速次数仅于路径形状有关与构成路径的路径段长短和数 目无关。并且由于在轨迹规划过程中采用基于滤波的技术的加减速策略， 避免了在加减速过程中加速度的突变。
本发明方法将加工路径段链接成路径链，根据拐角处加速度约東和轮 廓误差约東对路径链进行前瞻规划，路径段内釆用基于滤波技术的加减速 策略进行进给速度控制，使的整个插补过程具有高度柔性。试验表明该发 明能够根据加工路径几何特征自适应调节进给速度，实现对复杂曲面的高 速加工。
权利要求
1. 一种基于滤波技术的速度前瞻控制方法，其特征在于包括以下步骤将加工曲线的路径段链接成路径链，前瞻计算出加工曲线拐角处最大加速度约束速度和轮廓误差约束速度；根据各约束速度计算出拐角处速度；对路径链按直线加减速策略进行前瞻整体速度规划得到路径链前瞻规划速度，用拐角处速度与路径链前瞻规划速度的差值作为插补过程中是否提前减速的判据；如果上述差值超过规定的阀值，则计算路径链中减速段长度，反向递推路径链中的减速路径段，设置减速路径段的要求进给速度；按照基于滤波技术的加减速策略对路径链进行轨迹规划，并通过调节减速路径段的要求进给速度来实现加工速度随加工路径几何形态变化而自适应调节。
2. 按权利要求l所述的基于滤波技术的速度前瞻控制方法，其特征在 于所述拐角处最大加速度约東速度和拐角处轮廓误差约東速度根据以下 公式计算<formula>formula see original document page 2</formula>。其中ax/^ Fe/为拐角处最大加速度约東速度，a(11),皿为各轴最大加速度 总描述，A/为数控系统插补周期，乂,w代表前一路径段轴的坐标，代表后 一 路径段x,;r，z轴的坐标，为后一路径段》max为前一路径段的长度，的长度；wraW Fe/为拐角处轮廓误差约束速度，五为最大轮廓误差限制，a为 两相邻路径段之间的夹角，Af为数控系统插补周期。
3. 按权利要求2所述的基于滤波技术的速度前瞻控制方法，其特征在 于通过求取上述拐角处最大加速度约東速度和拐角处轮廓误差约束速度 中的最小值得到第i-1路径段最优拐角处要求速度。
4. 按权利要求1所述的基于滤波技术的速度前瞻控制方法，其特征在<formula>formula see original document page 3</formula>其中a为数控系统预先设置的加速度；A/为数控系统插补周期；S为路 径链的总长度；r^K"为第i-1路径段的要求进给速度；cwm7^《"为 第i - n路径段拐角处即时速度；为第i _ 1路径段拐角处所能达到的实际进给速度，即前瞻规划速度；CW72W^/,—2为第卜2路径段的拐角处要求速度；/e唯U第i-l路径段的路径长度。
5. 按权利要求1所述的基于滤波技术的速度前瞻控制方法，其特征在 于所述计算路径链中减速段长度、反向递推路径链中的减速路径段以及 设置减速路径段的要求进给速度包括以下过程若第i - 1路径段拐角处所能达到的速度小于等于第i - 1路径段的拐角 处要求速度，则不需要在插补过程中对路径链进行减速处理；若第i - 1路径段拐角处所能达到的速度大于第i - 1路径段的拐角处要 求速度，需要在轨迹规划过程中对路径链进行减速处理，计算出减速段长度；通过减速段长度递推计算路径链中需要减速的路径段和路径段中的减速点；根据减速点调节减速路径段的要求进给速度，来实现轨迹规划过程 中路径链进给速度的自适应调节；若减速段长度小于等于第i - 1路径段长度，则第i - 1路径段能够完成 整个减速过程，设置第i - 1路径段减速点之后的要求进给速度为第i - 1路 径段的拐角处要求速度，计算出第i-l路径段的减速点；若减速段长度大于第i-l路径段长度，则第i-l路径段长度不能够完 成减速过程，需要逆向递推减速路径段和段内减速点；设置第i-l路径段 减速点为O和第i - 1路径段减速点之后的要求进给速度为第i - 1路径段的 拐角处要求速度，重新计算剩余减速段长度和第i-2路径段拐角处速度若减速段长度小于等于第i - 2路径段长度，设置第i - 2路径段的减速 点为和第i - 2路径段减速点之后的要求进给速度为为第i _ 2路径段的拐角 处要求速度；若减速段长度仍大于第i-2路径段长度，向前递推一路径段，重复减速段长度和路径段长度判断过程，直到减速段长度小于等于路径段长度停 止。
6. 按权利要求1所述的基于滤波技术的速度前瞻控制方法，其特征在于基于滤波技术的加减速策略对路径链进行轨迹规划包括以下步骤根据读入路径链总长度及上一周期速度计算出路径链的即时速度，计算当前路径段本次行程和已运行长度；将路径段本次行程与前瞻规划出的对应路径段减速点进行比较； 若本次行程大于等于对应路径段减速点，且即时速度大于当前路径段减速点之后的要求进给速度，令即时速度等于该即时速度减去一个插补周期内的速度变化最大值，放入滑动滤波器进行滤波延迟补偿，重新计算当前路径段本次行程并输出。
7. 按权利要求6所述的基于滤波技术的速度前瞻控制方法，其特征在 于若本次行程大于等于对应路径段减速点，且即时速度小于等于当前路 径段减速点之后的要求进给速度，将路径链的即时速度放入滑动滤波器进 行滤波延迟补偿，重新计算当前路径段本次行程和已运行长度。
8. 按权利要求6所述的基于滤波技术的速度前瞻控制方法，其特征在 于若本次行程小于对应路径段减速点，且即时速度大于要求进给速度， 则令即时速度等于要求进给速度，将路径链的即时速度放入滑动滤波器进 行滤波延迟补偿，重新计算当前路径段本次行程和已运行长度。
9. 按权利要求6所述的基于滤波技术的速度前瞻控制方法，其特征在 于若本次行程小于对应路径段减速点，且即时速度小于等于要求进给速 度，将路径链的即时速度放入滑动滤波器进行滤波延迟补偿，重新计算当 前路径段本次行程和已运行长度。
全文摘要
本发明涉及一种基于滤波技术的速度前瞻控制方法，将加工曲线的路径段链接成路径链，前瞻计算出加工曲线拐角处最大加速度约束速度和轮廓误差约束速度；根据各约束速度计算出拐角处速度；对路径链按直线加减速策略进行前瞻整体速度规划得到路径链前瞻规划速度，用拐角处速度与路径链前瞻规划速度的差值作为插补过程中是否提前减速的判据；如果上述差值超过规定的阀值，则计算路径链中减速段长度，反向递推路径链中的减速路径段，设置减速路径段的要求进给速度；对路径链进行轨迹规划，并通过调节减速路径段的要求进给速度来实现加工速度随加工路径几何形态变化而自适应调节。本发明具有柔性自适应控制能力强、执行效率高、速度平滑性好等特点。
文档编号G05B19/4097GK101470434SQ20071015929
公开日2009年7月1日 申请日期2007年12月28日 优先权日2007年12月28日
发明者东 于, 宋桃桃, 张晓辉, 杜少华, 毅 胡 申请人:中国科学院沈阳计算技术研究所有限公司;沈阳高精数控技术有限公司