具有多轴加工机用刀具姿态控制功能的数值控制装置制造方法
【专利摘要】本发明提供一种具有多轴加工机用刀具姿态控制功能的数值控制装置。该数值控制装置控制具有三个直线轴和包含一个刀具相位控制用旋转轴的三个旋转轴的多轴加工机。该数值控制装置根据刀具前端点位置指令以及刀具姿态指令平滑地对刀具前端点位置以及刀具姿态（刀具方向、刀具相位方向）进行插补，求出插补刀具前端点位置和插补刀具姿态（插补刀具方向、插补刀具相位方向），根据求出的插补刀具前端点位置以及所述插补刀具姿态运算多轴加工机的三个直线轴以及三个旋转轴的各自的位置，向运算出的位置驱动这些各轴。
【专利说明】具有多轴加工机用刀具姿态控制功能的数值控制装置
【技术领域】
[0001]本发明涉及具有控制多轴加工机的多轴加工机用刀具姿态控制功能的数值控制装置，该多轴加工机具有至少三个直线轴和包含一个刀具相位控制用旋转轴的至少三个旋转轴。
【背景技术】
[0002]在具有至少三个直线轴和包含一个刀具相位控制用旋转轴的至少三个旋转轴的多轴加工机中，如下述[I]~[3]中所述那样，有使刀具前端点位置、刀具方向、刀具相位方向变化的同时对工件进行的加工。
[0003][I]纤维铺放机
[0004]所谓纤维铺放机，如图1所示，是在飞机的机身、翼面、火箭主体等具有平滑的面的工件上卷绕从滚轮出来的纤维(碳纤维复合材料)的加工机。刀具位置(臂位置)由通过Χ、y、z轴动作的臂来控制，刀具方向由两个旋转轴即B轴以及C轴来控制，刀具相位方向(滚轮方向)由另一个旋转轴即A轴来控制。
[0005]在图1中，虽然在图的右侧存在纤维铺放机的主体，但是省略了图示。另外，相对于刀具，工件被相对小地描绘。如图2所示，刀具前端点位置在工件上方平滑地移动的同时，一边平滑地改变刀具方向以及刀具相位方向，一边卷绕纤维。在图2中，将刀具前端点位置变化的路径描绘为刀具前端点路径，另外，将表示刀具方向以及刀具相位方向的矢量前端变化的路径分别描绘为刀具方向路径以及刀具相位方向路径。将表示刀具方向以及刀具相位方向的矢量设为单位矢量。以下也同样。
[0006][2]水射流机床
[0007]所谓水射流机床如图3所示，是通过从喷嘴喷射高压的切断水来切断工件的加工机。接受切断水的接收器(catcher)由臂来支承。刀具位置(刀具头位置)由三个直线轴、即X轴、Y轴、Z轴来控制，刀具方向(喷嘴方向)由两个旋转轴、即B轴、C轴来控制，刀具相位方向(臂方向)由另一个旋转轴、即A轴来控制。
[0008]如图4所示，刀具前端点位置在工件上方平滑地移动的同时，一边使刀具方向(喷嘴方向)和刀具相位方向(臂方向)也平滑地变化，一边切断工件。
[0009][3]刮削加工(hale machining)
[0010]所谓刮削加工如图5所示，是使用刮削刀具(haling tool)(非旋转刀具non-rotational tool),控制刀具姿态使得刀具方向与工件加工面大致垂直,刀具的前刀面与刀具前端点路径大致垂直来进行的加工。刀具位置(刀具头位置)由三个直线轴，即X轴、Y轴、Z轴来控制，刀具方向由两个旋转轴，即B轴、C轴来控制，刀具相位方向由另一个旋转轴即A轴来控制。
[0011]如图6所示，刀具前端点位置在工件上方平滑地移动的同时，一边使刀具方向和刀具相位方向也平滑地变化一边加工工件。
[0012]此外，在上述多轴加工机中，以刀具方向由B轴和C轴来控制，刀具相位方向由A轴来控制为例进行了说明，但是也有由A轴和B轴控制刀具方向，由C轴控制刀具相位方向，或者由A轴以及C轴控制刀具方向，由B轴控制刀具相位方向的例子。此外，在上述多轴加工机的例子中，是控制刀具方向或刀具相位方向的旋转轴位于刀具侧的刀具头旋转型多轴加工机，但是也有旋转轴位于工作台侧，通过旋转工作台进行工作台与刀具的相对的旋转的工作台旋转型多轴加工机(图21:由B轴以及C轴控制刀具方向，由A轴控制刀具相位方向)、或旋转轴位于刀具侧和工作台侧的双方，进行工作台和刀具的相对的旋转的混合型多轴加工机(图22:由A轴和C轴控制刀具方向，由B轴控制刀具相位方向)。
[0013]日本特开2009-301232号公报中公开了一种刀具相位控制用数值控制装置，能够针对还包含第三旋转轴的滚轮方向(刀具相位方向)的控制的刀具前端点控制指令进行坐标变换(倾斜面加工指令)。但是，该刀具相位控制用数值控制装置仅控制刀具相位方向，不是平滑地插补刀具前端点位置以及刀具姿态(刀具方向和刀具相位方向)的技术思想。
[0014]日本特开2005-182437号公报中公开了在刀具相对加工物倾斜地进行加工的4轴或者5轴加工机中，也用接近于所希望的曲线的平滑曲线进行插补的数值控制装置。该数值控制装置为了平滑地插补加工点并使刀具与加工物的相对关系也平滑地变化，使指令矢量的矢量前端点在设定容差量以内向矢量前端点用近似曲线上的最近的位置移动，由此，求出与指令矢量对应的修正矢量前端点。即，该专利文献公开了修正表示刀具方向的指令矢量来作为平滑曲线的技术。但是，并未公开平滑地插补包含刀具相位方向的刀具前端点位置以及刀具姿态(刀具方向和刀具相位方向)的技术思想。因此，该技术无法应用于需要进行刀具相位方向控制的机床。
[0015]在日本特开2007-322392号公报中公开了姿态平滑化方法，该方法得到从通过摄像单元拍摄的图像上的、包含对象物的抖动的姿态信息的时间序列中去除抖动而得的姿态信息的时间序列。该姿态平滑化方法是与图像处理有关的技术，不是控制机床的技术。即，该专利文献没有公开平滑地插补刀具前端点位置以及刀具姿态(刀具方向和刀具相位方向)的技术思想，以及根据刀具前端点位置以及刀具姿态控制三个直线轴以及三个旋转轴的技术思想。
[0016]日本特开平5-324047号公报中公开了能够使刀具相对于前进方向总是朝向切线方向地进行控制的刀具轴的切线方向控制方式。在此，使刀具相对于前进方向总是朝向切线方向地进行控制可以说是控制刀具相位，但是该专利文献没有公开平滑地插补刀具前端点位置以及刀具姿态(刀具方向和刀具相位方向)的技术思想。
【发明内容】
[0017]本发明涉及平滑地插补刀具前端点位置以及刀具姿态(刀具方向和刀具相位方向，控制三个直线轴和三个旋转轴的数值控制装置。即，本发明的目的在于提供一种具有多轴加工机用刀具姿态控制功能的数值控制装置，其在改变刀具前端点位置、刀具方向(刀具方向矢量)以及刀具相位方向(刀具相位方向矢量)的同时进行的加工中，例如能够如图7所示，一边在平滑的刀具前端点路径、平滑的刀具方向路径(刀具方向矢量前端的路径)以及平滑的刀具相位方向路径(刀具相位方向矢量前端的路径)上使刀具平滑地变化一边进行加工。在此，设刀具方向和刀具相位方向垂直。
[0018]在此，如果从图7的刀具方向路径以及刀具相位方向路径中去除刀具前端点路径部分，作为仅刀具方向(刀具方向矢量)以及刀具相位方向(刀具相位方向矢量)的变化而描绘刀具方向路径以及刀具相位方向路径，则如图8所示，表现为半径I的单位球上的路径。在图8中为了方便而与图7相比少描绘了矢量条数。
[0019]本发明的数值控制装置是控制具有至少三个直线轴和包含一个刀具相位控制用旋转轴的至少三个旋转轴的多轴加工机的装置，具有多种加工机用刀具姿态控制功能。该数值控制装置具有:刀具位置姿态指令读取部，其读取包含刀具前端点位置指令以及针对由刀具方向和刀具相位方向形成的刀具姿态的刀具姿态指令的加工程序；刀具位置姿态插补部，其根据所述刀具前端点位置指令以及所述刀具姿态指令，平滑地对刀具前端点位置以及刀具姿态进行插补，求出插补刀具前端点位置以及由插补后的刀具方向和插补后的刀具相位方向形成的插补刀具姿态；以及根据所述插补刀具前端点位置和所述插补刀具姿态运算所述至少三个直线轴和所述至少三个旋转轴的各轴位置的各轴位置运算部，向所述各轴位置驱动所述至少三个直线轴和所述至少三个旋转轴。
[0020]所述刀具姿态指令可以由作为刀具方向的指令的刀具方向矢量指令、还有作为刀具相位方向的指令的刀具相位方向矢量指令或者指示刀具相位方向相对于刀具前端点前进方向的偏转角的刀具相位偏转角组成。
[0021]所述刀具姿态指令也可以由作为刀具方向的指令的与所述至少三个旋转轴中控制刀具方向的两个旋转轴对应的指令、还有作为刀具相位方向的指令的与控制刀具相位方向的一个旋转轴对应的指令或者指示刀具相位方向相对于刀具前端点前进方向的偏转角的刀具相位偏转角指令组成。
[0022]所述刀具姿态指令可以是基于指示从初始刀具方向和初始刀具相位方向旋转后的刀具方向和刀具相位方向的四元数的四元数指令。在这种情况下，所述刀具位置姿态插补部可以构成为平滑地插补刀具前端点位置，求出所述插补刀具前端点位置，并根据所述四元数指令平滑地插补四元数，求出插补四元数，将所述插补四元数用作所述插补刀具姿态的结构。
[0023]所述刀具位置姿态插补部可以构成为分别平滑地插补刀具前端点位置、刀具方向以及刀具相位方向，求出上所述插补刀具前端点位置和所述插补刀具姿态的结构。
[0024]所述刀具位置姿态插补部可以构成为分别平滑地插补刀具前端点位置和刀具方向，求出所述插补刀具前端点位置和所述插补刀具方向，并求出与所述插补刀具方向垂直、且相对于由所述插补刀具方向和所述插补刀具前端点位置的变化方向形成的平面成所述偏转角的所述插补刀具相位方向的结构。
[0025]所述刀具位置姿态插补部可以构成为平滑地插补刀具前端点位置，求出所述插补刀具前端点位置，并根据所述刀具姿态指令求出对应的对应四元数指令，根据所述对应四元数指令平滑地插补四元数，求出插补四元数，将所述插补四元数用作所述插补刀具姿态的结构。
[0026]根据本发明，可以提供一种具有多轴加工机用刀具姿态控制功能的数值控制装置，在使刀具前端点位置、刀具方向(刀具方向矢量)、刀具相位方向(刀具相位方向矢量)变化的同时进行的加工中，能够一边在平滑的刀具前端点路径、平滑的刀具方向路径(刀具方向矢量前端的路径)以及平滑的刀具相位方向路径(刀具相位方向矢量前端的路径)上使刀具平滑地变化一边进行加工。【专利附图】
【附图说明】[0027]本发明的上述以及其他的目的和特征，可以通过参照附图的以下的实施例的说明而变得明了。
[0028]图1是说明作为多轴加工机的纤维铺放机的图。
[0029]图2是说明刀具如端点路径、刀具方向路径和刀具相位方向路径的图。
[0030]图3是说明作为多轴加工机的水射流机床的图。
[0031]图4是说明在图3的水射流机床中，刀具前端点位置在工件上方平滑地移动，并且一边使刀具方向(喷嘴方向)和刀具相位方向(臂方向)也平滑地变化，一边切断工件的情形的图。
[0032]图5是使用多轴加工机说明刮削加工的图。
[0033]图6是说明在图5所示的刮削加工中，刀具前端点位置在工件上方平滑地移动，并且一边使刀具方向和刀具相位方向也平滑地变化，一边用刮削刀具加工工件的情形的图。
[0034]图7是说明一边使刀具前端点路径、刀具方向路径(刀具方向矢量前端的路径、刀具相位方向路径(刀具相位方向矢量前端的路径)平滑地变化，一边加工工件的本发明中的课题的图。
[0035]图8是去除刀具前端点路径部分仅作为刀具方向(刀具方向矢量)和刀具相位方向(刀具相位方向矢量)的变化来说明刀具方向路径和刀具相位方向路径的图。
[0036]图9是用刀具方向矢量和刀具相位方向矢量指示刀具姿态指令的加工程序例。
[0037]图10是说明在第一实施方式中求出插补刀具相位方向矢量Vp的情形的图。
[0038]图11是用针对两个旋转轴和一个旋转轴的旋转轴位置指令指示刀具姿态指令的加工程序例。
[0039]图12是用刀具方向矢量指令和刀具相位偏转角指令指示刀具姿态指令的加工程序例。
[0040]图13是说明在第三实施方式中求出插补刀具相位方向矢量Vp的情形的图。
[0041]图14是用四元数指令指示刀具姿态指令的加工程序例。
[0042]图15是用单位四元数球面说明四元数的图。
[0043]图16是说明本发明的数值控制装置的框图。
[0044]图17是说明图16所示的数值控制装置(第一实施方式)中的刀具位置姿态插补部以及各轴位置运算部中的处理的流程图。
[0045]图18是说明图16所示的数值控制装置(第三实施方式)中的刀具位置姿态插补部中的处理的流程图。
[0046]图19是说明图16所示的数值控制装置(第四实施方式)中的刀具位置姿态插补部以及各轴位置运算部中的处理的流程图。
[0047]图20是说明图16所示的数值控制装置(第五实施方式)中的刀具位置姿态插补部中的处理的流程图。
[0048]图21是说明工作台旋转型多轴加工机的图。
[0049]图22是说明混合型多轴加工机的图。
【具体实施方式】
[0050]本发明可以应用于多种多轴加工机。以下与附图一起说明本发明的实施方式。[0051](第一实施方式)
[0052]如图1、图3、图5所示，假设用三个直线轴即X轴、Y轴、Z轴来控制刀具头，用两个旋转轴即B轴、C轴来控制刀具方向，用另一个旋转轴即A轴来控制刀具相位方向的机械结构。加工程序如图9所示的加工程序例I所示，用基于地址X、Y、Z的刀具前端点位置指令(xn、yn、zn)来指示刀具前端点位置,用基于地址1、J、K的刀具方向矢量指令(in、jn、kn)来指示刀具方向，用基于地址U、V、W的刀具相位方向矢量指令(un、vn、wn)来指示刀具相位方向，其中n=l、2、…。刀具方向矢量指令和刀具相位方向矢量指令是刀具姿态指令。
[0053]‘G43.4’是指示刀具前端点位置的刀具前端点控制模式的开始的G代码，‘G49’是该刀具前端点控制模式的结束的G代码。通过‘F’指示指令速度，通过‘H’指示刀具长度修正编号。(in、jn、kn)、(un、vn、wn)是单位矢量。刀具位置姿态指令读取部(参照图16)读取刀具前端点位置指令(xn、yn、zn)、刀具方向矢量指令(in、jn、kn)以及刀具相位方向矢量指令(un、vn、wn)。
[0054]另外,在此以用基于地址U、V、W的刀具相位方向矢量指令(un、vn、wn)来指示刀具相位方向为例，但是也可以如后述的第三实施方式那样，将刀具相位方向的指令作为指示刀具相位方向相对于刀具前端点前进方向的偏转角的刀具相位偏转角指令。
[0055]基于地址X、Y、Z的指令点列(xl、yl、zl)、(x2、y2、z2)…，‘平滑地插补’刀具前端点位置，得到表示刀具前端点路径的插补刀具前端点位置Pt (Ptx、Pty、Ptz)T。在此,所谓‘平滑地插补’是指根据指令点列(xl、yl、zl)、(X2、y2、z2)、…生成通过这些指令点列的样条曲线、NURBS曲线等平滑曲线，在每个插补周期，根据指令速度对该平滑曲线上的位置进行插补。即，当将表示通过从第η块向第(n+1)块的指令点列的平滑曲线的函数设为基于参数t的Ptn (t) (O < t < I)时,根据指令速度求出插补时刻τ的参数值s,求出Pt=Ptn (S)(参照图 10)。
[0056]平滑曲线可以是不通过指令点列而在容许值的范围内通过这些指令点列附近的曲线。这样基于指令点列平滑地 插补指令点的位置的技术是已经在日本特开2005-182437号公报等中记载的现有技术，因此不进行详细说明。“Τ”是转置。但是，以下在含义自明的情况下省略记载。
[0057]同样，基于地址1、J、K的刀具方向矢量指令列(il、jl、kl)、(i2、j2、k2)…，‘平滑地插补’刀具姿态，得到Vtr (Vtrx,Vtry,Vtrz)T0在此，所谓‘平滑地插补’如图8所示，是指生成通过刀具方向矢量指令列(il、jl、kl)、(i2、j2、k2)、…的前端的样条曲线、NURBS曲线等平滑曲线，与插补刀具前端点位置Pt对应地对该平滑曲线上的位置进行插补。即，当将表示通过从第η块向第(n+1)块的刀具方向矢量指令列的前端的平滑曲线的函数设为基于参数t的Vtrn (t) (O≤t≤I)时,求出Vtr=Vtrn (S)。平滑曲线可以是不通过刀具方向矢量指令列的前端而在容许值的范围内通过这些指令列附近的曲线。与Pt同样，包含后述的Vp，基于矢量指令列平滑地插补刀具姿态的技术例如是已经在日本特开2005-182437号公报中记载的现有技术，因此不详细说明。如下述(I)式那样对Vtr进行标准化，得到表示刀具方向路径(参照图8)的插补刀具方向矢量Vt (Vtx、Vty、Vtz)。
【权利要求】
1.一种具有多轴加工机用刀具姿态控制功能的数值控制装置，其控制具有至少三个直线轴和包含一个刀具相位控制用旋转轴的至少三个旋转轴的多轴加工机，该具有多轴加工机用刀具姿态控制功能的数值控制装置的特征在于， 具有: 刀具位置姿态指令读取部，其读取包含刀具前端点位置指令以及针对由刀具方向和刀具相位方向形成的刀具姿态的刀具姿态指令的加工程序； 刀具位置姿态插补部，其根据所述刀具前端点位置指令以及所述刀具姿态指令，平滑地对刀具前端点位置以及刀具姿态进行插补，求出插补刀具前端点位置以及由插补刀具方向和插补刀具相位方向形成的插补刀具姿态；以及 各轴位置运算部，其根据所述插补刀具前端点位置以及所述插补刀具姿态，运算所述至少三个直线轴以及所述至少三个旋转轴的各轴位置， 向所述各轴位置驱动所述至少三个直线轴以及所述至少三个旋转轴。
2.根据权利要求1所述的具有多轴加工机用刀具姿态控制功能的数值控制装置，其特征在于， 所述刀具姿态指令由作为刀具方向的指令的刀具方向矢量指令，还有作为刀具相位方向的指令的刀具相位方向矢量指令或者指示刀具相位方向相对于刀具前端点前进方向的偏转角的刀具相位偏转角指令组成。
3.根据权利要求1所述的具有多轴加工机用刀具姿态控制功能的数值控制装置，其特征在于， 所述刀具姿态指令由作为刀具方向`的指令的与所述至少三个旋转轴中控制刀具方向的两个旋转轴对应的指令，还有作为刀具相位方向的指令的与控制刀具相位方向的一个旋转轴对应的指令或者指示刀具相位方向相对于刀具前端点前进方向的偏转角的刀具相位偏转角指令组成。
4.根据权利要求1所述的具有多轴加工机用刀具姿态控制功能的数值控制装置，其特征在于， 所述刀具姿态指令是基于指示从初始刀具方向以及初始刀具相位方向旋转后的刀具方向以及刀具相位方向的四元数的四元数指令。
5.根据权利要求1~3中任一项所述的具有多轴加工机用刀具姿态控制功能的数值控制装置，其特征在于， 所述刀具位置姿态插补部分别对刀具前端点位置、刀具方向以及刀具相位方向平滑地进行插补，求出所述插补刀具前端点位置和所述插补刀具姿态。
6.根据权利要求2或3所述的具有多轴加工机用刀具姿态控制功能的数值控制装置，其特征在于， 所述刀具位置姿态插补部分别对刀具前端点位置以及刀具方向平滑地进行插补，求出所述插补刀具前端点位置以及所述插补刀具方向，并求出与所述插补刀具方向垂直、且相对于由所述插补刀具方向和所述插补刀具前端点位置的变化方向形成的平面成所述偏转角的所述插补刀具相位方向。
7.根据权利要求4所述的具有多轴加工机用刀具姿态控制功能的数值控制装置，其特征在于，所述刀具位置姿态插补部对刀具前端点位置平滑地进行插补，求出所述插补刀具前端点位置，并根据所述四元数指令对四元数平滑地进行插补，求出插补四元数，将所述插补四元数用作所述插补刀具姿态。
8.根据权利要求1~3中任一项所述的具有多轴加工机用刀具姿态控制功能的数值控制装置，其特征在于， 所述刀具位置姿态插补部对刀具前端点位置平滑地进行插补，求出所述插补刀具前端点位置，并根据所述刀具姿态指令求出对应的对应四元数指令，根据所述对应四元数指令对四元数平滑地进行插补，求出插补四元数，将所述插补四元数用作所述插补刀具姿态。
【文档编号】G05B19/41GK103513605SQ201310263204
【公开日】2014年1月15日 申请日期:2013年6月27日 优先权日:2012年6月28日
【发明者】大槻俊明 申请人:发那科株式会社