JPH08331881A - 電動機の制御装置 - Google Patents
電動機の制御装置Info
- Publication number
- JPH08331881A JPH08331881A JP8074671A JP7467196A JPH08331881A JP H08331881 A JPH08331881 A JP H08331881A JP 8074671 A JP8074671 A JP 8074671A JP 7467196 A JP7467196 A JP 7467196A JP H08331881 A JPH08331881 A JP H08331881A
- Authority
- JP
- Japan
- Prior art keywords
- signal
- circuit
- torque
- output
- speed
- 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
- Feedback Control In General (AREA)
- Control Of Position Or Direction (AREA)
- Control Of Velocity Or Acceleration (AREA)
- Control Of Electric Motors In General (AREA)
Abstract
御装置を得る。 【解決手段】予め定められた電動機の速度を指令するト
ルク信号を出力する速度指令手段と、上記電動機の回転
を検出する回転検出器と、この回転検出器の回転検出に
基づいて、上記電動機の回転を補正するべくクーロン摩
擦の補償トルク信号を出力する補償トルク出力手段と、
を備えた。
Description
械におけるテーブルや電動式産業用ロボットのアームの
ような負荷機械を駆動する電動機(直流電動機、誘導電
動機、同期電動機など)の制御装置に関するものであ
る。
る。図36は、平成4年電気学会産業応用部門全国大会
講演論文集No.178「規範システムモデルを内蔵し
た電動機の2自由度位置制御方式」に示された従来の電
動機の制御装置の実施の形態を示すブロック図である。
同図において、1は、回転角指令信号発生回路、2は、
第1の位置制御回路、3は、第1の速度制御回路、4
は、電動機の模擬回路、10は、第2の位置制御回路、
47は、第2の速度制御回路、12は、電動機、13
は、トルク伝達機構、14は、負荷機械、15は、回転
検出器、48は、トルク制御回路、52は、加算器であ
る。電動機12は、トルク伝達機構13を介して負荷機
械14を駆動し、回転検出器15は電動機12の速度お
よび位置を検出し実速度信号ωM および実回転角信号θ
M を出力する。電動機の模擬回路4は、電動機12とト
ルク伝達機構13と負荷機械14の3つのイナーシャを
合算した値をモデル化し、単なるイナーシャJA で示し
たものであり、後述する第1の速度制御回路3の出力で
ある第1のトルク信号T1*を入力して積分し模擬速度信
号ωA を出力する積分器23と模擬速度信号ωA を積分
して模擬回転角信号θA を出力する積分器21から構成
される。第1の位置制御回路2は、回転角指令信号発生
回路1から出力される回転角指令信号θM*と模擬回転角
信号θA との偏差(θM*−θA )を出力する減算器17
と前記偏差(θM*−θA )を比例増幅して第1の速度指
令信号ω1*を出力するゲインKP1の係数器16から構成
され、θA がθM*に追従するように制御する。第1の速
度制御回路3は、速度指令信号ω1*と模擬速度信号ωA
との偏差(ω1*−ωA )を出力する減算器19と前記偏
差(ω1*−ωA )を比例増幅して第1のトルク信号T1*
を出力するゲインKV1係数器18から構成され、ωA が
ω1*に追従するように制御する。第2の位置制御回路1
0は、模擬回転角信号θA と実回転角信号θM との偏差
(θA −θM )を出力する減算器25と前記偏差(θA
−θM )を比例増幅して第2の速度指令信号ω2*を出力
する係数器26から構成され、θM がθA に追従するよ
うに制御する。第2の速度制御回路47は、模擬速度信
号ωA と速度指令信号ω2*との加算値(ωA +ω2*)を
出力する加算器49と前記加算値(ωA +ω2*)と実速
度信号ωM との偏差((ωA +ω2*)−ωM )を出力す
る減算器50と前記偏差((ωA +ω2*)−ωM )を比
例積分増幅して第2のトルク信号T2*を出力する比例積
分器51から構成され、ωM がωA に追従するように制
御する。加算器52は、第1のトルク信号T1*と第2の
トルク信号T2*とを加算してトルク指令信号TM*を出力
し、トルク制御回路48はトルク指令信号TM*に基づい
て電動機12のトルクを制御する。
明する。図399は、従来の電動機の位置制御方式の実
施の形態を示すブロック図である。図において、1は、
回転角指令信号発生回路、2aは、位置制御回路、3a
は、速度制御回路、48aは、トルク制御回路、12
は、電動機、13は、トルク伝達機構、14は、負荷機
械、15は、回転検出器である。電動機12は、トルク
伝達機構13を介して負荷機械14を駆動し、回転検出
器15は電動機12の速度および位置を検出し速度信号
ωMおよび実回転角信号θMを出力する。位置制御回路2
aaは、回転角指令信号発生回路1から出力される回転
角指令信号θM*と実回転角信号θMとの偏差(θM*−θ
M)を出力する減算器17と、前記偏差(θM*−θM)を
比例増幅して速度指令信号ωM*を出力する係数器16か
ら構成され、θM*がθMに追従するように制御する。速
度制御回路3aは、速度指令信号ωM*と実速度信号ωM
との偏差(ωM*−ωM)を出力する減算器19と、前記
偏差(ωM*−ωM)を比例積分増幅してトルク指令信号
TM*を出力する比例積分器51から構成され、ωMがωM
*に追従するように制御する。トルク制御回路48a
は、トルク指令信号TM*に基づいて電動機12のトルク
を制御する。
従来例における電動機の制御装置では、回転角指令信号
に対する応答(目標値応答)は第1の位置制御回路2お
よび第1の速度制御回路3のゲインで調節でき、外乱に
対する応答(外乱応答)は第2の位置制御回路10およ
び第2の速度制御回路47のゲインで調節ができるの
で、回転角指令信号θM*と電動機の位置および速度検出
信号(実回転角信号θM 及び実速度信号ωM)とを比較
しその偏差が減少するように制御する単純なフィードバ
ック制御よりも目標値応答を上げられるという利点があ
る。しかしながら、このような制御回路であっても、上
記単純なフィードバック制御同様、クーロン摩擦に基づ
く位置のオーバーシュートが発生するという問題点があ
った。すなわち、図36に示す従来の電動機の制御装置
では、電動機の模擬回路4において設定されたモデル化
されたイナーシャJA と電動機とトルク伝達機構と負荷
機械を合算した実際のイナーシャが一致している場合に
減算器50からの出力に偏差((ωA +ω2*)−ωM )
が生じる原因として、電動機とトルク伝達機構及び負荷
機械のクーロン摩擦がある。クーロン摩擦分のトルク成
分は第2の速度制御回路47の比例積分器51にたまり
第2のトルク信号T2*として出力される。クーロン摩擦
は公知のように、電動機が運転中のみに発生し、電動機
が停止とともにクーロン摩擦がなくなり偏差((ωA +
ω2*)−ωM )は減少するが、電動機が停止した後も比
例積分器51にたまっているトルク成分はすぐには零に
ならないことから、第2の速度制御回路47はこの比例
積分器51にたまっているトルク成分を出力する。すな
わち、第2のトルク信号T2*を出力しトルク指令信号T
M*を出力する結果、トルク制御回路48はトルク指令信
号TM*に基づいて電動機12のトルクを制御する。その
ため、位置のオーバシュートが発生してしまうという問
題点があった。
る電動機の位置制御装置においても、速度偏差(ωM*−
ωM)の振幅の原因として電動機とトルク伝達機構およ
び負荷機械のクーロン摩擦がある。クーロン摩擦分のト
ルク成分は速度制御回路3aの積分器にたまりトルク指
令信号より出力される。したがって、この第2の従来例
においても、第1の従来例と同様、位置のオーバシュー
トが発生してしまうという問題点があった。この発明
は、上記のような従来の問題点を解決するためになされ
たもので、クーロン摩擦が生じても、位置のオーバーシ
ュートがない電動機の制御装置を得ることを第1の目的
とする。また、クーロン摩擦が変化するような場合であ
っても、この変化に応じてクーロン摩擦に対する適切な
補償を行い位置のオーバーシュートがない電動機の制御
装置を得ることを第2の目的とする。また、回転検出器
に量子化ノイズがある場合でも、クーロン摩擦に対する
適正な補償を行い位置のオーバーシュートがない電動機
の制御装置を得ることを第3の目的とする。また、電動
機の模擬手段のイナーシャが未知な場合や運転中に変化
する場合であっても、クーロン摩擦に対する適正な補償
を行い位置のオーバーシュートがない電動機の制御装置
を得ることを第4の目的とする。更に、第1の速度制御
回路からのトルク信号のリプル成分による補償トルクへ
の悪影響を防止し、クーロン摩擦に対する適正な補償を
行い位置のオーバーシュートがない電動機の制御装置を
得ることを第5の目的とする。
機の制御装置は、予め定められた電動機の速度を指令す
るトルク信号を出力する速度指令手段と、上記電動機の
回転を検出する回転検出器と、この回転検出器の回転検
出に基づいて、上記電動機の回転を補正するべくクーロ
ン摩擦の補償トルク信号を出力する補償トルク出力手段
と、を備えたものである。
電動機の速度を指令する第1のトルク信号を出力する速
度指令手段と、上記電動機の回転を検出する回転検出器
と、この回転検出器の回転検出に基づいて上記電動機の
回転を制御する第2のトルク信号を出力する速度制御手
段と、この速度指令制御手段からの第2のトルク信号及
び上記速度指令手段からの第1のトルク信号を入力とし
て加算し、この加算結果に基づいて上記電動機を回転す
る第1の加算器と、この加算器に対し、クーロン摩擦の
補償トルク信号を出力する補償トルク出力手段と、を備
えたものである。
速度指令手段が、回転角指令信号を出力する回転角指令
信号発生回路と、この回転角指令信号発生回路から出力
される回転角指令信号を一方の入力とし、この一方の入
力と他方の入力に基づき第1の速度指令信号を出力する
第1の位置制御回路と、この第1の速度指令信号を一方
の入力とし、この一方の入力と他方の入力に基づき第1
のトルク信号を出力する第1の速度制御回路と、この第
1のトルク信号に基づき、模擬回転角信号を上記第1の
位置制御回路の他方の入力へ出力するとともに、模擬速
度信号を上記第1の速度制御回路の他方の入力へ出力す
る電動機の模擬回路と、を備えたものである。
回転検出器が、実回転角信号と実速度信号を出力するも
のであり、速度制御手段が、上記回転検出器により検出
された実回転角信号及び電動機の模擬回路から出力され
た模擬回転角信号に基づき第2の速度指令信号を出力す
る第2の位置制御回路と、この第2の速度指令信号、回
転検出器により検出された実速度信号、及び電動機の模
擬回路から出力された模擬速度信号に基づき第2のトル
ク信号を出力する第2の速度制御回路と、を備えたもの
である。
補償トルク出力手段が、回転検出器からの実速度信号ま
たは電動機の模擬回路からの模擬速度信号を所定のパラ
メータを用いて加工した補償トルク信号を出力する摩擦
モデル回路と、第1の速度制御回路からの第1のトルク
信号及び電動機の模擬回路からの模擬速度信号に基づい
てクーロン摩擦成分を抽出し、これに基づき上記摩擦モ
デル回路中のパラメータを修正するパラメータ修正信号
を出力する摩擦修正回路と、を備えたものである。
補償トルク出力手段が、電動機模擬回路のイナーシャ修
正する修正回路を備えたものである。
修正回路が、模擬速度信号と第2の速度指令信号との加
算値と、実回転角速度信号との偏差を出力する加減算器
と、第1のトルク信号に基づいて極性信号を出力する極
性判別回路と、この極性判別回路から出力された極性信
号と、上記加減算器からの偏差とを乗算する乗算器と、
この乗算器の出力を積分する積分器と、この積分器の出
力とイナーシャ初期値を加算し、電動機模擬回路に対し
てイナーシャを出力する加算器と、を備えたものであ
る。
摩擦修正回路が、第1の速度制御回路からの第1のトル
ク信号をローパスフィルタを介して入力するようにした
ものである。
摩擦修正回路が、電動機の模擬回路より出力される模擬
速度信号と第1の速度制御回路より出力される第1のト
ルク信号とに基づき第1乃至第3の状態フラグを出力す
る判定回路と、第1の状態フラグの立ち上がりエッジに
て加算器より出力されるトルク指令信号をサンプル・ホ
ールドし、第1のサンプル・トルク信号を出力する第1
のサンプル・ホールド回路と、第2の状態フラグの立ち
下がりエッジにて加算器より出力されるトルク指令信号
をサンプル・ホールドし、第2のサンプル・トルク信号
を出力する第2のサンプル・ホールド回路と、第3の状
態フラグの立ち下がりエッジにて加算器より出力される
トルク指令信号をサンプル・ホールドし、第3のサンプ
ル・トルク信号を出力する第3のサンプル・ホールド回
路と、上記第2のサンプル・トルク信号とこの第3のサ
ンプル・トルク信号との平均値を出力する計算器と、こ
の計算器の出力と上記第1のサンプル・トルク信号との
偏差を出力する減算器と、上記状態フラグ1の立ち下が
りエッジにてこの偏差をサンプル・ホールドし、パラメ
ータ修正信号を出力する第4のサンプル・ホールド回路
と、を備えたものである。
は、摩擦修正回路が、電動機の模擬回路より出力される
模擬速度信号と第1の速度制御回路より出力される第1
のトルク信号により状態フラグを出力する判定回路と、
この状態フラグの立ち上がりエッジにて加算器より出力
されるトルク指令信号をサンプル・ホールドし、サンプ
ル・トルク信号を出力する第1のサンプル・ホールド回
路と、トルク指令信号とこの第1のサンプル・ホールド
回路から出力されるサンプル・トルク信号TSとの偏差
を出力する減算器と、状態フラグの立ち下がりエッジに
て偏差をサンプル・ホールドし、パラメータ修正値を出
力する第2のサンプル・ホールド回路と、トルク指令信
号と第2のサンプル・ホールド回路から出力される摩擦
モデル修正値との偏差を出力する減算器と、状態フラグ
の立ち下がりエッジにて偏差をサンプル・ホールドし、
積分項修正値を出力する第3のサンプル・ホールド回路
と、を備えたものである。
は、摩擦修正回路が、電動機の模擬回路より出力される
模擬速度信号と第1の速度制御回路より出力される第1
のトルク信号とにより状態フラグ1〜3を出力する判定
回路と、状態フラグ1の立ち上がりエッジにて加算器よ
り出力されるトルク指令信号をサンプル・ホールドし、
第1のサンプル・トルク信号を出力する第1のサンプル
・ホールド回路と、トルク指令信号とこの第1のサンプ
ル・ホールド回路から出力される第1のサンプル・トル
ク信号との偏差を出力する減算器と、状態フラグ2の立
ち下がりエッジにて減算器からの偏差をサンプル・ホー
ルドし、第2のサンプル・トルク信号を出力する第2の
サンプル・ホールド回路と、この第2のサンプル・ホー
ルド回路から出力される第2のサンプル・トルク信号と
トルク指令信号との偏差を出力する減算器と、状態フラ
グ3の立ち上がりエッジにてこの減算器からの偏差をサ
ンプル・ホールドし、第3のサンプル・トルク信号を出
力する第3のサンプル・ホールド回路と、トルク指令信
号とこの第3のサンプル・ホールド回路から出力された
第3のサンプル・トルク信号との加算値を出力する加算
器と、状態フラグ1の立ち下がりエッジにてこの加算器
による加算値をサンプル・ホールドし、パラメータ修正
値を出力する第4のサンプル・ホールド回路と、トルク
指令信号とこの第4のサンプル・ホールド回路から出力
された摩擦モデル修正値との偏差を出力する減算器と、
状態フラグ1の立ち下がりエッジにてこの減算器からの
偏差をサンプル・ホールドし、積分項修正値を出力する
第5のサンプル・ホールド回路と、を備えたものであ
る。
は、補償トルク出力手段が、回転検出器からの実速度信
号を所定のパラメータを用いて加工した補償トルク信号
を出力する摩擦モデル回路と、回転角指令信号発生回路
からの回転角指令信号に応じた摩擦量データを記憶し、
これに基づき上記摩擦モデル回路中のパラメータを修正
するパラメータ修正信号を出力する摩擦記憶回路と、を
備えたものである。
は、摩擦モデル回路が、回転検出器から出力された実速
度信号または電動機の模擬回路から出力された模擬速度
信号を比例増幅する係数器と、この係数器の出力値を所
定の値でリミットし、補償トルク信号を出力するリミッ
タ回路と、摩擦修正回路より出力されるパラメータ修正
信号を与えられると、このリミッタ回路のリミット値を
修正するリミット値プリセット回路と、を備えたもので
ある。
は、補償トルク出力手段が、速度指令手段から出力され
るトルク信号の指令要素とこの指令要素と同一種の要素
であって回転検出器により検出される実検出要素とを比
較し、この比較結果を予め定めた基準に照らして電動機
の回転を補正するべくクーロン摩擦の補償トルク信号を
出力するようにしたものである。
は、予め定めた基準値を、指令要素と実検出要素とを比
較し、これに基づいて修正するようにしたものである。
は、指令要素及び実検出要素において比較される互いに
同一種の要素を、回転角信号とし、各々回転角指令信号
及び実回転角信号としたものである。
の発明の実施の形態1の全体を示すブロック図である。
1は、回転角指令信号θM*を出力する回転角指令信号発
生回路、2は、この回転角指令信号θM*を一方の入力と
し、これに基づき速度指令信号ω1*を出力する第1の位
置制御回路、3は、この速度指令信号ω1*を一方の入力
とし、これに基づき第1のトルク信号T1*を出力する第
1の速度制御回路、4は、この第1のトルク信号T1*を
入力とし、上記第1の位置制御回路2の他方の入力へ模
擬回転角信号θA を出力するとともに上記第1の速度制
御回路3の他方の入力へ模擬速度信号ωA を出力する電
動機の模擬回路である。そして、これら回転角指令信号
発生回路1、第1の位置制御回路2、第1の速度制御回
路3、及び電動機の模擬回路4により速度指令手段を構
成している。また、7は、補償トルク信号TF を出力す
る摩擦モデル回路、8は、上記第1の速度制御回路3か
らの第1のトルク信号T1*、及び上記電動機の模擬回路
4からの模擬速度信号ωA を入力として、信号Iset 出
力するとともに上記摩擦モデル回路7に対し摩擦モデル
回路7中のパラメータを修正する信号Tfsetを出力する
摩擦修正回路である。そして、これら摩擦モデル回路7
及び摩擦修正回路8で補償トルク出力手段を構成してい
る。更に、9は、この摩擦修正回路8からの信号Iset
に基づいてその状態量を修正するとともに電動機の模擬
回路4からの模擬速度信号ωA を入力として第2のトル
ク信号T2*を出力する第2の速度制御回路、10は、上
記電動機の模擬回路4からの模擬回転角信号θA を一方
の入力として、この第2の速度制御回路9に対し第2の
速度指令信号ω2*を出力する第2の位置制御回路であ
る。そして、これら第2の速度制御回路9及び第2の位
置制御回路10で速度制御手段を構成している。11
は、第1の速度制御回路3からの第1のトルク信号T1
*、上記摩擦モデル回路7からの補償トルク信号TF 、
及び上記第2の速度制御回路9からの第2のトルク信号
T2*を第1の加算器、すなわち加算器36により加算し
てなるトルク指令信号TM*を入力するトルク制御回路、
12は、このトルク制御回路11の出力に基づきトルク
が制御される電動機、13は、この電動機12のトルク
を伝達するトルク伝達機構、14は、このトルク伝達機
構13により動作される負荷機械、15は、上記電動機
12の回転を検出し、上記第2の速度制御回路9に実速
度信号ωM を、上記第2の位置制御回路10に実回転角
信号θM を出力する回転検出器である。
詳細な構成を示すブロック図である。同図において、1
7は、電回転角指令信号発生回路1から出力される回転
角指令信号θM*と、電動機の模擬回路4から出力される
模擬回転角信号θA との偏差(θM*−θA )を出力する
減算器、16は、この偏差(θM*−θA )を比例増幅し
て第1の速度指令信号ω1*を出力するゲインKP1の係数
器である。このように模擬回転角信号θA をに回転角指
令信号θM*対してフィードバックする構成とすることに
より、第1の位置制御回路2は、模擬回転角信号θA を
回転角指令信号θM*に追従させるよう第1の速度指令信
号ω1*を出力する。
詳細な構成を示すブロック図である。同図において、1
9は、第1の位置制御回路2から出力される速度指令信
号ω1*と、電動機の模擬回路4から出力される模擬速度
信号ωA との偏差(ω1*−ωA )を出力する減算器、1
8は、この偏差(ω1*−ωA )を比例増幅して第1のト
ルク信号T1*を出力するゲインKV1の係数器である。こ
のように模擬速度信号ωA を第1の速度指令信号ω1*に
対してフィードバックする構成とすることにより、第1
の速度制御回路3は、模擬速度信号ωA を第1の速度指
令信号ω1*に追従させるよう第1のトルク信号T1*を出
力する。
細な構成を示すブロック図である。同図において、23
は、第1の速度制御回路3から出力される第1のトルク
信号T1*を入力とし、イナーシャJA の逆数(1/JA
)を乗じて積分し、模擬速度信号ωA を出力する積分
器、21は、この模擬速度信号ωA を積分して、模擬回
転角信号θA を出力する積分器である。なお、電動機の
模擬回路4の積分器23におけるイナーシャJA は、電
動機12とトルク伝達機構13と負荷機械14の3つの
イナーシャを合算し、これをモデル化して表したもので
あり、この値を適切な値とすることにより、電動機12
とトルク伝達機構13と負荷機械14の3つのイナーシ
ャに合致した適切な制御が行える。
の詳細な構成を示すブロック図である。同図において、
25は、電動機の模擬回路4から出力される模擬回転角
信号θA と、回転検出器15から出力される実回転角信
号θM との偏差(θA −θM )を出力する減算器、26
は、この偏差(θA −θM )を比例増幅して第2の速度
指令信号ω2*を出力するゲインKP2の係数器である。こ
のように実回転角信号θM を模擬回転角信号θA に対し
てフィードバックする構成とすることにより、第2の位
置制御回路10は、実回転角信号θM を模擬回転角信号
θA に追従させるよう第2の速度指令信号ω2*を出力す
るが、前述のごとくこの模擬回転角信号θA は、第1の
位置制御回路2により回転角指令信号θM*に追従させる
ように制御されるものであることから、このことは、最
終的に電動機12の回転角θM を回転角指令信号θM*に
追従させるように制御することと同じである。
詳細な構成を示すブロック図である。同図において、2
8は、電動機の模擬回路4から出力された模擬速度信号
ωA と、第2の位置制御回路10から出力された第2の
速度指令信号ω2*との加算値(ωA +ω2*)と、回転検
出器15から出力された実回転角速度信号ωM との偏差
((ωA +ω2*)−ωM )を出力する加減算器、29
は、この偏差((ωA +ω2*)−ωM )を比例増幅する
積分ゲインK12の係数器、30は、この係数器29の出
力を積分し、第2の積分トルク信号T2iを出力する積分
器、27は、摩擦修正回路8より出力される積分項修正
値ISETを与えられるとこの積分器30の積分値をプリ
セットする積分項プリセット回路、31は、上記係数器
29と並列に設けられて、上記偏差((ωA +ω2*)−
ωM )を比例増幅するゲインKV2の係数器、32は、こ
の係数器31の出力と上記第2の積分トルク信号T2iを
合算し、第2のトルク信号T2*を出力する加算器であ
る。このように外乱トルクが加わった場合に変化する積
分項修正値ISET を用いて積分器30の積分値をプリセ
ットする構成とすることにより、第2の速度制御回路9
は、外乱トルクが加わった場合でも電動機12の速度ω
M を模擬速度信号ωA に追従させるよう((ωA +ω2
*)−ωM )を比例増幅した第2のトルク信号T2*を出
力するが、前述のごとくこの模擬速度信号ωA は、第1
の速度制御回路3により第1の速度指令信号ω1*に追従
するように制御されるものであることから、最終的に電
動機12の速度ωM を第1の速度指令信号ω1*に追従さ
せるようにすることと同じである。
な構成を示すブロック図である。同図において、42
は、回転検出器15から出力された実回転角速度信号ω
M を比例増幅する摩擦モデルの傾きゲインKf の係数
器、43は、この係数器42の出力値を所定の値でリミ
ットし、補償トルクを出力するリミッタ回路、44は、
摩擦修正回路8より出力される摩擦モデル修正値Tfset
を与えられるとリミッタ回路43のリミット値を修正、
すなわちクーロン摩擦補償リミット値をプリセットする
リミット値プリセット回路である。
び負荷機械にクーロン摩擦が発生する場合におけるその
前後の補償トルクTf の変化を示す図である。前述のよ
うに電動機の模擬回路4のイナーシャJA と、電動機1
2とトルク伝達機構13及び負荷機械14を合算した実
際のイナーシャとが一致している場合に、偏差((ωA
+ω2*)−ωM )の振幅が生じる原因として、電動機1
2とトルク伝達機構13及び負荷機械14間のクーロン
摩擦がある。このクーロン摩擦は公知のように、電動機
が運転中のみに発生し、電動機が停止とともにクーロン
摩擦がなくなる。そして、このクーロン摩擦のトルク成
分は、この図8におけるa点、すなわち電動機12が加
速を初め、C点、すなわち電動機12が減速に入る時点
に至るまでの間にも、第2の速度制御回路47の積分器
にたまり第2のトルク信号T2*として出力されることか
ら、本実施の形態では、このクーロン摩擦のトルク成分
をこの第2のトルク信号T2*を加算器36を介しトルク
指令信号TM*として検出し、後述する摩擦修正回路8に
よりC点、すなわち電動機12が減速に入る時点におい
て、第2の速度制御回路9の積分器30を積分項プリセ
ット回路27によってプリセットして積分器30の積分
項を変え、第2のトルク信号T2*をゼロにするととも
に、摩擦モデル回路7のリミッタ回路43のクーロン摩
擦補償リミット値をリミット値プリセット回路44によ
ってプリセットしてクーロン摩擦補償リミット値の上限
を高め、補償トルクTf を立ち上げる。このようにする
ことにより、以後はクーロン摩擦のトルク成分を補償す
る形で電動機へのトルク供給が行われるため、クーロン
摩擦のトルク成分が第2の速度制御回路9の積分器には
たまらなくなり、その結果、実回転角信号θM のオーバ
シュートを減少させることができる。なお、このような
動作は、電動機が減速する時点で毎回行われ、後述する
摩擦修正回路8により摩擦モデル回路7のリミット値や
第2の速度制御回路9の積分項を修正するため、電動機
とトルク伝達機構及び負荷機械のクーロン摩擦が変化す
る場合でも、摩擦モデル回路7はクーロン摩擦成分を補
償することができ、実回転角信号θM のオーバシュート
を減少させることができる。
構成を示すブロック図である。同図において、106
は、電動機の模擬回路4より出力される模擬速度信号ω
A と第1の速度制御回路3より出力される第1のトルク
信号T1*とにより状態フラグ1〜3を出力する判定回
路、107は、状態フラグ1の立ち上がりエッジにて加
算器36より出力されるトルク指令信号TM*をサンプル
・ホールドし、第1のサンプル・トルク信号TS1を出力
する第1のサンプル・ホールド回路、108は、状態フ
ラグ2の立ち下がりエッジにて加算器36より出力され
るトルク指令信号TM*をサンプル・ホールドし、第2の
サンプル・トルク信号TS2を出力する第2のサンプル・
ホールド回路、109は、状態フラグ3の立ち下がりエ
ッジにて加算器36より出力されるトルク指令信号TM*
をサンプル・ホールドし、第3のサンプル・トルク信号
TS3を出力する第3のサンプル・ホールド回路、110
は、上記第2のサンプル・トルク信号TS2とこの第3の
サンプル・トルク信号TS3との加算値(TS2+TS3)を
出力する加算器、111は、この加算値(TS2+TS3)
を(1/2)倍し((TS2+TS3)/2)を出力する係
数器、112は、この係数器111の出力((TS2+T
S3)/2)と第1のサンプル・トルク信号TS1との偏差
(((TS2+TS3)/2)−TS1)を出力する減算器、
113は、状態フラグ1の立ち下がりエッジにてこの偏
差(((TS2+TS3)/2)−TS1)をサンプル・ホー
ルドし、摩擦モデル修正値Tfsetを出力する第4のサン
プル・ホールド回路、114は、上記トルク指令信号T
M*とこの摩擦モデル修正値Tfsetとの偏差(TM*−Tfs
et)を出力する減算器、115は、状態フラグ1の立ち
下がりエッジにてこの偏差(TM*−Tfset)をサンプル
・ホールドし、積分項修正値Iset を出力する第5のサ
ンプル・ホールド回路である。ここで判定回路106
は、表1に状態フラグ1〜3の出力と物理的意味の関係
を示すように、模擬速度信号ωA の絶対値|ωA |が正
数であれば、状態フラグ1を1、絶対値|ωA |が0で
あれば、状態フラグ1を0とし、模擬速度信号ωA と模
擬速度信号ωA の2回微分値ωA ”との積値(ωA ×ω
A ”)が正数でかつ第1のトルク信号T1*と模擬速度信
号ωA の2回微分値ωA”との積値(T1*×ωA ”)が
正数であれば、状態フラグ2を1、積値(ωA ×ωA
”)が0以下もしくは積値(T1*×ωA ”)が0以下
であれば、状態フラグ2を0とし、積値(ωA ×ωA
”)が正数でかつ積値(T1*×ωA ”)が負数であれ
ば、状態フラグ3を1、積値(ωA ×ωA ”)が0以下
もしくは積値(T1*×ωA ”)が0以上であれば、状態
フラグ3を0となるように制御する。このように構成し
た摩擦修正回路8は、電動機12が加減速を行う際の加
速直後のトルク指令を示す第2のサンプルトルク信号T
S2と停止直前のトルク指令を示す第3のサンプルトルク
信号TS3との平均値と、始動直前のトルク指令を示す第
1のサンプルトルク信号TS1との偏差を採ることにより
クーロン摩擦分のトルク成分を抽出し、これに基づい
て、摩擦モデル修正値Tfsetを出力し摩擦モデル回路7
中のパラメータを修正するとともに、積分項修正値Ise
t を出力し第2の速度制御回路9中の状態量を修正す
る。
の状態量を修正できる理由について、図10を参照しな
がら更に詳細に説明する。図10は、電動機12が三角
波パターンの加減速を行う際の模擬速度信号ωAとトル
ク指令信号TM*、及び前記状態フラグ1から3の概略
波形である。同図において、TL は垂直トルク、TF は
クーロン摩擦トルク(摩擦修正回路8にあっては、摩擦
モデル修正値Tfset)、TACC は加速トルク、TD は粘
性摩擦トルク、TDEC は減速トルク、T1 は始動直前の
トルク指令信号(摩擦修正回路8にあっては、第1のサ
ンプルトルク信号TS1)、T2 は加速直後のトルク指令
信号(摩擦修正回路8にあっては、第2のサンプルトル
ク信号TS2)、T3 は停止直前のトルク指令信号(摩擦
修正回路8にあっては、第3のサンプルトルク信号TS
3)である。ここで、摩擦モデル回路7中のパラメータ
及び第2の速度制御回路9中の状態量を修正するには、
クーロン摩擦トルクTF を求めることが必要である。加
速直後のトルク指令信号T2 及び停止直前のトルク指令
信号T3 はそれぞれ式(1)、式(2)のように表すこ
とができる。
れる。
一のとき、クーロン摩擦トルクTFは式(4)のように
表すことができる。
ク指令信号T1 と同一であるため、式(4)は式(5)
のように表すことができる。
は、加速直後のトルク指令信号T2と停止直前のトルク
指令信号T3 の平均値と、始動直前のトルク指令信号T
1 との偏差に基づいて求められることが分かる。このよ
うにして、摩擦修正回路8は、摩擦モデル回路中のパラ
メータを修正するとともに、第2の速度制御回路中の状
態量を修正することができる。
詳細な構成を示すブロック図である。同図において、2
4は、加算器36より出力されるトルク指令信号TM*に
トルク定数Kt の逆数を乗じて電流指令IM*に変換する
係数器、33は、電動機12の電流IM を検出する電流
検出器、34は、この電流検出器33により検出された
電動機12の電流IMに基づき、電動機12の電流IM が
電流指令IM*に追従するように電動機1に電圧Vを印可
する電流制御回路である。同図のように電動機12の電
流IM を電流指令IM*に対しフィードバックする構成と
することによって、トルク制御回路11は電動機12の
出力トルクがトルク指令信号TM*に追従するように制御
できる。電流制御回路34の詳細な構成については、例
えば、「ACサーボシステムの理論と設計の実際」、総
合電子出版社、1990年、P80〜P85、P153
〜P155参照のこと。
明の実施の形態2の全体を示すブロック図である。この
実施の形態2では、摩擦モデル回路45の入力が電動機
の模擬回路4から出力される模擬回転角速度信号ωA で
ある点、先の実施の形態1のものと異なるが、摩擦モデ
ル回路45以外の構成及び動作は、上述した実施の形態
1と同一なので説明を省略する。
詳細な構成を示すブロック図である。同図において、4
2は、電動機の模擬回路4から出力される模擬回転角速
度信号ωA を比例増幅する摩擦モデルの傾きゲインKf
の係数器、43は、この係数器42の出力値を所定の値
でリミットし補償トルクTf を出力するリミッタ回路、
44は、摩擦修正回路8より出力される摩擦モデル修正
値Tfsetが与えられるとリミッタ回路43のリミット値
を修正するリミット値修正回路である。このように摩擦
モデル修正値Tfsetが与えられるとリミッタ回路43の
リミット値を修正する構成とすることにより、摩擦モデ
ル回路45はクーロン摩擦成分を補償するための補償ト
ルクTf を出力し実回転角信号θM のオーバシュートを
減少させることができる。
角速度信号ωM から模擬回転角速度信号ωA に変えた理
由について説明する。デジタルサーボなどで用いられ
る、実回転角速度信号ωM を検出する回転検出器15
は、インクリメンタルエンコーダやアブソリュートエン
コーダなどで、このようなパルスエンコーダにより速度
検出を行う場合、一定速度で電動機12が回転していた
としてもエンコーダのパルスの発生のタイミングとその
パルスの読み込みとが同期していないので、速度制御周
期毎に読み込むパルス数にばらつきが生じる。また、エ
ンコーダの分解能(1回転あたりのパルス数)に係わる
量子化ノイズが発生する。そのため読み込んだパルス数
のばらつきが検出ノイズとして実回転角速度信号ωM に
含まれてしまう。その結果、摩擦モデル回路45から出
力される補償トルクに大きなリプル成分が含まれてしま
う。また、上述したように電動機の模擬回路4は、電動
機12とトルク伝達機構13と負荷機械14の3つのイ
ナーシャを合算した値をモデル化し、単なるイナーシャ
JA で示したものであるため、模擬回転角速度信号ωA
にはノイズ成分は含まれない。そのため模擬回転角速度
信号ωA を入力とした摩擦モデル回路45から出力され
る補償トルクにリプル成分が含まれず機械振動を誘発し
にくい滑らかな信号が得られる。
明の実施の形態3の全体を示すブロック図である。この
実施の形態3では、第1の速度制御回路3と摩擦修正回
路53との間の信号経路にローパスフィルタ回路5を介
在させた点、実施の形態1のものと異なり、これに伴い
摩擦修正回路53の構成も異なっているが、ローパスフ
ィルタ回路5以外の動作は、上述した実施の形態1と同
一なので説明を省略する。
御回路3から出力される第1のトルク信号T1*のうち、
所望の周波数以下の信号を通してフィルタ出力信号Tf1
を出力する。回転角指令信号発生回路1は、シーケンサ
などのパルス列出力装置で、このようなシーケンサによ
り回転角指令を入力する場合、パルス列入力が一定で電
動機12が一定速度で回転していたとしてもシーケンサ
のパルス列出力のタイミングとそのパルス列の読み込み
とが同期していないので、位置制御周期毎に読み込むパ
ルス数にばらつきが生じる。また、シーケンサの分解能
に係わる量子化ノイズが発生する。そのため、読み込ん
だパルス数のばらつきが回転角指令信号発生回路1から
出力される回転角指令信号θM*に作用し、さらに上述し
た第1の位置制御回路2から出力される第1の速度指令
信号ω1*にリプル成分として増幅され、さらに、上述し
た第1の速度制御回路3の第1のトルク信号T1*にリプ
ル成分として増幅される。
示すが、その構成は図9に示した実施の形態1の摩擦修
正回路8と概同一である。ここで図9に示した摩擦修正
回路8の入力の第1のトルク信号T1*にリプル成分があ
る場合、実施の形態1にて述べたように、摩擦修正回路
8中の判定回路106は電動機の模擬回路4より出力さ
れる模擬速度信号ωA と第1の速度制御回路3より出力
される第1のトルク信号T1*により状態フラグ1〜3を
出力するため、状態フラグ1〜3にリプル成分の影響が
でることから、第1〜第5のサンプル・ホールド回路が
誤動作してしまいクーロン摩擦の推定を誤る場合があ
る。しかし、本実施の形態3の図14のごとくローパス
フィルタ5をいれ、所望の周波数以下の信号のみを通し
てフィルタ出力信号Tf1としてこれを摩擦修正回路53
の入力とすることにより、リプル成分を抑制することが
でき、摩擦の推定を誤ることを未然に防ぐことができ
る。
ス列の読み込みの周波数の2分の1の周波数で発生しや
すいので、ローパスフィルタ回路5のカットオフ周波数
はパルス列の読み込みの周波数より低い周波数に設定す
る。
明の実施の形態4の全体を示すブロック図である。この
実施の形態4においては、実施の形態2の構成に実施の
形態3と同様のローパスフィルタ回路5を付加した点、
他の実施の形態と異なるが、ローパスフィルタ回路5以
外の動作については先に述べた実施の形態2と、ローパ
スフィルタ回路5については実施の形態3と同一なので
説明を省略する。
明の実施の形態5の全体を示すブロック図である。この
実施の形態5においては、第1の速度制御回路46と電
動機の模擬回路35及び修正回路6の構成及び動作が他
の実施の形態のものと異なるが、それ以外の構成は、上
述した実施の形態1と同一なので説明を省略する。
な構成を示すブロック図である。同図において、19
は、第1の位置制御回路2から出力される速度指令信号
ω1*と電動機の模擬回路35から出力される模擬速度信
号ωA との偏差(ω1*−ωA )を出力する減算器、20
は、この減算器19から出力される偏差(ω1*−ωA )
を比例増幅して第1のトルク信号T1*を出力するゲイン
KV1の係数器である。なお、係数器20は後述する修正
回路6からイナーシャJA が与えられるとゲインKV1が
更新される。このように模擬速度信号ωA を第1の速度
指令信号ω1*に対してフィードバックする構成とするこ
とにより、第1の速度制御回路46は模擬速度信号ωA
が第1の速度指令信号ω1*に追従するように制御でき
る。ここで、イナーシャJA とゲインKV1との関係を式
(1)に示す。
の詳細な構成を示すブロック図である。電動機の模擬回
路35は、電動機12とトルク伝達機構13と負荷機械
14の3つのイナーシャを合算した値をモデル化し、単
なるイナーシャJA で示したものである。同図におい
て、22は、第1の速度制御回路46から出力される第
1のトルク信号T1*を入力とし、イナーシャJA の逆数
(1/JA )を乗じて積分し模擬速度信号ωA を出力す
る積分器、21は、電動機の模擬回路35から出力され
る模擬速度信号ωA を積分して模擬回転角信号θA を出
力する積分器である。なお、積分器22は、後述する修
正回路6からイナーシャJA が与えられるとイナーシャ
JA が更新される。
を示すブロック図である。同図において、37は、模擬
速度信号ωA と第2の速度指令信号ω2*との加算値(ω
A +ω2*)と、実回転角速度信号ωM との偏差((ωA
+ω2*)−ωM )を出力する加減算器、39は、第1の
トルク信号T1*に基づいて極性信号Sgを出力する極性
判別回路、38は、この極性判別回路39から出力され
た極性信号Sgと、上記加減算器37からの偏差((ω
A +ω2*)−ωM )とを乗算する乗算器、40は、この
乗算器38の出力を積分する積分器、41は、この積分
器40の出力とイナーシャ初期値J0 を加算しイナーシ
ャJA を出力する加算器である。次に、動作について説
明する。加減算器37により模擬速度信号ωA と第2の
速度指令信号ω2*との加算値(ωA +ω2*)と、実回転
角速度信号ωM との偏差((ωA +ω2*)−ωM )が求
められる。第1のトルク信号T1*を極性判別回路39に
入力すると、第1のトルク信号T1*の極性信号Sgが求
められる。ここで、極性信号Sgは、第1の速度指令信
号ω1*が正転加速指令の場合、すなわち第1のトルク信
号T1*の極性が正であれば1、第1の速度指令信号ω1*
が逆転加速指令の場合、すなわち第1のトルク信号T1*
の極性が負であれば−1となる2値信号である。つづい
て、加減算器37から出力された偏差((ωA +ω2*)
−ωM )と、極性判別回路39から出力された第1のト
ルク信号T1*の極性信号Sgとの積が乗算器38によっ
て求められ、積分器40に供給される。すると、この積
分器40によってイナーシャJの修正値ΔJが求められ
る。つづいて、イナーシャ初期値J0 とこの修正値ΔJ
とを加算器41によって加算することにより、イナーシ
ャJA が求められる。ここでイナーシャ初期値J0 とし
て、例えば電動機12のイナーシャ値を用いればよい。
明の実施の形態6の全体を示すブロック図である。この
実施の形態6では、実施の形態2の構成に実施の形態5
と同様の、第1の速度制御回路46と電動機の模擬回路
35及び修正回路6を適用した点、他の実施の形態と異
なるものの、第1の速度制御回路46と電動機の模擬回
路35及び修正回路6以外の動作については実施の形態
2と同様、第1の速度制御回路46と電動機の模擬回路
35及び修正回路6については実施の形態5と同様であ
るので説明を省略する。
明の実施の形態7の全体を示すブロック図である。この
実施の形態7では、ローパスフィルタ回路5を設け、修
正回路54の入力をローパスフィルタ回路5のフィルタ
出力信号Tf1としている点、実施の形態5の図17のも
のと異なるものの、ローパスフィルタ5及び修正回路5
4以外の動作については実施の形態5と、ローパスフィ
ルタ5の動作については実施の形態4と同一であるので
説明を省略する。
構成を示すブロック図である。同図において、37は、
模擬速度信号ωA と第2の速度指令信号ω2*との加算値
(ωA +ω2*)と、実回転角速度信号ωM との偏差
((ωA +ω2*)−ωM )を出力する加減算器、39
は、フィルタ出力信号Tf1に基づいて極性信号Sgを出
力する極性判別回路、38は、この極性判別回路39か
らの極性信号Sgと、加減算器37からの偏差((ωA
+ω2*)−ωM )とを乗算する乗算器、40は、乗算器
38の出力を積分する積分器、41は、積分器40の出
力とイナーシャ初期値J0 を加算しイナーシャJA を出
力する加算器である。次に、動作について説明する。加
減算器37により模擬速度信号ωA と第2の速度指令信
号ω2*との加算値(ωA +ω2*)と、実回転角速度信号
ωM との偏差((ωA +ω2*)−ωM )が求められる。
フィルタ出力信号Tf1を極性判別回路39に入力する
と、フィルタ出力信号Tf1の極性信号Sgが求められ
る。ここで極性信号Sgは、第1の速度指令信号ω1*が
正転加速指令の場合、すなわちフィルタ出力信号Tf1の
極性が正であれば1、第1の速度指令信号ω1*が逆転加
速指令の場合、すなわちフィルタ出力信号Tf1の極性が
負であれば−1となる2値信号である。続いて、加減算
器37から出力された偏差((ωA +ω2*)−ωM )
と、極性判別回路39から出力されたフィルタ出力信号
Tf1の極性信号Sgとの積が乗算器38によって求めら
れ、積分器40に供給される。すると、この積分器40
によってイナーシャJの修正値ΔJが求められる。更
に、イナーシャ初期値J0 とこの修正値ΔJとを加算器
41によって加算することにより、イナーシャJA が求
められる。ここでイナーシャ初期値J0 として、例えば
電動機12のイナーシャ値を用いればよい。
明の実施の形態8の全体を示すブロック図である。この
実施の形態8では、実施の形態6の構成に実施の形態7
と同様の、ローパスフィルタ回路5を設け、修正回路5
4の入力をローパスフィルタ回路5のフィルタ出力信号
Tf1としている点、実施の形態6の図21のものと異な
るものの、ローパスフィルタ5及び修正回路54以外の
動作については実施の形態6と、ローパスフィルタ5の
動作については実施の形態4と同一であるので説明を省
略する。
明の実施の形態9の全体を示すブロック図である。この
実施の形態では、摩擦修正回路126の構成が実施の形
態1と相違するものの、それ以外については上述した実
施の形態1と同一なので説明を省略する。
詳細な構成を示すブロック図である。同図において、1
00は、電動機の模擬回路4より出力される模擬速度信
号ωA と第1の速度制御回路3より出力される第1のト
ルク信号T1*により状態フラグを出力する判定回路、1
01は、この状態フラグの立ち上がりエッジにて加算器
36より出力されるトルク指令信号TM*をサンプル・ホ
ールドし、サンプル・トルク信号TS を出力する第1の
サンプル・ホールド回路、102は、トルク指令信号T
M*とこの第1のサンプル・ホールド回路101から出力
されるサンプル・トルク信号TS との偏差(TM*−TS
)を出力する減算器、103は、状態フラグの立ち下
がりエッジにて偏差(TM*−TS )をサンプル・ホール
ドし、摩擦モデル修正値Tfsetを出力する第2のサンプ
ル・ホールド回路、104は、トルク指令信号TM*と第
2のサンプル・ホールド回路から出力される摩擦モデル
修正値Tfsetとの偏差(TM*−Tfset)を出力する減算
器、105は、状態フラグの立ち下がりエッジにて偏差
(TM*−Tfset)をサンプル・ホールドし、積分項修正
値Iset を出力する第3のサンプル・ホールド回路であ
る。ここで判定回路100は、模擬速度信号ωA と第1
のトルク信号T1*との積値(ωA ×T1*)が正数であれ
ば状態フラグを1、積値(ωA ×T1*)が負数、もしく
は模擬速度信号ωA が0であれば状態フラグを0とし、
第1のトルク信号T1*が0でかつ模擬速度信号ωA の絶
対値|ωA |が正数であれば、状態フラグは過去の状態
を保持するように制御する。表2に状態フラグの出力と
物理的意味の関係を示す。このように構成することによ
り、摩擦修正回路126は、電動機12が加減速を行う
際の始動直前のサンプル・トルク信号TS と減速開始直
前のトルク指令信号TM*との偏差に基づいて、摩擦モデ
ル修正値Tfsetを出力し摩擦モデル回路7中のパラメー
タを修正するとともに、積分項修正値Iset を出力し第
2の速度制御回路9中の状態量を修正できる。また、上
述した実施の形態1の摩擦修正回路8では、電動機12
が加減速を行う際の減速終了の時点で摩擦モデル回路7
中のパラメータを修正するとともに、第2の速度制御回
路9中の状態量を修正するので、電源投入後2度目以降
の電動機12加減速の際の停止整定時間を減少させるこ
とができるが、摩擦修正回路126では電動機12が加
減速を行う際の減速開始の時点で摩擦モデル回路7中の
パラメータを修正するとともに、第2の速度制御回路9
中の状態量を修正するため、電源投入後1度目の電動機
12加減速の際の停止整定時間についても減少させるこ
とができる。
が加減速を行う際の始動直前のサンプル・トルク信号T
S と減速開始直前のトルク指令信号TM*との偏差に基づ
いて、摩擦モデル回路7中のパラメータを修正するとと
もに、第2の速度制御回路9中の状態量を修正できる理
由について図27を参照しながら説明する。図27は電
動機12が台形波パターンの加減速を行う際の模擬速度
信号ωA とトルク指令信号TM*及び前記状態フラグの概
略波形である。同図において、TL は垂直トルク、TF
はクーロン摩擦トルク、T1 は始動直前のトルク指令信
号、T2 は減速開始直前のトルク指令信号である。ここ
で、摩擦モデル回路7中のパラメータ及び第2の速度制
御回路9中の状態量を修正するには、クーロン摩擦トル
クTF を求めることが必要である。減速開始直前のトル
ク指令信号T2 は式(7)のように表すことができる。
すことができる。
ク指令信号T1 と同一であるため、式(8)は式(9)
のように表すことができる。
は始動直前のトルク指令信号T1 と減速開始直前のトル
ク指令信号T2 との偏差に基づいて求めることができる
ため、摩擦モデル回路中のパラメータを修正するととも
に、第2の速度制御回路中の状態量を修正することがで
きる。
発明の実施の形態10の全体を示すこの実施の形態10
では、摩擦修正回路127の構成が実施の形態1と相違
するものの、それ以外については上述した実施の形態1
と同一なので説明を省略する。
詳細な構成を示すブロック図である。同図において、1
16は、電動機12の模擬回路4より出力される模擬速
度信号ωA と第1の速度制御回路3より出力される第1
のトルク信号T1*により状態フラグ1〜3を出力する判
定回路、117は、状態フラグ1の立ち上がりエッジに
て加算器36より出力されるトルク指令信号TM*をサン
プル・ホールドし、第1のサンプル・トルク信号TS1を
出力する第1のサンプル・ホールド回路、118は、ト
ルク指令信号TM*とこの第1のサンプル・ホールド回路
から出力される第1のサンプル・トルク信号TS1との偏
差(TM*−TS1)を出力する減算器、119は、状態フ
ラグ2の立ち下がりエッジにて減算器118からの偏差
(TM*−TS1)をサンプル・ホールドし、第2のサンプ
ル・トルク信号TS2を出力する第2のサンプル・ホール
ド回路、120は、この第2のサンプル・ホールド回路
から出力される第2のサンプル・トルク信号TS2とトル
ク指令信号TM*との偏差(TS2−TM*)を出力する減算
器、121は、状態フラグ3の立ち上がりエッジにてこ
の減算器120からの偏差(TS2−TM*)をサンプル・
ホールドし、第3のサンプル・トルク信号TS3を出力す
る第3のサンプル・ホールド回路、122は、トルク指
令信号TM*とこの第3のサンプル・ホールド回路121
から出力された第3のサンプル・トルク信号TS3との加
算値(TM*+TS3)を出力する加算器、123は、状態
フラグ1の立ち下がりエッジにてこの加算器122によ
る加算値(TM*+TS3)をサンプル・ホールドし、摩擦
モデル修正値Tfsetを出力する第4のサンプル・ホール
ド回路、124は、トルク指令信号TM*とこの第4のサ
ンプル・ホールド回路123から出力された摩擦モデル
修正値Tfsetとの偏差(TM*−Tfset)を出力する減算
器、125は、状態フラグ1の立ち下がりエッジにてこ
の減算器124からの偏差(TM*−Tfset)をサンプル
・ホールドし、積分項修正値Iset を出力する第5のサ
ンプル・ホールド回路である。ここで判定回路116
は、模擬速度信号ωA と第1のトルク信号T1*との積値
(ωA ×T1*)が正数であれば状態フラグ1を1、積値
(ωA ×T1*)が負数、もしくは模擬速度信号ωA が0
であれば状態フラグ1を0とし、第1のトルク信号T1*
が0でかつ模擬速度信号ωA の絶対値|ωA |が正数で
あれば、状態フラグ1は過去の状態を保持するように制
御し、模擬速度信号ωA と模擬速度信号ωA の2回微分
値ωA ”との積値(ωA ×ωA ”)が正数でかつ第1の
トルク信号T1*と模擬速度信号ωA の2回微分値ωA ”
との積値(T1*×ωA ”)が正数であれば状態フラグ2
を1、積値(ωA ×ωA ”)が0以下もしくは積値(T
1*×ωA ”)が0以下であれば状態フラグ2を0とし、
積値(ωA ×ωA ”)が負数でかつ積値(T1*×ωA
”)が負数であれば状態フラグ3を1、積値(ωA ×
ωA ”)が0以上もしくは積値(T1*×ωA ”)が0以
上であれば状態フラグ3を0となるように制御する。表
3に状態フラグ1〜3の出力と物理的意味の関係を示
す。このように構成することにより、摩擦修正回路12
7は、電動機12が加減速を行う際の加速直前のトルク
指令信号と加速直後のトルク指令信号と加速終了直前の
トルク指令信号と一定速運転中のトルク指令信号とに基
づいて、摩擦モデル修正値Tfsetを出力し摩擦モデル回
路7中のパラメータを修正するとともに、積分項修正値
Iset を出力し第2の速度制御回路9中の状態量を修正
できる。また、上述した実施の形態1の摩擦修正回路8
では、電動機12が加減速を行う際の減速終了の時点で
摩擦モデル回路7中のパラメータを修正するとともに、
第2の速度制御回路9中の状態量を修正するので、電源
投入後2度目以降の電動機12加減速の際の停止整定時
間時を減少させることができるが、摩擦修正回路127
では電動機12が加減速を行う際の減速開始の時点で摩
擦モデル回路7中のパラメータを修正するとともに、第
2の速度制御回路9中の状態量を修正するため、電源投
入後1度目の電動機12加減速の際の停止整定時間につ
いても減少させることができる。
が加減速を行う際の加速直前のトルク指令信号と加速直
後のトルク指令信号と加速終了直前のトルク指令信号と
一定速運転中のトルク指令信号とに基づいて、摩擦モデ
ル回路7中のパラメータを修正するとともに、第2の速
度制御回路9中の状態量を修正できる理由について図3
0を参照しながら説明する。図30は、電動機12が台
形波パターンの加減速を行う際の模擬速度信号ωAとト
ルク指令信号TM*及び前記状態フラグ1〜3の概略波
形である。同図において、TL は垂直トルク、TF はク
ーロン摩擦トルク、TACC は加速トルク、TD は粘性摩
擦トルク、TDEC は減速トルク、T1 は始動直前のトル
ク指令信号、T2は加速直後のトルク指令信号、T3 は
加速終了直前のトルク指令信号、T4 は一定速運転中の
トルク指令信号である。ここで、摩擦モデル回路7中の
パラメータ及び第2の速度制御回路9中の状態量を修正
するには、クーロン摩擦トルクTF を求めることが必要
である。そこで、このクーロン摩擦トルクTF と加速終
了直前のトルク指令信号T3 との関係式からこれを求め
ることにする。加速終了直前のトルク指令信号T3 は式
(10)のように表すことができる。
式(11)のように表すことができる。
クTD 、垂直トルクTL はそれぞれ式(12)、式(1
3)、式(14)のように表すことができる。
り、式(11)は式(15)のように表すことができ
る。
F は始動直前のトルク指令信号T1と加速直後のトルク
指令信号T2 と加速終了直前のトルク指令信号T3 と一
定速運転中のトルク指令信号T4 とに基づいて求めるこ
とができるため、摩擦モデル回路7中のパラメータを修
正するとともに、第2の速度制御回路9中の状態量を修
正することができる。
発明の実施の形態11の全体を示すブロック図である。
この実施の形態11では摩擦修正回路8の代わりに摩擦
記憶回路150を設けている点、実施の形態1と相違す
るものの、それ以外の構成及び動作は上述した実施の形
態1と同一なので説明を省略する。
M*に応じた摩擦量データを記憶しており、回転角指令信
号θM*に応じてその摩擦量データTfsetを出力する。摩
擦モデル回路7はこの摩擦量データTfsetと回転検出器
15から出力される実速度信号ωMとによって補償トル
ク信号Tf を出力する。加算器36は第1のトルク信号
T1*と第2のトルク信号T2*と前記補償トルク信号Tf
とを加算し、トルク指令信号TM*を出力する。トルク制
御回路11は前記トルク指令信号TM*に基づき、電動機
12のトルクを制御する。
作説明図である。摩擦記憶回路150は本図のように回
転角指令信号θM*に応じた機械系の摩擦量データTfset
を記憶しており、電動機の回転角指令θM*の入力に対し
て随時Tfsetを出力する。以上のように構成されている
ため、一旦摩擦記憶回路150に機械系の摩擦量データ
を記憶させておくだけで、摩擦トルクの補償を回転位置
に応じて行うことができ、摩擦修正回路8無しに回転角
に応じた摩擦トルクの補償を行うことができる。
ータは、摩擦修正回路8を仮に設置し、この出力Tfset
を用いることにより得ることができる。例えば、別途設
けた電動機12の位置制御装置により機械を駆動し、適
当なピッチで位置決めを行ってゆく。このとき、各位置
決めされた位置におけるTfsetが摩擦記憶回路150に
記憶する摩擦量データとして得られる。このデータを摩
擦記憶回路150に記憶させておけば、摩擦推定などの
複雑な計算なしにリアルタイムで摩擦トルクを補償する
ことができる。
実施の形態12の全体を示すブロック図である。この実
施の形態12では、実施の形態11の構成に摩擦修正回
路8を加え、これに伴い、摩擦記憶回路151を変更し
た点、実施の形態11のものと構成及び動作を異にする
ものの、それ以外については実施の形態11と同一なの
で説明を省略する。
おける摩擦記憶回路150と同様に回転角指令θM*に応
じた摩擦データTfsetを出力するが、さらに摩擦修正回
路8からの摩擦推定値によって記憶されたデータを随時
修正する機能を持っている。
151の動作を説明する。図34は電源投入直後の初期
状態における摩擦記憶回路151内の記憶データを示す
図である。電源投入直後には摩擦量データTfsetには一
定の適切な値Tfset0 を書き込んでおき、運転を開始し
てからこの記憶データを随時修正してゆく。
である。本図は回転角指令θM*がθA 、θB 、θC と変
化した時の例であり、同図(a)は時間に対する回転角
指令θM*の変化を、同図(b)は摩擦記憶回路151内
の摩擦量データを示す図である。この摩擦修正回路15
1によれば、回転角指令θM*に変化を生じた後停止する
と、摩擦修正回路8が機械系の摩擦量の推定値を出力す
る。回転角指令θM*が図36(a)のようにθA からθ
B に変化したときに出力される摩擦量の推定値をTfset
a 、θB からθC に変化したときに出力される摩擦量の
推定値をTfset bとすると、同図(b)のようにθA −
θB 間の摩擦量データをTfset aに、θB −θC 間の摩
擦量データをTfset bに修正する。
に記憶された摩擦量データを随時修正することにより、
回転位置によって摩擦量が異なる場合においても摩擦ト
ルクを補償することができ、また摩擦量が不明あるいは
変動するような機械においても摩擦トルクを補償するこ
とが可能である。
リ等によって構成する事により電源断直前のデータを保
持することができ、次回の電源投入時は最初の起動時か
らそのデータを利用して摩擦トルクの補償が可能となる
事は言うまでもない。
る。図36は、この発明の実施の形態13の全体を示す
ブロック図である。図において、1は、回転角指令信号
θM*を出力する回転角指令信号発生回路、2aは、この
回転角指令信号θM*を一方の入力とし、回転検出器15
から出力された実回転角信号θMを他方の入力として、
これに基づき速度指令信号ωM*を出力する位置制御回
路、3aは、この速度指令信号ωM*を一方の入力とし、
実速度信号ωMおよび積分器初期値Tisetを他方の入力
として、後述する基準値θdrp*に基づく第1のトルク信
号T1*と積分器出力Tiを出力する速度制御回路、60
は、回転角指令信号θM*と回転検出器15から出力され
た実回転角信号θMと実速度信号ωMと速度制御回路3a
から出力された積分器出力Tiとに基づいて補償トルク
信号として第2のトルク信号T2*を出力し、更に積分器
初期値Tisetを出力する補償トルク制御回路、61は、
第1のトルク信号T1*と第2のトルク信号T2*とを加算
し、トルク指令信号TM*を出力する加算器、11aは、
このトルク指令信号TM*に基づいて電動機12のトルク
を制御するトルク制御回路、14は、トルク伝達機構1
3を介して、このトルク制御回路11aにより動作され
る負荷機械、15は、上記電動機12の回転を検出し、
上記速度制御回路3aに実速度信号ωMを、上記位置制
御回路2aに実回転角信号θMを出力する回転検出器で
ある。なお、これら1、2a、12、14、15は、図
50に示す従来装置のものと同一である。
な構成を示すブロック図である。同図において、200
は、回転角指令信号発生回路1から出力される回転角指
令信号θM*と、実回転角信号θMとの偏差(θM*−θM)
を出力する減算器、201は、偏差(θM*−θM)を比
例増幅して速度指令信号ωM*を出力するゲインKpの係
数器である。このように構成することにより、位置制御
回路2aは実回転角信号θMが回転角指令信号θM*に追
従するように制御できる。
な構成を示すブロック図である。同図において、202
は、速度指令信号ωM*と実速度信号ωMとの偏差(ωM*
−ωM)を出力する減算器、203は、偏差(ωM*−ω
M)を比例増幅するゲインKvの係数器、204は、偏差
(ωM*−ωM)を積分ゲインKiで比例増幅した後に積分
し積分トルク信号Tiを出力する積分器、205は、補
償トルク制御回路60より出力される積分項初期値Tis
etを与えられると積分器204の積分値をプリセットす
る積分器プリセット回路、206は、係数器203と積
分器204の出力を加算し第1のトルク信号T1*を出力
する加算器である。このように構成することにより、速
度制御回路3aは実回転速度ωMが速度指令信号ωM*に
追従するように制御される。
の詳細な構成を示すブロック図である。同図において、
207は、実回転角信号θMと回転角指令信号θM*と基
準値θdrp*によりリセット信号RESを出力するリセッ
ト回路、208は、回転検出器15より出力される実速
度信号ωMとリセット信号RESにより第1、第2、第
3、第4のサンプルホールド指令信号SH1、SH2、
SH3、SH4を出力する判定回路、209は、サンプ
ルホールド指令信号SH1の立ち上がりエッジにて積分
トルク信号Tiをサンプルホールドし第1のサンプルト
ルク信号TS1を出力する第1のサンプルホールド回路、
210は、第2のサンプルホールド指令信号SH2の立
ち上がりエッジにて積分トルク信号Tiをサンプルホー
ルドし第2のサンプルトルク信号TS2を出力する第2の
サンプルホールド回路、211は、第2のサンプルトル
ク信号TS2と第1のサンプルトルク信号TS1との偏差
(TS2−TS1)を出力する減算器、212は、第3のサ
ンプルホールド指令信号SH3が1の時に第1のサンプ
ルトルク信号TS1をサンプルホールドして積分トルク初
期値Tisetを出力し、また第3のサンプルホールド指令
信号SH3が0のときに出力をリセットする第3のサン
プルホールド回路、213は、第4のサンプルホールド
指令信号SH4が1の時に減算器106の出力(TS2−
TS1)をサンプルホールドして補償トルク信号としての
第2のトルク信号T2*を出力し、また第4のサンプルホ
ールド指令信号SH4が0のときに出力をリセットする
第4のサンプルホールド回路である。ここでリセット回
路207は、実回転角信号θMと回転角指令信号θM*の
偏差の絶対値|θM*−θM|が基準値θdrp*以下であれ
ば、リセット信号RESを1、絶対値|θM*−θM|が
基準値θdrp*より大きければリセット信号RESを0と
なるように制御する。また、判定回路208は、実速度
信号ωMと実速度信号ωMの1回微分値ωM’の積(ωM×
ωM’)が正数であれば、第1のサンプルホールド指令
信号SH1を1、積(ωM×ωM’)が負数であれば第1
のサンプルホールド指令信号SH1を0、積(ωM×ω
M’)が0であれば第1のサンプルホールド指令信号S
H1は過去の状態を保持する。そして、第1のサンプル
ホールド指令信号SH1が0であれば第2のサンプルホ
ールド指令信号SH2を1、第1のサンプルホールド指
令信号SH1が1であれば第2のサンプルホールド指令
信号SH2を0とする。更に、第2のサンプルホールド
指令信号SH2が1でかつリセット信号が0であれば第
4のサンプルホールド指令信号SH4を1、第2のサン
プルホールド指令信号SH2が0もしくはリセット信号
が1であれば第2のサンプルホールド指令信号SH2を
0とし、第2のサンプルホールド指令信号SH2の値に
変化がなければ第2のサンプルホールド指令信号SH2
を0、第2のサンプルホールド指令信号SH2の値に0
から1あるいは1から0への変化があれば第4のサンプ
ルホールド指令信号SH4を1となるように制御する。
表1に第1、第2、第3、第4のサンプルホールド指令
信号SH1、SH2、SH3、SH4の出力と物理的意
味の関係を示す。このように構成することにより、補償
トルク制御回路60は、電動機12が加減速を行う際の
始動直前の速度制御回路3aの積分トルク信号Tiと減
速開始直前の速度制御回路3aの積分トルク信号Tiと
に基づいて、補償トルク信号としての第2のトルク信号
T2*を出力するとともに、積分器初期値Tisetを出力し
速度制御回路3a中の状態量を修正できる。
よび負荷機械14にクーロン摩擦がある場合において、
回転角指令信号θM*を変化させた時の補償トルク制御回
路60の出力である補償トルク信号としての第2のトル
ク信号T2*および積分トルク初期値Tisetと、速度制御
回路3aの出力である第1のトルク信号T1*と、トルク
指令信号TM*の変化を示す図である。電動機12が回転
中であるとき、その偏差(ωM*−ωM)の振幅の原因と
して、電動機12とトルク伝達機構および負荷機械14
のクーロン摩擦がある。クーロン摩擦分のトルク成分
は、A点すなわち電動機12が始動から、C点すなわち
電動機12が減速に入る時点までの間に、速度制御回路
3aの積分器204にたまり第1のトルク信号T1*より
出力される。また補償トルク制御回路60によりC点に
おいて、速度制御回路3aの状態量を修正、すなわち速
度制御回路3aの積分器204をプリセットすると同時
にトルク指令信号TM*が不連続にならないように補償ト
ルク制御回路60の出力を変更、すなわち補償トルク信
号としての第2のトルク信号T2*を出力する。クーロン
摩擦は上記のように、電動機12が運転中のみに発生
し、電動機12が停止するとともにクーロン摩擦がなく
なる。補償トルク制御回路60は電動機12の停止整定
の目安として位置偏差の基準値θdrp*を用い、位置偏差
の絶対値|θM*−θM|が基準値θdrp*以下となった時
点で速度制御回路3aの積分器204を再びプリセット
すると同時に補償トルク信号としての第2のトルク信号
T2*の出力を停止する。よって、クーロン摩擦のトルク
成分が速度制御回路3aの積分器204にたまらなくな
る。このように動作することにより、補償トルク制御回
路60はクーロン摩擦成分を補償するための補償トルク
信号としての第2のトルク信号T2*を出力し実回転角信
号θMのオーバシュートを減少させることができる。
の詳細な構成を示すブロック図である。同図において、
214は、トルク指令信号TM*にトルク定数Ktの逆数
を乗じて電流指令IM*に変換する係数器、215は、電
動機12の電流IMを検出する電流検出器、216は、
電動機12の電流が電流指令IM*に追従するように電動
機12に電圧Vを印加する電流制御回路である。同図の
ように構成することによって、トルク制御回路11a
は、電動機12の出力トルクがトルク指令信号TM*に追
従するように制御できる。電流制御回路216の詳細な
構成については、例えば、「ACサーボシステムの理論
と設計の実際」、総合電子出版社、1990年、P80
〜P85、P153〜P155を参照のこと。
る。図42は、この発明の実施の形態14の全体を示す
ブロック図である。ここで基準値調整回路61以外の動
作は上述した実施の形態13と同一なので説明を省略す
る。
詳細な構成を示すブロック図である。同図において、2
17は、回転角指令信号θM*と、実回転角信号θMとの
偏差(θM*−θM)を出力する減算器、218は、偏差
(θM*−θM)と実回転速度信号ωMにより基準値変化量
△θdrp*を出力する符号判定回路、219は、基準値変
化量△θdrp*を積分し基準値θdrp*を出力する積分器で
ある。ここで、符号判定回路218は、実回転速度信号
ωMが正数から0となったときの偏差(θM*−θM)が正
数であれば基準値変化量△θdrp*を1、実回転速度信号
ωMが正数から0となったときの偏差(θM*−θM)が負
数であれば基準値変化量△θdrp*を−1、実回転速度信
号ωMが負数から0となったときの偏差(θM*−θM)が
負数であれば基準値変化量△θdrp*を1、実回転速度信
号ωMが負数から0となったときの偏差(θM*−θM)が
正数であれば基準値変化量△θdrp*を−1、実回転速度
信号ωMが0となったときの偏差(θM*−θM)が0であ
れば基準値変化量△θdrp*を0となるように調整する。
このように構成することにより、基準値調整回路は電動
機の実回転速度と回転角指令信号と実回転角信号に基づ
いて基準値θdrp*を修正し補償トルク信号としての第2
のトルク信号T2*をリセットするタイミングを変更でき
る。
る。図44は、この発明の実施の形態3の全体を示すブ
ロック図である。ここで基準値調整回路62以外の動作
は上述した実施の形態15と同一なので説明を省略す
る。
詳細な構成を示すブロック図である。同図において、2
17は、回転角指令信号θM*と、実回転角信号θMとの
偏差(θM*−θM)を出力する減算器、220は、回転
角指令信号θM*の微分値θM*'を出力する微分器、22
1は偏差(θM*−θM)と微分値θM*'により基準値変化
量△θdrp*を出力する符号判定回路、219は、基準値
変化量△θdrp*を積分し基準値θdrp*を出力する積分器
である。ここで、符号判定回路221は、微分値θM*'
が正数から0となったときの偏差(θM*−θM)が正数
であれば基準値変化量△θdrp*を1、微分値θM*'が正
数から0となったときの偏差(θM*−θM)が負数であ
れば基準値変化量△θdrp*を−1、微分値θM*'が負数
から0となったときの偏差(θM*−θM)が負数であれ
ば基準値変化量△θdrp*を1、微分値θM*'が負数から
0となったときの偏差(θM*−θM)が正数であれば基
準値変化量△θdrp*を−1、微分値θM*'が0となった
ときの偏差(θM*−θM)が0であれば基準値変化量△
θdrp*を0となるように調整する。このように構成する
ことにより、基準値調整回路62は回転角指令信号θM*
と実回転角信号θMに基づいて基準値θdrp*を修正し補
償トルク信号としての第2のトルク信号T2*をリセット
するタイミングを変更できる。また、補償トルク制御回
路60、基準値調整回路62を付加し、基準値調整回路
62中で必要とする速度情報を速度回転角指令信号の微
分値から得るようにしたので、ノイズが少なくオーバシ
ュートのない速度情報を基に基準値の調整を行うことが
できるという効果がある。また、基準値調整回路62は
少なくとも1回の位置決めを行うことにより補償トルク
制御回路60中のパラメータを調整し摩擦トルクをフィ
ードフォワード補償するようにしたので、2回目以後の
回転角指令に対してオーバシュートが極めて少ない位置
制御が実現できるという効果がある。
る。図46は、この発明の実施の形態16の全体を示す
ブロック図である。ここで基準値調整回路63以外の動
作は上述した実施の形態13と同一なので説明を省略す
る。
詳細な構成を示すブロック図である。同図において、2
17は回転角指令信号θM*と、実回転角信号θMとの偏
差(θM*−θM)を出力する減算器、220は、回転角
指令信号θM*の微分値θM*'を出力する微分器、222
は、偏差(θM*−θM)と微分値θM*'により基準値変化
量△θdrp*を出力する最大偏差検出回路、219は、基
準値変化量△θdrp*を積分し基準値θdrp*を出力する積
分器である。ここで、最大偏差検出回路222は、微分
値θM*'が正数から0となった後、偏差(θM*−θM)の
微分値が0となった時点の偏差(θM*−θM)が正数で
あれば、基準値変化量△θdrp*を1、微分値θM*'が正
数から0となった後、偏差(θM*−θM)の微分値が0
となった時点の偏差(θM*−θM)が負数であれば、基
準値変化量△θdrp*を−1、微分値θM*'が負数から0
となった後、偏差(θM*−θM)の微分値が0となった
時点の偏差(θM*−θM)が負数であれば、基準値変化
量△θdrp*を1、微分値θM*'が負数から0となった
後、偏差(θM*−θM)の微分値が0となった時点の偏
差(θM*−θM)が正数であれば、基準値変化量△θdrp
*を−1、微分値θM*'が0となった後、偏差(θM*−θ
M)の微分値が0となった時点の偏差(θM*−θM)が0
であれば、基準値変化量△θdrp*を0となるように調整
する。このように構成することにより、基準値調整回路
63は回転角指令信号θM*と実回転角信号θMに基づい
て基準値θdrp*を修正し、補償トルク信号としての第2
のトルク信号T2*をリセットするタイミングを変更でき
る。また、微分値θM*'が0となった時点の偏差(θM*
−θM)の微分値が減少するようにしたので、オーバシ
ュート量を直接用いて基準値の調整を行うことができる
という効果がある。
8は、この発明の実施の形態17の全体を示すブロック
図である。ここで、ローパスフィルタ回路64以外の動
作は、上述した実施の形態13と同一なので説明を省略
する。
ク信号T2*が0にリセットされたときに動作し、補償ト
ルク信号としての第2のトルク信号T2*の所望の周波数
以下の信号を通し、フィルタ出力信号Tf2*を出力す
る。補償トルク信号としての第2のトルク信号をステッ
プ的に0にリセットした場合、電動機12の出力トルク
がステップ的に変化するので、トルク伝達機構と負荷機
械に対し強い衝撃を与えてしまう。しかし、ローパスフ
ィルタ64を入れることによりステップ状の第2のトル
ク信号T2*を滑らかにでき、トルク伝達機構と負荷機械
14に対する衝撃を緩和することができる。以上のよう
に、補償トルク制御回路60、ローパスフィルタ回路6
4を付加し、補償トルク制御回路60のトルク信号が不
連続にならないようにしたので、トルク伝達機構と負荷
機械に対して与える衝撃を小さくできるという効果があ
る。
れば、上記実施の形態1〜12は、摩擦要素の細分化を
行うための処理が複雑となり、処理に時間がかかるが、
摩擦要素の比率を知ることが可能である、という点にお
いて極めて有用である。また、上記実施の形態13〜1
7は、摩擦要素の比率を知ることはできないが、上記処
理が簡素化されているので、CPUの能力の低い機種に
も適用できる、という点において極めて有用である。
められた電動機の速度を指令するトルク信号を出力する
速度指令手段と、上記電動機の回転を検出する回転検出
器と、この回転検出器の回転検出に基づいて、上記電動
機の回転を補正するべくクーロン摩擦の補償トルク信号
を出力する補償トルク出力手段と、を備えたので、クー
ロン摩擦が生じても、位置のオーバーシュートがない。
補償トルク出力手段を、回転検出器からの実速度信号ま
たは電動機の模擬回路からの模擬速度信号を所定のパラ
メータを用いて加工した補償トルク信号を出力する摩擦
モデル回路と、第1の速度制御回路からの第1のトルク
信号及び電動機の模擬回路からの模擬速度信号に基づい
てクーロン摩擦成分を抽出し、これに基づき上記摩擦モ
デル回路中のパラメータを修正するパラメータ修正信号
を出力する摩擦修正回路と、を備えたものとしたので、
クーロン摩擦が変化するような場合であっても、この変
化に応じてクーロン摩擦に対する適切な補償を行い位置
のオーバーシュートがない。また、電動機の模擬回路か
らの模擬速度信号を所定のパラメータを用いて加工した
補償トルク信号を出力する摩擦モデル回路を構成の一部
とする場合にあっては回転検出器に量子化ノイズがある
場合でも、クーロン摩擦に対する適正な補償を行い位置
のオーバーシュートがない
補償トルク出力手段に、電動機模擬回路のイナーシャを
修正する修正回路を備えたものとしたので、電動機の模
擬手段のイナーシャが未知な場合や運転中に変化する場
合であっても、クーロン摩擦に対する適正な補償を行い
位置のオーバーシュートがない。
トルク出力手段を、速度指令手段から出力されるトルク
信号の指令要素とこの指令要素と同一種の要素であって
回転検出器により検出される実検出要素とを比較し、こ
の比較結果を予め定めた基準に照らして電動機の回転を
補正するべくクーロン摩擦の補償トルク信号を出力する
ものとし、さらに上記予め定めた基準値を、指令要素と
実検出要素とを比較し、これに基づいて修正するように
したもので、機械系のクーロン摩擦が変化するような場
合でも、2回目以後の位置決め運転時には回転角指令信
号に対してオーバシュートが極めて少ない位置制御が実
現できるという効果がある。
制御装置のブロック図である。
御回路の詳細を示すブロック図である。
御回路の第1の詳細実施の形態を示すブロック図であ
る。
回路の第1の詳細実施の形態を示すブロック図である。
御回路の詳細を示すブロック図である。
御回路の詳細を示すブロック図である。
路の詳細を示すブロック図である。
明図である。
の第1の詳細実施の形態を示すブロック図である。
回路の詳細を示すブロック図である。
置制御装置のブロック図である。
回路の詳細を示すブロック図である。
置制御装置のブロック図である。
路の第2の詳細実施の形態を示すブロック図である。
置制御装置のブロック図である。
置制御装置のブロック図である。
制御回路の第2の詳細実施の形態を示すブロック図であ
る。
擬回路の第2の詳細実施の形態を示すブロック図であ
る。
第1の詳細実施の形態を示すブロック図である。
置制御装置のブロック図である。
置制御装置のブロック図である。
第2の詳細実施の形態を示すブロック図である。
置制御装置のブロック図である。
置制御装置のブロック図である。
路の第3の詳細実施の形態を示すブロック図である。
る。
位置制御装置のブロック図である。
路の第4の詳細実施の形態を示すブロック図である。
る。
位置制御装置のブロック図である。
路の動作説明図である。
位置制御装置のブロック図である。
である。
明図である。
位置制御装置のブロック図である。
4と実施の形態15と実施の形態16と実施の形態17
における位置制御回路の詳細実施の形態を示すブロック
図である。
4と実施の形態15と実施の形態16と実施の形態17
における速度制御回路の詳細実施の形態を示すブロック
図である。
ルク制御回路の詳細実施の形態を示すブロック図であ
る。
ルク制御回路の動作説明図である。
4と実施の形態15と実施の形態16と実施の形態17
ににおけるトルク制御回路の詳細実施の形態を示すブロ
ック図である。
位置制御装置のブロック図である。
路を示すブロック図である。
位置制御装置のブロック図である。
路を示すブロック図である。
位置制御装置のブロック図である。
路を示すブロック図である。
位置制御装置のブロック図である。
置を示すブロック図である。
置を示すブロック図である。
Claims (16)
- 【請求項1】予め定められた電動機の速度を指令するト
ルク信号を出力する速度指令手段と、 上記電動機の回転を検出する回転検出器と、 この回転検出器の回転検出に基づいて、上記電動機の回
転を補正するべくクーロン摩擦の補償トルク信号を出力
する補償トルク出力手段と、を備えたことを特徴とする
電動機の制御装置。 - 【請求項2】速度指令手段から出力されるトルク信号を
第1のトルク信号とし、 この第1のトルク信号とは別に回転検出器の回転検出に
基づいて電動機の回転を制御する第2のトルク信号を出
力する速度制御手段と、 この速度指令制御手段からの第2のトルク信号、上記速
度指令手段からの第1のトルク信号、及び補償トルク出
力手段からの上記電動機の回転を補正するクーロン摩擦
の補償トルク信号を入力として加算し、この加算結果に
基づいて上記電動機を回転する第1の加算器と、を備え
たことを特徴とする請求項1記載の電動機の制御装置。 - 【請求項3】速度指令手段は、 回転角指令信号を出力する回転角指令信号発生回路と、 この回転角指令信号発生回路から出力される回転角指令
信号を一方の入力とし、この一方の入力と他方の入力に
基づき第1の速度指令信号を出力する第1の位置制御回
路と、 この第1の速度指令信号を一方の入力とし、この一方の
入力と他方の入力に基づき第1のトルク信号を出力する
第1の速度制御回路と、 この第1のトルク信号に基づき、模擬回転角信号を上記
第1の位置制御回路の他方の入力へ出力するとともに、
模擬速度信号を上記第1の速度制御回路の他方の入力へ
出力する電動機の模擬回路と、を備えたことを特徴とす
る請求項2記載の電動機の制御装置。 - 【請求項4】回転検出器は、実回転角信号と実速度信号
を出力するものであり、 速度制御手段は、 上記回転検出器により検出された実回転角信号及び電動
機の模擬回路から出力された模擬回転角信号に基づき第
2の速度指令信号を出力する第2の位置制御回路と、 この第2の速度指令信号、回転検出器により検出された
実速度信号、及び電動機の模擬回路から出力された模擬
速度信号に基づき第2のトルク信号を出力する第2の速
度制御回路と、を備えたことを特徴とする請求項3記載
の電動機の制御装置。 - 【請求項5】補償トルク出力手段は、 回転検出器からの実速度信号または電動機の模擬回路か
らの模擬速度信号を所定のパラメータを用いて加工した
補償トルク信号を出力する摩擦モデル回路と、第1の速
度制御回路からの第1のトルク信号及び電動機の模擬回
路からの模擬速度信号に基づいてクーロン摩擦成分を抽
出し、これに基づき上記摩擦モデル回路中のパラメータ
を修正するパラメータ修正信号を出力する摩擦修正回路
と、を備えたことを特徴とする請求項3乃至請求項4記
載の電動機の制御装置。 - 【請求項6】補償トルク出力手段は、電動機模擬回路の
イナーシャ修正する修正回路を備えたことを特徴とする
請求項5記載の電動機の制御装置。 - 【請求項7】修正回路は、模擬速度信号と第2の速度指
令信号との加算値と、実回転角速度信号との偏差を出力
する加減算器と、 第1のトルク信号に基づいて極性信号を出力する極性判
別回路と、 この極性判別回路から出力された極性信号と、上記加減
算器からの偏差とを乗算する乗算器と、 この乗算器の出力を積分する積分器と、 この積分器の出力とイナーシャ初期値を加算し、電動機
模擬回路に対してイナーシャを出力する加算器と、を備
えたことを特徴とする請求項6記載の電動機の制御装
置。 - 【請求項8】摩擦修正回路は、第1の速度制御回路から
の第1のトルク信号をローパスフィルタを介して入力す
ることを特徴とする請求項5乃至請求項7記載の電動機
の制御装置。 - 【請求項9】摩擦修正回路は、 電動機の模擬回路より出力される模擬速度信号と第1の
速度制御回路より出力される第1のトルク信号とに基づ
き第1乃至第3の状態フラグを出力する判定回路と、 第1の状態フラグの立ち上がりエッジにて加算器より出
力されるトルク指令信号をサンプル・ホールドし、第1
のサンプル・トルク信号を出力する第1のサンプル・ホ
ールド回路と、 第2の状態フラグの立ち下がりエッジにて加算器より出
力されるトルク指令信号をサンプル・ホールドし、第2
のサンプル・トルク信号を出力する第2のサンプル・ホ
ールド回路と、 第3の状態フラグの立ち下がりエッジにて加算器より出
力されるトルク指令信号をサンプル・ホールドし、第3
のサンプル・トルク信号を出力する第3のサンプル・ホ
ールド回路と、 上記第2のサンプル・トルク信号とこの第3のサンプル
・トルク信号との平均値を出力する計算器と、 この計算器の出力と上記第1のサンプル・トルク信号と
の偏差を出力する減算器と、上記状態フラグ1の立ち下
がりエッジにてこの偏差をサンプル・ホールドし、パラ
メータ修正信号を出力する第4のサンプル・ホールド回
路と、を備えたことを特徴とする請求項5乃至請求項8
記載の電動機の制御装置。 - 【請求項10】摩擦修正回路は、 電動機の模擬回路より出力される模擬速度信号と第1の
速度制御回路より出力される第1のトルク信号により状
態フラグを出力する判定回路と、 この状態フラグの立ち上がりエッジにて加算器より出力
されるトルク指令信号をサンプル・ホールドし、サンプ
ル・トルク信号を出力する第1のサンプル・ホールド回
路と、 トルク指令信号とこの第1のサンプル・ホールド回路か
ら出力されるサンプル・トルク信号TS との偏差を出力
する減算器と、 状態フラグの立ち下がりエッジにて偏差をサンプル・ホ
ールドし、パラメータ修正値を出力する第2のサンプル
・ホールド回路と、 トルク指令信号と第2のサンプル・ホールド回路から出
力される摩擦モデル修正値との偏差を出力する減算器
と、 状態フラグの立ち下がりエッジにて偏差をサンプル・ホ
ールドし、積分項修正値を出力する第3のサンプル・ホ
ールド回路と、を備えたことを特徴とする請求項5乃至
請求項8記載の電動機の制御装置。 - 【請求項11】摩擦修正回路は、 電動機の模擬回路より出力される模擬速度信号と第1の
速度制御回路より出力される第1のトルク信号とにより
状態フラグ1〜3を出力する判定回路と、 状態フラグ1の立ち上がりエッジにて加算器より出力さ
れるトルク指令信号をサンプル・ホールドし、第1のサ
ンプル・トルク信号を出力する第1のサンプル・ホール
ド回路と、 トルク指令信号とこの第1のサンプル・ホールド回路か
ら出力される第1のサンプル・トルク信号との偏差を出
力する減算器と、 状態フラグ2の立ち下がりエッジにて減算器からの偏差
をサンプル・ホールドし、第2のサンプル・トルク信号
を出力する第2のサンプル・ホールド回路と、この第2
のサンプル・ホールド回路から出力される第2のサンプ
ル・トルク信号とトルク指令信号との偏差を出力する減
算器と、 状態フラグ3の立ち上がりエッジにてこの減算器からの
偏差をサンプル・ホールドし、第3のサンプル・トルク
信号を出力する第3のサンプル・ホールド回路と、 トルク指令信号とこの第3のサンプル・ホールド回路か
ら出力された第3のサンプル・トルク信号との加算値を
出力する加算器と、 状態フラグ1の立ち下がりエッジにてこの加算器による
加算値をサンプル・ホールドし、パラメータ修正値を出
力する第4のサンプル・ホールド回路と、 トルク指令信号とこの第4のサンプル・ホールド回路か
ら出力された摩擦モデル修正値との偏差を出力する減算
器と、 状態フラグ1の立ち下がりエッジにてこの減算器からの
偏差をサンプル・ホールドし、積分項修正値を出力する
第5のサンプル・ホールド回路と、を備えたことを特徴
とする請求項5乃至請求項8記載の電動機の制御装置。 - 【請求項12】補償トルク出力手段は、 回転検出器からの実速度信号を所定のパラメータを用い
て加工した補償トルク信号を出力する摩擦モデル回路
と、 回転角指令信号発生回路からの回転角指令信号に応じた
摩擦量データを記憶し、これに基づき上記摩擦モデル回
路中のパラメータを修正するパラメータ修正信号を出力
する摩擦記憶回路と、を備えたことを特徴とする請求項
3乃至請求項4記載の電動機の制御装置。 - 【請求項13】摩擦モデル回路は、 回転検出器から出力された実速度信号または電動機の模
擬回路から出力された模擬速度信号を比例増幅する係数
器と、 この係数器の出力値を所定の値でリミットし、補償トル
ク信号を出力するリミッタ回路と、 摩擦修正回路より出力されるパラメータ修正信号を与え
られると、このリミッタ回路のリミット値を修正するリ
ミット値プリセット回路と、を備えたことを特徴とする
請求項5乃至請求項12記載の電動機の制御装置。 - 【請求項14】補償トルク出力手段は、 速度指令手段から出力されるトルク信号の指令要素とこ
の指令要素と同一種の要素であって回転検出器により検
出される実検出要素とを比較し、この比較結果を予め定
めた基準に照らして電動機の回転を補正するべくクーロ
ン摩擦の補償トルク信号を出力することを特徴とする請
求項1記載の電動機の制御装置。 - 【請求項15】予め定めた基準値は、指令要素と実検出
要素とを比較し、これに基づいて修正されることを特徴
とする請求項1記載の電動機の制御装置。 - 【請求項16】指令要素及び実検出要素において比較さ
れる互いに同一種の要素は、回転角信号であり、各々回
転角指令信号及び実回転角信号であることを特徴とする
請求項14または請求項15記載の電動機の制御装置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP07467196A JP3233009B2 (ja) | 1995-03-28 | 1996-03-28 | 電動機の制御装置 |
Applications Claiming Priority (3)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP7-69419 | 1995-03-28 | ||
| JP6941995 | 1995-03-28 | ||
| JP07467196A JP3233009B2 (ja) | 1995-03-28 | 1996-03-28 | 電動機の制御装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH08331881A true JPH08331881A (ja) | 1996-12-13 |
| JP3233009B2 JP3233009B2 (ja) | 2001-11-26 |
Family
ID=26410622
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP07467196A Expired - Fee Related JP3233009B2 (ja) | 1995-03-28 | 1996-03-28 | 電動機の制御装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP3233009B2 (ja) |
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2006199444A (ja) * | 2005-01-20 | 2006-08-03 | Mitsubishi Electric Corp | エレベータの制御装置 |
| US7560890B2 (en) | 2004-07-29 | 2009-07-14 | Mitsubishi Denki Kabushiki Kaisha | Position controller and controlling method therefor |
| US7719221B2 (en) | 2006-08-31 | 2010-05-18 | Kabushiki Kaisha Toshiba | Servo control apparatus |
| CN111433703A (zh) * | 2017-12-05 | 2020-07-17 | 日本电产株式会社 | 旋转控制装置、移动体及搬运机器人 |
Family Cites Families (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US5134354A (en) | 1989-04-10 | 1992-07-28 | Kabushiki Kaisha Yaskawa Denki Seisakusho | Servo motor control apparatus |
-
1996
- 1996-03-28 JP JP07467196A patent/JP3233009B2/ja not_active Expired - Fee Related
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US7560890B2 (en) | 2004-07-29 | 2009-07-14 | Mitsubishi Denki Kabushiki Kaisha | Position controller and controlling method therefor |
| JP2006199444A (ja) * | 2005-01-20 | 2006-08-03 | Mitsubishi Electric Corp | エレベータの制御装置 |
| US7719221B2 (en) | 2006-08-31 | 2010-05-18 | Kabushiki Kaisha Toshiba | Servo control apparatus |
| CN111433703A (zh) * | 2017-12-05 | 2020-07-17 | 日本电产株式会社 | 旋转控制装置、移动体及搬运机器人 |
Also Published As
| Publication number | Publication date |
|---|---|
| JP3233009B2 (ja) | 2001-11-26 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US5159254A (en) | Numerical control unit for estimating movement parameters using a model | |
| JP3084928B2 (ja) | 電動機の位置制御装置 | |
| EP1847892A2 (en) | Position controller | |
| US6211636B1 (en) | Pressing machine and motor torque control method in pressing machine | |
| JP2011072178A (ja) | イナーシャと摩擦を同時に推定する機能を有する電動機の制御装置 | |
| EP3076261A1 (en) | Machinery control device and gain determination method for friction compensation | |
| JP4075803B2 (ja) | モータの制御装置 | |
| KR20060072136A (ko) | 모터 제어 장치 | |
| US20180262153A1 (en) | Motor control system | |
| JP3233009B2 (ja) | 電動機の制御装置 | |
| JP3230571B2 (ja) | 電動機の速度制御装置 | |
| US5652491A (en) | Position controller for an electric motor | |
| JP3000850B2 (ja) | 電子カム | |
| JP3214270B2 (ja) | 電動機の速度制御装置並びに速度及び位置制御装置 | |
| JP3503343B2 (ja) | 摩擦補償型制御方法及び装置 | |
| CN109067284B (zh) | 一种基于滤波误差的电机控制方法及装置 | |
| JPH08286759A (ja) | 静摩擦を補償するロボット駆動制御方法 | |
| JP3226413B2 (ja) | 数値制御装置 | |
| JP2906255B2 (ja) | サーボ制御装置 | |
| CN109067288B (zh) | 一种基于电流环的电机控制方法及装置 | |
| JP2003333874A (ja) | 負荷イナーシャ同定装置 | |
| JP3269198B2 (ja) | 位置制御装置 | |
| JP2003084839A (ja) | オーバーシュート抑制機能を備えたモータ制御装置 | |
| JP3171860B2 (ja) | サーボ制御システム | |
| JP2006074896A (ja) | モータ制御装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20080921 Year of fee payment: 7 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20080921 Year of fee payment: 7 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090921 Year of fee payment: 8 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090921 Year of fee payment: 8 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100921 Year of fee payment: 9 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110921 Year of fee payment: 10 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110921 Year of fee payment: 10 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120921 Year of fee payment: 11 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130921 Year of fee payment: 12 |
|
| LAPS | Cancellation because of no payment of annual fees |