一种基于有限脉冲响应滤波的样条曲线插补方法技术

本发明专利技术涉及一种基于有限脉冲响应滤波的样条曲线插补方法，所述插补方法包括：进给轴运动学参数约束的进给速度规划；有限脉冲响应滤波引入附加约束条件下的进给速度规划；基于有限脉冲响应滤波的样条曲线插补。本发明专利技术通过建立进给轴加速度、跃度与加工路径进给速度之间关系，规划轴运动学约束的进给速度；在此基础上，建立有限脉冲响应滤波引入的滤波诱导插补误差与进给速度关系，规划插补误差等附加约束下的进给速度；最后，将各类约束条件下的许用进给速度信号进行两次有限脉冲响应滤波，保证速度轮廓的平滑性，实现无需迭代运算且无需前处理的实时快速样条曲线直接插补。前处理的实时快速样条曲线直接插补。前处理的实时快速样条曲线直接插补。

【技术实现步骤摘要】
一种基于有限脉冲响应滤波的样条曲线插补方法


[0001]本专利技术涉及高端装备智能制造
，尤其涉及一种基于有限脉冲滤波的样条曲线插补方法。

技术介绍

[0002]在数控机床或者铣削机器人等数字化制造装备的数控系统中，插补器属于核心部件之一，其功能是根据给定的刀具路径几何形状，生成各进给轴的加工轨迹；为此，规划刀具路径上的进给速度是前提，进给速度规划的合理与否直接决定进给运动效率和平稳性；虽然对于常规的直线/圆弧段刀具路径进给速度规划方法较为成熟，但是对于复杂的自由样条曲线刀具路径而言，由于其曲率等几何信息在任意变化，如何进行实时进给速度仍然是一个具有挑战的事情。
[0003]现有技术中有通过B样条曲线表示进给速度轮廓，进而通过对进给速度曲线控制点的迭代调整，使其满足进给轴驱动能力约束条件；也有通过预处理划分样条曲线上的速度敏感、半敏感和非敏感区间，进而降低实时进给速度规划阶段的计算负担；可见，现有技术难以实现在无需前处理或者无需迭代的前提下，直接在插补器内对样条曲线进行快速实时进给速度规划。

技术实现思路

