JPH10187221A - 軌跡規制機能付き助力アーム - Google Patents
軌跡規制機能付き助力アームInfo
- Publication number
- JPH10187221A JPH10187221A JP9198445A JP19844597A JPH10187221A JP H10187221 A JPH10187221 A JP H10187221A JP 9198445 A JP9198445 A JP 9198445A JP 19844597 A JP19844597 A JP 19844597A JP H10187221 A JPH10187221 A JP H10187221A
- Authority
- JP
- Japan
- Prior art keywords
- work
- arm
- transfer position
- range
- allowable
- 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.)
- Withdrawn
Links
Landscapes
- Automatic Assembly (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
- Automobile Manufacture Line, Endless Track Vehicle, Trailer (AREA)
Abstract
(57)【要約】
【課題】 狭小な場所でもワークの搬送が容易になるよ
うにする。 【解決手段】 ワークの搬送経路を予め教示しておくと
共に、その搬送軌跡に対する動作許容範囲をも教示し、
運転時には、設定された動作許容範囲内でワークが搬送
されるように、各アームの回動範囲を規制する。
うにする。 【解決手段】 ワークの搬送経路を予め教示しておくと
共に、その搬送軌跡に対する動作許容範囲をも教示し、
運転時には、設定された動作許容範囲内でワークが搬送
されるように、各アームの回動範囲を規制する。
Description
【0001】
【発明の属する技術分野】本発明は、助力アームの作業
点の位置に応じて移動範囲を規制する機能を持った助力
アームに関する。
点の位置に応じて移動範囲を規制する機能を持った助力
アームに関する。
【0002】
【従来の技術】たとえば、自動車の生産等においては、
重量物を車内に取り付ける等の作業者の作業負担を軽く
するために、特開平6−87476号公報、特開平7−
61799号公報、特開平7−112337号公報に開
示されているような作業補助装置(この明細書では助力
アームという)が用いられている。
重量物を車内に取り付ける等の作業者の作業負担を軽く
するために、特開平6−87476号公報、特開平7−
61799号公報、特開平7−112337号公報に開
示されているような作業補助装置(この明細書では助力
アームという)が用いられている。
【0003】
【発明が解決しようとする課題】しかしながら、このよ
うな従来の助力アームにあっては、ワークの作業点にお
いて、アームをロックしてワークを規定の位置に取り付
けることができるようにしたり、アームの揺動を規制し
てワークが揺動しないようにしたりすることができるよ
うにはなっているものの、ワークを搬送する途中の経路
では全くフリーの状態になっているので、ワークの搬送
途中でワークを他の生産機械にぶつけてしまったり、擦
ってしまったりしてワークを傷付ける恐れがある。
うな従来の助力アームにあっては、ワークの作業点にお
いて、アームをロックしてワークを規定の位置に取り付
けることができるようにしたり、アームの揺動を規制し
てワークが揺動しないようにしたりすることができるよ
うにはなっているものの、ワークを搬送する途中の経路
では全くフリーの状態になっているので、ワークの搬送
途中でワークを他の生産機械にぶつけてしまったり、擦
ってしまったりしてワークを傷付ける恐れがある。
【0004】通常は、作業者がこのようなことが起こら
ないように注意しながらワークを搬送させるが、非常に
重たいワークを狭小な場所で搬送させなければならない
ような場合には、ワークの慣性質量が大きいので、ワー
クをぶつけたりしないように、また、搬送中に怪我をし
ないようにするために、その搬送には細心の注意を払わ
なければならず、これが作業者の疲れの原因となった
り、作業効率を悪化させる原因となる。
ないように注意しながらワークを搬送させるが、非常に
重たいワークを狭小な場所で搬送させなければならない
ような場合には、ワークの慣性質量が大きいので、ワー
クをぶつけたりしないように、また、搬送中に怪我をし
ないようにするために、その搬送には細心の注意を払わ
なければならず、これが作業者の疲れの原因となった
り、作業効率を悪化させる原因となる。
【0005】このような問題を解決するためには、産業
用ロボットを使用するのも1つの方法ではあるが、車室
内でのワークの取り付け作業がロボットにとって非常に
難しい作業である場合には、ロボットだけで全ての作業
をするというわけにはいかず、結局はロボットと作業者
との共同作業を余儀無くされるが、安全面からこのよう
な共同作業を実現することには問題がある。
用ロボットを使用するのも1つの方法ではあるが、車室
内でのワークの取り付け作業がロボットにとって非常に
難しい作業である場合には、ロボットだけで全ての作業
をするというわけにはいかず、結局はロボットと作業者
との共同作業を余儀無くされるが、安全面からこのよう
な共同作業を実現することには問題がある。
【0006】本発明は、従来の助力アームをさらに改善
することによって、たとえ狭小な場所でもワークの搬送
を容易にすることができ、しかも搬送時の安全性を向上
させ、作業効率を向上させることができる軌跡規制機能
付き助力アームの提供を目的とする。
することによって、たとえ狭小な場所でもワークの搬送
を容易にすることができ、しかも搬送時の安全性を向上
させ、作業効率を向上させることができる軌跡規制機能
付き助力アームの提供を目的とする。
【0007】
【課題を解決するための手段】上記目的を達成するため
の本発明は各請求項毎に次のように構成される。
の本発明は各請求項毎に次のように構成される。
【0008】請求項1に記載の発明にあっては、複数の
アームから構成される助力アームにおいて、ワークが所
定の経路で搬送されるように、ワークの搬送位置を検出
して前記複数のアームそれぞれの回動範囲を制御する制
御手段を設けたことを特徴とする。
アームから構成される助力アームにおいて、ワークが所
定の経路で搬送されるように、ワークの搬送位置を検出
して前記複数のアームそれぞれの回動範囲を制御する制
御手段を設けたことを特徴とする。
【0009】この助力アームを用いて作業者がワークを
搬送する場合には、どこにでも自由にそのワークを搬送
できるというわけではなく、ワークの搬送位置に応じて
規制されるアームの回動範囲内でワークの搬送をするこ
とができる。
搬送する場合には、どこにでも自由にそのワークを搬送
できるというわけではなく、ワークの搬送位置に応じて
規制されるアームの回動範囲内でワークの搬送をするこ
とができる。
【0010】したがって、ワークの搬送軌跡が周囲の障
害物とぶつからない軌跡となるように、それぞれのアー
ムの回動範囲が制御されるので、作業者は障害物にぶつ
からないように気を使いながらワークを搬送する必要が
なくなり、作業効率を向上させることができる。
害物とぶつからない軌跡となるように、それぞれのアー
ムの回動範囲が制御されるので、作業者は障害物にぶつ
からないように気を使いながらワークを搬送する必要が
なくなり、作業効率を向上させることができる。
【0011】請求項2に記載の発明にあっては、複数の
アームから構成される助力アームにおいて、前記複数の
アームの回動位置を検出する回動位置検出手段と、当該
回動位置検出手段によって検出された各アームの回動位
置に基づいて、ワークの搬送位置を演算する搬送位置演
算手段と、前記複数のアームのうち少なくとも1つのア
ームの回動範囲を機械的に規制する規制部材と、当該規
制部材の設定位置を検出する規制部材位置検出手段と、
前記ワークの搬送位置と各アームの規制部材の位置関係
を記憶する記憶手段と、前記規制部材を駆動する駆動手
段と、前記搬送位置演算手段によって演算されたワーク
の搬送位置に基づいて前記記憶手段を参照し、前記規制
部材をそのワークの搬送位置に応じた設定位置に設定す
べく前記駆動手段を制御する制御手段とを有することを
特徴とする。
アームから構成される助力アームにおいて、前記複数の
アームの回動位置を検出する回動位置検出手段と、当該
回動位置検出手段によって検出された各アームの回動位
置に基づいて、ワークの搬送位置を演算する搬送位置演
算手段と、前記複数のアームのうち少なくとも1つのア
ームの回動範囲を機械的に規制する規制部材と、当該規
制部材の設定位置を検出する規制部材位置検出手段と、
前記ワークの搬送位置と各アームの規制部材の位置関係
を記憶する記憶手段と、前記規制部材を駆動する駆動手
段と、前記搬送位置演算手段によって演算されたワーク
の搬送位置に基づいて前記記憶手段を参照し、前記規制
部材をそのワークの搬送位置に応じた設定位置に設定す
べく前記駆動手段を制御する制御手段とを有することを
特徴とする。
【0012】ワークの搬送位置が今どこであるのかは、
各アームの回動位置に基づいて算出される。規制部材の
設定位置は、ワークの搬送位置に基づいて記憶手段に記
憶されているデータに基づいて演算される。このため、
各アームは、ワークの搬送位置に応じてその回動位置が
規制される。
各アームの回動位置に基づいて算出される。規制部材の
設定位置は、ワークの搬送位置に基づいて記憶手段に記
憶されているデータに基づいて演算される。このため、
各アームは、ワークの搬送位置に応じてその回動位置が
規制される。
【0013】したがって、ワークの搬送軌跡が周囲の障
害物とぶつからない軌跡となるように、それぞれのアー
ムの回動範囲が制御されるので、作業者は障害物にぶつ
からないように気を使いながらワークを搬送する必要が
なくなり、作業効率を向上させることができる。
害物とぶつからない軌跡となるように、それぞれのアー
ムの回動範囲が制御されるので、作業者は障害物にぶつ
からないように気を使いながらワークを搬送する必要が
なくなり、作業効率を向上させることができる。
【0014】請求項3に記載の発明にあっては、請求項
2に記載の発明の構成要素に加えて、さらに、前記ワー
クの搬送位置とその搬送位置における動作許容範囲とを
教示する教示ボタンをさらに有し、前記制御手段は、前
記教示ボタンが押されたときに、前記搬送位置演算手段
によって演算されたワークの搬送位置と動作許容範囲と
を前記記憶手段に記憶させる機能をさらに有することを
特徴とする。
2に記載の発明の構成要素に加えて、さらに、前記ワー
クの搬送位置とその搬送位置における動作許容範囲とを
教示する教示ボタンをさらに有し、前記制御手段は、前
記教示ボタンが押されたときに、前記搬送位置演算手段
によって演算されたワークの搬送位置と動作許容範囲と
を前記記憶手段に記憶させる機能をさらに有することを
特徴とする。
【0015】作業者がワークの搬送位置を規制する教示
を行うには、ワークを実際に手で動かして搬送軌跡を教
示すべく教示ボタンを押す。これによって、ワークの現
在の搬送位置が各アームの回動位置として記憶手段に記
憶され、また、同時に動作許容範囲も記憶手段に記憶さ
れる。
を行うには、ワークを実際に手で動かして搬送軌跡を教
示すべく教示ボタンを押す。これによって、ワークの現
在の搬送位置が各アームの回動位置として記憶手段に記
憶され、また、同時に動作許容範囲も記憶手段に記憶さ
れる。
【0016】このように、教示ができるようにしてある
と、レイアウト変更などによってワークの搬送軌跡を変
更する必要が生じた場合等にも臨機応変な対応が可能と
なり、ワークの搬送軌跡や規制範囲を容易に設定するこ
とができることになる。
と、レイアウト変更などによってワークの搬送軌跡を変
更する必要が生じた場合等にも臨機応変な対応が可能と
なり、ワークの搬送軌跡や規制範囲を容易に設定するこ
とができることになる。
【0017】請求項4に記載の発明にあっては、請求項
3の発明の構成に加えて、運転モードと教示モードとを
切り替える操作モードスイッチをさらに有し、前記制御
手段は、当該操作モードスイッチにより運転モードに切
り替えられているときには、前記搬送位置演算手段によ
って演算されたワークの搬送位置に基づいて前記記憶手
段を参照し、前記規制部材をそのワークの搬送位置に応
じた設定位置に設定すべく前記駆動手段を制御する一
方、教示モードに切り替えられているときには、前記教
示ボタンが押されたときに、前記搬送位置演算手段によ
って演算されたワークの搬送位置と動作許容範囲とを前
記記憶手段に記憶させることを特徴とする。
3の発明の構成に加えて、運転モードと教示モードとを
切り替える操作モードスイッチをさらに有し、前記制御
手段は、当該操作モードスイッチにより運転モードに切
り替えられているときには、前記搬送位置演算手段によ
って演算されたワークの搬送位置に基づいて前記記憶手
段を参照し、前記規制部材をそのワークの搬送位置に応
じた設定位置に設定すべく前記駆動手段を制御する一
方、教示モードに切り替えられているときには、前記教
示ボタンが押されたときに、前記搬送位置演算手段によ
って演算されたワークの搬送位置と動作許容範囲とを前
記記憶手段に記憶させることを特徴とする。
【0018】このように操作モードスイッチを運転モー
ドに切り替えることによって、記憶手段に記憶されてい
るデータに基づいてワークの搬送範囲が規制され、ま
た、操作モードスイッチを教示モードに切り替えること
によって記憶手段に記憶されているデータを書き替えて
新たなワークの搬送範囲を設定することができることに
なる。
ドに切り替えることによって、記憶手段に記憶されてい
るデータに基づいてワークの搬送範囲が規制され、ま
た、操作モードスイッチを教示モードに切り替えること
によって記憶手段に記憶されているデータを書き替えて
新たなワークの搬送範囲を設定することができることに
なる。
【0019】請求項5に記載の発明にあっては、複数の
アームから構成される助力アームにおいて、前記複数の
アームそれぞれの回転軸に取り付けられたブレーキ手段
と、前記複数のアームの回動位置を検出する回動位置検
出手段と、当該回動位置検出手段によって検出された各
アームの回動位置に基づいて、ワークの搬送位置を演算
する搬送位置演算手段と、前記ワークの搬送位置とその
搬送位置における動作許容範囲との関係データを記憶す
る記憶手段と、前記搬送位置演算手段によって演算され
たワークの搬送位置に基づいて前記記憶手段の関係デー
タを参照し、前記ワークの搬送位置が動作許容範囲外と
なったときには、少なくとも1つのブレーキを作動させ
る制御手段とを有することを特徴とする。
アームから構成される助力アームにおいて、前記複数の
アームそれぞれの回転軸に取り付けられたブレーキ手段
と、前記複数のアームの回動位置を検出する回動位置検
出手段と、当該回動位置検出手段によって検出された各
アームの回動位置に基づいて、ワークの搬送位置を演算
する搬送位置演算手段と、前記ワークの搬送位置とその
搬送位置における動作許容範囲との関係データを記憶す
る記憶手段と、前記搬送位置演算手段によって演算され
たワークの搬送位置に基づいて前記記憶手段の関係デー
タを参照し、前記ワークの搬送位置が動作許容範囲外と
なったときには、少なくとも1つのブレーキを作動させ
る制御手段とを有することを特徴とする。
【0020】ワークの搬送位置は、各アームの回動位置
に基づいて算出される。算出されたワークの搬送位置が
動作許容範囲外になると、ブレーキ手段が作動し、ワー
クの移動が規制される。
に基づいて算出される。算出されたワークの搬送位置が
動作許容範囲外になると、ブレーキ手段が作動し、ワー
クの移動が規制される。
【0021】このように、ワークの搬送軌跡が周囲の障
害物とぶつからない軌跡となるように、それぞれのアー
ムの回動が制御されるので、作業者は障害物にぶつから
ないように気を使いながらワークを搬送する必要がなく
なり、作業効率を向上させることができる。
害物とぶつからない軌跡となるように、それぞれのアー
ムの回動が制御されるので、作業者は障害物にぶつから
ないように気を使いながらワークを搬送する必要がなく
なり、作業効率を向上させることができる。
【0022】請求項6に記載の発明にあっては、請求項
5に記載の発明の構成要素に加えて、さらに、前記ワー
クの搬送位置とその搬送位置における動作許容範囲とを
教示する教示ボタンをさらに有し、前記制御手段は、前
記教示ボタンが押されたときに、前記搬送位置演算手段
によって演算されたワークの搬送位置と動作許容範囲と
を前記記憶手段に記憶させる機能をさらに有することを
特徴とする。
5に記載の発明の構成要素に加えて、さらに、前記ワー
クの搬送位置とその搬送位置における動作許容範囲とを
教示する教示ボタンをさらに有し、前記制御手段は、前
記教示ボタンが押されたときに、前記搬送位置演算手段
によって演算されたワークの搬送位置と動作許容範囲と
を前記記憶手段に記憶させる機能をさらに有することを
特徴とする。
【0023】作業者がワークの動作許容範囲を教示する
場合には、ワークを実際に手で動かして動作許容の限界
点を教示すべく教示ボタンを押す。これによって、ワー
クの動作許容範囲が記憶手段に記憶される。
場合には、ワークを実際に手で動かして動作許容の限界
点を教示すべく教示ボタンを押す。これによって、ワー
クの動作許容範囲が記憶手段に記憶される。
【0024】このように、教示ができるようにしてある
と、レイアウト変更などによってワークの搬送軌跡を変
更する必要が生じた場合等にも臨機応変な対応が可能と
なり、ワークの搬送軌跡や規制範囲を容易に設定するこ
とができることになる。
と、レイアウト変更などによってワークの搬送軌跡を変
更する必要が生じた場合等にも臨機応変な対応が可能と
なり、ワークの搬送軌跡や規制範囲を容易に設定するこ
とができることになる。
【0025】請求項7に記載の発明にあっては、請求項
6に記載の発明の構成要素に加えて、運転モードと教示
モードとを切り替える操作モードスイッチをさらに有
し、前記制御手段は、当該操作モードスイッチにより運
転モードに切り替えられているときには、前記搬送位置
演算手段によって演算されたワークの搬送位置に基づい
て前記記憶手段の関係データを参照し、前記ワークの搬
送位置が動作許容範囲外となったときには、少なくとも
1つのブレーキを作動させる一方、教示モードに切り替
えられているときには、前記教示ボタンが押されたとき
に、前記搬送位置演算手段によって演算されたワークの
搬送位置と動作許容範囲とを前記記憶手段に記憶させる
ことを特徴とする。
6に記載の発明の構成要素に加えて、運転モードと教示
モードとを切り替える操作モードスイッチをさらに有
し、前記制御手段は、当該操作モードスイッチにより運
転モードに切り替えられているときには、前記搬送位置
演算手段によって演算されたワークの搬送位置に基づい
て前記記憶手段の関係データを参照し、前記ワークの搬
送位置が動作許容範囲外となったときには、少なくとも
1つのブレーキを作動させる一方、教示モードに切り替
えられているときには、前記教示ボタンが押されたとき
に、前記搬送位置演算手段によって演算されたワークの
搬送位置と動作許容範囲とを前記記憶手段に記憶させる
ことを特徴とする。
【0026】このように操作モードスイッチを運転モー
ドに切り替えることによって、記憶手段に記憶されてい
る関係データに基づいてワークの搬送範囲が規制され、
また、操作モードスイッチを教示モードに切り替えるこ
とによって記憶手段に記憶されているデータを書き替え
て新たなワークの搬送範囲を設定することができること
になる。
ドに切り替えることによって、記憶手段に記憶されてい
る関係データに基づいてワークの搬送範囲が規制され、
また、操作モードスイッチを教示モードに切り替えるこ
とによって記憶手段に記憶されているデータを書き替え
て新たなワークの搬送範囲を設定することができること
になる。
【0027】請求項8に記載の発明にあっては、請求項
5に記載の発明において、前記ブレーキ手段は、アーム
の一部に形成された回転規制用突起を収容する切欠が一
部に形成され、当該切欠内に前記回転規制用突起が収容
されるように当該アームの回転軸に回転自在に取り付け
られたディスクと、当該ディスクを停止させるブレーキ
パッド及びキャリパーとから構成されることを特徴とす
る。
5に記載の発明において、前記ブレーキ手段は、アーム
の一部に形成された回転規制用突起を収容する切欠が一
部に形成され、当該切欠内に前記回転規制用突起が収容
されるように当該アームの回転軸に回転自在に取り付け
られたディスクと、当該ディスクを停止させるブレーキ
パッド及びキャリパーとから構成されることを特徴とす
る。
【0028】アームの回転規制用突起はディスクの切欠
に収容されているので、アームの回転によってこの突起
がディスクを回転させることになる。したがって、ディ
スクにブレーキがかけられると、アームが切欠によって
その動きを規制され、さらにワークが動作許容範囲外に
移動することが防止される。
に収容されているので、アームの回転によってこの突起
がディスクを回転させることになる。したがって、ディ
スクにブレーキがかけられると、アームが切欠によって
その動きを規制され、さらにワークが動作許容範囲外に
移動することが防止される。
【0029】このような構成とすると、請求項2から請
求項4に記載された発明に比較して、簡単な構成で同一
の作用を得ることができるようになる。
求項4に記載された発明に比較して、簡単な構成で同一
の作用を得ることができるようになる。
【0030】請求項9に記載の発明にあっては、請求項
8に記載の発明において、前記アームの一部に形成され
た回転規制用突起を収容する切欠は、前記ディスクが停
止されている場合であっても、前記ブレーキ手段の作動
遅れによるオーバーランが原因でワークが前記動作許容
範囲外に出てしまったときに当該ワークを前記動作許容
範囲内に引き戻せるだけの回動幅を有していることを特
徴とする。
8に記載の発明において、前記アームの一部に形成され
た回転規制用突起を収容する切欠は、前記ディスクが停
止されている場合であっても、前記ブレーキ手段の作動
遅れによるオーバーランが原因でワークが前記動作許容
範囲外に出てしまったときに当該ワークを前記動作許容
範囲内に引き戻せるだけの回動幅を有していることを特
徴とする。
【0031】ワークが動作許容範囲外に出ると、自動的
にブレーキがかかるようになっているが、ワークの搬送
速度が速かったり、ワークの重量が重い場合には、ブレ
ーキがかけられてからワークが実際に止まるまでにはオ
ーバーランが予想される。このオーバーランの距離が大
きいと、ワークを引き戻しても動作許容範囲内に位置さ
せることができず、ブレーキがかかったままとなってし
まう。
にブレーキがかかるようになっているが、ワークの搬送
速度が速かったり、ワークの重量が重い場合には、ブレ
ーキがかけられてからワークが実際に止まるまでにはオ
ーバーランが予想される。このオーバーランの距離が大
きいと、ワークを引き戻しても動作許容範囲内に位置さ
せることができず、ブレーキがかかったままとなってし
まう。
【0032】しかし、このように、切欠にある程度の回
転幅(遊び)を設けると、オーバーランした場合であっ
ても、ワークを容易に動作許容範囲内に引き戻すことが
でき、ブレーキを自動的に解除することができるように
なるので、使い勝手が良くなる。ただし、この回転幅を
大きく取り過ぎると、実質的なワークの搬送軌跡幅が広
がってしまい、本願発明の本来の目的(他の生産機械な
どとの干渉防止)を達成することができなくなる恐れが
あるので、この回転幅の設定には十分注意する必要があ
る。また、同様に、この回転幅との兼ね合いで、動作許
容範囲を伸張に設定することも重要である。
転幅(遊び)を設けると、オーバーランした場合であっ
ても、ワークを容易に動作許容範囲内に引き戻すことが
でき、ブレーキを自動的に解除することができるように
なるので、使い勝手が良くなる。ただし、この回転幅を
大きく取り過ぎると、実質的なワークの搬送軌跡幅が広
がってしまい、本願発明の本来の目的(他の生産機械な
どとの干渉防止)を達成することができなくなる恐れが
あるので、この回転幅の設定には十分注意する必要があ
る。また、同様に、この回転幅との兼ね合いで、動作許
容範囲を伸張に設定することも重要である。
【0033】
【発明の実施の形態】以下に、本発明にかかる軌跡規制
機能付き助力アームの第1の実施の形態について詳細に
説明する。図1は、本発明にかかる軌跡規制機能付き助
力アームの側面図であり、図2は、同助力アームの上面
図である。
機能付き助力アームの第1の実施の形態について詳細に
説明する。図1は、本発明にかかる軌跡規制機能付き助
力アームの側面図であり、図2は、同助力アームの上面
図である。
【0034】図1及び図2に示してあるように、この助
力アームは、基柱10に取り付けられ、この基柱10を
支点として垂直方向に回動自在なZ軸アーム20と、こ
のZ軸アーム20の一端に取り付けられ、このZ軸アー
ム20を支点として水平方向に回動自在なA軸アーム3
0と、このA軸アーム30の一端に取り付けられ、この
A軸アーム30を支点として同じく水平方向に回動可能
なB軸アーム40と、このB軸アーム40の一端に回動
自在に取り付けられたハンド(C軸)50とから構成さ
れる、4軸型の助力アームである。
力アームは、基柱10に取り付けられ、この基柱10を
支点として垂直方向に回動自在なZ軸アーム20と、こ
のZ軸アーム20の一端に取り付けられ、このZ軸アー
ム20を支点として水平方向に回動自在なA軸アーム3
0と、このA軸アーム30の一端に取り付けられ、この
A軸アーム30を支点として同じく水平方向に回動可能
なB軸アーム40と、このB軸アーム40の一端に回動
自在に取り付けられたハンド(C軸)50とから構成さ
れる、4軸型の助力アームである。
【0035】図示されてはいないが、この助力アームに
は重力バランス機構が備えられており、ハンド50で把
持されているワークの重量はこの重力バンランス機構に
よって釣り合っている。したがって、ワークが重量物で
あっても、作業酢は軽く力を加えるだけでそのワークを
搬送することができる。
は重力バランス機構が備えられており、ハンド50で把
持されているワークの重量はこの重力バンランス機構に
よって釣り合っている。したがって、ワークが重量物で
あっても、作業酢は軽く力を加えるだけでそのワークを
搬送することができる。
【0036】この助力アームでは、各アームの取り付け
部分に規制部材であるメカストッパーと回動位置検出手
段としてのアーム姿勢検出用エンコーダとが設けてあ
る。図示されているように、基柱10とZ軸アーム20
との接続部分には、Z軸出限用メカストッパー22とZ
軸戻り限用メカストッパー24とが設けられ、Z軸アー
ム20の回動範囲は、この2つのメカストッパー22,
24の設定位置によって規制される。また、このZ軸出
限用メカストッパー22の設定位置は、Z軸出限制御用
モーター26によって調整できるようになっており、ま
た、Z軸戻り限用メカストッパー24の設定位置は、Z
軸戻り限制御用モーター28によって調整できるように
なっている。
部分に規制部材であるメカストッパーと回動位置検出手
段としてのアーム姿勢検出用エンコーダとが設けてあ
る。図示されているように、基柱10とZ軸アーム20
との接続部分には、Z軸出限用メカストッパー22とZ
軸戻り限用メカストッパー24とが設けられ、Z軸アー
ム20の回動範囲は、この2つのメカストッパー22,
24の設定位置によって規制される。また、このZ軸出
限用メカストッパー22の設定位置は、Z軸出限制御用
モーター26によって調整できるようになっており、ま
た、Z軸戻り限用メカストッパー24の設定位置は、Z
軸戻り限制御用モーター28によって調整できるように
なっている。
【0037】また、Z軸アーム20とA軸アーム30と
の接続部分には、A軸出限用メカストッパー32とA軸
戻り限用メカストッパー34とが設けられ、A軸アーム
30の回動範囲は、この2つのメカストッパー32,3
4の設定位置によって規制される。また、このA軸出限
用メカストッパー32の設定位置は、A軸出限制御用モ
ーター36によって調整できるようになっており、ま
た、A軸戻り限用メカストッパー34の設定位置は、A
軸戻り限制御用モーター38によって調整できるように
なっている。
の接続部分には、A軸出限用メカストッパー32とA軸
戻り限用メカストッパー34とが設けられ、A軸アーム
30の回動範囲は、この2つのメカストッパー32,3
4の設定位置によって規制される。また、このA軸出限
用メカストッパー32の設定位置は、A軸出限制御用モ
ーター36によって調整できるようになっており、ま
た、A軸戻り限用メカストッパー34の設定位置は、A
軸戻り限制御用モーター38によって調整できるように
なっている。
【0038】さらに、A軸アーム30とB軸アーム40
との接続部分には、B軸出限用メカストッパー42とB
軸戻り限用メカストッパー44とが設けられ、B軸アー
ム40の回動範囲は、この2つのメカストッパー42,
44の設定位置によって規制される。また、このB軸出
限用メカストッパー42の設定位置は、B軸出限制御用
モーター46によって調整できるようになっており、ま
た、B軸戻り限用メカストッパー44の設定位置は、B
軸戻り限制御用モーター48によって調整できるように
なっている。
との接続部分には、B軸出限用メカストッパー42とB
軸戻り限用メカストッパー44とが設けられ、B軸アー
ム40の回動範囲は、この2つのメカストッパー42,
44の設定位置によって規制される。また、このB軸出
限用メカストッパー42の設定位置は、B軸出限制御用
モーター46によって調整できるようになっており、ま
た、B軸戻り限用メカストッパー44の設定位置は、B
軸戻り限制御用モーター48によって調整できるように
なっている。
【0039】最後に、B軸アーム40とハンド(C軸)
50との接続部分には、C軸出限用用メカストッパー5
2とC軸戻り限用メカストッパー54とが設けられ、ハ
ンド50の回動範囲は、この2つのメカストッパー5
2,54の設定位置によって規制される。また、このC
軸出限メカストッパー52の設定位置は、C軸出限制御
用モーター56によって調整できるようになっており、
また、C軸戻り限用メカストッパー54の設定位置は、
C軸戻り限制御用モーター58によって調整できるよう
になっている。
50との接続部分には、C軸出限用用メカストッパー5
2とC軸戻り限用メカストッパー54とが設けられ、ハ
ンド50の回動範囲は、この2つのメカストッパー5
2,54の設定位置によって規制される。また、このC
軸出限メカストッパー52の設定位置は、C軸出限制御
用モーター56によって調整できるようになっており、
また、C軸戻り限用メカストッパー54の設定位置は、
C軸戻り限制御用モーター58によって調整できるよう
になっている。
【0040】また、Z軸アーム20の回転軸には、図示
されていないがこのZ軸アーム20の回動位置を検出す
るアーム姿勢検出用エンコーダ20Eが、A軸アーム3
0の回転軸にはこのA軸アーム30の回動位置を検出す
るアーム姿勢検出用エンコーダ30Eが、B軸アーム4
0の回転軸にはこのB軸アーム40の回動位置を検出す
るアーム姿勢検出用エンコーダ40Eが、ハンド50の
回転軸にはこのハンド50の回動位置を検出するアーム
姿勢検出用エンコーダ50Eがそれぞれ設けてある。し
たがって、これらのアーム姿勢検出用エンコーダ20E
〜50Eの値によって、ワークの搬送位置を演算するこ
とができる。
されていないがこのZ軸アーム20の回動位置を検出す
るアーム姿勢検出用エンコーダ20Eが、A軸アーム3
0の回転軸にはこのA軸アーム30の回動位置を検出す
るアーム姿勢検出用エンコーダ30Eが、B軸アーム4
0の回転軸にはこのB軸アーム40の回動位置を検出す
るアーム姿勢検出用エンコーダ40Eが、ハンド50の
回転軸にはこのハンド50の回動位置を検出するアーム
姿勢検出用エンコーダ50Eがそれぞれ設けてある。し
たがって、これらのアーム姿勢検出用エンコーダ20E
〜50Eの値によって、ワークの搬送位置を演算するこ
とができる。
【0041】図3は、メカストッパーの詳細な構成図で
ある。図示されているように、出限または戻り限メカス
トッパー22,24(Z軸を例示する)は、アームの回
転軸を中心に回転するプーリー付きの回転部材60,6
2に取り付けられており、Z軸アーム20に接触する部
分には、メカストッパー22,24の破損を防止するた
めのショックアブソーバー23,25が取り付けられて
いる。この回転部材60,62は、ベルトを介してZ軸
出限制御用モータ26,Z軸戻り限制御用モータ28に
よって回動される。これらの制御用モータ26,28内
には、この回転角度を検出するためのエンコーダ26
E,28Eが設けられている。したがって、このエンコ
ーダからの信号に基づいてメカストッパー22,24の
設定位置を認識することができる。なお、このアームの
回転軸には、Z軸アーム20の回動角度を検出するエン
コーダ20Eが取り付けられているのは前述の通りであ
る。
ある。図示されているように、出限または戻り限メカス
トッパー22,24(Z軸を例示する)は、アームの回
転軸を中心に回転するプーリー付きの回転部材60,6
2に取り付けられており、Z軸アーム20に接触する部
分には、メカストッパー22,24の破損を防止するた
めのショックアブソーバー23,25が取り付けられて
いる。この回転部材60,62は、ベルトを介してZ軸
出限制御用モータ26,Z軸戻り限制御用モータ28に
よって回動される。これらの制御用モータ26,28内
には、この回転角度を検出するためのエンコーダ26
E,28Eが設けられている。したがって、このエンコ
ーダからの信号に基づいてメカストッパー22,24の
設定位置を認識することができる。なお、このアームの
回転軸には、Z軸アーム20の回動角度を検出するエン
コーダ20Eが取り付けられているのは前述の通りであ
る。
【0042】図4は、このように構成されている本発明
の助力アームの動作を説明するための図である。この図
は、助力アームを上から見た図であり、水平方向の動作
許容範囲しか示されていないが、実際にはZ軸アーム2
0の垂直方向の動きも規制されているので、動作許容範
囲は3次元となる。
の助力アームの動作を説明するための図である。この図
は、助力アームを上から見た図であり、水平方向の動作
許容範囲しか示されていないが、実際にはZ軸アーム2
0の垂直方向の動きも規制されているので、動作許容範
囲は3次元となる。
【0043】図のA地点からB地点では、ワークを狭い
場所で搬送することを想定しており、作業者がどのよう
にワークを押し引きしても、ワークをこの動作許容範囲
内でしか動かすことができないように、各メカストッパ
ーの設定位置が狭く制御される。同様に、B地点からC
地点までは、図示されている動作許容範囲でワークの搬
送が行われるように各メカストッパーの設定位置がA地
点からB地点の場合よりも広く制御される。
場所で搬送することを想定しており、作業者がどのよう
にワークを押し引きしても、ワークをこの動作許容範囲
内でしか動かすことができないように、各メカストッパ
ーの設定位置が狭く制御される。同様に、B地点からC
地点までは、図示されている動作許容範囲でワークの搬
送が行われるように各メカストッパーの設定位置がA地
点からB地点の場合よりも広く制御される。
【0044】このように、ワークの搬送位置に応じて各
メカストッパーの設定位置を調整することによって、動
作許容範囲を図示のような範囲に設定することができ
る。したがって、動作許容範囲外に障害物が存在してい
るとしても、作業者はその障害物を意識することなくワ
ークの搬送をすることができる。
メカストッパーの設定位置を調整することによって、動
作許容範囲を図示のような範囲に設定することができ
る。したがって、動作許容範囲外に障害物が存在してい
るとしても、作業者はその障害物を意識することなくワ
ークの搬送をすることができる。
【0045】次に、このような動作範囲の設定を自動的
に行う制御装置について説明する。図5は、制御装置に
接続される操作盤の正面図である。同図(a)は、ハン
ド50に取り付けられる操作盤の正面図であり、作業者
が操作しやすい場所に取り付けられる。操作盤70に
は、後述する教示モード時に押してワークの搬送位置や
各メカストッパーの設定位置を記憶させる教示釦72
と、運転開始又は教示開始時に押して各アームの原位置
を設定するマスタリング釦74とが設けられている。
に行う制御装置について説明する。図5は、制御装置に
接続される操作盤の正面図である。同図(a)は、ハン
ド50に取り付けられる操作盤の正面図であり、作業者
が操作しやすい場所に取り付けられる。操作盤70に
は、後述する教示モード時に押してワークの搬送位置や
各メカストッパーの設定位置を記憶させる教示釦72
と、運転開始又は教示開始時に押して各アームの原位置
を設定するマスタリング釦74とが設けられている。
【0046】同図(b)は、図示されていないが、本発
明の助力アームに接続される制御装置の操作盤の正面図
である。この操作盤80には、教示モードと運転モード
とを切り替える操作モードスイッチ82と、運転準備状
態にするための運転準備入りスイッチ83と、運転準備
状態を解除する運転準備切りスイッチ84と、教示デー
タの修正作業をするためのタッチパネル表示部85とが
設けられている。
明の助力アームに接続される制御装置の操作盤の正面図
である。この操作盤80には、教示モードと運転モード
とを切り替える操作モードスイッチ82と、運転準備状
態にするための運転準備入りスイッチ83と、運転準備
状態を解除する運転準備切りスイッチ84と、教示デー
タの修正作業をするためのタッチパネル表示部85とが
設けられている。
【0047】図6は、制御装置の概略構成を示すブロッ
ク図である。制御装置90は、アーム姿勢検出用エンコ
ーダ20E,30E,40E,50Eからのパルス信号
を高速でカウントする高速カウンタ92と、高速カウン
タ92のカウント値と制御用モータ(ACサーボモー
タ)26,28,36,38,46,48,56,58
のエンコーダ26E,28E,36E,38E,46
E,48E,56E,58Eのカウント値とを記憶する
RAM94と、ACサーボモータ26,28,36,3
8,46,48,56,58の動作を制御するACサー
ボドライバ100に位置決めの指令を出力したり、エン
コーダ26E,28E,36E,38E,46E,48
E,56E,58Eのカウント値を取り出す位置決めユ
ニット96と、前述の制御盤70,80に設けられてい
る各種のスイッチ類の信号を入力して、位置決めユニッ
ト96やRAM94とのデータの入出力を制御するCP
U(シーケンサ)98とから構成される。
ク図である。制御装置90は、アーム姿勢検出用エンコ
ーダ20E,30E,40E,50Eからのパルス信号
を高速でカウントする高速カウンタ92と、高速カウン
タ92のカウント値と制御用モータ(ACサーボモー
タ)26,28,36,38,46,48,56,58
のエンコーダ26E,28E,36E,38E,46
E,48E,56E,58Eのカウント値とを記憶する
RAM94と、ACサーボモータ26,28,36,3
8,46,48,56,58の動作を制御するACサー
ボドライバ100に位置決めの指令を出力したり、エン
コーダ26E,28E,36E,38E,46E,48
E,56E,58Eのカウント値を取り出す位置決めユ
ニット96と、前述の制御盤70,80に設けられてい
る各種のスイッチ類の信号を入力して、位置決めユニッ
ト96やRAM94とのデータの入出力を制御するCP
U(シーケンサ)98とから構成される。
【0048】次に、図7と図8のフローチャートに基づ
いて、本発明の助力アームの動作を詳細に説明する。図
7に示すフローチャートは、操作モードスイッチ82が
教示モードに設定されている場合に処理される教示作業
を示したものである。
いて、本発明の助力アームの動作を詳細に説明する。図
7に示すフローチャートは、操作モードスイッチ82が
教示モードに設定されている場合に処理される教示作業
を示したものである。
【0049】運転準備入りスイッチ83がONされてい
る場合には、各アーム20,30,40,50に設けら
れているメカストッパー22,24,32,34,4
2,44,52,54を解放状態にして、各アームの自
由度を最大限にする。つまり、一般的な助力アームと同
じくなるようにする(S1,S2)。
る場合には、各アーム20,30,40,50に設けら
れているメカストッパー22,24,32,34,4
2,44,52,54を解放状態にして、各アームの自
由度を最大限にする。つまり、一般的な助力アームと同
じくなるようにする(S1,S2)。
【0050】つぎに、各アームの原位置を出すために、
各アームをマスタリング治具に合わせる。このマスタリ
ング治具にハンド50を位置決めすると、全てのアーム
の自由度がなくなり、決められたポジションとなる。こ
の位置を原位置としている(S3,S4)。原位置が確
認されると、作業者はマスタリング釦74をONし、高
速カウンタ92等のカウント値を0にリセットする。そ
して再びメカストッパー22,24,32,34,4
2,44,52,54を解放状態にする(S5)。
各アームをマスタリング治具に合わせる。このマスタリ
ング治具にハンド50を位置決めすると、全てのアーム
の自由度がなくなり、決められたポジションとなる。こ
の位置を原位置としている(S3,S4)。原位置が確
認されると、作業者はマスタリング釦74をONし、高
速カウンタ92等のカウント値を0にリセットする。そ
して再びメカストッパー22,24,32,34,4
2,44,52,54を解放状態にする(S5)。
【0051】この状態で、作業者は理想的な経路でワー
クを搬送する。この教示中にCPU98は動作許容範囲
のパラメータを設定する。この動作許容範囲のパラメー
タとは、教示軌跡からの許容範囲を距離で示したもので
あり、この許容範囲のパラメータを大きくとれば動作許
容範囲は大きくなり、小さくとれば動作許容範囲は小さ
くなる。この動作許容範囲は教示軌跡を中心とする円と
して設定することもできるし、長方形の辺の長さで設定
することもできる。
クを搬送する。この教示中にCPU98は動作許容範囲
のパラメータを設定する。この動作許容範囲のパラメー
タとは、教示軌跡からの許容範囲を距離で示したもので
あり、この許容範囲のパラメータを大きくとれば動作許
容範囲は大きくなり、小さくとれば動作許容範囲は小さ
くなる。この動作許容範囲は教示軌跡を中心とする円と
して設定することもできるし、長方形の辺の長さで設定
することもできる。
【0052】たとえば、円として設定する場合には、教
示軌跡に対して半径rを設定する。このように設定する
と、教示軌跡から半径rの範囲が動作許容範囲となる。
示軌跡に対して半径rを設定する。このように設定する
と、教示軌跡から半径rの範囲が動作許容範囲となる。
【0053】また、長方形として設定する場合には、教
示軌跡に対して縦横2辺の長さX,Yを設定する。この
ように設定すると、教示軌跡を中心とする縦横の辺の長
さがX,Yである長方形の範囲が動作許容範囲となる
(S6,S7)。
示軌跡に対して縦横2辺の長さX,Yを設定する。この
ように設定すると、教示軌跡を中心とする縦横の辺の長
さがX,Yである長方形の範囲が動作許容範囲となる
(S6,S7)。
【0054】CPU98は、このパラメータの設定にし
たがって、動作許容限界領域を演算する。たとえば、助
力アームの設置されている周辺の障害物の設置データに
したがって、ワークがそれらの障害物に干渉しない限界
の領域を演算する(S8)。CPU98は、S7のステ
ップのパラメータにより設定された動作許容範囲がS8
のステップの動作許容限界領域と干渉するか判断し、干
渉する場合には、そのパラメータの設定では、搬送中に
ワークが障害物にぶつかる恐れがあるので、もう一度パ
ラメータの設定をし直し、干渉しない場合には、データ
は有効であるとしてRAM94に動作許容範囲のデータ
を保存する。具体的には、各アームのメカストッパーの
設定位置とワークの位置(各アームのアーム姿勢検出用
エンコーダのパルス数)との関係が記憶される(S9,
S10)。以上のようにして動作許容範囲を教示する。
たがって、動作許容限界領域を演算する。たとえば、助
力アームの設置されている周辺の障害物の設置データに
したがって、ワークがそれらの障害物に干渉しない限界
の領域を演算する(S8)。CPU98は、S7のステ
ップのパラメータにより設定された動作許容範囲がS8
のステップの動作許容限界領域と干渉するか判断し、干
渉する場合には、そのパラメータの設定では、搬送中に
ワークが障害物にぶつかる恐れがあるので、もう一度パ
ラメータの設定をし直し、干渉しない場合には、データ
は有効であるとしてRAM94に動作許容範囲のデータ
を保存する。具体的には、各アームのメカストッパーの
設定位置とワークの位置(各アームのアーム姿勢検出用
エンコーダのパルス数)との関係が記憶される(S9,
S10)。以上のようにして動作許容範囲を教示する。
【0055】図8は、このようにして教示されたデータ
に基づいて運転される場合の動作フローチャートであ
り、操作モードスイッチ82が運転モードに設定されて
いる場合に行われる処理である。
に基づいて運転される場合の動作フローチャートであ
り、操作モードスイッチ82が運転モードに設定されて
いる場合に行われる処理である。
【0056】運転準備入りスイッチ83がONされてい
る場合には、各アーム20,30,40,50に設けら
れているメカストッパー22,24,32,34,4
2,44,52,54を解放状態にして、各アームの自
由度を最大限にする。つまり、一般的な助力アームと同
じくなるようにする(S11,S12)。
る場合には、各アーム20,30,40,50に設けら
れているメカストッパー22,24,32,34,4
2,44,52,54を解放状態にして、各アームの自
由度を最大限にする。つまり、一般的な助力アームと同
じくなるようにする(S11,S12)。
【0057】つぎに、各アームの原位置を出すために、
各アームをマスタリング治具に合わせる。このマスタリ
ング治具にハンド50を位置決めすると、全てのアーム
の自由度がなくなり、決められたポジションとなる。こ
の位置を原位置としている(S13,S14)。原位置
が確認されると、作業者はマスタリング釦74をON
し、高速カウンタ92等のカウント値を0にリセットす
る(S15)。
各アームをマスタリング治具に合わせる。このマスタリ
ング治具にハンド50を位置決めすると、全てのアーム
の自由度がなくなり、決められたポジションとなる。こ
の位置を原位置としている(S13,S14)。原位置
が確認されると、作業者はマスタリング釦74をON
し、高速カウンタ92等のカウント値を0にリセットす
る(S15)。
【0058】CPU98は、高速カウンタ92でカウン
トされている各アーム20,30,40,50の現在位
置を入力し(S16)、各アームの先端が位置する座標
を演算する(S17)。CPU98は、演算された各ア
ームの先端座標に基づいて、第n軸のみ動作させた場合
のアームの先端動作許容限界ポイントを算出し(S18
〜S20)、その算出された限界ポイントがアームの先
端位置許容限界外でなければ、RAM94に教示されて
いる動作許容範囲のデータから許容限界ポイントにおけ
るメカストッパーの位置を演算する。以上のS20から
S23の処理は全てのアーム(4軸)に対して行う(S
21〜S23)。全てのアームについてのメカストッパ
ーの設定位置の演算が終了すると、CPU98は位置決
めユニット96に各メカストッパーの設定位置を指示
し、位置決めユニット96は、この指令に基づいてAC
サーボドライバ100を作動させてメカストッパーの位
置を指令された位置に設定する(S26)。
トされている各アーム20,30,40,50の現在位
置を入力し(S16)、各アームの先端が位置する座標
を演算する(S17)。CPU98は、演算された各ア
ームの先端座標に基づいて、第n軸のみ動作させた場合
のアームの先端動作許容限界ポイントを算出し(S18
〜S20)、その算出された限界ポイントがアームの先
端位置許容限界外でなければ、RAM94に教示されて
いる動作許容範囲のデータから許容限界ポイントにおけ
るメカストッパーの位置を演算する。以上のS20から
S23の処理は全てのアーム(4軸)に対して行う(S
21〜S23)。全てのアームについてのメカストッパ
ーの設定位置の演算が終了すると、CPU98は位置決
めユニット96に各メカストッパーの設定位置を指示
し、位置決めユニット96は、この指令に基づいてAC
サーボドライバ100を作動させてメカストッパーの位
置を指令された位置に設定する(S26)。
【0059】一方、S21のステップにおいて、S20
のステップで算出された限界ポイントがアームの先端位
置許容限界外である場合には、全てのアームについての
メカストッパーを停止させて、アラームを出力する(S
24,S25)。
のステップで算出された限界ポイントがアームの先端位
置許容限界外である場合には、全てのアームについての
メカストッパーを停止させて、アラームを出力する(S
24,S25)。
【0060】このように、教示は、ワークの搬送軌跡と
その搬送軌跡に対してどの程度外れても良いかの許容値
をパラメータとして設定することによって、ワークの許
容動作範囲という形で記憶させることによって行い、運
転は、この許容動作範囲内でワークが搬送されるよう
に、換言すれば、許容範囲内でしかワークの搬送が行わ
れないように、全てのアームのメカストッパーの位置が
ワークの搬送と共に(実際には各アームの先端座標に応
じて)調整される。
その搬送軌跡に対してどの程度外れても良いかの許容値
をパラメータとして設定することによって、ワークの許
容動作範囲という形で記憶させることによって行い、運
転は、この許容動作範囲内でワークが搬送されるよう
に、換言すれば、許容範囲内でしかワークの搬送が行わ
れないように、全てのアームのメカストッパーの位置が
ワークの搬送と共に(実際には各アームの先端座標に応
じて)調整される。
【0061】したがって、ワークの搬送軌跡が周囲の障
害物とぶつからない軌跡となるように、それぞれのアー
ムの回動範囲が制御されることになり、作業者は障害物
にぶつからないように気を使いながらワークを搬送する
必要がなくなるから、精神的な作業負担が軽くなり、作
業効率を向上させることができる。また、障害物との干
渉によりワークの品質を劣化させる事態の発生も少なく
なる。
害物とぶつからない軌跡となるように、それぞれのアー
ムの回動範囲が制御されることになり、作業者は障害物
にぶつからないように気を使いながらワークを搬送する
必要がなくなるから、精神的な作業負担が軽くなり、作
業効率を向上させることができる。また、障害物との干
渉によりワークの品質を劣化させる事態の発生も少なく
なる。
【0062】つぎに、本発明にかかる軌跡規制機能付き
助力アームの第2の実施の形態について説明する。この
実施の形態では、第1の実施の形態のようにメカストッ
パーによってアームの回動範囲を規制するのではなく、
ブレーキを用いてアームの回動範囲を規制しようとする
ものである。このように、ブレーキで回動範囲を規制す
るようにすれば、メカストッパーの駆動手段や位置決め
制御のための制御装置が不要となるので、機構の簡素化
と制御の簡素化を図ることができることになり、低コス
ト化と信頼性の向上という相反する事項を同時に満足す
ることができるようになる。
助力アームの第2の実施の形態について説明する。この
実施の形態では、第1の実施の形態のようにメカストッ
パーによってアームの回動範囲を規制するのではなく、
ブレーキを用いてアームの回動範囲を規制しようとする
ものである。このように、ブレーキで回動範囲を規制す
るようにすれば、メカストッパーの駆動手段や位置決め
制御のための制御装置が不要となるので、機構の簡素化
と制御の簡素化を図ることができることになり、低コス
ト化と信頼性の向上という相反する事項を同時に満足す
ることができるようになる。
【0063】図9は、複数のアームのそれぞれの回転軸
に取り付けられたブレーキ手段の構成を示す図である。
同図(A)は、ブレーキ手段をアームの軸方向から見た
正面図であり、(B)は、この図の側面図である。な
お、以降はA軸アーム30を例として説明する。
に取り付けられたブレーキ手段の構成を示す図である。
同図(A)は、ブレーキ手段をアームの軸方向から見た
正面図であり、(B)は、この図の側面図である。な
お、以降はA軸アーム30を例として説明する。
【0064】これらの図に示すように、アーム30は、
ベアリングによって回転自在に支持された回転軸30A
に固定して取り付けられている。また、このアーム30
が回転軸30Aにはめ込まれるボス部30Bには、ディ
スク31が回動自在に取り付けられている。このディス
ク31の一部には、アーム30の一部に形成された回転
規制用突起33を収容する切欠35が形成されている。
この切欠35は、一定の回動幅Lを有している。 アー
ム30の回転規制用突起33は、ディスク31の切欠3
5の内部に常に位置されているので、アーム30が回動
すると、この切欠35がディスク31の側面35Aに当
接しながらディスク31を回転させることになる。この
ディスク31には、ブレーキパッド37とキャリパー3
9とから構成されるブレーキ41が設けられている。こ
のブレーキ41は、後述のブレーキ制御ユニットによっ
てその動作が制御されるが、ブレーキ41によってディ
スク31が固定されると、アーム30は、回転幅Lの範
囲内でのみ回動できるようになる。
ベアリングによって回転自在に支持された回転軸30A
に固定して取り付けられている。また、このアーム30
が回転軸30Aにはめ込まれるボス部30Bには、ディ
スク31が回動自在に取り付けられている。このディス
ク31の一部には、アーム30の一部に形成された回転
規制用突起33を収容する切欠35が形成されている。
この切欠35は、一定の回動幅Lを有している。 アー
ム30の回転規制用突起33は、ディスク31の切欠3
5の内部に常に位置されているので、アーム30が回動
すると、この切欠35がディスク31の側面35Aに当
接しながらディスク31を回転させることになる。この
ディスク31には、ブレーキパッド37とキャリパー3
9とから構成されるブレーキ41が設けられている。こ
のブレーキ41は、後述のブレーキ制御ユニットによっ
てその動作が制御されるが、ブレーキ41によってディ
スク31が固定されると、アーム30は、回転幅Lの範
囲内でのみ回動できるようになる。
【0065】このように切欠35に回動幅Lを設けたこ
とによって、後に詳述するが、前記ブレーキ41の作動
遅れによるオーバーランが原因でワークが動作許容範囲
外に出てしまった場合でも、当該ワークを動作許容範囲
内に引き戻すことができ、自動的にブレーキを解除する
ことができるようになる。
とによって、後に詳述するが、前記ブレーキ41の作動
遅れによるオーバーランが原因でワークが動作許容範囲
外に出てしまった場合でも、当該ワークを動作許容範囲
内に引き戻すことができ、自動的にブレーキを解除する
ことができるようになる。
【0066】図10は、このように構成されている本発
明の助力アームの動作を説明するための図である。この
図は、助力アームを上から見た図であり、水平方向の動
作許容範囲しか示されていないが、実際にはZ軸アーム
20の垂直方向の動きも規制されているので、動作許容
範囲は3次元となる。
明の助力アームの動作を説明するための図である。この
図は、助力アームを上から見た図であり、水平方向の動
作許容範囲しか示されていないが、実際にはZ軸アーム
20の垂直方向の動きも規制されているので、動作許容
範囲は3次元となる。
【0067】図のA地点からB地点では、ワークを狭い
場所で搬送することを想定しており、作業者がどのよう
にワークを押し引きしても、ワークをこの動作許容範囲
内でしか動かすことができないように、ブレーキ41の
作動範囲が大きくなる。つまり、動作許容範囲が狭いの
で、動作許容範囲外にはみ出す機会が多くなり、ブレー
キ41を作動させるべき領域が広くなるのである。同様
に、B地点からC地点までは、図示されている動作許容
範囲でワークの搬送が行われるようにブレーキ41の作
動が制御される。
場所で搬送することを想定しており、作業者がどのよう
にワークを押し引きしても、ワークをこの動作許容範囲
内でしか動かすことができないように、ブレーキ41の
作動範囲が大きくなる。つまり、動作許容範囲が狭いの
で、動作許容範囲外にはみ出す機会が多くなり、ブレー
キ41を作動させるべき領域が広くなるのである。同様
に、B地点からC地点までは、図示されている動作許容
範囲でワークの搬送が行われるようにブレーキ41の作
動が制御される。
【0068】なお、ブレーキ41は、各軸に設けられて
いるので、ワークが動作許容範囲外に出たときには、全
てのブレーキ41を一斉にかけるようにすることが望ま
しいが、動作許容範囲の広さによっては、1つの軸をフ
リーにしていても動作許容範囲外に出てしまうことがな
いような特別の場合には、特定のブレーキのみをかける
ようにすることも可能である。
いるので、ワークが動作許容範囲外に出たときには、全
てのブレーキ41を一斉にかけるようにすることが望ま
しいが、動作許容範囲の広さによっては、1つの軸をフ
リーにしていても動作許容範囲外に出てしまうことがな
いような特別の場合には、特定のブレーキのみをかける
ようにすることも可能である。
【0069】このように、ワークの搬送位置に応じてブ
レーキ41のON,OFFを制御することによって、ブ
レーキを各軸アームの出戻限として作用させることがで
き、動作許容範囲を図示のような範囲とすることができ
る。したがって、動作許容範囲外に障害物が存在してい
るとしても、作業者はその障害物を意識することなくワ
ークの搬送をすることができる。
レーキ41のON,OFFを制御することによって、ブ
レーキを各軸アームの出戻限として作用させることがで
き、動作許容範囲を図示のような範囲とすることができ
る。したがって、動作許容範囲外に障害物が存在してい
るとしても、作業者はその障害物を意識することなくワ
ークの搬送をすることができる。
【0070】次に、このような動作範囲の設定を自動的
に行う制御装置について説明する。図11は、制御装置
の概略構成を示すブロック図である。制御装置90は、
アーム姿勢検出用エンコーダ20E,30E,40E,
50Eからのパルス信号を高速でカウントする高速カウ
ンタ92と、高速カウンタ92のカウント値を記憶する
RAM94と、前述の制御盤70,80に設けられてい
る各種のスイッチ類の信号を入力して、ブレーキ制御ユ
ニット102にON,OFFの信号を出力したり、RA
M94とのデータの入出力を制御するCPU(シーケン
サ)98とから構成される。なお、軸数分設けられてい
るブレーキ41は、ブレーキ制御ユニット102からの
信号によって動作する。
に行う制御装置について説明する。図11は、制御装置
の概略構成を示すブロック図である。制御装置90は、
アーム姿勢検出用エンコーダ20E,30E,40E,
50Eからのパルス信号を高速でカウントする高速カウ
ンタ92と、高速カウンタ92のカウント値を記憶する
RAM94と、前述の制御盤70,80に設けられてい
る各種のスイッチ類の信号を入力して、ブレーキ制御ユ
ニット102にON,OFFの信号を出力したり、RA
M94とのデータの入出力を制御するCPU(シーケン
サ)98とから構成される。なお、軸数分設けられてい
るブレーキ41は、ブレーキ制御ユニット102からの
信号によって動作する。
【0071】次に、図12と図13のフローチャートに
基づいて、本発明の助力アームの動作を詳細に説明す
る。図12に示すフローチャートは、操作モードスイッ
チ82が教示モードに設定されている場合に処理される
教示作業を示したものである。
基づいて、本発明の助力アームの動作を詳細に説明す
る。図12に示すフローチャートは、操作モードスイッ
チ82が教示モードに設定されている場合に処理される
教示作業を示したものである。
【0072】運転準備入りスイッチ83がONされてい
る場合には、各アーム20,30,40,50に設けら
れているブレーキ41の全てを解放状態にして、各アー
ムの自由度を最大限にする。つまり、一般的な助力アー
ムと同じくなるようにする(S41,S42)。
る場合には、各アーム20,30,40,50に設けら
れているブレーキ41の全てを解放状態にして、各アー
ムの自由度を最大限にする。つまり、一般的な助力アー
ムと同じくなるようにする(S41,S42)。
【0073】つぎに、各アームの原位置を出すために、
各アームをマスタリング治具に合わせる。このマスタリ
ング治具にハンド50を位置決めすると、全てのアーム
の自由度がなくなり、決められたポジションとなる。こ
の位置を原位置としている(S43,S44)。
各アームをマスタリング治具に合わせる。このマスタリ
ング治具にハンド50を位置決めすると、全てのアーム
の自由度がなくなり、決められたポジションとなる。こ
の位置を原位置としている(S43,S44)。
【0074】原位置が確認されると、作業者はマスタリ
ング釦74をONし、高速カウンタ92等のカウント値
を0にリセットする。そして再びブレーキ41の全てを
解放状態にする(S45,S46)。
ング釦74をONし、高速カウンタ92等のカウント値
を0にリセットする。そして再びブレーキ41の全てを
解放状態にする(S45,S46)。
【0075】この状態で、作業者は理想的な経路でワー
クを搬送する。この教示中にCPU98は動作許容範囲
のパラメータを設定する。この動作許容範囲のパラメー
タとは、教示軌跡からの許容範囲を距離で示したもので
あり、この許容範囲のパラメータを大きくとれば動作許
容範囲は大きくなり、小さくとれば動作許容範囲は小さ
くなる。この動作許容範囲は教示軌跡を中心とする円と
して設定することもできるし、長方形の辺の長さで設定
することもできる。
クを搬送する。この教示中にCPU98は動作許容範囲
のパラメータを設定する。この動作許容範囲のパラメー
タとは、教示軌跡からの許容範囲を距離で示したもので
あり、この許容範囲のパラメータを大きくとれば動作許
容範囲は大きくなり、小さくとれば動作許容範囲は小さ
くなる。この動作許容範囲は教示軌跡を中心とする円と
して設定することもできるし、長方形の辺の長さで設定
することもできる。
【0076】たとえば、円として設定する場合には、教
示軌跡に対して半径rを設定する。このように設定する
と、教示軌跡から半径rの範囲が動作許容範囲となる。
示軌跡に対して半径rを設定する。このように設定する
と、教示軌跡から半径rの範囲が動作許容範囲となる。
【0077】また、長方形として設定する場合には、教
示軌跡に対して縦横2辺の長さX,Yを設定する。この
ように設定すると、教示軌跡を中心とする縦横の辺の長
さがX,Yである長方形の範囲が動作許容範囲となる
(S47,S48)。
示軌跡に対して縦横2辺の長さX,Yを設定する。この
ように設定すると、教示軌跡を中心とする縦横の辺の長
さがX,Yである長方形の範囲が動作許容範囲となる
(S47,S48)。
【0078】CPU98は、このパラメータの設定にし
たがって、動作許容限界領域を演算する。たとえば、助
力アームの設置されている周辺の障害物の設置データに
したがって、ワークがそれらの障害物に干渉しない限界
の領域を演算する(S49)。CPU98は、S7のス
テップのパラメータにより設定された動作許容範囲がS
49のステップの動作許容限界領域と干渉するか判断
し、干渉する場合には、そのパラメータの設定では、搬
送中にワークが障害物にぶつかる恐れがあるので、もう
一度パラメータの設定をし直し、干渉しない場合には、
データは有効であるとしてRAM94に動作許容範囲の
データを保存する。具体的には、ワークの搬送位置(各
アームのアーム姿勢検出用エンコーダのパルス数)とそ
の搬送位置における動作許容範囲との関係データが記憶
される(S50,S51)。以上のようにして動作許容
範囲を教示する。
たがって、動作許容限界領域を演算する。たとえば、助
力アームの設置されている周辺の障害物の設置データに
したがって、ワークがそれらの障害物に干渉しない限界
の領域を演算する(S49)。CPU98は、S7のス
テップのパラメータにより設定された動作許容範囲がS
49のステップの動作許容限界領域と干渉するか判断
し、干渉する場合には、そのパラメータの設定では、搬
送中にワークが障害物にぶつかる恐れがあるので、もう
一度パラメータの設定をし直し、干渉しない場合には、
データは有効であるとしてRAM94に動作許容範囲の
データを保存する。具体的には、ワークの搬送位置(各
アームのアーム姿勢検出用エンコーダのパルス数)とそ
の搬送位置における動作許容範囲との関係データが記憶
される(S50,S51)。以上のようにして動作許容
範囲を教示する。
【0079】図13は、このようにして教示されたデー
タに基づいて運転される場合の動作フローチャートであ
り、操作モードスイッチ82が運転モードに設定されて
いる場合に行われる処理である。
タに基づいて運転される場合の動作フローチャートであ
り、操作モードスイッチ82が運転モードに設定されて
いる場合に行われる処理である。
【0080】運転準備入りスイッチ83がONされてい
る場合には、各アーム20,30,40,50に設けら
れている全てのブレーキ41を解放状態にして、各アー
ムの自由度を最大限にする。つまり、一般的な助力アー
ムと同じくなるようにする(S61,S62)。
る場合には、各アーム20,30,40,50に設けら
れている全てのブレーキ41を解放状態にして、各アー
ムの自由度を最大限にする。つまり、一般的な助力アー
ムと同じくなるようにする(S61,S62)。
【0081】つぎに、各アームの原位置を出すために、
各アームをマスタリング治具に合わせる。このマスタリ
ング治具にハンド50を位置決めすると、全てのアーム
の自由度がなくなり、決められたポジションとなる。こ
の位置を原位置としている(S63,S64)。原位置
が確認されると、作業者はマスタリング釦74をON
し、高速カウンタ92等のカウント値を0にリセットす
る(S65)。
各アームをマスタリング治具に合わせる。このマスタリ
ング治具にハンド50を位置決めすると、全てのアーム
の自由度がなくなり、決められたポジションとなる。こ
の位置を原位置としている(S63,S64)。原位置
が確認されると、作業者はマスタリング釦74をON
し、高速カウンタ92等のカウント値を0にリセットす
る(S65)。
【0082】CPU98は、高速カウンタ92でカウン
トされている各アーム20,30,40,50の現在位
置を入力し(S66)、アームの先端が位置する座標を
演算する。すなわち、ワークの位置を演算する(S6
7)。CPU98は、演算された各アームの先端座標に
基づいて、ワークが動作許容範囲内に入っているのか、
入っていないのかを判断し、ワークが動作許容範囲内に
入っていれば全てのブレーキをオフしてワークの搬送を
自由に行えるようにし(S70)、一方、ワークが動作
許容範囲外に出てしまったと判断された場合には、CP
U98は、ブレーキ制御ユニット102にブレーキ41
をオンさせるべき信号を出力して、全てのブレーキ41
をオンさせる(S69)。
トされている各アーム20,30,40,50の現在位
置を入力し(S66)、アームの先端が位置する座標を
演算する。すなわち、ワークの位置を演算する(S6
7)。CPU98は、演算された各アームの先端座標に
基づいて、ワークが動作許容範囲内に入っているのか、
入っていないのかを判断し、ワークが動作許容範囲内に
入っていれば全てのブレーキをオフしてワークの搬送を
自由に行えるようにし(S70)、一方、ワークが動作
許容範囲外に出てしまったと判断された場合には、CP
U98は、ブレーキ制御ユニット102にブレーキ41
をオンさせるべき信号を出力して、全てのブレーキ41
をオンさせる(S69)。
【0083】なお、ワークがこのように動作可能領域外
に出てしまった場合には、即座にブレーキがかけられる
ことになるが、このようにブレーキがかかった状態で
も、図9に示したように、ディスク31には切欠35が
設けてあり、また、この切欠は回転幅Lを有しているた
め、アームはこの回転幅L内である程度のガタを持って
ごく小さな角度ではあるが回動でき、このため、一旦動
作可能領域外に出てしまったワークをこの領域内に引き
戻すことができ、これによってブレーキが自動的に解除
されるようになっている。
に出てしまった場合には、即座にブレーキがかけられる
ことになるが、このようにブレーキがかかった状態で
も、図9に示したように、ディスク31には切欠35が
設けてあり、また、この切欠は回転幅Lを有しているた
め、アームはこの回転幅L内である程度のガタを持って
ごく小さな角度ではあるが回動でき、このため、一旦動
作可能領域外に出てしまったワークをこの領域内に引き
戻すことができ、これによってブレーキが自動的に解除
されるようになっている。
【0084】つまり、ブレーキがかかった状態でもアー
ムの回動状態は各軸のエンコーダによって検出されるの
で、回動幅Lの範囲内でアームを動かした結果、ワーク
が領域内に入ったと認識された場合には、即座にブレー
キが開放され、通常の助力アームと同様の搬送を再開す
ることができるのである。
ムの回動状態は各軸のエンコーダによって検出されるの
で、回動幅Lの範囲内でアームを動かした結果、ワーク
が領域内に入ったと認識された場合には、即座にブレー
キが開放され、通常の助力アームと同様の搬送を再開す
ることができるのである。
【0085】このような構成は、ワークが領域外に出る
と同時にブレーキがかかるようになっているもの(オバ
ーランしないもの)では不必要な構成であると言える
が、実際の装置ではワークが領域外に出たことが認識さ
れてからブレーキがかかるまでにタイムラグがあり、ま
た、ワークには慣性質量が作用するので、オーバーラン
を避けることができないので、使い勝手の良い助力アー
ムを構成しようとした場合には、この構成は必須であ
る。
と同時にブレーキがかかるようになっているもの(オバ
ーランしないもの)では不必要な構成であると言える
が、実際の装置ではワークが領域外に出たことが認識さ
れてからブレーキがかかるまでにタイムラグがあり、ま
た、ワークには慣性質量が作用するので、オーバーラン
を避けることができないので、使い勝手の良い助力アー
ムを構成しようとした場合には、この構成は必須であ
る。
【0086】なお、このような構成を採らない場合に
は、ワークが一旦領域外に出てしまうとブレーキがかか
ったままになってしまうので、これを強制的に解除する
解除釦(ブレーキ強制開放釦)を手元等に設け、ワーク
が領域外に出る度にこの釦を操作してワークの搬送を行
わなければならなくなり、非常に煩わしい操作が要求さ
れる助力アームとなってしまう。
は、ワークが一旦領域外に出てしまうとブレーキがかか
ったままになってしまうので、これを強制的に解除する
解除釦(ブレーキ強制開放釦)を手元等に設け、ワーク
が領域外に出る度にこの釦を操作してワークの搬送を行
わなければならなくなり、非常に煩わしい操作が要求さ
れる助力アームとなってしまう。
【0087】このように、教示は、ワークの搬送軌跡と
その搬送軌跡に対してどの程度外れても良いかの許容値
をパラメータとして設定することによって、ワークの許
容動作範囲という形で記憶させることによって行い、運
転は、この許容動作範囲内でワークが搬送されるよう
に、換言すれば、許容範囲内でしかワークの搬送が行わ
れないように、全てのブレーキのオン,オフがワークの
搬送と共に(実際には各アームの先端座標に応じて)制
御される。
その搬送軌跡に対してどの程度外れても良いかの許容値
をパラメータとして設定することによって、ワークの許
容動作範囲という形で記憶させることによって行い、運
転は、この許容動作範囲内でワークが搬送されるよう
に、換言すれば、許容範囲内でしかワークの搬送が行わ
れないように、全てのブレーキのオン,オフがワークの
搬送と共に(実際には各アームの先端座標に応じて)制
御される。
【0088】したがって、ワークの搬送軌跡が周囲の障
害物とぶつからない軌跡となるように、それぞれのアー
ムの回動範囲が制御されることになり、作業者は障害物
にぶつからないように気を使いながらワークを搬送する
必要がなくなるから、精神的な作業負担が軽くなり、作
業効率を向上させることができる。また、障害物との干
渉によりワークの品質を劣化させる事態の発生も少なく
なる。
害物とぶつからない軌跡となるように、それぞれのアー
ムの回動範囲が制御されることになり、作業者は障害物
にぶつからないように気を使いながらワークを搬送する
必要がなくなるから、精神的な作業負担が軽くなり、作
業効率を向上させることができる。また、障害物との干
渉によりワークの品質を劣化させる事態の発生も少なく
なる。
【0089】さらに、第1の実施の形態に比較して、メ
カストッパーを動かす8個のモータやこれらのモータの
制御が不用となり、機構が非常に簡素化されるので、装
置の信頼性を向上させることができ、比較的粗雑な扱い
を受ける現場の使用にも十分に耐えることができる。
カストッパーを動かす8個のモータやこれらのモータの
制御が不用となり、機構が非常に簡素化されるので、装
置の信頼性を向上させることができ、比較的粗雑な扱い
を受ける現場の使用にも十分に耐えることができる。
【0090】
【発明の効果】以上の説明により明らかなように、本発
明の軌跡規制機能付き助力アームによれば、各請求項毎
に次のような効果をする。
明の軌跡規制機能付き助力アームによれば、各請求項毎
に次のような効果をする。
【0091】請求項1及び請求項2に記載の発明では、
ワークの搬送位置を検出して前記複数のアームそれぞれ
の回動範囲を制御するようにしたので、ワークの搬送軌
跡が周囲の障害物とぶつからない軌跡となるように、そ
れぞれのアームの回動範囲が制御されることになり、作
業者は障害物にぶつからないように気を使いながらワー
クを搬送する必要がなくなり、精神的な作業負担が軽く
なり、作業効率を向上させることができる。また、障害
物との干渉によりワークの品質を劣化させる事態の発生
も少なくなる。
ワークの搬送位置を検出して前記複数のアームそれぞれ
の回動範囲を制御するようにしたので、ワークの搬送軌
跡が周囲の障害物とぶつからない軌跡となるように、そ
れぞれのアームの回動範囲が制御されることになり、作
業者は障害物にぶつからないように気を使いながらワー
クを搬送する必要がなくなり、精神的な作業負担が軽く
なり、作業効率を向上させることができる。また、障害
物との干渉によりワークの品質を劣化させる事態の発生
も少なくなる。
【0092】請求項3及び請求項6に記載の発明では、
手動操作によりワークの搬送軌跡と動作許容範囲との教
示をできるようにしたので、レイアウト変更などによっ
てワークの搬送軌跡を変更する必要が生じた場合等にも
臨機応変な対応が可能となり、ワークの搬送軌跡や規制
範囲を容易に設定することができる。
手動操作によりワークの搬送軌跡と動作許容範囲との教
示をできるようにしたので、レイアウト変更などによっ
てワークの搬送軌跡を変更する必要が生じた場合等にも
臨機応変な対応が可能となり、ワークの搬送軌跡や規制
範囲を容易に設定することができる。
【0093】請求項4及び請求項7に記載の発明では、
運転モードと教示モードとを切り替える操作モードスイ
ッチを設けたので、通常の運転と教示とを容易に切り替
えることができる。
運転モードと教示モードとを切り替える操作モードスイ
ッチを設けたので、通常の運転と教示とを容易に切り替
えることができる。
【0094】請求項5及び請求項8に記載の発明では、
ブレーキ手段をオン,オフさせることによってブレーキ
をアームの出戻限として機能させるようにし、ワークの
搬送位置を検出して前記複数のアームそれぞれの回動範
囲を制御するようにしたので、ワークの搬送軌跡が周囲
の障害物とぶつからない軌跡となるように、それぞれの
アームの回動範囲が制御されることになり、作業者は障
害物にぶつからないように気を使いながらワークを搬送
する必要がなくなり、精神的な作業負担が軽くなり、作
業効率を向上させることができる。また、障害物との干
渉によりワークの品質を劣化させる事態の発生も少なく
なる。
ブレーキ手段をオン,オフさせることによってブレーキ
をアームの出戻限として機能させるようにし、ワークの
搬送位置を検出して前記複数のアームそれぞれの回動範
囲を制御するようにしたので、ワークの搬送軌跡が周囲
の障害物とぶつからない軌跡となるように、それぞれの
アームの回動範囲が制御されることになり、作業者は障
害物にぶつからないように気を使いながらワークを搬送
する必要がなくなり、精神的な作業負担が軽くなり、作
業効率を向上させることができる。また、障害物との干
渉によりワークの品質を劣化させる事態の発生も少なく
なる。
【0095】さらに、ブレーキのオン,オフによってワ
ークが動作可能領域外に出ないように制御しているの
で、機構が非常に簡素なものとなり、助力アームの信頼
性を向上させることができ、比較的粗雑な扱いを受ける
現場の使用にも十分に耐えることができる。
ークが動作可能領域外に出ないように制御しているの
で、機構が非常に簡素なものとなり、助力アームの信頼
性を向上させることができ、比較的粗雑な扱いを受ける
現場の使用にも十分に耐えることができる。
【0096】請求項9に記載の発明にあっては、アーム
の一部に形成された回転規制用突起を収容する切欠は、
ディスクが停止されている場合であっても、ブレーキ手
段の作動遅れによるオーバーランが原因でワークが前記
動作許容範囲外に出てしまったときに当該ワークを前記
動作許容範囲内に引き戻せるだけの回動幅を有している
ので、ワークが領域外に出てしまったときに、これを領
域内に引き込むための解除機構が不要となり、非常に操
作性のよい助力アームとすることができる。
の一部に形成された回転規制用突起を収容する切欠は、
ディスクが停止されている場合であっても、ブレーキ手
段の作動遅れによるオーバーランが原因でワークが前記
動作許容範囲外に出てしまったときに当該ワークを前記
動作許容範囲内に引き戻せるだけの回動幅を有している
ので、ワークが領域外に出てしまったときに、これを領
域内に引き込むための解除機構が不要となり、非常に操
作性のよい助力アームとすることができる。
【図1】 本発明にかかる軌跡規制機能付き助力アーム
の側面図である。
の側面図である。
【図2】 本発明にかかる軌跡規制機能付き助力アーム
の上面図である。
の上面図である。
【図3】 本発明にかかる軌跡規制機能付き助力アーム
のメカストッパー部分の詳細図である。
のメカストッパー部分の詳細図である。
【図4】 本発明にかかる軌跡規制機能付き助力アーム
の動作説明図である。
の動作説明図である。
【図5】 本発明にかかる軌跡規制機能付き助力アーム
の操作盤の正面図であって、(a)は、アームに取り付
けられている操作盤の正面図であり、(b)は、制御装
置の操作板の正面図である。
の操作盤の正面図であって、(a)は、アームに取り付
けられている操作盤の正面図であり、(b)は、制御装
置の操作板の正面図である。
【図6】 本発明にかかる軌跡規制機能付き助力アーム
の第1の制御装置の概略構成を示すブロック図である。
の第1の制御装置の概略構成を示すブロック図である。
【図7】 第1の制御装置の教示動作を示すフローチャ
ートである。
ートである。
【図8】 第1の制御装置の運転動作を示すフローチャ
ートである。
ートである。
【図9】 複数のアームのそれぞれの回転軸に取り付け
られたブレーキ手段の構成を示す図であり、(A)は、
ブレーキ手段をアームの軸方向から見た正面図であり、
(B)は、この図の側面図である。
られたブレーキ手段の構成を示す図であり、(A)は、
ブレーキ手段をアームの軸方向から見た正面図であり、
(B)は、この図の側面図である。
【図10】 本発明にかかる軌跡規制機能付き助力アー
ムの動作説明図である。
ムの動作説明図である。
【図11】 本発明にかかる軌跡規制機能付き助力アー
ムの第2の制御装置の概略構成を示すブロック図であ
る。
ムの第2の制御装置の概略構成を示すブロック図であ
る。
【図12】 第2の制御装置の教示動作を示すフローチ
ャートである。
ャートである。
【図13】 第2の制御装置の運転動作を示すフローチ
ャートである。
ャートである。
20,30,40,50…アーム 22,24,32,34,42,44,52,54…メカストッパー、 26,28,36,38,46,48,56,58…制御用モータ、 20E ,30E ,40E ,50E …アーム姿勢検出用エンコーダ 30A …回転軸、 31…ディスク、 35…切欠、 35A …ディスクの側面、 37…ブレーキパッド、 39…キャリパー、 41…ブレーキ、 L…回転幅、 82…操作モードスイッチ。
───────────────────────────────────────────────────── フロントページの続き (51)Int.Cl.6 識別記号 FI // B23P 21/00 303 B62D 65/00 M B62D 65/00 B66F 19/00 K B66F 19/00 G05B 19/42 B
Claims (9)
- 【請求項1】 複数のアームから構成される助力アーム
において、 ワークが所定の経路で搬送されるように、ワークの搬送
位置を検出して前記複数のアームそれぞれの回動範囲を
制御する制御手段を設けたことを特徴とする軌跡規制機
能付き助力アーム。 - 【請求項2】 複数のアームから構成される助力アーム
において、 前記複数のアームの回動位置を検出する回動位置検出手
段と、 当該回動位置検出手段によって検出された各アームの回
動位置に基づいて、ワークの搬送位置を演算する搬送位
置演算手段と、 前記複数のアームのうち少なくとも1つのアームの回動
範囲を機械的に規制する規制部材と、 当該規制部材の設定位置を検出する規制部材位置検出手
段と、 前記ワークの搬送位置と各アームの規制部材の位置関係
を記憶する記憶手段と、 前記規制部材を駆動する駆動手段と、 前記搬送位置演算手段によって演算されたワークの搬送
位置に基づいて前記記憶手段を参照し、前記規制部材を
そのワークの搬送位置に応じた設定位置に設定すべく前
記駆動手段を制御する制御手段とを有することを特徴と
する軌跡規制機能付き助力アーム。 - 【請求項3】 前記ワークの搬送位置とその搬送位置に
おける動作許容範囲とを教示する教示ボタンをさらに有
し、 前記制御手段は、前記教示ボタンが押されたときに、前
記搬送位置演算手段によって演算されたワークの搬送位
置と動作許容範囲とを前記記憶手段に記憶させる機能を
さらに有することを特徴とする請求項2記載の軌跡規制
機能付き助力アーム。 - 【請求項4】 運転モードと教示モードとを切り替える
操作モードスイッチをさらに有し、 前記制御手段は、当該操作モードスイッチにより運転モ
ードに切り替えられているときには、前記搬送位置演算
手段によって演算されたワークの搬送位置に基づいて前
記記憶手段を参照し、前記規制部材をそのワークの搬送
位置に応じた設定位置に設定すべく前記駆動手段を制御
する一方、教示モードに切り替えられているときには、
前記教示ボタンが押されたときに、前記搬送位置演算手
段によって演算されたワークの搬送位置と動作許容範囲
とを前記記憶手段に記憶させることを特徴とする請求項
3記載の軌跡規制機能付き助力アーム。 - 【請求項5】 複数のアームから構成される助力アーム
において、 前記複数のアームそれぞれの回転軸に取り付けられたブ
レーキ手段と、 前記複数のアームの回動位置を検出する回動位置検出手
段と、 当該回動位置検出手段によって検出された各アームの回
動位置に基づいて、ワークの搬送位置を演算する搬送位
置演算手段と、 前記ワークの搬送位置とその搬送位置における動作許容
範囲との関係データを記憶する記憶手段と、 前記搬送位置演算手段によって演算されたワークの搬送
位置に基づいて前記記憶手段の関係データを参照し、前
記ワークの搬送位置が動作許容範囲外となったときに
は、少なくとも1つのブレーキを作動させる制御手段と
を有することを特徴とする軌跡規制機能付き助力アー
ム。 - 【請求項6】 前記ワークの搬送位置とその搬送位置に
おける動作許容範囲とを教示する教示ボタンをさらに有
し、 前記制御手段は、前記教示ボタンが押されたときに、前
記搬送位置演算手段によって演算されたワークの搬送位
置と動作許容範囲とを前記記憶手段に記憶させる機能を
さらに有することを特徴とする請求項5記載の軌跡規制
機能付き助力アーム。 - 【請求項7】 運転モードと教示モードとを切り替える
操作モードスイッチをさらに有し、 前記制御手段は、当該操作モードスイッチにより運転モ
ードに切り替えられているときには、前記搬送位置演算
手段によって演算されたワークの搬送位置に基づいて前
記記憶手段の関係データを参照し、前記ワークの搬送位
置が動作許容範囲外となったときには、少なくとも1つ
のブレーキを作動させる一方、教示モードに切り替えら
れているときには、前記教示ボタンが押されたときに、
前記搬送位置演算手段によって演算されたワークの搬送
位置と動作許容範囲とを前記記憶手段に記憶させること
を特徴とする請求項6記載の軌跡規制機能付き助力アー
ム。 - 【請求項8】 前記ブレーキ手段は、アームの一部に形
成された回転規制用突起を収容する切欠が一部に形成さ
れ、当該切欠内に前記回転規制用突起が収容されるよう
に当該アームの回転軸に回転自在に取り付けられたディ
スクと、当該ディスクを停止させるブレーキパッド及び
キャリパーとから構成されることを特徴とする請求項5
に記載の軌跡規制機能付き助力アーム。 - 【請求項9】 前記アームの一部に形成された回転規制
用突起を収容する切欠は、前記ディスクが停止されてい
る場合であっても、前記ブレーキ手段の作動遅れによる
オーバーランが原因でワークが前記動作許容範囲外に出
てしまったときに当該ワークを前記動作許容範囲内に引
き戻せるだけの回動幅を有していることを特徴とする請
求項8に記載の軌跡規制機能付き助力アーム。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP9198445A JPH10187221A (ja) | 1996-11-08 | 1997-07-24 | 軌跡規制機能付き助力アーム |
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP8-296678 | 1996-11-08 | ||
JP29667896 | 1996-11-08 | ||
JP9198445A JPH10187221A (ja) | 1996-11-08 | 1997-07-24 | 軌跡規制機能付き助力アーム |
Publications (1)
Publication Number | Publication Date |
---|---|
JPH10187221A true JPH10187221A (ja) | 1998-07-14 |
Family
ID=26510979
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP9198445A Withdrawn JPH10187221A (ja) | 1996-11-08 | 1997-07-24 | 軌跡規制機能付き助力アーム |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPH10187221A (ja) |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2005000537A1 (ja) * | 2003-06-25 | 2005-01-06 | Honda Motor Co., Ltd. | アシスト搬送方法及びその装置 |
WO2005035205A1 (ja) * | 2003-10-10 | 2005-04-21 | Mitsubishi Denki Kabushiki Kaisha | ロボットの制御装置 |
JP2005161376A (ja) * | 2003-12-04 | 2005-06-23 | Matsumoto Kikai Kk | ワーク保持装置でのワーク衝突防止方法 |
JP2007038059A (ja) * | 2005-08-01 | 2007-02-15 | Nagoya Institute Of Technology | 作業補助装置 |
JP2007038314A (ja) * | 2005-08-01 | 2007-02-15 | Nagoya Institute Of Technology | 作業補助装置 |
JP2007098507A (ja) * | 2005-10-04 | 2007-04-19 | Nagoya Institute Of Technology | 作業補助装置 |
JP2009034754A (ja) * | 2007-07-31 | 2009-02-19 | Toyota Motor Corp | パワーアシスト装置およびその制御方法 |
JP2016520493A (ja) * | 2013-04-26 | 2016-07-14 | イョット. シュマルツ ゲゼルシャフト ミット ベシュレンクテル ハフツング | 荷物を手動操作式に移動させる装置 |
CN110181481A (zh) * | 2019-05-09 | 2019-08-30 | 江苏亨通光导新材料有限公司 | 搬运机械手 |
WO2022114042A1 (ja) * | 2020-11-30 | 2022-06-02 | 住友重機械工業株式会社 | 情報処理装置及びピッキング装置 |
DE102021109904A1 (de) | 2021-04-20 | 2022-10-20 | J. Schmalz Gmbh | Handhabungsvorrichtung mit definierter Ruhekonfiguration |
WO2023067659A1 (ja) * | 2021-10-18 | 2023-04-27 | ファナック株式会社 | 制御装置 |
-
1997
- 1997-07-24 JP JP9198445A patent/JPH10187221A/ja not_active Withdrawn
Cited By (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2005000537A1 (ja) * | 2003-06-25 | 2005-01-06 | Honda Motor Co., Ltd. | アシスト搬送方法及びその装置 |
WO2005035205A1 (ja) * | 2003-10-10 | 2005-04-21 | Mitsubishi Denki Kabushiki Kaisha | ロボットの制御装置 |
JPWO2005035205A1 (ja) * | 2003-10-10 | 2006-12-21 | 三菱電機株式会社 | ロボットの制御装置 |
JP4596767B2 (ja) * | 2003-12-04 | 2010-12-15 | マツモト機械株式会社 | ワーク保持装置でのワーク衝突防止方法 |
JP2005161376A (ja) * | 2003-12-04 | 2005-06-23 | Matsumoto Kikai Kk | ワーク保持装置でのワーク衝突防止方法 |
JP2007038059A (ja) * | 2005-08-01 | 2007-02-15 | Nagoya Institute Of Technology | 作業補助装置 |
JP2007038314A (ja) * | 2005-08-01 | 2007-02-15 | Nagoya Institute Of Technology | 作業補助装置 |
JP2007098507A (ja) * | 2005-10-04 | 2007-04-19 | Nagoya Institute Of Technology | 作業補助装置 |
JP2009034754A (ja) * | 2007-07-31 | 2009-02-19 | Toyota Motor Corp | パワーアシスト装置およびその制御方法 |
JP4737160B2 (ja) * | 2007-07-31 | 2011-07-27 | トヨタ自動車株式会社 | パワーアシスト装置およびその制御方法 |
US8326454B2 (en) | 2007-07-31 | 2012-12-04 | Toyota Jidosha Kabushiki Kaisha | Power assist apparatus, and its control method |
JP2016520493A (ja) * | 2013-04-26 | 2016-07-14 | イョット. シュマルツ ゲゼルシャフト ミット ベシュレンクテル ハフツング | 荷物を手動操作式に移動させる装置 |
US10077170B2 (en) | 2013-04-26 | 2018-09-18 | J. Schmalz Gmbh | Device for the hand-guided movement of loads |
CN110181481A (zh) * | 2019-05-09 | 2019-08-30 | 江苏亨通光导新材料有限公司 | 搬运机械手 |
WO2022114042A1 (ja) * | 2020-11-30 | 2022-06-02 | 住友重機械工業株式会社 | 情報処理装置及びピッキング装置 |
DE102021109904A1 (de) | 2021-04-20 | 2022-10-20 | J. Schmalz Gmbh | Handhabungsvorrichtung mit definierter Ruhekonfiguration |
US12030730B2 (en) | 2021-04-20 | 2024-07-09 | J. Schmalz Gmbh | Handling device with defined idle configuration |
WO2023067659A1 (ja) * | 2021-10-18 | 2023-04-27 | ファナック株式会社 | 制御装置 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP2608161B2 (ja) | 産業用ロボットの停止制御方法 | |
JPH10187221A (ja) | 軌跡規制機能付き助力アーム | |
JP2000190262A (ja) | ロボットの制御装置 | |
US4542471A (en) | Robot control system for presetting limit values corresponding to limits of deviation | |
JP2792443B2 (ja) | ローダ装置 | |
JP3421442B2 (ja) | ロボットの位置教示方法及びロボット制御装置 | |
KR960012702B1 (ko) | 플레이백 로보트 | |
JP4240517B2 (ja) | サーボモータおよび多関節ロボットの異常負荷検出制御方法 | |
JPH0283185A (ja) | 産業用ロボットの教示方法と装置 | |
JP2002066969A (ja) | 移動ロボット | |
JPH05318359A (ja) | 工業用ロボット | |
JP4538859B2 (ja) | 工業用ロボット | |
JP2888063B2 (ja) | 車両用ドアの開閉制御装置 | |
JPS6213151B2 (ja) | ||
JP2000308990A (ja) | 工業用ロボット | |
JPS61206007A (ja) | サ−ボモ−タ制御方式 | |
JPH03100808A (ja) | コンベア付きロボットシステムの教示・再生方法及びその装置 | |
JPS63181011A (ja) | ロボツトの制御方法 | |
JPS60160407A (ja) | 数値制御装置 | |
JPH10279299A (ja) | 軌跡規制機能付き助力アーム | |
JPH1133867A (ja) | 工作機械の工具干渉保護方法及び保護装置 | |
JP2664985B2 (ja) | ティーチングプレイバック式ロボット | |
JP2665001B2 (ja) | ティーチングプレイバック式ロボット | |
JPH04317103A (ja) | 産業用ロボット | |
JPH09155776A (ja) | ロボットの制御装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A300 | Withdrawal of application because of no request for examination |
Free format text: JAPANESE INTERMEDIATE CODE: A300 Effective date: 20041005 |