JPH09322580A - 負荷状態推定装置 - Google Patents
負荷状態推定装置Info
- Publication number
- JPH09322580A JPH09322580A JP8132195A JP13219596A JPH09322580A JP H09322580 A JPH09322580 A JP H09322580A JP 8132195 A JP8132195 A JP 8132195A JP 13219596 A JP13219596 A JP 13219596A JP H09322580 A JPH09322580 A JP H09322580A
- Authority
- JP
- Japan
- Prior art keywords
- load
- stage
- motor
- shaft torque
- state
- 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.)
- Granted
Links
Landscapes
- Control Of Electric Motors In General (AREA)
- Feedback Control In General (AREA)
Abstract
(57)【要約】
【課題】多質点機械系負荷を駆動するサーボモータをフ
ィードバック制御するためには,直接測定が実質上不可
能な状態変数をオブザーバにより推定する必要がある
が,従来方式のオブザーバは,外部から上記負荷に加わ
る外乱を推定できず,外乱が変動すると状態変数の推定
値に誤差が生じるという欠点を抱えていた。 【解決手段】本発明は,モータ電流とモータ速度に基づ
いてモータ軸トルクを推定するモータ軸トルクオブザー
バ3と,モータ軸トルクオブザーバにより推定された上
記モータ軸トルク及び上記モータ速度に基づいて負荷の
状態と負荷トルク外乱を推定する負荷状態演算部4によ
り外乱を推定し,多質点機械系負荷を駆動するサーボモ
ータのより精度の高い制御を提供することを目的とする
ものである。
ィードバック制御するためには,直接測定が実質上不可
能な状態変数をオブザーバにより推定する必要がある
が,従来方式のオブザーバは,外部から上記負荷に加わ
る外乱を推定できず,外乱が変動すると状態変数の推定
値に誤差が生じるという欠点を抱えていた。 【解決手段】本発明は,モータ電流とモータ速度に基づ
いてモータ軸トルクを推定するモータ軸トルクオブザー
バ3と,モータ軸トルクオブザーバにより推定された上
記モータ軸トルク及び上記モータ速度に基づいて負荷の
状態と負荷トルク外乱を推定する負荷状態演算部4によ
り外乱を推定し,多質点機械系負荷を駆動するサーボモ
ータのより精度の高い制御を提供することを目的とする
ものである。
Description
【0001】
【発明の属する技術分野】本発明は,負荷状態推定装置
に係り,詳しくは,多質点機械系負荷を駆動するサーボ
モータをフィードバック制御するために,負荷外乱及び
負荷の状態を推定することのできる負荷状態推定装置に
関するものである。
に係り,詳しくは,多質点機械系負荷を駆動するサーボ
モータをフィードバック制御するために,負荷外乱及び
負荷の状態を推定することのできる負荷状態推定装置に
関するものである。
【0002】
【従来の技術】例えば,機械負荷を駆動するサーボモー
タの制御を行う時,モータと負荷の間の結合部が低剛性
であると共振・***振が発生し,制御が困難となる場合
がある。この共振・***振を防止するためには,フィー
ドバック制御が有効である。例えば負荷速度に基づいて
速度フィードバック制御を行う場合,フィードバック時
の変数である上記負荷速度を何らかの方法により測定す
る必要が生じるが,一般に負荷速度を直接測定するのは
不可能な場合が多く,測定が可能な場合でも測定器は高
価であり,現実的な解決手段として採用しがたい。この
ため観測可能な変数(例えば,モータ速度及びモータ電
流)に基づいて上記負荷速度等の状態変数を推定するオ
ブザーバが従来用いられてきた。一般にオブザーバと
は,ある系をフィードバック制御する場合に直接測定す
ることができない状態変数を制御入力と測定出力とから
推定するための機構を指し,状態観測器とも呼ばれる。
以下,サーボモータに駆動されるn質点機械系負荷の状
態を同一次元オブザーバにより推定する場合について説
明する。ここで該n質点機械系負荷とは,例えば多関節
ロボットや産業用自動化機械でよく見受けられる負荷と
モータがギアを介して接続されている場合など,複数の
負荷が何らかの結合手段(以下,結合軸と呼ぶ)により
直列的に接続されたものを指す。先ず,同一次元オブザ
ーバを導入するためモータ・n質点機械系負荷の概略構
成及び状態方程式を示す。ここに,図4はモータ・n質
点機械系負荷の概略構成を示すブロック図である。ま
た,図4に示すモータ・n質点機械系負荷のブロック線
図モデルを図5に,フィードバック変数を推定するため
の同一次元オブザーバを図6に示す。尚,図4及び図5
において,n質点機械系負荷を駆動するサーボモータの
モータ出力トルクはTAであり,n段目の負荷に外部よ
り加わる外乱が負荷トルク外乱TDで表されている。ま
た,TL1 はサーボモータと第1段目の負荷を連結する
モータ軸のモータ軸トルク,TLi は(i−1)段目の
負荷とi段目の負荷の間を連結する結合軸の結合軸トル
ク,ωMはモータ速度,ωL1〜ωLn は各段の負荷の
負荷速度,KMはモータイナーシャの逆数,KL1 〜K
Ln は各質点のイナーシャの逆数,Kε1 〜Kεn は各
軸のバネ定数,sはラプラス演算子,kはオブザーバゲ
インを表すものとする。また,i及びnは自然数であ
り,iはnより小さい。図5に示すブロック線図に基づ
くn質点機械系負荷の状態方程式を(1)式に示す。 DX=AX+BU …(1) 簡単のためn=3とすると, X=(TL1 ,TL2 ,ωM,ωL1 ,ωL2 )T U=(TA,TD)T
タの制御を行う時,モータと負荷の間の結合部が低剛性
であると共振・***振が発生し,制御が困難となる場合
がある。この共振・***振を防止するためには,フィー
ドバック制御が有効である。例えば負荷速度に基づいて
速度フィードバック制御を行う場合,フィードバック時
の変数である上記負荷速度を何らかの方法により測定す
る必要が生じるが,一般に負荷速度を直接測定するのは
不可能な場合が多く,測定が可能な場合でも測定器は高
価であり,現実的な解決手段として採用しがたい。この
ため観測可能な変数(例えば,モータ速度及びモータ電
流)に基づいて上記負荷速度等の状態変数を推定するオ
ブザーバが従来用いられてきた。一般にオブザーバと
は,ある系をフィードバック制御する場合に直接測定す
ることができない状態変数を制御入力と測定出力とから
推定するための機構を指し,状態観測器とも呼ばれる。
以下,サーボモータに駆動されるn質点機械系負荷の状
態を同一次元オブザーバにより推定する場合について説
明する。ここで該n質点機械系負荷とは,例えば多関節
ロボットや産業用自動化機械でよく見受けられる負荷と
モータがギアを介して接続されている場合など,複数の
負荷が何らかの結合手段(以下,結合軸と呼ぶ)により
直列的に接続されたものを指す。先ず,同一次元オブザ
ーバを導入するためモータ・n質点機械系負荷の概略構
成及び状態方程式を示す。ここに,図4はモータ・n質
点機械系負荷の概略構成を示すブロック図である。ま
た,図4に示すモータ・n質点機械系負荷のブロック線
図モデルを図5に,フィードバック変数を推定するため
の同一次元オブザーバを図6に示す。尚,図4及び図5
において,n質点機械系負荷を駆動するサーボモータの
モータ出力トルクはTAであり,n段目の負荷に外部よ
り加わる外乱が負荷トルク外乱TDで表されている。ま
た,TL1 はサーボモータと第1段目の負荷を連結する
モータ軸のモータ軸トルク,TLi は(i−1)段目の
負荷とi段目の負荷の間を連結する結合軸の結合軸トル
ク,ωMはモータ速度,ωL1〜ωLn は各段の負荷の
負荷速度,KMはモータイナーシャの逆数,KL1 〜K
Ln は各質点のイナーシャの逆数,Kε1 〜Kεn は各
軸のバネ定数,sはラプラス演算子,kはオブザーバゲ
インを表すものとする。また,i及びnは自然数であ
り,iはnより小さい。図5に示すブロック線図に基づ
くn質点機械系負荷の状態方程式を(1)式に示す。 DX=AX+BU …(1) 簡単のためn=3とすると, X=(TL1 ,TL2 ,ωM,ωL1 ,ωL2 )T U=(TA,TD)T
【数1】 尚,(1)式における状態変数X,制御入力Uは時間t
の行列関数であるが,必要の無いかぎり単にX,Uと表
し,DFは任意の状態変数Fの時間微分を示すものとす
る。上記したように(1)式の状態方程式における状態
変数Xのうち直接検出が容易であるのはモータ速度ωM
のみであり,フィードバック制御を行うためには上記負
荷速度(ωL1 〜ωLn )及び上記結合軸トルク(TL
1 〜TLn )を推定するオブザーバが必要となる。ここ
で,上記モータ・n質点機械系負荷システムと同一次元
のシステムを導入する。 DX* =(A−kI)X* +kX+BU …(2) 但し,X* =(TL1 * ,TL2 * ,ωM* ,ω
L1 * ,ωL2 * )T kはオブザーバゲイン Iは単位行列 さらに,(1)式の状態変数X(t)と(2)式の変数
X* (t)の差をE(t)とおき, E(t)=X(t)* −X(t) …(3) (3)式を整理すると, DE(t)=E(0){(A−kI)t} …(4) となる。(4)式に示されるように(A−kI)が安定
行列であれば,どんなE(0)に対しても,t→∞でE
(t)→0,即ち,X* (t)→X(t)となるのでX
* をXの推定値とすることができる。従って,例えば図
6に示すようなオブザーバを電子回路やマイクロコンピ
ュータ等の演算手段により実現し,上記モータ・n質点
機械系負荷の制御システムに導入すれば,上記状態変数
Xの推定値X* (以下,* は推定値を示す。)をフィー
ドバックして制御を行うことができる。尚,マイクロコ
ンピュータ等の演算手段を用いる場合には,制御入力及
び測定できる状態変数をA/D変換器によりデジタル化
すると共に(2)式のシステムを差分化して使用する。
差分化した場合の(2)式のシステムを(5)式に示
す。 {X* (m)−X* (m−1)}/h =(A−kI)X* (m−1)+kX(m)+BU(m) …(5) 但し,mは演算回数 hは演算周期 しかし,上記したような従来のオブザーバでは,制御入
力Uとして負荷トルク外乱TDが必要であるため負荷ト
ルク外乱TDが無い場合及び既知である場合には正確な
状態変数Xの推定を行うことができるが,負荷トルク外
乱TDが変動する場合には状態変数推定値X* に変動分
だけ誤差が含まれてしまう。換言すれば,上記オブザー
バでは負荷トルク外乱を推定することができない。
の行列関数であるが,必要の無いかぎり単にX,Uと表
し,DFは任意の状態変数Fの時間微分を示すものとす
る。上記したように(1)式の状態方程式における状態
変数Xのうち直接検出が容易であるのはモータ速度ωM
のみであり,フィードバック制御を行うためには上記負
荷速度(ωL1 〜ωLn )及び上記結合軸トルク(TL
1 〜TLn )を推定するオブザーバが必要となる。ここ
で,上記モータ・n質点機械系負荷システムと同一次元
のシステムを導入する。 DX* =(A−kI)X* +kX+BU …(2) 但し,X* =(TL1 * ,TL2 * ,ωM* ,ω
L1 * ,ωL2 * )T kはオブザーバゲイン Iは単位行列 さらに,(1)式の状態変数X(t)と(2)式の変数
X* (t)の差をE(t)とおき, E(t)=X(t)* −X(t) …(3) (3)式を整理すると, DE(t)=E(0){(A−kI)t} …(4) となる。(4)式に示されるように(A−kI)が安定
行列であれば,どんなE(0)に対しても,t→∞でE
(t)→0,即ち,X* (t)→X(t)となるのでX
* をXの推定値とすることができる。従って,例えば図
6に示すようなオブザーバを電子回路やマイクロコンピ
ュータ等の演算手段により実現し,上記モータ・n質点
機械系負荷の制御システムに導入すれば,上記状態変数
Xの推定値X* (以下,* は推定値を示す。)をフィー
ドバックして制御を行うことができる。尚,マイクロコ
ンピュータ等の演算手段を用いる場合には,制御入力及
び測定できる状態変数をA/D変換器によりデジタル化
すると共に(2)式のシステムを差分化して使用する。
差分化した場合の(2)式のシステムを(5)式に示
す。 {X* (m)−X* (m−1)}/h =(A−kI)X* (m−1)+kX(m)+BU(m) …(5) 但し,mは演算回数 hは演算周期 しかし,上記したような従来のオブザーバでは,制御入
力Uとして負荷トルク外乱TDが必要であるため負荷ト
ルク外乱TDが無い場合及び既知である場合には正確な
状態変数Xの推定を行うことができるが,負荷トルク外
乱TDが変動する場合には状態変数推定値X* に変動分
だけ誤差が含まれてしまう。換言すれば,上記オブザー
バでは負荷トルク外乱を推定することができない。
【0003】
【発明が解決しようとする課題】上記したような従来方
式のオブザーバでは,負荷トルク外乱が変動した場合,
状態変数Xが正確に推定できないという問題があった。
さらに,従来のオブザーバでは,(4)式に示されるよ
うに推定値X* が状態変数Xに漸近するために多少の時
間を必要とする。この推定のための遅れは,サーボモー
タにより駆動する機械負荷の質点が多くなると大きな問
題となる。即ち,状態変数の多い多質点機械系負荷を駆
動するサーボモータの制御では,上記サーボモータの共
振・***振発生を防止する目的でサーボ制御系へ状態変
数推定値X* をフィードバックしたとしても,上記した
推定遅れのために逆に制御系が不安定となったり,ハン
チングを起こしたりする恐れがある。また,オブザーバ
ゲインkを設定する必要があるが,多質点機械系負荷の
場合,その計算は複雑となる。本発明は,このような従
来の技術における課題を解決するために,状態観測器を
改良し,多質点機械系負荷における負荷の状態及び外部
からの負荷トルク外乱を推定することのできる負荷状態
推定装置を提供することを目的とするものである。
式のオブザーバでは,負荷トルク外乱が変動した場合,
状態変数Xが正確に推定できないという問題があった。
さらに,従来のオブザーバでは,(4)式に示されるよ
うに推定値X* が状態変数Xに漸近するために多少の時
間を必要とする。この推定のための遅れは,サーボモー
タにより駆動する機械負荷の質点が多くなると大きな問
題となる。即ち,状態変数の多い多質点機械系負荷を駆
動するサーボモータの制御では,上記サーボモータの共
振・***振発生を防止する目的でサーボ制御系へ状態変
数推定値X* をフィードバックしたとしても,上記した
推定遅れのために逆に制御系が不安定となったり,ハン
チングを起こしたりする恐れがある。また,オブザーバ
ゲインkを設定する必要があるが,多質点機械系負荷の
場合,その計算は複雑となる。本発明は,このような従
来の技術における課題を解決するために,状態観測器を
改良し,多質点機械系負荷における負荷の状態及び外部
からの負荷トルク外乱を推定することのできる負荷状態
推定装置を提供することを目的とするものである。
【0004】
【課題を解決するための手段】上記目的を達成するため
に本発明は,複数の負荷を結合軸により直列的に連結し
た多質点機械系負荷を駆動するサーボモータのモータ電
流とモータ速度との各検出値に基づいて,上記サーボモ
ータに結合された負荷の状態を推定する負荷状態推定装
置において,上記モータ電流と上記モータ速度との各検
出値に基づいて,上記サーボモータのモータ軸トルクを
推定するモータ軸トルクオブザーバと,上記モータ速度
の検出値と上記モータ軸トルクの推定値とに基づいて,
上記サーボモータに結合された初段の負荷の負荷速度と
上記初段の負荷とその次段の負荷との間の結合軸トルク
とを推定する初段負荷状態推定器と,(i−1)段目の
負荷の負荷速度の推定値と,上記(i−1)段目の負荷
とi段目の負荷との間の結合軸トルクの推定値とに基づ
いて,上記i段目の負荷の負荷速度と上記i段目の負荷
と(i+1)段目の負荷との間の結合軸トルクとを推定
する各段負荷状態推定器とを具備してなることを特徴と
する負荷状態推定装置として構成されている。このた
め,各段の負荷の負荷速度及び各段の負荷と次段の負荷
との間の結合軸トルクを推定することが可能である。さ
らに,最終段の負荷とその次段の負荷との間の結合軸ト
ルクとして推定されるトルクを上記サーボモータに加わ
る負荷トルク外乱とすれば,外部からの外乱を推定する
ことができるとともに,外乱による状態変数の推定誤差
を減少させることが可能である。また,各段の負荷の負
荷速度及び上記各段の負荷とその次段の負荷との間の上
記結合軸トルクを推定する際の雑音を低減する雑音低減
手段を具備すれば,雑音による状態変数の推定誤差を減
少させ,より精度のよい負荷の状態推定を行うことがで
きる。
に本発明は,複数の負荷を結合軸により直列的に連結し
た多質点機械系負荷を駆動するサーボモータのモータ電
流とモータ速度との各検出値に基づいて,上記サーボモ
ータに結合された負荷の状態を推定する負荷状態推定装
置において,上記モータ電流と上記モータ速度との各検
出値に基づいて,上記サーボモータのモータ軸トルクを
推定するモータ軸トルクオブザーバと,上記モータ速度
の検出値と上記モータ軸トルクの推定値とに基づいて,
上記サーボモータに結合された初段の負荷の負荷速度と
上記初段の負荷とその次段の負荷との間の結合軸トルク
とを推定する初段負荷状態推定器と,(i−1)段目の
負荷の負荷速度の推定値と,上記(i−1)段目の負荷
とi段目の負荷との間の結合軸トルクの推定値とに基づ
いて,上記i段目の負荷の負荷速度と上記i段目の負荷
と(i+1)段目の負荷との間の結合軸トルクとを推定
する各段負荷状態推定器とを具備してなることを特徴と
する負荷状態推定装置として構成されている。このた
め,各段の負荷の負荷速度及び各段の負荷と次段の負荷
との間の結合軸トルクを推定することが可能である。さ
らに,最終段の負荷とその次段の負荷との間の結合軸ト
ルクとして推定されるトルクを上記サーボモータに加わ
る負荷トルク外乱とすれば,外部からの外乱を推定する
ことができるとともに,外乱による状態変数の推定誤差
を減少させることが可能である。また,各段の負荷の負
荷速度及び上記各段の負荷とその次段の負荷との間の上
記結合軸トルクを推定する際の雑音を低減する雑音低減
手段を具備すれば,雑音による状態変数の推定誤差を減
少させ,より精度のよい負荷の状態推定を行うことがで
きる。
【0005】
【発明の実施の形態】以下添付図面を参照して,本発明
の一実施の形態につき説明し,本発明の理解に供する。
尚,以下の実施の形態は,本発明を具体化したものであ
って,本発明の技術的範囲を限定する性格のものではな
い。ここに図1は本発明の一実施の形態に係る負荷状態
推定装置の基本構成を示すブロック線図,図2は図4に
示したn質点機械系負荷におけるi段目の質点系を示す
ブロック線図,図3は上記負荷状態装置に係る負荷状態
演算部のi段目の質点系に対応する部分のブロック線図
である。尚,上記負荷状態推定装置における各変数及び
制御定数の定義は従来の技術と同様とする。図1に示す
ように,本実施の形態に係る負荷状態推定装置は,サー
ボモータのモータ電流IAを検出する電流検出器1,モ
ータ速度ωMを検出する速度検出器2,モータ電流IA
及びモータ速度ωMに基づいてモータ軸トルクTL1 を
推定するモータ軸トルクオブザーバ3,モータ速度ωM
及びモータ軸トルクTL1 に基づいて負荷の状態を推定
する負荷状態演算部4(初段負荷状態推定器及び各段負
荷状態推定器に相当)により構成されており,図4に示
したn質点機械系負荷を駆動するサーボモータをフィー
ドバック制御する場合の状態変数を推定する。以下,上
記負荷状態推定装置による状態変数の推定の詳細を説明
する。先ず,図2のi段目の質点系の状態方程式を示
す。 ωLi =(KLi /s)(TLi −TLi+1 ) …(6) TLi =(Kεi /s)(ωLi-1 −ωLi ) …(7) (6)式及び(7)式における(i−1)段目の負荷の
負荷速度ωLi-1 と(i−1)段目の負荷とi段目の負
荷との間の結合軸トルクTLi が既知であるとして,状
態方程式を書き直すと, ωLi * =ωLi-1 * −(s/Kεi * )TLi * …(8) TLi+1 * =−(s/KLi * )ωLi * +TLi * …(9) となる。また,(8)式及び(9)式に対応するブロッ
ク線図は図3のようになる。図3のブロック線図を1段
目の質点系からn段目の質点系にわたって直列に接続し
たものを,マイクロコンピュータ等の演算手段により実
現したものが負荷状態演算部4である。負荷状態演算部
4では各段の負荷の負荷速度ωLi * 及び各段の負荷と
その次段の負荷との間の結合軸トルクTLi+1 * とが推
定される。負荷状態演算部4の入力(1段目の負荷質点
系への入力)はωL1 * 及びTL 1 * ,即ちモータ速度
ωM及びモータ軸トルクTL1 * である。この内,モー
タ速度ωMは速度検出器2(例えばモータ軸に接続され
たタコジェネレータやパルスエンコーダ等を接続す
る。)により測定される。また,電流検出器1により検
出されたモータ電流IAからモータ出力トルクTAを求
めれば,モータ軸トルクTL1 * はモータ出力トルクT
A及び上記モータ速度ωMに基づいてモータ軸トルクオ
ブザーバ3により推定される。負荷状態演算部4では,
上記モータ速度ωM及びモータ軸トルクTL1 * より1
段目の負荷速度ωL1 * 及び1段目と2段目の間の結合
軸トルクTL2 * を推定し,上記負荷速度ωL1 * 及び
上記結合軸トルクTL2 * に基づいて2段目の負荷速度
ωL2 * 及び2段目と3段目の間の結合軸トルクTL3
* を求めるというように順次,各段の負荷の状態を推定
することができる。また,最終段(n段目)の負荷質点
系に対応する負荷状態推定値は,n段目の負荷の負荷速
度ωLn * 及びn段目の負荷と(n+1)段目の負荷の
間の結合軸トルクTLn+1 * であるが,結合軸トルクT
Ln+1 * はn段目の負荷に外部より加わった負荷トルク
外乱TD* に相当する。尚,負荷状態演算部4には微分
器41及び42が含まれるため,入力信号に含まれる雑
音を大きくしてしまう恐れがある。このため,負荷状態
演算部4の各段に,例えばローパスフィルタを挿入し,
上記雑音を低減する。以上のようにして,本実施の形態
に係る負荷状態推定装置を用いれば,各段の負荷の状態
及び外乱による負荷トルク外乱TDの正確な推定が可能
であり,負荷トルク外乱が変動した場合でも精度のよい
制御を提供することができる。また,ゲイン設定を行う
必要がなく多質点機械系負荷に適用する場合でも演算が
簡単で,推定遅れもない。
の一実施の形態につき説明し,本発明の理解に供する。
尚,以下の実施の形態は,本発明を具体化したものであ
って,本発明の技術的範囲を限定する性格のものではな
い。ここに図1は本発明の一実施の形態に係る負荷状態
推定装置の基本構成を示すブロック線図,図2は図4に
示したn質点機械系負荷におけるi段目の質点系を示す
ブロック線図,図3は上記負荷状態装置に係る負荷状態
演算部のi段目の質点系に対応する部分のブロック線図
である。尚,上記負荷状態推定装置における各変数及び
制御定数の定義は従来の技術と同様とする。図1に示す
ように,本実施の形態に係る負荷状態推定装置は,サー
ボモータのモータ電流IAを検出する電流検出器1,モ
ータ速度ωMを検出する速度検出器2,モータ電流IA
及びモータ速度ωMに基づいてモータ軸トルクTL1 を
推定するモータ軸トルクオブザーバ3,モータ速度ωM
及びモータ軸トルクTL1 に基づいて負荷の状態を推定
する負荷状態演算部4(初段負荷状態推定器及び各段負
荷状態推定器に相当)により構成されており,図4に示
したn質点機械系負荷を駆動するサーボモータをフィー
ドバック制御する場合の状態変数を推定する。以下,上
記負荷状態推定装置による状態変数の推定の詳細を説明
する。先ず,図2のi段目の質点系の状態方程式を示
す。 ωLi =(KLi /s)(TLi −TLi+1 ) …(6) TLi =(Kεi /s)(ωLi-1 −ωLi ) …(7) (6)式及び(7)式における(i−1)段目の負荷の
負荷速度ωLi-1 と(i−1)段目の負荷とi段目の負
荷との間の結合軸トルクTLi が既知であるとして,状
態方程式を書き直すと, ωLi * =ωLi-1 * −(s/Kεi * )TLi * …(8) TLi+1 * =−(s/KLi * )ωLi * +TLi * …(9) となる。また,(8)式及び(9)式に対応するブロッ
ク線図は図3のようになる。図3のブロック線図を1段
目の質点系からn段目の質点系にわたって直列に接続し
たものを,マイクロコンピュータ等の演算手段により実
現したものが負荷状態演算部4である。負荷状態演算部
4では各段の負荷の負荷速度ωLi * 及び各段の負荷と
その次段の負荷との間の結合軸トルクTLi+1 * とが推
定される。負荷状態演算部4の入力(1段目の負荷質点
系への入力)はωL1 * 及びTL 1 * ,即ちモータ速度
ωM及びモータ軸トルクTL1 * である。この内,モー
タ速度ωMは速度検出器2(例えばモータ軸に接続され
たタコジェネレータやパルスエンコーダ等を接続す
る。)により測定される。また,電流検出器1により検
出されたモータ電流IAからモータ出力トルクTAを求
めれば,モータ軸トルクTL1 * はモータ出力トルクT
A及び上記モータ速度ωMに基づいてモータ軸トルクオ
ブザーバ3により推定される。負荷状態演算部4では,
上記モータ速度ωM及びモータ軸トルクTL1 * より1
段目の負荷速度ωL1 * 及び1段目と2段目の間の結合
軸トルクTL2 * を推定し,上記負荷速度ωL1 * 及び
上記結合軸トルクTL2 * に基づいて2段目の負荷速度
ωL2 * 及び2段目と3段目の間の結合軸トルクTL3
* を求めるというように順次,各段の負荷の状態を推定
することができる。また,最終段(n段目)の負荷質点
系に対応する負荷状態推定値は,n段目の負荷の負荷速
度ωLn * 及びn段目の負荷と(n+1)段目の負荷の
間の結合軸トルクTLn+1 * であるが,結合軸トルクT
Ln+1 * はn段目の負荷に外部より加わった負荷トルク
外乱TD* に相当する。尚,負荷状態演算部4には微分
器41及び42が含まれるため,入力信号に含まれる雑
音を大きくしてしまう恐れがある。このため,負荷状態
演算部4の各段に,例えばローパスフィルタを挿入し,
上記雑音を低減する。以上のようにして,本実施の形態
に係る負荷状態推定装置を用いれば,各段の負荷の状態
及び外乱による負荷トルク外乱TDの正確な推定が可能
であり,負荷トルク外乱が変動した場合でも精度のよい
制御を提供することができる。また,ゲイン設定を行う
必要がなく多質点機械系負荷に適用する場合でも演算が
簡単で,推定遅れもない。
【0006】
【実施例】上記した本発明の一実施の形態に係る負荷状
態推定装置では,サーボモータのモータ電流の検出値I
Aによりモータ軸トルクTL1 の推定を行ったが,検出
値の代わりに,サーボモータへの電流指令に基づいてモ
ータ軸トルクTL1 の推定を行ってもよい。このような
負荷状態推定装置も本発明における負荷状態推定装置の
一例である。
態推定装置では,サーボモータのモータ電流の検出値I
Aによりモータ軸トルクTL1 の推定を行ったが,検出
値の代わりに,サーボモータへの電流指令に基づいてモ
ータ軸トルクTL1 の推定を行ってもよい。このような
負荷状態推定装置も本発明における負荷状態推定装置の
一例である。
【0007】
【発明の効果】本発明は上記したように構成されている
ため,多質点機械系負荷における各段の負荷の負荷速度
及び各段の負荷と次段の負荷との間の結合軸トルクを推
定することが可能であり,より精度の高いフィードバッ
ク制御を提供することができる。また,ゲイン設定を行
う必要がなく多質点機械系負荷に適用する場合でも演算
が簡単で,推定遅れもない。さらに,最終段の負荷とそ
の次段の負荷との間の結合軸トルクとして推定されるト
ルクを上記サーボモータに加わる負荷トルク外乱とすれ
ば,外部からの外乱を推定することができるとともに,
外乱による状態変数の推定誤差を減少させることが可能
である。また,各段の負荷の負荷速度及び上記各段の負
荷とその次段の負荷との間の上記結合軸トルクを推定す
る際の雑音を低減する雑音低減手段を具備すれば,雑音
による状態変数の推定誤差を減少させ,より精度のよい
負荷の状態推定を行うことができる。
ため,多質点機械系負荷における各段の負荷の負荷速度
及び各段の負荷と次段の負荷との間の結合軸トルクを推
定することが可能であり,より精度の高いフィードバッ
ク制御を提供することができる。また,ゲイン設定を行
う必要がなく多質点機械系負荷に適用する場合でも演算
が簡単で,推定遅れもない。さらに,最終段の負荷とそ
の次段の負荷との間の結合軸トルクとして推定されるト
ルクを上記サーボモータに加わる負荷トルク外乱とすれ
ば,外部からの外乱を推定することができるとともに,
外乱による状態変数の推定誤差を減少させることが可能
である。また,各段の負荷の負荷速度及び上記各段の負
荷とその次段の負荷との間の上記結合軸トルクを推定す
る際の雑音を低減する雑音低減手段を具備すれば,雑音
による状態変数の推定誤差を減少させ,より精度のよい
負荷の状態推定を行うことができる。
【図1】本発明の一実施の形態に係る負荷状態推定装置
の概略構成を示すブロック図。
の概略構成を示すブロック図。
【図2】モータ・n質点機械系負荷のi段目の質点系の
構成を示す図。
構成を示す図。
【図3】上記負荷状態推定装置に係る負荷状態演算部の
部分ブロック線図。
部分ブロック線図。
【図4】モータ・n質点機械系負荷の概略構成を示すブ
ロック図。
ロック図。
【図5】モータ・n質点機械系負荷のモデルブロック線
図。
図。
【図6】従来方式のオブザーバの一例を示す図。
1・・・電流検出器 2・・・速度検出器 3・・・モータ軸トルクオブザーバ 4・・・負荷状態演算部
Claims (3)
- 【請求項1】複数の負荷を結合軸により直列的に連結し
た多質点機械系負荷を駆動するサーボモータのモータ電
流とモータ速度との各検出値に基づいて,上記サーボモ
ータに結合された負荷の状態を推定する負荷状態推定装
置において,上記モータ電流と上記モータ速度との各検
出値に基づいて,上記サーボモータのモータ軸トルクを
推定するモータ軸トルクオブザーバと,上記モータ速度
の検出値と上記モータ軸トルクの推定値とに基づいて,
上記サーボモータに結合された初段の負荷の負荷速度と
上記初段の負荷とその次段の負荷との間の結合軸トルク
とを推定する初段負荷状態推定器と,(i−1)段目の
負荷の負荷速度の推定値と,上記(i−1)段目の負荷
とi段目の負荷との間の結合軸トルクの推定値とに基づ
いて,上記i段目の負荷の負荷速度と上記i段目の負荷
と(i+1)段目の負荷との間の結合軸トルクとを推定
する各段負荷状態推定器とを具備してなることを特徴と
する負荷状態推定装置。 - 【請求項2】最終段の負荷とその次段の負荷との間の結
合軸トルクとして推定されるトルクを上記サーボモータ
に加わる負荷トルク外乱とする請求項1記載の負荷状態
推定装置。 - 【請求項3】各段の負荷の負荷速度及び上記各段の負荷
とその次段の負荷との間の上記結合軸トルクを推定する
際の雑音を低減する雑音低減手段を具備してなる請求項
1若しくは2記載の負荷状態推定装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP13219596A JP3329184B2 (ja) | 1996-05-27 | 1996-05-27 | 負荷状態推定装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP13219596A JP3329184B2 (ja) | 1996-05-27 | 1996-05-27 | 負荷状態推定装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH09322580A true JPH09322580A (ja) | 1997-12-12 |
JP3329184B2 JP3329184B2 (ja) | 2002-09-30 |
Family
ID=15075627
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP13219596A Expired - Fee Related JP3329184B2 (ja) | 1996-05-27 | 1996-05-27 | 負荷状態推定装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3329184B2 (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2015186406A1 (ja) * | 2014-06-06 | 2015-12-10 | 株式会社明電舎 | 周期外乱自動抑制装置 |
-
1996
- 1996-05-27 JP JP13219596A patent/JP3329184B2/ja not_active Expired - Fee Related
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2015186406A1 (ja) * | 2014-06-06 | 2015-12-10 | 株式会社明電舎 | 周期外乱自動抑制装置 |
JPWO2015186406A1 (ja) * | 2014-06-06 | 2017-04-20 | 株式会社明電舎 | 周期外乱自動抑制装置 |
Also Published As
Publication number | Publication date |
---|---|
JP3329184B2 (ja) | 2002-09-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US5587635A (en) | Robot control apparatus for monitoring load on robot | |
US6903529B2 (en) | Method and apparatus for damping mechanical oscillations of a shaft in machine tools, manufacturing machines and robots | |
JP6324641B1 (ja) | 異常診断装置及び異常診断方法 | |
JPWO2017213183A1 (ja) | 異常診断装置及び異常診断方法 | |
CN106020116A (zh) | 具有对机器人进行异常诊断的功能的机器人控制装置 | |
US11865721B2 (en) | Work determination apparatus and work determination method | |
WO2002082202A1 (fr) | Organe de commande de moteur et procede de mesure de caracteristiques d'un mecanisme | |
CN106020124A (zh) | 伺服马达控制装置以及碰撞检测方法 | |
EP3489782B1 (en) | Control system, machine learning apparatus, maintenance assistance apparatus, data generating method, and maintenance assisting method | |
US11951615B2 (en) | Malfunction-type determination device and malfunction-type determination method | |
CN114260892B (zh) | 弹性关节力矩控制方法、装置、可读存储介质及机器人 | |
US5418439A (en) | Apparatus and method for discriminating position information in a position control system | |
CN110525513B (zh) | 一种线控转向***的故障监测方法和故障监测*** | |
JPH09322580A (ja) | 負荷状態推定装置 | |
EP3835750B1 (en) | Abnormality diagnosis device and abnormality diagnosis method | |
JP6881673B2 (ja) | 異常検出装置及び異常検出方法 | |
JPH1049223A (ja) | ニューラルネットワークを用いた故障診断方法およびその装置 | |
JPH112588A (ja) | ダイナモメータによって慣性の力を模擬する方法 | |
JPH1039908A (ja) | 産業用ロボットの故障予知方法 | |
JPH07160323A (ja) | 産業用ロボットの動作波形診断装置 | |
JPH0670567A (ja) | 電動機の制御ゲイン自動設定方法及びバックラッシュ検出方法 | |
JP2958978B2 (ja) | 学習制御方法 | |
EP4270769A1 (en) | Characteristic calculation device, characteristic calculation method, and program | |
JP4296331B2 (ja) | 負荷状態推定装置 | |
EP0809095A2 (de) | Verfahren und Vorrichtung zur Messung des Abtriebsmomentes eines Elektromotors |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20080719 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20080719 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090719 Year of fee payment: 7 |
|
LAPS | Cancellation because of no payment of annual fees |