JP3277454B2 - 検出位置補正装置及び回転速度検出装置 - Google Patents
検出位置補正装置及び回転速度検出装置Info
- Publication number
- JP3277454B2 JP3277454B2 JP06647297A JP6647297A JP3277454B2 JP 3277454 B2 JP3277454 B2 JP 3277454B2 JP 06647297 A JP06647297 A JP 06647297A JP 6647297 A JP6647297 A JP 6647297A JP 3277454 B2 JP3277454 B2 JP 3277454B2
- Authority
- JP
- Japan
- Prior art keywords
- time
- pulse
- rotational position
- rotating body
- detection
- 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.)
- Expired - Fee Related
Links
Landscapes
- Control Of Electric Motors In General (AREA)
Description
【0001】
【発明の属する技術分野】本発明は検出位置補正装置及
び回転速度検出装置に係り、特に、回転体の力学的モデ
ルに基づいて構成されたオブザーバによって回転体の検
出位置等に基づき該回転体の瞬時速度や外部から作用す
る制動力等を推定する装置において上記検出位置の誤差
を補正する検出位置補正装置、及び該検出位置補正装置
を利用することによって、より高精度に回転速度を検出
する回転速度検出装置に関する。
び回転速度検出装置に係り、特に、回転体の力学的モデ
ルに基づいて構成されたオブザーバによって回転体の検
出位置等に基づき該回転体の瞬時速度や外部から作用す
る制動力等を推定する装置において上記検出位置の誤差
を補正する検出位置補正装置、及び該検出位置補正装置
を利用することによって、より高精度に回転速度を検出
する回転速度検出装置に関する。
【0002】
【従来の技術】従来より、電動機や車両等の回転体の回
転速度を検出する方法として、いわゆるパルスエンコー
ダ、パルスジェネレータといった位置検出器を用いて回
転体の回転位置(回転角度)を検出し、検出された回転
位置(以下、単に「位置」ともいう)の値に基づいて回
転速度を検出する方法がある。一般的には、ある時間周
期で位置検出器の値が読み込まれ、その読み込みタイミ
ングにおける検出値と1タイミング前における検出値と
の差分によって、回転速度(以下、単に「速度」ともい
う)が検出される。
転速度を検出する方法として、いわゆるパルスエンコー
ダ、パルスジェネレータといった位置検出器を用いて回
転体の回転位置(回転角度)を検出し、検出された回転
位置(以下、単に「位置」ともいう)の値に基づいて回
転速度を検出する方法がある。一般的には、ある時間周
期で位置検出器の値が読み込まれ、その読み込みタイミ
ングにおける検出値と1タイミング前における検出値と
の差分によって、回転速度(以下、単に「速度」ともい
う)が検出される。
【0003】しかし、上記方法の場合、本来、連続量で
ある位置が、位置検出器の分解能に規定される離散値で
検出されるため、検出速度の時間遅れや量子化ノイズと
いった問題が生じる。さらに、速度が低速になると、位
置読み込み周期間で十分なパルス数が得られないため、
上記問題はより深刻なものとなる。
ある位置が、位置検出器の分解能に規定される離散値で
検出されるため、検出速度の時間遅れや量子化ノイズと
いった問題が生じる。さらに、速度が低速になると、位
置読み込み周期間で十分なパルス数が得られないため、
上記問題はより深刻なものとなる。
【0004】そこで、上記問題を回避するため、回転体
のモデルに基づいて、いわゆるオブザーバ(状態観測
器)を構成し、該オブザーバによりパルスが来ない間の
瞬時速度を推定する「瞬時速度オブザーバ」の手法が提
案されている(今野,堀:「高次外乱補償機能を有する
瞬時速度オブザーバ」,電気学会論文誌D,112,No6,平
成4 年)。以下、本手法について説明する。なお、上記
文献記載の本手法は、電動機制御における速度検出につ
いて述べられているので、以下の説明では回転体を電動
機として説明する。
のモデルに基づいて、いわゆるオブザーバ(状態観測
器)を構成し、該オブザーバによりパルスが来ない間の
瞬時速度を推定する「瞬時速度オブザーバ」の手法が提
案されている(今野,堀:「高次外乱補償機能を有する
瞬時速度オブザーバ」,電気学会論文誌D,112,No6,平
成4 年)。以下、本手法について説明する。なお、上記
文献記載の本手法は、電動機制御における速度検出につ
いて述べられているので、以下の説明では回転体を電動
機として説明する。
【0005】図9には、瞬時速度オブザーバ10の構
成、電動機12及び位置検出器14が示されている。同
図に示すように、入力された電流iにより回転駆動した
電動子の位置を求めるとき、電動機12は、電流iから
電動子の駆動トルクへの変換係数を示すトルク係数K
と、該駆動トルク及び電動子に外部から作用する外乱ト
ルクTd の加算要素と、電動子の慣性J及び積分要素1
/sからなる変換要素(1/Js)と、積分要素1/s
と、により表される。なお、sはラプラス変換の演算子
に相当している。
成、電動機12及び位置検出器14が示されている。同
図に示すように、入力された電流iにより回転駆動した
電動子の位置を求めるとき、電動機12は、電流iから
電動子の駆動トルクへの変換係数を示すトルク係数K
と、該駆動トルク及び電動子に外部から作用する外乱ト
ルクTd の加算要素と、電動子の慣性J及び積分要素1
/sからなる変換要素(1/Js)と、積分要素1/s
と、により表される。なお、sはラプラス変換の演算子
に相当している。
【0006】この電動機12の作用を説明すると、まず
電流iを入力すると、電流iのエネルギーは、電動子の
駆動トルク(Ki)に変換される。この駆動トルクに対
し、電動機外部から作用する外乱トルクTd が加わる
と、実際に電動子に作用するトルクは全トルクTm とな
る。次に、演算要素(1/Js)を慣性Jの逆数(1/
J)と積分要素(1/s)とに分解して考えると、全ト
ルクTm は、(1/J)により電動子の回転角速度に変
換され、さらに、この回転角速度は積分要素(1/s)
により電動子の回転速度ωに変換される。そして、回転
速度ωは、後段の積分要素(1/s)により連続量とし
ての実際の回転位置に変換される。
電流iを入力すると、電流iのエネルギーは、電動子の
駆動トルク(Ki)に変換される。この駆動トルクに対
し、電動機外部から作用する外乱トルクTd が加わる
と、実際に電動子に作用するトルクは全トルクTm とな
る。次に、演算要素(1/Js)を慣性Jの逆数(1/
J)と積分要素(1/s)とに分解して考えると、全ト
ルクTm は、(1/J)により電動子の回転角速度に変
換され、さらに、この回転角速度は積分要素(1/s)
により電動子の回転速度ωに変換される。そして、回転
速度ωは、後段の積分要素(1/s)により連続量とし
ての実際の回転位置に変換される。
【0007】電動子の実際の回転位置は、位置検出器1
4により離散値の回転位置θ(パルス計数値)として位
置読み取り周期T1 毎に検出される。
4により離散値の回転位置θ(パルス計数値)として位
置読み取り周期T1 毎に検出される。
【0008】瞬時速度オブザーバ10は、上記した電動
機12の等価モデル16を有しており、この等価モデル
16は、トルク係数Kn (トルク係数Kのノミナル値を
意味する)の定数器20と、駆動トルクの演算値及び外
乱トルクの推定値を加算する加算器22と、電動子に作
用する全トルクの推定値に対して(1/Jn s)を演算
する演算器24(Jn は慣性Jのノミナル値)と、演算
器24の演算結果に対して(1/s)を演算する積分器
26と、から構成される。なお、図9の瞬時速度オブザ
ーバ10では、回転速度ωの推定値、回転位置θの推定
値、外乱トルクTd の推定値及び全トルクTm の推定値
を、各変数に∧を付与した変数で表している。
機12の等価モデル16を有しており、この等価モデル
16は、トルク係数Kn (トルク係数Kのノミナル値を
意味する)の定数器20と、駆動トルクの演算値及び外
乱トルクの推定値を加算する加算器22と、電動子に作
用する全トルクの推定値に対して(1/Jn s)を演算
する演算器24(Jn は慣性Jのノミナル値)と、演算
器24の演算結果に対して(1/s)を演算する積分器
26と、から構成される。なお、図9の瞬時速度オブザ
ーバ10では、回転速度ωの推定値、回転位置θの推定
値、外乱トルクTd の推定値及び全トルクTm の推定値
を、各変数に∧を付与した変数で表している。
【0009】等価モデル16では、電流i及び外乱トル
クの推定値の入力により、制御系の制御周期T2 毎に演
算器24が電動子の速度の推定値を出力し、さらに積分
器26が位置の推定値を出力する。すなわち、等価モデ
ル16によれば、制御周期T 2 毎に上記推定値を出力す
るので、位置検出器14の読み取り周期T1 の間の位置
情報が得られない間でも位置及び速度の推定値を得るこ
とができる。
クの推定値の入力により、制御系の制御周期T2 毎に演
算器24が電動子の速度の推定値を出力し、さらに積分
器26が位置の推定値を出力する。すなわち、等価モデ
ル16によれば、制御周期T 2 毎に上記推定値を出力す
るので、位置検出器14の読み取り周期T1 の間の位置
情報が得られない間でも位置及び速度の推定値を得るこ
とができる。
【0010】さらに、瞬時速度オブザーバ10は、等価
モデル16により演算された位置の推定値と位置検出器
14により検出された位置θとの偏差Δθを演算する偏
差器28と、演算されたΔθに基づいて、読み取り周期
T1 毎に、等価モデル16で用いられる外乱トルクの推
定値及び該等価モデル16で推定される速度の推定値を
修正するためのゲインを各々演算する修正ゲイン演算部
18と、を備えている。
モデル16により演算された位置の推定値と位置検出器
14により検出された位置θとの偏差Δθを演算する偏
差器28と、演算されたΔθに基づいて、読み取り周期
T1 毎に、等価モデル16で用いられる外乱トルクの推
定値及び該等価モデル16で推定される速度の推定値を
修正するためのゲインを各々演算する修正ゲイン演算部
18と、を備えている。
【0011】瞬時速度オブザーバ10では、修正ゲイン
演算部18により演算されたゲインにより外乱トルクの
推定値及び速度の推定値が、Δθが零に一致するように
修正されるので、等価モデル16の各推定値は、現実の
電動機12の各出力値と略一致するようになり、よっ
て、回転速度及び外乱トルクの正確な推定が可能とな
る。
演算部18により演算されたゲインにより外乱トルクの
推定値及び速度の推定値が、Δθが零に一致するように
修正されるので、等価モデル16の各推定値は、現実の
電動機12の各出力値と略一致するようになり、よっ
て、回転速度及び外乱トルクの正確な推定が可能とな
る。
【0012】図9の瞬時速度オブザーバ10として、上
記文献には、「位置読み込み形」及び「平均速度読み込
み形」の2つの態様が示されている。以下では、「平均
速度読み込み形」の態様を、本発明の従来技術として、
さらに詳細に説明する。この平均速度読み込み形オブザ
ーバでは、エンコーダのパルス間隔が制御周期T2 より
長くなる場合を想定しており、エンコーダパルスが発生
した直後の制御時点で推定値の修正を行う。
記文献には、「位置読み込み形」及び「平均速度読み込
み形」の2つの態様が示されている。以下では、「平均
速度読み込み形」の態様を、本発明の従来技術として、
さらに詳細に説明する。この平均速度読み込み形オブザ
ーバでは、エンコーダのパルス間隔が制御周期T2 より
長くなる場合を想定しており、エンコーダパルスが発生
した直後の制御時点で推定値の修正を行う。
【0013】図10には、位置θに対応するパルス計数
値、位置検出器14による位置の読み込みタイミング、
及び制御周期が示されている。ここで、読み取り周期T
1 と制御周期T2 との間には、 T1 = mT2 ,mは整数 (1) という関係があるものとする。ここに、mは、パルス発
生時期に依存して変化する。また、読み取り周期T
1 は、速度分解能が十分得られるように数[ms]〜数
十[ms]に設定されている。なお、本手法では、DS
P(Digital Signal Processor)などの高速の演算デバ
イスの使用を前提としているので、制御周期T 2 は数十
[μs]程度となる。
値、位置検出器14による位置の読み込みタイミング、
及び制御周期が示されている。ここで、読み取り周期T
1 と制御周期T2 との間には、 T1 = mT2 ,mは整数 (1) という関係があるものとする。ここに、mは、パルス発
生時期に依存して変化する。また、読み取り周期T
1 は、速度分解能が十分得られるように数[ms]〜数
十[ms]に設定されている。なお、本手法では、DS
P(Digital Signal Processor)などの高速の演算デバ
イスの使用を前提としているので、制御周期T 2 は数十
[μs]程度となる。
【0014】位置検出器14の読み込み周期内では、時
間tは、 t = jT1 +kT2 ,0≦k<m (2) となる。但し、jは読み取り周期T1 の各区間に順番に
付与されたインデックス(番号)、kは読み取り周期T
1 の1区間内で生じたm個の制御周期T2 の各区間に順
番に付与されたインデックスである。j、kを指定する
と、(2) 式より時間tが定まるので、以下では、時間t
における一般の変数f(t)をf[j,k]と表すこと
にする。なお、f[j,m]=f[j+1,0]となる
ので、(2)式では、kの定義域に0を含ませている。
間tは、 t = jT1 +kT2 ,0≦k<m (2) となる。但し、jは読み取り周期T1 の各区間に順番に
付与されたインデックス(番号)、kは読み取り周期T
1 の1区間内で生じたm個の制御周期T2 の各区間に順
番に付与されたインデックスである。j、kを指定する
と、(2) 式より時間tが定まるので、以下では、時間t
における一般の変数f(t)をf[j,k]と表すこと
にする。なお、f[j,m]=f[j+1,0]となる
ので、(2)式では、kの定義域に0を含ませている。
【0015】また、回転速度の推定のためには、制御周
期T2 毎に外乱の推定値が必要となるが、簡単のため、
期T2 毎に外乱の推定値が必要となるが、簡単のため、
【0016】
【数1】
【0017】と仮定する。(3) 式は、間隔T2 において
外乱が一定値をとることを意味している。この仮定はT
2 が十分短い場合には、有効な近似となる。
外乱が一定値をとることを意味している。この仮定はT
2 が十分短い場合には、有効な近似となる。
【0018】ここで、時点[j,k]で電動子に作用す
る全トルクTm [j,k]の推定値(∧付)は、定数器
20及び加算器22により、
る全トルクTm [j,k]の推定値(∧付)は、定数器
20及び加算器22により、
【0019】
【数2】
【0020】と演算される。但し、i[j,k]は、時
点[j,k]での電流値である。そこで、演算器24が
(4) 式の全トルクの推定値を台形積分することにより、
次式のような速度の推定値を得る。
点[j,k]での電流値である。そこで、演算器24が
(4) 式の全トルクの推定値を台形積分することにより、
次式のような速度の推定値を得る。
【0021】
【数3】
【0022】次に、積分器26が(5) 式の速度推定値を
台形積分することにより、次式のような位置の推定値を
得る。
台形積分することにより、次式のような位置の推定値を
得る。
【0023】
【数4】
【0024】なお、(5) 、(6) 式の台形積分は、上述し
たように制御周期T2 毎に行われる。
たように制御周期T2 毎に行われる。
【0025】次に、(5) 式による速度ω[j,m]の推
定値(∧付)及び(6) 式による位置θ[j,m]の推定
値(∧付)には、推定誤差が含まれているので以下のよ
うに修正を行う。なお、エンコーダのパルス間隔を測定
するための図10の高速カウンタはパルスの到着と同時
にリセットされるものとする。
定値(∧付)及び(6) 式による位置θ[j,m]の推定
値(∧付)には、推定誤差が含まれているので以下のよ
うに修正を行う。なお、エンコーダのパルス間隔を測定
するための図10の高速カウンタはパルスの到着と同時
にリセットされるものとする。
【0026】すなわち、パルス間隔が高速カウンタによ
り精度良く測定でき、また、1パルス当たりの回転角度
も予めわかっているので、両者よりその間の平均速度<
ω[j+1]>が以下のように計算される。
り精度良く測定でき、また、1パルス当たりの回転角度
も予めわかっているので、両者よりその間の平均速度<
ω[j+1]>が以下のように計算される。
【0027】
【数5】
【0028】そして、パルスの到着直後の制御時点から
次のパルスの到着直後の制御時点までの間隔T1 と、そ
の間の平均速度<ω[j+1]>を用いて、時点[j+
1,0]における位置が、 θ[j+1,0]=θ[j,0]+<ω[j+1]>T1 (8) で近似できる。この従来技術では、パルス発生時点と制
御時点の時刻のずれは、大きくてT2 程度なので無視で
きると仮定している。
次のパルスの到着直後の制御時点までの間隔T1 と、そ
の間の平均速度<ω[j+1]>を用いて、時点[j+
1,0]における位置が、 θ[j+1,0]=θ[j,0]+<ω[j+1]>T1 (8) で近似できる。この従来技術では、パルス発生時点と制
御時点の時刻のずれは、大きくてT2 程度なので無視で
きると仮定している。
【0029】このように[j,m]の時点において、位
置検出器14の読み込みにより正確な位置θ[j,m]
=θ[j+1,0]がわかるので、偏差器28により位
置の推定誤差として、
置検出器14の読み込みにより正確な位置θ[j,m]
=θ[j+1,0]がわかるので、偏差器28により位
置の推定誤差として、
【0030】
【数6】
【0031】が得られる。そこで、この推定誤差が生じ
る原因を、推定外乱ベクトルの初期値Td [j,0]
(∧付)及び速度推定値の初期値ω[j,0](∧付)
の誤差によるものと考える。Δθを各初期値誤差に分け
て書くと次式のように表せる。
る原因を、推定外乱ベクトルの初期値Td [j,0]
(∧付)及び速度推定値の初期値ω[j,0](∧付)
の誤差によるものと考える。Δθを各初期値誤差に分け
て書くと次式のように表せる。
【0032】
【数7】
【0033】である。ここに、λは誤差Δθを各初期値
誤差に分配するための重み係数ベクトルである。(10)式
に基づいてxerr を計算し、これを以下のように次の速
度推定期間[j+1]における初期値の修正に用いる。
誤差に分配するための重み係数ベクトルである。(10)式
に基づいてxerr を計算し、これを以下のように次の速
度推定期間[j+1]における初期値の修正に用いる。
【0034】
【数8】
【0035】である。従って、修正演算式は次式のよう
になる。
になる。
【0036】
【数9】
【0037】(12)式の演算は、位置検出器14の読み込
み周期T1 毎に行う。また、同式右辺第2項の係数ベク
トルが、図9の修正ゲイン演算部18が演算する修正ゲ
インに相当する。修正ゲインについては、λをオブザー
バの希望する収束特性に合わせて設定することができ
る。その結果、時間と共に推定誤差が零に収束するの
で、瞬時速度及び外乱トルクを推定できる。
み周期T1 毎に行う。また、同式右辺第2項の係数ベク
トルが、図9の修正ゲイン演算部18が演算する修正ゲ
インに相当する。修正ゲインについては、λをオブザー
バの希望する収束特性に合わせて設定することができ
る。その結果、時間と共に推定誤差が零に収束するの
で、瞬時速度及び外乱トルクを推定できる。
【0038】
【発明が解決しようとする課題】しかしながら、上記従
来技術には、以下のような問題がある。
来技術には、以下のような問題がある。
【0039】すなわち、従来技術は、パルス発生時点と
制御時点との時刻のずれは、大きくてT2 程度なので無
視できると考えている。これは、DSPのような高速演
算デバイスを用いた場合に成り立つ条件であり、従来技
術では、T2 は数十[μs]程度という極めて速い周期
を仮定している。しかし、このような高速演算デバイス
は一般に高価であるため、装置全体が高額になるという
問題がある。さらに、安価な低速演算デバイスを用いる
と、制御周期T2 が長くなり、パルス発生時点と制御時
点の時刻のずれは無視できなくなるため、真の検出位置
に基づく誤差の修正が難しくなる。
制御時点との時刻のずれは、大きくてT2 程度なので無
視できると考えている。これは、DSPのような高速演
算デバイスを用いた場合に成り立つ条件であり、従来技
術では、T2 は数十[μs]程度という極めて速い周期
を仮定している。しかし、このような高速演算デバイス
は一般に高価であるため、装置全体が高額になるという
問題がある。さらに、安価な低速演算デバイスを用いる
と、制御周期T2 が長くなり、パルス発生時点と制御時
点の時刻のずれは無視できなくなるため、真の検出位置
に基づく誤差の修正が難しくなる。
【0040】つまり、図9に示すように、パルス発生時
点と制御時点(k=m)との時刻のずれΔtが大きくな
り、その制御時点において真の位置θ* と(13)、(14)式
に基づいて計算された近似位置θ[j+1,0]との間
の差、すなわち量子化誤差が無視できなくなるほど大き
くなる。これに伴って、量子化ノイズの増大、パラメー
タ変動に対するロバスト性の劣化、オブザーバの不安定
化といった不具合が生じる。
点と制御時点(k=m)との時刻のずれΔtが大きくな
り、その制御時点において真の位置θ* と(13)、(14)式
に基づいて計算された近似位置θ[j+1,0]との間
の差、すなわち量子化誤差が無視できなくなるほど大き
くなる。これに伴って、量子化ノイズの増大、パラメー
タ変動に対するロバスト性の劣化、オブザーバの不安定
化といった不具合が生じる。
【0041】本発明は、上記事実に鑑みて成されたもの
で、制御系の制御周期が長く、パルス発生時点と制御時
点の時刻のずれが無視できないような状況においても、
検出位置を正確に補正できる検出位置補正装置及び該装
置を用いることにより安定かつ高精度に回転速度を検出
できる回転速度検出装置を提供することを目的とする。
で、制御系の制御周期が長く、パルス発生時点と制御時
点の時刻のずれが無視できないような状況においても、
検出位置を正確に補正できる検出位置補正装置及び該装
置を用いることにより安定かつ高精度に回転速度を検出
できる回転速度検出装置を提供することを目的とする。
【0042】
【課題を解決するための手段】(検出位置補正装置) 上記目的を達成するために請求項1の発明は、回転体に
設置されたパルス生成器が出力したパルスの計数値に基
づいて該回転体の回転位置を検出する位置検出手段と、
前記パルス生成器により出力されたパルスのパルス間隔
を計測するパルス間隔計測手段と、回転位置が検出され
た現時点と、該現時点後に指定された制御時点との時間
差を計測する時間差計測手段と、前記位置検出手段によ
り1又は複数の検出時点で検出された回転位置の時間系
列、前記パルス間隔計測手段により1又は複数の計測時
点で計測されたパルス間隔の時間系列、及び前記時間差
計測手段により計測された時間差に基づいて、現時点で
検出された回転位置を、回転位置の変化量を直線で近似
するか、又はパルス間隔を用いて時間に対する制御時点
の回転位置の変化を多項式で近似して、前記制御時点の
回転位置に補正する検出位置補正手段と、を含んで構成
したものである。
設置されたパルス生成器が出力したパルスの計数値に基
づいて該回転体の回転位置を検出する位置検出手段と、
前記パルス生成器により出力されたパルスのパルス間隔
を計測するパルス間隔計測手段と、回転位置が検出され
た現時点と、該現時点後に指定された制御時点との時間
差を計測する時間差計測手段と、前記位置検出手段によ
り1又は複数の検出時点で検出された回転位置の時間系
列、前記パルス間隔計測手段により1又は複数の計測時
点で計測されたパルス間隔の時間系列、及び前記時間差
計測手段により計測された時間差に基づいて、現時点で
検出された回転位置を、回転位置の変化量を直線で近似
するか、又はパルス間隔を用いて時間に対する制御時点
の回転位置の変化を多項式で近似して、前記制御時点の
回転位置に補正する検出位置補正手段と、を含んで構成
したものである。
【0043】請求項1の発明では、回転体が回転する
と、この回転体に設置されたパルス生成器がパルスを出
力し、位置検出手段は、出力されたパルスの計数値に基
づいて回転体の回転位置を検出する。例えば、このパル
ス生成器を、回転速度に比例した周波数成分を有する交
流信号をパルス波形に変換するパルスジェネレータとし
て実現することができる。また、位置検出手段を、パル
ス発生回数を積算することによりパルスの計数値を求
め、このパルス計数値を回転位置に変換する手段として
実現することができる。なお、パルス生成器は、上記の
ような回転速度に比例した周波数成分をもつ交流信号を
発生するものに限らず、回転角に応じてパルス等の何ら
かの信号を発生するものでも良い。
と、この回転体に設置されたパルス生成器がパルスを出
力し、位置検出手段は、出力されたパルスの計数値に基
づいて回転体の回転位置を検出する。例えば、このパル
ス生成器を、回転速度に比例した周波数成分を有する交
流信号をパルス波形に変換するパルスジェネレータとし
て実現することができる。また、位置検出手段を、パル
ス発生回数を積算することによりパルスの計数値を求
め、このパルス計数値を回転位置に変換する手段として
実現することができる。なお、パルス生成器は、上記の
ような回転速度に比例した周波数成分をもつ交流信号を
発生するものに限らず、回転角に応じてパルス等の何ら
かの信号を発生するものでも良い。
【0044】ここで、図3のタイミングチャートに基づ
いて、本発明の検出位置補正装置の原理を説明する。こ
の説明では、本発明の検出位置補正装置が、従来技術と
同様に、パルス発生毎に、パルス発生直後の制御時点で
検出位置の補正を行うものとするが、本発明はこれに限
定されるものでない。
いて、本発明の検出位置補正装置の原理を説明する。こ
の説明では、本発明の検出位置補正装置が、従来技術と
同様に、パルス発生毎に、パルス発生直後の制御時点で
検出位置の補正を行うものとするが、本発明はこれに限
定されるものでない。
【0045】いま、時点[j+1,0]での真の位置を
求めると仮定する。ここで、図3では、簡単のために時
点[j+1,0]を[j+1]と表している。なお、図
3において時点[j+1]での真の位置とは、パルス発
生時点で回転位置が検出されたときの位置θ[j+1]
ではなく、その直後の制御時点(k=m)における位置
θ* である。
求めると仮定する。ここで、図3では、簡単のために時
点[j+1,0]を[j+1]と表している。なお、図
3において時点[j+1]での真の位置とは、パルス発
生時点で回転位置が検出されたときの位置θ[j+1]
ではなく、その直後の制御時点(k=m)における位置
θ* である。
【0046】ここで、本発明のパルス間隔計測手段は、
例えば、高速カウンタ(図3参照)により実現できる。
この高速カウンタは、きわめて短い周期でタイムカウン
トすることにより時間間隔を測定する計測タイマであ
り、パルス発生毎に回転速度の修正を行う図3の場合で
は、パルスの発生毎にそのカウント値をメモリに格納し
すると共に該カウント値をリセットする。このとき、メ
モリの値からそのときのパルス間隔が計測できる。この
高速カウンタのカウンタ周期は、通常数μ秒以下である
ため、精度良くパルス間隔を計測できる。なお、パルス
発生毎ではなく、複数のパルスが発生する区間毎に検出
位置の補正を行う場合には、パルス間隔計測手段は、各
区間の代表的なパルス同士のパルス間隔を計測する。
例えば、高速カウンタ(図3参照)により実現できる。
この高速カウンタは、きわめて短い周期でタイムカウン
トすることにより時間間隔を測定する計測タイマであ
り、パルス発生毎に回転速度の修正を行う図3の場合で
は、パルスの発生毎にそのカウント値をメモリに格納し
すると共に該カウント値をリセットする。このとき、メ
モリの値からそのときのパルス間隔が計測できる。この
高速カウンタのカウンタ周期は、通常数μ秒以下である
ため、精度良くパルス間隔を計測できる。なお、パルス
発生毎ではなく、複数のパルスが発生する区間毎に検出
位置の補正を行う場合には、パルス間隔計測手段は、各
区間の代表的なパルス同士のパルス間隔を計測する。
【0047】同様に、本発明の時間差計測手段も、例え
ば高速カウンタ(図3参照)により実現できる。すなわ
ち、制御時点k=mとその直前のパルス発生時点との時
間差Δtを、該制御時点における高速カウンタ値を読み
込むことで計測することができる。
ば高速カウンタ(図3参照)により実現できる。すなわ
ち、制御時点k=mとその直前のパルス発生時点との時
間差Δtを、該制御時点における高速カウンタ値を読み
込むことで計測することができる。
【0048】そして、本発明の検出位置補正手段は、検
出位置、パルス間隔及び時間差を用いることにより、例
えば、以下のようにして、現時点で検出された位置θ
[j+1]を、指定された制御時点の真の回転位置θ*
に補正する。
出位置、パルス間隔及び時間差を用いることにより、例
えば、以下のようにして、現時点で検出された位置θ
[j+1]を、指定された制御時点の真の回転位置θ*
に補正する。
【0049】すなわち、時点位置θ[j]からθ[j+
1]までの位置の変化量は、 θs /Tw [j+1]=(θ[j+1]−θ[j])/Tw [j+1] (13) となる。但し、Tw [j+1]は、時点[j]のパルス
と時点[j+1]のパルスとの間の時間間隔とする。(1
3)式により表される位置の変化量を用いると、直前のパ
ルス時点[j+1]からΔt経過した制御時点における
真の位置θ* は、以下のように求めることができる。
1]までの位置の変化量は、 θs /Tw [j+1]=(θ[j+1]−θ[j])/Tw [j+1] (13) となる。但し、Tw [j+1]は、時点[j]のパルス
と時点[j+1]のパルスとの間の時間間隔とする。(1
3)式により表される位置の変化量を用いると、直前のパ
ルス時点[j+1]からΔt経過した制御時点における
真の位置θ* は、以下のように求めることができる。
【0050】
【数10】
【0051】このように、位置検出手段からの位置θ
[j+1]を(14)式のように補正することにより、時点
[j+1]における真の位置を求めることができる。
[j+1]を(14)式のように補正することにより、時点
[j+1]における真の位置を求めることができる。
【0052】また、(14)式では、過去1パルス前との位
置の変化量から真の位置θ* を求めたが、過去数パルス
前との変化量から求めても良い。この場合は、過去のパ
ルス間隔に基づいて、以下のように位置の補正を行う。
置の変化量から真の位置θ* を求めたが、過去数パルス
前との変化量から求めても良い。この場合は、過去のパ
ルス間隔に基づいて、以下のように位置の補正を行う。
【0053】
【数11】
【0054】ここに、nは、過去nパルス前からの変化
量、すなわち、n個のパルス間の平均位置変化から求め
ていることを示している。また、(13)、(14)式までは位
置の変化量を直線で近似して、検出位置を補正したが、
過去n個のパルス間隔を用いて時間に対する真の位置の
変化を多項式で近似し、制御時点k=mにおける真の位
置を求めることもできる。例えば、ラグランジュの補間
公式(2次補間公式)を用いると、j番目のパルスが発
生した時刻をtj とし、ある時刻tにおける位置θ
(t)を以下のように求めることができる。
量、すなわち、n個のパルス間の平均位置変化から求め
ていることを示している。また、(13)、(14)式までは位
置の変化量を直線で近似して、検出位置を補正したが、
過去n個のパルス間隔を用いて時間に対する真の位置の
変化を多項式で近似し、制御時点k=mにおける真の位
置を求めることもできる。例えば、ラグランジュの補間
公式(2次補間公式)を用いると、j番目のパルスが発
生した時刻をtj とし、ある時刻tにおける位置θ
(t)を以下のように求めることができる。
【0055】
【数12】
【0056】である。
【0057】制御時点k=mにおける時刻tが、 t = Δt + tj+1 (18) であることを用いて、n=2、すなわち過去2パルスの
パルス間隔Tw [j],Tw [j+1]、及び過去2パ
ルスのパルス発生時の位置を使って、時間に対する真の
位置の変化を2次の多項式で近似するように(16)式、(1
7)式を適用すると、次式の補正式が得られる。
パルス間隔Tw [j],Tw [j+1]、及び過去2パ
ルスのパルス発生時の位置を使って、時間に対する真の
位置の変化を2次の多項式で近似するように(16)式、(1
7)式を適用すると、次式の補正式が得られる。
【0058】
【数13】
【0059】である。(20)〜(22)式を、さらにまとめる
と以下のようになる。
と以下のようになる。
【0060】
【数14】
【0061】全体を整理すると、補正式は次式のように
表せる。
表せる。
【0062】
【数15】
【0063】補正式は、(19)式及び(23)〜(25)式を用い
ても、或いは(26)式を用いても良い。なお、ここではパ
ルス発生毎のパルス間隔を用いて補正を行ったが、1パ
ルス毎ではなく、複数のパルスが発生する毎の時間間隔
を用いて(19)式より補正を行っても良い。
ても、或いは(26)式を用いても良い。なお、ここではパ
ルス発生毎のパルス間隔を用いて補正を行ったが、1パ
ルス毎ではなく、複数のパルスが発生する毎の時間間隔
を用いて(19)式より補正を行っても良い。
【0064】以上のように、本発明の検出位置補正装置
は、検出位置を、指定された制御時点の位置に補正する
ので、従来の瞬時速度オブザーバーのように各制御時点
毎に、外乱トルク、位置、速度等の物理量の誤差修正を
行って該物理量を検出する装置に本発明を適用した場
合、位置の検出時点と制御時点とのずれによって生じる
各物理量の推定精度の低下を防止することができる。 (回転速度検出装置) また、請求項2の発明は、請求項1の検出位置補正装置
を、回転速度検出装置に適用したもので、回転体に設置
されたパルス生成器が出力したパルスの計数値に基づい
て該回転体の回転位置を検出する位置検出手段と、回転
体を制御するための制御トルクを検出する制御トルク検
出手段と、前記制御トルク検出手段により検出された値
の制御トルク及び推定された値の外乱トルクが作用する
回転体のモデルに基づいて、与えられた回転速度及び回
転位置の各初期値とから回転体の回転速度及び回転位置
を推定する状態推定手段と、少なくとも前記パルス生成
器により出力されたパルスの数に基づいて、誤差修正時
点を判断する誤差修正判断手段と、前記パルス生成器に
より出力されたパルスのパルス間隔を計測するパルス間
隔計測手段と、回転位置が検出された現時点と、該現時
点後に前記誤差修正判断手段により判断された誤差修正
時点との時間差を計測する時間差計測手段と、前記位置
検出手段により1又は複数の検出時点で検出された回転
位置の時間系列、前記パルス間隔計測手段により1又は
複数の計測時点で計測されたパルス間隔の時間系列、及
び前記時間差計測手段により計測された時間差に基づい
て、現時点で検出された回転位置を、回転位置の変化量
を直線で近似するか、又はパルス間隔を用いて時間に対
する誤差修正時点の回転位置の変化を多項式で近似し
て、前記誤差修正時点の回転位置に補正する検出位置補
正手段と、前記誤差修正時点において、前記位置補正手
段により補正された回転位置と前記状態推定手段により
推定された回転位置との間に生じた位置の誤差に基づい
て、少なくとも前記外乱トルクの推定値及び回転速度の
初期値を修正する推定誤差修正手段と、を含んで構成し
たものである。
は、検出位置を、指定された制御時点の位置に補正する
ので、従来の瞬時速度オブザーバーのように各制御時点
毎に、外乱トルク、位置、速度等の物理量の誤差修正を
行って該物理量を検出する装置に本発明を適用した場
合、位置の検出時点と制御時点とのずれによって生じる
各物理量の推定精度の低下を防止することができる。 (回転速度検出装置) また、請求項2の発明は、請求項1の検出位置補正装置
を、回転速度検出装置に適用したもので、回転体に設置
されたパルス生成器が出力したパルスの計数値に基づい
て該回転体の回転位置を検出する位置検出手段と、回転
体を制御するための制御トルクを検出する制御トルク検
出手段と、前記制御トルク検出手段により検出された値
の制御トルク及び推定された値の外乱トルクが作用する
回転体のモデルに基づいて、与えられた回転速度及び回
転位置の各初期値とから回転体の回転速度及び回転位置
を推定する状態推定手段と、少なくとも前記パルス生成
器により出力されたパルスの数に基づいて、誤差修正時
点を判断する誤差修正判断手段と、前記パルス生成器に
より出力されたパルスのパルス間隔を計測するパルス間
隔計測手段と、回転位置が検出された現時点と、該現時
点後に前記誤差修正判断手段により判断された誤差修正
時点との時間差を計測する時間差計測手段と、前記位置
検出手段により1又は複数の検出時点で検出された回転
位置の時間系列、前記パルス間隔計測手段により1又は
複数の計測時点で計測されたパルス間隔の時間系列、及
び前記時間差計測手段により計測された時間差に基づい
て、現時点で検出された回転位置を、回転位置の変化量
を直線で近似するか、又はパルス間隔を用いて時間に対
する誤差修正時点の回転位置の変化を多項式で近似し
て、前記誤差修正時点の回転位置に補正する検出位置補
正手段と、前記誤差修正時点において、前記位置補正手
段により補正された回転位置と前記状態推定手段により
推定された回転位置との間に生じた位置の誤差に基づい
て、少なくとも前記外乱トルクの推定値及び回転速度の
初期値を修正する推定誤差修正手段と、を含んで構成し
たものである。
【0065】請求項2の発明では、制御トルク検出手段
が、回転体を制御するための制御トルクを検出する。こ
の制御トルクは、回転体が車両の車輪の場合はホイール
シリンダへのブレーキ圧による車輪への制動トルクであ
り、電動機の場合はモータを駆動するための駆動トルク
に相当する。
が、回転体を制御するための制御トルクを検出する。こ
の制御トルクは、回転体が車両の車輪の場合はホイール
シリンダへのブレーキ圧による車輪への制動トルクであ
り、電動機の場合はモータを駆動するための駆動トルク
に相当する。
【0066】また、状態推定手段が、制御トルク検出手
段により検出された値の制御トルク及び推定された値の
外乱トルクが作用する回転体のモデルに基づいて、与え
られた回転速度及び回転位置の各初期値とから回転体の
回転速度及び回転位置を推定する。例えば、制御トルク
と外乱トルクとを加算して回転体に作用する全トルクを
求め、この全トルクが作用した場合の回転体の回転角加
速度を、回転体のモデルに含まれる物理量(慣性モーメ
ント)から求めることができる。そして、回転角加速度
と回転速度の初期値とから積分演算によりこの時点の回
転体の回転速度を求め、さらに、この回転速度と回転位
置の初期値とから積分演算によりこの時点の回転位置を
求めることができる。なお、外乱トルクの推定値と回転
速度及び回転位置の各初期値は、最初は、所定の測定値
や推定値により得られた値を用いても良いが、後述する
推定誤差修正手段により修正された場合、状態推定手段
は、修正された外乱トルク、回転速度及び回転位置の各
初期値に基づいて回転体の回転速度及び回転位置を推定
する。
段により検出された値の制御トルク及び推定された値の
外乱トルクが作用する回転体のモデルに基づいて、与え
られた回転速度及び回転位置の各初期値とから回転体の
回転速度及び回転位置を推定する。例えば、制御トルク
と外乱トルクとを加算して回転体に作用する全トルクを
求め、この全トルクが作用した場合の回転体の回転角加
速度を、回転体のモデルに含まれる物理量(慣性モーメ
ント)から求めることができる。そして、回転角加速度
と回転速度の初期値とから積分演算によりこの時点の回
転体の回転速度を求め、さらに、この回転速度と回転位
置の初期値とから積分演算によりこの時点の回転位置を
求めることができる。なお、外乱トルクの推定値と回転
速度及び回転位置の各初期値は、最初は、所定の測定値
や推定値により得られた値を用いても良いが、後述する
推定誤差修正手段により修正された場合、状態推定手段
は、修正された外乱トルク、回転速度及び回転位置の各
初期値に基づいて回転体の回転速度及び回転位置を推定
する。
【0067】このように状態推定手段が回転速度等を推
定している間、誤差修正判断手段が、少なくともパルス
生成器が出力したパルスの数に基づいて、誤差修正時点
を判断する。なお、この誤差修正時点は、後述する推定
誤差修正手段による誤差修正が実行される制御時点であ
り、例えば、高速カウンタによってカウントされたパル
ス数が基準値に達した時点の直後における制御系の制御
時点となる。また、制御系の制御周期が一定回数以上繰
り返される間に前記パルス生成器が出力したパルスの数
が基準値以上となった時点を誤差修正の時点と判断する
こともできる。
定している間、誤差修正判断手段が、少なくともパルス
生成器が出力したパルスの数に基づいて、誤差修正時点
を判断する。なお、この誤差修正時点は、後述する推定
誤差修正手段による誤差修正が実行される制御時点であ
り、例えば、高速カウンタによってカウントされたパル
ス数が基準値に達した時点の直後における制御系の制御
時点となる。また、制御系の制御周期が一定回数以上繰
り返される間に前記パルス生成器が出力したパルスの数
が基準値以上となった時点を誤差修正の時点と判断する
こともできる。
【0068】次に、検出位置補正手段が、位置検出手段
により1又は複数の検出時点で検出された回転位置の時
間系列、パルス間隔計測手段により1又は複数の計測時
点で計測されたパルス間隔の時間系列、及び時間差計測
手段により計測された時間差に基づいて、現時点で検出
された回転位置を、回転位置の変化量を直線で近似する
か、又はパルス間隔を用いて時間に対する誤差修正時点
の回転位置の変化を多項式で近似して、誤差修正時点の
回転位置に補正する。
により1又は複数の検出時点で検出された回転位置の時
間系列、パルス間隔計測手段により1又は複数の計測時
点で計測されたパルス間隔の時間系列、及び時間差計測
手段により計測された時間差に基づいて、現時点で検出
された回転位置を、回転位置の変化量を直線で近似する
か、又はパルス間隔を用いて時間に対する誤差修正時点
の回転位置の変化を多項式で近似して、誤差修正時点の
回転位置に補正する。
【0069】そして、推定誤差修正手段が、位置補正手
段により補正された回転位置と状態推定手段により推定
された回転位置との間に生じた位置の誤差に基づいて、
少なくとも外乱トルクの推定値及び回転速度の初期値を
修正する。なお、この修正において、例えば、従来の瞬
時速度オブザーバーの(12)式の誤差修正式を用いること
もできる。また、外乱トルクの推定値と回転速度の初期
値と共に、回転位置の初期値を修正するようにしても良
く、この場合には、より正確な誤差修正が可能となる
(以下の実施の形態を参照)。なお、位置の誤差を各物
理量の誤差に分配する方法は、例えば、推定誤差が時間
と共に零に収束するように制御系を設計する際の拘束条
件などから得られる。以上のように修正された各値は、
状態推定手段で用いられるので、各推定値は真の値に接
近していく。
段により補正された回転位置と状態推定手段により推定
された回転位置との間に生じた位置の誤差に基づいて、
少なくとも外乱トルクの推定値及び回転速度の初期値を
修正する。なお、この修正において、例えば、従来の瞬
時速度オブザーバーの(12)式の誤差修正式を用いること
もできる。また、外乱トルクの推定値と回転速度の初期
値と共に、回転位置の初期値を修正するようにしても良
く、この場合には、より正確な誤差修正が可能となる
(以下の実施の形態を参照)。なお、位置の誤差を各物
理量の誤差に分配する方法は、例えば、推定誤差が時間
と共に零に収束するように制御系を設計する際の拘束条
件などから得られる。以上のように修正された各値は、
状態推定手段で用いられるので、各推定値は真の値に接
近していく。
【0070】このように本発明では、位置補正手段によ
り補正された回転位置を用いて、外乱トルクの推定値及
び回転速度の初期値を修正するため、位置検出時点と誤
差修正時点とのずれによって生じる量子化誤差が軽減さ
れ、高精度に回転速度を検出できる。特に、演算デバイ
スの能力によって制御系の制御周期が十分に短くでき
ず、よって、回転位置の量子化誤差が増大する場合にお
いても、正確に回転速度を推定することができると共
に、量子化ノイズの増大、パラメータ変動に対するロバ
スト性の劣化、及びオブザーバの不安定化などを防止す
ることができる。
り補正された回転位置を用いて、外乱トルクの推定値及
び回転速度の初期値を修正するため、位置検出時点と誤
差修正時点とのずれによって生じる量子化誤差が軽減さ
れ、高精度に回転速度を検出できる。特に、演算デバイ
スの能力によって制御系の制御周期が十分に短くでき
ず、よって、回転位置の量子化誤差が増大する場合にお
いても、正確に回転速度を推定することができると共
に、量子化ノイズの増大、パラメータ変動に対するロバ
スト性の劣化、及びオブザーバの不安定化などを防止す
ることができる。
【0071】
【発明の実施の形態】以下、本発明の検出位置補正装置
を、回転速度検出装置及びタイヤ発生力検出装置に適用
した各々の実施の形態について、図面に基づいて詳細に
説明する。 (第1の実施の形態)図1には、第1の実施の形態に係
る検出位置補正装置を、回転速度検出装置(瞬時速度オ
ブザーバー)に適用した場合の構成ブロック図が示され
ている。同図に示すように、本回転速度検出装置は、計
測対象である回転体を制御するための制御トルクを検出
する制御トルク検出手段30と、回転体の力学的モデル
に基づいて、検出された制御トルク及び推定された外乱
トルクにより回転体の瞬時位置及び瞬時速度を推定する
状態推定手段32と、回転体の所定の回転角の回転毎に
パルスを生成するパルスジェネレータ37のパルス計数
値に基づいて回転体の位置を検出する位置検出手段38
と、を含んで構成されている。なお、制御トルク検出手
段30及び状態推定手段32は、従来の瞬時速度オブザ
ーバ10の等価モデル16(図9)により実現できる
が、この例に限定されるものではない。
を、回転速度検出装置及びタイヤ発生力検出装置に適用
した各々の実施の形態について、図面に基づいて詳細に
説明する。 (第1の実施の形態)図1には、第1の実施の形態に係
る検出位置補正装置を、回転速度検出装置(瞬時速度オ
ブザーバー)に適用した場合の構成ブロック図が示され
ている。同図に示すように、本回転速度検出装置は、計
測対象である回転体を制御するための制御トルクを検出
する制御トルク検出手段30と、回転体の力学的モデル
に基づいて、検出された制御トルク及び推定された外乱
トルクにより回転体の瞬時位置及び瞬時速度を推定する
状態推定手段32と、回転体の所定の回転角の回転毎に
パルスを生成するパルスジェネレータ37のパルス計数
値に基づいて回転体の位置を検出する位置検出手段38
と、を含んで構成されている。なお、制御トルク検出手
段30及び状態推定手段32は、従来の瞬時速度オブザ
ーバ10の等価モデル16(図9)により実現できる
が、この例に限定されるものではない。
【0072】さらに、本回転速度検出装置は、パルスジ
ェネレータ37からのパルス数と制御周期T2 毎にカウ
ントされるカウント数とに基づいて誤差修正演算のタイ
ミングを判断する誤差修正判断手段34と、誤差修正演
算のタイミングと判断されたときに位置検出手段38に
より検出された位置θを(真の)位置θ* に補正する検
出位置補正装置50と、状態推定手段32により推定さ
れた位置と検出位置補正手段50により補正された位置
θ* との差分に基づいて、速度、外乱トルク及び位置の
推定値の修正を行う推定誤差修正手段36と、から構成
される。
ェネレータ37からのパルス数と制御周期T2 毎にカウ
ントされるカウント数とに基づいて誤差修正演算のタイ
ミングを判断する誤差修正判断手段34と、誤差修正演
算のタイミングと判断されたときに位置検出手段38に
より検出された位置θを(真の)位置θ* に補正する検
出位置補正装置50と、状態推定手段32により推定さ
れた位置と検出位置補正手段50により補正された位置
θ* との差分に基づいて、速度、外乱トルク及び位置の
推定値の修正を行う推定誤差修正手段36と、から構成
される。
【0073】検出位置補正装置50は、位置検出手段3
8が検出した位置θの時間系列を記憶する検出位置記憶
手段52と、パルスジェネレータ37が生成したパルス
のパルス間隔Twを計測するパルス間隔計測手段54
と、パルス間隔計測手段54により計測されたパルス間
隔の時間系列を記憶するパルス間隔記憶手段56と、制
御時点と該時点の直前に発生したパルスの時点との時間
差Δtを計測する時間差計測手段58と、誤差修正時点
で、位置θの時間系列、パルス間隔の時間系列及び時間
差Δtに基づいて現時点の検出位置θを制御時点の位置
θ*に補正する検出位置補正手段60と、から構成され
る。
8が検出した位置θの時間系列を記憶する検出位置記憶
手段52と、パルスジェネレータ37が生成したパルス
のパルス間隔Twを計測するパルス間隔計測手段54
と、パルス間隔計測手段54により計測されたパルス間
隔の時間系列を記憶するパルス間隔記憶手段56と、制
御時点と該時点の直前に発生したパルスの時点との時間
差Δtを計測する時間差計測手段58と、誤差修正時点
で、位置θの時間系列、パルス間隔の時間系列及び時間
差Δtに基づいて現時点の検出位置θを制御時点の位置
θ*に補正する検出位置補正手段60と、から構成され
る。
【0074】ここで、本実施の形態の位置読み込みのタ
イミングを示すタイミングチャートを図4に示す。同図
に示すように、本実施の形態の位置読み取り周期T
1 は、図3に示したようにパルス発生毎の周期ではな
く、パルスが2回検出される毎に誤差修正を行う周期を
例にしている。
イミングを示すタイミングチャートを図4に示す。同図
に示すように、本実施の形態の位置読み取り周期T
1 は、図3に示したようにパルス発生毎の周期ではな
く、パルスが2回検出される毎に誤差修正を行う周期を
例にしている。
【0075】図4において、θ[j−1],θ[j],
θ[j+1],...は、位置読み取り区間j−1,
j,j+1,...毎に(各区間の最後のパルス発生時
に)検出された回転位置を示す。また、Tw [j−
1],Tw [j],Tw [j+1],...は、位置読
み取り区間j−1,j,j+1,...のパルス間隔
(各区間の最後に発生したパルス同士の時間間隔)を示
す。そして、θ[l−3],θ[l−2],θ[l−
1],θ[l]...は、パルスl−3,l−2,l−
1,l...毎に検出された回転位置を示し、Tp [l
−1],Tp [l]...は、パルスl−2,l−1,
lの隣接パルス間隔を示す。
θ[j+1],...は、位置読み取り区間j−1,
j,j+1,...毎に(各区間の最後のパルス発生時
に)検出された回転位置を示す。また、Tw [j−
1],Tw [j],Tw [j+1],...は、位置読
み取り区間j−1,j,j+1,...のパルス間隔
(各区間の最後に発生したパルス同士の時間間隔)を示
す。そして、θ[l−3],θ[l−2],θ[l−
1],θ[l]...は、パルスl−3,l−2,l−
1,l...毎に検出された回転位置を示し、Tp [l
−1],Tp [l]...は、パルスl−2,l−1,
lの隣接パルス間隔を示す。
【0076】図4のタイミングの場合、位置検出手段3
8は、位置読み取り区間毎の位置θ[j−1],θ
[j],θ[j+1],...及びパルス毎のθ[l−
3],θ[l−2],θ[l−1],θ[l]...の
いずれかを検出して検出位置記憶手段52に出力する。
また、パルス間隔計測手段54は、位置読み取り区間毎
のパルス間隔Tw [j−1],Tw [j],Tw [j+
1],...及びパルス毎のパルス間隔Tp [l−
1],Tp [l]..のいずれかを計測してパルス間隔
記憶手段56に出力する。
8は、位置読み取り区間毎の位置θ[j−1],θ
[j],θ[j+1],...及びパルス毎のθ[l−
3],θ[l−2],θ[l−1],θ[l]...の
いずれかを検出して検出位置記憶手段52に出力する。
また、パルス間隔計測手段54は、位置読み取り区間毎
のパルス間隔Tw [j−1],Tw [j],Tw [j+
1],...及びパルス毎のパルス間隔Tp [l−
1],Tp [l]..のいずれかを計測してパルス間隔
記憶手段56に出力する。
【0077】次に、図1の回転速度検出装置の作用を図
5のフローチャートにより、図4のタイムチャートを参
照しながら説明する。なお、図5のフローチャートにお
いて、繰り返しループは、制御周期T2 のタイミングで
繰り返されるものであり、定数M、Nは、予め定められ
た零以上の定数である。また、jは誤差修正タイミング
のインデックス、kは制御周期T2 の制御タイミングの
インデックスであり、本実施の形態でも、上述のように
時刻tを[j,k]で表すこととする。
5のフローチャートにより、図4のタイムチャートを参
照しながら説明する。なお、図5のフローチャートにお
いて、繰り返しループは、制御周期T2 のタイミングで
繰り返されるものであり、定数M、Nは、予め定められ
た零以上の定数である。また、jは誤差修正タイミング
のインデックス、kは制御周期T2 の制御タイミングの
インデックスであり、本実施の形態でも、上述のように
時刻tを[j,k]で表すこととする。
【0078】図5のフローチャートには、過去1パルス
前の位置の変化量により真の位置θ * を求める回転位置
検出の流れが示されており、まず、ステップ99におい
て各変数(k,n等)の初期化を行う。次に、制御周期
T2 毎に繰り返される繰り返しループに移行し、このル
ープの始めにステップ100においてkを1つカウント
アップする。
前の位置の変化量により真の位置θ * を求める回転位置
検出の流れが示されており、まず、ステップ99におい
て各変数(k,n等)の初期化を行う。次に、制御周期
T2 毎に繰り返される繰り返しループに移行し、このル
ープの始めにステップ100においてkを1つカウント
アップする。
【0079】次のステップ101では、時点[j,k]
における回転体の制御トルクTq [j,k]を検出す
る。制御トルクは、回転体を制御するために加えられる
トルクであり、回転体が電動機の電動子の場合は、時点
[j,k]の電動子電流をセンサ等で検出し検出値に制
御トルクへの変換係数を乗ずることによって得られる。
また、回転体が車両の車輪の場合は、ホイールシリンダ
圧を検出し、検出値にブレーキトルクへの変換係数を乗
ずることによって得られる。そして、次のステップ10
2では、誤差修正判断手段34が、時点[j,k−1]
と[j,k]との間でパルスジェネレータ37から発生
したパルス数np を読み込む。
における回転体の制御トルクTq [j,k]を検出す
る。制御トルクは、回転体を制御するために加えられる
トルクであり、回転体が電動機の電動子の場合は、時点
[j,k]の電動子電流をセンサ等で検出し検出値に制
御トルクへの変換係数を乗ずることによって得られる。
また、回転体が車両の車輪の場合は、ホイールシリンダ
圧を検出し、検出値にブレーキトルクへの変換係数を乗
ずることによって得られる。そして、次のステップ10
2では、誤差修正判断手段34が、時点[j,k−1]
と[j,k]との間でパルスジェネレータ37から発生
したパルス数np を読み込む。
【0080】ところで、既に述べたように、回転体の角
加速度は、制御トルクと回転体に加わる外乱Td との総
和トルクを回転体の慣性モーメントで割ることによって
求まり、回転体の角速度は、この角速度を時間積分する
ことによって求まり、回転体の回転位置は、さらに角速
度を時間積分することによって求まる。
加速度は、制御トルクと回転体に加わる外乱Td との総
和トルクを回転体の慣性モーメントで割ることによって
求まり、回転体の角速度は、この角速度を時間積分する
ことによって求まり、回転体の回転位置は、さらに角速
度を時間積分することによって求まる。
【0081】そこで、状態推定手段32が、ステップ1
04において、ステップ101で得られた制御トルクと
外乱トルクの推定値とから回転体に加わる総和トルクを
(4)式により演算する。なお、外乱トルクの推定値は、
後述するように、誤差修正演算により修正されて真の外
乱トルクに接近するが、誤差修正演算を初めて実行する
前の外乱トルクの初期値は、他の方法により検出された
値を用いても良い。
04において、ステップ101で得られた制御トルクと
外乱トルクの推定値とから回転体に加わる総和トルクを
(4)式により演算する。なお、外乱トルクの推定値は、
後述するように、誤差修正演算により修正されて真の外
乱トルクに接近するが、誤差修正演算を初めて実行する
前の外乱トルクの初期値は、他の方法により検出された
値を用いても良い。
【0082】次のステップ105では、状態推定手段3
2が、上記の(5) 、(6) 式により台形積分を用いて回転
体の速度の推定値及び回転位置の推定値を演算する。
2が、上記の(5) 、(6) 式により台形積分を用いて回転
体の速度の推定値及び回転位置の推定値を演算する。
【0083】次のステップ106では、誤差修正判断手
段34が、時点[j,0]から時点[j,k]までの間
にパルスジェネレータ37が出力したパルス数の総和n
を演算する。この演算では、ステップ102で読み込ま
れたパルス数npを、パルス数nに累積的に加算する
(n←n+np)。そして、ステップ107及びステッ
プ108において誤差修正判断を行う。
段34が、時点[j,0]から時点[j,k]までの間
にパルスジェネレータ37が出力したパルス数の総和n
を演算する。この演算では、ステップ102で読み込ま
れたパルス数npを、パルス数nに累積的に加算する
(n←n+np)。そして、ステップ107及びステッ
プ108において誤差修正判断を行う。
【0084】すなわち、ステップ107では、インデッ
クスkが規定値M以上となったか否かを判定し、否定判
定であれば、再びステップ100から同様の演算を繰り
返す。演算の繰り返しによりkが増加し、やがてステッ
プ107で肯定判定となったとき、ステップ108にお
いて、ステップ106で加算されるパルス数の総和nが
規定値N以上であるか否かを判定する。ステップ108
が否定判定であれば、再びステップ100から同様の演
算を繰り返す。このループを繰り返し演算中にパルス数
が増加し、やがてステップ108で肯定判定となったと
き、検出位置補正手段60による位置補正演算を行う。
クスkが規定値M以上となったか否かを判定し、否定判
定であれば、再びステップ100から同様の演算を繰り
返す。演算の繰り返しによりkが増加し、やがてステッ
プ107で肯定判定となったとき、ステップ108にお
いて、ステップ106で加算されるパルス数の総和nが
規定値N以上であるか否かを判定する。ステップ108
が否定判定であれば、再びステップ100から同様の演
算を繰り返す。このループを繰り返し演算中にパルス数
が増加し、やがてステップ108で肯定判定となったと
き、検出位置補正手段60による位置補正演算を行う。
【0085】すなわち、最初1にセットされたインデッ
クスkがM以上となるまでの間にカウントされたパルス
数の総和nがN以上となったときに、誤差修正のタイミ
ングとみなして以下の位置補正演算を実行する。なお、
上記の規定値M、Nの値は、制御周期T2 の長さやパル
スジェネレータ37の分解能などに応じて任意好適に定
められる。
クスkがM以上となるまでの間にカウントされたパルス
数の総和nがN以上となったときに、誤差修正のタイミ
ングとみなして以下の位置補正演算を実行する。なお、
上記の規定値M、Nの値は、制御周期T2 の長さやパル
スジェネレータ37の分解能などに応じて任意好適に定
められる。
【0086】位置補正演算では、以下のような演算を行
う。すなわち、ステップ110において、検出位置補正
手段60が、パルス間隔記憶手段56に記憶されている
1パルス前のパルス間隔を読み込む。なお、このパルス
間隔を以下ではTp [l]として説明する。このパルス
間隔Tp [l]は、図4に示すように、誤差修正時点の
直前に発生したパルスlと、該パルスlの直前に発生し
たパルス(l−1)との時間間隔を表している。
う。すなわち、ステップ110において、検出位置補正
手段60が、パルス間隔記憶手段56に記憶されている
1パルス前のパルス間隔を読み込む。なお、このパルス
間隔を以下ではTp [l]として説明する。このパルス
間隔Tp [l]は、図4に示すように、誤差修正時点の
直前に発生したパルスlと、該パルスlの直前に発生し
たパルス(l−1)との時間間隔を表している。
【0087】なお、パルス間隔計測手段54は、上記ス
テップ100〜ステップ108の処理が実行されている
間に、パルス間隔を計測しており、この計測値をパルス
間隔記憶手段56に順次出力している。パルス間隔記憶
手段56では、記憶している値を入力された値に順次更
新するので、パルス間隔記憶手段56には、1パルス前
のパルス間隔Tp [l]が常に格納されていることにな
る。
テップ100〜ステップ108の処理が実行されている
間に、パルス間隔を計測しており、この計測値をパルス
間隔記憶手段56に順次出力している。パルス間隔記憶
手段56では、記憶している値を入力された値に順次更
新するので、パルス間隔記憶手段56には、1パルス前
のパルス間隔Tp [l]が常に格納されていることにな
る。
【0088】そして、ステップ120では、時間差計測
手段58が、誤差修正タイミングの制御時点と、該制御
時点の直前にパルスジェネレータ37が生成したパルス
の出力時点(位置θ[l]、θ[j+1]の検出時点)
との間の時間差Δtを計測し、検出位置補正手段60
が、時間差計測手段58により計測された時間差Δtを
読み込む。
手段58が、誤差修正タイミングの制御時点と、該制御
時点の直前にパルスジェネレータ37が生成したパルス
の出力時点(位置θ[l]、θ[j+1]の検出時点)
との間の時間差Δtを計測し、検出位置補正手段60
が、時間差計測手段58により計測された時間差Δtを
読み込む。
【0089】次に、ステップ122では、検出位置補正
手段60が検出位置記憶手段52に記憶されている検出
位置θ[j+1]を読み込む。なお、位置θ[j+1]
は、位置検出手段38が、 θ[j+1,0]=θ[j,0]+nθs (27) に従って演算する。ここに、θs は位置検出器から発生
する1 パルス当たりの回転角である。但し、(27)式によ
り得られた位置θ[j+1]がθ1 以上となった場合、
(27)式の演算値から回転体の1回転分の回転角θ1 (ラ
ジアンの単位で表現すれば、θ1 =2π[rad])が
減算される。この処理を施すことによって、位置は常に
手段60が検出位置記憶手段52に記憶されている検出
位置θ[j+1]を読み込む。なお、位置θ[j+1]
は、位置検出手段38が、 θ[j+1,0]=θ[j,0]+nθs (27) に従って演算する。ここに、θs は位置検出器から発生
する1 パルス当たりの回転角である。但し、(27)式によ
り得られた位置θ[j+1]がθ1 以上となった場合、
(27)式の演算値から回転体の1回転分の回転角θ1 (ラ
ジアンの単位で表現すれば、θ1 =2π[rad])が
減算される。この処理を施すことによって、位置は常に
【0090】
【数16】
【0091】の範囲に入るため、θ[j+1]のオーバ
ーフローを防ぐことができる。次に、ステップ123で
は、上記ステップで得られたTp [l]及びΔtに基づ
いて検出位置θ[j+1,0]を次式のように補正す
る。
ーフローを防ぐことができる。次に、ステップ123で
は、上記ステップで得られたTp [l]及びΔtに基づ
いて検出位置θ[j+1,0]を次式のように補正す
る。
【0092】
【数17】
【0093】なお、ステップ123で、誤差修正時点毎
のパルス間隔Tw を用いて補正するようにしても良い。
この場合、ステップ110において、検出位置補正手段
60が直前のパルス間隔Tw [j+1]を読み出し、検
出位置θ[j+1](=θ[l])を
のパルス間隔Tw を用いて補正するようにしても良い。
この場合、ステップ110において、検出位置補正手段
60が直前のパルス間隔Tw [j+1]を読み出し、検
出位置θ[j+1](=θ[l])を
【0094】
【数18】
【0095】のように補正する。以降のステップでは、
検出位置補正手段60が誤差修正演算を実施するが、誤
差修正周期T1 は制御周期T2 のk倍となっているの
で、まず、ステップ126において、次式により誤差修
正周期T1 を求める。
検出位置補正手段60が誤差修正演算を実施するが、誤
差修正周期T1 は制御周期T2 のk倍となっているの
で、まず、ステップ126において、次式により誤差修
正周期T1 を求める。
【0096】 T1 = kT2 (30) 次に、ステップ128で、
【0097】
【数19】
【0098】より、補正した検出位置と推定位置との差
を計算する。そして、ステップ130では、(31)式で求
められた差Δθに基づいて、次の時点[j+1,0]か
ら状態推定手段32で用いられる位置、速度、外乱の各
推定値の初期値を、次のように修正する。
を計算する。そして、ステップ130では、(31)式で求
められた差Δθに基づいて、次の時点[j+1,0]か
ら状態推定手段32で用いられる位置、速度、外乱の各
推定値の初期値を、次のように修正する。
【0099】
【数20】
【0100】ここに、λは誤差の分配を行うための重み
係数ベクトルで、所定のオブザーバの推定特性を有する
ように設計される。
係数ベクトルで、所定のオブザーバの推定特性を有する
ように設計される。
【0101】そして、ステップ132では、誤差修正タ
イミングのインデックスjを1つカウントアップすると
同時に、ステップ134、ステップ136において、k
及びnを零にリセットし、ステップ100に戻り再び繰
り返しループの演算を実行する。 (第2の実施の形態)次に、第2の実施の形態に係る回
転速度検出装置を説明する。なお、第2の実施の形態の
構成は、第1の実施の形態と同様であるので、同一の符
号を付して詳細な説明を省略する。但し、パルス間隔記
憶手段56は、過去Mp パルスまでのパルス間隔を記憶
する機能を有するとする。
イミングのインデックスjを1つカウントアップすると
同時に、ステップ134、ステップ136において、k
及びnを零にリセットし、ステップ100に戻り再び繰
り返しループの演算を実行する。 (第2の実施の形態)次に、第2の実施の形態に係る回
転速度検出装置を説明する。なお、第2の実施の形態の
構成は、第1の実施の形態と同様であるので、同一の符
号を付して詳細な説明を省略する。但し、パルス間隔記
憶手段56は、過去Mp パルスまでのパルス間隔を記憶
する機能を有するとする。
【0102】第2の実施の形態は、過去数パルスの時間
間隔から検出位置の位置平均変化量を求め、該位置平均
変化量より検出位置を補正するものであり、その作用
は、図6のフローチャートに示されている。なお、図6
では、図5と同様の作用部分については同一のステップ
番号を付して詳細な説明を省略し、異なる作用部分につ
いてのみ説明する。
間隔から検出位置の位置平均変化量を求め、該位置平均
変化量より検出位置を補正するものであり、その作用
は、図6のフローチャートに示されている。なお、図6
では、図5と同様の作用部分については同一のステップ
番号を付して詳細な説明を省略し、異なる作用部分につ
いてのみ説明する。
【0103】図6のフローチャートに示すように、誤差
修正タイミングと判断されたとき(ステップ108肯定
判定)、ステップ112において、検出位置補正手段6
0が、パルス間隔記憶手段56に記憶されている過去M
p パルスまでのパルス間隔を読み込む。そして、ステッ
プ120でΔtの読み込み、ステップ122で検出位置
θ[j+1]の読み込みを行った後、ステップ124に
おいて、次のように検出位置θの補正を行う。
修正タイミングと判断されたとき(ステップ108肯定
判定)、ステップ112において、検出位置補正手段6
0が、パルス間隔記憶手段56に記憶されている過去M
p パルスまでのパルス間隔を読み込む。そして、ステッ
プ120でΔtの読み込み、ステップ122で検出位置
θ[j+1]の読み込みを行った後、ステップ124に
おいて、次のように検出位置θの補正を行う。
【0104】
【数21】
【0105】なお、ステップ124の補正は、誤差修正
時点毎のパルス間隔Tw に基づいて行っても良い。この
場合は、パルス間隔計測手段54が誤差修正時点毎のパ
ルス間隔Tw を計測し、パルス間隔記憶手段56が、M
p 回過去のパルス間隔Tw を記憶するように構成する。
そして、ステップ112において、検出位置補正手段6
0が、パルス間隔記憶手段56からMp 回過去のパルス
間隔Tw を読み出し、ステップ124において、次のよ
うに検出位置θの補正を行う。
時点毎のパルス間隔Tw に基づいて行っても良い。この
場合は、パルス間隔計測手段54が誤差修正時点毎のパ
ルス間隔Tw を計測し、パルス間隔記憶手段56が、M
p 回過去のパルス間隔Tw を記憶するように構成する。
そして、ステップ112において、検出位置補正手段6
0が、パルス間隔記憶手段56からMp 回過去のパルス
間隔Tw を読み出し、ステップ124において、次のよ
うに検出位置θの補正を行う。
【0106】
【数22】
【0107】ここに、na は時点[j−Mp ]から[j
+1]までに発生したパルス数である。 (第3の実施の形態)次に、第3の実施の形態に係る回
転速度検出装置を説明する。なお、第3の実施の形態の
構成は、第1の実施の形態と同様であるので、同一の符
号を付して詳細な説明を省略する。但し、パルス間隔記
憶手段56は、過去Mp パルスまでのパルス間隔を記憶
し、検出位置記憶手段52は、過去Mp パルスまでの検
出位置を記憶するものとする。
+1]までに発生したパルス数である。 (第3の実施の形態)次に、第3の実施の形態に係る回
転速度検出装置を説明する。なお、第3の実施の形態の
構成は、第1の実施の形態と同様であるので、同一の符
号を付して詳細な説明を省略する。但し、パルス間隔記
憶手段56は、過去Mp パルスまでのパルス間隔を記憶
し、検出位置記憶手段52は、過去Mp パルスまでの検
出位置を記憶するものとする。
【0108】第3の実施の形態は、過去数パルスの時間
間隔を用いて、時間に対する真の変化を多項式で近似
し、検出位置を補正するものであり、その作用は、図7
のフローチャートに示されている。なお、図7では、図
5及び図6と同様の作用部分については同一のステップ
番号を付して詳細な説明を省略し、異なる作用部分につ
いてのみ説明する。
間隔を用いて、時間に対する真の変化を多項式で近似
し、検出位置を補正するものであり、その作用は、図7
のフローチャートに示されている。なお、図7では、図
5及び図6と同様の作用部分については同一のステップ
番号を付して詳細な説明を省略し、異なる作用部分につ
いてのみ説明する。
【0109】図7のフローチャートに示すように、誤差
修正タイミングと判断されたとき(ステップ108肯定
判定)、ステップ112において、検出位置補正手段6
0が、パルス間隔記憶手段56に記憶されている現パル
スを含む過去Mp パルスまでのパルス発生間隔を読み込
む。また、ステップ114において、検出位置補正手段
60が、検出位置記憶手段52に記憶されている現パル
スから過去Mp パルスまでのパルス毎の検出位置を読み
込む。次に、ステップ120において、時間差計測手段
58から出力された時間差Δtの読み込みを行った後、
ステップ125において、ステップ112〜120で得
られた情報に基づいて検出位置θの補正を行う。
修正タイミングと判断されたとき(ステップ108肯定
判定)、ステップ112において、検出位置補正手段6
0が、パルス間隔記憶手段56に記憶されている現パル
スを含む過去Mp パルスまでのパルス発生間隔を読み込
む。また、ステップ114において、検出位置補正手段
60が、検出位置記憶手段52に記憶されている現パル
スから過去Mp パルスまでのパルス毎の検出位置を読み
込む。次に、ステップ120において、時間差計測手段
58から出力された時間差Δtの読み込みを行った後、
ステップ125において、ステップ112〜120で得
られた情報に基づいて検出位置θの補正を行う。
【0110】検出位置θの補正では、l番目のパルスが
発生した時刻をtl とし、ある時刻tにおける位置θ
(t)は、ラグランジュの補間公式を用いると以下のよ
うに求めることができる。
発生した時刻をtl とし、ある時刻tにおける位置θ
(t)は、ラグランジュの補間公式を用いると以下のよ
うに求めることができる。
【0111】
【数23】
【0112】ここに、
【0113】
【数24】
【0114】である。具体例として、Mp =2の場合に
ついて説明する。誤差修正時点[j+1]における時刻
が、 t = Δt + tl (37) であることを用いる。パルス間隔記憶手段56から読み
出した過去2パルスのパルス間隔Tp [l−1]、Tp
[l]、及び検出位置記憶手段52から読み出した過去
2パルス発生時の位置θ(l)、θ(l−1)、θ(l
−2)に基づいて、時間に対する真の位置の変化を2次
の多項式で近似するよう(35)、(36)式を適用すると、次
式の補正式が得られる。
ついて説明する。誤差修正時点[j+1]における時刻
が、 t = Δt + tl (37) であることを用いる。パルス間隔記憶手段56から読み
出した過去2パルスのパルス間隔Tp [l−1]、Tp
[l]、及び検出位置記憶手段52から読み出した過去
2パルス発生時の位置θ(l)、θ(l−1)、θ(l
−2)に基づいて、時間に対する真の位置の変化を2次
の多項式で近似するよう(35)、(36)式を適用すると、次
式の補正式が得られる。
【0115】 θ* =θ(l−2)Ll-2 +θ(l−1)Ll-1 +θ(l)Ll (38) θ(l)はパルスlのときの検出位置を表しているの
で、 θ[l] = θ[j+1] (39) である。また、
で、 θ[l] = θ[j+1] (39) である。また、
【0116】
【数25】
【0117】である。1パルス当たりの回転角がθs で
あることを用いると、上記補正式は次式のように整理さ
れる。
あることを用いると、上記補正式は次式のように整理さ
れる。
【0118】
【数26】
【0119】補正式は、(38)式及び(40)式〜(42)式を用
いても、或いは(43)式を用いても良い。また、ここでは
Mp =2について説明したが、Mp =2以外の数値でも
補正が可能であることは勿論である。
いても、或いは(43)式を用いても良い。また、ここでは
Mp =2について説明したが、Mp =2以外の数値でも
補正が可能であることは勿論である。
【0120】なお、上記例では、パルス発生毎の時間間
隔及び位置を用いて補正を行ったが、誤差修正時点毎の
パルス発生間隔及び位置を用いて補正を行っても良い。
この場合は、過去Mp 回(例としてMp =2とする)ま
での誤差修正時点の直前に発生したパルスの間のパルス
間隔Tw [j]、Tw [j+1]をパルス間隔記憶手段
56から読み出し、さらに、誤差修正時点の直前のパル
ス発生時における誤差修正時点毎の検出位置θ[j+
1]、θ[j]、θ[j−1]も検出位置記憶手段52
から読み出し、これらの情報を使って、時間に対する真
の位置の変化を2次の多項式で近似するように(35)式、
(36)式を適用する。これにより、次式の補正式が得られ
る。
隔及び位置を用いて補正を行ったが、誤差修正時点毎の
パルス発生間隔及び位置を用いて補正を行っても良い。
この場合は、過去Mp 回(例としてMp =2とする)ま
での誤差修正時点の直前に発生したパルスの間のパルス
間隔Tw [j]、Tw [j+1]をパルス間隔記憶手段
56から読み出し、さらに、誤差修正時点の直前のパル
ス発生時における誤差修正時点毎の検出位置θ[j+
1]、θ[j]、θ[j−1]も検出位置記憶手段52
から読み出し、これらの情報を使って、時間に対する真
の位置の変化を2次の多項式で近似するように(35)式、
(36)式を適用する。これにより、次式の補正式が得られ
る。
【0121】
【数27】
【0122】ここに、
【0123】
【数28】
【0124】である。 (第4の実施の形態)本発明の検出位置補正装置が適用
された第4の実施の形態に係るタイヤ発生力検出装置の
構成ブロックを図2に示す。同図に示すように、本タイ
ヤ発生力検出装置は、図1の回転速度検出装置と同様の
構成要件(同一符号)と共に、さらに、推定誤差修正手
段36により修正された外乱トルクの推定値を、タイヤ
と路面との間に発生するタイヤ発生力(制動力)として
検出するタイヤ発生力推定手段40と、を備えている。
された第4の実施の形態に係るタイヤ発生力検出装置の
構成ブロックを図2に示す。同図に示すように、本タイ
ヤ発生力検出装置は、図1の回転速度検出装置と同様の
構成要件(同一符号)と共に、さらに、推定誤差修正手
段36により修正された外乱トルクの推定値を、タイヤ
と路面との間に発生するタイヤ発生力(制動力)として
検出するタイヤ発生力推定手段40と、を備えている。
【0125】図2のタイヤ発生力検出装置では、上記各
実施の形態の回転速度検出装置と同様に、図5乃至図7
のいずれかのフローチャートに従って、位置、速度、外
乱トルクの修正を行う。そして、タイヤ発生力推定手段
40は、状態推定手段32により推定された外乱トルク
Td [j,k]に基づいて以下のように制動力を推定す
る。なお、この制動力推定は、図5乃至図7のフローチ
ャートのステップ104で外乱トルクを加算する処理よ
り前に実行される。
実施の形態の回転速度検出装置と同様に、図5乃至図7
のいずれかのフローチャートに従って、位置、速度、外
乱トルクの修正を行う。そして、タイヤ発生力推定手段
40は、状態推定手段32により推定された外乱トルク
Td [j,k]に基づいて以下のように制動力を推定す
る。なお、この制動力推定は、図5乃至図7のフローチ
ャートのステップ104で外乱トルクを加算する処理よ
り前に実行される。
【0126】車輪の制動時の運動方程式は、
【0127】
【数29】
【0128】で表せる。ここに、Wは輪荷重、Pはホイ
ールシリンダ圧、Kはホイールシリンダ圧から制動トル
クTb への変換係数である。今、ステップ101の制御
トルク( 制動トルク) 検出において、 Tq = −KP (48) と制動トルクが検出されるので、
ールシリンダ圧、Kはホイールシリンダ圧から制動トル
クTb への変換係数である。今、ステップ101の制御
トルク( 制動トルク) 検出において、 Tq = −KP (48) と制動トルクが検出されるので、
【0129】
【数30】
【0130】という関係が成り立ち、外乱トルクの推定
値が制動力μWにタイヤの動荷重半径Rを乗じたものに
対応していることがわかる。そこで、ステップ104に
おいて、外乱トルクの推定値からタイヤ動荷重半径Rを
割れば制動力μWを推定することができる。
値が制動力μWにタイヤの動荷重半径Rを乗じたものに
対応していることがわかる。そこで、ステップ104に
おいて、外乱トルクの推定値からタイヤ動荷重半径Rを
割れば制動力μWを推定することができる。
【0131】さらに、輪荷重Wをセンサや演算等により
検出すれば、タイヤと路面間の摩擦係数μも推定するこ
とができる。推定した制動力、摩擦係数等は、アンチス
キッド装置や車両安定化制御装置などに用いることがで
きる。
検出すれば、タイヤと路面間の摩擦係数μも推定するこ
とができる。推定した制動力、摩擦係数等は、アンチス
キッド装置や車両安定化制御装置などに用いることがで
きる。
【0132】このように本実施の形態では、位置補正手
段により補正された回転位置を用いて、外乱トルクの推
定値及び回転速度の初期値を修正するため、位置検出時
点と誤差修正時点とのずれによって生じる量子化誤差が
軽減され、高精度にタイヤ発生力を検出できる。特に、
演算デバイスの能力によって制御系の制御周期が十分に
短くできず、よって、回転位置の量子化誤差が増大する
場合においても、正確にタイヤ発生力を推定することが
できると共に、量子化ノイズの増大、パラメータ変動に
対するロバスト性の劣化、及びオブザーバの不安定化な
どを防止することができる。
段により補正された回転位置を用いて、外乱トルクの推
定値及び回転速度の初期値を修正するため、位置検出時
点と誤差修正時点とのずれによって生じる量子化誤差が
軽減され、高精度にタイヤ発生力を検出できる。特に、
演算デバイスの能力によって制御系の制御周期が十分に
短くできず、よって、回転位置の量子化誤差が増大する
場合においても、正確にタイヤ発生力を推定することが
できると共に、量子化ノイズの増大、パラメータ変動に
対するロバスト性の劣化、及びオブザーバの不安定化な
どを防止することができる。
【0133】以上が、本発明の各実施の形態であるが、
上記例にのみ限定されるものではない。例えば、本発明
の検出位置補正装置を、回転速度検出装置やタイヤ発生
力検出装置に適用したが、検出された位置に基づいて、
各制御時点で処理を行う他の装置にも適用可能である。
上記例にのみ限定されるものではない。例えば、本発明
の検出位置補正装置を、回転速度検出装置やタイヤ発生
力検出装置に適用したが、検出された位置に基づいて、
各制御時点で処理を行う他の装置にも適用可能である。
【0134】また、検出位置補正手段による位置の補正
において、上記例以外の他の補間方法を用いることも可
能である。
において、上記例以外の他の補間方法を用いることも可
能である。
【0135】
【実施例】以下、図面を参照して、本発明の実施例に係
る検出位置補正装置の動作実験結果を説明する。
る検出位置補正装置の動作実験結果を説明する。
【0136】本動作実験では、制動時の車両の車輪速度
を検出する回転速度検出装置に本発明を適用し、50k
m/hで定速走行している状態から、ステップ状に制動
トルクを印加し、そのときの車両の前輪の瞬時速度を検
出している。なお、本実施例では、図5乃至図7のいず
れかのフローチャートに基づいて回転速度を検出する
が、動作実験では、フローチャートにおいてM=1、N
=1とし、制御周期T2を5msecとしている。
を検出する回転速度検出装置に本発明を適用し、50k
m/hで定速走行している状態から、ステップ状に制動
トルクを印加し、そのときの車両の前輪の瞬時速度を検
出している。なお、本実施例では、図5乃至図7のいず
れかのフローチャートに基づいて回転速度を検出する
が、動作実験では、フローチャートにおいてM=1、N
=1とし、制御周期T2を5msecとしている。
【0137】以下、この動作実験の結果について図8
(a)、(b)を用いて説明する。図8(a)には、本
実施例との比較のため、検出位置補正装置により位置補
正を行わなかった場合の車輪速度の推定結果が示されて
いる(横軸が時間軸)。同図において、真の速度値が破
線で、推定値が実線で示されている。
(a)、(b)を用いて説明する。図8(a)には、本
実施例との比較のため、検出位置補正装置により位置補
正を行わなかった場合の車輪速度の推定結果が示されて
いる(横軸が時間軸)。同図において、真の速度値が破
線で、推定値が実線で示されている。
【0138】図8(a)に示すように、位置補正無しの
場合の推定値は、振動成分を多く含み、推定誤差が大き
いことがわかる。これは、誤差修正時点とパルス発生時
点との間の時間差が無視できないほど大きく、検出位置
の量子化ノイズが増大しているためと思われる。
場合の推定値は、振動成分を多く含み、推定誤差が大き
いことがわかる。これは、誤差修正時点とパルス発生時
点との間の時間差が無視できないほど大きく、検出位置
の量子化ノイズが増大しているためと思われる。
【0139】これに対し、図8(b)には、本実施例の
検出位置補正装置を実施した場合の車輪速度推定結果が
示されている。同図においても、真の速度値が破線で、
推定値が実線で示されている。
検出位置補正装置を実施した場合の車輪速度推定結果が
示されている。同図においても、真の速度値が破線で、
推定値が実線で示されている。
【0140】図8(b)に示すように、真値と推定値と
が各時間領域でほとんど一致しており、補正無しと比べ
てはるかに良好に車輪速度を推定できることがわかっ
た。これは、誤差修正時点とパルス発生時点の時間差を
計測して検出位置を補正することにより、検出位置の量
子化ノイズによる推定誤差を抑制できたためと思われ
る。
が各時間領域でほとんど一致しており、補正無しと比べ
てはるかに良好に車輪速度を推定できることがわかっ
た。これは、誤差修正時点とパルス発生時点の時間差を
計測して検出位置を補正することにより、検出位置の量
子化ノイズによる推定誤差を抑制できたためと思われ
る。
【0141】以上の実験結果より、本発明の有効性が明
らかになった。
らかになった。
【0142】
【発明の効果】以上説明したように請求項1の発明によ
れば、回転位置の時間系列、パルス間隔の時間系列、及
び回転位置が検出された現時点と制御時点との時間差に
基づいて、現時点で検出された回転位置を、制御時点の
回転位置に補正するようにしたので、検出された現時点
の回転位置の量子化誤差をきわめて良好に低減すること
ができる。特に、制御系の制御周期が長く、パルス発生
時点と制御時点の時刻のずれが無視できないような状況
においても、検出位置を正確に補正できるので、検出位
置に基づいて外乱トルク、回転位置、回転速度等の瞬時
値を推定する装置に本発明を適用した場合に、補正無し
と比べてはるかに良好に各瞬時値を推定することができ
るという優れた効果がある。
れば、回転位置の時間系列、パルス間隔の時間系列、及
び回転位置が検出された現時点と制御時点との時間差に
基づいて、現時点で検出された回転位置を、制御時点の
回転位置に補正するようにしたので、検出された現時点
の回転位置の量子化誤差をきわめて良好に低減すること
ができる。特に、制御系の制御周期が長く、パルス発生
時点と制御時点の時刻のずれが無視できないような状況
においても、検出位置を正確に補正できるので、検出位
置に基づいて外乱トルク、回転位置、回転速度等の瞬時
値を推定する装置に本発明を適用した場合に、補正無し
と比べてはるかに良好に各瞬時値を推定することができ
るという優れた効果がある。
【0143】また、請求項2の発明によれば、回転位置
の時間系列、パルス間隔の時間系列、及び回転位置が検
出された現時点と制御時点との時間差に基づいて補正さ
れた回転位置を用いて、外乱トルクの推定値及び回転速
度の初期値を修正するため、位置検出時点と誤差修正時
点とのずれによって生じる量子化誤差がきわめて良好に
軽減され、高精度に回転速度を検出できる、という効果
が得られる。特に、演算デバイスの能力によって制御系
の制御周期が十分に短くできず、よって、回転位置の量
子化誤差が増大する場合においても、補正無しと比べて
はるかに良好に回転速度を推定することができると共
に、量子化ノイズの増大、パラメータ変動に対するロバ
スト性の劣化、及びオブザーバの不安定化などを防止す
ることができる。
の時間系列、パルス間隔の時間系列、及び回転位置が検
出された現時点と制御時点との時間差に基づいて補正さ
れた回転位置を用いて、外乱トルクの推定値及び回転速
度の初期値を修正するため、位置検出時点と誤差修正時
点とのずれによって生じる量子化誤差がきわめて良好に
軽減され、高精度に回転速度を検出できる、という効果
が得られる。特に、演算デバイスの能力によって制御系
の制御周期が十分に短くできず、よって、回転位置の量
子化誤差が増大する場合においても、補正無しと比べて
はるかに良好に回転速度を推定することができると共
に、量子化ノイズの増大、パラメータ変動に対するロバ
スト性の劣化、及びオブザーバの不安定化などを防止す
ることができる。
【図1】本発明の実施の形態に係る検出位置補正装置が
適用された回転速度検出装置の構成を示すブロック図で
ある。
適用された回転速度検出装置の構成を示すブロック図で
ある。
【図2】本発明の実施の形態に係る検出位置補正装置が
適用されたタイヤ発生力検出装置の構成を示すブロック
図である。
適用されたタイヤ発生力検出装置の構成を示すブロック
図である。
【図3】本発明の位置読み込みのタイミングを示すタイ
ミングチャートである。
ミングチャートである。
【図4】本発明の実施の形態の位置読み込みのタイミン
グを示すタイミングチャートである。
グを示すタイミングチャートである。
【図5】本発明の第1の実施の形態に係る回転速度検出
装置の処理の流れを示すフローチャートである。
装置の処理の流れを示すフローチャートである。
【図6】本発明の第2の実施の形態に係る回転速度検出
装置の処理の流れを示すフローチャートである。
装置の処理の流れを示すフローチャートである。
【図7】本発明の第3の実施の形態に係る回転速度検出
装置の処理の流れを示すフローチャートである。
装置の処理の流れを示すフローチャートである。
【図8】本発明の実施例に係る検出位置補正装置が適用
された回転速度検出装置の回転速度の推定結果を示す図
であって、(a)は位置補正無しの場合の推定結果、
(b)は位置補正した場合の推定結果を示す。
された回転速度検出装置の回転速度の推定結果を示す図
であって、(a)は位置補正無しの場合の推定結果、
(b)は位置補正した場合の推定結果を示す。
【図9】従来の瞬時速度オブザーバの構成を示すブロッ
ク図である。
ク図である。
【図10】従来の瞬時速度オブザーバの位置読み込みタ
イミングを示す図である。
イミングを示す図である。
【図11】従来の瞬時速度オブザーバの位置読み込みタ
イミングと誤差修正タイミングのずれを説明するための
図である。
イミングと誤差修正タイミングのずれを説明するための
図である。
30 制御トルク検出手段 32 状態推定手段 34 誤差修正判断手段 36 推定誤差修正手段 37 パルスジェネレータ 38 位置検出手段 40 タイヤ発生力推定手段 50 検出位置補正装置 52 検出位置記憶手段 54 パルス間隔計測手段 56 パルス間隔記憶手段 58 時間差計測手段 60 検出位置補正手段
───────────────────────────────────────────────────── フロントページの続き (56)参考文献 特開 平4−281381(JP,A) 特開 平8−51788(JP,A) 特開 平7−337100(JP,A) (58)調査した分野(Int.Cl.7,DB名) H02P 5/00 G01P 3/489
Claims (2)
- 【請求項1】 回転体に設置されたパルス生成器が出力
したパルスの計数値に基づいて該回転体の回転位置を検
出する位置検出手段と、 前記パルス生成器により出力されたパルスのパルス間隔
を計測するパルス間隔計測手段と、 回転位置が検出された現時点と、該現時点後に指定され
た制御時点との時間差を計測する時間差計測手段と、 前記位置検出手段により1又は複数の検出時点で検出さ
れた回転位置の時間系列、前記パルス間隔計測手段によ
り1又は複数の計測時点で計測されたパルス間隔の時間
系列、及び前記時間差計測手段により計測された時間差
に基づいて、現時点で検出された回転位置を、回転位置
の変化量を直線で近似するか、又はパルス間隔を用いて
時間に対する制御時点の回転位置の変化を多項式で近似
して、前記制御時点の回転位置に補正する検出位置補正
手段と、 を含む検出位置補正装置。 - 【請求項2】 回転体に設置されたパルス生成器が出力
したパルスの計数値に基づいて該回転体の回転位置を検
出する位置検出手段と、 回転体を制御するための制御トルクを検出する制御トル
ク検出手段と、 前記制御トルク検出手段により検出された値の制御トル
ク及び推定された値の外乱トルクが作用する回転体のモ
デルに基づいて、与えられた回転速度及び回転位置の各
初期値とから回転体の回転速度及び回転位置を推定する
状態推定手段と、 少なくとも前記パルス生成器により出力されたパルスの
数に基づいて、誤差修正時点を判断する誤差修正判断手
段と、 前記パルス生成器により出力されたパルスのパルス間隔
を計測するパルス間隔計測手段と、 回転位置が検出された現時点と、該現時点後に前記誤差
修正判断手段により判断された誤差修正時点との時間差
を計測する時間差計測手段と、 前記位置検出手段により1又は複数の検出時点で検出さ
れた回転位置の時間系列、前記パルス間隔計測手段によ
り1又は複数の計測時点で計測されたパルス間隔の時間
系列、及び前記時間差計測手段により計測された時間差
に基づいて、現時点で検出された回転位置を、回転位置
の変化量を直線で近似するか、又はパルス間隔を用いて
時間に対する誤差修正時点の回転位置の変化を多項式で
近似して、前記誤差修正時点の回転位置に補正する検出
位置補正手段と、 前記誤差修正時点において、前記位置補正手段により補
正された回転位置と前記状態推定手段により推定された
回転位置との間に生じた位置の誤差に基づいて、少なく
とも前記外乱トルクの推定値及び回転速度の初期値を修
正する推定誤差修正手段と、 を含む回転速度検出装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP06647297A JP3277454B2 (ja) | 1997-03-19 | 1997-03-19 | 検出位置補正装置及び回転速度検出装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP06647297A JP3277454B2 (ja) | 1997-03-19 | 1997-03-19 | 検出位置補正装置及び回転速度検出装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH10262387A JPH10262387A (ja) | 1998-09-29 |
JP3277454B2 true JP3277454B2 (ja) | 2002-04-22 |
Family
ID=13316771
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP06647297A Expired - Fee Related JP3277454B2 (ja) | 1997-03-19 | 1997-03-19 | 検出位置補正装置及び回転速度検出装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3277454B2 (ja) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4459463B2 (ja) * | 2001-02-19 | 2010-04-28 | 株式会社ハーモニック・ドライブ・システムズ | アクチュエータの位置決め誤差補正方法 |
KR100661106B1 (ko) * | 2002-04-05 | 2006-12-26 | 미쓰비시덴키 가부시키가이샤 | 모터의 제어장치 |
JP4007197B2 (ja) | 2003-01-16 | 2007-11-14 | トヨタ自動車株式会社 | モータ制御装置 |
JP5275765B2 (ja) * | 2008-11-28 | 2013-08-28 | 日本電産コパル株式会社 | モータ回転数予測装置 |
GB2478989A (en) * | 2010-03-26 | 2011-09-28 | Gm Global Tech Operations Inc | Determining speed of a multi-tooth wheel |
JP5780473B2 (ja) | 2011-12-14 | 2015-09-16 | 株式会社安川電機 | モータ制御装置及びモータシステム |
JP6631471B2 (ja) * | 2016-11-03 | 2020-01-15 | 株式会社デンソー | エンジン始動装置、及び車両 |
WO2022208590A1 (ja) * | 2021-03-29 | 2022-10-06 | 株式会社Fuji | サーボアンプ |
-
1997
- 1997-03-19 JP JP06647297A patent/JP3277454B2/ja not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JPH10262387A (ja) | 1998-09-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP0514847B1 (en) | System and method for controlling speed of electric motor in extremely low speed range using rotary pulse encoder | |
JP3277454B2 (ja) | 検出位置補正装置及び回転速度検出装置 | |
JP3228168B2 (ja) | 回転速度検出装置及びタイヤ発生力検出装置 | |
JPS61116986A (ja) | 速度制御装置 | |
JP6091523B2 (ja) | サーボ制御装置 | |
JP3296527B2 (ja) | モータ速度制御装置 | |
KR920009023B1 (ko) | 회전속도의 계측방법 | |
JPS6294249A (ja) | 速度制御方式 | |
JP5056853B2 (ja) | 速度検出方法とそれを用いたモータ制御装置 | |
US5533166A (en) | Method for calculating speed estimated value in speed control system | |
JP3196311B2 (ja) | 電動機の速度推定オブザーバ | |
JP2009095154A (ja) | モータ制御装置とその速度検出方法 | |
JPH027276B2 (ja) | ||
JP3339208B2 (ja) | モータ制御装置 | |
JP3402017B2 (ja) | 速度検出制御装置 | |
JP2001033472A (ja) | 回転速度検出装置 | |
JP2728499B2 (ja) | 電動機の速度制御装置 | |
KR100491665B1 (ko) | 전동기의 속도제어장치 | |
US5917301A (en) | Method for generating a motion profile of a motor | |
JP3111798B2 (ja) | 可変速駆動装置 | |
JP3620283B2 (ja) | 速度演算装置 | |
JP3166219B2 (ja) | 電動機の速度制御装置 | |
JP3055186B2 (ja) | 電動機の瞬時位置・瞬時速度・瞬時加速度検出装置、ならびに瞬時位置値・瞬時速度値・瞬時加速度値を用いた電動機の制御方法 | |
JP3230397B2 (ja) | 可変速駆動装置およびその装置を用いた速度推定装置 | |
JP3205758B2 (ja) | フィルタ装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
LAPS | Cancellation because of no payment of annual fees |