JP2022041159A - Numerical control system and interference check method - Google Patents

Numerical control system and interference check method Download PDF

Info

Publication number
JP2022041159A
JP2022041159A JP2020146210A JP2020146210A JP2022041159A JP 2022041159 A JP2022041159 A JP 2022041159A JP 2020146210 A JP2020146210 A JP 2020146210A JP 2020146210 A JP2020146210 A JP 2020146210A JP 2022041159 A JP2022041159 A JP 2022041159A
Authority
JP
Japan
Prior art keywords
axis
machine
priority
machine element
check
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.)
Pending
Application number
JP2020146210A
Other languages
Japanese (ja)
Inventor
浩貴 澤岡
Hiroki Sawaoka
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.)
Fanuc Corp
Original Assignee
Fanuc Corp
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 Fanuc Corp filed Critical Fanuc Corp
Priority to JP2020146210A priority Critical patent/JP2022041159A/en
Publication of JP2022041159A publication Critical patent/JP2022041159A/en
Pending legal-status Critical Current

Links

Images

Abstract

To provide a numerical control system for supporting interference check computing in a numerical control device so as to allow efficient detection of interference between machine elements, and an interference check support method.SOLUTION: A numerical control device 3 includes: a pulse generation unit 34 which allows a plurality of machine elements of a machine tool 2 to move along a plurality of control axes on the basis of movement pulses for the machine tool 2; an interference checking unit 36 which performs interference check computing to a plurality of check object sets in an order determined according to a prescribed priority; and an interference check support device 5 which supports the interference check computing. The interference check support device 5 includes a first storage unit 51 which stores machine element-control axis association information, and a priority calculation unit 54b which calculates priority for the plurality of check object sets on the basis of the movement pulses and the machine element-control axis association information.SELECTED DRAWING: Figure 1

Description

本開示は、数値制御システム及び干渉チェック方法に関する。 The present disclosure relates to a numerical control system and an interference check method.

数値制御装置は、予め作成された数値制御プログラムに基づいて、工作機械を構成する複数の機械要素(工具、テーブル、ワークを保持する治具等)を複数の制御軸に沿って移動させることによってワークに加工を行う。また数値制御装置は、工作機械の各機械要素が互いに干渉していないかどうかを確認するための干渉チェック演算を工作機械による加工中に並行して行う干渉チェック機能を備える(例えば、特許文献1参照)。 The numerical control device moves a plurality of machine elements (tools, tables, jigs for holding a workpiece, etc.) constituting a machine tool along a plurality of control axes based on a numerical control program created in advance. Process the work. Further, the numerical control device has an interference check function for performing an interference check operation in parallel during machining by the machine tool to confirm whether the machine elements of the machine tool interfere with each other (for example, Patent Document 1). reference).

特許第6066041号Patent No. 6066041

ところで従来の数値制御装置では、所定のチェック対象組を構成する2つの機械要素同士が干渉していないかどうかを、各機械要素の形状に関する形状情報、各機械要素の位置に関する位置情報、及び各機械要素の姿勢に関する姿勢情報を用いた干渉チェック演算を行うことによって判断する。また従来の数値制御装置では、このような干渉チェック演算を、複数のチェック対象組に対して行う必要があることから、時間がかかるおそれがある。 By the way, in the conventional numerical control device, whether or not two machine elements constituting a predetermined set to be checked do not interfere with each other is determined by shape information regarding the shape of each machine element, position information regarding the position of each machine element, and each. Judgment is made by performing an interference check calculation using attitude information regarding the attitude of the machine element. Further, in the conventional numerical control device, since it is necessary to perform such an interference check operation for a plurality of check target sets, it may take time.

このためチェック対象組の数が多くなると、数値制御装置による工作機械の制御周期内に全てのチェック対象組について干渉チェック演算を完了することができなくなってしまうおそれがある。またこのため、機械要素同士の干渉を適切なタイミングで検出できなくなってしまうおそれがある。 Therefore, if the number of sets to be checked increases, it may not be possible to complete the interference check calculation for all the sets to be checked within the control cycle of the machine tool by the numerical control device. For this reason, there is a possibility that interference between machine elements cannot be detected at an appropriate timing.

本開示は、上記課題に鑑みてなされたものであり、限られた時間内に全てのチェック対象組について干渉チェック演算を行うことができないような場合であっても、効率的に機械要素同士の干渉を検出できるよう数値制御装置における干渉チェック演算を支援する数値制御システム及び干渉チェック支援方法を提供する。 This disclosure has been made in view of the above problems, and even if it is not possible to perform the interference check calculation for all the check target sets within a limited time, the machine elements can be efficiently used with each other. Provided are a numerical control system and an interference check support method that support an interference check operation in a numerical control device so that interference can be detected.

本開示の一態様は、移動指令に基づいて工作機械の複数の機械要素を複数の軸に沿って移動させるとともに2つの機械要素の間の干渉チェック演算を複数のチェック対象組について所定の優先度によって定められた順序で行う数値制御装置と、前記干渉チェック演算を支援する干渉チェック支援装置と、を備えるものであって、前記干渉チェック支援装置は、前記工作機械における各軸と前記複数の機械要素のうち当該軸に沿って移動する機械要素とを関連付ける第1情報を記憶する第1記憶部と、前記移動指令及び前記第1情報に基づいて、前記複数のチェック対象組に対する前記優先度を算出する優先度算出部と、を備える、数値制御システムである。 In one aspect of the present disclosure, a plurality of machine elements of a machine tool are moved along a plurality of axes based on a movement command, and an interference check calculation between the two machine elements is performed with a predetermined priority for a plurality of sets to be checked. It is provided with a numerical control device performed in the order determined by the above and an interference check support device for supporting the interference check calculation, and the interference check support device includes each axis in the machine tool and the plurality of machines. A first storage unit that stores first information associated with a machine element that moves along the axis among the elements, and the priority for the plurality of check target sets based on the movement command and the first information. It is a numerical control system including a priority calculation unit for calculation.

本開示の一態様は、移動指令に基づいて工作機械の複数の機械要素を複数の軸に沿って移動させるとともに2つの機械要素の間の干渉チェック演算を複数のチェック対象組について所定の優先度によって定められた順序で行う数値制御装置における前記干渉チェック演算を支援する方法であって、前記移動指令と、前記工作機械における各軸と前記複数の機械要素のうち当該軸に沿って移動する機械要素とを関連付ける第1情報と、を取得し、前記移動指令と前記第1情報とに基づいて、前記複数のチェック対象組に対する前記優先度を算出する、干渉チェック支援方法である。 In one aspect of the present disclosure, a plurality of machine elements of a machine tool are moved along a plurality of axes based on a movement command, and an interference check calculation between the two machine elements is performed with a predetermined priority for a plurality of sets to be checked. It is a method of supporting the interference check calculation in the numerical control device performed in the order determined by the above, and is a machine that moves along the axis among the movement command, each axis in the machine tool, and the plurality of machine elements. It is an interference check support method that acquires the first information associated with an element and calculates the priority for the plurality of check target sets based on the movement command and the first information.

本開示の一態様によれば、優先度算出部は、移動指令と、工作機械における各軸と複数の機械要素のうちこの軸に沿って移動する機械要素とを関連付ける第1情報と、に基づいて、複数のチェック対象組に対する優先度を算出する。これにより、複数のチェック対象組について、例えば干渉が生じやすい機械要素の組み合わせのチェック対象組の優先度を高くすることができる。また数値制御装置は、移動指令に基づいて複数の機械要素を複数の軸に沿って移動させるとともに、複数のチェック対象組について優先度算出部において算出された優先度によって定めれられた順序で干渉チェック演算を行う。本開示の一態様によれば、数値制御装置では、優先度の高いチェック対象組から順に干渉チェック演算を行うことにより、限られた時間内に全てのチェック対象組について干渉チェック演算を行うことができないような場合であっても、効率的に機械要素同士の干渉を検出することができる。 According to one aspect of the present disclosure, the priority calculator is based on a movement command and first information associating each axis of the machine tool with a plurality of machine elements that move along this axis. Then, the priority for a plurality of check target sets is calculated. Thereby, for a plurality of check target sets, for example, it is possible to raise the priority of the check target set of the combination of machine elements that are likely to cause interference. In addition, the numerical control device moves a plurality of machine elements along a plurality of axes based on a movement command, and interferes with a plurality of check target sets in the order determined by the priority calculated by the priority calculation unit. Perform a check operation. According to one aspect of the present disclosure, in the numerical control device, the interference check calculation is performed for all the check target sets within a limited time by performing the interference check calculation in order from the check target set having the highest priority. Even if it is not possible, it is possible to efficiently detect interference between machine elements.

本開示の第1実施形態に係る数値制御システムの概略図である。It is a schematic diagram of the numerical control system which concerns on 1st Embodiment of this disclosure. 工作機械の一例を示す図である。It is a figure which shows an example of a machine tool. 機械要素-制御軸紐付け情報及び各軸従属関係情報の、機械構成木による表示例を示す図である。It is a figure which shows the display example by the machine composition tree of the machine element-control axis association information and each axis dependency information. 機械要素-制御軸紐付け情報及び各軸従属関係情報の一例を示す図である。It is a figure which shows an example of the machine element-control axis association information and each axis dependency information. 図4Aに例示する機械要素-制御軸紐付け情報及び各軸従属関係情報の下で第1~第4機械要素を従属機械要素群と静止機械要素群とに分類した場合を示す図である。FIG. 4 is a diagram showing a case where the first to fourth machine elements are classified into a dependent machine element group and a stationary machine element group under the machine element-control axis association information and each axis dependency information exemplified in FIG. 4A. チェック対象組抽出処理の具体的な手順を示すフローチャートである。It is a flowchart which shows the specific procedure of the check target group extraction process. 第1の優先度算出アルゴリズムによって優先度を算出する手順を説明するための図である。It is a figure for demonstrating the procedure of calculating a priority by the 1st priority calculation algorithm. 第2の優先度算出アルゴリズムによって優先度を算出する手順を説明するための図である。It is a figure for demonstrating the procedure of calculating a priority by the 2nd priority calculation algorithm. 第3の優先度算出アルゴリズムによって優先度を算出する手順を説明するための図である。It is a figure for demonstrating the procedure of calculating a priority by a 3rd priority calculation algorithm. 干渉チェック支援装置によって生成される干渉チェック支援情報の一例を示す図である。It is a figure which shows an example of the interference check support information generated by the interference check support device. 本開示の第2実施形態に係る数値制御システムの概略図である。It is a schematic diagram of the numerical control system which concerns on 2nd Embodiment of this disclosure.

<第1実施形態>
以下、図面を参照して、本開示の第1実施形態に係る数値制御システムについて説明する。
<First Embodiment>
Hereinafter, the numerical control system according to the first embodiment of the present disclosure will be described with reference to the drawings.

図1は、本実施形態に係る数値制御システム1の概略図である。 FIG. 1 is a schematic diagram of a numerical control system 1 according to the present embodiment.

数値制御システム1は、工作機械2と、この工作機械2を制御する数値制御装置(CNC)3と、を備える。 The numerical control system 1 includes a machine tool 2 and a numerical control device (CNC) 3 for controlling the machine tool 2.

工作機械2は、工具、テーブル、工具を支持する支持具、及びワークを保持する治具等の所定の立体形状を有する複数の機械要素と、各機械要素を複数の制御軸に沿って移動させる複数のサーボモータ2a,2b,…,2nと、を備える。工作機械2は、数値制御装置3から送信される移動パルスに基づいて複数のサーボモータ2a,…,2nを駆動し、複数の機械要素を複数の制御軸に沿って移動させることによって図示しないワークを加工する。ここで工作機械2は、例えば、旋盤、ボール盤、フライス盤、研削盤、レーザ加工機、及び射出成型機等であるが、これらに限らない。 The machine tool 2 has a plurality of machine elements having a predetermined three-dimensional shape such as a tool, a table, a support for supporting the tool, and a jig for holding a work, and each machine element is moved along a plurality of control axes. A plurality of servomotors 2a, 2b, ..., 2n and the like are provided. The machine tool 2 drives a plurality of servomotors 2a, ..., 2n based on a moving pulse transmitted from the numerical control device 3, and moves a plurality of machine elements along a plurality of control axes to move a work (not shown). To process. Here, the machine tool 2 is, for example, a lathe, a drilling machine, a milling machine, a grinding machine, a laser processing machine, an injection molding machine, and the like, but is not limited thereto.

数値制御装置3は、CPU(Central Processing Unit)等の演算処理手段、各種プログラムを格納したHDD(Hard Disk Drive)やSSD(Solid State Drive)等の補助記憶手段、演算処理手段がプログラムを実行する上で一時的に必要とされるデータを格納するためのRAM(Random Access Memory)といった主記憶手段、オペレータが各種操作を行うキーボードといった操作手段、及びオペレータに各種情報を表示するディスプレイといった表示手段等のハードウェアによって構成されるコンピュータである。 In the numerical control device 3, arithmetic processing means such as a CPU (Central Processing Unit), auxiliary storage means such as an HDD (Hard Disk Drive) and SSD (Solid State Drive) storing various programs, and arithmetic processing means execute programs. Main storage means such as RAM (Random Access Memory) for storing data temporarily required above, operation means such as a keyboard on which the operator performs various operations, display means such as a display for displaying various information to the operator, etc. It is a computer composed of the hardware of.

