JPH0691568A - ロボット制御装置 - Google Patents
ロボット制御装置Info
- Publication number
- JPH0691568A JPH0691568A JP24638792A JP24638792A JPH0691568A JP H0691568 A JPH0691568 A JP H0691568A JP 24638792 A JP24638792 A JP 24638792A JP 24638792 A JP24638792 A JP 24638792A JP H0691568 A JPH0691568 A JP H0691568A
- Authority
- JP
- Japan
- Prior art keywords
- joint angle
- robot
- joint
- force
- position control
- 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
- Manipulator (AREA)
- Control Of Position Or Direction (AREA)
Abstract
(57)【要約】
【目的】 要求軌道に対する追従性が良く、かつ安定性
の良い制御装置を提供する。また、作業対象やロボット
のアーム姿勢によらない安定な力制御を実現できる制御
装置を提供する。 【構成】 ロボットの制御装置は、減速機を介して関節
が駆動されるロボットの関節角を検出し、検出された関
節角をフィードバックして目標関節角に追従させる位置
制御手段と、ロボットに加わる外力を検出する力検出手
段とを有し、力検出手段(14)により検出された検出
力(fx)と要求作用力(dfx)とを入力としてその
入力に応じたロボットの変位を出すように予め定めた仮
想力学モデル(3)に従って演算する仮想力学モデル演
算部を設け、この仮想力学モデル演算部の出力を入力と
して目標関節角を出力とし検出される関節角の位置制御
手段の入力値に対する遅れを補償する前置補償器(2
a、2b)を位置制御手段の前段に設けたことを特徴と
する。
の良い制御装置を提供する。また、作業対象やロボット
のアーム姿勢によらない安定な力制御を実現できる制御
装置を提供する。 【構成】 ロボットの制御装置は、減速機を介して関節
が駆動されるロボットの関節角を検出し、検出された関
節角をフィードバックして目標関節角に追従させる位置
制御手段と、ロボットに加わる外力を検出する力検出手
段とを有し、力検出手段(14)により検出された検出
力(fx)と要求作用力(dfx)とを入力としてその
入力に応じたロボットの変位を出すように予め定めた仮
想力学モデル(3)に従って演算する仮想力学モデル演
算部を設け、この仮想力学モデル演算部の出力を入力と
して目標関節角を出力とし検出される関節角の位置制御
手段の入力値に対する遅れを補償する前置補償器(2
a、2b)を位置制御手段の前段に設けたことを特徴と
する。
Description
【0001】
【産業上の利用分野】本発明は、ロボット制御装置に係
り、特に、減速機を備えた産業用ロボットや極限作業ロ
ボットなどのロボット制御装置に関する。
り、特に、減速機を備えた産業用ロボットや極限作業ロ
ボットなどのロボット制御装置に関する。
【0002】
【従来の技術】ロボットの運動は、コリオリ力、重力、
遠心力またはクローン摩擦といった非線形項を含む複雑
な運動方程式で表される。このため、DD(ダイレクト
ドライブ)ロボットで高度な作業を行う場合は、複雑な
非線形補償を行い各軸の関節発生力を算出する制御が採
用される。
遠心力またはクローン摩擦といった非線形項を含む複雑
な運動方程式で表される。このため、DD(ダイレクト
ドライブ)ロボットで高度な作業を行う場合は、複雑な
非線形補償を行い各軸の関節発生力を算出する制御が採
用される。
【0003】しかし、減速機を備えたロボットの場合、
減速機の弾性やクローン摩擦といった補償し難い非線形
性の影響が大きく、先の逆動力学を用いた非線形補償
は、演算時間を増加させるだけでほとんど効果がない。
また、運動方程式に現れる非線形項の変化はモータから
見ると減速比分の1であり、高減速比の減速機を用いて
いればほとんど影響しなくなる。このため、これらのロ
ボットでは各関節軸毎にサーボ系でロボットを制御して
いる。
減速機の弾性やクローン摩擦といった補償し難い非線形
性の影響が大きく、先の逆動力学を用いた非線形補償
は、演算時間を増加させるだけでほとんど効果がない。
また、運動方程式に現れる非線形項の変化はモータから
見ると減速比分の1であり、高減速比の減速機を用いて
いればほとんど影響しなくなる。このため、これらのロ
ボットでは各関節軸毎にサーボ系でロボットを制御して
いる。
【0004】図5に、この従来のロボット制御システム
のブロック図を示す。図5の従来例では、ロボット作業
時の座標系(通常は直交座標系)で与えられた軌道 dP
を、座標変換手段42により関節の座標目標値 dθに逐
次変換している。(ここで、添字 dは「要求される」の
意を示す。)この他に、作業座標系の通過点が与えら
れ、その座標変換した関節角間を補間する関節角軌道を
生成して、この関節軌道により制御する従来例もある。
のブロック図を示す。図5の従来例では、ロボット作業
時の座標系(通常は直交座標系)で与えられた軌道 dP
を、座標変換手段42により関節の座標目標値 dθに逐
次変換している。(ここで、添字 dは「要求される」の
意を示す。)この他に、作業座標系の通過点が与えら
れ、その座標変換した関節角間を補間する関節角軌道を
生成して、この関節軌道により制御する従来例もある。
【0005】いずれにせよ、高減速比の減速機を備えた
ロボットでは、関節の要求目標値を追従する位置制御を
基本とし、ロボット作業座標系での動作を実現してい
る。
ロボットでは、関節の要求目標値を追従する位置制御を
基本とし、ロボット作業座標系での動作を実現してい
る。
【0006】このように高減速比の減速機を備えたロボ
ットでは、非線形補償を行わず、各軸の関節位置制御で
簡単にロボットを制御できる利点がある一方、関節の弾
性影響で、高い位置追従性を得ることができないという
問題点がある。
ットでは、非線形補償を行わず、各軸の関節位置制御で
簡単にロボットを制御できる利点がある一方、関節の弾
性影響で、高い位置追従性を得ることができないという
問題点がある。
【0007】高減速比の減速機を備えたロボットでは、
減速機等の動力伝達系に弾性があり、かつガタを生じや
すい。この関節弾性の影響で、ロボット姿勢により変化
する複雑な固有振動モードを生じ、結果として関節の位
置制御ゲインを上げるとロボット手先が振動的になる。
減速機等の動力伝達系に弾性があり、かつガタを生じや
すい。この関節弾性の影響で、ロボット姿勢により変化
する複雑な固有振動モードを生じ、結果として関節の位
置制御ゲインを上げるとロボット手先が振動的になる。
【0008】一般的に、関節位置制御による剛性とロボ
ット自体の関節剛性は、1:4程度が良いとされ、ロボ
ットが振動的にならない設定では位置追従性が制限され
る。つまり、高過減速を必要とする高速で高度な作業は
実現できない問題がある。
ット自体の関節剛性は、1:4程度が良いとされ、ロボ
ットが振動的にならない設定では位置追従性が制限され
る。つまり、高過減速を必要とする高速で高度な作業は
実現できない問題がある。
【0009】次に、ロボットを力制御する従来例を説明
する。
する。
【0010】近年、6軸力センサの普及により、産業用
ロボットに力制御を取り入れる動きが盛んであるが、減
速機をもつロボットではあまり良好な力制御が行われて
いないのが実情である。
ロボットに力制御を取り入れる動きが盛んであるが、減
速機をもつロボットではあまり良好な力制御が行われて
いないのが実情である。
【0011】図6に従来の力制御ブロック図を示す。
【0012】力制御においては、要求される要求作用力
dfと、力検出手段により検出された作業時反力fとが
一致するように、PD動作によるファイードバック系3
0が組まれ、これを積分器31で積分して要求位置rを
生成する。要求位置rは、座標変換手段42により要求
関節角度 rθに変換され、各関節はこれを追従するよう
にフィードバック制御されている。(なお、従来技術に
おいては「目標位置」=「要求位置」である。)ここ
で、力検出手段により検出された作業時反力は、位置追
従系と作業対象の柔らかさとの両者に依存している。つ
まり、力制御系の制御出力から作業時反力までの伝達関
数(力制御での制御対象)は、作業対象や作業座標系で
見た位置制御系の動特性で変化することになる。
dfと、力検出手段により検出された作業時反力fとが
一致するように、PD動作によるファイードバック系3
0が組まれ、これを積分器31で積分して要求位置rを
生成する。要求位置rは、座標変換手段42により要求
関節角度 rθに変換され、各関節はこれを追従するよう
にフィードバック制御されている。(なお、従来技術に
おいては「目標位置」=「要求位置」である。)ここ
で、力検出手段により検出された作業時反力は、位置追
従系と作業対象の柔らかさとの両者に依存している。つ
まり、力制御系の制御出力から作業時反力までの伝達関
数(力制御での制御対象)は、作業対象や作業座標系で
見た位置制御系の動特性で変化することになる。
【0013】力制御の内側に構成されている位置制御系
は、先に問題として示したように、あまり高い追従性を
持たないので、かなりの位相遅れ系である。このため、
作業対象が硬い場合、力制御の制御対象が不安定対象と
なる事態が生ずる。
は、先に問題として示したように、あまり高い追従性を
持たないので、かなりの位相遅れ系である。このため、
作業対象が硬い場合、力制御の制御対象が不安定対象と
なる事態が生ずる。
【0014】さらに、各関節の位置制御の帯域が低いた
め、作業座標系で見た比較的高い帯域での位置制御特性
は、ロボットの姿勢により変化し、結果として力制御対
象は例え作業対象が同一の特性を持っていても、ロボッ
ト姿勢で変化することになる。
め、作業座標系で見た比較的高い帯域での位置制御特性
は、ロボットの姿勢により変化し、結果として力制御対
象は例え作業対象が同一の特性を持っていても、ロボッ
ト姿勢で変化することになる。
【0015】以上により、図6に示す従来方式の力制御
手段では、作業対象の硬さによりその安定性が変化し、
作業対象によっては不安定となった。さらに、安定な作
業対象でも、ロボットのアーム姿勢によっては不安定発
振を生ずる望ましくないものであった。
手段では、作業対象の硬さによりその安定性が変化し、
作業対象によっては不安定となった。さらに、安定な作
業対象でも、ロボットのアーム姿勢によっては不安定発
振を生ずる望ましくないものであった。
【0016】
【発明が解決しようとする課題】以上のように、従来の
ロボット制御装置では、関節弾性の影響で、位置追従性
が上げられず高加減速を要する高速作業ができなかっ
た。
ロボット制御装置では、関節弾性の影響で、位置追従性
が上げられず高加減速を要する高速作業ができなかっ
た。
【0017】また、ロボットの力制御でも、目標位置へ
の追従性が低いため、作業対象のコンプライアンスに応
じた力制御設定が必要で、作業対象や作業位置により不
安定となる危険があった。
の追従性が低いため、作業対象のコンプライアンスに応
じた力制御設定が必要で、作業対象や作業位置により不
安定となる危険があった。
【0018】そこで本発明の目的は、第1として、関節
毎の軌道追従性を向上し位置制御の位相遅れのほとんど
ないロボット制御装置を提案することであり、第2とし
て、作業対象の硬さや作業位置によらず安定で、かつ力
制御帯域の広いロボット制御装置を提案することであ
る。
毎の軌道追従性を向上し位置制御の位相遅れのほとんど
ないロボット制御装置を提案することであり、第2とし
て、作業対象の硬さや作業位置によらず安定で、かつ力
制御帯域の広いロボット制御装置を提案することであ
る。
【0019】
【課題を解決するための手段】以上の目的を達成する手
段として、従来制御装置に加え、本発明では第1に、要
求関節角を入力として、関節位置制御系の遅れを考慮し
てこれを補償し、位置制御手段の目標角を生成出力する
前置補償器を備える構成とした。
段として、従来制御装置に加え、本発明では第1に、要
求関節角を入力として、関節位置制御系の遅れを考慮し
てこれを補償し、位置制御手段の目標角を生成出力する
前置補償器を備える構成とした。
【0020】また、第2に、ロボットへの要求作用力と
上記力検出手段の検出力とを入力として運動する計算機
上に構築された仮想内部モデルと、その内部モデルの運
動位置を座標変換して要求関節角を生成する座標変換手
段と、生成された要求関節角を入力として上記位置制御
手段の目標角を生成出力する前置補償器を備える構成に
した。
上記力検出手段の検出力とを入力として運動する計算機
上に構築された仮想内部モデルと、その内部モデルの運
動位置を座標変換して要求関節角を生成する座標変換手
段と、生成された要求関節角を入力として上記位置制御
手段の目標角を生成出力する前置補償器を備える構成に
した。
【0021】具体的には、ロボットの制御装置は、減速
機を介して関節が駆動されるロボットの関節角を検出
し、検出された関節角をフィードバックして目標関節角
に追従させる位置制御手段を有するロボット制御装置に
おいて、要求関節角を入力して目標関節角を出力し、検
出される関節角の前記位置制御手段の入力値に対する遅
れを補償する前置補償器を前記位置制御手段の前段に設
けたことを特徴とする。
機を介して関節が駆動されるロボットの関節角を検出
し、検出された関節角をフィードバックして目標関節角
に追従させる位置制御手段を有するロボット制御装置に
おいて、要求関節角を入力して目標関節角を出力し、検
出される関節角の前記位置制御手段の入力値に対する遅
れを補償する前置補償器を前記位置制御手段の前段に設
けたことを特徴とする。
【0022】また、ロボットの制御装置は、減速機を介
して関節が駆動されるロボットの関節角を検出し、検出
された関節角をフィードバックして目標関節角に追従さ
せる位置制御手段と、ロボットに加わる外力を検出する
力検出手段とを有するロボット制御装置において、前記
力検出手段により検出された検出力と要求作用力とを入
力としてその入力に応じたロボットの変位を出力するよ
うに予め定めた仮想力学モデルに従って演算する仮想力
学モデル演算部を設け、この仮想力学モデル演算部の出
力を入力として目標関節角を出力とし検出される関節角
の前記位置制御手段の入力値に対する遅れを補償する前
置補償器を前記位置制御手段の前段に設けたことを特徴
とする。
して関節が駆動されるロボットの関節角を検出し、検出
された関節角をフィードバックして目標関節角に追従さ
せる位置制御手段と、ロボットに加わる外力を検出する
力検出手段とを有するロボット制御装置において、前記
力検出手段により検出された検出力と要求作用力とを入
力としてその入力に応じたロボットの変位を出力するよ
うに予め定めた仮想力学モデルに従って演算する仮想力
学モデル演算部を設け、この仮想力学モデル演算部の出
力を入力として目標関節角を出力とし検出される関節角
の前記位置制御手段の入力値に対する遅れを補償する前
置補償器を前記位置制御手段の前段に設けたことを特徴
とする。
【0023】
【作用】関節駆動手段の入力uから、関節角検出手段の
出力θまでの連続時間系応答は、離散式で次式のように
表せる。
出力θまでの連続時間系応答は、離散式で次式のように
表せる。
【0024】 ただし、a1,a2,b0,b1は、関節駆動系の特性
パラメータである。
パラメータである。
【0025】今、従来のように位置制御系を組むと次式
となり、 u[k+1]=P(z-1)( rθ[k] −θ[k] ) (2) P(z-1):PD動作の離散表現r θ[k] :k時点での目標関節角 位置制御を含めた閉ループ伝達関数は、次の形で表せ
る。
となり、 u[k+1]=P(z-1)( rθ[k] −θ[k] ) (2) P(z-1):PD動作の離散表現r θ[k] :k時点での目標関節角 位置制御を含めた閉ループ伝達関数は、次の形で表せ
る。
【0026】 この伝達関数は、P(z-1)をハイゲインにするほど、
位置制御帯域が広くなるが、従来技術で記載したよう
に、固有振動に起因した外乱を増幅し、不安定発振を起
こすため、ゲインはさほど上げられない。
位置制御帯域が広くなるが、従来技術で記載したよう
に、固有振動に起因した外乱を増幅し、不安定発振を起
こすため、ゲインはさほど上げられない。
【0027】本発明の前置き補償器は、この位置制御系
を含めた伝達関数を制御対象とみなし、この応答を考慮
して、積極的に制御対象への入力(関節位置制御手段へ
の入力)を変化させる。
を含めた伝達関数を制御対象とみなし、この応答を考慮
して、積極的に制御対象への入力(関節位置制御手段へ
の入力)を変化させる。
【0028】これにより、制御対象の出力は目標値に遅
れていても、目標値が要求軌道に対し、進んだものであ
れば、制御対象の出力(関節角)は要求軌道と一致させ
ることができる。特に、位置制御ゲインをハイゲインに
して、追従性を向上させているのではないため、振動の
ない安定したロボット動作を実現できる特徴がある。
れていても、目標値が要求軌道に対し、進んだものであ
れば、制御対象の出力(関節角)は要求軌道と一致させ
ることができる。特に、位置制御ゲインをハイゲインに
して、追従性を向上させているのではないため、振動の
ない安定したロボット動作を実現できる特徴がある。
【0029】前置き補償の一例として、次の(4)式を
採用した場合で、補足説明する。
採用した場合で、補足説明する。
【0030】 ただし、 dθ[k+2] は、k時点での2制御周期未来の要
求関節角である。
求関節角である。
【0031】高減速機を用いたロボットの場合、アーム
の運動や姿勢によるパラメータ変化は少ないので、
(1)式のA(z-1)、B(z-1)は、その入出力関係
から事前に求めることができる。また、P(z-1)は位
置制御の設定値で、 dθ[k+2] も要求軌道であるので、
共に既知である。よって、(4)式を構成することは可
能で、この前置き補償と(3)式とから、閉ループ伝達
関数の極(分母)と零点(分子)は相殺される。
の運動や姿勢によるパラメータ変化は少ないので、
(1)式のA(z-1)、B(z-1)は、その入出力関係
から事前に求めることができる。また、P(z-1)は位
置制御の設定値で、 dθ[k+2] も要求軌道であるので、
共に既知である。よって、(4)式を構成することは可
能で、この前置き補償と(3)式とから、閉ループ伝達
関数の極(分母)と零点(分子)は相殺される。
【0032】つまり、要求軌道から制御対象出力までの
伝達関数は1となり、完全に各関節は要求軌道を追従す
ることになる。
伝達関数は1となり、完全に各関節は要求軌道を追従す
ることになる。
【0033】次に、本発明の力制御に関するロボット制
御装置の作用を説明する。
御装置の作用を説明する。
【0034】本発明における力制御では、前置き補償器
に加え、仮想内部モデルと呼ぶ計算機モデルを使用す
る。仮想モデルは、例えば、質量と緩衝器(ダンパ)か
らなる物理モデルでよく、質量体に要求作用力と検出力
の両者が加わって運動し、この仮想モデルの位置がロボ
ットの作業座標系での要求軌道となる。
に加え、仮想内部モデルと呼ぶ計算機モデルを使用す
る。仮想モデルは、例えば、質量と緩衝器(ダンパ)か
らなる物理モデルでよく、質量体に要求作用力と検出力
の両者が加わって運動し、この仮想モデルの位置がロボ
ットの作業座標系での要求軌道となる。
【0035】前置き補償器の入力は関節軌道であるの
で、逆運動学を用いた公知の座標変換手段により、作業
座標から各関節角軌道に変換され、上記の前置き補償器
の作用により、関節角はこの関節軌道をほぼ完全に追従
する。つまり、手先位置は仮想内部モデルの位置と一致
し、作業対象やロボットの姿勢に依存しない、仮想モデ
ルと同一の力制御性能を得ることができるようになる。
で、逆運動学を用いた公知の座標変換手段により、作業
座標から各関節角軌道に変換され、上記の前置き補償器
の作用により、関節角はこの関節軌道をほぼ完全に追従
する。つまり、手先位置は仮想内部モデルの位置と一致
し、作業対象やロボットの姿勢に依存しない、仮想モデ
ルと同一の力制御性能を得ることができるようになる。
【0036】また、仮想モデルのパラメータは、力制御
の動特性を決めるもので、仮想モデルにバネ・マス・ダ
ンパモデルを使えば、インピーダンス制御と呼ばれる高
度な動的力制御も容易に実現できる。
の動特性を決めるもので、仮想モデルにバネ・マス・ダ
ンパモデルを使えば、インピーダンス制御と呼ばれる高
度な動的力制御も容易に実現できる。
【0037】
【実施例】本発明によるロボット制御装置の実施例を図
面を参照して説明する。図1に本発明の第1実施例を示
す。あらかじめ各関節の軌道(時系列の関節角)が与え
られていて、これを高速追従する場合の例である。
面を参照して説明する。図1に本発明の第1実施例を示
す。あらかじめ各関節の軌道(時系列の関節角)が与え
られていて、これを高速追従する場合の例である。
【0038】ロボットは、各関節軸10毎に、モータ、
減速機およびサーボドライバ11から構成される関節駆
動手段と、関節角検出器12と、角速度検出器13を備
えている。サーボドライバ11は角速度検出器13で検
出される関節角速度が指令角速度と一致するようにアナ
ログの速度フィードバックを行っている。
減速機およびサーボドライバ11から構成される関節駆
動手段と、関節角検出器12と、角速度検出器13を備
えている。サーボドライバ11は角速度検出器13で検
出される関節角速度が指令角速度と一致するようにアナ
ログの速度フィードバックを行っている。
【0039】制御計算機は、位置制御手段20の出力を
D/A変換器21によりサーボドライバにホールド出力
し、関節角検出器12の出力をA/D変換器22で読み
込んでいる。
D/A変換器21によりサーボドライバにホールド出力
し、関節角検出器12の出力をA/D変換器22で読み
込んでいる。
【0040】位置制御手段20は、比例動作((2)式
のP(z-1)=gP )からなる位置フィードバックで、
関節目標値 rθと関節角θが一致するように指令角速度
uを算出する。
のP(z-1)=gP )からなる位置フィードバックで、
関節目標値 rθと関節角θが一致するように指令角速度
uを算出する。
【0041】以上の公知の制御系の伝達数1は、離散式
で表すと次式となる。
で表すと次式となる。
【0042】
【数1】 前置き補償器2は、要求軌道の2制御周期未来の要求関
節角 dθ[k+2] を入力として、次式の演算を行い、位置
制御手段20の入力である目標関節角を生成する。
節角 dθ[k+2] を入力として、次式の演算を行い、位置
制御手段20の入力である目標関節角を生成する。
【0043】
【数2】 本実施例で要求軌道は既知であるので、要求関節角の未
来値を使っても問題ない。また、式(6)で、
来値を使っても問題ない。また、式(6)で、
【0044】
【数3】 は、関節駆動手段11の入力から関節角度検出手段12
の出力までの連続時間系応答が(1)式と近似表現でき
ることを使って、各関節駆動部毎に、その入出力関係か
ら同定したパラメータである。
の出力までの連続時間系応答が(1)式と近似表現でき
ることを使って、各関節駆動部毎に、その入出力関係か
ら同定したパラメータである。
【0045】実際のロボットの各軸伝達関数(位置制御
手段を含めた制御対象)1は(5)式で、パラメータ次
数や値が、アーム姿勢や運動状態により変動するが、高
減速機を用いたロボットではそのパラメータ変化が少な
いので、位置制御手段を含めた制御対象1の極と零点
が、前置き補償器2の零点と極とで打ち消され、パラメ
ータ誤差の影響が大きくなる非常に高帯域まで、ほぼ完
全な要求軌道追従を実現できる。
手段を含めた制御対象)1は(5)式で、パラメータ次
数や値が、アーム姿勢や運動状態により変動するが、高
減速機を用いたロボットではそのパラメータ変化が少な
いので、位置制御手段を含めた制御対象1の極と零点
が、前置き補償器2の零点と極とで打ち消され、パラメ
ータ誤差の影響が大きくなる非常に高帯域まで、ほぼ完
全な要求軌道追従を実現できる。
【0046】なお、この実施例では、制御対象の極零相
殺補償器を採用したが、位相差零トラッキング制御と呼
ばれる補償器を前置きしたものでもよい。
殺補償器を採用したが、位相差零トラッキング制御と呼
ばれる補償器を前置きしたものでもよい。
【0047】次に図2を参照して本発明の第2実施例を
説明する。本実施例は、位置と力のハイブリッド制御と
呼ばれるものである。図3にその説明図を示す。ロボッ
トは、その先端にx−y平面上の反力を検出する力セン
サ14を備えており、2リンク2自由度に構成されてい
る。
説明する。本実施例は、位置と力のハイブリッド制御と
呼ばれるものである。図3にその説明図を示す。ロボッ
トは、その先端にx−y平面上の反力を検出する力セン
サ14を備えており、2リンク2自由度に構成されてい
る。
【0048】要求作業は、x軸方向に力制御、y軸方向
に位置制御を行いy軸と平行な壁の倣いを行うことであ
る。y軸方向の動作軌道はあらかじめ与えられている。
に位置制御を行いy軸と平行な壁の倣いを行うことであ
る。y軸方向の動作軌道はあらかじめ与えられている。
【0049】図2において、制御対象1a,1bは、図
1の1で示す従来の位置制御手段を含むロボットの各軸
構成であり、1aが第1関節,1bが第2関節の制御対
象である。符号100は、制御対象1a,1bと図示し
ない力センサ14および図示しない作業環境を内包した
ロボットの全体構成であり、目標関節角r θ1 ,r θ2
を入力とし、この入力により駆動した際の作業環境との
反力 Hfx , Hfy を検出し出力する。作業提唱を含め
た伝達系100の出力 Hfx , Hfy は、A/D変換器
23により計算機に読み込まれる。この力信号は、第2
リンクの座標系で表されているため、力座標変換手段4
1により、ロボットの作業座標に変換する。変換は次式
で行える。
1の1で示す従来の位置制御手段を含むロボットの各軸
構成であり、1aが第1関節,1bが第2関節の制御対
象である。符号100は、制御対象1a,1bと図示し
ない力センサ14および図示しない作業環境を内包した
ロボットの全体構成であり、目標関節角r θ1 ,r θ2
を入力とし、この入力により駆動した際の作業環境との
反力 Hfx , Hfy を検出し出力する。作業提唱を含め
た伝達系100の出力 Hfx , Hfy は、A/D変換器
23により計算機に読み込まれる。この力信号は、第2
リンクの座標系で表されているため、力座標変換手段4
1により、ロボットの作業座標に変換する。変換は次式
で行える。
【0050】 fx =c12 Hfx −s12 Hfy fy =s12 Hfx +c12 Hfy (7) ただし、 Hfx 、 Hfy は、力センサ座標系(第2リン
ク座標系)での検出力でs12=sin (θ1+θ2)、
c12=cos (θ1+θ2)である。
ク座標系)での検出力でs12=sin (θ1+θ2)、
c12=cos (θ1+θ2)である。
【0051】変換された力信号のうち、x軸方向は力制
御を行うため、仮想内部モデル3に送られる。仮想内部
モデル3は、マス・ダンパからなる物理モデルで、検出
力と要求作用力とで動作し、離散式で表わすと次式でそ
の運動を表せる。
御を行うため、仮想内部モデル3に送られる。仮想内部
モデル3は、マス・ダンパからなる物理モデルで、検出
力と要求作用力とで動作し、離散式で表わすと次式でそ
の運動を表せる。
【0052】
【数4】
【0053】ただし、α=(1−e-nT )T2 /2mM n=cM /mM d f:要求作用力、cM ;モデル粘性係数、mM ;モデ
ル慣性質量 f:f=fx で、座標変換して得られた検出力(反力と
符号が逆) T:制御周期 なお、関節弾性による外乱影響を考えて、仮想内部モデ
ルのパラメータが設定される。
ル慣性質量 f:f=fx で、座標変換して得られた検出力(反力と
符号が逆) T:制御周期 なお、関節弾性による外乱影響を考えて、仮想内部モデ
ルのパラメータが設定される。
【0054】(8)式から、x軸方向の動作軌道を得る
が、1制御周期未来の位置r[k+1]を算出できることが
わかる。ここでは、この1制御周期未来のx方向位置
を、座標変換手段42に送る。また、y軸方向は要求軌
道が既知であるので、x軸に合わせ1制御周期のy方向
未来値を送る。
が、1制御周期未来の位置r[k+1]を算出できることが
わかる。ここでは、この1制御周期未来のx方向位置
を、座標変換手段42に送る。また、y軸方向は要求軌
道が既知であるので、x軸に合わせ1制御周期のy方向
未来値を送る。
【0055】座標変換手段42は、この作業座標系で表
された1制御周期未来の要求位置を各関節角に変換す
る。座標変換は次式で行える。
された1制御周期未来の要求位置を各関節角に変換す
る。座標変換は次式で行える。
【0056】 dθ2=Cos-1〔(rx2 +ry2 −l1 2 −l2 2 )/2l1 l2 〕 dθ1=atan 2(ry,rx)−atan 2 (l2 sin dθ2,l1 +l2 cos dθ2) (9) この実施例では、各軸の前置き補償器2a,2bとして
次式の制御対象の零点を消去しない補償器を使う。
次式の制御対象の零点を消去しない補償器を使う。
【0057】
【数5】 この時、関節角は次式となる。
【0058】 θ[k] =γ dθ[k-1] +(1−γ) dθ[k-2] ただし、γ=b0/(b0+b1) 関節角は完全に要求関節軌道を追従するものではない
が、制御周期から考えて、十分な高帯域追従性を持つも
のである。
が、制御周期から考えて、十分な高帯域追従性を持つも
のである。
【0059】また、関節弾性を考慮して仮想内部モデル
3が設定されているので、その制御帯域において、ロボ
ット手先運動は仮想内部モデルと一致し、ロボットアー
ムの姿勢によらない安定した力制御を実現できる。
3が設定されているので、その制御帯域において、ロボ
ット手先運動は仮想内部モデルと一致し、ロボットアー
ムの姿勢によらない安定した力制御を実現できる。
【0060】なお、この実施例では、制御対象1a,1
bの極を相殺しない前置き補償器を採用したが、第1実
施例で示した方式の前置き補償器を採用してもかまわな
い。
bの極を相殺しない前置き補償器を採用したが、第1実
施例で示した方式の前置き補償器を採用してもかまわな
い。
【0061】次に、図4に本件発明の第3実施例を示
す。本実施例は、インピーダンス制御と呼ばれる動的力
制御に本発明を適用した例である。インピーダンス制御
とは、ロボットを柔らかく動かす制御である。外力が加
わらない時には、要求軌道にそって動作し、ロボットに
外力が加わると、要求軌道から外れることになっても、
その外力を小さくするようにロボットを動かす制御であ
り、はめ合い作業などに使われる。
す。本実施例は、インピーダンス制御と呼ばれる動的力
制御に本発明を適用した例である。インピーダンス制御
とは、ロボットを柔らかく動かす制御である。外力が加
わらない時には、要求軌道にそって動作し、ロボットに
外力が加わると、要求軌道から外れることになっても、
その外力を小さくするようにロボットを動かす制御であ
り、はめ合い作業などに使われる。
【0062】この場合、仮想内部モデル3は(11)式
からなるバネ・マス・ダンパ構成の物理モデルで表さ
れ、作業座標系に換算された検出力fを入力とし、その
検出力による変位量を算出する。
からなるバネ・マス・ダンパ構成の物理モデルで表さ
れ、作業座標系に換算された検出力fを入力とし、その
検出力による変位量を算出する。
【0063】
【数6】 (11)式を離散化して表現すると次式となる。
【0064】 ただし、AM (z-1)=1+aM12-1+aM2z-2 BM (z-1)=bM0+bM1z-1 なお、関節弾性による外乱影響があるため、仮想内部モ
デルのパラメータは任意に設定できるわけではなく、あ
る程度の慣性質量が必要で、かつ(11)式が漸近安定
になるように設定される。
デルのパラメータは任意に設定できるわけではなく、あ
る程度の慣性質量が必要で、かつ(11)式が漸近安定
になるように設定される。
【0065】(12)式から、1制御周期未来のモデル
の変位e[k+1] を算出でき、要求軌道の未来値 dP[k+
1] と加算することで、ロボットを柔らかく動かすため
の補正された軌道r[k+1] を得ることができる。
の変位e[k+1] を算出でき、要求軌道の未来値 dP[k+
1] と加算することで、ロボットを柔らかく動かすため
の補正された軌道r[k+1] を得ることができる。
【0066】その他は、第1、第2実施例と同じである
ので、省略する。
ので、省略する。
【0067】なお、インピーダンス制御では、要求作用
力が存在しないため、検出力のみを仮想内部モデルの入
力としているが、要求作用力0と検出力とを入力とした
ものと考えれば、請求項2と矛盾しない。
力が存在しないため、検出力のみを仮想内部モデルの入
力としているが、要求作用力0と検出力とを入力とした
ものと考えれば、請求項2と矛盾しない。
【0068】また、要求軌道と仮想内部モデルの変位と
を加算して、補正軌道を算出し、これを座標変換手段に
与えているが、この補正軌道は、ベースが要求軌道に固
定され、検出力で動作する仮想内部モデルの運動位置と
等価であり、請求項2と矛盾しない。
を加算して、補正軌道を算出し、これを座標変換手段に
与えているが、この補正軌道は、ベースが要求軌道に固
定され、検出力で動作する仮想内部モデルの運動位置と
等価であり、請求項2と矛盾しない。
【0069】
【発明の効果】以上説明したように、本発明によれば、
減速機を各関節に持つロボットであっても、高加減速を
要する高度な作業を、安定にかつ容易に実現できるよう
になる。また、減速機を各関節に持つロボットの力制御
では作業対象の硬さや作業位置による安定性の変化がな
く、良好な力制御を容易に実現できるようになる。ま
た、従来DDロボットでなければ困難であった動的力制
御を容易に実現することができる。
減速機を各関節に持つロボットであっても、高加減速を
要する高度な作業を、安定にかつ容易に実現できるよう
になる。また、減速機を各関節に持つロボットの力制御
では作業対象の硬さや作業位置による安定性の変化がな
く、良好な力制御を容易に実現できるようになる。ま
た、従来DDロボットでなければ困難であった動的力制
御を容易に実現することができる。
【図1】本発明によるロボット制御装置の第1実施例を
示すブロック図。
示すブロック図。
【図2】同第2実施例を示すブロック図。
【図3】同第2実施例におけるロボットの作業を示す
図。
図。
【図4】同第3実施例を示すブロック図。
【図5】従来の軌道追従制御例を示すブロック図。
【図6】従来の力制御例を示すブロック図。
1 制御対象(従来の関節制御手段を含むロボットシス
テム) 2 前置補償器 3 仮想内部モデル 10 ロボット 11 サーボドライバ 12 関節角検出器 13 関節角速度検出器 14 力検出器 20 関節位置制御手段 21 D/A変換器 22 A/D変換器(関節角用) 23 A/D変換器(力検出用) 30 PD動作による力制御手段 31 積分器 41 力の座標変換手段 42 位置の座標変換手段 100 作業対象を含めた伝達系(外部環境と接触した
際の制御対象) 200 計算機演算による入出力むだ時間を模擬した遅
延器(本来存在しない)
テム) 2 前置補償器 3 仮想内部モデル 10 ロボット 11 サーボドライバ 12 関節角検出器 13 関節角速度検出器 14 力検出器 20 関節位置制御手段 21 D/A変換器 22 A/D変換器(関節角用) 23 A/D変換器(力検出用) 30 PD動作による力制御手段 31 積分器 41 力の座標変換手段 42 位置の座標変換手段 100 作業対象を含めた伝達系(外部環境と接触した
際の制御対象) 200 計算機演算による入出力むだ時間を模擬した遅
延器(本来存在しない)
Claims (2)
- 【請求項1】減速機を介して関節が駆動されるロボット
の関節角を検出し、検出された関節角をフィードバック
して目標関節角に追従させる位置制御手段を有するロボ
ット制御装置において、要求関節角を入力して目標関節
角を出力し、検出される関節角の前記位置制御手段の入
力値に対する遅れを補償する前置補償器を前記位置制御
手段の前段に設けたことを特徴とするロボットの制御装
置。 - 【請求項2】減速機を介して関節が駆動されるロボット
の関節角を検出し、検出された関節角をフィードバック
して目標関節角に追従させる位置制御手段と、ロボット
に加わる外力を検出する力検出手段とを有するロボット
制御装置において、前記力検出手段により検出された検
出力と要求作用力とを入力としてその入力に応じたロボ
ットの変位を出力するように予め定めた仮想力学モデル
に従って演算する仮想力学モデル演算部を設け、この仮
想力学モデル演算部の出力を入力として目標関節角を出
力とし検出される関節角の前記位置制御手段の入力値に
対する遅れを補償する前置補償器を前記位置制御手段の
前段に設けたことを特徴とするロボットの制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP24638792A JPH0691568A (ja) | 1992-09-16 | 1992-09-16 | ロボット制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP24638792A JPH0691568A (ja) | 1992-09-16 | 1992-09-16 | ロボット制御装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
JPH0691568A true JPH0691568A (ja) | 1994-04-05 |
Family
ID=17147778
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP24638792A Withdrawn JPH0691568A (ja) | 1992-09-16 | 1992-09-16 | ロボット制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPH0691568A (ja) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6986613B2 (en) | 1997-07-15 | 2006-01-17 | Silverbrook Research Pty Ltd | Keyboard |
WO2011036750A1 (ja) * | 2009-09-24 | 2011-03-31 | 株式会社 東芝 | ロボット制御装置 |
CN104669261A (zh) * | 2015-02-11 | 2015-06-03 | 北京航空航天大学 | 一种可同步调整位移式变刚度关节驱动器和机器人关节刚度的一种调整方法 |
JP2020151824A (ja) * | 2019-03-22 | 2020-09-24 | キヤノン株式会社 | 制御装置、ロボット装置、制御方法、物品の製造方法、プログラム、及び記録媒体 |
-
1992
- 1992-09-16 JP JP24638792A patent/JPH0691568A/ja not_active Withdrawn
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6986613B2 (en) | 1997-07-15 | 2006-01-17 | Silverbrook Research Pty Ltd | Keyboard |
WO2011036750A1 (ja) * | 2009-09-24 | 2011-03-31 | 株式会社 東芝 | ロボット制御装置 |
US8428779B2 (en) | 2009-09-24 | 2013-04-23 | Kabushiki Kaisha Toshiba | Robot controlling device |
JP5238885B2 (ja) * | 2009-09-24 | 2013-07-17 | 株式会社東芝 | ロボット制御装置 |
CN104669261A (zh) * | 2015-02-11 | 2015-06-03 | 北京航空航天大学 | 一种可同步调整位移式变刚度关节驱动器和机器人关节刚度的一种调整方法 |
JP2020151824A (ja) * | 2019-03-22 | 2020-09-24 | キヤノン株式会社 | 制御装置、ロボット装置、制御方法、物品の製造方法、プログラム、及び記録媒体 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2022007358A1 (zh) | 阻抗控制方法、装置、阻抗控制器和机器人 | |
JPH0740204B2 (ja) | 多自由度非線形機械システムの制御装置 | |
KR101688344B1 (ko) | 다관절 로봇의 위빙 제어 장치 | |
Hashimoto et al. | Experimental study on torque control using Harmonic Drive built‐in torque sensors | |
Kim et al. | Compliant control of a two-link flexible manipulator featuring piezoelectric actuators | |
JPH10128688A (ja) | ロボットの非干渉化制御方法 | |
JPH10309684A (ja) | マニピュレータのコンプライアンス制御方式 | |
JPH10329063A (ja) | ロボット制御装置 | |
JP3081518B2 (ja) | ロボットの剛性同定方法及びその装置 | |
Feliu et al. | Inverse dynamics based control system for a three-degree-of-freedom flexible arm | |
Youcef-Toumi et al. | Force control of direct-drive manipulators for surface following | |
JP2020064576A (ja) | 制御システム、制御方法、及び制御プログラム | |
JPH0691568A (ja) | ロボット制御装置 | |
JPH0852675A (ja) | マニピュレータの選択的外乱補償型ハイブリッド制御装置および制御方法 | |
JP3300144B2 (ja) | 多軸ロボットのウィービング制御方法 | |
JPH02205489A (ja) | マニピュレータのインピーダンス制御方式 | |
WO1994017461A1 (en) | Apparatus for controlling weaving of robot | |
JPH04343690A (ja) | 多関節マニピュレータの関節摩擦補償方法 | |
JPS6190207A (ja) | ロボツト制御装置 | |
JPH0760667A (ja) | ロボットのウィービング制御装置 | |
Morlock et al. | Control of vibrations for a parallel manipulator with flexible links—concepts and experimental results | |
JPS6148003A (ja) | 多関節形ロボツトの制御装置 | |
JPS59220806A (ja) | 工業用ロボツトの制御方法 | |
JPH058187A (ja) | ロボツト | |
Wahrburg et al. | Flexdmp–extending dynamic movement primitives towards flexible joint robots |
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: 19991130 |