JPH06114763A - ロボット可動部の位置決め方法及びその装置 - Google Patents

Abstract

(57)【要約】 【目的】 粗い位置情報によっても正確に位置決めする
ことのできる位置決め装置を提案する。 【構成】 ロボットのハンド機構を移動させるためのサ
ーボモータ１０１を備え、このサーボモータ１０１の移
動位置，移動速度，駆動電流を制御することによりロボ
ットハンド機構の位置決めを位置決め装置において、目
標位置についての粗い位置情報とサーボモータ１０１を
駆動するための電流値データを外部から入力し、前記粗
い位置情報に基づいて目標位置にハンド機構を位置決め
するために、速度誤差検出回路（１３，４）と位置誤差
検出回路（２，２０４）とを含む位置決め制御回路と、
前記ハンド機構の移動状態を検出する監視回路２０と、
前記電流値データに基づいて電流量制御を行なう電流制
御回路８とを具備し、監視回路２０が前記位置決め制御
回路による前記ハンド機構の移動が略ゼロと検出したと
きに、モータ１０１への駆動パスを前記位置決め制御回
路から電流制御回路に切り替える。

Description

【発明の詳細な説明】

【０００１】

【産業上の利用分野】本発明は、ロボットの例えばハン
ド，フィンガやアームなどの可動部の位置決め方法及び
その装置に関するものである。

【０００２】

【従来の技術】従来、産業用ロボットによる組立作業
は、動作手順及び動作位置を予め教示しておき、その教
示手順及び教示位置に従った動作をロボットに行なわせ
ることにより達成されていた。従来のロボット装置の位
置決め制御のブロック図を図１に示す。同図に示すよう
に、フィンがの現在位置をエンコーダ（Ｅ）から得てそ
の現在位置と指令位置との差から移動速度を演算するよ
うにしている。

【０００３】このような従来技術のうち、特開平１−２
４６０８７は、ハンド装置がワークを把持する場合、フ
ィンガ部をある指定された位置（実際のワークサイズ＞
フィンガ部間隔）になるように教示し、その位置でワー
クを把持させるようにしている。また、ワークをトルク
によって制御する方法として、特開平１−１８３３８６
は、歪ゲージ等を用いたトルク検出手段で、フィンガ部
にかかるトルクを検出してこれを電動器にフィードバッ
クしている。

【０００４】さらにワークを力によって制御する単純な
方法として、実開昭５８−５５８８４のように電動器を
電流制御のみで行わせる方法や装置が提案されている。

【０００５】

【発明が解決しようとする課題】ところで、はじ対象の
ワークは重量と大きさを持つ。従って、剛体としてのフ
ィンガがそのワークを把持するためには、教示点に単に
移動したのでは把持できず、また、ワークの大きさも誤
差があったり、ワーク間で大きさが異なっているという
ことがある。従って、以下のような問題が従来にはあっ
た。

【０００６】上記従来例での図１に示されている位置決
め制御ブロック図に従って、ワークを担持するために
は、フィンガの目標位置を数値データとして予め直接入
力したり、あるいはフィンガを実際に動作させ、ワーク
を把持させて、その位置をティーチングするなどといっ
た方法が取られているが、この入力、ティーチング作業
に大変な時間がかかる。また、ワークのサイズに鑑みて
どのくらいのオーバーパルスをフィンガ駆動系に与えて
やれば、目標とする把持力でそのワークを把持するのか
といったことはあまり考慮されておらず、実際には、オ
ペレータがワークをフィンガに実際に把持させ、オペレ
ータは勘に頼ってオーバーパルス数を決定していたの
で、オペレータによりその値はまちまちになってしま
い、不安定であり、また熟練も必要とされていた。