数値制御装置3は、上記ハードウェア構成によって、加工プログラムメモリ31、指令解析部32、補間部33、パルス生成部34、位置姿勢算出部35、干渉チェック部36、形状記憶部37、及び干渉チェック支援装置5等の各種機能が実現される。 The numerical control device 3 has a machining program memory 31, a command analysis unit 32, an interpolation unit 33, a pulse generation unit 34, a position / orientation calculation unit 35, an interference check unit 36, a shape storage unit 37, and an interference check, depending on the hardware configuration. Various functions such as the support device 5 are realized.

加工プログラムメモリ31には、工作機械2の各機械要素を各制御軸に沿って移動(並進移動及び回転移動を含む)させるための指令を含む数値制御プログラムが格納される。数値制御プログラムは、所定のプログラミング言語(例えば、Gコード)によって記述されている。 The machining program memory 31 stores a numerical control program including a command for moving each machine element of the machine tool 2 along each control axis (including translational movement and rotational movement). The numerical control program is written in a predetermined programming language (for example, G code).

指令解析部32は、加工プログラムメモリ31に格納された数値制御プログラムをブロック毎に読み出し、解析し、解析結果に基づいて工作機械2の各制御軸の移動を指令する移動指令データを生成する。指令解析部32は、生成した移動指令データを補間部33へ送信する。 The command analysis unit 32 reads out the numerical control program stored in the machining program memory 31 for each block, analyzes it, and generates movement command data for commanding the movement of each control axis of the machine tool 2 based on the analysis result. The command analysis unit 32 transmits the generated movement command data to the interpolation unit 33.

補間部33は、指令解析部32から送信される移動指令データに基づいて、指令経路上の点を所定の補間周期で補間計算した補間データを生成する。補間部33は、生成した補間データをパルス生成部34へ送信する。 The interpolation unit 33 generates interpolation data obtained by interpolating and calculating points on the command path in a predetermined interpolation cycle based on the movement command data transmitted from the command analysis unit 32. The interpolation unit 33 transmits the generated interpolation data to the pulse generation unit 34.

パルス生成部34は、補間部33から送信される補間データに基づいて、工作機械2に対する移動指令、すなわち工作機械2の各サーボモータ2a,…,2nに対する移動パルスを上記補間周期毎に生成する。パルス生成部34は、以上のようにして生成した移動パルスをサーボモータ2a,…,2nへ入力することにより、工作機械2の複数の機械要素を複数の制御軸に沿って移動させる。なおパルス生成部34は、干渉チェック部36における後述の干渉チェック演算に基づいて複数の機械要素の何れかが干渉すると判断された場合には、この干渉を未然に防ぐべく移動パルスの生成及び工作機械2への入力を停止する。 The pulse generation unit 34 generates a movement command for the machine tool 2, that is, a movement pulse for each of the servomotors 2a, ..., 2n of the machine tool 2 for each interpolation cycle based on the interpolation data transmitted from the interpolation unit 33. .. By inputting the moving pulse generated as described above to the servomotors 2a, ..., 2n, the pulse generation unit 34 moves a plurality of machine elements of the machine tool 2 along a plurality of control axes. When it is determined that any of the plurality of machine elements interferes with each other based on the interference check calculation described later in the interference check unit 36, the pulse generation unit 34 generates and operates a moving pulse in order to prevent this interference. Stop the input to the machine 2.

またパルス生成部34は、上述のように補間データに基づいて移動パルスを補間周期毎に生成するとともに、今回の補間周期で工作機械2へ入力する予定の移動パルスを、工作機械2へ入力する前に位置姿勢算出部35へ送信する。 Further, the pulse generation unit 34 generates a moving pulse for each interpolation cycle based on the interpolation data as described above, and inputs the moving pulse to be input to the machine tool 2 in the current interpolation cycle to the machine tool 2. It is transmitted to the position / orientation calculation unit 35 before.

位置姿勢算出部35は、パルス生成部34から補間周期毎に送信される移動パルスに基づいて、移動パルスに基づいて各制御軸を移動させた場合における各制御軸の単位時間当たり(例えば、補間周期当たり)の軸移動量に関する軸移動量ベクトルと、移動パルスに基づいて各制御軸を移動させる前の各機械要素の位置に関する移動前位置ベクトルと、移動パルスに基づいて各制御軸を移動させた後の各機械要素の位置に関する移動後位置ベクトルと、移動パルスに基づいて各制御軸を移動させた後の各機械要素の姿勢に関する移動後姿勢情報と、を算出する。位置姿勢算出部35は、算出した各制御軸に対する軸移動量ベクトル及び各機械要素に対する移動前位置ベクトルを干渉チェック支援装置5へ送信する。また位置姿勢算出部35は、算出した各機械要素に対する移動後位置ベクトル及び移動後姿勢情報を干渉チェック部36へ送信する。 The position / orientation calculation unit 35 is based on the movement pulse transmitted from the pulse generation unit 34 in each interpolation cycle, and when each control axis is moved based on the movement pulse, the position / orientation calculation unit 35 per unit time of each control axis (for example, interpolation). The axis movement amount vector related to the axis movement amount (per cycle), the pre-movement position vector related to the position of each machine element before moving each control axis based on the movement pulse, and each control axis moved based on the movement pulse. The post-movement position vector regarding the position of each machine element after the movement and the post-movement posture information regarding the posture of each machine element after moving each control axis based on the movement pulse are calculated. The position / orientation calculation unit 35 transmits the calculated axis movement amount vector for each control axis and the pre-movement position vector for each machine element to the interference check support device 5. Further, the position / attitude calculation unit 35 transmits the calculated post-movement position vector and post-movement attitude information for each machine element to the interference check unit 36.

なお位置姿勢算出部35において算出する軸移動量ベクトルの向き及びノルムは以下のように定義される。制御軸が機械要素をその軸線に沿って並進移動させる直進軸である場合、軸移動量ベクトルの向きは制御軸と平行であり、軸移動量ベクトルのノルムは制御軸の軸線に沿った単位時間当たりの移動距離[mm]と等しい。また制御軸が機械要素をその軸線回りで回転移動させる回転軸である場合、制御軸の角速度ベクトルを軸移動量ベクトルとして用いる。すなわち制御軸が回転軸である場合、軸移動量ベクトルの向きは制御軸と平行であり、軸移動量ベクトルのノルムは制御軸の単位時間当たりの回転角度[rad]と等しい。なお以下では、軸移動量ベクトルのノルムを単に「軸移動量」ともいう。 The direction and norm of the axis movement amount vector calculated by the position / orientation calculation unit 35 are defined as follows. If the control axis is a straight axis that translates the machine element along its axis, the orientation of the axis movement vector is parallel to the control axis and the norm of the axis movement vector is the unit time along the axis of the control axis. Equal to the hit travel distance [mm]. When the control axis is a rotation axis that rotates and moves the machine element around its axis, the angular velocity vector of the control axis is used as the axis movement amount vector. That is, when the control axis is the rotation axis, the direction of the axis movement amount vector is parallel to the control axis, and the norm of the axis movement amount vector is equal to the rotation angle [rad] per unit time of the control axis. In the following, the norm of the axis movement amount vector is also simply referred to as “axis movement amount”.

形状記憶部37には、工作機械2を構成する複数の機械要素の各々の形状に関する形状情報が格納されている。なお、上述のようにパルス生成部34から工作機械2へ入力する移動パルスと同じ補間周期の移動パルスを位置姿勢算出部35へ入力する場合、仮に補間周期内に干渉チェック部36による干渉チェック演算を終えることができなかったとしても、直ちに干渉が生じることが無いように、形状記憶部37に格納されている形状情報には僅かなマージンを加えておくことが好ましい。すなわち、形状記憶部37に格納されている形状情報は、実際の機械要素よりも僅かに大きな機械要素に基づいて作成することが好ましい。 The shape storage unit 37 stores shape information regarding the shape of each of the plurality of machine elements constituting the machine tool 2. When a moving pulse having the same interpolation cycle as the moving pulse input from the pulse generation unit 34 to the machine tool 2 is input to the position / orientation calculation unit 35 as described above, the interference check calculation by the interference check unit 36 is performed within the interpolation cycle. It is preferable to add a small margin to the shape information stored in the shape storage unit 37 so that interference does not occur immediately even if the above cannot be completed. That is, it is preferable that the shape information stored in the shape storage unit 37 is created based on a machine element slightly larger than the actual machine element.

干渉チェック部36は、上述のようにパルス生成部34によって生成される移動パルスを工作機械2へ入力し続けた場合に、工作機械2を構成する複数の機械要素同士で干渉が生じるかどうかを判定するための干渉チェック演算を、複数のチェック対象組に対して行う。ここでチェック対象組とは、工作機械2を構成する複数の機械要素のうちの2つを組み合わせて構成される。従って工作機械2を構成する機械要素の総数がNである場合、チェック対象組の総数はN(N-1)/2である。 The interference check unit 36 determines whether or not interference occurs between a plurality of machine elements constituting the machine tool 2 when the moving pulse generated by the pulse generation unit 34 is continuously input to the machine tool 2 as described above. The interference check operation for determination is performed on a plurality of check target sets. Here, the check target set is configured by combining two of the plurality of machine elements constituting the machine tool 2. Therefore, when the total number of machine elements constituting the machine tool 2 is N, the total number of check target sets is N (N-1) / 2.

より具体的には、干渉チェック部36は、位置姿勢算出部35から補間周期毎に送信される移動後位置ベクトル及び移動後姿勢情報と、干渉チェック支援装置5において後述の手順によって補間周期毎に生成される干渉チェック支援情報と、形状記憶部37に格納された形状情報と、に基づいて、既知の干渉チェックアルゴリズム(例えば、分離軸方式)に基づく干渉チェック演算を行い、パルス生成部34によって生成される移動パルスを工作機械2へ入力し続けた場合に、工作機械2を構成する複数の機械要素同士で干渉するかどうかを判定する。干渉チェック部36は、干渉チェック演算によって干渉すると判断した場合には、その旨をパルス生成部34へ通知し、干渉が生じる前に移動パルスの生成及び工作機械2への入力を停止させる。 More specifically, the interference check unit 36 receives the post-movement position vector and the post-movement attitude information transmitted from the position / orientation calculation unit 35 for each interpolation cycle, and the interference check support device 5 for each interpolation cycle according to the procedure described later. Based on the generated interference check support information and the shape information stored in the shape storage unit 37, an interference check calculation based on a known interference check algorithm (for example, a separation axis method) is performed, and the pulse generation unit 34 performs an interference check calculation. When the generated moving pulse is continuously input to the machine tool 2, it is determined whether or not the plurality of machine elements constituting the machine tool 2 interfere with each other. When the interference check unit 36 determines that interference is caused by the interference check calculation, it notifies the pulse generation unit 34 to that effect, and stops the generation of the moving pulse and the input to the machine tool 2 before the interference occurs.

干渉チェック支援装置5は、第1記憶部51と、第2記憶部52と、第3記憶部53と、チェック支援情報生成部54と、を備え、これらを用いることによって干渉チェック部36における干渉チェック演算を支援するための情報である干渉チェック支援情報を生成する。 The interference check support device 5 includes a first storage unit 51, a second storage unit 52, a third storage unit 53, and a check support information generation unit 54, and by using these, interference in the interference check unit 36 Interference check support information, which is information for supporting the check operation, is generated.

第1記憶部51には、工作機械2における各制御軸と、各制御軸を移動させた場合に、当該移動に係る制御軸に沿って移動する機械要素と、を関連付ける機械要素-制御軸紐付け情報が、機械構成木やテーブル等の任意の形式で格納されている。なお本実施形態では、第1記憶部51には、機械要素-制御軸紐付け情報を後述の図3に例示するような機械構成木形式で格納する場合について説明する。 In the first storage unit 51, a machine element-control shaft string that associates each control axis in the machine tool 2 with a machine element that moves along the control axis related to the movement when each control axis is moved. The attached information is stored in an arbitrary format such as a machine configuration tree or a table. In this embodiment, a case where the machine element-control axis association information is stored in the first storage unit 51 in a machine configuration tree format as illustrated in FIG. 3 described later will be described.

第2記憶部52には、工作機械2における各制御軸の間の従属関係を規定する各軸従属関係情報が、機械構成木やテーブル等の任意の形式で格納されている。なお本実施形態では、第2記憶部52には、各軸従属関係情報を後述の図3に例示するような機械構成木形式で格納する場合について説明する。 In the second storage unit 52, each axis dependency information that defines the dependency between each control axis in the machine tool 2 is stored in an arbitrary format such as a machine component tree or a table. In this embodiment, a case where each axis dependency information is stored in the second storage unit 52 in a machine configuration tree format as illustrated in FIG. 3 described later will be described.

次に、これら記憶部51,52に格納されている機械要素-制御軸紐付け情報及び各軸従属関係情報の具体例について、図2及び図3を参照しながら説明する。 Next, specific examples of the machine element-control axis association information and each axis dependency information stored in the storage units 51 and 52 will be described with reference to FIGS. 2 and 3.

図2は、工作機械2の一例を示す図である。図2に例示する工作機械2は、6つの機械要素21,22,23,24,25,26を、5つの制御軸X,Y,Z,A,Cに沿って移動させることが可能となっている。第5機械要素25は、図示しないワークを支持する治具であり、第6機械要素26は、第5機械要素25を支持するテーブルである。これら第5機械要素25及び第6機械要素26は、例えば鉛直方向に沿って延びる制御軸C回りで回転移動させることが可能となっている。第4機械要素24は、第5機械要素25によって支持されるワークを加工する工具である。第3機械要素23は、その先端部において第4機械要素24を支持する支持具である。第2機械要素22は、第3機械要素23の基端部を水平面に沿って延びる制御軸A回りで回動自在に支持する支持具である。第1機械要素21は、第2機械要素22を鉛直方向に沿った制御軸Z、並びに水平面において互いに直交する制御軸X及び制御軸Yに沿って並行移動自在に支持する支持具である。すなわち図2の例では、制御軸X,Y,Zは直進軸であり、制御軸A,Cは回転軸である。 FIG. 2 is a diagram showing an example of the machine tool 2. The machine tool 2 illustrated in FIG. 2 can move six machine elements 21, 22, 23, 24, 25, 26 along five control axes X, Y, Z, A, and C. ing. The fifth machine element 25 is a jig that supports a work (not shown), and the sixth machine element 26 is a table that supports the fifth machine element 25. The fifth machine element 25 and the sixth machine element 26 can be rotationally moved around a control axis C extending along a vertical direction, for example. The fourth machine element 24 is a tool for machining a work supported by the fifth machine element 25. The third machine element 23 is a support that supports the fourth machine element 24 at its tip. The second machine element 22 is a support that rotatably supports the base end portion of the third machine element 23 around a control shaft A extending along a horizontal plane. The first mechanical element 21 is a support that movably supports the second mechanical element 22 along a control axis Z along the vertical direction, and a control axis X and a control axis Y orthogonal to each other in a horizontal plane. That is, in the example of FIG. 2, the control axes X, Y, and Z are straight axes, and the control axes A and C are rotation axes.

すなわち図2に例示する工作機械2では、第5機械要素25及び第6機械要素26は、制御軸Cに沿って一体に連れ回る。また、第1機械要素21、第2機械要素22、第3機械要素23、及び第4機械要素24は、制御軸X,Y,Zに沿って一体に連れ回り、第3機械要素23、及び第4機械要素24は、制御軸Aに沿って一体に連れ回る。 That is, in the machine tool 2 illustrated in FIG. 2, the fifth machine element 25 and the sixth machine element 26 are integrally rotated along the control axis C. Further, the first machine element 21, the second machine element 22, the third machine element 23, and the fourth machine element 24 are integrally rotated along the control axes X, Y, and Z, and the third machine element 23 and The fourth machine element 24 is integrally rotated along the control axis A.

図3は、図2に例示する工作機械2における機械要素-制御軸紐付け情報及び各軸従属関係情報の、機械構成木による表示例を示す図である。図2に例示する工作機械2では、制御軸Cと、制御軸X,Y,Z,Aと、を独立して移動させることが可能となっている。従って図3の機械構成木に示すように、制御軸Cと、制御軸X,Y,Z,Aとはそれぞれ独立してルートRに従属する。また図2に例示する工作機械2では、制御軸X,Y,Zを移動させると制御軸Aも移動するが、制御軸Aを移動させても制御軸X,Y,Zは移動しない。すなわち制御軸Aは、制御軸X,Y,Zより下位である。従って図3の機械構成木に示すように、制御軸Aは、制御軸X,Y,Zに従属する。 FIG. 3 is a diagram showing an example of displaying the machine element-control axis association information and each axis dependency information in the machine tool 2 exemplified in FIG. 2 by a machine configuration tree. In the machine tool 2 illustrated in FIG. 2, the control axis C and the control axes X, Y, Z, and A can be moved independently. Therefore, as shown in the machine configuration tree of FIG. 3, the control axis C and the control axes X, Y, Z, and A are independently dependent on the route R. Further, in the machine tool 2 illustrated in FIG. 2, when the control axes X, Y, Z are moved, the control axis A also moves, but even if the control axis A is moved, the control axes X, Y, Z do not move. That is, the control axis A is lower than the control axes X, Y, and Z. Therefore, as shown in the machine configuration tree of FIG. 3, the control axis A is dependent on the control axes X, Y, and Z.

また第5機械要素25及び第6機械要素26は、制御軸Cに沿って一体に連れ回ることから、図3の機械構成木に示すように、これら機械要素25,26は、制御軸Cと関連付けられる。また第3機械要素23及び第4機械要素24は、制御軸X,Y,Zより下位の制御軸Aに沿って一体に連れ回ることから、図3の機械構成木に示すように、これら機械要素23,24は、制御軸Aと関連付けられる。また第1機械要素21及び第2機械要素22は、制御軸X,Y,Zに沿って一体に連れ回ることから、図3の機械構成木に示すように、これら機械要素21,22は制御軸X,Y,Zのうち最も下位の制御軸Zと関連付けられる。 Further, since the fifth machine element 25 and the sixth machine element 26 are integrally rotated along the control axis C, these machine elements 25 and 26 are connected to the control axis C as shown in the machine configuration tree of FIG. Be associated. Further, since the third machine element 23 and the fourth machine element 24 are integrally rotated along the control axis A lower than the control axes X, Y, Z, these machines are shown in the machine configuration tree of FIG. Elements 23 and 24 are associated with control axis A. Further, since the first machine element 21 and the second machine element 22 are integrally rotated along the control axes X, Y, Z, these machine elements 21 and 22 are controlled as shown in the machine configuration tree of FIG. It is associated with the lowest control axis Z among the axes X, Y, and Z.

図1に戻り、チェック支援情報生成部54は、工作機械2の複数の機械要素の全ての組み合わせの中から1組以上のチェック対象組を抽出するチェック対象組抽出部54aと、複数のチェック対象組、より具体的にはチェック対象組抽出部54aによって抽出された複数のチェック対象組に対する優先度を算出する優先度算出部54bと、を備える。ここで複数のチェック対象組に対する優先度とは、干渉チェック部36において複数のチェック対象組に対し順に干渉チェック演算を行う際における順序を定める整数値である。以下では、値が小さなものから昇順で優先度が低くなるものとする。 Returning to FIG. 1, the check support information generation unit 54 includes a check target set extraction unit 54a that extracts one or more check target sets from all combinations of the plurality of machine elements of the machine tool 2, and a plurality of check targets. It includes a set, more specifically, a priority calculation unit 54b for calculating a priority for a plurality of check target sets extracted by the check target set extraction unit 54a. Here, the priority for the plurality of check target sets is an integer value that determines the order when the interference check unit 36 sequentially performs the interference check operation on the plurality of check target sets. In the following, it is assumed that the priority is lowered in ascending order from the smallest value.

第3記憶部53には、チェック対象組抽出部54aによって抽出されたチェック対象組に関する情報と、優先度算出部54bによって各チェック対象組に対して定められる優先度に関する情報と、を組み合わせることによって構成される干渉チェック支援情報が記憶される。 The third storage unit 53 combines information on the check target group extracted by the check target group extraction unit 54a and information on the priority determined for each check target group by the priority calculation unit 54b. The configured interference check support information is stored.

チェック対象組抽出部54aは、位置姿勢算出部35から補間周期毎に送信される各制御軸の軸移動量、第1記憶部51に格納されている機械要素-制御軸紐付け情報、及び第2記憶部52に格納されている各軸従属関係情報に基づいて、複数の機械要素の全組み合わせの中から、干渉チェック演算を実行する必要が無い組み合わせを除くことにより、1組以上のチェック対象組を抽出する。 The check target set extraction unit 54a includes the axis movement amount of each control axis transmitted from the position / orientation calculation unit 35 for each interpolation cycle, the machine element-control axis association information stored in the first storage unit 51, and the first. 2 One or more sets of check targets by excluding combinations that do not need to execute an interference check calculation from all combinations of a plurality of machine elements based on each axis dependency information stored in the storage unit 52. Extract pairs.

始めにチェック対象組抽出部54aは、位置姿勢算出部35から送信される各制御軸の軸移動量に基づいて、複数の制御軸の中から移動パルスによって移動させる制御軸を移動制御軸として特定する。より具体的には、チェック対象組抽出部54aは、軸移動量(軸移動量ベクトルのノルム)が0でない制御軸を移動制御軸として特定する。 First, the check target group extraction unit 54a specifies a control axis to be moved by a movement pulse from among a plurality of control axes as a movement control axis based on the axis movement amount of each control axis transmitted from the position / orientation calculation unit 35. do. More specifically, the check target set extraction unit 54a specifies a control axis in which the axis movement amount (norm of the axis movement amount vector) is not 0 as the movement control axis.

その後チェック対象組抽出部54aは、機械要素-制御軸紐付け情報及び各軸従属関係情報に基づいて、工作機械2を構成する複数の機械要素を、従属機械要素群と静止機械要素群とに分類する。従属機械要素群とは、移動制御軸とともに移動する機械要素が属する群であり、静止機械要素群とは、移動制御軸を移動させても移動しない機械要素が属する群である。より具体的には、チェック対象組抽出部54aは、移動制御軸及びこの移動制御軸より下位の制御軸と関連付けられた機械要素を従属機械要素群に分類し、全ての機械要素のうち従属機械要素群に属しない機械要素を静止機械要素群に分類する。 After that, the check target set extraction unit 54a converts a plurality of machine elements constituting the machine tool 2 into a dependent machine element group and a stationary machine element group based on the machine element-control axis association information and each axis dependency information. Classify. The dependent machine element group is a group to which the machine element that moves together with the movement control axis belongs, and the stationary machine element group is a group to which the machine element that does not move even if the movement control axis is moved belongs. More specifically, the check target set extraction unit 54a classifies the machine elements associated with the movement control axis and the control axis lower than the movement control axis into the dependent machine element group, and the dependent machine among all the machine elements. Machine elements that do not belong to the element group are classified into the stationary machine element group.

ここで従属機械要素群に属する機械要素は全て移動制御軸とともに移動する。このため従属機械要素群に属する機械要素の組み合わせは、干渉チェック演算を実行せずとも干渉しないことが明らかであるので、チェック対象組から除外される。また静止機械要素群に属する機械要素は全て移動制御軸を移動させても移動しない。このため、静止機械要素群に属する機械要素の組み合わせは、干渉チェック演算を実行せずとも干渉しないことが明らかであるので、チェック対象組から除外される。よってチェック対象組抽出部54aは、従属機械要素群に属する各機械要素と、静止機械要素群に属する各機械要素と、の組み合わせをチェック対象組として抽出する。換言すれば、チェック対象組抽出部54aは、複数の機械要素の全組み合わせの中から、従属機械要素群に属する機械要素同士の組み合わせと、静止機械要素群に属する機械要素同士の組み合わせとを除いた組み合わせをチェック対象組として抽出する。チェック対象組抽出部54aは、以上のような手順によって抽出したチェック対象組のリスト(以下、「チェック対象組リスト」という)を、第3記憶部53に記憶させる。 Here, all the machine elements belonging to the dependent machine element group move together with the movement control axis. Therefore, it is clear that the combination of machine elements belonging to the dependent machine element group does not interfere even if the interference check operation is not executed, so that the combination is excluded from the check target set. Moreover, all the machine elements belonging to the stationary machine element group do not move even if the movement control axis is moved. Therefore, it is clear that the combination of machine elements belonging to the stationary machine element group does not interfere even if the interference check operation is not executed, so that the combination is excluded from the check target set. Therefore, the check target set extraction unit 54a extracts the combination of each machine element belonging to the dependent machine element group and each machine element belonging to the stationary machine element group as the check target set. In other words, the check target set extraction unit 54a excludes the combination of the machine elements belonging to the dependent machine element group and the combination of the machine elements belonging to the stationary machine element group from all the combinations of the plurality of machine elements. The combined combination is extracted as the check target group. The check target group extraction unit 54a stores the list of check target groups extracted by the above procedure (hereinafter referred to as “check target group list”) in the third storage unit 53.

ここで以上のようなチェック対象組抽出部54aによってチェック対象組を抽出する具体的な手順について、図4A及び図4Bの具体例を参照しながら説明する。 Here, a specific procedure for extracting the check target set by the check target set extraction unit 54a as described above will be described with reference to the specific examples of FIGS. 4A and 4B.

図4Aは、機械要素-制御軸紐付け情報及び各軸従属関係情報の一例を示す図である。図4Aに示す例では、工作機械は、第1機械要素、第2機械要素、第3機械要素、及び第4機械要素を、第1制御軸、第2制御軸、第3制御軸、第4制御軸、第5制御軸、及び第6制御軸に沿って移動させることが可能となっている。また図4Aに例示する各軸従属関係情報の例では、第1~第4制御軸と、第5~第6制御軸とは、それぞれ独立して移動させることが可能となっている。また第5制御軸は第6制御軸より下位であり、第2~第4制御軸は第1制御軸より下位であり、第3制御軸及び第4制御軸はそれぞれ第1制御軸及び第2制御軸より下位であり、第2制御軸は第1制御軸より下位である。また図4Aに例示する機械要素-制御軸紐付け情報の例では、第1機械要素は第1制御軸と関連付けられ、第2機械要素は第4制御軸と関連付けられ、第4機械要素は第6制御軸と関連付けられ、第3機械要素は第5制御軸と関連付けられている。 FIG. 4A is a diagram showing an example of machine element-control axis association information and each axis dependency information. In the example shown in FIG. 4A, the machine tool has the first machine element, the second machine element, the third machine element, and the fourth machine element as the first control axis, the second control axis, the third control axis, and the fourth. It is possible to move along the control axis, the fifth control axis, and the sixth control axis. Further, in the example of each axis dependency information illustrated in FIG. 4A, the first to fourth control axes and the fifth to sixth control axes can be moved independently of each other. The fifth control axis is lower than the sixth control axis, the second to fourth control axes are lower than the first control axis, and the third control axis and the fourth control axis are the first control axis and the second control axis, respectively. It is lower than the control axis, and the second control axis is lower than the first control axis. Further, in the example of the machine element-control axis association information exemplified in FIG. 4A, the first machine element is associated with the first control axis, the second machine element is associated with the fourth control axis, and the fourth machine element is the first. The 6th control axis is associated and the 3rd machine element is associated with the 5th control axis.

図4Bは、図4Aに例示する機械要素-制御軸紐付け情報及び各軸従属関係情報の下で第1~第4機械要素を従属機械要素群と静止機械要素群とに分類した場合を示す図である。なお図4Bの例では、第1~第6制御軸のうち第1制御軸を移動制御軸とした。図4Bに示すように、移動制御軸である第1制御軸とこの第1制御軸より下位の第2、第3、及び第4制御軸と関連付けられた第1、及び第2機械要素は従属機械要素群に分類され、全ての機械要素のうち従属機械要素群に属しない第3、及び第4機械要素は静止機械要素群に分類される。従って図4Bに示す例では、第1~第4機械要素の全ての組み合わせ(第1及び第2機械要素、第1及び第3機械要素、第1及び第4機械要素、第2及び第3機械要素、第2及び第4機械要素、並びに第3及び第4機械要素の計6つの組み合わせ)のうち、第1及び第3機械要素、第1及び第4機械要素、第2及び第3機械要素、並びに第2及び第4機械要素の計4つの組み合わせがチェック対象組として抽出される。 FIG. 4B shows a case where the first to fourth machine elements are classified into a dependent machine element group and a stationary machine element group under the machine element-control axis association information and each axis dependency information exemplified in FIG. 4A. It is a figure. In the example of FIG. 4B, the first control axis among the first to sixth control axes is used as the movement control axis. As shown in FIG. 4B, the first control axis, which is a movement control axis, and the first and second machine elements associated with the second, third, and fourth control axes below the first control axis are dependent. The third and fourth machine elements, which are classified into the machine element group and do not belong to the dependent machine element group among all the machine elements, are classified into the stationary machine element group. Therefore, in the example shown in FIG. 4B, all combinations of the first to fourth machine elements (first and second machine elements, first and third machine elements, first and fourth machine elements, second and third machines). Of the six combinations of elements, second and fourth mechanical elements, and third and fourth mechanical elements), the first and third mechanical elements, the first and fourth mechanical elements, and the second and third mechanical elements. , And a total of four combinations of the second and fourth machine elements are extracted as the set to be checked.

図1に戻り、チェック対象組抽出部54aは、移動制御軸が複数存在する場合、各移動制御軸の下で上記手順に従って抽出されるチェック対象組の和集合をチェック対象組として抽出する。 Returning to FIG. 1, when a plurality of movement control axes exist, the check target set extraction unit 54a extracts the union of the check target sets extracted according to the above procedure under each movement control axis as the check target set.

図5は、チェック対象組抽出部54aにおけるチェック対象組抽出処理の具体的な手順を示すフローチャートである。なお図5に示す処理では、制御軸の総数をN(Nは、2以上の任意の整数)とする。チェック対象組抽出部54aは、位置姿勢算出部35から新たな軸移動量を受信したことに応じて図5に示すチェック対象組抽出処理を実行する。 FIG. 5 is a flowchart showing a specific procedure of the check target set extraction process in the check target set extraction unit 54a. In the process shown in FIG. 5, the total number of control axes is N (N is an arbitrary integer of 2 or more). The check target group extraction unit 54a executes the check target group extraction process shown in FIG. 5 in response to receiving a new axis movement amount from the position / orientation calculation unit 35.

始めにS1では、チェック対象組抽出部54aは、制御軸カウンタCの値を1にセットし、S2に移る。S2では、チェック対象組抽出部54aは、位置姿勢算出部35から送信される各制御軸に対する軸移動量に基づいて、カウンタCによって関連付けられる第C制御軸の軸移動量が0でないか否かを判定する。チェック対象組抽出部54aは、S2の判定結果がYESである場合にはS3に移り、NOである場合にはS5に移る。 First, in S1, the check target set extraction unit 54a sets the value of the control axis counter C to 1, and moves to S2. In S2, the check target set extraction unit 54a determines whether or not the axis movement amount of the Cth control axis associated with the counter C is not 0 based on the axis movement amount for each control axis transmitted from the position / orientation calculation unit 35. Is determined. The check target group extraction unit 54a moves to S3 when the determination result of S2 is YES, and moves to S5 when the determination result of S2 is NO.

S3では、チェック対象組抽出部54aは、第C制御軸を移動制御軸とすることにより、複数の機械要素を上述の手順に従って従属機械要素群と静止機械要素群とに分類し、S4に移る。S4では、チェック対象組抽出部54aは、従属機械要素群に属する各機械要素と、静止機械群に属する各機械要素と、の全ての組み合わせをチェック対象組として第3記憶部53におけるチェック対象組リストに追加し、S5に移る。 In S3, the check target set extraction unit 54a classifies a plurality of machine elements into a dependent machine element group and a stationary machine element group according to the above procedure by using the Cth control axis as the movement control axis, and moves to S4. .. In S4, the check target set extraction unit 54a sets all combinations of each machine element belonging to the dependent machine element group and each machine element belonging to the stationary machine group as the check target set, and the check target set in the third storage unit 53. Add to the list and move to S5.

S5では、チェック対象組抽出部54aは、制御軸カウンタCの値が制御軸の総数Nと等しいか否かを判定する。チェック対象組抽出部54aは、S5の判定結果がNOである場合にはS6に移り、制御軸カウンタCを1つだけカウントアップした後、S2に戻る。またチェック対象組抽出部54aは、S5の判定結果がYESである場合には、図5に示すチェック対象組抽出処理を終了する。 In S5, the check target set extraction unit 54a determines whether or not the value of the control axis counter C is equal to the total number N of the control axes. If the determination result of S5 is NO, the check target set extraction unit 54a moves to S6, counts up only one control axis counter C, and then returns to S2. If the determination result of S5 is YES, the check target set extraction unit 54a ends the check target set extraction process shown in FIG.

以上のようなチェック対象組抽出処理によれば、移動制御軸が複数存在する場合、各移動制御軸の下で複数の機械要素を従属機械要素群と静止機械要素群とに分類することによって得られる複数の組み合わせの和集合がチェック対象組として抽出される。 According to the check target set extraction process as described above, when there are a plurality of movement control axes, it is obtained by classifying the plurality of machine elements into a dependent machine element group and a stationary machine element group under each movement control axis. The union of a plurality of combinations to be checked is extracted as a set to be checked.

図1に戻り、優先度算出部54bは、位置姿勢算出部35から補間周期毎に送信される各制御軸の軸移動量ベクトル及び各機械要素の移動前位置ベクトル、並びに第1記憶部51に格納されている機械要素-制御軸紐付け情報に基づいて、チェック対象組抽出部54aによって抽出された複数のチェック対象組に対し、干渉が生じる可能性が高いものから降順で優先度を算出する。優先度算出部54bでは、以下で説明する第1、第2、及び第3の優先度算出アルゴリズムの何れか又はこれらを組み合わせた優先度算出アルゴリズムに基づいて複数のチェック対象組に対する優先度を算出することが可能となっている。 Returning to FIG. 1, the priority calculation unit 54b sends the position / orientation calculation unit 35 to the axis movement amount vector of each control axis, the pre-movement position vector of each machine element, and the first storage unit 51, which are transmitted for each interpolation cycle. Based on the stored machine element-control axis association information, the priority is calculated in descending order from the one with the highest possibility of interference to the plurality of check target sets extracted by the check target set extraction unit 54a. .. The priority calculation unit 54b calculates the priority for a plurality of check target sets based on one of the first, second, and third priority calculation algorithms described below or a priority calculation algorithm that combines them. It is possible to do.

<第1の優先度算出アルゴリズム>
第1の優先度算出アルゴリズムの下では、優先度算出部54bは、位置姿勢算出部35から送信される各制御軸の軸移動量に基づいて複数のチェック対象組に対する優先度を算出する。より具体的には、優先度算出部54bは、軸移動量が大きい制御軸から降順で、各制御軸と機械要素-制御軸紐付け情報によって関連付けられる各機械要素に対する機械要素順位を算出する。次に優先度算出部54bは、算出した機械要素順位が高い機械要素から降順で、各機械要素を含むチェック対象組に対する優先度を算出する。すなわち第1の優先度算出アルゴリズムの下では、優先度算出部54bは、単位時間当たりの軸移動量が大きな制御軸と関連付けられている機械要素を含むチェック対象組において干渉する可能性が高いと判断し、このような機械要素を含むチェック対象組の優先度を高くする。
<First priority calculation algorithm>
Under the first priority calculation algorithm, the priority calculation unit 54b calculates the priority for a plurality of check target sets based on the axis movement amount of each control axis transmitted from the position / orientation calculation unit 35. More specifically, the priority calculation unit 54b calculates the machine element order for each machine element associated with each control axis by the machine element-control axis association information in descending order from the control axis having the largest axis movement amount. Next, the priority calculation unit 54b calculates the priority for the check target set including each machine element in descending order from the machine element having the highest calculated machine element order. That is, under the first priority calculation algorithm, the priority calculation unit 54b is likely to interfere in the check target set including the machine element associated with the control axis having a large amount of axis movement per unit time. Judgment is made, and the priority of the check target group including such a machine element is increased.

ところで軸移動量の次元は、制御軸が直進軸である場合と制御軸が回転軸である場合とで異なる。より具体的には、制御軸が直進軸である場合、軸移動量は移動距離であり、制御軸が回転軸である場合、軸移動量は回転角度である。このため、直進軸に対する軸移動量と回転軸に対する軸移動量の大小を直接比較することはできない。このため第1の優先度算出アルゴリズムの下では、回転軸と機械要素-制御軸紐付け情報によって関連付けられる機械要素である回転機械要素を含むチェック対象組と、この回転機械要素を含まないチェック対象組とに分けて各チェック対象組に対する優先度を算出する。より具体的には、回転軸の方が直進軸よりも干渉に気づきにくいことから、第1の優先度算出アルゴリズムの下では、回転機械要素を含むチェック対象組に対する優先度を、回転機械要素を含まないチェック対象組に対する優先度よりも高くする。 By the way, the dimension of the axis movement amount differs depending on whether the control axis is a straight axis or a rotation axis. More specifically, when the control axis is a straight axis, the axis movement amount is a movement distance, and when the control axis is a rotation axis, the axis movement amount is a rotation angle. Therefore, it is not possible to directly compare the magnitude of the axis movement amount with respect to the straight axis and the axis movement amount with respect to the rotation axis. Therefore, under the first priority calculation algorithm, a check target set including a rotary machine element, which is a machine element associated with the rotation axis and a machine element-control axis association information, and a check target not including this rotation machine element. The priority for each check target group is calculated separately for each group. More specifically, since the rotating axis is less likely to notice interference than the straight axis, under the first priority calculation algorithm, the priority for the set to be checked including the rotating machine element is set to the rotating machine element. Set higher than the priority for the set to be checked that is not included.

ここで以上のような第1の優先度算出アルゴリズムによって優先度を算出する具体的な手順について、図6の具体例を参照しながら説明する。 Here, a specific procedure for calculating the priority by the first priority calculation algorithm as described above will be described with reference to the specific example of FIG.

図6は、第1の優先度算出アルゴリズムによって優先度を算出する手順を説明するための図である。図6の左側には、機械要素-制御軸紐付け情報及び各軸従属関係情報の一例を示し、図6の右側にはこのような構成の下で優先度算出部54bによって算出される各種パラメータを示す図である。 FIG. 6 is a diagram for explaining a procedure for calculating the priority by the first priority calculation algorithm. The left side of FIG. 6 shows an example of machine element-control axis association information and each axis dependency information, and the right side of FIG. 6 shows various parameters calculated by the priority calculation unit 54b under such a configuration. It is a figure which shows.

図6の左側に示す例では、工作機械は、第1機械要素、第2機械要素、第3機械要素、及び第4機械要素を、第1制御軸、第2制御軸、第3制御軸、第4制御軸、及び第5制御軸に沿って移動させることが可能となっている。図6の左側の例において、第1制御軸、第3制御軸、及び第4制御軸は直進軸であり、第2制御軸、及び第5制御軸は回転軸であるとする。図6の左側に例示する各軸従属関係の例では、第1~第2制御軸と、第3~第5制御軸とは、それぞれ独立して移動させることが可能となっている。また第2制御軸は第1制御軸より下位であり、第4制御軸及び第5制御軸は第3制御軸より下位であり、第5制御軸は第4制御軸より下位である。また図6の左側に例示する機械要素-制御軸紐付け情報の例では、第1機械要素は第1制御軸と関連付けられ、第2機械要素は第2制御軸と関連付けられ、第3機械要素は第4制御軸と関連付けられ、第4機械要素は第5制御軸と関連付けられている。また図6には、第1制御軸の軸移動量は4であり、第2制御軸の軸移動量は2であり、第3制御軸の軸移動量は3であり、第4制御軸の軸移動量は1であり、第5制御軸の軸移動量は3である場合の例を示す。すなわち図6の例では、直進軸の軸移動量は、第4制御軸、第3制御軸、及び第1制御軸の順で大きくなり、回転軸の軸移動量は、第2制御軸、及び第5制御軸の順で大きくなる。 In the example shown on the left side of FIG. 6, the machine tool has the first machine element, the second machine element, the third machine element, and the fourth machine element as the first control axis, the second control axis, and the third control axis. It is possible to move along the fourth control axis and the fifth control axis. In the example on the left side of FIG. 6, it is assumed that the first control axis, the third control axis, and the fourth control axis are straight axes, and the second control axis and the fifth control axis are rotation axes. In the example of each axis dependency relationship illustrated on the left side of FIG. 6, the first to second control axes and the third to fifth control axes can be moved independently of each other. The second control axis is lower than the first control axis, the fourth control axis and the fifth control axis are lower than the third control axis, and the fifth control axis is lower than the fourth control axis. Further, in the example of the machine element-control axis association information exemplified on the left side of FIG. 6, the first machine element is associated with the first control axis, the second machine element is associated with the second control axis, and the third machine element is associated with the third machine element. Is associated with the 4th control axis and the 4th machine element is associated with the 5th control axis. Further, in FIG. 6, the axis movement amount of the first control axis is 4, the axis movement amount of the second control axis is 2, the axis movement amount of the third control axis is 3, and the fourth control axis has an axis movement amount of 3. An example is shown in the case where the axis movement amount is 1 and the axis movement amount of the 5th control axis is 3. That is, in the example of FIG. 6, the amount of axial movement of the straight axis increases in the order of the fourth control axis, the third control axis, and the first control axis, and the amount of axial movement of the rotary axis increases with respect to the second control axis and the second control axis. It increases in the order of the fifth control axis.

図6に示すように、第1機械要素は直進軸である第1制御軸と関連付けられ、第2機械要素は回転軸である第2制御軸と関連付けられ、第3機械要素は直進軸である第4制御軸と関連付けられ、第4機械要素は回転軸である第5制御軸と関連付けられている。すなわち、第2機械要素及び第4機械要素は、回転軸と関連付けられる回転機械要素であり、第1機械要素及び第3機械要素は、直進軸と関連付けられる直進機械要素である。従って回転機械要素を直進機械要素よりも上位としかつ軸移動量が大きい制御軸から降順で、各制御軸と関連付けられる各機械要素に対する機械要素順位を算出すると、第4機械要素が1位となり、第2機械要素が2位となり、第1機械要素が3位となり、第3機械要素が4位となる。また機械要素順位が高い機械要素から降順で、各機械要素を含む各チェック対象組に対する優先度を算出すると、第2及び第4機械要素の組み合わせが1位となり、第1及び第4機械要素の組み合わせが2位となり、第3及び第4機械要素の組み合わせが3位となり、第1及び第2機械要素の組み合わせが4位となり、第2及び第3機械要素の組み合わせが5位となり、第1及び第3機械要素の組み合わせが6位となる。 As shown in FIG. 6, the first mechanical element is associated with the first control axis, which is the linear axis, the second mechanical element is associated with the second control axis, which is the rotary axis, and the third mechanical element is the linear axis. It is associated with a fourth control axis, and the fourth mechanical element is associated with a fifth control axis, which is the axis of rotation. That is, the second machine element and the fourth machine element are rotary machine elements associated with the rotary axis, and the first mechanical element and the third mechanical element are straight machine elements associated with the straight axis. Therefore, when the machine element order for each machine element associated with each control axis is calculated in descending order from the control axis in which the rotating machine element is higher than the straight machine element and the amount of shaft movement is large, the fourth machine element becomes the first place. The second machine element is in second place, the first machine element is in third place, and the third machine element is in fourth place. Further, when the priority is calculated for each check target set including each machine element in descending order from the machine element having the highest machine element order, the combination of the second and fourth machine elements becomes the first place, and the first and fourth machine elements The combination is in 2nd place, the combination of 3rd and 4th machine elements is in 3rd place, the combination of 1st and 2nd machine elements is in 4th place, the combination of 2nd and 3rd machine elements is in 5th place, and the 1st place. And the combination of the third machine element is the 6th place.

<第2の優先度算出アルゴリズム>
第2の優先度算出アルゴリズムの下では、優先度算出部54bは、位置姿勢算出部35から送信される各制御軸の軸移動量ベクトルに基づいて複数のチェック対象組に対する優先度を算出する。より具体的には、優先度算出部54bは、制御軸毎に算出された軸移動量ベクトルを用いることによって、複数の制御軸のうち2つを組み合わせて構成される軸対に対する相対軸移動量ベクトルを算出する。ここで制御軸の総数がMである場合、軸対の総数はM(M-1)/2である。また例えば第n制御軸の軸移動量ベクトルをvnとし、第m制御軸の軸移動量ベクトルをvmとした場合、第n制御軸及び第m制御軸によって構成される軸対に対する相対軸移動量ベクトルdnmは、vn-vmとなる。
<Second priority calculation algorithm>
Under the second priority calculation algorithm, the priority calculation unit 54b calculates the priority for a plurality of check target sets based on the axis movement amount vector of each control axis transmitted from the position / orientation calculation unit 35. More specifically, the priority calculation unit 54b uses the axis movement amount vector calculated for each control axis, so that the relative axis movement amount with respect to the axis pair configured by combining two of the plurality of control axes. Calculate the vector. Here, when the total number of control axes is M, the total number of axis pairs is M (M-1) / 2. Further, for example, when the axis movement amount vector of the nth control axis is vn and the axis movement amount vector of the mth control axis is vm, the relative axis movement amount with respect to the axis pair composed of the nth control axis and the mth control axis. The vector dnm is vn-vm.

次に優先度算出部54bは、全ての軸対に対する相対軸移動量(すなわち、相対軸移動量ベクトルのノルム)を算出する。次に優先度算出部54bは、算出した相対軸移動量が大きい軸対から降順で、各軸対と機械要素-制御軸紐付け情報によって関連付けられる機械要素の組み合わせを含む各チェック対象組に対する優先度を算出する。すなわち第2の優先度算出アルゴリズムの下では、優先度算出部54bは、単位時間当たりの相対軸移動量が大きな軸対と関連付けられている機械要素の組み合わせを含むチェック対象組において干渉する可能性が高いと判断し、このような機械要素の組み合わせを含むチェック対象組の優先度を高くする。 Next, the priority calculation unit 54b calculates the relative axis movement amount (that is, the norm of the relative axis movement amount vector) for all the axis pairs. Next, the priority calculation unit 54b gives priority to each check target group including the combination of each axis pair and the machine element associated with the machine element-control axis association information in descending order from the axis pair having the largest calculated relative axis movement amount. Calculate the degree. That is, under the second priority calculation algorithm, the priority calculation unit 54b may interfere in a set to be checked including a combination of machine elements associated with an axis pair having a large relative axis movement amount per unit time. Is judged to be high, and the priority of the set to be checked including such a combination of machine elements is increased.

上述のように軸移動量の次元は、制御軸が直進軸である場合と制御軸が回転軸である場合とで異なる。このため、軸移動量ベクトルvnから軸移動量ベクトルvmを減算して得られる相対軸移動量ベクトルdnmは、第n制御軸及び第m制御軸の少なくとも何れかが回転軸である場合、物理的な意味がなくなってしまう。このため全制御軸の中に回転軸が含まれている場合、この回転軸と関連付けられる回転機械要素を含むチェック対象組については、上述の第1の優先度算出アルゴリズムの下で優先度を算出し、直進機械要素のみを含むチェック対象組についてのみ第2の優先度算出アルゴリズムの下で優先度を算出する。 As described above, the dimension of the axis movement amount differs depending on whether the control axis is a straight axis or a rotation axis. Therefore, the relative axis movement amount vector dnm obtained by subtracting the axis movement amount vector vm from the axis movement amount vector vn is physically obtained when at least one of the nth control axis and the mth control axis is the rotation axis. It loses its meaning. Therefore, when the rotation axis is included in all the control axes, the priority is calculated under the above-mentioned first priority calculation algorithm for the check target set including the rotation machine element associated with this rotation axis. Then, the priority is calculated under the second priority calculation algorithm only for the check target set including only the straight-ahead machine element.

ここで以上のような第2の優先度算出アルゴリズムによって優先度を算出する具体的な手順について、図7の具体例を参照しながら説明する。 Here, a specific procedure for calculating the priority by the second priority calculation algorithm as described above will be described with reference to the specific example of FIG. 7.

図7は、第2の優先度算出アルゴリズムによって優先度を算出する手順を説明するための図である。図7の左側には、機械要素-制御軸紐付け情報及び各軸従属関係情報の一例を示し、図7の右側にはこのような構成の下で優先度算出部54bによって算出される各種パラメータを示す図である。 FIG. 7 is a diagram for explaining a procedure for calculating the priority by the second priority calculation algorithm. The left side of FIG. 7 shows an example of machine element-control axis association information and each axis dependency information, and the right side of FIG. 7 shows various parameters calculated by the priority calculation unit 54b under such a configuration. It is a figure which shows.

図7の左側に示す例では、工作機械は、第1機械要素、第2機械要素、及び第3機械要素を、第1制御軸、第2制御軸、第3制御軸、及び第4制御軸に沿って移動させることが可能となっている。図7の左側の例において、第1制御軸、第2制御軸、第3制御軸、及び第4制御軸は全て直進軸であるとする。図7の左側に例示する各軸従属関係の例では、第1~第2制御軸と、第3~第4制御軸とは、それぞれ独立して移動させることが可能となっている。また第2制御軸は第1制御軸より下位であり、第4制御軸は第3制御軸より下位である。また図7の左側に例示する機械要素-制御軸紐付け情報の例では、第1機械要素は第1制御軸と関連付けられ、第2機械要素は第2制御軸と関連付けられ、第3機械要素は第4制御軸と関連付けられている。 In the example shown on the left side of FIG. 7, the machine tool has the first machine element, the second machine element, and the third machine element as the first control axis, the second control axis, the third control axis, and the fourth control axis. It is possible to move along. In the example on the left side of FIG. 7, it is assumed that the first control axis, the second control axis, the third control axis, and the fourth control axis are all linear axes. In the example of each axis dependency relationship illustrated on the left side of FIG. 7, the first to second control axes and the third to fourth control axes can be moved independently of each other. The second control axis is lower than the first control axis, and the fourth control axis is lower than the third control axis. Further, in the example of the machine element-control axis association information exemplified on the left side of FIG. 7, the first machine element is associated with the first control axis, the second machine element is associated with the second control axis, and the third machine element is associated with the third machine element. Is associated with the 4th control axis.

図7の左側に示す例では、工作機械は、第1~第4制御軸を備える。従って第1~第4制御軸のうち2つを組み合わせることにより、第1及び第2制御軸、第1及び第3制御軸、第1及び第4制御軸、第2及び第3制御軸、第2及び第4制御軸、並びに第3及び第4制御軸の計6つの軸対を構成することができる。また図7には、第1制御軸と第2制御軸との間の相対軸移動量は4であり、第1制御軸と第3制御軸との間の相対軸移動量は5であり、第1制御軸と第4制御軸との間の相対軸移動量は3であり、第2制御軸と第3制御軸との間の相対軸移動量は1であり、第2制御軸と第4制御軸との間の相対軸移動量は6であり、第3制御軸と第4制御軸との間の相対軸移動量は2である場合の例を示す。すなわち、図7の例では、第2及び第3制御軸、第3及び第4制御軸、第1及び第4制御軸、第1及び第2制御軸、第1及び第3制御軸、並びに第2及び第4制御軸の順で相対軸移動量が大きくなる。 In the example shown on the left side of FIG. 7, the machine tool includes first to fourth control axes. Therefore, by combining two of the first to fourth control axes, the first and second control axes, the first and third control axes, the first and fourth control axes, the second and third control axes, and the first A total of six axis pairs of the second and fourth control axes and the third and fourth control axes can be configured. Further, in FIG. 7, the relative axis movement amount between the first control axis and the second control axis is 4, and the relative axis movement amount between the first control axis and the third control axis is 5. The relative axis movement amount between the first control axis and the fourth control axis is 3, the relative axis movement amount between the second control axis and the third control axis is 1, and the second control axis and the second control axis. An example is shown in which the relative axis movement amount between the 4 control axes is 6 and the relative axis movement amount between the 3rd control axis and the 4th control axis is 2. That is, in the example of FIG. 7, the second and third control axes, the third and fourth control axes, the first and fourth control axes, the first and second control axes, the first and third control axes, and the first The relative axis movement amount increases in the order of the second and fourth control axes.

図7に示すように、第1及び第4制御軸は、第1及び第3機械要素の組み合わせと関連付けられ、第1及び第2制御軸は、第1及び第2機械要素の組み合わせと関連付けられ、第2及び第4制御軸は、第2及び第3機械要素の組み合わせと関連付けられている。従って相対軸移動量が大きい軸対から降順で、各軸対と機械要素-制御軸紐付け情報によって関連付けられる機械要素の組み合わせを含む各チェック対象組に対する優先度を算出すると、第2及び第3機械要素の組み合わせが1位となり、第1及び第2機械要素の組み合わせが2位となり、第1及び第3機械要素の組み合わせが3位となる。 As shown in FIG. 7, the first and fourth control axes are associated with a combination of first and third machine elements, and the first and second control axes are associated with a combination of first and second machine elements. , 2nd and 4th control axes are associated with a combination of 2nd and 3rd machine elements. Therefore, when the priority for each check target group including the combination of each axis pair and the machine element associated with the machine element-control axis association information is calculated in descending order from the axis pair with the largest relative axis movement amount, the second and third The combination of machine elements is in first place, the combination of first and second machine elements is in second place, and the combination of first and third machine elements is in third place.

<第3の優先度算出アルゴリズム>
第3の優先度算出アルゴリズムの下では、優先度算出部54bは、位置姿勢算出部35から送信される各制御軸の軸移動量ベクトル及び各機械要素の移動前位置ベクトルに基づいて複数のチェック対象組に対する優先度を算出する。より具体的には、優先度算出部54bは、各制御軸の軸移動量ベクトルと、各機械要素の移動前位置ベクトルと、機械要素-制御軸紐付け情報と、に基づいて、各チェック対象組を構成する2つの機械要素の間の距離の減少率に比例する減少率パラメータを算出し、これら減少率パラメータに基づいて各チェック対象組に対する優先度を算出する。
<Third priority calculation algorithm>
Under the third priority calculation algorithm, the priority calculation unit 54b performs a plurality of checks based on the axis movement amount vector of each control axis and the pre-movement position vector of each machine element transmitted from the position / orientation calculation unit 35. Calculate the priority for the target set. More specifically, the priority calculation unit 54b is a check target based on the axis movement amount vector of each control axis, the pre-movement position vector of each machine element, and the machine element-control axis association information. A reduction rate parameter proportional to the reduction rate of the distance between the two machine elements constituting the set is calculated, and the priority for each check target set is calculated based on these reduction rate parameters.

以下では各チェック対象組に対する減少率パラメータを算出する手順について説明する。先ず優先度算出部54bは、位置姿勢算出部35から送信される各制御軸の軸移動量ベクトルを取得し、これら軸移動量ベクトルに基づいて、機械要素-制御軸紐付け情報によって各制御軸と関連付けられる機械要素の速度ベクトルを算出する。ここで直進軸と関連付けられる直進機械要素に対しては、軸移動量ベクトルをそのまま速度ベクトルとして用いる。また回転軸と関連付けられる回転機械要素に対しては、軸移動量ベクトルと所定の動径ベクトルとの外積を速度ベクトルとして用いる。ここで動径ベクトルは、各回転軸に対して予め定められたものが用いられる。より具体的には、動径ベクトルの向きは回転軸と直交する動径方向であり、動径ベクトルのノルムは回転軸から機械要素までの動径方向に沿った距離である。 The procedure for calculating the reduction rate parameter for each check target group will be described below. First, the priority calculation unit 54b acquires the axis movement amount vector of each control axis transmitted from the position / orientation calculation unit 35, and based on these axis movement amount vectors, each control axis is based on the machine element-control axis association information. Calculate the speed vector of the machine element associated with. Here, for the straight-moving machine element associated with the straight-moving axis, the axis movement amount vector is used as it is as the velocity vector. For the rotating machine element associated with the rotating axis, the outer product of the axis movement amount vector and the predetermined moving diameter vector is used as the velocity vector. Here, the radius vector used is predetermined for each rotation axis. More specifically, the direction of the radial vector is the radial direction orthogonal to the axis of rotation, and the norm of the radial vector is the distance along the radial direction from the axis of rotation to the machine element.

次に優先度算出部54bは、位置姿勢算出部35から送信される各機械要素の移動前位置ベクトルを取得し、これら移動前位置ベクトルに基づいて、各チェック対象組を構成する2つの機械要素に対する正規化された相対位置ベクトルを算出する。ここで第n機械要素の移動前位置ベクトルをrnとし、第m機械要素の移動前位置ベクトルをrmとした場合、第n機械要素と第m機械要素の組み合わせに対する正規化された相対位置ベクトルは、(rn-rm)/|rn-rm|となる。 Next, the priority calculation unit 54b acquires the pre-movement position vector of each machine element transmitted from the position / attitude calculation unit 35, and based on these pre-movement position vectors, the two machine elements constituting each check target set. Calculate the normalized relative position vector for. Here, when the pre-movement position vector of the n-th machine element is rn and the pre-movement position vector of the m-th machine element is rm, the normalized relative position vector for the combination of the n-th machine element and the m-th machine element is , (Rn-rm) / | rn-rm |.

次に優先度算出部54bは、先に算出した各機械要素に対する速度ベクトルに基づいて、各チェック対象組を構成する2つの機械要素に対する相対速度ベクトルを算出する。ここで第n機械要素の速度ベクトルをvnとし、第m機械要素の速度ベクトルをvmとした場合、第n機械要素と第m機械要素の組み合わせに対する相対速度ベクトルは、vn-vmとなる。 Next, the priority calculation unit 54b calculates the relative velocity vector for the two machine elements constituting each check target set based on the velocity vector for each machine element calculated earlier. Here, when the velocity vector of the nth machine element is vn and the velocity vector of the mth machine element is vm, the relative velocity vector for the combination of the nth machine element and the m machine element is vn-vm.

次に優先度算出部54bは、先に算出した相対速度ベクトルと相対位置ベクトルとの内積に負号を乗算することにより、各チェック対象組に対し減少率パラメータを算出する。ここでチェック対象組が第n機械要素と第m機械要素とによって構成される場合、減少率パラメータは、-(vn-vm)・(rn-rm)/|rn-rm|となる。以上の手順によって算出される減少率パラメータは、2つの機械要素の間の距離の単位時間当たりの減少率に比例する。すなわち、2つの機械要素の間の距離が変化しない場合、減少率パラメータは0となり、2つの機械要素の間の距離が広がる方向に変化する場合、減少率パラメータは負となり、2つの機械要素の間の距離が近くなる方向に変化する場合、減少率パラメータは正となる。 Next, the priority calculation unit 54b calculates the reduction rate parameter for each check target set by multiplying the inner product of the previously calculated relative velocity vector and relative position vector by a negative sign. Here, when the set to be checked is composed of the nth machine element and the mth machine element, the reduction rate parameters are − (vn-vm) · (rn-rm) / | rn-rm |. The reduction rate parameter calculated by the above procedure is proportional to the reduction rate of the distance between the two machine elements per unit time. That is, if the distance between the two machine elements does not change, the reduction rate parameter becomes 0, and if the distance between the two machine elements changes in the direction of increasing, the reduction rate parameter becomes negative and the two machine elements If the distance between them changes in the direction of becoming closer, the reduction rate parameter becomes positive.

次に優先度算出部54bは、以上の手順によって算出した減少率パラメータが大きな機械要素の組み合わせを含むチェック対象組から降順で優先度を算出する。すなわち第3の優先度算出アルゴリズムの下では、優先度算出部54bは、2つの構成要素の間の距離の減少率が大きいチェック対象組において干渉する可能性が高いと判断し、このような機械要素の組み合わせを含むチェック対象組の優先度を高くする。 Next, the priority calculation unit 54b calculates the priority in descending order from the check target group including the combination of the machine elements having the large reduction rate parameter calculated by the above procedure. That is, under the third priority calculation algorithm, the priority calculation unit 54b determines that there is a high possibility of interference in the check target set in which the reduction rate of the distance between the two components is large, and such a machine. Increase the priority of the set to be checked including the combination of elements.

ここで以上のような第3の優先度算出アルゴリズムによって優先度を算出する具体的な手順について、図8の具体例を参照しながら説明する。 Here, a specific procedure for calculating the priority by the above-mentioned third priority calculation algorithm will be described with reference to the specific example of FIG.

図8は、第3の優先度算出アルゴリズムによって優先度を算出する手順を説明するための図である。図8の左側には、機械要素-制御軸紐付け情報及び各軸従属関係情報の一例を示し、図8の右側にはこのような構成の下で優先度算出部54bによって算出される各種パラメータを示す図である。なお図8の左側に示す工作機械の構成は、図7の左側に示すものと同じであるので、詳細な説明は省略する。 FIG. 8 is a diagram for explaining a procedure for calculating the priority by the third priority calculation algorithm. The left side of FIG. 8 shows an example of machine element-control axis association information and each axis dependency information, and the right side of FIG. 8 shows various parameters calculated by the priority calculation unit 54b under such a configuration. It is a figure which shows. Since the machine tool configuration shown on the left side of FIG. 8 is the same as that shown on the left side of FIG. 7, detailed description thereof will be omitted.

図8の例では、第1制御軸と関連付けられる第1機械要素の速度ベクトルをv1とし、第2制御軸と関連付けられる第2機械要素の速度ベクトルをv2とし、第4制御軸と関連付けられる第3機械要素の速度ベクトルをv3とし、第1機械要素の移動前位置ベクトルをr1とし、第2機械要素の移動前位置ベクトルをr2とし、第3機械要素の移動前位置ベクトルをr3とする。また図8の例では、第1及び第2機械要素の組み合わせに対する相対速度ベクトルv1-v2は(0,0,1)とし、第1及び第3機械要素の組み合わせに対する相対速度ベクトルv1-v3は(0,2,0)とし、第2及び第3機械要素の組み合わせに対する相対速度ベクトルv2-v3は(1,0,0)とし、第1及び第2機械要素の組み合わせに対する正規化された相対位置ベクトルr1-r2は(0,0,-1)とし、第1及び第3機械要素の組み合わせに対する正規化された相対位置ベクトルr1-r3は(0,0,1)とし、第2及び第3機械要素の組み合わせに対する正規化された相対位置ベクトルr2-r3は(1,0,0)とする。 In the example of FIG. 8, the velocity vector of the first machine element associated with the first control axis is v1, the velocity vector of the second machine element associated with the second control axis is v2, and the fourth is associated with the fourth control axis. 3 The speed vector of the machine element is v3, the pre-movement position vector of the first machine element is r1, the pre-movement position vector of the second machine element is r2, and the pre-movement position vector of the third machine element is r3. Further, in the example of FIG. 8, the relative velocity vector v1-v2 for the combination of the first and second machine elements is (0,0,1), and the relative velocity vector v1-v3 for the combination of the first and third machine elements is. (0,2,0) and the relative velocity vector v2-v3 for the combination of the second and third machine elements is (1,0,0) and normalized relative to the combination of the first and second machine elements. The position vector r1-r2 is (0,0, -1) and the normalized relative position vector r1-r3 for the combination of the first and third machine elements is (0,0,1), the second and second. 3 The normalized relative position vector r2-r3 for the combination of machine elements is (1,0,0).

従って各機械要素の組み合わせに対する減少率パラメータを上述の手順に従って算出すると、第1及び第2機械要素の組み合わせに対する減少率パラメータは1となり、第1及び第3機械要素の組み合わせに対する減少率パラメータは0となり、第2及び第3機械要素の組み合わせに対する減少率パラメータは-1となる。従って減少率パラメータが大きな機械要素の組み合わせを含むチェック対象組から降順で優先度を算出すると、第1及び第2機械要素の組み合わせが1位となり、第1及び第3機械要素の組み合わせが2位となり、第2及び第3機械要素の組み合わせが3位となる。 Therefore, when the reduction rate parameter for each combination of machine elements is calculated according to the above procedure, the reduction rate parameter for the combination of the first and second machine elements is 1, and the reduction rate parameter for the combination of the first and third machine elements is 0. Therefore, the reduction rate parameter for the combination of the second and third machine elements is -1. Therefore, when the priority is calculated in descending order from the check target group including the combination of machine elements with a large reduction rate parameter, the combination of the first and second machine elements is ranked first, and the combination of the first and third machine elements is ranked second. Therefore, the combination of the second and third machine elements is ranked third.

図1に戻り、優先度算出部54bは、チェック対象組抽出部54aにおけるチェック対象組抽出処理によって抽出された複数のチェック対象組に対し、以上のような第1~第3の優先度算出アルゴリズムの何れか又はこれらを組み合わせた優先度算出アルゴリズムに基づいて優先度を算出し、算出した優先度を第3記憶部53におけるチェック対象組リストに追記する。これにより、チェック対象組抽出部54aによって抽出された複数のチェック対象組に対し優先度が付与される。 Returning to FIG. 1, the priority calculation unit 54b has the first to third priority calculation algorithms as described above for the plurality of check target groups extracted by the check target group extraction process in the check target group extraction unit 54a. The priority is calculated based on the priority calculation algorithm of any of the above or a combination thereof, and the calculated priority is added to the check target group list in the third storage unit 53. As a result, priority is given to the plurality of check target sets extracted by the check target set extraction unit 54a.

以上のように干渉チェック支援装置5では、位置姿勢算出部35から送信される軸移動量ベクトルや移動前位置ベクトルに基づいて、複数の機械要素の全組み合わせの中からチェック対象組を抽出し、さらにこれら複数のチェック対象組に対して優先度を付与し、優先度が付与されたチェック対象組リストを干渉チェック支援情報(例えば、図9参照)として第3記憶部53に記憶させる。 As described above, the interference check support device 5 extracts the set to be checked from all the combinations of the plurality of machine elements based on the axis movement amount vector and the pre-movement position vector transmitted from the position / orientation calculation unit 35. Further, priorities are given to these plurality of check target groups, and the check target group list to which the priorities are given is stored in the third storage unit 53 as interference check support information (see, for example, FIG. 9).

干渉チェック部36は、位置姿勢算出部35から補間周期毎に送信される移動後位置ベクトル及び移動後姿勢情報と、第3記憶部53に記憶された干渉チェック支援情報と、を取得する。また干渉チェック部36は、取得した干渉チェック支援情報によって定められた複数のチェック対象組について、優先度が高く定められたチェック対象組から順に干渉チェック演算を行う。 The interference check unit 36 acquires the post-movement position vector and the post-movement posture information transmitted from the position / attitude calculation unit 35 for each interpolation cycle, and the interference check support information stored in the third storage unit 53. Further, the interference check unit 36 performs an interference check operation for a plurality of check target sets defined by the acquired interference check support information, in order from the check target set having the highest priority.

本実施形態によれば、以下の効果が奏される。
優先度算出部54bは、工作機械2に対する移動パルスと、工作機械2における各制御軸と複数の機械要素のうちこの制御軸に沿って移動する機械要素とを関連付ける機械要素-制御軸紐付け情報と、に基づいて、複数のチェック対象組に対する優先度を算出する。これにより、複数のチェック対象組について、例えば干渉が生じやすい機械要素の組み合わせのチェック対象組の優先度を高くすることができる。また数値制御装置3は、数値制御プログラムに基づいて複数の機械要素を複数の制御軸に沿って移動させるとともに、複数のチェック対象組について優先度算出部54bにおいて算出された優先度によって定めれられた順序で干渉チェック演算を行う。本実施形態によれば、数値制御装置3では、優先度の高いチェック対象組から順に干渉チェック演算を行うことにより、限られた時間内に全てのチェック対象組について干渉チェック演算を行うことができないような場合であっても、効率的に機械要素同士の干渉を検出することができる。
According to this embodiment, the following effects are achieved.
The priority calculation unit 54b associates a moving pulse with respect to the machine tool 2 with each control axis in the machine tool 2 and a machine element moving along the control axis among a plurality of machine elements-control axis association information. And, based on, the priority for a plurality of check target sets is calculated. Thereby, for a plurality of check target sets, for example, it is possible to raise the priority of the check target set of the combination of machine elements that are likely to cause interference. Further, the numerical control device 3 moves a plurality of machine elements along a plurality of control axes based on a numerical control program, and is determined by the priority calculated by the priority calculation unit 54b for a plurality of check target sets. Interference check operations are performed in the order shown. According to the present embodiment, the numerical control device 3 cannot perform the interference check calculation for all the check target sets within a limited time by performing the interference check calculation in order from the check target set having the highest priority. Even in such a case, it is possible to efficiently detect interference between machine elements.

優先度算出部54bは、移動パルスに基づいて算出した各制御軸の軸移動量ベクトル及び機械要素-制御軸紐付け情報に基づいて、複数のチェック対象組に対する優先度を算出する。これにより、軸移動量ベクトルの長さや向きに応じて干渉が生じやすい機械要素の組み合わせを特定し、このチェック対象組の優先度を高くすることができる。 The priority calculation unit 54b calculates the priority for a plurality of check target sets based on the axis movement amount vector of each control axis and the machine element-control axis association information calculated based on the movement pulse. As a result, it is possible to specify a combination of machine elements that are likely to cause interference according to the length and direction of the axis movement amount vector, and to raise the priority of this check target set.

優先度算出部54bは、回転軸と関連付けられる回転機械要素を含むチェック対象組に対する優先度を、直進軸と関連付けられる直進機械要素のみを含むチェック対象組に対する優先度よりも高くする。これにより、直進軸よりも干渉に気づきにくい回転軸と関連付けられる回転機械要素を含むチェック対象組に対する優先度を、回転機械要素を含まないチェック対象組に対する優先度よりも高くすることができる。 The priority calculation unit 54b raises the priority for the check target group including the rotating machine element associated with the rotary axis higher than the priority for the check target group including only the straight machine element associated with the straight axis. As a result, the priority for the check target set including the rotary machine element associated with the rotary axis, which is less likely to notice the interference than the straight axis, can be higher than the priority for the check target set not including the rotary machine element.

第1の優先度算出アルゴリズムの下では、優先度算出部54bは、軸移動量が大きい制御軸から降順で、各制御軸と機械要素-制御軸紐付け情報によって関連付けられる各機械要素に対する機械要素順位を算出し、機械要素順位が高い機械要素から降順で、各機械要素を含む各チェック対象組に対する優先度を算出する。これにより、単位時間当たりの軸移動量が大きな制御軸と関連付けられている機械要素を含むチェック対象組において干渉する可能性が高いと判断し、このような機械要素を含むチェック対象組の優先度を高くすることができる。またこのような第1の優先度算出アルゴリズムによれば、簡易な演算で優先度を算出することができるので、数値制御装置3における演算負荷を軽減することができる。 Under the first priority calculation algorithm, the priority calculation unit 54b is a machine element for each machine element associated with each control axis by the machine element-control axis association information in descending order from the control axis having the largest axis movement amount. The order is calculated, and the priority for each check target group including each machine element is calculated in descending order from the machine element having the highest machine element order. As a result, it is determined that there is a high possibility that the axis movement amount per unit time will interfere with the check target group including the machine element associated with the large control axis, and the priority of the check target group including such a machine element is determined. Can be raised. Further, according to such a first priority calculation algorithm, the priority can be calculated by a simple calculation, so that the calculation load in the numerical control device 3 can be reduced.

第2の優先度算出アルゴリズムの下では、優先度算出部54bは、軸移動量に基づいて複数組の軸対に対する相対軸移動量を算出し、相対軸移動量が大きい軸対から降順で、各軸対と機械要素-制御軸紐付け情報によって関連付けられる機械要素の組み合わせを含む各チェック対象組に対する優先度を算出する。これにより、単位時間当たりの相対軸移動量が大きな軸対と関連付けられている機械要素の組み合わせを含むチェック対象組において干渉する可能性が高いと判断し、このような機械要素の組み合わせを含むチェック対象組の優先度を高くすることができる。 Under the second priority calculation algorithm, the priority calculation unit 54b calculates the relative axis movement amount for a plurality of sets of axis movements based on the axis movement amount, and in descending order from the axis pair with the largest relative axis movement amount. Calculate the priority for each check target set including the combination of each axis pair and the machine element-machine element associated with the control axis association information. As a result, it is judged that there is a high possibility of interference in the set to be checked including the combination of machine elements associated with the axis pair having a large relative axis movement amount per unit time, and the check including such a combination of machine elements is determined. The priority of the target group can be increased.

第3の優先度算出アルゴリズムの下では、優先度算出部54bは、軸移動量ベクトル、移動前位置ベクトル、及び機械要素-制御軸紐付け情報に基づいて、各チェック対象組を構成する2つの機械要素の間の距離の減少率に応じた減少率パラメータを算出し、これら減少率パラメータに基づいて各チェック対象組に対する優先度を算出する。これにより、機械要素の間の距離の減少率が大きいチェック対象組において干渉する可能性が高いと判断し、このような機械要素の組み合わせを含むチェック対象組の優先度を高くすることができる。 Under the third priority calculation algorithm, the priority calculation unit 54b constitutes two check target sets based on the axis movement amount vector, the pre-movement position vector, and the machine element-control axis association information. The reduction rate parameters are calculated according to the reduction rate of the distance between the machine elements, and the priority for each check target set is calculated based on these reduction rate parameters. As a result, it is determined that there is a high possibility of interference in the check target set in which the reduction rate of the distance between the machine elements is large, and the priority of the check target set including such a combination of machine elements can be increased.

優先度算出部54bは、複数のチェック対象組に対する優先度に関する情報を干渉チェック支援情報として第3記憶部53に記憶させ、干渉チェック部36は、第3記憶部53に記憶された干渉チェック支援情報を参照し、干渉チェック演算を行う。これにより、優先度算出部54bでは、干渉チェック部36における干渉チェック演算と独立した自由なタイミングでチェック対象組の優先度を算出する演算を行うことができる。 The priority calculation unit 54b stores information on the priority for a plurality of check target sets in the third storage unit 53 as interference check support information, and the interference check unit 36 stores the interference check support stored in the third storage unit 53. Refer to the information and perform the interference check operation. As a result, the priority calculation unit 54b can perform an operation of calculating the priority of the check target set at a free timing independent of the interference check operation in the interference check unit 36.

チェック対象組抽出部54aは、移動パルスに基づいて算出される軸移動量、機械要素-制御軸紐付け情報、及び各軸従属関係情報に基づいて、複数の機械要素の全ての組み合わせの中から1組以上のチェック対象組を抽出する。また優先度算出部54bは、チェック対象組抽出部54aによって抽出された複数のチェック対象組に対し優先度を算出する。これにより優先度算出部54bは、必ずしも全てのチェック対象組に対して優先度を算出する必要がなく、チェック対象組抽出部54aによって絞り込まれたチェック対象組に対してのみ優先度を算出すればよいので、数値制御装置3における演算負荷を軽減することができる。 The check target set extraction unit 54a is selected from all combinations of a plurality of machine elements based on the axis movement amount calculated based on the movement pulse, the machine element-control axis association information, and each axis dependency information. Extract one or more sets to be checked. Further, the priority calculation unit 54b calculates the priority for a plurality of check target sets extracted by the check target set extraction unit 54a. As a result, the priority calculation unit 54b does not necessarily have to calculate the priority for all the check target groups, and can calculate the priority only for the check target groups narrowed down by the check target group extraction unit 54a. Therefore, the calculation load on the numerical control device 3 can be reduced.

また本実施形態では、干渉チェック支援情報を生成する機能を備える干渉チェック支援装置5を、工作機械2の制御及び干渉チェック演算を行う数値制御装置3に組み込むとともに、干渉チェック支援装置5では、数値制御装置3のパルス生成部34から送信される移動パルスに基づいて干渉チェック支援情報を生成する。これにより、数値制御装置3における演算負荷が大きくなるものの、数値制御装置3によって工作機械2を制御しながら、リアルタイムで干渉チェック支援情報を生成することができる。このため、例えば工作機械2がオペレータによって手動で操作された場合であっても適切な干渉チェック支援情報を生成することができる。 Further, in the present embodiment, the interference check support device 5 having a function of generating interference check support information is incorporated into the numerical control device 3 that controls the machine tool 2 and performs the interference check calculation, and the interference check support device 5 has a numerical value. Interference check support information is generated based on the moving pulse transmitted from the pulse generation unit 34 of the control device 3. As a result, although the calculation load on the numerical control device 3 becomes large, it is possible to generate interference check support information in real time while controlling the machine tool 2 by the numerical control device 3. Therefore, for example, even when the machine tool 2 is manually operated by an operator, appropriate interference check support information can be generated.

<第2実施形態>
次に、本開示の第2実施形態に係る数値制御システムについて説明する。なお以下の説明では、第1実施形態に係る数値制御システムと同じ構成については同じ符号を付し、詳細な説明を省略する。
<Second Embodiment>
Next, the numerical control system according to the second embodiment of the present disclosure will be described. In the following description, the same reference numerals are given to the same configurations as those of the numerical control system according to the first embodiment, and detailed description thereof will be omitted.

図10は、本実施形態に係る数値制御システム1Aの概略図である。上述のように第1実施形態では、干渉チェック支援装置5を数値制御装置3に組み込んだ場合について説明した。これに対し本実施形態に係る数値制御システム1Aは、数値制御装置3Aと、この数値制御装置3Aとは別体で構成された干渉チェック支援装置5Aと、を備える点において第1実施形態に係る数値制御システム1Aと異なる。 FIG. 10 is a schematic diagram of the numerical control system 1A according to the present embodiment. As described above, in the first embodiment, the case where the interference check support device 5 is incorporated in the numerical control device 3 has been described. On the other hand, the numerical control system 1A according to the present embodiment relates to the first embodiment in that it includes a numerical control device 3A and an interference check support device 5A configured separately from the numerical control device 3A. It is different from the numerical control system 1A.

干渉チェック支援装置5Aは、第1記憶部51と、第2記憶部52と、チェック支援情報生成部54と、移動量位置算出部55Aと、を備える。 The interference check support device 5A includes a first storage unit 51, a second storage unit 52, a check support information generation unit 54, and a movement amount position calculation unit 55A.

