WO2021049028A1 - Numerical control device and machine learning device - Google Patents

Numerical control device and machine learning device Download PDF

Info

Publication number
WO2021049028A1
WO2021049028A1 PCT/JP2019/036198 JP2019036198W WO2021049028A1 WO 2021049028 A1 WO2021049028 A1 WO 2021049028A1 JP 2019036198 W JP2019036198 W JP 2019036198W WO 2021049028 A1 WO2021049028 A1 WO 2021049028A1
Authority
WO
WIPO (PCT)
Prior art keywords
robot
unit
interference
machine tool
machine
Prior art date
Application number
PCT/JP2019/036198
Other languages
French (fr)
Japanese (ja)
Inventor
正一 嵯峨▲崎▼
健輔 馬場
崇 末田
Original Assignee
三菱電機株式会社
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 三菱電機株式会社 filed Critical 三菱電機株式会社
Priority to PCT/JP2019/036198 priority Critical patent/WO2021049028A1/en
Priority to DE112019007579.9T priority patent/DE112019007579B4/en
Priority to JP2020552910A priority patent/JP6914452B1/en
Priority to CN201980100202.4A priority patent/CN114365047B/en
Publication of WO2021049028A1 publication Critical patent/WO2021049028A1/en

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1674—Programme controls characterised by safety, monitoring, diagnostic
    • B25J9/1676—Avoiding collision or forbidden zones
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00—Programme-control systems
    • G05B19/02—Programme-control systems electric
    • G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
    • G05B19/406—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by monitoring or safety
    • G05B19/4061—Avoiding collision or forbidden zones
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Landscapes

  • Engineering & Computer Science (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Numerical Control (AREA)
  • Manipulator (AREA)

Abstract

A numerical control device (1X) includes: a machine operation computation unit (801) that calculates the position at a specific timing of a first constituent element provided to a machine tool (100) by using a machine model (811) and first position data which is used when controlling the position of the first constituent element; a robot operation computation unit (802) that calculates the position at the specific timing of a second constituent element provided to a robot (60) by using a robot model (812) and second position data which is used when controlling the position of the second constituent element; and an interference check unit (803) that determines, on the basis of the position of the first constituent element and the position of the second constituent element, whether the machine tool (100) and the robot (60) will collide.

Description

数値制御装置、および機械学習装置Numerical control device and machine learning device
　本発明は、ロボットおよび工作機械を制御する数値制御装置、および機械学習装置に関する。 The present invention relates to a numerical control device for controlling a robot and a machine tool, and a machine learning device.
　数値制御装置の１つに、被加工物の加工を行う工作機械の制御と、被加工物の搬送および加工を行うロボットの制御とを並行して実行する制御装置がある。 One of the numerical control devices is a control device that controls a machine tool that processes a work piece and a robot that conveys and processes the work piece in parallel.
　特許文献１に記載の数値制御装置は、指定経過時刻におけるロボットの動作位置、および指定経過時刻における工作機械の動作位置に基づいて、ロボットおよび工作機械の三次元モデルを表示装置上に表示させている。 The numerical control device described in Patent Document 1 displays a three-dimensional model of the robot and the machine tool on the display device based on the operating position of the robot at the designated elapsed time and the operating position of the machine tool at the designated elapsed time. There is.
特許第４６５３８３６号公報Japanese Patent No. 4653836
　しかしながら、上記特許文献１の技術では、ロボットの動作と工作機械の動作とを表示しているものの、工作機械とロボットとが衝突するか否かを判断することができないという問題があった。 However, in the technique of Patent Document 1, although the operation of the robot and the operation of the machine tool are displayed, there is a problem that it cannot be determined whether or not the machine tool and the robot collide with each other.
　本発明は、上記に鑑みてなされたものであって、工作機械とロボットとが衝突するか否かを判断することができる数値制御装置を得ることを目的とする。 The present invention has been made in view of the above, and an object of the present invention is to obtain a numerical control device capable of determining whether or not a machine tool and a robot collide with each other.
　上述した課題を解決し、目的を達成するために、本発明の数値制御装置は、工作機械の動作シミュレーション用のデータである機械モデルと工作機械が備える第１の構成要素の位置を制御する際に用いられる第１の位置データとを用いて、特定タイミングにおける第１の構成要素の位置を算出する機械動作演算部を有する。また、本発明の数値制御装置は、ロボットの動作シミュレーション用のデータであるロボットモデルとロボットが備える第２の構成要素の位置を制御する際に用いられる第２の位置データとを用いて特定タイミングにおける第２の構成要素の位置を算出するロボット動作演算部を有する。また、本発明の数値制御装置は、第１の構成要素の位置および第２の構成要素の位置に基づいて、工作機械とロボットとが衝突するか否かを判断する衝突判断部を有する。 In order to solve the above-mentioned problems and achieve the object, the numerical control device of the present invention controls the position of the machine model which is the data for the motion simulation of the machine tool and the position of the first component included in the machine tool. It has a machine tool operation calculation unit that calculates the position of the first component at a specific timing by using the first position data used in the above. Further, the numerical control device of the present invention uses a robot model, which is data for robot motion simulation, and a second position data used when controlling the position of a second component included in the robot, to specify a specific timing. It has a robot motion calculation unit that calculates the position of the second component in the above. Further, the numerical control device of the present invention has a collision determination unit that determines whether or not the machine tool and the robot collide with each other based on the position of the first component and the position of the second component.
　本発明にかかる数値制御装置は、工作機械とロボットとが衝突するか否かを判断することができるという効果を奏する。 The numerical control device according to the present invention has the effect of being able to determine whether or not a machine tool and a robot collide with each other.
実施の形態１にかかる数値制御装置の構成例を示す図The figure which shows the structural example of the numerical control apparatus which concerns on Embodiment 1. 実施の形態１にかかる数値制御装置が制御する工作機械およびロボットの配置例を示す図The figure which shows the arrangement example of the machine tool and the robot controlled by the numerical control device which concerns on Embodiment 1. 実施の形態１にかかる数値制御装置が描画した画面の第１例を示す図The figure which shows the 1st example of the screen drawn by the numerical control device which concerns on Embodiment 1. 実施の形態１にかかる数値制御装置が描画した画面の第２例を示す図The figure which shows the 2nd example of the screen drawn by the numerical control device which concerns on Embodiment 1. 実施の形態１にかかる数値制御装置が描画した画面の第３例を示す図The figure which shows the 3rd example of the screen drawn by the numerical control device which concerns on Embodiment 1. 実施の形態１にかかる数値制御装置が検出する、ロボットハンドと工作機械の筐体との干渉を説明するための図The figure for demonstrating the interference between a robot hand and a machine tool housing detected by the numerical control device which concerns on Embodiment 1. 実施の形態１にかかる数値制御装置が検出する、ロボットアームと工作機械の外部に配置された機構との干渉を説明するための図The figure for demonstrating the interference between the robot arm and the mechanism arranged outside the machine tool detected by the numerical control device which concerns on Embodiment 1. 実施の形態１にかかる数値制御装置による干渉チェックの処理手順を示すフローチャートA flowchart showing a processing procedure of interference check by the numerical control device according to the first embodiment. 実施の形態２にかかる数値制御装置の構成例を示す図The figure which shows the structural example of the numerical control apparatus which concerns on Embodiment 2. 実施の形態２にかかる数値制御装置によって実行される干渉回避の第１の動作例を説明するための図The figure for demonstrating the 1st operation example of the interference avoidance executed by the numerical control apparatus which concerns on Embodiment 2. 実施の形態２にかかる数値制御装置によって実行される干渉回避の第２の動作例を説明するための図The figure for demonstrating the 2nd operation example of the interference avoidance executed by the numerical control apparatus which concerns on Embodiment 2. 実施の形態２にかかる数値制御装置による干渉チェックの処理手順を示すフローチャートA flowchart showing a processing procedure of interference check by the numerical control device according to the second embodiment. 実施の形態３にかかる数値制御装置の構成例を示す図The figure which shows the structural example of the numerical control apparatus which concerns on Embodiment 3. 実施の形態３にかかる数値制御装置がワークシミュレーションをする際のロボットおよび工作機械の動作を説明するための図The figure for demonstrating the operation of the robot and the machine tool when the numerical control device which concerns on Embodiment 3 performs work simulation. 図１４に示すワークシミュレーションが実行される際の画面表示の例を示す図The figure which shows the example of the screen display when the work simulation shown in FIG. 14 is executed. 図１５に示した面取り位置での加工ワークの形状を拡大表示した例を示す図The figure which shows the example which enlarged-displayed the shape of the machined work at the chamfer position shown in FIG. 実施の形態３にかかる数値制御装置によるワークシミュレーションの処理手順を示すフローチャートFlow chart showing the processing procedure of the work simulation by the numerical control device according to the third embodiment 実施の形態４にかかる数値制御装置の構成例を示す図The figure which shows the structural example of the numerical control apparatus which concerns on Embodiment 4. 実施の形態４にかかる数値制御装置が備える操作盤の構成例を示す図The figure which shows the structural example of the operation panel provided in the numerical control device which concerns on Embodiment 4. 実施の形態４にかかる数値制御装置が備える表示部で表示される干渉アラームの例を示す図The figure which shows the example of the interference alarm which is displayed on the display part of the numerical control device which concerns on Embodiment 4. 実施の形態４にかかる数値制御装置によって実行される干渉回避の動作例を説明するための図The figure for demonstrating the operation example of the interference avoidance executed by the numerical control apparatus which concerns on Embodiment 4. 実施の形態４にかかる数値制御装置による干渉チェックおよび干渉回避の処理手順を示すフローチャートA flowchart showing a processing procedure of interference check and interference avoidance by the numerical control device according to the fourth embodiment. 実施の形態５にかかる数値制御装置の構成例を示す図The figure which shows the structural example of the numerical control apparatus which concerns on Embodiment 5. 実施の形態にかかる数値制御装置が備える制御演算部のハードウェア構成例を示す図The figure which shows the hardware configuration example of the control calculation part included in the numerical control device which concerns on embodiment.
　以下に、本発明の実施の形態にかかる数値制御装置、および機械学習装置を図面に基づいて詳細に説明する。なお、これらの実施の形態によりこの発明が限定されるものではない。 Hereinafter, the numerical control device and the machine learning device according to the embodiment of the present invention will be described in detail with reference to the drawings. The present invention is not limited to these embodiments.
実施の形態１．
　図１は、実施の形態１にかかる数値制御装置の構成例を示す図である。数値制御装置１Ｘは、制御演算部２Ｘと、入力操作部３と、表示部４と、ＰＬＣ（Programmable　Logic　Controller：プログラマブルロジックコントローラ）３６を操作するための機械操作盤などのＰＬＣ操作部５とを有する。図１には、数値制御装置１Ｘとともに、工作機械１００、ロボットコントローラ５０、およびロボット６０が示されている。数値制御装置１Ｘと、工作機械１００と、ロボットコントローラ５０と、ロボット６０とで構成されるシステムが、制御システムである。 Embodiment 1.
FIG. 1 is a diagram showing a configuration example of a numerical control device according to the first embodiment. The numerical control device 1X includes a control calculation unit 2X, an input operation unit 3, a display unit 4, and a PLC operation unit 5 such as a machine operation panel for operating a PLC (Programmable Logic Controller) 36. Have. FIG. 1 shows a machine tool 100, a robot controller 50, and a robot 60 together with a numerical control device 1X. A system composed of a numerical control device 1X, a machine tool 100, a robot controller 50, and a robot 60 is a control system.
　数値制御装置１Ｘは、駆動部９０の各サーボ制御部と通信を実行するとともに、ロボットコントローラ５０との間で通信を実行する。数値制御装置１Ｘは、工作機械１００に対して工具を使った加工ワーク（被加工物）の加工を実行させるとともに、ロボット６０に対して加工ワークの搬送を実行させるコンピュータである。数値制御装置１Ｘは、ＧコードプログラムといったＮＣ（Numerical　Control）プログラムを用いて、工作機械１００およびロボット６０を制御する。加工プログラムであるＮＣプログラムには、工作機械１００への指令と、ロボット６０への指令とが含まれている。数値制御装置１Ｘは、ＮＣプログラムのうちのロボット６０への指令を、ロボットプログラムの指令に変換してロボット６０を制御する。 The numerical control device 1X executes communication with each servo control unit of the drive unit 90 and also executes communication with the robot controller 50. The numerical control device 1X is a computer that causes the machine tool 100 to execute machining of a machining work (workpiece) using a tool, and causes the robot 60 to execute the transfer of the machining work. The numerical control device 1X controls the machine tool 100 and the robot 60 by using an NC (Numerical Control) program such as a G code program. The NC program, which is a machining program, includes a command to the machine tool 100 and a command to the robot 60. The numerical control device 1X controls the robot 60 by converting a command to the robot 60 in the NC program into a command of the robot program.
　本実施の形態の数値制御装置１Ｘは、ロボット６０と工作機械１００とが干渉するか否かを判断し、干渉する場合にはアラームを発生させる。ロボット６０と工作機械１００との干渉は、工作機械１００とロボット６０との衝突と同義である。ロボット６０と工作機械１００との干渉には、ロボット６０が把持する工具と工作機械１００との干渉、工作機械１００が把持する工具とロボット６０との干渉、ロボット６０が把持する工具と工作機械１００が把持する工具との干渉が含まれる。 The numerical control device 1X of the present embodiment determines whether or not the robot 60 and the machine tool 100 interfere with each other, and if they interfere with each other, an alarm is generated. Interference between the robot 60 and the machine tool 100 is synonymous with a collision between the machine tool 100 and the robot 60. The interference between the robot 60 and the machine tool 100 includes interference between the tool held by the robot 60 and the machine tool 100, interference between the tool held by the machine tool 100 and the robot 60, and the tool held by the robot 60 and the machine tool 100. Includes interference with the tool gripped by.
　工作機械１００は、工具および加工ワークを駆動する駆動部９０を備えている。駆動部９０の例は、加工ワークを回転させながら工具を駆動する駆動機構である。実施の形態１では、工具の駆動方向が、例えばＸ軸方向に平行な方向とＺ軸方向に平行な方向との２方向である。なお、軸方向は装置構成によるので、軸方向は、上記方向に限定されない。 The machine tool 100 includes a drive unit 90 that drives a tool and a machining work. An example of the drive unit 90 is a drive mechanism that drives a tool while rotating a workpiece. In the first embodiment, the driving direction of the tool is, for example, two directions, a direction parallel to the X-axis direction and a direction parallel to the Z-axis direction. Since the axial direction depends on the device configuration, the axial direction is not limited to the above direction.
　駆動部９０は、数値制御装置１Ｘ上で規定された各軸方向に工具を移動させるサーボモータ９０１，９０２と、サーボモータ９０１，９０２の位置および速度を検出する検出器９７，９８とを備えている。また、駆動部９０は、数値制御装置１Ｘからの指令に基づいて、サーボモータ９０１，９０２を制御する各軸方向のサーボ制御部を備えている。各軸方向のサーボ制御部は、検出器９７，９８からの位置および速度に基づいて、サーボモータ９０１，９０２へのフィードバック制御を行う。 The drive unit 90 includes servomotors 901 and 902 that move the tool in each axial direction defined on the numerical control device 1X, and detectors 97 and 98 that detect the positions and speeds of the servomotors 901 and 902. There is. Further, the drive unit 90 includes a servo control unit in each axial direction that controls the servomotors 901 and 902 based on a command from the numerical control device 1X. The servo control unit in each axial direction performs feedback control to the servomotors 901 and 902 based on the position and speed from the detectors 97 and 98.
　サーボ制御部のうちの、Ｘ軸サーボ制御部９１は、サーボモータ９０１を制御することによって工具のＸ軸方向の動作を制御し、Ｚ軸サーボ制御部９２は、サーボモータ９０２を制御することによって工具のＺ軸方向の動作を制御する。なお、工作機械１００が２つ以上の刃物台を備えていてもよい。この場合、駆動部９０は、１つの刃物台毎に、１組のＸ軸サーボ制御部９１と、Ｚ軸サーボ制御部９２と、サーボモータ９０１，９０２と、検出器９７，９８とを備える。 Of the servo control units, the X-axis servo control unit 91 controls the operation of the tool in the X-axis direction by controlling the servomotor 901, and the Z-axis servo control unit 92 controls the servomotor 902. Controls the Z-axis movement of the tool. The machine tool 100 may be provided with two or more tool rests. In this case, the drive unit 90 includes a set of X-axis servo control units 91, a Z-axis servo control unit 92, servomotors 901 and 902, and detectors 97 and 98 for each tool post.
　また、駆動部９０は、加工ワークを回転させるための主軸を回転させる主軸モータ９１１と、主軸モータ９１１の位置および回転数を検出する検出器２１１とを備えている。検出器２１１が検出する回転数は、主軸モータ９１１の回転数に対応している。 Further, the drive unit 90 includes a spindle motor 911 for rotating the spindle for rotating the workpiece, and a detector 211 for detecting the position and rotation speed of the spindle motor 911. The rotation speed detected by the detector 211 corresponds to the rotation speed of the spindle motor 911.
　また、駆動部９０は、数値制御装置１Ｘからの指令に基づいて、主軸モータ９１１を制御する主軸サーボ制御部２００を備えている。主軸サーボ制御部２００は、検出器２１１からの位置および回転数に基づいて、主軸モータ９１１へのフィードバック制御を行う。 Further, the drive unit 90 includes a spindle servo control unit 200 that controls the spindle motor 911 based on a command from the numerical control device 1X. The spindle servo control unit 200 performs feedback control to the spindle motor 911 based on the position and the rotation speed from the detector 211.
　なお、工作機械１００が２つの加工ワークを同時に加工する場合には、駆動部９０は、主軸モータ９１１と、検出器２１１と、主軸サーボ制御部２００とを２組備える。この場合、工作機械１００は、２つ以上の刃物台を備えている。 When the machine tool 100 processes two workpieces at the same time, the drive unit 90 includes two sets of a spindle motor 911, a detector 211, and a spindle servo control unit 200. In this case, the machine tool 100 includes two or more tool rests.
　入力操作部３は、制御演算部２Ｘに情報を入力する手段である。入力操作部３は、キーボード、ボタンまたはマウスなどの入力手段によって構成され、ユーザによる数値制御装置１Ｘに対するコマンドなどの入力、またはＮＣプログラムもしくはパラメータなどを受付けて制御演算部２Ｘに入力する。表示部４は、液晶表示装置などの表示手段によって構成され、制御演算部２Ｘによって処理された情報を表示画面に表示する。表示部４の例は、液晶タッチパネルである。この場合、入力操作部３の一部の機能が、表示部４に配置されている。 The input operation unit 3 is a means for inputting information to the control calculation unit 2X. The input operation unit 3 is composed of input means such as a keyboard, a button, or a mouse, and receives an input of a command or the like to the numerical control device 1X by the user, an NC program, a parameter, or the like and inputs it to the control calculation unit 2X. The display unit 4 is composed of display means such as a liquid crystal display device, and displays the information processed by the control calculation unit 2X on the display screen. An example of the display unit 4 is a liquid crystal touch panel. In this case, some functions of the input operation unit 3 are arranged in the display unit 4.
　制御演算部２Ｘは、工作機械１００の座標系で規定されたＮＣプログラムを用いて工作機械１００およびロボット６０を制御する。制御演算部２Ｘは、入力制御部３２と、データ設定部３３と、記憶部３４と、画面処理部３１と、解析処理部３７と、制御信号処理部３５と、ＰＬＣ３６と、補間処理部３８と、加減速処理部３９と、軸データ出力部４０と、ロボット制御部４１と、シミュレーション制御部８０Ｘとを有する。なお、ＰＬＣ３６は、制御演算部２Ｘの外部に配置されてもよい。 The control calculation unit 2X controls the machine tool 100 and the robot 60 by using the NC program defined by the coordinate system of the machine tool 100. The control calculation unit 2X includes an input control unit 32, a data setting unit 33, a storage unit 34, a screen processing unit 31, an analysis processing unit 37, a control signal processing unit 35, a PLC 36, and an interpolation processing unit 38. It has an acceleration / deceleration processing unit 39, an axis data output unit 40, a robot control unit 41, and a simulation control unit 80X. The PLC 36 may be arranged outside the control calculation unit 2X.
　記憶部３４は、パラメータ記憶エリア３４１、ＮＣプログラム記憶エリア３４３、表示データ記憶エリア３４４、および共有エリア３４５を有している。また、記憶部３４は、シミュレーション用データ３４６を記憶する記憶エリアを有している。 The storage unit 34 has a parameter storage area 341, an NC program storage area 343, a display data storage area 344, and a shared area 345. In addition, the storage unit 34 has a storage area for storing simulation data 346.
　パラメータ記憶エリア３４１内には、制御演算部２Ｘの処理で使用されるパラメータ等が格納される。具体的には、パラメータ記憶エリア３４１内には、数値制御装置１Ｘを動作させるための制御パラメータ、サーボパラメータおよび工具データ８１３，８１４が格納される。工具データ８１３は、工作機械１００で用いられる工具のデータであり、工具データ８１４は、ロボット６０で用いられる工具のデータである。工具データ８１３は、工作機械１００で用いられる工具の形状の情報を含んでいる。工具データ８１４は、ロボット６０で用いられる工具の形状の情報を含んでいる。工具データ８１３，８１４は、シミュレーション制御部８０Ｘによって記憶部３４内から読み出される。なお、以下の説明では、形状の情報には、形そのものの情報と、寸法の情報とが含まれているものとする。 The parameter storage area 341 stores parameters and the like used in the processing of the control calculation unit 2X. Specifically, the parameter storage area 341 stores control parameters, servo parameters, and tool data 815,814 for operating the numerical control device 1X. The tool data 813 is the data of the tool used in the machine tool 100, and the tool data 814 is the data of the tool used in the robot 60. The tool data 813 includes information on the shape of the tool used in the machine tool 100. The tool data 814 includes information on the shape of the tool used in the robot 60. The tool data 815 and 814 are read out from the storage unit 34 by the simulation control unit 80X. In the following description, it is assumed that the shape information includes information on the shape itself and information on dimensions.
　ＮＣプログラム記憶エリア３４３内には、加工ワークの加工に用いられるＮＣプログラムが格納される。実施の形態１のＮＣプログラムは、工作機械１００を制御するための指令と、ロボット６０を制御するための指令とを含んでいる。 The NC program used for machining the machining work is stored in the NC program storage area 343. The NC program of the first embodiment includes a command for controlling the machine tool 100 and a command for controlling the robot 60.
　表示データ記憶エリア３４４内には、表示部４で表示される画面表示データが格納される。画面表示データは、表示部４に情報を表示するためのデータである。また、記憶部３４には、一時的に使用されるデータを記憶する共有エリア３４５が設けられている。 The screen display data displayed by the display unit 4 is stored in the display data storage area 344. The screen display data is data for displaying information on the display unit 4. Further, the storage unit 34 is provided with a shared area 345 for storing data that is temporarily used.
　シミュレーション用データ３４６は、工作機械１００を描画することができるデータである機械モデル８１１と、ロボット６０を描画することができるデータであるロボットモデル８１２とを含んでいる。機械モデル８１１およびロボットモデル８１２は、シミュレーション制御部８０Ｘによって記憶部３４内から読み出される。機械モデル８１１は、工作機械１００の３次元構造を示す３次元データであり、ロボットモデル８１２は、ロボット６０の３次元構造を示す３次元データである。 The simulation data 346 includes a machine model 811 which is data capable of drawing the machine tool 100 and a robot model 812 which is data capable of drawing the robot 60. The mechanical model 811 and the robot model 812 are read out from the storage unit 34 by the simulation control unit 80X. The machine model 811 is three-dimensional data showing the three-dimensional structure of the machine tool 100, and the robot model 812 is three-dimensional data showing the three-dimensional structure of the robot 60.
　機械モデル８１１は、実際に工作機械１００が具備する加工室（加工槽）内の動作シミュレーション用のデータである。機械モデル８１１は、ＣＡＤ（Computer　Aided　Design））データから生成される。ロボットモデル８１２は、ロボット６０の動作シミュレーション用データである。ロボットモデル８１２は、ＣＡＤデータから生成される。機械モデル８１１は、拡張子が「.mdl」等の機械モデルデータであり、ロボットモデル８１２は、拡張子が「.mdl」等のロボットモデルデータである。 The machine model 811 is data for motion simulation in the machining chamber (machining tank) actually provided in the machine tool 100. The machine model 811 is generated from CAD (Computer Aided Design) data. The robot model 812 is data for motion simulation of the robot 60. The robot model 812 is generated from CAD data. The machine model 811 is machine model data having an extension of ".mdl" or the like, and the robot model 812 is robot model data having an extension of ".mdl" or the like.
　画面処理部３１は、表示データ記憶エリア３４４に格納された画面表示データを表示部４に表示させる制御を行う。入力制御部３２は、入力操作部３から入力される情報を受付ける。データ設定部３３は、入力制御部３２で受付けられた情報を記憶部３４に記憶させる。すなわち、入力操作部３が受付けた入力情報は、入力制御部３２およびデータ設定部３３を介して記憶部３４に書き込まれる。 The screen processing unit 31 controls the display unit 4 to display the screen display data stored in the display data storage area 344. The input control unit 32 receives the information input from the input operation unit 3. The data setting unit 33 stores the information received by the input control unit 32 in the storage unit 34. That is, the input information received by the input operation unit 3 is written to the storage unit 34 via the input control unit 32 and the data setting unit 33.
　制御信号処理部３５は、ＰＬＣ３６に接続されており、ＰＬＣ３６から、工作機械１００の機械を動作させるリレーなどの信号情報を受付ける。制御信号処理部３５は、受付けた信号情報を、記憶部３４の共有エリア３４５に書き込む。これらの信号情報は、加工運転時に補間処理部３８が参照する。また、制御信号処理部３５は、解析処理部３７によって共有エリア３４５に補助指令が出力されると、この補助指令を制御信号処理部３５が共有エリア３４５から読み出してＰＬＣ３６に送る。補助指令は、数値制御軸である駆動軸を動作させる指令以外の指令である。補助指令の例は、ＭコードまたはＴコードである。 The control signal processing unit 35 is connected to the PLC 36, and receives signal information from the PLC 36, such as a relay that operates the machine of the machine tool 100. The control signal processing unit 35 writes the received signal information in the shared area 345 of the storage unit 34. These signal information is referred to by the interpolation processing unit 38 during the processing operation. Further, when the analysis processing unit 37 outputs an auxiliary command to the shared area 345, the control signal processing unit 35 reads the auxiliary command from the shared area 345 and sends it to the PLC 36. Auxiliary commands are commands other than commands that operate the drive shaft, which is a numerical control shaft. An example of an auxiliary command is an M code or a T code.
　ＰＬＣ３６は、ＰＬＣ３６が実行する機械動作が記述されたラダープログラムを格納している。ＰＬＣ３６は、補助指令であるＴコードまたはＭコードを受付けると、ラダープログラムに従って補助指令に対応する処理を工作機械１００に実行する。ＰＬＣ３６は、補助指令に対応する処理を実行した後、ＮＣプログラムの次のブロックを実行させるために、機械制御が完了したことを示す完了信号を制御信号処理部３５に送る。 The PLC 36 stores a ladder program in which the machine operation executed by the PLC 36 is described. When the PLC 36 receives the T code or the M code which is the auxiliary command, the PLC 36 executes the process corresponding to the auxiliary command on the machine tool 100 according to the ladder program. After executing the process corresponding to the auxiliary command, the PLC 36 sends a completion signal indicating that the machine control is completed to the control signal processing unit 35 in order to execute the next block of the NC program.
　制御演算部２Ｘでは、制御信号処理部３５と、解析処理部３７と、補間処理部３８と、ロボット制御部４１と、シミュレーション制御部８０Ｘとが記憶部３４を介して接続されており、記憶部３４を介して情報の書き込み、および読み出しを行う。以下の説明では、制御信号処理部３５と、解析処理部３７と、補間処理部３８と、ロボット制御部４１と、シミュレーション制御部８０Ｘとの間の情報の書き込み、および読み出しを説明する際に記憶部３４が介されていることを省略する場合がある。 In the control calculation unit 2X, the control signal processing unit 35, the analysis processing unit 37, the interpolation processing unit 38, the robot control unit 41, and the simulation control unit 80X are connected via the storage unit 34, and the storage unit Information is written and read through 34. In the following description, it is stored when writing and reading information between the control signal processing unit 35, the analysis processing unit 37, the interpolation processing unit 38, the robot control unit 41, and the simulation control unit 80X. It may be omitted that the unit 34 is interposed.
　ＮＣプログラムの選択は、ユーザが入力操作部３でＮＣプログラム番号を入力することによって行われる。このＮＣプログラム番号は、入力制御部３２およびデータ設定部３３を介して共有エリア３４５に書き込まれる。機械操作盤等のサイクルスタートをトリガとして、解析処理部３７は、選択されたＮＣプログラム番号を共有エリア３４５から読み出すと、選択されたＮＣプログラムをＮＣプログラム記憶エリア３４３内から読み出して、ＮＣプログラムの各ブロック（各行）に対して解析処理を行う。解析処理部３７は、例えば、Ｇコード（軸移動等に関する指令）、Ｔコード（工具交換指令など）、Ｓコード（主軸モータ回転数指令）、およびＭコード（機械動作指令）を解析する。 The NC program is selected by the user inputting the NC program number in the input operation unit 3. This NC program number is written in the shared area 345 via the input control unit 32 and the data setting unit 33. Triggered by the cycle start of the machine operation panel or the like, the analysis processing unit 37 reads the selected NC program number from the shared area 345, reads the selected NC program from the NC program storage area 343, and reads the selected NC program from the NC program storage area 343. Analysis processing is performed for each block (each line). The analysis processing unit 37 analyzes, for example, a G code (command related to shaft movement, etc.), a T code (tool change command, etc.), an S code (spindle motor rotation speed command), and an M code (machine operation command).
　解析処理部３７は、解析した行にＭコードまたはＴコードが含まれている場合には、解析結果を共有エリア３４５および制御信号処理部３５を介してＰＬＣ３６に送る。また、解析処理部３７は、解析した行にＭコードが含まれている場合には、Ｍコードを、制御信号処理部３５を介してＰＬＣ３６に送る。ＰＬＣ３６はＭコードに対応する機械制御を実行する。実行が完了した場合、制御信号処理部３５を介してＭコードの完了を示す結果が記憶部３４に書き込まれる。補間処理部３８は記憶部３４に書き込まれた実行結果を参照する。 When the analyzed line contains an M code or a T code, the analysis processing unit 37 sends the analysis result to the PLC 36 via the shared area 345 and the control signal processing unit 35. If the analyzed line contains an M code, the analysis processing unit 37 sends the M code to the PLC 36 via the control signal processing unit 35. The PLC 36 executes the machine control corresponding to the M code. When the execution is completed, the result indicating the completion of the M code is written in the storage unit 34 via the control signal processing unit 35. The interpolation processing unit 38 refers to the execution result written in the storage unit 34.
　また、解析処理部３７は、工作機械１００へのＧコードが含まれている場合には、共有エリア３４５を介して解析結果を補間処理部３８に送る。具体的には、解析処理部３７は、Ｇコードに対応する移動条件を生成して補間処理部３８に送る。また、解析処理部３７は、Ｓコードで指定された主軸回転数を補間処理部３８に送る。主軸回転数は、単位時間あたりの主軸の回転の回数である。移動条件は、加工位置を移動させていくための工具送りの条件であり、刃物台を移動させる速度、刃物台を移動させる位置などで示される。例えば、工具の工具送りは、工具をＸ軸方向（＋Ｘ方向）およびＺ軸方向（＋Ｚ方向）に進ませる。 Further, when the G code for the machine tool 100 is included, the analysis processing unit 37 sends the analysis result to the interpolation processing unit 38 via the shared area 345. Specifically, the analysis processing unit 37 generates a movement condition corresponding to the G code and sends it to the interpolation processing unit 38. Further, the analysis processing unit 37 sends the spindle rotation speed specified by the S code to the interpolation processing unit 38. The spindle speed is the number of revolutions of the spindle per unit time. The movement condition is a tool feed condition for moving the machining position, and is indicated by the speed at which the tool post is moved, the position at which the tool post is moved, and the like. For example, tool feed of a tool advances the tool in the X-axis direction (+ X direction) and the Z-axis direction (+ Z direction).
　また、解析処理部３７は、ロボット指令解析部３７１を有している。ロボット指令解析部３７１は、接続されたロボット６０の動作を解析する手段である。ロボット指令解析部３７１は、ＮＣプログラムに含まれるロボット指令を解析し、解析結果を、共有エリア３４５を介してロボット制御部４１に送る。 Further, the analysis processing unit 37 has a robot command analysis unit 371. The robot command analysis unit 371 is a means for analyzing the operation of the connected robot 60. The robot command analysis unit 371 analyzes the robot command included in the NC program and sends the analysis result to the robot control unit 41 via the shared area 345.
　解析結果には、ロボット６０の座標系を設定するための指令であるロボット座標系設定指令、ロボット６０の動作を規定したロボット動作指令などが含まれている。 The analysis result includes a robot coordinate system setting command which is a command for setting the coordinate system of the robot 60, a robot operation command which defines the operation of the robot 60, and the like.
　補間処理部３８は、解析処理部３７による解析結果のうち工作機械１００への指令を用いて工作機械１００を制御するためのデータを生成し、加減速処理部３９に送る。加減速処理部３９は、補間処理部３８から供給された補間処理の結果に対して、加速度をなめらかに変化させるための加減速処理を行う。加減速処理部３９は、加減速処理の処理結果である速度指令を軸データ出力部４０に送る。 The interpolation processing unit 38 generates data for controlling the machine tool 100 by using a command to the machine tool 100 among the analysis results by the analysis processing unit 37, and sends the data to the acceleration / deceleration processing unit 39. The acceleration / deceleration processing unit 39 performs acceleration / deceleration processing for smoothly changing the acceleration with respect to the result of the interpolation processing supplied from the interpolation processing unit 38. The acceleration / deceleration processing unit 39 sends a speed command, which is a processing result of the acceleration / deceleration processing, to the axis data output unit 40.
　軸データ出力部４０は、速度指令を駆動部９０に出力する。具体的には、軸データ出力部４０は、Ｘ軸への速度指令をＸ軸サーボ制御部９１に出力し、Ｚ軸への速度指令をＺ軸サーボ制御部９２に出力する。また、軸データ出力部４０は、主軸への回転数指令を主軸サーボ制御部２００に出力する。 The axis data output unit 40 outputs a speed command to the drive unit 90. Specifically, the axis data output unit 40 outputs a speed command to the X-axis to the X-axis servo control unit 91, and outputs a speed command to the Z-axis to the Z-axis servo control unit 92. Further, the shaft data output unit 40 outputs a rotation speed command to the spindle to the spindle servo control unit 200.
　ロボット制御部４１は、ロボット指令解析部３７１による解析の結果に基づいて、ロボット６０への指令をロボットプログラムに変換する。すなわち、ロボット制御部４１は、ロボット指令解析部３７１から送られてくる、ロボット指令の解析結果に基づいて、ロボットコントローラ５０が解釈可能なロボット指令を生成する。ロボット制御部４１は、生成したロボット指令をロボットコントローラ５０に送る。ロボットコントローラ５０は、ロボット制御部４１から送られてくるロボット指令に基づいて、ロボット６０の各軸の位置データを生成し、位置データを用いてロボット６０を制御する。 The robot control unit 41 converts a command to the robot 60 into a robot program based on the result of analysis by the robot command analysis unit 371. That is, the robot control unit 41 generates a robot command that can be interpreted by the robot controller 50 based on the analysis result of the robot command sent from the robot command analysis unit 371. The robot control unit 41 sends the generated robot command to the robot controller 50. The robot controller 50 generates position data for each axis of the robot 60 based on a robot command sent from the robot control unit 41, and controls the robot 60 using the position data.
　数値制御装置１Ｘでは、ＮＣプログラムに設定されている指令が順番に実行される。したがって、補間処理部３８が工作機械１００を制御するためのデータを生成して加減速処理部３９に送る順番、およびロボット制御部４１が位置データを生成してロボットコントローラ５０に送る順番は、それぞれＮＣプログラムに設定されている指令の順番に対応している。 In the numerical control device 1X, the commands set in the NC program are executed in order. Therefore, the order in which the interpolation processing unit 38 generates data for controlling the machine tool 100 and sends it to the acceleration / deceleration processing unit 39 and the order in which the robot control unit 41 generates position data and sends it to the robot controller 50 are different. It corresponds to the order of commands set in the NC program.
　シミュレーション制御部８０Ｘは、記憶部３４、補間処理部３８、加減速処理部３９、ロボット制御部４１、および画面処理部３１に接続されている。シミュレーション制御部８０Ｘは、画面処理部３１に接続されているが、図１では、シミュレーション制御部８０Ｘと画面処理部３１との接続線の記載を省略している。以下の説明では、シミュレーション制御部８０Ｘによる表示部４への情報の書き込みを説明する際に、画面処理部３１が介されていることを省略する場合がある。 The simulation control unit 80X is connected to a storage unit 34, an interpolation processing unit 38, an acceleration / deceleration processing unit 39, a robot control unit 41, and a screen processing unit 31. Although the simulation control unit 80X is connected to the screen processing unit 31, the description of the connection line between the simulation control unit 80X and the screen processing unit 31 is omitted in FIG. In the following description, when writing information to the display unit 4 by the simulation control unit 80X, it may be omitted that the screen processing unit 31 is used.
　シミュレーション制御部８０Ｘは、ロボット６０の動作および工作機械１００の動作を演算によってシミュレーションする。シミュレーション制御部８０Ｘは、機械動作演算部８０１と、ロボット動作演算部８０２と、干渉チェック部８０３とを備えている。 The simulation control unit 80X simulates the operation of the robot 60 and the operation of the machine tool 100 by calculation. The simulation control unit 80X includes a machine operation calculation unit 801, a robot operation calculation unit 802, and an interference check unit 803.
　機械動作演算部８０１は、工作機械１００が備える構成要素の移動を描画し、ロボット動作演算部８０２は、ロボット６０が備える構成要素の移動を描画する。シミュレーション制御部８０Ｘは、描画結果を表示部４に表示させる。 The machine motion calculation unit 801 draws the movement of the components included in the machine tool 100, and the robot motion calculation unit 802 draws the movement of the components included in the robot 60. The simulation control unit 80X causes the display unit 4 to display the drawing result.
　機械動作演算部８０１は、記憶部３４から機械モデル８１１および工具データ８１３を読み出し、機械モデル８１１および工具データ８１３を用いて工作機械１００の動作をシミュレーションする。 The machine operation calculation unit 801 reads the machine model 811 and the tool data 813 from the storage unit 34, and simulates the operation of the machine tool 100 using the machine model 811 and the tool data 813.
　また、機械動作演算部８０１は、補間処理部３８から、工作機械１００の各軸の位置データを取得する。機械動作演算部８０１は、補間処理部３８から取り込んだ位置データに基づいて、機械モデル８１１から描画される工作機械１００の構成要素の位置を修正する。 Further, the machine operation calculation unit 801 acquires the position data of each axis of the machine tool 100 from the interpolation processing unit 38. The machine operation calculation unit 801 corrects the positions of the components of the machine tool 100 drawn from the machine model 811 based on the position data fetched from the interpolation processing unit 38.
　このように、機械動作演算部８０１は、工作機械１００の動作シミュレーション用のデータである機械モデル８１１に基づいて工作機械１００が備える第１の構成要素を描画する。また、機械動作演算部８０１は、第１の構成要素の位置を制御する際に用いられる第１の位置データを用いて、第１の構成要素を再描画する。 In this way, the machine motion calculation unit 801 draws the first component included in the machine tool 100 based on the machine model 811 which is the data for the motion simulation of the machine tool 100. Further, the machine operation calculation unit 801 redraws the first component using the first position data used when controlling the position of the first component.
　ロボット動作演算部８０２は、記憶部３４からロボットモデル８１２および工具データ８１４を読み出し、ロボットモデル８１２および工具データ８１４を用いてロボット６０の動作をシミュレーションする。 The robot motion calculation unit 802 reads out the robot model 812 and the tool data 814 from the storage unit 34, and simulates the motion of the robot 60 using the robot model 812 and the tool data 814.
　また、ロボット動作演算部８０２は、ロボット制御部４１から、ロボット６０の各軸の位置データを取得する。ロボット動作演算部８０２は、ロボット制御部４１から取り込んだ位置データに基づいて、ロボットモデル８１２から描画されるロボット６０の構成要素の位置を修正する。 Further, the robot motion calculation unit 802 acquires the position data of each axis of the robot 60 from the robot control unit 41. The robot motion calculation unit 802 corrects the positions of the components of the robot 60 drawn from the robot model 812 based on the position data fetched from the robot control unit 41.
　このように、ロボット動作演算部８０２は、ロボット６０の動作シミュレーション用のデータであるロボットモデル８１２に基づいてロボット６０が備える第２の構成要素を描画し、第２の構成要素の位置を制御する際に用いられる第２の位置データを用いて第２の構成要素を再描画する。 In this way, the robot motion calculation unit 802 draws the second component included in the robot 60 based on the robot model 812, which is the data for the motion simulation of the robot 60, and controls the position of the second component. The second component is redrawn using the second position data used in the case.
　衝突判断部である干渉チェック部８０３は、機械動作演算部８０１およびロボット動作演算部８０２が描画した稼働部（構成要素）の描画データ同士の重なりをチェックする。換言すると、干渉チェック部８０３は、工作機械１００とロボット６０とが干渉（衝突）するか否かを判断する。 The collision check unit 803, which is a collision determination unit, checks the overlap of the drawing data of the operation units (components) drawn by the machine operation calculation unit 801 and the robot operation calculation unit 802. In other words, the interference check unit 803 determines whether or not the machine tool 100 and the robot 60 interfere with each other (collision).
　すなわち、干渉チェック部８０３は、特定タイミングにおける第１の構成要素の位置および特定タイミングにおける第２の構成要素の位置に基づいて、特定タイミングで工作機械１００とロボット６０とが衝突するか否かを判断する。 That is, the interference check unit 803 determines whether or not the machine tool 100 and the robot 60 collide with each other at a specific timing based on the position of the first component at the specific timing and the position of the second component at the specific timing. to decide.
　干渉チェック部８０３は、工作機械１００とロボット６０とが干渉することを検出すると、補間処理部３８およびロボット制御部４１に動作中止の信号を送るとともに、干渉に対するアラームの表示指示であるアラーム指示情報を、画面処理部３１を経由して表示部４に送る。これにより、干渉チェック部８０３は、表示部４に干渉を示す干渉アラームを表示させる。アラーム指示情報には、工作機械１００とロボット６０とが干渉する位置の情報が含まれていてもよい。この場合、表示部４は、干渉する位置の情報を含んだ干渉アラームを表示する。 When the interference check unit 803 detects that the machine tool 100 and the robot 60 interfere with each other, the interference check unit 803 sends an operation stop signal to the interpolation processing unit 38 and the robot control unit 41, and alarm instruction information which is an alarm display instruction for interference. Is sent to the display unit 4 via the screen processing unit 31. As a result, the interference check unit 803 causes the display unit 4 to display an interference alarm indicating interference. The alarm instruction information may include information on the position where the machine tool 100 and the robot 60 interfere with each other. In this case, the display unit 4 displays an interference alarm including information on the position of interference.
　工作機械１００は、ＮＣ工作機械であり、駆動軸によって工具と加工ワークとを相対的に移動させながら、工具で加工ワークを加工する。工作機械１００の座標系とロボット６０の座標系とは異なる座標系である。工作機械１００は、直交座標系で制御され、例えば３軸方向に工具または加工ワークを移動させる。ロボット６０は、回転軸を備えており、例えば、４軸以上の方向に駆動する。ロボット６０は、複数の関節と複数のアームを備えており、１つの関節が１つのアームを１軸以上の方向に移動させる。 The machine tool 100 is an NC machine tool, and the machine tool is machined with the tool while the tool and the machine tool are relatively moved by the drive shaft. The coordinate system of the machine tool 100 and the coordinate system of the robot 60 are different. The machine tool 100 is controlled by a Cartesian coordinate system and moves a tool or a workpiece in, for example, three axes. The robot 60 includes a rotation axis, and drives, for example, in directions of four or more axes. The robot 60 includes a plurality of joints and a plurality of arms, and one joint moves one arm in a direction of one axis or more.
　なお、実施の形態１は、工作機械１００を描画する際に用いられる描画用のデータが、動作シミュレーション用のデータである機械モデル８１１である場合について説明するが、機械動作演算部８０１は、機械モデル８１１以外の描画用データを用いて工作機械１００を描画してもよい。 In the first embodiment, the case where the drawing data used when drawing the machine tool 100 is the machine model 811 which is the data for motion simulation will be described, but the machine motion calculation unit 801 is a machine. The machine tool 100 may be drawn using drawing data other than the model 811.
　また、実施の形態１は、ロボット６０を描画する際に用いられる描画用のデータが、動作シミュレーション用のデータであるロボットモデル８１２である場合について説明するが、ロボット動作演算部８０２は、ロボットモデル８１２以外の描画用データを用いてロボット６０を描画してもよい。 Further, the first embodiment describes a case where the drawing data used when drawing the robot 60 is the robot model 812, which is the data for motion simulation. However, the robot motion calculation unit 802 describes the robot model. The robot 60 may be drawn using drawing data other than 812.
　機械動作演算部８０１は、例えば、ポンチ絵程度の描画を行うことができる粗い描画用データを用いて工作機械１００を描画してもよい。また、ロボット動作演算部８０２は、ポンチ絵程度の描画を行うことができる粗い描画用データを用いてロボット６０を描画してもよい。 The machine operation calculation unit 801 may draw the machine tool 100 using, for example, coarse drawing data capable of drawing a ponchi-e or the like. Further, the robot motion calculation unit 802 may draw the robot 60 using coarse drawing data capable of drawing a ponchi-e or the like.
　ただし、干渉チェック部８０３が工作機械１００とロボット６０との間の干渉チェックを行う際には、機械動作演算部８０１は、正確な動作シミュレーションができる程度に精度の高いシミュレーション用データ（例えば、機械モデル８１１）を用いる。また、干渉チェック部８０３が工作機械１００とロボット６０との間の干渉チェックを行う際には、ロボット動作演算部８０２は、正確な動作シミュレーションができる程度に精度の高いシミュレーション用データ（例えば、ロボットモデル８１２）を用いる。 However, when the interference check unit 803 performs an interference check between the machine tool 100 and the robot 60, the machine motion calculation unit 801 uses simulation data (for example, a machine) with high accuracy to the extent that accurate motion simulation can be performed. Model 811) is used. Further, when the interference check unit 803 performs an interference check between the machine tool 100 and the robot 60, the robot motion calculation unit 802 uses simulation data (for example, a robot) with high accuracy to the extent that accurate motion simulation can be performed. Model 812) is used.
　ここで、工作機械１００とロボット６０との間の干渉チェックのシミュレーションについて説明する。図２は、実施の形態１にかかる数値制御装置が制御する工作機械およびロボットの配置例を示す図である。 Here, a simulation of an interference check between the machine tool 100 and the robot 60 will be described. FIG. 2 is a diagram showing an arrangement example of a machine tool and a robot controlled by the numerical control device according to the first embodiment.
　工作機械１００は、筐体１４と、工具ホルダ１１ａ，１１ｂと、チャック機構１２ａ，１２ｂとを備えている。工作機械１００では、筐体１４の内部が加工ワーク５ａ，５ｂを加工する加工室となっている。 The machine tool 100 includes a housing 14, tool holders 11a and 11b, and chuck mechanisms 12a and 12b. In the machine tool 100, the inside of the housing 14 is a processing chamber for processing the processing workpieces 5a and 5b.
　チャック機構１２ａは、加工室内で加工ワーク５ａを保持し、チャック機構１２ｂは、加工室内で加工ワーク５ｂを保持する。工具ホルダ１１ａは、工具６ａを保持し、工具ホルダ１１ｂは、工具６ｂを保持する。工具６ａは、チャック機構１２ａによって保持されている加工ワーク５ａを加工し、工具６ｂは、チャック機構１２ｂによって保持されている加工ワーク５ｂを加工する。 The chuck mechanism 12a holds the machining work 5a in the machining chamber, and the chuck mechanism 12b holds the machining work 5b in the machining chamber. The tool holder 11a holds the tool 6a, and the tool holder 11b holds the tool 6b. The tool 6a processes the machining work 5a held by the chuck mechanism 12a, and the tool 6b processes the machining work 5b held by the chuck mechanism 12b.
　ロボット６０は、工作機械１００の近傍に配置されており、工作機械１００に対して加工ワーク５ａ，５ｂの搬入および搬出を行う。また、ロボット６０は、工作機械１００が保持している加工ワーク５ａに対し、工具６ｃで加工を行う。工作機械１００が用いる工具６ａ，６ｂが第１の工具であり、ロボット６０が用いる工具６ｃが第２の工具である。 The robot 60 is arranged in the vicinity of the machine tool 100, and carries in and out the machining workpieces 5a and 5b to the machine tool 100. Further, the robot 60 processes the machining work 5a held by the machine tool 100 with the tool 6c. The tools 6a and 6b used by the machine tool 100 are the first tools, and the tools 6c used by the robot 60 are the second tools.
　ロボット６０は、ロボットアーム２１と、ロボットハンド２２と、台座２３とを備えている。台座２３は、ロボットアーム２１を保持する。ロボットアーム２１は、１または複数の軸方向に移動可能となっている。ロボットハンド２２は、台座２３とは反対側の、ロボットアーム２１の先端部に配置されている。ロボットハンド２２は、工具６ｃを掴む。 The robot 60 includes a robot arm 21, a robot hand 22, and a pedestal 23. The pedestal 23 holds the robot arm 21. The robot arm 21 is movable in one or more axial directions. The robot hand 22 is arranged at the tip of the robot arm 21 on the opposite side of the pedestal 23. The robot hand 22 grabs the tool 6c.
　機械モデル８１１は、加工室内におけるチャック機構１２ａ，１２ｂ、加工ワーク５ａ，５ｂ、工具ホルダ１１ａ，１１ｂ、および工具６ａ，６ｂの動作シミュレーション用のデータである。 The machine model 811 is data for motion simulation of the chuck mechanisms 12a and 12b, the machining workpieces 5a and 5b, the tool holders 11a and 11b, and the tools 6a and 6b in the machining chamber.
　工作機械１００の動作がシミュレーションされる際には、工作機械１００の全体構成と、工作機械１００の加工室内の動作がシミュレーションされ、工作機械１００の加工室内の状態が描画される。加工室内に対しては、チャック機構１２ａ，１２ｂ、加工ワーク５ａ，５ｂ、工具ホルダ１１ａ，１１ｂ、および工具６ａ，６ｂの動作がシミュレーションされ、チャック機構１２ａ，１２ｂ、加工ワーク５ａ，５ｂ、工具ホルダ１１ａ，１１ｂ、および工具６ａ，６ｂが描画される。 When the operation of the machine tool 100 is simulated, the overall configuration of the machine tool 100 and the operation of the machine tool 100 in the machining chamber are simulated, and the state of the machine tool 100 in the machining chamber is drawn. The operations of the chuck mechanisms 12a and 12b, the machining workpieces 5a and 5b, the tool holders 11a and 11b, and the tools 6a and 6b are simulated in the machining chamber, and the chuck mechanisms 12a and 12b, the machining workpieces 5a and 5b and the tool holder are simulated. 11a, 11b, and tools 6a, 6b are drawn.
　ロボットモデル８１２は、ロボットアーム２１およびロボットハンド２２の動作シミュレーション用のデータである。ロボット６０の動作がシミュレーションされる際には、ロボットアーム２１およびロボットハンド２２の動作がシミュレーションされ、ロボットアーム２１およびロボットハンド２２の状態が描画される。 The robot model 812 is data for motion simulation of the robot arm 21 and the robot hand 22. When the movement of the robot 60 is simulated, the movements of the robot arm 21 and the robot hand 22 are simulated, and the states of the robot arm 21 and the robot hand 22 are drawn.
　図３は、実施の形態１にかかる数値制御装置が描画した画面の第１例を示す図である。図３では、表示部４における画面表示の例を示している。図３に示す画面１３０では、加工室内の状態を表示している。 FIG. 3 is a diagram showing a first example of a screen drawn by the numerical control device according to the first embodiment. FIG. 3 shows an example of screen display in the display unit 4. The screen 130 shown in FIG. 3 displays the state of the processing chamber.
　図３および後述する図４では、チャック機構１２ａ，１２ｂの画像を画像１２Ａ，１２Ｂとして図示し、加工ワーク５ａ，５ｂの画像を画像５Ａ，５Ｂとして図示し、工具ホルダ１１ａ，１１ｂの画像を画像１１Ａ，１１Ｂとして図示し、工具６ａ，６ｂの画像を画像６Ａ，６Ｂとして図示している。また、図３では、ロボットアーム２１の画像を画像２１Ａとして図示し、ロボットハンド２２の画像を画像２２Ａとして図示し、工具６ｃの画像を画像６Ｃとして図示している。 In FIG. 3 and FIG. 4 described later, the images of the chuck mechanisms 12a and 12b are shown as images 12A and 12B, the images of the machining workpieces 5a and 5b are shown as images 5A and 5B, and the images of the tool holders 11a and 11b are shown. The images of the tools 6a and 6b are shown as images 6A and 6B. Further, in FIG. 3, the image of the robot arm 21 is shown as the image 21A, the image of the robot hand 22 is shown as the image 22A, and the image of the tool 6c is shown as the image 6C.
　機械動作演算部８０１は、補間処理部３８から、工作機械１００の各軸の位置データを取り込む。機械動作演算部８０１は、補間処理部３８から取り込んだ位置データに基づいて、工作機械１００が備える稼働部（工作機械１００が備える構成要素）を描画し直す。すなわち、機械動作演算部８０１は、補間処理部３８から取り込んだ位置データに基づいて、機械モデル８１１から描画される工作機械１００の構成要素の位置を修正する。工作機械１００が備える稼働部は、前述したチャック機構１２ａ，１２ｂ、加工ワーク５ａ，５ｂ、工具ホルダ１１ａ，１１ｂ、および工具６ａ，６ｂである。機械動作演算部８０１は、例えば、工具ホルダ１１ａ，１１ｂの移動、および工具６ａ，６ｂの移動を描画する。 The machine operation calculation unit 801 captures the position data of each axis of the machine tool 100 from the interpolation processing unit 38. The machine operation calculation unit 801 redraws the operating unit (components included in the machine tool 100) included in the machine tool 100 based on the position data fetched from the interpolation processing unit 38. That is, the machine operation calculation unit 801 corrects the positions of the components of the machine tool 100 drawn from the machine model 811 based on the position data fetched from the interpolation processing unit 38. The moving parts included in the machine tool 100 are the chuck mechanisms 12a and 12b, the machining workpieces 5a and 5b, the tool holders 11a and 11b, and the tools 6a and 6b described above. The machine operation calculation unit 801 draws, for example, the movement of the tool holders 11a and 11b and the movement of the tools 6a and 6b.
　ロボット動作演算部８０２は、ロボット制御部４１から、ロボット６０の各軸の位置データを取り込む。ロボット動作演算部８０２は、ロボット制御部４１から取り込んだ位置データに基づいて、ロボット６０が備える稼働部（ロボット６０が備える構成要素）を描画し直す。すなわち、ロボット動作演算部８０２は、ロボット制御部４１から取り込んだ位置データに基づいて、ロボットモデル８１２から描画されるロボット６０の構成要素の位置を修正する。ロボット６０が備える稼働部は、前述したロボットアーム２１、ロボットハンド２２、および工具６ｃである。ロボット動作演算部８０２は、例えば、ロボットアーム２１の移動、および工具６ｃを掴んでいるロボットハンド２２の移動を描画する。 The robot motion calculation unit 802 captures position data of each axis of the robot 60 from the robot control unit 41. The robot motion calculation unit 802 redraws the moving unit (components included in the robot 60) included in the robot 60 based on the position data fetched from the robot control unit 41. That is, the robot motion calculation unit 802 corrects the positions of the components of the robot 60 drawn from the robot model 812 based on the position data fetched from the robot control unit 41. The moving unit included in the robot 60 is the robot arm 21, the robot hand 22, and the tool 6c described above. The robot motion calculation unit 802 draws, for example, the movement of the robot arm 21 and the movement of the robot hand 22 holding the tool 6c.
　シミュレーション制御部８０Ｘは、機械動作演算部８０１による描画結果、およびロボット動作演算部８０２による描画結果を、画面処理部３１を経由して表示部４に表示させる。表示部４によって表示される画面の例が、図３に示す画面１３０である。 The simulation control unit 80X causes the display unit 4 to display the drawing result by the machine operation calculation unit 801 and the drawing result by the robot operation calculation unit 802 via the screen processing unit 31. An example of the screen displayed by the display unit 4 is the screen 130 shown in FIG.
　干渉チェック部８０３は、機械動作演算部８０１およびロボット動作演算部８０２が描画した稼働部の描画データ同士の重なりをチェックする。具体的には、干渉チェック部８０３は、工作機械１００の工具ホルダ１１ａ，１１ｂまたは工具６ａ，６ｂと、ロボットアーム２１または工具６ｃを掴んだロボットハンド２２と、が干渉するか否かを判断する。機械モデル８１１およびロボットモデル８１２は、３次元データであるので、干渉チェック部８０３は、工作機械１００の３次元形状およびロボット６０の３次元形状に対して干渉をチェックする。 The interference check unit 803 checks the overlap between the drawing data of the operation unit drawn by the machine operation calculation unit 801 and the robot operation calculation unit 802. Specifically, the interference check unit 803 determines whether or not the tool holders 11a, 11b or tools 6a, 6b of the machine tool 100 interfere with the robot hand 22 that holds the robot arm 21 or the tool 6c. .. Since the machine model 811 and the robot model 812 are three-dimensional data, the interference check unit 803 checks for interference with the three-dimensional shape of the machine tool 100 and the three-dimensional shape of the robot 60.
　図４は、実施の形態１にかかる数値制御装置が描画した画面の第２例を示す図である。図４では、衝突が検知された場合の、表示部４における画面表示の例を示している。図４に示す画面１３１では、干渉チェック部８０３が、矢印Ｄ１の方向にロボットハンド２２の画像２２Ａが移動した際に、加工室内で構成要素同士の干渉を検知した場合の加工室内の状態を表示している。 FIG. 4 is a diagram showing a second example of the screen drawn by the numerical control device according to the first embodiment. FIG. 4 shows an example of screen display on the display unit 4 when a collision is detected. On the screen 131 shown in FIG. 4, when the interference check unit 803 detects the interference between the components in the processing chamber when the image 22A of the robot hand 22 moves in the direction of the arrow D1, the state in the processing chamber is displayed. doing.
　干渉チェック部８０３は、図４に示すように、工具６ｂの画像６Ｂと、ロボットハンド２２の画像２２Ａとが衝突によって重なっていること検出すると、補間処理部３８およびロボット制御部４１に動作中止の信号を送るとともに、画面処理部３１を経由して表示部４に干渉アラームを表示させる。表示部４によって表示される干渉アラーム画面は、衝突をユーザに気付かせるような画面であれば、何れの画面であってもよい。干渉アラームの表示は、他のアラームと同様の画面によって表示される。画面１３１では、ロボット６０と工作機械１００とが衝突する位置が示される。 As shown in FIG. 4, when the interference check unit 803 detects that the image 6B of the tool 6b and the image 22A of the robot hand 22 overlap due to a collision, the interpolation processing unit 38 and the robot control unit 41 stop operating. Along with sending a signal, the display unit 4 displays an interference alarm via the screen processing unit 31. The interference alarm screen displayed by the display unit 4 may be any screen as long as it is a screen that makes the user aware of the collision. The display of the interference alarm is displayed by the same screen as other alarms. The screen 131 shows the position where the robot 60 and the machine tool 100 collide.
　補間処理部３８およびロボット制御部４１は、干渉チェック部８０３から動作中止の信号を受け取ると、演算を停止する。ここで、干渉チェック部８０３は、制御演算部２Ｘの先読み処理での演算結果で干渉の有無を判断している。このため、シミュレーション制御部８０Ｘは、実際に工作機械１００とロボット６０とが干渉（衝突）する前に、工作機械１００およびロボット６０の稼働部の動作を停止することができる。 When the interpolation processing unit 38 and the robot control unit 41 receive the operation stop signal from the interference check unit 803, the calculation is stopped. Here, the interference check unit 803 determines the presence or absence of interference based on the calculation result in the look-ahead processing of the control calculation unit 2X. Therefore, the simulation control unit 80X can stop the operation of the moving parts of the machine tool 100 and the robot 60 before the machine tool 100 and the robot 60 actually interfere with each other (collision).
　また、工作機械１００の座標系とロボット６０の座標系とは異なっているが、記憶部３４には工作機械１００の座標系とロボット６０の座標系との位置関係を定義するパラメータが格納されている。したがって、干渉チェック部８０３は、記憶部３４が格納している位置関係に基づいて、工作機械１００の稼働部とロボット６０の稼働部との干渉をチェックすることができる。 Further, although the coordinate system of the machine tool 100 and the coordinate system of the robot 60 are different, the storage unit 34 stores parameters that define the positional relationship between the coordinate system of the machine tool 100 and the coordinate system of the robot 60. There is. Therefore, the interference check unit 803 can check the interference between the operating unit of the machine tool 100 and the operating unit of the robot 60 based on the positional relationship stored in the storage unit 34.
　なお、動作シミュレーション用のデータである機械モデル８１１およびロボットモデル８１２は、稼働しない部分を含んでいてもよい。例えば、機械モデル８１１は、工作機械１００の筐体１４を含んでいてもよい。また、ロボットモデル８１２は、台座２３を含んでいてもよい。この場合、ロボットモデル８１２には、ロボットアーム２１、ロボットハンド２２、工具６ｃ、および台座２３が含まれている。 Note that the machine model 811 and the robot model 812, which are data for motion simulation, may include parts that do not operate. For example, the machine model 811 may include a housing 14 of the machine tool 100. Further, the robot model 812 may include a pedestal 23. In this case, the robot model 812 includes a robot arm 21, a robot hand 22, a tool 6c, and a pedestal 23.
　機械モデル８１１が工作機械１００の全体構成を含む場合、表示部４は、工作機械１００の全体を表示する。また、ロボットモデル８１２がロボット６０の全体構成を含む場合、表示部４は、ロボット６０の全体を表示する。 When the machine model 811 includes the entire configuration of the machine tool 100, the display unit 4 displays the entire machine tool 100. When the robot model 812 includes the entire configuration of the robot 60, the display unit 4 displays the entire robot 60.
　図５は、実施の形態１にかかる数値制御装置が描画した画面の第３例を示す図である。図５では、表示部４における画面表示の例を示している。図５に示す画面１３２は、表示部４が、工作機械１００の全体およびロボット６０の全体を表示した場合の画面である。 FIG. 5 is a diagram showing a third example of a screen drawn by the numerical control device according to the first embodiment. FIG. 5 shows an example of screen display in the display unit 4. The screen 132 shown in FIG. 5 is a screen when the display unit 4 displays the entire machine tool 100 and the entire robot 60.
　図５では、工作機械１００の画像を画像１００Ａとして図示し、筐体１４の画像を画像１４Ａとして図示し、ロボット６０の画像を画像６０Ａとして図示し、台座２３の画像を画像２３Ａとして図示している。機械モデル８１１が工作機械１００の全体構成を含む場合、干渉チェック部８０３は、ロボットハンド２２が工作機械１００の筐体１４に干渉することを検出できる。 In FIG. 5, the image of the machine tool 100 is shown as the image 100A, the image of the housing 14 is shown as the image 14A, the image of the robot 60 is shown as the image 60A, and the image of the pedestal 23 is shown as the image 23A. There is. When the machine model 811 includes the entire configuration of the machine tool 100, the interference check unit 803 can detect that the robot hand 22 interferes with the housing 14 of the machine tool 100.
　図６は、実施の形態１にかかる数値制御装置が検出する、ロボットハンドと工作機械の筐体との干渉を説明するための図である。ここでは、機械モデル８１１が工作機械１００の全体を含む場合に干渉チェック部８０３が検出する干渉の第１例について説明する。図６では、矢印Ｄ２の方向にロボットハンド２２が移動した際に、ロボットハンド２２と工作機械１００の筐体１４とが干渉した状態を示している。 FIG. 6 is a diagram for explaining the interference between the robot hand and the housing of the machine tool detected by the numerical control device according to the first embodiment. Here, a first example of interference detected by the interference check unit 803 when the machine model 811 includes the entire machine tool 100 will be described. FIG. 6 shows a state in which the robot hand 22 and the housing 14 of the machine tool 100 interfere with each other when the robot hand 22 moves in the direction of the arrow D2.
　また、機械モデル８１１が工作機械１００の全体を含む場合、干渉チェック部８０３は、ロボットアーム２１が工作機械１００の外部に配置された機構に干渉することを検出できる。 Further, when the machine model 811 includes the entire machine tool 100, the interference check unit 803 can detect that the robot arm 21 interferes with a mechanism arranged outside the machine tool 100.
　図７は、実施の形態１にかかる数値制御装置が検出する、ロボットアームと工作機械の外部に配置された機構との干渉を説明するための図である。ここでは、機械モデル８１１が工作機械１００の全体を含む場合に干渉チェック部８０３が検出する干渉の第２例について説明する。 FIG. 7 is a diagram for explaining the interference between the robot arm and the mechanism arranged outside the machine tool, which is detected by the numerical control device according to the first embodiment. Here, a second example of interference detected by the interference check unit 803 when the machine model 811 includes the entire machine tool 100 will be described.
　ローダ３０は、工作機械１００の外部で搬送物７を搬送する装置である。ロボットハンド２２およびロボットアーム２１は、工作機械１００の外部でも動作するので、ロボットハンド２２およびロボットアーム２１は、ローダ３０または搬送物７に衝突する場合がある。図７では、矢印Ｄ３の方向に工具６ｃが移動した際に、ロボットアーム２１とローダ３０とが干渉した状態を示している。 The loader 30 is a device that conveys the conveyed object 7 outside the machine tool 100. Since the robot hand 22 and the robot arm 21 also operate outside the machine tool 100, the robot hand 22 and the robot arm 21 may collide with the loader 30 or the conveyed object 7. FIG. 7 shows a state in which the robot arm 21 and the loader 30 interfere with each other when the tool 6c moves in the direction of the arrow D3.
　つぎに、数値制御装置１Ｘによる干渉チェックの処理手順について説明する。図８は、実施の形態１にかかる数値制御装置による干渉チェックの処理手順を示すフローチャートである。 Next, the processing procedure of the interference check by the numerical control device 1X will be described. FIG. 8 is a flowchart showing a processing procedure of interference check by the numerical control device according to the first embodiment.
　解析処理部３７は、ＮＣプログラムを解析する（ステップＳ１０）。すなわち、解析処理部３７は、工作機械１００を動作させる指令（駆動部９０への指令）およびロボット６０を動作させる指令（ロボット６０への指令）を含んだＮＣプログラムを解析する。具体的には、解析処理部３７は、工作機械１００の駆動部９０への指令である機械駆動指令を解析し、ロボット指令解析部３７１は、ロボット６０への指令であるロボット指令を解析する。 The analysis processing unit 37 analyzes the NC program (step S10). That is, the analysis processing unit 37 analyzes the NC program including the command for operating the machine tool 100 (command to the drive unit 90) and the command for operating the robot 60 (command to the robot 60). Specifically, the analysis processing unit 37 analyzes the machine drive command which is a command to the drive unit 90 of the machine tool 100, and the robot command analysis unit 371 analyzes the robot command which is a command to the robot 60.
　解析処理部３７は、解析した指令が機械駆動指令であるかロボット指令であるかを判断する。解析した指令が機械駆動指令である場合（ステップＳ１５、Ｙｅｓ）、解析処理部３７は、機械駆動指令の解析結果を補間処理部３８に送る。一方、解析した指令がロボット指令である場合（ステップＳ１５、Ｎｏ）、解析処理部３７は、ロボット指令の解析結果をロボット制御部４１に送る。 The analysis processing unit 37 determines whether the analyzed command is a machine drive command or a robot command. When the analyzed command is a machine drive command (step S15, Yes), the analysis processing unit 37 sends the analysis result of the machine drive command to the interpolation processing unit 38. On the other hand, when the analyzed command is a robot command (step S15, No), the analysis processing unit 37 sends the analysis result of the robot command to the robot control unit 41.
　補間処理部３８は、機械駆動指令の解析結果を用いて、機械駆動指令の補間処理を行う（ステップＳ２０）。そして、補間処理部３８は、補間処理した機械駆動指令に基づいて、工作機械１００の動作である工作機械動作の演算処理を実行する（ステップＳ３０）。すなわち、補間処理部３８は、補間処理した機械駆動指令から、工作機械１００が備える駆動部９０の各軸位置を計算する。 The interpolation processing unit 38 performs interpolation processing of the machine drive command using the analysis result of the machine drive command (step S20). Then, the interpolation processing unit 38 executes arithmetic processing of the machine tool operation, which is the operation of the machine tool 100, based on the machine drive command that has been interpolated (step S30). That is, the interpolation processing unit 38 calculates each axis position of the drive unit 90 included in the machine tool 100 from the machine drive command that has been interpolated.
　ロボット制御部４１は、ロボット指令の解析結果を用いて、ＮＣプログラムをロボットプログラムに変換する（ステップＳ４０）。また、ロボット制御部４１は、ロボットプログラムに基づいて、ロボット６０の動作であるロボット動作の演算処理を実行する（ステップＳ５０）。すなわち、ロボット制御部４１は、ロボットプログラムからロボット６０の各軸位置を計算する。具体的には、ロボット制御部４１は、ロボットアーム２１の位置、ロボットハンド２２の位置などの計算を行う。 The robot control unit 41 converts the NC program into a robot program using the analysis result of the robot command (step S40). Further, the robot control unit 41 executes arithmetic processing of the robot operation, which is the operation of the robot 60, based on the robot program (step S50). That is, the robot control unit 41 calculates each axis position of the robot 60 from the robot program. Specifically, the robot control unit 41 calculates the position of the robot arm 21, the position of the robot hand 22, and the like.
　補間処理部３８で計算された駆動部９０の各軸位置を示す位置データは、機械動作演算部８０１に送られる。また、ロボット制御部４１で計算されたロボット６０の各軸位置を示す位置データは、ロボット動作演算部８０２に送られる。 The position data indicating each axis position of the drive unit 90 calculated by the interpolation processing unit 38 is sent to the machine operation calculation unit 801. Further, the position data indicating each axis position of the robot 60 calculated by the robot control unit 41 is sent to the robot motion calculation unit 802.
　シミュレーション制御部８０Ｘは、描画処理を実行する（ステップＳ６０）。具体的には、機械動作演算部８０１は、機械モデル８１１に基づいて工作機械１００の機械構成を描画し、工具データ８１３に基づいて工作機械１００が用いる工具６ａ，６ｂを描画する。また、ロボット動作演算部８０２は、ロボットモデル８１２に基づいて、ロボット６０を描画し、工具データ８１４に基づいてロボット６０が用いる工具６ｃを描画する。 The simulation control unit 80X executes the drawing process (step S60). Specifically, the machine motion calculation unit 801 draws the machine configuration of the machine tool 100 based on the machine model 811 and draws the tools 6a and 6b used by the machine tool 100 based on the tool data 813. Further, the robot motion calculation unit 802 draws the robot 60 based on the robot model 812, and draws the tool 6c used by the robot 60 based on the tool data 814.
　また、機械動作演算部８０１は、補間処理部３８から、駆動部９０の各軸位置を示す位置データを取り込む。機械動作演算部８０１は、取り込んだ位置データに基づいて、工作機械１００が備える機構の稼働部を描画し直す。機械動作演算部８０１は、例えば、工作機械１００の工具ホルダ１１ａ，１１ｂの移動、および工具６ａ，６ｂの移動を描画する。 Further, the machine operation calculation unit 801 captures position data indicating each axis position of the drive unit 90 from the interpolation processing unit 38. The machine operation calculation unit 801 redraws the operation unit of the mechanism included in the machine tool 100 based on the captured position data. The machine operation calculation unit 801 draws, for example, the movement of the tool holders 11a and 11b of the machine tool 100 and the movement of the tools 6a and 6b.
　また、ロボット動作演算部８０２は、ロボット制御部４１から、ロボット６０の各軸位置を示す位置データを取り込む。ロボット動作演算部８０２は、取り込んだ位置データに基づいて、ロボット６０が備える機構の稼働部を描画し直す。ロボット動作演算部８０２は、例えば、ロボットアーム２１の移動、および工具６ｃを含むロボットハンド２２の移動を描画する。 Further, the robot motion calculation unit 802 acquires position data indicating each axis position of the robot 60 from the robot control unit 41. The robot motion calculation unit 802 redraws the moving unit of the mechanism included in the robot 60 based on the captured position data. The robot motion calculation unit 802 draws, for example, the movement of the robot arm 21 and the movement of the robot hand 22 including the tool 6c.
　機械動作演算部８０１およびロボット動作演算部８０２による描画結果（描画データ）は、シミュレーション制御部８０Ｘが画面処理部３１を経由して表示部４に表示させる。 The simulation control unit 80X displays the drawing result (drawing data) by the machine operation calculation unit 801 and the robot operation calculation unit 802 on the display unit 4 via the screen processing unit 31.
　干渉チェック部８０３は、ロボット６０と工作機械１００との間の干渉チェック処理を実行する（ステップＳ７０）。すなわち、干渉チェック部８０３は、機械動作演算部８０１で描画された稼働部の描画データと、ロボット動作演算部８０２で描画された稼働部の描画データとの重なりをチェックする。具体的には、干渉チェック部８０３は、工作機械１００の各軸位置と、ロボット６０の各軸位置とに基づいて、以下の（１）から（４）に示す構成要素間で干渉が発生するか否かを判断する。
（１）機械モデル８１１に基づく工作機械１００の機械構成
（２）工具データ８１３に基づく工具６ａ，６ｂ
（３）ロボットモデル８１２に基づくロボット６０の構成
（４）工具データ８１４に基づく工具６ｃ The interference check unit 803 executes an interference check process between the robot 60 and the machine tool 100 (step S70). That is, the interference check unit 803 checks the overlap between the drawing data of the moving unit drawn by the machine operation calculation unit 801 and the drawing data of the moving unit drawn by the robot operation calculation unit 802. Specifically, the interference check unit 803 causes interference between the components shown in the following (1) to (4) based on each axis position of the machine tool 100 and each axis position of the robot 60. Judge whether or not.
(1) Machine configuration of machine tool 100 based on machine model 811 (2) Tools 6a, 6b based on tool data 813
(3) Configuration of robot 60 based on robot model 812 (4) Tool 6c based on tool data 814
　干渉チェック部８０３は、例えば、工作機械１００の工具ホルダ１１ａ，１１ｂまたは工具６ａ，６ｂと、ロボット６０のロボットアーム２１、ロボットハンド２２、または工具６ｃとの間に干渉が発生するか否かをチェックする（ステップＳ８０）。 The interference check unit 803 determines whether or not interference occurs between, for example, the tool holders 11a, 11b or tools 6a, 6b of the machine tool 100 and the robot arm 21, the robot hand 22, or the tool 6c of the robot 60. Check (step S80).
　干渉が発生している場合（ステップＳ８０、Ｙｅｓ）、干渉チェック部８０３は、アラーム処理を実行する（ステップＳ９０）。すなわち、干渉チェック部８０３は、補間処理部３８およびロボット制御部４１に、動作中止の信号を送ると同時に、画面処理部３１を経由して表示部４に干渉アラームを表示させる。補間処理部３８およびロボット制御部４１は、干渉チェック部８０３から動作中止の信号を受け取ると、演算処理を停止する。 When interference has occurred (step S80, Yes), the interference check unit 803 executes alarm processing (step S90). That is, the interference check unit 803 sends an operation stop signal to the interpolation processing unit 38 and the robot control unit 41, and at the same time, causes the display unit 4 to display an interference alarm via the screen processing unit 31. When the interpolation processing unit 38 and the robot control unit 41 receive the operation stop signal from the interference check unit 803, the calculation processing is stopped.
　干渉が発生していない場合（ステップＳ８０、Ｎｏ）、シミュレーション制御部８０Ｘは、シミュレーション処理を終了する。 When no interference has occurred (step S80, No), the simulation control unit 80X ends the simulation process.
　本実施の形態では、数値制御装置１Ｘが、工作機械１００およびロボット６０の実際の動作に合わせてシミュレーション描画および干渉チェックを行う場合について説明した。数値制御装置１Ｘは、工作機械１００およびロボット６０を動作させることなくシミュレーション描画および干渉チェックを行ってもよい。この場合、数値制御装置１Ｘは、数値制御装置１Ｘが持っているマシンロック機能を用いる。マシンロック機能は、位置データの計算は行うが、駆動部９０およびロボットコントローラ５０には指令を出さない機能である。数値制御装置１Ｘは、マシンロック機能を用いることにより、工作機械１００およびロボット６０を実際に動作させなくても、シミュレーション描画および干渉チェックを行うことができる。 In the present embodiment, the case where the numerical control device 1X performs simulation drawing and interference check according to the actual operations of the machine tool 100 and the robot 60 has been described. The numerical control device 1X may perform simulation drawing and interference check without operating the machine tool 100 and the robot 60. In this case, the numerical control device 1X uses the machine lock function possessed by the numerical control device 1X. The machine lock function is a function that calculates position data but does not issue a command to the drive unit 90 and the robot controller 50. By using the machine lock function, the numerical control device 1X can perform simulation drawing and interference check without actually operating the machine tool 100 and the robot 60.
　このように実施の形態１では、数値制御装置１Ｘが、機械モデル８１１および工作機械１００を制御する際に用いる位置データに基づいて工作機械１００を描画し、ロボットモデル８１２およびロボット６０を制御する際に用いる位置データに基づいてロボット６０を描画し、描画した工作機械１００およびロボット６０に基づいて、ロボット６０と工作機械１００とが衝突するか否かを判断している。これにより、数値制御装置１Ｘは、ロボット６０と工作機械１００とが衝突するか否かを判断することが可能となる。 As described above, in the first embodiment, when the numerical control device 1X draws the machine tool 100 based on the position data used when controlling the machine model 811 and the machine tool 100, and controls the robot model 812 and the robot 60. The robot 60 is drawn based on the position data used in the above, and it is determined whether or not the robot 60 and the machine tool 100 collide with each other based on the drawn machine tool 100 and the machine tool 60. As a result, the numerical control device 1X can determine whether or not the robot 60 and the machine tool 100 collide with each other.
実施の形態２．
　つぎに、図９から図１２を用いてこの発明の実施の形態２について説明する。実施の形態２では、シミュレーションによって干渉を検知した場合に、干渉を回避できるよう、工作機械１００およびロボット６０を制御して、工作機械１００およびロボット６０の運転を継続する。 Embodiment 2.
Next, a second embodiment of the present invention will be described with reference to FIGS. 9 to 12. In the second embodiment, when interference is detected by simulation, the machine tool 100 and the robot 60 are controlled so that the interference can be avoided, and the operation of the machine tool 100 and the robot 60 is continued.
　図９は、実施の形態２にかかる数値制御装置の構成例を示す図である。図９の各構成要素のうち図１に示す実施の形態１の数値制御装置１Ｘと同一機能を達成する構成要素については同一符号を付しており、重複する説明は省略する。 FIG. 9 is a diagram showing a configuration example of the numerical control device according to the second embodiment. Of the components of FIG. 9, components that achieve the same functions as the numerical control device 1X of the first embodiment shown in FIG. 1 are designated by the same reference numerals, and redundant description will be omitted.
　数値制御装置１Ｙは、数値制御装置１Ｘと比較して、制御演算部２Ｘの代わりに制御演算部２Ｙを備えている。制御演算部２Ｙの記憶部３４が記憶しているシミュレーション用データ３４６は、機械モデル８１１、ロボットモデル８１２、ロボット経由点、および待機時間上限値を含んでいる。ロボット経由点および待機時間上限値については後述する。また、制御演算部２Ｙは、制御演算部２Ｘと比較して、シミュレーション制御部８０Ｘの代わりにシミュレーション制御部８０Ｙを備えている。 Compared with the numerical control device 1X, the numerical control device 1Y includes a control calculation unit 2Y instead of the control calculation unit 2X. The simulation data 346 stored in the storage unit 34 of the control calculation unit 2Y includes the machine model 811, the robot model 812, the robot transit point, and the waiting time upper limit value. The robot transit point and the upper limit of the waiting time will be described later. Further, the control calculation unit 2Y includes a simulation control unit 80Y instead of the simulation control unit 80X as compared with the control calculation unit 2X.
　シミュレーション制御部８０Ｙは、シミュレーション制御部８０Ｘと同様に、ロボット６０の動作および工作機械１００の動作を演算によってシミュレーションする。シミュレーション制御部８０Ｙは、機械動作演算部８０１と、ロボット動作演算部８０２と、干渉チェック部８０３と、干渉回避処理部８０４とを備えている。なお、図９では、シミュレーション制御部８０Ｙが記憶部３４から取得して格納しておく、機械モデル８１１、ロボットモデル８１２、および工具データ８１３，８１４の図示は省略している。 Similar to the simulation control unit 80X, the simulation control unit 80Y simulates the operation of the robot 60 and the operation of the machine tool 100 by calculation. The simulation control unit 80Y includes a machine operation calculation unit 801, a robot operation calculation unit 802, an interference check unit 803, and an interference avoidance processing unit 804. Note that in FIG. 9, the mechanical model 811, the robot model 812, and the tool data 833 and 814 that the simulation control unit 80Y acquires and stores from the storage unit 34 are not shown.
　干渉回避処理部８０４は、工作機械１００とロボット６０とが干渉すると判断された場合に、工作機械１００とロボット６０との干渉を回避するため、ロボット６０への指令などを変更する。 When it is determined that the machine tool 100 and the robot 60 interfere with each other, the interference avoidance processing unit 804 changes a command to the robot 60 or the like in order to avoid interference between the machine tool 100 and the robot 60.
　干渉回避処理部８０４は、工作機械１００とロボット６０とが干渉すると判断された場合、ロボット６０の姿勢を変更することによって干渉を回避できるか否かを判断する。ロボット６０の姿勢を変更することによって干渉を回避できる場合、干渉回避処理部８０４は、ロボット６０への移動指令であるロボット移動指令を、ロボット６０の姿勢を変更したロボット移動指令に置き換える。これにより、干渉回避処理部８０４は、ロボット６０と工作機械１００の干渉を回避させる。 When it is determined that the machine tool 100 and the robot 60 interfere with each other, the interference avoidance processing unit 804 determines whether or not the interference can be avoided by changing the posture of the robot 60. When interference can be avoided by changing the posture of the robot 60, the interference avoidance processing unit 804 replaces the robot movement command, which is a movement command to the robot 60, with a robot movement command in which the posture of the robot 60 is changed. As a result, the interference avoidance processing unit 804 avoids the interference between the robot 60 and the machine tool 100.
　ロボット６０の姿勢を変更することによって干渉を回避できない場合、干渉回避処理部８０４は、ロボット経由点を目標位置としたロボット移動指令を挿入することで干渉を回避できるか否かを判断する。ロボット経由点は、ロボット６０に経由させることが可能な位置を示している。 When the interference cannot be avoided by changing the posture of the robot 60, the interference avoidance processing unit 804 determines whether or not the interference can be avoided by inserting the robot movement command with the robot transit point as the target position. The robot transit point indicates a position where the robot 60 can pass through.
　ロボット経由点を用いることによって干渉を回避できる場合、干渉回避処理部８０４は、工作機械１００とロボット６０とを干渉させてしまうロボット移動指令（指令）の直前に、工作機械１００との干渉を発生させないロボット移動指令を挿入することで、ロボット６０の移動経路を変更する。これにより、干渉回避処理部８０４は、ロボット６０と工作機械１００の干渉を回避させる。 When interference can be avoided by using the robot waypoint, the interference avoidance processing unit 804 generates interference with the machine tool 100 immediately before the robot movement command (command) that causes the machine tool 100 and the robot 60 to interfere with each other. By inserting a robot movement command that does not allow the robot 60 to move, the movement path of the robot 60 is changed. As a result, the interference avoidance processing unit 804 avoids the interference between the robot 60 and the machine tool 100.
　なお、本実施の形態では、干渉を発生させてしまうロボット移動指令の直前に干渉を回避するための指令を挿入する場合について説明するが、干渉を回避するための指令は、干渉を発生させてしまうロボット移動指令より前に挿入されればよい。 In the present embodiment, a case where a command for avoiding interference is inserted immediately before a robot movement command that causes interference will be described, but a command for avoiding interference causes interference. It may be inserted before the robot movement command to be stored.
　ロボット経由点を用いても干渉を回避できない場合、干渉回避処理部８０４は、干渉する構成要素（干渉対象）が工具６ａ，６ｂなどの工作機械１００の可動部であれば、ロボット６０の移動を一時的に停止することで干渉回避が可能か否かを判断する。具体的には、干渉回避処理部８０４が記憶部３４から待機時間上限値を取得する。待機時間上限値は、ロボット６０を停止させることができる時間の上限値である。すなわち、ロボット６０は、待機時間上限値以下の時間であれば、待機することができる。干渉回避処理部８０４は、待機時間上限値以下の特定時間の間ロボット６０を停止させることで干渉を回避できるか否かを判断する。 When interference cannot be avoided even by using the robot waypoint, the interference avoidance processing unit 804 moves the robot 60 if the interfering component (interference target) is a moving part of the machine tool 100 such as tools 6a and 6b. Judge whether interference can be avoided by temporarily stopping. Specifically, the interference avoidance processing unit 804 acquires the waiting time upper limit value from the storage unit 34. The standby time upper limit value is an upper limit value of the time during which the robot 60 can be stopped. That is, the robot 60 can stand by if the time is equal to or less than the upper limit of the waiting time. The interference avoidance processing unit 804 determines whether or not interference can be avoided by stopping the robot 60 for a specific time equal to or less than the upper limit value of the standby time.
　待機時間上限値以下の特定時間だけロボット６０を待機させることで干渉を回避できる場合、干渉回避処理部８０４は、ロボット６０と工作機械１００を干渉させてしまうロボット移動指令の直前に待機（ドウェル）指令を挿入する。これにより、干渉回避処理部８０４は、ロボット６０と工作機械１００の干渉を回避させる。 When interference can be avoided by making the robot 60 stand by for a specific time equal to or less than the upper limit of the waiting time, the interference avoidance processing unit 804 waits immediately before the robot movement command that causes the robot 60 and the machine tool 100 to interfere with each other (dwell). Insert the command. As a result, the interference avoidance processing unit 804 avoids the interference between the robot 60 and the machine tool 100.
　干渉回避処理部８０４は、ロボット６０の姿勢を変更すること、ロボット６０の経路を変更すること、および待機指令を挿入することの少なくとも１つを実行することでロボット６０と工作機械１００の干渉を回避させる。すなわち、干渉回避処理部８０４は、ロボット６０の姿勢を変更すること、ロボット６０の経路を変更すること、および待機指令を挿入することを組み合わせて、ロボット６０と工作機械１００の干渉を回避させてもよい。 The interference avoidance processing unit 804 causes interference between the robot 60 and the machine tool 100 by executing at least one of changing the posture of the robot 60, changing the path of the robot 60, and inserting a standby command. Avoid it. That is, the interference avoidance processing unit 804 combines the posture of the robot 60, the path of the robot 60, and the insertion of the standby command to avoid interference between the robot 60 and the machine tool 100. May be good.
　つぎに、干渉回避を行う際のロボット６０の動作例について説明する。図１０は、実施の形態２にかかる数値制御装置によって実行される干渉回避の第１の動作例を説明するための図である。干渉回避の第１の動作例では、干渉回避処理部８０４は、干渉を検出すると、ロボット６０を姿勢変更させることによって、干渉を回避する。図１０では、図７に示した干渉が発生する場合の、干渉回避の動作を示している。図１０では、工具６ｃを矢印Ｄ３の方向に移動させつつ、ロボット６０の姿勢を変更した場合を示している。 Next, an operation example of the robot 60 when avoiding interference will be described. FIG. 10 is a diagram for explaining a first operation example of interference avoidance executed by the numerical control device according to the second embodiment. In the first operation example of interference avoidance, when the interference avoidance processing unit 804 detects the interference, the robot 60 is changed in posture to avoid the interference. FIG. 10 shows an operation of avoiding interference when the interference shown in FIG. 7 occurs. FIG. 10 shows a case where the posture of the robot 60 is changed while moving the tool 6c in the direction of the arrow D3.
　干渉回避処理部８０４は、姿勢変更を行う場合、ロボット６０が把持している工具６ｃの先端位置および姿勢が姿勢の変更前後で変化しないように、ロボット移動指令を置き換える。干渉回避処理部８０４は、このロボット移動指令の置き換えによって、干渉を回避することが可能か否かを判断する。回避可能な場合、干渉回避処理部８０４は、干渉を回避できるロボット移動指令に従ってロボット６０を動作させる。 When the posture is changed, the interference avoidance processing unit 804 replaces the robot movement command so that the tip position and posture of the tool 6c held by the robot 60 do not change before and after the posture change. The interference avoidance processing unit 804 determines whether or not it is possible to avoid interference by replacing the robot movement command. If it can be avoided, the interference avoidance processing unit 804 operates the robot 60 according to the robot movement command capable of avoiding the interference.
　図７に示した干渉が発生する場合、干渉回避処理部８０４は、工具６ｃの先端位置および姿勢を姿勢の変更前後で変更せず、特定のロボットアーム２１の姿勢が変化するよう、ロボット移動指令を置き換える。図１０では、ロボットアーム２１のうち、台座２３に接合されている第１のロボットアームを矢印Ｄ４ａの方向に移動させ、第１のロボットアームに接合されている第２のロボットアームを矢印Ｄ４ｂの方向に移動させることで、ロボット６０の姿勢が変更された場合を示している。 When the interference shown in FIG. 7 occurs, the interference avoidance processing unit 804 does not change the tip position and posture of the tool 6c before and after the change of the posture, and commands the robot movement so that the posture of the specific robot arm 21 changes. To replace. In FIG. 10, among the robot arms 21, the first robot arm joined to the pedestal 23 is moved in the direction of the arrow D4a, and the second robot arm joined to the first robot arm is moved by the arrow D4b. The case where the posture of the robot 60 is changed by moving the robot 60 in the direction is shown.
　図１１は、実施の形態２にかかる数値制御装置によって実行される干渉回避の第２の動作例を説明するための図である。干渉回避の第２の動作例では、干渉回避処理部８０４は、干渉を検出すると、ロボット６０の移動経路を変更させることによって、干渉を回避する。図１１では、図６に示した干渉が発生する場合の、干渉回避の動作を示している。図１１では、工具６ｃを矢印Ｄ５の方向に移動させ、その後、工具６ｃを矢印Ｄ６の方向に移動させるよう、ロボット６０の移動経路を変更した場合を示している。 FIG. 11 is a diagram for explaining a second operation example of interference avoidance executed by the numerical control device according to the second embodiment. In the second operation example of interference avoidance, when the interference avoidance processing unit 804 detects the interference, the interference avoidance processing unit 804 avoids the interference by changing the movement path of the robot 60. FIG. 11 shows an operation of avoiding interference when the interference shown in FIG. 6 occurs. FIG. 11 shows a case where the movement path of the robot 60 is changed so that the tool 6c is moved in the direction of the arrow D5 and then the tool 6c is moved in the direction of the arrow D6.
　干渉回避処理部８０４は、記憶部３４からロボット経由点Ｐ１を取得する。干渉回避処理部８０４は、干渉が発生するロボット移動指令の直前に、ロボット経由点Ｐ１を、干渉対象（図６では、工具６ｃ）の目標位置（経由位置）としたロボット移動指令を挿入することで干渉を回避できるか否かを判断する。 The interference avoidance processing unit 804 acquires the robot transit point P1 from the storage unit 34. The interference avoidance processing unit 804 inserts a robot movement command in which the robot passage point P1 is set as the target position (via position) of the interference target (tool 6c in FIG. 6) immediately before the robot movement command in which interference occurs. To determine if interference can be avoided.
　干渉を回避できる場合、干渉回避処理部８０４は、ロボット６０と工作機械１００との干渉を発生させるロボット移動指令の直前に、ロボット経由点Ｐ１を経由するロボット移動指令を挿入することで、ロボット６０が備える構成要素の移動経路を変更する。これにより、干渉回避処理部８０４は、ロボット６０と工作機械１００の干渉を回避する。なお、記憶部３４は、ロボット経由点Ｐ１を複数記憶しておいてもよい。この場合、干渉回避処理部８０４は、複数のロボット経由点Ｐ１を用いて、複数の回避経路を適用してもよい。 When interference can be avoided, the interference avoidance processing unit 804 inserts the robot movement command via the robot transit point P1 immediately before the robot movement command that causes interference between the robot 60 and the machine tool 100, so that the robot 60 Change the movement route of the components provided by. As a result, the interference avoidance processing unit 804 avoids the interference between the robot 60 and the machine tool 100. The storage unit 34 may store a plurality of robot transit points P1. In this case, the interference avoidance processing unit 804 may apply a plurality of avoidance routes by using the plurality of robot passage points P1.
　つぎに、数値制御装置１Ｙによる干渉チェックの処理手順について説明する。図１２は、実施の形態２にかかる数値制御装置による干渉チェックの処理手順を示すフローチャートである。なお、図１２の説明では、図８のフローチャートで説明した処理と同様の処理については、その説明を省略する。 Next, the processing procedure of the interference check by the numerical control device 1Y will be described. FIG. 12 is a flowchart showing a processing procedure of interference check by the numerical control device according to the second embodiment. In the description of FIG. 12, the description of the same processing as that described in the flowchart of FIG. 8 will be omitted.
　数値制御装置１Ｙは、ステップＳ１０からＳ８０までは数値制御装置１Ｘと同様の処理を実行する。干渉チェック処理の結果、干渉が発生していない場合（ステップＳ８０、Ｎｏ）、シミュレーション制御部８０Ｙは、シミュレーション処理を終了する。 The numerical control device 1Y executes the same processing as the numerical control device 1X from steps S10 to S80. If no interference has occurred as a result of the interference check process (steps S80, No), the simulation control unit 80Y ends the simulation process.
　干渉チェック処理の結果、干渉が発生している場合（ステップＳ８０、Ｙｅｓ）、干渉回避処理部８０４は、ロボット６０の姿勢変更を行うことで干渉の回避が可能か否かを判断する（ステップＳ１００）。 If interference has occurred as a result of the interference check process (step S80, Yes), the interference avoidance processing unit 804 determines whether or not the interference can be avoided by changing the posture of the robot 60 (step S100). ).
　ロボット６０が把持する工具６ｃの先端位置および姿勢が、ロボット移動指令の変換前後で同等でないと、目的とした加工をロボット６０が実施できなくなる。このため、干渉回避処理部８０４は、干渉を回避させるための指令における工具６ｃの先端位置および姿勢が、干渉が発生する指令と同じになるような、ロボット６０の各軸位置（ロボット６０を構成する各軸の位置）のパターンを算出する。 If the tip position and posture of the tool 6c gripped by the robot 60 are not the same before and after the conversion of the robot movement command, the robot 60 cannot perform the desired machining. Therefore, the interference avoidance processing unit 804 configures each axis position (robot 60) of the robot 60 so that the tip position and posture of the tool 6c in the command for avoiding interference are the same as the command in which interference occurs. Calculate the pattern of each axis position).
　干渉回避処理部８０４は、ロボット移動指令の変換前後で工具６ｃの先端位置および姿勢を変更することなく、干渉を回避できる軸位置のパターンを算出できたか否かを判断する。すなわち、干渉回避処理部８０４は、導出したロボット６０の各軸位置を適用した場合に、干渉を回避できるか否かを判断する。 The interference avoidance processing unit 804 determines whether or not the pattern of the shaft position that can avoid the interference can be calculated without changing the tip position and the posture of the tool 6c before and after the conversion of the robot movement command. That is, the interference avoidance processing unit 804 determines whether or not interference can be avoided when each axis position of the derived robot 60 is applied.
　干渉回避処理部８０４は、ロボット６０の姿勢変更を行うことで干渉を回避可能であると判断した場合（ステップＳ１００、Ｙｅｓ）、ロボット６０の姿勢を変更する（ステップＳ１１０）。具体的には、干渉回避処理部８０４は、干渉を発生させるロボット移動指令を、ロボット６０の姿勢を変更したロボット移動指令に置き換える。これにより、干渉回避処理部８０４は、干渉を発生させるロボット指令を、干渉が発生しない姿勢のロボット指令に変更する。 When the interference avoidance processing unit 804 determines that interference can be avoided by changing the posture of the robot 60 (step S100, Yes), the interference avoidance processing unit 804 changes the posture of the robot 60 (step S110). Specifically, the interference avoidance processing unit 804 replaces the robot movement command that causes interference with the robot movement command that changes the posture of the robot 60. As a result, the interference avoidance processing unit 804 changes the robot command that causes interference to the robot command in a posture that does not cause interference.
　このように、干渉回避処理部８０４は、干渉を発生させるロボット移動指令においてロボット６０の姿勢を変更することで、干渉を回避できる場合は、ロボット６０の姿勢変更処理を実行する。これにより、干渉回避処理部８０４は、干渉を発生させるロボット移動指令を干渉回避可能なロボット移動指令に置き換えてロボット６０を動作させる。 In this way, the interference avoidance processing unit 804 executes the posture change processing of the robot 60 when the interference can be avoided by changing the posture of the robot 60 in the robot movement command for generating the interference. As a result, the interference avoidance processing unit 804 replaces the robot movement command that causes interference with a robot movement command that can avoid interference, and operates the robot 60.
　干渉回避処理部８０４は、ロボット６０の姿勢変更を行っても干渉を回避できないと判断した場合（ステップＳ１００、Ｎｏ）、ロボット６０の経路変更を行うことで干渉の回避が可能か否かを判断する（ステップＳ１２０）。すなわち、干渉回避処理部８０４は、干渉が発生するロボット移動指令の直前に、経路変更指令を挿入すると、干渉を回避できるか否かを判断する。具体的には、干渉回避処理部８０４は、予め設定しておいたロボット経由点をロボット６０が通過した場合に、干渉を回避できるか否かを判断する。このとき、干渉回避処理部８０４は、任意の数（１または複数）のロボット経由点を設定できるものとし、それぞれのロボット経由点を通過するロボット移動指令を挿入した場合に、干渉を回避できるか否かを判断する。 When the interference avoidance processing unit 804 determines that the interference cannot be avoided even if the posture of the robot 60 is changed (step S100, No), the interference avoidance processing unit 804 determines whether or not the interference can be avoided by changing the route of the robot 60. (Step S120). That is, the interference avoidance processing unit 804 determines whether or not the interference can be avoided by inserting the route change command immediately before the robot movement command in which the interference occurs. Specifically, the interference avoidance processing unit 804 determines whether or not interference can be avoided when the robot 60 passes through a preset robot transit point. At this time, the interference avoidance processing unit 804 can set an arbitrary number (one or a plurality) of robot transit points, and if a robot movement command passing through each robot transit point is inserted, can interference be avoided? Judge whether or not.
　干渉回避処理部８０４は、ロボット６０の経路変更を行うことで干渉を回避可能であると判断した場合（ステップＳ１２０、Ｙｅｓ）、ロボット６０の移動経路を変更する（ステップＳ１３０）。具体的には、干渉回避処理部８０４は、干渉が発生するロボット移動指令の直前に、干渉を発生させない移動指令を挿入する。換言すると、干渉回避処理部８０４は、干渉が発生するロボット移動指令の直前に、干渉を回避できるロボット経由点を目標位置としたロボット移動指令（経路変更指令）を挿入する。干渉を回避可能なロボット経由点が複数ある場合、干渉回避処理部８０４は、移動距離が最も短い、すなわち最短時間で移動可能なロボット経由点を目標位置としたロボット移動指令を、干渉が発生するロボット移動指令の直前に挿入する。 When the interference avoidance processing unit 804 determines that interference can be avoided by changing the route of the robot 60 (step S120, Yes), the interference avoidance processing unit 804 changes the movement route of the robot 60 (step S130). Specifically, the interference avoidance processing unit 804 inserts a movement command that does not cause interference immediately before the robot movement command that causes interference. In other words, the interference avoidance processing unit 804 inserts a robot movement command (route change command) with the robot transit point at which interference can be avoided as a target position immediately before the robot movement command in which interference occurs. When there are a plurality of robot transit points capable of avoiding interference, the interference avoidance processing unit 804 issues a robot movement command with the robot transit point having the shortest movement distance, that is, the robot transit point that can move in the shortest time, as a target position. Insert just before the robot movement command.
　干渉回避処理部８０４は、ロボット６０の経路変更を行っても干渉を回避できないと判断した場合（ステップＳ１２０、Ｎｏ）、ロボット６０の待機で干渉の回避が可能か否かを判断する（ステップＳ１４０）。具体的には、干渉回避処理部８０４は、ロボット６０が干渉する干渉対象が可動部であり、かつロボット６０を待機時間上限値内の間停止させることで、干渉を回避できるか否かを判断する。すなわち、干渉回避処理部８０４は、ロボット６０が干渉する対象が工作機械１００の工具６ａ，６ｂといった可動部であるか否かを判断する。干渉対象が可動部である場合、干渉回避処理部８０４は、待機上限値範囲以内の間、ロボット６０を停止させることで、工具６ａ，６ｂなどの可動部が移動し、干渉を回避できる状態に移行するか否かを判断する。 When the interference avoidance processing unit 804 determines that the interference cannot be avoided even if the route of the robot 60 is changed (step S120, No), the interference avoidance processing unit 804 determines whether or not the interference can be avoided by waiting for the robot 60 (step S140). ). Specifically, the interference avoidance processing unit 804 determines whether or not the interference can be avoided by stopping the robot 60 while the interference target that the robot 60 interferes with is a movable part and the robot 60 is within the upper limit of the standby time. To do. That is, the interference avoidance processing unit 804 determines whether or not the object with which the robot 60 interferes is a movable part such as the tools 6a and 6b of the machine tool 100. When the object of interference is a movable part, the interference avoidance processing unit 804 stops the robot 60 while within the standby upper limit value range, so that the movable parts such as tools 6a and 6b move and the interference can be avoided. Decide whether to migrate.
　干渉回避処理部８０４は、ロボット６０の待機で干渉の回避が可能であると判断した場合（ステップＳ１４０、Ｙｅｓ）、ロボット６０への待機処理を実行する。具体的には、干渉回避処理部８０４は、干渉が発生するロボット指令の直前に、干渉を回避できる時間分の待機指令、すなわちロボット６０を停止させるための待機指令を挿入する（ステップＳ１５０）。 When it is determined that the interference avoidance processing unit 804 can avoid the interference by waiting for the robot 60 (step S140, Yes), the interference avoidance processing unit 804 executes the standby processing for the robot 60. Specifically, the interference avoidance processing unit 804 inserts a standby command for a time during which interference can be avoided, that is, a standby command for stopping the robot 60, immediately before the robot command in which interference occurs (step S150).
　干渉回避処理部８０４が、ロボット６０の待機では干渉を回避できないと判断すると（ステップＳ１４０、Ｎｏ）、干渉チェック部８０３は、アラーム処理を実行する（ステップＳ１６０）。すなわち、干渉チェック部８０３は、補間処理部３８およびロボット制御部４１に、動作中止の信号を送るとともに、画面処理部３１を経由して表示部４に干渉アラームを表示させる。補間処理部３８およびロボット制御部４１は、干渉チェック部８０３から動作中止の信号を受け取ると、演算処理を停止する。 When the interference avoidance processing unit 804 determines that interference cannot be avoided while the robot 60 is on standby (step S140, No), the interference check unit 803 executes alarm processing (step S160). That is, the interference check unit 803 sends an operation stop signal to the interpolation processing unit 38 and the robot control unit 41, and causes the display unit 4 to display an interference alarm via the screen processing unit 31. When the interpolation processing unit 38 and the robot control unit 41 receive the operation stop signal from the interference check unit 803, the calculation processing is stopped.
　このように実施の形態２によれば、数値制御装置１Ｙは、干渉が発生する場合には、ロボット６０の姿勢変更、ロボット６０の移動経路の変更、またはロボット６０の待機指令の挿入を実行するので、ロボット６０と工作機械１００の干渉を回避できる。 As described above, according to the second embodiment, when interference occurs, the numerical control device 1Y executes the posture change of the robot 60, the movement path of the robot 60, or the insertion of the standby command of the robot 60. Therefore, the interference between the robot 60 and the machine tool 100 can be avoided.
実施の形態３．
　つぎに、図１３から図１７を用いてこの発明の実施の形態３について説明する。実施の形態３では、加工ワーク５ａ，５ｂの加工中の形状をシミュレーション（以下、ワークシミュレーションという）する。 Embodiment 3.
Next, a third embodiment of the present invention will be described with reference to FIGS. 13 to 17. In the third embodiment, the shapes of the machining workpieces 5a and 5b during machining are simulated (hereinafter referred to as work simulation).
　図１３は、実施の形態３にかかる数値制御装置の構成例を示す図である。図１３の各構成要素のうち数値制御装置１Ｘ，１Ｙと同一機能を達成する構成要素については同一符号を付しており、重複する説明は省略する。 FIG. 13 is a diagram showing a configuration example of the numerical control device according to the third embodiment. Of the components of FIG. 13, components that achieve the same functions as the numerical control devices 1X and 1Y are designated by the same reference numerals, and duplicate description will be omitted.
　数値制御装置１Ｚは、数値制御装置１Ｙと比較して、制御演算部２Ｙの代わりに制御演算部２Ｚを備えている。制御演算部２Ｚの記憶部３４が記憶しているシミュレーション用データ３４６は、機械モデル８１１、ロボットモデル８１２、ロボット経由点、待機時間上限値、およびワークデータ８１５を含んでいる。ワークデータ８１５は、加工ワーク５ａ，５ｂの情報であり、加工ワーク５ａ，５ｂの加工開始時の形状および装着位置などの情報を含んでいる。 Compared with the numerical control device 1Y, the numerical control device 1Z includes a control calculation unit 2Z instead of the control calculation unit 2Y. The simulation data 346 stored in the storage unit 34 of the control calculation unit 2Z includes the machine model 811, the robot model 812, the robot transit point, the waiting time upper limit value, and the work data 815. The work data 815 is information on the machining workpieces 5a and 5b, and includes information such as the shape and mounting position of the machining workpieces 5a and 5b at the start of machining.
　制御演算部２Ｚは、制御演算部２Ｙと比較して、シミュレーション制御部８０Ｙの代わりにシミュレーション制御部８０Ｚを備えている。 The control calculation unit 2Z includes a simulation control unit 80Z instead of the simulation control unit 80Y as compared with the control calculation unit 2Y.
　シミュレーション制御部８０Ｚは、加工ワーク５ａ，５ｂの形状の変化を演算によってシミュレーションする。シミュレーション制御部８０Ｚは、機械動作演算部８０１と、ロボット動作演算部８０２と、干渉チェック部８０３と、干渉回避処理部８０４とを備えている。また、本実施の形態のシミュレーション制御部８０Ｚは、移動軌跡演算部８０５、ワーク位置演算部８０６、およびワーク形状演算部８０７を備えている。なお、図１３では、シミュレーション制御部８０Ｚが記憶部３４から取得する、機械モデル８１１、ロボットモデル８１２、および工具データ８１３，８１４の図示は省略している。 The simulation control unit 80Z simulates changes in the shapes of the machining workpieces 5a and 5b by calculation. The simulation control unit 80Z includes a machine operation calculation unit 801, a robot operation calculation unit 802, an interference check unit 803, and an interference avoidance processing unit 804. Further, the simulation control unit 80Z of the present embodiment includes a movement locus calculation unit 805, a work position calculation unit 806, and a work shape calculation unit 807. Note that in FIG. 13, the mechanical model 811, the robot model 812, and the tool data 833 and 814 acquired by the simulation control unit 80Z from the storage unit 34 are not shown.
　移動軌跡演算部８０５は、機械動作演算部８０１から工作機械１００の各軸の移動データを取得し、ロボット動作演算部８０２からロボット６０の各軸の移動データを取得する。移動軌跡演算部８０５は、工作機械１００の各軸の移動データ、およびロボット６０の各軸の移動データに基づいて、工具６ａ～６ｃの移動軌跡を演算する。工具６ａまたは工具６ｂの移動軌跡が第１の移動軌跡であり、工具６ｃの移動軌跡が第２の移動軌跡である。 The movement locus calculation unit 805 acquires the movement data of each axis of the machine tool 100 from the machine movement calculation unit 801 and the movement data of each axis of the robot 60 from the robot movement calculation unit 802. The movement locus calculation unit 805 calculates the movement locus of the tools 6a to 6c based on the movement data of each axis of the machine tool 100 and the movement data of each axis of the robot 60. The movement locus of the tool 6a or the tool 6b is the first movement locus, and the movement locus of the tool 6c is the second movement locus.
　ワーク位置演算部８０６は、記憶部３４からワークデータ８１５を取得する。ワーク位置演算部８０６は、工具６ａ～６ｃおよびロボット６０の座標系上における、加工ワーク５ａ，５ｂの位置を算出する。具体的には、ワーク位置演算部８０６は、ワークデータ８１５と、機械モデル８１１と、ロボットモデル８１２とに基づいて、加工ワーク５ａ，５ｂの位置であるワーク位置を算出する。 The work position calculation unit 806 acquires the work data 815 from the storage unit 34. The work position calculation unit 806 calculates the positions of the machining workpieces 5a and 5b on the coordinate systems of the tools 6a to 6c and the robot 60. Specifically, the work position calculation unit 806 calculates the work position, which is the position of the machining work 5a and 5b, based on the work data 815, the machine model 811 and the robot model 812.
　ワーク形状演算部８０７は、工具６ａ～６ｃの移動軌跡と、加工ワーク５ａ，５ｂの位置と、に基づいて、加工ワーク５ａ，５ｂの加工中の形状（形状の時間的な変化）を算出する。また、ワーク形状演算部８０７は、加工ワーク５ａ，５ｂの加工中の形状を、画面処理部３１を介して表示部４に表示させる。 The work shape calculation unit 807 calculates the shape (temporal change of the shape) of the machining workpieces 5a and 5b based on the movement locus of the tools 6a to 6c and the positions of the machining workpieces 5a and 5b. .. Further, the work shape calculation unit 807 causes the display unit 4 to display the shapes of the machined works 5a and 5b being machined via the screen processing unit 31.
　ここで、数値制御装置１Ｚが表示部４の画面に表示させる情報について説明する。図１４は、実施の形態３にかかる数値制御装置がワークシミュレーションをする際のロボットおよび工作機械の動作を説明するための図である。図１５は、図１４に示すワークシミュレーションが実行される際の画面表示の例を示す図である。 Here, the information displayed on the screen of the display unit 4 by the numerical control device 1Z will be described. FIG. 14 is a diagram for explaining the operation of the robot and the machine tool when the numerical control device according to the third embodiment performs a work simulation. FIG. 15 is a diagram showing an example of screen display when the work simulation shown in FIG. 14 is executed.
　図１４では、工作機械１００が、第１系統Ｑ１および第２系統Ｑ２で旋削加工を実行した後、ロボット６０が、第３系統Ｑ３でロボット制御による面取り加工を実行する様子を示している。第１系統Ｑ１は、工具６ａを含んだ系統であり、第２系統Ｑ２は、工具６ｂを含んだ系統であり、第３系統Ｑ３は、工具６ｃを含んだ系統である。工具６ａを含んだ第１系統Ｑ１は、加工ワーク５ａを加工し、工具６ｂを含んだ第２系統Ｑ２は、加工ワーク５ｂを加工する。また、工具６ｃを含んだ第３系統Ｑ３は、加工ワーク５ａを加工する。加工ワーク５ａは、工具６ａを含んだ第１系統Ｑ１によって面取り位置Ｐ２まで加工されると、第１系統Ｑ１による加工が継続されながら、工具６ｃを含んだ第３系統Ｑ３によって面取り位置Ｐ２で面取り加工が行われる。 FIG. 14 shows a state in which the machine tool 100 executes turning in the first system Q1 and the second system Q2, and then the robot 60 executes chamfering in the third system Q3 under robot control. The first system Q1 is a system including the tool 6a, the second system Q2 is the system including the tool 6b, and the third system Q3 is the system including the tool 6c. The first system Q1 including the tool 6a processes the machining work 5a, and the second system Q2 including the tool 6b processes the machining work 5b. Further, the third system Q3 including the tool 6c processes the machining work 5a. When the machining work 5a is machined to the chamfering position P2 by the first system Q1 including the tool 6a, the machining work 5a is chamfered at the chamfering position P2 by the third system Q3 including the tool 6c while the machining by the first system Q1 is continued. Processing is done.
　数値制御装置１Ｚが備える表示部４は、加工途中の加工ワーク５ａ，５ｂを表示するとともに、工作機械１００およびロボット６０の工具６ａ～６ｃを表示する。図１５に示す画面１３３では、第１系統Ｑ１で旋削加工が実行される際に、加工途中の加工ワーク５ａと、工作機械１００の工具６ａとが表示される場合を示している。図１５に示す画面１３４では、その後、第１系統Ｑ１での旋削加工および第３系統Ｑ３での面取り加工が実行される際に、加工途中の加工ワーク５ａと、工作機械１００の工具６ａと、ロボット６０の工具６ｃとが表示される場合を示している。すなわち、画面１３３では、工作機械１００の第１系統Ｑ１による旋削加工段階のシミュレーション結果が表示され、画面１３４では、ロボット６０の第３系統Ｑ３による面取り工程段階のシミュレーション結果が表示されている。 The display unit 4 included in the numerical control device 1Z displays the machining workpieces 5a and 5b in the process of machining, and also displays the tools 6a to 6c of the machine tool 100 and the robot 60. The screen 133 shown in FIG. 15 shows a case where the machining work 5a in the middle of machining and the tool 6a of the machine tool 100 are displayed when the turning process is executed in the first system Q1. On the screen 134 shown in FIG. 15, when the turning process in the first system Q1 and the chamfering process in the third system Q3 are subsequently executed, the machining work 5a in the middle of machining, the tool 6a of the machine tool 100, and the tool 6a are displayed. The case where the tool 6c of the robot 60 is displayed is shown. That is, on the screen 133, the simulation result of the turning process stage by the first system Q1 of the machine tool 100 is displayed, and on the screen 134, the simulation result of the chamfering process stage by the third system Q3 of the robot 60 is displayed.
　表示部４が表示する画面（ワークシミュレーション画面）では画面の任意の箇所の拡大および縮小が可能となっており、加工後のワーク形状の特定箇所の詳細形状を確認可能となっている。図１６は、図１５に示した面取り位置での加工ワークの形状を拡大表示した例を示す図である。図１６の画面１３５では、加工ワーク５ａの面取り位置Ｐ２の画像を拡大表示している。なお、図１６では、加工ワーク５ａの箇所にハッチングを付している。 On the screen (work simulation screen) displayed by the display unit 4, it is possible to enlarge or reduce an arbitrary part of the screen, and it is possible to confirm the detailed shape of a specific part of the work shape after processing. FIG. 16 is a diagram showing an example in which the shape of the machined work at the chamfered position shown in FIG. 15 is enlarged and displayed. On the screen 135 of FIG. 16, the image of the chamfered position P2 of the machining work 5a is enlarged and displayed. In FIG. 16, hatching is attached to the portion of the machining work 5a.
　つぎに、数値制御装置１Ｚによるワークシミュレーションの処理手順について説明する。図１７は、実施の形態３にかかる数値制御装置によるワークシミュレーションの処理手順を示すフローチャートである。図１７では、第１系統Ｑ１および第３系統Ｑ３での加工ワーク５ａに対するワークシミュレーションについて説明する。なお、図１７の説明では、図８のフローチャートで説明した処理と同様の処理については、その説明を省略する。 Next, the processing procedure of the work simulation by the numerical control device 1Z will be described. FIG. 17 is a flowchart showing a processing procedure of work simulation by the numerical control device according to the third embodiment. FIG. 17 describes a work simulation for the machining work 5a in the first system Q1 and the third system Q3. In the description of FIG. 17, the description of the same processing as that described in the flowchart of FIG. 8 will be omitted.
　数値制御装置１Ｚは、ワークシミュレーションを開始すると、第１系統Ｑ１で工作機械１００による旋削加工を実行し、第３系統Ｑ３でロボット６０による面取り加工を実行する。なお、第１系統Ｑ１の処理および第３系統Ｑ３の処理は並列にて実施されるものとする。 When the work simulation is started, the numerical control device 1Z executes turning by the machine tool 100 in the first system Q1 and chamfering by the robot 60 in the third system Q3. It is assumed that the processing of the first system Q1 and the processing of the third system Q3 are performed in parallel.
　第１系統Ｑ１の旋削加工ステップでは、解析処理部３７が、ＮＣプログラムを解析する（ステップＳ１０Ａ）。すなわち、解析処理部３７が、工作機械１００の駆動部９０への指令である機械駆動指令を解析する。 In the turning step of the first system Q1, the analysis processing unit 37 analyzes the NC program (step S10A). That is, the analysis processing unit 37 analyzes the machine drive command, which is a command to the drive unit 90 of the machine tool 100.
　補間処理部３８は、機械駆動指令の解析結果を用いて、機械駆動指令の補間処理を行う（ステップＳ２０）。そして、補間処理部３８は、補間処理した機械駆動指令に基づいて、工作機械１００の動作である工作機械動作の演算処理を実行する（ステップＳ３０）。補間処理部３８による演算処理で得られる機械動作には、工作機械１００が備える駆動部９０の各軸位置の情報が含まれている。 The interpolation processing unit 38 performs interpolation processing of the machine drive command using the analysis result of the machine drive command (step S20). Then, the interpolation processing unit 38 executes arithmetic processing of the machine tool operation, which is the operation of the machine tool 100, based on the machine drive command that has been interpolated (step S30). The machine operation obtained by the arithmetic processing by the interpolation processing unit 38 includes information on each axis position of the drive unit 90 included in the machine tool 100.
　移動軌跡演算部８０５は、工具６ａの移動軌跡である第１の工具移動軌跡の演算処理を実行する（ステップＳ２００）。具体的には、移動軌跡演算部８０５は、工作機械１００が備える駆動部９０の各軸位置と、機械モデル８１１と、工具データ８１３とに基づいて、工具６ａの移動軌跡を算出する。 The movement locus calculation unit 805 executes the calculation process of the first tool movement locus, which is the movement locus of the tool 6a (step S200). Specifically, the movement locus calculation unit 805 calculates the movement locus of the tool 6a based on each axis position of the drive unit 90 included in the machine tool 100, the machine model 811 and the tool data 813.
　第３系統Ｑ３の面取り加工ステップでは、解析処理部３７のロボット指令解析部３７１が、ＮＣプログラムを解析する（ステップＳ１０Ｂ）。すなわち、ロボット指令解析部３７１が、ロボット６０への指令であるロボット指令を解析する。 In the chamfering step of the third system Q3, the robot command analysis unit 371 of the analysis processing unit 37 analyzes the NC program (step S10B). That is, the robot command analysis unit 371 analyzes the robot command, which is a command to the robot 60.
　ロボット制御部４１は、ロボット６０への指令の解析結果を用いて、ロボット６０へのＮＣプログラムをロボットプログラムに変換する（ステップＳ４０）。また、ロボット制御部４１は、ロボットプログラムに基づいて、ロボット６０の動作であるロボット動作の演算処理を実行する（ステップＳ５０）。ロボット制御部４１による演算処理で得られるロボット動作には、ロボット６０の各軸位置の情報が含まれている。 The robot control unit 41 converts the NC program to the robot 60 into a robot program by using the analysis result of the command to the robot 60 (step S40). Further, the robot control unit 41 executes arithmetic processing of the robot operation, which is the operation of the robot 60, based on the robot program (step S50). The robot operation obtained by the arithmetic processing by the robot control unit 41 includes information on each axis position of the robot 60.
　移動軌跡演算部８０５は、工具６ｃの移動軌跡である第２の工具移動軌跡の演算処理を実行する（ステップＳ２１０）。具体的には、移動軌跡演算部８０５は、ロボット６０の各軸位置と、ロボットモデル８１２と、工具データ８１４とに基づいて、工具６ｃの移動軌跡を算出する。 The movement locus calculation unit 805 executes the calculation processing of the second tool movement locus, which is the movement locus of the tool 6c (step S210). Specifically, the movement locus calculation unit 805 calculates the movement locus of the tool 6c based on each axis position of the robot 60, the robot model 812, and the tool data 814.
　移動軌跡演算部８０５が、工具６ａ，６ｃの移動軌跡を算出した後、ワーク位置演算部８０６は、ワークデータ８１５と、機械モデル８１１と、ロボットモデル８１２とに基づいて、加工ワーク５ａの位置であるワーク位置の演算処理を実行する（ステップＳ２２０）。すなわち、ワーク位置演算部８０６は、ワーク位置の演算処理にて加工ワーク５ａが工作機械１００の加工室内の何れの位置に存在するかを算出する。 After the movement locus calculation unit 805 calculates the movement locus of the tools 6a and 6c, the work position calculation unit 806 performs the work position calculation unit 806 at the position of the machining work 5a based on the work data 815, the machine model 811 and the robot model 812. The arithmetic processing of a certain work position is executed (step S220). That is, the work position calculation unit 806 calculates the position of the machine tool 5a in the machine tool 100 by the work position calculation process.
　ワーク形状演算部８０７は、ワーク形状の演算処理を実行する（ステップＳ２３０）。具体的には、ワーク形状演算部８０７は、工具６ａ～６ｃの移動軌跡と、加工ワーク５ａの位置と、に基づいて、加工ワーク５ａの加工中の形状を算出する。すなわち、ワーク形状演算部８０７は、ステップＳ２００，Ｓ２１０で算出された工具６ａ，６ｃの移動軌跡と、ステップＳ２２０で算出されたワーク位置とに基づいて、特定領域まで加工された後の加工ワーク５ａの形状を算出する。換言すると、ワーク形状演算部８０７は、ワーク形状の時間的な変化を算出する。このとき、ワーク形状演算部８０７は、加工ワーク５ａに対して、工具６ａ，６ｃが通過した箇所を除外した形状を演算していく。 The work shape calculation unit 807 executes the work shape calculation process (step S230). Specifically, the work shape calculation unit 807 calculates the shape of the machining work 5a during machining based on the movement locus of the tools 6a to 6c and the position of the machining work 5a. That is, the work shape calculation unit 807 is the machined work 5a after being machined to a specific region based on the movement locus of the tools 6a and 6c calculated in steps S200 and S210 and the work position calculated in step S220. Calculate the shape of. In other words, the work shape calculation unit 807 calculates the time change of the work shape. At this time, the work shape calculation unit 807 calculates the shape of the machined work 5a excluding the portions where the tools 6a and 6c have passed.
　シミュレーション制御部８０Ｚは、描画処理を実行する（ステップＳ２４０）。具体的には、ワーク形状演算部８０７が、算出した加工ワーク５ａの加工中の形状を描画し、描画したデータを画面処理部３１に送る。これにより、表示部４は、加工ワーク５ａの加工中の形状を表示する。 The simulation control unit 80Z executes the drawing process (step S240). Specifically, the work shape calculation unit 807 draws the calculated shape of the processing work 5a during processing, and sends the drawn data to the screen processing unit 31. As a result, the display unit 4 displays the shape of the machining work 5a during machining.
　シミュレーション制御部８０Ｚは、加工ワーク５ｂに対しても、加工ワーク５ａと同様に加工中の形状を算出することができる。シミュレーション制御部８０Ｚは、算出した加工ワーク５ａ，５ｂを用いて、ロボット６０と加工ワーク５ａ，５ｂとの干渉をチェックしてもよいし、干渉を回避させてもよい。また、シミュレーション制御部８０Ｚは、算出した加工ワーク５ａ，５ｂを用いて、工作機械１００と加工ワーク５ａ，５ｂとの干渉をチェックしてもよいし、干渉を回避させてもよい。 The simulation control unit 80Z can calculate the shape of the machining work 5b during machining in the same manner as the machining work 5a. The simulation control unit 80Z may check the interference between the robot 60 and the machining workpieces 5a and 5b by using the calculated machining workpieces 5a and 5b, or may avoid the interference. Further, the simulation control unit 80Z may check the interference between the machine tool 100 and the machining workpieces 5a and 5b by using the calculated machining workpieces 5a and 5b, or may avoid the interference.
　このように実施の形態３によれば、数値制御装置１Ｚは、工具６ａ～６ｃの移動軌跡を算出し、工具６ａ～６ｃの移動軌跡に基づいて加工ワーク５ａ，５ｂの形状を算出するので、加工中の加工ワーク５ａ，５ｂの形状を算出することができる。 As described above, according to the third embodiment, the numerical control device 1Z calculates the movement locus of the tools 6a to 6c and calculates the shapes of the machining workpieces 5a and 5b based on the movement locus of the tools 6a to 6c. The shapes of the machining workpieces 5a and 5b being machined can be calculated.
　また、数値制御装置１Ｚは、加工中の加工ワーク５ａ，５ｂの形状を算出できるので、加工ワーク５ａ，５ｂとロボット６０との干渉のチェックおよび干渉の回避を正確に実行できる。また、数値制御装置１Ｚは、加工中の加工ワーク５ａ，５ｂの形状を算出できるので、加工ワーク５ａ，５ｂと工作機械１００との干渉のチェックおよび干渉の回避を正確に実行できる。 Further, since the numerical control device 1Z can calculate the shapes of the machining workpieces 5a and 5b being machined, it is possible to accurately check the interference between the machining workpieces 5a and 5b and the robot 60 and avoid the interference. Further, since the numerical control device 1Z can calculate the shapes of the machining workpieces 5a and 5b being machined, it is possible to accurately check the interference between the machining workpieces 5a and 5b and the machine tool 100 and avoid the interference.
実施の形態４．
　つぎに、図１８から図２２を用いてこの発明の実施の形態４について説明する。実施の形態４では、工作機械１００またはロボット６０への手動操作に対して、工作機械１００とロボット６０との間に干渉が発生するか否かを判断し、干渉する場合には、干渉回避の動作を実行する。 Embodiment 4.
Next, a fourth embodiment of the present invention will be described with reference to FIGS. 18 to 22. In the fourth embodiment, it is determined whether or not interference occurs between the machine tool 100 and the robot 60 with respect to the manual operation of the machine tool 100 or the robot 60, and if it interferes, interference avoidance is avoided. Perform the action.
　図１８は、実施の形態４にかかる数値制御装置の構成例を示す図である。図１８の各構成要素のうち数値制御装置１Ｘ，１Ｙ，１Ｚと同一機能を達成する構成要素については同一符号を付しており、重複する説明は省略する。 FIG. 18 is a diagram showing a configuration example of the numerical control device according to the fourth embodiment. Of the components of FIG. 18, the components that achieve the same functions as the numerical control devices 1X, 1Y, and 1Z are designated by the same reference numerals, and redundant description will be omitted.
　数値制御装置１Ｌは、数値制御装置１Ｙと比較して、制御演算部２Ｙの代わりに制御演算部２Ｌを備えている。制御演算部２Ｌは、制御演算部２Ｙと比較して、シミュレーション制御部８０Ｙの代わりに干渉回避制御部８１を備えている。また、制御演算部２Ｌは、制御演算部２Ｙと比較して、ロボット制御部４１の代わりにロボット制御部４１Ｌを備えている。 The numerical control device 1L includes a control calculation unit 2L instead of the control calculation unit 2Y as compared with the numerical control device 1Y. The control calculation unit 2L includes an interference avoidance control unit 81 instead of the simulation control unit 80Y as compared with the control calculation unit 2Y. Further, the control calculation unit 2L includes a robot control unit 41L instead of the robot control unit 41 as compared with the control calculation unit 2Y.
　制御演算部２Ｌの記憶部３４が記憶しているシミュレーション用データ３４６は、機械モデル８１１と、ロボットモデル８１２とを含んでいる。 The simulation data 346 stored in the storage unit 34 of the control calculation unit 2L includes the machine model 811 and the robot model 812.
　干渉回避制御部８１は、シミュレーション制御部８０Ｙが備えている機能に加えて、手動操作された際に干渉を回避するための処理を実行する機能を備えている。干渉回避制御部８１は、工作機械１００またはロボット６０への手動操作に対して、工作機械１００とロボット６０との間に干渉が発生するか否かを判断し、干渉する場合には工作機械１００とロボット６０との干渉を回避するため、ロボット６０への指令などを変更する。干渉回避制御部８１は、機械動作演算部８５１と、ロボット動作演算部８５２と、干渉チェック部８５３と、干渉回避処理部８５４とを備えている。 The interference avoidance control unit 81 has a function of executing a process for avoiding interference when manually operated, in addition to the function of the simulation control unit 80Y. The interference avoidance control unit 81 determines whether or not interference occurs between the machine tool 100 and the robot 60 in response to a manual operation on the machine tool 100 or the robot 60, and if it interferes, the machine tool 100 In order to avoid interference between the robot 60 and the robot 60, the command to the robot 60 and the like are changed. The interference avoidance control unit 81 includes a machine operation calculation unit 851, a robot operation calculation unit 852, an interference check unit 853, and an interference avoidance processing unit 854.
　機械動作演算部８５１は、機械モデル８１１および工具データ８１３を記憶部３４から取得する。また、ロボット動作演算部８５２は、ロボットモデル８１２および工具データ８１４を記憶部３４から取得する。なお、図１８では、干渉回避制御部８１が記憶部３４から取得して格納しておく、機械モデル８１１、ロボットモデル８１２、および工具データ８１３，８１４の図示は省略している。 The machine operation calculation unit 851 acquires the machine model 811 and the tool data 813 from the storage unit 34. Further, the robot motion calculation unit 852 acquires the robot model 812 and the tool data 814 from the storage unit 34. Note that in FIG. 18, the mechanical model 811, the robot model 812, and the tool data 833 and 814 that the interference avoidance control unit 81 acquires from the storage unit 34 and stores are omitted.
　機械動作演算部８５１は、機械動作演算部８０１が備えている機能に加えて、手動操作された際の工作機械１００の位置および形状を算出する機能を備えている。機械動作演算部８５１は、手動操作による移動対象が工作機械１００の構成要素であった場合、移動対象、移動量、機械モデル８１１および工具データ８１３に基づいて、工作機械１００の移動後の位置および形状を算出する。機械動作演算部８５１は、算出結果である、工作機械１００の移動後の位置および形状を干渉チェック部８５３に送信する。 The machine motion calculation unit 851 has a function of calculating the position and shape of the machine tool 100 when manually operated, in addition to the functions of the machine motion calculation unit 801. When the movement target by the manual operation is a component of the machine tool 100, the machine operation calculation unit 851 determines the position of the machine tool 100 after the movement and the position of the machine tool 100 based on the movement target, the movement amount, the machine model 811 and the tool data 813. Calculate the shape. The machine operation calculation unit 851 transmits the calculated position and shape of the machine tool 100 after movement to the interference check unit 853.
　ロボット動作演算部８５２は、ロボット動作演算部８０２が備えている機能に加えて、手動操作された際のロボット６０の位置および形状を算出する機能を備えている。ロボット動作演算部８５２は、手動操作による移動対象がロボット６０の構成要素であった場合、移動対象、移動量、ロボットモデル８１２および工具データ８１４に基づいて、ロボット６０の移動後の位置および形状を算出する。ロボット動作演算部８５２は、算出結果である、ロボット６０の移動後の位置および形状を干渉チェック部８５３に送信する。 The robot motion calculation unit 852 has a function of calculating the position and shape of the robot 60 when manually operated, in addition to the functions of the robot motion calculation unit 802. When the movement target by the manual operation is a component of the robot 60, the robot motion calculation unit 852 determines the position and shape of the robot 60 after the movement based on the movement target, the movement amount, the robot model 812, and the tool data 814. calculate. The robot motion calculation unit 852 transmits the calculated position and shape of the robot 60 after movement to the interference check unit 853.
　干渉チェック部８５３は、手動操作による移動対象の移動後の位置および形状に基づいて、工作機械１００とロボット６０とが干渉するか否かを判断する。干渉回避処理部８５４は、ロボット６０の姿勢を変更することで干渉回避が可能である場合に、ロボット６０の姿勢を変更した移動データを生成して、ロボット制御部４１Ｌに送信する。 The interference check unit 853 determines whether or not the machine tool 100 and the robot 60 interfere with each other based on the position and shape of the moving object after movement by manual operation. When interference avoidance is possible by changing the posture of the robot 60, the interference avoidance processing unit 854 generates movement data in which the posture of the robot 60 is changed and transmits the movement data to the robot control unit 41L.
　数値制御装置１Ｌの入力操作部３は、手動ハンドル５５と、ジョグボタン５７と、軸選択スイッチ５９とを備えている。また、数値制御装置１Ｌのロボット制御部４１Ｌは、ロボット手動操作部４１５を備えている。また、数値制御装置１Ｌの補間処理部３８は、手動可否判断部３８２Ｍを備えている。 The input operation unit 3 of the numerical control device 1L includes a manual handle 55, a jog button 57, and an axis selection switch 59. Further, the robot control unit 41L of the numerical control device 1L includes a robot manual operation unit 415. Further, the interpolation processing unit 38 of the numerical control device 1L includes a manual availability determination unit 382M.
　手動ハンドル５５は、ロボット６０の軸方向の移動量を操作するためのハンドルである。手動ハンドル５５は、手動パルスジェネレータである。手動ハンドル５５は、操作に対応する移動量を制御演算部２Ｌに送る。この移動量は、記憶部３４を介してロボット手動操作部４１５に送られる。 The manual handle 55 is a handle for controlling the amount of movement of the robot 60 in the axial direction. The manual handle 55 is a manual pulse generator. The manual handle 55 sends a movement amount corresponding to the operation to the control calculation unit 2L. This movement amount is sent to the robot manual operation unit 415 via the storage unit 34.
　なお、手動ハンドル５５は、工作機械１００の軸方向の移動量を操作する際に用いられてもよい。すなわち、ユーザは、１つの手動ハンドル５５で、ロボット６０の操作および工作機械１００の操作を行ってもよい。この場合、ユーザからの操作を受け付ける操作盤（後述する操作盤５３）には、手動ハンドル５５による手動操作対象を切り替えるための切替スイッチ（後述する切替スイッチ１５）を配置しておく。 The manual handle 55 may be used when manipulating the amount of movement of the machine tool 100 in the axial direction. That is, the user may operate the robot 60 and the machine tool 100 with one manual handle 55. In this case, a changeover switch (changeover switch 15 described later) for switching the manual operation target by the manual handle 55 is arranged on the operation panel (operation panel 53 described later) that receives an operation from the user.
　ジョグボタン５７は、ロボット６０の軸方向の移動量をジョグ操作するためのボタンである。ジョグボタン５７は、操作に対応する操作情報を制御演算部２Ｌに送る。この操作情報は移動量に対応する情報であり、記憶部３４を介してロボット手動操作部４１５に送られる。 The jog button 57 is a button for jogging the amount of movement of the robot 60 in the axial direction. The jog button 57 sends operation information corresponding to the operation to the control calculation unit 2L. This operation information is information corresponding to the movement amount, and is sent to the robot manual operation unit 415 via the storage unit 34.
　軸選択スイッチ５９は、ロボット６０に対して手動操作する軸を選択するスイッチである。軸選択スイッチ５９の例は、工作機械１００における座標系で、Ｘ軸を指定するスイッチ、Ｙ軸を指定するスイッチ、Ｚ軸を指定するスイッチ、Ａ軸を指定するスイッチ、Ｂ軸を指定するスイッチ、Ｃ軸を指定するスイッチである。軸選択スイッチ５９は、押下またはタッチされた軸が何れの軸であるかを示す軸情報を、制御演算部２Ｌに送る。この軸情報は、記憶部３４を介してロボット手動操作部４１５に送られる。 The axis selection switch 59 is a switch for selecting an axis to be manually operated with respect to the robot 60. An example of the axis selection switch 59 is a coordinate system in the machine tool 100, in which a switch that specifies the X axis, a switch that specifies the Y axis, a switch that specifies the Z axis, a switch that specifies the A axis, and a switch that specifies the B axis. , A switch that specifies the C-axis. The axis selection switch 59 sends axis information indicating which axis the pressed or touched axis is to the control calculation unit 2L. This axis information is sent to the robot manual operation unit 415 via the storage unit 34.
　ここで、切替スイッチ１５を備えた操作盤５３の構成について説明する。図１９は、実施の形態４にかかる数値制御装置が備える操作盤の構成例を示す図である。図１９に示すように、操作盤５３は、工作機械１００の前面などに配置されている。また、工作機械１００の前面には、表示部４および手動ハンドル５５が配置されている。なお、図１９では、ジョグボタン５７、および軸選択スイッチ５９の図示を省略している。 Here, the configuration of the operation panel 53 provided with the changeover switch 15 will be described. FIG. 19 is a diagram showing a configuration example of an operation panel included in the numerical control device according to the fourth embodiment. As shown in FIG. 19, the operation panel 53 is arranged on the front surface of the machine tool 100 or the like. Further, a display unit 4 and a manual handle 55 are arranged on the front surface of the machine tool 100. In FIG. 19, the jog button 57 and the axis selection switch 59 are not shown.
　操作盤５３には、手動ハンドル５５による手動操作対象を切り替えるための切替スイッチ１５が配置されている。切替スイッチ１５は、手動操作対象をロボット６０に切り替えるためのスイッチと、手動操作対象を工作機械１００に切り替えるためのスイッチとを有している。切替スイッチ１５が操作されると、切替スイッチ１５は、操作に対応する手動操作対象を制御演算部２Ｌの解析処理部３７に送る。 A changeover switch 15 for switching a manual operation target by the manual handle 55 is arranged on the operation panel 53. The changeover switch 15 has a switch for switching the manual operation target to the robot 60 and a switch for switching the manual operation target to the machine tool 100. When the changeover switch 15 is operated, the changeover switch 15 sends the manual operation target corresponding to the operation to the analysis processing unit 37 of the control calculation unit 2L.
　ロボット６０または工作機械１００が、手動操作可能な構成要素を複数有している場合、解析処理部３７は、入力操作部３から送られてくる情報に基づいて、手動操作に対応する移動対象がロボット６０の構成要素であるか工作機械１００の構成要素であるかを解析する。この場合、ユーザは、入力操作部３に対し、手動操作するロボット６０の構成要素を指定する操作、または手動操作する工作機械１００の構成要素を指定する操作を実行する。 When the robot 60 or the machine tool 100 has a plurality of components that can be manually operated, the analysis processing unit 37 moves the movement target corresponding to the manual operation based on the information sent from the input operation unit 3. It is analyzed whether it is a component of the robot 60 or a component of the machine tool 100. In this case, the user executes an operation of designating the component of the robot 60 to be manually operated or an operation of designating the component of the machine tool 100 to be manually operated to the input operation unit 3.
　ロボット手動操作部４１５は、手動可否判断部４２１Ｒおよび移動データ送信部４２２を備えている。手動可否判断部４２１Ｒは、制御システムの状態（以下、システム状態という）に基づいて、ロボット６０の手動操作の可否を判断する。すなわち、手動可否判断部４２１Ｒは、ロボット６０、数値制御装置１Ｌ、および工作機械１００の少なくとも１つの状態に基づいて、ロボット６０の手動操作の可否を判断する。可否の判断には、数値制御装置１Ｌが持つ種々のデータが参照される。手動可否判断部４２１Ｒは、例えば、非常停止状態である場合、ロボットコントローラ５０との通信が未接続である場合、またはロボット６０の周辺の侵入禁止領域にユーザが侵入している場合に、手動操作不可と判断する。 The robot manual operation unit 415 includes a manual availability determination unit 421R and a movement data transmission unit 422. The manual availability determination unit 421R determines whether or not the robot 60 can be manually operated based on the state of the control system (hereinafter referred to as the system state). That is, the manual operation availability determination unit 421R determines whether or not the robot 60 can be manually operated based on at least one state of the robot 60, the numerical control device 1L, and the machine tool 100. Various data possessed by the numerical control device 1L are referred to in determining whether or not it is possible. The manual enable / disable determination unit 421R is manually operated, for example, when the robot is in an emergency stop state, communication with the robot controller 50 is not connected, or a user has invaded the intrusion prohibited area around the robot 60. Judge as impossible.
　移動データ送信部４２２は、軸選択スイッチ５９で選択された軸情報と、解析処理部３７が解析した移動量に基づいて移動指令を生成し、移動指令をロボットコントローラ５０に送る。これにより、数値制御装置１Ｌは、ロボットコントローラ５０を介して、ロボット６０を操作することができる。解析処理部３７が解析した移動量は、ジョグボタン５７または手動ハンドル５５から送られてくる情報に対応している。すなわち、解析処理部３７が解析した移動量は、ジョグボタン５７または手動ハンドル５５への手動操作に対応している。 The movement data transmission unit 422 generates a movement command based on the axis information selected by the axis selection switch 59 and the movement amount analyzed by the analysis processing unit 37, and sends the movement command to the robot controller 50. As a result, the numerical control device 1L can operate the robot 60 via the robot controller 50. The movement amount analyzed by the analysis processing unit 37 corresponds to the information sent from the jog button 57 or the manual handle 55. That is, the movement amount analyzed by the analysis processing unit 37 corresponds to the manual operation of the jog button 57 or the manual handle 55.
　手動可否判断部３８２Ｍは、システム状態に基づいて、工作機械１００の手動操作の可否を判断する。すなわち、手動可否判断部３８２Ｍは、ロボット６０、数値制御装置１Ｌ、および工作機械１００の少なくとも１つの状態に基づいて、工作機械１００の手動操作の可否を判断する。可否の判断には、数値制御装置１Ｌが持つ種々のデータが参照される。手動可否判断部３８２Ｍは、例えば、非常停止状態である場合、または工作機械１００の周辺の侵入禁止領域にユーザが侵入している場合に、手動操作不可と判断する。 The manual availability determination unit 382M determines whether or not the machine tool 100 can be manually operated based on the system state. That is, the manual availability determination unit 382M determines whether or not the machine tool 100 can be manually operated based on at least one state of the robot 60, the numerical control device 1L, and the machine tool 100. Various data possessed by the numerical control device 1L are referred to in determining whether or not it is possible. The manual availability determination unit 382M determines that manual operation is not possible, for example, when the user is in an emergency stop state or when a user has invaded the intrusion prohibited area around the machine tool 100.
　ここで、手動操作が行われた場合の、干渉チェック処理について説明する。本実施の形態の解析処理部３７は、切替スイッチ１５によって切替えられた手動操作対象（移動対象）と、ジョグボタン５７への操作に対応する操作情報を受け付ける。解析処理部３７は、移動対象がロボット６０である場合、受け付けた操作情報に基づいて移動量を算出し、移動量をロボット手動操作部４１５に送る。また、解析処理部３７は、移動対象が工作機械１００である場合、受け付けた操作情報に基づいて移動量を算出し、移動量を補間処理部３８に送る。 Here, the interference check process when a manual operation is performed will be described. The analysis processing unit 37 of the present embodiment receives the manual operation target (movement target) switched by the changeover switch 15 and the operation information corresponding to the operation to the jog button 57. When the movement target is the robot 60, the analysis processing unit 37 calculates the movement amount based on the received operation information and sends the movement amount to the robot manual operation unit 415. Further, when the movement target is the machine tool 100, the analysis processing unit 37 calculates the movement amount based on the received operation information and sends the movement amount to the interpolation processing unit 38.
　ロボット手動操作部４１５は、移動量を受け付けると、移動量をロボット動作演算部８５２に送る。また、補間処理部３８は、移動量を受け付けると、移動量を機械動作演算部８５１に送る。 When the robot manual operation unit 415 receives the movement amount, the robot manual operation unit 415 sends the movement amount to the robot motion calculation unit 852. Further, when the interpolation processing unit 38 receives the movement amount, the interpolation processing unit 38 sends the movement amount to the machine operation calculation unit 851.
　ロボット動作演算部８５２は、ロボット手動操作部４１５から移動量を受け付けると、移動対象がロボット６０であると判断し、移動量に基づいて、ロボット６０の移動後の位置および形状を算出する。ロボット動作演算部８５２は、算出結果である、ロボット６０の移動後の位置および形状を干渉チェック部８５３に送信する。 When the robot motion calculation unit 852 receives the movement amount from the robot manual operation unit 415, it determines that the movement target is the robot 60, and calculates the position and shape of the robot 60 after the movement based on the movement amount. The robot motion calculation unit 852 transmits the calculated position and shape of the robot 60 after movement to the interference check unit 853.
　機械動作演算部８５１は、補間処理部３８から移動量を受け付けると、移動対象が工作機械１００であると判断し、移動量に基づいて、工作機械１００の移動後の位置および形状を算出する。機械動作演算部８５１は、算出結果である、工作機械１００の移動後の位置および形状を干渉チェック部８５３に送信する。 When the machine operation calculation unit 851 receives the movement amount from the interpolation processing unit 38, it determines that the movement target is the machine tool 100, and calculates the position and shape of the machine tool 100 after the movement based on the movement amount. The machine operation calculation unit 851 transmits the calculated position and shape of the machine tool 100 after movement to the interference check unit 853.
　干渉チェック部８５３は、ロボット動作演算部８５２から移動後のロボット６０の位置および形状を受け付けると、移動後のロボット６０の位置および形状と、工作機械１００の位置および形状とに基づいて、干渉をチェックする。この場合、干渉チェック部８５３は、干渉の有無を手動可否判断部４２１Ｒに送る。 When the interference check unit 853 receives the position and shape of the robot 60 after movement from the robot motion calculation unit 852, it causes interference based on the position and shape of the robot 60 after movement and the position and shape of the machine tool 100. To check. In this case, the interference check unit 853 sends the presence / absence of interference to the manual availability determination unit 421R.
　干渉チェック部８５３は、機械動作演算部８５１から移動後の工作機械１００の位置および形状を受け付けると、移動後の工作機械１００の位置および形状と、ロボット６０の位置および形状とに基づいて、干渉をチェックする。この場合、干渉チェック部８５３は、干渉の有無を手動可否判断部３８２Ｍに送る。 When the interference check unit 853 receives the position and shape of the machine tool 100 after movement from the machine operation calculation unit 851, the interference check unit 853 interferes based on the position and shape of the machine tool 100 after movement and the position and shape of the robot 60. Check. In this case, the interference check unit 853 sends the presence / absence of interference to the manual availability determination unit 382M.
　手動可否判断部４２１Ｒは、干渉がある場合は、手動操作不可と判断し、移動データ送信部４２２によるロボットコントローラ５０へのデータ送信を禁止する。手動可否判断部４２１Ｒは、干渉がない場合は、システム状態に基づいて、移動データ送信部４２２によるロボットコントローラ５０へのデータ送信を許可するか否かを判断する。 If there is interference, the manual availability determination unit 421R determines that manual operation is not possible, and prohibits the movement data transmission unit 422 from transmitting data to the robot controller 50. If there is no interference, the manual availability determination unit 421R determines whether or not to allow the mobile data transmission unit 422 to transmit data to the robot controller 50 based on the system state.
　手動可否判断部３８２Ｍは、干渉がある場合は、手動操作不可と判断し、補間処理部３８による加減速処理部３９へのデータ送信を禁止する。手動可否判断部３８２Ｍは、干渉がない場合は、システム状態に基づいて、補間処理部３８による加減速処理部３９へのデータ送信を許可するかを判断する。干渉チェック部８５３は、干渉がある場合は、画面処理部３１を介して表示部４に干渉アラームを表示させてもよい。 If there is interference, the manual availability determination unit 382M determines that manual operation is not possible, and prohibits the interpolation processing unit 38 from transmitting data to the acceleration / deceleration processing unit 39. If there is no interference, the manual availability determination unit 382M determines whether to allow the interpolation processing unit 38 to transmit data to the acceleration / deceleration processing unit 39 based on the system state. If there is interference, the interference check unit 853 may display an interference alarm on the display unit 4 via the screen processing unit 31.
　図２０は、実施の形態４にかかる数値制御装置が備える表示部で表示される干渉アラームの例を示す図である。表示部４は、干渉アラームとして、「手動操作による干渉発生のため移動不可」といったメッセージを画面上に表示する。 FIG. 20 is a diagram showing an example of an interference alarm displayed on a display unit included in the numerical control device according to the fourth embodiment. The display unit 4 displays a message such as "cannot move due to interference caused by manual operation" on the screen as an interference alarm.
　ところで、手動操作がロボット６０への手動操作であった場合、干渉回避処理部８５４は、ロボット６０の姿勢を変えることで干渉を回避することが可能な場合がある。例えば、ユーザが、軸選択スイッチ５９でロボット６０の直線軸を指定して直線軸を移動させる場合、ロボット６０の姿勢によっては、干渉を回避可能な場合がある。そのため、干渉チェック部８５３にて干渉があると判断された場合、干渉回避処理部８５４は、姿勢を変更することで干渉回避が可能か否かを判断する。干渉回避が可能な場合、干渉回避処理部８５４は、手動可否判断部４２１Ｒに手動操作可能であることを通知するとともに、姿勢を変更した移動データを手動可否判断部４２１Ｒに送信する。干渉回避処理部８５４は、干渉回避処理部８０４と同様の方法によって、ロボット６０の姿勢を変更する移動データを算出する。 By the way, when the manual operation is a manual operation on the robot 60, the interference avoidance processing unit 854 may be able to avoid the interference by changing the posture of the robot 60. For example, when the user specifies the linear axis of the robot 60 with the axis selection switch 59 and moves the linear axis, interference may be avoided depending on the posture of the robot 60. Therefore, when the interference check unit 853 determines that there is interference, the interference avoidance processing unit 854 determines whether or not interference avoidance is possible by changing the posture. When interference avoidance is possible, the interference avoidance processing unit 854 notifies the manual propriety determination unit 421R that the manual operation is possible, and transmits the movement data whose posture has been changed to the manual propriety determination unit 421R. The interference avoidance processing unit 854 calculates the movement data for changing the posture of the robot 60 by the same method as the interference avoidance processing unit 804.
　つぎに、数値制御装置１Ｌによる干渉回避の方法について説明する。図２１は、実施の形態４にかかる数値制御装置によって実行される干渉回避の動作例を説明するための図である。数値制御装置１Ｌは、例えば、ロボット６０の姿勢変更によって干渉を回避する。図２１の左側に示すロボット６０は、ロボットアーム２１が搬送物７に衝突した状態を示し、図２１の右側に示すロボット６０は、ロボットアーム２１が搬送物７に衝突ないようロボット６０の軸の角度を変更した状態を示している。 Next, a method of avoiding interference by the numerical control device 1L will be described. FIG. 21 is a diagram for explaining an operation example of interference avoidance executed by the numerical control device according to the fourth embodiment. The numerical control device 1L avoids interference by changing the posture of the robot 60, for example. The robot 60 shown on the left side of FIG. 21 shows a state in which the robot arm 21 collides with the conveyed object 7, and the robot 60 shown on the right side of FIG. 21 shows the axis of the robot 60 so that the robot arm 21 does not collide with the conveyed object 7. It shows the state where the angle is changed.
　ユーザが、ロボット６０を手動で直交座標系の軸方向に対して移動させる指令を出している際に、干渉回避処理部８５４が、次の指令で干渉すると判断した場合、干渉回避処理部８５４は、姿勢を変えることによって干渉を回避できるか否かをチェックする。具体的には、干渉回避処理部８５４は、ロボットハンド２２の先端位置および姿勢が姿勢変更の前後で変わらないよう、ロボット６０の軸Ａ１，Ａ２，Ａ３の角度を算出し、算出した角度の姿勢で干渉するか否かをチェックする。 If the user manually issues a command to move the robot 60 in the axial direction of the Cartesian coordinate system and the interference avoidance processing unit 854 determines that the robot 60 will interfere with the next command, the interference avoidance processing unit 854 will perform the interference avoidance processing unit 854. , Check if interference can be avoided by changing the posture. Specifically, the interference avoidance processing unit 854 calculates the angles of the axes A1, A2, and A3 of the robot 60 so that the tip position and posture of the robot hand 22 do not change before and after the posture change, and the posture of the calculated angles. Check if it interferes with.
　ロボット６０の軸のうち、台座２３に接合されている第１のロボットアームの軸が軸Ａ１であり、第１のロボットアームに接合されている第２のロボットアームの軸が軸Ａ２であり、第２のロボットアームに接合されている第３のロボットアームの軸が軸Ａ３である。 Of the axes of the robot 60, the axis of the first robot arm joined to the pedestal 23 is the axis A1, and the axis of the second robot arm joined to the first robot arm is the axis A2. The axis of the third robot arm joined to the second robot arm is the axis A3.
　図２１では、軸Ａ１，Ａ２の角度が変更された場合を示している。干渉回避処理部８５４は、軸Ａ３の角度を変更しないことによって、ロボットハンド２２の先端位置および姿勢を姿勢変更の前後で変わらないようにしつつ、干渉を回避できる姿勢を算出する。 FIG. 21 shows a case where the angles of the axes A1 and A2 are changed. The interference avoidance processing unit 854 calculates a posture that can avoid interference while keeping the tip position and posture of the robot hand 22 unchanged before and after the posture change by not changing the angle of the axis A3.
　干渉する場合、干渉回避処理部８５４は、軸Ａ１，Ａ２，Ａ３の角度を再度算出する処理と、干渉するか否かをチェックする処理とを繰り返す。干渉しない軸Ａ１，Ａ２，Ａ３の角度を算出できた場合のみ干渉回避が可能となる。 In the case of interference, the interference avoidance processing unit 854 repeats the process of recalculating the angles of the axes A1, A2 and A3 and the process of checking whether or not they interfere. Interference can be avoided only when the angles of the axes A1, A2, and A3 that do not interfere can be calculated.
　つぎに、数値制御装置１Ｌによる干渉チェックおよび干渉回避の処理手順について説明する。図２２は、実施の形態４にかかる数値制御装置による干渉チェックおよび干渉回避の処理手順を示すフローチャートである。 Next, the processing procedure of interference check and interference avoidance by the numerical control device 1L will be described. FIG. 22 is a flowchart showing a processing procedure of interference check and interference avoidance by the numerical control device according to the fourth embodiment.
　数値制御装置１Ｌは、手動操作が行われた際に、工作機械１００またはロボット６０に対して手動操作に対応する実際の動作を実行する前に、干渉の有無を判断し、干渉が無い場合には、工作機械１００またはロボット６０に対して手動操作に対応する実際の動作を実行させる。 When the manual operation is performed, the numerical control device 1L determines the presence or absence of interference before performing the actual operation corresponding to the manual operation on the machine tool 100 or the robot 60, and when there is no interference. Causes the machine tool 100 or the robot 60 to perform an actual operation corresponding to a manual operation.
　解析処理部３７は、手動操作を解析する（ステップＳ３１０）。具体的には、解析処理部３７は、切替スイッチ１５から送られてくる情報に基づいて、手動操作に対応する移動対象がロボット６０であるか工作機械１００であるかを解析する。また、解析処理部３７は、入力操作部３から送られてくる情報に基づいて、手動操作に対応する移動対象がロボット６０の構成要素であるか工作機械１００の構成要素であるかを解析する。また、解析処理部３７は、ジョグボタン５７または手動ハンドル５５から送られてくる操作情報を解析する。 The analysis processing unit 37 analyzes the manual operation (step S310). Specifically, the analysis processing unit 37 analyzes whether the moving target corresponding to the manual operation is the robot 60 or the machine tool 100 based on the information sent from the changeover switch 15. Further, the analysis processing unit 37 analyzes whether the moving target corresponding to the manual operation is a component of the robot 60 or a component of the machine tool 100 based on the information sent from the input operation unit 3. .. Further, the analysis processing unit 37 analyzes the operation information sent from the jog button 57 or the manual handle 55.
　解析処理部３７は、移動対象が工作機械１００であるか否かを判断する。すなわち、解析処理部３７は、手動操作が工作機械１００の構成要素の移動に対応するか否かを判断する（ステップＳ３２０）。移動対象が工作機械１００の構成要素であった場合（ステップＳ３２０、Ｙｅｓ）、解析処理部３７は、記憶部３４および補間処理部３８を介して、機械動作演算部８５１に移動対象および移動量を送る。機械動作演算部８５１は、移動対象、移動量、機械モデル８１１、および工具データ８１３に基づいて、工作機械１００の手動操作に応じた移動後の位置および形状を算出する。 The analysis processing unit 37 determines whether or not the moving target is the machine tool 100. That is, the analysis processing unit 37 determines whether or not the manual operation corresponds to the movement of the components of the machine tool 100 (step S320). When the movement target is a component of the machine tool 100 (step S320, Yes), the analysis processing unit 37 transfers the movement target and the movement amount to the machine operation calculation unit 851 via the storage unit 34 and the interpolation processing unit 38. send. The machine motion calculation unit 851 calculates the position and shape of the machine tool 100 after movement according to the manual operation, based on the movement target, the movement amount, the machine model 811 and the tool data 813.
　干渉チェック部８５３は、ロボット６０との干渉をチェックする（ステップＳ３３０）。すなわち、干渉チェック部８５３は、手動操作によって移動した場合の工作機械１００が、ロボット６０に干渉するか否かを判断する。具体的には、干渉チェック部８５３は、移動後の工作機械１００の位置および形状と、ロボット６０の位置および形状とに基づいて、工作機械１００がロボット６０に干渉するか否かを判断する。このとき、干渉チェック部８５３は、ロボット６０の位置および形状を、ロボットモデル８１２および工具データ８１４に基づいて算出する。また、干渉チェック部８５３は、移動後の工作機械１００の位置および形状を、機械モデル８１１、工具データ８１３、移動対象、および移動量に基づいて算出する。 The interference check unit 853 checks for interference with the robot 60 (step S330). That is, the interference check unit 853 determines whether or not the machine tool 100 when moved by manual operation interferes with the robot 60. Specifically, the interference check unit 853 determines whether or not the machine tool 100 interferes with the robot 60 based on the position and shape of the machine tool 100 after movement and the position and shape of the robot 60. At this time, the interference check unit 853 calculates the position and shape of the robot 60 based on the robot model 812 and the tool data 814. Further, the interference check unit 853 calculates the position and shape of the machine tool 100 after movement based on the machine model 811, the tool data 813, the movement target, and the movement amount.
　干渉チェック部８５３は、干渉すると判断した場合には（ステップＳ３４０、Ｙｅｓ）、手動可否判断部３８２Ｍに工作機械１００の移動不可を通知する（ステップＳ３６０）。また、干渉チェック部８５３は、工作機械１００が備える軸を停止させ、干渉アラームを表示部４に表示させる。 When the interference check unit 853 determines that it interferes (step S340, Yes), it notifies the manual availability determination unit 382M that the machine tool 100 cannot be moved (step S360). Further, the interference check unit 853 stops the shaft included in the machine tool 100 and displays an interference alarm on the display unit 4.
　干渉チェック部８５３は、干渉しないと判断した場合には（ステップＳ３４０、Ｎｏ）、手動可否判断部３８２Ｍに工作機械１００の移動可能を通知する（ステップＳ３５０）。この場合、補間処理部３８は、システム状態に異常が無ければ、移動対象および移動量に基づいて、工作機械１００を制御するためのデータを生成し、加減速処理部３９に送る。これにより、工作機械１００が手動操作に従って制御される。 When the interference check unit 853 determines that there is no interference (step S340, No), the interference check unit 853 notifies the manual availability determination unit 382M that the machine tool 100 can be moved (step S350). In this case, if there is no abnormality in the system state, the interpolation processing unit 38 generates data for controlling the machine tool 100 based on the movement target and the movement amount, and sends the data to the acceleration / deceleration processing unit 39. As a result, the machine tool 100 is controlled according to a manual operation.
　移動対象がロボット６０の構成要素であった場合（ステップＳ３２０、Ｎｏ）、解析処理部３７は、記憶部３４およびロボット手動操作部４１５を介して、ロボット動作演算部８５２に移動対象および移動量を送る。ロボット動作演算部８５２は、移動対象、移動量、ロボットモデル８１２、および工具データ８１４に基づいて、ロボット６０の移動後の位置および形状を算出する。 When the movement target is a component of the robot 60 (step S320, No), the analysis processing unit 37 transmits the movement target and the movement amount to the robot motion calculation unit 852 via the storage unit 34 and the robot manual operation unit 415. send. The robot motion calculation unit 852 calculates the position and shape of the robot 60 after movement based on the movement target, the movement amount, the robot model 812, and the tool data 814.
　干渉チェック部８５３は、工作機械１００との干渉をチェックする（ステップＳ３７０）。すなわち、干渉チェック部８５３は、手動操作によって移動した場合のロボット６０が、工作機械１００に干渉するか否かを判断する。具体的には、干渉チェック部８５３は、移動後のロボット６０の位置および形状と、工作機械１００の位置および形状とに基づいて、ロボット６０が工作機械１００に干渉するか否かを判断する。 The interference check unit 853 checks for interference with the machine tool 100 (step S370). That is, the interference check unit 853 determines whether or not the robot 60, which is moved by manual operation, interferes with the machine tool 100. Specifically, the interference check unit 853 determines whether or not the robot 60 interferes with the machine tool 100 based on the position and shape of the robot 60 after movement and the position and shape of the machine tool 100.
　干渉チェック部８５３は、干渉すると判断した場合には（ステップＳ３８０、Ｙｅｓ）、干渉回避処理部８５４にロボット６０の移動不可を通知する。干渉回避処理部８５４は、ロボット６０の姿勢変更による干渉回避動作を計算する（ステップＳ３９０）。干渉チェック部８５３は、干渉の回避が可能か否かを判断する（ステップＳ４００）。干渉チェック部８５３が干渉の回避が不可能であると判断した場合（ステップＳ４００、Ｎｏ）、干渉チェック部８５３は、手動可否判断部４２１Ｒにロボット６０の移動不可を通知する（ステップＳ４１０）。また、干渉チェック部８５３は、ロボット６０が備える軸を停止させ、干渉アラームを表示部４に表示させる。 When the interference check unit 853 determines that it interferes (step S380, Yes), it notifies the interference avoidance processing unit 854 that the robot 60 cannot move. The interference avoidance processing unit 854 calculates the interference avoidance operation by changing the posture of the robot 60 (step S390). The interference check unit 853 determines whether or not interference can be avoided (step S400). When the interference check unit 853 determines that it is impossible to avoid the interference (step S400, No), the interference check unit 853 notifies the manual propriety determination unit 421R that the robot 60 cannot be moved (step S410). Further, the interference check unit 853 stops the axis included in the robot 60 and causes the display unit 4 to display the interference alarm.
　ステップＳ４００の処理において、干渉チェック部８５３が干渉の回避が可能であると判断した場合（ステップＳ４００、Ｙｅｓ）、干渉チェック部８５３は、手動可否判断部４２１Ｒにロボット６０の移動可能を通知する（ステップＳ４２０）。また、干渉チェック部８５３は、移動データ送信部４２２に干渉回避の動作指令を送る（ステップＳ４３０）。干渉回避の動作指令は、干渉を回避することができるロボット６０への移動データを含んでいる。移動データ送信部４２２は、干渉回避の動作指令に基づいて、ロボット６０に移動データを送る。これにより、ロボット６０が手動操作に従って制御される。 In the process of step S400, when the interference check unit 853 determines that the interference can be avoided (step S400, Yes), the interference check unit 853 notifies the manual propriety determination unit 421R that the robot 60 can be moved (step S400, Yes). Step S420). Further, the interference check unit 853 sends an operation command for avoiding interference to the moving data transmission unit 422 (step S430). The interference avoidance operation command includes movement data to the robot 60 that can avoid interference. The movement data transmission unit 422 sends movement data to the robot 60 based on the operation command for avoiding interference. As a result, the robot 60 is controlled according to the manual operation.
　ステップＳ３８０の処理において、干渉チェック部８５３は、干渉しないと判断した場合には（ステップＳ３８０、Ｎｏ）、手動可否判断部４２１Ｒにロボット６０の移動可能を通知する（ステップＳ４４０）。ロボット制御部４１は、移動対象および移動量を用いて、ロボット６０を制御するためのデータを生成し、ロボットコントローラ５０に送る。これにより、ロボット６０が数値制御装置１Ｌによって制御される。 In the process of step S380, when it is determined that the robot does not interfere (step S380, No), the interference check unit 853 notifies the manual availability determination unit 421R that the robot 60 can be moved (step S440). The robot control unit 41 generates data for controlling the robot 60 using the movement target and the movement amount, and sends the data to the robot controller 50. As a result, the robot 60 is controlled by the numerical control device 1L.
　このように実施の形態４によれば、工作機械１００またはロボット６０への手動操作に対して、工作機械１００とロボット６０との間に干渉が発生するか否かを判断し、干渉する場合には、干渉回避の動作を実行するので、手動操作の際の干渉を回避することができる。 As described above, according to the fourth embodiment, it is determined whether or not interference occurs between the machine tool 100 and the robot 60 with respect to the manual operation of the machine tool 100 or the robot 60, and when the interference occurs. Performs an interference avoidance operation, so that interference during manual operation can be avoided.
実施の形態５．
　つぎに、図２３を用いてこの発明の実施の形態５について説明する。実施の形態５では、機械学習装置が、干渉の有無を学習する。 Embodiment 5.
Next, a fifth embodiment of the present invention will be described with reference to FIG. 23. In the fifth embodiment, the machine learning device learns the presence or absence of interference.
　図２３は、実施の形態５にかかる数値制御装置の構成例を示す図である。図２３の各構成要素のうち数値制御装置１Ｙと同一機能を達成する構成要素については同一符号を付しており、重複する説明は省略する。 FIG. 23 is a diagram showing a configuration example of the numerical control device according to the fifth embodiment. Among the components of FIG. 23, the components that achieve the same function as the numerical control device 1Y are designated by the same reference numerals, and duplicate description will be omitted.
　数値制御装置１Ｍは、数値制御装置１Ｙと比較して、制御演算部２Ｙの代わりに制御演算部２Ｍを備えている。制御演算部２Ｍは、制御演算部２Ｙが備える構成要素に加えて、機械学習装置７０を備えている。 Compared with the numerical control device 1Y, the numerical control device 1M includes a control calculation unit 2M instead of the control calculation unit 2Y. The control calculation unit 2M includes a machine learning device 70 in addition to the components included in the control calculation unit 2Y.
　機械学習装置７０は、シミュレーション制御部８０Ｙと、解析処理部３７とに接続されている。機械学習装置７０は、シミュレーション位置情報（ｒ）と、ＮＣプログラム情報（ｒ）と、干渉情報（ｒ）とを用いて、工作機械１００とロボット６０の間の干渉の有無を学習する。すなわち、機械学習装置７０は、干渉の有無の推測処理を学習する。 The machine learning device 70 is connected to the simulation control unit 80Y and the analysis processing unit 37. The machine learning device 70 learns the presence or absence of interference between the machine tool 100 and the robot 60 by using the simulation position information (r), the NC program information (r), and the interference information (r). That is, the machine learning device 70 learns the estimation process of the presence or absence of interference.
　シミュレーション位置情報（ｒ）は、シミュレーション制御部８０Ｙが、干渉の有無を判定する際に、シミュレーション用データ３４６を用いて工作機械１００およびロボット６０の位置を算出した位置データである。シミュレーション制御部８０Ｙは、干渉の有無を判定する際には、シミュレーション位置情報（ｒ）を画面処理部３１に送り、干渉の有無を学習する際には、シミュレーション位置情報（ｒ）を機械学習装置７０に送る。 The simulation position information (r) is position data obtained by the simulation control unit 80Y calculating the positions of the machine tool 100 and the robot 60 using the simulation data 346 when determining the presence or absence of interference. The simulation control unit 80Y sends the simulation position information (r) to the screen processing unit 31 when determining the presence / absence of interference, and sends the simulation position information (r) to the machine learning device when learning the presence / absence of interference. Send to 70.
　ＮＣプログラム情報（ｒ）は、干渉の有無が判定される際に、解析処理部３７が用いたＮＣプログラムの情報である。干渉情報（ｒ）は、工作機械１００がロボット６０に衝突するかを示す衝突情報である。干渉情報（ｒ）は、干渉（衝突）の有無を示す情報と、干渉の位置を示す情報と、干渉する構成要素（干渉対象）を示す情報とを含んでいる。 The NC program information (r) is the NC program information used by the analysis processing unit 37 when determining the presence or absence of interference. The interference information (r) is collision information indicating whether the machine tool 100 collides with the robot 60. The interference information (r) includes information indicating the presence or absence of interference (collision), information indicating the position of interference, and information indicating an interfering component (interference target).
　機械学習装置７０は、状態観測部７１と、データ取得部７２と、学習部７３とを含んでいる。状態観測部７１は、シミュレーション位置情報（ｒ）をシミュレーション制御部８０Ｙから取得し、ＮＣプログラム情報（ｒ）を解析処理部３７から取得する。状態観測部７１は、シミュレーション位置情報（ｒ）およびＮＣプログラム情報（ｒ）を状態情報（ｉ）として観測する。状態観測部７１は、データ観測した結果である状態情報（ｉ）を学習部７３に出力する。データ取得部７２は、干渉チェック部８０３から干渉情報（ｒ）を取得する。データ取得部７２は、干渉情報（ｒ）を学習部７３に出力する。 The machine learning device 70 includes a state observation unit 71, a data acquisition unit 72, and a learning unit 73. The state observation unit 71 acquires the simulation position information (r) from the simulation control unit 80Y and the NC program information (r) from the analysis processing unit 37. The state observation unit 71 observes the simulation position information (r) and the NC program information (r) as the state information (i). The state observation unit 71 outputs the state information (i), which is the result of data observation, to the learning unit 73. The data acquisition unit 72 acquires the interference information (r) from the interference check unit 803. The data acquisition unit 72 outputs the interference information (r) to the learning unit 73.
　学習部７３は、状態情報（ｉ）および干渉情報（ｒ）の組み合わせに基づいて作成されるデータセットに基づいて、干渉の有無を推測した情報である干渉推測情報（ｎ）を学習する。ここで、状態変数である状態情報（ｉ）は、シミュレーション位置情報（ｒ）およびＮＣプログラム情報（ｒ）を互いに関連付けたデータである。 The learning unit 73 learns the interference estimation information (n), which is information that estimates the presence or absence of interference, based on the data set created based on the combination of the state information (i) and the interference information (r). Here, the state information (i), which is a state variable, is data in which the simulation position information (r) and the NC program information (r) are associated with each other.
　なお、機械学習装置７０は、数値制御装置１Ｍに設けられるものに限られない。機械学習装置７０は、数値制御装置１Ｍの外部に設けられてもよい。機械学習装置７０は、ネットワークを介して数値制御装置１Ｍに接続可能な装置に設けられてもよい。すなわち、機械学習装置７０は、ネットワークを介して数値制御装置１Ｍに接続された別個のコンポーネントであってもよい。また、機械学習装置７０は、クラウドサーバ上に存在していてもよい。 The machine learning device 70 is not limited to the one provided in the numerical control device 1M. The machine learning device 70 may be provided outside the numerical control device 1M. The machine learning device 70 may be provided in a device that can be connected to the numerical control device 1M via a network. That is, the machine learning device 70 may be a separate component connected to the numerical control device 1M via a network. Further, the machine learning device 70 may exist on the cloud server.
　学習部７３は、例えば、ニューラルネットワークモデルに従って、いわゆる教師あり学習により、シミュレーション位置情報（ｒ）およびＮＣプログラム情報（ｒ）を含んだ状態情報（ｉ）と、教師データである干渉情報（ｒ）とから干渉推測情報（ｎ）を学習する。ここで、教師あり学習とは、ある入力と結果のデータの組を大量に学習装置に与えることで、それらのデータセットにある特徴を学習し、入力から結果を推定するモデルをいう。 The learning unit 73 uses, for example, according to a neural network model, by so-called supervised learning, state information (i) including simulation position information (r) and NC program information (r), and interference information (r) which is supervised data. The interference estimation information (n) is learned from and. Here, supervised learning refers to a model in which a large number of sets of data of a certain input and a result are given to a learning device, features in those data sets are learned, and the result is estimated from the input.
　ニューラルネットワークは、複数のニューロンからなる入力層、複数のニューロンからなる中間層（隠れ層）、および複数のニューロンからなる出力層で構成される。中間層は、１層でもよいし２層以上でもよい。 A neural network is composed of an input layer composed of a plurality of neurons, an intermediate layer (hidden layer) composed of a plurality of neurons, and an output layer composed of a plurality of neurons. The intermediate layer may be one layer or two or more layers.
　例えば、３層のニューラルネットワークであれば、複数の入力が入力層に入力されると、その値に重みを掛けて中間層に入力され、その結果にさらに重みを掛けて出力層から出力される。この出力結果は、各々の重みの値によって変わる。 For example, in the case of a three-layer neural network, when multiple inputs are input to the input layer, the values are weighted and input to the intermediate layer, and the result is further weighted and output from the output layer. .. This output result depends on the value of each weight.
　本実施の形態のニューラルネットワークは、状態情報（ｉ）および干渉情報（ｒ）の組み合わせに基づいて作成されるデータセットに従って、いわゆる教師あり学習により、干渉推測情報（ｎ）を学習結果（推測値）として出力する。 The neural network of the present embodiment learns the interference estimation information (n) by so-called supervised learning according to the data set created based on the combination of the state information (i) and the interference information (r) (estimated value). ) Is output.
　すなわち、ニューラルネットワークは、入力層にシミュレーション位置情報（ｒ）とＮＣプログラム情報（ｒ）とを含んだ状態情報（ｉ）を入力して出力層から出力された結果が、干渉情報（ｒ）に近付くよう、重みを調整することで、干渉推測情報（ｎ）を学習する。 That is, the neural network inputs the state information (i) including the simulation position information (r) and the NC program information (r) into the input layer, and the result output from the output layer becomes the interference information (r). The interference estimation information (n) is learned by adjusting the weights so as to approach each other.
　また、ニューラルネットワークは、いわゆる教師なし学習によって、干渉推測情報（ｎ）を学習することもできる。教師なし学習とは、入力データのみを大量に機械学習装置７０に与えることで、入力データがどのような分布をしているか学習し、対応する教師データ（出力データ）を与えなくても、入力データに対して圧縮、分類、整形等を行い学習する手法である。教師なし学習では、データセットにある特徴を似たもの同士にクラスタリングすること等ができる。教師なし学習では、このクラスタリングの結果を使って、何らかの基準を設けて、この基準を最適にするような出力の割り当てを行うことで、出力の予測を実現することができる。 The neural network can also learn the interference estimation information (n) by so-called unsupervised learning. Unsupervised learning is to give a large amount of input data to the machine learning device 70 to learn how the input data is distributed and input it without giving the corresponding teacher data (output data). It is a method of learning by compressing, classifying, and shaping data. In unsupervised learning, features in a dataset can be clustered into similar ones. In unsupervised learning, the result of this clustering can be used to set some criteria and assign outputs that optimize these criteria to achieve output prediction.
　また、機械学習装置７０は、複数の数値制御装置に対して作成されるデータセットに従って、干渉推測情報（ｎ）を学習結果（推測値）として出力してもよい。なお、機械学習装置７０は、同一の現場で使用される複数の数値制御装置からデータセットを取得してもよいし、或いは、異なる現場で独立して稼働する複数の数値制御装置から収集されるデータセットを利用して干渉推測情報（ｎ）を学習してもよい。さらに、機械学習装置７０は、データセットを収集する数値制御装置を途中で対象に追加し、或いは、逆に対象から切り離すことも可能である。また、ある数値制御装置に関して干渉推測情報（ｎ）を学習した機械学習装置７０を、これとは別の数値制御装置に取り付け、当該別の数値制御装置に関して干渉推測情報（ｎ）を再学習して更新するようにしてもよい。 Further, the machine learning device 70 may output the interference estimation information (n) as a learning result (estimated value) according to the data sets created for the plurality of numerical control devices. The machine learning device 70 may acquire a data set from a plurality of numerical control devices used at the same site, or may be collected from a plurality of numerical control devices operating independently at different sites. Interference estimation information (n) may be learned using a data set. Further, the machine learning device 70 can add a numerical control device for collecting a data set to the target on the way, or conversely, separate it from the target. Further, the machine learning device 70 that has learned the interference estimation information (n) for a certain numerical control device is attached to another numerical control device, and the interference estimation information (n) is relearned for the other numerical control device. You may update it.
　また、機械学習装置７０に用いられる学習アルゴリズムとしては、特徴量そのものの抽出を学習する、深層学習（Deep　Learning）を用いることもできる。また、学習部７３は、他の公知の方法、例えば遺伝的プログラミング、機能論理プログラミング、サポートベクターマシンなどに従って機械学習を実行してもよい。 Further, as a learning algorithm used in the machine learning device 70, deep learning, which learns the extraction of the feature amount itself, can also be used. In addition, the learning unit 73 may execute machine learning according to other known methods such as genetic programming, functional logic programming, and support vector machines.
　機械学習装置７０は、推測した干渉推測情報（ｎ）をシミュレーション制御部８０Ｙに出力する。シミュレーション制御部８０Ｙは、干渉が発生する直前ではなく、干渉の発生が推測されるＮＣプログラムのブロックの前のブロックエンドで工作機械１００を停止させる。干渉が発生する直前で工作機械１００またはロボット６０を停止した場合、工作機械１００またはロボット６０の移動速度によっては、停止に時間がかかり、干渉を起こす場合があるからである。本実施の形態では、シミュレーション制御部８０Ｙが、干渉の発生が推測されるＮＣプログラムのブロックの前のブロックエンドで工作機械１００を停止させるので、干渉を防ぐことができる。 The machine learning device 70 outputs the estimated interference estimation information (n) to the simulation control unit 80Y. The simulation control unit 80Y stops the machine tool 100 at the block end before the block of the NC program in which the interference is presumed to occur, not immediately before the interference occurs. This is because if the machine tool 100 or the robot 60 is stopped immediately before the interference occurs, it may take a long time to stop and the interference may occur depending on the moving speed of the machine tool 100 or the robot 60. In the present embodiment, the simulation control unit 80Y stops the machine tool 100 at the block end before the block of the NC program in which the occurrence of interference is presumed, so that the interference can be prevented.
　このように実施の形態５では、機械学習装置７０が、干渉情報（ｒ）と、シミュレーション位置情報（ｒ）と、ＮＣプログラム情報（ｒ）とを互いに関連付けたデータセットに基づいて、干渉推測情報（ｎ）を学習している。したがって、機械学習装置７０は、状態情報（ｉ）に基づいて、干渉推測情報（ｎ）を算出することが可能となる。 As described above, in the fifth embodiment, the machine learning device 70 uses the interference estimation information based on the data set in which the interference information (r), the simulation position information (r), and the NC program information (r) are associated with each other. (N) is being learned. Therefore, the machine learning device 70 can calculate the interference estimation information (n) based on the state information (i).
実施の形態６．
　つぎに、図２３を用いてこの発明の実施の形態６について説明する。実施の形態６では、実施の形態４で説明した制御演算部２Ｌの動作に機械学習装置７０を適用する。実施の形態６では、実施の形態５と比較して、状態情報（ｉ）に干渉情報（ｒ）が加わり、教師データに干渉情報（ｒ）ではなく干渉回避プログラム情報（ｒ）を用いる。また、実施の形態６では、機械学習装置７０が干渉推測情報（ｎ）ではなく干渉回避推測情報（ｎ）を学習する。 Embodiment 6.
Next, a sixth embodiment of the present invention will be described with reference to FIG. 23. In the sixth embodiment, the machine learning device 70 is applied to the operation of the control calculation unit 2L described in the fourth embodiment. In the sixth embodiment, as compared with the fifth embodiment, the interference information (r) is added to the state information (i), and the interference avoidance program information (r) is used for the teacher data instead of the interference information (r). Further, in the sixth embodiment, the machine learning device 70 learns the interference avoidance estimation information (n) instead of the interference estimation information (n).
　干渉回避プログラム情報（ｒ）は、干渉を回避する際に、干渉回避処理部８０４が用いたＮＣプログラムの情報である。干渉回避推測情報（ｎ）は、干渉を回避するための指令を推測した情報である。 The interference avoidance program information (r) is the information of the NC program used by the interference avoidance processing unit 804 when avoiding the interference. The interference avoidance estimation information (n) is information in which a command for avoiding interference is inferred.
　機械学習装置７０は、シミュレーション位置情報（ｒ）と、ＮＣプログラム情報（ｒ）と、干渉情報（ｒ）とを用いて、干渉回避推測情報（ｎ）を学習する、すなわち、機械学習装置７０は、干渉回避に用いるＮＣプログラムの指令を推測する。 The machine learning device 70 learns the interference avoidance estimation information (n) by using the simulation position information (r), the NC program information (r), and the interference information (r), that is, the machine learning device 70 , Guess the NC program command used to avoid interference.
　本実施の形態の状態観測部７１は、シミュレーション位置情報（ｒ）、ＮＣプログラム情報（ｒ）、および干渉情報（ｒ）を状態情報（ｉ）として観測する。状態観測部７１は、データ観測した結果である状態情報（ｉ）を学習部７３に出力する。 The state observation unit 71 of the present embodiment observes the simulation position information (r), the NC program information (r), and the interference information (r) as the state information (i). The state observation unit 71 outputs the state information (i), which is the result of data observation, to the learning unit 73.
　データ取得部７２は、干渉回避処理部８０４から干渉回避プログラム情報（ｒ）を取得する。データ取得部７２は、干渉回避プログラム情報（ｒ）を学習部７３に出力する。干渉回避処理部８０４は、干渉を回避する際には、干渉回避プログラム情報（ｒ）をロボット制御部４１に送り、干渉の回避を学習する際には、干渉回避プログラム情報（ｒ）を機械学習装置７０に送る。 The data acquisition unit 72 acquires the interference avoidance program information (r) from the interference avoidance processing unit 804. The data acquisition unit 72 outputs the interference avoidance program information (r) to the learning unit 73. The interference avoidance processing unit 804 sends interference avoidance program information (r) to the robot control unit 41 when avoiding interference, and machine learns interference avoidance program information (r) when learning to avoid interference. Send to device 70.
　本実施の形態では、状態観測部７１は、シミュレーション位置情報（ｒ）、ＮＣプログラム情報（ｒ）、および干渉情報（ｒ）を状態情報（ｉ）として観測する。 In the present embodiment, the state observation unit 71 observes the simulation position information (r), the NC program information (r), and the interference information (r) as the state information (i).
　また、本実施の形態の学習部７３は、状態情報（ｉ）および教師データである干渉回避プログラム情報（ｒ）の組み合わせに基づいて作成されるデータセットに基づいて、干渉回避推測情報（ｎ）を学習する。ここで、データセットは、状態変数である状態情報（ｉ）および干渉回避プログラム情報（ｒ）を互いに関連付けたデータである。 Further, the learning unit 73 of the present embodiment has interference avoidance estimation information (n) based on a data set created based on a combination of state information (i) and interference avoidance program information (r) which is teacher data. To learn. Here, the data set is data in which the state information (i) and the interference avoidance program information (r), which are state variables, are associated with each other.
　本実施の形態でも学習部７３は、例えば、ニューラルネットワークモデルに従って、いわゆる教師あり学習により、状態情報（ｉ）と干渉回避プログラム情報（ｒ）を互いに関連付けたデータセットから干渉回避推測情報（ｎ）を学習する。 Also in this embodiment, the learning unit 73 uses, for example, according to a neural network model, by so-called supervised learning, the interference avoidance estimation information (n) from a data set in which the state information (i) and the interference avoidance program information (r) are associated with each other. To learn.
　すなわち、ニューラルネットワークは、入力層にシミュレーション位置情報（ｒ）とＮＣプログラム情報（ｒ）と干渉情報（ｒ）と含んだ状態情報（ｉ）を入力して出力層から出力された結果が、干渉回避プログラム情報（ｒ）に近付くよう、重みを調整することで、干渉回避推測情報（ｎ）を学習する。本実施の形態のニューラルネットワークは、いわゆる教師あり学習により、干渉回避推測情報（ｎ）を学習結果（推測した指令）として出力する。 That is, in the neural network, the state information (i) including the simulation position information (r), the NC program information (r), and the interference information (r) is input to the input layer, and the result output from the output layer interferes. The interference avoidance estimation information (n) is learned by adjusting the weight so as to approach the avoidance program information (r). The neural network of the present embodiment outputs interference avoidance guess information (n) as a learning result (guessed command) by so-called supervised learning.
　また、本実施の形態のニューラルネットワークは、いわゆる教師なし学習によって、干渉回避推測情報（ｎ）を学習することもできる。 Further, the neural network of the present embodiment can also learn the interference avoidance guessing information (n) by so-called unsupervised learning.
　また、機械学習装置７０は、複数の数値制御装置に対して作成されるデータセットに従って、干渉回避推測情報（ｎ）を学習結果（推測値）として出力してもよい。また、ある数値制御装置に関して干渉回避推測情報（ｎ）を学習した機械学習装置７０を、これとは別の数値制御装置に取り付け、当該別の数値制御装置に関して干渉回避推測情報（ｎ）を再学習して更新するようにしてもよい。 Further, the machine learning device 70 may output the interference avoidance estimation information (n) as a learning result (estimated value) according to the data sets created for the plurality of numerical control devices. Further, the machine learning device 70 that has learned the interference avoidance estimation information (n) for a certain numerical control device is attached to another numerical control device, and the interference avoidance estimation information (n) is regenerated for the other numerical control device. You may learn and update.
　また、干渉回避制御部８１は、干渉が発生する直前ではなく、干渉の発生が推測されるＮＣプログラムのブロックの前のブロックに干渉回避推測情報に対応する指令を挿入する。干渉回避推測情報に対応する指令は、干渉を回避させることができるＮＣプログラムの指令である。これにより、干渉回避制御部８１は、工作機械１００とロボット６０との間の干渉を事前に回避することができる。 Further, the interference avoidance control unit 81 inserts a command corresponding to the interference avoidance estimation information in the block before the block of the NC program in which the interference is estimated to occur, not immediately before the interference occurs. The command corresponding to the interference avoidance guess information is an NC program command capable of avoiding interference. As a result, the interference avoidance control unit 81 can avoid interference between the machine tool 100 and the robot 60 in advance.
　このように実施の形態６では、機械学習装置７０が、干渉情報（ｒ）と、シミュレーション位置情報（ｒ）と、ＮＣプログラム情報（ｒ）と、干渉回避プログラム情報（ｒ）とを互いに関連付けたデータセットに基づいて、干渉回避推測情報（ｎ）を学習している。したがって、機械学習装置７０は、状態情報（ｉ）に基づいて、干渉回避プログラム情報（ｎ）を算出することが可能となる。 As described above, in the sixth embodiment, the machine learning device 70 associates the interference information (r), the simulation position information (r), the NC program information (r), and the interference avoidance program information (r) with each other. The interference avoidance estimation information (n) is learned based on the data set. Therefore, the machine learning device 70 can calculate the interference avoidance program information (n) based on the state information (i).
　なお、実施の形態１から６の内容を組み合わせてもよい。例えば、数値制御装置１Ｘ～１Ｚの少なくとも１つが、ロボット手動操作部４１５を備えていてもよい。また、数値制御装置１Ｘ～１Ｚの少なくとも１つが、機械学習装置７０を備えていてもよい。 Note that the contents of the first to sixth embodiments may be combined. For example, at least one of the numerical control devices 1X to 1Z may include a robot manual operation unit 415. Further, at least one of the numerical control devices 1X to 1Z may include a machine learning device 70.
　ここで、制御演算部２Ｘ，２Ｙ，２Ｚ，２Ｌ，２Ｍのハードウェア構成について説明する。図２４は、実施の形態にかかる数値制御装置が備える制御演算部のハードウェア構成例を示す図である。なお、制御演算部２Ｘ，２Ｙ，２Ｚ，２Ｌ，２Ｍは、同様のハードウェア構成を有しているので、ここでは制御演算部２Ｘのハードウェア構成について説明する。 Here, the hardware configuration of the control calculation unit 2X, 2Y, 2Z, 2L, 2M will be described. FIG. 24 is a diagram showing a hardware configuration example of a control calculation unit included in the numerical control device according to the embodiment. Since the control calculation unit 2X, 2Y, 2Z, 2L, and 2M have the same hardware configuration, the hardware configuration of the control calculation unit 2X will be described here.
　制御演算部２Ｘは、図２４に示したプロセッサ３０１、メモリ３０２、およびインタフェース回路３０３により実現することができる。プロセッサ３０１の例は、ＣＰＵ（Central　Processing　Unit、中央処理装置、処理装置、演算装置、マイクロプロセッサ、マイクロコンピュータ、プロセッサ、ＤＳＰ（Digital　Signal　Processor）ともいう）またはシステムＬＳＩ（Large　Scale　Integration）である。メモリ３０２の例は、ＲＡＭ（Random　Access　Memory）、ＲＯＭ（Read　Only　Memory）である。 The control calculation unit 2X can be realized by the processor 301, the memory 302, and the interface circuit 303 shown in FIG. 24. An example of the processor 301 is a CPU (Central Processing Unit, central processing unit, processing unit, arithmetic unit, microprocessor, microcomputer, processor, DSP (Digital Signal Processor)) or system LSI (Large Scale Integration). Examples of the memory 302 are RAM (Random Access Memory) and ROM (Read Only Memory).
　制御演算部２Ｘは、プロセッサ３０１が、メモリ３０２で記憶されている、制御演算部２Ｘの動作を実行するためのプログラムを読み出して実行することにより実現される。また、このプログラムは、制御演算部２Ｘの手順または方法をコンピュータに実行させるものであるともいえる。メモリ３０２は、プロセッサ３０１が各種処理を実行する際の一時メモリにも使用される。 The control calculation unit 2X is realized by the processor 301 reading and executing a program stored in the memory 302 for executing the operation of the control calculation unit 2X. It can also be said that this program causes the computer to execute the procedure or method of the control calculation unit 2X. The memory 302 is also used as a temporary memory when the processor 301 executes various processes.
　なお、制御演算部２Ｘの機能について、一部を専用のハードウェアで実現し、一部をソフトウェアまたはファームウェアで実現するようにしてもよい。また、機械学習装置７０を、図２４に示したハードウェアで実現してもよい。 Note that some of the functions of the control calculation unit 2X may be realized by dedicated hardware, and some may be realized by software or firmware. Further, the machine learning device 70 may be realized by the hardware shown in FIG. 24.
　以上の実施の形態に示した構成は、本発明の内容の一例を示すものであり、別の公知の技術と組み合わせることも可能であるし、本発明の要旨を逸脱しない範囲で、構成の一部を省略、変更することも可能である。 The configuration shown in the above-described embodiment shows an example of the content of the present invention, can be combined with another known technique, and is one of the configurations without departing from the gist of the present invention. It is also possible to omit or change the part.
　１Ｌ，１Ｍ，１Ｘ～１Ｚ　数値制御装置、２Ｌ，２Ｍ，２Ｘ～２Ｚ　制御演算部、３　入力操作部、４　表示部、５ａ，５ｂ　加工ワーク、６ａ～６ｃ　工具、７　搬送物、１１ａ，１１ｂ　工具ホルダ、１２ａ，１２ｂ　チャック機構、１４　筐体、１５　切替スイッチ、２１　ロボットアーム、２２　ロボットハンド、２３　台座、３０　ローダ、３１　画面処理部、３４　記憶部、３７　解析処理部、３８　補間処理部、３９　加減速処理部、４０　軸データ出力部、４１，４１Ｌ　ロボット制御部、５０　ロボットコントローラ、５３　操作盤、５５　手動ハンドル、５７　ジョグボタン、５９　軸選択スイッチ、６０　ロボット、７０　機械学習装置、７１　状態観測部、７２　データ取得部、７３　学習部、８０Ｘ～８０Ｚ　シミュレーション制御部、８１　干渉回避制御部、９０　駆動部、１００　工作機械、１３０～１３５　画面、３０１　プロセッサ、３０２　メモリ、３０３　インタフェース回路、３４１　パラメータ記憶エリア、３４３　ＮＣプログラム記憶エリア、３４４　表示データ記憶エリア、３４５　共有エリア、３４６　シミュレーション用データ、３７１　ロボット指令解析部、３８２Ｍ，４２１Ｒ　手動可否判断部、４１５　ロボット手動操作部、４２２　移動データ送信部、８０１，８５１　機械動作演算部、８０２，８５２　ロボット動作演算部、８０３，８５３　干渉チェック部、８０４，８５４　干渉回避処理部、８０５　移動軌跡演算部、８０６　ワーク位置演算部、８０７　ワーク形状演算部、８１１　機械モデル、８１２　ロボットモデル、８１３，８１４　工具データ、８１５　ワークデータ、Ｐ１　ロボット経由点、Ｐ２　面取り位置。 1L, 1M, 1X-1Z numerical control device, 2L, 2M, 2X-2Z control calculation unit, 3 input operation unit, 4 display unit, 5a, 5b machining work, 6a-6c tool, 7 transported object, 11a, 11b tool Holder, 12a, 12b chuck mechanism, 14 housing, 15 changeover switch, 21 robot arm, 22 robot hand, 23 pedestal, 30 loader, 31 screen processing unit, 34 storage unit, 37 analysis processing unit, 38 interpolation processing unit, 39 Acceleration / deceleration processing unit, 40-axis data output unit, 41, 41L robot control unit, 50 robot controller, 53 operation panel, 55 manual handle, 57 jog button, 59 axis selection switch, 60 robot, 70 machine learning device, 71 state observation Unit, 72 data acquisition unit, 73 learning unit, 80X-80Z simulation control unit, 81 interference avoidance control unit, 90 drive unit, 100 machine machine, 130-135 screen, 301 processor, 302 memory, 303 interface circuit, 341 parameter storage Area, 343 NC program storage area, 344 display data storage area, 345 shared area, 346 simulation data, 371 robot command analysis unit, 382M, 421R manual availability judgment unit, 415 robot manual operation unit, 422 mobile data transmission unit, 801 , 851 Machine motion calculation unit, 802,852 Robot motion calculation unit, 803, 853 Interference check unit, 804,854 Interference avoidance processing unit, 805 Movement locus calculation unit, 806 Work position calculation unit, 807 Work shape calculation unit, 811 Machine Model, 812 robot model, 833,814 tool data, 815 work data, P1 robot waypoint, P2 chamfering position.

Claims (10)

  1. 　工作機械の動作シミュレーション用のデータである機械モデルと前記工作機械が備える第１の構成要素の位置を制御する際に用いられる第１の位置データとを用いて、特定タイミングにおける前記第１の構成要素の位置を算出する機械動作演算部と、
    　ロボットの動作シミュレーション用のデータであるロボットモデルと前記ロボットが備える第２の構成要素の位置を制御する際に用いられる第２の位置データとを用いて前記特定タイミングにおける前記第２の構成要素の位置を算出するロボット動作演算部と、
    　前記第１の構成要素の位置および前記第２の構成要素の位置に基づいて、前記工作機械と前記ロボットとが衝突するか否かを判断する衝突判断部を有することを特徴とする数値制御装置。     The first configuration at a specific timing is used by using a machine model which is data for motion simulation of a machine tool and first position data used when controlling the position of a first component included in the machine tool. Machine tool operation calculation unit that calculates the position of the element,
    Using the robot model, which is data for robot motion simulation, and the second position data used when controlling the position of the second component included in the robot, the second component at the specific timing The robot motion calculation unit that calculates the position and
    A numerical control device having a collision determination unit that determines whether or not the machine tool and the robot collide with each other based on the position of the first component and the position of the second component. ..
  2. 　前記機械動作演算部は、前記工作機械の描画用のデータおよび前記第１の位置データを用いて、前記第１の構成要素を描画し、
    　前記ロボット動作演算部は、前記ロボットの描画用のデータおよび前記第２の位置データを用いて、前記第２の構成要素を描画する、
    　ことを特徴とする請求項１に記載の数値制御装置。     The machine operation calculation unit draws the first component by using the drawing data of the machine tool and the first position data.
    The robot motion calculation unit draws the second component by using the drawing data of the robot and the second position data.
    The numerical control device according to claim 1.
  3. 　前記工作機械と前記ロボットとが衝突する場合に、前記衝突を発生させる前記ロボットへの移動指令を前記ロボットの姿勢を変更する指令に置き換えること、前記移動指令よりも前に前記ロボットの経路変更を行う指令である経路変更指令を挿入すること、および前記移動指令の直前に待機指令を挿入することの少なくとも１つを実行することで、前記衝突を回避させる干渉回避処理部をさらに有する、
    　ことを特徴とする請求項１または２に記載の数値制御装置。     When the machine tool and the robot collide, the movement command to the robot that causes the collision is replaced with a command to change the posture of the robot, and the route change of the robot is performed before the movement command. It further has an interference avoidance processing unit that avoids the collision by executing at least one of inserting a route change command which is a command to be executed and inserting a standby command immediately before the movement command.
    The numerical control device according to claim 1 or 2.
  4. 　前記工作機械が用いる第１の工具の第１の移動軌跡および前記ロボットが用いる第２の工具の第２の移動軌跡を演算する移動軌跡演算部と、
    　前記工作機械および前記ロボットが加工する加工物の形状から、前記第１の工具および前記第２の工具が通過した箇所を除外した形状を演算して、前記加工物の加工後の形状を描画する加工後形状演算部と、
    　をさらに有することを特徴とする請求項１から３の何れか１つに記載の数値制御装置。     A movement locus calculation unit that calculates a first movement locus of the first tool used by the machine tool and a second movement locus of the second tool used by the robot, and a movement locus calculation unit.
    The shape of the machine tool and the workpiece processed by the robot is calculated by excluding the portion where the first tool and the second tool have passed, and the shape of the workpiece after machining is drawn. Post-processing shape calculation unit and
    The numerical control device according to any one of claims 1 to 3, further comprising.
  5. 　前記機械動作演算部は、前記工作機械への手動操作に対応する前記第１の構成要素の移動量に基づいて、前記第１の構成要素の位置および形状を算出し、
    　前記ロボット動作演算部は、前記ロボットへの手動操作に対応する前記第２の構成要素の移動量に基づいて、前記第２の構成要素の位置および形状を算出し、
    　前記衝突判断部は、前記第１の構成要素の位置および形状と、前記第２の構成要素の位置および形状とに基づいて、前記工作機械と前記ロボットとが衝突するか否かを判断する、
    　ことを特徴とする請求項１に記載の数値制御装置。     The machine operation calculation unit calculates the position and shape of the first component based on the amount of movement of the first component corresponding to the manual operation on the machine tool.
    The robot motion calculation unit calculates the position and shape of the second component based on the amount of movement of the second component corresponding to the manual operation on the robot.
    The collision determination unit determines whether or not the machine tool and the robot collide with each other based on the position and shape of the first component and the position and shape of the second component.
    The numerical control device according to claim 1.
  6. 　前記工作機械と前記ロボットとが衝突する場合に、前記衝突を発生させる前記ロボットへの移動指令を、衝突を回避可能な姿勢に変更する移動指令に置き換えること、および前記移動指令の直前に待機指令を挿入することの少なくとも１つを実行することで、前記衝突を回避させる干渉回避処理部をさらに有する、
    　ことを特徴とする請求項５に記載の数値制御装置。     When the machine tool collides with the robot, the movement command to the robot that causes the collision is replaced with a movement command that changes the posture so that the collision can be avoided, and a standby command immediately before the movement command. Further includes an interference avoidance processing unit that avoids the collision by executing at least one of the insertion of the above.
    The numerical control device according to claim 5.
  7. 　前記工作機械への指令である機械駆動指令と前記ロボットへの指令であるロボット指令とを含んだ数値制御プログラムを解析する解析処理部と、
    　前記ロボット指令を用いて前記ロボットを制御するロボット制御部と、
    　をさらに有し、
    　前記解析処理部は、解析した指令が前記機械駆動指令であるか前記ロボット指令であるかを判断し、解析した指令が前記ロボット指令である場合、前記ロボット指令の解析結果を前記ロボット制御部に送る、
    　ことを特徴とする請求項１から６の何れか１つに記載の数値制御装置。     An analysis processing unit that analyzes a numerical control program including a machine drive command that is a command to the machine tool and a robot command that is a command to the robot.
    A robot control unit that controls the robot using the robot command,
    Have more
    The analysis processing unit determines whether the analyzed command is the machine drive command or the robot command, and when the analyzed command is the robot command, the analysis result of the robot command is sent to the robot control unit. send,
    The numerical control device according to any one of claims 1 to 6, wherein the numerical control device is characterized.
  8. 　前記第１の構成要素には、前記工作機械が用いる工具を含み、
    　前記第２の構成要素には、前記ロボットが用いる工具を含む、
    　ことを特徴とする請求項１から７の何れか１つに記載の数値制御装置。     The first component includes tools used by the machine tool.
    The second component includes tools used by the robot.
    The numerical control device according to any one of claims 1 to 7, wherein the numerical control device is characterized.
  9. 　工作機械の動作シミュレーション用のデータである機械モデルと前記工作機械が備える第１の構成要素の位置を制御する際に用いられる第１の位置データとを用いて算出された特定タイミングにおける前記第１の構成要素の位置、およびロボットの動作シミュレーション用のデータであるロボットモデルと前記ロボットが備える第２の構成要素の位置を制御する際に用いられる第２の位置データとを用いて算出された前記特定タイミングにおける前記第２の構成要素の位置を示すシミュレーション位置情報と、前記工作機械および前記ロボットの制御に用いた加工プログラムの情報である加工プログラム情報とを含む状態変数を観測する状態観測部と、
    　前記工作機械と前記ロボットとが衝突するか否かを示す衝突情報を取得するデータ取得部と、
    　前記状態変数および前記衝突情報の組み合わせに基づいて作成されるデータセットに従って、
    　前記工作機械と前記ロボットとが衝突するか否かを推測した情報である干渉推測情報を学習する学習部と、
    　を備えることを特徴とする機械学習装置。     The first at a specific timing calculated using a machine model which is data for motion simulation of a machine tool and first position data used when controlling the position of a first component included in the machine machine. The robot model, which is data for simulating the movement of the robot, and the second position data used for controlling the position of the second component included in the robot. A state observing unit that observes state variables including simulation position information indicating the position of the second component at a specific timing and machining program information that is machining program information used for controlling the machine tool and the robot. ,
    A data acquisition unit that acquires collision information indicating whether or not the machine tool and the robot collide with each other.
    According to the dataset created based on the combination of the state variables and the collision information
    A learning unit that learns interference estimation information, which is information that estimates whether or not the machine tool and the robot collide with each other.
    A machine learning device characterized by being equipped with.
  10. 　工作機械の動作シミュレーション用のデータである機械モデルと前記工作機械が備える第１の構成要素の位置を制御する際に用いられる第１の位置データとを用いて算出された特定タイミングにおける前記第１の構成要素の位置、およびロボットの動作シミュレーション用のデータであるロボットモデルと前記ロボットが備える第２の構成要素の位置を制御する際に用いられる第２の位置データとを用いて算出された前記特定タイミングにおける前記第２の構成要素の位置を示すシミュレーション位置情報と、前記工作機械および前記ロボットの制御に用いた加工プログラムの情報である加工プログラム情報と、前記工作機械と前記ロボットとが衝突するか否かを示す衝突情報とを含む状態変数を観測する状態観測部と、
    　前記工作機械と前記ロボットとが衝突する場合に、前記工作機械と前記ロボットとを衝突させない加工プログラムの情報である回避プログラム情報を取得するデータ取得部と、
    　前記状態変数および前記回避プログラム情報の組み合わせに基づいて作成されるデータセットに従って、
    　前記工作機械と前記ロボットとを衝突させない加工プログラムの情報を推測した情報である干渉回避推測情報を学習する学習部と、
    　を備えることを特徴とする機械学習装置。     The first at a specific timing calculated using a machine model which is data for motion simulation of a machine tool and first position data used when controlling the position of a first component included in the machine machine. The robot model, which is data for simulating the movement of the robot, and the second position data used for controlling the position of the second component included in the robot. The simulation position information indicating the position of the second component at a specific timing, the machining program information which is the information of the machining program used to control the machine tool and the robot, and the machine tool and the robot collide with each other. A state observation unit that observes state variables including collision information indicating whether or not it is present,
    A data acquisition unit that acquires avoidance program information, which is information on a machining program that does not cause the machine tool to collide with the robot when the machine tool and the robot collide with each other.
    According to the dataset created based on the combination of the state variables and the avoidance program information.
    A learning unit that learns interference avoidance guessing information, which is information that guesses information on a machining program that does not cause the machine tool to collide with the robot.
    A machine learning device characterized by being equipped with.
PCT/JP2019/036198 2019-09-13 2019-09-13 Numerical control device and machine learning device WO2021049028A1 (en)

Priority Applications (4)

Application Number Priority Date Filing Date Title
PCT/JP2019/036198 WO2021049028A1 (en) 2019-09-13 2019-09-13 Numerical control device and machine learning device
DE112019007579.9T DE112019007579B4 (en) 2019-09-13 2019-09-13 Numerical control device and machine learning device
JP2020552910A JP6914452B1 (en) 2019-09-13 2019-09-13 Numerical control device and machine learning device
CN201980100202.4A CN114365047B (en) 2019-09-13 2019-09-13 Numerical control device and machine learning device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2019/036198 WO2021049028A1 (en) 2019-09-13 2019-09-13 Numerical control device and machine learning device

Publications (1)

Publication Number Publication Date
WO2021049028A1 true WO2021049028A1 (en) 2021-03-18

Family

ID=74866981

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2019/036198 WO2021049028A1 (en) 2019-09-13 2019-09-13 Numerical control device and machine learning device

Country Status (4)

Country Link
JP (1) JP6914452B1 (en)
CN (1) CN114365047B (en)
DE (1) DE112019007579B4 (en)
WO (1) WO2021049028A1 (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7157281B1 (en) * 2022-04-18 2022-10-19 ファナック株式会社 ROBOT CONTROL DEVICE, NUMERICAL CONTROL SYSTEM AND NUMERIC CONTROL METHOD
US11878424B2 (en) 2021-12-06 2024-01-23 Fanuc Corporation Point set interference check

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07223181A (en) * 1994-02-09 1995-08-22 Yaskawa Electric Corp Interference checking device for manipulator
JP4653836B2 (en) * 2008-12-12 2011-03-16 ファナック株式会社 Simulation device
JP2015160253A (en) * 2014-02-26 2015-09-07 キヤノン株式会社 Trajectory generation method, robot device, program and recording medium

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE10226140A1 (en) * 2002-06-13 2004-01-08 Kuka Roboter Gmbh Method, for preventing collisions between industrial robots and other objects, involves checking predicted path configuration by distance/obstruction algorithms, stopping robot/other objects if collision impending
JP4249794B1 (en) * 2007-10-29 2009-04-08 ファナック株式会社 Control device for robot for workpiece transfer
JP4902816B1 (en) * 2011-01-26 2012-03-21 三菱電機株式会社 Numerical controller
CN104345687B (en) * 2013-08-09 2017-10-20 中国科学院沈阳计算技术研究所有限公司 A kind of tool sweep volume modeling method
JP6200456B2 (en) * 2015-06-29 2017-09-20 ファナック株式会社 Interference check system between machine tool and robot
JP6517762B2 (en) 2016-08-23 2019-05-22 ファナック株式会社 A robot system that learns the motion of a robot that a human and a robot work together
JP6457469B2 (en) * 2016-12-08 2019-01-23 ファナック株式会社 Mobile robot interference area setting device
CN207432246U (en) * 2017-09-27 2018-06-01 杭州新松机器人自动化有限公司 A kind of mechanical arm collision detecting system
JP6698603B2 (en) * 2017-09-29 2020-05-27 ファナック株式会社 Numerical control system and method for detecting abnormal operation state

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07223181A (en) * 1994-02-09 1995-08-22 Yaskawa Electric Corp Interference checking device for manipulator
JP4653836B2 (en) * 2008-12-12 2011-03-16 ファナック株式会社 Simulation device
JP2015160253A (en) * 2014-02-26 2015-09-07 キヤノン株式会社 Trajectory generation method, robot device, program and recording medium

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US11878424B2 (en) 2021-12-06 2024-01-23 Fanuc Corporation Point set interference check
JP7157281B1 (en) * 2022-04-18 2022-10-19 ファナック株式会社 ROBOT CONTROL DEVICE, NUMERICAL CONTROL SYSTEM AND NUMERIC CONTROL METHOD
WO2023203617A1 (en) * 2022-04-18 2023-10-26 ファナック株式会社 Robot control device, numerical control system, and numerical control method

Also Published As

Publication number Publication date
DE112019007579B4 (en) 2023-11-09
JPWO2021049028A1 (en) 2021-10-07
CN114365047A (en) 2022-04-15
DE112019007579T5 (en) 2022-04-14
JP6914452B1 (en) 2021-08-04
CN114365047B (en) 2023-02-03

Similar Documents

Publication Publication Date Title
CN110394780B (en) Simulation device of robot
JP5436460B2 (en) Industrial robot system
JP2020128009A (en) Method for controlling robot
JP5872894B2 (en) Robot motion teaching support apparatus and method
JP2019532827A (en) Method for collision avoidance motion planning
CN101957610A (en) The cutter path display device of lathe
US20150120036A1 (en) Machine Tool
JP6914452B1 (en) Numerical control device and machine learning device
JP2019188558A (en) Tool selection device and machine learning device
JP7011064B2 (en) Toolpath Virtualization and Optimization Systems, Methods and Equipment
JP2009190113A (en) Robot simulation device
JP7259860B2 (en) ROBOT ROUTE DETERMINATION DEVICE, ROBOT ROUTE DETERMINATION METHOD, AND PROGRAM
KR102205034B1 (en) Display apparatus
US11717965B2 (en) Determination of robot posture
WO2022054245A1 (en) Numerical control apparatus and industrial machine control system
JP6811878B1 (en) Numerical control device and numerical control method
JP7328473B1 (en) CONTROL DEVICE, INDUSTRIAL MACHINE SYSTEM, RUN HISTORY DATA DISPLAY METHOD, AND PROGRAM
JP7448651B2 (en) Offline teaching device and operation program generation method
JP6932618B2 (en) Robot teaching method, robot teaching device, robot system, program and recording medium
JP7232704B2 (en) ROBOT PROGRAM EVALUATION DEVICE, ROBOT PROGRAM EVALUATION METHOD AND ROBOT PROGRAM EVALUATION PROGRAM
US20230249347A1 (en) Path planning during execution of robot control
JP2023062780A (en) Robot data processing server and trajectory data calculation method

Legal Events

Date Code Title Description
ENP Entry into the national phase

Ref document number: 2020552910

Country of ref document: JP

Kind code of ref document: A

121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 19944705

Country of ref document: EP

Kind code of ref document: A1

122 Ep: pct application non-entry in european phase

Ref document number: 19944705

Country of ref document: EP

Kind code of ref document: A1