(57)【特許請求の範囲】
【請求項１】
所定の作業を実行する作業ツールと、この作業ツールを往復移動自在に支持した可動軸と、この可動軸を駆動制御する制御手段とを備えて成り、前記可動軸は、回転検出可能なエンコーダを備え予め設定された回転数および負荷電流により回転するサーボモータと、このサーボモータに連結したボールねじ軸と、ボールねじ軸に係合しボールねじ軸の延びる方向へ往復移動自在な可動部材とから構成され、前記作業ツールを所定の位置まで所定の推力および速度により移動制御する作業ロボット制御装置において、
前記制御手段は、前記サーボモータの回転を駆動制御するサーボアンプと、前記可動軸の目標位置、目標推力、目標速度を１つの動作ステップとしこの動作ステップを前記可動軸の動作順に並べて構成した命令コードを記憶する記憶部と、前記命令コードの動作ステップに基づき前記サーボアンプへ動作指令を送る制御部とを備えて成り、
さらに、前記制御手段は、前記命令コードを表示する表示部と、この表示部に表示した前記命令コードに新たな動作ステップを追加する入力キーとを備えた入力手段を接続して成り、
前記入力手段は、前記命令コードを少なくとも６つ以上の動作ステップに追加変更してこの変更したデータを前記記憶部へ送信する処理を行うことを特徴とする作業ロボット制御装置。
【請求項２】
前記制御部は、ラダープログラムを実行する汎用ＰＬＣであることを特徴とする請求項１に記載の作業ロボット制御装置。
【請求項３】
前記動作ステップの設定値は、数値およびアルファベット或いはどちらか一方のみで構成したコードであることを特徴とする請求項１または請求項２に記載の作業ロボット制御装置。
【請求項４】
前記制御手段は、前記可動軸を複数制御して成り、
前記記憶部は、可動軸毎に割り当てた前記命令コードを複数記憶して成り、
前記動作ステップは、当該命令コードに該当しない可動軸の目標位置あるいは一連の作業に付随する付随作業を実行する周辺機器の動作情報を含んで構成され、
前記制御部は、実行中の動作ステップに基づいて該当する可動軸を駆動制御し、該当する可動軸が所定の目標位置へ到達し、かつ、該当しない可動軸あるいは前記周辺機器が当該動作ステップに設定した条件を何れも満足すれば次の動作ステップへ移行するよう処理して成ることを特徴とする請求項１ないし請求項３の何れかに記載の作業ロボット制御装置。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、作業ツールを目的の位置まで移動制御するものであり、作業ツールの移動時の推力を複数回切り替える作業ロボット制御装置に関する。
【背景技術】
【０００２】
従来の作業ロボット制御装置は、特許文献１および特許文献２に開示されており、ねじに係合するドライバビットを回転駆動可能な作業ツールと、この作業ツールを支持し所定のねじ締めポイントへ移動自在な往復移動手段と、この往復移動手段を予め設定されている動作条件に基づき駆動制御する制御手段と、この制御手段に前記動作条件を設定可能な入力手段とを備えて成る。前記動作条件は、作業ツールの移動速度に係る速度テーブルと、ねじに付与する推力に係るトルクテーブルと、ねじの種類に係るねじ種登録テーブルと、ねじ締付け中の前記推力を切り替える位置（以下、推力切替ポイントという）およびねじの長さなどの各種情報から成る寸法データ設定テーブルと、これら４つの各テーブルに設定した情報と最終的に正しく締付けられたねじの位置であるねじ締め基準位置とがそれぞれ関連付けられているポイントテーブルとから構成される。また、前記往復移動手段には、エンコーダを備えたサーボモータが配設されており、このサーボモータの回転によって往復移動手段が往復移動する。前記制御手段は、ポイントテーブルのねじ締め基準位置およびこのねじ締め基準位置に関連付けられている前記寸法データ設定テーブル、ねじ種登録データテーブルに基づいて５つの推力切替ポイントを算出するように構成され、この算出した５つの推力切替ポイントから締付けるねじの種類に応じた数の推力切替ポイントを設定するように構成される。これにより、従来の作業ロボット制御装置は、締付けるねじの種類に応じた数の推力切替ポイントを設定し、下降する作業ツールの発揮する推力を推力切替ポイントに基づいて順次切り替える特徴がある。
【０００３】
また、特許文献２あるいは特許文献３には、複数のサーボモータを駆動制御するサーボアンプが開示されている。このサーボアンプは、これに該当するサーボモータを接続して成り、サーボモータから発せられた信号を受信あるいは前記制御手段の指令を受けて該当するサーボモータへ信号を送信するように構成されている。さらに、特許文献３には、前記制御手段は、各サーボアンプへそれぞれ信号を送受信可能なモーションコントローラを備え、前記モーションコントローラに予め設定されているモーションプログラムおよび前記動作条件に基づき各サーボアンプを制御することが開示されている。
【先行技術文献】
【特許文献】
【０００４】
【特許文献１】特許第3797598号公報
【特許文献２】特許第4050982号公報
【特許文献３】特開2007-179229号公報
【発明の概要】
【発明が解決しようとする課題】
【０００５】
しかしながら、従来の作業ロボット制御装置は、推力切替ポイントの登録可能な数が最大５つに制約されているので、さらに多くの推力の切り替えを要する作業が行えないという問題があった。この問題を解決するには、前記寸法データ設定テーブルに設定できる推力切替ポイントの数を増やす変更を行う必要がある。しかも、このようなシステム変更は、ユーザが前記入力手段を用い容易に行えるものではなく、メーカが多大な時間を掛けて都度ソフト設計する必要がある。つまり、従来の作業ロボット制御装置は、５つを超える数の推力切替ポイントの追加変更をねじ締め基準位置など座標や速度といった設定値変更のように前記入力手段を用いて簡単にできないという問題もあった。また、従来の作業ロボット制御装置は、上述のように前記モーションコントローラを備えており、このモーションコントローラは、ラダープログラムを実行する汎用ＰＬＣに比べて高価である。このため、従来の作業ロボット制御装置は、制御手段のコストを低減できないという問題もあった。
【課題を解決するための手段】
【０００６】
本発明は上記課題に鑑みて創成されたものであり、所定の作業を実行する作業ツールと、この作業ツールを往復移動自在に支持した可動軸と、この可動軸を駆動制御する制御手段とを備えて成り、前記可動軸は、回転検出可能なエンコーダを備え予め設定された回転数および負荷電流により回転するサーボモータと、このサーボモータに連結したボールねじ軸と、ボールねじ軸に係合しボールねじ軸の延びる方向へ往復移動自在な可動部材とから構成され、前記作業ツールを所定の位置まで所定の推力および速度により移動制御する作業ロボット制御装置において、前記制御手段は、前記サーボモータの回転を駆動制御するサーボアンプと、前記可動軸の目標位置、目標推力、目標速度を１つの動作ステップとしこの動作ステップを前記可動軸の動作順に並べて構成した命令コードを記憶する記憶部と、前記命令コードの動作ステップに基づき前記サーボアンプへ動作指令を送る制御部とを備えて成り、さらに、前記制御手段は、前記命令コードを表示する表示部と、この表示部に表示した前記命令コードに新たな動作ステップを追加する入力キーとを備えた入力手段を接続して成り、前記入力手段は、前記命令コードを少なくとも６つ以上の動作ステップに追加変更してこの変更したデータを前記記憶部へ送信する処理を行うことを特徴とする。なお、前記制御部は、ラダープログラムを実行する汎用ＰＬＣであることが望ましい。また、前記動作ステップの設定値は、数値およびアルファベット或いはどちらか一方のみで構成したコードであることが望ましい。さらに、前記制御手段は、前記可動軸を複数制御して成り、前記記憶部は、可動軸毎に割り当てた前記命令コードを複数記憶して成り、前記動作ステップは、当該命令コードに該当しない可動軸の目標位置あるいは一連の作業に付随する付随作業を実行する周辺機器の動作情報を含んで構成され、前記制御部は、実行中の動作ステップに基づいて該当する可動軸を駆動制御し、該当する可動軸が所定の目標位置へ到達し、かつ、該当しない可動軸あるいは前記周辺機器が当該動作ステップに設定した条件を何れも満足すれば次の動作ステップへ移行するよう処理して成ることが望ましい。
【発明の効果】
【０００７】
本発明の作業ロボット制御装置は、上述のように前記制御部を高価なモーションコントローラから比較的安価な汎用ＰＬＣへ置き換えて構成しているため、従来よりも制御部のコストを低減できるという利点がある。
【０００８】
また、本発明の作業ロボット制御装置は、前記動作ステップの設定値は、数値およびアルファベット或いはどちらか一方のみで構成したコードであるので、一連の作業を全てコードにより表現できる。よって、本発明の作業ロボットの制御装置は、従来に比べて制御の処理が簡素化され、記憶部の容量が低減可能となる利点もある。また、これにより、一般的に記憶部の容量に制限のある汎用ＰＬＣを用いて複数の可動軸も制御可能となる。
【０００９】
さらに、本発明の作業ロボット制御装置は、５つを超える動作ステップを１つの命令コードとすることができるので、５つを超える推力の切り替えを要する作業を実現できるという利点もある。しかも、本発明の作業ロボット制御装置は、前記入力手段を用いて前記命令コードに新たな動作ステップを追加することができるので、従来のようなシステム変更を行わなくても５つを超える数の推力の切り替え設定が容易に行えるという利点もある。また、前記動作ステップは、推力切替位置である目標位置および目標推力のみならず可動軸の目標速度も含んでいるので、本発明の作業ロボット制御装置は、５つを超える数の移動速度の切り替えも行える。よって、本発明の作業ロボット制御装置は、５つを超える作業工程に分けて可動軸を細かに駆動制御できるので従来対応できなかった数多くの推力および速度の切り替えを要する作業を行うことができるという利点もある。
【００１０】
また、本発明の作業ロボット制御装置は、前記可動軸が複数で構成される場合、前記命令コードを可動軸毎に記憶しており、各命令コードはそれぞれ該当する可動軸の動作順に並べた複数の動作ステップで構成される。この動作ステップは、前記動作コード、該当する可動軸の目標位置、目標推力、目標速度に加え、該当しない可動軸の目標位置あるいは周辺機器の動作情報などを設定項目として備えており、これら何れの設定項目も全て数値によって設定される。よって、本発明の作業ロボット制御装置は、実行する命令コードに該当の可動軸と、これに該当しない可動軸あるいは前記作業ツールなどの周辺機器とをそれぞれ連携して駆動制御できるという利点もある。
【図面の簡単な説明】
【００１１】
【図１】本発明に係る作業ロボット制御装置を説明する斜視図である。
【図２】本発明に係る制御手段のブロック図である。
【図３】本発明に係る各可動軸と命令コードの割付データを説明する説明図である。
【図４】本発明に係る命令コードおよび動作ステップの構成を説明する説明図であり、（ａ）は可動軸１０に該当する命令コード、（ｂ）は第二の可動軸２０に該当の命令コード、（ｃ）は第三の可動軸３０に該当の命令コードを示す。
【図５】本発明に係る動作ステップの変更や追加を説明する説明図である。
【発明を実施するための形態】
【００１２】
以下、図１ないし図５に基づき本発明の実施の形態を説明する。本発明の作業ロボット制御装置１は、ねじＰの締付けなど所定の作業を実行する作業ツール６０と、この作業ツール６０を支持するとともにこれを所定の位置へ移動可能な可動軸１０と、この可動軸１０を駆動制御する制御手段７０とを備えて成る。
【００１３】
前記作業ツール６０は、回転自在な出力軸を備えたモータＢＭと、このモータＢＭの出力軸に連結された減速機６１と、この減速機６１に接続され後記ビット６４の負荷トルクを検出可能なトルクセンサ６２と、このトルクセンサ６２を固定支持した取付板６３と、前記トルクセンサ６２に接続されねじＰに係合可能なビット６４とを備えて成る。また、この作業ツール６０は、前記モータＢＭの回転駆動を制御するコントローラ６５に接続されており、前記コントローラ６５は前記制御手段７０に接続されている。
【００１４】
前記可動軸１０は、回転検出可能なエンコーダを備えたサーボモータＭ１と、このサーボモータＭ１に連結され回転自在なボールねじ軸１１と、このボールねじ軸に螺合した可動部材１２と、前記ボールねじ軸１１に対して平行に配され前記可動部材１２を挿通する２本のガイド軸１３ａ，１３ｂと、前記サーボモータＭ１の本体および前記ガイド軸１３ａ，１３ｂの両端を支持するとともに前記ボールねじ軸１１を回転自在に支持して成るフレーム１４とから構成される。
【００１５】
前記可動部材１２には、作業ツール６０の取付板６３が固定されているため、可動軸１０は、サーボモータＭ１の回転により作業ツール６０をボールねじ軸１１の延びる方向へ往復移動自在に支持して成る。これにより、可動軸１０は、図１に示すように作業ツール６０をワークＷの表面へ接近或いは離反するＺ方向へ往復移動自在に構成されている。
【００１６】
また、本発明の作業ロボット制御装置１は、図１に示すように前記可動軸１０を固定しＸ方向へ移動する第二の可動軸２０と、この第二の可動軸２０を固定しＹ方向へ移動する第三の可動軸３０とを備えている。前記第二、第三の可動軸２０，３０は、上述した可動軸１０と同様の構成であるため、第二、第三の可動軸２０，３０に係る構成の説明は省略する。なお、本発明の作業ロボット制御装置１は、上述のように３つの可動軸で構成したものに限定されることはなく、可動軸を１つ以上備えていればよい。
【００１７】
前記制御手段７０は、前記可動軸１０のサーボモータＭ１を回転制御するサーボアンプＳ１と、前記可動軸１０の目標位置およびこの目標位置へ到達させる間に発揮させるサーボモータＭ１の目標推力、目標速度を１つの動作ステップとし、この動作ステップを複数可動軸１０の動作順に並べて構成した命令コードを記憶する記憶部７１と、前記サーボアンプＳ１に接続され前記命令コードの動作ステップに基づき前記サーボアンプＳ１へ適宜動作指令を送る制御部７２とから構成されている。また、前記制御手段７０は、前記記憶部７１に記憶した命令コードを読み込み複数の動作ステップを一覧表示する表示部７３と、この表示部７３に表示された動作コードと動作コードとの間に新たな動作ステップを挿入可能な入力キー７４とを有する入力手段７５を備えて成る。この入力手段７５は、前記表示部７３と前記入力キー７４とを備えたノート型パソコンであり、前記制御部７２に接続されているので前記入力キー７４を操作することで既に設定されている命令コードを前記記憶部７１から読み込み前記表示部７４へ表示することができる。また、前記入力手段７５は、前述した命令コードの表示のみならず、表示部７４に表示した前記動作ステップの値を入力キー７４により変更することができ、さらに、変更した前記値を記憶部７１に記憶する旨の信号を前記制御部７２へ指令するように構成される。なお、前記入力手段７５は、表示部７３および入力キー７４を備えていればよく、上述したノート型パソコンに限定されるものではない。例えば、先行技術文献２に示すティーチングペンダントであってもよい。
【００１８】
前記サーボアンプＳ１は、サーボモータＭ１のエンコーダから送信される回転検出信号に基づきサーボモータＭ１の回転速度を算出するとともに、この回転速度を予め設定した速度となるように回転駆動制御可能に構成される。さらに、サーボアンプＳ１は、回転駆動中のサーボモータＭ１の負荷電流を検出し、この検出した負荷電流を予め設定した電流となるように回転駆動制御するように構成される。よって、サーボアンプＳ１は、サーボモータＭ１の回転数および推力を所定の設定値により回転制御する。なお、前記第二の可動軸２０および第三の可動軸３０に対応するサーボアンプＳ２，Ｓ３は、上述のサーボアンプＳ１と同様の構成であるので説明を省略する。
【００１９】
前記制御部７２は、所謂汎用ＰＬＣであり、前記記憶部７１を備えて成る。前記記憶部７１には、上述した命令コードの他に一連の作業を実行するためのラダープログラムが予め設定されている。また、この制御部７２は、上述した各サーボアンプの他に前記コントローラ６５などの周辺機器から信号を受信したりあるいは前記周辺機器へ信号を送信するように構成されている。よって、制御部７２は、命令コードおよび前記ラダープログラムを実行して前記サーボアンプＳ１および周辺機器をそれぞれ制御している。
【００２０】
本発明の作業ロボット制御装置１は、図３に示す割付データを前記記憶部７１に記憶しており、この割付データには、制御する可動軸数毎に命令コードが割り付けられている。しかも、この割付データの可動軸数を事前に選択して登録しておくことで、どの可動軸がどの命令コードに該当するのかを事前に取り決めることができる。よって、本発明の作業ロボット制御装置１は、可動軸数の異なるロボット機種を事前に登録できるので、異なるロボット機種を共通の前記制御手段７０により制御できる。
【００２１】
前記命令コードは、図４（ａ）ないし（ｃ）に示すように１つの命令コードに対して複数の動作ステップが動作順に並べられ組み合わされており、動作ステップＮｏ，１から順に実行される。これにより、各可動軸は、該当する可動軸の目標位置まで予め設定した目標速度および目標推力を発揮し動作することができる。
【００２２】
また、１つの動作ステップは、複数の設定項目で構成され、これら設定項目は、前記制御部７２の処理内容を数値化した動作コードと、前記命令コードに該当する可動軸の目標位置、目標速度、目標推力と、前記命令コードに該当しない可動軸の目標位置または周辺機器の動作情報の何れか一方の情報となっている。前述の命令コードに該当しない可動軸の目標位置あるいは周辺機器の動作情報は、図４（ａ）ないし（ｃ）に示す付随情報ＡないしＥの設定項目に設定され、前記動作ステップに設定されるのは全て数値となっている。なお、動作ステップは、全て数値としたがこれに限定されるものではなく、数値とアルファベットとを組み合わせたコードであってもよく、さらには、数値あるいはアルファベットのどちらか一方のコードであってもよい。また、図４（ａ）ないし（ｃ）の目標位置は、便宜上アルファベットで表現する。
【００２３】
前記動作コードは、制御部７２の処理を予め取り決めたものであり、二桁の数値で設定されている。具体的には、動作コード「２０」であれば、該当する可動軸を設定した目標位置まで目標速度および目標推力により移動するよう該当するサーボアップへ指令を送る処理を行い、動作コード「８３」であれば、該当しない可動軸あるいは周辺機器の動作を待ってから次の動作ステップへ移行する処理を行う。
【００２４】
上述した命令コードは、例えば図４（ａ）に示した命令コードＮｏ，０を図５に示す命令コードＮｏ，０’に変更することができる。この命令コードＮｏ，０’は、命令コードＮｏ，０の動作ステップＮｏ，３の目標速度および目標推力の変更が成されており、さらに、動作ステップＮｏ，３’およびＮｏ，３”が新たに追加されている。このような命令コードの変更は、表示部７３に表示された命令コードおよび動作ステップを確認しながら入力キー７４を操作して行うことができるので、上述した入力手段７５を用いて容易に変更可能である。しかも、１つの命令コードは、６つ以上の動作ステップにより構成することができるので、従来行えなかった６つ以上の推力の切り替えや速度切り替えも行える。
【００２５】
次に、本発明のロボット制御装置１の作用について説明する。ワークＷが所定の位置へ到達すると図示しないワーククランプが作動してワークＷを固定する。これを受け、制御部７２は、前記モータＭＢを回転駆動するよう前記コントローラ６５へ指令を送るとともに、図４（ａ）ないし（ｃ）に示す命令コードＮｏ，０、Ｎｏ，１、Ｎｏ，２を同時に実行する。これにより、各命令コードは、それぞれの動作ステップＮｏ，１から順に実行され、作業ツール６０が所定のねじ締めポイントへ移動する。また、命令コードＮｏ，１ないしＮｏ，３の処理が全て完了することで一連のねじ締め作業は完了する。
【００２６】
前記命令コードＮｏ，１の動作ステップＮｏ，１は、この命令コードＮｏ，１に該当する第二の可動軸２０を位置Ｘへ移動する命令となっている。これにより、制御部７２は、前記サーボアンプＳ２へ動作ステップＮｏ，１に設定した目標位置、目標速度、目標推力の情報を送る。また、サーボアンプＳ２は、これらの情報に基づきサーボモータＭ２を駆動制御するため、前記作業ツール６０は、前記目標位置である位置Ｘへ移動する。さらに、サーボアンプＳ２は、作業ツール６０が位置Ｘに到達した旨の信号を制御部７２へ送り、制御部７２は、位置Ｘ移動完了フラグを立てる。これにより、命令コードＮｏ，１の動作ステップＮｏ，１が処理されるので、制御部７２は、次の動作ステップＮｏ，２へ移行する処理を行う。しかし、動作ステップＮｏ，２には、命令コードＮｏ，１に該当しない可動軸１０の動作を待つ付随情報Ａが設定されているため、制御部７２は、付随情報Ａの成立条件である可動軸１０の全ての動作完了まで次の動作ステップＮｏ，３へは移行させず、命令コードＮｏ，１の処理を中断する。
【００２７】
続いて、命令コードＮｏ，２の動作ステップＮｏ，１は、この命令コードＮｏ，２に該当しない第二の可動軸２０の動作を待つ付随情報Ｂが設定されている。しかし、この命令コードＮｏ，２を実行する際、第二の可動軸２０は上述した命令コードＮｏ，１によって既に位置Ｘへ到達しており、前記位置Ｘ移動完了フラグが立てられている。このため、付随情報Ｂの条件が成立しているので、制御部７２は、命令コードＮｏ，２の動作ステップＮｏ，１から動作ステップＮｏ２へ移行する処理を行う。続いて、命令コードＮｏ，２の動作ステップＮｏ，２が実行されるので、制御部７２は、前記サーボアンプＳ３へ動作ステップＮｏ，２に設定した目標位置、目標速度、目標推力の情報を送る。これにより、サーボアンプＳ３は、これら各情報に基づきサーボモータＭ３を駆動制御するため、作業ツール６０は、前記目標位置である位置Ｙへ移動する。さらに、サーボアンプＳ３は、作業ツール６０が位置Ｙに到達した旨の信号を制御部７２へ送り、制御部７２は、位置Ｙ移動完了フラグを立てる。これにより、命令コードＮｏ，２の動作ステップＮｏ，２が処理されるので、制御部７２は、次の動作ステップＮｏ，３へ移行する処理を行う。しかし、この動作ステップＮｏ，３には、命令コードＮｏ，２に該当しない可動軸１０の動作を待つ付随情報Ａが設定されているため、制御部７２は、付随情報Ａの成立条件である可動軸１０の全ての動作完了まで次の動作ステップＮｏ，４へは移行させず、命令コードＮｏ，２の処理を中断する。
【００２８】
次に、前記命令コードＮｏ，０の動作ステップＮｏ，１は、この命令コードＮｏ，０に該当しない第二の可動軸２０および第三の可動軸３０の動作を待つ付随情報Ｂおよび付随情報Ｃがそれぞれ設定されている。しかし、第二、第三の可動軸２０，３０は、上述したように前記位置Ｘおよび前記位置Ｙへの移動が何れも完了している。制御部７２は、前記位置Ｘ移動完了フラグおよび位置Ｙ移動完了フラグが立っていることを判断すると、命令コードＮｏ，０の動作ステップＮｏ，１から動作ステップＮｏ，２へ移行する処理を行う。続いて、命令コードＮｏ，０の動作ステップＮｏ，２が実行されるので、制御部７２は、前記サーボアンプＳ１へ動作ステップＮｏ，２に設定した目標位置、目標速度、目標推力の情報を送る。これにより、サーボアンプＳ１は、これら各情報に基づきサーボモータＭ１を駆動制御するため、作業ツール６０は、前記目標位置である位置Ａへ移動する。このように、目標位置への移動が完了すれば次の動作ステップＮｏ，３ないしＮｏ，５へ順に移行し、各動作ステップに設定された位置Ｂ、位置Ｃ、位置Ｄの順に作業ツール６０が移動する。また、制御部７２は、命令コードＮｏ，０の動作ステップＮｏ，５を完了すると次の動作ステップＮｏ，６へ移行する処理を行う。この動作ステップＮｏ，６は、付随情報Ｅが設定されている。この付随情報Ｅは、前記作業ツール６０が所定のトルクを出力し終えたことが成立条件となっている。このため、制御部７２は、前記コントローラ６５からの情報に基づき付随情報Ｅが成立しているか判断し、成立していれば動作ステップＮｏ，６から次の動作ステップＮｏ，７へ移行する処理を行う。次に、制御部７２は、動作ステップＮｏ，７を実行すると、作業ツール６０が下降し始める位置の原点Ｚへ復帰する。続いて、制御部７２は、動作ステップＮｏ，７から動作ステップＮｏ，８へ移行する処理を行い命令コードＮｏ，０の処理を全て完了させる。これにより、可動軸１０の動作は全て完了となるので、制御部７２は、昇降動作完了フラグを立てる。
【００２９】
また、上述したように命令コードＮｏ，１および命令コードＮｏ，２は何れも処理が中断されていたが、前記昇降動作完了フラグが立てられているので、前記付随情報Ａが成立することになる。これにより、制御部７２は、中断していた命令コードＮｏ，１および命令コードＮｏ，２の処理を再開させ、作業ツール６０が作業開始前の位置である原点Ｘおよび原点Ｙへ復帰する。よって、命令コードＮｏ，０ないしＮｏ，３が全て完了し一連の作業が完了する。
【符号の説明】
【００３０】
１    作業ロボット制御装置
１０    可動軸
６０    作業ツール
７０    制御手段
７２    制御部
７５    入力手段
Ｍ１    サーボモータ
Ｓ１    サーボアンプ
【要約】
【課題】可動軸を安価な汎用ＰＬＣによって駆動制御できる作業ロボット制御装置の提供。
【解決手段】所定の作業を実行する作業ツール６０と、この作業ツール６０を往復移動自在に支持した可動軸１０と、この可動軸１０を駆動制御する制御手段７０とを備えて成る。前記制御手段７０は、サーボモータＭ１の回転を駆動制御するサーボアンプＳ１と、可動部材１２の目標位置、目標推力、目標速度を１つの動作ステップとしこの動作ステップを前記可動部材１２の動作順に並べて構成した命令コードを記憶する記憶部７１と、前記命令コードの動作ステップに基づき前記サーボアンプＳ１へ動作指令を送る制御部７２とを備えて成る。また、前記制御部７２は、ラダープログラムを実行する汎用ＰＬＣである。これにより、制御部７２を従来の高価なモーションコントローラから安価な汎用ＰＬＣへ変更できる。
【選択図】図２【図１】
0005952929.tif 000002
【図２】
0005952929.tif 000003
【図３】
0005952929.tif 000004
【図４】
0005952929.tif 000005
【図５】
0005952929.tif 000006