CN113156891A - 一种基于弓高误差限制和加加速度连续的进给率规划方法 - Google Patents

一种基于弓高误差限制和加加速度连续的进给率规划方法 Download PDF

Info

Publication number
CN113156891A
CN113156891A CN202110453986.8A CN202110453986A CN113156891A CN 113156891 A CN113156891 A CN 113156891A CN 202110453986 A CN202110453986 A CN 202110453986A CN 113156891 A CN113156891 A CN 113156891A
Authority
CN
China
Prior art keywords
feed rate
curve
sub
parameter
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
CN202110453986.8A
Other languages
English (en)
Other versions
CN113156891B (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.)
Beihang University
Original Assignee
Beihang University
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 Beihang University filed Critical Beihang University
Priority to CN202110453986.8A priority Critical patent/CN113156891B/zh
Publication of CN113156891A publication Critical patent/CN113156891A/zh
Application granted granted Critical
Publication of CN113156891B publication Critical patent/CN113156891B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

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/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
    • 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/34083Interpolation general

Landscapes

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

Abstract

本发明属于数控加工制造领域,特别涉及一种基于弓高误差限制和加加速度连续的进给率规划方法,首先给出新颖的S型函数的形式;其次综合考虑弓高误差限制和运动学限制,确定加工轨迹的几何特征关键点,并计算每个关键点的进给率;之后,为了保证相邻两个子曲线的进给率连续,使用双向扫描算法在必要时修改某些关键点的进给率;最后使用新颖的S型函数规划每一段子曲线的进给率,并拼接得到加工轨迹的进给率曲线。本发明通过构造高阶连续的新颖的S型函数对零件加工时的进给率进行规划,使得整个加工过程连续且满足弓高误差限制和运动学限制。

Description

一种基于弓高误差限制和加加速度连续的进给率规划方法
技术领域
本发明属于数控加工制造领域,特别涉及一种基于弓高误差限制 和加加速度连续的进给率规划方法,通过构造高阶连续的S型函数对 零件加工时的进给率进行规划,使得整个加工过程连续且满足弓高误 差限制和运动学限制。
背景技术
在数控系统指导下的数字化加工过程中,通常数控系统首先会接 收加工轨迹、进给速率、刀位偏置等加工信息,然后利用插补模块依 据加工信息实时计算加工过程中的插补点。由于进给率直接影响着加 工的精度和加工效率,插补模块中的进给率规划成为了数控加工领域 内的研究热点。
一方面,加工轨迹通常由G01代码表示,由于该轨迹的低阶连续 性,导致在连接点处加工速度不连续,从而引入较大的误差。另一方 面,随着CAD技术的不断进步,复杂曲线的参数化技术日臻成熟,使用 参数表达加工轨迹曲线逐步可行,于是面向参数曲线的进给速率规划 开始被提出。在进给率规划中,一般需要考虑弓高误差限制和运动学 限制。其中弓高误差指的是相邻两个插补点构成的直线段与加工轨迹 之间的最大距离,为了保证加工精度,该距离不能超过一个给定的阈 值。运动学限制一般包括加工速度、加速度和加加速度,这些运动量 都不能超过给定的阈值,否则会引起机床的不良震动,从而影响加工 精度。
目前面向参数曲线的进给率规划方案主要分为两类:整体方案: 该方案会在给定几何误差限制条件和运动学限制条件后,构造多个不 等式和以加工时间最短的目标函数,整体求解满足限制的进给率;分段 方案:该方案首先提取曲线关键点将其分为多段子曲线,在确定关键 点的进给率之后,使用高阶光滑曲线规划每一段子曲线的进给率,最 后拼接得到曲线的进给率。
上述两类方案中,整体方案的缺点是规划得到的进给率没有解析的 表达式,通常需要后续使用其他函数对进给率进行拟合,最后可能会导 致某些运动量超过给定的阈值;分段方案的缺点是公式繁多,计算复杂, 通常需要离线规划出进给率后,再进行实时插补过程。
发明内容
针对上述问题,本发明设计了一种改进的分段方案,首先给出新颖的S 型函数的形式;其次综合考虑弓高误差限制和运动学限制,确定加工轨 迹的几何特征关键点,并计算每个关键点的进给率;之后,为了保证相邻 两个子曲线的进给率连续,使用双向扫描算法在必要时修改某些关键点的 进给率;最后使用新颖的S型函数规划每一段子曲线的进给率,并拼接得 到加工轨迹的进给率曲线。
为实现上述目的,本发明提供了一种基于弓高误差限制和加速度连续 的进给率规划方法,包括如下步骤:
S1:使用三角函数过渡S型函数的加加速度从零到极大值之间的变化, 使得加加速度连续,构造新颖的S型函数如下:
Figure BDA0003039894140000031
其中,v(t)为进给率;Ti,i=1,2,3,4,5,6,7是新型S型进给率函数(1)规划 的子曲线的七个时间参数;A1和A2分别是新型S型进给率函数(1)规划的 子曲线的加速度的极大值和极小值;t表示当前时间;ti,i=1,2,3,4,5,6,7是 时间累计量,即t1=T1,t2=T1+T2,t3=T1+T2+T3,t4=T1+T2+T3+T4, t5=T1+T2+T3+T4+T5,t6=T1+T2+T3+T4+T5+T6,t7=T1+T2+ T3+T4+T5+T6+T7;vs是初始速度;vm是允许的最大速度;
S2:使用等间隔参数序列,依据弓高误差限制和运动学限制获得加工 轨迹曲线的多个关键点;
S3:利用双向扫描调节步骤S2中获得的某些关键点的进给率,以使前 一个关键点的进给率光滑过渡到后一个关键点的进给率;
S4:在步骤S3调节某些关键点的进给率之后,确定各子曲线的时间参 数和加速度极值,并带入式(1)中,得到各子曲线的进给率;将多个子曲 线的进给率进行拼接,获得整个加工轨迹曲线的进给率。
进一步,步骤2具体过程如下:
假定加工轨迹曲线的参数表达式为P(u)=(x(u),y(u),z(u)),其中,u为 参数点且0≤u≤1,u=0表示曲线的起点,u=1为曲线的终点;设定参 数点间隔为Δu,即ui+1=ui+Δu,ui+1表示第i+1个参数点,ui表示第i个 参数点,i=0,1,2,...,n,n表示曲线内部参数点的个数;x(u),y(u),z(u)分别 为x,y,z坐标轴上的参数表达式;
首先考虑弓高误差的限制,由于插补周期很小,在弓高误差的计算过 程中,使用微小圆弧段近似代替参数点附近的曲线;对于参数点ui,弓高 误差由如下式计算:
Figure BDA0003039894140000041
其中,εchord为弓高误差;ρi为参数点ui的曲率半径;vi为参数点ui的进给 率;Ts为插补周期;假定给定的弓高误差阈值为e,则εchord≤e,由式(2) 得到
Figure BDA0003039894140000042
其次考虑运动学限制,运动学限制要考虑切向速度、法向加速度和法 向加加速度;使用小圆弧段近似代替参数点附近的曲线,法向加速度和法 向加加速度由下式计算:
Figure BDA0003039894140000043
Figure BDA0003039894140000044
其中,An为切向加速度;Jn为切向加加速度;
假定给定的切向加速度和切向加加速度的阈值分别为Am和Jm,则有 An≤Am和Jn≤Jm,由式(3)和(4)得到
Figure BDA0003039894140000045
Figure BDA0003039894140000046
综合考虑上述弓高误差和运动学限制以及进给率最大值限制,参数点 ui的进给率如下:
Figure BDA0003039894140000047
其中,F是切向速度最大值;
当确定所有参数点的进给率之后,选择进给率局部最小的参数点作为 曲线的关键点,并根据这些关键点将曲线分为多个子曲线;其中,进给率 局部最小指的是参数点ui的进给率vi满足条件vi≤vi+1和vi≤vi-1
进一步,步骤3中,首先利用正向扫描调节某些关键点的进给率,具 体过程如下:
A.令i=0;
B.若vi+1>vi则转到步骤C;否则转到步骤F;
C.若
Figure BDA0003039894140000051
则转到步骤D;否则转到步骤E;
D.令
Figure BDA0003039894140000052
T2=0,计算过渡长度s=(vi+1+vi)(T1+ T2+T3)/2,若s<li则无需改变vi+1,其中,li表示从参数点ui到参数点ui+1之间的弧长;若s>li则解如下方程:
Figure BDA0003039894140000053
若存在唯一的解vupdate满足vi<vupdate<vi+1,则令vi+1=vupdate,转到 步骤F;
E.令
Figure BDA0003039894140000054
计算过渡长度s=(vi+1+ vi)(T1+T2+T3)/2,若s<li则无需改变vi+1;若s>li则分别求解方程(6) 和如下方程(7):
Figure BDA0003039894140000055
若存在唯一的解vupdate满足vi<vupdate<vi+1,则令vi+1=vupdate,转到 步骤F;
F.令i=i+1,若i<n则转到步骤B;否则结束调节;
在正向扫描结束之后进行反向扫描,具体过程如下:
A’.令i=n;
B’.若vi>vi+1则转到步骤C’;否则转到步骤F’;
C’.若
Figure BDA0003039894140000061
则转到步骤D’;否则转到步骤E’;
D’.令
Figure BDA0003039894140000062
T2=0,计算过渡长度s=(vi+vi+1)(T1+ T2+T3)/2,若s<li则无需改变vi,其中li表示从参数点ui到参数点ui+1之 间的弧长;若s>li则解如下方程:
Figure BDA0003039894140000063
若存在唯一的解vupdate满足vi+1<vupdate<vi,则令vi=vupdate,转到步 骤F’;其中,v表示对应子曲线段上可以达到的最大速度;
E’.令
Figure BDA0003039894140000064
计算过渡长度s=(vi+ vi+1)(T1+T2+T3)/2,若s<li则无需改变vi;若s>li则分别求解方程(8) 和如下方程(9):
Figure BDA0003039894140000065
若存在唯一的解vupdate满足vi+1<vupdate<vi,则令vi=vupdate,转到步 骤F’;
F’.令i=i-1,若i>0则转到步骤B’;否则结束调节。
进一步,步骤4具体过程如下:
在步骤S3中经过进给率调节后,某些关键点的进给率有所降低,则多 个子曲线可由此分成两类:第一类是两端的关键点进给率至少有一个变化 的子曲线,第二类是两端的关键点进给率都未变化的子曲线,对于第j个子 曲线,他的初始进给率vs=vj-1,结束进给率ve=vj,其中j=1,2,...,n。
进一步,第一类子曲线采用如下方法确定七个时间参数和两个加速度 极值:
当vs<ve时,首先令T4=T5=T6=T7=0,A2=0。若
Figure BDA0003039894140000071
则令
Figure BDA0003039894140000072
T2=0,
Figure BDA0003039894140000073
否则令
Figure BDA0003039894140000074
Figure BDA0003039894140000075
A1=Am
当vs>ve时,首先令T1=T2=T3=T4=0,A1=0。若
Figure BDA0003039894140000076
则令
Figure BDA0003039894140000077
T6=0,
Figure BDA0003039894140000078
否则令
Figure BDA0003039894140000079
Figure BDA00030398941400000710
A2=Am
第二类子曲线采用如下方法确定七个时间参数和两个加速度极值;
首先要判断子曲线上的最大进给率能否达到切向速度最大值F,具体判 断过程如下:
按照下式(10)计算从初速度vs加速到切向速度最大值F,然后再减速 到末速度ve所需路程:
s=(vs+F)(T1+T2+T3)/2+(ve+F)(T5+T6+T7)/2 (10)
其中,当
Figure BDA00030398941400000711
时,
Figure BDA00030398941400000712
T2=0;否则
Figure BDA00030398941400000713
Figure BDA00030398941400000714
Figure BDA00030398941400000715
时,
Figure BDA00030398941400000716
T7=0;否则
Figure BDA00030398941400000717
根据所需路程s与子曲线弧长li的大小关系确定子曲线上的最大进给率 能否达到切向速度最大值F,若s<li,则最大进给率vm=F,否则需要按 照下述方法计算最大进给率vm
(1)求解方程
Figure RE-GDA00030943300900000718
若存在一个 解va满足
Figure RE-GDA0003094330090000081
则vm=v,否则转到步骤(2);
(2)求解方程
Figure BDA0003039894140000081
若存在一个解va满足
Figure BDA0003039894140000082
则 vm=va,否则转到步骤(3);
(3)求解方程
Figure BDA0003039894140000083
必存在 一个解va满足
Figure BDA0003039894140000084
则vm=va
在确定子曲线上的最大进给率vm后,按照如下方法确定七个时间参数 和加速度极值:
Figure BDA0003039894140000085
Figure BDA0003039894140000086
T2=0,
Figure BDA0003039894140000087
否则
Figure BDA0003039894140000088
A1=Am
Figure BDA0003039894140000089
Figure BDA00030398941400000810
T6=0,
Figure BDA00030398941400000811
否则
Figure BDA00030398941400000812
A2=Am
令s=(vs+F)(T1+T2+T3)/2+(ve+F)(T5+T6+T7)/2,则
Figure BDA00030398941400000813
本发明的有益效果:
1)本发明中关键点的确认过程中,不但确定了关键点的允许速度的最 大值,还保证了弓高误差不超过给定阈值,之后根据关键点将曲线分为多 个子曲线,简化了问题;
2)本发明通过双向扫描方案调节了关键点的速度,使得每个关键的速 度是可以被所提出的新颖的S型函数光滑过渡的;
3)本发明将子曲线分为两类,分别确定了所提出的新颖的S型函数的 七个时间参数和两个加速度极值,从而确定了新颖的S型函数的具体表达 式;
4)本发明根据具体表达式规划每一个子曲线的进给率,并拼接起来, 使得整个加工轨迹的进给率曲线高阶连续。
附图说明
图1是本发明实施例1的基于弓高误差限制和加加速度连续的进给率 规划方法流程图;
图2是本发明实施例2的测试曲线的曲线图;
图3是本发明实施例2的最大进给率随着曲线参数的变化图;
图4是本发明实施例2的子曲线的速度图像;
图5是本发明实施例2的测试曲线的进给率图像;
图6是本发明实施例2的测试曲线的弓高误差图像。
具体实施方式
下面结合附图和实施例进一步描述本发明,应该理解,以下所述实施例 旨在便于对本发明的理解,而对其不起任何限定作用。
实施例1
如图1所示,本实施例的基于弓高误差限制和加加速度连续的进给率规 划方法,包括如下步骤:
S1:给出新颖的S型进给率函数的形式;
传统的S型函数的加加速度是跳跃变化的,也就是说加加速度并不连 续。已有相关文献证明,加加速度的不连续会引起加工过程中,机床的剧 烈震动,从而影响加工工件表面的质量。基于此考虑,本发明使用三角函 数过渡加加速度从零到极大值之间的变化,使得加加速度是连续的,最终 设计新颖的S型函数如公式(1)所示。
Figure BDA0003039894140000101
其中,Ti,i=1,2,3,4,5,6,7是该S型函数的七个时间参数,A1和A2是加速度 的极大值和极小值,ti,i=1,2,3,4,5,6,7是时间累计量,即t1=T1,t2=T1+T2, t3=T1+T2+T3,t4=T1+T2+T3+T4,t5=T1+T2+T3+T4+T5, t6=T1+T2+T3+T4+T5+T6,t7=T1+T2+T3+T4+T5+T6+T7。vs是初始速度,vm是允许的最大速度。t表示当前时间。
下面说明如何根据具体的待加工曲线来确定这些参数。
S2:使用等间隔参数序列,依据弓高误差限制和运动学限制获得加工 轨迹曲线的关键点;
假定加工轨迹的曲线参数表达式为P(u)=(x(u),y(u),z(u)),其中, x(u),y(u),z(u)分别为x,y,z坐标轴上的参数表达式;u为参数点且0≤u≤1, u=0表示曲线的起点,u=1为曲线的终点。设定参数点间隔为Δu,即 ui+1=ui+Δu,ui+1表示第i+1个参数点,ui表示第i个参数点, i=0,1,2,...,n,n表示曲线内部参数点的个数。如果取Δu=0.001,则曲线内部有999个参数点。
首先考虑弓高误差的限制。由于插补周期很小,在弓高误差的计算过 程中,可以使用微小圆弧段近似代替参数点附近的曲线。对于参数点ui, 弓高误差可由如下式计算:
Figure BDA0003039894140000111
其中,εchord为弓高误差;ρi为参数点ui的曲率半径,vi为参数点ui的进给 率,Ts为插补周期。假定给定的弓高误差阈值为e,则应该有εchord≤e,由 式(2)得到
Figure BDA0003039894140000112
其次考虑运动学限制,运动学限制要考虑切向速度、法向加速度和法 向加加速度。同样的,可以使用小圆弧段近似代替参数点附近的曲线,法 向加速度和法向加加速度可由下式计算:
Figure BDA0003039894140000113
Figure BDA0003039894140000114
其中,An为切向加速度;Jn为切向加加速度。
假定给定的切向加速度和切向加加速度的阈值分别为Am和Jm,则应该 有An≤Am和Jn≤Jm,由式(3)和(4)得到
Figure BDA0003039894140000115
Figure BDA0003039894140000116
综合考虑上述弓高误差和运动学限制以及进给率最大值限制,参数点 ui对应的进给率如下:
Figure BDA0003039894140000117
其中,F是切向速度最大值,该值是人为直接给定的。
当确定所有参数点的进给率之后,选择进给率局部最小的参数点作为 曲线的关键点,并根据这些关键点将曲线分为多段子曲线。其中,进给率 局部最小指的是参数点ui的进给率vi满足条件vi≤vi+1和vi≤vi-1
S3:利用双向扫描调节某些关键点的进给率,以使前一个关键点的进 给率光滑过渡到后一个关键点的进给率;
在确定曲线的关键点及其对应的进给率之后,由于加工需要从静止开 始且结束时停止运动,曲线的起点u=0和终点u=1也应为关键点,且两者 对应的进给率为0。这里用一系列二维点(ui,vi)来表示关键点及其进给率。 当子曲线的长度过短时,不能从前一个关键点的进给率光滑过渡到后一个 关键点的进给率,需要使用双向扫描算法,在必要时降低某些关键点的进 给率。此外,在双向扫描的过程中,只考虑一直加速的情况,目的是计算可达到的速度的最大值,因此只涉及到前三个时间参数T1、T2、T3
首先利用正向扫描调节某些关键点的进给率,具体过程如下:
A.令i=0;
B.若vi+1>vi则转到C;否则转到F;
C.若
Figure BDA0003039894140000121
则转到D;否则转到E;
D.令
Figure BDA0003039894140000122
T2=0,计算过渡长度s=(vi+1+vi)(T1+ T2+T3)/2,若s<li则无需改变vi+1,其中li表示从参数点ui到参数点ui+1之 间的弧长;若s>li则解如下方程:
Figure BDA0003039894140000123
若存在唯一的解vupdate满足vi<vupdate<vi+1,则令vi+1=vupdate,转到 F。
E.令
Figure BDA0003039894140000124
计算过渡长度s=(vi+1+ vi)(T1+T2+T3)/2,若s<li则无需改变vi+1;若s>li则分别求解方程(6) 和如下方程(7):
Figure BDA0003039894140000131
若存在唯一的解vupdate满足vi<vupdate<vi+1,则令vi+1=vupdate,转到 F;
F.令i=i+1,若i<n则转到B;否则结束调节。
正向扫描结束之后进行反向扫描,过程和正向扫描类似,具体如下:
A.令i=n;
B.若vi>vi+1则转到C;否则转到F;
C.若
Figure BDA0003039894140000132
则转到D;否则转到E;
D.令
Figure BDA0003039894140000133
T2=0,计算过渡长度s=(vi+vi+1)(T1+ T2+T3)/2,若s<li则无需改变vi,其中li表示从参数点ui到参数点ui+1之 间的弧长;若s>li则解如下方程:
Figure BDA0003039894140000134
若存在唯一的解vupdate满足vi+1<vupdate<vi,则令vi=vupdate,转到F; 其中,v表示对应子曲线段上可以达到的最大速度。
E.令
Figure BDA0003039894140000135
计算过渡长度s=(vi+ vi+1)(T1+T2+T3)/2,若s<li则无需改变vi;若s>li则分别求解方程(8) 和如下方程(9):
Figure BDA0003039894140000136
若存在唯一的解vupdate满足vi+1<vupdate<vi,则令vi=vupdate,转到F;
F.令i=i-1,若i>0则转到B;否则结束调节。
S4:在步骤S3调节某些关键点的进给率之后,确定各子曲线的七个时 间参数和两个加速度极值;
在步骤S3中经过进给率调节后,某些关键点的进给率有所降低,则子 曲线可由此分成两类:第一类是两端的关键点进给率至少有一个变化的子 曲线,第二类是两端的关键点进给率都未变化的子曲线。对于第j个子曲线, 他的初始进给率vs=vj-1,结束进给率ve=vj,其中j=1,2,...,n。
第一类子曲线采用如下方法确定七个时间参数和两个加速度极值:
当vs<ve时,首先令T4=T5=T6=T7=0,A2=0。若
Figure BDA0003039894140000141
则令
Figure BDA0003039894140000142
T2=0,
Figure BDA0003039894140000143
否则令
Figure BDA0003039894140000144
Figure BDA0003039894140000145
A1=Am
当vs>ve时,首先令T1=T2=T3=T4=0,A1=0。若
Figure BDA0003039894140000146
则令
Figure BDA0003039894140000147
T6=0,
Figure BDA0003039894140000148
否则令
Figure BDA0003039894140000149
Figure BDA00030398941400001410
A2=Am
第二类子曲线采用如下方法确定七个时间参数和两个加速度极值;
首先要判断子曲线上的最大进给率能否达到人为直接给定的切向速度 最大值F,如果能够达到,则在速度规划中会出现匀速阶段,新颖的S型函 数里的时间参数T4会大于0;否则就会等于0。具体判断过程如下:
按照下式(10)计算从初速度vs加速到切向速度最大值F,然后再减速 到末速度ve所需路程:
s=(vs+F)(T1+T2+T3)/2+(ve+F)(T5+T6+T7)/2 (10)
其中,当
Figure BDA00030398941400001411
时,
Figure BDA00030398941400001412
T2=0;否则
Figure BDA00030398941400001413
Figure BDA00030398941400001414
Figure BDA00030398941400001415
时,
Figure BDA00030398941400001416
T7=0;否则
Figure BDA00030398941400001417
根据所需路程s与子曲线弧长li的大小关系 确定子曲线上的最大进给率能否达到切向速度最大值F。若s<li,则最大 进给率vm=F,否则需要按照下述方法计算最大进给率vm
(1)求解方程
Figure RE-GDA0003094330090000152
若存在一个 解va满足
Figure RE-GDA0003094330090000153
则vm=v,否则转到步骤(2);
(2)求解方程
Figure BDA0003039894140000153
若存在一个解va满足
Figure BDA0003039894140000154
则 vm=va,否则转到(3);
(3)求解方程
Figure BDA0003039894140000155
必存在 一个解va满足
Figure BDA0003039894140000156
则vm=va
至此确定了子曲线上的最大进给率vm,之后按照如下方法确定七个时 间参数和加速度极值:
Figure BDA0003039894140000157
Figure BDA0003039894140000158
T2=0,
Figure BDA0003039894140000159
否则
Figure BDA00030398941400001510
A1=Am
Figure BDA00030398941400001511
Figure BDA00030398941400001512
T6=0,
Figure BDA00030398941400001513
否则
Figure BDA00030398941400001514
A2=Am
令s=(vs+F)(T1+T2+T3)/2+(ve+F)(T5+T6+T7)/2,则
Figure BDA00030398941400001515
确定子曲线上的七个时间参数和加速度的极大值和极小值之后,可以 根据新颖的S型函数(1)规划多个子曲线上的进给率;之后将多个子曲线 的进给率拼接起来,就得到了整个加工轨迹曲线的进给率。
实施例2
下面以平面的NURBS曲线为例,如图2所示,该NURBS曲线为2阶, 节点向量为U=[0,0,0,0.2,0.4,0.6,0.8,1,1,1],权向量为W=[1,1,1,1,1,1,1], 控制点为P={(60,0),(120,120),(72,48),(60,120),(48,48),(0,120),(60,0)}。 具体过程如下:
步骤一:以Δu=0.0001为间隔,速度最大值F=200mm/s,加速度最 大值Am=2000mm/s2,加加速度最大值Jm=60000mm/s3,计算曲线内 部9999个参数点的最大进给率,得到的最大进给率随着曲线参数的变化如 图3所示。取局部极小值点,得到该参数曲线的关键点为{u1=0.1514,u2= 0.3098,u3=0.5000,u4=0.6902,u5=0.8468。
步骤二:曲线的起点u0=0和终点u6=1,经过双向扫描之后得到表示 关键点及其进给率的二维点列为 {(0,0),(0.1514,12.77),(0.3098,106.83),(0.5000,39.14),(0.6902,106.83), (0.8468,12.77),(1,0)}。关键点将曲线分为六个子曲线。
步骤三:计算得到每个子曲线的七个时间参数和两个加速度极值如下表 所示:
表1六个子曲线的七个时间参数和两个加速度极值
Figure BDA0003039894140000161
Figure BDA0003039894140000171
步骤四:按照公式(1),规划各子曲线的进给率。由式(1)得到的 子曲线的速度如图4所示,在该段子曲线上,进给率从初速度vs历经三种 阶段(加速度增大阶段,加速度固定阶段,加速度减小阶段)加速到切向 速度最大值F,之后以切向速度最大值F匀速运动一段时间,最后历经三种 阶段(加速度增大阶段,加速度固定阶段,加速度减小阶段)减速到末速 度ve,实现了进给率的光滑过渡拼接六个子曲线的进给率,得到了加工轨 迹的进给率,如图5所示,即使在关键点处,进给率也是连续的,整体的 进给率足够光滑。由此可以减少机床加工的震动,从而提高工件的加工质 量。弓高误差如图6所示,可以看到在该曲线任意点上的弓高误差都是小 于给定的阈值的(不到给定阈值的一半),说明本发明的进给率规划方案可 以严格的控制住弓高误差。
对于本领域的普通技术人员来说,在不脱离本发明创造构思的前提下, 还可以对本发明的实施例做出若干变型和改进,这些都属于本发明的保护 范围。

Claims (5)

1.一种基于弓高误差限制和加速度连续的进给率规划方法,其特征在于,包括如下步骤:
S1:使用三角函数过渡S型函数的加加速度从零到极大值之间的变化,使得加加速度连续,构造新颖的S型函数如下:
Figure FDA0003039894130000011
其中,v(t)为进给率;Ti,i=1,2,3,4,5,6,7是新型S型进给率函数(1)规划的子曲线的七个时间参数;A1和A2分别是新型S型进给率函数(1)规划的子曲线的加速度的极大值和极小值;t表示当前时间;ti,i=1,2,3,4,5,6,7是时间累计量,即t1=T1,t2=T1+T2,t3=T1+T2+T3,t4=T1+T2+T3+T4,t5=T1+T2+T3+T4+T5,t6=T1+T2+T3+T4+T5+T6,t7=T1+T2+T3+T4+T5+T6+T7;vs是初始速度;vm是允许的最大速度;
S2:使用等间隔参数序列,依据弓高误差限制和运动学限制获得加工轨迹曲线的多个关键点;
S3:利用双向扫描调节步骤S2中获得的某些关键点的进给率,以使前一个关键点的进给率光滑过渡到后一个关键点的进给率;
S4:在步骤S3调节某些关键点的进给率之后,确定各子曲线的时间参数和加速度极值,并带入式(1)中,得到各子曲线的进给率;将多个子曲线的进给率进行拼接,获得整个加工轨迹曲线的进给率。
2.根据权利要求1所述的方法,其特征在于,步骤2具体过程如下:
假定加工轨迹曲线的参数表达式为P(u)=(x(u),y(u),z(u)),其中,u为参数点且0≤u≤1,u=0表示曲线的起点,u=1为曲线的终点;设定参数点间隔为Δu,即ui+1=ui+Δu,ui+1表示第i+1个参数点,ui表示第i个参数点,i=0,1,2,...,n,n表示曲线内部参数点的个数;x(u),y(u),z(u)分别为x,y,z坐标轴上的参数表达式;
首先考虑弓高误差的限制,由于插补周期很小,在弓高误差的计算过程中,使用微小圆弧段近似代替参数点附近的曲线;对于参数点ui,弓高误差由如下式计算:
Figure FDA0003039894130000021
其中,εchord为弓高误差;ρi为参数点ui的曲率半径;vi为参数点ui的进给率;Ts为插补周期;假定给定的弓高误差阈值为e,则εchord≤e,由式(2)得到
Figure FDA0003039894130000022
其次考虑运动学限制,运动学限制要考虑切向速度、法向加速度和法向加加速度;使用小圆弧段近似代替参数点附近的曲线,法向加速度和法向加加速度由下式计算:
Figure FDA0003039894130000023
Figure FDA0003039894130000024
其中,An为切向加速度;Jn为切向加加速度;
假定给定的切向加速度和切向加加速度的阈值分别为Am和Jm,则有An≤Am和Jn≤Jm,由式(3)和(4)得到
Figure FDA0003039894130000031
Figure FDA0003039894130000032
综合考虑上述弓高误差和运动学限制以及进给率最大值限制,参数点ui的进给率如下:
Figure FDA0003039894130000033
其中,F是切向速度最大值;
当确定所有参数点的进给率之后,选择进给率局部最小的参数点作为曲线的关键点,并根据这些关键点将曲线分为多个子曲线;其中,进给率局部最小指的是参数点ui的进给率vi满足条件vi≤vi+1和vi≤vi-1
3.根据权利要求2所述的方法,其特征在于,步骤3中,首先利用正向扫描调节某些关键点的进给率,具体过程如下:
A.令i=0;
B.若vi+1>vi则转到步骤C;否则转到步骤F;
C.若
Figure FDA0003039894130000034
则转到步骤D;否则转到步骤E;
D.令
Figure FDA0003039894130000035
T2=0,计算过渡长度s=(vi+1+vi)(T1+T2+T3)/2,若s<li则无需改变vi+1,其中,li表示从参数点ui到参数点ui+1之间的弧长;若s>li则解如下方程:
Figure FDA0003039894130000036
若存在唯一的解vupdate满足vi<vupdate<vi+1,则令vi+1=vupdate,转到步骤F;
E.令
Figure FDA0003039894130000037
计算过渡长度s=(vi+1+vi)(T1+T2+T3)/2,若s<li则无需改变vi+1;若s>li则分别求解方程(6) 和如下方程(7):
Figure FDA0003039894130000041
若存在唯一的解vupdate满足vi<vupdate<vi+1,则令vi+1=vupdate,转到步骤F;
F.令i=i+1,若i<n则转到步骤B;否则结束调节;
在正向扫描结束之后进行反向扫描,具体过程如下:
A’.令i=n;
B’.若vi>vi+1则转到步骤C’;否则转到步骤F’;
C’.若
Figure FDA0003039894130000042
则转到步骤D’;否则转到步骤E’;
D’.令
Figure FDA0003039894130000043
T2=0,计算过渡长度s=(vi+vi+1)(T1+T2+T3)/2,若s<li则无需改变vi,其中li表示从参数点ui到参数点ui+1之间的弧长;若s>li则解如下方程:
Figure FDA0003039894130000044
若存在唯一的解vupdate满足vi+1<vupdate<vi,则令vi=vupdate,转到步骤F’;其中,v表示对应子曲线段上可以达到的最大速度;
E’.令
Figure FDA0003039894130000045
计算过渡长度s=(vi+vi+1)(T1+T2+T3)/2,若s<li则无需改变vi;若s>li则分别求解方程(8)和如下方程(9):
Figure FDA0003039894130000046
若存在唯一的解vupdate满足vi+1<vupdate<vi,则令vi=vupdate,转到步骤F’;
F’.令i=i-1,若i>0则转到步骤B’;否则结束调节。
4.根据权利要求3所述的方法,其特征在于,步骤4具体过程如下:
在步骤S3中经过进给率调节后,某些关键点的进给率有所降低,则多个子曲线可由此分成两类:第一类是两端的关键点进给率至少有一个变化的子曲线,第二类是两端的关键点进给率都未变化的子曲线,对于第j个子曲线,他的初始进给率vs=vj-1,结束进给率ve=vj,其中j=1,2,...,n。
5.根据权利要求4所述的方法,其特征在于,第一类子曲线采用如下方法确定七个时间参数和两个加速度极值:
当vs<ve时,首先令T4=T5=T6=T7=0,A2=0。若
Figure RE-FDA0003094330080000051
则令
Figure RE-FDA0003094330080000052
T2=0,
Figure RE-FDA0003094330080000053
否则令
Figure RE-FDA0003094330080000054
Figure RE-FDA0003094330080000055
A1=Am
当vs>ve时,首先令T1=T2=T3=T4=0,A1=0。若
Figure RE-FDA0003094330080000056
则令
Figure RE-FDA0003094330080000057
T6=0,
Figure RE-FDA0003094330080000058
否则令
Figure RE-FDA0003094330080000059
Figure RE-FDA00030943300800000510
A2=Am
第二类子曲线采用如下方法确定七个时间参数和两个加速度极值;
首先要判断子曲线上的最大进给率能否达到切向速度最大值F,具体判断过程如下:
按照下式(10)计算从初速度vs加速到切向速度最大值F,然后再减速到末速度ve所需路程:
s=(vs+F)(T1+T2+T3)/2+(ve+F)(T5+T6+T7)/2 (10)
其中,当
Figure RE-FDA00030943300800000511
时,
Figure RE-FDA00030943300800000512
T2=0;否则
Figure RE-FDA00030943300800000513
Figure RE-FDA00030943300800000514
Figure RE-FDA00030943300800000515
时,
Figure RE-FDA00030943300800000516
T7=0;否则
Figure RE-FDA00030943300800000517
根据所需路程s与子曲线弧长li的大小关系确定子曲线上的最大进给率能否达到切向速度最大值F,若s<li,则最大进给率vm=F,否则需要按照下述方法计算最大进给率vm
(1)求解方程
Figure RE-FDA0003094330080000061
若存在一个解va满足
Figure RE-FDA0003094330080000062
则vm=v,否则转到步骤(2);
(2)求解方程
Figure RE-FDA0003094330080000063
若存在一个解va满足
Figure RE-FDA0003094330080000064
则vm=va,否则转到步骤(3);
(3)求解方程
Figure RE-FDA0003094330080000065
必存在一个解va满足
Figure RE-FDA0003094330080000066
则vm=va
在确定子曲线上的最大进给率vm后,按照如下方法确定七个时间参数和加速度极值:
Figure RE-FDA0003094330080000067
Figure RE-FDA0003094330080000068
T2=0,
Figure RE-FDA0003094330080000069
否则
Figure RE-FDA00030943300800000610
A1=Am
Figure RE-FDA00030943300800000611
Figure RE-FDA00030943300800000612
T6=0,
Figure RE-FDA00030943300800000613
否则
Figure RE-FDA00030943300800000614
A2=Am
令s=(vs+F)(T1+T2+T3)/2+(ve+F)(T5+T6+T7)/2,则
Figure RE-FDA00030943300800000615
CN202110453986.8A 2021-04-26 2021-04-26 一种基于弓高误差限制和加加速度连续的进给率规划方法 Active CN113156891B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110453986.8A CN113156891B (zh) 2021-04-26 2021-04-26 一种基于弓高误差限制和加加速度连续的进给率规划方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110453986.8A CN113156891B (zh) 2021-04-26 2021-04-26 一种基于弓高误差限制和加加速度连续的进给率规划方法

Publications (2)

Publication Number Publication Date
CN113156891A true CN113156891A (zh) 2021-07-23
CN113156891B CN113156891B (zh) 2023-02-17

Family

ID=76870940

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110453986.8A Active CN113156891B (zh) 2021-04-26 2021-04-26 一种基于弓高误差限制和加加速度连续的进给率规划方法

Country Status (1)

Country Link
CN (1) CN113156891B (zh)

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104007705A (zh) * 2014-05-05 2014-08-27 上海交通大学 小线段路径压缩平滑的前瞻插补系统
CN105500354A (zh) * 2016-02-02 2016-04-20 南京埃斯顿机器人工程有限公司 一种工业机器人应用的过渡轨迹规划方法
CN107817764A (zh) * 2017-10-23 2018-03-20 山东大学 一种基于s曲线加减速算法的nurbs曲线双向自适应插补算法
KR20180082115A (ko) * 2017-01-10 2018-07-18 한화에어로스페이스 주식회사 S-커브를 이용한 모션 프로파일 생성 방법 및 컴퓨팅 장치
CN110865610A (zh) * 2019-10-18 2020-03-06 中国工程物理研究院机械制造工艺研究所 一种基于机床振动抑制的刀具轨迹插值和速度规划方法
CN111240275A (zh) * 2020-01-16 2020-06-05 北京航空航天大学 基于对数几率函数在运动和误差限制下的进给率规划方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104007705A (zh) * 2014-05-05 2014-08-27 上海交通大学 小线段路径压缩平滑的前瞻插补系统
CN105500354A (zh) * 2016-02-02 2016-04-20 南京埃斯顿机器人工程有限公司 一种工业机器人应用的过渡轨迹规划方法
KR20180082115A (ko) * 2017-01-10 2018-07-18 한화에어로스페이스 주식회사 S-커브를 이용한 모션 프로파일 생성 방법 및 컴퓨팅 장치
CN107817764A (zh) * 2017-10-23 2018-03-20 山东大学 一种基于s曲线加减速算法的nurbs曲线双向自适应插补算法
CN110865610A (zh) * 2019-10-18 2020-03-06 中国工程物理研究院机械制造工艺研究所 一种基于机床振动抑制的刀具轨迹插值和速度规划方法
CN111240275A (zh) * 2020-01-16 2020-06-05 北京航空航天大学 基于对数几率函数在运动和误差限制下的进给率规划方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
SHUJIE SUN 等: "A study on adaptive NURBS interpolation points calculation with jerk-limited acceleration", 《2013 IEEE INTERNATIONAL CONFERENCE ON INFORMATION AND AUTOMATION (ICIA)》 *
杨敏 等: "复杂约束下的五轴数控系统自适应速度规划", 《机械工程学报》 *

Also Published As

Publication number Publication date
CN113156891B (zh) 2023-02-17

Similar Documents

Publication Publication Date Title
CN105759725B (zh) 速度敏感区间恒速曲线插补速度规划方法
US20200004228A1 (en) A feedrate scheduling method for five-axis dual-spline curve interpolation
EP1869531B1 (en) Method of tolerance-based trajectory planning
Bi et al. A general, fast and robust B-spline fitting scheme for micro-line tool path under chord error constraint
CN108227630B (zh) 一种采用时间参数多项式插补的自由曲面数控加工方法
CN100445911C (zh) 曲线插补方法
WO2016127826A1 (zh) 曲线速度规划方法、装置及其数控加工路径数据处理方法
KR100253684B1 (ko) 가공능률을향상시키기위해가공기의능력을고려하여커터경로를규정하는이산점들을생성하는방법
CN109765887B (zh) 一种自动驾驶控制方法
CN105045211B (zh) 一种等弓高误差变步长切线插补方法
CN103064344A (zh) 一种基于nurbs曲线插补的速度平滑控制方法
CN101539769A (zh) 基于二次b样条曲线对g01代码的拟合及插补方法
CN112486101B (zh) Nurbs曲线自适应前瞻插补方法
CN110134065B (zh) 一种基于正弦平方加速度前瞻的机床加工轨迹运动规划方法
CN114115131B (zh) 一种应用于五轴数控机床的时间样条曲线拟合与插补方法
CN111240275B (zh) 基于对数几率函数在运动和误差限制下的进给率规划方法
KR0170434B1 (ko) 편평한 압출성형물과 환상단면의 성형물의 압출성형방법과 그 장치
CN114019910B (zh) 一种小线段刀具轨迹实时全局光顺方法
CN113156891B (zh) 一种基于弓高误差限制和加加速度连续的进给率规划方法
CN114740803A (zh) 一种nurbs曲线插补速度控制方法、装置及设备
CN112486094B (zh) 复杂曲面侧铣加工的刀具优化和加工轨迹生成方法
CN111610751B (zh) 过点集nurbs插值曲线的插值误差多次细分迭代计算方法
CN111487928B (zh) 一种基于刀位点增删改指令的数控加工轨迹平滑方法
Sencer et al. Curvature-continuous sharp corner smoothing scheme for Cartesian motion systems
CN109991921B (zh) 一种平顺b样条轨迹直接生成方法

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant