特許 6194914 位置予測装置及び位置検出装置

(19)【発行国】日本国特許庁(JP)

(12)【公報種別】特許公報(B2)

(11)【特許番号】6194914

(24)【登録日】2017年8月25日

(45)【発行日】2017年9月13日

(54)【発明の名称】位置予測装置及び位置検出装置

(51)【国際特許分類】

   G01D 5/244 20060101AFI20170904BHJP

   G01D 5/245 20060101ALI20170904BHJP

【ＦＩ】

   G01D5/244 J

   G01D5/245 R

【請求項の数】8

【全頁数】13

(21)【出願番号】特願2015-67498(P2015-67498)

(22)【出願日】2015年3月27日

(65)【公開番号】特開2016-186475(P2016-186475A)

(43)【公開日】2016年10月27日

【審査請求日】2016年2月12日

(73)【特許権者】

【識別番号】000003067

【氏名又は名称】ＴＤＫ株式会社

(74)【代理人】

【識別番号】100132207

【弁理士】

【氏名又は名称】太田 昌孝

(74)【代理人】

【識別番号】100095463

【弁理士】

【氏名又は名称】米田 潤三

(72)【発明者】

【氏名】山地 勇一郎

(72)【発明者】

【氏名】望月 慎一郎

(72)【発明者】

【氏名】平林 啓

(72)【発明者】

【氏名】梅原 剛

【審査官】 深田 高義

(56)【参考文献】

【文献】 特開２００８−１１６２９２（ＪＰ，Ａ）

【文献】 特開２００４−０３１５９２（ＪＰ，Ａ）

【文献】 特開平１０−１６２２８２（ＪＰ，Ａ）

【文献】 国際公開第２０１３／０７６８３９（ＷＯ，Ａ１）

【文献】 特開２００３−２２２５１８（ＪＰ，Ａ）

(58)【調査した分野】（Int.Cl.，ＤＢ名）

Ｇ０１Ｄ ５／２４４

Ｇ０１Ｄ ５／２４５

(57)【特許請求の範囲】

【請求項1】

連続的に作動する動作体の所定時刻における位置を予測する装置であって、
前記動作体に設けられてなる磁界発生部の外部磁界を検出する検出部から出力される前記動作体の位置に関する信号に基づき、前記動作体の位置情報を算出する演算処理部と、
前記演算処理部により算出された前記位置情報を時刻でＮ回（Ｎは１以上の整数である。）微分したＮ次微分値に基づき、前記動作体の前記所定時刻における位置を予測する予測部と
を備え、
前記予測部は、前記Ｎ次微分値についてのフィルタ処理を行い、前記動作体の前記所定時刻における位置情報のＮ次微分値の予測値を算出し、前記Ｎ次微分値の予測値を時刻でＮ回積分することで、前記動作体の前記所定時刻における位置を予測することを特徴とする位置予測装置。

【請求項2】

前記予測部は、前記動作体の位置情報のうち、最新の位置情報を時刻でＮ回（Ｎは１以上の整数である。）微分したＮ次微分値を少なくとも用いて、前記動作体の前記所定時刻における位置を予測することを特徴とする請求項１に記載の位置予測装置。

【請求項3】

前記動作体の位置情報が、角度情報であることを特徴とする請求項１又は２に記載の位置予測装置。

【請求項4】

前記予測部は、前記位置情報としての角度情報を時刻で１回微分した角速度情報に基づき、前記動作体の前記所定時刻における位置を予測することを特徴とする請求項１〜３のいずれかに記載の位置予測装置。

【請求項5】

前記予測部は、前記位置情報としての角度情報を時刻で２回微分した角加速度情報に基づき、前記動作体の前記所定時刻における位置を予測することを特徴とする請求項１〜３のいずれかに記載の位置予測装置。

【請求項6】

請求項１〜５のいずれかに記載の位置予測装置と、
前記動作体に設けられてなる前記磁界発生部に対向して配置され、前記動作体の位置を検出可能な前記検出部と
を備えることを特徴とする位置検出装置。

【請求項7】

前記検出部は、磁気抵抗効果素子を含むことを特徴とする請求項６に記載の位置検出装置。

【請求項8】

前記動作体が、所定の回転軸を中心とし、前記検出部に対して相対的に回転する回転動作体であることを特徴とする請求項６又は７に記載の位置検出装置。

【発明の詳細な説明】

【技術分野】

【0001】

本発明は、動作体の作動による位置を予測する装置及び当該動作体の作動による位置を検出する装置に関する。

【背景技術】

【0002】

従来、工作機械等における機械可動部に取り付けられるサーボモータ等の動作体の回転動作等による物理量の変化を検出することで、当該動作体の位置を検出する位置検出装置が用いられている。この位置検出装置による出力を通じて動作体の回転動作等を連続的に追尾し、動作体にフィードバックすることで、当該動作体の動作制御が行われる。

【0003】

このような位置検出装置としては、磁界を発生する磁界発生部と磁気検出装置とを備えるものが知られている。かかる磁気検出装置は、一般に、磁界発生部により発生する外部磁界を検知し、磁界発生部が相対的に移動した物理量を示すアナログ信号を出力する磁気検出素子と、上記アナログ信号をデジタル信号に変換し、当該デジタル信号に基づいて現在時刻における動作体の位置を算出することのできる演算回路とを備え、磁気検出素子と演算回路とが同一の半導体チップ上に集積されて一体化された集積回路として構成される。

【0004】

このような磁気検出装置の演算回路において算出された、現在時刻における動作体の位置情報に基づき、動作体の動作制御が行われる。しかし、磁気検出素子から出力されるアナログ信号をデジタル信号に変換する処理、当該デジタル信号に含まれるノイズを除去するフィルタリング処理、当該デジタル信号に基づいて現在時刻における動作体の位置を算出する処理等により、遅延が生じ得る。そのため、特に高速に作動する動作体を精確に動作制御するために、上記遅延を取り戻すべく、動作体の位置情報から将来時刻における動作体の位置を予測し、当該予測値に基づいて動作体を制御する方法が採用されている。

【0005】

このような方法を実施可能な位置検出装置として、従来、回転体に設けられた磁石の磁界強度を計測する磁気センサ素子、磁気センサ素子の計測値から磁石の回転角度を演算する角度計算手段、角度計算手段の出力する回転角度のデータを記憶しておく記憶手段、記憶手段の記憶内容を統計処理することにより回転状態を推定する回転状態推定手段、回転状態推定手段で推定された回転状態から以降の回転角度を予測する外挿処理手段、及び外挿処理手段で予測した回転角度に基づいて回転角度を算出し出力する出力手段を備える回転検出装置が提案されている（特許文献１参照）。

【先行技術文献】

【特許文献】

【0006】

【特許文献1】特開２００８−１１６２９２号公報

【発明の概要】

【発明が解決しようとする課題】

【0007】

上記特許文献１に記載の回転検出装置において、磁気センサ素子により一定サンプリング周期で現在時刻の角度が出力され、記憶手段に記憶、蓄積される。そして、記憶手段に記憶、蓄積されている現在時刻の角度データに至る過去の角度データに、平均化フィルタ等の処理を行い、予測すべきサンプリング時刻における角度（予測角度）が求められる。

【0008】

磁気センサ素子により一定サンプリング周期で出力される、現在時刻の角度データには所定のノイズが含まれる。このようなノイズを含む角度データを用いて、上記特許文献１のように線形外挿処理により予測角度を求めると、予測角度の精度が低下してしまうという問題がある。図９に示す予測モデルから明らかなように、現在時刻Ｔ_nの角度θ_nと過去の時刻Ｔ_n-1の角度θ_n-1とが、それぞれ所定のノイズ（図９中、矢印はノイズ幅を表す。）を含み、それらの角度データを用いて次回サンプリング時刻Ｔ_n+1における予測角度θ_n+1を線形外挿予測する場合、予測角度θ_n+1に含まれるノイズは角度θ_n，θ_n-1よりも増幅されてしまう。

【0009】

また、上記角度データを用いた平均フィルタ処理等により予測角度を求めようとすると、それによる群遅延が生じてしまい、予測すべきサンプリング時刻を未来に設定する必要がある。予測すべきサンプリング時刻を未来に設定すると、ノイズの増幅を抑制することができず、予測角度の精度が低下してしまうという問題がある。

【0010】

予測角度の精度を高めるために、磁気センサ素子により出力される角度データについてフィルタ回路等による処理を行い、当該角度データに含まれるノイズを低減することが考えられる。フィルタ回路等による処理によって、角度データに含まれるノイズを低減することは可能である。しかし、フィルタ回路等による処理により、さらなる遅延が生じてしまうため、予測すべきサンプリング時刻をさらに未来に設定せざるを得ない。このように予測すべきサンプリング時刻をさらに未来に設定すると、フィルタ回路等により低減されたノイズが再び増幅して予測角度に含まれてしまうため、結果として予測角度の精度が低下してしまうという問題がある。

【0011】

上記課題に鑑み、本発明は、連続的に作動する動作体の所定時刻における位置を精確に予測することのできる位置予測装置及び当該位置予測装置を含む位置検出装置を提供することを目的とする。

【課題を解決するための手段】

【0012】

上記課題を解決するために、本発明は、連続的に作動する動作体の所定時刻における位置を予測する装置であって、前記動作体に設けられてなる磁界発生部の外部磁界を検出する検出部から出力される前記動作体の位置に関する信号に基づき、前記動作体の位置情報を算出する演算処理部と、前記演算処理部により算出された前記位置情報を時刻でＮ回（Ｎは１以上の整数である。）微分したＮ次微分値に基づき、前記動作体の前記所定時刻における位置を予測する予測部とを備え、前記予測部は、前記Ｎ次微分値についてのフィルタ処理を行い、前記動作体の前記所定時刻における位置情報のＮ次微分値の予測値を算出し、前記Ｎ次微分値の予測値を時刻でＮ回積分することで、前記動作体の前記所定時刻における位置を予測することを特徴とする位置予測装置を提供する（発明１）。

