JP3689194B2 - ロボットの制御方法 - Google Patents
ロボットの制御方法 Download PDFInfo
- Publication number
- JP3689194B2 JP3689194B2 JP21534696A JP21534696A JP3689194B2 JP 3689194 B2 JP3689194 B2 JP 3689194B2 JP 21534696 A JP21534696 A JP 21534696A JP 21534696 A JP21534696 A JP 21534696A JP 3689194 B2 JP3689194 B2 JP 3689194B2
- Authority
- JP
- Japan
- Prior art keywords
- path
- teaching
- point
- input
- short
- 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.)
- Expired - Fee Related
Links
Images
Landscapes
- Numerical Control (AREA)
- Manipulator (AREA)
Description
【発明の属する技術分野】
本発明は、ロボットを高速タクトラインに適用する場合でのロボット制御方法に係り、外部からの確認信号の入力時期によって、マニピュレータを構成するメカニズムに多大な衝撃を与えることなくロボットの動作を教示点で停止させ、外部からの信号の変化を待機させるか、そのまま教示点もしくは教示点近傍を通過して、後続する動作経路における動作と滑らかに接続させるかを選択させるようにした、ロボットの制御方法に関するものである。
【0002】
【従来の技術】
外部機器とのインターロックが必要で、かつタクトタイムに高速性が要求されるラインにロボットを適用する場合、ワーククランプ等の確認を行うための入力待ち無駄時間を、いかに最小にするかは高速タクトラインにおける最重要課題の一つである。このため、ロボットの動作を停止させてから確認信号の入力の有無を判定するのではなく、ロボットを動作させながら同時に確認信号の有無判定を行う方法がとられている。この場合確認信号がすでに入力されていればそのまま動作を継続し、教示点もしくは教示点近傍を通過して継続する動作経路の動作と直接に接続される。
【0003】
一方、確認入力が存在しない場合は、ロボットを安全な位置にて待機させるために、確認信号の有無判定命令を教示した点で停止させる。
【0004】
通常高速タクトラインにおいては、ロボットを高速に動作させるため、教示点を通らずに適当な近回り動作をさせるのが一般的である。これは連続する2つの動作経路のうちの前者の終了部における減速部と、後者の開始部における加速部の速度を重ね合わせたり、連続する2つの動作経路における前者の経路の終了点付近一定区間と後者経路の開始点付近一定区間の動作経路を短絡、すなわち近回りさせることによって実現している。
【0005】
【発明が解決しようとする課題】
ところで、このような重ね合わせ区間または動作経路短絡区間において確認信号の有無の判定を行おうとする場合、確認信号が入力されたからといって、ロボットの動作を急激に変化させたり停止させたりすると、マニピュレータを構成するメカニズムに多大な衝撃を与えることとなり、減速機等にダメージを与える可能性が大きい。したがって、これらの重ね合わせ区間または経路短絡区間においては、ロボットを動作させながら同時に確認信号の有無判定を行う手段をとることができず、タクトタイム短縮の要求に答えることができない。
本発明の目的は、このような重ね合わせ区間においても、ロボットを動作させながら同時に確認信号の入力の有無の判定を行って、ロボットを高速に制御し得る制御方法を提供することにある。
【0006】
【課題を解決するための手段】
上記目的を達成するために本発明においては、連続する2つの動作経路の交点に至る直前の減速開始点、または経路短絡を始めるべき時点においてもなお確認信号が入力されない場合は、速度の重ね合わせまたは経路短絡を行わずはじめの動作経路の教示点に向かって滑らかに停止するよう減速制御を実行し、教示点に向かっての動作中に確認信号が入力された場合は、その時点で継続する動作経路の動作を開始して、加減速度の重ね合わせを行う。
【0007】
【作用】
図1または図2に示すようなロボット言語で記述したプログラムに基いてロボットを動作させる場合を考える。入力確認命令(INPUTQ)は前後の動作命令に挾まれており、この入力確認命令の実行で確認信号が入力されない場合は、前者の動作命令の教示点でロボットを停止させて入力確認待機をさせる。一方、前者の動作命令の教示点へ到達するまでに確認信号が入力された場合には、前後の動作命令の実行を分断させることなく、可能な限り目標に近い高速度または短絡経路で動作を継続させ、タクトタイムの短縮をはかる。
【0008】
【発明の実施の形態】
以下、本発明を図面により説明する。
図1および図2は、本発明に係る動作方法について、ロボット言語を用いて記述した作業プログラムの例である。同図においてMOVEP命令は、ロボットを現在位置からその教示目標点に位置決め動作させる命令であるが、教示目標点近傍の減速区間で、後続するMOVEP命令の加速区間と速度の重ね合わせ処理を行い、教示点を通過せずに教示点近傍を高速で滑らかに通過させるものである。
【0009】
MOVEQ命令は、同様にロボットを現在位置からその教示目標点に位置決め動作させる命令であるが、その教示目標点より指定距離手前で動作終了し、後続するMOVEQ命令の開始点(すなわち先行するMOVEQ命令の教示点)から指定距離進んだ点に向かう短絡経路をリアルタイムに作成して、近回り動作を行なわせるための命令である。ここで短絡させるべき距離の指定は、MOVEQ命令の1つのパラメータで行なわれる。
【0010】
INPUTQ命令は、直前のMOVEPまたはMOVEQ命令の実行中に、それらの教示目標点へ到達するより指定時間前から指定入力ポートの入力を監視し、動作中に指定の入力があれば、後続するMOVEP命令との速度の重ね合わせ処理、または後続するMOVEQ命令との短絡動作を可能とする命令である。
【0011】
図3(a)、(b)および図4(a)、(b)は、図1または図2に示す作業プログラムを実行した場合の、ロボットの動作経路を表したものである。図3および図4において1は教示点Pn に向かって位置決め動作する場合に、減速を開始する点である。2は教示点Pn から教示点Pn+1 に位置決め動作する場合に、加速を終了する点である。また、3は減速点1よりも手前で教示点Pn までの所定距離に定めた短絡経路への分岐点である。
【0012】
図3(a)は、Pn 点への位置決め動作中で短絡経路への分岐点3通過以前に入力が確認された場合の例を示す。ロボットはPn 点に向かう経路から教示短絡経路4に進路変更する。この教示短絡経路4の始点は教示点Pn からMOVEQ命令のパラメータで指定した分だけ戻った点であり、終点は後続するMOVEQ命令でPn+1 点に向かう位置決め経路上で、教示点Pn からMOVEQ命令のパラメータで指定した分だけ進んだ点である。教示短絡経路4の動作を完了すると、ロボットはその点から後続する教示点Pn+1 に向かう経路に進路変更する。ただし、進路変更については急激に行うものではなく、ロボット構成要素に許容以上の機械的衝撃を与えないような速度変化の平滑化を行う。教示短絡経路は、図3の(a)に示すように教示点Pn を通過せず停止することもなく近回りするので、ロボットの動作時間を短縮させることになる。
【0013】
図3(b)は、Pn 点への位置決め動作中で短絡経路への分岐点3の通過以後で、かつ減速開始点1より手前で確認信号が入力された場合の経路を示す。この場合、ロボットは速度重ね合わせ経路5を通過する。そしてPn+1 点への位置決め動作経路を継続する。この場合は先の教示短絡経路4よりは経路、動作時間とも長くなるが、減速しきって教示点Pn に到達し、再度加速してPn+1 点に向かうよりは、短時間で動作させることができる。
【0014】
図4(a)はPn 点への位置決め動作中で減速開始点1を通過した後に確認信号が入力された場合の動作経路を示す。この場合、減速区間の速度指令と次の教示点Pn+1 への位置決め動作の加速区間の速度指令とを重ね合わせた遅れ重ね合わせ経路6が実行される。この場合は、入力が確認された以降の残り減速区間の速度指令のみを、次のMOVEP命令の加速区間の速度指令と重ね合わせるため、図3(b)の速度重ね合わせ経路5よりは動作量、動作時間とも長くなる。しかしながら、減速しきって教示点Pn に到達し、再度加速してPn+1 点に向かうよりは、短時間で動作させることができる。
【0015】
図4(b)はPn 点への位置決め動作中には確認信号が入力されなかった場合の動作経路を表す。この場合は完全に減速して教示点Pn に到達した後に外部入力を待ち、その後に教示点Pn+1 に向かって加速を開始するのでもっとも経路が長くまた動作時間も長くかかる。
【0016】
ところで上記のように外部信号の入力タイミングによって速度の重ね合わせタイミングを調整したり、短絡経路をリアルタイムで変更するためには、作業プログラムの解釈、軌道計画、およびサーボ出力データの生成を、実際の動作区間に先行して演算しておく必要がある。すなわち、加減速の重ね合わせ処理を行うためには、減速処理が始まる時点において、減速パターンはもちろんのこと後続経路の加速パターンをサーボ出力データの段階まで算出しておく。また、短絡経路の生成については、短絡経路への切替え点到達前に短絡経路の軌道計画をサーボ出力データの段階まで算出しておく。後続の位置決め動作経路の軌道計画は、短絡経路の動作完了までにサーボ出力データの段階まで算出しておく。このようにしておくことにより、速度の重ね合わせ処理が十分に行なわれなかったり、経路の切替え時にロボットが一瞬停止したりすることが防止できる。
【0017】
このため、ロボット制御装置にはCPUを1つ以上採用し、サーボ機構へのデータ出力処理を行っている間にも、CPUの空き時間を利用して次にサーボ回路に出力すべきデータの作成を行ない、あるいはCPUを特定の処理専用に割り当てることによって、作業プログラムから現在実行中の命令に続く命令を取り出して解釈を行い、軌道計画やサーボ出力データの算出を並行して行う。もちろん、各処理毎にCPUを専用で割り当てもよいし、または各処理毎にタスクを割付け1つのCPUをマルチタスク制御方式で実行させてもよい。
【0018】
図5はロボット制御装置内部構成の一例をしめす図である。同図において、7は、作業プログラム解釈部であり、複数の作業プログラムが格納されたファイル8から指定された作業プログラムを読みだし順次命令の解釈を行う。解釈された命令は、各命令専用の処理部に実行が任される。例えば、動作命令は軌道計画部9に、入出力命令は入出力管理部10にといった類いである。
【0019】
軌道計画部9では、動作命令の記憶内容にしたがって、加減速部を含めて速度の出力パターンを時間の関数で生成する。すなわち、所定のサンプリング時間単位にロボットを動かす経路上の目標点を算出し、これら目標点データを順次バッファ11に格納する。ただし、次の座標変換部12が直前のデータを読み取っていなければ待機する。また、確認信号の入力状態に応じて算出済みの軌道計画を変更させる必要が発生するため、入出力管理部10との同期制御を行う。
【0020】
入出力管理部10では、入出力命令の実行を司るが、入出力の実行および完了と、ロボット動作の開始および終了タイミングとが密接に関係するため、軌道計画部9またはサーボ出力部18と同期制御を行う。また上述のように、軌道計画部9との同期制御を行う場合もある。
【0021】
座標変換部12は、バッファ11のサンプリング時間毎のロボット目標点を、ロボット機構データ13に基づいて座標変換を行い、バッファ14に格納する。ただし、バッファ14は1段であるため次のサーボ出力データ生成部15が直前のデータを読み取っていなければ待機する。
【0022】
サーボ出力データ生成部15は、バッファ14に格納されたサンプリング時間毎の座標変換されたロボット目標点データを、サーボ制御パラメータ16に基づいて、サーボ出力データに変換し、バッファ17に格納する。ただし、次のサーボ出力部18が直前のデータを読み取っていなければ待機する。サーボ出力部18は、サンプリング時間に対応したクロックパルスに同期して、バッファ17のデータを取り出しサーボ機構に出力する。また、入出力管理部10との同期制御が必要となることがある。たとえば、ある教示点にロボットが到達したことを確認した後、あるポートへの出力を行う必要がある場合には、その教示点への到達に対応するサーボ出力の完了後、入出力管理部10に通知することが必要である。また、ある入力命令の完了後ロボットの動作を可能とする場合には、サーボ出力部18は、入出力管理部10からの入力確認通知を待った後、サーボ機構19への出力を行う。また、サーボ機構への出力前に、出力データの急激な変化をなくしてロボットを滑らかに動作させるために、通常は一種のローパスフィルタの処理を行う場合も多い。
【0023】
図5の構成の装置の動作を図6ないし図8によって本発明の実施の形態を詳細に説明する。
【0024】
図5において、2つのMOVEP命令に挾まれたINPUTQ命令が実行される時、確認信号の入力タイミングによってロボットの速度指令がどのように変化するかを示したものである。縦軸に速度指令、横軸に時間を取ると、位置決め動作中のグラフは一般に台形状となる。すなわち加速時の右上がり直線の区間、速度一定の区間、減速時の右下がり直線の区間から構成される。連続する2つの位置決め動作の速度指令の重ね合わせは、確認信号の入力のタイミングによって、図6(a),(b),(c)の3通りの現象が発生する。
【0025】
図6において、(a)は先行するMOVEP命令の実行中で減速区間に到達する以前に確認信号が入力された場合である。ここで確認信号の認識動作の開始は、INPUTQ命令のパラメータで指定できるものである。この場合、先行する位置決め動作の減速開始とともに後続の位置決め動作の加速を始めることが出来るため、確認信号認識命令を教示しない場合と同じ動作時間で後続のMOVEP命令の教示点に到達することができる。この場合の制御装置内部での演算処理は次のように行なわれる。
【0026】
図5において、作業プログラム解釈部7は、MOVEP命令を解釈すると、その直後にINPUTQ命令が存在するか否か確認する。存在すればさらにMOVEP命令が続くか否か確認する。こうしてMOVEP−INPUTQ−MOVEPの命令シーケンスが確認されると、作業プログラム解釈部7は、軌道計画部9に前者MOVEPの情報と後者MOVEPの情報を順次引き渡す。また入出力管理部10にINPUTQの情報を引き渡す。ただし、これらの情報には以下に示す情報が付加される。先ず前者MOVEP命令の情報には本来の軌道情報と速度情報以外に、INPUTQ命令のパラメータである確認信号認識開始先行時間の算出依頼と、その時刻の到来を入出力管理部10に通知するための同期番号Aが付加される。また、後者MOVEP命令の情報には本来の軌道情報と速度情報以外に、動作開始のタイミング通知を受ける同期番号Bが付加される。
【0027】
入出力管理部10に引き渡されるINPUTQ命令の情報には、本来の入力ポート番号以外に確認信号入力監視開始時刻の到来を認識するための前期同期番号Aが付加される。さらに確認信号の入力と同時に後者MOVEPの動作開始を軌道計画部9に通知するための別の同期番号Bが付加される。
【0028】
軌道計画部9では、受け取った前者MOVEP命令の情報に基づいて軌道計画を行い、サンプル時間毎の目標位置と確認信号入力認識開始先行時間の算出を行う。サンプル時間毎の目標位置は時間順にバッファ11に出力されるが、確認信号入力認識開始タイミングとなるサンプリング時間の目標位置データは、特に前期同期番号Aとセットで出力される。続いて後者MOVEP命令の情報を受取り、同様に軌道計画を行いサンプル時間毎の目標位置を算出するが、第1データに前期同期番号Bが付加されるためバッファ11への出力は待機状態となる。出力が可能となるのは、入出力管理部10から前記同期番号Bの通知を受けた後で、前者MOVEP軌道の減速が開始する時点である。これ以降は、両軌道のサンプル時間毎の動作量を合成し再度目標位置に変換した値を順次バッファ11へ出力する。これにより速度指令の重ね合わせが行なわれ、重ね合わせ経路3上を動作させることができる。バッファ11,14,17に格納されるデータの構造を図7に示す。各バッファ間でデータは変換され次元の異なるものとなるが、サンプリング時間毎の対応はとられているため、同期番号と各データとの同期関係は保たれる。
【0029】
入出力管理部10は、INPUTQ命令と同期番号Aおよび同期番号Bを受け取ると、サーボ出力部18から同期番号Aが通知されるのを待って指定入力の確認を開始する。同期番号Aが通知された後その指定入力が確認されると、軌道計画部9に同期番号Bを通知する。また、命令の実行完了通知として入力が確認されたことを作業プログラム解釈部7に通知する。
【0030】
座標変換部12とサーボ出力データ生成部15は、前述のように実行が進められる。サーボ出力部18は、サーボ出力データに前記同期番号Aが付帯されていれば、入出力管理部10に確認信号の入力認識開始の通知を行う。
【0031】
図6(b)は図5において先行するMOVEP命令の実行中で減速区間に到達したが、まだ教示点には到達していない間に確認信号が入力された場合である。この場合、すでに減速区間にはいっているために速度は減少しつつあるが、可能な限り早急に後続の位置決め動作の加速を始める。そうすることにより、先行する位置決め動作の減速区間での未消化部分が、後続の位置決め動作の加速部分と一部ではあるが重ね合わせられるため、後続のMOVEP命令の教示点に到達するための動作時間は、先行位置決め動作が教示点Pn に行き着いてしまう場合よりも短縮されることになる。この場合の制御装置内部での演算処理は次のように行なわれる。
【0032】
軌道計画部9では、第6図(a)の場合と同様に前者MOVEP命令の情報に基づくサンプル時間毎の目標位置を時間順にバッファ11に出力した後、後者MOVEP命令の情報に基づくサンプル時間毎の目標位置を算出し、入出力管理部10からの同期番号Bの通知を待機している。しかしながら(a)の場合と異なり、この同期番号Bの通知を受けるのは前者MOVEP軌道の減速が開始した後である。これ以降は、両軌道のサンプル時間毎の動作量を合成し再度目標位置に変換した値を順次バッファ11へ出力する。これにより(a)の場合よりは短い期間ではあるが、速度指令の重ね合わせが行なわれ図3(a)の重ね合わせ経路4上を動作させることができる。
【0033】
図6(c)は図5において先行するMOVEP命令の目標教示点に到達した後、確認信号が入力された場合である。この場合、前後の位置決め動作の速度指令が重ね合わせられることはなく、全く動作時間および距離の短縮は行なわれない。この場合の制御装置内部での演算処理は次のように行なわれる。
【0034】
軌道計画部9では、図6(a)の場合と同様に前者MOVEP命令の情報に基づくサンプル時間毎の目標位置を時間順にバッファ11に出力した後、後者MOVEP命令の情報に基づくサンプル時間毎の目標位置を算出し、入出力管理部10からの同期番号Bの通知を待機している。しかしながら図6(a),(b)の場合と異なり、この同期番号Bの通知を受けるのは前者MOVEP軌道の減速が完了した後である。すなわちPn 点でロボットが停止した後である。これ以降は、後者MOVEP命令の軌道に沿ってロボットは動作することとなる。
【0035】
図8は2つのMOVEQ命令に挾まれたINPUTQ命令が実行される時、確認信号の入力のタイミングによってロボットの合成速度指令がどのように変化するかを示したものである。この場合には同図(a),(b),(c),(d)に示す4通りの現象が発生する。
【0036】
図8(a)は図5において先行するMOVEQ命令の実行中で教示短絡軌道への分岐点に到達する以前に確認信号が入力された場合である。ここで確認信号の入力認識動作の開始は、INPUTQ命令のパラメータで指定できるものである。この場合、確認信号入力認識命令を教示しない場合と同じ動作時間で後続のMOVEQ命令の教示点に到達することができる。この場合の制御装置内部での演算処理は、次のように行なわれる。
【0037】
図5において、作業プログラム解釈部7は、MOVEQ命令を解釈すると、その直後にINPUTQ命令が存在するか否か確認する。存在すればさらにMOVEQ命令が続くか否か確認する。こうしてMOVEQ−INPUTQ−MOVEQの命令シーケンスが確認されると、作業プログラム解釈部7は、軌道計画部9に前者MOVEQの情報と後者MOVEQの情報を順次引き渡す。また入出力管理部10にINPUTQの情報を引き渡す。ただし、これらの情報には以下に示す情報が付加される。先ず前者MOVEQ命令の情報には本来の軌道情報と速度情報以外に、INPUTQ命令のパラメータである確認信号入力認識開始先行時間の算出依頼と、その時刻の到来を入出力管理部10に通知するための同期番号Aが付加される。また、後者MOVEQ命令の情報には本来の軌道情報と速度情報以外に、動作開始のタイミング通知を受ける同期番号Bが付加される。
【0038】
入出力管理部10に引き渡されるINPUTQ命令の情報には、本来の入力ポート番号以外に入力監視開始時刻の到来を認識するための前期同期番号Aが付加される。さらに入力確認と同時に後者MOVEPの動作開始を軌道計画部9に通知するための別の同期番号Bが付加される。
【0039】
軌道計画部9では、受け取った先行および後行の各MOVEQ命令の情報に基づいて、3つの軌道を計画する。このうち2つは図6と同様加減速部を持つ前後MOVEQ命令に対応する区間の台形状の速度関数であり、もう一つは、教示短絡経路を動作する場合の速度関数である。さらに2つのMOVEQ命令に対応する区間の速度関数は、それぞれ短絡軌道への分岐点、または短絡軌道からの復帰点で前後に分けられる。図9はこのときに作成される5つの速度関数の例を示す線図である。まず、図9(a)に示す速度関数21から、サンプリング時間毎の目標位置と確認信号入力認識開始先行時間の算出を行う。サンプル時間毎の目標位置データは時間順にバッファ11に出力されるが、入力確認開始タイミングとなるサンプリング時間の目標位置データは、特に前期同期番号Aとセットで出力される。図9(b)の速度関数23の最初のサンプリング時間の目標位置データには同期番号Bが付加され、バッファ11への出力は待機状態となる。出力が可能となるのは入出力管理部10から前記同期番号Bの通知を受けた後で、前者MOVEP命令の軌道が短絡軌道に分岐する時点である。これ以降は、図9(b)の速度関数23のサンプリング時間毎の目標位置がバッファ11に出される。これにより教示短絡経路5上を動作させることができる。この後、図9(c)の速度関数24は破棄され、速度関数25のサンプリング時間毎の目標位置がバッファ11に出される。
【0040】
入出力管理部10は、INPUTQ命令と同期番号Aおよび同期番号Bを受け取ると、サーボ出力部18から同期番号Aが通知されるのを待って確認信号の入力の監視を開始する。同期番号Aが通知された後確認信号が入力されると、軌道計画部9に同期番号Bを通知する。また、命令の実行完了通知として確認信号が入力されたことを作業プログラム解釈部7に通知する。
【0041】
座標変換部12とサーボ出力データ生成部15は、前述のように実行が進められる。サーボ出力部18は、サーボ出力データに前記同期番号Aが付帯されていれば、入出力管理部10に確認信号の入力認識開始の通知を行う。
【0042】
図8(b)は、図5において先行するMOVEQ命令の実行中で教示短絡軌道への分岐点に到達した後、減速開始点に到達以前に確認信号が入力された場合である。この場合は、図6(a)と同様に前後の位置決め動作の加減速部を重ね合わせることができるので、短絡動作をまったく行なわれないが教示点Pn を通る場合よりも、短時間で次の教示点Pn+1 に到達することができる。この場合の制御装置内部での演算処理は次のように行なわれる。
【0043】
軌道計画部9では、図9(a)の速度関数21の出力が完了した時点、すなわち教示短絡経路への分岐点を通過しても入出力管理部10からの確認信号の入力通知がない場合は、図9(b)の速度関数23を破棄し図9(a)の速度関数22からサンプリング時間毎の目標位置データを算出し、バッファ11への出力を開始する。また図9(b)の速度関数24のサンプリング時間毎の目標位置データを算出し、特に第1データには同期番号Bを付加する。ただしバッファ11へ出力が可能となるのは、入出力管理部10から前記同期番号Bの通知を受けた後で、前者MOVEP命令の軌道が減速区間に到達した時である。これ以降は図9(a)の速度関数22と図9(c)の速度関数24のサンプリング時間毎の動作量を合成し、再度目標位置に変換した値を順次バッファ11に出する。図9(a)および(c)の速度関数22と24の成分の出力が完了した後は、図9(c)の速度関数25のサンプリング時間毎の目標位置がバッファ11に出力される。
【0044】
図8(c)は図5において先行するMOVEQ命令の実行で教示短絡軌道への分岐が行なわれず、減速区間へ入ってから教示点に到達するまでに確認信号の入力が行なわれた場合である。この場合は、図6(b)の場合と同様に可能な限り早急に後続の位置決め動作の加速を始める。そうすることにより、先行する位置決め動作の減速区間での未消化部分が、後続の位置決め動作の加速部分と一部ではあるが重ね合わせられるため、図8(b)の場合よりは動作距離は長いが、重ね動作をまったく行わず教示点Pn を通る場合よりも、短時間で次の教示点Pn+1 に到達することができる。この場合の制御装置内部での演算処理は次のように行なわれる。
【0045】
軌道計画部9では、図9(a)の速度関数21の出力が完了した時点、すなわち教示短絡経路への分岐点を通過しても入出力管理部10からの確認信号入力認識の通知がないため、図9(b)の速度関数23を破棄し図9(a)の速度関数22からサンプリング時間毎の目標位置データを算出し、バッファ11への出力を開始する。また図9(c)の速度関数24のサンプリング時間毎の目標位置データを算出し、第1データに同期番号Bを付加して、入出力管理部10からの同期番号Bの通知を待機する。しかしながら図8(b)の場合と異なり、この同期番号Bの通知を受けるのは前者MOVEP軌道の減速が開始した後である。これ以降は図9(a)および(c)の速度関数22と24のサンプリング時間毎の動作量を合成し、再度目標位置に変換した値を順次バッファ11に出力する。図9(a)および(c)の速度関数22と24の成分の出力が完了した後は、図9(c)の速度関数25のサンプリング時間毎の目標位置がバッファ11に出力される。
【0046】
図8(d)は、図5において先行するMOVEP命令の目標教示点に到達した後に確認信号が入力された場合である。この場合、前後の位置決め動作経路が短絡されることも、速度指令が重ね合わせられることもなく、全く動作時間および距離の短縮は行なわれない。この場合の制御装置内部での演算処理は次のように行なわれる。
【0047】
軌道計画部9では、図9(a)の速度関数21の出力が完了した時点、すなわち教示短絡経路への分岐点を通過しても入出力管理部10からの確認信号の入力通知がないため、図9(b)の速度関数23を破棄し図9(a)の速度関数22からサンプリング時間毎の目標位置データを算出し、バッファ11への出力を開始する。また図9(c)の速度関数24のサンプリング時間毎の目標位置データを算出し、第1データに同期番号Bを付加して、入出力管理部10からの同期番号Bの通知を待機する。しかしながら図8(a)ないし(c)の場合と異なり、この同期番号Bの通知を受けるのは前者MOVEP命令軌道の減速が完了した後である。すなわちPn 点でロボットが停止した後である。
【0048】
これ以降は図9(c)の速度関数24のサンプリング時間毎の目標位置データを順次バッファ11に出力し、続いて図9(c)の速度関数25のサンプリング時間毎の目標位置データを順次バッファ11に出力することによって、後者MOVEP命令の軌道に沿ってロボットは動作することとなる。
【0049】
【発明の効果】
以上説明したように本発明によれば、連続する2つの動作経路の先行する経路の終了部における減速部と後行する経路の開始部における加速部の速度を重ね合わせることによってロボットの高速動作を実現するシステムにおいて、動作継続のための外部確認信号が入力されない場合は先行する動作経路の目標教示点に滑らかに停止させ、先行する動作経路の目標教示点に到達するまでに外部からの確認信号が入力された場合には、その時点で可能な限りの最高速度を保持し後行する動作経路の動作に滑らかに接続させることができる。
【0050】
また、連続する2つの動作経路の先行する動作経路の終了点付近一定区間と後行する動作経路の開始部付近における一定区間の動作経路を短絡、すなわち近回りさせることによってロボットの高速動作を実現するシステムにおいて、動作継続のための外部確認信号が入力されない場合は先行する動作経路の目標教示点に滑らかに停止させ、先行する動作経路の目標教示点に到達するまでに外部確認信号が入力された場合には、短絡経路を生成して後者動作経路の動作に滑らかに接続させるか、あるいは最高速度を保持し後行する動作経路の動作に滑らかに接続させることができる。これにより、ロボット駆動機構に衝撃を与えず、安全でかつ無駄な待ち時間を徹底的に排除したロボットシステムが実現できるものである。
【図面の簡単な説明】
【図1】作業プログラムの例を示す図。
【図2】作業プログラムの例を示す図。
【図3】ロボットの教示短絡経路と速度重ね合わせ経路の例を示す図。
【図4】遅れ重ね合わせ経路と重ね合わせが行われなかった時の経路の例を示す図。
【図5】ロボット制御装置内部構成の例を示す図。
【図6】外部確認信号の入力タイミングと速度指令の例を示す図。
【図7】目標位置データの内部記憶構成の例を示す図。
【図8】外部確認信号の入力タイミングと速度指令の例を示す図。
【図9】本発明における速度関数の例を示す図。
【符号の説明】
1 減速開始点
2 加速終了点
3 教示短絡経路への分岐点
4 短絡経路
5 速度の重ね合わせ経路
6 遅れ重ね合わせ経路
7 作業プログラム解釈部
8 作業プログラムファイル
9 軌道計画部
10 入出力管理部
11 バッファ
12 座標変換部
13 ロボット機構データ
14 バッファ
15 サーボ出力データ生成部
16 サーボ制御パラメータ
17 バッファ
18 サーボ出力部
19 サーボ機構
Claims (2)
- 教示点P n に向かう第1の経路と前記第1の経路を動作中に確認信号が与えられたときに前記教示点P n から次の教示点P n+1 に向かう第2の経路に移動するロボットの制御方法において、前記第1の経路上に教示短絡経路の始点を教示し、前記第2の経路上に教示短絡経路の終点を教示し、前記教示点Pnへの移動中に前記第1の経路から前記教示短絡経路を通り前記第2の経路に至る軌道を予め算出し、(a)前記確認信号が前記第1の経路の全動作区間中に入力されなかったときは、前記教示点P n までロボットを移動させるとともに滑らかに減速して前記教示点P n で停止させ、前記確認信号の入力を待って前記教示点P n から前記教示点P n+1 に向かって滑らかに加速して前記第2の経路を移動させ、(b)前記確認信号が前記第1の経路の前記教示短絡経路の始点に至るまでに入力されたときは、前記算出した教示短絡経路の軌道に従って前記教示短絡経路の始点から前記第1の経路から前記第2の経路に至る動作経路短絡のための制御を開始し、(c)前記第1の経路の前記教示短絡経路の始点に到達の後で前記教示点P n に至る間に前記確認信号が入力されたときは、前記第1の経路と前記第2の経路の速度の重ね合わせを実行する、ロボットの制御方法。
- 教示点P n に向かう第1の経路と前記第1の経路を動作中に確認信号が与えられたときに前記教示点P n から次の教示点P n+1 に向かう第2の経路に移動するロボットの制御方法において、前記第1の経路上に教示短絡経路の始点を教示し、前記第2の経路上に教示短絡経路の終点を教示し、前記教示点Pnへの移動中に前記第1の経路から前記教示短絡経路を通り前記第2の経路に至る軌道を予め算出し、前記第1の経路には前記教示点P n に近い減速開始点を設け、前記第2の経路には前記教示点P n に近い加速終了点を設け、(a)前記確認信号が前記第1の経路の全動作区間中に入力されなかったときは、前記教示点P n までロボットを移動させるとともに前記減速開始点から前記教示点P n に至る間で滑らかに減速して前記教示点P n で停止させ、前記確認信号の入力を待って前記教示点P n から前記第2の経路の前記加速終了点に向かって滑らかに加速して前記第2の経路を移動させ、(b)前記確認信号が前記第1の経路の前記教示短絡経路の始点に至るまでに入力されたときは、前記算出した教示短絡経路の軌道に従って前記教示短絡経路の始点から前記第1の経路から前記第2の経路に至る動作経路短絡のための制御を開始し、(c)前記第1の経路の前記教示短絡経路の始点に到達の後で前記教示点P n に至る間に前記確認信号が入力されたときは、前記第1の経路の減速区間と前記第2の経路の加速区間の速度の重ね合わせを実行させるロボットの制御方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP21534696A JP3689194B2 (ja) | 1996-07-26 | 1996-07-26 | ロボットの制御方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP21534696A JP3689194B2 (ja) | 1996-07-26 | 1996-07-26 | ロボットの制御方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH1039917A JPH1039917A (ja) | 1998-02-13 |
JP3689194B2 true JP3689194B2 (ja) | 2005-08-31 |
Family
ID=16670787
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP21534696A Expired - Fee Related JP3689194B2 (ja) | 1996-07-26 | 1996-07-26 | ロボットの制御方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3689194B2 (ja) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4209342B2 (ja) * | 2004-02-19 | 2009-01-14 | 株式会社日立産機システム | モーションコントローラ装置 |
JP2007164260A (ja) * | 2005-12-09 | 2007-06-28 | Yokogawa Electric Corp | モータ制御装置 |
JP5461807B2 (ja) * | 2008-09-18 | 2014-04-02 | 株式会社タダノ | クレーンの移動制御装置及び移動式クレーン |
JP5156570B2 (ja) * | 2008-10-06 | 2013-03-06 | 株式会社森精機製作所 | 自動プログラミング装置及びこれを備えたnc工作機械の制御装置 |
JP2015097045A (ja) * | 2013-11-15 | 2015-05-21 | ファナック株式会社 | 非常停止時に工具及び被加工物を保護するモータ制御装置 |
JP6360301B2 (ja) * | 2013-12-25 | 2018-07-18 | 川崎重工業株式会社 | 動作プログラム作成方法およびロボットの制御方法 |
JP5890466B2 (ja) * | 2014-05-14 | 2016-03-22 | ファナック株式会社 | 退避機能を備えた数値制御装置 |
CN110315526B (zh) * | 2018-03-29 | 2023-09-08 | 日本电产三协(浙江)有限公司 | 机器人的控制方法及机器人 |
-
1996
- 1996-07-26 JP JP21534696A patent/JP3689194B2/ja not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JPH1039917A (ja) | 1998-02-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JPS63216689A (ja) | 自動作業装置 | |
JPS61157909A (ja) | ロボツトの経路誤差補正方式 | |
JP3689194B2 (ja) | ロボットの制御方法 | |
JP2010170435A (ja) | モーション制御用指令システム、モーション制御用指令方法およびモーション制御システム | |
US8255083B2 (en) | Industrial robot and method for controlling the movement of an industrial robot | |
JP3168682B2 (ja) | 数値制御装置 | |
JP2004326257A (ja) | シミュレーション装置 | |
KR102297735B1 (ko) | 로봇 제어 장치, 로봇 제어 방법, 프로그램 | |
JP3821404B2 (ja) | 溶接作業用ロボットの制御方法 | |
JPH02257204A (ja) | 複数ロボット腕の衝突回避制御方式 | |
JPH06114761A (ja) | 制振制御方法 | |
KR20020012199A (ko) | 프로그래머블 컨트롤러 | |
JP2004252814A (ja) | 多関節型ロボットの速度制御法および制御装置 | |
JPH0728520A (ja) | ロボットの原点復帰制御方法 | |
CN110142757A (zh) | 一种控制机器人运动的方法、装置及下位机 | |
JP5678746B2 (ja) | ロボットの制御方法およびロボットの制御装置 | |
JPH06180605A (ja) | 工作機械の早送り制御方法及び装置 | |
JPH09251320A (ja) | ロボット衝突防止システム | |
JP2801108B2 (ja) | 数値制御装置 | |
JPH09305210A (ja) | 複数台ロボットの干渉防止方法 | |
JP7398947B2 (ja) | モータ制御装置 | |
JP2689748B2 (ja) | ロボットの制御方法 | |
JPH04347705A (ja) | 工作機械における早送り位置決め制御装置 | |
JP2001154719A (ja) | 自由曲線補間方法 | |
JPH0264713A (ja) | 自動作業装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20040927 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20041005 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20041203 |
|
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: 20050607 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20050610 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090617 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100617 Year of fee payment: 5 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100617 Year of fee payment: 5 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110617 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110617 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120617 Year of fee payment: 7 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120617 Year of fee payment: 7 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130617 Year of fee payment: 8 |
|
LAPS | Cancellation because of no payment of annual fees |