(57)【要約】【課題】ドアノブの動きに、ロボットアームによるドアノブの操作方向を応答性良く追従させること。【解決手段】ロボット１は、ドア２のドアノブ２１をロボットハンド１２１によって把持可能なロボットアーム１２と、ロボットアーム１２に加わる力を検出する力センサ１３と、ドアノブ２１の初期操作方向を記憶する記憶部１４１と、ドアノブ２１の座標系における原点と一致する中心位置から、ドアノブ２１の初期操作方向の直線上の任意の終端部まで伸びる形状である、仮想的な受動モデルＭを設置する受動モデル設置部１４２と、受動モデルＭの中心位置と終端部を結ぶ直線に沿ってロボットアーム１２を操作する第１処理と、力センサ１３によって検出された力に基づいて受動モデルＭの姿勢を更新する第２処理と、を繰り返す制御部１４３と、を備える。【選択図】図１
2017154193.tif 000002
【特許請求の範囲】
【請求項１】
ドアの取っ手を把持部によって把持可能なアームと、
前記アームに加わる力を検出する力検出部と、
前記取っ手の初期操作方向を記憶する記憶部と、
前記取っ手の座標系における原点と一致する中心位置から、前記取っ手の初期操作方向の直線上の任意の終端部まで伸びる形状である、仮想的な受動モデルを設置する受動モデル設置部と、
前記受動モデルの前記中心位置と前記終端部を結ぶ直線に沿って前記アームを操作する第１処理と、前記力検出部によって検出された力に基づいて前記受動モデルの姿勢を更新する第２処理と、を繰り返す制御部と、を備えるロボット。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、ロボットに関し、特に、ドアを開閉するロボットに関する。
【背景技術】
【０００２】
近年、ドアを開閉するロボットが提案されている。例えば、特許文献１には、開閉方向が未知であるドアを開閉するロボットが開示されている。特許文献１に開示されたロボットは、ロボットアームの先端に設けられたロボットハンドでドアノブを把持した状態で、ロボットハンドを任意の方向に移動するよう制御する。そして、そのときにロボットアームに加わる力を検出し、検出した力に基づいて、ドアの開く方向を判断する。
【先行技術文献】
【特許文献】
【０００３】
【特許文献１】特開２０１０−２２１３２０号公報
【発明の概要】
【発明が解決しようとする課題】
【０００４】
ところで、ロボットが開閉するドアが、回転させて開閉するタイプのドアである場合、ドアが開くにつれて、ロボットアームによるドアノブの操作方向が変わる。そのため、倣い制御によって、ドアの開閉状態に応じて、ロボットアームによるドアノブの操作方向を制御することが考えられる。
【０００５】
しかし、実際には、ロボットハンドとドアノブとの間には滑りがあるため、ドアが開くにつれて、ドアノブの動きに、ロボットアームによるドアノブの操作方向が追従できなくなり、ドアの開き角度と、ロボットアームによるドアノブの操作角度（引く角度）と、が乖離していき、ドアを開ききることができないことがある。
【０００６】
本発明は、上記を鑑みなされたものであって、ドアノブの動きに、ロボットアームによるドアノブの操作方向を応答性良く追従させることができるロボットを提供する。
【課題を解決するための手段】
【０００７】
本発明の一態様に係るロボットによれば、
ドアの取っ手を把持部によって把持可能なアームと、
前記アームに加わる力を検出する力検出部と、
前記取っ手の初期操作方向を記憶する記憶部と、
前記取っ手の座標系における原点と一致する中心位置から、前記取っ手の初期操作方向の直線上の任意の終端部まで伸びる形状である、仮想的な受動モデルを設置する受動モデル設置部と、
前記受動モデルの前記中心位置と前記終端部を結ぶ直線に沿って前記アームを操作する第１処理と、前記力検出部によって検出された力に基づいて前記受動モデルの姿勢を更新する第２処理と、を繰り返す制御部と、を備える。
【発明の効果】
【０００８】
上述した本発明の態様によれば、ドアの取っ手の動きに、ロボットアームによる取っ手の操作方向を応答性良く追従させることができるという効果が得られる。
【図面の簡単な説明】
【０００９】
【図１】本実施の形態に係るロボット１の全体構成例を示す図である。
【図２】本実施の形態に係るロボット１において、受動モデルＭの更新に応じて、ドアノブ２１の操作方向を更新する様子の例を示す図である。
【図３】本実施の形態に係るロボット１において、ドア２を操作する場合の動作フローの例を示すフローチャートである。
【図４】本実施の形態に係る受動モデルＭに関連して定義する座標系の例を示す図である。
【図５】本実施の形態に係る制御装置１４の構成例を示すブロック図である。
【発明を実施するための形態】
【００１０】
以下、図面を参照して本発明の実施の形態について説明する。
図１は、本実施の形態に係るロボット１の全体構成例を示す図である。ロボット１は、蝶番２２を中心に回転させて開閉するタイプのドア２を、ドア２のドアノブ（取っ手）２１を把持した状態で開閉するロボットである。ロボット１は、ロボット本体１１と、ロボットアーム１２と、力センサ１３と、制御装置１４と、を備えている。
【００１１】
ロボットアーム１２は、ロボット本体１１に取り付けられる。また、ロボットアーム１２は、先端に設けられたロボットハンド１２１によってドアノブ２１を把持可能である。ロボットハンド１２１は、把持部の一例である。また、ロボットアーム１２は、複数の関節（図１では２つ）を備えており、制御装置１４からの制御信号に従い、複数の関節に設けられたアクチュエータ（不図示）を駆動することによって、人間の腕のように駆動することができる。また、ロボットアーム１２は、制御装置１４からの制御信号に従い、ロボットハンド１２１の把持動作を実現する複数のアクチュエータ（不図示）を駆動することによって、ロボットハンド１２１を人間の手のように駆動することができる。本実施の形態では、ロボットアーム１２は、ロボットハンド１２１を６自由度方向に任意の角度で動作させることが可能であるとする。
【００１２】
力センサ１３は、ドアノブ２１からロボットハンド１２１に加わる外力を検出するもので、力検出部の一例である。力センサ１３によって検出された外力は制御装置１４に出力される。
【００１３】
制御装置１４は、ロボットアーム１２に制御信号を出力することによって、ドア２の開閉を実現するようロボットアーム１２を制御する。制御装置１４は、ロボット本体１１に内蔵されており、ＣＰＵ（Central Processing Unit）、ＣＰＵによって実行される制御プログラム、演算プログラム等が記憶されたＲＯＭ（Read Only Memory）、処理データ等を記憶するＲＡＭ（Random Access Memory）等からなるマイクロコンピュータを中心にして、ハードウェア構成されている。
【００１４】
ここで、まず、本実施の形態に係る制御装置１４における、ロボットアーム１２の制御方法の概要について説明する。
本実施の形態では、ロボットハンド１２１でドア２のドアノブ２１を把持した状態で、ドア２を開閉させる。しかし、ドア２は、回転させて開閉するタイプであるため、ドア２が開くにつれて、ロボットアーム１２によるドアノブ２１の操作方向が変わる。これに対応するため、倣い制御を行うことが考えられる。
【００１５】
しかし、実際には、ロボットハンド１２１とドアノブ２１との間には滑りがあるため、ドア２が開くにつれて、ドア２の開き角度と、ロボットアーム１２によるドアノブ２１の操作角度（引く角度）と、が乖離し、ドアを開ききることができないことがある。そのため、ドアノブ２１の動きに応じて、ロボットアーム１２によるドアノブ２１の操作方向を適宜更新することが重要である。
【００１６】
そこで、本実施の形態では、制御装置１４は、図２に示されるように、ロボットハンド１２１がドアノブ２１を把持する把持位置に、非ホロミックで受動的な特性を持つ仮想的な内部モデル（以下、受動モデルＭと称す）を設置する。そして、制御装置１４は、ドアノブ２１の動きに応じて、受動モデルＭを更新し、更新した受動モデルＭの姿勢に基づいて、ロボットアーム１２によるドアノブ２１の操作方向を制御する。具体的には、制御装置１４は、ロボットアーム１２が、受動モデルＭの長手方向に沿って、ドアノブ２１を操作するよう制御する。
【００１７】
このような受動モデルＭをドアノブ２１の把持位置に設置することで、ロボットハンド１２１が動作可能な６自由度が５自由度以下に拘束されることになる。その結果、ドアノブ２１の動きに、ドアノブ２１の操作方向を応答性良く追従させることができる。その一方で、ドア２の振動や力センサ１３のセンサノイズの影響を受けにくくなるため、その他の方向への感度を低く抑えることができる。
【００１８】
さらに、本実施の形態では、制御装置１４は、受動モデルＭの姿勢に応じて、ドアノブ２１の操作方向を制御するだけでなく、ドアノブ２１の操作方向とロボットハンド１２１の姿勢（方向）とが一致するように、ロボットアーム１２の姿勢を制御する。これにより、図２に示されるように、ドアノブ２１を、ドア２と直交するする操作方向に効率よく操作することができる。なお、図２において、受動モデルＭには、キャスター車輪Ｃが設けられている。
【００１９】
次に、本実施の形態に係るロボット１の動作フローについて説明する。
図３は、本実施の形態に係るロボット１において、ドア２を操作する場合の動作フローの例を示すフローチャートである。本実施の形態では、ドアノブ２１の初期の操作方向である初期操作方向は既知であり、制御装置１４に記憶されているものとする。また、ロボットハンド１２１がドアノブ２１を把持し、ドアノブ２１の初期操作方向と受動モデルＭの姿勢とが一致した状態で、ドア２の操作が開始されるものとする。
【００２０】
まず、制御装置１４は、受動モデルＭの姿勢Ｘcenterに応じた操作方向へドアノブ２１の操作力ｆｏｐを発生するよう、ロボットアーム１２を制御する（ステップＳ１）。初期の受動モデルＭの姿勢Ｘcenterは、ドアノブ２１の初期操作方向と一致する。そのため、ここでは、制御装置１４は、ドアノブ２１の初期操作方向に操作力ｆｏｐを発生するよう制御する。
【００２１】
続いて、制御装置１４は、受動モデルＭの姿勢Ｘcenterに応じたドアノブ２１の操作方向とロボットハンド１２１の姿勢（方向）とが一致するように、ロボットアーム１２の姿勢を制御する（ステップＳ２）。初期の受動モデルＭの姿勢姿勢Ｘcenterは、ドアノブ２１の初期操作方向と一致する。そのため、ここでは、制御装置１４は、ロボットハンド１２１の姿勢（方向）を、ドアノブ２１の初期操作方向と一致するよう制御する。
【００２２】
ロボットアーム１２は、制御装置１４によるステップＳ１，Ｓ２の制御に従い、ドアノブ２１を操作する。また、力センサ１３は、このときにロボットハンド１２１に掛かる外力ｆｃｅｎｔｅｒを検出し、検出した外力ｆｃｅｎｔｅｒを制御装置１４に出力する。
【００２３】
続いて、制御装置１４は、力センサ１３によって検出されたロボットハンド１２１に掛かる外力ｆｃｅｎｔｅｒを入力として（ステップＳ３）、受動モデルＭを更新する（ステップＳ４）。これにより、更新した最新の受動モデルＭの姿勢Ｘcenterが得られる。
【００２４】
続いて、制御装置１４は、ドア２の操作が完了したか否かを判定し（ステップＳ５）、操作が完了していた場合、処理を終了する。
一方、ドア２の操作が完了していない場合、ステップＳ１の処理に戻る。そして、制御装置１４は、ステップＳ１において、直近のステップＳ４で更新した最新の受動モデルＭの姿勢Ｘcenterに応じた操作方向へドアノブ２１の操作力ｆｏｐを発生するよう、ロボットアーム１２を制御する。また、制御装置１４は、ステップＳ２において、直近のステップＳ４で更新された最新の受動モデルＭの姿勢Ｘcenterに応じたドアノブ２１の操作方向とロボットハンド１２１の姿勢（方向）とが一致するように、ロボットアーム１２の姿勢を制御する。以下、上記と同様のステップＳ３，Ｓ４の処理を行う。
【００２５】
次に、図３のステップＳ４の受動モデルＭの更新処理について説明する。
本実施の形態では、ロボットハンド１２１によるドアノブ２１の把持位置に受動モデルＭをあてはめるために、図４に示されるような座標系を定義する。
【００２６】
ドアノブ２１の座標系をΣｎｏｂとし、仮想的な受動モデルＭの座標系をΣｃｅｎｔｅｒとする。また、仮想的な受動モデルＭとして、キャスターモデルのような受動的な要素を仮定した場合の受動モデルＭの終端の座標系をΣｔａｉｌとする。なお、以上の座標系は全て、Σｇｒｏｂａｌを基準とした座標系とする。
【００２７】
また、ΣｃｅｎｔｅｒとΣｎｏｂの原点は一致し、姿勢のみが異なるとする。また、ΣｃｅｎｔｅｒとΣｔａｉｌのｘ軸は同一直線上にあり、両者は距離Ｌだけ離れているとする。
ロボットアーム１２によるドアノブ２１の操作力ｆｏｐは、Σｃｅｎｔｅｒのｘｃ方向に作用させる（ドア２を開く場合の操作方向は−ｘｃ方向となり、ドア２を閉じる場合の操作方向はｘｃ方向となる）。
また、ロボットハンド１２１とドアノブ２１の相対姿勢は固定されておらず、ロボットハンド１２１は任意の姿勢を自由に取れることを前提としている。
【００２８】
ここで、非ホロミックな受動モデルＭとして、キャスターモデルを仮定した場合、力センサ１３によって検出されたロボットハンド１２１に掛かる外力ｆｃｅｎｔｅｒと、ロボットアーム１２によるドアノブ２１の操作力ｆｏｐと、からなる合力によって、受動モデルＭには以下の式（１）で表される外力が作用する。
【数１】
2017154193.tif 000003
【００２９】
式（１）において、ｔａｉｌＴｃｅｎｔｅｒは、幾何学的な特性を定義するもので、以下の式（２）の行列で表される。
【数２】
2017154193.tif 000004
【００３０】
また、受動モデルＭの終端は、以下の式（３）の動特性を持つと仮定する。
【数３】
2017154193.tif 000005
【００３１】
ここで、Ｍｔａｉｌ、Ｄｔａｉｌは、Σｔａｉｌの動特性を定義する対角行列となり、例えば、以下の式（４）、式（５）のようなパラメータを取り得る。
【数４】
2017154193.tif 000006
【数５】
2017154193.tif 000007
【００３２】
受動モデルＭの中心の位置・姿勢を実現するように、ロボットアーム１２のロボットハンド１２１を制御するため、式（３）をロボットハンド１２１の座標系Σｃｅｎｔｅｒへ変換する必要がある。
例えば、ΣｃｅｎｔｅｒとΣｔａｉｌとの幾何学的な関係は、以下の式（６）〜式（８）で定義することができる。
【数６】
2017154193.tif 000008
【数７】
2017154193.tif 000009
【数８】
2017154193.tif 000010
【００３３】
式（６）〜式（８）を用いると、式（３）は、以下の式（９）のように表される。
【数９】
2017154193.tif 000011
式（９）を得ることが、図３のステップＳ４の受動モデルＭの更新処理に相当する。
【００３４】
式（９）から分かるように、力センサ１３によって検出されたロボットハンド１２１に掛かる外力ｆｃｅｎｔｅｒを入力とし、ドア２を開けるのに適した受動モデル特性を実現する、受動モデルＭの姿勢Ｘcenterを出力とする制御ループを組むことが可能になる。
【００３５】
制御装置１４は、受動モデルＭの更新処理後、ドア２の操作が完了していなければ、最新のＸcenterの姿勢方向をドアノブ２１の操作方向として、ドアノブ２１へ操作力ｆｏｐを発生するように、ロボットアーム１２を制御する（図３のステップＳ１に相当）。さらに、制御装置１４は、ドアノブ２１の操作方向とロボットハンド１２１の姿勢（方向）とが一致するように、ロボットアーム１２の姿勢を制御する（図３のステップＳ２に相当）。
【００３６】
上述のようにして、式（９）に基づいて、ロボットアーム１２によるドアノブ２１の操作方向及びロボットハンド１２１の姿勢を制御することにより、ドアノブ２１の動きに、ドアノブ２１の操作方向を応答性良く追従させることができる。その一方で、他の方向への感度（ドア２の振動や力センサ１３のセンサノイズの影響）を低く迎えることができる。これにより、ドアノブ２１の安定的な操作を実現することができるため、ロボットハンド１２１とドアノブ２１との間に滑りがあったとしても、ドア２を開ききることができる。
【００３７】
次に、本実施の形態に係る制御装置１４の構成について説明する。
図５は、本実施の形態に係る制御装置１４の構成例を示すブロック図である。制御装置１４は、記憶部１４１と、受動モデル設置部１４２と、制御部１４３と、を備えている。なお、受動モデル設置部１４２及び制御部１４３は、例えば、ＣＰＵによって実現することができ、また、記憶部１４１は、例えば、ＲＯＭ、ＲＡＭ等によって実現することができる。
【００３８】
記憶部１４１は、ドアノブ２１の初期操作方向を記憶する。
受動モデル設置部１４２は、ドアノブ２１の座標系における原点と一致する中心位置（Σcenter）から、ドアノブ２１の初期操作方向の直線上の任意の終端部（Σtail）まで伸びる形状である、仮想的な受動モデルＭを設置する。
【００３９】
制御部１４３は、ロボットアーム１２に制御信号を出力することによって、ドア２の開閉を実現するようロボットアーム１２を制御する。具体的には、制御部１４３は、受動モデルＭの中心位置（Σcenter）と終端部（Σtail）とを結ぶΣcenter−Σtail直線（受動モデルＭの長手方向）に沿って、ロボットアーム１２を操作する第１処理と、力センサ１３によって検出された外力（ｆｃｅｎｔｅｒ）に基づいて受動モデルＭの姿勢（Ｘcenter）を更新する第２処理と、を繰り返す。
【００４０】
上述のように、制御部１４３は、力センサ１３によって検出された外力（ｆｃｅｎｔｅｒ）に基づいて更新した受動モデルＭのΣcenter−Σtail直線に沿って、ロボットアーム１２を操作する。そのため、ドアノブ２１の動きに、ドアノブ２１の操作方向を応答性良く追従させる一方で、他の方向への感度を低く迎えることができる。これにより、ロボットハンド１２１とドアノブ２１との間に滑りがあったとしても、ドア２を開ききることができる。
【００４１】
なお、本発明は上記実施の形態に限られたものではなく、趣旨を逸脱しない範囲で適宜変更することが可能である。
【符号の説明】
【００４２】
１  ロボット
１１  ロボット本体
１２  ロボットアーム
１２１  ロボットハンド
１３  力センサ
１４  制御装置
１４１  記憶部
１４２  受動モデル設置部
１４３  制御部
２  ドア
２１  ドアノブ
２２  蝶番
Ｍ  受動モデル
Ｃ  キャスター車輪
【図１】
2017154193.tif 000012
【図２】
2017154193.tif 000013
【図３】
2017154193.tif 000014
【図４】
2017154193.tif 000015
【図５】
2017154193.tif 000016