CN104678899A - 曲线速度规划方法、装置及其数控加工路径数据处理方法 - Google Patents

曲线速度规划方法、装置及其数控加工路径数据处理方法 Download PDF

Info

Publication number
CN104678899A
CN104678899A CN201510072415.4A CN201510072415A CN104678899A CN 104678899 A CN104678899 A CN 104678899A CN 201510072415 A CN201510072415 A CN 201510072415A CN 104678899 A CN104678899 A CN 104678899A
Authority
CN
China
Prior art keywords
acceleration
point
curve
parameter
intermediate point
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.)
Granted
Application number
CN201510072415.4A
Other languages
English (en)
Other versions
CN104678899B (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.)
BEIJING PEITIAN TECHNOLOGY Co Ltd
Original Assignee
BEIJING PEITIAN TECHNOLOGY Co Ltd
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 BEIJING PEITIAN TECHNOLOGY Co Ltd filed Critical BEIJING PEITIAN TECHNOLOGY Co Ltd
Priority to CN201510072415.4A priority Critical patent/CN104678899B/zh
Publication of CN104678899A publication Critical patent/CN104678899A/zh
Priority to PCT/CN2016/072703 priority patent/WO2016127826A1/zh
Priority to US15/550,754 priority patent/US10768602B2/en
Application granted granted Critical
Publication of CN104678899B publication Critical patent/CN104678899B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/18Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
    • G05B19/19Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/18Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
    • G05B19/41Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by interpolation, e.g. the computation of intermediate points between programmed end points to define the path to be followed and the rate of travel along that path
    • G05B19/4103Digital interpolation
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/18Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
    • G05B19/416Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by control of velocity, acceleration or deceleration
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/34Director, elements to supervisory
    • G05B2219/34141B-spline, NURBS non uniform rational b-spline
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/37Measurements
    • G05B2219/37347Speed, velocity