【0013】

上記発明（発明１）によれば、連続的に作動する動作体の位置情報にノイズが含まれている場合であっても、当該位置情報のＮ次微分値に基づいて所定時刻における動作体の位置を予測することで、当該所定時刻における動作体の位置を精確に予測することができる。

【0015】

上記発明（発明１）において、前記予測部は、前記動作体の位置情報のうち、最新の位置情報を時刻でＮ回（Ｎは１以上の整数である。）微分したＮ次微分値を少なくとも用いて、前記動作体の前記所定時刻における位置を予測するのが好ましい（発明２）。

【0016】

上記発明（発明１，２）において、前記動作体の位置情報が、角度情報であるのが好ましく（発明３）、上記発明（発明１〜３）において、前記予測部は、前記位置情報としての角度情報を時刻で１回微分した角速度情報に基づき、前記動作体の前記所定時刻における位置を予測してもよいし（発明４）、前記位置情報としての角度情報を時刻で２回微分した角加速度情報に基づき、前記動作体の前記所定時刻における位置を予測してもよい（発明５）。

【0017】

また、本発明は、上記発明（発明１〜５）に係る位置予測装置と、前記動作体に設けられてなる前記磁界発生部に対向して配置され、前記動作体の位置を検出可能な前記検出部とを備えることを特徴とする位置検出装置を提供する（発明６）。

【0018】

上記発明（発明６）において、前記検出部は、磁気抵抗効果素子を含むことができ（発明７）、かかる発明（発明６，７）において、前記動作体が、所定の回転軸を中心とし、前記検出部に対して相対的に回転する回転動作体であるのが好ましい（発明８）。

【発明の効果】

【0019】

本発明によれば、連続的に作動する動作体の所定時刻における位置を精確に予測することのできる位置予測装置及び当該位置予測装置を含む位置検出装置を提供することができる。

【図面の簡単な説明】

【0020】

【図1】図１は、本発明の一実施形態に係る回転角度検出装置の概略構成を示す斜視図である。

【図2】図２は、本発明の一実施形態に係る回転角度検出装置の概略構成を示す側面図である。

【図3】図３は、本発明の一実施形態における磁気検出装置の概略構成を示すブロック図である。

【図4】図４は、本発明の一実施形態における検出部の回路構成を概略的に示す回路図である。

【図5】図５は、本発明の一実施形態における磁気検出素子としてのＭＲ素子の概略構成を示す斜視図である。

【図6】図６は、実施例１におけるシミュレーション結果を示すグラフである。

【図7】図７は、比較例１におけるシミュレーション結果を示すグラフである。

【図8】図８は、比較例２におけるシミュレーション結果を示すグラフである。

【図9】図９は、ノイズを含む角度データを用いた線形予測モデルにおいて予測値に含まれるノイズが増幅することを説明するためのグラフである。

【発明を実施するための形態】

【0021】

本発明の実施の形態について、図面を参照しながら詳細に説明する。図１は、本実施形態に係る回転角度検出装置の概略構成を示す斜視図であり、図２は、本実施形態に係る回転角度検出装置の概略構成を示す側面図であり、図３は、本実施形態における磁気検出装置の概略構成を示すブロック図であり、図４は、本実施形態における検出部の回路構成を概略的に示す回路図であり、図５は、本実施形態における磁気検出素子としてのＭＲ素子の概略構成を示す斜視図である。

【0022】

図１及び図２に示すように、本実施形態に係る回転角度検出装置１は、磁石２と、磁石２に対向して配置される磁気検出装置３とを備える。磁石２は、回転軸Ｃを中心として連続的に回転する軸部１１（例えばサーボモータ等のモータ軸等）の軸方向の一端部に固定されており、軸部１１の回転に連動して、回転軸Ｃを中心として回転する。

【0023】

磁石２は、回転軸Ｃに直交する端面２１と、回転軸Ｃを含む仮想平面を中心として対称に配置されたＮ極２２及びＳ極２３とを有し、回転軸Ｃに直交する方向（Ｓ極２３からＮ極２２に向かう方向であって、Ｎ極２２とＳ極２３との境界に直交する方向）に磁化されている。磁石２は、それが有する磁化に基づいて磁界を発生する。

【0024】

磁気検出装置３は、磁石２の端面２１に対向するように配置されており、磁石２による磁界を検出する。本実施形態に係る回転角度検出装置１は、磁気検出装置３の出力に基づいて磁石２の回転角度、すなわち回転移動する軸部１１の回転角度を検出することができる。

【0025】

図３に示すように、磁気検出装置３は、磁石２（図１、図２参照）の磁界を検出する検出部３１と、検出部３１から出力されるアナログ信号をデジタル信号に変換するＡ／Ｄ（アナログ−デジタル）変換部３２、Ａ／Ｄ変換部３２によりデジタル変換されたデジタル信号を演算処理し、回転角度θを算出する演算処理部３３、及び演算処理部３３により算出された回転角度θを１回微分するとともに、当該微分値、すなわち角速度ωに基づいて次回サンプリング時刻Ｔ_n+1における回転角度θ_n+1を予測する予測部３４を有する。本実施形態においては、少なくとも演算処理部３３及び予測部３４により、連続的に作動する動作体（例えば連続的に回転するサーボモータのモータ軸等）の位置（回転位置）を予測可能な位置予測装置が構成される。

【0026】

図４に示すように、検出部３１は、第１の検出部３１Ａ及び第２の検出部３１Ｂを含み、第１及び第２の検出部３１Ａ，３１Ｂのそれぞれは、少なくとも１つの磁気検出素子を含む。検出部３１は、所定のサンプリング周期（例えば、５０〜１００μｓｅｃ程度）で、磁石２の磁界の方向が所定の方向に対するなす角度（回転角度）に関する検出信号（アナログ信号）を生成し、出力する。

【0027】

第１及び第２の検出部３１Ａ，３１Ｂのそれぞれは、少なくとも１つの磁気検出素子として、直列に接続された一対の磁気検出素子を含んでいてもよい。この場合において、第１及び第２の検出部３１Ａ，３１Ｂのそれぞれは、直列に接続された第１の一対の磁気検出素子と、直列に接続された第２の一対の磁気検出素子とを含むホイートストンブリッジ回路を有する。

【0028】

第１の検出部３１Ａが有するホイートストンブリッジ回路３１１は、電源ポートＶ１と、グランドポートＧ１と、２つの出力ポートＥ１１，Ｅ１２と、直列に接続された第１の一対の磁気検出素子Ｒ１１，Ｒ１２と、直列に接続された第２の一対の磁気検出素子Ｒ１３，Ｒ１４とを含む。磁気検出素子Ｒ１１，Ｒ１３の各一端は、電源ポートＶ１に接続されている。磁気検出素子Ｒ１１の他端は、磁気検出素子Ｒ１２の一端と出力ポートＥ１１とに接続されている。磁気検出素子Ｒ１３の他端は、磁気検出素子Ｒ１４の一端と出力ポートＥ１２とに接続されている。磁気検出素子Ｒ１２，Ｒ１４の各他端は、グランドポートＧ１に接続されている。電源ポートＶ１には、所定の大きさの電源電圧が印加され、グランドポートＧ１はグランドに接続される。

【0029】

第２の検出部３１Ｂが有するホイートストンブリッジ回路３１２は、第１の検出部３１Ａのホイートストンブリッジ回路３１１と同様の構成を有し、電源ポートＶ２と、グランドポートＧ２と、２つの出力ポートＥ２１，Ｅ２２と、直列に接続された第１の一対の磁気検出素子Ｒ２１，Ｒ２２と、直列に接続された第２の一対の磁気検出素子Ｒ２３，Ｒ２４とを含む。磁気検出素子Ｒ２１，Ｒ２３の各一端は、電源ポートＶ２に接続されている。磁気検出素子Ｒ２１の他端は、磁気検出素子Ｒ２２の一端と出力ポートＥ２１とに接続されている。磁気検出素子Ｒ２３の他端は、磁気検出素子Ｒ２４の一端と出力ポートＥ２２とに接続されている。磁気検出素子Ｒ２２，Ｒ２４の各他端は、グランドポートＧ２に接続されている。電源ポートＶ２には、所定の大きさの電源電圧が印加され、グランドポートＧ２はグランドに接続される。

【0030】

本実施形態において、ホイートストンブリッジ回路３１１，３１２に含まれるすべての磁気検出素子Ｒ１１〜Ｒ１４，Ｒ２１〜Ｒ２４として、ＴＭＲ素子、ＧＭＲ素子等のＭＲ素子を用いることができ、特にＴＭＲ素子を用いるのが好ましい。ＴＭＲ素子、ＧＭＲ素子は、磁化方向が固定された磁化固定層と、印加される磁界の方向に応じて磁化方向が変化する自由層と、磁化固定層及び自由層の間に配置される非磁性層とを有する。

【0031】

