JP7311732B1 - Numerical controller and numerical control system - Google Patents
Numerical controller and numerical control system Download PDFInfo
- Publication number
- JP7311732B1 JP7311732B1 JP2023525093A JP2023525093A JP7311732B1 JP 7311732 B1 JP7311732 B1 JP 7311732B1 JP 2023525093 A JP2023525093 A JP 2023525093A JP 2023525093 A JP2023525093 A JP 2023525093A JP 7311732 B1 JP7311732 B1 JP 7311732B1
- Authority
- JP
- Japan
- Prior art keywords
- robot
- load
- load estimation
- command
- unit
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000004458 analytical method Methods 0.000 claims abstract description 50
- 230000033001 locomotion Effects 0.000 claims description 73
- 230000005484 gravity Effects 0.000 claims description 15
- 238000000034 method Methods 0.000 claims description 13
- 238000004364 calculation method Methods 0.000 claims description 9
- 230000007274 generation of a signal involved in cell-cell signaling Effects 0.000 abstract description 18
- 230000004044 response Effects 0.000 abstract description 11
- 238000001514 detection method Methods 0.000 description 24
- 238000010586 diagram Methods 0.000 description 19
- 230000000875 corresponding effect Effects 0.000 description 15
- 230000006870 function Effects 0.000 description 14
- 230000005540 biological transmission Effects 0.000 description 11
- 230000001276 controlling effect Effects 0.000 description 9
- 210000004247 hand Anatomy 0.000 description 7
- 238000012545 processing Methods 0.000 description 7
- 230000008569 process Effects 0.000 description 5
- 210000000707 wrist Anatomy 0.000 description 4
- 238000004590 computer program Methods 0.000 description 2
- 239000000284 extract Substances 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004913 activation Effects 0.000 description 1
- 238000007792 addition Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 230000002079 cooperative effect Effects 0.000 description 1
- 238000012217 deletion Methods 0.000 description 1
- 230000037430 deletion Effects 0.000 description 1
- 238000005553 drilling Methods 0.000 description 1
- 230000009977 dual effect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000000227 grinding Methods 0.000 description 1
- 238000001746 injection moulding Methods 0.000 description 1
- 238000003754 machining Methods 0.000 description 1
- 238000003801 milling Methods 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 238000013519 translation Methods 0.000 description 1
Images
Landscapes
- Manipulator (AREA)
Abstract
工作機械のユーザが容易に負荷の情報を設定できる数値制御装置及び数値制御システムを提供する。数値制御プログラムを用いてロボット制御装置を介してロボットを制御する数値制御装置であって、前記数値制御プログラム中のロボット制御指令を解析する解析部と、前記解析部により解析した前記ロボット制御指令に応じて、負荷推定動作のための負荷推定動作信号を生成する負荷推定指令部と、前記負荷推定動作信号を含むロボット指令信号を生成し、前記ロボット制御装置へ送信するロボット指令信号生成部と、を備え、前記ロボット制御装置は、前記負荷推定動作信号に応じて、前記ロボットに負荷推定動作を実行させると共に、前記ロボットにおいて前記負荷推定動作時に検出される外力を測定し、測定した前記外力に基づいて、前記ロボットにおいて負荷の情報を設定するための負荷設定情報を算出し、算出した前記負荷設定情報を前記負荷のパラメータと対応付けて記憶部に記憶する、数値制御装置。Provided are a numerical controller and a numerical control system that allow a user of a machine tool to easily set load information. A numerical controller for controlling a robot via a robot controller using a numerical control program, comprising: an analysis unit for analyzing a robot control command in the numerical control program; a load estimation command unit for generating a load estimation operation signal for a load estimation operation, a robot command signal generation unit for generating a robot command signal including the load estimation operation signal and transmitting the robot command signal to the robot controller; wherein the robot control device causes the robot to perform a load estimation operation in response to the load estimation operation signal, measures an external force detected in the robot during the load estimation operation, and determines the measured external force a numerical control device for calculating load setting information for setting load information in the robot based on the above, and storing the calculated load setting information in a storage unit in association with the load parameter.
Description
本開示は、数値制御装置及び数値制御システムに関する。 The present disclosure relates to numerical controllers and numerical control systems.
従来、人との接触を検知して動作を停止する協働ロボットに関する技術が開示されている。例えば、協働ロボットの接触力を正確に計測するため、保持するワークの負荷情報を設定する技術が開示されている。 Conventionally, there has been disclosed a technology related to a collaborative robot that detects contact with a person and stops moving. For example, a technique for setting load information of a workpiece to be held is disclosed in order to accurately measure the contact force of a collaborative robot.
また、加工現場を自動化するため、工作機械からロボットを操作するシステムに関する技術が開示されている。例えば、工作機械のユーザが慣れ親しんだ数値制御指令を用いてロボットの運転を行う技術が開示されている（例えば、特許文献１参照）。 Also, a technique related to a system for operating a robot from a machine tool has been disclosed in order to automate a machining site. For example, there has been disclosed a technique of operating a robot using numerical control commands familiar to users of machine tools (see, for example, Patent Document 1).
協働ロボットは、負荷を設定する際に、協働ロボットに取り付けられるツールや、協働ロボットのハンドが把持するワーク等を含む負荷の情報（例えば、負荷の重量、負荷の重心位置、負荷のイナーシャ等）から正確な外力を計算する必要がある。 When setting the load, the collaborative robot receives information about the load (for example, the weight of the load, the position of the center of gravity of the load, the position of the center of gravity of the load, It is necessary to calculate an accurate external force from the inertia, etc.).
しかし、負荷の重心位置等のような力学的なパラメータを計算することは、工作機械のユーザにとって難易度が高い。また、協働ロボットの負荷設定に不慣れな工作機械ユーザが、協働ロボットの教示操作盤を用いて正確に負荷の情報を設定するのは困難である。 However, it is very difficult for users of machine tools to calculate dynamic parameters such as the position of the center of gravity of the load. In addition, it is difficult for a machine tool user who is unfamiliar with collaborative robot load settings to accurately set load information using the teaching operation panel of the collaborative robot.
そのため、工作機械のユーザが容易に負荷の情報を設定できる数値制御装置及び数値制御システムが望まれている。 Therefore, there is a demand for a numerical control device and a numerical control system that allow a machine tool user to easily set load information.
本開示の一態様は、数値制御プログラムを用いてロボット制御装置を介してロボットを制御する数値制御装置であって、前記数値制御プログラム中のロボット制御指令を解析する解析部と、前記解析部により解析した前記ロボット制御指令に応じて、負荷推定動作のための負荷推定動作信号を生成する負荷推定指令部と、前記負荷推定動作信号を含むロボット指令信号を生成し、前記ロボット制御装置へ送信するロボット指令信号生成部と、を備え、前記ロボット制御装置は、前記負荷推定動作信号に応じて、前記ロボットに負荷推定動作を実行させると共に、前記ロボットにおいて前記負荷推定動作時に検出される外力を測定し、測定した前記外力に基づいて、前記ロボットにおいて負荷の情報を設定するための負荷設定情報を算出し、算出した前記負荷設定情報を前記負荷のパラメータと対応付けて記憶部に記憶する。 One aspect of the present disclosure is a numerical controller that controls a robot via a robot controller using a numerical control program, comprising: an analysis unit that analyzes a robot control command in the numerical control program; a load estimation command unit that generates a load estimation operation signal for a load estimation operation according to the analyzed robot control command; and a robot command signal that includes the load estimation operation signal, and transmits the robot command signal to the robot control device. and a robot command signal generator, wherein the robot control device causes the robot to perform a load estimation operation according to the load estimation operation signal, and measures an external force detected in the robot during the load estimation operation. Then, based on the measured external force, load setting information for setting load information in the robot is calculated, and the calculated load setting information is associated with the load parameter and stored in a storage unit.
本開示の一態様は、数値制御装置の数値制御プログラムを用いてロボット制御装置を介してロボットを制御する数値制御システムであって、前記数値制御装置は、前記数値制御プログラム中のロボット制御指令を解析する解析部と、前記解析部により解析した前記ロボット制御指令に応じて、負荷推定動作のための負荷推定動作信号を生成する負荷推定指令部と、前記負荷推定動作信号を含むロボット指令信号を生成し、前記ロボット制御装置へ送信するロボット指令信号生成部と、を備え、前記ロボット制御装置は、前記負荷推定動作信号に応じて、前記ロボットに負荷推定動作を実行させるためのロボット命令を生成するロボット命令生成部と、前記負荷推定動作信号に応じて、前記ロボットにおいて前記負荷推定動作時に検出される外力を測定する接触制御部と、前記負荷推定動作信号に応じて、測定した前記外力に基づいて、前記ロボットにおいて負荷の情報を設定するための負荷設定情報を算出し、算出した前記負荷設定情報を前記負荷のパラメータと対応付けて記憶部に記憶する負荷推定実行部と、を備える。 One aspect of the present disclosure is a numerical control system that controls a robot via a robot controller using a numerical control program of a numerical controller, wherein the numerical controller executes a robot control command in the numerical control program. an analysis unit that analyzes; a load estimation command unit that generates a load estimation operation signal for a load estimation operation according to the robot control command analyzed by the analysis unit; and a robot command signal including the load estimation operation signal. and a robot command signal generation unit that generates and transmits the robot command signal to the robot control device, wherein the robot control device generates a robot command for causing the robot to execute the load estimation motion according to the load estimation motion signal. a robot command generation unit that measures the external force detected by the robot during the load estimation operation according to the load estimation operation signal; and the external force that is measured according to the load estimation operation signal. a load estimation execution unit that calculates load setting information for setting load information in the robot based on the load information, and stores the calculated load setting information in a storage unit in association with the load parameter.
以下、本開示の実施形態の一例について説明する。図１は、本実施形態に係る数値制御システム１の機能ブロック図である。 An example of an embodiment of the present disclosure will be described below. FIG. 1 is a functional block diagram of a numerical control system 1 according to this embodiment.
数値制御システム１は、図示しないワークを加工する工作機械２と、この工作機械２の動作を制御する数値制御装置（ＣＮＣ）４と、工作機械２の近傍に設けられた協働ロボット３と、協働ロボット３の動作を制御するロボット制御装置５と、を備える。数値制御システム１は、互いに通信可能に接続された数値制御装置４及びロボット制御装置５を用いることによって、工作機械２及び協働ロボット３の動作を連動して制御する。
The numerical control system 1 includes a
工作機械２は、数値制御装置４から送信される工作機械制御信号に応じて図示しないワークを加工する。ここで工作機械２は、例えば、旋盤、ボール盤、フライス盤、研削盤、レーザ加工機、及び射出成形機等であるが、これらに限らない。
The
協働ロボット３は、ロボット制御装置５による制御下において動作し、例えば工作機械２によって加工されるワークに対し所定の作業を行う。協働ロボット３は、例えば多関節ロボットであり、そのアーム先端部３ａにはワークを把持したり、加工したり、検査したりするためのツール３ｂが取り付けられている。以下では、協働ロボット３は、６軸の多関節ロボットとした場合について説明するが、これに限らない。また以下では、協働ロボット３は、６軸の多関節ロボットとした場合について説明するが、軸数はこれに限らない。
The
協働ロボット３は、接触停止機能、退避モード機能、反転動作機能等のような機能を有し、人と協働で安全に作業することができる。接触停止機能は、人と軽い力（例えば、１０から２０Ｎ（すなわち、１から２ｋｇｆ））で接触したとき、即座に停止する機能である。退避モード機能は、人が協働ロボット３のアームを押すことによってアームを各軸において退避可能な機能である。反転動作機能は、協働ロボット３が硬い物体と接触した場合、アームが即座に反転することによって、挟み込みを軽減する機能である。協働ロボット３は、人との接触等のような外力を検出するために、外力検出センサ等によって構成される外力検出部３１（図２参照）を備える。外力検出センサは、例えば、トルクセンサ、力センサ等である。すなわち、協働ロボット３は、外力検出センサによって人との接触を検知し、ロボット制御装置５は、外力検出センサによって検出された外力に応じて協働ロボット３の動作を停止する。これにより、協働ロボット３は、人と協働で安全に作業することができる。
The
数値制御装置４及びロボット制御装置５は、それぞれＣＰＵ（Ｃｅｎｔｒａｌ Ｐｒｏｃｅｓｓｉｎｇ Ｕｎｉｔ）等の演算処理手段、各種コンピュータプログラムを格納したＨＤＤ（Ｈａｒｄ Ｄｉｓｋ Ｄｒｉｖｅ）やＳＳＤ（Ｓｏｌｉｄ Ｓｔａｔｅ Ｄｒｉｖｅ）等の補助記憶手段、演算処理手段がコンピュータプログラムを実行する上で一時的に必要とされるデータを格納するためのＲＡＭ（Ｒａｎｄｏｍ Ａｃｃｅｓｓ Ｍｅｍｏｒｙ）といった主記憶手段、オペレータが各種操作を行うキーボードといった操作手段、及びオペレータに各種情報を表示するディスプレイといった表示手段等のハードウェアによって構成されるコンピュータである。これら数値制御装置４及びロボット制御装置５は、例えばイーサネット（登録商標）によって相互に各種信号を送受信することが可能となっている。
The
図２は、本実施形態に係る数値制御装置４及びロボット制御装置５の機能ブロック図である。先ず、数値制御装置４の詳細な構成について説明する。図２に示すように数値制御装置４は、上記ハードウェア構成によって、工作機械２の動作を制御する機能、協働ロボット３の制御軸の動作経路を生成する機能等のような各種機能を実現する。
FIG. 2 is a functional block diagram of the
数値制御装置４は、数値制御プログラムを用いてロボット制御装置５を介して協働ロボット３を制御する。すなわち、数値制御装置４は、ロボット用の数値制御プログラムに従って、協働ロボット３及びツール３ｂの動作を制御するための各種指令を生成し、ロボット制御装置５へ送信する。より具体的には、数値制御装置４は、プログラム入力部４１と、解析部４２と、動作制御部４３と、記憶部４４と、ロボット指令信号生成部４５と、データ送受信部４６と、負荷推定指令部４７と、を備える。
The
プログラム入力部４１は、複数のロボット指令ブロックによって構成されるロボット用の数値制御プログラムを記憶部４４から読み出し、これを逐次解析部４２へ入力する。
The
解析部４２は、プログラム入力部４１から入力される数値制御プログラムに基づく指令種別を指令ブロックごとに解析し、その解析結果を動作制御部４３及びロボット指令信号生成部４５へ出力する。より具体的には、解析部４２は、指令ブロックの指令種別が工作機械２に対する工作機械用数値制御指令である場合、この工作機械用数値制御指令を動作制御部４３へ送信する。解析部４２は、指令ブロックの指令種別が協働ロボット３に対するロボット用数値制御指令である場合、このロボット用数値制御指令（以下、ロボット制御指令ともいう）をロボット指令信号生成部４５へ出力する。
The
動作制御部４３は、解析部４２から送信される解析結果に応じて工作機械２の動作を制御するための工作機械制御信号を生成し、工作機械２の各種軸を駆動するアクチュエータへ入力する。工作機械２は、動作制御部４３から入力される工作機械制御信号に応じて動作し、図示しないワークを加工する。
The
記憶部４４は、例えば、オペレータによる操作に基づいて作成された複数の数値制御プログラムを格納する。より具体的には、記憶部４４は、工作機械２の動作を制御するための工作機械２に対する複数の指令ブロックや協働ロボット３の動作を制御するための協働ロボット３に対する複数の指令ブロック等によって構成される数値制御プログラムを格納する。記憶部４４に格納されている数値制御プログラムは、ＧコードやＭコード等、工作機械２の動作を制御するため既知のプログラム言語で記述されている。
The
また、記憶部４４は、例えば、上記数値制御プログラムの下で作動する工作機械２の各種軸の位置（すなわち、工作機械２の刃物台やテーブル等の位置）を示す機械座標値を格納する。なお、これら機械座標値は、工作機械２上又は工作機械２の近傍の任意の位置に定められた基準点を原点とする工作機械座標系の下で定義される。記憶部４４には、数値制御プログラムの下で逐次変化する機械座標値の最新値が格納されるよう、図示しない処理によって逐次更新される。
The
また、記憶部４４は、例えば、ロボット制御装置５の制御下で作動する協働ロボット３の制御点（例えば、協働ロボット３のアーム先端部３ａ）の位置及び姿勢、換言すれば協働ロボット３の各制御軸の位置を示すロボット座標値が格納されている。なお、これらロボット座標値は、上述したように工作機械座標系とは異なるロボット座標系の下で定義される。記憶部４４には、数値制御プログラムの下で逐次変化するロボット座標値の最新値が格納されるよう、図示しない処理によりロボット制御装置５から取得されたロボット座標値によって逐次更新される。
The
また、記憶部４４は、例えば、オペレータにより入力された協働ロボット３の始点及び終点といった教示位置を記憶する。具体的には、記憶部４４は、ティーチペンダント等から入力された協働ロボット３の教示位置、キーボード等から入力された教示位置等を記憶する。協働ロボット３の教示位置には、協働ロボット３の各制御軸の位置を示すロボット座標値が含まれ、これらロボット座標値は、工作機械座標系とは異なるロボット座標系の下で定義される。
The
ロボット指令信号生成部４５は、解析部４２から入力されるロボット指令ブロック毎の解析結果に基づいて、ロボット指令ブロック毎にロボット指令信号を生成し、生成したロボット指令信号をデータ送受信部４６に書き込む。
The robot command
具体的には、ロボット指令信号生成部４５は、解析部４２から入力される解析結果としてのロボット用数値制御指令に基づいて、ロボット指令ブロック毎にロボット指令信号を生成し、生成したロボット指令信号をデータ送受信部４６に書き込む。
Specifically, the robot command
データ送受信部４６は、ロボット制御装置５のデータ送受信部６０との間で指令及びロボット座標値等の各種データを送受信する。具体的には、データ送受信部４６は、ロボット指令信号生成部４５によって生成されたロボット指令信号をロボット制御装置５のデータ送受信部６０へ送信する。
The data transmitter/
負荷推定指令部４７は、解析部４２により解析したロボット制御指令に応じて、負荷推定動作のための負荷推定動作信号を生成する。具体的には、解析部４２は、数値制御プログラムから負荷推定動作指令が抽出されると、負荷推定指令部４７へ指令を通知する。負荷推定指令部４７は、解析部４２からの指令の通知に応じて、負荷推定動作信号を生成し、ロボット指令信号生成部４５へ通知する。
The load
ロボット指令信号生成部４５は、負荷推定動作信号を含むロボット指令信号を生成し、データ送受信部４６を介してロボット制御装置５へ送信する。これにより、ロボット制御装置５は、負荷推定動作信号に応じて、負荷推定動作を実行する。
The robot
ここで、負荷推定動作は、協働ロボット３の負荷設定情報を算出するために、協働ロボット３の移動方向、移動速度、回転軸の回転角度、負荷重量、協働ロボット３によるワークの把持状態等を用いて、協働ロボット３を移動させること、協働ロボット３において負荷の情報を設定するための負荷設定情報を算出すること、算出した負荷設定情報を負荷のパラメータ（例えば、負荷設定番号）と対応付けて記憶部５１に記憶すること等を含む。
Here, in order to calculate the load setting information of the
次に、ロボット制御装置５の構成について詳細に説明する。図２に示すように、ロボット制御装置５には、上記ハードウェア構成によって、記憶部５１、解析部５２、ロボット命令生成部５３、プログラム管理部５４、軌跡制御部５５、キネマティクス制御部５６、サーボ制御部５７、負荷設定選択部５８、ダイナミクス制御部５９、データ送受信部６０、負荷推定実行部６１、及び接触制御部６２等の各種機能が実現される。ロボット制御装置５は、これらのような機能部を用いることによって、数値制御装置４から送信される指令に基づいて協働ロボット３の動作を制御する。
Next, the configuration of the
記憶部５１は、協働ロボット３を制御するためのロボットプログラム及び各種情報を記憶する。また、記憶部５１は、協働ロボット３の負荷設定を記憶する。なお、本実施形態では、記憶部５１は、ロボット制御装置５に設けられているが、記憶部５１は、数値制御装置４に設けられてもよく、数値制御装置４及びロボット制御装置５の外部の電子機器や外部サーバー等に設けられてもよい。
The
データ送受信部６０は、数値制御装置４のデータ送受信部４６から送信されるロボット指令信号を受信する。また、データ送受信部６０は、受信したロボット指令信号を逐次、解析部５２へ出力する。
The data transmitter/
解析部５２は、データ送受信部６０から入力されるロボット指令信号を解析する。また、解析部５２は、その解析結果をロボット命令生成部５３へ出力する。
The
ロボット命令生成部５３は、解析部５２から入力されるロボット指令信号の解析結果に基づいて、ロボット指令信号に応じたロボット命令を生成する。ロボット命令生成部５３は、生成したロボット命令をプログラム管理部５４へ出力する。
The robot command generation unit 53 generates a robot command corresponding to the robot command signal based on the analysis result of the robot command signal input from the
プログラム管理部５４は、ロボット命令生成部５３からロボット命令が入力されると、ロボット命令を逐次実行することにより、上記ロボット指令信号に応じた協働ロボット３の動作計画を生成し、軌跡制御部５５へ出力する。
When a robot command is input from the robot command generation unit 53, the program management unit 54 sequentially executes the robot command to generate a motion plan for the
また、プログラム管理部５４は、ロボット命令生成部５３から入力されるロボット命令がブロックロボット命令である場合には、記憶部５１に格納されているロボットプログラムに、入力されたブロックロボット命令を追加する。これにより記憶部５１には、数値制御装置４から送信されるロボット指令信号に応じたロボットプログラムが生成されて記憶される。記憶されたロボットプログラムは、プログラム管理部５４がロボット命令としてロボットプログラム起動指令を受けることにより、起動及び再生される。
Further, when the robot command input from the robot command generation unit 53 is a block robot command, the program management unit 54 adds the input block robot command to the robot program stored in the
軌跡制御部５５は、プログラム管理部５４から動作計画が入力されると、協働ロボット３の制御点の時系列データを算出し、キネマティクス制御部５６へ出力する。
When the motion plan is input from the program management unit 54 , the
キネマティクス制御部５６は、入力された時系列データから協働ロボット３の各関節の目標角度を算出し、サーボ制御部５７へ入力する。
The kinematics control
サーボ制御部５７は、キネマティクス制御部５６から入力される目標角度が実現するように協働ロボット３の各サーボモータをフィードバック制御することによって協働ロボット３に対するロボット制御信号を生成し、協働ロボット３のサーボモータへ入力する。また、サーボ制御部５７は、後述のダイナミクス制御部５９により計算されたトルクを反映したロボット制御信号を生成する。これにより、ロボット制御装置５は、負荷設定情報に基づいて協働ロボット３を制御可能となっている。
The
負荷設定選択部５８は、記憶部５１に記憶された負荷設定情報を用いて、協働ロボット３において負荷の情報を設定する。具体的には、負荷設定選択部５８は、解析部５２により解析されたロボット指令信号に応じて、記憶部５１に記憶された負荷設定情報を読み出し、負荷設定情報をダイナミクス制御部５９へ通知する。
The load
ダイナミクス制御部５９は、負荷設定選択部５８により通知された負荷設定情報に基づいて、逆動力学計算により協働ロボット３に入力するトルクを計算する。ダイナミクス制御部５９は、計算により取得したトルクを、サーボ制御部５７へ出力する。
The dynamics control
ここで、協働ロボット３の逆動力学計算とは、協働ロボット３の動作軌跡計画で算出される望みの運動（各関節の位置、速度、加速度の時系列データ）に基づいて、協働ロボット３に加わる手先負荷や重力、自重を考慮し、そのような応答を実現するための各モータへの入力トルクを計算する手法である。このような逆動力学計算に関するものとして、例えば、計算トルク法やニュートン・オイラー法等の数値計算方法が開示されている（例えば、特開平８－１１８２７５号公報、特開２０１５－５８５２０号公報）。
Here, the inverse dynamics calculation of the
負荷推定実行部６１は、負荷推定動作信号に応じて、接触制御部６２が測定した外力に基づいて、協働ロボット３において負荷の情報を設定するための負荷設定情報を算出し、算出した負荷設定情報を負荷のパラメータ（例えば、負荷設定番号）と対応付けて記憶部５１に記憶する。
The load
接触制御部６２は、負荷推定動作信号に応じて、協働ロボット３の外力検出部３１において負荷推定動作時に検出される外力を測定（取得）する。接触制御部６２は、測定した外力を負荷推定実行部に通知する。
The
次に、負荷推定動作の具体的な処理について説明する。数値制御装置４の解析部４２は、数値制御プログラム中のロボット制御指令を解析し、数値制御プログラムから負荷推定動作指令が抽出されると、負荷推定指令部４７へ指令を通知する。
Next, specific processing of the load estimation operation will be described. The
負荷推定指令部４７は、解析部４２からの指令の通知に応じて、負荷推定動作信号を生成し、ロボット指令信号生成部４５へ通知する。ロボット指令信号生成部４５は、解析部４２によって解析されたロボット制御指令及び負荷推定動作信号に基づいて、負荷推定動作信号を含むロボット指令信号を生成し、データ送受信部４６を介してロボット制御装置５へ送信する。
The load
ロボット命令生成部５３は、解析部５２により解析されたロボット指令信号における負荷推定動作信号に応じて、協働ロボット３に負荷推定動作を実行させるためのロボット命令を生成する。生成したロボット命令及び上述したようなプログラム管理部５４、軌跡制御部５５、キネマティクス制御部５６、サーボ制御部５７、負荷設定選択部５８及びダイナミクス制御部５９の制御によって、協働ロボット３は、負荷推定動作を実行する。
The robot command generating unit 53 generates a robot command for causing the
接触制御部６２は、解析部５２により解析されたロボット指令信号における負荷推定動作信号に応じて、協働ロボット３の外力検出部３１において負荷推定動作時に検出される外力を測定（取得）する。接触制御部６２は、測定した外力を負荷推定実行部６１に通知する。
The
負荷推定実行部６１は、負荷推定動作信号に応じて、接触制御部６２が測定した外力に基づいて、協働ロボット３において負荷の情報を設定するための負荷設定情報を算出する。そして、負荷推定実行部６１は、算出した負荷設定情報を負荷設定番号と対応付けて記憶部５１に記憶する。例えば、負荷推定実行部６１は、負荷推定動作信号に応じて、接触制御部６２が測定した外力と、協働ロボット３の各関節軸におけるトルクセンサのエンコーダ値とから、協働ロボット３のハンドの先端位置及び姿勢を求め、求めた協働ロボット３のハンドの先端位置及び姿勢を用いて、協働ロボット３の負荷設定情報として、協働ロボット３のハンドの重量及び重心位置を算出する。そして、負荷推定実行部６１は、算出したハンドの重量及び重心位置を負荷設定番号と対応付けて記憶部５１に記憶する。また、例えば、負荷推定実行部６１は、接触制御部６２が測定した外力に基づいて、協働ロボット３の負荷設定情報として、協働ロボット３のハンドのイナーシャを算出し、算出したハンドのイナーシャを負荷設定番号と対応付けて記憶部５１に記憶する。
The load
工作機械２のユーザは、従来、３Ｄ ＣＡＤ上で座標系を設定し、負荷の重量及び重心位置などを算出し、算出した重量及び重心位置などを教示操作盤を操作することによって設定していた。また、工作機械２のユーザは、従来、協働ロボット３の教示操作盤によって負荷推定用のプログラムを作成しておき、ユーザが手動で実行することによって負荷の重量及び重心位置などを算出する場合もあった。本実施形態に係る数値制御装置４は、上述したように、協働ロボット３の負荷設定情報を自動的に算出し、記憶部５１に記憶している。そして、数値制御装置４は、負荷の情報を設定する際に、自動的に算出され、かつ記憶部５１に記憶された負荷設定情報を用いて、負荷の情報の設定を自動的に実行する。これにより、工作機械２のユーザは、負荷の情報の設定が自動的に行われるため、容易に負荷の情報を設定することができる。
Conventionally, the user of the
図３は、負荷推定動作指令の例を示す図である。図３に示される例では、負荷設定番号、負荷推定モードＯＦＦ指令及び負荷推定モードＯＮ指令が対応付けられている。負荷推定モードＯＦＦ指令は、Ｇ１００．０からＧ１０９．０のＧコードである。負荷推定モードＯＮ指令は、Ｇ１００．１からＧ１０９．１のＧコードである。 FIG. 3 is a diagram showing an example of a load estimation operation command. In the example shown in FIG. 3, the load setting number, the load estimation mode OFF command, and the load estimation mode ON command are associated with each other. The load estimation mode OFF command is a G code from G100.0 to G109.0. The load estimation mode ON command is a G code from G100.1 to G109.1.
例えば、負荷設定番号１（Ｎｏ．１）に対応する負荷推定モードＯＦＦ指令は、Ｇ１００．０であり、負荷設定番号１（Ｎｏ．１）に対応する負荷推定モードＯＮ指令は、Ｇ１００．１である。 For example, the load estimation mode OFF command corresponding to load setting number 1 (No. 1) is G100.0, and the load estimation mode ON command corresponding to load setting number 1 (No. 1) is G100.1. be.
図４は、本実施形態に係る数値制御プログラムの例を示す図である。図５は、図４に示される数値制御プログラムを実行した際における数値制御装置４とロボット制御装置５との間の信号及び情報の流れを示すシーケンス図である。図４及び図５に示される例では、数値制御装置４は、負荷推定動作指令を含む数値制御プログラムを実行し、協働ロボット３によって検出された外力に基づいて負荷設定情報を算出する。
FIG. 4 is a diagram showing an example of a numerical control program according to this embodiment. FIG. 5 is a sequence diagram showing the flow of signals and information between the
先ず、“Ｍ１００”が指令され、ロボット制御装置５は、協働ロボット３のハンドを開くように制御する。次いで、“Ｇ６８．８”が入力され、各軸座標系が選択される。これにより、ロボット制御装置５は、協働ロボット３を各軸座標系において動作させることができる。“Ｇ７．３ Ｊ１＝＿Ｊ２＝＿Ｊ３＝＿Ｊ４＝＿Ｊ５＝＿Ｊ６＝＿”が指令されると、ロボット制御装置５は、各軸座標系上の基準位置に協働ロボット３を移動及び位置決めする。なお、コマンド中のアンダーバーの部分には、協働ロボット３の指定位置の座標値が入力される。
First, "M100" is commanded, and the
次いで、“Ｇ１００．１”が指令され、負荷設定番号（Ｎｏ．１：ハンド）に対応する負荷推定モードＯＮが通知され、ロボット制御装置５は、負荷推定動作を開始する。次いで、“Ｇ６８．９”が指令され、直交座標系が選択される。これにより、ロボット制御装置５は、協働ロボット３を直交座標系において動作させることができる。次いで、“Ｇ０１ Ｘ１００．０ Ｆ１０００”が指令され、ロボット制御装置５は、協働ロボット３を＋Ｘ方向へ移動速度１０００ｍｍ／ｍｉｎで移動させる。このとき、ロボット制御装置５の接触制御部６２は、協働ロボット３の外力検出部３１において検出される外力を測定する。
Next, "G100.1" is commanded, the load estimation mode ON corresponding to the load setting number (No. 1: hand) is notified, and the
次いで、“Ｇ６８．８”が指令され、各軸座標系が選択される。次いで、“Ｇ７．３ Ｊ５＝４５．０ Ｊ６＝４５．０ Ｅ２５”が指令され、ロボット制御装置５は、協働ロボット３のＪ５軸及びＪ６軸を、それぞれ最大移動速度の２５％で４５度回転させる。このとき、ロボット制御装置５の接触制御部６２は、協働ロボット３の外力検出部３１において検出される外力を測定する。
Then "G68.8" is commanded to select each axis coordinate system. Next, "G7.3 J5=45.0 J6=45.0 E25" is commanded, and the
次いで、“Ｇ１００．０”が指令され、負荷設定番号（Ｎｏ．１：ハンド）に対応する負荷推定モードＯＦＦが通知され、ロボット制御装置５は、負荷推定動作を停止する。負荷推定実行部６１は、接触制御部６２が測定した外力に基づいて、負荷設定情報を算出する。そして、負荷推定実行部６１は、算出した負荷設定情報を負荷設定番号（Ｎｏ．１：ハンド）と対応付けて記憶部５１に記憶する。
Next, "G100.0" is commanded, the load estimation mode OFF corresponding to the load setting number (No. 1: hand) is notified, and the
次いで、“Ｇ６８．９”が指令され、直交座標系が選択される。“Ｇ０１ Ｘ＿Ｙ＿Ｚ＿Ａ＿Ｂ＿Ｃ＿Ｐ＿”が指令されると、ロボット制御装置５は、直交座標系上のワーク把持位置へ協働ロボット３を直線移動させ、位置決めする。
Then "G68.9" is commanded to select the Cartesian coordinate system. When "G01 X_Y_Z_A_B_C_P_" is commanded, the
次いで、“Ｍ１０１”が指令され、ロボット制御装置５は、協働ロボット３のハンドを閉じるように制御し、協働ロボット３は、ワークを把持する。“Ｇ０１ Ｘ＿Ｙ＿Ｚ＿Ａ＿Ｂ＿Ｃ＿Ｐ＿”が指令されると、ロボット制御装置５は、直交座標系上の負荷推定動作開始位置へ協働ロボット３を直線移動させ、位置決めする。
Next, "M101" is commanded, the
次いで、“Ｇ１０１．１”が指令され、負荷設定番号（Ｎｏ．２：ハンド＋ワーク）に対応する負荷推定モードＯＮが通知され、ロボット制御装置５は、負荷推定動作を開始する。次いで、“Ｇ６８．９”が指令され、直交座標系が選択される。次いで、“Ｇ０１ Ｘ１００．０ Ｆ１０００”が指令され、ロボット制御装置５は、協働ロボット３を＋Ｘ方向へ移動速度１０００ｍｍ／ｍｉｎで移動させる。このとき、ロボット制御装置５の接触制御部６２は、協働ロボット３の外力検出部３１において検出される外力を測定する。
Next, "G101.1" is commanded, the load estimation mode ON corresponding to the load setting number (No. 2: hand + work) is notified, and the
次いで、“Ｇ６８．８”が指令され、各軸座標系が選択される。次いで、“Ｇ７．３ Ｊ５＝４５．０ Ｊ６＝４５．０ Ｅ２５”が指令され、ロボット制御装置５は、協働ロボット３のＪ５軸及びＪ６軸を、それぞれ最大移動速度の２５％で４５度回転させる。このとき、ロボット制御装置５の接触制御部６２は、協働ロボット３の外力検出部３１において検出される外力を測定する。
Then "G68.8" is commanded to select each axis coordinate system. Next, "G7.3 J5=45.0 J6=45.0 E25" is commanded, and the
次いで、“Ｇ１０１．０”が指令され、負荷設定番号（Ｎｏ．２：ハンド＋ワーク）に対応する負荷推定モードＯＦＦが通知され、ロボット制御装置５は、負荷推定動作を停止する。負荷推定実行部６１は、接触制御部６２が測定した外力に基づいて、負荷設定情報を算出する。そして、負荷推定実行部６１は、算出した負荷設定情報を負荷設定番号（Ｎｏ．２：ハンド＋ワーク）と対応付けて記憶部５１に記憶する。次いで、“Ｍ３０”が指令され、数値制御プログラムは終了する。
Next, "G101.0" is commanded, the load estimation mode OFF corresponding to the load setting number (No. 2: hand + work) is notified, and the
図６は、負荷推定指令の例を示す図である。図６に示される例では、負荷推定動作指令は、負荷設定番号と対応付けられている。負荷推定動作指令は、Ｇ１００ Ｘ＿Ｙ＿Ｚ＿Ｊ５＿Ｊ６＿からＧ１０９ Ｘ＿Ｙ＿Ｚ＿Ｊ５＿Ｊ６＿のＧコードである。例えば、負荷設定番号１（Ｎｏ．１）に対応する負荷推定動作指令は、Ｇ１００ Ｘ＿Ｙ＿Ｚ＿Ｊ５＿Ｊ６＿である。図６に示される負荷推定動作指令は、負荷推定動作時の協働ロボット３のツールの並進方向（Ｊ５軸）及び協働ロボット３の手首軸の回転方向（Ｊ６軸）をロボット制御装置５に対して指令する。 FIG. 6 is a diagram showing an example of a load estimation command. In the example shown in FIG. 6, the load estimation operation command is associated with the load setting number. The load estimation operation commands are G codes from G100 X_Y_Z_J5_J6_ to G109 X_Y_Z_J5_J6_. For example, the load estimation operation command corresponding to load setting number 1 (No. 1) is G100 X_Y_Z_J5_J6_. The load estimation operation command shown in FIG. command against.
図７は、本実施形態に係る数値制御プログラムの例を示す図である。図８は、図７に示される数値制御プログラムを実行した際における数値制御装置４とロボット制御装置５との間の信号及び情報の流れを示すシーケンス図である。図７及び図８に示される例では、数値制御装置４は、負荷推定動作指令を含む数値制御プログラムを実行し、協働ロボット３によって検出された外力に基づいて負荷設定情報を算出する。図７及び図８に示される例では、負荷推定動作指令は、負荷推定動作時の協働ロボット３のツールの並進方向（Ｊ５軸）及び協働ロボット３の手首軸の回転方向（Ｊ６軸）をロボット制御装置５に対して指令する。
FIG. 7 is a diagram showing an example of a numerical control program according to this embodiment. FIG. 8 is a sequence diagram showing the flow of signals and information between the
先ず、“Ｍ１００”が指令され、ロボット制御装置５は、協働ロボット３のハンドを開くように制御する。次いで、“Ｇ６８．８”が入力され、各軸座標系が選択される。“Ｇ７．３ Ｊ１＝＿Ｊ２＝＿Ｊ３＝＿Ｊ４＝＿Ｊ５＝＿Ｊ６＝＿”が指令されると、ロボット制御装置５は、各軸座標系上の基準位置に協働ロボット３を移動及び位置決めする。
First, "M100" is commanded, and the
次いで、“Ｇ１００ Ｘ１００．０ Ｊ５＝４５．０ Ｊ６＝４５．０ Ｆ１０００ Ｅ２５”が指令され、負荷設定番号（Ｎｏ．１：ハンド）に対応する負荷設定動作が指令され、ロボット制御装置５は、負荷推定動作を開始する。 Next, "G100 X100.0 J5=45.0 J6=45.0 F1000 E25" is commanded, and the load setting operation corresponding to the load setting number (No. 1: hand) is commanded. Start the load estimation operation.
ロボット制御装置５は、負荷推定動作として、協働ロボット３を＋Ｘ方向へ移動速度１０００ｍｍ／ｍｉｎで移動させる。このとき、ロボット制御装置５の接触制御部６２は、協働ロボット３の外力検出部３１において検出される外力を測定する。更に、ロボット制御装置５は、負荷推定動作として、協働ロボット３のＪ５軸及びＪ６軸を、それぞれ最大移動速度の２５％で４５度回転させる。このとき、ロボット制御装置５の接触制御部６２は、協働ロボット３の外力検出部３１において検出される外力を測定する。
As a load estimation operation, the
負荷推定実行部６１は、接触制御部６２が測定した外力に基づいて、負荷設定情報を算出する。そして、負荷推定実行部６１は、算出した負荷設定情報を負荷設定番号（Ｎｏ．１：ハンド）と対応付けて記憶部５１に記憶する。その後、ロボット制御装置５は、負荷推定動作を終了する。
The load
次いで、“Ｇ６８．９”が指令され、直交座標系が選択される。“Ｇ０１ Ｘ＿Ｙ＿Ｚ＿Ａ＿Ｂ＿Ｃ＿Ｐ＿”が指令されると、ロボット制御装置５は、直交座標系上のワーク把持位置へ協働ロボット３を直線移動させ、位置決めする。
Then "G68.9" is commanded to select the Cartesian coordinate system. When "G01 X_Y_Z_A_B_C_P_" is commanded, the
次いで、“Ｍ１０１”が指令され、ロボット制御装置５は、協働ロボット３のハンドを閉じるように制御し、協働ロボット３は、ワークを把持する。“Ｇ０１ Ｘ＿Ｙ＿Ｚ＿Ａ＿Ｂ＿Ｃ＿Ｐ＿”が指令されると、ロボット制御装置５は、直交座標系上の負荷推定動作開始位置へ協働ロボット３を直線移動させ、位置決めする。
Next, "M101" is commanded, the
次いで、“Ｇ１０１ Ｘ１００．０ Ｊ５＝４５．０ Ｊ６＝４５．０ Ｆ１０００ Ｅ２５”が指令され、負荷設定番号（Ｎｏ．２：ハンド＋ワーク）に対応する負荷設定動作が指令され、ロボット制御装置５は、負荷推定動作を開始する。ロボット制御装置５は、負荷推定動作として、協働ロボット３を＋Ｘ方向へ移動速度１０００ｍｍ／ｍｉｎで移動させる。このとき、ロボット制御装置５の接触制御部６２は、協働ロボット３の外力検出部３１において検出される外力を測定する。更に、ロボット制御装置５は、負荷推定動作として、協働ロボット３のＪ５軸及びＪ６軸を、それぞれ最大移動速度の２５％で４５度回転させる。このとき、ロボット制御装置５の接触制御部６２は、協働ロボット３の外力検出部３１において検出される外力を測定する。
Next, "G101 X100.0 J5=45.0 J6=45.0 F1000 E25" is commanded, and the load setting operation corresponding to the load setting number (No. 2: hand + work) is commanded. starts the load estimation operation. As a load estimation operation, the
負荷推定実行部６１は、接触制御部６２が測定した外力に基づいて、負荷設定情報を算出する。そして、負荷推定実行部６１は、算出した負荷設定情報を負荷設定番号（Ｎｏ．２：ハンド＋ワーク）と対応付けて記憶部５１に記憶する。その後、ロボット制御装置５は、負荷推定動作を終了する。次いで、“Ｍ３０”が指令され、数値制御プログラムは終了する。
The load
図９は、負荷推定指令の例を示す図である。図９に示される例では、負荷推定動作指令は、負荷設定番号と対応付けられている。負荷推定動作指令は、Ｇ１００ Ｘ＿Ｙ＿Ｚ＿Ｊ５＿Ｊ６＿Ｐ＿からＧ１０９ Ｘ＿Ｙ＿Ｚ＿Ｊ５＿Ｊ６＿Ｐ＿のＧコードである。例えば、負荷設定番号１（Ｎｏ．１）に対応する負荷推定動作指令は、Ｇ１００ Ｘ＿Ｙ＿Ｚ＿Ｊ５＿Ｊ６＿Ｐ＿である。 FIG. 9 is a diagram showing an example of a load estimation command. In the example shown in FIG. 9, the load estimation operation command is associated with the load setting number. The load estimation operation commands are G codes from G100 X_Y_Z_J5_J6_P_ to G109 X_Y_Z_J5_J6_P_. For example, the load estimation operation command corresponding to load setting number 1 (No. 1) is G100 X_Y_Z_J5_J6_P_.
図９に示される負荷推定動作指令は、負荷推定動作時の協働ロボット３のツールの並進方向（Ｊ５軸）、協働ロボット３の手首軸の回転方向（Ｊ６軸）及び負荷重量（Ｐ）を、ロボット制御装置５に対して指令する。
The load estimation operation command shown in FIG. 9 includes the translation direction of the tool of the collaborative robot 3 (J5 axis), the rotation direction of the wrist axis of the collaborative robot 3 (J6 axis), and the load weight (P) during the load estimation operation. is commanded to the
図１０は、本実施形態に係る数値制御プログラムの例を示す図である。図１１は、図１０に示される数値制御プログラムを実行した際における数値制御装置４とロボット制御装置５との間の信号及び情報の流れを示すシーケンス図である。図１０及び図１１に示される例では、数値制御装置４は、負荷推定動作指令を含む数値制御プログラムを実行し、協働ロボット３によって検出された外力に基づいて負荷設定情報を算出する。図１０及び図１１に示される例では、負荷推定動作指令は、負荷推定動作時の協働ロボット３のツールの並進方向（Ｊ５軸）、協働ロボット３の手首軸の回転方向（Ｊ６軸）及び負荷重量（Ｐ）を、ロボット制御装置５に対して指令する。
FIG. 10 is a diagram showing an example of a numerical control program according to this embodiment. FIG. 11 is a sequence diagram showing the flow of signals and information between the
先ず、“Ｍ１００”が指令され、ロボット制御装置５は、協働ロボット３のハンドを開くように制御する。次いで、“Ｇ６８．８”が入力され、各軸座標系が選択される。“Ｇ７．３ Ｊ１＝＿Ｊ２＝＿Ｊ３＝＿Ｊ４＝＿Ｊ５＝＿Ｊ６＝＿”が指令されると、ロボット制御装置５は、各軸座標系上の基準位置に協働ロボット３を移動及び位置決めする。
First, "M100" is commanded, and the
次いで、“Ｇ１００ Ｘ１００．０ Ｊ５＝４５．０ Ｊ６＝４５．０ Ｐ３００ Ｆ１０００ Ｅ２５”が指令され、負荷設定番号（Ｎｏ．１：ハンド）に対応する負荷設定動作が指令され、ロボット制御装置５は、負荷推定動作を開始する。ここで、「Ｐ３００」は、負荷重量が３００ｇであることを示す。
Next, "G100 X100.0 J5=45.0 J6=45.0 P300 F1000 E25" is commanded, the load setting operation corresponding to the load setting number (No. 1: hand) is commanded, and the
ロボット制御装置５は、負荷推定動作として、協働ロボット３を＋Ｘ方向へ移動速度１０００ｍｍ／ｍｉｎで移動させる。このとき、ロボット制御装置５の接触制御部６２は、協働ロボット３の外力検出部３１において検出される外力を測定する。更に、ロボット制御装置５は、負荷推定動作として、協働ロボット３のＪ５軸及びＪ６軸を、それぞれ最大移動速度の２５％で４５度回転させる。このとき、ロボット制御装置５の接触制御部６２は、協働ロボット３の外力検出部３１において検出される外力を測定する。
As a load estimation operation, the
負荷推定実行部６１は、接触制御部６２が測定した外力及び指令された負荷重量に基づいて、負荷設定情報を算出する。そして、負荷推定実行部６１は、算出した負荷設定情報を負荷設定番号（Ｎｏ．１：ハンド）と対応付けて記憶部５１に記憶する。その後、ロボット制御装置５は、負荷推定動作を終了する。
The load
次いで、“Ｇ６８．９”が指令され、直交座標系が選択される。“Ｇ０１ Ｘ＿Ｙ＿Ｚ＿Ａ＿Ｂ＿Ｃ＿Ｐ＿”が指令されると、ロボット制御装置５は、直交座標系上のワーク把持位置へ協働ロボット３を直線移動させ、位置決めする。
Then "G68.9" is commanded to select the Cartesian coordinate system. When "G01 X_Y_Z_A_B_C_P_" is commanded, the
次いで、“Ｍ１０１”が指令され、ロボット制御装置５は、協働ロボット３のハンドを閉じるように制御し、協働ロボット３は、ワークを把持する。“Ｇ０１ Ｘ＿Ｙ＿Ｚ＿Ａ＿Ｂ＿Ｃ＿Ｐ＿”が指令されると、ロボット制御装置５は、直交座標系上の負荷推定動作開始位置へ協働ロボット３を直線移動させ、位置決めする。
Next, "M101" is commanded, the
次いで、“Ｇ１０１ Ｘ１００．０ Ｊ５＝４５．０ Ｊ６＝４５．０ Ｐ５００ Ｆ１０００ Ｅ２５”が指令され、負荷設定番号（Ｎｏ．２：ハンド＋ワーク）に対応する負荷推定動作が指令され、ロボット制御装置５は、負荷推定動作を開始する。ここで、「Ｐ５００」は、負荷重量が５００ｇであることを示す。
Next, "G101 X100.0 J5=45.0 J6=45.0 P500 F1000 E25" is commanded, the load estimation operation corresponding to the load setting number (No. 2: hand + work) is commanded, and the
ロボット制御装置５は、負荷推定動作として、協働ロボット３を＋Ｘ方向へ移動速度１０００ｍｍ／ｍｉｎで移動させる。このとき、ロボット制御装置５の接触制御部６２は、協働ロボット３の外力検出部３１において検出される外力を測定する。更に、ロボット制御装置５は、負荷推定動作として、協働ロボット３のＪ５軸及びＪ６軸を、それぞれ最大移動速度の２５％で４５度回転させる。このとき、ロボット制御装置５の接触制御部６２は、協働ロボット３の外力検出部３１において検出される外力を測定する。
As a load estimation operation, the
負荷推定実行部６１は、接触制御部６２が測定した外力及び指令された負荷重量に基づいて、負荷設定情報を算出する。そして、負荷推定実行部６１は、算出した負荷設定情報を負荷設定番号（Ｎｏ．２：ハンド＋ワーク）と対応付けて記憶部５１に記憶する。その後、ロボット制御装置５は、負荷推定動作を終了する。次いで、“Ｍ３０”が指令され、数値制御プログラムは終了する。
The load
図１２は、本実施形態に係る数値制御プログラムの例を示す図である。図１３は、図１２に示される数値制御プログラムを実行した際における数値制御装置４とロボット制御装置５との間の信号及び情報の流れを示すシーケンス図である。図１２及び図１３に示される例では、数値制御装置４は、負荷推定動作指令を含む数値制御プログラムを実行し、協働ロボット３によって検出された外力に基づいて負荷設定情報を算出する。図１２及び図１３に示される例では、負荷推定動作指令は、負荷推定動作時の協働ロボット３のツールの並進方向（Ｊ５軸）及び協働ロボット３の手首軸の回転方向（Ｊ６軸）を、ロボット制御装置５に対して指令し、更に、協働ロボット３の動作状態として、協働ロボット３によるワークの把持状態をロボット制御装置５に対して通知する。
FIG. 12 is a diagram showing an example of a numerical control program according to this embodiment. FIG. 13 is a sequence diagram showing the flow of signals and information between the
先ず、図１２及び図１３に示す例における負荷推定動作の具体的な処理について、図２を参照しながら説明する。数値制御装置４の解析部４２は、数値制御プログラム中のロボット制御指令を解析し、数値制御プログラムからハンド開閉指令が抽出されると、ロボット指令信号生成部４５へ指令を通知し、ロボット指令信号生成部４５は、ハンド開閉指令を含むロボット指令信号を生成し、データ送受信部４６を介してロボット制御装置５へ送信する。これにより、ロボット制御装置５は、ハンド開閉指令に応じて、ハンド開閉動作を実行する。
First, specific processing of the load estimation operation in the examples shown in FIGS. 12 and 13 will be described with reference to FIG. The
また、負荷推定指令部４７は、数値制御プログラムからハンド開閉指令が抽出されると、ハンド開閉指令に応じて、負荷推定指令部４７において保持されるワークの把持状態を更新する。
Further, when a hand opening/closing command is extracted from the numerical control program, the load
更に、解析部４２は、数値制御プログラム中のロボット制御指令を解析し、数値制御プログラムから負荷推定動作指令が抽出されると、負荷推定指令部４７へ指令を通知する。
Furthermore, the
負荷推定指令部４７は、解析部４２からの指令の通知に応じて、負荷推定動作信号を生成し、ロボット指令信号生成部４５へ通知する。ここで、負荷推定指令部４７は、負荷推定動作信号において、協働ロボット３の動作状態（例えば、ワークの把持状態、協働ロボット３のハンドの開閉状態など）をロボット制御装置５に指令する。
The load
ロボット指令信号生成部４５は、解析部４２によって解析されたロボット制御指令及び負荷推定動作信号に基づいて、負荷推定動作信号を含むロボット指令信号を生成し、データ送受信部４６を介してロボット制御装置５へ送信する。
The robot command
ロボット命令生成部５３は、解析部５２により解析されたロボット指令信号における負荷推定動作信号に応じて、協働ロボット３に負荷推定動作を実行させるためのロボット命令を生成する。生成したロボット命令及び上述したようなプログラム管理部５４、軌跡制御部５５、キネマティクス制御部５６、サーボ制御部５７、負荷設定選択部５８及びダイナミクス制御部５９の制御によって、協働ロボット３は、負荷推定動作を実行する。
The robot command generating unit 53 generates a robot command for causing the
接触制御部６２は、解析部５２により解析されたロボット指令信号における負荷推定動作信号に応じて、協働ロボット３の外力検出部３１において負荷推定動作時に検出される外力を測定（取得）する。接触制御部６２は、測定した外力を負荷推定実行部６１に通知する。
The
負荷推定実行部６１は、負荷推定動作信号に応じて、接触制御部６２が測定した外力に基づいて、協働ロボット３において負荷の情報を設定するための負荷設定情報を算出する。そして、負荷推定実行部６１は、算出した負荷設定情報を協働ロボット３の動作状態と対応付けて記憶部５１に記憶する。例えば、負荷推定実行部６１は、算出した負荷設定情報をワークの把持状態と対応付けて記憶部５１に記憶する。
The load
次いで、解析部４２は、数値制御プログラム中のロボット制御指令を解析し、数値制御プログラムからハンド開閉指令が抽出されると、ロボット指令信号生成部４５へ指令を通知し、ロボット指令信号生成部４５は、ハンド開閉指令を含むロボット指令信号を生成し、データ送受信部４６を介してロボット制御装置５へ送信する。これにより、ロボット制御装置５は、ハンド開閉指令に応じて、ハンド開閉動作を実行する。
Next, the
更に、ロボット制御装置５は、ハンド開閉指令に応じて、ワークの把持状態を負荷設定選択部５８へ通知する。負荷設定選択部５８は、通知されたワークの把持状態と対応付けられた負荷設定情報を記憶部５１から読み出し、ダイナミクス制御部５９へ通知する。
Further, the
ダイナミクス制御部５９は、通知された負荷設定情報に基づいて逆動力学計算により協働ロボット３に入力するトルクを計算する。ダイナミクス制御部５９は、計算により取得したトルクを、サーボ制御部５７へ出力する。サーボ制御部５７は、ダイナミクス制御部５９により計算されたトルクを反映したロボット制御信号を生成する。これにより、ロボット制御装置５は、負荷設定情報に基づいて協働ロボット３を制御することができる。
The dynamics control
なお、ロボット制御装置５は、協働ロボット３が、２つのハンドを有する（デュアルハンド）場合、第１のハンド及び第２のハンドそれぞれの開閉状態に対応する負荷設定情報を記憶部５１に記憶する。
When the
次に、図１２及び図１３を参照しながら、負荷推定動作の例を説明する。先ず、“Ｍ１００”が指令され、ロボット制御装置５は、協働ロボット３のハンドを開くように制御する。更に、数値制御装置４は、ワークの把持状態（ワークなし）をロボット制御装置５へ通知する。
Next, an example of the load estimation operation will be described with reference to FIGS. 12 and 13. FIG. First, "M100" is commanded, and the
次いで、“Ｇ６８．８”が入力され、各軸座標系が選択される。“Ｇ７．３ Ｊ１＝＿Ｊ２＝＿Ｊ３＝＿Ｊ４＝＿Ｊ５＝＿Ｊ６＝＿”が指令されると、ロボット制御装置５は、各軸座標系上の基準位置に協働ロボット３を移動及び位置決めする。次いで、“Ｇ１００ Ｘ１００．０ Ｊ５＝４５．０ Ｊ６＝４５．０ Ｆ１０００ Ｅ２５”が指令され、ロボット制御装置５は、負荷推定動作を開始する。
Then "G68.8" is entered to select each axis coordinate system. When "G7.3 J1=_J2=_J3=_J4=_J5=_J6=_" is commanded, the
ロボット制御装置５は、負荷推定動作として、協働ロボット３を＋Ｘ方向へ移動速度１０００ｍｍ／ｍｉｎで移動させる。このとき、ロボット制御装置５の接触制御部６２は、協働ロボット３の外力検出部３１において検出される外力を測定する。更に、ロボット制御装置５は、負荷推定動作として、協働ロボット３のＪ５軸及びＪ６軸を、それぞれ最大移動速度の２５％で４５度回転させる。このとき、ロボット制御装置５の接触制御部６２は、協働ロボット３の外力検出部３１において検出される外力を測定する。
As a load estimation operation, the
負荷推定実行部６１は、接触制御部６２が測定した外力に基づいて負荷設定情報を算出する。そして、負荷推定実行部６１は、算出した負荷設定情報をワークの把持状態（ワークなし）と対応付けて記憶部５１に記憶する。その後、ロボット制御装置５は、負荷推定動作を終了する。
The load
次いで、“Ｇ６８．９”が指令され、直交座標系が選択される。“Ｇ０１ Ｘ＿Ｙ＿Ｚ＿Ａ＿Ｂ＿Ｃ＿Ｐ＿”が指令されると、ロボット制御装置５は、直交座標系上のワーク把持位置へ協働ロボット３を直線移動させ、位置決めする。
Then "G68.9" is commanded to select the Cartesian coordinate system. When "G01 X_Y_Z_A_B_C_P_" is commanded, the
次いで、“Ｍ１０１”が指令され、ロボット制御装置５は、協働ロボット３のハンドを閉じるように制御し、協働ロボット３は、ワークを把持する。更に、数値制御装置４は、ワークの把持状態（ワークあり）をロボット制御装置５へ通知する。
Next, "M101" is commanded, the
“Ｇ０１ Ｘ＿Ｙ＿Ｚ＿Ａ＿Ｂ＿Ｃ＿Ｐ＿”が指令されると、ロボット制御装置５は、直交座標系上の負荷推定動作開始位置へ協働ロボット３を直線移動させ、位置決めする。次いで、“Ｇ１０１ Ｘ１００．０ Ｊ５＝４５．０ Ｊ６＝４５．０ Ｆ１０００ Ｅ２５”が指令され、ロボット制御装置５は、負荷推定動作を開始する。
When "G01 X_Y_Z_A_B_C_P_" is commanded, the
ロボット制御装置５は、負荷推定動作として、協働ロボット３を＋Ｘ方向へ移動速度１０００ｍｍ／ｍｉｎで移動させる。このとき、ロボット制御装置５の接触制御部６２は、協働ロボット３の外力検出部３１において検出される外力を測定する。更に、ロボット制御装置５は、負荷推定動作として、協働ロボット３のＪ５軸及びＪ６軸を、それぞれ最大移動速度の２５％で４５度回転させる。このとき、ロボット制御装置５の接触制御部６２は、協働ロボット３の外力検出部３１において検出される外力を測定する。
As a load estimation operation, the
負荷推定実行部６１は、接触制御部６２が測定した外力に基づいて負荷設定情報を算出する。そして、負荷推定実行部６１は、算出した負荷設定情報をワークの把持状態（ワークあり）と対応付けて記憶部５１に記憶する。その後、ロボット制御装置５は、負荷推定動作を終了する。
The load
その後、“Ｍ１００”が指令され、ロボット制御装置５は、協働ロボット３のハンドを開くように制御する。更に、数値制御装置４は、ワークの把持状態（ワークなし）をロボット制御装置５へ通知する。負荷設定選択部５８は、通知されたワークの把持状態（ワークなし）と対応付けられた負荷設定情報を記憶部５１から読み出す。そして、負荷設定選択部５８は、ワークの把持状態（ワークあり）と対応付けられた負荷設定情報を、ワークの把持状態（ワークなし）と対応付けられた負荷設定情報に切り替える。
After that, "M100" is commanded, and the
その後、“Ｍ１０１”が指令され、ロボット制御装置５は、協働ロボット３のハンドを閉じるように制御する。更に、数値制御装置４は、ワークの把持状態（ワークあり）をロボット制御装置５へ通知する。負荷設定選択部５８は、通知されたワークの把持状態（ワークあり）と対応付けられた負荷設定情報を記憶部５１から読み出す。そして、負荷設定選択部５８は、ワークの把持状態（ワークなし）と対応付けられた負荷設定情報を、ワークの把持状態（ワークあり）と対応付けられた負荷設定情報に切り替える。その後、“Ｍ３０”が指令され、数値制御プログラムは終了する。なお、上記の実施形態では、数値制御装置４が、ワークの把持状態をロボット制御装置５へ通知したが、ロボット制御装置５は、ロボット制御装置５自体が保持しているワークの把持状態を用いてもよい。
After that, "M101" is commanded, and the
以上説明したように本実施形態によれば、数値制御装置４は、数値制御プログラム中のロボット制御指令を解析する解析部４２と、解析部４２により解析したロボット制御指令に応じて、負荷推定動作のための負荷推定動作信号を生成する負荷推定指令部４７と、負荷推定動作信号を含むロボット指令信号を生成し、ロボット制御装置５へ送信するロボット指令信号生成部４５と、を備え、ロボット制御装置５は、負荷推定動作信号に応じて、協働ロボット３に負荷推定動作を実行させると共に、協働ロボット３において負荷推定動作時に検出される外力を測定し、測定した外力に基づいて、協働ロボット３において負荷の情報を設定するための負荷設定情報を算出し、算出した負荷設定情報を負荷のパラメータと対応付けて記憶部５１に記憶する。
As described above, according to the present embodiment, the
このような構成を備えることによって、数値制御装置４は、工作機械のユーザが協働ロボット３の教示操作盤を使用せず、負荷の重心位置などのような力学的パラメータを含む負荷の情報を容易に設定することができる。
With such a configuration, the
また、ロボット制御装置５は、算出した負荷設定情報を、負荷のパラメータとしての協働ロボット３の動作状態と対応付けて記憶部５１に記憶し、協働ロボット３の動作状態は、ワークの把持状態及び協働ロボット３のハンドの開閉状態の少なくとも１つを含む。このような構成を備えることによって、数値制御装置４は、例えば、協働ロボット３のハンド開閉指令時に、負荷設定情報を、ハンドの開閉状態と対応づけられた負荷設定情報に自動的に切替えることによって、工作機械のユーザが負荷を意識せずに容易に協働ロボット３を使用することができる。
Further, the
また、負荷推定指令部４７は、負荷推定動作信号において、協働ロボット３におけるツールの並進移動方向又は協働ロボット３の回転軸の回転方向をロボット制御装置５に指令する。このような構成を備えることによって、数値制御装置４は、負荷設定情報を算出するための負荷推定動作をロボット制御装置５に適切に実行させることができる。
In addition, the load
また、負荷推定指令部４７は、負荷推定動作信号において、負荷の重量、負荷の重心位置、及び負荷のイナーシャのうちの少なくとも１つを算出することを指令する。このような構成を備えることによって、数値制御装置４は、ロボット制御装置５に対して、負荷設定情報を適切に算出させることができる。
Moreover, the load
また、協働ロボット３は、人との接触を検知して動作を停止する。このような構成を備えることによって、数値制御装置４は、協働ロボット３を用いて、人と協働で安全に作業することができる。
Also, the
以上、本発明の実施形態について説明したが、上記の数値制御システム１は、ハードウェア、ソフトウェア又はこれらの組み合わせにより実現することができる。また、上記の数値制御システム１により行なわれる制御方法も、ハードウェア、ソフトウェア又はこれらの組み合わせにより実現することができる。ここで、ソフトウェアによって実現されるとは、コンピュータがプログラムを読み込んで実行することにより実現されることを意味する。 Although the embodiments of the present invention have been described above, the numerical control system 1 can be realized by hardware, software, or a combination thereof. Also, the control method performed by the numerical control system 1 can be realized by hardware, software, or a combination thereof. Here, "implemented by software" means implemented by a computer reading and executing a program.
プログラムは、様々なタイプの非一時的なコンピュータ可読媒体（ｎｏｎ－ｔｒａｎｓｉｔｏｒｙ ｃｏｍｐｕｔｅｒ ｒｅａｄａｂｌｅ ｍｅｄｉｕｍ）を用いて記憶され、コンピュータに供給することができる。非一時的なコンピュータ可読媒体は、様々なタイプの実体のある記録媒体（ｔａｎｇｉｂｌｅ ｓｔｏｒａｇｅ ｍｅｄｉｕｍ）を含む。非一時的なコンピュータ可読媒体の例は、磁気記録媒体（例えば、ハードディスクドライブ）、光磁気記録媒体（例えば、光磁気ディスク）、ＣＤ－ＲＯＭ（Ｒｅａｄ Ｏｎｌｙ Ｍｅｍｏｒｙ）、ＣＤ－Ｒ、ＣＤ－Ｒ／Ｗ、半導体メモリ（例えば、マスクＲＯＭ、ＰＲＯＭ（Ｐｒｏｇｒａｍｍａｂｌｅ ＲＯＭ）、ＥＰＲＯＭ（Ｅｒａｓａｂｌｅ ＰＲＯＭ）、フラッシュＲＯＭ、ＲＡＭ（ｒａｎｄｏｍ ａｃｃｅｓｓ ｍｅｍｏｒｙ））を含む。 The program can be stored and provided to the computer using various types of non-transitory computer readable medium. Non-transitory computer-readable media include various types of tangible storage media. Examples of non-transitory computer-readable media include magnetic recording media (e.g., hard disk drives), magneto-optical recording media (e.g., magneto-optical discs), CD-ROMs (Read Only Memory), CD-Rs, CD-R/ W, semiconductor memory (eg, mask ROM, PROM (programmable ROM), EPROM (erasable PROM), flash ROM, RAM (random access memory)).
本開示について詳述したが、本開示は上述した個々の実施形態に限定されるものではない。これらの実施形態は、本開示の要旨を逸脱しない範囲で、または、特許請求の範囲に記載された内容とその均等物から導き出される本開示の趣旨を逸脱しない範囲で、種々の追加、置き換え、変更、部分的削除等が可能である。また、これらの実施形態は、組み合わせて実施することもできる。例えば、上述した実施形態において、各動作の順序や各処理の順序は、一例として示したものであり、これらに限定されるものではない。また、上述した実施形態の説明に数値又は数式が用いられている場合も同様である。 Although the disclosure has been described in detail, the disclosure is not limited to the specific embodiments described above. These embodiments include various additions, replacements, Modification, partial deletion, etc. are possible. Also, these embodiments can be implemented in combination. For example, in the above-described embodiments, the order of each operation and the order of each process are shown as an example, and are not limited to these. The same applies when numerical values or formulas are used in the description of the above-described embodiments.
上記実施形態及び変形例に関し、更に以下の付記を開示する。
（付記１）
数値制御プログラムを用いてロボット制御装置（５）を介してロボット（３）を制御する数値制御装置（４）であって、
前記数値制御プログラム中のロボット制御指令を解析する解析部（４２）と、
前記解析部により解析した前記ロボット制御指令に応じて、負荷推定動作のための負荷推定動作信号を生成する負荷推定指令部（４７）と、
前記負荷推定動作信号を含むロボット指令信号を生成し、前記ロボット制御装置へ送信するロボット指令信号生成部（４５）と、
を備え、
前記ロボット制御装置は、
前記負荷推定動作信号に応じて、前記ロボットに負荷推定動作を実行させると共に、前記ロボットにおいて前記負荷推定動作時に検出される外力を測定し、
測定した前記外力に基づいて、前記ロボットにおいて負荷の情報を設定するための負荷設定情報を算出し、
算出した前記負荷設定情報を前記負荷のパラメータと対応付けて記憶部（５１）に記憶する、
数値制御装置。
（付記２）
前記ロボット制御装置は、算出した前記負荷設定情報を、前記負荷のパラメータとしての前記ロボットの動作状態と対応付けて前記記憶部に記憶し、前記ロボットの前記動作状態は、ワークの把持状態及び前記ロボットのハンドの開閉状態の少なくとも１つを含む、付記１に記載の数値制御装置。
（付記３）
前記負荷推定指令部は、前記負荷推定動作信号において、前記負荷の重量、前記負荷の重心位置、及び前記負荷のイナーシャのうちの少なくとも１つを算出することを指令する、付記１又は２に記載の数値制御装置。
（付記４）
前記負荷推定指令部は、前記負荷推定動作信号において、前記負荷の重量、前記負荷の重心位置、及び前記負荷のイナーシャのうちの少なくとも１つを算出することを指令する、付記１又は２に記載の数値制御装置。
（付記５）
前記ロボットは、人との接触を検知して動作を停止する協働ロボットである、付記１又は２に記載の数値制御装置。
（付記６）
数値制御装置（４）の数値制御プログラムを用いてロボット制御装置（５）を介してロボット（３）を制御する数値制御システム（１）であって、
前記数値制御装置は、
前記数値制御プログラム中のロボット制御指令を解析する解析部（４２）と、
前記解析部により解析した前記ロボット制御指令に応じて、負荷推定動作のための負荷推定動作信号を生成する負荷推定指令部（４７）と、
前記負荷推定動作信号を含むロボット指令信号を生成し、前記ロボット制御装置へ送信するロボット指令信号生成部（４５）と、
を備え、
前記ロボット制御装置は、
前記負荷推定動作信号に応じて、前記ロボットに負荷推定動作を実行させるためのロボット命令を生成するロボット命令生成部（５３）と、
前記負荷推定動作信号に応じて、前記ロボットにおいて前記負荷推定動作時に検出される外力を測定する接触制御部（６２）と、
前記負荷推定動作信号に応じて、測定した前記外力に基づいて、前記ロボットにおいて負荷の情報を設定するための負荷設定情報を算出し、算出した前記負荷設定情報を前記負荷のパラメータと対応付けて記憶部（５１）に記憶する負荷推定実行部（６１）と、
を備える数値制御システム。
（付記７）
前記負荷推定実行部は、算出した前記負荷設定情報を、前記負荷のパラメータとしての前記ロボットの動作状態と対応付けて前記記憶部に記憶し、前記ロボットの前記動作状態は、ワークの把持状態及び前記ロボットのハンドの開閉状態の少なくとも１つを含む、
付記６に記載の数値制御システム。
（付記８）
前記負荷推定指令部は、前記負荷推定動作信号において、前記ロボットの並進移動方向又は前記ロボットの関節軸の回転方向を前記ロボット制御装置に指令する、付記６又は７に記載の数値制御システム。
（付記９）
前記負荷推定指令部は、前記負荷推定動作信号において、前記負荷の重量、負荷の重心位置、負荷のイナーシャのうちの少なくとも１つを前記ロボット制御装置に算出させる、付記６又は７に記載の数値制御システム。
（付記１０）
前記ロボットは、人との接触を検知して動作を停止する協働ロボットである、付記６又は７に記載の数値制御システム。The following additional remarks are disclosed regarding the above-described embodiment and modifications.
(Appendix 1)
A numerical controller (4) for controlling a robot (3) via a robot controller (5) using a numerical control program,
an analysis unit (42) for analyzing a robot control command in the numerical control program;
a load estimation command unit (47) that generates a load estimation operation signal for a load estimation operation according to the robot control command analyzed by the analysis unit;
a robot command signal generation unit (45) that generates a robot command signal including the load estimation motion signal and transmits the robot command signal to the robot controller;
with
The robot control device is
causing the robot to perform a load estimation operation according to the load estimation operation signal, and measuring an external force detected by the robot during the load estimation operation;
calculating load setting information for setting load information in the robot based on the measured external force;
storing the calculated load setting information in a storage unit (51) in association with parameters of the load;
Numerical controller.
(Appendix 2)
The robot control device stores the calculated load setting information in the storage unit in association with an operation state of the robot as a parameter of the load, and the operation state of the robot includes a gripping state of a workpiece and the load setting information. 2. The numerical control device according to appendix 1, including at least one of open/closed states of the hand of the robot.
(Appendix 3)
3. The load estimation command unit according to
(Appendix 4)
3. The load estimation command unit according to
(Appendix 5)
3. The numerical controller according to
(Appendix 6)
A numerical control system (1) for controlling a robot (3) via a robot controller (5) using a numerical control program of a numerical controller (4),
The numerical controller is
an analysis unit (42) for analyzing a robot control command in the numerical control program;
a load estimation command unit (47) that generates a load estimation operation signal for a load estimation operation according to the robot control command analyzed by the analysis unit;
a robot command signal generation unit (45) that generates a robot command signal including the load estimation motion signal and transmits the robot command signal to the robot controller;
with
The robot control device is
a robot command generation unit (53) for generating a robot command for causing the robot to perform a load estimation motion according to the load estimation motion signal;
a contact control unit (62) for measuring an external force detected by the robot during the load estimation motion according to the load estimation motion signal;
load setting information for setting load information in the robot is calculated according to the load estimation motion signal and based on the measured external force, and the calculated load setting information is associated with the load parameter. a load estimation execution unit (61) stored in a storage unit (51);
Numerical control system with
(Appendix 7)
The load estimation execution unit stores the calculated load setting information in the storage unit in association with the operating state of the robot as a parameter of the load. including at least one of open and closed states of the hand of the robot;
A numerical control system according to appendix 6.
(Appendix 8)
8. The numerical control system according to appendix 6 or 7, wherein the load estimation command section commands the translational movement direction of the robot or the rotation direction of the joint shaft of the robot to the robot control device in the load estimation motion signal.
(Appendix 9)
8. The numerical value according to appendix 6 or 7, wherein the load estimation command unit causes the robot control device to calculate at least one of the weight of the load, the position of the center of gravity of the load, and the inertia of the load in the load estimation motion signal. control system.
(Appendix 10)
8. The numerical control system according to appendix 6 or 7, wherein the robot is a collaborative robot that detects contact with a person and stops moving.
１ 数値制御システム
２ 工作機械
３ 協働ロボット
４ 数値制御装置
５ ロボット制御装置
３１ 外力検出部
４１ プログラム入力部
４２ 解析部
４３ 動作制御部
４４ 記憶部
４５ ロボット指令信号生成部
４６ データ送受信部
４７ 負荷推定指令部
５１ 記憶部
５２ 解析部
５３ ロボット命令生成部
５４ プログラム管理部
５５ 軌跡制御部
５６ キネマティクス制御部
５７ サーボ制御部
５８ 負荷設定選択部
５９ ダイナミクス制御部
６０ データ送受信部
６１ 負荷推定実行部
６２ 接触制御部1
Claims (10)
前記数値制御プログラム中のロボット制御指令を解析する解析部と、
前記解析部により解析した前記ロボット制御指令に応じて、負荷推定動作のための負荷推定動作信号を生成する負荷推定指令部と、
前記負荷推定動作信号を含むロボット指令信号を生成し、前記ロボット制御装置へ送信するロボット指令信号生成部と、
を備え、
前記ロボット制御装置は、
前記負荷推定動作信号に応じて、前記ロボットに負荷推定動作を実行させると共に、前記ロボットにおいて前記負荷推定動作時に検出される外力を測定し、
測定した前記外力に基づいて、前記ロボットにおいて負荷の情報を設定するための負荷設定情報を算出し、
算出した前記負荷設定情報を前記負荷のパラメータと対応付けて記憶部に記憶する、
数値制御装置。A numerical controller that controls a robot via a robot controller using a numerical control program,
an analysis unit that analyzes a robot control command in the numerical control program;
a load estimation command unit that generates a load estimation operation signal for a load estimation operation according to the robot control command analyzed by the analysis unit;
a robot command signal generator that generates a robot command signal including the load estimation motion signal and transmits the robot command signal to the robot controller;
with
The robot control device is
causing the robot to perform a load estimation operation according to the load estimation operation signal, and measuring an external force detected by the robot during the load estimation operation;
calculating load setting information for setting load information in the robot based on the measured external force;
storing the calculated load setting information in a storage unit in association with parameters of the load;
Numerical controller.
前記数値制御装置は、
前記数値制御プログラム中のロボット制御指令を解析する解析部と、
前記解析部により解析した前記ロボット制御指令に応じて、負荷推定動作のための負荷推定動作信号を生成する負荷推定指令部と、
前記負荷推定動作信号を含むロボット指令信号を生成し、前記ロボット制御装置へ送信するロボット指令信号生成部と、
を備え、
前記ロボット制御装置は、
前記負荷推定動作信号に応じて、前記ロボットに負荷推定動作を実行させるためのロボット命令を生成するロボット命令生成部と、
前記負荷推定動作信号に応じて、前記ロボットにおいて前記負荷推定動作時に検出される外力を測定する接触制御部と、
前記負荷推定動作信号に応じて、測定した前記外力に基づいて、前記ロボットにおいて負荷の情報を設定するための負荷設定情報を算出し、算出した前記負荷設定情報を前記負荷のパラメータと対応付けて記憶部に記憶する負荷推定実行部と、
を備える数値制御システム。A numerical control system that controls a robot via a robot controller using a numerical control program of the numerical controller,
The numerical controller is
an analysis unit that analyzes a robot control command in the numerical control program;
a load estimation command unit that generates a load estimation operation signal for a load estimation operation according to the robot control command analyzed by the analysis unit;
a robot command signal generator that generates a robot command signal including the load estimation motion signal and transmits the robot command signal to the robot controller;
with
The robot control device is
a robot instruction generation unit that generates a robot instruction for causing the robot to perform a load estimation operation according to the load estimation operation signal;
a contact control unit that measures an external force detected by the robot during the load estimation operation according to the load estimation operation signal;
load setting information for setting load information in the robot is calculated according to the load estimation motion signal and based on the measured external force, and the calculated load setting information is associated with the load parameter. a load estimation execution unit stored in a storage unit;
Numerical control system with
請求項６に記載の数値制御システム。The load estimation execution unit stores the calculated load setting information in the storage unit in association with the operating state of the robot as a parameter of the load. including at least one of open and closed states of the hand of the robot;
The numerical control system according to claim 6.
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2023003095 | 2023-01-31 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| JP7311732B1 true JP7311732B1 (en) | 2023-07-19 |
Family
ID=87201271
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2023525093A Active JP7311732B1 (en) | 2023-01-31 | 2023-01-31 | Numerical controller and numerical control system |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP7311732B1 (en) |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2014241018A (en) * | 2013-06-11 | 2014-12-25 | ファナック株式会社 | Machine tool and control device for controlling robot |
| JP2018122397A (en) * | 2017-01-31 | 2018-08-09 | ブラザー工業株式会社 | Control device |
| JP2020170356A (en) * | 2019-04-03 | 2020-10-15 | ファナック株式会社 | Machining control system and machining system |
| JP7022260B1 (en) * | 2020-06-30 | 2022-02-17 | ファナック株式会社 | Numerical control system |
-
2023
- 2023-01-31 JP JP2023525093A patent/JP7311732B1/en active Active
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2014241018A (en) * | 2013-06-11 | 2014-12-25 | ファナック株式会社 | Machine tool and control device for controlling robot |
| JP2018122397A (en) * | 2017-01-31 | 2018-08-09 | ブラザー工業株式会社 | Control device |
| JP2020170356A (en) * | 2019-04-03 | 2020-10-15 | ファナック株式会社 | Machining control system and machining system |
| JP7022260B1 (en) * | 2020-06-30 | 2022-02-17 | ファナック株式会社 | Numerical control system |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP2020516475A (en) | Teaching Mode Collision Avoidance System and Method for Industrial Robot Manipulators | |
| JP6469065B2 (en) | Machine learning device and machining time prediction device | |
| WO2022224425A1 (en) | Numerical control device and numerical control system | |
| JP2019146421A (en) | Failure predicting device and mechanical learning device | |
| JP7311732B1 (en) | Numerical controller and numerical control system | |
| JP7260728B1 (en) | Numerical controller and numerical control system | |
| WO2022102578A1 (en) | Numerical control apparatus and numerical control system | |
| JP7260727B1 (en) | Numerical controller and numerical control system | |
| WO2024116221A1 (en) | Numerical control device and numerical control system | |
| JP7288158B1 (en) | Numerical controller | |
| WO2024116223A1 (en) | Robot control device | |
| JP7288157B1 (en) | Numerical controller and numerical control system | |
| JPH10143218A (en) | Cycle time prediction device for robot | |
| JP6811878B1 (en) | Numerical control device and numerical control method | |
| WO2022176818A1 (en) | Robot control device, robot control system, and computer program | |
| TW202422252A (en) | Numerical control device and numerical control system | |
| JP7355965B1 (en) | Numerical control device and numerical control system | |
| JP7448736B1 (en) | Numerical control device and numerical control system | |
| TW202419993A (en) | Numerical control device and numerical control system | |
| TW202419994A (en) | Numerical control device and numerical control system | |
| TW202419995A (en) | Numerical control device and numerical control system | |
| JP7332822B1 (en) | Numerical controller and numerical control system | |
| Maťuga | Control and positioning of robotic arm on CNC cutting machines and their applications in industry | |
| WO2022191057A1 (en) | Motion-path generation device, numerical control device, numerical control system, and computer program | |
| US20240231308A9 (en) | Command generation device and non-transitory computer-readable medium storing a computer program |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20230425 |
|
| A871 | Explanation of circumstances concerning accelerated examination |
Free format text: JAPANESE INTERMEDIATE CODE: A871 Effective date: 20230425 |
|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20230606 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20230706 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 7311732 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |