サンプルプログラム2：MM_S2_Viz_Basic

現在ご覧いただいているのは未リリースのバージョンです（V2.1.0）。異なるバージョンを参照する場合は、画面右上のボタンから切り替えが可能です。

■ ご利用中のバージョンが分からない場合はお気軽にサポート窓口までご連絡ください。

プログラム概要

機能

ロボットがMech-Vizプロジェクトをトリガーして実行し、その後計画された経路を取得して、把持および配置を実行します。

ファイル場所

Mech-VisionとMech-Vizソフトウェアのインストールディレクトリにある Communication Component/Robot_Interface/YASKAWA/sample/MM_S2_Viz_Basic。

必要なプロジェクト

Mech-VisionとMech-Vizプロジェクト

使用前提

標準インターフェース通信設定が完了しました。
自動キャリブレーションが完了しました。

このサンプルプログラムは参考用です。ユーザーは実際の状況に応じて、このプログラムを基に変更を加える必要があります。このプログラムをそのまま使用しないでください。

プログラム説明

以下はMM_S2_Viz_Basicサンプルプログラムのコードと関連する説明です。

NOP
'--------------------------------
'FUNCTION: trigger Mech-Viz
'project and get planned path
'Mech-Mind, 2023-12-25
'--------------------------------
'clear I50 to I69
CLEAR I050 20
'initialize p variables
SUB P071 P071
SUB P072 P072
SUB P073 P073
'move to robot home position
MOVJ C00000 VJ=50.00
'initialize communication
'parameters (initialization is
'required only once)
CALL JOB:MM_INIT_SOCKET ARGF"192.168.170.22;50000;1"
'move to image-capturing position
MOVJ C00001 VJ=50.00 PL=0
'open socket connection
CALL JOB:MM_OPEN_SOCKET
'trigger Mech-Viz project
CALL JOB:MM_START_VIZ ARGF"2;30"
'get planned path, 1st argument
'(1) means getting pose in JPs
CALL JOB:MM_GET_VIZDATA ARGF"1;51;52;53"
'check whether planned path has
'been got from Mech-Viz
'successfully
IFTHENEXP I053<>2100
	'add error handling logic here
	'according to different error
	'codes
	'e.g.: I053=2038 means no
	'point cloud in ROI
	 PAUSE
ENDIF
'close socket connection
CALL JOB:MM_CLOSE_SOCKET
'save waypoints of the planned
'path to local variables one
'by one
CALL JOB:MM_GET_JPS ARGF"1;71;61;62"
CALL JOB:MM_GET_JPS ARGF"2;72;63;64"
CALL JOB:MM_GET_JPS ARGF"3;73;65;66"
'follow the planned path to pick
'move to approach waypoint of
'picking
MOVJ P071 VJ=50.00 PL=0
'move to picking waypoint
MOVJ P072 VJ=10.00 PL=0
'add object grasping logic here,
'such as DOUT OT#(1) ON
PAUSE
'move to departure waypoint of
'picking
MOVJ P073 VJ=50.00 PL=0
'move to intermediate waypoint of
'placing
MOVJ C00002 VJ=50.00
'move to approach waypoint of
'placing
MOVL C00003 V=166.6 PL=0
'move to placing waypoint
MOVL C00004 V=50.0 PL=0
'add object releasing logic here,
'such as DOUT OT#(1) OFF
PAUSE
'move to departure waypoint of
'placing
MOVL C00005 V=166.6 PL=0
'move back to robot home position
MOVJ C00006 VJ=50.00
END

上記のサンプルプログラムの処理流れは、下図の通りです。

下表は上記のプログラムのコードとその説明です。コマンド名のリンクをクリックすることで、その詳細な説明を確認できます。

処理流れコートと説明

変数初期化

'clear I50 to I69
CLEAR I050 20

CLEAR：データをクリアするためのコマンド。
I050：番号が50の整数型変数（I変数）からクリアを開始することを指定します。
20：クリアする変数の数を20個に指定します。

このコマンドは、整数型変数I050からI069（合計20個）の値をすべて0にクリアすることを意味します。

'initialize p variables
SUB P071 P071
SUB P072 P072
SUB P073 P073

SUB：減算コマンド。
最初のP071：減算の被減数として位置型変数（P変数）P071を指定します。また、演算結果もP071に保存されます。
2番目のP071：減数として位置型変数P071を指定します。

上記の3つのコマンドは、位置型変数P071、P072およびP073をそれぞれ0に設定することを意味します。

Home位置に移動

'move to robot home position
MOVJ C00000 VJ=50.00

MOVJ：関節移動コマンド。

C00000：ティーチング法で設定されたロボットの位置番号。

事前にC00000（Home位置）を設定する必要があります。詳細については、キャリブレーション開始点を設定をご参照ください。
ティーチング後、ロボット軸のティーチング位置が無条件でC00000に書き込まれます。このティーチング位置は編集できません。
ティーチペンダントの画面上には、この番号（C00000）は表示されません。

VJ=50.00：関節速度を指定します。関節速度は、最大速度に対する比率で表されます。

このコマンドは、ロボットが関節移動の方式で設定されたHome位置に移動することを意味します。

通信初期化

'initialize communication
'parameters (initialization is
'required only once)
CALL JOB:MM_INIT_SOCKET ARGF"192.168.170.22;50000;1"

CALL：指定されたコマンド（またはプログラム）を呼び出します。
JOB：呼び出すコマンド（またはプログラム）を指定します。
MM_INIT_SOCKET：通信を初期化するためのコマンド。
ARGF：ティーチペンダントの画面上では英字括弧で表示されます。
192.168.170.22：IPCのIPアドレス。
50000：IPCのポート番号。
1：通信のタイムアウト待機時間（1分間）。

このコマンドは、ロボットが MM_INIT_SOCKET コマンドを使用して、通信対象（IPC）のIPアドレス（192.168.170.22）、ポート番号（50000）、およびタイムアウト待機時間（1分間）を指定することを意味します。

実際の状況に基づいてIPCのIPアドレスやポート番号を変更し、ビジョンシステムで設定されたパラメータと一致するようにする必要があります。

撮影位置に移動

'move to image-capturing position
MOVJ C00001 VJ=50.00 PL=0

C00001：ティーチング法で設定されたロボットの位置番号。C00001（撮影位置）を事前に設定する必要があります。詳細については、キャリブレーション開始点を設定をご参照ください。
PL=0：位置レベルを0に指定します。位置レベルとは、ロボットがティーチングされた位置にどの程度接近するかを示すもので、値の範囲は0～8です。値が小さいほど、位置により近くなります。

このコマンドは、ロボットが関節移動の方式で設定された撮影位置に移動することを意味します。

通信確立

'open socket connection
CALL JOB:MM_OPEN_SOCKET

ロボットは MM_OPEN_SOCKET コマンドを使用して、ビジョンシステムとの間のTCPプロトコル通信接続を確立します。

Mech-Vizプロジェクトをトリガー

'trigger Mech-Viz project
CALL JOB:MM_START_VIZ ARGF"2;30"

MM_START_VIZ：Mech-Vizプロジェクトの実行をトリガーするためのコマンド。
2：変数P030が表す関節角度データをMech-Vizプロジェクトに送信します。
30：変数Pの番号。この変数はカスタマイズされた関節角度データを保存します。把持経路を計画する際に、Mech-Vizプロジェクトの仮想ロボットはこの関節角度から最初の経路点に移動します。

ここでは、P030変数型をパルス形式として選択する必要があります。

このコマンドは、ロボットがビジョンシステムをトリガーしてMech-Vizプロジェクトを実行し、Mech-VizがMech-Visionから出力されたビジョン結果に基づいて把持経路を計画することを意味します。

計画された経路を取得

'get planned path, 1st argument
'(1) means getting pose in JPs
CALL JOB:MM_GET_VIZDATA ARGF"1;51;52;53"

MM_GET_VIZDATA：Mech-Vizが計画された経路を取得するためのコマンド。
1：取得した経路点の位置姿勢を関節角度の形式として指定します。
51：変数Iの番号。この変数はビジョンシステムが返す経路点の数を保存します。
52：変数Iの番号。この変数は、「ビジョン処理による移動」の経路点（把持点）が経路全体における位置番号を保存します。
53：変数Iの番号。この変数はコマンド実行のステータスコードを保存します。

このコマンドは、ロボットがMech-Vizプロジェクトから返された計画経路を取得することを意味します。

返された計画経路はロボットのメモリに保存されるため、この時点ではユーザーが計画経路を直接取得することはできません。その後の「計画された経路を保存」コマンドを実行することで、経路を取得することができます。

'check whether planned path has
'been got from Mech-Viz
'successfully
IFTHENEXP I053<>2100
	'add error handling logic here
	'according to different error
	'codes
	'e.g.: I053=2038 means no
	'point cloud in ROI
	 PAUSE
ENDIF

IFTHENEXP A … ENDIF：条件Aが成立する場合、プログラムはIFTHENEXPとENDIFの間のコードを実行します。
<>：等しくないことを意味します。

上記のコードは、ステータスコードI052が2100の場合、ロボットがすべての計画された経路を正常に取得することを意味し、それ以外の場合はビジョンシステムに異常が発生し、プログラムはIFTHENEXPとENDIFの間のコードを実行することを意味します。ユーザーは、特定のエラーコードに応じて適切な処理を行うことが可能です。本サンプルでは、すべてのエラーコードに対して同一の処理を行い、PAUSEコマンドを使用してプログラムの実行を一時停止しています。

通信接続を切断

'close socket connection
CALL JOB:MM_CLOSE_SOCKET

ロボットは MM_CLOSE_SOCKET コマンドを使用して、ビジョンシステムとの間のTCPプロトコル通信接続を切断します。

計画された経路を保存