[0004]本专利技术的目的在于克服现有技术的缺点，提供了一种基于有限脉冲响应滤波的样条曲线插补方法，解决了现有技术中存在的不足。
[0005]本专利技术的目的通过以下技术方案来实现：一种基于有限脉冲响应滤波的样条曲线插补方法，该方法通过建立进给轴加速度、跃度与加工路径进给速度之间关系，规划轴运动学约束的进给速度；在此基础上，建立有限脉冲响应滤波引入的滤波诱导插补误差与进给速度关系，规划插补误差等附加约束下的进给速度；最后，将各类约束条件下的许用进给速度信号进行两次有限脉冲响应滤波，保证速度轮廓的平滑性，实现无需迭代运算且无需前处理的实时快速样条曲线直接插补；其具体包括如下内容：
[0006]第一步、进给轴运动学约束的进给速度规划；
[0007]首先，规划进给轴加速度约束下的进给速度；对于三维空间加工路径，无论其形貌如何，均可计算出其当前位置的曲率半径ρ，故在该位置，三个进给轴X轴、Y轴、Z轴的位置信号为：
[0008][0009]其中，x、y、z分别为X轴、Y轴、Z轴的位置信号，(x0,y0,z0)是样条曲线曲率圆圆心，(n1,n2,n3)表示曲率圆所在平面的法向量，v为进给速度，t为时间；将上式对时间t求二阶导数，可得进给轴X轴、Y轴、Z轴的加速度，分别记为a
x
、a
y
、a
z
，满足：
[0010][0011]记进给轴最大许用加速度为a
max
，则进给轴加速度约束的进给速度v
acc
为：
[0012][0013]其次，规划进给轴跃度约束下的进给速度；将v
acc
关于时间求导，可得进给轴X轴、Y轴、Z轴的跃度，分别记为j
x
、j
y
、j
z
，满足：
[0014][0015]记进给轴最大许用跃度为j
max
，则进给轴加速度约束的进给速度v
jerk
为：
[0016][0017]第二步 有限脉冲响应滤波引入附加约束下的进给速度规划
[0018]首先，根据进给轴最大许用加速度和最大许用跃度，确定两个级联有限脉冲响应滤波器的时间常数；记输入到数控系统中加工代码的指令进给速度为v
p
，第一个和第二个有限脉冲响应滤波器时间常数分别为T1和T2，则为了保证切向加速度和跃度在进给轴许用加速度和跃度范围内，T1和T2为：
[0019][0020]其次，规划有限脉冲响应滤波诱导插补误差约束的进给速度；基于二阶泰勒级数展开，建立有限脉冲响应滤波诱导插补误差∈与进给速度之间关系模型为：
[0021][0022]记有限脉冲响应滤波诱导插补误差约束的进给速度为v
∈
，有限脉冲响应滤波诱导
插补误差许用值为∈
max
，则v
∈
可根据关系模型公式计算为：
[0023][0024]接下来，规划最大相角滞后约束的进给速度；为了保证关系模型具有足够的近似精度，须对相角滞后进行限制，记许用最大滞后相角为则最大相角滞后约束的进给速度v
ph
为：
[0025][0026]第三步 基于有限脉冲响应滤波的样条曲线插补
[0027]首先，根据前述两步骤中各约束条件下的进给速度，计算当前位置各约束协同作用下的许用进给速度v
sc
：
[0028][0029]其次，生成各进给轴滤波前进给速度；根据当前位置样条曲线单位切向量在X、Y、Z方向分量分别乘以v
sc
，获得进给轴X轴、Y轴、Z轴滤波前进给速度，记为v
sx
、v
sy
、v
sz
；
[0030]接下来，对X轴、Y轴、Z轴滤波前进给速度v
sx
、v
sy
、v
sz
进行两次有限脉冲响应滤波，两个有限脉冲响应滤波器时域模型分别为：
[0031][0032][0033]X轴、Y轴、Z轴滤波后进给速度v
fx
、v
fy
、v
fz
即为：
[0034][0035]其中，*表示卷积运算；
[0036]最后，生成各进给轴位置指令；分别将X轴、Y轴、Z轴滤波后进给速度v
fx
、v
fy
、v
fz
对时间积分，即可获得X轴、Y轴、Z轴位置指令p
x
、p
y
、p
z
，将p
x
、p
y
、p
z
输入到各进给轴伺服控制系统中，即可实现数控机床对样条曲线的实时插补跟踪。
[0037]本专利技术具有以下优点：通过建立进给轴加速度、跃度与加工路径进给速度之间关系，规划轴运动学约束的进给速度；在此基础上，建立有限脉冲响应滤波引入的滤波诱导插补误差与进给速度关系，规划插补误差等附加约束下的进给速度；最后，将各类约束条件下的许用进给速度信号进行两次有限脉冲响应滤波，保证速度轮廓的平滑性，实现无需迭代运算且无需前处理的实时快速样条曲线直接插补。
附图说明
[0038]图1为本专利技术方法的流程示意图；
[0039]图2为空间直角坐标系中样条曲线加工路径示意图；
[0040]图3为本专利技术插补得到的各进给轴加速度示意图；
[0041]图4为本专利技术插补得到的各进给轴跃度示意图；
[0042]图5为本专利技术插补得到的插补误差示意图。
具体实施方式
[0043]为使本申请实施例的目的、技术方案和优点更加清楚，下面将结合本申请实施例中附图，对本申请实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本申请一部分实施例本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于有限脉冲响应滤波的样条曲线插补方法，其特征在于：所述插补方法包括：建立进给轴加速度、跃度与加工路径进给速度之间的关系，规划轴运动学参数约束的进给速度；建立有限脉冲响应滤波引入的滤波诱导插补误差与进给速度关系，规划插补误差附加约束下的进给速度；将各类约束条件下的许用进给速度信号进行两次有限脉冲响应滤波，保证速度轮廓的平滑性，实现无需迭代运算且无需前处理的实时快速样条曲线直接插补。2.根据权利要求1所述的一种基于有限脉冲响应滤波的样条曲线插补方法，其特征在于：所述建立进给轴加速度、跃度与加工路径进给速度之间的关系，规划轴运动学参数约束的进给速度包括：规划进给轴加速度约束下的进给速度步骤和规划进给轴跃度约束下的进给速度步骤。3.根据权利要求2所述的一种基于有限脉冲响应滤波的样条曲线插补方法，其特征在于：所述规划进给轴加速度约束下的进给速度步骤包括：对于三维空间加工路径，计算出其当前位置的曲率半径ρ，得到在该位置三个进给轴X轴、Y轴、Z轴的位置信号为将三个进给轴X轴、Y轴、Z轴的位置信号对时间t求二阶导数，可得进给轴X轴、Y轴、Z轴的加速度a
x
、a
y
、a
z
，且满足设进给轴最大许用加速度为a
max
，则进给轴加速度约束下的进给速度v
acc
为4.根据权利要求3所述的一种基于有限脉冲响应滤波的样条曲线插补方法，其特征在于：所述规划进给轴跃度约束下的进给速度步骤包括：将所述进给轴X轴、Y轴、Z轴的加速度a
x
、a
y
、a
z
对时间t求导，得到进给轴X轴、Y轴、Z轴的
跃度j
x
、j
y
、j
z
，且满足设进给轴最大许用跃度为j
max
，则进给轴加速度约束的进给速度v
jerk
为5.根据权利要求1所述的一种基于有限脉冲响应滤波的样条曲线插补方法，其特征在于：所述建立有限脉冲响应滤波引入的滤波诱导插补误差与进给速度关系，规划插补误差附加约束下的进给速度包括：根据进给轴最大许用加速度和最大许用跃度，确定两个级联有限脉冲响应滤波器的时间常数；规划有限脉冲响应滤波诱导插补误差约束下的进给速度；规划最大相角滞后约束下的进给速度。6.根据权利要求5所述的一种基于有限脉冲响应滤波的样条曲线插补方法，其特征在于：所述根据进给轴最大许用加速度和最大许用跃度，确定两个级联有限脉冲响应滤波器的时间常数包括：设输入到数控系统...

【专利技术属性】
技术研发人员：宋得宁，马建伟，姚建均，钟宇光，周超，
申请(专利权)人：哈尔滨工程大学，
类型：发明
国别省市：