FANUCロボットの標準インターフェースコマンド
本文では、FANUCロボットとMech-Mindビジョンシステム間のTCPプロトコル通信の標準インターフェースコマンドについて説明します。ここで、ロボット(クライアント)はコマンドをMech-Mindビジョンシステム(サーバー)に送信し、Mech-Mindビジョンシステムは処理されたデータをロボットに返します。
これらのコマンドを使用する前に、以下のことに注意してください。
-
コマンドのデータ単位:
-
関節角度の単位は度(°)です。
-
ロボットのフランジ位置姿勢またはロボットのツール位置姿勢は位置と姿勢で構成されています。位置(XYZ座標値)の単位はミリメートル(mm)で、姿勢はオイラー角で表され、単位は度(°)です。
-
-
ビジョンポイントまたは経路点:
-
ビジョンポイント:Mech-Visionが認識した対象物で、1つのビジョンポイントには対象物の位置姿勢、ラベル、速度、対象物の寸法、カスタマイズされたデータなどが含まれます。
-
経路点:ロボットが計画された経路に沿って1つずつ到達する必要のあるポイントで、経路点にはロボットの位置姿勢、ラベル、移動方式、速度などが含まれます。経路点は次の2つの種類に分けられます。
-
「ビジョン処理による移動」の経路点:「ビジョン処理による移動」ステップに対応する経路点。
-
「ビジョン処理による移動」の以外の経路点:「ビジョン処理による移動」ステップ以外の移動ステップに対応する経路点。
-
-
Mech-Visionプロジェクトを実行
機能
このコマンドは、Mech-Visionプロジェクトを実行するために使用されます。Mech-Visionプロジェクトの実行中、ビジョンシステムはカメラ撮影を行い、一連のビジョンアルゴリズムで画像データを処理し、一連のビジョンポイントまたは経路点を生成します。
|
呼び出し順序
-
プロジェクトのステップパラメータは、Mech-Visionプロジェクトを実行する前に設定する必要があります。したがって、 Mech-Visionのパラメータレシピを切り替る または Mech-Visionプロジェクトに対象物の寸法を入力 コマンドは Mech-Visionプロジェクトを実行 コマンドの前に呼び出す必要があります。
-
Mech-Visionプロジェクトが実行された後、ビジョンシステムはビジョンポイントまたは経路点を取得できます。したがって、 Mech-Visionプロジェクトを実行 コマンドは ビジョン結果を取得 、 Mech-Visionによって計画された計画された計画経路を取得 または Mech-Visionのカスタマイズされたデータを取得 コマンドの前に呼び出す必要があります。
コマンド形式
MM_START_VIS(Job,Pos_Num_Need,SendPos_Type,Pr_Num)
入力パラメータ
Job
このパラメータはMech-Visionのプロジェクト番号を表し、Mech-Visionプロジェクトリストで確認できます。プロジェクト名の前の数字は、プロジェクト番号を示します。
Pos_Num_Need
このパラメータは、Mech-Visionプロジェクトから取得されるビジョンポイントまたは経路点の予期数を表します。値は0または0より大きい整数です。
Mech-Visionプロジェクトに「経路計画」ステップがある場合、このパラメータは経路点の予期数を表します。それ以外の場合はビジョンポイントの予期数を表します。 |
-
0:Mech-Visionプロジェクトからすべてのビジョンポイントまたは経路点を取得します。
-
0より大きい整数:Mech-Visionプロジェクトから指定数のビジョンポイントまたは経路点を取得します。
-
Mech-Visionプロジェクトから出力されたビジョンポイントまたは経路点の合計数が、指定されたパラメータ値より小さい場合、出力されたすべてのビジョンポイントまたは経路点が取得されます。
-
Mech-Visionプロジェクトから出力されたビジョンポイントまたは経路点の合計数が、指定されたパラメータ値より大きい場合、指定された数のビジョンポイントまたは経路点が取得されます。
-
|
SendPos_Type
このパラメータは、ロボット実機の位置姿勢がMech-Visionプロジェクトにどのような形式で送信されるかを指定します。値が0、1、2または3です。
SendPos_Type | 説明 | 適用シーン |
---|---|---|
0 |
このコマンドは、ロボットの位置姿勢をMech-Visionプロジェクトに送信する必要はありません。 |
カメラがEye to Hand方式で取り付けられています。Mech-Visionプロジェクトに「経路計画」ステップがある場合、経路計画の開始位置は経路計画設定ツールで設定された初期位置となります。 |
1 |
このコマンドは、ロボットの現在の関節角度とフランジ位置姿勢をMech-Visionプロジェクトに送信する必要があります。 |
カメラがEye in Hand方式で取り付けられています。この設定は、直行ロボット以外のほとんどのロボットに適用されます。 |
2 |
このコマンドは、ロボットの現在のフランジ位置姿勢をMech-Visionプロジェクトに送信する必要があります。 |
カメラがEye in Hand方式で取り付けられています。ロボットに関節角度データはなく、フランジ位置姿勢データのみある場合に適用可能です(例えば直行ロボット)。 |
3 |
このコマンドは、カスタマイズされた関節角度をMech-Visionプロジェクトに送信する必要があります。 |
カメラがEye to Hand方式で取り付けられています。Mech-Visionプロジェクトに「経路計画」ステップがあり、ロボット側から「経路計画」ステップの開始位置を設定する必要がある場合に適用可能です。 |
Pr_Num
このパラメータは、位置レジスタの番号を指定します。この番号に対応する位置レジスタは、カスタマイズされた関節角度データを保存するために使用されます。
-
SendPos_Typeパラメータ値が3の場合、位置レジスタで表される関節角度データは計画のための最初の経路点としてMech-Visionプロジェクトの「経路計画」ステップに送信されます。また、位置レジスタのデータ型を関節型に変更する必要があります。
-
SendPos_Typeのパラメータ値が3以外の場合、位置レジスタで表される関節角度データは実際には使用されませんが、この位置レジスタの番号を設定する必要があります。
ビジョン結果を取得
機能
このコマンドは、Mech-Visionによって出力されたビジョン結果(一連のビジョンポイント)を取得するために使用されます。ビジョンポイントの対象物の位置姿勢(つまり「出力」ステップの「poses」ポートのデータ)は、ビジョンシステムによって自動的に対応するロボットのツール位置姿勢に変換されます。変換流れは以下の通りです。
-
対象物の位置姿勢を四元数からオイラー角の形式に変換します。
-
対象物の位置姿勢をX軸を中心に180°回転させ、Z軸が下を向くようにします。
-
ロボットメーカーによって定義されたゼロ位置に基づいて、垂直方向に対応するオフセットを追加します。
呼び出し順序
このコマンドは Mech-Visionプロジェクトを実行 の後に呼び出す必要があります。このコマンドを使用した後、位置姿勢データを表示するために ビジョン結果または計画された経路を保存(位置姿勢形式はツール位置姿勢) コマンドを呼び出す必要があります。
コマンド形式
MM_GET_VIS(Job,Reg_Pos_Num,Reg_Status)
入力パラメータ
Job
このパラメータはMech-Visionのプロジェクト番号を表し、Mech-Visionプロジェクトリストで確認できます。プロジェクト名の前の数字は、プロジェクト番号を示します。
出力パラメータ
Reg_Pos_Num
このパラメータは、数値レジスタの番号を指定します。この番号に対応する数値レジスタは、Mech-Visionが返されたビジョンポイントの数を保存するために使用されます。
Reg_Status
このパラメータは、数値レジスタの番号を指定します。この番号に対応する数値レジスタは、コマンド実行のステータスコードを保存するために使用されます。コマンドが正常に実行された場合、ステータスコードは 1100 になります。 コマンド実行中にエラーが発生した場合、対応するエラーコードが返されます。詳細については、 標準インターフェースのステータスコード一覧とトラブルシューティング をご参照ください。
このコマンドを呼び出した後、ビジョンシステムは10秒以内に処理結果を返さない場合、タイムアウトのエラーコードが返されます。Mech-Visionでは、ツールバーから をクリックし、実際の状況に応じてタイムアウトを変更することができます。 |
ビジョン結果または計画された経路を保存(位置姿勢形式はツール位置姿勢)
コマンド形式
MM_GET_POS(Serial,Pr_Num,Reg_Label,Reg_Speed)
入力パラメータ
Serial
このパラメータは、ビジョンポイントまたは経路点のインデックス番号を指定します。つまり、このインデックス番号に対応するビジョンポイントまたは経路点のツール位置姿勢、ラベル、および速度が指定された変数に保存されます。インデックス番号は1から始まります。
出力パラメータ
Pr_Num
このパラメータは、位置レジスタの番号を指定します。この番号に対応する位置レジスタは、指定されたインデックス番号に対応するビジョンポイントまたは経路点のツール位置姿勢を保存するために使用されます。
Reg_Label
このパラメータは、数値レジスタの番号を指定します。この番号に対応する数値レジスタは、指定されたインデックス番号に対応するビジョンポイントまたは経路点のラベルを保存するために使用されます。
Reg_Speed
このパラメータは、数値レジスタの番号を指定します。この番号に対応する数値レジスタは、指定されたインデックス番号に対応するビジョンポイントまたは経路点の速度を保存するために使用されます。
計画された経路を保存(位置姿勢形式は関節角度)
Mech-Visionのパラメータレシピを切り替る
機能
このコマンドは、Mech-Visionプロジェクトに使用するパラメータレシピを切り替えるために使用されます。下図は、Mech-VisionプロジェクトのレシピAまたはレシピBの手動切り替えを示しています。パラメータレシピの詳細については、パラメータレシピ をご参照ください。
呼び出し順序
このコマンドは、 Mech-Visionプロジェクトを実行 コマンドの前に呼び出す必要があります。
コマンド形式
MM_SET_MOD(Job,Model_Num)
入力パラメータ
Job
このパラメータはMech-Visionのプロジェクト番号を表し、Mech-Visionプロジェクトリストで確認できます。プロジェクト名の前の数字は、プロジェクト番号を示します。
Model_Num
このパラメータは、Mech-Visionプロジェクトのパラメータレシピ番号を表します。パラメータレシピ番号を確認するには、 パラメータレシピの番号を確認 をご参照ください。
Mech-Visionによって計画された計画された計画経路を取得
機能
このコマンドは、Mech-Visionによって計画された経路(一連の経路点)を取得するために使用されます。ここでの経路は、経路計画設定ツールによって計画されます。下図に示すように、 エディタを開く をクリックして経路計画設定ツールを開くことができます。「経路計画」ステップの詳細については、経路計画 をご参照ください。
Mech-Visionの「出力」ステップの ポートタイプ パラメータを「事前定義済み(ロボット経路)」に設定する必要があります。 |
呼び出し順序
このコマンドは Mech-Visionプロジェクトを実行 の後に呼び出す必要があります。このコマンドを使用した後、位置姿勢データを表示するために ビジョン結果または計画された経路を保存(位置姿勢形式はツール位置姿勢) または 計画された経路を保存(位置姿勢形式は関節角度) コマンドを呼び出す必要があります。
コマンド形式
MM_GET_VISP(Job,Jps_Pos,Reg_Pos_Num,Reg_VPos_Num,Reg_Status)
入力パラメータ
Job
このパラメータはMech-Visionのプロジェクト番号を表し、Mech-Visionプロジェクトリストで確認できます。プロジェクト名の前の数字は、プロジェクト番号を示します。
Jps_Pos
このパラメータは、経路点の位置姿勢形式を指定するために使用されます。値は1または2です。
-
1:関節角度。このコマンドを使用した後、関節角度データを表示するために 計画された経路を保存(位置姿勢形式は関節角度) コマンドを呼び出す必要があります。
-
2:ツール位置姿勢。このコマンドを使用した後、ツール位置姿勢データを表示するために ビジョン結果または計画された経路を保存(位置姿勢形式はツール位置姿勢) コマンドを呼び出す必要があります。
出力パラメータ
Reg_Pos_Num
このパラメータは、数値レジスタの番号を指定します。この番号に対応する数値レジスタは、ビジョンシステムが返す経路点の数を保存します。デフォルトでは、一度にビジョンシステムによって送信される経路点の最大数は20です。したがって、このパラメータのデフォルトの最大値は20です。 Mech-Visionでは、ツールバーから
をクリックします。実際の状況に応じて最大数の初期値を変更することができますが、最大数の上限は30です。Mech-Visionによって計画された計画された計画経路を取得 コマンドを呼び出す前に、必ず Mech-Visionプロジェクトを実行 コマンドのPos_Num_Needを0に設定してください。これにより、Mech-Visionによって計画された計画された計画経路を取得 コマンドの呼び出し回数をを減らすことができます。Mech-Visionプロジェクトを実行 コマンドのPos_Num_Needが1に設定されている場合、Mech-Visionによって計画された計画された計画経路を取得 コマンドを一回呼び出すと1つの経路点のみが取得され、すべての経路点を取得するには複数回の呼び出しが必要です。 |
Reg_VPos_Num
このパラメータは、数値レジスタの番号を指定します。この番号は、経路計画設定ツールでの「ビジョン処理による移動」ステップの経路点が経路全体における位置番号を保存するための数値レジスタの番号を指定します。経路中に「ビジョン処理による移動」ステップの経路点がない場合、このパラメータの値は0になります。
例えば、経路全体が「移動_1」、「移動_2」、「ビジョン処理による移動」、「移動_3」という経路点で構成されている場合、「ビジョン処理による移動」の経路点の位置番号は3です。
Reg_Status
このパラメータは、数値レジスタの番号を指定します。この番号に対応する数値レジスタは、コマンド実行のステータスコードを保存するために使用されます。コマンドが正常に実行された場合、ステータスコードは 1103 になります。 コマンド実行中にエラーが発生した場合、対応するエラーコードが返されます。詳細については、 標準インターフェースのステータスコード一覧とトラブルシューティング をご参照ください。
このコマンドを呼び出した後、ビジョンシステムは10秒以内に処理結果を返さない場合、タイムアウトのエラーコードが返されます。Mech-Visionでは、ツールバーから をクリックし、実際の状況に応じてタイムアウトを変更することができます。 |
Mech-Visionのカスタマイズされたデータを取得
機能
このコマンドは、Mech-Visionの「出力」ステップからカスタマイズされたポートのデータを取得するために使用されます。このコマンドを1回呼び出すと、「出力」ステップのすべてのポートデータがロボットメモリに保存されます。
カスタマイズされたポートを設定するには、「出力」ステップのパラメータで エディタを開く をクリックし、表示される画面で設定を行います。その中、事前定義された通信キー名はカスタマイズされたポート名です。例えば、下図の「customeData1」ポートと「customeData2」ポートはカスタマイズされたポートです。
|
呼び出し順序
このコマンドは Mech-Visionプロジェクトを実行 の後に呼び出す必要があります。このコマンドを使用した後、カスタマイズされたデータを表示するために Mech-Visionのカスタマイズされたデータを保存 コマンドを呼び出す必要があります。
コマンド形式
MM_GET_DY_DT(Job,Reg_Pos_Num,Reg_Status)
入力パラメータ
Job
このパラメータはMech-Visionのプロジェクト番号を表し、Mech-Visionプロジェクトリストで確認できます。プロジェクト名の前の数字は、プロジェクト番号を示します。
出力パラメータ
Reg_Pos_Num
このパラメータは、数値レジスタの番号を指定します。この番号に対応する数値レジスタは、Mech-Visionが返されたビジョンポイントの数を保存するために使用されます。
Reg_Status
このパラメータは、数値レジスタの番号を指定します。この番号に対応する数値レジスタは、コマンド実行のステータスコードを保存するために使用されます。コマンドが正常に実行された場合、ステータスコードは 1100 になります。 コマンド実行中にエラーが発生した場合、対応するエラーコードが返されます。詳細については、 標準インターフェースのステータスコード一覧とトラブルシューティング をご参照ください。
Mech-Visionのカスタマイズされたデータを保存
呼び出し順序
このコマンドは Mech-Visionのカスタマイズされたデータを取得 の後に呼び出す必要があります。
コマンド形式
MM_GET_DYPOS(Serial,Pr_Num,Reg_Label,Reg_UserData)
入力パラメータ
Serial
このパラメータは、ビジョンポイントのインデックス番号を指定します。つまり、このインデックス番号に対応するビジョンポイントのカスタマイズされたデータを指定された変数に保存します。インデックス番号は1から始まります。
出力パラメータ
Pr_Num
このパラメータは、位置レジスタの番号を指定します。この番号に対応する位置レジスタは、指定されたインデックス番号に対応するビジョンポイントのツール位置姿勢を保存するために使用されます。
Reg_Label
このパラメータは、数値レジスタの番号を指定します。この番号に対応する数値レジスタは、指定されたインデックス番号に対応するビジョンポイントのラベルを保存するために使用されます。Mech-Visionでラベルのポートが設定されていない場合、0で埋められます。
Reg_UserData
このパラメータは、数値レジスタの開始番号を指定します。指定された開始番号から、指定されたインデックス番号に対応するビジョンポイントのカスタマイズされたデータを対応するレジスタに順番に保存します。
吸盤のDO信号を取得
機能
このコマンドは、Mech-VisionまたはMech-Vizプロジェクトによって計画された複数パーティション吸盤の制御信号を取得するために使用されます。このコマンドは64個のDO信号を返します。有効なDO信号は非負の整数で、範囲は0から999です。無効なDO信号は-1であり、プレースホルダーとして使用されます。ロボットは、吸盤のDO信号を設定 コマンドで取得したDO信号リストをロボットハンドに適用します。
例えば下表の場合、返された有効なDO信号は1、3、5、6で、これは上記のDO信号に対応する値がONに設定されていることを示します。
1番目 |
2番目 |
3番目 |
4番目 |
5番目 |
6番目 |
7番目 |
8番目 |
… |
63番目 |
64番目 |
1 |
3 |
5 |
6 |
-1 |
-1 |
-1 |
-1 |
… |
-1 |
-1 |
このコマンドを使用する前に、DO信号を設定する必要があります。
-
Mech-VisionプロジェクトのDO信号を設定
「経路計画」ステップのパラメータから エディタを開く をクリックします。表示される画面でロボットハンド名をダブルクリックし、 ロボットハンドの種類 を デパレタイズ用吸盤 に選択します。 デパレタイズ用吸盤設定 をクリックし、実際の状況に応じてDO信号を設定します。
-
Mech-VizプロジェクトのDO信号と「DOを設定」ステップを設定
-
Mech-Vizでは、ロボットハンド名をダブルクリックし、 ロボットハンドの種類 を デパレタイズ用吸盤 に選択します。 デパレタイズ用吸盤設定 をクリックし、実際の状況に応じてDO信号を設定します。
-
「DOを設定」ステップを設定します。
-
「DOを設定」ステップは、「ビジョン処理による移動」ステップの後につなぐ必要があります。
-
受信者 を 標準インターフェース に設定します。
-
実行モード では、 ソース に ビジョン処理による移動 を選択し、 「ビジョン処理による移動」を選択 を使用する「ビジョン処理による移動」ステップ名、すなわち「DOを設定」ステップの前にある「ビジョン処理による移動」ステップ名、例えば下図では「ビジョン処理による移動_1」を選択します。
-
-
呼び出し順序
-
Mech-Visionによって計画された計画された計画経路を取得、Mech-Vizの計画経路を取得 または 「ビジョン処理による移動」の計画データまたはカスタマイズされたデータを取得 コマンドの後にこのコマンドを呼び出す必要があります。すなわち、ロボットはまず移動経路を取得し、その後に「ビジョン処理による移動」の経路点に対応する吸盤DO信号を取得する必要があります。
-
このコマンドは、 吸盤のDO信号を設定 コマンドの前に呼び出す必要があります。
吸盤のDO信号を設定
呼び出し順序
このコマンドは 吸盤のDO信号を取得 の後に呼び出す必要があります。
Mech-Vizプロジェクトを実行
機能
このコマンドは、Mech-Vizプロジェクトを実行するために使用されます。Mech-Vizは、Mech-Visionの出力されたビジョン結果に基づいてロボットの動作経路を計画します。
Mech-Vizのリソースパネルでプロジェクトを右クリックし、自動的に読み込む にチェックを入れます。 |
呼び出し順序
プロジェクトのステップパラメータは、Mech-Vizプロジェクトを実行する前に設定する必要があります。したがって、 Mech-Vizのステップパラメータを読み取る または Mech-Vizのステップパラメータを設定 コマンドは Mech-Vizプロジェクトを実行 コマンドの前に呼び出す必要があります。
コマンド形式
MM_START_VIZ(SendPos_Type,Pr_Num)
入力パラメータ
SendPos_Type
このパラメータは、ロボット実機の位置姿勢がMech-Vizプロジェクトにどのような形式で送信されるかを指定します。値が0、1または2です。
ロボットの位置姿勢タイプ | 説明 | 適用シーン |
---|---|---|
0 |
このコマンドはロボットの位置姿勢をMech-Vizプロジェクトに送信する必要がありません。Mech-Vizプロジェクトでの仮想ロボットは初期位置姿勢(JPs = [0, 0, 0, 0, 0, 0] )から最初の経路点に移動します。 |
カメラがEye to Hand方式で取り付けられています。 |
1 |
このコマンドはロボットの現在の関節角度とフランジ位置姿勢をMech-Vizプロジェクトに送信する必要があります。Mech-Vizプロジェクトでの仮想ロボットは受信された関節角度から最初の経路点に移動します。 |
カメラの取り付け方式がEye in Handである場合は推奨します。 |
2 |
このコマンドはロボットのティーチポイント(現在の関節角度ではなく、カスタマイズされた関節角度)をMech-Vizプロジェクトに送信する必要があります。これは、ロボットが画像撮影領域の外にいる場合に(下図に示す)、Mech-Vizプロジェクトが次回の経路を事前に計画することをトリガーするために使用されます。Mech-Vizプロジェクトでの仮想ロボットは受信された最初のティーチポイントから最初の経路点に移動します。 |
カメラの取り付け方式がEye to Handである場合は推奨します。 |
カメラの取り付け方法がEye to Handである場合、なぜ ロボットの位置姿勢タイプ を2に設定することが推奨されますか?
下図に示すように、ロボットは配置領域で動作しています。
この場合、 SendPos_Type を 1 に設定すると、ロボットの現在の位置姿勢がMech-Vizに送信され、ロボット実機は最初の経路点に移動する前に他の位置に移動する可能性があります。仮想ロボットは現在の位置からMech-Vizプロジェクトの最初の経路点に移動し、この移動中に衝突が検出されるため警告が表示される可能性があります。
この場合、 SendPos_Type を 2 に設定すると、ロボット側で設定されたティーチポイントがMech-Vizに送信されます。これにより、ロボット実機は配置領域でMech-Vizをトリガーして次回の経路を事前に計画し、サイクル時間を短縮することができます。
したがって、カメラがEye to Hand方式で取り付けられている場合、ロボットの位置姿勢タイプを2に設定することが推奨されます。
Pr_Num
このパラメータは、位置レジスタの番号を指定します。この番号に対応する位置レジスタは、カスタマイズされた関節角度データを保存するために使用されます。
-
SendPos_Typeパラメータ値が2の場合、位置レジスタで表される関節角度データは計画のための最初の経路点としてMech-Vizプロジェクトに送信されます。また、位置レジスタのデータ型を関節型に変更する必要があります。
-
SendPos_Typeのパラメータ値が2以外の場合、位置レジスタで表される関節角度データは実際には使用されませんが、この位置レジスタの番号を設定する必要があります。
Mech-Vizの分岐ステップの出口を設定
機能
このコマンドは、「メッセージによって異なる分岐を実行」ステップの出口を設定するために使用されます。Mech-Vizプロジェクトが「メッセージによって異なる分岐を実行」ステップに実行すると、このコマンドによって出口を指定するのを待ちます。
呼び出し順序
このコマンドは Mech-Vizプロジェクトを実行 の後に呼び出す必要があります。
Mech-Vizの現在のインデックスを設定
機能
このコマンドは、インデックス付きのステップの現在のインデックス値を設定するために使用されます。インデックス付きのステップとは、「グリッドによる移動」、「リストによる移動」、「事前計画パレットパターン」、「カスタマイズのパレットパターン」など、「インデックス」パラメータを含むステップのことです。
呼び出し順序
通常、インデックス付きのステップの前には「メッセージによって異なる分岐を実行」ステップがあり、ロボットはまず Mech-Vizプロジェクトを実行 コマンドを呼び出し、次に Mech-Vizの現在のインデックスを設定 コマンドを呼び出し、最後に Mech-Vizの分岐ステップの出口を設定 コマンドを呼び出します。これにより、Mech-Vizは現在のインデックス値を設定するための十分な時間が確保されます。
Mech-Vizの計画経路を取得
機能
このコマンドは、Mech-Vizプロジェクトによって計画された動作経路(一連の経路点)を取得するために使用されます。
経路点:ロボットが計画された経路に沿って1つずつ到達する必要のあるポイントで、経路点にはロボットの位置姿勢、ラベル、移動方式、速度などが含まれます。経路点は次の2つの種類に分けられます。
|
呼び出し順序
このコマンドは、Mech-Vizプロジェクトを実行 コマンドの後に呼び出す必要があります。このコマンドを使用した後、位置姿勢データを表示するために ビジョン結果または計画された経路を保存(位置姿勢形式はツール位置姿勢) または 計画された経路を保存(位置姿勢形式は関節角度) コマンドを呼び出す必要があります。
コマンド形式
MM_GET_VIZ(Jps_Pos,Reg_Pos_Num,Reg_VPos_Num,Reg_Status)
入力パラメータ
Jps_Pos
このパラメータは、経路点の位置姿勢形式を指定するために使用されます。値は1または2です。
-
1:関節角度。このコマンドを使用した後、関節角度データを表示するために 計画された経路を保存(位置姿勢形式は関節角度) コマンドを呼び出す必要があります。
-
2:ツール位置姿勢。このコマンドを使用した後、ツール位置姿勢データを表示するために ビジョン結果または計画された経路を保存(位置姿勢形式はツール位置姿勢) コマンドを呼び出す必要があります。
出力パラメータ
Reg_Pos_Num
このパラメータは、数値レジスタの番号を指定します。この番号に対応する数値レジスタは、ビジョンシステムが返す経路点の数を保存するために使用されます。デフォルトでは、一度にビジョンシステムによって送信される経路点の最大数は20個であるため、このパラメータの最大初期値は20となります。 Mech-Visionでは、ツールバーから
をクリックします。実際の状況に応じて最大数の初期値を変更することができますが、最大数の上限は30です。Reg_VPos_Num
このパラメータは、数値レジスタの番号を指定します。この番号は、Mech-Vizプロジェクトでの「ビジョン処理による移動」ステップの経路点が経路全体における位置番号を保存するための数値レジスタの番号を指定します。経路中に「ビジョン処理による移動」ステップの経路点がない場合、このパラメータの値は0になります。
例えば、経路全体が「移動_1」、「移動_2」、「ビジョン処理による移動」、「移動_3」という経路点で構成されている場合、「ビジョン処理による移動」の経路点の位置番号は3です。
Reg_Status
このパラメータは、数値レジスタの番号を指定します。この番号に対応する数値レジスタは、コマンド実行のステータスコードを保存するために使用されます。コマンドが正常に実行された場合、ステータスコードは 2100 になります。 コマンド実行中にエラーが発生した場合、対応するエラーコードが返されます。詳細については、 標準インターフェースのステータスコード一覧とトラブルシューティング をご参照ください。
このコマンドを呼び出した後、ビジョンシステムは10秒以内に処理結果を返さない場合、タイムアウトのエラーコードが返されます。Mech-Visionでは、ツールバーから をクリックし、実際の状況に応じてタイムアウトを変更することができます。 |
「ビジョン処理による移動」の計画データまたはカスタマイズされたデータを取得
機能
このコマンドは、Mech-Visionプロジェクトの「ビジョン処理による移動」の計画データ、またはMech-Vizプロジェクトの「ビジョン処理による移動」の計画データまたはカスタマイズされたデータを取得するために使用されます。このコマンドを1回呼び出すと、すべてのデータがロボットメモリに保存されます。
-
Mech-Visionプロジェクトの場合:ここでの「ビジョン処理による移動」の計画データは、経路計画設定ツールの「ビジョン処理による移動」ステップが計画されたデータのことで、把持するワークのラベル、把持されたワークの合計数、今回把持されたワークの数、吸盤のエッジコーナー番号、TCPオフセット、ワーク群の向き、単体ワークの向き、ワーク群の寸法が含まれます。
-
Mech-Vizプロジェクトの場合:
-
ここでの「ビジョン処理による移動」の計画データは、Mech-Vizの「ビジョン処理による移動」ステップが計画されたデータのことで、把持するワークのラベル、把持されたワークの合計数、今回把持されたワークの数、吸盤のエッジコーナー番号、TCPオフセット、ワーク群の向き、単体ワークの向き、ワーク群の寸法が含まれます。
-
カスタマイズされたデータ:Mech-Visionの「出力」ステップのカスタマイズされたポートのデータがMech-Vizの転送によって得られたデータのことです。 カスタマイズされたポートを設定するには、「出力」ステップのパラメータで エディタを開く をクリックし、表示される画面で設定を行います。その中、事前定義された通信キー名はカスタマイズされたポート名です。例えば、下図の「customeData1」ポートと「customeData2」ポートはカスタマイズされたポートです。
-
|
呼び出し順序
このコマンドは Mech-Visionプロジェクトを実行 または Mech-Vizプロジェクトを実行 の後に呼び出す必要があります。このコマンドを使用した後、「ビジョン処理による移動」の計画データまたはカスタマイズされたデータを表示するために 「ビジョン処理による移動」の計画データたはカスタマイズされたデータを保存 コマンドを呼び出す必要があります。
コマンド形式
MM_GET_PLNDT(Resource,Jps_Pos,Reg_Pos_Num,Reg_VPos_Num,Reg_Status)
入力パラメータ
Resource
このパラメータは、「ビジョン処理による移動」の計画データのソースを指定します。値が0または正整数です。
-
0:Mech-Vizから「ビジョン処理による移動」の計画データを取得します。
-
正整数:Mech-Visionから「ビジョン処理による移動」の計画データ取得します。ここで設定された正整数はMech-Visionプロジェクト番号となります。
Jps_Pos
このパラメータは、返されたデータの予期形式を表します。
-
Resourceが0の場合、Jps_Posパラメータ値の範囲は1~4になります。
Jps_Posパラメータ値 返されたデータの予期形式 の説明(Mech-Visionプロジェクトにカスタマイズされたポートがない場合は カスタマイズされたデータ がありません) 1
位置姿勢(関節角度形式),移動方式,ツール番号,速度,カスタマイズされたデータ1,...,カスタマイズされたデータN
2
位置姿勢(ツール位置姿勢形式),移動方式,ツール番号,速度,カスタマイズされたデータ1,...,カスタマイズされたデータN
3
位置姿勢(関節角度形式),移動方式,ツール番号,速度,Mech-Vizの「ビジョン処理による移動」の計画データ,カスタマイズされたデータ1,...,カスタマイズされたデータN
4
位置姿勢(ツール位置姿勢形式),移動方式,ツール番号,速度,Mech-Vizの「ビジョン処理による移動」の計画データ,カスタマイズされたデータ1,...,カスタマイズされたデータN
-
Resourceが正整数の場合、Jps_Posパラメータ値の範囲は1~2になります。
Jps_Posパラメータ値 返されたデータの予期形式 の説明 1
位置姿勢(関節角度形式),移動方式,ツール番号,速度,Mech-Visionの「ビジョン処理による移動」の計画データ
2
位置姿勢(ツール位置姿勢形式),移動方式,ツール番号,速度,Mech-Visionの「ビジョン処理による移動」の計画データ
位置姿勢
経路点の位置姿勢は、ロボット関節角度(度単位)、またはツール位置姿勢(3次元座標はミリメートル単位、オイラー角は度単位)で表されることができます。
移動方式
ロボットの移動タイプを表し、値の範囲が1または2です。
-
1:関節運動。
-
2:直線運動。
ツール番号
ロボットが経路点に移動するときに使用するロボットハンドの番号です。-1である場合、ロボットハンドが使用されないことを示します。
速度
速度の意味はプロジェクトによって異なります。詳細は以下の通りです。
-
Mech-Visionプロジェクトの場合:速度は、経路計画設定ツールで設定されたシミュレーション速度の値(パーセンテージで表す)を指します。
-
Mech-Vizプロジェクトの場合:速度は、移動ステップのパラメータで設定された速度パラメータの値にMech-Vizで設定されたグローバル速度を乗算したもの(パーセンテージで表す)を指します。
「ビジョン処理による移動」の計画データ
Mech-VisionまたはMech-Vizの「ビジョン処理による移動」ステップが計画されたデータのことで、把持するワークのラベル、把持されたワークの合計数、今回把持されたワークの数、吸盤のエッジコーナー番号、TCPオフセット、ワーク群の向き、単体ワークの向き、ワーク群の寸法が含まれます。
名称 | 説明 | 次元数 |
---|---|---|
把持するワークのラベル |
10個の整数で構成され、デフォルトは10個のゼロです。 |
10 |
把持されたワークの合計数 |
累計で把持されたワークの数です。 |
1 |
今回把持されたワークの数です。 |
今回把持されたワークの数です。 |
1 |
吸盤のエッジコーナー番号 |
この吸盤に使用されているエッジコーナー番号です。 |
1 |
TCPオフセット |
ワーク群の中心がロボットハンド中心に対して持つXYZ方向のオフセットを指します。 |
3 |
ワーク群の向き |
吸盤の長辺に対するワーク群の向きです。0は平行、1は垂直を意味します。 |
1 |
単体ワークの向き |
吸盤の長辺に対する単体ワークの向きです。0は平行、1は垂直を意味します。 |
1 |
ワーク群の寸法 |
今回把持されたワーク群の長さ、幅、高さです。 |
3 |
カスタイズされたデータ
単一のビジョンポイントのすべてのカスタマイズされたポートのデータです。例えば、「出力」ステップの各ポートのデータは下表の通りである場合、ロボットが取得した最初のビジョンポイントの カスタマイズされたデータ は[0, 0, 1]と[0, 0]であり、ロボットが取得した2番目のビジョンポイントの カスタマイズされたデータ は[1, 0, 0] と [1, 1]です。
ポート名 |
poses |
labels |
customData1 |
customData2 |
ポートデータ |
[ [0, 0, 0, 1, 0, 0, 0], [0, 0, 0, 1, 0, 0, 0] ] |
[ "0", "1" ] |
[ [0, 0, 1], [1, 0, 0] ] |
[ [0, 0], [1, 1] ] |
最初のビジョンポイント |
[0, 0, 0, 1, 0, 0, 0] |
0 |
[0, 0, 1] |
[0, 0] |
2番目のビジョンポイント |
[0, 0, 0, 1, 0, 0, 0] |
1 |
[1, 0, 0] |
[1, 1] |
出力パラメータ
Reg_Pos_Num
このパラメータは、数値レジスタの番号を指定します。この番号に対応する数値レジスタは、ビジョンシステムが返す経路点の数を保存するために使用されます。
Reg_VPos_Num
このパラメータは、数値レジスタの番号を指定します。この番号は、Mech-Vizプロジェクトでの「ビジョン処理による移動」ステップの経路点が経路全体における位置番号を保存するための数値レジスタの番号を指定します。経路中に「ビジョン処理による移動」ステップの経路点がない場合、このパラメータの値は0になります。
例えば、経路全体が「移動_1」、「移動_2」、「ビジョン処理による移動」、「移動_3」という経路点で構成されている場合、「ビジョン処理による移動」の経路点の位置番号は3です。
Reg_Status
このパラメータは、数値レジスタの番号を指定します。この番号に対応する数値レジスタは、コマンド実行のステータスコードを保存するために使用されます。コマンドによりMech-Visionプロジェクトの「ビジョン処理による移動」の計画データの取得に成功した場合、ステータスコードは 1103 になります。コマンドによりMech-Vizプロジェクトの「ビジョン処理による移動」の計画データまたはカスタマイズされたデータの取得に成功した場合、ステータスコードは 2100 になります。 コマンド実行中にエラーが発生した場合、対応するエラーコードが返されます。詳細については、 標準インターフェースのステータスコード一覧とトラブルシューティング をご参照ください。
「ビジョン処理による移動」の計画データたはカスタマイズされたデータを保存
呼び出し順序
このコマンドは 「ビジョン処理による移動」の計画データまたはカスタマイズされたデータを取得 の後に呼び出す必要があります。
コマンド形式
MM_GET_PLJOP(Serial,Jps_Pos,Pr_Num,Reg_MoveType,Reg_ToolNum,Reg_Speed,Reg_UserData,Reg_PlanRes)
入力パラメータ
Serial
このパラメータは、経路点のインデックス番号を指定します。つまり、このインデックス番号に対応する経路点の「ビジョン処理による移動」の計画データたはカスタマイズされたデータを指定された変数に保存します。インデックス番号は1から始まります。
Jps_Pos
このパラメータは、「ビジョン処理による移動」の計画データまたはカスタマイズされたデータを取得 コマンド内のJps_Posで設定された値と一致する必要があります。
出力パラメータ
Pr_Num
このパラメータは、位置レジスタの番号を指定します。この番号に対応する位置レジスタは、指定されたインデックス番号に対応する経路点の位置姿勢を保存するために使用されます。
Reg_MoveType
このパラメータは、数値レジスタの番号を指定します。この番号に対応する数値レジスタは、指定されたインデックス番号に対応する経路点の移動方式,を保存するために使用されます。1は関節運動、2は直線運動を表します。
Reg_ToolNum
このパラメータは、数値レジスタの番号を指定します。この番号に対応する数値レジスタは、指定されたインデックス番号に対応する、経路点に移動するときに使用するロボットハンドの番号を保存するために使用されます。番号が-1である場合、ロボットハンドが使用されないことを表します。
Reg_Speed
このパラメータは、数値レジスタの番号を指定します。この番号に対応する数値レジスタは、指定されたインデックス番号に対応する経路点の速度を保存するために使用されます。
Reg_UserData
このパラメータは、数値レジスタの開始番号を指定します。指定された開始番号から、指定されたインデックス番号に対応する経路点のカスタマイズされたデータが、対応する数値レジスタに順番に保存されます。カスタマイズされたデータは最大50個の数値レジスタを使用します。
Reg_PlanRes
このパラメータは、数値レジスタの開始番号を指定します。指定された開始番号から、指定されたインデックス番号に対応する経路点の「ビジョン処理による移動」の計画データが、対応する数値レジスタに順番に保存されます。「ビジョン処理による移動」の計画データは、21個の数値レジスタを使用します。
「ビジョン処理による移動」の計画データの詳細を下表に示します。
データ | 説明 | 対応する数値レジスタの番号 |
---|---|---|
把持するワークのラベル |
10個の整数で構成され、デフォルトは10個のゼロです。 |
Reg_PlanRes~Reg_PlanRes+9 |
把持されたワークの合計数 |
累計で把持されたワークの数です。 |
Reg_PlanRes+10 |
今回把持されたワークの数 |
今回把持されたワークの数 |
Reg_PlanRes+11 |
吸盤のエッジコーナー番号 |
この吸盤に使用されているエッジコーナー番号です。 |
Reg_PlanRes+12 |
TCPオフセット |
ワーク群の中心がロボットハンド中心に対して持つXYZ方向のオフセットを指します。 |
Reg_PlanRes+13~Reg_PlanRes+15 |
ワーク群の向き |
吸盤の長辺に対するワーク群の向きです。0は平行、1は垂直を意味します。 |
Reg_PlanRes+16 |
単体ワークの向き |
吸盤の長辺に対する単体ワークの向きです。0は平行、1は垂直を意味します。 |
Reg_PlanRes+17 |
ワーク群の寸法 |
今回把持されたワーク群の長さ、幅、高さです。 |
Reg_PlanRes+18~Reg_PlanRes+20 |
Mech-Vizのステップパラメータを読み取る
呼び出し順序
このコマンドは、 Mech-Vizプロジェクトを実行 コマンドの前に呼び出す必要があります。
コマンド形式
MM_GET_PROP(Read_id,Reg_Status,Reg_Viz_Prop)
入力パラメータ
Read_id
このパラメータは、property_configファイルで指定された 構成ID のフィールドとなります。
Mech-Visionでは、ツールバーの をクリックし、 プロパティ設定 をクリックしてproperty_configファイルを開きます。 |
このコマンドを使用する前に、あらかじめproperty_configファイルに、ステップ番号と、パラメータ名に対応するキー名を、以下の形式で指定しておく必要があります。
read,構成ID,ステップ番号,パラメータ名に対応するキー名
read |
ステップパラメータ値の読取りに使用する行を指定します。 |
構成ID |
唯一の番号を正の整数で指定します。1つの構成IDは、1つのステップパラメータ値を読み取るためにのみ使用できます。複数のステップパラメータ値を読み取る場合は、異なる構成IDを使用してください。 |
ステップ番号 |
読み取るパラメータが属するステップの番号を指定します。 |
キー名 |
読み込むパラメータに対応するキー名を指定します。 |
|
property_configファイルには複数のreadコマンドを設定することができますが、各readコマンドの構成IDは一意である必要があります。 |
出力パラメータ
Reg_Status
このパラメータは、数値レジスタの番号を指定します。この番号に対応する数値レジスタは、コマンド実行のステータスコードを保存するために使用されます。コマンドが正常に実行された場合、ステータスコードは 2109 になります。 コマンド実行中にエラーが発生した場合、対応するエラーコードが返されます。詳細については、 標準インターフェースのステータスコード一覧とトラブルシューティング をご参照ください。
Reg_Viz_Prop
このパラメータは、数値レジスタの番号を指定します。この番号に対応する数値レジスタは、指定されたステップの返されたパラメータ値を保存するために使用されます。
Mech-Vizのステップパラメータを設定
呼び出し順序
このコマンドは、 Mech-Vizプロジェクトを実行 コマンドの前に呼び出す必要があります。
コマンド形式
MM_SET_PROP(Write_id,Reg_Status)
入力パラメータ
Write_id
このパラメータは、property_configファイルで指定された 構成ID のフィールドとなります。
Mech-Visionでは、ツールバーの をクリックし、 プロパティ設定 をクリックしてproperty_configファイルを開きます。 |
このコマンドを使用する前に、あらかじめproperty_configファイルに、ステップ番号、パラメータ名に対応するキー名とパラメータ値を、以下の形式で指定しておく必要があります。
write,構成ID,ステップ番号,パラメータ名に対応するキー名,パラメータ値
write |
ステップパラメータ値の設定に使用する行を指定します。 |
構成ID |
番号(一意でない)を正の整数で指定します。 |
ステップ番号 |
設定するパラメータが属するステップの番号を指定します。 |
キー名 |
設定するパラメータに対応するキー名を指定します。 |
パラメータ値 |
設定するパラメータ値を指定します。 |
|
出力パラメータ
MM_Status
このパラメータは、数値レジスタの番号を指定します。この番号に対応する数値レジスタは、コマンド実行のステータスコードを保存するために使用されます。コマンドが正常に実行された場合、ステータスコードは 2108 になります。 コマンド実行中にエラーが発生した場合、対応するエラーコードが返されます。詳細については、 標準インターフェースのステータスコード一覧とトラブルシューティング をご参照ください。
サンプル
例えば、property_configファイルの内容は、1が構成ID、3がステップ番号、xOffset、yOffset、zOffsetがキー名、10がxOffsetに対応するパラメータ値、20がyOffsetに対応するパラメータ値、30がzOffsetに対応するパラメータ値を表します。
write,1,3,xOffset,10
write,1,3,yOffset,20
write,1,3,zOffset,30
ロボットが以下のコマンドを送信した後、Mech-VizはxOffset、yOffsetとzOffsのパラメータ値をそれぞれ10、20と30に設定します。
CALL MM_SET_PROP(1,10)
上記のサンプルを実行すると、xOffset、yOffsetとzOffsに対応するパラメータ値がそれぞれ10、20と30に設定され、コマンド実行のステータスコードが数値レジスタR[10]に保存されます。
Mech-Visionプロジェクトに対象物の寸法を入力
機能
このコマンドは、対象物の寸法をMech-Visionプロジェクトに入力するために使用されます。下図に示すように、入力される対象物の寸法は、「対象物の寸法を読み込む」ステップの 箱の寸法設定 パラメータ値となります。
呼び出し順序
このコマンドは、 Mech-Visionプロジェクトを実行 コマンドの前に呼び出す必要があります。
「通知」ステップのメッセージを取得
機能
Mech-VisionプロジェクトまたはMech-Vizプロジェクトが「通知」ステップまで実行すると、ビジョンシステムは「通知」ステップで事前設定されたメッセージを返します。
このコマンドを使用する前に、「通知」ステップで以下の設定を行う必要があります。
-
Mech-Visionプロジェクト内の「通知」ステップ
-
「通知」ステップを他のステップの右側につなぎます(ここでは、「出力」ステップを例とします)。
-
「出力」ステップのパラメータで 出力がある場合に制御フローをトリガー にチェックを入れます。
-
「通知」ステップのパラメータで、サービス名に Standard Interface Notify(変更不可) を入力し、メッセージに 1001 (実際の状況に応じて変更可能で、正の整数の入力が必要)入力します。
-
-
Mech-Vizプロジェクト内の「通知」ステップ
-
「通知」ステップをワークフローの適切な場所に配置し、その他のステップをつなぎます。
-
「通知」ステップのパラメータで、「受信者」を 標準インターフェース に選択し、メッセージに 1000 (実際の状況に応じて変更可能で、正の整数の入力が必要)を入力します。
-
呼び出し順序
このコマンドは、Mech-Visionプロジェクトを実行 または Mech-Vizプロジェクトを実行 コマンドの直後に呼び出される必要があります。
キャリブレーション
機能
このコマンドは、ロボットのハンドアイキャリブレーション(外部パラメータのキャリブレーション)を実行するために使用されます。自動キャリブレーションを行うには、このコマンドをキャリブレーションツールと併用する必要があります。Mech-Visionのツールバーの カメラキャリブレーション(標準モード) をクリックしてキャリブレーションツールを起動できます。詳細については、 FANUCロボットの自動キャリブレーション をご参照ください。
コマンド形式
MM_CALIB(Move_Type,PosJps,WaitTime,AxisNum,AxisVal,Reg_CalibPos)
入力パラメータ
Move_Type
このパラメータはロボットの移動タイプを表し、値の範囲が1または2です。
-
1:直線運動。
-
2:関節運動。
PosJps
このパラメータは、キャリブレーションポイントの位置姿勢形式を指定するために使用されます。値は1または2です。
-
1:ツール位置姿勢。
-
2:関節角度。
WaitTime
このパラメータは、ロボットがキャリブレーションポイントに移動した後の待機時間を表します(ロボットの振動を防止するため)。単位は秒で、初期値は2秒です。
AxisNum
このパラメータは、ロボットの軸数を表します。
AxisVal
このパラメータは外部軸のデータを表し、単位はミリメートルです。第7軸としてレールがある場合、かつロボットがそのレールの動きを制御する場合は、このパラメータを具体的な外部軸データ値に設定する必要があります。それ以外の場合は、このパラメータを0に設定する必要があります。
Reg_CalibPos
このパラメータは、MM_AUTO_CALIBで使用される位置レジスタの番号を表します。デフォルトでは100となっており、つまりキャリブレーションポイントの位置姿勢データは位置レジスタPR[100]に保存されます。
Mech-Vizプロジェクトを停止
呼び出し順序
このコマンドは Mech-Vizプロジェクトを実行 の後に呼び出す必要があります。
プロジェクトのステータスを取得
コマンド形式
MM_GET_STAT(MM_Status)
出力パラメータ
MM_Status
このパラメータは、数値レジスタの番号を指定します。この番号に対応する数値レジスタは、コマンド実行のステータスコードを保存するために使用されます。コマンドが正常に実行された場合、ステータスコードは 1101 になり、Mech-Visionプロジェクトが準備完了していることを示します。 コマンド実行中にエラーが発生した場合、対応するエラーコードが返されます。詳細については、 標準インターフェースのステータスコード一覧とトラブルシューティング をご参照ください。