'save waypoints of the planned
'path to local variables one
'by one
CALL JOB:MM_GET_JPS ARGF"1;71;61;62"
CALL JOB:MM_GET_JPS ARGF"2;72;63;64"
CALL JOB:MM_GET_JPS ARGF"3;73;65;66"

MM_GET_JPS：計画された経路を保存するためのコマンド。
1：最初の経路点を保存します。
71：変数Iの番号。この変数は最初の経路点の関節角度を保存します。
61：変数Iの番号。この変数は最初の経路点に対応するラベルを保存します。
62：変数Iの番号。この変数は最初の経路点に対応するロボットハンド番号を保存します。

「CALL JOB:MM_GET_JPS ARGF"1;71;61;62」コマンドは、最初の経路点の関節角度、ラベル、およびロボットハンド番号をそれぞれ指定された変数に保存することを意味します。

このサンプルでは、Mech-Vizで計画された経路に3つの経路点が含まれていると仮定しています。最初の経路点は「把持のアプローチ点（P071）」、2番目の経路点は「把持点（P072）」、3番目の経路点は「把持の離れる点（P073）」です。Mech-Vizプロジェクトで作成されたワークフローに応じて、プログラムを適切に変更し、経路を保存する必要があります。

把持のアプローチ点に移動

'follow the planned path to pick
'move to approach waypoint of
'picking
MOVJ P071 VJ=50.00 PL=0

ロボットが把持のアプローチ点（P071が表す位置）に移動します。

把持点に移動

'move to picking waypoint
MOVJ P072 VJ=10.00 PL=0

ロボットが把持点（P072が表す位置）に移動します。

DO設定による把持

'add object grasping logic here,
'such as DOUT OT#(1) ON
PAUSE

ロボットが把持点に到達した後、DOコマンド（例えば「DOUT OT#(1) ON」）を設定して、ロボットハンドを制御し、ワークを把持します。実際の状況に応じてDO設定を調整する必要があります。

PAUSEコマンドはプログラムの実行を一時停止します。DO設定コマンドが設定されている場合、このPAUSEコマンドは削除できます。

把持の離れる点に移動

'move to departure waypoint of
'picking
MOVJ P073 VJ=50.00 PL=0

ロボットが把持の離れる点（P073が表す位置）に移動します。

中間点に移動

'move to intermediate waypoint of
'placing
MOVJ C00002 VJ=50.00

ロボットは把持の離れる点と配置のアプローチ点の間の中間点に移動します。

中間点を追加することで、ロボットの移動がスムーズになり、不要な衝突を避けることができます。実際の状況に応じて複数の中間点を追加することが可能です。
C00002（中間点）を事前に設定する必要があります。詳細については、キャリブレーション開始点を設定をご参照ください。

配置のアプローチ点に移動

'move to approach waypoint of
'placing
MOVL C00003 V=166.6 PL=0

ロボットが中間点から配置のアプローチ点に移動します。

アプローチ点を追加することで、ロボットが移動する際にシーンの物体（コンテナなど）と衝突するのを防ぐことができます。
事前にC00003（配置のアプローチ点）を設定する必要があります。詳細については、キャリブレーション開始点を設定をご参照ください。

配置点に移動

'move to placing waypoint
MOVL C00004 V=50.0 PL=0

ロボットが配置のアプローチ点から配置点に移動します。

配置点は他の作業セルや人員、機器から十分な安全距離を確保し、ロボットの最大可動範囲を超えないようにする必要があります。
事前にC00004（配置点）を設定する必要があります。詳細については、キャリブレーション開始点を設定をご参照ください。

DO設定による配置

'add object releasing logic here,
'such as DOUT OT#(1) OFF
PAUSE

ロボットが配置点に到達した後、DOコマンド（例えば「DOUT OT#(1) OFF」）を設定して、ロボットハンドを制御し、ワークを配置します。実際の状況に応じてDO設定を調整する必要があります。

PAUSEコマンドはプログラムの実行を一時停止します。DO設定コマンドが設定されている場合、このPAUSEコマンドは削除できます。

配置の離れる点に移動

'move to departure waypoint of
'placing
MOVL C00005 V=166.6 PL=0

ロボットが配置点から配置の離れる点に移動します。

離れる点を追加することで、ロボットが移動する際にシーン内の物体（コンテナなど）との衝突を防ぐことができます。
事前にC00005（配置の離れる点）を設定する必要があります。詳細については、キャリブレーション開始点を設定をご参照ください。

Home位置に移動

'move back to robot home position
MOVJ C00006 VJ=50.00

ロボットが配置の離れる点からHome位置に戻ります。

事前にC00006（Home位置）を設定する必要があります。詳細については、キャリブレーション開始点を設定をご参照ください。

Mech-Mindは、お客様のプライバシーを重視しています

このサイトでは最高の体験を提供するために Cookie を使用しています。サイトの閲覧を続ける場合、Cookie の使用に同意したことになります。「拒否する」を選択すると、このサイトを訪れた際に追跡や記憶が行われないように単独の Cookie が使用されます。

同意する

拒否する