具体的には、図５に示すように、ＭＲ素子は、複数の下部電極４１と、複数のＭＲ膜５０と、複数の上部電極４２とを有する。複数の下部電極４１は、基板（図示せず）上に設けられている。各下部電極４１は細長い形状を有する。下部電極４１の長手方向に隣接する２つの下部電極４１の間には、間隙が形成されている。下部電極４１の上面における、長手方向の両端近傍にそれぞれＭＲ膜５０が設けられている。ＭＲ膜５０は、下部電極４１側から順に積層された自由層５１、非磁性層５２、磁化固定層５３及び反強磁性層５４を含む。自由層５１は、下部電極４１に電気的に接続されている。反強磁性層５４は、反強磁性材料により構成され、磁化固定層５３との間で交換結合を生じさせることで、磁化固定層５３の磁化の方向を固定する役割を果たす。複数の上部電極４２は、複数のＭＲ膜５０上に設けられている。各上部電極４２は細長い形状を有し、下部電極４１の長手方向に隣接する２つの下部電極４１上に配置され、隣接する２つのＭＲ膜５０の反強磁性層５４同士を電気的に接続する。なお、ＭＲ膜５０は、上部電極４２側から順に自由層５１、非磁性層５２、磁化固定層５３及び反強磁性層５４が積層されてなる構成を有していてもよい。

【0032】

ＴＭＲ素子においては、非磁性層５２はトンネルバリア層である。ＧＭＲ素子においては、非磁性層５２は非磁性導電層である。ＴＭＲ素子、ＧＭＲ素子において、自由層５１の磁化の方向が磁化固定層５３の磁化の方向に対してなす角度に応じて抵抗値が変化し、この角度が０°（互いの磁化方向が平行）のときに抵抗値が最小となり、１８０°（互いの磁化方向が反平行）のときに抵抗値が最大となる。

【0033】

図４において、磁気検出素子Ｒ１１〜Ｒ１４，Ｒ２１〜Ｒ２４の磁化固定層の磁化の方向を塗りつぶした矢印で表し、自由層の磁化の方向を白抜きの矢印で表す。第１の検出部３１Ａにおいて、磁気検出素子Ｒ１１，Ｒ１４の磁化固定層の磁化の方向は第１の方向Ｄ１に平行な方向であり、磁気検出素子Ｒ１２，Ｒ１３の磁化固定層の磁化の方向は、磁気検出素子Ｒ１１，Ｒ１４の磁化固定層の磁化の方向と反平行方向である。第１の検出部３１Ａにおいて、磁石２の磁界の第１の方向Ｄ１の成分の強度に応じて、出力ポートＥ１１，Ｅ１２の電位差が変化し、磁石２の磁界の第１の方向Ｄ１の強度を表す信号が出力される。

【0034】

第２の検出部３１Ｂにおいて、磁気検出素子Ｒ２１，Ｒ２４の磁化固定層の磁化の方向は第２の方向Ｄ２（第１の方向Ｄ１に直交する方向）であり、磁気検出素子Ｒ２２，Ｒ２３の磁化固定層の磁化の方向は、磁気検出素子Ｒ２１，Ｒ２４の磁化固定層の磁化の方向と反平行方向である。第２の検出部３１Ｂにおいて、磁石２の磁界の第２の方向Ｄ２の成分の強度に応じて、出力ポートＥ２１，Ｅ２２の電位差が変化し、磁石２の磁界の第２の方向Ｄ２の強度を表す信号が出力される。

【0035】

差分検出器３５は、出力ポートＥ１１，Ｅ１２の電位差に対応する信号を第１の信号Ｓ１としてＡ／Ｄ変換部３２に出力する。差分検出器３６は、出力ポートＥ２１，Ｅ２２の電位差に対応する信号を第２の信号Ｓ２としてＡ／Ｄ変換部３２に出力する。

【0036】

図４に示すように、第１の検出部３１Ａにおける磁気検出素子Ｒ１１〜Ｒ１４の磁化固定層の磁化方向と、第２の検出部３１Ｂにおける磁気検出素子Ｒ２１〜Ｒ２４の磁化固定層の磁化方向とは、互いに直交する。この場合、第１の信号Ｓ１の波形は、回転角度θに依存したコサイン（Ｃｏｓｉｎｅ）波形になり、第２の信号Ｓ２の波形は、回転角度θに依存したサイン（Ｓｉｎｅ）波形になる。本実施形態において、第２の信号Ｓ２の位相は、第１の信号Ｓ１の位相に対して信号周期の１／４、すなわちπ／２（９０°）異なっている。

【0037】

Ａ／Ｄ変換部３２は、検出部３１から所定のサンプリング周期で出力される、第１及び第２の信号（回転角度θに関するアナログ信号）Ｓ１，Ｓ２をデジタル信号に変換し、当該デジタル信号が演算処理部３３に入力される。

【0038】

演算処理部３３は、Ａ／Ｄ変換部３２によりアナログ信号から変換されたデジタル信号についての演算処理を行い、磁石２の回転角度θを算出する。この演算処理部３３は、例えば、マイクロコンピュータ等により構成される。演算処理部３３により算出された磁石２の回転角度θは、演算処理部３３に含まれる記憶部（図示せず）に記憶される。

【0039】

