(57)【要約】【課題】従来よりも正確な移動経路を作成することができる。【解決手段】所定の処理ツールを備えるロボットと、ティーチングモード時に前記処理ツールの移動軌跡を取得する制御装置とを備えるロボットシステムであって、前記ロボットは、前記処理ツールに作用する外力を検出する力センサを備え、前記制御装置は、ティーチングモード時において前記力センサが検出する外力が一定値になるように、前記処理ツールをワークの表面に押し付けながら移動させて前記移動軌跡を取得する。【選択図】図１
2019202372.tif 000002
【特許請求の範囲】
【請求項１】
所定の処理ツールを備えるロボットと、ティーチングモード時に前記処理ツールの移動軌跡を取得する制御装置とを備えるロボットシステムであって、
前記ロボットは、前記処理ツールに作用する外力を検出する力センサを備え、
前記制御装置は、ティーチングモード時において前記力センサが検出する外力が一定値になるように、前記処理ツールをワークの表面に押し付けながら移動させて前記移動軌跡を取得することを特徴とするロボットシステム。
【請求項２】
前記制御装置は、プレイバックモード時には前記移動軌跡に基づいて前記ロボットを制御することを特徴とする請求項１記載のロボットシステム。
【請求項３】
前記制御装置は、前記移動軌跡を、前記処理ツールを前記ワークの表面に押し付ける方向又は前記押し付ける方向とは反対方向にオフセットさせることで移動経路を作成し、前記移動経路に基づいて前記ロボットを制御する
ことを特徴とする請求項１または２記載のロボットシステム。
【請求項４】
前記処理ツールは、前記ワークの表面に対して前記一定値の力で押圧されても変形しない剛性を有する材料で形成されている教示用ツールである
ことを特徴とする請求項１〜３のいずれか一項に記載のロボットシステム。
【請求項５】
前記処理ツールは、所定の処理を行う工具である
ことを特徴とする請求項１〜４のいずれか一項に記載のロボットシステム。
【請求項６】
所定の処理ツールと、前記処理ツールに作用する外力を検出する力センサとを備えるロボットの制御方法であって、
ティーチングモード時に前記処理ツールの移動軌跡を取得する取得ステップを含み、
前記取得ステップでは、ティーチングモード時において前記力センサが検出する外力が一定値になるように、前記処理ツールをワークの表面に押し付けながら移動させて前記移動軌跡を取得することを特徴とするロボットの制御方法。
【請求項７】
プレイバックモード時には、前記取得ステップで取得した前記移動軌跡に基づいて前記ロボットを制御する制御ステップをさらにを含むことを特徴とする請求項６記載のロボットの制御方法。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、ロボットシステム及びロボットの制御方法に関する。
【背景技術】
【０００２】
下記特許文献１には、三次元自由曲面を有する作業対象物に対して、手先部に取付けられた工具で研削、研磨等の倣い作業を実施する産業用ロボット機構が開示されている。この産業用ロボット機構は、事前に作業者により手動で教示された移動経路に沿って工具を移動させることで作業対象物に対して倣い作業を実施する、いわゆるティーチングプレイバック制御を行う。
【先行技術文献】
【特許文献】
【０００３】
【特許文献１】特許第３６７０７００号公報
【発明の概要】
【発明が解決しようとする課題】
【０００４】
ところで、上記移動経路の教示には、作業者の教示能力によってばらつきが生じてしまう。そのため、正確な移動経路を教示することができず、産業用ロボット機構は、正確な移動経路で工具を移動させることができない場合がある。
【０００５】
本発明は、上述した事情に鑑みてなされたものであり、従来よりも正確な移動経路を作成することを目的とするものである。
【課題を解決するための手段】
【０００６】
上記目的を達成するために、本発明では、ロボットシステムに係る第１の解決手段として、所定の処理ツールを備えるロボットと、ティーチングモード時に前記処理ツールの移動軌跡を取得し、プレイバックモード時には前記移動軌跡に基づいて前記ロボットを制御する制御装置とを備えるロボットシステムであって、前記ロボットは、前記処理ツールに作用する外力を検出する力センサを備え、前記制御装置は、ティーチングモード時において前記力センサが検出する外力が一定値になるように、前記処理ツールをワークの表面に押し付けながら移動させて前記移動軌跡を取得する、という手段を採用する。
【０００７】
本発明では、ロボットシステムに係る第２の解決手段として、上記第１の解決手段において、前記制御装置は、プレイバックモード時には前記移動軌跡に基づいて前記ロボットを制御する、という手段を採用する。
【０００８】
本発明では、ロボットシステムに係る第３の解決手段として、上記第１または第２の解決手段において、前記制御装置は、前記移動軌跡を、前記処理ツールを前記ワークの表面に押し付ける方向又は前記押し付ける方向とは反対方向にオフセットさせることで移動経路を作成し、前記移動経路に基づいて前記ロボットを制御する、という手段を採用する。
【０００９】
本発明では、ロボットシステムに係る第４の解決手段として、上記第１〜第３のいずれかの解決手段において、前記処理ツールは、前記ワークの表面に対して前記一定値の力で押圧されても変形しない剛性を有する材料で形成されている教示用ツールである、という手段を採用する。
【００１０】
本発明では、ロボットシステムに係る第５の解決手段として、上記第１〜第４のいずれかの解決手段において、前記処理ツールは、前記所定の処理を行う工具である、という手段を採用する。
【００１１】
本発明では、ロボットの制御方法に係る第６の解決手段として、所定の処理ツールと、前記処理ツールに作用する外力を検出する力センサとを備えるロボットの制御方法であって、ティーチングモード時に前記処理ツールの移動軌跡を取得する取得ステップを含み、前記取得ステップでは、ティーチングモード時において前記力センサが検出する外力が一定値になるように、前記処理ツールをワークの表面に押し付けながら移動させて前記移動軌跡を取得する、という手段を採用する。
【００１２】
本発明では、ロボットの制御方法に係る第７の解決手段として、上記第６の解決手段において、プレイバックモード時には、前記取得ステップで取得した前記移動軌跡に基づいて前記ロボットを制御する制御ステップをさらにを含む、という手段を採用する。
【発明の効果】
【００１３】
本発明によれば、従来よりも正確な移動経路を作成することができる。
【図面の簡単な説明】
【００１４】
【図１】本発明の一実施形態に係るロボットシステムＡの構成を示すブロック図である。
【図２】本発明の一実施形態に係る制御装置２の構成を示すブロック図である。
【図３】本発明の一実施形態に係る産業用ロボット１及び制御装置２の動作の流れを示す図である。
【図４】本発明の一実施形態に係るティーチングモードの動作を説明する図である。
【図５】本発明の一実施形態に係るワークＷに接着剤を塗布・注入する工具の構成を示す図である。
【図６】本発明の一実施形態に係るワークＷの表面の接着剤を拭き取る工具の構成を示す図である。
【発明を実施するための形態】
【００１５】
以下、図面を参照して、本発明の一実施形態について説明する。
本実施形態に係るロボットシステムＡは、図１に示すようにロボット１及び制御装置２を備える。
ロボット１は、治具Ｆにより固定されたワークＷの表面形状に沿った移動経路Ｒを移動しながら、ワークＷに対して所定の処理を行うロボットである。
ここで、所定の処理とは、バリ取り加工、Ｃ面取り加工、ラウンドエッジ加工、接着剤等の液体の塗付、注入又は拭き取り等である。
【００１６】
ロボット１は、ロボットアーム３、ハンド部４、処理ツール５及び力センサ６を備える。
ロボットアーム３は、複数の多関節機構を有する。ロボットアーム３の各関節には、各関節を各々駆動するモータが設けられている。ロボットアーム３は、制御装置２によりモータが駆動されることで、例えば、三次元空間を移動することができる。また、各関節には、モータの回転角度を検知するエンコーダが設けられている。
【００１７】
ハンド部４は、処理ツール５をロボットアーム３に対して着脱可能に接続する。
処理ツール５は、ハンド部４によりロボットアーム３の先端に取り付けられる。処理ツール５は、ロボットアーム３の駆動により、三次元空間内で位置と姿勢を移動可能である。処理ツール５は、所定の力で押圧されても変形しない剛性を有する材料で形成される。この所定の力とは、処理ツール５がワークＷを押し付ける押付け力である。処理ツール５は、ティーチングモードで移動経路Ｒを作成する場合に作業者によりロボットアーム３の先端に取り付けられる。この処理ツール５は、プレイバックモードにおいて上記所定の処理を行う工具であってもよいし、ティーチングモードにおいて上記移動経路Ｒを作成するための専用の教示用ツールであってもよい。
【００１８】
力センサ６は、処理ツール５に作用する外力Ｆｔを検出する。そして、力センサ６は、検出した外力Ｆｔを制御装置２に出力する。例えば、力センサ６は、三次元的に移動可能なロボットアーム３と処理ツール５との間に取り付けられる。この力センサ６は、例えば、直交３軸方向の力と各軸周りのトルクを検出する。ただし、力センサ６は、これに限定されず、ワークＷに対する押し付け力が検出できる限りで、その他の力センサであってもよい。
【００１９】
制御装置２は、ティーチングモード時に処理ツール５の移動軌跡及びロボット１の動作データを記憶し、プレイバックモード時にはその移動軌跡及び動作データに基づいてロボット１を制御する。以下に、制御装置２の構成について、具体的に説明する。
図２に示すように、制御装置２は、ロボット制御部２１、記憶部２２、軌跡取得部２３、及び経路作成部２４を備える。
【００２０】
ロボット制御部２１は、力センサ６から処理ツール５に作用する外力Ｆｔを取得する。そして、ロボット制御部２１は、取得した外力Ｆｔが一定値になるように、ロボットアーム３に設けられたモータの駆動を制御することで、処理ツール５をワークＷの表面に押し付けながら予め設定される各教示点Ｔに移動させる。すなわち、ロボット制御部２１は、ワークＷの表面に対する処理ツール５の押付け力を制御しながら、処理ツール５をワークＷの表面形状に倣せる。ここで、処理ツール５をワークＷの表面に押し付ける方向（押付け方向）は、例えば、ワークＷの表面の法線方向である。ただし、押付け方向はワークＷの表面の法線方向に限定されず、ワークＷと処理ツール５との干渉を避けるために、法線方向からずらした方向であってもよい。また、処理ツール５をワークＷの表面形状に倣せる方向（移動方向）とは、例えば、押付け方向に対して垂直な方向である。
【００２１】
記憶部２２は、予め設定された上記教示点Ｔを格納する。この教示点Ｔは、ワークＷの表面上に複数設定される。例えば、この教示点Ｔは、ワークＷの表面形状を倣わせる処理ツール５の開始位置と停止位置とを含む。
【００２２】
軌跡取得部２３は、処理ツール５が移動した位置の軌跡（移動軌跡）及びその位置ごとのロボットアーム３の動作データ（位置と姿勢）を取得する。例えば、軌跡取得部２３は、ロボットアーム３に設けられたエンコーダから取得したモータの回転角度に基づいて、処理ツール５の移動軌跡及びその移動軌跡におけるロボットアーム３の動作データを算出する。
【００２３】
経路作成部２４は、軌跡取得部２３が取得した移動軌跡から移動経路Ｒを作成する。例えば、経路作成部２４は、軌跡取得部２３で取得した移動軌跡を、押付け方向又は押付け方向とは反対方向にオフセットさせることで移動経路Ｒを作成する。例えば、このオフセット量は、処理ツール５の形状に基づいて決定される。例えば、ロボットアーム３の先端に教示用ツールを取り付けられて移動経路Ｒを作成した場合には、その教示用ツールの押付け方向の長さと、上記所定の処理を行うためにロボットアーム３の先端に取り付けられる工具の押付け方向の長さとの差分値に基づいてオフセット量が設定される。そして、経路作成部２４は、作成した移動経路Ｒと軌跡取得部２３で取得した動作データとを関連付けて記憶部２２に格納する。
【００２４】
例えば、所定の処理として、ワークＷに対して接着剤を塗付又は注入する場合には、ロボットアーム３の先端に取り付けられたノズル（工具）を、ワークＷから所定の距離だけ引き離した距離で倣いながら、そのノズルから接着剤を吐出させる。この場合には、経路作成部２４は、軌跡取得部２３で取得した軌跡を、押付け方向とは反対方向に所定の距離だけオフセットさせることで移動経路Ｒを作成する。
【００２５】
一方、例えば、所定の処理として、ワークＷの表面の接着剤を拭き取る場合には、ロボットアーム３の先端に取り付けられたヘラ（工具）を、ワークＷに押し付けながら倣うことで接着剤を拭き取る。この場合には、経路作成部２４は、軌跡取得部２３で取得した移動軌跡を、押付け方向に所定の距離だけオフセットさせることで移動経路Ｒを作成する。
【００２６】
次に、ロボット１及び制御装置２の動作について、図３，４をも参照して詳しく説明する。
【００２７】
作業者は、ロボットアーム３の先端に処理ツール５として教示用ツールを取り付ける。そして、作業者は、ワークＷの形状に沿って複数の教示点Ｔ１〜Ｔ４を制御装置２に粗く教示する（ステップＳ１０１）。この教示点Ｔ１〜Ｔ４は、作業者が処理ツール５をワークＷの表面上に手動で移動させることで教示してもよいし、作業者がワークＷの表面上における所望の座標を記憶部２２に格納させることで教示してもよい。ワークＷの３ＤＣＡＤモデルを用いてオフラインで教示してもよい。なお、教示点Ｔ１は、処理ツール５が倣う軌跡の開始位置であり、教示点Ｔ４は、処理ツール５が倣う軌跡の停止位置である。また、教示点Ｔ２，Ｔ３は、処理ツール５が倣う軌跡の開始位置と停止位置との間の位置を示す。
【００２８】
教示点Ｔ１〜Ｔ４の教示が終了すると、ロボット制御部２１は、力センサ６から取得した外力Ｆｔが一定値になるように、ロボットアーム３を力制御しながら、処理ツール５が教示点Ｔ１，教示点Ｔ２，教示点Ｔ３，及び教示点Ｔ４の順に倣うように低速で移動させる（ステップＳ１０２）。例えば、ワークＷの表面が三次元形状である場合には、ロボット制御部２１は、押付け方向の一方向で力制御しながら処理ツール５をワークＷの表面を倣わせるように制御する。なお、上記低速とは、上記所定の処理を行う場合における工具の移動速度よりも低い速度である。
【００２９】
軌跡取得部２３は、ステップＳ１０２において、ロボットアーム３に設けられたエンコーダから取得したモータの回転角度に基づいて、処理ツール５の移動経路及びロボットアーム３の動作データを取得する（ステップＳ１０３）。なお、処理ツール５がワークＷの表面上を移動した移動軌跡を作成することは、ワークＷの表面形状を取得することを意味する。
【００３０】
経路作成部２４は、軌跡取得部２３で取得した軌跡を、押付け方向又は押付け方向とは反対方向に所定距離だけオフセットさせることで移動経路Ｒを作成する（ステップＳ１０４）。そして、経路作成部２４は、作成した移動経路Ｒを上記動作データと関連付けて記憶部２２に格納する。これにより、本実施形態では、作業者が正確な移動経路Ｒを作成する必要がなくなり、自動で移動経路Ｒを作成することができる。これにより、ワークＷが三次元形状等の複雑な形状であっても、経路作成部２４は、ワークＷの形状（ワークＷの表面上の軌跡）を正確に取得することができる。そして、経路作成部２４は、取得した形状データに基づいて正確な移動経路Ｒを作成することができる。
【００３１】
移動経路Ｒが作成されると、作業者は、教示用ツールを取り外し、ロボットアーム３の先端に工具を取り付ける。そして、ロボット制御部２１は、記憶部２２に格納された移動経路Ｒを工具が移動するように制御することで、ワークＷに対して所定の処理を行う（ステップＳ１０５）。
【００３２】
このように、本実施形態に係るロボットシステムＡは、ワークＷの表面形状を処理ツール５で倣うことで、ワークＷの表面形状を取得する。そして、ロボットシステムＡは、取得したワークＷの表面形状に基づいて移動経路Ｒを作成する。これにより、ワークＷが固定される位置やワークＷの大きさにズレが生じる場合にも、ワークＷごとに正確な移動経路Ｒを作成することができる。
【００３３】
また、本実施形態に係るロボットシステムＡは、作業者の教示に依らず移動経路Ｒを自動で作成するために、正確な教示が困難な三次元形状等の複雑形状を持つワークＷに対しても、正確な移動経路Ｒを作成することができる。
【００３４】
また、本実施形態に係るロボットシステムＡは、例えば、工具を用いてワークＷに対して所定の処理を行う場合には、工具を移動経路Ｒに沿って一方向に位置制御を行いながら動作させることで高速かつ正確に動作させることができる。例えば、工具を用いて接着剤をワークＷに塗布・注入する場合には、工具をワークＷの表面から所定の距離を浮かせたうえで、工具の移動方向を位置制御で動作させる。これにより、工具とワークＷの表面との距離を一定に保ちながら、接着剤の塗布・注入における品質を安定させることができる。
【００３５】
また、本実施形態に係るロボットシステムＡは、プレイバックモードにおいてワークＷの端部まで十分に上記所定の処理を行う場合には、移動経路Ｒの両端を所定の距離だけ外挿してもよい。これにより、ロボットシステムＡは、例えば、工具によりワークＷの端部にまで十分に接着剤を塗付又は拭き取ることができる。
【００３６】
なお、本発明は上記実施形態に限定されるものではなく、例えば以下のような変形例が考えられる。
（１）上記実施形態では、ロボット制御部２１は、記憶部２２に予め格納されている、ワークＷの３ＤＣＡＤモデルから押付け方向を生成してもよい。
【００３７】
（２）上記実施形態では、ワークＷに接着剤を塗布・注入する工具として、図５に示すような工具をハンド部４でロボットアーム３の先端に取り付けてもよい。例えば、工具は、エアチューブ１１、カートリッジ１２、及びノズル１３を備える。エアチューブ１１は、ディスペンサー（不図示）とカートリッジ１２とを連通させる。カートリッジ１２に充填された接着剤をディスペンサーからエアチューブ１１を介して圧送される圧縮空気によって、ノズル１３から外部に吐出する。
【００３８】
（３）上記実施形態では、ワークＷの表面の接着剤を拭き取る工具として、図６に示すように、弾性を有するヘラ１４をハンド部４でロボットアーム３の先端に取り付けてもよい。これにより、ヘラ１４をワークＷの表面に押し込むことが可能となり、ヘラ１４の浮きを抑え、接着剤を拭い残しを減少させることができる。
【符号の説明】
【００３９】
１  ロボット
２  制御装置
３  ロボットアーム
４  ハンド部
５  処理ツール
６  力センサ
１１  エアチューブ
１２  カートリッジ
１３  ノズル
１４  ヘラ
２１  ロボット制御部
２２  記憶部
２３  軌跡取得部
２４  経路作成部
【図１】
2019202372.tif 000003
【図２】
2019202372.tif 000004
【図３】
2019202372.tif 000005
【図４】
2019202372.tif 000006
【図５】
2019202372.tif 000007
【図６】
2019202372.tif 000008