Landscapes

  • Engineering & Computer Science (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Computing Systems (AREA)
  • Theoretical Computer Science (AREA)
  • Numerical Control (AREA)
  • Image Generation (AREA)

Abstract

曲线速度规划方法、装置及其数控加工路径数据处理方法。本发明提供一种基于NURBS曲线插补的曲线速度规划方法、装置及应用NURBS曲线插补速度规划的数控加工路径数据处理方法,该处理方法包括:获取具有NURBS曲线的数控加工路径数据,获取所述NURBS曲线上参数步长Δui内的加速度ai;将各加速度与最大允许加速度比较确定加速度敏感点和敏感区间;确定加速度敏感区间的中间点作为加减速分界点;计算中间点的速度值作为目标速度;根据目标速度对加速度敏感区间进行加速和减速的规划,以得到规划后的NURBS曲线的数控加工路径数据。利用本发明,能够预先计算减速阶段加速度超出限制的插补点,从而避免加速阶段末速度过高而导致加速度超出限制。

Description

曲线速度规划方法、装置及其数控加工路径数据处理方法
技术领域
本发明涉及数控加工技术领域,尤其涉及一种基于NURBS曲线插补的曲线速度规划方法、装置及应用NURBS曲线插补速度规划的数控加工路径数据处理方法。
背景技术
数控加工***中,CAM(computer Aided Manufacturing,计算机辅助制造)软件常常将复杂曲线分解为细密的小线段,作为数控***的插补轨迹。近年来,CAM逐渐使用NURBS(非均匀B样条)曲线的形式来拟合复杂曲线,并将NURBS的参数发送给数控加工***作为插补数据。这样能够大大减小传输文件的提交,并且由于避免了频繁的加速和减速,使加工效率远远高于小线段加工,因此NURBS插补正在成为数控加工的主流趋势。
由于NURBS曲线的曲率是非线性变化的,这使得加工过程中必须实时计算插补速度和加速度,避免超出加工误差限制和机床加速能力限制。尽管现有的插补算法通常能够在允许的最大速度曲线的限制下进行加速段的插补,但这些算法无法考虑减速阶段的速度突变,导致加速度超出最大向心加速度的限制。
因此,现有技术中通过回溯法或双向加速法来避免减速阶段的加速度超出限制。但是,使用回溯法时,为了得到符合加速度要求的速度曲线而回溯计算的次数是无法预测的,并且每次回溯时加速阶段末速度的递减量没有可行的估计方法,只能通过多次计算来试探。同时,回溯之后插补点要重新计算,插补点的速度也要重新估计,这样的算法计算量巨大,非常耗时,无法保证在一个插补周期内完成多插补点回溯并重新计算,因此在实时插补中的应用空间有限。使用双向加速法时,两端初始速度差距较大时会造成初速度较大的一侧停止插补而等待另一侧插补,直至另一侧插补速度到达满足相遇的要求为止。由于双向同时开始插补,实际加工中如果正向插补需要等待反向插补一个以上的周期,会造成正向插补速度和位置无法控制,因此这种情况下无法使用该算法。
发明内容
本发明要解决的技术问题是提供一种基于NURBS曲线插补的曲线速度规划方法、装置及应用NURBS曲线插补速度规划的数控加工路径数据处理方法,能够预先计算减速阶段加速度超出限制的插补点,从而避免加速阶段末速度过高而导致加速度超出限制。
为解决上述问题,本发明提供一种数控加工路径数据的处理方法,所述方法包括:获取具有NURBS曲线的数控加工路径数据;获取所述NURBS曲线上参数步长Δui内的加速度ai;将所述NURBS曲线各处的加速度ai与最大允许加速度比较以确定加速度敏感点,并根据确定的加速度敏感点确定加速度敏感区间;确定所述加速度敏感区间的中间点,以作为所述敏感区间内加速和减速的分界点;计算所述中间点的速度值,以作为目标速度;以及根据所述目标速度对所述加速度敏感区间进行加速和减速的规划,以得到规划后的NURBS曲线的数控加工路径数据。
其中,所述将所述NURBS曲线各处的加速度与最大允许加速度比较以确定加速度敏感点,并根据确定的加速度敏感点确定加速度敏感区间的步骤包括:计算NURBS曲线各处的曲率1/ρi,并根据弦高误差δmax的限制条件和向心加速度amax的限制条件确定最大允许速度曲线;以及计算各参数步长Δui内的加速度,并当参数步长Δui内的加速度ai大于最大允许加速度且参数步长Δui+n内的加速度ai+n小于所述最大允许加速度时,确定与所述最大允许加速度差值最小的加速度对应的参数步长的端点为加速度敏感点,并根据确定的加速度敏感点确定加速度敏感区间。
其中,所述根据所述目标速度对所述加速度敏感区间进行加速和减速的规划,以得到规划后的NURBS曲线的数控加工路径数据的步骤包括:判断插补点对应的参数是否进入所述加速度敏感区间;以及当确定插补点对应的参数进入所述加速度敏感区间时,从所述加速度敏感区间的一侧端点作为起始点开始向所述中间点加速,并从所述中间点向另一侧端点作为终点减速。
为解决上述问题,本发明还提供一种基于NURBS曲线插补的速度控制方法,该方法包括:计算NURBS曲线各处的曲率1/ρi,并根据弦高误差δmax的限制条件和向心加速度amax的限制条件确定最大允许速度曲线。计算各参数步长Δui内的加速度,并当参数步长Δui内的加速度ai大于最大允许加速度且参数步长Δui+n内的加速度ai+n小于该最大允许加速度时,确定与该最大允许加速度差值最小的加速度对应的参数步长的端点为加速度敏感点。将该最大允许速度曲线按极小值分成多段,并根据每个速度曲线段的加速度敏感区间的中间点确定对应的参数值umid,并计算该中间点的速度值。判断插补点对应的参数u是否进入该加速度敏感区间。以及当确定插补点对应的参数u进入该加速度敏感区间时,从该加速度敏感区间的一侧端点作为起始点开始向该中间点加速,并从该中间点向另一侧端点作为终点减速,其中,该中间点加速度为0。
其中,利用如下第一公式计算各参数步长Δui内的加速度:
第一公式: a i = v i + 1 2 - v i 2 2 s i ≈ v 2 ( u i + Δu ) - v 2 ( u i ) 2 | | C → ( u i + Δu ) - C → ( u i ) | | .
其中,ui为当前插补点的参数值,分子表示速度值,分母表示用NURBS曲线上两插补点之间的弦线段近似代替弧线段。
其中,利用如下第二、三公式计算该中间点的速度值:
第二公式:Vmid=Vm+am(umid-um);
第三公式:Vmid=Vm+n+am+n(umid-um+n)。
其中,am、am+n分别为速度曲线段的加速度敏感区间两个端点对应的加速度,um、um+n分别为对应的参数。vmid的值为通过该第二、三公式计算得出的计算值和该最大允许速度之间的最小值。
其中,当该中间点的速度值大于该最大允许速度时,设定该中间点的速度值为该最大允许速度。
其中,该起始点加速度为该加速度敏感区域起始点的斜率值,在该中间点向另一侧端点减速的起始加速度为0,该终点加速度为该加速度敏感区域终点的斜率。
为解决上述问题,本发明还提供一种基于NURBS曲线插补的速度控制装置,包括:最大允许速度曲线确定单元,用于根据NURBS曲线各处的曲率1/ρi,以及弦高误差δmax的限制条件和向心加速度amax的限制条件确定最大允许速度曲线。加速度敏感点确定单元,用于计算各参数步长Δui内的加速度,以及判断参数步长Δui内的加速度ai大于最大允许加速度且参数步长Δui+n内的加速度ai+n小于该最大允许加速度时,确定与该最大允许加速度差值最小的加速度对应的参数步长的端点为加速度敏感点。中间点速度值确定单元,用于根据将该最大允许速度曲线按极小值分成的每段速度曲线段的加速度敏感区间的中间点确定对应的参数值umid,并计算该中间点的速度值。以及插补点计算单元,用于判断插补点对应的参数u是否进入该加速度敏感区间,并当确定插补点对应的参数u进入该加速度敏感区间时,从该加速度敏感区间的一侧端点作为起始点开始向该中间点加速,并从该中间点向另一侧端点作为终点减速,其中,该中间点加速度为0。
其中,当该中间点的速度值大于该最大允许速度时,该中间点速度值确定单元确定该中间点的速度值为该最大允许速度。
本发明提供的一种基于NURBS曲线插补的曲线速度规划方法、装置及应用NURBS曲线插补速度规划的数控加工路径数据处理方法,通过预测加速度敏感点,并在加速度敏感的区间使用***允许的最大加速度重新做S型速度规划。因此,NURBS插补可以严格按照新的速度曲线来加速和减速,而无需担心速度和加速度超出限制。另外,由于新的速度曲线仅在加速度敏感点偏离原最大允许速度曲线,是在速度和加速度限制下实现了加工效率最大化。同时,该算法可以一次插补无需回溯、也无需等待某一方的插补结果,运算量轻,插补的实时性得到了保证。
附图说明
图1为现有技术中参数u与NURBS曲线曲率、最大允许速度函数关系示意图;
图2为本发明实施方式中的一种数控加工路径数据处理方法的流程示意图;
图3为本发明另一实施方式中的一种基于NURBS曲线插补的速度控制方法的流程示意图;
图4为本发明实施方式中的根据参数u、最大允许速度确定加速度敏感点的示意图;
图5为本发明实施方式中的速度规划示意图;
图6为本发明实施方式中的一种基于NURBS曲线插补的速度控制装置的功能模块示意图。
具体实施方式
为详细说明本发明的技术内容、构造特征、所实现目的及效果,以下结合附图和实施例对本发明进行详细说明。
以下将首先对NURBS曲线插补算法的基本原理进行说明:
1、NURBS曲线是分段多项式曲线,通常写成关于参数u的一元函数形式:
C → = Σ i = 0 n N i , n ( u ) w i P → i Σ i = 0 n N i , n ( u ) w i - - - ( 1 )
其中,p为阶数(多项式最高次数),Pi为控制点(限制曲线形状的多边形的笛卡尔坐标),wi为权重(曲线被控制点吸引的程度),ui为节点(分段区间的始末点参数值),u为NURBS曲线的自变量,U={U1,U2,……,Un+1},称为节点矢量。Ni,p(u)是非均匀有理B样条基函数,由节点矢量U确定,并满足Cox-de Boor递推关系式(2)和(3):
N i , p ( u ) = u - u i u i + p - u i N i , p - 1 ( u ) + u i + p + 1 - u u i + p + 1 - u i + 1 N i + 1 , p - 1 ( u ) - - - ( 2 )
N i , 0 ( u ) = 1 , u ∈ [ u i , u i + 1 ) 0 , others - - - ( 3 )
2、NURBS曲线插补的速度控制:
设定NURBS曲线为:P(u)=(x(u),y(u),z(u));
其中,时间函数u是曲线参数,记为u(ti)=ui,u(ti+1)=ui+1。每个参数u对应于NURBS曲线上的一个点。故NURBS曲线插补的任务是在参数域内选择一系列的u并计算这些u对应的曲线(即刀具的加工路径中的加工段)上的点。
当前点的参数值为u(ti),因此一个插补周期T之后的插补点对应参数u(ti+1)满足以下泰勒展开:
u ( t i + 1 ) = u ( t i ) + T du dt | t = t i + T 2 d 2 u dt 2 | t = t i + o ( T 2 ) - - - ( 4 )
3、弦高误差对进给速度与进给步长的影响:
NURBS曲线插补通常采用两插补点ui、ui+1间的弦线段逼近弧段来实现,弦线段与弧线段之间的最大距离即为最大插补弦高误差。在定周期数控插补时,为了保证插补轨迹满足一定精度要求,需要对进给速度的最大值进行限定。
用圆弧近似方法可求得弦高误差为:
δ i = ρ i - ρ i 2 - ( v ( u i ) T 2 ) 2 - - - ( 5 )
其中,ρi为ui处的曲率半径,V为编程进给速度,T为插补周期。由公式(5)可得:
V ( u i ) = 2 T ρ i 2 - ( ρ i - δ i ) 2 ≈ 8 ρ i δ i T - - - ( 6 )
假设限定最大弦高误差为δmax,则由公式(6)得到:
V ( u i ) ≤ 8 ρ i δ max T Δ L i ≤ 8 ρ i δ max - - - ( 7 )
其中,ΔLi为第i段进给步长。从上式可知每段进给步长必须满足最大弦高误差的限定条件。同时,为了满足数控机床***加工精度的要求,NURBS曲线每插补周期进给步长还必须考虑加减速和最大法向加速度的约束,即:
ΔL = min ( Δ L i 1 , 8 ρ i δ max , ΔT ρ a max ) - - - ( 8 )
其中,ΔLi1为加减速约束下的进给步长,amax最大法向加速度,并且:
amax=V(ui)2ρi   (9)
因此,根据如上公式并如图1(a)和(b)所示,通过计算插补点的曲线曲率,可以得到插补点处允许的最大速度。从当前插补点加速到下一插补点的末速度,不能超过允许的最大速度。
请参阅图2,为本发明实施方式中的一种基于NURBS曲线插补的速度控制方法流程示意图。
步骤S10,获取具有NURBS曲线的数控加工路径数据。
步骤S11,获取该NURBS曲线上参数步长Δui内的加速度ai
步骤S12,将该NURBS曲线各处的加速度与最大允许加速度比较以确定加速度敏感点,并根据确定的加速度敏感点确定加速度敏感区间。
在本实施方式中,最大允许加速度根据NURBS曲线各处的曲率1/ρi、弦高误差δmax的限制条件以及向心加速度amax的限制条件确定。当参数步长Δui内的加速度ai大于最大允许加速度且参数步长Δui+n内的加速度ai+n小于该最大允许加速度时,确定与该最大允许加速度差值最小的加速度对应的参数步长的端点为加速度敏感点。
步骤S13,确定该加速度敏感区间的中间点,以作为该敏感区间内加速和减速的分界点。
步骤S14,计算该中间点的速度值,以作为目标速度。
步骤S15,根据该目标速度对该加速度敏感区间进行加速和减速的规划,以得到规划后的NURBS曲线的数控加工路径数据。
其中,当插补点对应的参数u进入加速度敏感区间时,从加速度敏感区间的一侧端点作为起始点开始向所述中间点加速,并从中间点向另一侧端点作为终点减速,从而实现对该加速度敏感区间进行加速和减速的规划。
请参阅图3,为本发明另一实施方式中的一种基于NURBS曲线插补的速度控制方法流程示意图。
步骤S20,计算NURBS曲线各处的曲率1/ρi,并根据弦高误差δmax的限制条件(公式(5))和向心加速度amax的限制条件(公式(9))确定最大允许速度曲线(即NURBS曲线各处的最大允许速度Vmax)。
步骤S21,计算各参数步长Δui内的加速度,并与最大允许加速度比较。如果参数步长Δui内的加速度ai大于最大允许加速度,而Δui+n内的加速度ai+n小于最大允许加速度时,则确定与该最大允许加速度差值最小的加速度对应的参数步长的端点为加速度敏感点。
其中,设定参数步长Δu的值为极小值,例如Δu=10-5,因此可以将参数步长Δu内的加速过程视为匀加速过程。
具体地,利用如下公式(10)计算各参数步长Δui内的加速度:
a i = v i + 1 2 - v i 2 2 s i ≈ v 2 ( u i + Δu ) - v 2 ( u i ) 2 | | C → ( u i + Δu ) - C → ( u i ) | | . - - - ( 10 )
其中,ui为当前插补点的参数值,分子表示速度值,分母表示用NURBS曲线上两插补点之间的弦线段近似代替弧线段。由于,弦线段比弧线段长度小,因此加速度的计算值比真实值偏大。如果要求偏大的加速度值小于最大允许加速度,那么各处加速度的真实值就一定不会超出最大允许加速度的限制。
进一步地,取各参数步长Δui终点的加速度值与最大允许加速度值比较,可以得到如图3所示的加速度敏感点,如星形标记点。
步骤S22,将如步骤S20确定的最大允许速度曲线按极小值分成多段(每段最大允许速度曲线以下简称速度曲线段),即每两个速度波谷之间的速度曲线为一段(全曲线的起点和终点也视为速度波谷)。确定一段速度曲线段的加速度敏感点,并判断对应的加速度敏感的区间(以下简称为敏感区间)以及该敏感区间的中间点对应的参数值umid,并计算中间点的速度值。
具体地,将该敏感区间的两个端点分别按当前的斜率做延长线并相交于一点,该交点称为中间点,该中间点对应的参数值umid就是该速度曲线段的加速插补阶段的终点,同时也是减速插补阶段的起点。当中间点速度如果大于最大允许速度,则取最大允许速度。
其中,利用如下公式(11)、(12)计算该中间点的速度值:
Vmid=Vm+am(umid-um)   (11)
Vmid=Vm+n+am+n(umid-um+n)   (12)
其中,am、am+n分别为速度曲线段的加速度敏感区间两个端点对应的加速度,um、um+n分别为对应的参数。
如图4所示,其中,1~2点、3~4点、5~6点、7~8点、9~10点、11~12点所包含的区间为敏感区间。此处以3~4点、5~6点之间的敏感区间为例加以说明。
计算3点和6点的加速度a3、a6作为斜率,可以分别得到通过3点(u3,v3)和6点(u6,v6)的直线方程l1、l2
l1:v=v3+a3(u-u3)
l2:v=v6+a6(u-u6)
联立以上方程可以得出交点(即中间点)坐标(umid,vmid)。其中,vmid的值为计算值和最大允许速度之间的最小值。需要说明的是,由于斜率a3、a6是加速和减速阶段允许的最大加速度,所以只要重新规划的速度曲线在这两条直线的下方,就一定满足***加速度的限制。以这种方式求出的中间点,一定会处在两条直线正下方的包围之内,也就是说,可以保证加速和减速的终点和起始点都必然在满足加速度限制的范围之内,因此中间点的坐标是合理可接受的。
步骤S23,启动实时插补,根据公式(4)确定插补点对应的参数u并判断该参数u是否进入该确定的敏感区间。若是,则进入步骤S24,否则,进入步骤S25。
步骤S24,从该敏感区间的一侧(如左侧)端点开始,向该中间点加速,到达该中间点后,向另一侧(如右侧)端点减速,其中,该中间点时加速度为0。然后,流程结束。
其中,起始点加速度为该点的斜率值,加速度和加加速度都要保持如公式(8)的要求,并且起始加速度为0,末加速度为该另一侧(右侧)端点的斜率。
具体地,从该敏感区间左侧向中间点加速是一个类S型加速的过程,初始加速度不为0,末加速度为0,末速度不得超过vmid,加速终点不得超过umid。以此为加速条件,在加速过程的每个周期都作为是否使用正加加速度的依据,最终能够柔性地加速到中间点。从中间点开始减速的过程同样是一个类S型减速的过程,初始加速度为0,末加速度不为0,末速度尽可能贴近v6,加速终点不得超过u6
由于用户指定进给率限制而使最大允许速度曲线出现匀速段的情况(例如图4中点4~点5区间),很可能在很短的时间内从敏感区间端点到匀速段的加速就已经结束,由于加速度限制而导致的效率损失被降低到最小化。
如图5所示,颜色加深部分是从敏感区间端点到中间点重做的速度规划。这意味着,从颜色加深线段的左侧的相邻速度谷底开始,沿着颜色未加深线段和颜色加深线段加速是既满足速度限制又满足加速度限制的。
步骤S25,根据公式(8)按照最大允许速度计算插补点。然后流程结束。
请参阅图6,为本发明一实施方式提供的基于NURBS曲线插补的速度控制装置的功能模块示意图。该装置30包括:
最大允许速度曲线确定单元31,用于根据NURBS曲线各处的曲率1/ρi,以及弦高误差δmax的限制条件和向心加速度amax的限制条件确定最大允许速度曲线。
加速度敏感点确定单元32,用于计算各参数步长Δui内的加速度,以及判断参数步长Δui内的加速度ai大于最大允许加速度且参数步长Δui+n内的加速度ai+n小于该最大允许加速度时,确定与该最大允许加速度差值最小的加速度对应的参数步长的端点为加速度敏感点。
中间点速度值确定单元33,用于根据将该最大允许速度曲线按极小值分成的每段速度曲线段的加速度敏感区间的中间点确定对应的参数值umid,并计算该中间点的速度值。以及
插补点计算单元34,用于判断插补点对应的参数u是否进入该加速度敏感区间,并当确定插补点对应的参数u进入该加速度敏感区间时,从该加速度敏感区间的一侧端点作为起始点开始向该中间点加速,并从该中间点向另一侧端点作为终点减速,其中,该中间点加速度为0。
本发明提供的一种基于NURBS曲线插补的曲线速度规划方法、装置及应用NURBS曲线插补速度规划的数控加工路径数据处理方法,通过预测加速度敏感点,并在加速度敏感的区间使用***允许的最大加速度重新做S型速度规划。因此,NURBS插补可以严格按照新的速度曲线来加速和减速,而无需担心速度和加速度超出限制。另外,由于新的速度曲线仅在加速度敏感点偏离原最大允许速度曲线,是在速度和加速度限制下实现了加工效率最大化。同时,该算法可以一次插补无需回溯、也无需等待某一方的插补结果,运算量轻,插补的实时性得到了保证。
以上所述仅为本发明的实施方式,并非因此限制本发明的专利范围,凡是利用本发明说明书及附图内容所作的等效结构或等效流程变换,或直接或间接运用在其他相关的技术领域,均同理包括在本发明的专利保护范围内。

Claims (10)

1.一种数控加工路径数据的处理方法,其特征在于,所述方法包括:
获取具有NURBS曲线的数控加工路径数据;
获取所述NURBS曲线上参数步长Δui内的加速度ai
将所述NURBS曲线各处的加速度ai与最大允许加速度比较以确定加速度敏感点,并根据确定的加速度敏感点确定加速度敏感区间;
确定所述加速度敏感区间的中间点,以作为所述敏感区间内加速和减速的分界点;
计算所述中间点的速度值,以作为目标速度;以及
根据所述目标速度对所述加速度敏感区间进行加速和减速的规划,以得到规划后的NURBS曲线的数控加工路径数据。
2.如权利要求1所述的数控加工路径数据的处理方法,其特征在于,所述将所述NURBS曲线各处的加速度与最大允许加速度比较以确定加速度敏感点,并根据确定的加速度敏感点确定加速度敏感区间的步骤包括:
计算NURBS曲线各处的曲率1/ρi,并根据弦高误差δmax的限制条件和向心加速度amax的限制条件确定最大允许速度曲线;以及
计算各参数步长Δui内的加速度ai,并当参数步长Δui内的加速度ai大于最大允许加速度且参数步长Δui+n内的加速度ai+n小于所述最大允许加速度时,确定与所述最大允许加速度差值最小的加速度对应的参数步长的端点为加速度敏感点,并根据确定的加速度敏感点确定加速度敏感区间。
3.如权利要求1所述的数控加工路径数据的处理方法,其特征在于,所述根据所述目标速度对所述加速度敏感区间进行加速和减速的规划,以得到规划后的NURBS曲线的数控加工路径数据的步骤包括:
判断插补点对应的参数是否进入所述加速度敏感区间;以及
当确定插补点对应的参数进入所述加速度敏感区间时,从所述加速度敏感区间的一侧端点作为起始点开始向所述中间点加速,并从所述中间点向另一侧端点作为终点减速。
4.一种基于NURBS曲线插补的速度控制方法,其特征在于,所述方法包括:
计算NURBS曲线各处的曲率1/ρi,并根据弦高误差δmax的限制条件和向心加速度amax的限制条件确定最大允许速度曲线;
计算各参数步长Δui内的加速度ai,并当参数步长Δui内的加速度ai大于最大允许加速度且参数步长Δui+n内的加速度ai+n小于所述最大允许加速度时,确定与所述最大允许加速度差值最小的加速度对应的参数步长的端点为加速度敏感点;
将所述最大允许速度曲线按极小值分成多段,并根据每个速度曲线段的加速度敏感区间的中间点确定对应的参数值umid,并计算所述中间点的速度值;
判断插补点对应的参数u是否进入所述加速度敏感区间;以及
当确定插补点对应的参数u进入所述加速度敏感区间时,从所述加速度敏感区间的一侧端点作为起始点开始向所述中间点加速,并从所述中间点向另一侧端点作为终点减速,其中,所述中间点加速度为0。
5.如权利要求4所述的基于NURBS曲线插补的速度控制方法,其特征在于,利用如下第一公式计算各参数步长Δui内的加速度:
第一公式: a i = v i + 1 2 - v i 2 2 s i ≈ v 2 ( u i + Δu ) - v 2 ( u i ) 2 | | C → ( u i + Δu ) - C → ( u i ) | | ;
其中,ui为当前插补点的参数值,分子表示速度值,分母表示用NURBS曲线上两插补点之间的弦线段近似代替弧线段。
6.如权利要求4所述的基于NURBS曲线插补的速度控制方法,其特征在于,利用如下第二、三公式计算所述中间点的速度值:
第二公式:Vmid=Vm+am(umid-um);
第三公式:Vmid=Vm+n+am+n(umid-um+n);
其中,am、am+n分别为速度曲线段的加速度敏感区间两个端点对应的加速度,um、um+n分别为对应的参数;vmid的值为通过所述第二、三公式计算得出的计算值和所述最大允许速度之间的最小值。
7.如权利要求4或6所述的基于NURBS曲线插补的速度控制方法,其特征在于,当所述中间点的速度值大于所述最大允许速度时,设定所述中间点的速度值为所述最大允许速度。
8.如权利要求4所述的基于NURBS曲线插补的速度控制方法,其特征在于,所述起始点加速度为所述加速度敏感区域起始点的斜率值,在所述中间点向另一侧端点减速的起始加速度为0,所述终点加速度为所述加速度敏感区域终点的斜率。
9.一种基于NURBS曲线插补的速度控制装置,其特征在于,包括:
最大允许速度曲线确定单元,用于根据NURBS曲线各处的曲率1/ρi,以及弦高误差δmax的限制条件和向心加速度amax的限制条件确定最大允许速度曲线;
加速度敏感点确定单元,用于计算各参数步长Δui内的加速度,以及判断参数步长Δui内的加速度ai大于最大允许加速度且参数步长Δui+n内的加速度ai+n小于所述最大允许加速度时,确定与所述最大允许加速度差值最小的加速度对应的参数步长的端点为加速度敏感点;
中间点速度值确定单元,用于根据将所述最大允许速度曲线按极小值分成的每段速度曲线段的加速度敏感区间的中间点确定对应的参数值umid,并计算所述中间点的速度值;以及
插补点计算单元,用于判断插补点对应的参数u是否进入所述加速度敏感区间,并当确定插补点对应的参数u进入所述加速度敏感区间时,从所述加速度敏感区间的一侧端点作为起始点开始向所述中间点加速,并从所述中间点向另一侧端点作为终点减速,其中,所述中间点加速度为0。
10.如权利要求9所述的基于NURBS曲线插补的速度控制装置,其特征在于,当所述中间点的速度值大于所述最大允许速度时,所述中间点速度值确定单元确定所述中间点的速度值为所述最大允许速度。
CN201510072415.4A 2015-02-11 2015-02-11 曲线速度规划方法、装置及其数控加工路径数据处理方法 Active CN104678899B (zh)

Priority Applications (3)

Application Number Priority Date Filing Date Title
CN201510072415.4A CN104678899B (zh) 2015-02-11 2015-02-11 曲线速度规划方法、装置及其数控加工路径数据处理方法
PCT/CN2016/072703 WO2016127826A1 (zh) 2015-02-11 2016-01-29 曲线速度规划方法、装置及其数控加工路径数据处理方法
US15/550,754 US10768602B2 (en) 2015-02-11 2016-01-29 Curve velocity planning method, device, and numerical control machining route data processing method thereof

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510072415.4A CN104678899B (zh) 2015-02-11 2015-02-11 曲线速度规划方法、装置及其数控加工路径数据处理方法

Publications (2)

Publication Number Publication Date
CN104678899A true CN104678899A (zh) 2015-06-03
CN104678899B CN104678899B (zh) 2017-12-15

Family

ID=53314136

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510072415.4A Active CN104678899B (zh) 2015-02-11 2015-02-11 曲线速度规划方法、装置及其数控加工路径数据处理方法

Country Status (3)

Country Link
US (1) US10768602B2 (zh)
CN (1) CN104678899B (zh)
WO (1) WO2016127826A1 (zh)

Cited By (20)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105045211A (zh) * 2015-07-13 2015-11-11 太原科技大学 一种等弓高误差变步长切线插补方法
CN105759725A (zh) * 2016-03-22 2016-07-13 大连理工大学 速度敏感区间恒速曲线插补速度规划方法
CN105785921A (zh) * 2016-03-25 2016-07-20 华南理工大学 一种工业机器人nurbs曲线插补时的速度规划方法
WO2016127826A1 (zh) * 2015-02-11 2016-08-18 深圳配天智能技术研究院有限公司 曲线速度规划方法、装置及其数控加工路径数据处理方法
CN107272597A (zh) * 2017-07-14 2017-10-20 福建工程学院 一种基于进退法的nurbs曲线插补快速预读处理方法
WO2018068302A1 (zh) * 2016-10-14 2018-04-19 深圳配天智能技术研究院有限公司 一种轨迹速度规划方法及轨迹速度规划装置
WO2018205248A1 (zh) * 2017-05-12 2018-11-15 深圳配天智能技术研究院有限公司 样条路径的插补方法及相关设备
CN109416529A (zh) * 2017-12-19 2019-03-01 深圳配天智能技术研究院有限公司 数控***、具有存储功能的装置及nurbs曲线插补方法
WO2020124606A1 (zh) * 2018-12-21 2020-06-25 深圳配天智能技术研究院有限公司 数控加工方法及***、具有存储功能的装置
CN111948982A (zh) * 2020-09-10 2020-11-17 成都广泰威达数控技术股份有限公司 一种基于插补算法的机械加工控制方法
CN112327758A (zh) * 2020-10-22 2021-02-05 哈尔滨工程大学 基于b样条拟合及分段插补的小线段刀轨局部光顺方法
CN112486034A (zh) * 2020-11-09 2021-03-12 北京配天技术有限公司 验证轨迹规划的方法、电子设备及存储介质
CN112650147A (zh) * 2020-12-28 2021-04-13 深圳数马电子技术有限公司 一种曲率限制下的最大速度参数限制方法以及装置
CN112764393A (zh) * 2020-12-28 2021-05-07 深圳数马电子技术有限公司 一种确定速度敏感区间的扫描方法以及装置
CN112936101A (zh) * 2021-01-29 2021-06-11 天津中屹铭科技有限公司 一种应用于自动化打磨切割设备的柔性控制方法
CN113671898A (zh) * 2020-05-14 2021-11-19 大族激光科技产业集团股份有限公司 数控加工方法、***、计算机设备及存储介质
CN114035513A (zh) * 2021-09-28 2022-02-11 苏州谋迅智能科技有限公司 S形速度曲线前瞻规划方法和装置、存储介质和计算设备
CN114265367A (zh) * 2021-12-31 2022-04-01 杭州电子科技大学 一种高精度参数路径插补方法及***
CN114872035A (zh) * 2020-10-16 2022-08-09 深圳市华成工业控制股份有限公司 一种局部减速控制方法、运动速度的规划方法、运动路径的规划方法和数据更新方法
CN115328032A (zh) * 2022-10-11 2022-11-11 济南邦德激光股份有限公司 基于s形加减速的b样条速度前瞻控制方法、设备和介质

Families Citing this family (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102017008748A1 (de) * 2017-09-19 2019-03-21 Innolite Gmbh Software-Baustein, Präzisionsmaschine, Verfahren und Bauteil
US11403816B2 (en) * 2017-11-30 2022-08-02 Mitsubishi Electric Corporation Three-dimensional map generation system, three-dimensional map generation method, and computer readable medium
JP2020095316A (ja) * 2018-12-10 2020-06-18 ファナック株式会社 数値制御装置
CN111381565B (zh) * 2018-12-27 2023-02-21 沈阳中科数控技术股份有限公司 三次多项式s曲线加减速的加加速度递归计算限制方法
CN110653137B (zh) * 2019-10-17 2022-02-18 安阳工学院 一种保持喷头垂直于喷涂面的喷涂方法
CN110757455B (zh) * 2019-10-25 2022-11-22 上海新时达机器人有限公司 一种速度规划方法
CN111722591B (zh) * 2020-06-05 2021-10-08 浙江工业大学 一种商标模切机高精度联动插补的方法
TWI766598B (zh) * 2020-11-13 2022-06-01 台達電子工業股份有限公司 基於軸物理限制的傳動機構進給率規劃方法
CN112783084B (zh) * 2021-01-04 2022-02-22 大族激光科技产业集团股份有限公司 一种曲线加工方法及数控***
CN113204215B (zh) * 2021-04-16 2022-08-02 华中科技大学 一种数控加工全局nurbs轨迹实时插补方法及其应用
CN113467368A (zh) * 2021-07-15 2021-10-01 苏州谋迅智能科技有限公司 S形速度曲线的调整方法
CN113625657B (zh) * 2021-08-18 2022-12-16 深圳市英威腾电气股份有限公司 一种基于电子凸轮曲线的运动控制方法及装置

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH11345014A (ja) * 1999-05-21 1999-12-14 Mitsubishi Electric Corp 数値制御装置
JP2001154719A (ja) * 1999-11-30 2001-06-08 Yaskawa Electric Corp 自由曲線補間方法
CN102722141A (zh) * 2012-06-28 2012-10-10 华南理工大学 一种基于pc-fpga的nurbs曲线实时插补方法
CN103064335A (zh) * 2012-12-31 2013-04-24 北京配天大富精密机械有限公司 一种数控***的功能变更方法、运行方法及运动控制卡

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101493687B (zh) 2009-03-02 2010-07-21 广西大学 实时前瞻全程加减速控制的nurbs曲线自适应分段插补方法
DE102009049172B4 (de) * 2009-10-13 2019-07-25 Kuka Roboter Gmbh Verfahren und Vorrichtung zur Steuerung eines Manipulators
CN101995850B (zh) * 2010-11-05 2012-02-29 江俊逢 一种计算机辅助数字控制方法与***
CN104238458A (zh) * 2013-06-08 2014-12-24 沈阳高精数控技术有限公司 一种nurbs曲线高速前瞻插补方法
CN104331025B (zh) 2014-10-31 2017-01-25 西安交通大学 一种面向微小线段高效加工的速度前瞻预处理方法
CN104678899B (zh) 2015-02-11 2017-12-15 北京配天技术有限公司 曲线速度规划方法、装置及其数控加工路径数据处理方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH11345014A (ja) * 1999-05-21 1999-12-14 Mitsubishi Electric Corp 数値制御装置
JP2001154719A (ja) * 1999-11-30 2001-06-08 Yaskawa Electric Corp 自由曲線補間方法
CN102722141A (zh) * 2012-06-28 2012-10-10 华南理工大学 一种基于pc-fpga的nurbs曲线实时插补方法
CN103064335A (zh) * 2012-12-31 2013-04-24 北京配天大富精密机械有限公司 一种数控***的功能变更方法、运行方法及运动控制卡

Cited By (35)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10768602B2 (en) 2015-02-11 2020-09-08 Shenzhen A&E Intelligent Technology Institute Co., Ltd. Curve velocity planning method, device, and numerical control machining route data processing method thereof
WO2016127826A1 (zh) * 2015-02-11 2016-08-18 深圳配天智能技术研究院有限公司 曲线速度规划方法、装置及其数控加工路径数据处理方法
CN105045211A (zh) * 2015-07-13 2015-11-11 太原科技大学 一种等弓高误差变步长切线插补方法
CN105045211B (zh) * 2015-07-13 2017-11-07 太原科技大学 一种等弓高误差变步长切线插补方法
CN105759725A (zh) * 2016-03-22 2016-07-13 大连理工大学 速度敏感区间恒速曲线插补速度规划方法
CN105759725B (zh) * 2016-03-22 2018-04-10 大连理工大学 速度敏感区间恒速曲线插补速度规划方法
CN105785921A (zh) * 2016-03-25 2016-07-20 华南理工大学 一种工业机器人nurbs曲线插补时的速度规划方法
CN105785921B (zh) * 2016-03-25 2018-06-22 华南理工大学 一种工业机器人nurbs曲线插补时的速度规划方法
WO2018068302A1 (zh) * 2016-10-14 2018-04-19 深圳配天智能技术研究院有限公司 一种轨迹速度规划方法及轨迹速度规划装置
CN108235742A (zh) * 2016-10-14 2018-06-29 深圳配天智能技术研究院有限公司 一种轨迹速度规划方法及轨迹速度规划装置
CN109564417A (zh) * 2017-05-12 2019-04-02 深圳配天智能技术研究院有限公司 样条路径的插补方法及相关设备
CN109564417B (zh) * 2017-05-12 2021-07-09 深圳配天智能技术研究院有限公司 样条路径的插补方法及相关设备
WO2018205248A1 (zh) * 2017-05-12 2018-11-15 深圳配天智能技术研究院有限公司 样条路径的插补方法及相关设备
CN107272597B (zh) * 2017-07-14 2019-08-30 福建工程学院 一种基于进退法的nurbs曲线插补快速预读处理方法
CN107272597A (zh) * 2017-07-14 2017-10-20 福建工程学院 一种基于进退法的nurbs曲线插补快速预读处理方法
CN109416529A (zh) * 2017-12-19 2019-03-01 深圳配天智能技术研究院有限公司 数控***、具有存储功能的装置及nurbs曲线插补方法
WO2020124606A1 (zh) * 2018-12-21 2020-06-25 深圳配天智能技术研究院有限公司 数控加工方法及***、具有存储功能的装置
CN113671898A (zh) * 2020-05-14 2021-11-19 大族激光科技产业集团股份有限公司 数控加工方法、***、计算机设备及存储介质
CN113671898B (zh) * 2020-05-14 2023-12-08 大族激光科技产业集团股份有限公司 数控加工方法、***、计算机设备及存储介质
CN111948982A (zh) * 2020-09-10 2020-11-17 成都广泰威达数控技术股份有限公司 一种基于插补算法的机械加工控制方法
CN111948982B (zh) * 2020-09-10 2024-01-30 成都广泰威达数控技术股份有限公司 一种基于插补算法的机械加工控制方法
CN114872035B (zh) * 2020-10-16 2023-08-22 深圳市华成工业控制股份有限公司 运动速度和路径的规划方法及减速控制和数据更新的方法
CN114872035A (zh) * 2020-10-16 2022-08-09 深圳市华成工业控制股份有限公司 一种局部减速控制方法、运动速度的规划方法、运动路径的规划方法和数据更新方法
CN112327758A (zh) * 2020-10-22 2021-02-05 哈尔滨工程大学 基于b样条拟合及分段插补的小线段刀轨局部光顺方法
CN112327758B (zh) * 2020-10-22 2021-09-21 哈尔滨工程大学 基于b样条拟合及分段插补的小线段刀轨局部光顺方法
CN112486034A (zh) * 2020-11-09 2021-03-12 北京配天技术有限公司 验证轨迹规划的方法、电子设备及存储介质
CN112486034B (zh) * 2020-11-09 2023-11-10 北京配天技术有限公司 验证轨迹规划的方法、电子设备及存储介质
CN112764393B (zh) * 2020-12-28 2022-07-12 深圳数马电子技术有限公司 一种确定速度敏感区间的扫描方法以及装置
CN112650147B (zh) * 2020-12-28 2023-11-28 深圳数马电子技术有限公司 一种曲率限制下的最大速度参数限制方法以及装置
CN112764393A (zh) * 2020-12-28 2021-05-07 深圳数马电子技术有限公司 一种确定速度敏感区间的扫描方法以及装置
CN112650147A (zh) * 2020-12-28 2021-04-13 深圳数马电子技术有限公司 一种曲率限制下的最大速度参数限制方法以及装置
CN112936101A (zh) * 2021-01-29 2021-06-11 天津中屹铭科技有限公司 一种应用于自动化打磨切割设备的柔性控制方法
CN114035513A (zh) * 2021-09-28 2022-02-11 苏州谋迅智能科技有限公司 S形速度曲线前瞻规划方法和装置、存储介质和计算设备
CN114265367A (zh) * 2021-12-31 2022-04-01 杭州电子科技大学 一种高精度参数路径插补方法及***
CN115328032A (zh) * 2022-10-11 2022-11-11 济南邦德激光股份有限公司 基于s形加减速的b样条速度前瞻控制方法、设备和介质

Also Published As

Publication number Publication date
US20180088551A1 (en) 2018-03-29
WO2016127826A1 (zh) 2016-08-18
CN104678899B (zh) 2017-12-15
US10768602B2 (en) 2020-09-08

Similar Documents

Publication Publication Date Title
CN104678899A (zh) 曲线速度规划方法、装置及其数控加工路径数据处理方法
CN102419570B (zh) 数控机床高速加工的加减速前瞻控制方法
CN103064344B (zh) 一种基于nurbs曲线插补的速度平滑控制方法
CN107850887B (zh) S型曲线规划方法、装置及数控机床
CN107710084B (zh) 一种加工路径规划方法、加工路径规划装置及数控机床
CN101957611B (zh) 样条曲线实时插补方法
CN100451891C (zh) 微小程序段的动态前瞻处理方法及实现装置
CN101615038B (zh) 高速加工中心速度优化与平滑运动控制方法
Lai et al. On the development of a parametric interpolator with confined chord error, feedrate, acceleration and jerk
CN110471368A (zh) 一种高速数控机床加工速度自适应的前瞻插补方法
CN104281099B (zh) 一种考虑加工特性的nurbs直接插补方法及装置
CN104181860B (zh) 数控机床s型加减速控制方法
CN102945020B (zh) 速度前瞻的方法及其数控装置、数控***
CN104597847A (zh) 基于Akima样条曲线拟合的前瞻插补方法
CN105045211B (zh) 一种等弓高误差变步长切线插补方法
CN107844058A (zh) 一种运动曲线离散动态规划方法
CN111158318B (zh) 一种非对称性四次曲线柔性加减速规划方法
CN102141794A (zh) 一种用于数控***的连续轨迹段间衔接速度处理方法
Yuan et al. Time-optimal interpolation for CNC machining along curved tool pathes with confined chord error
CN103279069A (zh) 用于数控机床的三角函数二阶连续可导加减速算法
CN104898577A (zh) S形曲线速度规划方法、装置及数控方法和数控机床
CN108563122A (zh) 一种移动机器人速度平滑插值方法
CN111381565B (zh) 三次多项式s曲线加减速的加加速度递归计算限制方法
JP2000148223A5 (ja) 曲線補間加減速制御方法および数値制御装置
CN101424361B (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
GR01 Patent grant
GR01 Patent grant