磁石２の回転角度θは、例えば下記式で示すアークタンジェント計算によって算出され得る。
θ＝ａｔａｎ（Ｓ１／Ｓ２）

【0040】

なお、３６０°の範囲内で、上記式における回転角度θの解には、１８０°異なる２つの値がある。しかし、第１の信号Ｓ１及び第２の信号Ｓ２の正負の組み合わせにより、回転角度θの真の値が、上記式における２つの解のいずれかであるかを判別することができる。すなわち、第１の信号Ｓ１が正の値のときは、回転角度θは０°よりも大きく１８０°よりも小さい。第１の信号Ｓ１が負の値のときは、回転角度θは１８０°よりも大きく３６０°よりも小さい。第２の信号Ｓ２が正の値のときは、回転角度θは０°以上９０°未満及び２７０°より大きく３６０°以下の範囲内である。第２の信号Ｓ２が負の値のときは、回転角度θは９０°よりも大きく２７０°よりも小さい。演算処理部３３は、上記式と、第１の信号Ｓ１及び第２の信号Ｓ２の正負の組み合わせの判定とにより、３６０°の範囲内で回転角度θを算出する。

【0041】

予測部３４は、演算処理部３３により算出され、記憶部に記憶された磁石２の回転角度θを１回微分した１次微分値に基づいて、次回サンプリング時刻Ｔ_n+1における磁石２の回転角度θ_n+1を予測する。具体的には、予測部３４は、記憶部に記憶された磁石２の回転角度θを１回微分した角速度ωを算出し、当該角速度ωについて、例えば移動平均フィルタ処理等のフィルタ処理を行うことで、次回サンプリング時刻Ｔ_n+1における角速度ω_n+1の予測値を算出する。そして、当該角速度ω_n+1の予測値を積分して、次回サンプリング時刻Ｔ_n+1における磁石２の回転角度θ_n+1の予測値を算出する。

【0042】

上記構成を有する回転角度検出装置１において、軸部１１の回転に伴い磁石２が回転すると、磁石２の磁界が変化する。その磁界の変化に応じ、検出部３１の磁気検出素子Ｒ１１〜Ｒ１４，Ｒ２１〜Ｒ２４の抵抗値が変化し、第１の検出部３１Ａ及び第２の検出部３１Ｂのそれぞれの出力ポートＥ１１，Ｅ１２，Ｅ２１，Ｅ２２の電位差に応じ、所定のサンプリング周期で第１の方向Ｄ１及び第２の方向Ｄ２における磁石２の磁界強度を表す信号Ｓ１，Ｓ２が差分検出器３５，３６から出力される。そして、差分検出器３５，３６から出力された第１の信号Ｓ１及び第２の信号Ｓ２が出力され、Ａ／Ｄ変換部３２によりデジタル信号に変換される。その後、演算処理部３３により、磁石２の回転角度θ（現在時刻ｎにおける回転角度θ_n）が算出される。

【0043】

本実施形態に係る回転角度検出装置１において、検出部３１からの出力をアナログ信号として読み出す処理（すなわち、第１及び第２の検出部３１Ａ，３１Ｂの出力ポートＥ１１，Ｅ１２，Ｅ２１，Ｅ２２の電位差に対応して差分検出器３５，３６から第１及び第２の信号Ｓ１，Ｓ２を出力する処理）、Ａ／Ｄ変換部３２にて当該第１及び第２の信号Ｓ１，Ｓ２をデジタル信号に変換する処理等により遅延が生じる。この遅延を取り戻すために、予測部３４による回転角度の予測が重要となる。

【0044】

ここで、演算処理部３３により算出される磁石の回転角度θには、所定のノイズが含まれる。このノイズを含む回転角度θに基づいて次回サンプリング時刻Ｔ_n+1における回転角度θ_n+1を予測すると、回転角度θ_n+1の予測値に含まれるノイズが増幅してしまい、正確な予測が困難となる。

【0045】

この点、上記サンプリング周期のうちの極めて短時間（例えば、現在サンプリング時刻Ｔ_nから遡って３サンプリング周期以下程度）においては、磁石２の回転運動を、等速回転運動であると仮定することができる。すなわち、次回サンプリング時刻Ｔ_n+1における角速度ω_n+1は、現在サンプリング時刻Ｔ_nにおける角速度ω_nと実質的に同一であるとの仮定が成立する。そのため、本実施形態において、予測部３４は、極めて短時間において算出された回転角度θ（例えば、現在サンプリング時刻Ｔ_nから遡って３サンプリング周期以下程度に算出された回転角度θ_n〜θ_n-3）を１回微分した１次微分値である角速度ω_n〜ω_n-3を算出し、当該角速度ω_n〜ω_n-3に基づいて次回サンプリング時刻Ｔ_n+1の角速度ω_n+1を予測する。そして、予測部３４は、当該角速度ω_n+1の予測値から回転角度θ_n+1を算出する。これにより、後述する実施例からも明らかなように、回転角度θに含まれるノイズが増幅されることなく、次回サンプリング時刻Ｔ_n+1における回転角度θ_n+1の正確な予測が可能となる。

