CN109032077B - 一种基于刀具姿态控制的五轴数控加工指令点插补方法 - Google Patents
一种基于刀具姿态控制的五轴数控加工指令点插补方法 Download PDFInfo
- Publication number
- CN109032077B CN109032077B CN201811031196.5A CN201811031196A CN109032077B CN 109032077 B CN109032077 B CN 109032077B CN 201811031196 A CN201811031196 A CN 201811031196A CN 109032077 B CN109032077 B CN 109032077B
- Authority
- CN
- China
- Prior art keywords
- point
- vector
- interpolation
- curve
- axis
- 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
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical 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/41—Numerical 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
Abstract
Description
技术领域
本发明涉及数控加工技术领域,具体涉及一种基于刀具姿态控制的五轴数控加工指令点插补方法。
背景技术
五轴数控机床能够通过刀尖点位置坐标和刀轴矢量的变化达到灵活控制刀具位姿的目的,从而提高加工速度、精度和表面光洁度,在航空、汽车、模具制造等行业得到广泛应用。指令点插补对加工精度和效率有着直接影响,是五轴数控加工中的关键问题。
线性插补是五轴数控系统常用的指令点插补方法,该方法通过对机床各轴首末点位置坐标进行线性分割,实现刀具位姿变化。在实际加工中发现,线性插补方式会导致下述问题产生。首先,五轴数控加工工件几何造型复杂,采用直线段对复杂曲线离散化,不仅会增加数据传输负担,而且在离散化过程中会产生不必要的误差。其次,由于刀轴矢量各分量与旋转轴位置坐标间存在非线性映射,采用线性插补法进行五轴数控加工时,无法控制刀具姿态。最后,线性插补方法无法保证机床各轴速度和加速度的连续性,影响加工表面光滑度。
发明内容
针对现有技术存在的问题,本发明提供一种基于刀具姿态控制的五轴数控加工指令点插补方法,将通过获取到的离散刀轴矢量和刀尖点拟合得到的连续曲线进行插补,以降低数据传输负担,保证刀具姿态曲线二阶连续变化,进而实现机床旋转轴速度和加速度连续变化。
为了实现上述目的,一种基于刀具姿态控制的五轴数控加工指令点插补方法,包括以下步骤:
步骤1:根据加工需求,使用五轴数控加工程序,根据给定的数控加工程序得到刀尖点位置集合P={Pk|Pk=(Pxk,Pyk,Pzk)且Pxk,Pyk,Pzk∈R,k=0,...,n}和刀轴矢量集合Q={Qk|Qk=(Qxk,Qyk,Qzk),|Qk|=1,k=0,...,n};
步骤2:根据读入的数控加工程序,将离散刀尖点位置集合转化为参数样条曲线P(u);
步骤3:根据读入的数控加工程序确定待插补曲线起始点P0和终点Pn对应的刀轴矢量Q0和Qn,从而建立局部旋转坐标系Q0-N-V;
步骤4:根据任意点Pk∈P,确定其对应刀轴矢量Qk在局部旋转坐标系Q0-N-V中的位置,并根据任意刀轴矢量Qk得到刀轴矢量曲线Q(u);
步骤6:根据第k-1个插补周期插补点对应的参数值uk-1、系统插补周期Ts和第k-1个插补周期对应加工速度V(uk-1),确定第k个插补周期插补点对应参数值uk;
步骤7:将第k个插补周期插补点对应的参数值uk带入刀尖点拟合曲线P(u)和刀具姿态曲线Q(u),即得到下一插补周期的插补点P(uk)和对应刀轴矢量Q(uk)。
进一步地,所述步骤2将离散刀尖点位置集合转化为参数样条曲线P(u)的公式如下:
P(u)=(x(u),y(u),z(u));
其中,u为曲线参数,且u0≤u≤un,x(u)、y(u)和z(u)分别为参数u在坐标系x轴、y轴和z轴的分量拟合得到参数曲线。
进一步地,所述步骤3中建立局部旋转坐标系Q0-N-V的公式如下:
进一步地,所述步骤4中确定刀轴矢量Qk在局部旋转坐标系Q0-N-V中位置的公式如下:
ψk=arc sin(Qk·V);
进一步地,所述步骤5.1中确定参数值uk的公式如下:
其中,|Pk-1Pk|表示刀具沿点Pk-1运动到点Pk时的距离,其计算公式如下:
进一步地,所述步骤5.2中确定参数值uk对应点处一、二阶导数的公式如下:
其中,ψk′(uk)为参数值uk对应点处的一阶导数,ψk″(uk)为参数值uk对应点处的二阶导数,b3k、b2k、blk和b0k均为曲线系数。
其中,αk(u)、αk+1(u)、βk(u)、βk+1(u)、γk(u)和γk+1(u)为五次样条曲线系数,其计算公式如下:
进一步地,所述步骤6中确定第k个插补周期插补点对应参数值uk的公式如下:
本发明的有益效果:
本发明提出一种基于刀具姿态控制的五轴数控加工指令点插补方法,一方面,通过对获取的离散刀轴矢量拟合确定刀具姿态曲线,能够保证加工过程中的刀轴矢量始终在所要求的单位球面上运动,避免了线性插补方法中旋转轴随动变化产生的非线性误差,提高了加工精度,另一方面,本方法能够得到二阶连续的刀具姿态曲线,进而保证机床旋转轴速度和加速度的连续性,避免机床旋转轴的大幅变化,提高加工表面光滑度。
附图说明
图1为本发明实施例中基于刀具姿态控制的五轴数控加工指令点插补方法流程图;
图2为本发明实施例中刀具轨迹图;
图3为本发明实施例中刀具姿态曲线图;
图4为本发明实施例中刀具姿态曲线各分量及一、二阶导数变化图;
其中,(a)为本发明实施例中刀具姿态曲线各分量变化图;(b)为本发明实施例中刀具姿态曲线各分量一阶导数变化图;(c)为本发明实施例中刀具姿态曲线各分量二阶导数变化图。
具体实施方式
为了使本发明的目的、技术方案及优势更加清晰,下面结合附图和具体实施例对本发明做进一步详细说明。此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明。
一种基于刀具姿态控制的五轴数控加工指令点插补方法,流程如图1所示,具体方法如下所述:
步骤1:根据加工需求,使用五轴数控加工程序,根据给定的数控加工程序得到刀尖点位置集合P={Pk|Pk=(Pxk,Pyk,Pzk)且Pxk,Pyk,Pzk∈R,k=0,...,n}和刀轴矢量集合Q={Qk|Qk=(Qxk,Qyk,Qzk),|Qk|=1,k=0,...,n};
本实施例中,采用刀轴矢量编程方式形成的数控加工程序得到刀尖点位置集合P和刀轴矢量集合Q,刀轴矢量编程方式形成的数控加工程序可表示为如下格式:
G05.0X_Y_Z_U_V_W_F_;
其中,刀尖点在X、Y、Z方向的坐标分量分别由X_、Y_、Z_后的数值确定,刀轴矢量在X、Y、Z方向的坐标分量分别由U_、V_、W_后的数值确定,F为该段程序对应的刀具进给速度。
步骤2:根据读入的数控加工程序,将离散刀尖点位置集合转化为参数样条曲线P(u);
所述将离散刀尖点位置集合转化为参数样条曲线P(u)的公式如下:
P(u)=(x(u),y(u),z(u));
其中,u为曲线参数,且u0≤u≤un,x(u)、y(u)和z(u)分别为参数u在坐标系x轴、y轴和z轴的分量拟合得到参数曲线。
步骤3:根据读入的数控加工程序确定待插补曲线起始点P0和终点Pn对应的刀轴矢量Q0和Qn,从而建立局部旋转坐标系Q0-N-V;
所述建立局部旋转坐标系Q0-N-V的公式如下:
步骤4:根据任意点Pk∈P,确定其对应刀轴矢量Qk在局部旋转坐标系Q0-N-V中的位置,并根据任意刀轴矢量Qk得到刀轴矢量曲线Q(u);
所述确定刀轴矢量Qk在局部旋转坐标系Q0-N-V中位置的公式如下:
ψk=arc sin(Qk·V);
所述确定参数值uk的公式如下:
其中,|Pk-1Pk|表示刀具沿点Pk-1运动到点Pk时的距离,其计算公式如下:
本实施例中,假定由点ψk-2,ψk-1,ψk,ψk+1和ψk+2确定的三次样条拟合曲线ψk(u)如下式所示:
ψk(u)=b3ku3+b2ku2+b1ku+b0k (uk-2≤u≤uk+2);
其中,b3k、b2k、b1k和b0k均为曲线系数。令Ik表示点ψk-2,ψk-1,ψk,ψk+1和ψk+2与拟合曲线ψk(u)上参数uk-2,uk-1,uk,uk+1和uk+2对应点间距离的平方和:
则Ik表示以bik为变量的函数,为使函数Ik达到最小值,Ik对各变量bik的偏导数应满足:
上式可表示为:
将参数uk-2,uk-1,uk,uk+1,uk+2以及ψk-2,ψk-1,ψk,ψk+1,ψk+2代入上式,即可确定bik(i=0,1,2,3)的值,进而确定参数值uk对应点处一、二阶导数的公式如下:
其中,ψk′(uk)为参数值uk对应点处的一阶导数,ψk″(uk)为参数值uk对应点处的二阶导数。
本实施例中,参数u0和u1处对应值的一、二阶导数分别等于ψ2(u0)和ψ2(u1)处一、二阶导数值,参数un和un-1处对应值的一、二阶导数分别等于ψn-2(un)和ψn-2(un-1)处一、二阶导数值。当确定参数uk对应点ψk的一、二阶导矢量后,刀轴矢量由Qk变化至Qk+1过程中,刀轴矢量与平面N-Qn间夹角ψk(u)的公式如下:
令参数u0和u1处对应值的一、二阶导数等于和处一、二阶导数值,参数un和un-1处对应值的一、二阶导数分别等于和处一、二阶导数值。当确定参数uk对应点的一、二阶导矢量后,刀轴矢量由Qk变化至Qk+1过程中,刀轴矢量与平面N-Qn间夹角的公式如下:
其中,αk(u)、αk+1(u)、βk(u)、βk+1(u)、γk(u)和γk+1(u)为五次样条曲线系数,其计算公式如下:
步骤6:根据第k-1个插补周期插补点对应的参数值uk-1、系统插补周期Ts和第k-1个插补周期对应加工速度V(uk-1),确定第k个插补周期插补点对应参数值uk;
所述确定第k个插补周期插补点对应参数值uk的公式如下:
步骤7:将第k个插补周期插补点对应的参数值uk带入刀尖点拟合曲线P(u)和刀具姿态曲线Q(u),即得到下一插补周期的插补点P(uk)和对应刀轴矢量Q(uk)。
为验证本发明方法的有效性,在插补周期T=2ms,编程进给速度F=4500mm/min,最大加速度amax=280mm/s2,最大轮廓误差emax=0.03mm的条件下,采用本方法对S型试件进行加工仿真。为便于进行分析,选择S型试件上的一条刀具轨迹进行说明,如图2所示。
图3所示为采用本文所述算法得到的刀具姿态曲线。由该图可知,所得到的刀具姿态曲线位于单位球面上且经过给定的离散刀轴矢量集合,说明本算法能够保证刀具姿态曲线上任意向量均为单位矢量。图中星号标记点为给定的离散刀轴矢量,说明所生成的刀具姿态曲线能够经过给定的离散刀轴矢量。
图4所示为刀具姿态曲线各分量及其一、二阶导数图。该图进一步说明采用本算法得到的刀具姿态曲线经过给定的离散刀轴矢量,且曲线在x,y和z方向各分量均满足一阶和二阶连续的条件。
最后应说明的是:以上实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解;其依然可以对前述实施例所记载的技术方案进行修改,或者对其中部分或者全部技术特征进行等同替换;因而这些修改或者替换,并不使相应技术方案的本质脱离本发明权利要求所限定的范围。
Claims (8)
1.一种基于刀具姿态控制的五轴数控加工指令点插补方法,其特征在于,包括以下步骤:
步骤1:根据加工需求,使用五轴数控加工程序,根据给定的数控加工程序得到刀尖点位置集合P={Pk|Pk=(Pxk,Pyk,Pzk)且Pxk,Pyk,Pzk∈R,k=0,...,n}和刀轴矢量集合Q={Qk|Qk=(Qxk,Qyk,Qzk),|Qk|=1,k=0,...,n};
步骤2:根据读入的数控加工程序,将离散刀尖点位置集合转化为参数样条曲线P(u);
步骤3:根据读入的数控加工程序确定待插补曲线起始点P0和终点Pn对应的刀轴矢量Q0和Qn,从而建立局部旋转坐标系Q0-N-V;
步骤4:根据任意点Pk∈P,确定其对应刀轴矢量Qk在局部旋转坐标系Q0-N-V中的位置,并根据任意刀轴矢量Qk得到刀轴矢量曲线Q(u);
步骤6:根据第k-1个插补周期插补点对应的参数值uk-1、系统插补周期Ts和第k-1个插补周期对应加工速度V(uk-1),确定第k个插补周期插补点对应参数值uk;
步骤7:将第k个插补周期插补点对应的参数值uk带入刀尖点拟合曲线P(u)和刀具姿态曲线Q(u),即得到下一插补周期的插补点P(uk)和对应刀轴矢量Q(uk)。
2.根据权利要求1所述的基于刀具姿态控制的五轴数控加工指令点插补方法,其特征在于,所述步骤2中将离散刀尖点位置集合转化为参数样条曲线P(u)的公式如下:
P(u)=(x(u),y(u),z(u));
其中,u为曲线参数,且u0≤u≤un,x(u)、y(u)和z(u)分别为参数u在坐标系x轴、y轴和z轴的分量拟合得到参数曲线。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811031196.5A CN109032077B (zh) | 2018-09-05 | 2018-09-05 | 一种基于刀具姿态控制的五轴数控加工指令点插补方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811031196.5A CN109032077B (zh) | 2018-09-05 | 2018-09-05 | 一种基于刀具姿态控制的五轴数控加工指令点插补方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109032077A CN109032077A (zh) | 2018-12-18 |
CN109032077B true CN109032077B (zh) | 2022-03-18 |
Family
ID=64623472
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811031196.5A Active CN109032077B (zh) | 2018-09-05 | 2018-09-05 | 一种基于刀具姿态控制的五轴数控加工指令点插补方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109032077B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111679629B (zh) * | 2020-06-01 | 2023-01-10 | 南京航空航天大学 | 一种多主轴头加工的空行程无干涉轨迹规划方法 |
CN112847364B (zh) * | 2021-01-06 | 2022-09-30 | 南京航空航天大学 | 机器人铣削加工刀具路径c3连续的在线实时解析光顺方法 |
CN112685978B (zh) * | 2021-03-11 | 2021-06-08 | 中国空气动力研究与发展中心计算空气动力研究所 | 一种适用于五次样条重构格式的自适应人工粘性控制方法 |
CN113433889B (zh) * | 2021-06-08 | 2023-09-26 | 西安交通大学 | 一种基于三段式羊角曲线的五轴机床加工的刀具轨迹规划方法 |
CN113778018B (zh) * | 2021-08-25 | 2023-04-07 | 西安交通大学 | 一种基于R-test的五轴机床刀轴矢量误差测量方法 |
CN115616983B (zh) * | 2022-12-14 | 2023-03-07 | 广东工业大学 | 一种五轴联动同步刀具路径插补方法和系统 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102393678A (zh) * | 2011-08-25 | 2012-03-28 | 沈阳高精数控技术有限公司 | 适用于五轴数控装置的轨迹平滑处理方法 |
CN102566494A (zh) * | 2010-12-09 | 2012-07-11 | 中国科学院沈阳计算技术研究所有限公司 | 一种基于刀具矢量平滑压缩的五轴数控插补方法 |
CN102566496A (zh) * | 2010-12-09 | 2012-07-11 | 中国科学院沈阳计算技术研究所有限公司 | 适用于数控装置的进给速度动态实时前瞻控制方法 |
CN103257614A (zh) * | 2012-02-20 | 2013-08-21 | 发那科株式会社 | 具有加工曲线生成功能的数值控制装置 |
Family Cites Families (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3207409B2 (ja) * | 1988-03-10 | 2001-09-10 | ファナック株式会社 | ロボットのツール姿勢制御方法 |
DE112005000451B4 (de) * | 2004-02-27 | 2020-02-13 | Thk Co., Ltd. | Designverfahren für ein Industrieerzeugnis unter Verwendung einer Klothoidenkurve, und Verfahren und Vorrichtung zur numerischen Steuerung unter Verwendung der Klothoidenkurve |
CN102566511B (zh) * | 2010-12-09 | 2013-07-03 | 中国科学院沈阳计算技术研究所有限公司 | 五轴数控系统刀心点插补路径插值方法 |
CN102608951B (zh) * | 2011-01-25 | 2014-12-17 | 沈阳机床(集团)设计研究院有限公司上海分公司 | 五轴联动刀轴矢量平面插补算法 |
CN102393680B (zh) * | 2011-09-29 | 2013-05-22 | 沈阳高精数控技术有限公司 | 一种基于圆锥面刀具矢量插值的参数曲线插补方法 |
JP5425342B1 (ja) * | 2012-05-22 | 2014-02-26 | 三菱電機株式会社 | 数値制御装置 |
JP5426728B2 (ja) * | 2012-06-28 | 2014-02-26 | ファナック株式会社 | 多軸加工機用工具姿勢制御機能を有する数値制御装置 |
WO2014016943A1 (ja) * | 2012-07-26 | 2014-01-30 | 三菱電機株式会社 | 数値制御装置 |
CN104635619A (zh) * | 2013-11-12 | 2015-05-20 | 沈阳高精数控技术有限公司 | 基于刀具矢量插补的五轴数控加工方法 |
CN106094730B (zh) * | 2016-06-30 | 2018-04-06 | 沈阳建筑大学 | 基于数控机床主轴和伺服轴功率的切削力系数辨识方法 |
CN106647623B (zh) * | 2016-12-22 | 2019-08-13 | 广州数控设备有限公司 | 一种几何精度及衔接速度最优化的五轴联动平滑插补方法 |
-
2018
- 2018-09-05 CN CN201811031196.5A patent/CN109032077B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102566494A (zh) * | 2010-12-09 | 2012-07-11 | 中国科学院沈阳计算技术研究所有限公司 | 一种基于刀具矢量平滑压缩的五轴数控插补方法 |
CN102566496A (zh) * | 2010-12-09 | 2012-07-11 | 中国科学院沈阳计算技术研究所有限公司 | 适用于数控装置的进给速度动态实时前瞻控制方法 |
CN102393678A (zh) * | 2011-08-25 | 2012-03-28 | 沈阳高精数控技术有限公司 | 适用于五轴数控装置的轨迹平滑处理方法 |
CN103257614A (zh) * | 2012-02-20 | 2013-08-21 | 发那科株式会社 | 具有加工曲线生成功能的数值控制装置 |
Non-Patent Citations (3)
Title |
---|
A TOOL PATH CORRECTION AND COMPRESSION ALGORITHM FOR FIVE-AXIS CNC MACHINING;Geng Cong等;《 Journal of Systems ence & Complexity》;20131015;正文第804、810-811页 * |
数控系统五轴联动轨迹平滑技术研究与应用;耿聪;《中国博士学位论文全文数据库 工程科技I辑》;20141115;正文第7、44-66、96页 * |
耿聪.数控系统五轴联动轨迹平滑技术研究与应用.《中国博士学位论文全文数据库 工程科技I辑》.2014, * |
Also Published As
Publication number | Publication date |
---|---|
CN109032077A (zh) | 2018-12-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109032077B (zh) | 一种基于刀具姿态控制的五轴数控加工指令点插补方法 | |
US9513623B2 (en) | Method for generating trajectory for numerical control process | |
CN110039538B (zh) | 一种基于大型复杂构件点云信息的机器人轨迹规划方法 | |
US20030033050A1 (en) | Motion control system and method utilizing spline interpolation | |
CN112847364B (zh) | 机器人铣削加工刀具路径c3连续的在线实时解析光顺方法 | |
CN110722576B (zh) | 工业机器人铣削加工路径全局光顺方法及系统 | |
CN105759726B (zh) | 基于轮廓误差约束的自适应曲线插补方法 | |
CN112162527A (zh) | 适用于五轴数控装置的刀具路径拐角平滑过渡方法 | |
Švejda et al. | Interpolation method for robot trajectory planning | |
CN116400646A (zh) | 一种基于奇异补偿的五轴数控机床通用后置处理方法 | |
WO2018020663A1 (ja) | 数値制御装置 | |
CN114019910A (zh) | 一种小线段刀具轨迹实时全局光顺方法 | |
JP2006053789A (ja) | 多軸数値制御装置用のncポストプロセッサ装置 | |
Shi et al. | A novel task coordinate frame reduced-dimension 3-D contouring control | |
Jia et al. | Adaptive estimation and nonlinear variable gain compensation of the contouring error for precise parametric curve following | |
CN109697272B (zh) | 一种简易的二次b样条曲线拟合方法 | |
Simba et al. | Iterative contouring controller design for biaxial feed drive systems | |
CN115502984A (zh) | 六自由度机器人侧铣运动规划方法及系统 | |
Wang et al. | Universal real-time NURBS interpolator on a PC-based controller | |
Wang et al. | Research and implementation of high-precision biaxial tracking control system based on NURBS interpolator | |
TWI541623B (zh) | 五軸加工數值控制系統及其數值控制方法 | |
Geng et al. | A tool path correction and compression algorithm for five-axis CNC machining | |
JP2009538744A (ja) | 旋削加工を制御する方法、および旋削加工に適したnc機械 | |
CN113946139A (zh) | 数控系统的速度预测、数控系统的控制方法及数控系统 | |
CN109531573B (zh) | 一种基于样条线机器人姿态平滑路径生成方法 |
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 |