【０００７】また、上記の方法では、一度目標となる位
置を設定してしまうと、そのワークに関しては常に一定
の位置にフィンガ部が位置決めされるので、ワークの寸
法誤差といったものを考慮した時、実際に把持するワー
クが多少小さい場合には、設定しておいた位置へフィン
ガ部が位置決めされても、実際には目標となる把持力が
発生しておらず、ワークがずれてしまったり、最悪の場
合には、まったく把持力が発生しないまま、つまりフィ
ンガがワークを把持をしないまま次の動作へ移行してし
まったりする。また、逆に予め設定しておいたワークサ
イズよりも実際に把持するワークの方が多少、大きい場
合には、目標の把持力よりも、その指令位置へフィンガ
部を位置決めすることにより、目標の把持力よりも大き
な把持力が発生してしまい、ワークを曲げたり、あるい
は壊したりしてしまうことが考えられる。また、剛性が
高いものを把持した場合には、駆動源としてのＤＣサー
ボモータに考えていた以上の電流が流れてしまい、最悪
の場合には容量の小さなＤＣサーボモータでは過電流と
なってしまい、ＤＣサーボモータ自体が壊れてしまう様
な状態が出てきてしまい、問題となる。

【０００８】一方、ワークに加わる把持力を検出して制
御する場合には、フィンガメカ機構部に歪ゲージを取り
付け、この歪ゲージの出力信号を増幅するアンプといっ
たものが必要となるが、このようなゲージの取付けによ
り装置が構成的に複雑なものになってしまい、また、同
時に高価なものになってしまうので、実用性が低くな
る。また、歪ゲージそのものも、信頼性の高いものが無
いといった問題点がある。

【０００９】また、単純な電動器の電流制御のみでは、
位置制御が出来ないのは当然のことで、かつ機構部の摩
擦や剛性の影響で押付力（把持力）に大きな誤差を生じ
てしまう問題がある。そこで、本発明が解決しようとす
る課題は、このような従来の問題点を解決するために提
案されたものでその目的は、目標位置を粗く定義するこ
とが可能であり、それでも確実に対象の可動部を目標位
置に移動することが可能なロボットの可動部の位置決め
方法及びその装置を提案することにある。

【００１０】

【課題を解決するための手段】上記課題を達成するため
の本発明は、ロボットの可動部を移動させるための電動
モータ手段を備え、この電動モータ手段の移動位置，移
動速度，駆動電流を制御することによりロボット可動部
の位置決めを行なう方法において、目標位置についての
粗い位置情報を与え、前記粗い位置情報に基づいて前記
目標位置に可動部を位置決めし、上記粗い位置情報に基
づいた位置決め動作の終了後に、前記電動モータ手段に
所定の電流を供給することを特徴とするロボットの可動
部の位置決め方法。

【００１１】また、上記課題を達成するための本発明に
係る位置決め装置は、ロボットの可動部を移動させるた
めの電動モータ手段を備え、この電動モータ手段の移動
位置，移動速度，駆動電流を制御することによりロボッ
ト可動部の位置決めを位置決め装置において、目標位置
についての粗い位置情報を外部から入力する手段と、前
記電動モータ手段を駆動するための電流値データを外部
から入力する手段と、前記粗い位置情報に基づいて前記
目標位置に可動部を位置決めするために、速度誤差検出
回路と位置誤差検出回路とを含む位置決め制御回路と、
前記可動部の移動状態を検出する検出手段と、前記電流
値データに基づいて電流量制御を行なう電流制御回路
と、前記検出手段が前記位置決め制御回路による前記可
動部の移動が略ゼロと検出したときに、前記モータ手段
への駆動パスを前記位置決め制御回路から電流制御回路
に切り替える切り替え手段とを具備することを特徴とす
る。

【００１２】本発明によれば、可動部をまず粗く位置決
めし、その後は電流制御にだけにより可動部を目標位置
にまで正確に位置決めさせる。

【００１３】

【実施例】以下添付図面を参照して、本発明の好適な実
施例を説明する。 〈構成〉図２は本発明の実施したロボットハンド機構を
示す図である。図２において、１０１はサーボモータ、
１０２はサーボモータ１０１に連結された位置検出用の
パルスエンコーダ、１０３はサーボモータの回転出力軸
に取り付けられたタイミングプーリ、１０４はタイミン
グベルト、１０５はプーリ１０３の反対側に位置するタ
イミングプーリ、１０６は左右両ネジの切られているボ
ールネジである。１０７と１０８は直線ガイドであり、
１０９，１１０は不図示のボールネジ１０６のためのナ
ット（不図示）が取り付けられた可動部であるところの
フィンガ部、１１１，１１２はフィンガ部と固定フレー
ム１１３に別々につけられたフィンガ用のストッパーで
ある。１１５はフィンガ部の原点位置出しする為の原点
センサである。１１４はロボットハンド機構部全体を産
業用ロボット先端に取り付ける為の取付フランジであ
る。

【００１４】このロボットハンド機構の動作は、サーボ
モータ１０１の回転出力を、タイミングプーリ１０３と
タイミングベルト１０４とタイミングプーリ１０５に伝
達し、ボールネジ１０６を回転させる。これにより、フ
ィンガ部１０９，１１０は離れる方向や近づく方向に直
線移動することが出来、この２つのフィンガによりワー
クを把持出来るものである。また、サーボモータ１０１
に取付けられたパルスエンコーダ１０２によって、フィ
ンガ部１０９，１１０の位置は検出できるようになって
いる。また、フィンガ部１０９，１１０の位置原点は、
原点センサ１１５を規準にして設定できるようになって
いる。フィンガ部１０９と１１０は離れる方向に移動し
たとき、フィンガ１０９がフレーム１１３に接触する前
に、フィンガ１１０のストッパー１１２とフレーム１１
３のストッパー１１１が接触するようになっている。

【００１５】図３は本方法を実現する制御装置のハード
構成図を示している。２０１は制御を実現する中央処理
装置（ＣＰＵ）であり、２０２はＣＰＵ２０１とバス結
合され、一連の制御処理アルゴリズムのプログラム及び
マンマシンインターフェースプログラムを含む不揮発性
のメモリ（ＲＯＭ）であり、２０３は教示データを記憶
可能な電源バックアップされたメモリ（ＲＡＭ）であ
る。また、２０４はサーボモータ１０１と連結されたパ
ルスエンコーダ１０２に接続され、サーボモータの現在
位置を計数可能にする現在値カウンタである。２０８は
前記サーボモータとトルクアンプ２０９を通して接続さ
れているＤ／Ａコンバータであり、ＣＰＵ２０１の指示
でアナログ電流指示をトルクアンプ２０９へ出力出来る
ようになっている。２０６は原点センサ１１５の情報を
ＣＰＵ２０１へ取り込むためのＩ／Ｏのインターフェー
スである。また、２１１は外部の教示装置２１２とＣＰ
Ｕを結ぶ通信用インターフェースである。前記２０２，
２０３，２０４，２０６，２０８，２１１はすべてバス
２１３によってＣＰＵ２０１と接続されている。 〈第１実施例〉図４は本発明の第１実施例を示し、ロボ
ットハンド機構の把持力制御方法に関する制御ブロック
図である。図４は、位置決め制御ループ（図中実線の枠
で示す）と把持力制御ループ（図中破線の枠で示す）と
いう２つのループからなる。位置決め制御ループは「準
備位置」にフィンガを位置決めするループで、把持力制
御ループは準備位置にフィンガが置かれた後にフィンガ
が発生する把持力を制御するループである。準備位置への位置決め まず、位置決め制御ループについて説明する。

【００１６】図における、指令位置レジスタ１は、対象
ワークを把持するための目標指令位置を記憶するレジス
タで、この指令位置は、対象ワークの寸法に対して多少
余裕がある位置、即ち、そこに位置決めされた時に対象
ワークとフィンガ部との間にある程度の間隔が有るよう
な位置へフィンガ部の駆動源であるサーボモータを動作
させるような位置であり、実際のワークの把持動作へ移
行する前の準備段階での目標指令位置である。この目標
指令位置１は加算器２へ出力される。加算器２は、目標
指令位置１と、フィンガ部の現在位置との位置偏差を求
めて、位置ループゲイン乗算器３へ出力する。位置ルー
プゲイン乗算器３は、位置偏差に所定の制御ゲインを乗
じて目標移動速度を演算し加算器４へ出力する。加算器
４は、入力されてきた目標移動速度と、フィンガ部の現
在移動速度１４との速度偏差を求めて、速度ループゲイ
ン乗算器５へ出力する。速度ループゲイン乗算器５は、
入力されてきた速度偏差に所定の制御ゲインを乗じて、
目標指令電流を加算器７へ出力する。加算器７は、入力
されてきた目標指令電流と、現在サーボモータ９に出力
されている現在指令電流との電流偏差を求めて、これを
トルクアンプ８へ出力する。トルクアンプ８は、入力さ
れてきた電流偏差を増幅し、指令電流とし、サーボモー
タ９へ出力する。サーボモータ９は、入力されてきた指
令電流により駆動され、トルクを発生してフィンガメカ
機構１０９，１１０を開閉させ位置決めを行なう。エン
コーダ１０２はフィンガ部の現在位置を検出する為に、
サーボモータ１０の回転に対応した信号を現在位置カウ
ンタ２０４へ出力し、その現在位置カウンタ２０４はエ
ンコーダ１０２からの信号により現在位置を算出して、
現在位置とする。また、現在位置カウンタ１２の出力を
微分器１３を通して現在速度としている。これらは従来
通りの位置決め制御ループである。

【００１７】この位置決め制御ループによって、フィン
ガ部を、対象ワークを把持する為の準備動作としての準
備位置に位置決めをする。フィンガが準備位置に位置決
めされたとき、フィンガ部と把持する対象ワークとの間
には、ある程度間隔がある。よって、今までのような正
確な位置決めの為のティーチングなどが不要で教示作業
が簡単となる。把持力制御 次に、フィンガ部が実際に対象ワークを把持するための
動作が以下のように行なわれる。

【００１８】フィンガを上記の準備位置に位置決めした
後、ループ切換スイッチ６を位置決め制御ループ側（図
中、ｂ位置）から把持力制御ループ（ａ位置）へ切換え
る。この時、指令把持力切換スイッチ１９は、初め第１
指令把持力側（ｃ位置）に接続されている。そして、第
１指令把持力がセットされ、把持力／トルク演算部１８
へ出力される。

【００１９】把持力／トルク演算部１８には、指令把持
力に対するトルク（電流）値への変換器が有り、指令把
持力を入力すると、それに必要なトルク（電流）値を演
算して、指令トルク（電流）値として出力する。一般
に、サーボモータは指令電流値に対して、比例的にトル
クが発生し、当然トルクとそれによって発生する力は比
例的な関係上にあるから、指令電流値に対して発生して
くる力というものは、常に比例的な関係にある。よって
簡単な変換関数がその把持力／トルク演算部１８には用
意されている。

【００２０】第１指令把持力が把持力トルク演算部１８
へ入力されると、前記変換関数によりトルク（電流）値
に変換されて、指令値としてループ切換スイッチ６を通
して加算器７へ出力される。そして、電流制御ループ
（トルクアンプ８から加算器７へ戻るループ）によって
電流定値制御を行って、サーボモータ９に一定のトルク
を発生させ、ハンドメカ機構を動作させ、フィンガ部を
対象ワークに接触させる。

【００２１】ここで、第１の指令把持力について言及す
る。把持力／トルク演算部１８以後においては、指令電
流値というものは、ハンドメカ機構１１の固有の摺動抵
抗などにより、指令電流値が小さい時にはフィンガ部が
動作しないような領域が存在するので、この摺動抵抗に
打ち勝って、実際にフィンガ部が動作できるような電流
値以上の値を指令電流値とする。この値を逆変換して、
第１指令把持力という形で設定しておく。

【００２２】第１の指令把持力に応じてハンドメカ機構
のフィンガ部が、対象ワークに対して把持する方向に動
作し、実際にフィンガ部が対象ワークに接触したら、指
令把持力切換スイッチ１９を第２指令把持力（ｄ位置）
側に切換える。このスイッチ１９をｃ位置からｄ位置に
切換えるタイミングは、ループ切換スイッチ６を位置決
め制御ループから把持力制御側に切換えた後に、モータ
の回転速度がゼロになった時点である。この速度監視は
速度監視器２０により行なわれ、現在速度が速度＝０と
なった時をフィンガ部が対象ワークに接触したと判断し
て、第２指令把持力側に指令把持力切換スイッチ１９を
切換えるというものである。

【００２３】そして、第２指令把持力１７側にスイッチ
が切替わると、第２指令把持力が把持に／トルク演算部
１８へ出力され、変換関数により第２指令把持力に対応
した指令トルク（電流）値に変換されて、指令値として
ループ切換スイッチ６を通して加算器７へ出力される。
そして、電流制御ループによって、電流定値制御を行っ
て、サーボモータ１０１に一定のトルクを発生させ、ハ
ンドメカ機構を動作させ、フィンガ部が対象ワークに対
して目標とする把持力を達成できる。

