JPH08118278A

JPH08118278A - 力制御ロボット

Info

Publication number: JPH08118278A
Application number: JP26015394A
Authority: JP
Inventors: Taku Yoshimi; 見卓吉; Makoto Jinno; 野誠神; Fumio Ozaki; 崎文夫尾; Yasuhiko Tamada; 田保彦玉
Original assignee: Toshiba Corp; Toshiba Machine Co Ltd
Current assignee: Toshiba Corp; Shibaura Machine Co Ltd
Priority date: 1994-10-25
Filing date: 1994-10-25
Publication date: 1996-05-14

Abstract

(57)【要約】【目的】作業の種類や作業対象物の形状に応じて適す
る力制御を容易に指定し実行できるようにした力制御ロ
ボットを提供する。【構成】ロボット手先部にある力覚センサ（４）を用
いてエンドエフェクタ（５）を作業対象物（Ｗ）の表面
へ指定押し付け力で押し付けるように力制御し、この表
面に沿ってエンドエフェクタ（５）を移動させて作業を
行う力制御ロボットにおいて、所望作業を選択し実行す
るために必要な複数のパラメータを解釈するロボット言
語解釈装置（１０）を備え、ロボット言語解釈装置（１
０）は、指定押し付け力の押し付け方向を指定する押し
付け方向テーブル（１２）と、力覚センサ（４）で検出
する検出力のうち力制御に使用する力成分を指定する検
出力テーブル（１３）と、押し付け方向テーブル（１
２）および検出力テーブル（１３）の各々のパラメータ
を指定するパラメータ指定手段（１１）とを備えること
を特徴とする。

Description

【発明の詳細な説明】

【０００１】

【産業上の利用分野】本発明は、力制御ロボットに係
り、特に力覚センサを用いてエンドエフェクタを作業対
象物の表面へ指定押し付け力で押し付けるように力制御
し、作業を行う力制御ロボットに関する。

【０００２】

【従来の技術】力制御ロボットを用い、作業対象物のバ
リ取り等の種々の作業が行われている。これらの場合、
力制御ロボットにおいては、ロボット手先部にあるエン
ドエフェクタを作業対象物の表面へ指定押し付け力で押
し付けるように力制御し、この表面に沿ってエンドエフ
ェクタを移動させることによって作業を行う。

【０００３】エンドエフェクタが作業対象物を押し付け
る力は、ロボット手先部におけるエンドエフェクタの近
傍にある力覚センサによって検出される。力覚センサに
よる検出結果は、エンドエフェクタを作業対象物の表面
へ指定押し付け力で押し付けるように力制御に用いられ
る。

【０００４】

【発明が解決しようとする課題】ロボット手先部の作業
空間内における移動には、一般に加速度による慣性力が
作用し、また振動を伴うことが多い。また、力覚センサ
はロボットの手先部の先端部等に装着されている。この
ため、力覚センサはロボット手先部の運動に伴い、加速
度を受けたりあるいは手先部の基部を基準にした振動を
受けたりする。力覚センサによって実際に検出される力
はエンドエフェクタが作業対象物から受ける反力のみと
は限らず、力制御に使用するために必要な力の他に種々
のノイズ的な力が混在している。

【０００５】エンドエフェクタを作業対象物に対して押
し付ける方向と力覚センサによって検出される力の方向
とは必ずしも一致せず、従って、力覚センサによって検
出される力方向の逆方向にエンドエフェクタを押し付け
さえすればよいということにはならない。

【０００６】力制御ロボットを用いて種々の作業を選択
して実行する場合、エンドエフェクタを作業対象物の表
面へ指定押し付け力で押し付けるように力制御するため
には、選択された作業種類や作業対象物の形状等に応じ
て、力覚センサで検出した力のうちの適する力成分を力
制御に使用する必要がある。

【０００７】このために、エンドエフェクタを作業対象
物に対して押し付ける方向や力制御に使用する力成分を
十分に検討し、この検討結果を基にしてロボット動作プ
ログラムを作成する。力制御に使用する力成分を指定す
るためには、座標系やエンドエフェクタの押し付け方向
や力の種類等を指定する必要がある。

【０００８】従来は、力制御ロボットによる作業を行う
毎に、エンドエフェクタを作業対象物に対して押し付け
る方向や力制御に使用する力成分等を検討しロボット動
作プログラムを作成していた。また、作業の途中で指定
を変更する必要がある場合も存在し、この場合には即座
の変更は困難であった。

【０００９】このように、作業にとりかかる毎にあるい
は作業の途中で、エンドエフェクタを作業対象物に対し
て押し付ける方向や力制御に使用する力成分を検討しロ
ボット動作プログラムを作成したり、あるいは作業の途
中で繁雑な手続きにより設定を変更したりすることは作
業効率的に好ましくない。

【００１０】そこで、本発明の目的は、上記従来技術の
有する問題を解消し、作業の種類や作業対象物の形状に
応じて適する力制御を容易に指定し実行できるようにし
た力制御ロボットを提供することである。

【００１１】

【課題を解決するための手段】上記目的を達成するため
に、本発明による力制御ロボットは、ロボット手先部に
ある力覚センサを用いてエンドエフェクタを作業対象物
の表面へ指定押し付け力で押し付けるように力制御し、
この表面に沿って前記エンドエフェクタを移動させて作
業を行う力制御ロボットにおいて、所望作業を選択し実
行するために必要な複数のパラメータを解釈するロボッ
ト言語解釈装置を備え、前記ロボット言語解釈装置は、
前記指定押し付け力の押し付け方向を指定する押し付け
方向テーブルと、前記力覚センサで検出する検出力のう
ち前記力制御に使用する力成分を指定する検出力テーブ
ルと、前記押し付け方向テーブルおよび前記検出力テー
ブルの各々のパラメータを指定するパラメータ指定手段
とを備えることを特徴とする。

【００１２】また、好適には、前記押し付け方向テーブ
ルは、押し付け方向を指定するために、採用する座標系
を指定する座標系パラメータと、この座標系における押
し付け方向を指定する指定方向パラメータと、押し付け
方向の指定方法を指定する指定方法パラメータとを有す
ることを特徴とする。

【００１３】また、好適には、前記指定方法パラメータ
は、採用された座標系におけるいずれかの座標軸方向を
指定する直接指定方法、前記エンドエフェクタの移動方
向と作業空間内に所望に選択した選択方向とのベクトル
外積で指定するベクトル外積指定方法、あるいは円弧の
中心向きか外向きかを指定する円弧指定方法のいずれか
の指定方法で指定されることを特徴とする。

【００１４】また、好適には、前記検出力テーブルは、
前記力制御に使用する力成分を指定するために、採用す
る座標系を指定する検出座標系パラメータと、検出する
力成分の方向を指定する検出方向パラメータと、検出す
る力成分の種類を指定する検出力パラメータとを有する
ことを特徴とする。

【００１５】また、好適には、前記検出力パラメータ
は、採用された座標系のいずれかの座標軸方向に作用す
る並進力、複数の力成分が合成された合成力、あるいは
前記エンドエフェクタの重心回りに作用するモーメント
力と作用点までの距離とから演算して求めるのいずれか
で指定されることを特徴とする。

【００１６】また、好適には、前記検出力パラメータ
は、検出する力成分の大きさのみを指定するパラメータ
であることを特徴とする。

【００１７】

【作用】エンドエフェクタを作業対象物に対して押し付
ける方向と力覚センサによって検出される力の方向とは
必ずしも一致せず、力覚センサによって検出される力方
向の逆方向にエンドエフェクタを押し付けさえすればよ
いということにはならない。そこで、選択された作業種
類や作業対象物の形状等に応じて力覚センサで検出した
力のうちの力制御に適する力成分を選択し、この選択し
た力成分とは別個に、エンドエフェクタが作業対象物を
押し付ける指定押し付け力の押し付け方向を指定する。

【００１８】エンドエフェクタが作業対象物を押し付け
る指定押し付け力の押し付け方向と、力覚センサで検出
する検出力のうち力制御に使用するために指定する力成
分とを、パラメータ指定手段により指定する。

【００１９】ロボット言語解釈装置は、押し付け方向テ
ーブルおよび検出力テーブルのパラメータを解釈し、作
業の種類や作業対象物の形状に応じて適する力制御を実
行させるようにする。作業の種類等に応じた力制御に必
要なパラメータは、押し付け方向テーブルおよび検出力
テーブルとしてテーブル形式で与えられているので、適
する力制御を容易に指定し実行することができる。

【００２０】

【実施例】以下に本発明による力制御ロボットの実施例
について図面を参照して説明する。図２は、本発明の力
制御ロボットの全体構成を示す図である。図２におい
て、力制御ロボットは、ロボット本体１と、ロボット本
体１の制御装置２と、制御装置２へ指示を送るティーチ
ペンダント３とを備えている。ロボット本体１の手先部
の先端には、作業対象物（ワーク）Ｗに研削等の作業を
行うエンドエフェクタ５が装着されている。ロボット本
体１の手先部には、エンドエフェクタ５の近傍に６軸の
力覚センサ４が設けられている。

【００２１】力制御ロボットを用いて作業を実行する場
合、力覚センサ４を用いてエンドエフェクタを作業対象
物の表面へ指定押し付け力で押し付けるように制御装置
２内部に設けられたアーム制御装置６では、力制御法と
して、例えば、式（１）に従って力制御される。Ｖｄ＝Ｋｆ（Ｆｄ−Ｆ）（１）ここで、Ｆｄは目標の指定押し付け力、Ｆは力覚センサ
４で検出した検出力のうちの力制御に使用する力成分、
Ｋｆは力制御ゲイン、Ｖｄはエンドエフェクタ５の押し
付け方向の速度を示す速度指令値である。式（１）中の
検出力の力成分Ｆ、および、速度指令値Ｖｄを与える押
し付け方向は、ロボット言語解釈装置１０の押し付け方
向テーブル１２と検出力テーブル１３において指定され
る。

【００２２】図１に示すように、制御装置２には、所望
作業を選択し実行するために必要な複数のパラメータを
解釈するロボット言語解釈装置１０が設けられている。

【００２３】ロボット言語解釈装置１０は、エンドエフ
ェクタ５が作業対象物Ｗの表面を指定押し付け力で押し
付ける押し付け方向を指定する押し付け方向テーブル１
２と、力覚センサ４で検出する検出力のうち力制御に使
用する力成分を指定する検出力テーブル１３と、押し付
け方向テーブル１２および検出力テーブル１３の各々の
パラメータを指定するパラメータ指定手段１１とを備え
ている。

【００２４】押し付け方向テーブル１２は、図４あるい
は図７に示すように、採用する座標系を指定する座標系
パラメータと、この座標系における押し付け方向を指定
する指定方向パラメータと、押し付け方向の指定方法を
指定する指定方法パラメータとを有する。

【００２５】座標系パラメータとしては、例えば作業対
象物Ｗに座標系を設定したワーク座標系ΣＷやエンドエ
フェクタ５に座標系を設定したツール座標系ΣＴがあ
る。指定方向パラメータとしては、座標系パラメータで
設定された座標系におけるいずれかの座標軸方向があ
る。

【００２６】指定方法パラメータとしては、例えば、直
接指定方法、ベクトル外積指定方法、あるいは円弧指定
方法がある。直接指定方法は、座標系パラメータで設定
された座標系におけるいずれかの座標軸方向を直接指定
する方法であり、作業対象物の形状が単純な場合に有効
である。ベクトル外積指定方法は、エンドエフェクタ５
の移動方向と作業空間内に所望に選択した選択方向との
ベクトル外積で指定する方法である。所望に選択した選
択方向としては、例えば、作業対象物Ｗ表面の法線方向
がある。ベクトル外積指定方法は、曲面の研磨作業や作
業対象物の周囲の凹凸のある端部の面取り作業などのよ
うに、作業中に作業対象物の形状に応じてエンドエフェ
クタ５の押し付け方向を変化させる必要がある作業の場
合でも、作業の最初から最後までエンドエフェクタの押
し付け方向の指定を変更する必要がなくなり、動作プロ
グラムの生成を非常に容易に行うことができるという効
果を有する。円弧指定方法は、円弧の中心向きか外向き
かを指定する方法であり、作業対象物Ｗに円弧状の形状
の個所が多くある場合に有効である。

【００２７】検出力テーブル１３は、図５あるいは図８
に示すように、採用する座標系に関する検出座標系パラ
メータと、検出する力成分の方向を指定する検出方向パ
ラメータと、検出する力成分の種類を指定する検出力パ
ラメータとを有する。

【００２８】検出座標系パラメータとしては、例えば作
業対象物Ｗに座標系を設定したワーク座標系ΣＷやエン
ドエフェクタ５に座標系を設定したツール座標系ΣＴが
ある。検出方向パラメータとしては、検出座標系パラメ
ータで設定された座標系におけるいずれかの座標軸方向
がある。

【００２９】検出力パラメータとしては、例えば、並進
力、合成力、あるいはモーメントから演算して求める力
のいずれかで指定される。これらの力成分は、符号を正
負を問わず単に大きさのみを指定すればよい。

【００３０】ここで、並進力の指定は、採用された座標
系のいずれかの座標軸方向に作用する力として指定する
ことであり、作業対象物Ｗの形状が単純な場合等におい
てエンドエフェクタ５が作業対象物Ｗから受ける反力方
向が容易に判断できる場合に有効である。合成力の指定
は、複数の力成分が合成された力として指定することで
あり、単一の並進力では指定できないような形状を作業
対象物Ｗが有する場合等に有効である。モーメントから
演算して求める力の指定は、エンドエフェクタ５の重心
回りに作用するモーメント力と作用点までの距離とから
演算して求める力を指定することである。エンドエフェ
クタ５重心まわりのモーメント力をＭGXとし、重心位置
からエンドエフェクタ５の作用点までのＦに垂直な方向
の距離をＬとすると、モーメントから演算して求める力
ＦはＦ＝ＭGX ／Ｌ（２）として得られる。エンドエフェクタ５が加速度運動した
りして慣性力を受ける場合等、外部からのノイズの影響
をうけにくい信頼性高い力信号を検出することができる
（特開平４−１６４５８５号公報参照）。

【００３１】次に、以下に本発明の具体的実施例につい
て説明する。まず、図３乃至図５を参照して本発明の第
１実施例について説明する。ロボット本体１は、エンド
エフェクタ５としての円筒状のロータリーグラインダを
備えている。作業対象物Ｗ１は、長手方向に平板状の平
表面１５と、短手方向に互いに平行な平表面１６、１７
とを有する。また、平表面１５の法線方向と平表面１６
の法線方向とは直交する関係にある。ロータリーグライ
ンダ５の円筒側面が平表面１５へ指定押し付け力で押し
付けられるように力制御され、かつ図３に表示した移動
方向ベクトルＶ１の方向（ワーク座標系ΣＷにおける−
Ｙ方向）へ移動して、研磨作業が行われる。

【００３２】図４に、本実施例において指定する押し付
け方向テーブル１２を示す。テーブル番号を指定するこ
とにより、対応する押し付け方向テーブル１２が指定さ
れる。図４においては、座標系パラメータとしてワーク
座標系ΣＷが指定され、指定方向パラメータとして−Ｚ
方向が指定され、指定方法パラメータとして直接指定方
法が指定されている。

【００３３】ロボット言語解釈装置１０には種々の押し
付け方向テーブル１２が予め備えられているので、これ
らの３個のパラメータを各々指定しなくとも、テーブル
番号を１と指定するだけで、所望のパラメータを設定し
たことに等価となる。

【００３４】図５に、本実施例において指定する検出力
テーブル１３を示す。テーブル番号を指定することによ
り、検出力テーブル１３の具体的な内容が設定される。
図５においては、検出座標系パラメータとしてツール座
標系ΣＴが指定され、検出力パラメータとして並進力が
指定され、検出方向パラメータとしてＹ方向が指定され
ている。ここで、ワーク座標系ΣＷのＺ軸方向が平表面
１５の法線方向に、Ｙ軸方向が作業対象物Ｗ１の長手方
向に設定されている。ツール座標系ΣＴのＺ軸は、ロー
タリーグラインダ５の回転軸方向に設定されている。

【００３５】平面の研磨作業の場合、エンドエフェクタ
５は作業対象物Ｗ１の平表面１５へ押し付けられる。こ
の場合、エンドエフェクタ５は平表面１５に鉛直に押し
付けられることが確かであるので、力制御に使用する力
成分としてはエンドエフェクタ５が平表面１５から受け
る反力を使用することが適当である。従って、力制御に
使用する力成分の検出方向は、ツール座標系ΣＴのＹ方
向に設定され、エンドエフェクタ５が平表面１５の法線
方向に押し付けられることから指定方向パラメータとし
て−Ｚ方向が指定されている。

【００３６】なお、検出力パラメータとして並進力を指
定したが、モーメントから演算して求める力Ｆ＝Ｍ
GX ／Ｌを指定してもよい。また、押し付け方向テ
ーブル１２において、押し付け方向はワーク座標系ΣＷ
の−Ｚ方向と符号を含めて指定されている。このため、
力覚センサ４で検出した検出力のうちの力制御に使用す
る力成分の大きさを目標押し付け力と比較し、どの程度
ずれているかについて大きさのみがわかればよく、力成
分の正負の符号を考慮する必要がない。これにより、検
出力テーブル１３の設定時に検出力の方向を気にする必
要はなくなり、設定を容易に行うことができる。

【００３７】次に、図６乃至図８を参照して本発明の第
２実施例について説明する。ロボット本体１はエンドエ
フェクタ５として円錐型カッターを備えている。作業対
象物Ｗ２は平表面１８と曲表面１９とを有し、平表面１
８と曲表面１９との交線としてワーク端部２０が形成さ
れている。ワーク端部２０は同一平面上にある曲線を形
成している。また、平表面１８の法線方向と曲表面１９
の法線方向とは直交する関係にある。円錐型カッター５
の円錐面がワーク端部２０へ目標押し付け力で押し付け
られるように力制御され、かつ移動方向ベクトルＶ２の
方向へ移動し、ワーク端部２０の面取り作業が行われ
る。

【００３８】図７に、本実施例において指定する押し付
け方向テーブル１２を示す。本実施例においてはテーブ
ル番号２を指定することにより、押し付け方向テーブル
１２が指定される。

【００３９】図７においては、座標系パラメータとして
ワーク座標系ΣＷが指定され、指定方向パラメータとし
て＋Ｚ方向が指定され、指定方法パラメータとしてベク
トル外積指定方法が指定されている。

【００４０】ロボット言語解釈装置１０には種々の押し
付け方向テーブル１２が予め備えられているので、これ
らの３個のパラメータを各々指定しなくとも、テーブル
番号を２と指定するだけで、所望のパラメータを設定し
たことに等価となる。

【００４１】図８に、本実施例において指定する検出力
テーブル１３を示す。テーブル番号２を指定することに
より、検出力テーブル１３の具体的な内容が設定され
る。図８においては、検出座標系パラメータとしてツー
ル座標系ΣＴが指定され、検出力パラメータとして合成
力が指定され、検出方向パラメータとしてＸＹ平面の方
向が指定されている。本実施例では、ワーク座標系ΣＷ
においてＺ方向は平表面１８の法線方向に設定されてお
り、ツール座標系ΣＴのＺ方向は円錐型カッターの回転
軸方向に設定されている。

【００４２】本実施例では、指定方法パラメータとして
指定したベクトル外積指定方法においては、作業空間内
の選択方向は平表面１８の表面法線方向ベクトルＮ２の
方向に選択されている。エンドエフェクタ５の所定押し
付け方向を、式（３）で表される押し付け方向ベクトル
Ｆ２の方向に設定する。押し付け方向ベクトルＦ２は、
ベクトルＶ２とベクトルＮ２の外積として、Ｆ２＝Ｖ２ × Ｎ２（３）で与えられる。

【００４３】ワーク端部２０の面取り作業の場合は、作
業の進行状況に応じて作業対象物Ｗ２から受ける反力の
向きが変化する。このため、エンドエフェクタ５で検出
する力の方向もそれに合わせて変化させる必要がある。
しかしながら、ワーク端部２０の形状が予めわかってい
ない場合、作業の進行状況に応じて検出力の指定を変更
することは困難である。そこで本実施例の場合では、力
覚センサ４により検出した検出力のうちの力制御に使用
する力成分として、ツール座標系ΣＴのＸＹ平面内の合
成力を指定しているのである。これにより、作業の進行
状況に応じて作業対象物Ｗ２から受ける反力の方向が変
化しても、それを気にする必要がなくなる。

【００４４】さらに、エンドエフェクタ５の押し付け方
向の指定についても、エンドエフェクタ５がワーク端部
２０の周囲を一周するとエンドエフェクタ５の押し付け
方向も変化し得る。しかしながら、エンドエフェクタ５
の押し付け方向が変化した場合においても、ベクトル外
積指定方法に従えば、押し付け方向をエンドエフェクタ
５の進行方向ベクトルと作業空間内に設定した方向ベク
トル（ここでは、平表面１８の法線方向Ｎ２であるワー
ク座標系ΣＷにおける＋Ｚ方向）との双方に直交する方
向として指定することで、作業の最初から最後まで押し
付け方向の指定を変更せずに作業を実行することができ
る。この結果、作業中に作業対象物Ｗ２のワーク端部２
０の曲線形状に応じてエンドエフェクタ５の押し付け方
向を変化させる必要がある面取り作業において、作業の
最初から最後までエンドエフェクタ５の押し付け方向の
指定を変更する必要がなくなり、動作プログラムの生成
を非常に容易に行うことができる。

【００４５】以上説明したように、第１あるいは第２の
実施例の構成によれば、押し付け方向テーブル１２およ
び検出力テーブル１３に適当な値を設定することによ
り、研磨作業やワーク端部２０の面取り作業のような種
々の異なる作業を実行する場合に、それぞれの作業に適
した力制御方法を容易に設定するができる。この結果、
異なる作業に適した力制御を容易に行うことができる。

【００４６】なお、上述の実施例の説明において、ロボ
ット言語解釈装置１０は制御装置２に設けられていると
したが、ティーチペンダント３に設けてもよく、あるい
は、制御装置２とティーチペンダント３との両方にまた
がって設けてもよい。

【００４７】また、ロボット本体１の軸構成は６軸円筒
座標型である必要はなく、多関節型、極座標型あるいは
直交座標型などいかなる構成であってもかまわない。ま
た手先部の力覚センサは、６軸力覚センサ４に限らずエ
ンドエフェクタ５に作用する力を検出できるものであれ
ば他の構成でもよい。

【００４８】

【発明の効果】以上説明したように、本発明の構成によ
れば、ロボット言語解釈装置は、指定押し付け力の押し
付け方向を指定する押し付け方向テーブルと、力覚セン
サで検出する検出力のうち力制御に使用する力成分を指
定する検出力テーブルと、押し付け方向テーブルおよび
検出力テーブルの各々のパラメータを指定するパラメー
タ指定手段を備えているので、作業の種類や作業対象物
の形状に応じて適する力制御を容易に指定し実行するこ
とができる。

