(58)【調査した分野】(Int.Cl.,DB名)
前記3つの磁気センサを第1磁気センサ、第2磁気センサおよび第3磁気センサとすると、前記第1磁気センサの出力信号と前記第2磁気センサの出力信号との位相差が120度であり、前記第1磁気センサの出力信号と前記第3磁気センサの出力信号との位相差が240度である、請求項1に記載の回転角演算装置。
【発明を実施するための形態】
【0015】
以下では、この発明の実施形態を、添付図面を参照して詳細に説明する。
図1は、本発明の一実施形態に係る回転角検出装置が適用された電動パワーステアリング装置の概略構成を示す模式図である。
電動パワーステアリング装置1は、車両を操向するための操舵部材としてのステアリングホイール2と、このステアリングホイール2の回転に連動して転舵輪3を転舵する転舵機構4と、運転者の操舵を補助するための操舵補助機構5とを備えている。ステアリングホイール2と転舵機構4とは、ステアリングシャフト6および中間軸7を介して機械的に連結されている。
【0016】
ステアリングシャフト6は、ステアリングホイール2に連結された入力軸8と、中間軸7に連結された出力軸9とを含む。入力軸8と出力軸9とは、トーションバー10を介して同一軸線上で相対回転可能に連結されている。すなわち、ステアリングホイール2が回転されると、入力軸8および出力軸9は、互いに相対回転しつつ同一方向に回転するようになっている。
【0017】
ステアリングシャフト6の周囲には、本発明の一実施形態に係る回転角検出装置が適用されたトルクセンサ(トルク検出装置)11が設けられている。トルクセンサ11は、入力軸8および出力軸9の相対回転変位量に基づいて、ステアリングホイール2に与えられた操舵トルクを検出する。トルクセンサ11によって検出される操舵トルクは、モータ制御用ECU(電子制御ユニット:Electronic Control Unit)12に入力される。
【0018】
転舵機構4は、ピニオン軸13と、転舵軸としてのラック軸14とを含むラックアンドピニオン機構からなる。ラック軸14の各端部には、タイロッド15およびナックルアーム(図示略)を介して転舵輪3が連結されている。ピニオン軸13は、中間軸7に連結されている。ピニオン軸13は、ステアリングホイール2の操舵に連動して回転するようになっている。ピニオン軸13の先端には、ピニオン16が連結されている。
【0019】
ラック軸14は、自動車の左右方向(直進方向に直交する方向)に沿って直線状に延びている。ラック軸14の軸方向の中間部には、ピニオン16に噛み合うラック17が形成されている。このピニオン16およびラック17によって、ピニオン軸13の回転がラック軸14の軸方向移動に変換される。ラック軸14を軸方向に移動させることによって、転舵輪3を転舵することができる。
【0020】
ステアリングホイール2が操舵(回転)されると、この回転が、ステアリングシャフト6および中間軸7を介して、ピニオン軸13に伝達される。そして、ピニオン軸13の回転は、ピニオン16およびラック17によって、ラック軸14の軸方向移動に変換される。これにより、転舵輪3が転舵される。
操舵補助機構5は、操舵補助力を発生するための電動モータ18と、電動モータ18の出力トルクを転舵機構4に伝達するための減速機構19とを含む。電動モータ18は、この実施形態では、三相ブラシレスモータからなる。減速機構19は、ウォーム軸20と、このウォーム軸20と噛み合うウォームホイール21とを含むウォームギヤ機構からなる。減速機構19は、伝達機構ハウジングとしてのギヤハウジング22内に収容されている。
【0021】
ウォーム軸20は、電動モータ18によって回転駆動される。また、ウォームホイール21は、ステアリングシャフト6とは同方向に回転可能に連結されている。ウォームホイール21は、ウォーム軸20によって回転駆動される。
電動モータ18によってウォーム軸20が回転駆動されると、ウォームホイール21が回転駆動され、ステアリングシャフト6が回転する。そして、ステアリングシャフト6の回転は、中間軸7を介してピニオン軸13に伝達される。ピニオン軸13の回転は、ラック軸14の軸方向移動に変換される。これにより、転舵輪3が転舵される。すなわち、電動モータ18によってウォーム軸20を回転駆動することによって、転舵輪3が転舵されるようになっている。
【0022】
電動モータ18のロータの回転角(ロータ回転角)は、レゾルバ等の回転角センサ25によって検出される。回転角センサ25の出力信号は、モータ制御用ECU12に入力される。電動モータ18は、モータ制御装置としてのモータ制御用ECU12によって制御される。
図2は、モータ制御用ECU12の電気的構成を示す概略図である。
【0023】
モータ制御用ECU12は、トルクセンサ11によって検出される操舵トルクThに応じて電動モータ18を駆動することによって、操舵状況に応じた適切な操舵補助を実現する。モータ制御用ECU12は、マイクロコンピュータ40と、マイクロコンピュータ40によって制御され、電動モータ18に電力を供給する駆動回路(インバータ回路)31と、電動モータ18に流れるモータ電流を検出する電流検出部32とを備えている。
【0024】
電動モータ18は、例えば三相ブラシレスモータであり、
図3に図解的に示すように、界磁としてのロータ100と、U相、V相およびW相のステータ巻線101,102,103を含むステータ105とを備えている。電動モータ18は、ロータの外部にステータを対向配置したインナーロータ型のものであってもよいし、筒状のロータの内部にステータを対向配置したアウターロータ型のものであってもよい。
【0025】
各相のステータ巻線101,102,103の方向にU軸、V軸およびW軸をとった三相固定座標(UVW座標系)が定義される。また、ロータ100の磁極方向にd軸(磁極軸)をとり、ロータ100の回転平面内においてd軸と直角な方向にq軸(トルク軸)をとった二相回転座標系(dq座標系。実回転座標系)が定義される。dq座標系は、ロータ100とともに回転する回転座標系である。dq座標系では、q軸電流のみがロータ100のトルク発生に寄与するので、d軸電流を零とし、q軸電流を所望のトルクに応じて制御すればよい。ロータ100の回転角(電気角)θ
-Sは、U軸に対するd軸の回転角である。dq座標系は、ロータ角θ
-Sに従う実回転座標系である。このロータ角θ
-Sを用いることによって、UVW座標系とdq座標系との間での座標変換を行うことができる。
【0026】
マイクロコンピュータ40は、CPUおよびメモリ(ROM、RAM、不揮発性メモリなど)を備えており、所定のプログラムを実行することによって、複数の機能処理部として機能するようになっている。この複数の機能処理部には、電流指令値設定部41と、電流偏差演算部42と、PI(比例積分)制御部43と、dq/UVW変換部44と、PWM(Pulse Width Modulation)制御部45と、UVW/dq変換部46と、回転角演算部47とを含む。
【0027】
回転角演算部47は、回転角センサ25の出力信号に基づいて、電動モータ18のロータの回転角(電気角。以下、「ロータ角θ
S」という。)を演算する。
電流指令値設定部41は、dq座標系の座標軸に流すべき電流値を電流指令値として設定する。具体的には、電流指令値設定部41は、d軸電流指令値I
d*およびq軸電流指令値I
q*(以下、これらを総称するときには「二相電流指令値I
dq*」という。)を設定する。さらに具体的には、電流指令値設定部41は、q軸電流指令値I
q*を有意値とする一方で、d軸電流指令値I
d*を零とする。より具体的には、電流指令値設定部41は、トルクセンサ11によって検出される操舵トルク(検出操舵トルク)Thに基づいて、q軸電流指令値I
q*を設定する。
【0028】
検出操舵トルクThに対するq軸電流指令値I
q*の設定例は、
図4に示されている。検出操舵トルクThは、たとえば、右方向への操舵のためのトルクが正の値にとられ、左方向への操舵のためのトルクが負の値にとられている。また、q軸電流指令値I
q*は、電動モータ18から右方向操舵のための操作補助力を発生させるべきときには正の値とされ、電動モータ18から左方向操舵のための操作補助力を発生させるべきときには負の値とされる。q軸電流指令値I
q*は、検出操舵トルクThの正の値に対しては正をとり、検出操舵トルクThの負の値に対しては負をとる。検出操舵トルクThが零のときには、q軸電流指令値I
q*は零とされる。そして、検出操舵トルクThの絶対値が大きくなるほど、q軸電流指令値I
q*の絶対値が大きくなるように、q軸電流指令値I
q*が設定されている。
【0029】
電流指令値設定部41によって設定された二相電流指令値I
dq*は、電流偏差演算部42に与えられる。
電流検出部32は、電動モータ18のU相電流I
U、V相電流I
VおよびW相電流I
W(以下、これらを総称するときは、「三相検出電流I
UVW」という。)を検出する。電流検出部32によって検出された三相検出電流I
UVWは、UVW/dq変換部46に与えられる。
【0030】
UVW/dq変換部46は、電流検出部32によって検出されるUVW座標系の三相検出電流I
UVW(U相電流I
U、V相電流I
VおよびW相電流I
W)を、dq座標系の二相検出電流I
dおよびI
q(以下総称するときには「二相検出電流I
dq」という。)に座標変換する。この座標変換には、回転角演算部47によって演算されたロータ角θ
Sが用いられる。
【0031】
電流偏差演算部42は、電流指令値設定部41によって設定される二相電流指令値I
dq*と、UVW/dq変換部46から与えられる二相検出電流I
dqとの偏差を演算する。より具体的には、電流偏差演算部42は、d軸電流指令値I
d*に対するd軸検出電流I
dの偏差およびq軸電流指令値I
q*に対するq軸検出電流I
qの偏差を演算する。これらの偏差は、PI制御部43に与えられる。
【0032】
PI制御部43は、電流偏差演算部42によって演算された電流偏差に対するPI演算を行なうことにより、電動モータ18に印加すべき二相電圧指令値V
dq*(d軸電圧指令値V
d*およびq軸電圧指令値V
q*)を生成する。この二相電圧指令値V
dq*は、dq/UVW変換部44に与えられる。
dq/UVW変換部44は、二相電圧指令値V
dq*を三相電圧指令値V
UVW*に座標変換する。この座標変換には、回転角演算部47によって演算されたロータ角θ
Sが用いられる。三相電圧指令値V
UVW*は、U相電圧指令値V
U*、V相電圧指令値V
V*およびW相電圧指令値V
W*からなる。この三相電圧指令値V
UVW*は、PWM制御部45に与えられる。
【0033】
PWM制御部45は、U相電圧指令値V
U*、V相電圧指令値V
V*およびW相電圧指令値V
W*にそれぞれ対応するデューティのU相PWM制御信号、V相PWM制御信号およびW相PWM制御信号を生成し、駆動回路31に供給する。
駆動回路31は、U相、V相およびW相に対応した三相インバータ回路からなる。このインバータ回路を構成するパワー素子がPWM制御部45から与えられるPWM制御信号によって制御されることにより、三相電圧指令値V
UVW*に相当する電圧が電動モータ18の各相のステータ巻線101,102、103に印加されることになる。
【0034】
電流偏差演算部42およびPI制御部43は、電流フィードバック制御手段を構成している。この電流フィードバック制御手段の働きによって、電動モータ18に流れるモータ電流が、電流指令値設定部41によって設定された二相電流指令値I
dq*に近づくように制御される。
図5は、トルクセンサ11の構成を図解的に示す模式図である。
【0035】
入力軸8には、環状の第1の磁石(多極磁石)61が一体回転可能に連結されている。第1の磁石61の下側には、第1の磁石61の回転に応じて互いに位相差を有する正弦波状の信号をそれぞれ出力する3つの磁気センサ71,72,73が配置されている。
出力軸9には、環状の第2の磁石(多極磁石)62が一体回転可能に連結されている。第2の磁石62の上側には、第2の磁石62の回転に応じて互いに位相差を有する正弦波状の信号をそれぞれ出力する3つの磁気センサ74,75,76が配置されている。
【0036】
各磁気センサ71〜76の出力信号S
1〜S
6は、入力軸8に加えられる操舵トルクを演算するためのトルク演算用ECU77に入力されている。トルク演算用ECU77の電源は、イグニッションキーがオン操作されることによってオンとなる。イグニッションキーがオフ操作されたときには、そのことを示すイグニッションキーオフ操作信号が、トルク演算用ECU77に入力される。なお、磁気センサとしては、たとえば、ホール素子、磁気抵抗素子(MR素子)等、磁界の作用により電気的特性が変化する特性を有する素子を備えたものを用いることができる。この実施形態では、磁気センサとしては、ホール素子が用いられている。
【0037】
前記磁石61,62、前記磁気センサ71〜76およびトルク演算用ECU77によって、トルクセンサ11が構成されている。
トルク演算用ECU77は、マイクロコンピュータを含んでいる。マイクロコンピュータは、CPUおよびメモリ(ROM,RAM,不揮発性メモリ等)を備えており、所定のプログラムを実行することによって、複数の機能処理部として機能する。この複数の機能処理部には、第1の回転角演算部77Aと、第2の回転角演算部77Bと、トルク演算部77Cとを含んでいる。
【0038】
第1の回転角演算部77Aは、3つの磁気センサ71,72,73の出力信号S
1,S
2,S
3に基づいて入力軸8の回転角(電気角θ
A)を演算する。第2の回転角演算部77Bは、3つの磁気センサ74,75,73の出力信号S
4,S
5,S
6に基づいて出力軸9の回転角(電気角θ
B)を演算する。
トルク演算部77Cは、第1の回転角演算部77Aによって検出された入力軸8の回転角θ
Aと第2の回転角演算部77Bによって検出された出力軸9の回転角θ
Bとに基づいて、入力軸8に加えられた操舵トルクThを演算する。具体的には、操舵トルクThは、トーションバー10のバネ定数をKとし、各磁石61,62に設けられた磁極対数をNとすると、次式(1)に基づいて演算される。
【0039】
Th={(θ
A−θ
B)/N}×K …(1)
第1の磁石61、磁気センサ71,72,73および第1の回転角演算部77Aによって、入力軸8の回転角θ
Aを検出するための第1の回転角検出装置が構成されている。また、第2の磁石62、磁気センサ74,75,76および第2の回転角演算部77Bによって、出力軸9の回転角θ
Bを検出するための第2の回転角検出装置が構成されている。第1の回転角検出装置(第1の回転角演算部77A)の動作と第2の回転角検出装置(第2の回転角演算部77B)動作は同様であるので、以下、第1の回転角検出装置(第1の回転角演算部77A)の動作についてのみ説明する。
【0040】
図6は、第1の磁石61の構成および2つの磁気センサの配置を示す模式図である。
第1の磁石61は、周方向に等角度間隔で配された4組の磁極対(M1,M2),(M3,M4),(M5,M6),(M7,M8)を有している。つまり、第1の磁石61は、等角度間隔で配置された8個の磁極M1〜M8を有している。各磁極M1〜M8は、入力軸8の中心軸を中心として、ほぼ45°(電気角ではほぼ180°)の角度間隔(角度幅)で配置されている。各磁極M1〜M8の磁力の大きさは、ほぼ一定である。
【0041】
3つの磁気センサ71,72,73は、第1の磁石61の下側の環状端面に対向して、配置されている。以下において、磁気センサ71を第1磁気センサ71、磁気センサ72を第2磁気センサ72、磁気センサ73を第3磁気センサ73という場合がある。第1磁気センサ71と第2磁気センサ72とは、入力軸8の中心軸を中心として電気角で120°の角度間隔で配置されている。また、第2磁気センサ72と第3磁気センサ73とは、入力軸8の中心軸を中心として電気角で120°の角度間隔で配置されている。したがって、第1磁気センサ71と第3磁気センサ73とは、入力軸8の中心軸を中心として電気角で240°の角度間隔で配置されている。
【0042】
図6に矢印で示す方向を入力軸8の正方向の回転方向とする。そして、入力軸8が正方向に回転されると入力軸8の回転角が大きくなり、入力軸8が逆方向に回転されると、入力軸2の回転角が小さくなるものとする。各磁気センサ71,72,73からは、
図7に示すように、入力軸8の回転に伴って、正弦波状の信号S
1,S
2,S
3が出力される。なお、
図6の横軸の回転角[deg]は、機械角を表している。
【0043】
以下において、第1磁気センサ71の出力信号S
1を第1出力信号S
1または第1センサ値S
1といい、第2磁気センサ72の出力信号S
2を第2出力信号S
2または第2センサ値S
2といい、第3磁気センサ73の出力信号S
3を第3出力信号S
3または第3センサ値S
3という場合がある。
以下においては、説明の便宜上、入力軸8の回転角をθ
Aではなく、θで表すことにする。各出力信号S
1,S
2,S
3が正弦波信号であるとみなし、入力軸8の回転角をθ(電気角)とすると、第1磁気センサ71の出力信号S
1は、S
1=A
1・sinθと表され、第2磁気センサ72の出力信号S
2は、S
2=A
2・sin(θ+120)と表され、第3磁気センサ73の出力信号S
3は、S
3=A
3・sin(θ+240)と表される。A
1,A
2,A
3は、それぞれ振幅を表している。第1出力信号S
1と第2出力信号S
2との位相差は120度である。第2出力信号S
2と第3出力信号S
3との位相差も120度である。したがって、第1出力信号S
1と第3出力信号S
3との位相差は240度である。
【0044】
第1の回転角演算部77Aによる回転角θの演算方法の基本的な考え方について説明する。第1の回転角演算部77Aによる回転角演算モードには、第1演算モード〜第5演算モードがある。以下、各演算モードについて説明する。
[1]第1演算モード
第1演算モードは、第1および第2磁気センサ71,72が、3サンプリング周期(3演算周期)連続して共に同じ1つの磁極を検出している場合に適用される演算モードである。第1演算モードでは、第1および第2磁気センサ71,72における3サンプリング分の出力信号に基づいて回転角θが演算される。
【0045】
第1出力信号S
1と第2出力信号S
2との位相差(電気角)をCで表すことにする。また、今回のサンプリング周期の番号(今回の演算周期の番号)を[n]、前回のサンプリング周期の番号を[n-1]、前々回のサンプリング周期の番号を[n-2]で表すことにする。また、各磁極M1〜M8の角度幅(磁極幅,ピッチ幅)のばらつきに基づく回転角演算誤差を補正するための補正値を、角度幅誤差補正値(磁極幅誤差補正値)といい、Eで表すことにする。
【0046】
位相差C、サンプリング周期番号[n],[n-1],[n-2]および角度幅誤差補正値Eを用いると、今回、前回および前々回にサンプリングされた第1出力信号S
1ならびに今回、前回および前々回にサンプリングされた第2出力信号S
2を、それぞれ次式(2a),(2b),(2c), (2d),(2e),(2f)で表すことができる。
S
1[n]=A
1[n]sin(E
1[n]θ[n]) …(2a)
S
1[n-1]=A
1[n-1]sin(E
1[n-1]θ[n-1]) …(2b)
S
1[n-2]=A
1[n-2]sin(E
1[n-2]θ[n-2]) …(2c)
S
2[n]=A
2[n]sin(E
2[n]θ[n]+C) …(2d)
S
2[n-1]=A
2[n-1]sin(E
2[n-1]θ[n-1]+C) …(2e)
S
2[n-2]=A
2[n-2]sin(E
2[n-2]θ[n-2]+C) …(2f)
前記式(2a)〜(2f)において、E
1[x]は、x番目の演算周期において第1磁気センサ71が検出している磁極に対応する角度幅誤差補正値である。E
2[x]は、x番目の演算周期において第2磁気センサ72が検出している磁極に対応する角度幅誤差補正値である。
【0047】
ある磁極の角度幅をw(電気角)とすると、その磁極の角度幅誤差θ
err(電気角)は、次式(3)で定義される。
θ
err=w−180 …(3)
その磁極に対する角度幅誤差補正値Eは、次式(4)で定義される。
E=180/w
=180/(θ
err+180) …(4)
各磁極の角度幅誤差補正値Eは、各磁極の磁極幅に関する情報である。なお、各磁極の磁極幅に関する情報は、各磁極の角度幅wであってもよいし、各磁極の角度幅誤差θ
errであってもよい。
【0048】
Cが既知であるとすると、前記式(2a)〜(2f)で表される6つの式に含まれる未知数の数は16となる。つまり、未知数の数が方程式の数より多いため、このままでは、6つの式からなる連立方程式を解くことができない。
この実施形態では、サンプリング間隔(サンプリング周期)を短く設定することにより、3サンプリング間の温度変化による振幅の変化がないとみなす。つまり、3サンプリング間の第1磁気センサ71の出力信号の振幅A
1[n],A
1[n-1],A
1[n-2]が互いに等しいとみなして、これらをA
1とする。同様に、3サンプリング間の第2磁気センサ72の出力信号の振幅A
2[n],A
2[n-1],A
2[n-2]が互いに等しいとみなし、これらをA
2とする。
【0049】
3サンプリング間において、両磁気センサ71,72が共に同じ1つの磁極を検出している場合には、3サンプリング分の両磁気センサ71,72の出力信号に含まれている角度幅誤差補正値E
1[n],E
1[n-1],E
1[n-2],E
2[n],E
2[n-1],E
2[n-2]は同じ値となるので、これらをEで表すことにする。これにより、前記式(2a)〜(2f)は、それぞれ次式(5a)〜(5f)で表わされる。
【0050】
S
1[n]=A
1sin(Eθ[n]) …(5a)
S
1[n-1]=A
1sin(Eθ[n-1]) …(5b)
S
1[n-2]=A
1sin(Eθ[n-2]) …(5c)
S
2[n]=A
2sin(Eθ[n]+C) …(5d)
S
2[n-1]=A
2sin(Eθ[n-1]+C) …(5e)
S
2[n-2]=A
2sin(Eθ[n-2]+C) …(5f)
これら6つの式に含まれる未知数(A
1,A
2,E,θ[n],θ[n-1],θ[n-2])の数は6となる。つまり、未知数の数が方程式の数以下となるため、6つの式からなる連立方程式を解くことができる。したがって、前記6つの式(5a)〜(5f) からなる連立方程式を解くことにより、入力軸8の回転角θ[n]を演算することができる。
【0051】
以下、両磁気センサ間の位相差Cが120度である場合について、具体的に説明する。位相差Cが120度である場合には、前記6つの式(5a)〜(5f) は、それぞれ次式(6a)〜(6f)で表わすことができる。
S
1[n]=A
1sin(Eθ[n]) …(6a)
S
1[n-1]=A
1sin(Eθ[n-1]) …(6b)
S
1[n-2]=A
1sin(Eθ[n-2]) …(6c)
S
2[n]=A
2sin(Eθ[n]+120) …(6d)
S
2[n-1]=A
2sin(Eθ[n-1]+120) …(6e)
S
2[n-2]=A
2sin(Eθ[n-2]+120) …(6f)
Eθ[n]を1つの未知数と考えると、前記6つの式(6a)〜(6f)のうちの4つの式(6a),(6b),(6d),(6e) からなる連立方程式を解くことにより、Eθ[n]は、次式(7) (以下、「Eθ基本演算式(7)」という。)で表わされる。
【0053】
また、前記6つの式(6a)〜(6f)からなる連立方程式を解くことにより、角度幅誤差補正値Eは、次式(8) (以下、「E演算式(8)」という。)で表わされる。
【0055】
したがって、前記Eθ基本演算式(7)により演算されたEθ[n]を、前記E演算式(8)により演算された角度幅誤差補正値Eで除することにより、θ[n]を求めることができる。つまり、次式(9)により、θ[n]を求めることができる。
θ[n]=Eθ[n]/E …(9)
ただし、E演算式(8) に含まれている分数のいずれかの分母が零になる場合には、E演算式(8)に基づいて角度幅誤差補正値Eを演算することはできない。そこで、この実施形態では、E演算式(8) に含まれている分数のいずれかの分母が零になる場合には、前回に演算された角度幅誤差補正値Eを今回の角度幅誤差補正値Eとして用いるようにしている。
【0056】
なお、E演算式(8) に含まれている分数のいずれかの分母が零になる場合とは、次式(10),(11),(12)でそれぞれ表される3つの条件のうちの少なくとも1つの条件を満たす場合である。
【0058】
また、Eθ基本演算式(7)に含まれている分数のいずれかの分母が零になる場合には、Eθ基本演算式(7)に基づいてEθ[n]を演算することはできない。そこで、この実施形態では、Eθ基本演算式(7)に含まれている分数のいずれかの分母が零になる場合には、Eθ基本演算式(7)とは異なる演算式によってEθ[n]を演算するようにしている。さらに、この実施形態では、Eθ基本演算式(7)に基づいてEθ[n]を演算することができるけれども、より簡単な演算式によってEθ[n]を演算できる場合には、Eθ基本演算式(7)とは異なる演算式によってEθ[n]を演算するようにしている。この実施形態では、Eθ基本演算式(7)よりも簡単にEθ[n]を演算できる場合とは、S
2[n]=0の場合またはS
1[n]=0の場合である。
【0059】
この実施形態では、Eθ[n]を演算するための演算式として、Eθ基本演算式(7)を含めて10種類の演算式が用意されている。表1は、10種類の演算式と、その演算式が適用される条件とを示している。なお、Eθ[n]を演算する際には、表1の上から順番にその条件を満たしているか否かが判別され、条件を満たしたと判別されるとそれ以降の条件判別は行われず、当該条件に対応する演算式により、Eθ[n]が演算される。
【0061】
表1の上から1番目の演算式は、Eθ基本演算式(7)である。Eθ基本演算式(7)は、S
1[n]およびS
2[n]のいずれもが零でなく、かつEθ基本演算式(7)に含まれている分数のいずれの分母も零でないという条件を満たしている場合に、適用される。Eθ基本演算式(7)に含まれている分数のいずれの分母も零でないという条件は、p
1−p
2≠0でかつ、p
12+p
1p
2+p
22≠0でかつ、S
1[n-1]≠0でかつS
2[n-1]≠0である場合に満たされる。なお、S
1[n-1]はp
1の分母であり、S
2[n-1]はp
2の分母である。
【0062】
ただし、p
12+p
1p
2+p
22=0が成立するのは、p
1=p
2=0の場合だけであるが、第1磁気センサ71と第2磁気センサ72とは位相が120度ずれているため、両磁気センサ71,72のセンサ値S
1,S
2が同時に零になることはない。このため、p
12+p
1p
2+p
22=0が成立することはない。したがって、Eθ基本演算式(7)に含まれている分数のいずれの分母も零でないという条件は、p
1−p
2≠0でかつ、S
1[n-1]≠0でかつS
2[n-1]≠0である場合に満たされる。
【0063】
表1の上から2番目の演算式は、p
1−p
2=0である場合に適用される演算式である。p
1−p
2=0が成立する場合について検討する。この場合には、p
1=p
2であるから、次式(13)が成立する。
【0065】
これを変形すると、次式(14)が得られる。
【0067】
前記式(14)が成立する場合とは、Eθ[n]とEθ[n-1]とが等しい場合である。つまり、今回のEθ[n]が前回のEθ[n-1]に等しい場合である。そこで、S
1[n]およびS
2[n]のいずれもが零でなく、かつp
1の分母S
1[n-1]およびp
2の分母S
2[n-1]のいずれもが零でなく、かつp
1−p
2=0であるという条件を満たした場合には、前回に演算されたEθ[n-1]が今回のEθ[n]として用いられる。
【0068】
表1の上から3番目および4番目の演算式は、p
1の分母S
1[n-1]が零となる場合に適用される演算式である。S
1[n-1]=A
1sinEθ[n-1]であるので、sinEθ[n-1]=0のときに、S
1[n-1]=0となる。つまり、Eθ[n-1]が0度または180度のときに、S
1[n-1]が零となる。S
2[n-1]=A
2sin(Eθ[n-1]+120)であるので、Eθ[n-1]が0度のときにはS
2[n-1]>0となり、Eθ[n-1]が180度のときにはS
2[n-1]<0となる。したがって、S
1[n-1]=0でかつS
2[n-1]>0のときにはEθ[n-1]=0となり、S
1[n-1]=0でかつS
2[n-1]<0のときにはEθ[n-1]=180となる。
【0069】
Eθ[n-1]=0である場合には、前記式 (6c),(6d)は、それぞれ次式 (15c),(15d)で表される。
S
2[n]=A
2sin(Eθ[n]+120) …(15c)
S
2[n-1]=A
2sin120=√3/2・A
2 …(15d)
前記式(15d)から、次式(16)が得られる。
【0070】
A
2=(2/√3)・S
2[n-1] …(16)
前記式(16)を前記式(15c)に代入すると、次式(17)が得られる。
sin(Eθ[n]+120)=(√3/2)・(S
2[n]/S
2[n-1]) …(17)
したがって、Eθ[n]は、次式(18)により演算することができる。
【0072】
つまり、表1の上から3番目に示すように、S
1[n]およびS
2[n]のいずれもが零でなく、かつp
2の分母S
2[n-1]が零でなく、かつp
1の分母S
1[n-1]が零であり、かつS
2[n-1]>0であるという条件を満たした場合には、前記式(18)で表される演算式に基づいてEθ[n]が演算される。
一方、Eθ[n-1]=180である場合には、前記式 (6c),(6d)は、それぞれ次式(19c),(19d)で表される。
【0073】
S
2[n]=A
2sin(Eθ[n]+120) …(19c)
S
2[n-1]=A
2sin300=−√3/2・ A
2 …(19d)
前記式(19d)から、次式(20)が得られる。
A
2=(−2/√3)・S
2[n-1] …(20)
前記式(20)を前記式(19c)に代入すると、次式(21)が得られる。
【0074】
sin(Eθ[n]+120)=(−√3/2)・(S
2[n]/S
2[n-1]) …(21)
したがって、Eθ[n]は、次式(22)により演算することができる。
【0076】
つまり、表1の上から4番目に示すように、S
1[n]およびS
2[n]のいずれもが零でなく、かつp
2の分母S
2[n-1]が零でなく、かつp
1の分母S
1[n-1]が零であり、かつS
2[n-1]<0であるという条件を満たした場合には、前記式(22)で表される演算式に基づいてEθ[n]が演算される。
表1の上から5番目および6番目の演算式は、S
2[n]=0となる場合に適用される演算式である。S
2[n]=A
2sin(Eθ[n]+120)であるので、sin(Eθ[n]+120)=0のときに、S
2[n]=0となる。つまり、Eθ[n]が−120度または60度のときに、S
2[n]=0となる。S
1[n]=A
1sinEθ[n]であるので、Eθ[n]が−120度のときにはS
1[n]<0となり、Eθ[n]が60度のときにはS
1[n]>0となる。したがって、S
2[n]=0でかつS
1[n]>0のときにはEθ[n]=60となり、S
2[n]=0でかつS
1[n]<0であればEθ[n]=−120となる。
【0077】
つまり、表1の上から5番目に示すように、S
1[n]が零でなく、かつp
2の分母S
2[n-1]が零でなく、かつS
2[n]=0であり、かつS
1[n]>0であるという条件を満たした場合には、Eθ[n]は60度として演算される。また、表1の上から6番目に示すように、S
1[n]が零でなく、かつp
2の分母S
2[n-1]が零でなく、かつS
2[n]=0であり、かつS
1[n]>0であるという条件を満たした場合には、Eθ[n]は−120度として演算される。
【0078】
表1の上から7番目および8番目の演算式は、p
2の分母S
2[n-1]が零となる場合に適用される演算式である。S
2[n-1]=A
2sin(Eθ[n-1]+120)であるので、sin(Eθ[n-1]+120)=0のときに、S
2[n-1]=0となる。つまり、Eθ[n-1]が−120度または60度のときに、S
2[n-1]が零となる。S
1[n-1]=A
1sinEθ[n-1]であるので、Eθ[n-1]が−120度のときにはS
1[n-1]<0となり、Eθ[n-1]が60度のときにはS
1[n-1]>0となる。したがって、S
2[n-1]=0でかつS
1[n-1]>0のときにはEθ[n-1]=60となり、S
2[n-1]=0でかつS
1[n-1]<0のときにはEθ[n-1]=−120となる。
【0079】
Eθ[n-1]=60である場合には、前記式 (6a),(6b)は、それぞれ次式 (23a),(23b)で表される。
S
1[n]=A
1sinEθ[n] …(23a)
S
1[n-1]=A
1sin60=√3/2・ A
1 …(23b)
前記式(23b)から、次式(24)が得られる。
【0080】
A
1=(2/√3)・S
1[n-1] …(24)
前記式(24)を前記式(23a)に代入すると、次式(25)が得られる。
sinEθ[n]=(√3/2)・(S
1[n]/S
1[n-1]) …(25)
したがって、Eθ[n]は、次式(26)により演算することができる。
【0082】
つまり、表1の上から7番目に示すように、S
1[n]が零でなく、かつp
2の分母S
2[n-1]が零であり、かつS
1[n-1]>0であるという条件を満たした場合には、前記式(26)で表される演算式に基づいてEθ[n]が演算される。
一方、Eθ[n-1]=−120である場合には、前記式 (6a),(6b)は、それぞれ次式 (27a),(27b)で表される。
【0083】
S
1[n]=A
1sinEθ[n] …(27a)
S
1[n-1]=A
1sin(−120)=−√3/2・ A
2 …(27b)
前記式(27b)から、次式(28)が得られる。
A
1=(−2/√3)・S
1[n-1] …(28)
前記式(28)を前記式(27a)に代入すると、次式(29)が得られる。
【0084】
sinEθ[n]=(−√3/2)・(S
1[n]/S
1[n-1]) …(29)
したがって、Eθ[n]は、次式(30)により演算することができる。
【0086】
つまり、表1の上から8番目に示すように、S
1[n]が零でなく、かつp
2の分母S
2[n-1]が零であり、かつS
1[n-1]<0であるという条件を満たした場合には、前記式(30)で表される演算式に基づいてEθ[n]が演算される。
表1の上から9番目および10番目の演算式は、S
1[n]=0となる場合に適用される演算式である。S
1[n]=A
1sinEθ[n]であるので、sinEθ[n]=0のときに、S
1[n]=0となる。つまり、Eθ[n]が0度または180度のときに、S
1[n]=0となる。S
2[n]=A
2sin(Eθ[n]+120]であるので、Eθ[n]が0度のときにはS
2[n]>0となり、Eθ[n]が180度のときにはS
2[n]<0となる。したがって、S
1[n]=0でかつS
2[n]>0であればEθ[n]=0となり、S
1[n]=0でかつS
2[n]<0であればEθ[n]=180となる。
【0087】
つまり、表1の上から9番目に示すように、S
1[n]が零であり、かつS
2[n]>0であるという条件を満たした場合には、Eθ[n]は0度として演算される。また、表1の上から10番目に示すように、S
1[n]が零であり、かつS
2[n]<0であるという条件を満たした場合には、Eθ[n]は180度として演算される。
Eθ[n]が演算されると、前記式(6a)に基づいて振幅A
1を演算することができるとともに、前記式(6d)に基づいて振幅A
2を演算することができる。つまり、第1演算モードによって、E,θ[n],A
1,A
2を演算することができる。
[2]第2演算モード
第2演算モードは、第2および第3磁気センサ72,73が、3サンプリング周期(3演算周期)連続して共に同じ1つの磁極を検出している場合に適用される演算モードである。第2演算モードでは、第2および第3磁気センサ72,73における3サンプリング分の出力信号に基づいて回転角θが演算される。
【0088】
第2磁気センサ72および第3磁気センサ73の出力信号S
2,S
3を、角度幅誤差補正値Eを用いて表すと、第2磁気センサ72の出力信号S
2[n]はS
2[n]=A
2・sin(E
2θ[n]+120)で表され、第3磁気センサ73の出力信号S
3[n]は、S
3[n]=A
3・sin(E
3θ[n]+240)と表される。ここで、E
3は、第3磁気センサ73が検出している磁極に対応する角度幅誤差補正値である。第2磁気センサ72および第3磁気センサ73が同じ磁極を検出している場合には、E
2とE
3とは等しいので、これらをEで表すと、第2磁気センサ72の出力信号S
2[n]はS
2[n]=A
2・sin(Eθ[n]+120)で表され、第3磁気センサ73の出力信号S
3[n]は、S
3[n]=A
3・sin(Eθ[n]+240)と表される。
【0089】
(Eθ[n]+120)をEΘ[n]に置き換えると、第2出力信号S
2[n]はS
2[n]=A
2・sinEΘ[n]で表され、第3出力信号S
3[n]はS
3[n]=A
3・sin(EΘ[n]+120)で表わされる。したがって、第2出力信号S
2と第3出力信号S
3とを用い、前述した方法と同様な方法でEΘ[n]とEとを演算することができる。EΘ[n]=Eθ[n]+120であるので、θ[n]=(EΘ[n]−120)/Eである。したがって、θ[n]=(EΘ[n]−120)/Eの式に、演算されたEΘ[n]とEを代入することにより、入力軸8の回転角θ[n]を演算することができる。また、EΘ[n]が演算されると、振幅A
2および振幅A
3を演算することができる。つまり、第2演算モードによって、E,θ[n],A
2,A
3を演算することができる。
【0090】
第2演算モードによる回転角演算に用いられる3サンプリング分の第2および第3出力信号を、前記式(6a) 〜(6f)にならって次式(31a) 〜(31f)で表すと、EΘ基本演算式およびE演算式はそれぞれ次式(32) および(33)で表すことができる。
S
2[n]=A
2sin(Eθ[n]+120) …(31a)
S
2[n-1]=A
2sin(Eθ[n-1]+120) …(31b)
S
2[n-2]=A
2sin(Eθ[n-2]+120) …(31c)
S
3[n]=A
3sin(Eθ[n]+120) …(31d)
S
3[n-1]=A
3sin(Eθ[n-1]+120) …(31e)
S
3[n-2]=A
3sin(Eθ[n-2]+120) …(31f)
【0093】
第1演算モードまたは第2演算モードでは、3つの磁気センサ71,72,73のうちの2つの磁気センサにおける3サンプリング分の出力信号に基づいて入力軸8の回転角θ[n]を演算しているので、精度の高い回転角を演算することが可能となる。また、第1演算モードまたは第2演算モードでは、入力軸8の回転角θ[n]の演算に用いられる数式の数が、これらの数式に含まれている本来の未知数の数より少なくても、入力軸8の回転角θ[n]を演算することができるので、入力軸8の回転角θ[n]を演算するために必要なセンサ値の数を少なくすることが可能となる。
【0094】
第1演算モードまたは第2演算モードでは、3サンプリング間での同じ磁気センサの出力信号の振幅が互いに等しいとみなしている。3サンプリング間での同じ磁気センサの出力信号の振幅は、温度変化の影響によって異なる値となる可能性がある。しかしながら、サンプリング間隔が小さい場合には、3サンプリング間の温度変化は非常に小さいので、3サンプリング間での同じ磁気センサの出力信号の振幅は等しいとみなすことができる。したがって、第1演算モードまたは第2演算モードでは、3サンプリング間での温度変化の影響による振幅のばらつきを補償することができる。また、第1演算モードまたは第2演算モードでは、回転角の演算に用いられている2つの磁気センサ間の振幅は、別々の未知数として扱っているので、それらの2つの磁気センサ間の温度特性のばらつきの影響を補償することができる。これにより、精度の高い回転角を検出することができる。
【0095】
また、第1演算モードまたは第2演算モードでは、磁石61の各磁極M1〜M8の角度幅(ピッチ幅)のばらつきを高い精度で補償できるので、誤差のより小さい回転角を検出することが可能となる。
[3]第3演算モード
第3演算モードは、第1演算モードおよび第2演算モードのいずれもが適用できない場合であって、第1磁気センサ71が検出している磁極に対応する角度幅誤差補正値E
1および第1出力信号S
1の振幅A
1が第1演算モードによって既に演算されてメモリに記憶されている場合に適用される演算モードである。第3演算モードでは、主として第1磁気センサ71の出力信号S
1に基づいて回転角θが演算される。
【0096】
たとえば、
図8Aに示すように、磁石61(入力軸8)が矢印で示す方向に回転している場合において、第1および第2磁気センサ71,72が同じ磁極(この例ではM1)を検出している状態から、第2磁気センサ72の検出している磁極が変化した場合に、第3演算モードは適用される。
角度幅誤差補正値Eと今演算周期の番号nを用いると、今演算周期においてサンプリングされた第1磁気センサ71の出力信号S
1は、次式(34)で表される。
【0097】
S
1[n]=A
1[n]sin(E
1θ[n]) …(34)
E
1は、第1磁気センサ71が検出している磁極に対応する角度幅誤差補正値である。
前記式(34)から回転角θ[n]は、次式(35)で表される。
θ[n]=(1/E
1)sin
−1(S
1[n]/A
1) …(35)
メモリに記憶されており、第1磁気センサ71が検出している磁極に対応するE
1およびA
1を、前記式(35)に代入することにより、θ[n]が演算される。ただし、式(35)によって回転角θ[n]を演算する場合には、2つの回転角θ[n]が演算されるので、いずれの回転角が実際の回転角であるかを判定する必要がある。この判定方法について、
図9を参照して説明する。
図9には、第1出力信号S
1、第2出力信号S
2および第3出力信号S
3の1周期分の波形が示されている。
図9の横軸の回転角[deg]は、電気角を表している。
【0098】
図9に示すように、第1出力信号S
1[n]がたとえば正の値である場合には、(1/E
1)sin
−1(S
1[n]/A
1)に対応する回転角θ[n]は、0度〜90度の領域R1内の回転角と、90度〜180度の領域R2内の回転角との2つの回転角となる。また、第1出力信号S
1[n]がたとえば負の値である場合には、(1/E
1)sin
−1(S
1[n]/A
1)に対応する回転角θ[n]は、180度〜270度の領域U1内の回転角と、270度〜360度の領域U2内の回転角との2つの回転角となる。
【0099】
この実施形態では、第1磁気センサ71以外の2つの磁気センサ72,73の出力信号S
2,S
3のいずれか一方に基づいて、前記式(35)によって演算される2つの回転角のうちのいずれが実際の回転角であるかが判定される。たとえば、第2出力信号S
2[n]に基づいて、前記判定が行われる場合について説明する。第2出力信号S
2の振幅A
2の1/2を閾値a(a>0)とする。この閾値aは、たとえば、メモリに記憶されている第2出力信号S
2の振幅A
2であって、第1磁気センサ71が検出している磁極に対応する振幅A
2に基づいて求めることができる。なお、第1出力信号S
1の振幅A
1の1/2を閾値a(a>0)としてもよい。
【0100】
第2出力信号S
2[n]がa以上のときに取り得る入力軸8の回転角θ[n]は、0度〜30度の範囲および270度〜360度の範囲である。第2出力信号S
2[n]が−a未満のときに取り得る入力軸8の回転角θ[n]は、90度〜210度の範囲である。第2出力信号S
2[n]が−a以上a未満のときに取り得る入力軸8の回転角θ[n]は、30度〜90度の範囲および210度〜270度の範囲である。
【0101】
したがって、前記式(35)によって演算された2つの回転角のうち、いずれの回転角が実際の回転角であるかを、第2出力信号S
2[n]に基づいて判定することができる。具体的には、第1出力信号S
1[n]が正の値である場合には、第2出力信号S
2[n]が−a以上であれば、前記式(35)によって演算された2つの回転角のうち領域R1内の回転角が実際の回転角であると判定される。一方、第2出力信号S
2[n]が−a未満であれば、前記式(35)によって演算された2つの回転角のうち領域R2内の回転角が実際の回転角であると判定される。
【0102】
第1出力信号S
1[n]が負の値である場合には、第2出力信号S
2[n]がa未満であれば、前記式(35)によって演算された2つの回転角のうち領域U1内の回転角が実際の回転角であると判定される。一方、第2出力信号S
2[n]がa以上であれば、前記式(35)によって演算された2つの回転角のうち領域U2内の回転角が実際の回転角であると判定される。
[4]第4演算モード
第4演算モードは、第1演算モードおよび第2演算モードのいずれもが適用できない場合であって、第2磁気センサ72が検出している磁極に対応する角度幅誤差補正値E
2および第2出力信号S
2の振幅A
2が第1演算モードまたは第3演算モードによって既に演算されてメモリに記憶されている場合に適用される演算モードである。第4演算モードでは、主として第2磁気センサ72の出力信号S
2に基づいて回転角θが演算される。
【0103】
たとえば、
図8Bに示すように、磁石61(入力軸8)が矢印で示す方向に回転している場合において、第1および第2磁気センサ71,72が同じ磁極(この例ではM1)を検出している状態から、第1磁気センサ71が検出している磁極が変化した場合に、第4演算モードは適用される。
角度幅誤差補正値Eと今演算周期の番号nを用いると、今演算周期においてサンプリングされた第2磁気センサ72の出力信号S
2は、次式 (36)で表される。
【0104】
S
2[n]=A
2[n]sin(E
2θ[n]+120) …(36)
E
2は、第2磁気センサ72が検出している磁極に対応する角度幅誤差補正値である。
前記式(36)から回転角θ[n]は、次式(37)で表される。
θ[n]=(1/E
2){sin
−1(S
2[n]/A
2)−120} …(37)
メモリに記憶されており、第2磁気センサ72が検出している磁極に対応するE
2およびA
2を、前記式(37)に代入することにより、θ[n]が演算される。
【0105】
前記式(37)によって回転角θ[n]を演算すると、2つの回転角θ[n]が演算される。そこで、第2磁気センサ72以外の2つの磁気センサ71,73の出力信号S
1,S
3のいずれか一方に基づいて、前記式(37)によって演算された2つの回転角θ[n]のうちのいずれが実際の回転角であるかを判定する。
たとえば、第1出力信号S
1[n]に基づいて、前記判定が行われる場合について説明する。メモリに記憶されている第1出力信号S
1の振幅A
1の1/2または第2出力信号S
2の振幅A
2の1/2を閾値a(a>0)とする。
【0106】
第2出力信号S
2[n]が正の値である場合には、第1出力信号S
1[n]が−a未満であれば、前記式(37)によって演算された2つの回転角のうち240度〜330度の領域内の回転角が実際の回転角であると判定される。一方、第1出力信号S
1[n]が−a以上であれば、前記式(37)によって演算された2つの回転角のうち0度〜60度または330度〜360度の領域内の回転角が実際の回転角であると判定される。
【0107】
第2出力信号S
2[n]が負の値である場合には、第1出力信号S
1[n]がa以上であれば、前記式(37)によって演算された2つの回転角のうち60度〜150度の領域内の回転角が実際の回転角であると判定される。一方、第1出力信号S
1[n]がa未満であれば、前記式(37)によって演算された2つの回転角のうち150度〜240度の領域内の回転角が実際の回転角であると判定される。
[5]第5演算モード
第5演算モードは、第1演算モードおよび第2演算モードのいずれもが適用できない場合であって、第3磁気センサ73が検出している磁極に対応する角度幅誤差補正値E
3および第3出力信号S
3の振幅A
3が第2演算モードによって既に演算されてメモリに記憶されている場合に適用される演算モードである。第5演算モードでは、主として第3磁気センサ72の出力信号S
3に基づいて回転角θが演算される。
【0108】
たとえば、
図8Cに示すように、磁石61(入力軸8)が矢印で示す方向に回転している場合において、第2および第3磁気センサ72,73が同じ磁極(この例ではM2)を検出している状態から、第2磁気センサ72が検出している磁極が変化した場合に、第5演算モードは適用される。
角度幅誤差補正値Eと今演算周期の番号nを用いると、今演算周期においてサンプリングされた第3磁気センサ73の出力信号S
3は、次式 (38)で表される。
【0109】
S
3[n]=A
3[n]sin(E
3θ[n]+240) …(38)
E
3は、第3磁気センサ72が検出している磁極に対応する角度幅誤差補正値である。
前記式(38)から回転角θ[n]は、次式(39)で表される。
θ[n]=(1/E
3){sin
−1(S
3[n]/A
3)−120} …(39)
メモリに記憶されており、第3磁気センサ73が検出している磁極に対応するE
3およびA
3を、前記式(39)に代入することにより、θ[n]が演算される。
【0110】
前記式(39)によって回転角θ[n]を演算すると、2つの回転角θ[n]が演算される。そこで、第3磁気センサ73以外の2つの磁気センサ71,723の出力信号S
1,S
2のいずれか一方に基づいて、前記式(39)によって演算された2つの回転角θ[n]のうちのいずれが実際の回転角であるかを判定する。
たとえば、第2出力信号S
2[n]に基づいて、前記判定が行われる場合について説明する。メモリに記憶されている第2出力信号S
2の振幅A
2の1/2または第3出力信号S
3の振幅A
3の1/2を閾値a(a>0)とする。
【0111】
第3出力信号S
3[n]が正の値である場合には、第2出力信号S
2[n]が−a未満であれば、前記式(39)によって演算された2つの回転角のうち120度〜210度の領域内の回転角が実際の回転角であると判定される。一方、第2出力信号S
2[n]が−a以上であれば、前記式(39)によって演算された2つの回転角のうち210度〜300度の領域内の回転角が実際の回転角であると判定される。
【0112】
第3出力信号S
3[n]が負の値である場合には、第2出力信号S
2[n]がa以上であれば、前記式(39)によって演算された2つの回転角のうち300度〜360度または0度〜30度の領域内の回転角が実際の回転角であると判定される。一方、第2出力信号S
2[n]がa未満であれば、前記式(39)によって演算された2つの回転角のうち30度〜120度の領域内の回転角が実際の回転角であると判定される。
【0113】
図10は、第1の回転角演算部77Aの動作を示すフローチャートである。
トルク演算用ECU77の電源がオンすると、第1の回転角演算部77Aは、強制回転に基づく回転角演算処理を行う(ステップS1)。この処理は、電動モータ18を一時的に強制回転させることにより、入力軸8(出力軸9)を回転させ、入力軸8の回転角θを演算する処理である。この処理の詳細については後述する。
【0114】
前述した第1演算モードまたは第2演算モードでは、前回のサンプリング時点と今回のサンプリング時点とにおいて、回転角θ[n]の演算に用いられる2つの磁気センサの出力信号が変化していない場合には、前回演算されたEθ[n](またはEΘ[n])、Eおよびθ[n]が、今回のEθ[n](またはEΘ[n])、Eおよびθ[n]として用いられる(表1の上から2番目の演算式を参照)。しかしながら、イグニッションキーがオン操作されることによって、トルク演算用ECU77の電源がオンされた時点では、前回演算されたEθ[n](またはEΘ[n])、Eおよびθ[n]は存在しないため、トルク演算用ECU77の電源がオンされた後に、回転角θ[n]の演算に用いられる2つの磁気センサの出力信号が変化していない場合には、回転角θ[n]を演算できなくなる。そこで、Eθ[n](またはEΘ[n])、Eおよびθ[n]の前回値を作成するために、強制回転に基づく回転角演算処理を行っている。
【0115】
強制回転に基づく回転角演算処理が終了すると、第1の回転角演算部77Aは、通常時の回転角演算処理を行う(ステップS2)。この処理の詳細については後述する。通常時の回転角演算処理は、イグニッションキーのオフ操作が行われるまで継続して行われる。イグニッションキーのオフ操作が行われると(ステップS3:YES)、第1の回転角演算部77Aは通常時の回転角演算処理を終了する。
【0116】
図11A、
図11Bおよび
図11Cは、
図10のステップS1の強制回転に基づく回転角演算処理の手順を示すフローチャートである。
強制回転に基づく回転角演算処理開始時において第1磁気センサ71が検出している磁極を基準磁極として、各磁極に相対的な番号を割り当てた場合の各磁極の番号を相対的極番号と定義する。第1磁気センサ71が検出している磁極の相対的極番号(以下、「第1相対的極番号」という)を変数r1で表し、第2磁気センサ72が検出している磁極の相対的極番号(以下、「第2相対的極番号」という)を変数r2で表し、第3磁気センサ73が検出している磁極の相対的極番号(以下、「第3相対的極番号」という)を変数r3で表すことにする。なお、各相対的極番号r1,r2,r3は、1〜8の整数をとり、1より1少ない相対的極番号は8となり、8より1大きい相対的極番号は1となるものとする。
【0117】
トルク演算用ECU77内のメモリには、
図12に示すように、e1〜e7で示すエリア等が設けられている。エリアe1には、1〜8の相対的磁極番号毎に角度幅誤差補正値Eの値が記憶される。エリアe2には、1〜8の相対的磁極番号毎に第1出力信号S
1の振幅A
1が記憶される。エリアe3には、1〜8の相対的磁極番号毎に第2出力信号S
2の振幅A
2が記憶される。エリアe4には、1〜8の相対的磁極番号毎に第3出力信号S
3の振幅A
3が記憶される。
【0118】
エリアe5には、複数演算周期分の第1相対的極番号r1[n-k]〜r1[n](kは、3以上の自然数)が記憶される。エリアe6には、複数演算周期分の第2相対的極番号r2[n-k]〜r2[n]が記憶される。エリアe7には、複数演算周期分の第3相対的極番号r3[n-k]〜r3[n]が記憶される。
図11Aに戻り、強制回転に基づく回転角演算処理では、短時間ではあるがステアリングホイール2が自動的に回転する。このため、運転者は何らかの故障が発生したと誤解するおそれがある。そこで、第1の回転角演算部77Aは、運転者への警告を行う(ステップS11)。具体的には、第1の回転角演算部77Aは、車内に設けられた表示装置(図示略)、音声出力装置(図示略)等を制御するための映像音声制御装置(図示略)に、警告出力指令を送信する。映像音声制御装置は、この警告出力指令を受信すると、「ステアリングホイールが強制的に回転しますが故障ではありません」等のメッセージを表示装置に表示したり、音声出力装置によって音声出力したりする。
【0119】
次に、第1の回転角演算部77Aは、第1方向に電動モータ18を回転駆動させる(ステップS12)。具体的には、第1の回転角演算部77Aは、第1方向に電動モータ18を回転駆動させるための第1強制回転指令をモータ制御用ECU12に送信する。モータ制御用ECU12は、この第1強制回転指令を受信すると、第1方向に電動モータ18を回転駆動させる。
【0120】
第1の回転角演算部77Aは、各磁気センサ71,72,73のセンサ値S
1[n], S
2[n] ,S
3[n]を取得する(ステップS13)。ステップS13の処理は、後述するステップS19またはステップS21でYESと判定されるまで、所定の演算周期毎に繰り返し実行される。トルク演算用ECU77内のメモリには、所定回数前に取得されたセンサ値から最新に取得されたセンサ値までの複数回分(3回以上)のセンサ値が記憶されるようになっている。
【0121】
第1の回転角演算部77Aは、今回の処理が強制回転に基づく回転角演算処理開始後の初回の処理であるか否かを判別する(ステップS14)。今回の処理が強制回転に基づく回転角演算処理開始後の初回の処理である場合には(ステップS14:YES)、第1の回転角演算部77Aは、相対的極番号の設定処理を行う(ステップS15)。
図13は、相対的極番号の設定処理の詳細な手順を示すフローチャートである。
【0122】
第1の回転角演算部77Aは、まず、第1出力信号S
1が0より大きいか否かを判別する(ステップS51)。第1出力信号S
1が0より大きい場合には(ステップS51:YES)、第1の回転角演算部77Aは、第1磁気センサ71が検出している磁極がN極の磁極であると判別し、第1相対的極番号r1を1に設定する(ステップS54)。そして、ステップS56に進む。
【0123】
一方、第1出力信号S
1が0以下である場合には(ステップS51:NO)、第1の回転角演算部77Aは、第1出力信号S
1が0より小さいか否かを判別する(ステップS52)。第1出力信号S
1が0より小さい場合には(ステップS52:YES)、第1の回転角演算部77Aは、第1磁気センサ71が検出している磁極がS極の磁極であると判別し、第1相対的極番号r1を2に設定する(ステップS55)。そして、ステップS56に進む。
【0124】
前記ステップS52において、第1出力信号S
1が0以上であると判別された場合には(ステップS52:NO)、つまり、第1出力信号S
1が0である場合には、第1の回転角演算部77Aは、入力軸8の回転角が0°であるか180°であるかを判別するために、第2出力信号S
2が0より大きいか否かを判別する(ステップS53)。第2出力信号S
2が0より大きい場合には(ステップS53:YES)、第1の回転角演算部77Aは、入力軸8の回転角が0°であると判別し、第1相対的極番号r1を1に設定する(ステップS54)。そして、ステップS56に進む。
【0125】
一方、第2出力信号S
2が0以下である場合には(ステップS53:NO)、第1の回転角演算部77Aは、入力軸8の回転角が180°であると判別し、第1相対的極番号r1を2に設定する(ステップS55)。そして、ステップS56に進む。
ステップS56では、第1の回転角演算部77Aは、「S
1≧0かつS
2>0」または「S
1≦0かつS
2<0」の条件を満たしているか否かを判別する。この条件を満たしている場合には(ステップS56:YES)、第1の回転角演算部77Aは、第2磁気センサ72が検出している磁極の極番号は、第1磁気センサ71が検出している磁極の極番号と同じであると判別し、第2相対的極番号r2に第1相対的極番号r1と同じ番号(r2=r1)を設定する(ステップS57)。そして、ステップS59に進む。
【0126】
一方、前記ステップS56の条件を満たしていない場合には(ステップS56:NO)、第1の回転角演算部77Aは、第2磁気センサ72が検出している磁極の極番号は、第1磁気センサ71が検出している磁極の極番号より1だけ大きい番号であると判別し、第2相対的極番号r2に、第1相対的極番号r1より1だけ大きい番号(r2=r1+1)を設定する(ステップS58)。そして、ステップS59に進む。
【0127】
ステップS59では、第1の回転角演算部77Aは、「S
1≧0かつS
3<0」または「S
1≦0かつS
3>0」の条件を満たしているか否かを判別する。この条件を満たしている場合には(ステップS59:YES)、第1の回転角演算部77Aは、第3磁気センサ73が検出している磁極の極番号は、第1磁気センサ71が検出している磁極の極番号より1だけ大きい番号であると判別し、第3相対的極番号r3に、第1相対的極番号r1より1だけ大きい番号(r3=r1+1)を設定する(ステップS60)。そして、
図11BのステップS18に移行する。
【0128】
一方、前記ステップS59の条件を満たしていない場合には(ステップS59:NO)、第1の回転角演算部77Aは、第3磁気センサ73が検出している磁極の極番号は、第1磁気センサ71が検出している磁極の極番号より2だけ大きい番号であると判別し、第3相対的極番号r3に、第1相対的極番号r1より2だけ大きい番号(r3=r1+2)を設定する(ステップS61)。そして、
図11BのステップS18に移行する。
【0129】
前記ステップS56の条件に基づいて第2相対的極番号r2を決定している理由および前記ステップS59の条件に基づいて第3相対的極番号r3を決定している理由について説明する。たとえば、磁石61における磁極M1と磁極M2とからなる磁極対が第1磁気センサ71を通過する際の、第1、第2および第3出力信号S
1,S
2,S
3の信号波形を模式的に表すと、
図14の(a),(b),(c)のようになる。
【0130】
図14において、Q1およびQ4で示す領域においては、第2磁気センサ72が検出している磁極の極番号は、第1磁気センサ71が検出している磁極の極番号と同じである。一方、Q2,Q3,Q5およびQ6で示す領域においては、第2磁気センサ72が検出している磁極の極番号は、第1磁気センサ71が検出している磁極の極番号より1だけ大きい。
【0131】
領域Q1においては、両センサ値S
1,S
2は、S
1≧0かつS
2>0の第1条件を満たす。領域Q2およびQ3においては、両センサ値S
1,S
2は、S
1>0かつS
2≦0の第2条件を満たす。領域Q4においては、両センサ値S
1,S
2は、S
1≦0かつS
2<0の第3条件を満たす。領域Q5およびQ6においては、両センサ値S
1,S
2は、S
1<0かつS
2≧0の第4条件を満たす。そこで、第1の回転角演算部77Aは、第1条件および第3条件の一方を満たしているときには、第2磁気センサ72が検出している磁極の極番号が、第1磁気センサ71が検出している磁極の極番号と同じであると判別している。一方、第1条件および第3条件のいずれの条件をも満たしていないときには、第1の回転角演算部77Aは、第2磁気センサ72が検出している磁極の極番号が、第1磁気センサ71が検出している磁極の極番号より1だけ大きいと判別している。
【0132】
図14において、Q1およびQ2で示す領域ならびにQ4およびQ5で示す領域においては、第3磁気センサ73が検出している磁極の極番号は、第1磁気センサ71が検出している磁極の極番号より1だけ大きい。一方、Q3およびQ6で示す領域においては、第3磁気センサ72が検出している磁極の極番号は、第1磁気センサ71が検出している磁極の極番号より2だけ大きい。
【0133】
領域Q1およびQ2においては、両センサ値S
1,S
3は、S
1≧0かつS
3<0の第5条件を満たす。領域Q3においては、両センサ値S
1,S
3は、S
1>0かつS
3≧0の第6条件を満たす。領域Q4およびQ5においては、両センサ値S
1,S
3は、S
1≦0かつS
3>0の第7条件を満たす。領域Q6においては、両センサ値S
1,S
2は、S
1<0かつS
3≦0の第8条件を満たす。そこで、第1の回転角演算部77Aは、第5条件および第7条件のいずれか一方を満たしているときには、第3磁気センサ73が検出している磁極の極番号が、第1磁気センサ71が検出している磁極の極番号より1だけ大きいと判別している。一方、第5条件および第7条件のいずれをも満たしていないときには、第1の回転角演算部77Aは、第3磁気センサ73が検出している磁極の極番号が、第1磁気センサ71が検出している磁極の極番号より2だけ大きいと判別している。
【0134】
図11Aに戻り、前記ステップS14において、今回の処理が強制回転に基づく回転角演算処理開始後の初回の処理ではないと判別された場合には(ステップS14:NO)、ステップS16に移行する。
ステップS16では、第1の回転角演算部77Aは、メモリに記憶されているセンサ値S
1,S
2,S
3に基づいて、センサ値S
1,S
2,S
3毎に、センサ値の符号が反転するゼロクロスを検出したか否かを判別する。ゼロクロスが検出されなかったときには(ステップS16:NO)、第1の回転角演算部77Aは、
図11BのステップS18に移行する。
【0135】
前記ステップS16において、いずれかのセンサ値S
1,S
2,S
3に対してゼロクロスが検出された場合には(ステップS16:YES)、第1の回転角演算部77Aは、相対的極番号の更新処理を行なう(ステップS17)。具体的には、第1の回転角演算部77Aは、前記ステップS16でゼロクロスが検出された磁気センサに対して現在設定されている相対的極番号r1,r2またはr3を、入力軸8(磁石61)の回転方向に応じて、1だけ大きい番号または1だけ小さい番号に変更する。
【0136】
入力軸8の回転方向が正方向(
図6に矢印で示す方向)である場合には、第1の回転角演算部77Aは、前記ステップS16でゼロクロスが検出された磁気センサに対して現在設定されている相対的極番号r1,r2またはr3を、1だけ大きい番号に更新する。一方、入力軸8の回転方向が逆方向である場合には、第1の回転角演算部77Aは、ゼロクロスが検出された磁気センサに対して現在設定されている相対的極番号r1,r2またはr3を、1だけ小さい番号に更新する。ただし、前述したように、”1”の相対的極番号に対して、1だけ小さい相対的極番号は、”8”となる。また、”8”の相対的極番号に対して、1だけ大きい相対的極番号は、”1”となる。
【0137】
なお、入力軸8の回転方向は、例えば、ゼロクロスが検出された出力信号の前回値および今回値と、他方の出力信号の今回値とに基づいて判定することができる。具体的には、ゼロクロスが検出された出力信号が第1出力信号S
1である場合には、「第1出力信号S
1の前回値が0より大きくかつその今回値が0以下であり、第2出力信号S
2が0より小さい」という条件、または「第1出力信号S
1の前回値が0未満でかつその今回値が0以上であり、第2出力信号S
2が0より大きい」という条件を満たしている場合には、回転方向は正方向(
図6に矢印で示す方向)であると判定される。
【0138】
一方、「第1出力信号S
1の前回値が0以上でかつその今回値が0未満であり、第2出力信号S
2が0より大きい」という条件、または「第1出力信号S
1の前回値が0以下でかつその今回値が0より大きく、第2出力信号S
2が0より小さい」という条件を満たしている場合には、回転方向は逆方向であると判定される。
ゼロクロスが検出された出力信号が第2出力信号S
2である場合には、「第2出力信号S
2の前回値が0より大きくかつその今回値が0以下であり、第1出力信号S
1が0より大きい」という条件、または「第2出力信号S
2の前回値が0未満でかつその今回値が0以上であり、第1出力信号S
1が0より小さい」という条件を満たしている場合には、回転方向は正方向(
図6に矢印で示す方向)であると判定される。一方、「第2出力信号S
2の前回値が0以上でかつその今回値が0未満であり、第1出力信号S
1が0より小さい」という条件、または「第2出力信号S
2の前回値が0以下でかつその今回値が0より大きく、第1出力信号S
1が0より大きい」という条件を満たしている場合には、回転方向は逆方向であると判定される。
【0139】
ゼロクロスが検出された出力信号が第3出力信号S
3である場合には、「第3出力信号S
3の前回値が0より大きくかつその今回値が0以下であり、第2出力信号S
2が0より大きい」という条件、または「第3出力信号S
3の前回値が0未満でかつその今回値が0以上であり、第2出力信号S
2が0より小さい」という条件を満たしている場合には、回転方向は正方向(
図6に矢印で示す方向)であると判定される。
【0140】
一方、「第3出力信号S
3の前回値が0以上でかつその今回値が0未満であり、第2出力信号S
2が0より小さい」という条件、または「第3出力信号S
3の前回値が0以下でかつその今回値が0より大きく、第2出力信号S
2が0より大きい」という条件を満たしている場合には、回転方向は逆方向であると判定される。
相対的極番号の更新処理が終了すると、第1の回転角演算部77Aは、
図11BのステップS18に移行する。ステップS18では、第1の回転角演算部77Aは、第1および第2磁気センサ71,72が共に同じ1つの磁極を3演算周期連続して検出しているという条件を満たしている否かを判別する。ステップS18の条件を満たしていない場合には(ステップS18:NO)、第1の回転角演算部77Aは、第2および第3磁気センサ72,73が共に同じ1つの磁極を3演算周期連続して検出しているという条件を満たしている否かを判別する(ステップS20)。ステップS20の条件を満たしていない場合には(ステップS20:NO)、第1の回転角演算部77Aは、
図11AのステップS13に戻る。
【0141】
前記ステップS18において、ステップS18の条件を満たしていると判別された場合には(ステップS18:YES)、第1の回転角演算部77Aは、EθおよびEを演算するための演算式に含まれている分数のいずれの分母も零でないという条件を満たしているか否かを判別する(ステップS19)。ステップS19の条件を満たしていない場合には(ステップS19:NO)、第1の回転角演算部77Aは、
図11AのステップS13に戻る。一方、ステップS19の条件を満たしている場合には(ステップS19:YES)、第1の回転角演算部77Aは、ステップS22に移行する。
【0142】
前記ステップS20において、ステップS20の条件を満たしていると判別された場合には(ステップS20:YES)、第1の回転角演算部77Aは、EΘおよびEを演算するための演算式に含まれている分数のいずれの分母も零でないという条件を満たしているか否かを判別する(ステップS21)。ステップS21の条件を満たしていない場合には(ステップS21:NO)、第1の回転角演算部77Aは、
図11AのステップS13に戻る。一方、ステップS21の条件を満たしている場合には(ステップS21:YES)、第1の回転角演算部77Aは、ステップS22に移行する。
【0143】
ステップS22では、第1の回転角演算部77Aは、第1方向とは反対方向である第2方向に電動モータ18を回転駆動させる。具体的には、第1の回転角演算部77Aは、第2方向に電動モータ18を回転駆動させるための第2強制回転指令をモータ制御用ECU12に送信する。モータ制御用ECU12は、この第2強制回転指令を受信すると、第2方向に電動モータ18を回転駆動させる。
【0144】
この後、第1の回転角演算部77Aは、各磁気センサ71,72のセンサ値S
1[n], S
2[n] ,S
3[n]を取得する(ステップS23)。ステップS23の処理は、後述するステップS27またはステップS31でYESと判定されるまで、所定の演算周期毎に繰り返し実行される。そして、第1の回転角演算部77Aは、メモリに記憶されているセンサ値S
1,S
2,S
3に基づいて、センサ値S
1,S
2,S
3毎に、センサ値の符号が反転するゼロクロスを検出したか否かを判別する(ステップS24)。ゼロクロスが検出されなかったときには(ステップS24:NO)、第1の回転角演算部77Aは、
図11CのステップS26に移行する。
【0145】
前記ステップS24において、いずれかのセンサ値S
1,S
2,S
3に対してゼロクロスが検出された場合には(ステップS24:YES)、第1の回転角演算部77Aは、相対的極番号の更新処理を行なう(ステップS25)。この相対的極番号の更新処理は、前述したステップS17における相対的極番号の更新処理と同じである。ステップS25の相対的極番号の更新処理が終了すると、第1の回転角演算部77Aは、
図11CのステップS26に移行する。
【0146】
ステップS26では、第1の回転角演算部77Aは、第1および第2磁気センサ71,72が共に同じ1つの磁極を3演算周期連続して検出しているという条件を満たしている否かを判別する。ステップS26の条件を満たしていない場合には(ステップS26:NO)、第1の回転角演算部77Aは、第2および第3磁気センサ72,73が共に同じ1つの磁極を3演算周期連続して検出しているという条件を満たしている否かを判別する(ステップS30)。ステップS30の条件を満たしていない場合には(ステップS30:NO)、第1の回転角演算部77Aは、
図11BのステップS23に戻る。
【0147】
前記ステップS26において、ステップS26の条件を満たしていると判別された場合には(ステップS26:YES)、第1の回転角演算部77Aは、第1演算モードのためのEθ基本演算式およびE演算式に含まれている分数のいずれの分母も零でないという条件を満たしているか否かを判別する(ステップS27)。ステップS27の条件を満たしていない場合には(ステップS27:NO)、第1の回転角演算部77Aは、
図11BのステップS23に戻る。
【0148】
ステップS27の条件を満たしていると判別された場合には(ステップS27:YES)、第1の回転角演算部77Aは、第1演算モードによってθ[n],E,A
1,A
2を演算する(ステップS28)。そして、第1の回転角演算部77Aは、演算されたE、A
1およびA
2を、第1および第2磁気センサ71,72が検出している磁極の相対的極番号に関連付けてメモリに記憶する(ステップS29)。第1および第2磁気センサ71,72が検出している磁極の相対的極番号は、現在設定されている第1相対的極番号r1または第2相対的極番号r2と同じ値となる。具体的には、第1の回転角演算部77Aは、メモリのエリアe1,e2,e3内の現在設定されている第1相対的極番号r1に対応する記憶場所に、演算されたE、A
1およびA
2をそれぞれ記憶する。この後、第1の回転角演算部77Aは、ステップS34に進む。
【0149】
前記ステップS30において、ステップS30の条件を満たしていると判別された場合には(ステップS30:YES)、第1の回転角演算部77Aは、第2演算モードのためのEΘ基本演算式およびE演算式に含まれている分数のいずれの分母も零でないという条件を満たしているか否かを判別する(ステップS31)。ステップS31の条件を満たしていない場合には(ステップS31:NO)、第1の回転角演算部77Aは、
図11BのステップS23に戻る。
【0150】
ステップS31の条件を満たしている場合には(ステップS31:YES)、第1の回転角演算部77Aは、第2演算モードによってθ[n],E,A
2,A
3を演算する(ステップS32)。そして、第1の回転角演算部77Aは、演算されたE、A
2およびA
3を、第2および第3磁気センサ72,73が検出している磁極の相対的極番号に関連付けてメモリに記憶する(ステップS33)。第2および第3磁気センサ72,73が検出している磁極の相対的極番号は、現在設定されている第2相対的極番号r2または第3相対的極番号r3と同じ値となる。具体的には、第1の回転角演算部77Aは、メモリのエリアe1,e3,e4内の現在設定されている第3相対的極番号r3に対応する記憶場所に、演算されたE、A
2およびA
3をそれぞれ記憶する。この後、第1の回転角演算部77Aは、ステップS34に進む。
【0151】
ステップS34では、第1の回転角演算部77Aは、電動モータ18の駆動を停止させるとともに運転者への警告を停止させる。具体的には、第1の回転角演算部77Aは、電動モータ18の駆動停止指令をモータ制御用ECU12に送信するとともに、映像音声制御装置に警告停止指令を送信する。モータ制御用ECU12は、電動モータ18の駆動停止指令を受信すると電動モータ18の駆動を停止させる。映像音声制御装置は、警告停止指令を受信すると、警告表示、警告音声出力等を停止させる。これにより、強制回転に基づく回転角演算処理が終了する。
【0152】
図15Aおよび
図15Bは、
図10のステップS2の通常時の回転角演算処理の手順を示すフローチャートである。
図15Aおよび
図15Bの処理は、所定の演算周期毎に繰り返し実行される。
第1の回転角演算部77Aは、各磁気センサ71,72,73のセンサ値S
1[n], S
2[n] ,S
3[n]を取得する(ステップS61)。そして、第1の回転角演算部77Aは、メモリに記憶されているセンサ値S
1,S
2,S
3に基づいて、センサ値S
1,S
2,S
3毎に、センサ値の符号が反転するゼロクロスを検出したか否かを判別する(ステップS62)。ゼロクロスが検出されなかったときには(ステップS62:NO)、第1の回転角演算部77Aは、ステップS64に移行する。
【0153】
前記ステップS62において、いずれかのセンサ値S
1,S
2,S
3に対してゼロクロスが検出された場合には(ステップS62:YES)、第1の回転角演算部77Aは、相対的極番号の更新処理を行なう(ステップS63)。この相対的極番号の更新処理は、前述した
図11AのステップS17における相対的極番号の更新処理と同じである。ステップS63の相対的極番号の更新処理が終了すると、第1の回転角演算部77Aは、ステップS64に移行する。
【0154】
ステップS64では、第1の回転角演算部77Aは、第1および第2磁気センサ71,72が共に同じ1つの磁極を3演算周期連続して検出しているという条件を満たしている否かを判別する。ステップS64の条件を満たしている場合には(ステップS64:YES)、第1の回転角演算部77Aは、第1演算モードによってθ[n],E,A
1,A
2を演算する(ステップS65)。第1演算モードによって回転角θ[n]を演算する際においては、第1の回転角演算部77Aは、Eθ基本演算式に含まれている分数の分母が零でないか否か、E演算式に含まれている分数の分母が零でないか否かを判定し、それらの判定結果に応じてθ[n],E,A
1,A
2を演算する。
【0155】
第1の回転角演算部77Aは、θ[n],E,A
1,A
2を演算すると、Eθ基本演算式およびE演算式に含まれている分数のいずれの分母も零でないという条件を満たしていたか否かを判別する(ステップS66)。ステップS66の条件を満たしていた場合には(ステップS66:YES)、第1の回転角演算部77Aは、演算されたE、A
1およびA
2を、第1および第2磁気センサ71,72が検出している磁極の相対的極番号に関連付けてメモリに記憶する(ステップS67)。第1および第2磁気センサ71,72が検出している磁極の相対的極番号は、現在設定されている第1相対的極番号r1または第2相対的極番号r2と同じ値となる。具体的には、第1の回転角演算部77Aは、メモリのエリアe1,e2,e3内の現在設定されている第1相対的極番号r1に対応する記憶場所に、演算されたE、A
1およびA2をそれぞれ記憶する。なお、メモリのエリアe1,e2,e3の前記記憶場所に既にE、A
1およびA
2が記憶されている場合には、今回演算されたE、A
1およびA
2が上書きされる。この後、第1の回転角演算部77Aは、今回演算周期での処理を終了する。
【0156】
前記ステップS66において、ステップS66の条件を満たしていなかったと判別された場合には(ステップS66:NO)、第1の回転角演算部77Aは、ステップS67の処理を行うことなく、今回演算周期での処理を終了する。したがって、この場合には、ステップS65で演算されたE、A
1およびA
2は、メモリのエリアe1,e2,e3に記憶されない。
【0157】
前記ステップS64において、ステップS64の条件を満たしていないと判別された場合には(ステップS64:NO)、第1の回転角演算部77Aは、第2および第3磁気センサ72,73が共に同じ1つの磁極を3演算周期連続して検出しているという条件を満たしている否かを判別する(ステップS68)。ステップS68の条件を満たしている場合には(ステップS68:YES)、第1の回転角演算部77Aは、第2演算モードによってθ[n],E,A
2,A
3を演算する(ステップS69)。第2演算モードによって回転角θ[n]を演算する際においては、第1の回転角演算部77Aは、EΘ基本演算式に含まれている分数の分母が零でないか否か、E演算式に含まれている分数の分母が零でないか否かを判定し、それらの判定結果に応じてθ[n],E,A
2,A
3を演算する。
【0158】
第1の回転角演算部77Aは、θ[n],E,A
2,A
3を演算すると、EΘ基本演算式およびE演算式に含まれている分数のいずれの分母も零でないという条件を満たしていたか否かを判別する(ステップS70)。ステップS70の条件を満たしていた場合には(ステップS70:YES)、第1の回転角演算部77Aは、演算されたE、A
2およびA
3を、第2および第3磁気センサ72,73が検出している磁極の相対的極番号に関連付けてメモリに記憶する(ステップS71)。第2および第3磁気センサ72,73が検出している磁極の相対的極番号は、現在設定されている第2相対的極番号r2または第3相対的極番号r3と同じ値となる。具体的には、第1の回転角演算部77Aは、メモリのエリアe1,e3,e4内の現在設定されている第3相対的極番号r3に対応する記憶場所に、演算されたE、A
2およびA
3をそれぞれ記憶する。なお、メモリのエリアe1,e3,e4の前記記憶場所に既にE、A
2およびA
3が記憶されている場合には、今回演算されたE、A
2およびA
3が上書きされる。この後、第1の回転角演算部77Aは、今回演算周期での処理を終了する。
【0159】
前記ステップS70において、ステップS70の条件を満たしていなかったと判別された場合には(ステップS70:NO)、第1の回転角演算部77Aは、ステップS71の処理を行うことなく、今回演算周期での処理を終了する。したがって、この場合には、ステップS69で演算されたE、A
2およびA
3は、メモリのエリアe1,e3,e4に記憶されない。
【0160】
前記ステップS68において、ステップS68の条件を満たしていないと判別された場合には(ステップS68:NO)、第1磁気センサ71が検出している磁極に対応する磁極幅補正値Eがメモリに記憶されているか否かを判別する(ステップS72)。この判別は、メモリのエリアe1内の現在設定されている第1相対的極番号r1に対応する記憶場所に、磁極幅補正値Eが記憶されているか否かに基づいて行われる。
【0161】
第1磁気センサ71が検出している磁極に対応する磁極幅補正値Eがメモリに記憶されている場合には(ステップS72:YES)、第1の回転角演算部77Aは、第3演算モードによって回転角θ[n]を演算する(ステップS73)。そして、第1の回転角演算部77Aは、今回演算周期での処理を終了する。
前記ステップS72において、第1磁気センサ71が検出している磁極に対応する磁極幅補正値Eがメモリに記憶されていないと判別された場合には(ステップS72:NO)、第1の回転角演算部77Aは、ステップS74に進む。ステップS74では、第1の回転角演算部77Aは、第2磁気センサ72が検出している磁極に対応する磁極幅補正値Eがメモリに記憶されているか否かを判別する。この判別は、メモリのエリアe2内の現在設定されている第2相対的極番号r2に対応する記憶場所に、磁極幅補正値Eが記憶されているか否かに基づいて行われる。
【0162】
第2磁気センサ72が検出している磁極に対応する磁極幅補正値Eがメモリに記憶されている場合には(ステップS74:YES)、第1の回転角演算部77Aは、第4演算モードによって回転角θ[n]を演算する(ステップS75)。そして、第1の回転角演算部77Aは、今回演算周期での処理を終了する。
前記ステップS74において、第2磁気センサ721が検出している磁極に対応する磁極幅補正値Eがメモリに記憶されていないと判別された場合には(ステップS74:NO)、第1の回転角演算部77Aは、第5演算モードによって回転角θ[n]を演算する(ステップS76)。そして、第1の回転角演算部77Aは、今回演算周期での処理を終了する。
【0163】
以上、この発明の一実施形態について説明したが、この発明はさらに他の形態で実施することもできる。たとえば、
図15AのステップS66を省略して、ステップS65の処理が終了したときには、ステップS67に進むようにしてもよい。同様に、
図15AのステップS70を省略して、ステップS69の処理が終了したときには、ステップS71に進むようにしてもよい。
【0164】
また、第2磁気センサ72に対して、入力軸8の半径方向に間隔をおいて、予備の磁気センサを配置しておき、第2磁気センサ72が故障したときに、予備の磁気センサの出力信号を第2磁気センサ72の出力信号の代わりに用いるようにしてもよい。
その他、特許請求の範囲に記載された事項の範囲で種々の設計変更を施すことが可能である。