【００２４】尚、この第１実施例では把持力指示という
形式にしたが、電流定値制御であるから、初めから目標
となる把持力に対する指令電流値を直接、電流制御ルー
プに入力する方法や、あるいはトルクという形で指示す
る方法などがある。ここで、フィンガ部で対象ワークを
目標把持力で把持する為に、第１指令把持力、第２指令
把持力というように２段階で制御する理由は、目標把持
力に対応するであろう指令値を一度に与えると、対象ワ
ークとフィンガ部との間に間隔があるように上述の準備
位置において位置決めされているので、その間隔によっ
ては実際に対象ワークを把持した時に実際にワークにか
かる発生把持力が大きく変化してしまうこともあるし、
衝突するかも知れないことを考えると、瞬時に対象ワー
クに加わる把持力が、目標把持力に対して非常に大きな
把持力となってしまい、対象ワークに対して悪い影響、
つまり変形させたり、壊したり、把持できず飛ばした
り、発生する把持力がバラツキがあるものになってしま
う。そこで、第１指令把持力１６によってフィンガ部を
安定かつ確実に動作させ、対象ワークとの間隔を考慮せ
ずに、衝突のときの把持力の大きな変化がない（一定値
におちついている）ような指令値、かつ、接触（衝突）
させた時に発生する把持力にバラツキが有るときでも、
それらの値が目標把持力以上にならないような指令値と
しておき、これによってフィンガ部を対象ワークに接触
させる。フィンガ部と対象ワークが接触している状態か
らは、指令電流値に対して発生してくる把持力が比例的
に増加するので、目標把持力に対応した指令電流値を与
えるこによって安定した目標把持力が得られる。

【００２５】図５に一度に目標把持力に対応する指令値
を与えた場合の一例を示し、図６に本発明による指令値
（電流）と発生把持力の一例を示す。図６に示すよう
に、本実施例による手法の法が、接触時の発生把持力は
小さく、また変動幅も小さいことが分かる。次に、図７
〜図１１を参照して第１実施例の把持プロセスを説明す
る。

【００２６】図７は、不図示のロボットアームによって
ロボットハンド機構を移動し、ワークを搬送する全体動
作を表すフローチャートである。ステップＳ１におい
て、ロボットアームによって、ロボットハンド機構が把
持するための対象ワークに対して実際に把持できる位置
へ移動し位置決めされる。次に、ステップＳ２において
ロボットハンドのフィンガ部が対象ワークを把持する動
作に移行し、ステップＳ３で、把持動作が終了するとロ
ボットアームによりロボットハンドは対象ワークの組付
け位置へ移動、位置決めされる。次に、ステップＳ４
で、ロボットハンドは対象ワークを組付ける為のワーク
・リリース動作を行なう。そして、動作が継続している
場合には、最初の動作に戻り、ない場合には終了する
（ステップＳ５）。

【００２７】図８は図７のステップＳ２におけるフィン
ガ把持動作の実行部のプロセスを示した図であり、図９
はそのフローチャートである。図８のＳＴＥＰ１は、図
９のステップＳ１１からステップＳ１３に対応してい
る。まず、フィンガ部が対象ワークに対して多少余裕の
有る位置へ移動する為に、目標位置と目標速度がセット
され（ステップＳ１１，ステップＳ１２）、フィンガ部
が目標位置へ移動、位置決めされる（ステップＳ１
３）。

【００２８】図８のＳＴＥＰ１で、フィンガ部がワーク
近傍に位置決めされると、次にＳＴＥＰ２においてフィ
ンガ部がワーク近傍から対象ワークを実際に把持する動
作に移行する。まず、フィンガ部を駆動させる為に、サ
ーボモータに指令値を与える。これは図９のステップＳ
１４における第１指令把持力セットである。この第１指
令把持力の決定の仕方は、フィンガ部が安定かつ確実に
移動できる指令値（電流値ｏｒ把持力ｅｔｃ）とする。