移動量位置算出部55Aは、加工プログラムメモリ31に格納された数値制御プログラムを読み出し、数値制御装置3の指令解析部32、補間部33、パルス生成部34、及び位置姿勢算出部35における演算と同じ手順によって、数値制御装置3における補間周期と同じ周期で各制御軸の軸移動量ベクトル及び各機械要素の移動前位置ベクトルを生成する。移動量位置算出部55Aは、生成した軸移動量ベクトル及び移動前位置ベクトルを、チェック支援情報生成部54へ送信する。移動量位置算出部55Aから送信される軸移動量ベクトル及び移動前位置ベクトルに基づいてチェック支援情報生成部54において干渉チェック支援情報を生成する手順は第1実施形態と同じであるので、詳細な説明は省略する。 The movement amount position calculation unit 55A reads out the numerical control program stored in the machining program memory 31, and performs calculations in the command analysis unit 32, the interpolation unit 33, the pulse generation unit 34, and the position / attitude calculation unit 35 of the numerical control device 3. By the same procedure, the axis movement amount vector of each control axis and the pre-movement position vector of each machine element are generated in the same cycle as the interpolation cycle in the numerical control device 3. The movement amount position calculation unit 55A transmits the generated axis movement amount vector and the pre-movement position vector to the check support information generation unit 54. The procedure for generating interference check support information in the check support information generation unit 54 based on the axis movement amount vector and the pre-movement position vector transmitted from the movement amount position calculation unit 55A is the same as that in the first embodiment. The explanation is omitted.

本実施形態では、加工プログラムメモリ31に格納された数値制御プログラムに基づいて干渉チェック支援情報を生成する干渉チェック支援装置5Aを、数値制御装置3Aと別体で構成する。これにより、数値制御装置3Aによって工作機械2の制御を開始する前に、より具体的には数値制御プログラムを作成した段階で、この数値制御プログラムに基づいて干渉チェック支援情報を生成することができる。よって本実施形態に係る数値制御システム1によれば、第1実施形態に係る数値制御システム1と比較して、工作機械2の制御を行う際における数値制御装置3Aの演算負荷を軽減することができる。 In the present embodiment, the interference check support device 5A that generates interference check support information based on the numerical control program stored in the machining program memory 31 is configured separately from the numerical control device 3A. Thereby, before starting the control of the machine tool 2 by the numerical control device 3A, more specifically, at the stage where the numerical control program is created, the interference check support information can be generated based on this numerical control program. .. Therefore, according to the numerical control system 1 according to the present embodiment, it is possible to reduce the calculation load of the numerical control device 3A when controlling the machine tool 2 as compared with the numerical control system 1 according to the first embodiment. can.

本開示は、上記実施形態に限定されるものではなく、種々の変更及び変形が可能である。例えば上記第1実施形態では、チェック支援情報生成部54は生成したチェック支援情報を第3記憶部53に格納し、干渉チェック部36は第3記憶部53に格納されたチェック支援情報を読み込んでから干渉チェック演算を行う場合について説明したが、本発明はこれに限らない。チェック支援情報生成部54で生成したチェック支援情報は、第3記憶部53を介さずに干渉チェック部36へ送信するようにしてもよい。 The present disclosure is not limited to the above embodiment, and various modifications and modifications are possible. For example, in the first embodiment, the check support information generation unit 54 stores the generated check support information in the third storage unit 53, and the interference check unit 36 reads the check support information stored in the third storage unit 53. The case where the interference check calculation is performed has been described above, but the present invention is not limited to this. The check support information generated by the check support information generation unit 54 may be transmitted to the interference check unit 36 without going through the third storage unit 53.

1,1A…数値制御システム
2…工作機械
3,3A…数値制御装置
31…加工プログラムメモリ
32…指令解析部
33…補間部
34…パルス生成部
35…位置姿勢算出部
36…干渉チェック部
37…形状記憶部
5,5A…干渉チェック支援装置
51…第1記憶部
52…第2記憶部
53…第3記憶部
54…チェック支援情報生成部
54a…チェック対象組抽出部
54b…優先度算出部
55A…移動量位置算出部
1,1A ... Numerical control system 2 ... Machine tool 3,3A ... Numerical control device 31 ... Machining program memory 32 ... Command analysis unit 33 ... Interpretation unit 34 ... Pulse generation unit 35 ... Position and orientation calculation unit 36 ... Interference check unit 37 ... Shape storage unit 5,5A ... Interference check support device 51 ... 1st storage unit 52 ... 2nd storage unit 53 ... 3rd storage unit 54 ... Check support information generation unit 54a ... Check target group extraction unit 54b ... Priority calculation unit 55A … Movement amount position calculation unit

Claims (9)

移動指令に基づいて工作機械の複数の機械要素を複数の軸に沿って移動させるとともに2つの機械要素の間の干渉チェック演算を複数のチェック対象組について所定の優先度によって定められた順序で行う数値制御装置と、
前記干渉チェック演算を支援する干渉チェック支援装置と、を備える数値制御システムであって、
前記干渉チェック支援装置は、
前記工作機械における各軸と前記複数の機械要素のうち当該軸に沿って移動する機械要素とを関連付ける第1情報を記憶する第1記憶部と、
前記移動指令及び前記第1情報に基づいて、前記複数のチェック対象組に対する前記優先度を算出する優先度算出部と、を備える、数値制御システム。
A plurality of machine elements of a machine tool are moved along a plurality of axes based on a movement command, and an interference check calculation between the two machine elements is performed for a plurality of check target sets in an order determined by a predetermined priority. Numerical control device and
A numerical control system including an interference check support device that supports the interference check calculation.
The interference check support device is
A first storage unit that stores first information that associates each axis of the machine tool with a machine element that moves along the axis among the plurality of machine elements.
A numerical control system including a priority calculation unit for calculating the priority for the plurality of check target sets based on the movement command and the first information.
前記優先度算出部は、前記移動指令に基づいて算出した各軸の軸移動量及び前記第1情報に基づいて前記複数のチェック対象組に対する前記優先度を算出する、請求項1に記載の数値制御システム。 The numerical value according to claim 1, wherein the priority calculation unit calculates the priority for the plurality of check target sets based on the axis movement amount of each axis calculated based on the movement command and the first information. Control system. 前記複数の軸は、前記機械要素を軸線に沿って並進移動させる直進軸と、前記機械要素を軸線回りで回転移動させる回転軸と、に分けられ、
前記優先度算出部は、前記回転軸と前記第1情報によって関連付けられる機械要素である回転機械要素を含むチェック対象組に対する前記優先度を、前記回転機械要素を含まないチェック対象組に対する前記優先度よりも高くする、請求項2に記載の数値制御システム。
The plurality of axes are divided into a straight axis that translates the machine element along an axis and a rotation axis that rotates the machine element around the axis.
The priority calculation unit sets the priority for the check target set including the rotary machine element, which is a machine element associated with the rotary axis by the first information, and the priority for the check target set not including the rotary machine element. The numerical control system according to claim 2, which is higher than the above.
前記優先度算出部は、
前記軸移動量が大きい軸から降順で、各軸と前記第1情報によって関連付けられる各機械要素に対する機械要素順位を算出し、
前記機械要素順位が高い機械要素から降順で、各機械要素を含む各チェック対象組に対する前記優先度を算出する、請求項2又は3に記載の数値制御システム。
The priority calculation unit
The machine element order for each axis and each machine element associated with the first information is calculated in descending order from the axis having the largest amount of axis movement.
The numerical control system according to claim 2 or 3, wherein the priority is calculated for each check target set including each machine element in descending order from the machine element having the highest machine element order.
前記優先度算出部は、
前記軸移動量に基づいて複数組の軸対に対する相対軸移動量を算出し、
前記相対軸移動量が大きい軸対から降順で、各軸対と前記第1情報によって関連付けられる機械要素の組み合わせを含む各チェック対象組に対する前記優先度を算出する、請求項2又は3に記載の数値制御システム。
The priority calculation unit
Based on the axis movement amount, the relative axis movement amount for a plurality of sets of axis pairs is calculated.
The second or third aspect of the present invention, wherein the priority is calculated for each check target set including the combination of each axis pair and the machine element associated with the first information in descending order from the axis pair having the largest relative axis movement amount. Numerical control system.
前記優先度算出部は、前記軸移動量及び前記第1情報に基づいて、各チェック対象組を構成する2つの機械要素の間の距離の減少率に応じた減少率パラメータを算出し、当該減少率パラメータに基づいて各チェック対象組に対する前記優先度を算出する、請求項2に記載の数値制御システム。 The priority calculation unit calculates a reduction rate parameter according to the reduction rate of the distance between the two machine elements constituting each check target set based on the axis movement amount and the first information, and the reduction rate parameter is calculated. The numerical control system according to claim 2, wherein the priority is calculated for each set to be checked based on the rate parameter. 前記優先度算出部によって算出された前記優先度に関する情報を記憶する第3記憶部をさらに備え、
前記数値制御装置は、前記第3記憶部に記憶された前記優先度に関する情報を参照し、各チェック対象組に対する前記干渉チェック演算を行う、請求項1から6の何れかに記載の数値制御システム。
Further, a third storage unit for storing information regarding the priority calculated by the priority calculation unit is provided.
The numerical control system according to any one of claims 1 to 6, wherein the numerical control device refers to the information regarding the priority stored in the third storage unit and performs the interference check calculation for each check target set. ..
前記干渉チェック支援装置は、前記工作機械における各軸の間の従属関係を規定する第2情報を記憶する第2記憶部と、前記移動指令、前記第1情報、及び前記第2情報に基づいて、前記複数の機械要素の全ての組み合わせの中から1組以上の前記チェック対象組を抽出するチェック対象組抽出部と、をさらに備え、
前記優先度算出部は、前記チェック対象組抽出部によって抽出された複数のチェック対象組に対して前記優先度を算出する、請求項1から7の何れかに記載の数値制御システム。
The interference check support device is based on a second storage unit that stores second information that defines a dependency relationship between axes in the machine tool, a movement command, the first information, and the second information. Further, a check target set extraction unit for extracting one or more sets of check target sets from all combinations of the plurality of machine elements is further provided.
The numerical control system according to any one of claims 1 to 7, wherein the priority calculation unit calculates the priority for a plurality of check target sets extracted by the check target set extraction unit.
移動指令に基づいて工作機械の複数の機械要素を複数の軸に沿って移動させるとともに2つの機械要素の間の干渉チェック演算を複数のチェック対象組について所定の優先度によって定められた順序で行う数値制御装置における前記干渉チェック演算を支援する干渉チェック支援方法であって、
前記移動指令と、前記工作機械における各軸と前記複数の機械要素のうち当該軸に沿って移動する機械要素とを関連付ける第1情報と、を取得し、
前記移動指令と前記第1情報とに基づいて、前記複数のチェック対象組に対する前記優先度を算出する、干渉チェック支援方法。
A plurality of machine elements of a machine tool are moved along a plurality of axes based on a movement command, and an interference check operation between the two machine elements is performed for a plurality of check target sets in an order determined by a predetermined priority. It is an interference check support method that supports the interference check operation in a numerical control device.
The movement command and the first information associating each axis in the machine tool with the machine element moving along the axis among the plurality of machine elements are acquired.
An interference check support method for calculating the priority for the plurality of check target sets based on the movement command and the first information.
JP2020146210A 2020-08-31 2020-08-31 Numerical control system and interference check method Pending JP2022041159A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2020146210A JP2022041159A (en) 2020-08-31 2020-08-31 Numerical control system and interference check method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2020146210A JP2022041159A (en) 2020-08-31 2020-08-31 Numerical control system and interference check method

Publications (1)

Publication Number Publication Date
JP2022041159A true JP2022041159A (en) 2022-03-11

Family

ID=80500230

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2020146210A Pending JP2022041159A (en) 2020-08-31 2020-08-31 Numerical control system and interference check method

Country Status (1)

Country Link
JP (1) JP2022041159A (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7415093B1 (en) 2023-05-11 2024-01-16 ファナック株式会社 Control device and computer readable recording medium

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7415093B1 (en) 2023-05-11 2024-01-16 ファナック株式会社 Control device and computer readable recording medium

Similar Documents

Publication Publication Date Title
Sun et al. Chatter free tool orientations in 5-axis ball-end milling
Liu et al. Inverse kinematics of a 5-axis hybrid robot with non-singular tool path generation
CN102216037B (en) A method and a device for optimizing a programmed movement path for an industrial robot
WO2011096327A1 (en) Processing path generation method and device for same
JP2007090479A (en) Off-line teaching device of robot
KR102312368B1 (en) System, method for controlling redundant robot, and a recording medium having computer readable program for executing the method
JP2013058035A (en) Numerical control device for multiple spindle machine tool including workpiece installation error correction section
CN104210302A (en) Three-dimensional engraving machine, method and system
JP2013257809A (en) Tool locus display device displaying tool vector of machine tool
CN114131611B (en) Off-line compensation method, system and terminal for joint errors of robot gravity pose decomposition
JP2018077778A (en) Numerical control system
CN109760040A (en) Method of determining interference, determining interference system and storage medium
CN101791810B (en) Polar coordinate numerical control woodworking basket milling machine
JP2021071818A (en) Tool life prediction system
JPWO2018179401A1 (en) Tool path generation method and apparatus
CN107073714A (en) For the method and system for the machining locus for correcting robot guiding tool
US20220137591A1 (en) System and method for design and manufacture using multi-axis machine tools
JP2022041159A (en) Numerical control system and interference check method
JP2018128986A (en) Path correction method and control device of multi-axis processing machine
WO2022045253A1 (en) Numerical control system and interference checking assistance method
JP6865055B2 (en) Machining load analysis device, machining load analysis program, and machining load analysis system
JP2019197333A (en) Path correction method and control device of multiple spindle processing machine
Shen et al. An NC code based machining movement simulation method for a parallel robotic machine
JP6623902B2 (en) Processing path calculation device, processing path calculation method, and computer program
US11194313B2 (en) Numerical controller

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20230615

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20240415

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20240430