JPH04326403A - 空気圧駆動装置 - Google Patents
空気圧駆動装置Info
- Publication number
- JPH04326403A JPH04326403A JP9750491A JP9750491A JPH04326403A JP H04326403 A JPH04326403 A JP H04326403A JP 9750491 A JP9750491 A JP 9750491A JP 9750491 A JP9750491 A JP 9750491A JP H04326403 A JPH04326403 A JP H04326403A
- Authority
- JP
- Japan
- Prior art keywords
- output
- section
- air chamber
- pressure
- inertia matrix
- 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.)
- Pending
Links
- 239000011159 matrix material Substances 0.000 claims description 51
- 238000006243 chemical reaction Methods 0.000 claims description 26
- 230000001133 acceleration Effects 0.000 claims description 22
- 230000004069 differentiation Effects 0.000 claims description 22
- 238000001514 detection method Methods 0.000 claims description 11
- 239000012530 fluid Substances 0.000 claims description 3
- 230000001131 transforming effect Effects 0.000 abstract description 2
- 230000009466 transformation Effects 0.000 abstract 1
- 230000008859 change Effects 0.000 description 4
- 238000010586 diagram Methods 0.000 description 4
- 230000000694 effects Effects 0.000 description 4
- 230000007246 mechanism Effects 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 238000000034 method Methods 0.000 description 1
- 230000003534 oscillatory effect Effects 0.000 description 1
- 238000011144 upstream manufacturing Methods 0.000 description 1
Landscapes
- Control Of Position Or Direction (AREA)
- Flow Control (AREA)
- Fluid-Pressure Circuits (AREA)
- Feedback Control In General (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【発明の詳細な説明】
【0001】
【産業上の利用分野】本発明は圧縮空気源を駆動源とし
て動作を行う空気圧駆動装置に関するものである。 【0002】 【従来の技術】近年の機器の小型・軽量化が望まれてい
る中で、空気圧駆動装置は動作部の出力重量比が高く、
小型軽量化が容易であるため有望視されている。また、
駆動源から動作部への力の伝達も配管により容易にかつ
自由にできるため、伝達機構も不要となり、このことも
小型軽量化に有利である。さらに、安価で、環境を汚す
こともなく、力を保持したり圧力エネルギーとして保存
できる等の長所を生かして、産業分野等で広く利用され
ている。また、1自由度の空気圧駆動装置では、これま
で、欠点とされていた制御性の悪さも、弁部の開口面積
を指令値に応じて変化させる機能を有する流量制御弁を
用いて、空気室内の圧力の制御を行い外部信号による中
間停止が電気モータ駆動と同等の性能で可能となってき
た。 【0003】しかし、多自由度の空気圧駆動装置では、
慣性変動やコリオリ力、遠心力等の影響で、動作角度や
初期姿勢によって制御性能が変化していた。これに対し
て、電気モータ駆動のロボットに有効とされているモデ
ルベースド制御を空気圧駆動装置に適用することで、慣
性変動やコリオリ力、遠心力等の影響を補償することが
可能となった。 【0004】以下図面を参照しながら、そのモデルベー
スド制御を利用した従来の空気圧駆動装置の一例につい
て説明する。図6は従来の空気圧駆動装置の一例を示す
全体図である。図6において1a、1bは空気室を有す
る空気圧揺動型シリンダ、2a、2bはリンク、3a、
3bは空気室動作部の位置を検出する位置センサ、4は
圧縮空気源、5a、5b、5c、5dは空気室に空気を
流出入させるために弁部の開口面積を指令値に応じて変
化させる機能を有する流量制御弁、7は負荷、11は位
置信号獲得器、12は微分器、13は微分器、17は慣
性行列出力部、18は慣性行列微分部、19はコリオリ
力出力部、20はコリオリ力微分部、21は補償入力出
力部、22は外乱推定部、23は外乱補償部、24は補
償係数出力部、25は乗算器、26は乗算器、27は加
算器、28は乗算器、64はモデル入力出力部、90は
動作制御部である。 【0005】図2は図6における空気圧駆動揺動型シリ
ンダの詳細説明図である。1は空気室を有する揺動形シ
リンダ、30はシリンダ1内を気密性を保ちながら移動
できるベーン、31a、31bは空気室である。 【0006】以上のように構成された空気圧駆動装置に
ついて、以下その動作について説明する。 【0007】空気圧駆動装置の運動方程式は、空気室3
0a、30b内のそれぞれの圧力をp1j 、p2j
(j=1、2)、空気圧揺動シリンダ1a、1bとリン
ク2a、2bと位置センサ3a、3bと負荷7との全体
の慣性モーメントをJ(θ)、粘性摩擦係数をDj(j
=1、2)、ベーンの受圧面積をAj(j=1、2)、
ベーンの受圧部の外半径と内半径との中心半径をr0j
(j=1、2)、ベーンの回転変位量をθj(j=1、
2)、ベーンに作用する外乱力をdj(j=1、2)と
すると、【0008】 【数1】 【0009】の関係が成り立つ。ここでδpj(j=1
、2)はそれぞれ圧力pij(i=1、2,j=1、2
)の圧力差であり、空気圧流量制御弁の開口面積sij
(i=1、2,j=1、2)の開口面積差δsj(j=
1、2)との関係は、空気圧流量制御弁の上流側圧力と
下流側圧力との差が十分あると仮定し、平衡点(基準圧
力p0)まわりで線形化を行うと、 【0010】 【数2】 【0011】という関係が得られる。ここで、Ps は
供給圧力、k1j 、k2j はベーンの形状や温度等
に関係する定数である。(数1)の両辺を微分した、【
0012】 【数3】 【0013】に、(数2)を代入すると、【0014】 【数4】 【0015】を得る。この時、制御入力δsを、【00
16】 【数5】 【0017】とする。ここでuは新しい入力である。 (数5)を(数4)に代入すると、非線形補償が実現で
き、 【0018】 【数6】 【0019】という線形システムが得られる。入力uは
この式を基に、現代制御理論等で構成する。つまり、入
力uは、モデル入力出力部64より、 【0020】 【数7】 【0021】と構成できる。ここで、kc1はフィード
バックゲインである。 【0022】 【発明が解決しようとする課題】しかしながら上記のよ
うな構成では、慣性変動やコリオリ力、遠心力等の影響
を補償できるものの、圧力をフィードバックしないため
、圧力を制御することができず、試行を繰り返すうちに
、圧力の収束点が変化し、シリンダ内の圧力が供給圧力
や排気圧力に近づき、制御性能が劣化するという課題を
有していた。 【0023】本発明は上記従来の課題に鑑み、圧力をフ
ィードバックし、常に安定な制御性能を維持するととも
に、空気室動作部に作用する外乱を推定する外乱推定方
式をモデルベースド制御の考えに基づいて構成し、任意
の目標位置に対する位置決め等の動作を高速、高精度に
実現する空気圧駆動装置を提供することを目的とするも
のである。 【0024】 【課題を解決するための手段】本発明の空気圧駆動装置
は、空気が流入あるいは流出する第1空気室と第2空気
室の2つの空気室群と前記第1空気室と前記第2空気室
との間にあり気密性を保ちながら移動可能な空気室動作
部とを有し、前記空気室動作部が前記空気室動作部に作
用する動作流体力の合力によって駆動される空気圧アク
チュエータと、前記空気圧アクチュエータを複数個を一
連の連鎖状に配置し、前記空気圧アクチュエータ間をリ
ンクで連結した空気圧駆動装置であって、前記空気室群
に指令値に応じた空気を流入あるいは流出させることが
できる流量制御弁群と、前記空気室動作部の位置と速度
と加速度と前記空気室群の内部の圧力を検出あるいは算
出する空気室状態検出部と、前記空気室動作部が目標動
作状態に従って移動するために、前記動作制御部が空気
圧駆動装置の慣性行列を計算する慣性行列出力部と、コ
リオリ力及び遠心力を計算するコリオリ力出力部と、前
記慣性行列を微分する慣性行列微分部と、前記コリオリ
力出力部の出力を微分するコリオリ力微分部と、前記目
標動作状態と前記空気室状態検出部の出力の内の位置と
速度と圧力とを用いてモデル入力を計算するモデル入力
出力部と、空気圧駆動装置の運動方程式を線形化した空
気圧線形モデルを用いて前記モデル入力出力部の出力を
モデル変換入力に変換して出力するモデル変換部と、前
記空気室動作部と前記空気室群の幾何学的形状と前記空
気室内の空気の温度と供給圧力と基準平衡圧力から補償
係数Aを計算し前記空気室動作部の速度を乗じて補償入
力を計算する補償入力出力部と、前記空気室動作部と前
記空気室群の幾何学的形状と前記空気室内の空気の温度
と供給圧力と基準平衡圧力から補償係数Bを計算する補
償係数出力部と、前記空気室動作部に作用する外乱を推
定あるいは測定する外乱推定部と、前記外乱推定部の出
力から外乱補償入力を構成する外乱補償部と、前記慣性
行列出力部の出力に前記モデル変換部の出力を乗じたも
のと、前記慣性行列微分部の出力に前記空気室動作部の
加速度を乗じたものと、前記コリオリ力微分部の出力と
、前記補償入力出力部の出力と、前記外乱補償部の出力
とを加算して制御指令値を生成し、前記制御指令値に前
記補償係数出力部の出力を乗じて前記制御弁駆動指令値
を生成する制御弁駆動指令値生成部とを有する動作制御
部とを備えたものである。 【0025】 【作用】本発明は上記した構成によって、圧力をフィー
ドバックするモデルベースド制御を用いることで、常に
一定の制御性能を維持し、任意の点で高速かつ高精度な
位置決めが実現できる。 【0026】 【実施例】以下本発明の一実施例の空気圧駆動装置につ
いて、図面を参照しながら説明する。 【0027】図1は本発明の第1の実施例における空気
圧駆動装置の構成を示す全体図である。 【0028】図1において1a、1bは空気室を有する
空気圧揺動型シリンダ、2a、2bはリンク、3a、3
bは空気室動作部の位置を検出する位置センサ、4は圧
縮空気源、5a、5b、5c、5dは空気室に空気を流
出入させるために弁部の開口面積を指令値に応じて変化
させる機能を有する流量制御弁、6a、6b、6c、6
dはそれぞれ空気室の内部圧力を検出する圧力センサ、
7は負荷、10は動作制御部、11は位置信号獲得器、
12は微分器、13は微分器、14は圧力信号獲得器、
15はモデル入力出力部、16はモデル変換部、17は
慣性行列出力部、18は慣性行列微分部、19はコリオ
リ力出力部、20はコリオリ力微分部、21は補償入力
出力部、22は外乱推定部、23は外乱補償部、24は
補償係数出力部、25は乗算器、26は乗算器、27は
加算器、28は乗算器、29は制御弁駆動指令値生成部
である。 【0029】図2は図1における空気圧駆動揺動型シリ
ンダの詳細説明図である。空気圧揺動型シリンダは従来
例と同じである。 【0030】以上のように構成された空気圧駆動装置に
ついて、以下図1、図2を用いてその動作を説明する。 【0031】空気圧駆動装置の運動方程式(数1)を線
形化すると、 【0032】 【数8】 【0033】を得る。ここで、Jnは慣性行列J(θ)
を線形化した行列である。この線形化方程式(数8)を
モデルとするモデルベースド制御を考える。すなわち、
(数8)を微分した、 【0034】 【数9】 【0035】と、(数2)より、 【0036】 【数10】 【0037】を得る。したがって、弁の開口面積差δs
を制御弁駆動指令値生成部29により、【0038】 【数11】 【0039】という入力が考えられる。ここで、vはモ
デル変換入力で、モデル変換部16の出力で、uはモデ
ル入力でモデル入力出力部15の出力である。すなわち
、(数4)に(数11)を代入することにより、非線形
補償が実現でき、 【0040】 【数12】 【0041】という線形システムが得られる。したがっ
て、状態方程式で表すと、 【0042】 【数13】 【0043】となる。ここで、この線形化モデルは、(
数4)と(数8)と等価である。すなわち、次の状態方
程式、 【0044】 【数14】 【0045】に基づいて、モデル入力出力部15が状態
フィードバック系を構成することにする。これにより、
容易に圧力フィードバックを行うことができる。 【0046】なお、制御入力δsj(j=1、2)から
、実際の入力となる開口面積s1j、s2j(j=1、
2)への分配は、各々の圧力及び開口面積は均等に分配
される、すなわち、 【0047】 【数15】 【0048】 【数16】 【0049】が成り立つと仮定して、 【0050】 【数17】 【0051】のように均等に分配する。ただし、圧力フ
ィードバックの部分は圧力pij(i=1、2,j=1
、2)を基準平衡圧力p0に収束させる為に、(数15
)を用いて、 【0052】 【数18】 【0053】として分配する。以上の構成法により、θ
をθdに近づけると共に、圧力を基準平衡圧力p0に収
束させることができる。 【0054】本実施例のように、圧力フィードバックを
用いたモデルベースド制御を行うことにより、慣性変動
やコリオリ力、遠心力等の影響を補償を行うとともに、
圧力を制御できるため常に安定な制御性能を維持するこ
とができる。 【0055】以下本発明の第2の実施例について図面を
参照しながら説明する。 【0056】図3は本発明の第2の実施例を示す空気圧
駆動装置、図1における外乱推定部の詳細説明図である
。 【0057】図3において、11は位置信号獲得器、1
2は微分器、13は微分器、14は圧力信号獲得器、1
7は慣性行列出力部、19はコリオリ力出力部、22は
外乱推定部、23は外乱補償部、40は定点慣性行列出
力部、42は算出圧力出力部である。 【0058】以上のように構成された空気圧駆動装置に
ついて、以下、図3を用いてその動作を説明する。 【0059】空気圧駆動方式の場合、外乱の影響を考慮
するために、たとえ外乱を精度よく推定あるいは測定で
きたとしても、(数5)の構成では、外乱の微分値を扱
うため動摩擦のような定常的な外乱は補償できない。そ
こで、空気圧駆動装置でモデルベースド制御を行う場合
の制御入力δsを次のように構成する。 【0060】 【数19】 【0061】ここで、 【0062】 【数20】 【0063】は外乱dの推定値、khは外乱補償ゲイン
である。 【0064】この外乱dを推定するために外乱推定部2
2を、外乱推定オブザーバを用いて構成する。1自由度
の空気圧駆動装置の場合、圧力差δpを入力とする機構
部分のみのモデルのオブザーバにより、高精度な推定を
実現した。しかし、多自由度の空気圧駆動装置の場合、
これをそのまま拡張すると慣性変動やコリオリ力、遠心
力等の非線形特性を無視することとなる。すなわち、オ
ブザーバのモデルを機構部分の運動方程式を線形化した
定点慣性行列出力部40の出力を用いたモデル、 【
0065】 【数21】 【0066】とすると、摩擦の推定精度が悪くなると予
想される。したがって、ここでは、オブザーバにもモデ
ルベースド制御の考え方を導入した、新方式のオブザー
バを構成する。すなわち、オブザーバのモデルを、【0
067】 【数22】 【0068】とし、オブザーバの入力となる算出圧力【
0069】 【数23】 【0070】は(数22)と(数1)の摩擦の項を排除
した、 【0071】 【数24】 【0072】とが等しいとして、算出圧力出力部42に
より、 【0073】 【数25】 【0074】とする。すなわち、外乱dを含んだ拡大シ
ステムは、外乱dをステップ状と仮定して、【0075
】 【数26】 【0076】と構成する。したがって、オブザーバは、
【0077】 【数27】 【0078】となる。 【0079】本実施例のように、モデルベースド制御の
考え方を用いた外乱推定オブザーバを構成することによ
り、外乱dを高精度に推定することができる。 【0080】以下本発明の第3の実施例について図面を
参照しながら説明する。 【0081】図4は本発明の第3の実施例を示す空気圧
駆動装置の全体図である。 【0082】図4において1a、1bは空気室を有する
空気圧揺動型シリンダ、2a、2bはリンク、3a、3
bは空気室動作部の位置を検出する位置センサ、4は圧
縮空気源、5a、5b、5c、5dは空気室に空気を流
出入させるために弁部の開口面積を指令値に応じて変化
させる機能を有する流量制御弁、6a、6b、6c、6
dはそれぞれ空気室の内部圧力を検出する圧力センサ、
7は負荷、11は位置信号獲得器、12は微分器、13
は微分器、14は圧力信号獲得器、15はモデル入力出
力部、16はモデル変換部、17は慣性行列出力部、1
8は慣性行列微分部、19はコリオリ力出力部、20は
コリオリ力微分部、21は補償入力出力部、22は外乱
推定部、23は外乱補償部、24は補償係数出力部、2
9は制御弁駆動指令値生成部、40は定点慣性行列出力
部、42は算出圧力出力部、50は動作制御部である。 【0083】以上のように構成された空気圧駆動装置に
ついて、以下、図4を用いてその動作を説明する。 【0084】空気圧駆動装置の運動方程式(数1)を線
形化したモデル、 【0085】 【数28】 【0086】での、δpと、(数1)のδpとは、圧力
差δpが途中の状態量であるため、等しくはない。した
がって、(数14)の状態方程式をもとに、状態フィー
ドバックを行うと、応答が振動的になる場合が生ずる。 そこで、(数14)を、 【0087】 【数29】 【0088】とし、(数29)中の算出圧力【0089
】 【数30】 【0090】を、(数1)の摩擦の項を排除した、【0
091】 【数31】 【0092】を用いて、算出圧力出力部42が、【00
93】 【数32】 【0094】を出力する。これを圧力の代わりに用いて
、フィードバックすることで、望みの応答を得ることが
できる。 【0095】本実施例のように、算出圧力をフィードバ
ックするモデルベースド制御を行うことにより、慣性変
動やコリオリ力、遠心力等の影響を補償を行うとともに
、圧力を制御でき、さらに、モデルの誤差による振動も
抑えることができるため常に安定な制御性能を維持する
ことができる。 【0096】以下本発明の第4の実施例について図面を
参照しながら説明する。 【0097】図5は本発明の第4の実施例を示す空気圧
駆動装置の全体図である。 【0098】図5において1a、1bは空気室を有する
空気圧揺動型シリンダ、2a、2bはリンク、3a、3
bは空気室動作部の位置を検出する位置センサ、4は圧
縮空気源、5a、5b、5c、5dは空気室に空気を流
出入させるために弁部の開口面積を指令値に応じて変化
させる機能を有する流量制御弁、6a、6b、6c、6
dはそれぞれ空気室の内部圧力を検出する圧力センサ、
7は負荷、11は位置信号獲得器、12は微分器、13
は微分器、14は圧力信号獲得器、17は慣性行列出力
部、18は慣性行列微分部、19はコリオリ力出力部、
20はコリオリ力微分部、21は補償入力出力部、22
は外乱推定部、23は外乱補償部、24は補償係数出力
部、29は制御弁駆動指令値生成部、60は動作制御部
、62は算出加速度出力部、64はモデル入力出力部、
66はモデル変換部である。 【0099】以上のように構成された空気圧駆動装置に
ついて、以下、図5を用いてその動作を説明する。 【0100】空気室内部の圧力を任意の値に設定する為
に、算出加速度出力部62で圧力信号から加速度情報を
算出して、この計算した加速度を用いてモデル入力出力
部64で加速度フィードバックを行い、間接的に圧力を
制御することにする。すなわち、(数1)を変形して、
【0101】 【数33】 【0102】を用いて、加速度フィードバックすること
で、間接的に圧力フィードバックを行う構成である。し
たがって、入力uは、 【0103】 【数34】 【0104】とする。また、この場合、フィードバック
制御系を設計するモデルは、どのようなモデルでもよく
、モデル変換部66はモデル入力出力部64の出力を変
換しなくてもよい。 【0105】本実施例のように、圧力信号から加速度情
報を算出して、この計算した加速度を用いて加速度フィ
ードバックを行い、間接的に圧力を制御することで、圧
力を制御することができ、常に安定な制御性能を維持す
ることができる。 【0106】なお、第2及び第3の実施例において、算
出圧力 【0107】 【数35】 【0108】を、(数25)のように算出したが、【0
109】 【数36】 【0110】の様に、計算してもよい。 【0111】 【発明の効果】以上のように本発明は、空気が流入ある
いは流出する第1空気室と第2空気室の2つの空気室群
と前記第1空気室と前記第2空気室との間にあり気密性
を保ちながら移動可能な空気室動作部とを有し、前記空
気室動作部が前記空気室動作部に作用する動作流体力の
合力によって駆動される空気圧アクチュエータと、前記
空気圧アクチュエータを複数個を一連の連鎖状に配置し
、前記空気圧アクチュエータ間をリンクで連結した空気
圧駆動装置であって、前記空気室群に指令値に応じた空
気を流入あるいは流出させることができる流量制御弁群
と、前記空気室動作部の位置と速度と加速度と前記空気
室群の内部の圧力を検出あるいは算出する空気室状態検
出部と、前記空気室動作部が目標動作状態に従って移動
するために、前記動作制御部が空気圧駆動装置の慣性行
列を計算する慣性行列出力部と、コリオリ力及び遠心力
を計算するコリオリ力出力部と、前記慣性行列を微分す
る慣性行列微分部と、前記コリオリ力出力部の出力を微
分するコリオリ力微分部と、前記目標動作状態と前記空
気室状態検出部の出力の内の位置と速度と圧力とを用い
てモデル入力を計算するモデル入力出力部と、空気圧駆
動装置の運動方程式を線形化した空気圧線形モデルを用
いて前記モデル入力出力部の出力をモデル変換入力に変
換して出力するモデル変換部と、前記空気室動作部と前
記空気室群の幾何学的形状と前記空気室内の空気の温度
と供給圧力と基準平衡圧力から補償係数Aを計算し前記
空気室動作部の速度を乗じて補償入力を計算する補償入
力出力部と、前記空気室動作部と前記空気室群の幾何学
的形状と前記空気室内の空気の温度と供給圧力と基準平
衡圧力から補償係数Bを計算する補償係数出力部と、前
記空気室動作部に作用する外乱を推定あるいは測定する
外乱推定部と、前記外乱推定部の出力から外乱補償入力
を構成する外乱補償部と、前記慣性行列出力部の出力に
前記モデル変換部の出力を乗じたものと、前記慣性行列
微分部の出力に前記空気室動作部の加速度を乗じたもの
と、前記コリオリ力微分部の出力と、前記補償入力出力
部の出力と、前記外乱補償部の出力とを加算して制御指
令値を生成し、前記制御指令値に前記補償係数出力部の
出力を乗じて前記制御弁駆動指令値を生成する制御弁駆
動指令値生成部とを有する動作制御部とを備えたもので
あるので、任意の点で高速かつ高精度な位置決めが実現
することができる。
て動作を行う空気圧駆動装置に関するものである。 【0002】 【従来の技術】近年の機器の小型・軽量化が望まれてい
る中で、空気圧駆動装置は動作部の出力重量比が高く、
小型軽量化が容易であるため有望視されている。また、
駆動源から動作部への力の伝達も配管により容易にかつ
自由にできるため、伝達機構も不要となり、このことも
小型軽量化に有利である。さらに、安価で、環境を汚す
こともなく、力を保持したり圧力エネルギーとして保存
できる等の長所を生かして、産業分野等で広く利用され
ている。また、1自由度の空気圧駆動装置では、これま
で、欠点とされていた制御性の悪さも、弁部の開口面積
を指令値に応じて変化させる機能を有する流量制御弁を
用いて、空気室内の圧力の制御を行い外部信号による中
間停止が電気モータ駆動と同等の性能で可能となってき
た。 【0003】しかし、多自由度の空気圧駆動装置では、
慣性変動やコリオリ力、遠心力等の影響で、動作角度や
初期姿勢によって制御性能が変化していた。これに対し
て、電気モータ駆動のロボットに有効とされているモデ
ルベースド制御を空気圧駆動装置に適用することで、慣
性変動やコリオリ力、遠心力等の影響を補償することが
可能となった。 【0004】以下図面を参照しながら、そのモデルベー
スド制御を利用した従来の空気圧駆動装置の一例につい
て説明する。図6は従来の空気圧駆動装置の一例を示す
全体図である。図6において1a、1bは空気室を有す
る空気圧揺動型シリンダ、2a、2bはリンク、3a、
3bは空気室動作部の位置を検出する位置センサ、4は
圧縮空気源、5a、5b、5c、5dは空気室に空気を
流出入させるために弁部の開口面積を指令値に応じて変
化させる機能を有する流量制御弁、7は負荷、11は位
置信号獲得器、12は微分器、13は微分器、17は慣
性行列出力部、18は慣性行列微分部、19はコリオリ
力出力部、20はコリオリ力微分部、21は補償入力出
力部、22は外乱推定部、23は外乱補償部、24は補
償係数出力部、25は乗算器、26は乗算器、27は加
算器、28は乗算器、64はモデル入力出力部、90は
動作制御部である。 【0005】図2は図6における空気圧駆動揺動型シリ
ンダの詳細説明図である。1は空気室を有する揺動形シ
リンダ、30はシリンダ1内を気密性を保ちながら移動
できるベーン、31a、31bは空気室である。 【0006】以上のように構成された空気圧駆動装置に
ついて、以下その動作について説明する。 【0007】空気圧駆動装置の運動方程式は、空気室3
0a、30b内のそれぞれの圧力をp1j 、p2j
(j=1、2)、空気圧揺動シリンダ1a、1bとリン
ク2a、2bと位置センサ3a、3bと負荷7との全体
の慣性モーメントをJ(θ)、粘性摩擦係数をDj(j
=1、2)、ベーンの受圧面積をAj(j=1、2)、
ベーンの受圧部の外半径と内半径との中心半径をr0j
(j=1、2)、ベーンの回転変位量をθj(j=1、
2)、ベーンに作用する外乱力をdj(j=1、2)と
すると、【0008】 【数1】 【0009】の関係が成り立つ。ここでδpj(j=1
、2)はそれぞれ圧力pij(i=1、2,j=1、2
)の圧力差であり、空気圧流量制御弁の開口面積sij
(i=1、2,j=1、2)の開口面積差δsj(j=
1、2)との関係は、空気圧流量制御弁の上流側圧力と
下流側圧力との差が十分あると仮定し、平衡点(基準圧
力p0)まわりで線形化を行うと、 【0010】 【数2】 【0011】という関係が得られる。ここで、Ps は
供給圧力、k1j 、k2j はベーンの形状や温度等
に関係する定数である。(数1)の両辺を微分した、【
0012】 【数3】 【0013】に、(数2)を代入すると、【0014】 【数4】 【0015】を得る。この時、制御入力δsを、【00
16】 【数5】 【0017】とする。ここでuは新しい入力である。 (数5)を(数4)に代入すると、非線形補償が実現で
き、 【0018】 【数6】 【0019】という線形システムが得られる。入力uは
この式を基に、現代制御理論等で構成する。つまり、入
力uは、モデル入力出力部64より、 【0020】 【数7】 【0021】と構成できる。ここで、kc1はフィード
バックゲインである。 【0022】 【発明が解決しようとする課題】しかしながら上記のよ
うな構成では、慣性変動やコリオリ力、遠心力等の影響
を補償できるものの、圧力をフィードバックしないため
、圧力を制御することができず、試行を繰り返すうちに
、圧力の収束点が変化し、シリンダ内の圧力が供給圧力
や排気圧力に近づき、制御性能が劣化するという課題を
有していた。 【0023】本発明は上記従来の課題に鑑み、圧力をフ
ィードバックし、常に安定な制御性能を維持するととも
に、空気室動作部に作用する外乱を推定する外乱推定方
式をモデルベースド制御の考えに基づいて構成し、任意
の目標位置に対する位置決め等の動作を高速、高精度に
実現する空気圧駆動装置を提供することを目的とするも
のである。 【0024】 【課題を解決するための手段】本発明の空気圧駆動装置
は、空気が流入あるいは流出する第1空気室と第2空気
室の2つの空気室群と前記第1空気室と前記第2空気室
との間にあり気密性を保ちながら移動可能な空気室動作
部とを有し、前記空気室動作部が前記空気室動作部に作
用する動作流体力の合力によって駆動される空気圧アク
チュエータと、前記空気圧アクチュエータを複数個を一
連の連鎖状に配置し、前記空気圧アクチュエータ間をリ
ンクで連結した空気圧駆動装置であって、前記空気室群
に指令値に応じた空気を流入あるいは流出させることが
できる流量制御弁群と、前記空気室動作部の位置と速度
と加速度と前記空気室群の内部の圧力を検出あるいは算
出する空気室状態検出部と、前記空気室動作部が目標動
作状態に従って移動するために、前記動作制御部が空気
圧駆動装置の慣性行列を計算する慣性行列出力部と、コ
リオリ力及び遠心力を計算するコリオリ力出力部と、前
記慣性行列を微分する慣性行列微分部と、前記コリオリ
力出力部の出力を微分するコリオリ力微分部と、前記目
標動作状態と前記空気室状態検出部の出力の内の位置と
速度と圧力とを用いてモデル入力を計算するモデル入力
出力部と、空気圧駆動装置の運動方程式を線形化した空
気圧線形モデルを用いて前記モデル入力出力部の出力を
モデル変換入力に変換して出力するモデル変換部と、前
記空気室動作部と前記空気室群の幾何学的形状と前記空
気室内の空気の温度と供給圧力と基準平衡圧力から補償
係数Aを計算し前記空気室動作部の速度を乗じて補償入
力を計算する補償入力出力部と、前記空気室動作部と前
記空気室群の幾何学的形状と前記空気室内の空気の温度
と供給圧力と基準平衡圧力から補償係数Bを計算する補
償係数出力部と、前記空気室動作部に作用する外乱を推
定あるいは測定する外乱推定部と、前記外乱推定部の出
力から外乱補償入力を構成する外乱補償部と、前記慣性
行列出力部の出力に前記モデル変換部の出力を乗じたも
のと、前記慣性行列微分部の出力に前記空気室動作部の
加速度を乗じたものと、前記コリオリ力微分部の出力と
、前記補償入力出力部の出力と、前記外乱補償部の出力
とを加算して制御指令値を生成し、前記制御指令値に前
記補償係数出力部の出力を乗じて前記制御弁駆動指令値
を生成する制御弁駆動指令値生成部とを有する動作制御
部とを備えたものである。 【0025】 【作用】本発明は上記した構成によって、圧力をフィー
ドバックするモデルベースド制御を用いることで、常に
一定の制御性能を維持し、任意の点で高速かつ高精度な
位置決めが実現できる。 【0026】 【実施例】以下本発明の一実施例の空気圧駆動装置につ
いて、図面を参照しながら説明する。 【0027】図1は本発明の第1の実施例における空気
圧駆動装置の構成を示す全体図である。 【0028】図1において1a、1bは空気室を有する
空気圧揺動型シリンダ、2a、2bはリンク、3a、3
bは空気室動作部の位置を検出する位置センサ、4は圧
縮空気源、5a、5b、5c、5dは空気室に空気を流
出入させるために弁部の開口面積を指令値に応じて変化
させる機能を有する流量制御弁、6a、6b、6c、6
dはそれぞれ空気室の内部圧力を検出する圧力センサ、
7は負荷、10は動作制御部、11は位置信号獲得器、
12は微分器、13は微分器、14は圧力信号獲得器、
15はモデル入力出力部、16はモデル変換部、17は
慣性行列出力部、18は慣性行列微分部、19はコリオ
リ力出力部、20はコリオリ力微分部、21は補償入力
出力部、22は外乱推定部、23は外乱補償部、24は
補償係数出力部、25は乗算器、26は乗算器、27は
加算器、28は乗算器、29は制御弁駆動指令値生成部
である。 【0029】図2は図1における空気圧駆動揺動型シリ
ンダの詳細説明図である。空気圧揺動型シリンダは従来
例と同じである。 【0030】以上のように構成された空気圧駆動装置に
ついて、以下図1、図2を用いてその動作を説明する。 【0031】空気圧駆動装置の運動方程式(数1)を線
形化すると、 【0032】 【数8】 【0033】を得る。ここで、Jnは慣性行列J(θ)
を線形化した行列である。この線形化方程式(数8)を
モデルとするモデルベースド制御を考える。すなわち、
(数8)を微分した、 【0034】 【数9】 【0035】と、(数2)より、 【0036】 【数10】 【0037】を得る。したがって、弁の開口面積差δs
を制御弁駆動指令値生成部29により、【0038】 【数11】 【0039】という入力が考えられる。ここで、vはモ
デル変換入力で、モデル変換部16の出力で、uはモデ
ル入力でモデル入力出力部15の出力である。すなわち
、(数4)に(数11)を代入することにより、非線形
補償が実現でき、 【0040】 【数12】 【0041】という線形システムが得られる。したがっ
て、状態方程式で表すと、 【0042】 【数13】 【0043】となる。ここで、この線形化モデルは、(
数4)と(数8)と等価である。すなわち、次の状態方
程式、 【0044】 【数14】 【0045】に基づいて、モデル入力出力部15が状態
フィードバック系を構成することにする。これにより、
容易に圧力フィードバックを行うことができる。 【0046】なお、制御入力δsj(j=1、2)から
、実際の入力となる開口面積s1j、s2j(j=1、
2)への分配は、各々の圧力及び開口面積は均等に分配
される、すなわち、 【0047】 【数15】 【0048】 【数16】 【0049】が成り立つと仮定して、 【0050】 【数17】 【0051】のように均等に分配する。ただし、圧力フ
ィードバックの部分は圧力pij(i=1、2,j=1
、2)を基準平衡圧力p0に収束させる為に、(数15
)を用いて、 【0052】 【数18】 【0053】として分配する。以上の構成法により、θ
をθdに近づけると共に、圧力を基準平衡圧力p0に収
束させることができる。 【0054】本実施例のように、圧力フィードバックを
用いたモデルベースド制御を行うことにより、慣性変動
やコリオリ力、遠心力等の影響を補償を行うとともに、
圧力を制御できるため常に安定な制御性能を維持するこ
とができる。 【0055】以下本発明の第2の実施例について図面を
参照しながら説明する。 【0056】図3は本発明の第2の実施例を示す空気圧
駆動装置、図1における外乱推定部の詳細説明図である
。 【0057】図3において、11は位置信号獲得器、1
2は微分器、13は微分器、14は圧力信号獲得器、1
7は慣性行列出力部、19はコリオリ力出力部、22は
外乱推定部、23は外乱補償部、40は定点慣性行列出
力部、42は算出圧力出力部である。 【0058】以上のように構成された空気圧駆動装置に
ついて、以下、図3を用いてその動作を説明する。 【0059】空気圧駆動方式の場合、外乱の影響を考慮
するために、たとえ外乱を精度よく推定あるいは測定で
きたとしても、(数5)の構成では、外乱の微分値を扱
うため動摩擦のような定常的な外乱は補償できない。そ
こで、空気圧駆動装置でモデルベースド制御を行う場合
の制御入力δsを次のように構成する。 【0060】 【数19】 【0061】ここで、 【0062】 【数20】 【0063】は外乱dの推定値、khは外乱補償ゲイン
である。 【0064】この外乱dを推定するために外乱推定部2
2を、外乱推定オブザーバを用いて構成する。1自由度
の空気圧駆動装置の場合、圧力差δpを入力とする機構
部分のみのモデルのオブザーバにより、高精度な推定を
実現した。しかし、多自由度の空気圧駆動装置の場合、
これをそのまま拡張すると慣性変動やコリオリ力、遠心
力等の非線形特性を無視することとなる。すなわち、オ
ブザーバのモデルを機構部分の運動方程式を線形化した
定点慣性行列出力部40の出力を用いたモデル、 【
0065】 【数21】 【0066】とすると、摩擦の推定精度が悪くなると予
想される。したがって、ここでは、オブザーバにもモデ
ルベースド制御の考え方を導入した、新方式のオブザー
バを構成する。すなわち、オブザーバのモデルを、【0
067】 【数22】 【0068】とし、オブザーバの入力となる算出圧力【
0069】 【数23】 【0070】は(数22)と(数1)の摩擦の項を排除
した、 【0071】 【数24】 【0072】とが等しいとして、算出圧力出力部42に
より、 【0073】 【数25】 【0074】とする。すなわち、外乱dを含んだ拡大シ
ステムは、外乱dをステップ状と仮定して、【0075
】 【数26】 【0076】と構成する。したがって、オブザーバは、
【0077】 【数27】 【0078】となる。 【0079】本実施例のように、モデルベースド制御の
考え方を用いた外乱推定オブザーバを構成することによ
り、外乱dを高精度に推定することができる。 【0080】以下本発明の第3の実施例について図面を
参照しながら説明する。 【0081】図4は本発明の第3の実施例を示す空気圧
駆動装置の全体図である。 【0082】図4において1a、1bは空気室を有する
空気圧揺動型シリンダ、2a、2bはリンク、3a、3
bは空気室動作部の位置を検出する位置センサ、4は圧
縮空気源、5a、5b、5c、5dは空気室に空気を流
出入させるために弁部の開口面積を指令値に応じて変化
させる機能を有する流量制御弁、6a、6b、6c、6
dはそれぞれ空気室の内部圧力を検出する圧力センサ、
7は負荷、11は位置信号獲得器、12は微分器、13
は微分器、14は圧力信号獲得器、15はモデル入力出
力部、16はモデル変換部、17は慣性行列出力部、1
8は慣性行列微分部、19はコリオリ力出力部、20は
コリオリ力微分部、21は補償入力出力部、22は外乱
推定部、23は外乱補償部、24は補償係数出力部、2
9は制御弁駆動指令値生成部、40は定点慣性行列出力
部、42は算出圧力出力部、50は動作制御部である。 【0083】以上のように構成された空気圧駆動装置に
ついて、以下、図4を用いてその動作を説明する。 【0084】空気圧駆動装置の運動方程式(数1)を線
形化したモデル、 【0085】 【数28】 【0086】での、δpと、(数1)のδpとは、圧力
差δpが途中の状態量であるため、等しくはない。した
がって、(数14)の状態方程式をもとに、状態フィー
ドバックを行うと、応答が振動的になる場合が生ずる。 そこで、(数14)を、 【0087】 【数29】 【0088】とし、(数29)中の算出圧力【0089
】 【数30】 【0090】を、(数1)の摩擦の項を排除した、【0
091】 【数31】 【0092】を用いて、算出圧力出力部42が、【00
93】 【数32】 【0094】を出力する。これを圧力の代わりに用いて
、フィードバックすることで、望みの応答を得ることが
できる。 【0095】本実施例のように、算出圧力をフィードバ
ックするモデルベースド制御を行うことにより、慣性変
動やコリオリ力、遠心力等の影響を補償を行うとともに
、圧力を制御でき、さらに、モデルの誤差による振動も
抑えることができるため常に安定な制御性能を維持する
ことができる。 【0096】以下本発明の第4の実施例について図面を
参照しながら説明する。 【0097】図5は本発明の第4の実施例を示す空気圧
駆動装置の全体図である。 【0098】図5において1a、1bは空気室を有する
空気圧揺動型シリンダ、2a、2bはリンク、3a、3
bは空気室動作部の位置を検出する位置センサ、4は圧
縮空気源、5a、5b、5c、5dは空気室に空気を流
出入させるために弁部の開口面積を指令値に応じて変化
させる機能を有する流量制御弁、6a、6b、6c、6
dはそれぞれ空気室の内部圧力を検出する圧力センサ、
7は負荷、11は位置信号獲得器、12は微分器、13
は微分器、14は圧力信号獲得器、17は慣性行列出力
部、18は慣性行列微分部、19はコリオリ力出力部、
20はコリオリ力微分部、21は補償入力出力部、22
は外乱推定部、23は外乱補償部、24は補償係数出力
部、29は制御弁駆動指令値生成部、60は動作制御部
、62は算出加速度出力部、64はモデル入力出力部、
66はモデル変換部である。 【0099】以上のように構成された空気圧駆動装置に
ついて、以下、図5を用いてその動作を説明する。 【0100】空気室内部の圧力を任意の値に設定する為
に、算出加速度出力部62で圧力信号から加速度情報を
算出して、この計算した加速度を用いてモデル入力出力
部64で加速度フィードバックを行い、間接的に圧力を
制御することにする。すなわち、(数1)を変形して、
【0101】 【数33】 【0102】を用いて、加速度フィードバックすること
で、間接的に圧力フィードバックを行う構成である。し
たがって、入力uは、 【0103】 【数34】 【0104】とする。また、この場合、フィードバック
制御系を設計するモデルは、どのようなモデルでもよく
、モデル変換部66はモデル入力出力部64の出力を変
換しなくてもよい。 【0105】本実施例のように、圧力信号から加速度情
報を算出して、この計算した加速度を用いて加速度フィ
ードバックを行い、間接的に圧力を制御することで、圧
力を制御することができ、常に安定な制御性能を維持す
ることができる。 【0106】なお、第2及び第3の実施例において、算
出圧力 【0107】 【数35】 【0108】を、(数25)のように算出したが、【0
109】 【数36】 【0110】の様に、計算してもよい。 【0111】 【発明の効果】以上のように本発明は、空気が流入ある
いは流出する第1空気室と第2空気室の2つの空気室群
と前記第1空気室と前記第2空気室との間にあり気密性
を保ちながら移動可能な空気室動作部とを有し、前記空
気室動作部が前記空気室動作部に作用する動作流体力の
合力によって駆動される空気圧アクチュエータと、前記
空気圧アクチュエータを複数個を一連の連鎖状に配置し
、前記空気圧アクチュエータ間をリンクで連結した空気
圧駆動装置であって、前記空気室群に指令値に応じた空
気を流入あるいは流出させることができる流量制御弁群
と、前記空気室動作部の位置と速度と加速度と前記空気
室群の内部の圧力を検出あるいは算出する空気室状態検
出部と、前記空気室動作部が目標動作状態に従って移動
するために、前記動作制御部が空気圧駆動装置の慣性行
列を計算する慣性行列出力部と、コリオリ力及び遠心力
を計算するコリオリ力出力部と、前記慣性行列を微分す
る慣性行列微分部と、前記コリオリ力出力部の出力を微
分するコリオリ力微分部と、前記目標動作状態と前記空
気室状態検出部の出力の内の位置と速度と圧力とを用い
てモデル入力を計算するモデル入力出力部と、空気圧駆
動装置の運動方程式を線形化した空気圧線形モデルを用
いて前記モデル入力出力部の出力をモデル変換入力に変
換して出力するモデル変換部と、前記空気室動作部と前
記空気室群の幾何学的形状と前記空気室内の空気の温度
と供給圧力と基準平衡圧力から補償係数Aを計算し前記
空気室動作部の速度を乗じて補償入力を計算する補償入
力出力部と、前記空気室動作部と前記空気室群の幾何学
的形状と前記空気室内の空気の温度と供給圧力と基準平
衡圧力から補償係数Bを計算する補償係数出力部と、前
記空気室動作部に作用する外乱を推定あるいは測定する
外乱推定部と、前記外乱推定部の出力から外乱補償入力
を構成する外乱補償部と、前記慣性行列出力部の出力に
前記モデル変換部の出力を乗じたものと、前記慣性行列
微分部の出力に前記空気室動作部の加速度を乗じたもの
と、前記コリオリ力微分部の出力と、前記補償入力出力
部の出力と、前記外乱補償部の出力とを加算して制御指
令値を生成し、前記制御指令値に前記補償係数出力部の
出力を乗じて前記制御弁駆動指令値を生成する制御弁駆
動指令値生成部とを有する動作制御部とを備えたもので
あるので、任意の点で高速かつ高精度な位置決めが実現
することができる。
【図1】本発明の第1の実施例における空気圧駆動装置
の構成を示す全体図である。
の構成を示す全体図である。
【図2】図1における空気圧駆動揺動型シリンダの断面
図である。
図である。
【図3】本発明の第2の実施例を示す空気圧駆動装置、
外乱推定部のブロック図である。
外乱推定部のブロック図である。
【図4】本発明の第3の実施例における空気圧駆動装置
の構成を示す全体図である。
の構成を示す全体図である。
【図5】本発明の第4の実施例における空気圧駆動装置
の構成を示す全体図である。
の構成を示す全体図である。
【図6】従来の空気圧駆動装置の一例を示す全体図であ
る。
る。
Claims (8)
- 【請求項1】 空気が流入あるいは流出する第1空気
室と第2空気室の2つの空気室群と前記第1空気室と前
記第2空気室との間にあり気密性を保ちながら移動可能
な空気室動作部とを有し、前記空気室動作部が前記空気
室動作部に作用する動作流体力の合力によって駆動され
る空気圧アクチュエータと、前記空気室群に、指令され
る指令値に応じた空気を流入あるいは流出させることが
できる流量制御弁群と、前記空気室動作部の位置と速度
と加速度と前記空気室群の内部の圧力を検出あるいは算
出する空気室状態検出部と、その空気室状態検出部から
の出力に基づき前記空気室動作部が目標動作状態に従っ
て移動するために必要な制御弁駆動指令値を前記流量制
御弁群に出力する動作制御部とを備え、前記空気圧アク
チュエータが複数個一連の連鎖状に配置され、前記空気
圧アクチュエータ間がリンクで連結された空気圧駆動装
置であって、前記動作制御部が、空気圧駆動装置の慣性
行列を計算する慣性行列出力部と、コリオリ力及び遠心
力を計算するコリオリ力出力部と、前記慣性行列を微分
する慣性行列微分部と、前記コリオリ力出力部の出力を
微分するコリオリ力微分部と、前記目標動作状態と前記
空気室状態検出部の出力の内の、位置と速度と圧力とを
用いてモデル入力を計算するモデル入力出力部と、前記
空気圧駆動装置の運動方程式を線形化した空気圧線形モ
デルを用いて前記モデル入力出力部の出力をモデル変換
入力に変換して出力するモデル変換部と、前記空気室動
作部と前記空気室群の幾何学的形状と前記空気室内の空
気の温度と供給圧力と基準平衡圧力から補償係数Aを計
算し前記空気室動作部の速度を乗じて補償入力を計算す
る補償入力出力部と、前記空気室動作部と前記空気室群
の幾何学的形状と前記空気室内の空気の温度と供給圧力
と基準平衡圧力から補償係数Bを計算する補償係数出力
部と、前記空気室動作部に作用する外乱を推定あるいは
測定する外乱推定部と、前記外乱推定部の出力から外乱
補償入力を構成する外乱補償部と、前記慣性行列出力部
の出力に前記モデル変換部の出力を乗じたものと、前記
慣性行列微分部の出力に前記空気室動作部の加速度を乗
じたものと、前記コリオリ力微分部の出力と、前記補償
入力出力部の出力と、前記外乱補償部の出力とを加算し
て制御指令値を生成し、前記制御指令値に前記補償係数
出力部の出力を乗じて前記制御弁駆動指令値を生成する
制御弁駆動指令値生成部とを備えたことを特徴とする空
気圧駆動装置。 - 【請求項2】 動作制御部に、空気圧線形モデルを生
成した線形化基準点での定点慣性行列を出力する定点慣
性行列出力部と、前記慣性行列出力部の出力と前記コリ
オリ力出力部の出力と前記定点慣性行列出力部の出力と
前記空気室状態検出部の出力と、前記空気室内部の圧力
差をアクチュエータの発生トルクに変換する圧力トルク
変換定数とを用いて算出圧力を出力する算出圧力出力部
とが設けられ、前記外乱推定部が前記空気室状態検出部
の出力の内の位置と速度の少なくとも一方の出力と前記
算出圧力出力部の出力と前記定点慣性行列出力部の出力
と前記圧力トルク変換定数を用いて、空気室動作部に作
用する外乱を推定することを特徴とする請求項1記載の
空気圧駆動装置。 - 【請求項3】 動作制御部に、空気圧線形モデルを生
成した線形化基準点での定点慣性行列を出力する定点慣
性行列出力部と、前記慣性行列出力部の出力とコリオリ
力出力部の出力と前記定点慣性行列出力部の出力と前記
空気室状態検出部の出力と、前記空気室内部の圧力差を
アクチュエータの発生トルクに変換する圧力トルク変換
定数とを用いて算出圧力を出力する算出圧力出力部とを
設け、前記モデル入力出力部が、目標動作状態と前記算
出圧力出力部の出力と空気室状態検出部の出力の内の位
置と速度とを用いて空気圧線形モデルの入力を計算する
ことを特徴とする請求項1または2記載の空気圧駆動装
置。 - 【請求項4】 算出圧力出力部が、前記慣性行列出力
部の出力と前記定点慣性行列出力部の出力との差に前記
空気室動作部の加速度を乗じ、前記コリオリ力出力部の
出力を加えた補償トルク指令値Aに圧力トルク変換定数
の逆数を乗じた補償圧力指令値を、前記空気室内部の圧
力差から減算することにより算出圧力を構成し出力する
ことを特徴とする請求項2または3記載の空気圧駆動装
置。 - 【請求項5】 算出圧力出力部が、前記空気室内部の
圧力差に圧力トルク変換定数の逆数を乗じ、前記コリオ
リ力出力部の出力を減算した補償トルク指令値Bに、前
記圧力トルク変換定数と前記定点慣性行列出力部の出力
と前記慣性行列出力部の出力の逆行列とを乗ずることに
より算出圧力を構成し出力することを特徴とする請求項
2または3記載の空気圧駆動装置。 - 【請求項6】 動作制御部に、前記慣性行列出力部の
出力と前記コリオリ力出力部の出力と前記空気室内部の
圧力差と圧力トルク変換定数と前記外乱推定部の出力よ
り前記空気室動作部の算出加速度を出力する前記算出加
速度出力部を設け、前記モデル入力出力部が、目標動作
状態と前記算出加速度出力部の出力と前記空気室状態検
出部の出力の内の位置と速度とを用いてモデル入力を計
算し、前記モデル変換部が任意の線形モデルを用いて前
記モデル入力出力部の出力をモデル変換入力に変換して
出力することを特徴とする請求項1または2記載の空気
圧駆動装置。 - 【請求項7】 算出加速度出力部が、前記空気室内部
の圧力差に圧力トルク変換定数を乗じ、前記コリオリ力
出力部の出力と前記外乱推定部の出力を減算した補償ト
ルク指令値Cに前記慣性行列出力部の出力の逆行列を乗
じて算出加速度を構成し出力することを特徴とする請求
項6記載の空気圧駆動装置。 - 【請求項8】 動作制御部に、前記空気室動作部に作
用する粘性摩擦を測定あるいは計算する粘性摩擦出力部
と、前記粘性摩擦出力部の出力を微分する粘性摩擦微分
部とを加え、前記制御弁指令値生成部が、前記慣性行列
出力部の出力に前記モデル変換部の出力を乗じたものと
、前記慣性行列微分部の出力に前記空気室動作部の加速
度を乗じたものと、前記コリオリ力微分部の出力と、前
記補償入力出力部の出力と、前記外乱補償部の出力と、
前記粘性摩擦微分部の出力とを加算して制御指令値を生
成し、前記制御指令値に前記補償係数出力部の出力を乗
じて制御弁駆動指令値を生成することを特徴とする請求
項1記載の空気圧駆動装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP9750491A JPH04326403A (ja) | 1991-04-26 | 1991-04-26 | 空気圧駆動装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP9750491A JPH04326403A (ja) | 1991-04-26 | 1991-04-26 | 空気圧駆動装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
JPH04326403A true JPH04326403A (ja) | 1992-11-16 |
Family
ID=14194096
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP9750491A Pending JPH04326403A (ja) | 1991-04-26 | 1991-04-26 | 空気圧駆動装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPH04326403A (ja) |
-
1991
- 1991-04-26 JP JP9750491A patent/JPH04326403A/ja active Pending
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Bobrow et al. | Modeling, identification, and control of a pneumatically actuated, force controllable robot | |
Hildebrandt et al. | Cascaded control concept of a robot with two degrees of freedom driven by four artificial pneumatic muscle actuators | |
Rouzbeh et al. | Design, implementation and control of an improved hybrid pneumatic-electric actuator for robot arms | |
Kim et al. | Investigations of a robotic test bed with viscoelastic liquid cooled actuators | |
Krichel et al. | Tracking control of a pneumatic muscle actuator using one servovalve | |
CN110259879A (zh) | 用于电动Stewart结构的无力反馈隔振控制方法和系统 | |
CN114800522A (zh) | 无末端力传感器的液压机械臂接触作业自适应阻抗控制系统 | |
CN106607901A (zh) | 一种3自由度气动串联机械手的关节控制器 | |
Hildebrandt et al. | A cascaded tracking control concept for pneumatic muscle actuators | |
Gulati et al. | Non-linear pressure observer design for pneumatic actuators | |
Salim et al. | Position control of pneumatic actuator using an enhancement of NPID controller based on the characteristic of rate variation nonlinear gain | |
JPH04326403A (ja) | 空気圧駆動装置 | |
Liyanage et al. | High speed electro-hydraulic actuator for a scara type robotic arm | |
Thomas et al. | A novel, low-cost pneumatic positioning system | |
Schindele et al. | Trajectory tracking of a pneumatically driven parallel robot using higher-order SMC | |
Gyeviki et al. | Position control of pneumatic actuators with PLC | |
Ider | Force and motion trajectory tracking control of flexible-joint robots | |
Gulati et al. | Pressure observer based servo control of pneumatic actuators | |
JPH03249401A (ja) | 空気圧駆動装置 | |
Otten et al. | Position and torque tracking: Series elastic actuation versus model-based-controlled hydraulic actuation | |
Hoffmann et al. | Comparison of Cascaded and Flatness-Based Control of a Pneumatically-Driven Rotary Joint | |
Rahman et al. | Experimental comparison between proportional and pwm-solenoid valves controlled servopneumatic positioning systems | |
JPH04145201A (ja) | 空気圧駆動装置 | |
Ming et al. | Development of the pneumatic servo control system | |
Cambera et al. | Feedback linearizing controller for a single link flexible arm with a passive gravity compensation mechanism |