【００２９】一例として、指令電流値に対するフィンガ
部の変位の関係を図１０に示す。この図１０図１１から
は、ここで使用したメカに関しては指令電流値１５０ｍ
Ａぐらいを境に、フィンガ部が安定かつ確実に変位して
いることがわかるので、第１の指令値として１５０ｍＡ
をセットする。図９のステップＳ１５で、位置決め制御
ループから把持力制御ループへスイッチを切換えて、ス
テップＳ１６でサーボモータに第１の指令値が与えら
れ、フィンガ部が安定かつ確実にワーク把持方向に移動
する。ステップＳ１７においては、フィンガ部が対象ワ
ークに接触したか、しないかを現在速度を監視し、現在
速度＝０であるか、ないかを判断して、現在速度が
“０”以外で、まだフィンガ部が移動途中ならば、ひき
つづき第１の指令値を与えつづけ、もし現在速度が
“０”となれば、フィンガ部が対象ワークに接触したこ
ととして、図８のＳＴＥＰ３及び図６のステップＳ１８
へと進む。

【００３０】図８のＳＴＥＰ３は具体的には、図９のス
テップＳ１８〜ステップＳ２１に相当しており、ＳＴＥ
Ｐ３では対象ワークを把持する目標把持力の指令電流値
を与える。まず、ステップＳ１８においては、第２指令
把持力（目標把持力）が対象ワークに与えられる。指令
電流値をセットする。この第２指令把持力の決定の仕方
は、予めフィンガ部とワークが接触した状態を想定して
創り出し、指令電流値に対してどの程度の把持力が発生
するかを確認しておく。図１１はこのためのものであ
り、フィンガ部がワークに接触している状態から徐々
に、指令電流値を増加させた時に発生する把持力がどの
ように変化するかをプロットしたものの一例である。こ
れによって、第２の指令把持力セットにおいて、実際に
与える指令電流値との関係がわかる。

【００３１】次に、ステップＳ１９においては、第１の
指令把持力から第２の指令把持力にスイッチ１９を切換
える。するとステップＳ２０でフィンガ部が対象ワーク
に接触している状態からサーボモータに第２の指令値が
与えられ、第２の指令把持力動作により、目標とする把
持力で対象ワークを確実に把持する方向にフィンガ部を
移動させる。

【００３２】ステップＳ２１においては、確実に把持が
完了したかを確認して、そして、その把持力を維持した
まま、図９のフローチャートをぬける。そして、図７の
ステップＳ３へと移行していく。そして、把持した対象
ワークを組み付ける位置へロボットアームによってロボ
ットハンドを移動させ、図８のＳＴＥＰ４において、ワ
ークをリリースする動作へ移る。

【００３３】図７のステップＳ２でロボットハンドが把
持動作を行なっているとき、特に図９のＳＴＥＰ２及び
ＳＴＥＰ３においては、図４の指令位置レジスタ１に
は、カウンタ２０４からの現在位置の値が常に代入され
ており、図７図８のＳＴＥＰ４で位置指令によるフィン
ガ部の移動命令によって現在位置の指令位置への代入動
作を抽出し、両値の一致している状態でスイッチ６を切
換え、位置決め制御系に変更し、通常の位置制御を行な
い、ワークをリリースできる位置にフィンガ部を移動す
る。 〈第２実施例〉第１実施例の図９の把持動作フローチャ
ートにおいて、ステップＳ１６の第１把持動作は、一定
の電流値のみで、フィンガ部を移動させるように制御す
る例である。この第１把持動作をさらに信頼性を増すよ
うにする第２実施例を、図１２のフローチャートでに示
す。図１２は、図９のフローチャートのステップＳ１６
の部分の詳細フローチャートとして書かれている。

【００３４】ステップＳ３１で、まず初期値として、あ
らかじめ設定されている指令下限値を設定して、ステッ
プＳ３２でトルクアンプを介してサーボモータ１０１へ
電流を流す。ステップＳ３３でサーボモータ１０１がフ
ィンガ部の移動ガイドやボールネジの摩擦等で移動しな
かったか否か（即ち、速度０であったか否か）をチェッ
クし、移動しているときはステップＳ３６で同じ指令値
でサーボモータに電流を流し続ける。ステップＳ３３で
移動しなかったときは、ステップＳ３４で現在の指令値
があらかじめ設定されている指令上限値を越えていない
かをチェックし、越えている場合は終了し、図９のステ
ップＳ１７へ進む。ステップＳ３４で上限値を越えてい
ない場合はステップＳ３５へ進み、現指令値にあらかじ
め設定された増加値を加算し、ステップＳ３６へ戻って
再度先の説明した内容を実行する。 〈応用〉上述した一定力の押付方法を原点出し動作に応
用した場合について説明する。