【図面の簡単な説明】

【図１】本発明による力制御ロボットにおけるロボット
言語解釈装置の詳細構成を示すブロック図。

【図２】力制御ロボットの全体構成を示す斜視図。

【図３】本発明の実施例において平面の研磨作業を行う
ことを説明する図。

【図４】本発明の第１実施例における押し付け方向テー
ブルの内容を示す図。

【図５】本発明の第１実施例における検出力テーブルの
内容を示す図。

【図６】本発明の第２実施例においてワーク端部の面取
り作業を行うことを説明する図。

【図７】本発明の第２実施例における押し付け方向テー
ブルの内容を示す図。

【図８】本発明の第２実施例における検出力テーブルの
内容を示す図。

【符号の説明】

１ロボット本体２制御装置３ティーチペンダント４力覚センサ５エンドエフェクタ６アーム制御装置Ｗ，Ｗ１，Ｗ２作業対象物１０ロボット言語解釈装置１１パラメータ指定手段１２押し付け方向テーブル１３検出力テーブル

フロントページの続き (72)発明者尾崎文夫神奈川県川崎市幸区小向東芝町１株式会社東芝研究開発センター内 (72)発明者玉田保彦静岡県沼津市大岡2068の３東芝機械株式会社沼津事業所内

Claims

【特許請求の範囲】

【請求項１】ロボット手先部にある力覚センサを用いて
エンドエフェクタを作業対象物の表面へ指定押し付け力
で押し付けるように力制御し、この表面に沿って前記エ
ンドエフェクタを移動させて作業を行う力制御ロボット
において、所望作業を選択し実行するために必要な複数のパラメー
タを解釈するロボット言語解釈装置を備え、前記ロボット言語解釈装置は、前記指定押し付け力の押
し付け方向を指定する押し付け方向テーブルと、前記力
覚センサで検出する検出力のうち前記力制御に使用する
力成分を指定する検出力テーブルと、前記押し付け方向
テーブルおよび前記検出力テーブルの各々のパラメータ
を指定するパラメータ指定手段とを備えることを特徴と
する力制御ロボット。
【請求項２】前記押し付け方向テーブルは、押し付け方
向を指定するために、採用する座標系を指定する座標系
パラメータと、この座標系における押し付け方向を指定
する指定方向パラメータと、押し付け方向の指定方法を
指定する指定方法パラメータとを有することを特徴とす
る請求項１に記載の力制御ロボット。
【請求項３】前記指定方法パラメータは、採用された座
標系におけるいずれかの座標軸方向を指定する直接指定
方法、前記エンドエフェクタの移動方向と作業空間内に
所望に選択した選択方向とのベクトル外積で指定するベ
クトル外積指定方法、あるいは円弧の中心向きか外向き
かを指定する円弧指定方法のいずれかの指定方法で指定
されることを特徴とする請求項２に記載の力制御ロボッ
ト。
【請求項４】前記検出力テーブルは、前記力制御に使用
する力成分を指定するために、採用する座標系を指定す
る検出座標系パラメータと、検出する力成分の方向を指
定する検出方向パラメータと、検出する力成分の種類を
指定する検出力パラメータとを有することを特徴とする
請求項１に記載の力制御ロボット。
【請求項５】前記検出力パラメータは、採用された座標
系のいずれかの座標軸方向に作用する並進力、複数の力
成分が合成された合成力、あるいは前記エンドエフェク
タの重心回りに作用するモーメント力と作用点までの距
離とから演算して求める力のいずれかで指定されること
を特徴とする請求項４に記載の力制御ロボット。
【請求項６】前記検出力パラメータは、検出する力成分
の大きさのみを指定するパラメータであることを特徴と
する請求項４または請求項５に記載の力制御ロボット。