JP2012088198A - トルク検出装置 - Google Patents
トルク検出装置 Download PDFInfo
- Publication number
- JP2012088198A JP2012088198A JP2010235699A JP2010235699A JP2012088198A JP 2012088198 A JP2012088198 A JP 2012088198A JP 2010235699 A JP2010235699 A JP 2010235699A JP 2010235699 A JP2010235699 A JP 2010235699A JP 2012088198 A JP2012088198 A JP 2012088198A
- Authority
- JP
- Japan
- Prior art keywords
- rotation angle
- resolver
- steering
- torque
- angle
- 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.)
- Pending
Links
Images
Landscapes
- Power Steering Mechanism (AREA)
Abstract
【課題】 2相のうち一方の検出コイルが断線している場合に、回転角が一義的に求められる範囲を広くする。
【解決手段】 異常側レゾルバの電気角が一演算周期のあいだに0°あるいは180°を通過する可能性が無い状況であれば、cos相の振幅のみから電気角θenが一義的に決まる。また、異常側レゾルバの電気角が一演算周期のあいだに90°あるいは270°を通過する可能性が無い状況であれば、sin相の振幅のみから電気角θenが一義的に決まる。このことを利用して、トルク演算部は、一演算周期前に算出された異常側レゾルバの電気角に基づいて、正常相の検出コイルの振幅から回転角を一義的に算出することができる状況であるか否かを判断する。
【選択図】 図9
【解決手段】 異常側レゾルバの電気角が一演算周期のあいだに0°あるいは180°を通過する可能性が無い状況であれば、cos相の振幅のみから電気角θenが一義的に決まる。また、異常側レゾルバの電気角が一演算周期のあいだに90°あるいは270°を通過する可能性が無い状況であれば、sin相の振幅のみから電気角θenが一義的に決まる。このことを利用して、トルク演算部は、一演算周期前に算出された異常側レゾルバの電気角に基づいて、正常相の検出コイルの振幅から回転角を一義的に算出することができる状況であるか否かを判断する。
【選択図】 図9
Description
本発明は、2つのレゾルバを備え、各レゾルバで検出した回転角に基づいて操舵トルクを検出するトルク検出装置に関する。
従来から、運転者の操舵操作に対して操舵アシストトルクを付与する電動パワーステアリング装置が知られている。電動パワーステアリング装置は、ステアリングシャフトに働いた操舵トルクをトルク検出装置で検出し、操舵トルクが大きくなるにしたがって増加する目標アシストトルクを算出し、算出した目標アシストトルクが得られるように、電動モータの通電量をフィードバック制御する。従って、電動パワーステアリング装置においては、特に、トルク検出装置の信頼性が要求される。
トルク検出装置は、ステアリングシャフトに設けたトーションバーの捩れ角度を検出することにより、この捩れ角度に比例した操舵トルクを算出する。例えば、特許文献1にて提案されたトルク検出装置は、2つのレゾルバを用いてトーションバーの捻れ角度を検出する構成を採用している。このトルク検出装置においては、トーションバーの一端側に第1レゾルバを、他端側に第2レゾルバを設け、第1レゾルバにて検出される第1回転角θ1と第2レゾルバにて検出される第2回転角θ2との差から、操舵トルクを検出する。
各レゾルバは、励磁用交流信号が供給されてロータコイルに通電する励磁コイルと、トーションバーの周囲に設けられる一対の検出コイル(sin相検出コイル,cos相検出コイル)とを備えている。一対の検出コイルは、互いに電気角で90度(π/2)ずらして組み付けられる。sin相検出コイルは、ロータの回転角のsin値に応じた振幅となる交流信号を出力し、cos相検出コイルは、ロータの回転角のcos値に応じた振幅となる交流信号を出力する。従って、レゾルバで検出されるロータの回転角は、sin相検出コイルの出力信号の振幅をcos相検出コイルの出力信号の振幅で除算した値のアークタンジェント値に基づいて演算することができる。
この特許文献1にて提案されたトルク検出装置は、一方のレゾルバにおける検出コイルの一つが断線した場合でも、正常なレゾルバで検出された回転角が所定角度範囲に入っている場合には、断線したコイルと対をなす他方の検出コイルの出力信号を使って回転角を推定する。これは、第1レゾルバにて検出される第1回転角θ1と第2レゾルバにて検出される第2回転角θ2との機械的な角度差が常に一定値以下になるという条件に基づいて、正常なレゾルバで検出された回転角が所定角度範囲に入っている状況においては、断線したコイルと対をなす他方の検出コイルの出力信号から回転角を一義的に求めることができることを利用したものである。従って、正常なレゾルバで検出された回転角が所定角度範囲に入っている状況においては、第1回転角θ1と第2回転角θ2との差から操舵トルクを検出することができる。
しかしながら、第1回転角θ1と第2回転角θ2との機械的な角度差が一定値以下になるという条件に基づいて、他方の検出コイル(断線したコイルと対をなす正常な検出コイル)の出力信号から回転角を求める構成においては、一義的に回転角が求められる状況となる正常側レゾルバの回転角の範囲を広くとれない。例えば、通常の操舵操作でトーションバーが捩られる角度の最大値は6[deg](機械角)程度である。この場合においては、一義的に回転角が求められる状況となる正常側レゾルバの回転角の範囲は全体の半分程度しかなく、トルク検出の継続が難しい。
本発明は、上記問題に対処するためになされたもので、2相のうち一方の検出コイルが断線している場合に、回転角が一義的に求められる範囲を広くすることを目的とする。
上記目的を達成するために、本発明の特徴は、操舵ハンドルに連結されたステアリングシャフトの入力側の回転角である第1回転角に応じた2相の検出信号を出力する一対の検出コイルを有する第1レゾルバ(110)と、前記ステアリングシャフトの出力側の回転角である第2回転角に応じた2相の検出信号を出力する一対の検出コイルを有する第2レゾルバ(120)とを備えたレゾルバユニット(100)と、前記第1レゾルバの出力する2相の検出信号に基づいて前記第1回転角を演算し、前記第2レゾルバの出力する2相の検出信号に基づいて前記第2回転角を演算する回転角演算手段(S15)と、前記演算された第1回転角と第2回転角との差に基づいて前記ステアリングシャフトに働く操舵トルクを演算するトルク演算手段(S16)とを備えたトルク検出装置において、
前記第1レゾルバあるいは第2レゾルバの何れかで、前記一対の検出コイルの一方に異常が発生していることを検出する異常検出手段(S13)と、前記検出コイルの一方に異常が検出されているとき、前記回転角演算手段が前記第1回転角および第2回転角を演算する演算周期あたりに前記第1回転角あるいは前記第2回転角が変化する回転角変化量が所定変化量以内であるという回転角変化条件に基づいて、前記異常が検出されている検出コイルを有する異常側レゾルバの回転角を一義的に算出することができる状況であるか否かを判断する異常側回転角算出可否判断手段(S34,S38,S44,S48)と、前記異常側回転角算出可否判断手段により、前記異常側レゾルバの回転角を一義的に算出することができる状況であると判定されている場合には、前記異常側レゾルバにおける異常が検出されていない検出コイルの検出信号に基づいて、前記回転角変化条件を満たす前記異常側レゾルバの回転角を演算する異常側回転角演算手段(S33,S37,S43,S47)とを備えたことにある。
前記第1レゾルバあるいは第2レゾルバの何れかで、前記一対の検出コイルの一方に異常が発生していることを検出する異常検出手段(S13)と、前記検出コイルの一方に異常が検出されているとき、前記回転角演算手段が前記第1回転角および第2回転角を演算する演算周期あたりに前記第1回転角あるいは前記第2回転角が変化する回転角変化量が所定変化量以内であるという回転角変化条件に基づいて、前記異常が検出されている検出コイルを有する異常側レゾルバの回転角を一義的に算出することができる状況であるか否かを判断する異常側回転角算出可否判断手段(S34,S38,S44,S48)と、前記異常側回転角算出可否判断手段により、前記異常側レゾルバの回転角を一義的に算出することができる状況であると判定されている場合には、前記異常側レゾルバにおける異常が検出されていない検出コイルの検出信号に基づいて、前記回転角変化条件を満たす前記異常側レゾルバの回転角を演算する異常側回転角演算手段(S33,S37,S43,S47)とを備えたことにある。
本発明においては、ステアリングシャフトの入力側に第1レゾルバが設けられ、出力側に第2レゾルバが設けられる。第1レゾルバは、励磁用交流信号が入力され、一対の検出コイル(sin相検出コイル、cos相検出コイル)から、ステアリングシャフト入力側の回転角である第1回転角に応じた2相の検出信号を出力する。第2レゾルバも同様に、励磁用交流信号が入力され、一対の検出コイル(sin相検出コイル、cos相検出コイル)から、ステアリングシャフト出力側の回転角である第2回転角に応じた2相の検出信号を出力する。2相の検出信号は、入力された励磁用交流信号によって発生する交流電圧信号であって、回転角のsin値に依存して振幅が変化するsin相検出信号と、回転角のcos値に依存して振幅が変化するcos相検出信号とからなる。従って、各レゾルバにおいては、一方の検出コイルからsin相検出信号を出力し、他方の検出コイルからcos相検出信号を出力する。
回転角演算手段は、第1レゾルバの出力する2相の検出信号に基づいて第1回転角を演算し、第2レゾルバの出力する2相の検出信号に基づいて第2回転角を演算する。例えば、各レゾルバにおけるsin相検出信号とcos相検出信号との振幅をそれぞれ検出し、sin相検出信号の振幅をcos相検出信号の振幅で除算した値のアークタンジェント値に基づいて回転角を演算することができる。トルク演算手段は、こうして演算された第1回転角と第2回転角との差に基づいてステアリングシャフトに働く操舵トルクを演算する。つまり、ステアリングシャフトの捩れ角度を検出することにより、その捩れ角度に比例した操舵トルクを演算する。この場合、ステアリングシャフトには、捩れ角度を検出しやすいように、トーションバーを介装することが好ましい。
レゾルバの検出コイルの信号出力ライン等が断線した場合には、検出コイルから正常な検出信号が出力されなくなる。このとき、一対の検出コイルのうち一方のみに異常が発生している状況においては、他方の検出コイルの出力する検出信号の振幅からは、2通りの解(演算結果)が得られて、一義的に回転角を決めることができない。こうした問題に対して、従来装置においては、第1回転角と第2回転角との角度差の限界が設定(想定)されていることから、異常が発生していないレゾルバの回転角が所定範囲となる場合にのみ、他方の検出コイルの出力する検出信号の振幅から一義的に回転角を決めることができることに着目して回転角を演算しているが、一義的に回転角を決められる所定範囲が狭い。
そこで、本発明においては、異常検出手段が、第1レゾルバあるいは第2レゾルバの何れかで、一対の検出コイルの一方に異常が発生しているか否かを判断する。そして、一対の検出コイルの一方に異常が発生していることが検出されると、回転角演算手段が第1回転角および第2回転角を演算する演算周期あたりに第1回転角あるいは第2回転角が変化する回転角変化量が所定変化量以内であるという回転角変化条件に基づいて、異常が検出されている検出コイルを有する異常側レゾルバの回転角を一義的に算出することができる状況であるか否かを判断する。
各演算手段は、それぞれ決められた演算周期にて繰り返し演算処理を実行する。従って、回転角演算手段の演算周期にステアリングシャフトの回転角速度を乗算すれば一演算周期のあいだに変化した回転角の変化量、つまり、回転角変化量が求められる。一方、操舵ハンドルを回転操作する速度には限界があるため、回転角変化量は、所定変化量以内となる。このため、一演算周期前に算出された異常側レゾルバの電気角に基づいて、異常が検出されている検出コイルを有する異常側レゾルバの回転角を一義的に算出することができる状況であるか否かを判断することができる。この場合、異常側回転角算出可否判断手段は、一演算周期前に算出された異常側レゾルバの電気角を表す情報(電気角を導き出せる情報)を記憶する記憶手段(33)を備えているとよい。
そして、異常側回転角演算手段は、異常側回転角算出可否判断手段により、異常側レゾルバの回転角を一義的に算出することができる状況であると判定されている場合には、異常側レゾルバにおける異常が検出されていない検出コイルの検出信号に基づいて、回転角変化条件を満たす異常側レゾルバの回転角を演算する。従って、回転変化条件を設定することで、異常側レゾルバにおける異常が検出されていない検出コイルの検出信号から回転角を一義的に決めることができる。つまり、異常側レゾルバにおける異常が検出されていない検出コイルの検出信号の振幅から演算される2通りの回転角から、そのうちの1つを一義的に決めることができる。
この結果、本発明によれば、2相のうち一方の検出コイルが断線している場合であっても、回転角が一義的に求められる範囲が広くなるため、操舵トルクを検出できる期間が長くなる。従って、本発明のトルク検出装置を電動パワーステアリング装置のトルク検出用に用いた場合には、適正な操舵アシストを継続できる期間を長くすることができる。
本発明の他の特徴は、前記異常側回転角算出可否判断手段は、前記異常が検出されている検出コイルがsin相検出コイルである場合には、前記異常側レゾルバの電気角が一演算周期のあいだに0°あるいは180°を通過する可能性がない状況であるときに、前記異常側レゾルバの回転角を一義的に算出することができる状況であると判定し、前記異常が検出されている検出コイルがcos相検出コイルである場合には、前記異常側レゾルバの電気角が一演算周期のあいだに90°あるいは270°を通過する可能性がない状況であるときに、前記異常側レゾルバの回転角を一義的に算出することができる状況であると判定することにある。
異常が検出されている検出コイルがsin相検出コイルである場合には、異常側レゾルバの電気角が一演算周期のあいだに0°あるいは180°を通過できる状況にあると、cos相検出コイルから出力される検出信号の振幅からは一義的に回転角を決めることができない。これは、異常側レゾルバの電気角が、0°あるいは180°を挟んでどちら側にあるのか分からないためである。同様に、異常が検出されている検出コイルがcos相検出コイルである場合には、異常側レゾルバの電気角が一演算周期のあいだに90°あるいは270°を通過できる状況にあると、sin相検出コイルから出力される検出信号の振幅からは一義的に回転角を決めることができない。これは、異常側レゾルバの電気角が、90°あるいは270°を挟んでどちら側にあるのか分からないためである。
そこで、本発明においては、異常側回転角算出可否判断手段が、異常が検出されている検出コイルがsin相検出コイルである場合には、異常側レゾルバの電気角が一演算周期のあいだに0°あるいは180°を通過する可能性がない状況であるときに、異常側レゾルバの回転角を一義的に算出することができる状況であると判定し、異常が検出されている検出コイルがcos相検出コイルである場合には、異常側レゾルバの電気角が一演算周期のあいだに90°あるいは270°を通過する可能性がない状況であるときに、異常側レゾルバの回転角を一義的に算出することができる状況であると判定する。この場合、異常側回転角算出可否判断手段は、例えば、一演算周期前に算出された異常側レゾルバの電気角と、回転角変化条件に基づいて、上記状況であるか否かを判定すればよい。これによれば、2相のうち一方の検出コイルが断線している場合であっても、簡単な条件付けにて、回転角が一義的に求められる範囲を広くすることができる。
本発明の他の特徴は、前記所定変化量は、前記操舵ハンドルが回される操舵速度に基づいて設定されることにある。
本発明によれば、操舵ハンドルが回される操舵速度(回転角速度)に基づいて所定変化量が設定されるため、適正な回転角変化条件を設定することができる。
本発明の特徴は、前記所定変化量は、前記操舵ハンドルが回される操舵速度の想定される最大値に基づいて設定されることにある。
本発明によれば、操舵ハンドルが回される操舵速度の想定される最大値に基づいて所定変化量が設定されるため、確実な回転角変化条件を設定することができる。
本発明の他の特徴は、前記操舵ハンドルが回される操舵速度を検出する操舵速度検出手段(S51,S61)と、前記操舵速度検出手段により検出された操舵速度が小さくなるほど小さくなる前記所定変化量を設定する変化量設定手段(S52,S53,S62,S63)とを備えたことにある。
本発明によれば、操舵速度が小さくなるほど所定変化量を小さく設定するため、回転角が一義的に求められる範囲を更に広くすることができる。
尚、上記説明においては、発明の理解を助けるために、実施形態に対応する発明の構成に対して、実施形態で用いた符号を括弧書きで添えているが、発明の各構成要件を前記符号によって規定される実施形態に限定させるものではない。
以下、本発明の一実施形態について図面を用いて説明する。図1は、実施形態としてのトルク検出装置を備えた車両の電動パワーステアリング装置の概略構成図である。
電動パワーステアリング装置は、操舵ハンドル11の操舵により転舵輪である左右前輪FW1,FWを転舵する転舵機構10と、転舵機構10に設けられ操舵アシストトルクを発生するパワーアシスト部20と、パワーアシスト部20の電動モータ21を駆動制御するアシスト制御装置50(以下、アシストECU50と呼ぶ)と、レゾルバユニット100とを備えている。
転舵機構10は、ステアリングシャフト12を回転可能に備えている。ステアリングシャフト12の上端には、操舵ハンドル11が一体回転可能に接続され、ステアリングシャフト12の下端には、ピニオンギヤ13が一体回転可能に接続されている。ピニオンギヤ13は、ラックバー14に形成されたラック歯と噛み合ってラックアンドピニオン機構を構成する。ラックバー14の両端には、図示しないタイロッドおよびナックルアームを介して左右前輪FW1,FW2が転舵可能に接続されている。左右前輪FW1,FW2は、ステアリングシャフト12の軸線回りの回転に伴うラックバー14の軸線方向の変位に応じて左右に転舵される。
ラックバー14には、パワーアシスト部20が組み付けられている。パワーアシスト部20は、操舵アシスト用の電動モータ21(例えば、3相DCブラシレスモータ)とボールねじ機構22とからなる。電動モータ21の回転軸は、ボールねじ機構22を介してラックバー14に動力伝達可能に接続されていて、その回転により左右前輪FW1,FW2の転舵をアシストする。ボールねじ機構22は、減速器および回転−直線変換器として機能するもので、電動モータ21の回転を減速するとともに直線運動に変換してラックバー14に伝達する。尚、電動モータ21をラックバー14に組み付けるのに代えて、電動モータ21をステアリングシャフト12に組み付けて、電動モータ21の回転を減速器を介してステアリングシャフト12に伝達して同シャフト12を軸線周りに駆動するように構成してもよい。
電動モータ21には、その回転軸の回転角を検出するための回転角センサ61が設けられている。この回転角センサ61は、電動モータ21内に組み込まれ、電動モータ21の回転子の回転角度位置に応じた検出信号を出力するもので、例えば、レゾルバにより構成される。この回転角センサ61の検出信号は、電動モータ21の回転角および回転角速度の計算に利用される。一方、この電動モータ21の回転角は、操舵角の検出に利用される。また、電動モータ21の回転角を時間で微分して得られる回転角速度は、操舵速度に対応するため操舵速度ωの検出に利用される。
ステアリングシャフト12は、その軸方向の中間位置にトーションバー12aが設けられる。ステアリングシャフト12において、トーションバー12aの上端と操舵ハンドル11とを連結する部分を入力シャフト12inと呼び、トーションバー12aの下端とピニオンギヤ13とを連結する部分を出力シャフト12outと呼ぶ。
ステアリングシャフト12には、レゾルバユニット100が設けられる。レゾルバユニット100は、トーションバー12aと、入力シャフト12inに組み付けられた第1レゾルバ110と、出力シャフト12outに組み付けられた第2レゾルバ120とから構成される。第1レゾルバ110は、入力シャフト12inの回転角(トーションバー12aの一方端位置における回転角であって本発明の第1回転角に相当する)に応じた信号を出力し、第2レゾルバ120は、出力シャフト12outの回転角(トーションバー12aの他方端位置における回転角であって本発明の第2回転角に相当する)に応じた信号を出力する。操舵ハンドル11が回動操作されると、ステアリングシャフト12にトルクが働いてトーションバー12aが捩れる。トーションバー12aの捩れ角度は、ステアリングシャフト12に働く操舵トルクに比例する。従って、第1レゾルバ110で検出される第1回転角θ1と、第2レゾルバ120で検出される第2回転角θ2との差を求めることでステアリングシャフト12に働く操舵トルクを検出することができる。第1レゾルバ110、第2レゾルバ120は、アシストECU50に接続されている。
アシストECU50は、マイクロコンピュータおよび信号処理回路等を備えた演算部30と、スイッチング回路で構成されるモータ駆動回路40(例えば、3相インバータ回路)とを備えている。演算部30は、アシスト演算部31と、トルク演算部32と、記憶部33とから構成される。トルク演算部32は、レゾルバユニット100および回転角センサ61と接続されて、ステアリングシャフト12に働く操舵トルクを演算により検出する。また、トルク演算部32は、運転者に異常を報知するための警告ランプ65を接続しており、後述する断線検出時に警告ランプ65を点灯する。レゾルバユニット100とトルク演算部32と記憶部33と回転角センサ61とからなる構成が本発明のトルク検出装置に相当する。アシスト演算部31は、トルク演算部32により検出された操舵トルクに基づいて電動モータ21の制御量を演算し、それに対応した制御信号をモータ駆動回路40に出力する。記憶部33は、各種の制御プログラムや制御用データ等を記憶したメモリから構成される。
モータ駆動回路40は、アシスト演算部31からのPWM制御信号を入力して、内部のスイッチング素子のデューティ比を制御することにより電動モータ21への通電量を調整する。モータ駆動回路40には、電動モータ21に流れる電流を検出する電流センサ41が設けられる。
アシスト演算部31は、電流センサ41、車速センサ60、回転角センサ61を接続している。車速センサ60は、車速vxを表す車速検出信号を出力する。また、アシスト演算部31は、トルク演算部32により算出した操舵トルクの計算結果を入力する。
次に、アシスト演算部31の実施する操舵アシスト制御について簡単に説明する。アシスト演算部31は、車速センサ60により検出される車速vxと、トルク演算部32により算出された操舵トルクTrとを取得し、取得した車速vxと操舵トルクTrに基づいて、目標アシストトルクを算出する。目標アシストトルクは、図示しないアシストマップ等を参照して、操舵トルクTrが大きくなるにしたがって増加し、かつ、車速vxが増加するにしたがって減少するように設定される。アシスト演算部31、この目標アシストトルクを発生させるために必要な目標電流を計算し、電流センサ41により検出された実電流と目標電流との偏差に基づいてPI制御(比例積分制御)式等を使って目標指令電圧を計算し、目標指令電圧に応じたPWM制御信号をモータ駆動回路40に出力する。アシスト演算部31は、回転角センサ61により検出される電動モータ21の回転角(電気角)を取得して、回転角に応じた3相(U相、V相,W相)のPWM制御信号を生成することにより、電動モータ21に3相駆動電圧を印加する。こうして、電動モータ21には、電流フィードバック制御により運転者の操舵方向と同じ方向に回転する向きの目標電流が流れる。これにより、運転者の操舵操作が、電動モータ21で発生するトルクにより適切にアシストされる。
次に、レゾルバユニット100について説明する。図2は、レゾルバユニット100の概略回路構成を表す。第1レゾルバ110は、入力シャフト12inをロータとして備える。入力シャフト12inの外周側のステータには、ロータの周方向に沿って巻かれた第1励磁コイル111が固定して設けられている。ロータとなる入力シャフト12inには、第1ロータコイル114が固定して設けられている。第1ロータコイル114は、ロータの回転に伴って回転する。第1ロータコイル114は、ロータ内に設けた変圧器(図示略)を介して第1励磁コイル111と非接触にて電気的に接続され、第1励磁コイル111に印加される交流電圧によって通電される。尚、図示しないが、第1ロータコイル114は、回転角の分解能を高めるために、ロータの機械的な回転角に対して電気角がN倍となるように等角度間隔で複数配置されている。
第1レゾルバ110は、入力シャフト12inの外周側のステータに第1sin相検出コイル112および第1cos相検出コイル113とを備えている。第1sin相検出コイル112と第1cos相検出コイル113とは、互いに電気角がπ/2ずれる位置に配置される。
第1sin相検出コイル112および第1cos相検出コイル113は、第1ロータコイル114の回転平面上に配置され、第1ロータコイル114で発生する磁束により交流電圧信号を出力する。第1sin相検出コイル112および第1cos相検出コイル113で発生する交流電圧信号の振幅値は、第1ロータコイル114に対する第1sin相検出コイル112および第1cos相検出コイル113の回転位置に応じて変化する。つまり、第1sin相検出コイル112は、入力シャフト12inの回転角のsin値に応じた振幅となる交流電圧信号を出力し、第1cos相検出コイル113は、入力シャフト12inの回転角のcos値に応じた振幅となる交流電圧信号を出力する。
第1励磁コイル111の一端は、第1励磁ライン210を介してアシストECU50の第1励磁信号出力ポート50pe1に接続されている。また、第1sin相検出コイル112の一端は、第1sin相検出ライン212を介してアシストECU50の第1sin相信号入力ポート50ps1に接続されている。また、第1cos相検出コイル113の一端は、第1cos相検出ライン213を介してアシストECU50の第1cos相信号入力ポート50pc1に接続されている。図中において、符号100pe1は、レゾルバユニット100の第1励磁信号入力ポートであり、符号100ps1は第1sin相信号出力ポートであり、符号100pc1は第1cos相信号出力ポートである。従って、ワイヤハーネスとなる部分は、第1励磁信号出力ポート50pe1と第1励磁信号入力ポート100pe1との間の第1励磁ライン210、第1sin相信号出力ポート100ps1と第1sin相信号入力ポート50ps1との間の第1sin相検出ライン212、第1cos相信号出力ポート100pc1と第1cos相信号入力ポート50pc1との間の第1cos相検出ライン213である。
また、第1励磁コイル111の他端、第1sin相検出コイル112の他端、第1cos相検出コイル113の他端は、共通グランドライン240を介してアシストECU50のグランドポート50pgに接続される。図中において、符号100pgはレゾルバユニット100のグランドポートである。従って、グランドポート50pgとグランドポート100pgとの間の共通グランドライン240がワイヤハーネス部分となる。
第2レゾルバ120は、出力シャフト12outをロータとして備える。出力シャフト12outの外周側のステータには、ロータの周方向に沿って巻かれた第2励磁コイル121が固定して設けられている。ロータとなる出力シャフト12outには、第2ロータコイル124が固定して設けられている。第2ロータコイル124は、ロータの回転に伴って回転する。第2ロータコイル124は、ロータ内に設けた変圧器(図示略)を介して第2励磁コイル121と非接触にて電気的に接続され、第2励磁コイル121に印加される交流電圧によって通電される。尚、図示しないが、第2ロータコイル124は、回転角の分解能を高めるために、ロータの機械的な回転角に対して電気角がN倍となるように等角度間隔で複数配置されている。
第2レゾルバ120は、出力シャフト12outの外周側のステータに第2sin相検出コイル122および第2cos相検出コイル123とを備えている。第2sin相検出コイル122と第2cos相検出コイル123とは、互いに電気角がπ/2ずれる位置に配置される。
第2sin相検出コイル122および第2cos相検出コイル123は、第2ロータコイル124の回転平面上に配置され、第2ロータコイル124で発生する磁束により交流電圧信号を出力する。第2sin相検出コイル122および第2cos相検出コイル123で発生する交流電圧信号の振幅値は、第2ロータコイル124に対する第2sin相検出コイル122および第2cos相検出コイル123の回転位置に応じて変化する。つまり、第2sin相検出コイル122は、出力シャフト12outの回転角のsin値に応じた振幅となる交流電圧信号を出力し、第2cos相検出コイル123は、出力シャフト12outの回転角のcos値に応じた振幅となる交流電圧信号を出力する。
第2励磁コイル121の一端は、第2励磁ライン220を介してアシストECU50の第2励磁信号出力ポート50pe2に接続されている。また、第2sin相検出コイル122の一端は、第2sin相検出ライン222を介してアシストECU50の第2sin相信号入力ポート50ps2に接続されている。また、第2cos相検出コイル123の一端は、第2cos相検出ライン223を介してアシストECU50の第2cos相信号入力ポート50pc2に接続されている。図中において、符号100pe2はレゾルバユニット100の第2励磁信号入力ポートであり、符号100ps2は第2sin相信号出力ポートであり、符号100pc2は第2cos相信号出力ポートである。従って、ワイヤハーネスとなる部分は、第2励磁信号出力ポート50pe2と第2励磁信号入力ポート100pe2との間の第2励磁ライン220、第2sin相信号出力ポート100ps2と第2sin相信号入力ポート50ps2との間の第2sin相検出ライン222、第2cos相信号出力ポート100pc2と第2cos相信号入力ポート50pc2との間の第2cos相検出ライン223である。
また、第2励磁コイル121の他端、第2sin相検出コイル122の他端、第2cos相検出コイル123の他端は、共通グランドライン240を介してアシストECU50のグランドポート50pgに接続される。
アシストECU50は、コイル駆動回路52を備えている。このコイル駆動回路52は、第1励磁コイル駆動回路521と第2励磁コイル駆動回路522とから構成されている。第1励磁コイル駆動回路521は、一定の周期、振幅の励磁用交流電圧を第1励磁信号出力ポート50pe1から出力する。以下、第1励磁信号出力ポート50pe1から出力される励磁用交流電圧を第1励磁信号と呼び、第1励磁信号の電圧値を第1励磁電圧V1と呼ぶ。第1励磁電圧V1は、振幅をE1とすると、次式にて表される。
V1=E1・sin(ωt) ・・・(1)
V1=E1・sin(ωt) ・・・(1)
また、第2励磁コイル駆動回路522は、第1励磁コイル駆動回路521から出力される励磁用交流電圧と同じ周波数、かつ、互いに同位相となるように設定された励磁用交流電圧を第2励磁信号出力ポート50pe2から出力する。以下、第2励磁信号出力ポート50pe2から出力される励磁用交流電圧を第2励磁信号と呼び、第2励磁信号の電圧値を第2励磁電圧V2と呼ぶ。第2励磁電圧V2は、振幅をE2とすると、次式にて表される。
V2=E2・sin(ωt) ・・・(2)
V2=E2・sin(ωt) ・・・(2)
尚、第1励磁電圧V1および第2励磁電圧V2の振幅E1,E2は、第1レゾルバ110,第2レゾルバ120の特性に合わせて設定される。また、第1励磁コイル駆動回路521と第2励磁コイル駆動回路522とを共通にして、一つの励磁コイル駆動回路(例えば、第1励磁コイル駆動回路521)から励磁信号をレゾルバユニット100に供給するようにしてもよい。この場合には、第1励磁ライン210と第2励磁ライン220とを1本にすることができる。
第1励磁信号により第1レゾルバ110の第1励磁コイル111が励磁されると、第1sin相検出コイル112および第1cos相検出コイル113で交流電圧が発生する。また、第2励磁信号により第2レゾルバ120の第2励磁コイル121が励磁されると、第2sin相検出コイル122および第2cos相検出コイル123で交流電圧が発生する。
第1sin相検出コイル112から出力される交流電圧信号を第1sin相検出信号と呼び、その電圧値を第1sin相検出電圧Es1と呼ぶ。また、第1cos相検出コイル113から出力される交流電圧信号を第1cos相検出信号と呼び、その電圧値を第1cos相検出電圧Ec1と呼ぶ。第1sin相検出電圧Es1、および、第1cos相検出電圧Ec1は次式にて表される。
Es1=K1・E1・sin(N・θ1)・sin(ωt+α) ・・・(3)
Ec1=K1・E1・cos(N・θ1)・sin(ωt+α) ・・・(4)
Es1=K1・E1・sin(N・θ1)・sin(ωt+α) ・・・(3)
Ec1=K1・E1・cos(N・θ1)・sin(ωt+α) ・・・(4)
また、第2sin相検出コイル122から出力される交流電圧信号を第2sin相検出信号と呼び、その電圧値を第2sin相検出電圧Es2と呼ぶ。また、第2cos相検出コイル123から出力される交流電圧信号を第2cos相検出信号と呼び、その電圧値を第2cos相検出電圧Ec2と呼ぶ。第2sin相検出電圧Es2、および、第2cos相検出電圧Ec2は次式にて表される。
Es2=K2・E2・sin(N・θ2)・sin(ωt+α) ・・・(5)
Ec2=K2・E2・cos(N・θ2)・sin(ωt+α) ・・・(6)
Es2=K2・E2・sin(N・θ2)・sin(ωt+α) ・・・(5)
Ec2=K2・E2・cos(N・θ2)・sin(ωt+α) ・・・(6)
ここで、θ1は入力シャフト12inに直結した第1レゾルバ110のロータの角度、θ2は出力シャフト12outに直結した第2レゾルバ120のロータの角度、K1は第1レゾルバ110の変圧比、K2は第2レゾルバ120の変圧比、Nは第1レゾルバ110および第2レゾルバ120の軸倍角、αは励磁信号に対する位相遅れ量(入出力位相差)、ωは励磁周波数、tは時間を表す。
アシストECU50は、第1sin相検出信号,第1cos相検出信号,第2sin相検出信号,第2cos相検出信号を、それぞれ第1sin相検出ライン212,第1cos相検出ライン213,第2sin相検出ライン222,第2cos相検出ライン223を介して入力する。アシストECU50は、第1sin相検出信号,第1cos相検出信号,第2sin相検出信号,第2cos相検出信号をアンプ51s1,51c1,51s2,51c2に入力してグランド電位に対する各検出信号の電圧を増幅し、増幅した電圧信号を図示しないA/D変換器によりデジタル値に変換し、このデジタル値をマイコンに入力してトルク計算処理を行う。
アシストECU50におけるトルク演算部32は、第1sin相検出信号,第1cos相検出信号,第2sin相検出信号,第2cos相検出信号を増幅しデジタル信号に変換してマイコンに入力する回路と、コイル駆動回路52と、マイコンによりトルク計算処理を行う機能部とから構成される。
次に、操舵トルクを計算する方法について説明する。まず、第1レゾルバ110,第2レゾルバ120のロータの角度θ1,θ2を検出する方法から説明する。どちらも、同様の方法で計算するため、ここでは、第1レゾルバ110の第1回転角θ1の検出方法を例にとり説明する。
第1sin相検出信号の振幅は、(3)式から、K1・E1・sin(N・θ1)で表される。また、第1cos相検出信号の振幅は、(4)式から、K1・E1・cos(N・θ1)で表される。ここで、第1sin相検出信号の振幅をAs1とする(As1=K1・E1・sin(N・θ1))。また、第1cos相検出信号の振幅をAc1とする(Ac1=K1・E1・sin(N・θ1))。アシストECU50のトルク演算部32は、第1sin相検出信号、第1cos相検出信号の電圧値を、第1励磁信号の周期に比べて短い周期でサンプリングする。例えば、第1励磁信号の1周期に対して、等時間間隔で4回、それぞれの検出信号の電圧値をサンプリングする。サンプリングした電圧値は、離散値であるため、最小二乗法を用いて、次式(7),(8)により振幅As1,Ac1を計算することができる。
ここで、fi,tiは、それぞれサンプリングされた値と時間(サンプリング周期)の離散値である。
同様にして、第2レゾルバ120の第2回転角θ2は、次式(11)により計算することができる。
ここで、As2は第2sin相検出信号の振幅(As2=K2・E2・sin(N・θ2))であり、Ac2は第2cos相検出信号の振幅(Ac2=K2・E2・cos(N・θ2))である。
こうして第1回転角θ1と第2回転角θ2が求められると、次式(12)により操舵トルクTrを計算することができる。
Tr=Kb・(θ1−θ2) ・・・(12)
ここで、Kbは、トーションバー12aの捩り特性に応じて決まる比例定数(バネ定数)であり、予め記憶部33に記憶されている。
Tr=Kb・(θ1−θ2) ・・・(12)
ここで、Kbは、トーションバー12aの捩り特性に応じて決まる比例定数(バネ定数)であり、予め記憶部33に記憶されている。
次に、各レゾルバ110,120において、sin相あるいはcos相のコイルの何れかに異常が発生したときの回転角θ1(θ2)の検出方法について説明する。まず、第1レゾルバ110のsin相に異常が生じた場合(第1sin相検出信号が正常に検出できない場合)を例にとり説明する。尚、コイルの異常とは、コイル112,113,122,123そのものの異常だけでなく、第1sin相検出ライン212,第1cos相検出ライン213,第2sin相検出ライン222,第2cos相検出ライン223の断線等、正常にsin相検出信号あるいはcos相検出信号がアシストECU50に入力されない状態をいう。
上述したように第1回転角θ1は、第1sin相検出信号の振幅As1と第1cos相検出信号の振幅Ac1から上記式(10)により計算により求められる。このため、振幅As1が検出できない場合には、上記式(10)を用いて計算できない。この場合には、異常が検出されていない相のコイル(ここでは、第1cos相検出コイル113)の出力する検出信号の振幅から回転角θ1を計算する。
上述したように、第1sin相検出信号の振幅As1は、As1=K1・E1・sin(N・θ1)で表され、第1cos相検出信号の振幅Ac1は、Ac1=K1・E1・cos(N・θ1)で表される。従って、次式(13),(14)の関係式が得られる。
ここで、K1・E1の値は、レゾルバユニット100の正常時において予め測定して記憶しておくことができる。K1・E1と振幅As1,Ac1の関係は、図14(a)に示すものとなる。従って、この2つの式から次式(15)が得られ、次式(16)に示す第1回転角θ1の計算式が得られる。
また、第2レゾルバ120における片側相のコイル異常時においても同様に考える事ができる。sin相に異常が生じた場合には、第2cos相検出信号の振幅Ac2から次式(18)に示す回転角θ2の計算式が得られ、cos相に異常が生じた場合には、第2sin相検出信号の振幅As2から次式(19)に示す回転角θ2の計算式が得られる。
尚、K2・E2と振幅As2,Ac2の関係は、図14(b)に示すものとなる。
こうした計算式(16),(17),(18),(19)は、片側相の検出信号の振幅から回転角を求めるものであるため、2通りの解が出てしまい、一義的に回転角を導き出すことができない。そこで本実施形態においては、以下に示す第1条件と第2条件に基づいて、2通りの解からその1つを特定することができる状況が発生することに着目して、そうした状況となったときに片側相の検出信号の振幅から回転角を一義的に求める。
まず、第1条件、および、第1条件に基づいて決まる片側相の検出信号の振幅から回転角を一義的に算出することのできる状況(以下、第1条件下算出可能状況と呼ぶ)について説明する。
ステアリングシャフト12に設けられているトーションバー12aは、操舵操作により捩られるが、その捩られる角度には限界があり、通常の操舵操作では、例えば、6[deg](機械角)未満となっている。つまり、第1レゾルバ110のロータの角度である第1回転角θ1と、第2レゾルバ120のロータの角度である第2回転角θ2との差が常に6[deg]未満となる。これをレゾルバの電気角で表すと、レゾルバの軸倍角Nを8(N=8)とした場合には、次式(20)のように、第1レゾルバ110の電気角θe1(=N・θ1)と第2レゾルバ120の電気角θe2(=N・θ2)との差は48[deg]未満となる。
|θe1−θe2|<48° ・・・(20)
このように第1回転角θ1と第2回転角θ2とが常に所定角度差未満になるという条件が第1条件である。尚、式中においては、[deg]を[°]で表すことにする。
|θe1−θe2|<48° ・・・(20)
このように第1回転角θ1と第2回転角θ2とが常に所定角度差未満になるという条件が第1条件である。尚、式中においては、[deg]を[°]で表すことにする。
cos相の振幅Ac1のみから電気角θe1が一義的に決まるのは、次式(21),(22)に示すように、電気角θe1が0°〜180°までの範囲であること、あるいは、180°〜360°までの範囲であることが予めわかっている場合である。
0°<θe1<180° ・・・(21)
180<θe1<360° ・・・(22)
0°<θe1<180° ・・・(21)
180<θe1<360° ・・・(22)
従って、第1条件(式(20))から、正常側の第2レゾルバ120の電気角θe2が次式(23),(24)の範囲であれば、cos相の振幅Ac1のみから電気角θe1が一義的に決まる。
0°+48°<θe2<180°−48° ・・・(23)
180+48°<θe2<360―48° ・・・(24)
0°+48°<θe2<180°−48° ・・・(23)
180+48°<θe2<360―48° ・・・(24)
これを整理すると、次式(25),(26)が得られる。
48°<θe2<132° ・・・(25)
228°<θe2<312° ・・・(26)
従って、第1レゾルバ110のsin相に異常が生じた場合に、正常側の第2レゾルバ120の電気角θe2が式(25),(26)で表される範囲に入っているという状況が第1条件下算出可能状況となる。
48°<θe2<132° ・・・(25)
228°<θe2<312° ・・・(26)
従って、第1レゾルバ110のsin相に異常が生じた場合に、正常側の第2レゾルバ120の電気角θe2が式(25),(26)で表される範囲に入っているという状況が第1条件下算出可能状況となる。
同様にして、第1レゾルバ110のcos相に異常が生じて、sin相の振幅As1のみしかわからない場合であっても、以下の状況となる場合には、振幅As1のみから第1回転角θ1を演算することができる。
sin相の振幅As1のみから電気角θe1が一義的に決まるのは、次式(27),(28)に示すように、電気角θe1が−90°〜90°までの範囲であること、あるいは、90°〜270°までの範囲であることが予めわかっている場合である。
―90°<θe1<90° ・・・(27)
90<θe1<270° ・・・(28)
―90°<θe1<90° ・・・(27)
90<θe1<270° ・・・(28)
従って、第1条件(式(20))から、正常側の第2レゾルバ120の電気角θe2が次式(29),(30)の範囲であれば、sin相の振幅As1のみから電気角θe1が一義的に決まる。
―90°+48°<θe2<90°−48° ・・・(29)
90+48°<θe2<270―48° ・・・(30)
―90°+48°<θe2<90°−48° ・・・(29)
90+48°<θe2<270―48° ・・・(30)
これを整理すると、次式(31),(32)が得られる。
―42°<θe2<42° ・・・(31)
138°<θe2<222° ・・・(32)
尚、電気角を0°〜360°のあいだの値で示すと、次式(33),(34),(35)にて表すことができる。
0°<θe2<42° ・・・(33)
138°<θe2<222° ・・・(34)
318°<θe2<360° ・・・(35)
従って、第1レゾルバ110のcos相に異常が生じた場合に、正常側の第2レゾルバ120の電気角θe2が式(33)〜(35)で表される範囲に入っているという状況も第1条件下算出可能状況となる。
―42°<θe2<42° ・・・(31)
138°<θe2<222° ・・・(32)
尚、電気角を0°〜360°のあいだの値で示すと、次式(33),(34),(35)にて表すことができる。
0°<θe2<42° ・・・(33)
138°<θe2<222° ・・・(34)
318°<θe2<360° ・・・(35)
従って、第1レゾルバ110のcos相に異常が生じた場合に、正常側の第2レゾルバ120の電気角θe2が式(33)〜(35)で表される範囲に入っているという状況も第1条件下算出可能状況となる。
以下、式(25),(26)で表される範囲、および、式(33)〜(35)で表される範囲を第1条件下算出可能範囲と呼ぶ。
同様にして、第2レゾルバ120のsin相あるいはcos相のコイルの何れかに異常が発生した場合についても、正常側の第1レゾルバ110の電気角θe1に基づいて、電気角θe1が予め設定した角度範囲(式(25)、(26)、(33)〜(35)においてθe2をθe1に置き換えた範囲)に入る場合には、第1条件下算出可能状況となるため、振幅As2あるいは振幅Ac2のみから第2回転角θ2を演算することができる。
図3(a)は、sin相に異常が発生したときの第1条件下算出可能範囲(正常側レゾルバの電気角)を表し、図3(b)は、cos相に異常が発生したときの第1条件下算出可能範囲(正常側レゾルバの電気角)を表す。図中において、矢印で示した範囲が第1条件下算出可能範囲であり、塗りつぶした範囲が回転角の一義的に決まらない範囲である。この図から分かるように、第1条件から設定される第1条件下算出可能範囲は、全体の半分程度であり、余り広くない。
そこで、本実施形態においては、さらに第2条件に基づいて、片側相の検出信号の振幅から回転角を一義的に算出することのできる状況(以下、第2条件下算出可能状況と呼ぶ)を設定する。以下、第2条件、および、第2条件下算出可能状況について説明する。
アシストECU50のトルク演算部32は、後述する操舵トルク検出ルーチン(図3)を一定の短い周期で繰り返して実行する。そして、この操舵トルク検出ルーチンにおいては、その演算周期で第1回転角θ1と第2回転角θ2とがそれぞれ繰り返し計算される。一方、操舵ハンドル11を回転操作する速度には限界があるため、第1回転角θ1,第2回転角θ2が一演算周期のあいだに変化する回転角の変化量、つまり、回転角変化量は所定変化量以内となる。以下、この所定変化量である、回転角変化量の想定される最大値を最大変化量と呼ぶ。また、第1回転角θ1と第2回転角θ2とを区別しない場合には、それらの回転角を回転角θと呼び、その回転角θを電気角に換算した角度を電気角θeと呼ぶ。また、第1レゾルバ110と第2レゾルバ120とを区別しない場合には、それらを単にレゾルバと呼ぶ。
最大変化量を電気角で表した値をΔθemaxとすると、最大変化量Δθemaxは、次式(36)にて表すことができる。
Δθemax=N・(360/2π)・ωmax・Tc ・・・(36)
ここで、Nはレゾルバの軸倍角、ωmaxは操舵ハンドル11の回転角速度(以下、操舵速度と呼ぶ)の想定される最大値、Tcはトルク演算部32が第1回転角θ1と第2回転角θ2とを計算する演算周期である。例えば、N=8、Tc=200[μs]、ωmax=100[rad/s]とすると、最大変化量Δθemaxは、約9.2[deg]となる。
Δθemax=N・(360/2π)・ωmax・Tc ・・・(36)
ここで、Nはレゾルバの軸倍角、ωmaxは操舵ハンドル11の回転角速度(以下、操舵速度と呼ぶ)の想定される最大値、Tcはトルク演算部32が第1回転角θ1と第2回転角θ2とを計算する演算周期である。例えば、N=8、Tc=200[μs]、ωmax=100[rad/s]とすると、最大変化量Δθemaxは、約9.2[deg]となる。
このように、一演算周期の間に電気角θeが変化する回転角変化量Δθeが最大変化量Δθemax未満になるという条件が第2条件である。この第2条件を用いると、異常側レゾルバの一演算周期前に計算した電気角θe(n−1)が以下に示す範囲に入っている状況においては、次の演算周期における電気角θen(今回、計算しようとする電気角θen)を片側相の振幅から一義的に決めることができる。
ここで、sin相に異常が生じた場合の例について説明する。最大変化量Δθemaxを9.2[deg]とした場合、次式(37)に示すように、異常側レゾルバの一演算周期前に計算した電気角θe(n-1)と、今回計算される電気角θenとの差は9.2[deg]未満となる。
|θen−θe(n−1)|<9.2° ・・・(37)
|θen−θe(n−1)|<9.2° ・・・(37)
cos相の振幅のみから電気角θenが一義的に決まるのは、電気角θenが0°〜180°までの範囲であること、あるいは、180°〜360°までの範囲であることが予めわかっている場合である。従って、第2条件(式(37))から、異常側レゾルバの一演算周期前に計算された電気角θe(n−1)が、次式(38),(39)に示す範囲であれば、cos相の振幅のみから電気角θenが一義的に決まる。
0°+9.2°<θe(n−1)<180°−9.2° ・・・(38)
180+9.2°<θe(n−1)<360―9.2° ・・・(39)
0°+9.2°<θe(n−1)<180°−9.2° ・・・(38)
180+9.2°<θe(n−1)<360―9.2° ・・・(39)
異常側レゾルバの電気角が一演算周期のあいだに0°あるいは180°を通過できる状況にあると、cos相の振幅からは一義的に回転角を決めることができない。これは、cos相の振幅だけでは、異常側レゾルバの電気角が、0°あるいは180°を挟んでどちら側にあるのか分からないためである。一方、異常側レゾルバの電気角が一演算周期のあいだに0°あるいは180°を通過する可能性が無い状況であれば、cos相の振幅のみから電気角θenが一義的に決まる。こうしたことから、上記の式(38),(39)が導かれる。
式(38),(39)を整理すると、次式(40),(41)が得られる。この式(40),(41)が成立する場合に、cos相の振幅のみから電気角θenが一義的求められる。
9.2°<θe(n−1)<170.8° ・・・(40)
189.2°<θe(n−1)<350.8° ・・・(41)
従って、レゾルバのsin相に異常が生じた場合に、異常側レゾルバの一演算周期前に計算された電気角θe(n−1)が式(40),(41)で表される範囲に入っているという状況が第2条件下算出可能状況となる。
9.2°<θe(n−1)<170.8° ・・・(40)
189.2°<θe(n−1)<350.8° ・・・(41)
従って、レゾルバのsin相に異常が生じた場合に、異常側レゾルバの一演算周期前に計算された電気角θe(n−1)が式(40),(41)で表される範囲に入っているという状況が第2条件下算出可能状況となる。
同様にして、レゾルバのcos相に異常が生じて、sin相の振幅のみしかわからない場合であっても、以下の状況となる場合には、sin相の振幅のみから異常側レゾルバの回転角を演算することができる。
sin相の振幅のみから電気角θenが一義的に決まるのは、電気角θenが−90°〜90°までの範囲であること、あるいは、90°〜270°までの範囲であることが予めわかっている場合である。従って、第2条件(式(37))から、異常側レゾルバの一演算周期前に計算された電気角θe(n−1)が、次式(42),(43)に示す範囲であれば、sin相の振幅のみから電気角θenが一義的に決まる。
−90°+9.2°<θe(n−1)<90°−9.2° ・・・(42)
90+9.2°<θe(n−1)<270―9.2° ・・・(43)
−90°+9.2°<θe(n−1)<90°−9.2° ・・・(42)
90+9.2°<θe(n−1)<270―9.2° ・・・(43)
異常側レゾルバの電気角が一演算周期のあいだに90°あるいは270°を通過できる状況にあると、sin相の振幅からは一義的に回転角を決めることができない。これは、sin相の振幅だけでは、異常側レゾルバの電気角が、90°あるいは270°を挟んでどちら側にあるのか分からないためである。一方、異常側レゾルバの電気角が一演算周期のあいだに90°あるいは270°を通過する可能性が無い状況であれば、sin相の振幅のみから電気角θenが一義的に決まる。こうしたことから、上記の式(42),(43)が導かれる。
式(42),(43)を整理すると、次式(44),(45)が得られる。この式(44),(45)が成立する場合に、sin相の振幅のみから電気角θenが一義的求められる。
−80.8°<θe(n−1)<80.8° ・・・(44)
99.2°<θe(n−1)<260.8° ・・・(45)
尚、電気角を0°〜360°のあいだの値で示すと、次式(46),(47),(48)にて表すことができる。
0°<θe(n−1)<80.8° ・・・(46)
99.2°<θe(n−1)<260.8° ・・・(47)
279.2°<θe(n−1)<360° ・・・(48)
従って、レゾルバのcos相に異常が生じた場合に、異常側レゾルバの一演算周期前に計算された電気角θe(n−1)が式(46)〜(48)で表される範囲に入っているという状況も第2条件下算出可能状況となる。
−80.8°<θe(n−1)<80.8° ・・・(44)
99.2°<θe(n−1)<260.8° ・・・(45)
尚、電気角を0°〜360°のあいだの値で示すと、次式(46),(47),(48)にて表すことができる。
0°<θe(n−1)<80.8° ・・・(46)
99.2°<θe(n−1)<260.8° ・・・(47)
279.2°<θe(n−1)<360° ・・・(48)
従って、レゾルバのcos相に異常が生じた場合に、異常側レゾルバの一演算周期前に計算された電気角θe(n−1)が式(46)〜(48)で表される範囲に入っているという状況も第2条件下算出可能状況となる。
以下、式(40),(41)で表される範囲、および、式(46)〜(48)で表される範囲を第2条件下算出可能範囲と呼ぶ。
図4(a)は、sin相に異常が発生したときの第2条件下算出可能範囲(θe(n−1)の範囲)を表し、図4(b)は、cos相に異常が発生したときの第2条件下算出可能範囲(θe(n−1)の範囲)を表す。図中において、矢印で示した範囲が第2条件下算出可能範囲であり、塗りつぶした範囲が回転角の一義的に決まらない範囲である。この図から分かるように、第2条件から設定される第2条件下算出可能範囲は、非常に広い。
次に、トルク演算部32の実行する操舵トルク検出処理について説明する。図5は、操舵トルク検出ルーチンを表すフローチャートである。操舵トルク検出ルーチンは、記憶部33に制御プログラムとして記憶されている。操舵トルク検出ルーチンは、イグニッションキーがオン状態となっている期間において、所定の短い周期で繰り返し実行される。尚、トルク演算部32は、操舵トルク検出ルーチンの起動とともに、コイル駆動回路52を作動させて、第1励磁信号出力ポート50pe1および第2励磁信号出力ポート50pe2から第1励磁信号および第2励磁信号の出力を開始する。
トルク演算部32は、ステップS11において、第1sin相検出信号,第1cos相検出信号,第2sin相検出信号,第2cos相検出信号の電圧値である第1sin相検出電圧Es1,第1cos相検出電圧Ec1,第2sin相検出電圧Es2,第2cos相検出電圧Ec2を読み込む。トルク演算部32は、操舵トルク検出ルーチンとは別のサンプリングルーチンで、励磁信号の1周期当たりに例えば4回のサンプリング周期で検出電圧Es1,Ec1,Es2,Ec2の瞬時値をサンプリングしている。このステップS11では、そのサンプリングルーチンでサンプリングした検出電圧Es1,Ec1,Es2,Ec2の読み込みを行う。続いて、ステップS12において、読み込んだ検出電圧Es1,Ec1,Es2,Ec2に基づいて、最小二乗法を用いて、第1sin相検出信号,第1cos相検出信号,第2sin相検出信号,第2cos相検出信号の振幅As1,Ac1,As2,Ac2を計算する。
続いて、トルク演算部32は、ステップS13において、検出電圧Es1,Ec1,Es2,Ec2に基づいて、コイル異常のチェックを行う。コイル異常は、レゾルバ内のコイル異常だけでなく、第1sin相検出ライン212,第1cos相検出ライン213,第2sin相検出ライン222,第2cos相検出ライン223の断線等により生じる。主に、ワイヤハーネス部の断線、コネクタ外れが原因となる。こうしたコイル異常が発生した場合には、検出電圧Es1,Ec1,Es2,Ec2が正常な範囲から外れる。例えば、検出電圧Es1,Ec1,Es2,Ec2のオフセットが生じたり、交流電圧信号が検出されなくなったりする。ステップS13は、こうした検出電圧Es1,Ec1,Es2,Ec2が正常範囲から外れているか否かに基づいて、コイル異常の有無、および、コイル異常が発生しているレゾルバ、および、その異常相を特定する。
続いて、トルク演算部32は、ステップS14において、コイル異常チェック結果に基づいて、コイル異常が発生しているか否かを判断し、コイル異常が発生していない場合には(S14:No)、ステップS15において、第1レゾルバ110の第1回転角θ1と第2レゾルバ120の第2回転角θ2を上記式(10)、(11)を用いて計算する。
続いて、トルク演算部32は、ステップS16において、上記式(12)を用いて、操舵トルクTrを計算し、次に、ステップS17において、計算した操舵トルクTrをアシスト演算部31に出力する。アシスト演算部31は、この操舵トルクTrを使って目標アシストトルクを計算し、この目標アシストトルクに対応した目標電流が電動モータ21に流れるようにモータ駆動回路40にPWM制御信号を出力する。これにより、電動モータ21から適正な操舵アシストトルクが発生する。
トルク演算部32は、ステップS17の処理を行うと、操舵トルク検出ルーチンを一旦終了する。そして、所定の短い周期にて操舵トルク検出ルーチンを繰り返す。こうした処理が繰り返されて、ステップS13において、コイル異常が検出されると、ステップS14の判断は「Yes」となる。この場合、トルク演算部32は、その処理をステップS18に進めて、車両の警告ランプ65を点灯させる。これにより、ドライバーに対して異常が生じていることを認識させることができる。尚、ドライバーに異常報知する手段は、警告ランプ65に限らず、異常メッセージをスピーカや表示画面等を使って報知するようにしてもよい。
続いて、トルク演算部32は、ステップS19において、コイル異常が1つ(1相)であるか否かを判断する。コイル異常が複数である場合には、操舵トルクTrを検出することができないため、ステップS20において、アシスト演算部31に対して、トルク検出不能信号を出力する。これにより、アシスト演算部31は、操舵アシスト制御を停止する。
一方、コイル異常が1つである場合(S19:Yes)には、ステップS21において、コイル異常が発生しているのは第1レゾルバ110であるか否かを判断する。第1レゾルバ110である場合には、ステップS22において、第2レゾルバ120の第2回転角θ2を上記式(11)を用いて計算する。
続いて、トルク演算部32は、ステップS30において、第1レゾルバ110の第1回転角θ1を演算する。この処理については、図6のフローチャートを使って後述する。ステップS30において、第1レゾルバ110の第1回転角θ1が算出されると、この第1回転角θ1とステップS22で算出した第2回転角θ2とに基づいて操舵トルクTrを計算し(S16)、その操舵トルクTrをアシスト演算部31に出力する(S17)。
また、ステップS21において、コイル異常が発生しているのは第1レゾルバ110ではない、つまり、第2レゾルバ120でコイル異常が発生していると判断した場合には、ステップS23において、第1レゾルバ110の第1回転角θ1を上記式(10)を用いて計算する。
続いて、トルク演算部32は、ステップS40において、第2レゾルバ110の第2回転角θ2を演算する。この処理については、図7のフローチャートを使って後述する。ステップS40において、第2レゾルバ120の第2回転角θ2が算出されると、この第2回転角θ2とステップS23で算出した第1回転角θ1とに基づいて操舵トルクTrを計算し(S16)、その操舵トルクTrをアシスト演算部31に出力する(S17)。
尚、トルク演算部32は、ステップS15,S30,S40で第1回転角θ1および第2回転角θ2を計算するたびに、その回転角θ1,θ2に対応した電気角θe1,θe2を、一演算周期前の電気角θe1(n−1),θe2(n−1)として記憶部33に記憶更新する。この記憶部33に記憶された電気角θe1(n−1),θe2(n−1)は、後述する第2条件下算出可能状況の判定に利用される。
次に、ステップS30の第1レゾルバ110の第1回転角θ1の計算処理について説明する。図6は、上記操舵トルク検出ルーチンにおいてステップS30として組み込まれた第1回転角計算ルーチン(サブルーチン)を表すフローチャートである。
第1回転角計算ルーチンが起動すると、トルク演算部32は、まず、ステップS31において、第1レゾルバ110のコイル異常はsin相で発生しているのか否かを判断する。コイル異常がsin相で発生している場合には、ステップS32において、先のステップS22で算出した第2レゾルバ120の第2回転角θ2に対応する電気角θe2が第1条件下算出可能範囲に入っているか否かを判断する。つまり、第1条件下算出可能状況にあるか否かを判断する。この第1条件下算出可能範囲は、図8(a)に矢印で示す範囲である。
このステップS32においては、電気角θe2が次式(49),(50)にて表される範囲に入っているか否かについて判断される。
θes1<θe2<θes2 ・・・(49)
θes3<θe2<θes4 ・・・(50)
この第1条件下算出可能範囲は、上述したように、第1回転角θ1と第2回転角θ2とが所定角度差未満になるという第1条件から設定されるもので、例えば、上述した例を使えば、θes1=48°,θes2=132°,θes3=228°,θes4=312°である。この所定角度差は、電気角で示すと(θes1−0°)[deg]で表される角度である。
θes1<θe2<θes2 ・・・(49)
θes3<θe2<θes4 ・・・(50)
この第1条件下算出可能範囲は、上述したように、第1回転角θ1と第2回転角θ2とが所定角度差未満になるという第1条件から設定されるもので、例えば、上述した例を使えば、θes1=48°,θes2=132°,θes3=228°,θes4=312°である。この所定角度差は、電気角で示すと(θes1−0°)[deg]で表される角度である。
トルク演算部32は、電気角θe2が第1条件下算出可能範囲に入っていると判定した場合(S32:Yes)には、ステップS33において、上記式(16)を用いて第1回転角θ1を計算する。この場合、第1回転角θ1は、2通りの解が存在するが、上記の第1条件を満たす解を選択する。つまり、第2回転角θ2との差が所定角度差未満(上記の例では6[deg])となる第1回転角θ1を選択する。
トルク演算部32は、こうして第1レゾルバ120の第1回転角θ1を算出すると、その処理をメインルーチンである操舵トルク検出ルーチンのステップS16に進める。
トルク演算部32は、ステップS32において、「No」と判定した場合、つまり、電気角θe2が第1条件下算出可能範囲に入っていないと判定した場合には、その処理をステップS34に進める。このステップS34においては、一演算周期前に算出した第1回転角θ1(n−1)に対応する電気角θe1(n−1)が第2条件下算出可能範囲に入っているか否かを判断する。つまり、第2条件下算出可能状況にあるか否かを判断する。この第2条件下算出可能範囲は、図9(a)に矢印で示す範囲である。
このステップS34においては、電気角θe1(n−1)が次式(51),(52)にて表される範囲に入っているか否かについて判断される。
θesa<θe1(n−1)<θesb ・・・(51)
θesc<θe1(n−1)<θesd ・・・(52)
この第2条件下算出可能範囲は、上述したように、一演算周期の間に電気角θeが変化できる回転角変化量Δθeが最大変化量Δθemax未満になるという第2条件から設定されるもので、例えば、上述した例を使えば、θesa=9.2°,θesb=170.8°,θesc=189.2°,θesd=350.8°である。この最大変化量Δθemaxは、電気角で示すと(θesa−0°)[deg]で表される角度である。尚、一演算周期前において第1回転角θ1が算出できていなかった場合には、上記の判断をすることができないので、ステップS34の判断は「No」となる。
θesa<θe1(n−1)<θesb ・・・(51)
θesc<θe1(n−1)<θesd ・・・(52)
この第2条件下算出可能範囲は、上述したように、一演算周期の間に電気角θeが変化できる回転角変化量Δθeが最大変化量Δθemax未満になるという第2条件から設定されるもので、例えば、上述した例を使えば、θesa=9.2°,θesb=170.8°,θesc=189.2°,θesd=350.8°である。この最大変化量Δθemaxは、電気角で示すと(θesa−0°)[deg]で表される角度である。尚、一演算周期前において第1回転角θ1が算出できていなかった場合には、上記の判断をすることができないので、ステップS34の判断は「No」となる。
トルク演算部32は、電気角θe1(n−1)が第2条件下算出可能範囲に入っていると判定した場合(S34:Yes)には、ステップS33において、上記式(16)を用いて第1回転角θ1を計算する。この場合、第1回転角θ1においても、2通りの解が存在するが、上記の第2条件を満たす解を選択する。つまり、一演算周期前に算出した第1回転角θ1(n−1)に対応する電気角θe1(n−1)との差が最大変化量Δθemax未満となる第1回転角θ1を選択する。
トルク演算部32は、こうして第1レゾルバ120の第1回転角θ1を算出すると、その処理をメインルーチンである操舵トルク検出ルーチンのステップS16に進める。
一方、ステップS34において、「No」と判定した場合、つまり、第2条件下算出可能状況ではないと判定した場合には、トルク演算部32は、その処理をステップS35に進める。このステップS35においては、一演算周期前の操舵トルク検出ルーチンで計算した操舵トルクTr(n-1)を、今回の操舵トルクTrに設定し、その操舵トルクTrをアシスト演算部31に出力する(S17)。
また、ステップS31において、「No」、つまり、第1レゾルバ110のコイル異常がcos相で発生していると判定した場合には、ステップS36において、先のステップS22で算出した第2レゾルバ120の第2回転角θ2に対応する電気角θe2が第1条件下算出可能範囲に入っているか否かを判断する。つまり、第1条件下算出可能状況にあるか否かを判断する。この第1条件下算出可能範囲は、図8(b)に矢印で示す範囲である。
このステップS36においては、電気角θe2が次式(53),(54),(55)にて表される範囲に入っているか否かについて判断される。
0°<θe2<θec1 ・・・(53)
θec2<θe2<θec3 ・・・(54)
θec4<θe2<360° ・・・(55)
この第1条件下算出可能範囲は、上述したように、第1回転角θ1と第2回転角θ2とが所定角度差未満になるという第1条件から設定されるもので、例えば、上述した例を使えば、θec1=42°,θec2=138°,θes4=222°,θec4=318°である。この所定角度差は、電気角で示すと、例えば、(90°−θec1)[deg]で表される角度である。
0°<θe2<θec1 ・・・(53)
θec2<θe2<θec3 ・・・(54)
θec4<θe2<360° ・・・(55)
この第1条件下算出可能範囲は、上述したように、第1回転角θ1と第2回転角θ2とが所定角度差未満になるという第1条件から設定されるもので、例えば、上述した例を使えば、θec1=42°,θec2=138°,θes4=222°,θec4=318°である。この所定角度差は、電気角で示すと、例えば、(90°−θec1)[deg]で表される角度である。
トルク演算部32は、電気角θe2が第1条件下算出可能範囲に入っていると判定した場合(S36:Yes)には、ステップS37において、上記式(17)を用いて第1回転角θ1を計算する。この場合、第1回転角θ1は、2通りの解が存在するが、上記の第1条件を満たす解を選択する。つまり、第2回転角θ2との差が所定角度差未満(上記の例では6[deg])となる第1回転角θ1を選択する。
トルク演算部32は、こうして第1レゾルバ110の第1回転角θ1を算出すると、その処理をメインルーチンである操舵トルク検出ルーチンのステップS16に進める。
トルク演算部32は、ステップS36において、「No」と判定した場合、つまり、電気角θe2が第1条件下算出可能範囲に入っていないと判定した場合には、その処理をステップS38に進める。このステップS38においては、一演算周期前に算出した第1回転角θ1(n−1)に対応する電気角θe1(n−1)が第2条件下算出可能範囲に入っているか否かを判断する。つまり、第2条件下算出可能状況にあるか否かを判断する。この第2条件下算出可能範囲は、図9(b)に矢印で示す範囲である。
このステップS38においては、電気角θe1(n−1)が次式(56),(57),(58)にて表される範囲に入っているか否かについて判断される。
0°<θe1(n−1)<θeca ・・・(56)
θecb<θe1(n−1)<θecc ・・・(57)
θecd<θe1(n−1)<360° ・・・(58)
この第2条件下算出可能範囲は、上述したように、一演算周期の間に電気角θeが変化できる回転角変化量Δθeが最大変化量Δθemax未満になるという第2条件から設定されるもので、例えば、上述した例を使えば、θeca=80.8°,θecb=99。2°,θecc=260.8°,θecd=279.2°である。この最大変化量Δθemaxは、電気角で示すと、例えば、(90°−θeca)[deg]で表される角度である。尚、一演算周期前において第1回転角θ1が算出できていなかった場合には、上記の判断をすることができないので、ステップS38の判断は「No」となる。
0°<θe1(n−1)<θeca ・・・(56)
θecb<θe1(n−1)<θecc ・・・(57)
θecd<θe1(n−1)<360° ・・・(58)
この第2条件下算出可能範囲は、上述したように、一演算周期の間に電気角θeが変化できる回転角変化量Δθeが最大変化量Δθemax未満になるという第2条件から設定されるもので、例えば、上述した例を使えば、θeca=80.8°,θecb=99。2°,θecc=260.8°,θecd=279.2°である。この最大変化量Δθemaxは、電気角で示すと、例えば、(90°−θeca)[deg]で表される角度である。尚、一演算周期前において第1回転角θ1が算出できていなかった場合には、上記の判断をすることができないので、ステップS38の判断は「No」となる。
トルク演算部32は、電気角θe1(n−1)が第2条件下算出可能範囲に入っていると判定した場合(S38:Yes)には、ステップS37において、上記式(17)を用いて第1回転角θ1を計算する。この場合、第1回転角θ1は、2通りの解が存在するが、上記の第2条件を満たす解を選択する。つまり、一演算周期前に算出した第1回転角θ1(n−1)に対応する電気角θe1(n−1)との差が最大変化量Δθemax未満となる第1回転角θ1を選択する。
トルク演算部32は、こうして第1レゾルバ120の第1回転角θ1を算出すると、その処理をメインルーチンである操舵トルク検出ルーチンのステップS16に進める。
一方、ステップS38において、「No」と判定した場合、つまり、第2条件下算出可能状況ではないと判定した場合には、トルク演算部32は、その処理を上述のステップS35に進める。
次に、ステップS40の第2レゾルバ120の第2回転角θ2の計算処理について説明する。図7は、上記操舵トルク検出ルーチンにおいてステップS40として組み込まれた第2回転角計算ルーチン(サブルーチン)を表すフローチャートである。尚、第2回転角計算ルーチンは、上述した第1回転角計算ルーチンと同様に考えればよい。
第2回転角計算ルーチンが起動すると、トルク演算部32は、まず、ステップS41において、第2レゾルバ110のコイル異常はsin相で発生しているのか否かを判断する。コイル異常がsin相で発生している場合には、ステップS42において、先のステップS23で算出した第1レゾルバ110の第1回転角θ1に対応する電気角θe1が第1条件下算出可能範囲に入っているか否かを判断する。つまり、第1条件下算出可能状況にあるか否かを判断する。この第1条件下算出可能範囲は、図8(a)に矢印で示す範囲である。
このステップS42においては、電気角θe1が次式(59),(60)にて表される範囲に入っているか否かについて判断される。
θes1<θe1<θes2 ・・・(59)
θes3<θe1<θes4 ・・・(60)
θes1<θe1<θes2 ・・・(59)
θes3<θe1<θes4 ・・・(60)
トルク演算部32は、電気角θe1が第1条件下算出可能範囲に入っていると判定した場合(S42:Yes)には、ステップS43において、上記式(18)を用いて第2回転角θ2を計算する。この場合、第1回転角θ1との差が所定角度差未満となる第2回転角θ2を選択する。
トルク演算部32は、電気角θe1が第1条件下算出可能範囲に入っていないと判定した場合には(S42:No)、ステップS44において、一演算周期前に算出した第2回転角θ2(n−1)に対応する電気角θe2(n−1)が第2条件下算出可能範囲に入っているか否かを判断する。つまり、第2条件下算出可能状況にあるか否かを判断する。この第2条件下算出可能範囲は、図9(a)に矢印で示す範囲である。
このステップS44においては、電気角θe2(n−1)が次式(61),(62)にて表される範囲に入っているか否かについて判断される。
θesa<θe2(n−1)<θesb ・・・(61)
θesc<θe2(n−1)<θesd ・・・(62)
θesa<θe2(n−1)<θesb ・・・(61)
θesc<θe2(n−1)<θesd ・・・(62)
トルク演算部32は、電気角θe2(n−1)が第2条件下算出可能範囲に入っていると判定した場合(S44:Yes)には、ステップS43において、上記式(18)を用いて第2回転角θ2を計算する。この場合、一演算周期前に算出した第2回転角θ2(n−1)に対応する電気角θe2(n−1)との差が最大変化量Δθemax未満となる第2回転角θ2を選択する。
トルク演算部32は、こうして第2レゾルバ120の第2回転角θ2を算出すると、その処理をメインルーチンである操舵トルク検出ルーチンのステップS16に進める。
一方、ステップS44において、「No」と判定した場合、つまり、第2条件下算出可能状況ではないと判定した場合には、ステップS45において、一演算周期前の操舵トルク検出ルーチンで計算した操舵トルクTr(n-1)を、今回の操舵トルクTrに設定し、その操舵トルクTrをアシスト演算部31に出力する(S17)。
また、ステップS41において、「No」、つまり、第2レゾルバ120のコイル異常がcos相で発生していると判定した場合には、ステップS46において、先のステップS23で算出した第1レゾルバ110の第1回転角θ1に対応する電気角θe1が第1条件下算出可能範囲に入っているか否かを判断する。つまり、第1条件下算出可能状況にあるか否かを判断する。この第1条件下算出可能範囲は、図8(b)に矢印で示す範囲である。
このステップS46においては、電気角θe1が次式(63),(64),(65)にて表される範囲に入っているか否かについて判断される。
0°<θe1<θec1 ・・・(63)
θec2<θe1<θec3 ・・・(64)
θec4<θe1<360° ・・・(65)
0°<θe1<θec1 ・・・(63)
θec2<θe1<θec3 ・・・(64)
θec4<θe1<360° ・・・(65)
トルク演算部32は、電気角θe1が第1条件下算出可能範囲に入っていると判定した場合(S46:Yes)には、ステップS47において、上記式(19)を用いて第2回転角θ2を計算する。この場合、第1回転角θ1との差が所定角度差未満となる第2回転角θ2を選択する。
トルク演算部32は、こうして第2レゾルバ120の第2回転角θ2を算出すると、その処理をメインルーチンである操舵トルク検出ルーチンのステップS16に進める。
トルク演算部32は、ステップS46において、「No」と判定した場合、つまり、電気角θe1が第1条件下算出可能範囲に入っていないと判定した場合には、ステップS48において、一演算周期前に算出した第2回転角θ2(n−1)に対応する電気角θe2(n−1)が第2条件下算出可能範囲に入っているか否かを判断する。つまり、第2条件下算出可能状況にあるか否かを判断する。この第2条件下算出可能範囲は、図9(b)に矢印で示す範囲である。
このステップS48においては、電気角θe2(n−1)が次式(66),(67),(68)にて表される範囲に入っているか否かについて判断される。
0°<θe2(n−1)<θeca ・・・(66)
θecb<θe2(n−1)<θecc ・・・(67)
θecd<θe2(n−1)<360° ・・・(68)
0°<θe2(n−1)<θeca ・・・(66)
θecb<θe2(n−1)<θecc ・・・(67)
θecd<θe2(n−1)<360° ・・・(68)
トルク演算部32は、電気角θe2(n−1)が第2条件下算出可能範囲に入っていると判定した場合(S48:Yes)には、ステップS47において、上記式(19)を用いて第2回転角θ2を計算する。この場合、第2回転角θ2は、2通りの解が存在するが、一演算周期前に算出した第2回転角θ2(n−1)に対応する電気角θe2(n−1)との差が最大変化量Δθemax未満となる第2回転角θ2を選択する。
トルク演算部32は、こうして第2レゾルバ120の第2回転角θ2を算出すると、その処理をメインルーチンである操舵トルク検出ルーチンのステップS16に進める。
一方、ステップS48において、「No」と判定した場合、つまり、第2条件下算出可能状況ではないと判定した場合には、トルク演算部32は、その処理を上述のステップS45に進める。
以上説明した本実施形態のトルク検出装置においては、第1条件(捩れ角度上限)から導き出した第1条件下算出可能状況だけでなく、第2条件(回転角変化量上限)から導き出した第2条件下算出可能状況となる場合にも、正常側相の検出信号の振幅に基づいて回転角を算出する。従って、片側相にコイル異常が発生した場合でも、正常側相の検出信号の振幅から一義的に回転角を算出できる範囲が非常に広くなり、操舵トルクを検出できる期間が長くなる。従って、電動パワーステアリング装置で適正な操舵アシストを継続できる期間を長くすることができる。
また、2つの算出可能状況とはならず、異常側レゾルバの回転角を一義的に決めることができない場合には、直前回(一演算周期前)の操舵トルク検出ルーチンで計算した操舵トルクTr(n-1)を用いて操舵アシストを継続するため、途中で操舵アシストが中断してしまうことが無く操作性が良好となる。
また、コイル異常が発生した場合には、警告ランプ65が点灯するため、操舵アシストを継続させながらも、ドライバーに異常を認識させることができる。これにより、早期に修理が行われるため、2重故障により操舵アシストが停止されるという状況に陥る確率を極めて小さくすることができる。
次に、変形例について説明する。上述した実施形態においては、操舵ハンドル11の操舵速度ωの想定される最大値ωmaxに基づいて第2条件下算出可能範囲を設定したが、操舵速度ωの大きさ|ω|が小さければ、式(36)における最大変化量Δθemaxが小さくなるため、図10に示すように、第2条件下算出可能範囲をさらに拡大することができる。
例えば、操舵速度ωの想定される最大値ωmaxが10[rad/s]となる場合には、式(36)を用いて最大変化量Δθemaxを計算すると、最大変化量Δθemaxは、約0.92[deg]となる。従って、第2条件下算出可能範囲が非常に広くなる。尚、図10は、sin相にコイル異常が発生したときの第2条件下算出可能範囲を表すもので、cos相のコイル異常が発生したときの第2条件下算出可能範囲は、この図を原点を中心に90°回転させたものとなる。
そこで、変形例においては、実際の操舵速度ωを検出し、検出した操舵速度ωの大きさに応じた最大変化量Δθemaxを設定する。以下、検出した操舵速度ωの大きさを実操舵速度|ω|と呼ぶ。
この場合、実操舵速度|ω|は、電動モータ21に設けた回転角センサ61で検出された回転角の時間微分値から求めるようにすることができるが、他にも、ステアリングシャフト12に操舵角センサ(図示略)を設けて、その操舵角センサで検出された操舵角の時間微分値から求めるようにしても良いし、レゾルバユニット100における正常側レゾルバの検出する回転角の時間微分値から求めるようにしても良い。
実操舵速度|ω|に応じて最大変化量Δθemaxを設定するにあたっては、図11に示すように、実操舵速度|ω|を式(36)のωmaxに代入して理論値となる最大変化量Δθemaxを設定するとよい。また、図12に示すように、理論値に対して余裕幅を上乗せした値に設定するようにしてもよい。この場合には、検出誤差等による第2条件下算出可能状況の判断誤りが生じないようになる。また、図13に示すように、実操舵速度|ω|が所定値以下となる範囲においては、最大変化量Δθemaxを一定値とした余裕幅を持たせて設定するようにしてもよい。この場合には、操舵速度検出分解能の関係で、操舵速度の測定精度が低くなる範囲での測定値を、第2条件下算出可能範囲の設定に反映させないようにすることができる。このため、第2条件下算出可能状況の判断誤りを更に減らすことができる。
このように実操舵速度|ω|に応じて最大変化量Δθemaxを可変させる場合には、第1回転角計算ルーチンおよび第2回転角計算ルーチンにおいて、図15、図16に示す処理を追加するとよい。つまり、図15に示すように、ステップS32とステップS34との間、および、ステップS42とステップS44との間に、ステップS51,S52,S53の処理を追加し、図16に示すように、ステップS36とステップS38との間、および、ステップS46とステップS48との間に、ステップS61,S62,S63の処理を追加する。
コイル異常がsin相で発生している場合には、図15に示すように、トルク演算部32は、ステップS51において、回転角センサ61で検出されるモータ回転角の時間微分値から操舵速度ωを検出する。続いて、ステップS52において、実操舵速度|ω|に基づいて、図11(あるいは図12,図13でも良い)に示した実操舵速度|ω|と最大変化量Δθemaxとの関係から、最大変化量Δθemaxを設定する。実操舵速度|ω|と最大変化量Δθemaxとの関係を表す情報は、計算式あるいはマップを使って予め記憶部33に記憶されている。トルク演算部32は、記憶部33に記憶されている情報を参照して、最大変化量Δθemaxを設定する。続いて、トルク演算部32は、ステップS53において、最大変化量Δθemaxに基づいて、第2条件下算出可能範囲の境界となるθesa,,θesb,θesc,θesdを設定する(図9(a)参照)。この場合、(θesa−0°)[deg]で表される角度が最大変化量Δθemaxとなるように設定すればよい。
また、コイル異常がcos相で発生している場合には、図16に示すように、トルク演算部32は、ステップS61において、操舵速度ωを検出し、ステップS62において、実操舵速度|ω|に基づいて、最大変化量Δθemaxを設定する。続いて、トルク演算部32は、ステップS63において、最大変化量Δθemaxに基づいて、第2条件下算出可能範囲の境界となるθeca,,θecb,θecc,θecdを設定する(図9(b)参照)。この場合、(90°−θeca)[deg]で表される角度が最大変化量Δθemaxとなるように設定すればよい。
この変形例によれば、実操舵速度|ω|が小さくなるほど小さくなる最大変化量Δθemaxを設定するため、異常側レゾルバの回転角を一義的に決めることができる第2条件下算出可能範囲がさらに広くなる。
以上、本実施形態について説明したが、本発明は上記実施形態に限定されることなく、本発明の範囲内において種々の変形例を採用することができる。例えば、本実施形態においては、第1条件と第2条件との両方を用いて回転角が一義的に決まる範囲を設定しているが、第2条件のみから回転角が一義的に決まる範囲を設定するようにしてもよい。
11…操舵ハンドル、12…ステアリングシャフト、12in…入力シャフト、12out…出力シャフト、12a…トーションバー、20…パワーアシスト部、21…電動モータ、31…アシスト演算部、32…トルク演算部、33…記憶部、40…モータ駆動回路、50…アシストECU、51s1,51c1,51s2,51c2…アンプ、52…コイル駆動回路、61…回転角センサ、100…レゾルバユニット、110…第1レゾルバ、111…第1励磁コイル、112…第1sin相検出コイル、113…第1cos相検出コイル、114…第1ロータコイル、120…第2レゾルバ、121…第2励磁コイル、122…第2sin相検出コイル、123…第2cos相検出コイル、124…第2ロータコイル、212…第1sin相検出ライン、213…第1cos相検出ライン、222…第2sin相検出ライン、223…第2cos相検出ライン、As1,Ac1,As2,Ac2…振幅、Es1,Ec1,Es2,Ec2…検出電圧、Tr…操舵トルク、θ1…第1回転角、θ2…第2回転角、ω…操舵速度。
Claims (5)
- 操舵ハンドルに連結されたステアリングシャフトの入力側の回転角である第1回転角に応じた2相の検出信号を出力する一対の検出コイルを有する第1レゾルバと、前記ステアリングシャフトの出力側の回転角である第2回転角に応じた2相の検出信号を出力する一対の検出コイルを有する第2レゾルバとを備えたレゾルバユニットと、
前記第1レゾルバの出力する2相の検出信号に基づいて前記第1回転角を演算し、前記第2レゾルバの出力する2相の検出信号に基づいて前記第2回転角を演算する回転角演算手段と、
前記演算された第1回転角と第2回転角との差に基づいて前記ステアリングシャフトに働く操舵トルクを演算するトルク演算手段と
を備えたトルク検出装置において、
前記第1レゾルバあるいは第2レゾルバの何れかで、前記一対の検出コイルの一方に異常が発生していることを検出する異常検出手段と、
前記検出コイルの一方に異常が検出されているとき、前記回転角演算手段が前記第1回転角および第2回転角を演算する演算周期あたりに前記第1回転角あるいは前記第2回転角が変化する回転角変化量が所定変化量以内であるという回転角変化条件に基づいて、前記異常が検出されている検出コイルを有する異常側レゾルバの回転角を一義的に算出することができる状況であるか否かを判断する異常側回転角算出可否判断手段と、
前記異常側回転角算出可否判断手段により、前記異常側レゾルバの回転角を一義的に算出することができる状況であると判定されている場合には、前記異常側レゾルバにおける異常が検出されていない検出コイルの検出信号に基づいて、前記回転角変化条件を満たす前記異常側レゾルバの回転角を演算する異常側回転角演算手段と
を備えたことを特徴とするトルク検出装置。 - 前記異常側回転角算出可否判断手段は、前記異常が検出されている検出コイルがsin相検出コイルである場合には、前記異常側レゾルバの電気角が一演算周期のあいだに0°あるいは180°を通過する可能性がない状況であるときに、前記異常側レゾルバの回転角を一義的に算出することができる状況であると判定し、前記異常が検出されている検出コイルがcos相検出コイルである場合には、前記異常側レゾルバの電気角が一演算周期のあいだに90°あるいは270°を通過する可能性がない状況であるときに、前記異常側レゾルバの回転角を一義的に算出することができる状況であると判定することを特徴とする請求項1記載のトルク検出装置。
- 前記所定変化量は、前記操舵ハンドルが回される操舵速度に基づいて設定されることを特徴とする請求項1または2記載のトルク検出装置。
- 前記所定変化量は、前記操舵ハンドルが回される操舵速度の想定される最大値に基づいて設定されることを特徴とする請求項3記載のトルク検出装置。
- 前記操舵ハンドルが回される操舵速度を検出する操舵速度検出手段と、
前記操舵速度検出手段により検出された操舵速度が小さくなるほど小さくなる前記所定変化量を設定する変化量設定手段と
を備えたことを特徴とする請求項1ないし請求項4の何れか一項記載のトルク検出装置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2010235699A JP2012088198A (ja) | 2010-10-20 | 2010-10-20 | トルク検出装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2010235699A JP2012088198A (ja) | 2010-10-20 | 2010-10-20 | トルク検出装置 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| JP2012088198A true JP2012088198A (ja) | 2012-05-10 |
Family
ID=46259970
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2010235699A Pending JP2012088198A (ja) | 2010-10-20 | 2010-10-20 | トルク検出装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP2012088198A (ja) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2012111396A (ja) * | 2010-11-26 | 2012-06-14 | Toyota Motor Corp | 電動パワーステアリング装置 |
-
2010
- 2010-10-20 JP JP2010235699A patent/JP2012088198A/ja active Pending
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2012111396A (ja) * | 2010-11-26 | 2012-06-14 | Toyota Motor Corp | 電動パワーステアリング装置 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP4911271B1 (ja) | トルク検出装置 | |
| JP5051404B2 (ja) | トルク検出装置 | |
| EP3045871B1 (en) | Rotational-angle detection device and electric power-steering device provided with rotational-angle detection device | |
| JP4425297B2 (ja) | 操舵補助装置 | |
| JP2010048760A (ja) | レゾルバの異常検出装置および電気式動力舵取装置 | |
| JP6669318B2 (ja) | 電動パワーステアリング装置、及び電動パワーステアリング装置用モータの回転角検出方法 | |
| JP6024971B2 (ja) | 回転角検出装置 | |
| JP2009069106A (ja) | トルク検出装置、及び電動パワーステアリング装置 | |
| JP2005147733A (ja) | 異常検出装置、異常検出方法、車両用操舵装置 | |
| JP2012088198A (ja) | トルク検出装置 | |
| JP2012083279A (ja) | トルク検出装置 | |
| JP5699972B2 (ja) | ツインレゾルバ式トルクセンサ及び電動パワーアシスト装置 | |
| JP4189675B2 (ja) | 車両の電動パワーステアリング装置 | |
| JP5482680B2 (ja) | トルク検出装置および電動パワーステアリング装置 | |
| US8942890B2 (en) | Torque detecting device and electric power steering system | |
| JP4380317B2 (ja) | トルクセンサ装置の補正値検出方法 | |
| JP4438386B2 (ja) | トルク検出装置 | |
| JP5459184B2 (ja) | 電動パワーステアリング装置 | |
| JP5447291B2 (ja) | 回転角検出装置及び電動パワーステアリング装置 | |
| JP2007327800A (ja) | 回転角度検出装置およびそれを備える電動パワーステアリング装置 | |
| JP2014139054A (ja) | 電動パワーステアリング装置 | |
| JP2007327829A (ja) | 回転角度検出装置およびそれを備える電動パワーステアリング装置 | |
| JP2008267856A (ja) | トルク検出装置 | |
| JP2005219652A (ja) | 電動パワーステアリング装置 |