【００３５】図１３は、この原点出し動作のフローチャ
ートを示している。このフローチャトで、ＳＴＥＰＡは
実施例１，２の把持動作時のＳＴＥＰ２に、ＳＴＥＰＢ
は同ＳＴＥＰ３に対応しており、一定力押付方法として
は、まったく同じ動作になっている。図１３のフローチ
ャートに従って、ロボットハンド機構図（図２）と、制
御ブロック図（図４）を用いて説明する。

【００３６】まず、原点出し動作を行なう前に、図１２
の制御ブロックにおいて、切換スイッチ６はｂ位置に接
続されて位置決め制御系に接続されていることになって
いる。図１３で、原点出し動作をスタートさせると、ス
テップＳ３１で図１２の把持力制御ループに第１指令力
をセットし、ステップＳ３２でスイッチ１９をｃ位置
に、スイッチ６をａ位置に接続し、把持力制御系に切換
える。

【００３７】ステップＳ３３，ステップＳ３４で、この
指令力を出力制御しつつ、速度監視器２０で速度が零に
なるまで続けて出力する。このステップＳ３３，ステッ
プＳ３４の動作で、ロボットハンド機構（図２）では、
フィンガ部１０９，１１０は互いに離れる方向に移動
し、フィンガ１１０に取付けられたストッパー１１２と
固定フレーム１１３に取付けられたストッパー１１１が
接触した状態となる（ＳＴＥＰＡ）。

【００３８】次に、ステップＳ３５で、第２の指令力を
セットし、ステップＳ３６でスイッチ１９を切換えて、
ステップＳ３７，ステップＳ３８で第１指令力より大き
い第２指令力をサーボモータに出力制御し、ハンド機構
部にサーボモータのトルクが完全に伝達されたタイミン
グで次ＳＴＥＰに進む。ステップＳ３７，ステップＳ３
８の状態で、ロボットハンド機構（図２）は、ストッパ
ー１１１とストッパ１１２は、バラツキなく一定力で付
き当たった状態になっている（ＳＴＥＰＢ）。

【００３９】さらに、ステップＳ３９で、図４のＳＴＥ
Ｐ６をｂ位置に接続し、位置決め制御系に切換える。こ
のとき、指令位置レジスタには、カウンタ２０４からの
現在位置の値を代入する。ステップＳ４０では、指令位
置レジスタ１に微小移動量を加算しつづけ、先の移動方
法と逆になるようサーボモータを回転させる。ステップ
Ｓ４１では、この回転しているサーボモータと接続して
いるパルスエンコーダのＺ相信号（サーボモータ１回転
当り、１パルスの信号）が検知するまで、ステップＳ４
０のサーボモータの移動を行い、Ｚ相信号が検知される
と即座にステップＳ４２で図４の現在値カウンタ１２を
クリアして、サーボモータの移動を止めて、原点出し動
作を終了する（ＳＴＥＰＣ）。

【００４０】この一定力押付方法を、ロボットハンド又
はロボットアームの原点出し動作に適用した場合、正確
な力で可動部を押付けられ、伝達部の変形量の再現性が
高くなり、原点センサを廃止し、コストダウンが計れる
効果がある。 〈その他の変形〉本発明は上記３つの実施例に限定され
ることはなく、種々の変形が可能である。

【００４１】例えば、上記第３実施例の原点出し動作の
例において、第２実施例での図１２に示した指令値を徐
々に増加させる手法を、図１３のステップＳ３３の動作
として行なうと、原点出し動作の信頼性をより高めるこ
とができる。また上記実施例は、ロボットハンドを例に
取って説明してきたが、ロボットアーム等、目標位置と
いう概念の有るものであればいかなるものにも適用可能
である。

【００４２】

【発明の効果】以上説明したように本発明のロボットの
可動部の位置決め方法及びその装置によれば、粗い位置
決めが可能な制御系による粗い位置決めの後に、電流制
御によるトルク制御を行なって最終の目標位置に正確に
移動することができる。更に、トルク制御系において
は、第１の指令値を与えて、可動部の移動がゼロになっ
た後にさらに第１の指令値よりも大きな第２の指令値を
モータ手段に与えることで、より正確な力で目標位置に
接近することができ、例えば、押付対象物を正確に押付
けることが出来る効果がある。

