(57)【要約】【課題】原点復帰時に原点体が損傷するのを解消でき、しかも駆動モーターに過酷な負荷が掛かるのを避けて、常に適正に原点復帰作業を行なうことができるパラレルメカニズムを提供する。【解決手段】複数の駆動アームおよびロッドと、操作ヘッドを備えている回転型のパラレルメカニズムにおいて、駆動アームの外面に基準突起を設け、駆動アームの通常動作範囲の外に臨むベースの外面に、原点復帰操作された駆動アームの基準突起を受け止める原点体を設ける。以て、駆動アームを原点復帰操作して、基準突起が原点体に接当する状態において、駆動モーターの出力トルクが設定値に達したことを制御回路で判定して前記駆動モーターを停止し、同時に駆動モーターからフィードバックされる位置信号に基づき制御回路で原点位置を特定する。【選択図】図１
2009255196.tif 000002
【特許請求の範囲】
【請求項１】
操作ヘッドの作業領域の上方に配置されるベースと、前記ベースに配置される複数個の駆動モーターと、前記駆動モーターで上下に旋回駆動される駆動アームと、前記駆動アームの旋回動作を前記操作ヘッドに伝えるロッドと、前記駆動モーターの作動状態を制御する制御回路を有するパラレルメカニズムであって、
前記駆動アームの外面に基準突起が設けられ、前記駆動アームの通常動作範囲の外に臨む前記ベースの外面に、原点復帰操作された前記駆動アームの前記基準突起を受け止める原点体が設けられており、
前記駆動アームを原点復帰操作して、前記基準突起が前記原点体に接当する状態において、前記駆動モーターの出力トルクが設定値に達したことを前記制御回路で判定して前記駆動モーターを停止し、同時に前記駆動モーターからフィードバックされる位置信号に基づき前記制御回路で原点位置を特定するパラレルメカニズム。
【請求項２】
前記駆動モーターが前記ベースに固定したモーターブラケットで支持されており、
前記駆動アームの基端に設けたアームボスが、前記駆動モーターの出力軸に固定されており、
前記基準突起が前記アームボスの周面に固定され、前記原点体が前記モーターブラケットに固定してある請求項１記載のパラレルメカニズム。
【請求項３】
前記駆動アームが原点復帰前の初期位置に位置していることを示す一対の合マークが、前記モーターブラケットと前記アームボスとに設けてある請求項１または２記載のパラレルメカニズム。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、例えば産業用ロボットとして使用されるパラレルメカニズム、なかでも操作ヘッドが複数対のアームユニットで支持してある回転型のパラレルメカニズムに関する。
【背景技術】
【０００２】
この種のパラレルメカニズムの基本構造は、例えば特許文献１に公知である。そこでは、ベースと、ベースの下面に均等配置される３個のサーボモーターと、サーボモーターで駆動操作される３個のアームユニットと、３個のアームユニットで支持される操作ヘッドなどでパラレルメカニズムを構成している。必要に応じて、ベースと操作ヘッドとの間に伸縮しながら回転動力を伝動するボールスプライン軸が付加される。操作ヘッドの下面側には、処理対象を捕捉するハンドなどが設けてあり、操作ヘッドの動作空間の上方に先のベースフレームが配置してある。
【０００３】
各アームユニットは、サーボモーターで上下に旋回駆動される駆動アームと、駆動アームの旋回動作を操作ヘッドに伝えるロッドで構成してあり、ロッドは駆動アームおよび操作ヘッドに対してボール継手で連結してある。ボールスプライン軸は、伸縮自在に連結される駆動軸と受動軸とからなり、上下両端がユニバーサルジョイントを介して連結してある。各駆動アームの駆動方向と駆動量を変更することにより、操作ヘッドを所定の３次元空間内で自由に変位できる。この種のパラレルメカニズムは特許文献２にも見ることができる。
【０００４】
【特許文献１】特開２００１−２７７１６４号公報（段落番号０００６〜７、図１）
【特許文献２】特表２００５−５２８９９３号公報（段落番号００１９、図１）
【発明の開示】
【発明が解決しようとする課題】
【０００５】
この種のパラレルメカニズムにおいては、作業時間の経過や、メンテナンス時の駆動モーターや減速機の交換に伴なって、駆動モーターの旋回位置にずれを生じ、このずれによって誤差が生じる。このような誤差を修正するために原点復帰作業を行なう必要がある。制御盤の電源を再投入するなど、駆動モーターの位置情報が消失した場合にも、同様に原点復帰作業を行なう必要がある。原点復帰を行なう際には、駆動アームの通常動作範囲の外に原点ピンを設けておき、駆動アームに設けた基準ピンを原点ピンに接当させて原点復帰を行なうが、次のような問題を生じる。
【０００６】
駆動アームを旋回駆動する駆動モーター（サーボモーター）には減速比の大きな減速機が組み込まれており、そのため駆動アームを原点位置へ旋回移動させて基準ピンを原点ピンに接当させたとき、原点ピンに過大な力が掛かる。例えば、駆動モーターの減速機の出力トルクが３００Ｎｍであり、基準ピンのモーメントアームが８０ｍｍであるときには、原点ピンに３７５０Ｎもの大きな力が作用する。こうした場合には駆動モーターは過負荷状態に陥り、過負荷を検知した時点で自動停止するが、自動停止するまでの間に原点ピンの全体が変形し、あるいは原点ピンの一部が破損するため、原点復帰を適正に行なえない。
【０００７】
原点ピンや基準ピンの機械的な強度を向上して、先のようなピンの損傷を避けることは不可能ではない。しかし、その場合には、高価な駆動モーターに過酷な負荷を繰り返し掛けることとなり、駆動モーターの耐久性が損なわれる。さらに、原点ピンや基準ピンを強化する場合には、各ピンが装着される構造体の機械的強度をも同時に強化する必要があり、パラレルメカニズムの全体コストや重量が嵩む。
【０００８】
本発明の目的は、原点復帰時の駆動モーターの駆動状態を制御回路で好適化して、原点体が損傷するのを解消でき、しかも駆動モーターに過酷な負荷が掛かるのを避けて、常に適正に原点復帰作業を行なうことができるパラレルメカニズムを提供することにある。
【課題を解決するための手段】
【０００９】
本発明のパラレルメカニズムは、操作ヘッドの作業領域の上方に配置されるベースと、ベースに配置される複数個の駆動モーターと、駆動モーターで上下に旋回駆動される駆動アームと、駆動アームの旋回動作を操作ヘッドに伝えるロッドと、駆動モーターの作動状態を制御する制御回路を有する。駆動アームの外面には基準突起を設け、駆動アームの通常動作範囲の外に臨むベースの外面に、原点復帰操作された駆動アームの基準突起を受け止める原点体を設ける。以て、駆動アームを原点復帰操作して、基準突起が原点体に接当する状態において、駆動モーターの出力トルクが設定値に達したことを制御回路で判定して前記駆動モーターを停止し、同時に駆動モーターからフィードバックされる位置信号に基づき制御回路で原点位置を特定する。
【００１０】
駆動モーターはベースに固定したモーターブラケットで支持する。駆動アームの基端に設けたアームボスは、駆動モーターの出力軸に固定する。基準突起はアームボスの周面に固定し、原点体はモーターブラケットに固定する。
【００１１】
駆動アームが原点復帰前の初期位置に位置していることを示す一対の合マークを、モーターブラケットとアームボスとに設ける。
【発明の効果】
【００１２】
本発明のパラレルメカニズムでは、駆動アームを原点復帰操作して、基準突起が原点体に接当する状態において、駆動モーターの出力トルクが設定値に達したことを制御回路で判定して前記駆動モーターを停止する。このように、原点復帰時の駆動モーターの出力トルクを制御回路で設定値以下に制限すると、原点体や基準突起に過剰な力が作用するを防止でき、したがって原点体や基準突起が損傷するのを確実に解消して、原点復帰作業を適正に行なえる。また、駆動モーターの出力トルクを設定値以下に制限することにより、駆動モーターに過酷な負荷が掛かるのを避けて、駆動モーターを長期にわたって良好な状態に維持し続けることができる。
【００１３】
基準突起を駆動アームの基端のアームボスの周面に固定し、原点体を駆動モーターのモーターブラケットに固定すると、より厳密に駆動アームを原点復帰させることができる。それは、厳密に位置決めされたモーターブラケットおよびアームボスに原点体および基準突起を固定することにより、原点体と基準突起の相対的な位置関係を高精度化できるからである。
【００１４】
一対の合マークを、モーターブラケットとアームボスとに設けるパラレルメカニズムによれば、各駆動アームを変位させて一対の合マークを合致させるだけで、操作ヘッドをベースから充分に離れた適正な初期位置に位置させることができる。したがって、個々の駆動アームを通常使用範囲を越えて原点復帰操作する際に、受動スプライン軸の上端がユニバーサルジョイントに接当干渉したり、ロッドのばねユニットと駆動アームとが接当干渉するのを確実に防止できる。これにより、駆動アームの原点復帰作業を誰もが常に適正に行なえることとなる。
【発明を実施するための最良の形態】
【００１５】
（実施例）  図１から図６は本発明に係るパラレルメカニズムを搬送ロボットに適用した実施例を示す。図２および図３に示すように、パラレルメカニズムは、テーブルやコンベアーを跨ぐ状態で設置される高剛性の架台１を基体にして構成する。詳しくは、架台１の上壁に固定されるベース２と、ベース２の下面に配置される３個の駆動モーター３と、駆動モーター３で駆動される３個のアームユニット４と、各アームユニット４で支持される操作ヘッド５と、中央部に配置される駆動軸６などで構成する。ベース２は、操作ヘッド５の動作空間の上方に位置することになり、その上面には、駆動軸６を回転駆動するモーター７が設けてある。
【００１６】
ベース２の下面には３個のモーターブラケット１０が均等な間隔をあけて設けてあり、これらのモーターブラケット１０に駆動モーター３が組み付けてある。駆動モーター３はサーボモータと減速機とを一体に備えており、減速機で減速された往復旋回動力を出力する。さらにサーボモータに内蔵された回転エンコーダーによって、フィードバック信号を制御回路１１へ出力する。駆動モーター３は、制御回路１１からの指令信号によってその駆動方向と駆動量および駆動速度が制御される。３個の駆動モーター３は、その中心軸線が正三角形の各辺を構成する状態でベース２に配置してあり、先の正三角形の中心は駆動軸６の軸中心位置に一致させてある。
【００１７】
アームユニット４は、駆動モーター３で上下に旋回駆動される駆動アーム１４と、駆動アーム１４の旋回動作を操作ヘッド５に伝えるロッド１５とで構成してある。駆動アーム１４の基端にはアームボス１６が固定してあり、このアームボス１６が駆動モーター３の出力軸に固定してある。図３に示すようにロッド１５は、平行に配置される一対のリンク棒１７と、リンク棒１７の上下端寄りに設けられて、両リンク棒１７を引き寄せ付勢するばねユニット１８とで構成してある。駆動アーム１４および操作ヘッド５とロッド１５とは、それぞれボール継手１９で連結してある。このように、ボール継手１９を介して連結されたアームユニット４によれば、駆動アーム１４を駆動モーター３で上下に往復旋回操作することにより、操作ヘッド５を所定の３次元空間内で自由に変位できる。操作ヘッド５が３次元変位できる空間のうち、基準平面上の直径１０４０ｍｍ、高さ２００ｍｍの作動範囲が操作ヘッド５の作業領域となる。なお、対向するボール継手１９のボール中心どうしを結ぶ線は、先の駆動モーター３の中心軸線と平行になっている。
【００１８】
操作ヘッド５は、三角形状の板状ブロックからなり、その中央部分に駆動軸６の回転動力を受け継ぐ操作軸２１が回転自在に軸支してある。駆動軸６は、上半側の駆動スプライン軸２２と、下半側の受動スプライン軸２３とを備えたボールスプライン軸からなる。両スプライン軸２２・２３の上下端は、それぞれユニバーサルジョイント２４を介して、モーター７の出力軸、および先の操作軸２１に連結してある。操作軸２１の下端のフランジ部分に、搬送対象を捕捉する捕捉体（図示していない）が装着される。
【００１９】
上記構成のパラレルメカニズムの原点復帰を行なうために、駆動アーム１４の外面に丸軸状の基準ピン（基準突起）２６を設けている。さらに、駆動アーム１４の通常動作範囲の外に臨むベース２の外面に、原点復帰操作された駆動アーム１４の基準ピン２６を受け止める丸軸状の原点ピン（原点体）２７を設けている。詳しくは、図１に示すようにアームボス１６の周面に、基準ピン２６をピン軸心が放射方向に沿う状態で固定し、モーターブラケット１０の側端面に、原点ピン２７をピン軸心が駆動モーター３の中心軸線と平行になる状態で固定している。図４に示すように原点ピン２７は、その基端部に研削仕上げされた軸基部２８を備えており、軸基部２８に連続するねじ軸にナット２９をねじ込むことにより、モーターブラケット１０に締結固定される。
【００２０】
このように、原点ピン２７を基準ピン２６の旋回軌跡と交差する状態で配置することにより、駆動アーム１４を原点位置へ復帰操作したとき、基準ピン２６を原点ピン２７で受け止めて、それ以上駆動アーム１４が旋回移動するのを阻止して原点位置を特定できる。なお、先に説明した駆動アーム１４の通常動作範囲とは、操作ヘッド５が規定された作業領域を変位するときの駆動アーム１４の動作範囲を意味している。この実施例では、駆動アーム１４が通常動作範囲を越えて上方へ旋回移動する側に原点ピン２７を設けるようにした。
【００２１】
以上のように構成したパラレルメカニズムは、後述する要領で原点復帰作業を行なうが、原点復帰を行なう直前の操作ヘッド５の位置が不適切であると、原点復帰作業を行なうことで機械的な干渉を起こすおそれがある。例えば、操作ヘッド５が規定された作業領域から上方へ遠く離れた位置にある状態で原点復帰作業を行なうと、例えば受動スプライン軸２２の上端がユニバーサルジョイント２４に干渉してしまう。こうした不具合を防ぐために、駆動アーム１４のすべてを初期位置に変位操作してから、原点復帰作業を行なう。また、駆動アーム１４を初期位置へ確実に変位操作するために、一対の合マーク３０・３１をモーターブラケット１０の側端面と、アームボス１６の側端面とに設けている。
【００２２】
合マーク３０・３１はラベルを貼り付けて形成でき、あるいは刻印部分に塗料を塗布して形成できる。３個の駆動アーム１４を個別に作動させて、全ての駆動アーム１４の合マーク３１をモーターブラケット１０に設けた合マーク３０に一致させた状態では、操作ヘッド５をベース２から充分に離れた位置に位置させることができる。多くの場合は、操作ヘッド５が規定された作業領域の範囲内に位置する状態を初期位置とする。
【００２３】
原点復帰作業は、以下の手順に従って行なう。まず、先に説明した要領で駆動アーム１４のすべてを原点復帰前の初期位置に変位操作する（第１過程）。次に図１および図４に示すように、駆動アーム１４の任意のひとつを初期位置から原点復帰操作して、基準ピン２６を原点ピン２７に接当させる。この状態で、駆動モーター３からフィードバックされる位置信号を制御回路１１で受け取って駆動アーム１４の原点位置を特定する（第２過程）。この後、原点復帰操作された駆動アーム１４を初期位置へ戻す（第３過程）。ふたつめの駆動アーム１４について、上記の第２過程と前記第３過程を行なって、ふたつめの駆動アーム１４の原点位置を特定する。残る駆動アーム１４について、第２過程と前記第３過程を行なって、最後の駆動アーム１４の原点位置を特定する。以上の手順を図５にまとめて表示しており、一連の手順を全ての駆動アーム１４について行なうことにより、パラレルメカニズムの原点復帰作業を完了できる。
【００２４】
基準ピン２６を原点ピン２７に接当する第２過程において、原点ピン２７が損傷し、あるいは駆動モーター３に過酷な負荷が掛かるのを避けるために、駆動モーター３の駆動状態を制御回路１１で次のように制御する。駆動アーム１４を原点復帰操作して基準ピン２６が原点ピン２７に接当する状態において、図６に示すように、駆動モーター３の出力トルクが原点復帰操作中の状態（Ｔ１の状態）から、設定値に達した（Ｔ２の状態）ことを制御回路１１で判定して駆動モーター３を停止する。同時に駆動モーター３からフィードバックされる位置信号に基づき制御回路１１で原点位置を特定する。この後、原点復帰操作された駆動アーム１４を初期位置へ戻す。駆動モーター３の出力トルクとは、減速機の出力軸部分での出力トルクを意味する。また、前記設定値は、例えば駆動モーター３の定格トルクを１００％とするとき、出力トルクが１５％に達した状態とする。
【００２５】
以上のように、基準ピン２６を原点ピン２７で受け止めた状態において、駆動モーター３の出力トルクが設定値に達した状態で駆動モーター３を停止すると、基準ピン２６および原点ピン２７に過剰な力が作用するのを防止できる。したがって、原点復帰時に原点ピン２７が損傷するのを解消でき、しかも駆動モーター３に過酷な負荷が掛かるのを避けて常に適正に原点復帰作業を行なうことができることとなる。
【００２６】
上記の実施例では、駆動モーター３の出力トルクが定格トルクの１５％に達した時点を閾値としたが、その必要はない。要は、基準ピン２６および原点ピン２７の機械的な強度との関係で、両ピン２６・２７が塑性変形せず、弾性変形の範囲内でその変形量が極力小さいことと、駆動モーター３に過負荷が作用しないことを満たす値であれば、先の閾値は一定の範囲内で選択することができる。
【００２７】
上記の実施例以外に、基準ピン２６はアームボス１６に設ける必要はなく、駆動アーム１４の任意位置に設けることができる。同様に、原点ピン２７は駆動アーム１４の旋回軌跡に臨むベース２の外面に設けることができる。原点体２７は、ピンや軸などの突起である必要はなく、駆動アーム１４の外面を直接受け止める凹部や切欠であってもよい。その場合の基準突起２６は駆動アーム１４が兼ねることになる。駆動モーター３、および駆動アーム１４の配置個数は３個以上であってもよい。パラレルメカニズムは、駆動軸６を省略した状態で使用することができる。操作ヘッド５を初期位置に位置させる手段としては、操作ヘッド５を水平姿勢でテーブルやコンベア上に直接押し当て、あるいはこれらの上面に載置した治具に操作ヘッド５を押し当てた状態を初期位置とすることができる。
【図面の簡単な説明】
【００２８】
【図１】原点復帰時のパラレルメカニズムの正面図である。
【図２】駆動アームを原点復帰前の初期位置に作動させた状態の正面図である。
【図３】パラレルメカニズムの平面図である。
【図４】図１におけるＡ−Ａ線断面図である。
【図５】原点復帰作業の手順を示すフローチャートである。
【図６】原点復帰時の駆動モーターの出力トルクの変動を示す図表である。
【符号の説明】
【００２９】
２  ベース
３  駆動モーター
５  操作ヘッド
１０  モーターブラケット
１１  制御回路
１４  駆動アーム
１５  ロッド
１６  アームボス
２６  基準突起（基準ピン）
２７  原点体（原点ピン）
３０・３１  合マーク
【図１】
2009255196.tif 000003
【図２】
2009255196.tif 000004
【図３】
2009255196.tif 000005
【図４】
2009255196.tif 000006
【図５】
2009255196.tif 000007
【図６】
2009255196.tif 000008