移送ロボットの制御方法
【課題】本発明は、比較的小さな設置面積に配置でき、上下への昇降範囲が広くできるとともに、安全にワークを移送することが可能な移送ロボットを提供する。
【解決手段】搬送物を載置するハンド部１４と、前記ハンド部１４を一方向に移動させる水平アーム機構３０と、前記水平アーム機構３０を上下に移動する昇降機構２０を備えた移送ロボットにおいて、前記昇降機構２０が、ベース部材２に備えられた少なくとも２組のリンク機構から構成され、２組のリンク機構の第２関節部６が互いに内側になるように動作させながら、ハンド部１４のローリング方向、横ずれ動作、ヨーイング方向の動作を行なう。
【解決手段】搬送物を載置するハンド部１４と、前記ハンド部１４を一方向に移動させる水平アーム機構３０と、前記水平アーム機構３０を上下に移動する昇降機構２０を備えた移送ロボットにおいて、前記昇降機構２０が、ベース部材２に備えられた少なくとも２組のリンク機構から構成され、２組のリンク機構の第２関節部６が互いに内側になるように動作させながら、ハンド部１４のローリング方向、横ずれ動作、ヨーイング方向の動作を行なう。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、液晶用のガラス基板や半導体ウェハ等の薄板状のワークをストッカに出し入れする移送ロボットおよびその移送方法と制御方法に関する。
【背景技術】
【０００２】
従来の移送ロボットとしては、脚部を屈曲伸縮させて上下動し、上部に配置されたアームによりワークを移送するものが提案されている（例えば、特許文献１〜３参照）。
従来の第１の移送ロボットは、図７に示すようにハンド部材１８０を紙面と直交する水平方向（Ｘ方向：同図中に符号不記入）に移動自在とするハンド部材動作機構１０８と、このハンド部材動作機構１０８の全体を移動させるためのリンク機構１０９とを有している。リンク機構１０９は、ベース部材１９０に一端部が連結部１９３ａを介して回転自在に連結された第１のアーム１９１と、この第１のアーム１９１の他端部に連結部１９３ｂを介して連結された第２のアーム１９２とを具備しており、かつこの第２のアーム１９２の他端部には、ハンド部材動作機構１０８のベース部１８１が連結部１９３ｃを介して回転可能に連結された構造を有している。
しかしながら、従来の第１の移送ロボットでは、できる限り広い領域においてハンド部材移動可能とし、かつハンド部材を水平および垂直方向に直線的に移動できるようにすることが要請される場合が多いが、第１および第２のアーム１９１，１９２を回転させることによってワークをＹ方向 （図７の紙面に直交する方向）およびＺ方向に直線的に移動
させ得る範囲が比較的狭くなっていた。
これを解決するために、第２の従来例が発案されている。図８を用いて第２の従来例について説明する。第２の従来例は、ベース部材１と、リンク機構２と、２つのハンド部材２３０（２３０Ａ，２３０Ｂ）を有するハンド部材動作機構２０３とを具備して構成されている。ベース部材２０１は、一定の高さを有するボックス状に形成されており、たとえばフロアに固定して設けられている。ただし、後述するように、このベース部材２０１をＹ方向に移動自在に設けることもできる。りンク機構２０２は、第１および第２のアーム２２１，２２２と、中間アーム２２３と、第１ないし第４の連結部２２４ａ〜２２４ｄとを具備して構成されている。第１ないし第４の連結部２２４ａ〜２２４ｄのそれぞれの軸心Ｃ１〜Ｃ４は、いずれもＸ方向に延びている。第１のアーム２１の一端部は、第１の連結部２２４ａを介してベース部材１の一側面の上部に連結されており、軸心Ｃ１周りに回転自在である。軸心Ｃ１から第１のアーム２２１の他端部先端までの長さＬａは、フロアから軸心Ｃ１までの高さＨａよりも短い寸法とされている。このことにより、第１のアーム２２１は軸心Ｃ１の全周囲にわたって回転自在となっている。中間アーム２２３は、たとえば第１のアーム２２１と略同一長さである。この中間アーム２２３は、その一端部が第３の連結部２２４ｃを介して第１のアーム２２１の他端部に連結されていることにより、第１のアーム２２１に対して軸心Ｃ３周りに相対回転自在である。第２のアーム２２２は、たとえば第１のアーム２２１や中間アーム２２３よりも短くされており、その一端部が第４の連結部２２４ｄを介して中間アーム２２３の他端部に連結されていることにより、中間アーム２２３に対して軸心Ｃ４周りに相対回転自在である。第２のアーム２２２の他端部は、ハンド部材動作機構２０３のベース部２３１に第２の連結部２２４ｂを介して連結されている。このため、ハンド部材動作機構２０３は、第２のアーム２２２に対して軸心Ｃ２周りに相対回転自在となっている。
また、第３の従来例について図９を用いて説明する。第３の従来例は、昇降装置３１０は、複数のポスト３２１，３２２を有するベースユニット３１２と、ワークを支持するワーク支持ユニット３１３と、一端がベースユニット３１２のポスト３２１，３２２に連結されかつ他端がワーク支持ユニット３１３に連結される屈伸型の複数のアームユニット３４１，３４２，３４３，３４４を有する昇降機構３１４とを備える。ワーク上昇時に、ワ
ーク支持ユニット３１３が複数のポスト３２１，３２２よりも高い位置に配され、ワーク下降時に、ワーク支持ユニット１３の少なくとも一部が複数のポスト３２１，３２２の間に配される。
【先行技術文献】
【特許文献】
【０００３】
【特許文献１】特開平１１−２３８７７９号公報（第４頁、図２）
【特許文献２】特開２００２−２１０６８４号公報（第６頁、図２）
【特許文献３】特開２００６−１７６２７６号公報（第４頁、図１）
【発明の概要】
【発明が解決しようとする課題】
【０００４】
保管するストッカには天井に届くほどの高さから床面近くまでに液晶用のガラス基板や半導体ウェハ等の薄板状のワークが一定の間隔を持って積み重ねられ保管されている。このようなストッカが移送ロボットの前後または左右に配置されている。これに対応するために移送ロボットは、大型化するとともに長ストロークの昇降機構と旋回機構を備える必要がある。このように構成されたストッカおよび移送ロボットは、相対的にワークの取り出し方向に対してローリング方向に傾いて取り付けられるケースが、大型化することで増えてきている。そうすると、ワークを移送ロボットのハンドで受け取るときにストッカに対して傾いた状態になるためにワークを受け取った際にワークが位置ずれを起こし、搬送先で所定の位置に配置できないなどの問題が生じるために、ローリング方向の補正機能が必要とされてきている。また、ストッカ内のワークの配置についても、ワークは正確な位置にあるとは限らない。たとえば、ワークの取り出し方向に対してヨーイング方向に傾いていたり、横方向にスライドしたりしている場合がある。搬送先で所定の位置に配置するために補正する機能が必要とされてきている。これまでは、これら補正をするために、別途補正機構を備えていたが、装置が複雑化することや設置面積が大きくなるといった問題が生じていた。
また、保管されるワークも大型化されることで重量が重くなり、これを移送する移送ロボットは剛性を高める必要があるとともに、万が一、昇降機構が故障した際にワークが落下して損傷することを防止する安全策を備えることが要求されてきている。また、年々、基板の生産数は増えるためにスループットを速くすることが、基板が大型化しても要求されている。
さらに、このようなワークを移送するシステムの環境は周囲のクリーン度を保つ設備を必要としており、大型化する移送ロボットについてもフットプリントを小さくすることが要求されている。
しかしながら、従来の第１の移送ロボットは、第１および第２のアームを回転させることによってワークを水平方向および垂直方向に直線的に移動させ得るが、垂直方向に関して、ベース部材と干渉するためにベース部材より下面には物理的に下降することができないために昇降範囲が狭くなっていた。また、ストッカ内のワークの位置ずれを補正する手段がないために補正できない問題が生じていた。このような補正する機構を備えると構造が大きくなったり、複雑になるといった問題が生じることになり、適用が困難となっていた。
また、従来の第２の移送ロボットでは、３リンク構成にすることにより可動範囲を広くすることができるようになったが、リンクを駆動する駆動機構が故障した場合、ワークの落下を防止する機構を備えていないので、高価なワークを損傷する問題が生じしていた。また、水平方向に垂直方向の位置を維持したまま移動することができることにより、ストッカ内のワークの横ずれを補正することはできるかもしれないが、補正するのに必要なセンサを備えていないために補正することができない。その他のローリング方向やヨーインク方向の補正することができないために所定の位置に搬送することができないといった問題が生じていた。
また、従来の第３の移送ロボットでは、４本のリンク機構によりワーク搬送部を支持して昇降することから、何れか１本のリンク機構の駆動機構に故障が生じても、ワークを落下させることなく、安全な位置へワークを移送することができる可能性がある。しかしな
がら、従来の第３の移送ロボットは、リンク機構が外向きに屈曲するために下降位置では大きな設置面を必要とすることになり、フットプリントが小さくならないといった問題が生じていた。また、ワークの取り出し方向に対してピッチング方向に傾かせることができるもののローリング方向、ヨーイング方向や横ずれを補正する機構が備えられていないために所定の位置への位置決めができないといった問題が生じていた。
本発明はこのような問題点に鑑みてなされたものであり、比較的小さな設置面積に配置でき、上下への昇降範囲が広くできるとともに、安全にワークを移送でき、移送する際に所定の位置へ位置決め可能なように傾き補正が可能な移送ロボットを提供することを目的とする。
【課題を解決するための手段】
【０００５】
上記問題を解決するため、本発明は、次のように構成したものである。
請求項１に記載の発明は、搬送物を載置するハンド部と、前記ハンド部を回動可能に支持する第２アームと、前記第２アームを回転可能に支持する第１アームと、を少なくとも備え、前記ハンド部が一方向に移動するように前記アームが回転する水平アーム機構と、
ベースの片側に片側第１関節部で回動可能に支持された片側第１脚部と、前記片側第１脚部に片側第２関節部で回動可能に支持され前記水平アーム機構を支持する片側第２脚部と、を備えた第１リンク機構と、前記ベースの他方側に他方側第１関節部で回動可能に支持された他方側第１脚部と、前記他方側第１脚部に他方側第２関節部で回動可能に支持され前記水平アーム機構を支持する他方側第２脚部と、を備えた第２リンク機構と、を備え、前記片側第１関節部と前記他方側第１関節部と前記片側第２関節部と前記他方側第２関節部のそれぞれの回転軸の方向と前記ハンド部の移動方向とが平行になるよう配置され、 前記ハンド部の移動方向から見て、前記片側第２関節部と前記他方側第２関節部が前記第１リンク機構と前記第２リンク機構の内側に互いに張り出すように前記片側第１脚部と前記他方側第１脚部が互いに逆方向に回転しながら、前記ハンド部を前記片側第１関節部と前記他方側第１関節部との間で上下に移動させうる昇降機構と、を備えた移送ロボットの制御方法であって、前記ハンド部の移動方向のローリング方向の傾きを変えるように、あるいは、前記ハンド部が水平状態を維持したまま前記ハンド部の移動方向に対して横ずれ動作するように、前記片側第１脚部と前記他方側第１脚部を前記片側第１関節部と前記他方側第１関節部においてそれぞれ互いに異なる角度量を回転させ、前記片側第２脚部と前記他方側第２脚部を前記片側第２関節部と前記他方側第２関節部においてそれぞれ互いに異なる角度量を回転させること、を特徴とするものである。
請求項２に記載の発明は、搬送物を載置するハンド部と、前記ハンド部を回動可能に支持する第２アームと、前記第２アームを回転可能に支持する第１アームと、を少なくとも備え、前記ハンド部が一方向に移動するように前記アームが回転する水平アーム機構と、 ベースの片側に片側第１関節部で回動可能に支持された片側第１脚部と、前記片側第１脚部に片側第２関節部で回動可能に支持され前記水平アーム機構を支持する片側第２脚部と、を備えた第１リンク機構と、前記ベースの他方側に他方側第１関節部で回動可能に支持された他方側第１脚部と、前記他方側第１脚部に他方側第２関節部で回動可能に支持され前記水平アーム機構を支持する他方側第２脚部と、を備えた第２リンク機構と、を備え、前記片側第１関節部と前記他方側第１関節部と前記片側第２関節部と前記他方側第２関節部のそれぞれの回転軸の方向と前記ハンド部の移動方向とが平行になるよう配置され、 前記ハンド部の移動方向から見て、前記片側第２関節部と前記他方側第２関節部が前記第１リンク機構と前記第２リンク機構の内側に互いに張り出すように前記片側第１脚部と前記他方側第１脚部が互いに逆方向に回転しながら、前記ハンド部を前記片側第１関節部と前記他方側第１関節部との間で上下に移動させうる昇降機構と、前記ベースを鉛直軸回りに旋回させる旋回機構と、を備えた移送ロボットの制御方法であって、前記ハンド部の移動方向のヨーイング方向の方向を変えるように前記旋回機構によって前記ベースを旋回させること、を特徴とする移送ロボットの制御方法を特徴とするものである。
請求項３に記載の発明は、前記ハンド部の前記ローリング方向の傾きの変更を、前記ハンド部の移動方向に対する前記搬送物の載置場所の傾きに応じて行なうこと、を特徴とするものである。
請求項４に記載の発明は、前記ハンド部の前記横ずれ動作を、前記ハンド部の移動方向に対する前記搬送物の載置場所の横ずれ量に応じて行なうこと、を特徴とするものである。
請求項５に記載の発明は、前記ハンド部の前記ヨーイング方向の方向の変更を、前記ハンド部の移動方向に対する前記搬送物の載置場所の方向のずれ量に応じて行なうこと、を特徴とするものである。
請求項６に記載の発明は、前記水平アーム機構が、前記第１アームを回動可能に支持するとともに前記片側第２脚部と前記他方側第２脚部とに回動可能に支持される支持ベースと、前記支持ベースに設けられた第１のセンサと、を備え、前記ハンド部が前記支持ベースの上側に引き込まれたときに前記第１のセンサによって前記搬送物の前記ハンド部の移動方向に対する横ずれ量を検出し、前記検出した搬送物の横ずれ量に応じて前記ハンド部の前記横ずれ動作を行なうこと、を特徴とするものである。
請求項７に記載の発明は、前記ハンド部に第２のセンサを設け、前記第２のセンサによって前記ハンド部に載置された前記搬送物の前記ハンド部に対する角度ずれを検出し、 前記搬送物の前記ハンド部に対する角度ずれに応じて前記ハンド部の前記ヨーイング方向の方向の変更を行なうこと、を特徴とするものである。
【発明の効果】
【０００６】
本発明によると、昇降機構が少なくとも２つのリンク機構から構成され、リンク機構が脚部支持部材の内側を旋回することで水平アーム機構を昇降させ、水平アーム機構が最下降位置に位置した際には脚部支持部材の内側に配置されるように構成されたことで、昇降範囲を広くすることができる。また、少なくとも２つのリンク機構から構成されていることで、万が一、１つのリンク機構が故障して駆動力が発生できなくなったとしても、他方のリンク機構により駆動力を得ることができることから水平アーム機構が落下することを防止し、ワークの損傷を防止する２重化した安全機構を提供している。さらに、水平アーム機構が脚部支持部材の内側に配置され、リンク機構も脚部支持部材よりも外側に大きく飛び出さないような位置に旋回して水平アーム機構が最下降位置に位置するように形成されるので、リンク機構が外側に飛び出るような屈曲構造ではないので、比較的小さな設置面積に配置することが可能であり、フットプリントを小さくすることができる。
また、本発明によると、ハンド移動方向に関して同軸上に第１水平関節を配置し、一方向に伸縮するアームによりハンドを移動させることにより、ストッカからのワークの出し入れが、２つのハンドを用いることにより高速化することができる。すなわちスループットを向上することができる。
また、本発明によると、２組のリンク機構からなる昇降機構に備えられた少なくとも２つの回転関節を備えることにより、水平アーム機構をハンドの移動方向に関してローリング方向および左右方向の何れか一つの方向に移動できることから、移送ロボットとストッカの相対的な位置ずれを移送ロボットの動作により補正できるので、従来あったロボットのように補正機構を必要とせずに済み、装置を複雑化することなく、設置面積が小さいまま補正することが可能となる。
また、本発明によると、２組のリンク機構からなる昇降機構に備えられた少なくとも２つの回転関節を備えるとともに、移送ロボットの旋回軸を利用して、水平アーム機構をハンドの移動方向に関してローリング方向、ヨーング方向および左右方向の搬送物がハンドに載置された際の搬送物の位置ずれを補正することができるので、ストッカ内の搬送物の配置に関わらず、搬送物を所定の位置で搬送先に移送することができる。
【図面の簡単な説明】
【０００７】
【図１】本発明の実施例を示す移送ロボットの斜視図
【図２】本発明の実施例の水平アーム機構が最上昇位置へ移動した場合を示す斜視図
【図３】本発明の実施例の水平アーム機構が最下降位置へ移動した場合を示す斜視図
【図４】本発明のローリングずれを補正する昇降機構の動作を示す模式図
【図５】本発明の横ずれを補正する昇降機構の動作を示す模式図
【図６】ハンド上のワークのずれを補正するフローチャート
【図７】第１の従来の移送ロボットを示す正面図
【図８】第２の従来の移送ロボットを示す正面図
【図９】第３の従来の移送ロボットを示す正面図
【発明を実施するための形態】
【０００８】
以下、本発明の実施の形態について図を参照して説明する。
【実施例１】
【０００９】
図１は、本発明の移送ロボットの斜視図である。
本発明の移送ロボットは、図示しないストッカに配置されたワークを取り出し、作業エ
リアへ移送するために、旋回機構１７、昇降機構２０および水平アーム機構３０から構成されている。
本発明が特許文献１から３と異なる部分は、旋回機能を有し、昇降機構がダブルレッグ機構からなりハンド部が昇降機構の間に下降する部分である。
旋回機構１７は、台座１に取り付けられたベース２の略中心に旋回軸が配置されるように設置されている。また、ベース２の両端には脚部支持部材３ａ、３ｂが設置されている。
【００１０】
昇降機構２０は、脚部支持部材３ａ、３ｂに備えられた不図示の駆動部が第１関節部４ａ、４ｂに備えられ、第１脚部５ａ、５ｂの一端が連結され、第１脚部５ａ、５ｂの他端は不図示の駆動部が備えられた第２関節部６ａ、６ｂで第２脚部７ａ、７ｂの一端と連結される。第２脚部７ａ、７ｂの他端は、支持ベース８に回動可能に連結されている。第１脚部５ａ、５ｂは、水平アーム機構３０の最下降位置への移動をより低くできるように脚部支持部材３ａ、３ｂよりも長く形成されている。第２脚部７ａ、７ｂの長さは、水平アーム機構３０が最下降位置へ移動した際に、第１脚部５ａ、５ｂの側面が脚部支持部材３ａ、３ｂの側面から大きく飛び出さないように決められており、第１脚部５ａ、５ｂの長さよりも短い長さで形成されている。
【００１１】
次に、水平アーム機構３０について説明する。水平アーム機構３０は、２つのハンド１４ａ、１４ｂを不図示のワークをストッカから出し入れするように移動させるダブルリンク機構から構成されている。支持ベース８に備えられた不図示の駆動機構を備えた第１水平関節部９ａで第１アーム１０ａの一端と連結され、第１アーム１０ａの他端は、第２水平関節部１１ａで第２アーム１２ａの一端と連結される。第２アーム１２ａの他端は、第３水平関節部１３ａで第１ハンド１４ａと連結されている。
また、支持ベース８には、支持部材１６を備えた支柱１５が取り付けられており、支持部材に備えられた不図示の駆動機構を備えた第１水平関節部９ｂで第１アーム１０ｂの一端と連結され、第１アーム１０ｂの他端は、第２水平関節部１１ｂで第２アーム１２ｂの一端と連結される。第２アーム１２ｂの他端は、第３水平関節部１３ｂで第１ハンド１４ｂと連結されている。第１アーム１０ａ、１０ｂと第２アーム１２ａ、１２ｂは互いに対向し、対面構造を形成している。また、第１水平関節部９ａ、９ｂは、本実施例では同軸上に配置されている。しかしながら、ハンド１４ａ、１４ｂの移動方向に関して互いにオフセットした構成としても第１アーム１０ａ、１０ｂと第２アーム１２ａ、１２ｂのアーム長を変更することで本実施例と同じ動作が可能である。また、第１水平関節部９ａ、９ｂは、第３水平関節部１３ａ、１３ｂは、ハンド１４ａ、１４ｂの移動方向に関して同軸上に配置されている。
また、第１水平関節部９ａ、９ｂの回転軸は、本実施例では旋回機構１７の旋回軸よりも前方にオフセットしており、旋回機構１７との干渉しないように配置されている。しかしながら、ハンド１４ａ、１４ｂの移動方向に関して前後にオフセットした構成としても第１アーム１０ａ、１０ｂと第２アーム１２ａ、１２ｂのアーム長を変更することで本実施例と同じ動作が可能である。
【００１２】
次に、動作について説明する。はじめに昇降機構の動作について図２および３を用いて説明する。図２は昇降機構２０が最上昇位置に移動した場合であり、図３は昇降機構２０が最下降位置に移動した場合を示している。一方の昇降機構について説明し、他方の動作は面対称であるので説明を省略する。
図１および図２を用いて最上昇位置へ移動する場合について説明する。第１関節部４ａおよび第２関節部６ａの不図示のモータ等からなる駆動機構が駆動され、ハンド１４ａの移動方向正面から見て第１脚部５ａは反時計回りに第１関節部４ａを中心に旋回し、第２脚部７ａは時計回りに第２関節部６ａを中心に旋回して水平アーム機構３０を最上昇位置に移動させる。
また、図１および図３を用いて最下降位置へ移動する場合について説明する。第１関節部４ａおよび第２関節部６ａの不図示のモータ等からなる駆動機構が駆動され、ハンド１４ａの移動方向正面から見て第１脚部５ａは時計回りに第１関節部４ａを中心に旋回し、第２脚部７ａは反時計回りに第２関節部６ａを中心に旋回して水平アーム機構３０を下降させ、第１脚部５ａがベース２面と同じ高さになった場合、さらに第１脚部５ａは時計回りに第１関節部４ａを中心に旋回して、第１脚部５ａの側面が脚部支持部材３ａの側面から大きく飛び出さない程度まで旋回させ、第２脚部７ａは時計回りに第２関節部６ａを中心に旋回して最上昇位置に移動させる。
最下降位置に水平アーム機構３０が移動した場合、水平アーム機構３０は、昇降機構２０の間に配置される。このようにすることで、不図示のストッカの最下位置のワークを支持ベース８に取り付けられたハンド１４ａにより取り出すことが可能となる。
また、一方の昇降機構２０が故障しても他方の昇降機構２０で駆動できるので水平アーム機構は落下することなく、安全な最下位置への移動が可能であり、ワークを損傷することがない。
旋回領域は、旋回機構１７を中心に脚部支持部材３ａ、３ｂ側面までの長さが旋回半径となっており、比較的小さな設置面積を可能とする。
【００１３】
次に、図４を用いてハンドの移動方向に関してローリンク方向にストッカが傾いて設置された場合の昇降機構の補正動作について説明する。図４はワークをストッカへ移送する方向から見た昇降機構の部分の模式図である。
ストッカが設置された場合にある傾きθをもって設置された場合は、第１脚部５ａを水平維持状態から角度θ時計回りに第１関節部４ａを回転させ、第２脚部７ａを水平維持状態から角度θ反時計回りに第２関節部６ａを回転させる。また、第１脚部５ｂを水平維持状態から角度θ反時計回りに第１関節部４ｂを回転させ、第２脚部７ｂを水平維持状態から角度θ時計回りに第２関節部６ｂを回転させる。そうすることで、支持ベース８は、水平状態から角度θ傾いた状態に保持され、支持ベース８上に配置された不図示の水平アーム機構が水平状態から角度θ傾いた状態に保持される。
このような傾きを補正する動作としては、たとえば、ワークをストッカから取り出し、移送する動作を移送ロボットに操作者が教示する際にティーチングペンダントによる手動動作で行われ、一旦、教示されればプレーバック動作により同じ軌道で移送ロボットは動作する。
【００１４】
次に、ハンドの移動方向に関してヨーイング方向にストッカが傾いて設置された場合の補正動作について説明する。このような傾きを補正する動作としては、たとえば、ワークをストッカから取り出し、移送する動作を移送ロボットに操作者が教示する際にティーチングペンダントによる手動動作で行われる。その際に補正動作する軸は、図４に記載されている旋回機構１７により所定の角度に調整される。一旦、教示されればプレーバック動作により同じ軌道で移送ロボットは動作する。
【００１５】
次に、図５を用いてハンドの移動方向に関してストッカが左に横ずれして設置された場合の昇降機構の補正動作について説明する。図５はワークをストッカへ移送する方向から見た昇降機構の部分の模式図である。
ストッカが設置された場合に横ずれして設置された場合は、第１脚部５ａを水平維持状態から角度θ反時計回りに第１関節部４ａを回転させ、第２脚部７ａを水平維持状態から角度θ時計回りに第２関節部６ａを回転させる。また、第１脚部５ｂを水平維持状態から角度θ時計回りに第１関節部４ｂを回転させ、第２脚部７ｂを水平維持状態から角度θ時計回りに第２関節部６ｂを回転させる。そうすることで、支持ベース８は、水平状態を維持したまま左右に移動することができ、支持ベース８上に配置された不図示の水平アーム機構が水平状態を維持したまま、左右方向に移動できる。
【００１６】
ストッカが傾いていたり、横ずれしていたりした場合について説明したが、ストッカ内でワークが傾いたり、横ずれしていたりする場合も想定される。ワークが傾くケースであるが、ワークの移送方向に関してローリングしている場合は考える必要はなく、ヨーイング方向に関してのみ考慮すればよい。つまり、ローリング方向に傾きを持っているとするとストッカの配置面が傾いていることが考えられるが、ストッカ内は精度良く製作されているので、ローリング方向の傾きは生じにくいと考えられるためである。
図６のフローチャートを用いて、ヨーイング方向の傾きの補正と横ずれについて説明する。
（１）ロボットハンド上にワークを載置する。
（２）ハンドに備えられた図示しない２つのセンサの相対角度から角度ずれを検出する。（３）ステップ２で検出された角度ずれは、旋回機構の回転角度に変換されて角度補正される。
（４）ロボットハンドに載置したガラス基板を引き込んだ場合に、支持ベースおよび支持部材に搭載した不図示の距離検出センサで横ずれを検出する。
（５）横ずれが生じていれば、各関節の回転角度に横ずれ量を変換することで位置補正する。
（６）角度および位置補正した姿勢を維持したまま、作業領域へ移動する。
以上のステップを行うことにより、ワークをハンドに載置した際のヨーイングずれおよび横ずれを補正することができる。
【００１７】
次に、水平アーム機構３０の動作について図１をもとに説明する。第１アーム１０ａ、１０ｂの一端と支持ベース８および支持部材１６が連結され、第１アーム１０ａ、１０ｂの他端は、第２水平関節部１１ａ、１１ｂで第２アーム１２ａ、１２ｂの一端と連結される。第２アーム１２ａ、１２ｂの他端は、第３水平関節部１３ａ、１３ｂで第１ハンド１４ａ、１４ｂと連結されている。支持ベース８および支持部材１６に備えられた回転駆動機構が駆動されると、たとえば、各水平関節部へベルト駆動等により駆動力が伝達され、ハンド１４ａ、１４ｂは一方向を向いて移動する。ハンド１４ａはアームが伸びた位置を示したものであり、ハンド１４ｂはアームが縮んだ位置を示している。本実施例では、上下の水平アーム機構３０において、第２水平関節部１１ａ、１１ｂが互いに反対方向に張り出すようにしているが、これに限られるものではなく、たとえば、支柱１５の反対側の水平方向に互いの第２水平関節部１１ａ、１１ｂが張り出すように動作させても良い。
尚、本発明では、上アームと下アームを有する多関節ロボットについて述べたが、上下いずれか一方のアームからなる多関節ロボットでも良いことは自明である。また、第１から第３水平関節部の回転関節を有する移送ロボットについて述べたが、第３水平関節部が固定された移送ロボットについても同様な作用および効果を有することは当然である。
【産業上の利用可能性】
【００１８】
本発明では、液晶基板や半導体ウェハを移送するロボットについて述べたが、このような基板を搬送するものであれば、たとえば、太陽発電用のパネルや有機ＥＬ基板等の基板でも、基板であれば、移送することは可能である。
【符号の説明】
【００１９】
１ 台座
２ ベース
３ａ、３ｂ 脚部支持部材
４ａ、４ｂ 第１関節部
５ａ、５ｂ 第１脚部
６ａ、６ｂ 第２関節部
７ａ、７ｂ 第２脚部
８ 支持ベース
９ａ、９ｂ 第１水平関節部
１０ａ、１０ｂ 第１アーム
１１ａ、１１ｂ 第２水平関節部
１２ａ、１２ｂ 第２アーム
１３ａ、１３ｂ 第３水平関節部
１４ａ、１４ｂ ハンド
１５ 支柱
１６ 支持部材
１７ 旋回機構
２０ 昇降機構
３０ 水平アーム機構
【技術分野】
【０００１】
本発明は、液晶用のガラス基板や半導体ウェハ等の薄板状のワークをストッカに出し入れする移送ロボットおよびその移送方法と制御方法に関する。
【背景技術】
【０００２】
従来の移送ロボットとしては、脚部を屈曲伸縮させて上下動し、上部に配置されたアームによりワークを移送するものが提案されている（例えば、特許文献１〜３参照）。
従来の第１の移送ロボットは、図７に示すようにハンド部材１８０を紙面と直交する水平方向（Ｘ方向：同図中に符号不記入）に移動自在とするハンド部材動作機構１０８と、このハンド部材動作機構１０８の全体を移動させるためのリンク機構１０９とを有している。リンク機構１０９は、ベース部材１９０に一端部が連結部１９３ａを介して回転自在に連結された第１のアーム１９１と、この第１のアーム１９１の他端部に連結部１９３ｂを介して連結された第２のアーム１９２とを具備しており、かつこの第２のアーム１９２の他端部には、ハンド部材動作機構１０８のベース部１８１が連結部１９３ｃを介して回転可能に連結された構造を有している。
しかしながら、従来の第１の移送ロボットでは、できる限り広い領域においてハンド部材移動可能とし、かつハンド部材を水平および垂直方向に直線的に移動できるようにすることが要請される場合が多いが、第１および第２のアーム１９１，１９２を回転させることによってワークをＹ方向 （図７の紙面に直交する方向）およびＺ方向に直線的に移動
させ得る範囲が比較的狭くなっていた。
これを解決するために、第２の従来例が発案されている。図８を用いて第２の従来例について説明する。第２の従来例は、ベース部材１と、リンク機構２と、２つのハンド部材２３０（２３０Ａ，２３０Ｂ）を有するハンド部材動作機構２０３とを具備して構成されている。ベース部材２０１は、一定の高さを有するボックス状に形成されており、たとえばフロアに固定して設けられている。ただし、後述するように、このベース部材２０１をＹ方向に移動自在に設けることもできる。りンク機構２０２は、第１および第２のアーム２２１，２２２と、中間アーム２２３と、第１ないし第４の連結部２２４ａ〜２２４ｄとを具備して構成されている。第１ないし第４の連結部２２４ａ〜２２４ｄのそれぞれの軸心Ｃ１〜Ｃ４は、いずれもＸ方向に延びている。第１のアーム２１の一端部は、第１の連結部２２４ａを介してベース部材１の一側面の上部に連結されており、軸心Ｃ１周りに回転自在である。軸心Ｃ１から第１のアーム２２１の他端部先端までの長さＬａは、フロアから軸心Ｃ１までの高さＨａよりも短い寸法とされている。このことにより、第１のアーム２２１は軸心Ｃ１の全周囲にわたって回転自在となっている。中間アーム２２３は、たとえば第１のアーム２２１と略同一長さである。この中間アーム２２３は、その一端部が第３の連結部２２４ｃを介して第１のアーム２２１の他端部に連結されていることにより、第１のアーム２２１に対して軸心Ｃ３周りに相対回転自在である。第２のアーム２２２は、たとえば第１のアーム２２１や中間アーム２２３よりも短くされており、その一端部が第４の連結部２２４ｄを介して中間アーム２２３の他端部に連結されていることにより、中間アーム２２３に対して軸心Ｃ４周りに相対回転自在である。第２のアーム２２２の他端部は、ハンド部材動作機構２０３のベース部２３１に第２の連結部２２４ｂを介して連結されている。このため、ハンド部材動作機構２０３は、第２のアーム２２２に対して軸心Ｃ２周りに相対回転自在となっている。
また、第３の従来例について図９を用いて説明する。第３の従来例は、昇降装置３１０は、複数のポスト３２１，３２２を有するベースユニット３１２と、ワークを支持するワーク支持ユニット３１３と、一端がベースユニット３１２のポスト３２１，３２２に連結されかつ他端がワーク支持ユニット３１３に連結される屈伸型の複数のアームユニット３４１，３４２，３４３，３４４を有する昇降機構３１４とを備える。ワーク上昇時に、ワ
ーク支持ユニット３１３が複数のポスト３２１，３２２よりも高い位置に配され、ワーク下降時に、ワーク支持ユニット１３の少なくとも一部が複数のポスト３２１，３２２の間に配される。
【先行技術文献】
【特許文献】
【０００３】
【特許文献１】特開平１１−２３８７７９号公報（第４頁、図２）
【特許文献２】特開２００２−２１０６８４号公報（第６頁、図２）
【特許文献３】特開２００６−１７６２７６号公報（第４頁、図１）
【発明の概要】
【発明が解決しようとする課題】
【０００４】
保管するストッカには天井に届くほどの高さから床面近くまでに液晶用のガラス基板や半導体ウェハ等の薄板状のワークが一定の間隔を持って積み重ねられ保管されている。このようなストッカが移送ロボットの前後または左右に配置されている。これに対応するために移送ロボットは、大型化するとともに長ストロークの昇降機構と旋回機構を備える必要がある。このように構成されたストッカおよび移送ロボットは、相対的にワークの取り出し方向に対してローリング方向に傾いて取り付けられるケースが、大型化することで増えてきている。そうすると、ワークを移送ロボットのハンドで受け取るときにストッカに対して傾いた状態になるためにワークを受け取った際にワークが位置ずれを起こし、搬送先で所定の位置に配置できないなどの問題が生じるために、ローリング方向の補正機能が必要とされてきている。また、ストッカ内のワークの配置についても、ワークは正確な位置にあるとは限らない。たとえば、ワークの取り出し方向に対してヨーイング方向に傾いていたり、横方向にスライドしたりしている場合がある。搬送先で所定の位置に配置するために補正する機能が必要とされてきている。これまでは、これら補正をするために、別途補正機構を備えていたが、装置が複雑化することや設置面積が大きくなるといった問題が生じていた。
また、保管されるワークも大型化されることで重量が重くなり、これを移送する移送ロボットは剛性を高める必要があるとともに、万が一、昇降機構が故障した際にワークが落下して損傷することを防止する安全策を備えることが要求されてきている。また、年々、基板の生産数は増えるためにスループットを速くすることが、基板が大型化しても要求されている。
さらに、このようなワークを移送するシステムの環境は周囲のクリーン度を保つ設備を必要としており、大型化する移送ロボットについてもフットプリントを小さくすることが要求されている。
しかしながら、従来の第１の移送ロボットは、第１および第２のアームを回転させることによってワークを水平方向および垂直方向に直線的に移動させ得るが、垂直方向に関して、ベース部材と干渉するためにベース部材より下面には物理的に下降することができないために昇降範囲が狭くなっていた。また、ストッカ内のワークの位置ずれを補正する手段がないために補正できない問題が生じていた。このような補正する機構を備えると構造が大きくなったり、複雑になるといった問題が生じることになり、適用が困難となっていた。
また、従来の第２の移送ロボットでは、３リンク構成にすることにより可動範囲を広くすることができるようになったが、リンクを駆動する駆動機構が故障した場合、ワークの落下を防止する機構を備えていないので、高価なワークを損傷する問題が生じしていた。また、水平方向に垂直方向の位置を維持したまま移動することができることにより、ストッカ内のワークの横ずれを補正することはできるかもしれないが、補正するのに必要なセンサを備えていないために補正することができない。その他のローリング方向やヨーインク方向の補正することができないために所定の位置に搬送することができないといった問題が生じていた。
また、従来の第３の移送ロボットでは、４本のリンク機構によりワーク搬送部を支持して昇降することから、何れか１本のリンク機構の駆動機構に故障が生じても、ワークを落下させることなく、安全な位置へワークを移送することができる可能性がある。しかしな
がら、従来の第３の移送ロボットは、リンク機構が外向きに屈曲するために下降位置では大きな設置面を必要とすることになり、フットプリントが小さくならないといった問題が生じていた。また、ワークの取り出し方向に対してピッチング方向に傾かせることができるもののローリング方向、ヨーイング方向や横ずれを補正する機構が備えられていないために所定の位置への位置決めができないといった問題が生じていた。
本発明はこのような問題点に鑑みてなされたものであり、比較的小さな設置面積に配置でき、上下への昇降範囲が広くできるとともに、安全にワークを移送でき、移送する際に所定の位置へ位置決め可能なように傾き補正が可能な移送ロボットを提供することを目的とする。
【課題を解決するための手段】
【０００５】
上記問題を解決するため、本発明は、次のように構成したものである。
請求項１に記載の発明は、搬送物を載置するハンド部と、前記ハンド部を回動可能に支持する第２アームと、前記第２アームを回転可能に支持する第１アームと、を少なくとも備え、前記ハンド部が一方向に移動するように前記アームが回転する水平アーム機構と、
ベースの片側に片側第１関節部で回動可能に支持された片側第１脚部と、前記片側第１脚部に片側第２関節部で回動可能に支持され前記水平アーム機構を支持する片側第２脚部と、を備えた第１リンク機構と、前記ベースの他方側に他方側第１関節部で回動可能に支持された他方側第１脚部と、前記他方側第１脚部に他方側第２関節部で回動可能に支持され前記水平アーム機構を支持する他方側第２脚部と、を備えた第２リンク機構と、を備え、前記片側第１関節部と前記他方側第１関節部と前記片側第２関節部と前記他方側第２関節部のそれぞれの回転軸の方向と前記ハンド部の移動方向とが平行になるよう配置され、 前記ハンド部の移動方向から見て、前記片側第２関節部と前記他方側第２関節部が前記第１リンク機構と前記第２リンク機構の内側に互いに張り出すように前記片側第１脚部と前記他方側第１脚部が互いに逆方向に回転しながら、前記ハンド部を前記片側第１関節部と前記他方側第１関節部との間で上下に移動させうる昇降機構と、を備えた移送ロボットの制御方法であって、前記ハンド部の移動方向のローリング方向の傾きを変えるように、あるいは、前記ハンド部が水平状態を維持したまま前記ハンド部の移動方向に対して横ずれ動作するように、前記片側第１脚部と前記他方側第１脚部を前記片側第１関節部と前記他方側第１関節部においてそれぞれ互いに異なる角度量を回転させ、前記片側第２脚部と前記他方側第２脚部を前記片側第２関節部と前記他方側第２関節部においてそれぞれ互いに異なる角度量を回転させること、を特徴とするものである。
請求項２に記載の発明は、搬送物を載置するハンド部と、前記ハンド部を回動可能に支持する第２アームと、前記第２アームを回転可能に支持する第１アームと、を少なくとも備え、前記ハンド部が一方向に移動するように前記アームが回転する水平アーム機構と、 ベースの片側に片側第１関節部で回動可能に支持された片側第１脚部と、前記片側第１脚部に片側第２関節部で回動可能に支持され前記水平アーム機構を支持する片側第２脚部と、を備えた第１リンク機構と、前記ベースの他方側に他方側第１関節部で回動可能に支持された他方側第１脚部と、前記他方側第１脚部に他方側第２関節部で回動可能に支持され前記水平アーム機構を支持する他方側第２脚部と、を備えた第２リンク機構と、を備え、前記片側第１関節部と前記他方側第１関節部と前記片側第２関節部と前記他方側第２関節部のそれぞれの回転軸の方向と前記ハンド部の移動方向とが平行になるよう配置され、 前記ハンド部の移動方向から見て、前記片側第２関節部と前記他方側第２関節部が前記第１リンク機構と前記第２リンク機構の内側に互いに張り出すように前記片側第１脚部と前記他方側第１脚部が互いに逆方向に回転しながら、前記ハンド部を前記片側第１関節部と前記他方側第１関節部との間で上下に移動させうる昇降機構と、前記ベースを鉛直軸回りに旋回させる旋回機構と、を備えた移送ロボットの制御方法であって、前記ハンド部の移動方向のヨーイング方向の方向を変えるように前記旋回機構によって前記ベースを旋回させること、を特徴とする移送ロボットの制御方法を特徴とするものである。
請求項３に記載の発明は、前記ハンド部の前記ローリング方向の傾きの変更を、前記ハンド部の移動方向に対する前記搬送物の載置場所の傾きに応じて行なうこと、を特徴とするものである。
請求項４に記載の発明は、前記ハンド部の前記横ずれ動作を、前記ハンド部の移動方向に対する前記搬送物の載置場所の横ずれ量に応じて行なうこと、を特徴とするものである。
請求項５に記載の発明は、前記ハンド部の前記ヨーイング方向の方向の変更を、前記ハンド部の移動方向に対する前記搬送物の載置場所の方向のずれ量に応じて行なうこと、を特徴とするものである。
請求項６に記載の発明は、前記水平アーム機構が、前記第１アームを回動可能に支持するとともに前記片側第２脚部と前記他方側第２脚部とに回動可能に支持される支持ベースと、前記支持ベースに設けられた第１のセンサと、を備え、前記ハンド部が前記支持ベースの上側に引き込まれたときに前記第１のセンサによって前記搬送物の前記ハンド部の移動方向に対する横ずれ量を検出し、前記検出した搬送物の横ずれ量に応じて前記ハンド部の前記横ずれ動作を行なうこと、を特徴とするものである。
請求項７に記載の発明は、前記ハンド部に第２のセンサを設け、前記第２のセンサによって前記ハンド部に載置された前記搬送物の前記ハンド部に対する角度ずれを検出し、 前記搬送物の前記ハンド部に対する角度ずれに応じて前記ハンド部の前記ヨーイング方向の方向の変更を行なうこと、を特徴とするものである。
【発明の効果】
【０００６】
本発明によると、昇降機構が少なくとも２つのリンク機構から構成され、リンク機構が脚部支持部材の内側を旋回することで水平アーム機構を昇降させ、水平アーム機構が最下降位置に位置した際には脚部支持部材の内側に配置されるように構成されたことで、昇降範囲を広くすることができる。また、少なくとも２つのリンク機構から構成されていることで、万が一、１つのリンク機構が故障して駆動力が発生できなくなったとしても、他方のリンク機構により駆動力を得ることができることから水平アーム機構が落下することを防止し、ワークの損傷を防止する２重化した安全機構を提供している。さらに、水平アーム機構が脚部支持部材の内側に配置され、リンク機構も脚部支持部材よりも外側に大きく飛び出さないような位置に旋回して水平アーム機構が最下降位置に位置するように形成されるので、リンク機構が外側に飛び出るような屈曲構造ではないので、比較的小さな設置面積に配置することが可能であり、フットプリントを小さくすることができる。
また、本発明によると、ハンド移動方向に関して同軸上に第１水平関節を配置し、一方向に伸縮するアームによりハンドを移動させることにより、ストッカからのワークの出し入れが、２つのハンドを用いることにより高速化することができる。すなわちスループットを向上することができる。
また、本発明によると、２組のリンク機構からなる昇降機構に備えられた少なくとも２つの回転関節を備えることにより、水平アーム機構をハンドの移動方向に関してローリング方向および左右方向の何れか一つの方向に移動できることから、移送ロボットとストッカの相対的な位置ずれを移送ロボットの動作により補正できるので、従来あったロボットのように補正機構を必要とせずに済み、装置を複雑化することなく、設置面積が小さいまま補正することが可能となる。
また、本発明によると、２組のリンク機構からなる昇降機構に備えられた少なくとも２つの回転関節を備えるとともに、移送ロボットの旋回軸を利用して、水平アーム機構をハンドの移動方向に関してローリング方向、ヨーング方向および左右方向の搬送物がハンドに載置された際の搬送物の位置ずれを補正することができるので、ストッカ内の搬送物の配置に関わらず、搬送物を所定の位置で搬送先に移送することができる。
【図面の簡単な説明】
【０００７】
【図１】本発明の実施例を示す移送ロボットの斜視図
【図２】本発明の実施例の水平アーム機構が最上昇位置へ移動した場合を示す斜視図
【図３】本発明の実施例の水平アーム機構が最下降位置へ移動した場合を示す斜視図
【図４】本発明のローリングずれを補正する昇降機構の動作を示す模式図
【図５】本発明の横ずれを補正する昇降機構の動作を示す模式図
【図６】ハンド上のワークのずれを補正するフローチャート
【図７】第１の従来の移送ロボットを示す正面図
【図８】第２の従来の移送ロボットを示す正面図
【図９】第３の従来の移送ロボットを示す正面図
【発明を実施するための形態】
【０００８】
以下、本発明の実施の形態について図を参照して説明する。
【実施例１】
【０００９】
図１は、本発明の移送ロボットの斜視図である。
本発明の移送ロボットは、図示しないストッカに配置されたワークを取り出し、作業エ
リアへ移送するために、旋回機構１７、昇降機構２０および水平アーム機構３０から構成されている。
本発明が特許文献１から３と異なる部分は、旋回機能を有し、昇降機構がダブルレッグ機構からなりハンド部が昇降機構の間に下降する部分である。
旋回機構１７は、台座１に取り付けられたベース２の略中心に旋回軸が配置されるように設置されている。また、ベース２の両端には脚部支持部材３ａ、３ｂが設置されている。
【００１０】
昇降機構２０は、脚部支持部材３ａ、３ｂに備えられた不図示の駆動部が第１関節部４ａ、４ｂに備えられ、第１脚部５ａ、５ｂの一端が連結され、第１脚部５ａ、５ｂの他端は不図示の駆動部が備えられた第２関節部６ａ、６ｂで第２脚部７ａ、７ｂの一端と連結される。第２脚部７ａ、７ｂの他端は、支持ベース８に回動可能に連結されている。第１脚部５ａ、５ｂは、水平アーム機構３０の最下降位置への移動をより低くできるように脚部支持部材３ａ、３ｂよりも長く形成されている。第２脚部７ａ、７ｂの長さは、水平アーム機構３０が最下降位置へ移動した際に、第１脚部５ａ、５ｂの側面が脚部支持部材３ａ、３ｂの側面から大きく飛び出さないように決められており、第１脚部５ａ、５ｂの長さよりも短い長さで形成されている。
【００１１】
次に、水平アーム機構３０について説明する。水平アーム機構３０は、２つのハンド１４ａ、１４ｂを不図示のワークをストッカから出し入れするように移動させるダブルリンク機構から構成されている。支持ベース８に備えられた不図示の駆動機構を備えた第１水平関節部９ａで第１アーム１０ａの一端と連結され、第１アーム１０ａの他端は、第２水平関節部１１ａで第２アーム１２ａの一端と連結される。第２アーム１２ａの他端は、第３水平関節部１３ａで第１ハンド１４ａと連結されている。
また、支持ベース８には、支持部材１６を備えた支柱１５が取り付けられており、支持部材に備えられた不図示の駆動機構を備えた第１水平関節部９ｂで第１アーム１０ｂの一端と連結され、第１アーム１０ｂの他端は、第２水平関節部１１ｂで第２アーム１２ｂの一端と連結される。第２アーム１２ｂの他端は、第３水平関節部１３ｂで第１ハンド１４ｂと連結されている。第１アーム１０ａ、１０ｂと第２アーム１２ａ、１２ｂは互いに対向し、対面構造を形成している。また、第１水平関節部９ａ、９ｂは、本実施例では同軸上に配置されている。しかしながら、ハンド１４ａ、１４ｂの移動方向に関して互いにオフセットした構成としても第１アーム１０ａ、１０ｂと第２アーム１２ａ、１２ｂのアーム長を変更することで本実施例と同じ動作が可能である。また、第１水平関節部９ａ、９ｂは、第３水平関節部１３ａ、１３ｂは、ハンド１４ａ、１４ｂの移動方向に関して同軸上に配置されている。
また、第１水平関節部９ａ、９ｂの回転軸は、本実施例では旋回機構１７の旋回軸よりも前方にオフセットしており、旋回機構１７との干渉しないように配置されている。しかしながら、ハンド１４ａ、１４ｂの移動方向に関して前後にオフセットした構成としても第１アーム１０ａ、１０ｂと第２アーム１２ａ、１２ｂのアーム長を変更することで本実施例と同じ動作が可能である。
【００１２】
次に、動作について説明する。はじめに昇降機構の動作について図２および３を用いて説明する。図２は昇降機構２０が最上昇位置に移動した場合であり、図３は昇降機構２０が最下降位置に移動した場合を示している。一方の昇降機構について説明し、他方の動作は面対称であるので説明を省略する。
図１および図２を用いて最上昇位置へ移動する場合について説明する。第１関節部４ａおよび第２関節部６ａの不図示のモータ等からなる駆動機構が駆動され、ハンド１４ａの移動方向正面から見て第１脚部５ａは反時計回りに第１関節部４ａを中心に旋回し、第２脚部７ａは時計回りに第２関節部６ａを中心に旋回して水平アーム機構３０を最上昇位置に移動させる。
また、図１および図３を用いて最下降位置へ移動する場合について説明する。第１関節部４ａおよび第２関節部６ａの不図示のモータ等からなる駆動機構が駆動され、ハンド１４ａの移動方向正面から見て第１脚部５ａは時計回りに第１関節部４ａを中心に旋回し、第２脚部７ａは反時計回りに第２関節部６ａを中心に旋回して水平アーム機構３０を下降させ、第１脚部５ａがベース２面と同じ高さになった場合、さらに第１脚部５ａは時計回りに第１関節部４ａを中心に旋回して、第１脚部５ａの側面が脚部支持部材３ａの側面から大きく飛び出さない程度まで旋回させ、第２脚部７ａは時計回りに第２関節部６ａを中心に旋回して最上昇位置に移動させる。
最下降位置に水平アーム機構３０が移動した場合、水平アーム機構３０は、昇降機構２０の間に配置される。このようにすることで、不図示のストッカの最下位置のワークを支持ベース８に取り付けられたハンド１４ａにより取り出すことが可能となる。
また、一方の昇降機構２０が故障しても他方の昇降機構２０で駆動できるので水平アーム機構は落下することなく、安全な最下位置への移動が可能であり、ワークを損傷することがない。
旋回領域は、旋回機構１７を中心に脚部支持部材３ａ、３ｂ側面までの長さが旋回半径となっており、比較的小さな設置面積を可能とする。
【００１３】
次に、図４を用いてハンドの移動方向に関してローリンク方向にストッカが傾いて設置された場合の昇降機構の補正動作について説明する。図４はワークをストッカへ移送する方向から見た昇降機構の部分の模式図である。
ストッカが設置された場合にある傾きθをもって設置された場合は、第１脚部５ａを水平維持状態から角度θ時計回りに第１関節部４ａを回転させ、第２脚部７ａを水平維持状態から角度θ反時計回りに第２関節部６ａを回転させる。また、第１脚部５ｂを水平維持状態から角度θ反時計回りに第１関節部４ｂを回転させ、第２脚部７ｂを水平維持状態から角度θ時計回りに第２関節部６ｂを回転させる。そうすることで、支持ベース８は、水平状態から角度θ傾いた状態に保持され、支持ベース８上に配置された不図示の水平アーム機構が水平状態から角度θ傾いた状態に保持される。
このような傾きを補正する動作としては、たとえば、ワークをストッカから取り出し、移送する動作を移送ロボットに操作者が教示する際にティーチングペンダントによる手動動作で行われ、一旦、教示されればプレーバック動作により同じ軌道で移送ロボットは動作する。
【００１４】
次に、ハンドの移動方向に関してヨーイング方向にストッカが傾いて設置された場合の補正動作について説明する。このような傾きを補正する動作としては、たとえば、ワークをストッカから取り出し、移送する動作を移送ロボットに操作者が教示する際にティーチングペンダントによる手動動作で行われる。その際に補正動作する軸は、図４に記載されている旋回機構１７により所定の角度に調整される。一旦、教示されればプレーバック動作により同じ軌道で移送ロボットは動作する。
【００１５】
次に、図５を用いてハンドの移動方向に関してストッカが左に横ずれして設置された場合の昇降機構の補正動作について説明する。図５はワークをストッカへ移送する方向から見た昇降機構の部分の模式図である。
ストッカが設置された場合に横ずれして設置された場合は、第１脚部５ａを水平維持状態から角度θ反時計回りに第１関節部４ａを回転させ、第２脚部７ａを水平維持状態から角度θ時計回りに第２関節部６ａを回転させる。また、第１脚部５ｂを水平維持状態から角度θ時計回りに第１関節部４ｂを回転させ、第２脚部７ｂを水平維持状態から角度θ時計回りに第２関節部６ｂを回転させる。そうすることで、支持ベース８は、水平状態を維持したまま左右に移動することができ、支持ベース８上に配置された不図示の水平アーム機構が水平状態を維持したまま、左右方向に移動できる。
【００１６】
ストッカが傾いていたり、横ずれしていたりした場合について説明したが、ストッカ内でワークが傾いたり、横ずれしていたりする場合も想定される。ワークが傾くケースであるが、ワークの移送方向に関してローリングしている場合は考える必要はなく、ヨーイング方向に関してのみ考慮すればよい。つまり、ローリング方向に傾きを持っているとするとストッカの配置面が傾いていることが考えられるが、ストッカ内は精度良く製作されているので、ローリング方向の傾きは生じにくいと考えられるためである。
図６のフローチャートを用いて、ヨーイング方向の傾きの補正と横ずれについて説明する。
（１）ロボットハンド上にワークを載置する。
（２）ハンドに備えられた図示しない２つのセンサの相対角度から角度ずれを検出する。（３）ステップ２で検出された角度ずれは、旋回機構の回転角度に変換されて角度補正される。
（４）ロボットハンドに載置したガラス基板を引き込んだ場合に、支持ベースおよび支持部材に搭載した不図示の距離検出センサで横ずれを検出する。
（５）横ずれが生じていれば、各関節の回転角度に横ずれ量を変換することで位置補正する。
（６）角度および位置補正した姿勢を維持したまま、作業領域へ移動する。
以上のステップを行うことにより、ワークをハンドに載置した際のヨーイングずれおよび横ずれを補正することができる。
【００１７】
次に、水平アーム機構３０の動作について図１をもとに説明する。第１アーム１０ａ、１０ｂの一端と支持ベース８および支持部材１６が連結され、第１アーム１０ａ、１０ｂの他端は、第２水平関節部１１ａ、１１ｂで第２アーム１２ａ、１２ｂの一端と連結される。第２アーム１２ａ、１２ｂの他端は、第３水平関節部１３ａ、１３ｂで第１ハンド１４ａ、１４ｂと連結されている。支持ベース８および支持部材１６に備えられた回転駆動機構が駆動されると、たとえば、各水平関節部へベルト駆動等により駆動力が伝達され、ハンド１４ａ、１４ｂは一方向を向いて移動する。ハンド１４ａはアームが伸びた位置を示したものであり、ハンド１４ｂはアームが縮んだ位置を示している。本実施例では、上下の水平アーム機構３０において、第２水平関節部１１ａ、１１ｂが互いに反対方向に張り出すようにしているが、これに限られるものではなく、たとえば、支柱１５の反対側の水平方向に互いの第２水平関節部１１ａ、１１ｂが張り出すように動作させても良い。
尚、本発明では、上アームと下アームを有する多関節ロボットについて述べたが、上下いずれか一方のアームからなる多関節ロボットでも良いことは自明である。また、第１から第３水平関節部の回転関節を有する移送ロボットについて述べたが、第３水平関節部が固定された移送ロボットについても同様な作用および効果を有することは当然である。
【産業上の利用可能性】
【００１８】
本発明では、液晶基板や半導体ウェハを移送するロボットについて述べたが、このような基板を搬送するものであれば、たとえば、太陽発電用のパネルや有機ＥＬ基板等の基板でも、基板であれば、移送することは可能である。
【符号の説明】
【００１９】
１ 台座
２ ベース
３ａ、３ｂ 脚部支持部材
４ａ、４ｂ 第１関節部
５ａ、５ｂ 第１脚部
６ａ、６ｂ 第２関節部
７ａ、７ｂ 第２脚部
８ 支持ベース
９ａ、９ｂ 第１水平関節部
１０ａ、１０ｂ 第１アーム
１１ａ、１１ｂ 第２水平関節部
１２ａ、１２ｂ 第２アーム
１３ａ、１３ｂ 第３水平関節部
１４ａ、１４ｂ ハンド
１５ 支柱
１６ 支持部材
１７ 旋回機構
２０ 昇降機構
３０ 水平アーム機構
【特許請求の範囲】
【請求項１】
搬送物を載置するハンド部と、前記ハンド部を回動可能に支持する第２アームと、前記第２アームを回転可能に支持する第１アームと、を少なくとも備え、前記ハンド部が一方向に移動するように前記アームが回転する水平アーム機構と、
ベースの片側に片側第１関節部で回動可能に支持された片側第１脚部と、前記片側第１脚部に片側第２関節部で回動可能に支持され前記水平アーム機構を支持する片側第２脚部と、を備えた第１リンク機構と、
前記ベースの他方側に他方側第１関節部で回動可能に支持された他方側第１脚部と、前記他方側第１脚部に他方側第２関節部で回動可能に支持され前記水平アーム機構を支持する他方側第２脚部と、を備えた第２リンク機構と、を備え、
前記片側第１関節部と前記他方側第１関節部と前記片側第２関節部と前記他方側第２関節部のそれぞれの回転軸の方向と前記ハンド部の移動方向とが平行になるよう配置され、
前記ハンド部の移動方向から見て、前記片側第２関節部と前記他方側第２関節部が前記第１リンク機構と前記第２リンク機構の内側に互いに張り出すように前記片側第１脚部と前記他方側第１脚部が互いに逆方向に回転しながら、前記ハンド部を前記片側第１関節部と前記他方側第１関節部との間で上下に移動させうる昇降機構と、
を備えた移送ロボットの制御方法であって、
前記ハンド部の移動方向のローリング方向の傾きを変えるように、あるいは、前記ハンド部が水平状態を維持したまま前記ハンド部の移動方向に対して横ずれ動作するように、前記片側第１脚部と前記他方側第１脚部を前記片側第１関節部と前記他方側第１関節部においてそれぞれ互いに異なる角度量を回転させ、前記片側第２脚部と前記他方側第２脚部を前記片側第２関節部と前記他方側第２関節部においてそれぞれ互いに異なる角度量を回転させること、を特徴とする移送ロボットの制御方法。
【請求項２】
搬送物を載置するハンド部と、前記ハンド部を回動可能に支持する第２アームと、前記第２アームを回転可能に支持する第１アームと、を少なくとも備え、前記ハンド部が一方向に移動するように前記アームが回転する水平アーム機構と、
ベースの片側に片側第１関節部で回動可能に支持された片側第１脚部と、前記片側第１脚部に片側第２関節部で回動可能に支持され前記水平アーム機構を支持する片側第２脚部と、を備えた第１リンク機構と、
前記ベースの他方側に他方側第１関節部で回動可能に支持された他方側第１脚部と、前記他方側第１脚部に他方側第２関節部で回動可能に支持され前記水平アーム機構を支持する他方側第２脚部と、を備えた第２リンク機構と、を備え、
前記片側第１関節部と前記他方側第１関節部と前記片側第２関節部と前記他方側第２関節部のそれぞれの回転軸の方向と前記ハンド部の移動方向とが平行になるよう配置され、
前記ハンド部の移動方向から見て、前記片側第２関節部と前記他方側第２関節部が前記第１リンク機構と前記第２リンク機構の内側に互いに張り出すように前記片側第１脚部と前記他方側第１脚部が互いに逆方向に回転しながら、前記ハンド部を前記片側第１関節部と前記他方側第１関節部との間で上下に移動させうる昇降機構と、
前記ベースを鉛直軸回りに旋回させる旋回機構と、
を備えた移送ロボットの制御方法であって、
前記ハンド部の移動方向のヨーイング方向の方向を変えるように前記旋回機構によって前記ベースを旋回させること、を特徴とする移送ロボットの制御方法。
【請求項３】
前記ハンド部の前記ローリング方向の傾きの変更を、前記ハンド部の移動方向に対する前記搬送物の載置場所の傾きに応じて行なうこと、を特徴とする請求項１記載の移送ロボットの制御方法。
【請求項４】
前記ハンド部の前記横ずれ動作を、前記ハンド部の移動方向に対する前記搬送物の載置場所の横ずれ量に応じて行なうこと、を特徴とする請求項１記載の移送ロボットの制御方法。
【請求項５】
前記ハンド部の前記ヨーイング方向の方向の変更を、前記ハンド部の移動方向に対する前記搬送物の載置場所の方向のずれ量に応じて行なうこと、を特徴とする請求項２記載の移送ロボットの制御方法。
【請求項６】
前記水平アーム機構が、前記第１アームを回動可能に支持するとともに前記片側第２脚部と前記他方側第２脚部とに回動可能に支持される支持ベースと、前記支持ベースに設けられた第１のセンサと、を備え、
前記ハンド部が前記支持ベースの上側に引き込まれたときに前記第１のセンサによって前記搬送物の前記ハンド部の移動方向に対する横ずれ量を検出し、
前記検出した搬送物の横ずれ量に応じて前記ハンド部の前記横ずれ動作を行なうこと、を特徴とする請求項１記載の移送ロボットの制御方法。
【請求項７】
前記ハンド部に第２のセンサを設け、
前記第２のセンサによって前記ハンド部に載置された前記搬送物の前記ハンド部に対する角度ずれを検出し、
前記搬送物の前記ハンド部に対する角度ずれに応じて前記ハンド部の前記ヨーイング方向の方向の変更を行なうこと、を特徴とする請求項２記載の移送ロボットの制御方法。
【請求項１】
搬送物を載置するハンド部と、前記ハンド部を回動可能に支持する第２アームと、前記第２アームを回転可能に支持する第１アームと、を少なくとも備え、前記ハンド部が一方向に移動するように前記アームが回転する水平アーム機構と、
ベースの片側に片側第１関節部で回動可能に支持された片側第１脚部と、前記片側第１脚部に片側第２関節部で回動可能に支持され前記水平アーム機構を支持する片側第２脚部と、を備えた第１リンク機構と、
前記ベースの他方側に他方側第１関節部で回動可能に支持された他方側第１脚部と、前記他方側第１脚部に他方側第２関節部で回動可能に支持され前記水平アーム機構を支持する他方側第２脚部と、を備えた第２リンク機構と、を備え、
前記片側第１関節部と前記他方側第１関節部と前記片側第２関節部と前記他方側第２関節部のそれぞれの回転軸の方向と前記ハンド部の移動方向とが平行になるよう配置され、
前記ハンド部の移動方向から見て、前記片側第２関節部と前記他方側第２関節部が前記第１リンク機構と前記第２リンク機構の内側に互いに張り出すように前記片側第１脚部と前記他方側第１脚部が互いに逆方向に回転しながら、前記ハンド部を前記片側第１関節部と前記他方側第１関節部との間で上下に移動させうる昇降機構と、
を備えた移送ロボットの制御方法であって、
前記ハンド部の移動方向のローリング方向の傾きを変えるように、あるいは、前記ハンド部が水平状態を維持したまま前記ハンド部の移動方向に対して横ずれ動作するように、前記片側第１脚部と前記他方側第１脚部を前記片側第１関節部と前記他方側第１関節部においてそれぞれ互いに異なる角度量を回転させ、前記片側第２脚部と前記他方側第２脚部を前記片側第２関節部と前記他方側第２関節部においてそれぞれ互いに異なる角度量を回転させること、を特徴とする移送ロボットの制御方法。
【請求項２】
搬送物を載置するハンド部と、前記ハンド部を回動可能に支持する第２アームと、前記第２アームを回転可能に支持する第１アームと、を少なくとも備え、前記ハンド部が一方向に移動するように前記アームが回転する水平アーム機構と、
ベースの片側に片側第１関節部で回動可能に支持された片側第１脚部と、前記片側第１脚部に片側第２関節部で回動可能に支持され前記水平アーム機構を支持する片側第２脚部と、を備えた第１リンク機構と、
前記ベースの他方側に他方側第１関節部で回動可能に支持された他方側第１脚部と、前記他方側第１脚部に他方側第２関節部で回動可能に支持され前記水平アーム機構を支持する他方側第２脚部と、を備えた第２リンク機構と、を備え、
前記片側第１関節部と前記他方側第１関節部と前記片側第２関節部と前記他方側第２関節部のそれぞれの回転軸の方向と前記ハンド部の移動方向とが平行になるよう配置され、
前記ハンド部の移動方向から見て、前記片側第２関節部と前記他方側第２関節部が前記第１リンク機構と前記第２リンク機構の内側に互いに張り出すように前記片側第１脚部と前記他方側第１脚部が互いに逆方向に回転しながら、前記ハンド部を前記片側第１関節部と前記他方側第１関節部との間で上下に移動させうる昇降機構と、
前記ベースを鉛直軸回りに旋回させる旋回機構と、
を備えた移送ロボットの制御方法であって、
前記ハンド部の移動方向のヨーイング方向の方向を変えるように前記旋回機構によって前記ベースを旋回させること、を特徴とする移送ロボットの制御方法。
【請求項３】
前記ハンド部の前記ローリング方向の傾きの変更を、前記ハンド部の移動方向に対する前記搬送物の載置場所の傾きに応じて行なうこと、を特徴とする請求項１記載の移送ロボットの制御方法。
【請求項４】
前記ハンド部の前記横ずれ動作を、前記ハンド部の移動方向に対する前記搬送物の載置場所の横ずれ量に応じて行なうこと、を特徴とする請求項１記載の移送ロボットの制御方法。
【請求項５】
前記ハンド部の前記ヨーイング方向の方向の変更を、前記ハンド部の移動方向に対する前記搬送物の載置場所の方向のずれ量に応じて行なうこと、を特徴とする請求項２記載の移送ロボットの制御方法。
【請求項６】
前記水平アーム機構が、前記第１アームを回動可能に支持するとともに前記片側第２脚部と前記他方側第２脚部とに回動可能に支持される支持ベースと、前記支持ベースに設けられた第１のセンサと、を備え、
前記ハンド部が前記支持ベースの上側に引き込まれたときに前記第１のセンサによって前記搬送物の前記ハンド部の移動方向に対する横ずれ量を検出し、
前記検出した搬送物の横ずれ量に応じて前記ハンド部の前記横ずれ動作を行なうこと、を特徴とする請求項１記載の移送ロボットの制御方法。
【請求項７】
前記ハンド部に第２のセンサを設け、
前記第２のセンサによって前記ハンド部に載置された前記搬送物の前記ハンド部に対する角度ずれを検出し、
前記搬送物の前記ハンド部に対する角度ずれに応じて前記ハンド部の前記ヨーイング方向の方向の変更を行なうこと、を特徴とする請求項２記載の移送ロボットの制御方法。
【図１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図９】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図９】
【公開番号】特開２０１０−１５８７６９（Ｐ２０１０−１５８７６９Ａ）
【公開日】平成２２年７月２２日（２０１０．７．２２）
【国際特許分類】
【出願番号】特願２０１０−３８９２７（Ｐ２０１０−３８９２７）
【出願日】平成２２年２月２４日（２０１０．２．２４）
【分割の表示】特願２００８−５５８９９０（Ｐ２００８−５５８９９０）の分割
【原出願日】平成２０年８月２９日（２００８．８．２９）
【出願人】（０００００６６２２）株式会社安川電機 (2,482)
【Ｆターム（参考）】
【公開日】平成２２年７月２２日（２０１０．７．２２）
【国際特許分類】
【出願日】平成２２年２月２４日（２０１０．２．２４）
【分割の表示】特願２００８−５５８９９０（Ｐ２００８−５５８９９０）の分割
【原出願日】平成２０年８月２９日（２００８．８．２９）
【出願人】（０００００６６２２）株式会社安川電機 (2,482)
【Ｆターム（参考）】
[ Back to top ]