CN104076743B - 一种自识别插补种类的插补控制方法 - Google Patents

一种自识别插补种类的插补控制方法 Download PDF

Info

Publication number
CN104076743B
CN104076743B CN201410319680.3A CN201410319680A CN104076743B CN 104076743 B CN104076743 B CN 104076743B CN 201410319680 A CN201410319680 A CN 201410319680A CN 104076743 B CN104076743 B CN 104076743B
Authority
CN
China
Prior art keywords
value
spline
interpolation
prime
section
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201410319680.3A
Other languages
English (en)
Other versions
CN104076743A (zh
Inventor
杨亮亮
许守金
史伟民
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Jiangsu Sifang Packaging Paper Industry Co ltd
Original Assignee
Zhejiang Sci Tech University ZSTU
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Zhejiang Sci Tech University ZSTU filed Critical Zhejiang Sci Tech University ZSTU
Priority to CN201410319680.3A priority Critical patent/CN104076743B/zh
Publication of CN104076743A publication Critical patent/CN104076743A/zh
Application granted granted Critical
Publication of CN104076743B publication Critical patent/CN104076743B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Abstract

一种自识别插补种类的插补控制方法,利用图形采集设备和matlab软件获得加工位置点信息,利用B样条理论构造固定不变的一组基函数,反算控制点,利用B样条均参数理论,计算加工轨迹的曲率变化,根据曲率变化特点对加工轨迹的插补类型进行自动识别。对样条插补段根据弓高误差计算出速度限制曲线,对根据弓高误差求出的速度限制值与给定的最大限制速度进行判断,取二者的较小值,构成新的速度限制曲线。对于圆弧插补段、直线插补段计算特征值,进而进行相应插补计算。本发明提供了一种能自动对插补种类进行识别的插补控制方法,利用基函数固定的B样条理论进行插补计算,有效提高了加工的精度和效率的一种自识别插补种类的插补控制方法。

Description

一种自识别插补种类的插补控制方法
技术领域
该发明涉及数控系统领域,,特别是数控机床以及其他涉及路径规划的领域,是一种自识别插补种类的插补控制方法。
背景技术
数控系统领域的核心是数控插补技术,与国外一些发达国家的产品相比,中国的数控机床技术仍然较为落后,特别是在高速高精方面。中国正处于工业转型期,汽车、钢铁、机械、电子等行业的高速增长,构成了对数控机床的巨大需要,但是其核心技术即插补技术仍然存在着诸多问题。
在加工一些较为复杂的曲线、曲面时,刀具的路径轨迹,可能是自由型曲线,也可能是圆弧或者直线,如果只是用人工识别,进而发出指令,一些轮廓人眼很难识别。只是用圆弧或者直线插补进行拟合刀具加工轨迹时,必然带来精度不够高的问题;但是如果只是用样条插补,虽然对自由型曲线和直线插补出的精度足够高,一般能满足要求,但是对圆弧型曲线段进行样条插补就存在加工精度和效率的问题,并且如果对轨迹是直线的路径仍然利用样条进行插补的话,加工效率也会大为的降低。
高精度的加工曲线轮廓一般都是用极为短小的直线段进行逼近,直线段越短,逼近的误差就越小。对一些具有突变点的曲线,在加工这些突变点时,加工速度必然要降低,否则很难满足加工要求,但是整个曲线段都按突变点的速度限制,必然会带来加工的效率低下,这就带来加工精度和效率的规划问题。
对加工路径轨迹的分段理论很多,但是大多数都是简单进行分段,没有涉及自动区分插补类型,也没有涉及每段的始末速度以及最大速度限制变化,简单的分段很难满足对精度和效率的要求。
发明内容
本发明为克服现有技术的上述不足,提供一种计算量少、简单的均匀B样条方法,采取一种能自动识别插补种类的插补控制方法,有效的解决插补种类的识别,分段、启停、加工精度不够高等问题的一种自识别插补种类的插补控制方法。
所述一种自识别插补种类的插补控制方法包括以下步骤:
第一步,利用图形采集设备对工件进行拍照,利用matlab软件对照片进行处理,获得加工位置点信息。
第二步,构造均匀B样条曲线,根据样条插补的要求以及B样条特性,节点向量取值形式为:
U=[-p+1,-p+2,...,0,1,2,...,p] (1)
其中p是样条基函数的次数。由样条基函数递推公式可以得到均匀B样条基函数计算公式,具体公式如下所示:
N n , p ( u ) = 1 p ! Σ j = 0 p ( - 1 ) j C p + i j ( u + p - n - j ) p u ∈ [ 0,1 ] , n = 0,1 , . . . , p - - - ( 2 )
其中p是样条基函数的次数,n是基函数的序列号,u是变化参数。
假设给定m+p+1个控制点可得B样条曲线Pk(u),计算公式如下所示:
P k ( u ) = Σ n = 0 p P k + n N n , p ( u ) 0 ≤ u ≤ 1 k = 0,1 , · · · , m - - - ( 3 )
其中Pk(u)为p次B样条的第k段曲线,p是样条基函数的次数,n是基函数的序列号,u是变化参数,Nn,p(u)是相应的基函数,Pk+n是第k+n个控制点。
它的全体(m+1段)称为n次B样条曲线。如果参数u取0,随着控制点的变化可得到一组样条曲线上的点即边界通过点,如果已知这些边界通过点便可以根据这些通过点反算出控制点。第一步已经得到加工轨迹的位置点信息即边界通过点,进而根据位置点信息利用公式3反算控制点。
第三步,利用均匀B样条均参数理论对路径轨迹的插补种类进行自动识别。根据样条均参数理论,u值均匀变化,求出每个插补点的一阶导数与二阶导数,计算每个插补点处的曲率,计算公式如下:
K = x ′ ( u ) y ′ ′ ( u ) - x ′ ′ ( u ) y ′ ( u ) ( x ′ ( u ) 2 + y ′ ( u ) 2 ) 3 - - - ( 4 )
其中x'(u)表示用B样条方法表示的x值关于u值的一阶导数,其中y'(u)表示用B样条方法表示的y值关于u值的一阶导数。x''(u)表示用B样条方法表示的x值关于u值的二阶导数,其中y''(u)表示用B样条方法表示的y值关于u值的二阶导数。
根据曲率的变化,对加工轨迹类型进行自动识别,当某段曲率为零或者接近零时,记录此段的始末u值,对此段进行直线插补;当某段曲率相同或者曲率之间的差额小到一定值时,可认为此段是圆弧,记录此段的始末u值,对此段进行圆弧插补;当某段曲率变化没有规律时,可认为是自由型曲线,记录始末u值,对此段进行样条插补。
第四步,对于样条插补段进行前瞻预判分段。
根据控制点、采样周期、弓高误差限制要求,利用均参数B样条理论生成插补曲线,求出速度限制曲线。弓高误差限制下的速度计算公式:
v = 2 e ( 2 - ( x ′ ( u ) 2 + y ′ ( u ) 2 ) 3 x ′ ( u ) y ′ ′ ( u ) - x ′ ′ ( u ) y ′ ( u ) - e ) Ts - - - ( 5 )
其中x'(u)表示用B样条方法表示的x值关于u值的一阶导数,其中y'(u)表示用B样条方法表示的y值关于u值的一阶导数。x''(u)表示用B样条方法表示的x值关于u值的二阶导数,其中y''(u)表示用B样条方法表示的y值关于u值的二阶导数,Ts是采样周期,e是弓高误差。通过上面的公式,可以建立每个坐标位置下的速度限制曲线。
在路径规划时,加工速度有可能会出现二种情况,一种是满足给定的最大限制速度要求,但是无法满足根据弓高误差求出的速度限制要求;另外一种情况是满足根据弓高误差求出的速度限制要求,却无法满足给定的最大限制速度要求。所以为了保证加工精度,需要对根据弓高误差求出的速度限制值与给定的最大限制速度进行判断,取二者的较小值,构成新的速度限制曲线,以保证加工过程中对加工精度要求。
根据求出的速度限制曲线,得到样条插补段的速度极小值和极大值,以及对应的u值。根据速度极小值记录的u值,可得到u值对应的位置,进而根据速度极小值对应的位置信息对样条插补段进行分段。每段路径进行实际规划时,最大限制速度要取速度限制曲线上对应的极大值进行规划。速根据上述公式5,求出速度极值,具体的计算公式为:
v m = 2 e ( 2 - ( x , ( u 1 ) 2 + y , ( u 1 ) 2 ) 3 x , ( u 1 ) y , , ( u 1 ) - x , , ( u 1 ) y , ( u 1 ) - e ) Ts - - - ( 6 )
其中ul是速度极值点对应的u值,x'(u)表示用B样条方法表示的x值关于u值的一阶导数,其中y'(u)表示用B样条方法表示的y值关于u值的一阶导数。x''(u)表示用B样条方法表示的x值关于u值的二阶导数,其中y''(u)表示用B样条方法表示的y值关于u值的二阶导数,Ts是采样周期,e是弓高误差。
为了避免机床的在每段路径上反复启停,每段速度变化都是从一个极小值到另一个极小值。最后对每段利用S型路径规划理论求出时间点,再利用B样条非均匀理论进行样条插补计算。
第五步,对圆弧插补段特征值进行计算,对圆弧进行插补,需要知道圆弧段的圆心、半径、始末点等信息。
通过圆弧段记录的始末u值u0、u1,可以得到圆弧始末点p0、p1,计算公式如下:
p 0 = Σ n = 0 p P k + n N n , p ( u 0 ) p 1 = Σ n = 0 p P k + n N n , p ( u 1 ) - - - ( 7 )
其中p是样条基函数的次数,n是基函数的序列号,Nn,p(u)是相应的基函数,Pk+n是第k+n个控制点。
圆弧半径是此段曲率的倒数,圆弧圆心的计算公式为:
d = ( x 0 - x 1 ) 2 + ( y 0 - y 1 ) 2 R = ( o x - x 0 + x 1 2 ) 2 + ( o y - y 0 + y 1 2 ) 2 + d 2 4 R = ( x 0 - o x ) 2 + ( y 0 - o y ) 2 - - - ( 8 )
其中(x0,y0)是圆弧起始点p0的横纵坐标,(x1,y1)是圆弧末尾点p1的横纵坐标,d是圆弧起始点之间的弦长,(ox,oy)是圆弧圆心的横纵坐标,(ox,oy)是未知量可以通过上述方程组求解得到。知道圆心、半径、圆弧始末点即可进行圆弧插补。
第六步,对直线段特征值进行计算,直线段由于没有弓高误差的限制,所以插补起来较为简单。通过直线段记录的始末u值,计算出直线段首末点,进而求出两点之间的距离S,进行直线插补计算。
本发明与现有技术相比具有如下优点和效果:
对刀具加工轨迹的插补类型进行自动识别分类,对加工复杂的曲线,通过对自动选择插补种类,能有效的提高插补精度和效率,解决人工识别不够准确的弊端。采用均匀B样条,构造不变的一组基函数,相比其他类型的样条方法,计算量会大为的减少,插补效率会大幅度提升。对于样条插补段根据弓高误差计算出速度限制曲线,为了保证加工精度,需要对根据弓高误差求出的速度限制值与给定的最大限制速度进行判断,取二者的较小值,构成新的速度限制曲线。通过速度限制曲线可对样条型曲线段进行分段、确定始末速度,能有效的减少计算量,提高了插补效率。
附图说明
图1是本发明方法的插补流程图。
图2是本发明方法的加工轨迹示意图,1表示样条插补段,2表示直线插补段,3表示圆弧插补段,4表示样条插补段。
图3是本发明方法表示样条插补段采用均参数B样条理论生成的位置坐标曲线与利用弓高误差求出的速度限制曲线的对应关系。上半部分表示速度限制曲线,下半部分表示对应的位置变化曲线。
图4是本发明方法表示圆弧段计算特征值时始末点、圆心、半径之间的几何关系。
具体实施方式
下面结合附图和实施例对本发明进一步说明,参照附图:
如图1,一种自识别插补种类的插补控制方法,包括以下步骤:
第一步,利用图形采集设备对工件进行拍照,利用matlab软件对照片进行处理,获得加工位置点信息。
第二步,构造均匀B样条曲线,根据样条插补的要求以及B样条特性,节点向量取值形式为:
U=[-p+1,-p+2,...,0,1,2,...,p] (1)
其中p是样条基函数的次数。由样条基函数递推公式可以得到均匀B样条基函数计算公式,具体公式如下所示:
N n , p ( u ) = 1 p ! Σ j = 0 p ( - 1 ) j C p + i j ( u + p - n - j ) p u ∈ [ 0,1 ] , n = 0,1 , . . . , p - - - ( 2 )
其中p是样条基函数的次数,n是基函数的序列号,u是变化参数。
假设给定m+p+1个控制点可得B样条曲线Pk(u),计算公式如下所示:
P k ( u ) = Σ n = 0 p P k + n N n , p ( u ) 0 ≤ u ≤ 1 k = 0,1 , · · · , m - - - ( 3 )
其中Pk(u)为p次B样条的第k段曲线,p是样条基函数的次数,n是基函数的序列号,u是变化参数,Nn,p(u)是相应的基函数,Pk+n是第k+n个控制点。
它的全体(m+1段)称为n次B样条曲线。如果参数u取0,随着控制点的变化可得到一组样条曲线上的点即边界通过点,如果已知这些边界通过点便可以根据这些通过点反算出控制点。第一步已经得到加工轨迹的位置点信息即边界通过点,进而根据位置点信息利用公式3反算控制点。
第三步,利用均匀B样条均参数理论对路径轨迹的插补种类进行自动识别。根据样条均参数理论,u值均匀变化,求出每个插补点的一阶导数与二阶导数,计算每个插补点处的曲率,计算公式如下:
K = x ′ ( u ) y ′ ′ ( u ) - x ′ ′ ( u ) y ′ ( u ) ( x ′ ( u ) 2 + y ′ ( u ) 2 ) 3 - - - ( 4 )
其中x'(u)表示用B样条方法表示的x值关于u值的一阶导数,其中y'(u)表示用B样条方法表示的y值关于u值的一阶导数。x''(u)表示用B样条方法表示的x值关于u值的二阶导数,其中y''(u)表示用B样条方法表示的y值关于u值的二阶导数。
根据曲率的变化,对加工轨迹类型进行自动识别,当某段曲率为零或者接近零时,记录此段的始末u值,对此段进行直线插补;当某段曲率相同或者曲率之间的差额小到一定值时,可认为此段是圆弧,记录此段的始末u值,对此段进行圆弧插补;当某段曲率变化没有规律时,可认为是自由型曲线,记录始末u值,对此段进行样条插补。
第四步,对于样条插补段进行前瞻预判分段。
根据控制点、采样周期、弓高误差限制要求,利用均参数B样条理论生成插补曲线,求出速度限制曲线。弓高误差限制下的速度计算公式:
v = 2 e ( 2 - ( x ′ ( u ) 2 + y ′ ( u ) 2 ) 3 x ′ ( u ) y ′ ′ ( u ) - x ′ ′ ( u ) y ′ ( u ) - e ) Ts - - - ( 5 )
其中x'(u)表示用B样条方法表示的x值关于u值的一阶导数,其中y'(u)表示用B样条方法表示的y值关于u值的一阶导数。x''(u)表示用B样条方法表示的x值关于u值的二阶导数,其中y''(u)表示用B样条方法表示的y值关于u值的二阶导数,Ts是采样周期,e是弓高误差。通过上面的公式,可以建立每个坐标位置下的速度限制曲线。
在路径规划时,加工速度有可能会出现二种情况,一种是满足给定的最大限制速度要求,但是无法满足根据弓高误差求出的速度限制要求;另外一种情况是满足根据弓高误差求出的速度限制要求,却无法满足给定的最大限制速度要求。所以为了保证加工精度,需要对根据弓高误差求出的速度限制值与给定的最大限制速度进行判断,取二者的较小值,构成新的速度限制曲线,以保证加工过程中对加工精度要求。
根据求出的速度限制曲线,得到样条插补段的速度极小值和极大值,以及对应的u值。根据速度极小值记录的u值,可得到u值对应的位置,进而根据速度极小值对应的位置信息对样条插补段进行分段。每段路径进行实际规划时,最大限制速度要取速度限制曲线上对应的极大值进行规划。速根据上述公式5,求出速度极值,具体的计算公式为:
v m = 2 e ( 2 - ( x , ( u 1 ) 2 + y , ( u 1 ) 2 ) 3 x , ( u 1 ) y , , ( u 1 ) - x , , ( u 1 ) y , ( u 1 ) - e ) Ts - - - ( 6 )
其中ul是速度极值点对应的u值,x'(u)表示用B样条方法表示的x值关于u值的一阶导数,其中y'(u)表示用B样条方法表示的y值关于u值的一阶导数。x(u)表示用B样条方法表示的x值关于u值的二阶导数,其中y''(u)表示用B样条方法表示的y值关于u值的二阶导数,Ts是采样周期,e是弓高误差。
为了避免机床的在每段路径上反复启停,每段速度变化都是从一个极小值到另一个极小值。最后对每段利用S型路径规划理论求出时间点,再利用B样条非均匀理论进行样条插补计算。
第五步,对圆弧插补段特征值进行计算,对圆弧进行插补,需要知道圆弧段的圆心、半径、始末点等信息。
通过圆弧段记录的始末u值u0、u1,可以得到圆弧始末点p0、p1,计算公式如下:
p 0 = Σ n = 0 p P k + n N n , p ( u 0 ) p 1 = Σ n = 0 p P k + n N n , p ( u 1 ) - - - ( 7 )
其中p是样条基函数的次数,n是基函数的序列号,Nn,p(u)是相应的基函数,Pk+n是第k+n个控制点。
圆弧半径是此段曲率的倒数,圆弧圆心的计算公式为:
d = ( x 0 - x 1 ) 2 + ( y 0 - y 1 ) 2 R = ( o x - x 0 + x 1 2 ) 2 + ( o y - y 0 + y 1 2 ) 2 + d 2 4 R = ( x 0 - o x ) 2 + ( y 0 - o y ) 2 - - - ( 8 )
其中(x0,y0)是圆弧起始点p0的横纵坐标,(x1,y1)是圆弧末尾点p1的横纵坐标,d是圆弧起始点之间的弦长,(ox,oy)是圆弧圆心的横纵坐标,(ox,oy)是未知量可以通过上述方程组求解得到。知道圆心、半径、圆弧始末点即可进行圆弧插补。
第六步,对直线段特征值进行计算,直线段由于没有弓高误差的限制,所以插补起来较为简单。通过直线段记录的始末u值,计算出直线段首末点,进而求出两点之间的距离S,进行直线插补计算。
如图2,在加工一些较为复杂的曲线、曲面时,刀具的路径轨迹,可能是自由型曲线图中1、4所示,也可能是圆弧图中3所示或者直线图中2所示,如果只是用人工识别,进而发出指令,一些轮廓人眼很难识别。只是用圆弧或者直线插补进行拟合刀具加工轨迹时,必然带来精度不够高的问题;但是如果只是用样条插补,虽然对自由型曲线和直线插补出的精度足够高,一般能满足要求,但是对圆弧型曲线段进行样条插补就存在加工精度和效率的问题,并且如果对轨迹是直线的路径仍然利用样条进行插补的话,加工效率也会大为的降低。
如图3,坐标拐点A、C、E对应的速度较小,如果要保证加工精度,这些点的进给速度一定不能大于根据弓高误差求出的速度限制,但如果整个自由型曲线段轨迹速度都按照这些速度极小值运行,就会影响加工效率。因此综合考虑效率和精度问题,可以根据这些速度极小值所对应u值,对自由型曲线段进行分段处理。如果每段进行轨迹规划的时候,每段的速度都是从零开始的加速过程和到零速停止的减速过程,就会导致极为频繁的启停过程,不但降低了加工效率而且对机床造成了过多的冲击,也会导致工件加工表面质量的降低。
从图3可以看出限制速度是一条连续变化的曲线,在实际加工时加工速度有可能会出现二种情况,一种是满足给定的最大限制速度要求,但是无法满足根据弓高误差求出的速度限制要求;另外一种情况是满足根据弓高误差求出的速度限制要求,却无法满足给定的最大限制速度要求。所以为了保证加工精度,需要对根据弓高误差求出的速度限制值与给定的最大限制速度进行判断,取二者的较小值,构成新的速度限制曲线,以保证加工过程中对加工精度要求。
为此本发明根据速度限制曲线进行路径规划,提取速度极小值和极大值以及对应的u值。根据速度极小值进行分段,并初步确定每段速度的始末值,根据速度限制曲线的极大值作为每段最大限制速度进行路径规划。进行始末速度前瞻规划,从最后一段开始,逐段判断末速度能否加速到初速度,否的话对初速度进行更新替换。再从第一段开始,逐段判断初速度能否加速到末速度,否的话对末速度进行更新替换。实际规划时的初速度要根据实际运行时的前一段的末速度,确定下一段的初速度,有效解决机床的频繁启动问题和弓高误差超限问题。
如图4实施例表明,通过圆弧段记录的始末u值u0、u1,可以得到圆弧始末点p0、p1,计算公式如下:
p 0 = Σ n = 0 p P k + . n N n , p ( u 0 ) p 1 = Σ n = 0 p P k + . n N n , p ( u 1 ) - - - ( 7 )
其中p是样条基函数的次数,n是基函数的序列号,Nn,p(u)是相应的基函数,Pk+n是第k+n个控制点。
圆弧半径是此段曲率的倒数,圆弧圆心的计算公式为:
d = ( x 0 - x 1 ) 2 + ( y 0 - y 1 ) 2 R = ( o x - x 0 + x 1 2 ) 2 + ( o y - y 0 + y 1 2 ) 2 + d 2 4 R = ( x 0 - o x ) 2 + ( y 0 - o y ) 2 - - - ( 8 )
其中(x0,y0)是圆弧起始点p0的横纵坐标,(x1,y1)是圆弧末尾点p1的横纵坐标,d是圆弧起始点之间的弦长,(ox,oy)是圆弧圆心的横纵坐标,(ox,oy)是未知量可以通过上述方程组求解得到。知道圆心、半径、圆弧始末点即可进行圆弧插补。
显而易见,在不偏离本发明的真实精神和范围的前提下,在此描述的本发明可以有许多变化。因此,所有对于本领域技术人员来说显而易见的改变,都应包括在本权利要求书所涵盖的范围之内。
本发明所要求保护的范围仅由所述的权利要求书进行限定。

Claims (2)

1.一种自识别插补种类的插补控制方法,其特征在于步骤如下:
第一步,利用图形采集设备对工件进行拍照,利用matlab软件对照片进行处理,获得加工位置点信息;
第二步,构造均匀B样条曲线,根据样条插补的要求以及B样条特性,节点向量取值形式为:
U=[-p+1,-p+2,...,0,1,2,...,p] (1)
其中p是样条基函数的次数,由样条基函数递推公式可以得到均匀B样条基函数计算公式,具体公式如下所示:
N n , p ( u ) = 1 p ! Σ j = 0 p ( - 1 ) j C p + i j ( u + p - n - j ) p u ∈ [ 0 , 1 ] , n = 0 , 1 , ... , p - - - ( 2 )
其中p是样条基函数的次数,n是基函数的序列号,u是变化参数,假设给定m+p+1个控制点可得B样条曲线Pk(u),计算公式如下所示:
P k ( u ) = Σ n = 0 p P k + n N n , p ( u ) 0 ≤ u ≤ 1 k = 0 , 1 , ... , m - - - ( 3 )
其中Pk(u)为p次B样条的第k段曲线,p是样条基函数的次数,n是基函数的序列号,u是变化参数,Nn,p(u)是相应的基函数,Pk+n是第k+n个控制点,它的全体,即m+1段,称为n次B样条曲线,如果参数u取0,随着控制点的变化可得到一组样条曲线上的点即边界通过点,如果已知这些边界通过点便可以根据这些通过点反算出控制点,第一步已经得到加工位置点信息即边界通过点,进而根据位置点信息利用公式(3)反算控制点;
第三步,利用均匀B样条均参数理论对加工轨迹的插补种类进行自动识别:根据样条均参数理论,u值均匀变化,求出每个插补点的一阶导数与二阶导数,计算每个插补点处的曲率,计算公式如下:
K = x ′ ( u ) y ′ ′ ( u ) - x ′ ′ ( u ) y ′ ( u ) ( x ′ ( u ) 2 + y ′ ( u ) 2 ) 3 - - - ( 4 )
其中x′(u)表示用B样条方法表示的x值关于u值的一阶导数,其中y′(u)表示用B样条方法表示的y值关于u值的一阶导数;x″(u)表示用B样条方法表示的x值关于u值的二阶导数,其中y″(u)表示用B样条方法表示的y值关于u值的二阶导数;
根据曲率的变化,对加工轨迹类型进行自动识别,当某段曲率为零或者接近零时,记录此段的始末u值,对此段进行直线插补;当某段曲率相同或者曲率之间的差额小到一定值时,可认为此段是圆弧,记录此段的始末u值,对此段进行圆弧插补;当某段曲率变化没有规律时,可认为是自由型曲线,记录始末u值,对此段进行样条插补;
第四步,对于样条插补段进行前瞻预判分段:根据控制点、采样周期、弓高误差限制要求,利用均匀B样条均参数理论生成插补曲线,求出速度限制曲线;弓高误差限制下的速度计算公式:
v = 2 e ( 2 ( x ′ ( u ) 2 + y ′ ( u ) 2 ) 3 x ′ ( u ) y ′ ′ ( u ) - x ′ ′ ( u ) y ′ ( u ) - e ) T s - - - ( 5 )
其中x′(u)表示用B样条方法表示的x值关于u值的一阶导数,其中y′(u)表示用B样条方法表示的y值关于u值的一阶导数;x″(u)表示用B样条方法表示的x值关于u值的二阶导数,其中y″(u)表示用B样条方法表示的y值关于u值的二阶导数;Ts是采样周期,e是弓高误差;通过上面的公式,可以建立每个坐标位置下的速度限制曲线;
在路径规划时,加工速度有可能会出现二种情况,一种是满足给定的最大限制速度要求,但是无法满足根据弓高误差求出的速度限制要求;另外一种情况是满足根据弓高误差求出的速度限制要求,却无法满足给定的最大限制速度要求,所以为了保证加工精度,需要对根据弓高误差求出的速度限制值与给定的最大限制速度进行判断,取二者的较小值,构成新的速度限制曲线,以保证加工过程中对加工精度要求;
根据求出的速度限制曲线,得到样条插补段的速度极小值,以及对应的u值;根据速度极小值记录的u值,可得到u值对应的位置,进而根据速度极小值对应的位置信息对样条插补段进行分段,每段路径进行实际规划时,最大限制速度要取速度限制曲线上对应的极大值进行规划,根据上述公式(5),求出速度极值,具体的计算公式为:
v min = 2 e ( 2 ( x ′ ( u l ) 2 + y ′ ( u l ) 2 ) 3 x ′ ( u l ) y ′ ′ ( u l ) - x ′ ′ ( u l ) y ′ ( u l ) - e ) T s - - - ( 6 )
其中ul是速度极值点对应的u值,
其中x′(u)表示用B样条方法表示的x值关于u值的一阶导数,其中y′(u)表示用B样条方法表示的y值关于u值的一阶导数;x″(u)表示用B样条方法表示的x值关于u值的二阶导数,其中y″(u)表示用B样条方法表示的y值关于u值的二阶导数;Ts是采样周期,e是弓高误差;
为了避免机床的在每段路径上反复启停,每段速度变化都是从一个极小值到另一个极小值,最后对每段利用S型路径规划理论求出时间点,再利用B样条非均匀理论进行样条插补计算;
第五步,对圆弧插补段特征值进行计算,对圆弧进行插补,需要知道圆弧段的圆心、半径、始末点信息;
通过圆弧段记录的始末u值u0、u1,可以得到圆弧始末点p0、p1,计算公式如下:
p 0 = Σ n = 0 p P k + n N n , p ( u 0 )
p 1 = Σ n = 0 p P k + n N n , p ( u 1 ) - - - ( 7 )
其中p是样条基函数的次数,n是基函数的序列号,Nn,p(u)是相应的基函数,Pk+n是第k+n个控制点,圆弧半径是此段曲率的倒数,圆弧圆心的计算公式为:
d = ( x 0 - x 1 ) 2 + ( y 0 - y 1 ) 2 R = ( o x - x 0 + x 1 2 ) 2 + ( o y - y 0 + y 1 2 ) 2 + d 2 4 R = ( x 0 - o x ) 2 + ( y 0 - o y ) 2 - - - ( 8 )
其中(x0,y0)是圆弧起始点p0的横纵坐标,(x1,y1)是圆弧末尾点p1的横纵坐标,d是圆弧起始点与末尾点之间的弦长,R是圆弧半径,(ox,oy)是圆弧圆心的横纵坐标,(ox,oy)是未知量可以通过上述方程组求解得到;知道圆心、半径、圆弧始末点即可进行圆弧插补;
第六步,对直线段特征值进行计算:直线段由于没有弓高误差的限制,所以插补起来较为简单;通过直线段记录的始末u值,计算出直线段首末点,进而求出两点之间的距离S,进行直线插补计算。
2.如权利要求1所述的一种自识别插补种类的插补控制方法,其特征在于:第四步有关自由型曲线的分段以及每段始末速度的计算:根据求出的速度限制曲线,得到速度限制曲线的极小值以及对应的u值,根据速度极小值记录的u值,可得到u值对应的位置信息,进而根据速度极小值对应的位置信息对样条插补段分段,以速度限制曲线的极小值,作为每一段的始末速度,对自由型曲线段进行前瞻预判;速度极小值具体的计算公式为:
v min = 2 e ( 2 ( x ′ ( u l ) 2 + y ′ ( u l ) 2 ) 3 x ′ ( u l ) y ′ ′ ( u l ) - x ′ ′ ( u l ) y ′ ( u l ) - e ) T s - - - ( 6 )
其中ul是速度极小值点对应的u值。
CN201410319680.3A 2014-07-07 2014-07-07 一种自识别插补种类的插补控制方法 Active CN104076743B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201410319680.3A CN104076743B (zh) 2014-07-07 2014-07-07 一种自识别插补种类的插补控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201410319680.3A CN104076743B (zh) 2014-07-07 2014-07-07 一种自识别插补种类的插补控制方法

Publications (2)

Publication Number Publication Date
CN104076743A CN104076743A (zh) 2014-10-01
CN104076743B true CN104076743B (zh) 2016-12-07

Family

ID=51598073

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201410319680.3A Active CN104076743B (zh) 2014-07-07 2014-07-07 一种自识别插补种类的插补控制方法

Country Status (1)

Country Link
CN (1) CN104076743B (zh)

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104898554A (zh) * 2015-04-30 2015-09-09 柳州宏开汽车科技有限公司 一种基于离散刀位点的复合刀具路径生成方法
CN106527351B (zh) * 2015-09-10 2019-01-22 沈阳高精数控智能技术股份有限公司 一种过渡曲线长度动态确定的小线段实时插补方法
CN106125677B (zh) * 2016-07-27 2018-08-21 邓耀华 一种柔性材料轨迹加工方法和装置
CN106500702B (zh) * 2016-12-07 2019-06-21 上海新时达电气股份有限公司 连续轨迹规划过渡路径的平滑方法与装置
CN107748639A (zh) * 2017-10-19 2018-03-02 广州视睿电子科技有限公司 一种曲线的编辑方法、装置、设备和存储介质
JP7037457B2 (ja) * 2018-09-05 2022-03-16 オークマ株式会社 数値制御装置および数値制御方法
CN110288621A (zh) * 2019-05-17 2019-09-27 北京达佳互联信息技术有限公司 基于b样条的唇线补全方法、装置、电子设备及存储介质
CN110625617B (zh) * 2019-10-21 2023-05-12 中冶赛迪工程技术股份有限公司 一种智能机器人轨迹规划方法
CN116079714A (zh) * 2022-12-02 2023-05-09 盐城工学院 一种基于b样条的六轴机械臂轨迹规划方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0420985A1 (en) * 1989-01-30 1991-04-10 Fanuc Ltd. Involute interpolation speed control system
JP2004171268A (ja) * 2002-11-20 2004-06-17 Yaskawa Electric Corp 数値制御装置の指令作成装置
CN1621986A (zh) * 2003-11-28 2005-06-01 山崎马扎克公司 控制机床的方法和设备
CN103092128A (zh) * 2013-01-25 2013-05-08 北京元茂兴控制设备技术有限责任公司 一种多轴运动控制器和运动控制算法
CN103699056A (zh) * 2013-12-02 2014-04-02 嘉兴学院 高速高精度数控加工的小线段实时平滑过渡插补方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0420985A1 (en) * 1989-01-30 1991-04-10 Fanuc Ltd. Involute interpolation speed control system
JP2004171268A (ja) * 2002-11-20 2004-06-17 Yaskawa Electric Corp 数値制御装置の指令作成装置
CN1621986A (zh) * 2003-11-28 2005-06-01 山崎马扎克公司 控制机床的方法和设备
CN103092128A (zh) * 2013-01-25 2013-05-08 北京元茂兴控制设备技术有限责任公司 一种多轴运动控制器和运动控制算法
CN103699056A (zh) * 2013-12-02 2014-04-02 嘉兴学院 高速高精度数控加工的小线段实时平滑过渡插补方法

Also Published As

Publication number Publication date
CN104076743A (zh) 2014-10-01

Similar Documents

Publication Publication Date Title
CN104076743B (zh) 一种自识别插补种类的插补控制方法
CN103801981B (zh) 一种用于样条插补的四次多项式速度规划算法
CN102799145B (zh) 拐角多周期恒加加速度过渡的s曲线加减速直线插补方法
CN102393678B (zh) 适用于五轴数控装置的轨迹平滑处理方法
CN104615084B (zh) 加工进给速度优化的刀轨曲线轮廓误差补偿方法
CN105425727A (zh) 五轴侧铣加工刀具路径光顺方法
US20190324469A1 (en) Shuttle vehicle speed control method and apparatus, and shuttle vehicle
CN103076761A (zh) 基于数控系统的刀具半径补偿的矢量计算方法
CN103699056A (zh) 高速高精度数控加工的小线段实时平滑过渡插补方法
CN104483897B (zh) 一种直驱龙门式运动平台轮廓控制装置及方法
CN103728923A (zh) 一种高效高平稳的数控系统柔性加减速控制方法
CN105676779A (zh) 一种自由曲面加工局部干涉区域边界确定的追踪方法
CN106647637A (zh) 一种用于高质量加工的三角函数加减速控制方法
CN109917430A (zh) 一种基于轨迹平滑算法的卫星定位轨迹漂移纠偏方法
CN108829045A (zh) 连续微直线段的衔接速度的优化方法及系统
CN103279069A (zh) 用于数控机床的三角函数二阶连续可导加减速算法
CN102866671A (zh) 大圆弧直纹面数控加工刀具轨迹规划方法
CN103941647A (zh) 用于嵌入式数控设备的柔性加减速控制插补方法
CN106125672A (zh) 一种复杂曲面零件高效加工方法
CN103586738A (zh) 基于整体叶轮叶片形状的精铣变进给速度优化方法
CN104020719A (zh) 速度敏感点分段nurbs曲线的s型加减速控制插补算法
CN104732066A (zh) 路径约束条件下车辆行为时空演化的建模方法及其应用
CN103149879A (zh) 一种基于弧长的数控系统椭圆插补方法
CN101261507A (zh) 电脑数值控制直线转换nurbs曲线加工路径方法
CN102880118B (zh) 基于插补精度和加速度限制的变插补周期曲线插补方法

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20201203

Address after: 241000 No.39, Yinhu North Road, economic and Technological Development Zone, Wuhu City, Anhui Province

Patentee after: Li Dongze

Address before: Room 502, building 1, No. 40, xiayuangang East Street, Tianhe District, Guangzhou City, Guangdong Province 510000

Patentee before: Guangzhou Boyi Intellectual Property Operation Co.,Ltd.

Effective date of registration: 20201203

Address after: Room 502, building 1, No. 40, xiayuangang East Street, Tianhe District, Guangzhou City, Guangdong Province 510000

Patentee after: Guangzhou Boyi Intellectual Property Operation Co.,Ltd.

Address before: 310018 No. 2, Xiasha Higher Education Zone, Hangzhou, Zhejiang, Jianggan District

Patentee before: ZHEJIANG SCI-TECH University

TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20211117

Address after: 225000 west side of Shuangtang Road, Ganquan Town, Yangzhou City, Jiangsu Province

Patentee after: JIANGSU SIFANG PACKAGING PAPER INDUSTRY CO.,LTD.

Address before: 241000 No.39, Yinhu North Road, economic and Technological Development Zone, Wuhu City, Anhui Province

Patentee before: Li Dongze