【００４３】また、第１の指令値を、移動を確認しなが
ら、ステップ状に増加させることで、より確実に押付を
実現できる効果がある。

【図面の簡単な説明】

【図１】従来の位置決め回路の制御ブロック図である。

【図２】本発明の位置決め方法の適用対象となるロボッ
トハンド機構を示す図である。

【図３】実施例の制御装置のハード構成図である。

【図４】実施例の制御装置のブロック構成図。

【図５】従来技術における指令値と発生把持力の時間変
化を示す図である。

【図６】本実施例における指令値と発生把持力の時間変
化を示す図である。

【図７】実施例の全体動作のフローチャートである。

【図８】フィンガ把持プロセスを示す図である。

【図９】フィンガ把持動作のフローチャートである。

【図１０】指令電流に対するフィンガ部変位を示す図で
ある。

【図１１】押付部接触状態からの指令電流と把持力を示
す図である。

【図１２】第２実施例における把持動作のフローチャー
トである。

【図１３】本発明を原点出し動作に応用したときのフロ
ーチャートである。

Claims (9)

【特許請求の範囲】
1. 【請求項１】 ロボットの可動部を移動させるための電
   動モータ手段を備え、この電動モータ手段の移動位置，
   移動速度，駆動電流を制御することによりロボット可動
   部の位置決めを行なう方法において、 目標位置についての粗い位置情報を与え、 前記粗い位置情報に基づいて前記目標位置に可動部を位
   置決めし、 上記粗い位置情報に基づいた位置決め動作の終了後に、
   前記電動モータ手段に所定の電流を供給することを特徴
   とするロボットの可動部の位置決め方法。
2. 【請求項２】 前記電動モータ手段はサーボモータであ
   ることを特徴とする請求項１に記載のロボットの可動部
   の位置決め方法。
3. 【請求項３】 前記可動部の現在位置を検出するための
   サーボモータの出力軸に直結されたエンコーダを具備し
   たことを特徴とする請求項２に記載のロボットの可動部
   の位置決め方法。
4. 【請求項４】 前記供給工程において、 前記可動部の移動のみが可能な第１の電流値を与え、 可動部が押付対象物と接触したことを検出し、 前記第１の電流値よりも大きな第２の電流値を前記電動
   モータ手段に与えることを特徴とする請求項１に記載の
   ロボットの可動部の位置決め方法。
5. 【請求項５】 前記供給工程において、 可動部の移動が認められないとき、前記第１の電流値を
   徐々に増加させることを特徴とする請求項４に記載のロ
   ボットの可動部の位置決め方法。
6. 【請求項６】 前記供給工程において、 前記第１の電流値を徐々に増加させる工程において、上
   限値に達した時点で増加を停止させることを特徴とする
   請求項４に記載のロボットの可動部の位置決め方法。
7. 【請求項７】 更に把持工程を含むことを特徴とする請
   求項１に記載のロボットの可動部の位置決め方法。
8. 【請求項８】 ロボットの可動部を移動させるための電
   動モータ手段を備え、この電動モータ手段の移動位置，
   移動速度，駆動電流を制御することによりロボット可動
   部の位置決めを位置決め装置において、 目標位置についての粗い位置情報を外部から入力する手
   段と、 前記電動モータ手段を駆動するための電流値データを外
   部から入力する手段と、 前記粗い位置情報に基づいて前記目標位置に可動部を位
   置決めするために、速度誤差検出回路と位置誤差検出回
   路とを含む位置決め制御回路と、 前記可動部の移動状態を検出する検出手段と、 前記電流値データに基づいて電流量制御を行なう電流制
   御回路と、 前記検出手段が前記位置決め制御回路による前記可動部
   の移動が略ゼロと検出したときに、前記モータ手段への
   駆動パスを前記位置決め制御回路から電流制御回路に切
   り替える切り替え手段とを具備することを特徴とするロ
   ボットの可動部の位置決め装置。
9. 【請求項９】 更に把持工程を含むことを特徴とする請
   求項６に記載のロボットの可動部の位置決め装置。