【0046】

予測部３４は、例えば、現在サンプリング時刻Ｔ_nから遡って３サンプリング周期以下の回転角度θ_n〜θ_n-3をそれぞれ１回微分した角速度ω_n〜ω_n-3を用いた移動平均フィルタ処理により、次回サンプリング時刻Ｔ_n+1の角速度ω_n+1を予測し、当該角速度ω_n+1の予測値から、次回サンプリング時刻Ｔ_n+1の回転角度θ_n+1を算出する。このようにして算出された回転角度θ_n+1は、軸部１１を含む動作体（例えばモータ軸を含むサーボモータ等）の駆動回路等（図示せず）に入力され、当該動作体の動作制御が行われる。

【0047】

上述したように、本実施形態に係る回転角度検出装置１によれば、磁石２の回転に伴い算出される、所定のノイズを含む回転角度θを１回微分した角速度ωに基づいて次回サンプリング時刻Ｔ_n+1の角速度ω_n+1及びそれから算出される回転角度θ_n+1を予測するため、次回サンプリング時刻Ｔ_n+1における回転角度θ_n+1を精確に予測することができる。

【0048】

また、本実施形態に係る回転角度検出装置１によれば、回転角度θに含まれるノイズを除去することなくそのまま１回微分した角速度ωに基づいて次回サンプリング時刻Ｔ_n+1の回転角度θ_n+1を予測することで、回転角度θのフィルタリング処理によるさらなる遅延が生じることがない。そのため、当該遅延による次回サンプリング時刻Ｔ_n+1の回転角度θ_n+1に含まれるノイズが増幅するのを抑制することができ、次回サンプリング時刻Ｔ_n+1の回転角度θ_n+1を精確に予測することができる。

【0049】

さらに、本実施形態に係る回転角度検出装置１によれば、次回サンプリング時刻Ｔ_n+1における回転角度θ_n+1を精確に予測するために、現在サンプリング時刻Ｔ_nの回転角度θ_nと、当該現在サンプリング時刻Ｔ_nから遡って、例えば３サンプリング時刻（Ｔ_n-1，Ｔ_n-2，Ｔ_n-3）に演算処理部３３にて算出された回転角度θ_n〜θ_n-3とを用いればよいため、当該回転角度θ_n+1の予測のために必要な情報量（サンプル数）を少なくすることができるという効果も奏し得る。

【0050】

以上説明した実施形態は、本発明の理解を容易にするために記載されたものであって、本発明を限定するために記載されたものではない。したがって、上記実施形態に開示された各要素は、本発明の技術的範囲に属する全ての設計変更や均等物をも含む趣旨である。

【0051】

上記実施形態において、予測部３４は、回転角度θを１回微分した角速度ωに基づいて、次回サンプリング時刻Ｔ_n+1における角速度ω_n+1の予測値を算出し、当該角速度ω_n+1の予測値から回転角度θ_n+1の予測値を算出しているが、本発明はこのような態様に限定されるものではない。例えば、予測部３４は、回転角度θを２回微分した角加速度αに基づいて、次回サンプリング時刻Ｔ_n+1における角加速度α_n+1の予測値を算出し、当該角加速度α_n+1の予測値から回転角度θ_n+1の予測値を算出してもよい。すなわち、予測部３４は、回転角度θをＮ回（Ｎは１以上の整数である。）微分したＮ次微分値に基づいて、次回サンプリング時刻Ｔ_n+1における回転角度θ_n+1の予測値を算出してもよい。

【0052】

上記実施形態において、磁界発生部として軸部１１に固定された磁石２を用いているが、本発明はこのような態様に限定されるものではなく、例えば、少なくとも１組のＮ極及びＳ極が交互にリング状に配置された磁石を磁界発生部として用い、当該磁石の外周部に磁気検出装置を対向配置させてなるものであってもよいし、直線状スケールを磁界発生部として用いてもよい。

【0053】

上記実施形態において、磁石２が固定された軸部１１が回転軸Ｃを中心に回転することにより磁石２が磁気検出装置３に対して相対的に回転移動するが、本発明はこのような態様に限定されるものではない。例えば、磁石２（軸部１１）と磁気検出装置３とが、互いに反対方向に回転するものであってもよいし、磁石２（軸部１１）が回転せずに磁気検出装置３が回転するものであってもよい。

【実施例】

【0054】

以下、実施例等を挙げて本発明をさらに詳細に説明するが、本発明は下記の実施例等に何ら限定されるものではない。

【0055】

〔実施例１〕
図３及び図４に示す構成を有する磁気検出装置３における、予測部３４による次回サンプリング時刻Ｔ_n+1の回転角度θ_n+1の予測について、ＭＡＴＬＡＢを用いてシミュレーションを行い、回転角度θ_n+1の予測値に含まれるノイズを求めた。かかるシミュレーションにおいて、磁石２が９００００ｄｅｇ／ｓｅｃで等速回転運動し、検出部３１によるサンプリング周期が５０μｓｅｃであり、演算処理部３３により算出される回転角度θに含まれるノイズが±０．０１°であるとした。また、４サンプルの当該回転角度θ_n〜θ_n-3をそれぞれ１回微分した角速度ω_n〜ω_n-3を用いた移動平均フィルタ処理を行うことを通じて、予測部３４にて回転角度θ_n+1を予測するものとした。シミュレーション結果を図６に示す。

【0056】

上記シミュレーションの結果、回転角度θを１回微分した角速度ωを用いて次回サンプリング時刻Ｔ_n+1における回転角度θ_n+1を予測すると、当該回転角度の予測値に含まれるノイズを±０．００９°に抑えることができることが確認された。

【0057】

〔比較例１〕
演算処理部３３により算出された１サンプルの回転角度θ_nを１回微分したω_n用いて線形外挿処理を行うことでω_n+1を求め、当該ω_n+1を積分することにより回転角度θ_n+1の予測をすることとした以外は、実施例１と同様にして回転角度θ_n+1の予測値に含まれるノイズを求めた。シミュレーション結果を図７に示す。

【0058】

上記シミュレーションの結果、回転角度θ_nを用いて次回サンプリング時刻Ｔ_n+1における回転角度θ_n+1を予測すると、当該回転角度の予測値に含まれるノイズが±０．０３°に増幅することが確認された。

【0059】

〔比較例２〕
Ａ／Ｄ変換部３２にて変換されたデジタル信号について、ＦＩＲフィルタ処理を行うことで、回転角度θ_nに含まれるノイズを±０．００２７°まで低減させるとともに、ＦＩＲフィルタ処理による群遅延の増加に伴う予測すべきサンプリング時刻を５サンプリング周期分将来に設定した以外は、比較例１と同様にして予測すべきサンプリング時刻Ｔ_n+5における回転角度θ_n+5の予測値に含まれるノイズを求めた。シミュレーション結果を図８に示す。

【0060】

上記シミュレーションの結果、回転角度θ_nを用いて予測すべきサンプリング時刻Ｔ_n+5における回転角度θ_n+5を予測すると、当該回転角度の予測値に含まれるノイズが±０．０３２４°に増大することが確認された。

【0061】

実施例１、比較例１及び比較例２の結果から明らかなように、回転角度θを１回微分した角速度ωを用いた予測により、回転角度θにノイズが含まれていたとしても、そのノイズを増幅させることなく、次回サンプリング時刻Ｔ_n+1の回転角度θ_n+1を予測することができた。また、比較例２の結果から、検出部３１からの出力をアナログ信号として読み取り、当該アナログ信号がＡ／Ｄ変換部３２にて変換されたデジタル信号にフィルタ処理を行い、回転角度θに含まれるノイズを低減させたとしても、当該フィルタ処理による群遅延の増大に起因して、予測時刻をさらに未来に設定せざるを得なくなるため、結果として、回転角度の予測値に含まれるノイズが増大してしまうことが確認された。

【0062】

〔実施例２〕
磁石２が−１８０００００ｄｅｇ／ｓｅｃ²で等加速回転運動しているものとし、演算処理部３３により算出された回転角度θを２回微分した角加速度αを用いるとともに、８サンプル（角加速度α_n〜α_n-7）を用いて移動平均フィルタ処理を行うことで予測部３４にて回転角度θ_n+1を予測した以外は、実施例１と同様にして回転角度θ_n+1の予測値に含まれるノイズを求めた。

【0063】

上記シミュレーションの結果、角加速度αを用いて次回サンプリング時刻Ｔ_n+1における回転角度θ_n+1を予測すると、当該回転角度の予測値に含まれるノイズが±０．０２９°であった。比較のために、演算処理部３３により算出された回転角度θを用いた移動平均フィルタ処理を行うことで予測部３４による回転角度の予測を同様にシミュレートした結果、当該回転角度の予測値に含まれるノイズが±０．０４７°であった。この結果から、角加速度αを用いた予測であっても、当該回転角度θ_n+1の予測値に含まれるノイズを増大させることなく、精確な予測が可能であることが確認された。

【0064】

実施例２の結果から、アプリケーションに応じ予測モデルが複雑になる場合であっても、最高次数の係数にフィルタリングすることで、ノイズを増大させることなく、精確な予測が可能であると推認することができる。

【符号の説明】

【0065】

１…回転角度検出装置（位置検出装置）
２…磁石（磁界発生部）
３…磁気検出装置
３１…検出部
３３…演算処理部
３４…予測部

【図1】

【図2】

【図3】

【図4】

【図5】

【図6】

【図7】

【図8】

【図9】