JP3871130B2 - Motor control device - Google Patents
Motor control device Download PDFInfo
- Publication number
- JP3871130B2 JP3871130B2 JP2003074824A JP2003074824A JP3871130B2 JP 3871130 B2 JP3871130 B2 JP 3871130B2 JP 2003074824 A JP2003074824 A JP 2003074824A JP 2003074824 A JP2003074824 A JP 2003074824A JP 3871130 B2 JP3871130 B2 JP 3871130B2
- Authority
- JP
- Japan
- Prior art keywords
- phase
- rotor
- count value
- value
- energized phase
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Images
Landscapes
- Gear-Shifting Mechanisms (AREA)
- Control Of Electric Motors In General (AREA)
Description
【0001】
【発明の属する技術分野】
本発明は、エンコーダのパルス信号のカウント値に基づいてロータの回転位置を検出してモータの通電相を順次切り換えることでロータを目標位置まで回転駆動するモータ制御装置に関するものである。
【0002】
【従来の技術】
近年、構造が簡単で安価なモータとして需要が増加しているスイッチトリラクタンスモータ等のブラシレス型のモータは、ロータの回転に同期してパルス信号を出力するエンコーダを搭載し、このエンコーダのパルス信号をカウントして、そのエンコーダカウント値に基づいてロータの回転位置を検出して通電相を順次切り換えることでロータを回転駆動するようにしたものがある。このようなエンコーダ付きのモータは、起動後のエンコーダカウント値に基づいてロータの回転位置を検出することができるため、フィードバック制御系(F/B制御系)によりロータを目標位置まで回転させる位置切換制御(位置決め制御)を行う各種の位置切換装置の駆動源として用いられている(例えば特許文献1参照)。
【0003】
このようなエンコーダ付きのモータでF/B制御を行う場合、エンコーダのパルス信号出力タイミングに同期してエンコーダカウント値に基づいて通電相を切り換えてロータを目標位置に向かって回転駆動し、エンコーダカウント値が目標位置に応じて設定された目標カウント値に到達した時点で、ロータが目標位置に到達したと判断してF/B制御を終了し、ロータを目標位置で停止させるようにしている。
【0004】
【特許文献1】
特開2001−271917号公報(第4頁〜第8頁等)
【0005】
【発明が解決しようとする課題】
上記従来のモータのF/B制御では、エンコーダのパルス信号出力タイミングに同期して通電相を切り換えるため、F/B制御の途中で、何等かの原因でロータの回転が一旦停止して、エンコーダからパルス信号が出力されなくなると、通電相の切り換えを行うことができなくなってしまい、ロータを目標位置まで回転駆動できないという不具合が発生する。
【0006】
このような不具合を解決するため、本発明者らは、特願2002−276521号の明細書に記載されているように、F/B制御による通電相の切り換えとは別に、時間同期処理によって通電相を切り換える機能を持たせ、ロータの回転が停止した状態でも時間同期処理によって通電相の切り換えを行うことができるようにする発明を出願している。
【0007】
F/B制御の途中で、何等かの原因でロータの回転が逆転することがあるため、逆転を検出したときには、直ちに通電相をホールド(固定)して逆転を止める必要がある(逆転を止めないと逆転し続けてしまうためである)。一般に、逆転の検出方法は、エンコーダカウント値の前回値と今回値とを比較して、エンコーダカウント値の増減方向が反転したか否かで、逆転の有無を判定するようにしている(図26参照)。
【0008】
しかし、図27に示すように、F/Bと時間同期処理の両方で通電相を切り換えると、前回のF/B処理によるエンコーダカウント値の前回値が時間同期処理によって更新されてしまうため、実際にロータが逆転していても、エンコーダカウント値の前回値と今回値が同じになって停止と判定されてしまい、その結果、時間同期処理によって通電相を切り換えて逆転し続けてしまうという不具合を発生する。
【0009】
本発明はこれらの事情を考慮してなされたものであり、その目的は、モータのF/B制御の途中で、何等かの原因でロータの回転が一旦停止した場合でも、可能な限りロータを目標位置まで回転駆動できると共に、逆転が発生したときには逆転を止めることができるモータ制御装置を提供することにある。
【0010】
【課題を解決するための手段】
上記目的を達成するために、本発明の請求項1のモータ制御装置は、モータのF/B制御中にエンコーダのパルス信号出力タイミングに同期してエンコーダカウント値に基づいて通電相を設定する第1の通電相設定手段と、ロータが目標位置に回転駆動されるまで時間同期処理によって所定周期でエンコーダカウント値に基づいて通電相を設定する第2の通電相設定手段とを備え、これら第1及び第2の各通電相設定手段によって通電相が設定される毎にその通電相の巻線に通電するように構成すると共に、ロータを目標位置へ回転駆動する途中で該ロータの回転方向が逆転したときにその逆転を検出する逆転検出手段を設け、この逆転検出手段で逆転を検出したときに通電相ホールド手段によって通電相を前回の通電相に固定するようにしたものである。
【0011】
この構成では、モータF/B制御の途中で、何等かの原因でロータの回転が一旦停止してエンコーダからパルス信号が出力されなくなった場合でも、時間同期処理によって所定周期でその時点のエンコーダカウント値に基づいて通電相を設定できるため、ロータの回転が停止した状態でも通電相の切り換えを行うことができて、可能な限りロータを目標位置まで回転駆動することができる。しかも、ロータを目標位置へ回転駆動する途中で該ロータの回転方向が逆転すれば、その逆転を検出して通電相を固定して逆転を止めることができる。
【0012】
この場合、逆転検出手段の具体例としては、請求項2のように、ロータをエンコーダカウント値がカウントアップする方向に回転駆動しているときには該エンコーダカウント値の最大値を逐次記憶しておき、現在のエンコーダカウント値と前記最大値とを比較することで逆転の有無を判定し、ロータをエンコーダカウント値がカウントダウンする方向に回転駆動しているときには該エンコーダカウント値の最小値を逐次記憶しておき、現在のエンコーダカウント値と前記最小値とを比較することで逆転の有無を判定するようにすると良い。このようにすれば、前回のF/B処理によるエンコーダカウント値の前回値が時間同期処理によって更新されるという事情があっても、エンコーダカウント値の最大値・最小値を用いて逆転検出を行うことができる。
【0013】
ところで、図28に示すように、F/B制御中(ロータの回転中)に目標位置が切り換えられると、F/B制御の途中でロータの回転方向を強制的に逆転させなければならないことがある。このような場合、ロータの回転中に目標位置が切り換えられても、ロータの慣性があるためにロータの回転方向を即座に逆転させることは不可能であり、実際には、目標位置が切り換えられてからロータの回転方向が逆転するまでに若干の時間を要するため、その間は、切り換え後の目標位置から見て、ロータが“逆転”している状態となる。このため、逆転検出を正確に行い過ぎると(換言すれば後述する不感帯がないと)、F/B制御の途中で目標位置が切り換えられた場合に、目標位置の切り換え直後のロータの慣性による過渡的な挙動が“逆転”と判定されて、モータが強制的に停止されてしまう不具合が発生する。
【0014】
この対策として、請求項3のように、現在のエンコーダカウント値を前記最大値又は前記最小値と比較して逆転の有無を判定する際に、前記最大値及び前記最小値に対してそれぞれ所定カウント値分の不感帯を設定し、この不感帯内では逆転と判定しないようにすると良い。このようにすれば、F/B制御の途中で目標位置が切り換えられた場合でも、目標位置の切り換え直後のロータの慣性による過渡的な挙動を不感帯によって“逆転”と判定せずに済み、F/B制御の途中で目標位置が切り換えられた場合でも、ロータを目標位置まで回転駆動することができる。
【0015】
また、請求項4のように、通電相ホールド手段で通電相が固定されている状態を検出したときにオープンループ駆動手段によりオープンループ制御に切り換え、エンコーダカウント値の情報をフィードバックせずに通電相を順次切り換えると共に、その通電相の切換回数をカウントしてそのカウント値に基づいてロータを目標位置まで回転駆動するようにすると良い。このようにすれば、逆転検出により通電相が固定されている状態から自動的にF/B制御可能な状態に復帰することができる。
【0016】
この場合、請求項5のように、前記最大値又は前記最小値は、F/B制御開始時にそのときのエンコーダカウント値を初期値としてセットするようにすると良い。このようにすれば、過去のF/B制御で検出されたエンコーダカウント値の最大値又は最小値の影響を受けずに、今回のF/B制御中のエンコーダカウント値の最大値又は最小値を正確に検出することができる。
【0017】
また、請求項6のように、モータとしてスイッチトリラクタンスモータを使用するようにしても良い。スイッチトリラクタンスモータは、永久磁石が不要で構造が簡単であるため、安価であり、温度環境等に対する耐久性・信頼性も高いという利点がある。
【0018】
以上説明した請求項1〜6に係る発明は、スイッチトリラクタンスモータ等のブラシレス型のモータを駆動源とする各種の位置切換装置に適用でき、例えば、請求項7のように、車両の自動変速機のレンジを切り換えるレンジ切換機構を駆動するモータの制御装置に適用しても良い。これにより、信頼性の高いモータ駆動式のレンジ切換装置を構成することができる。
【0019】
【発明の実施の形態】
以下、本発明を車両のレンジ切換装置に適用した一実施形態を図面に基づいて説明する。
【0020】
まず、図1に基づいてレンジ切換機構11の構成を説明する。レンジ切換機構11の駆動源となるモータ12は、例えばスイッチトリラクタンスモータにより構成され、減速機構26(図4参照)を内蔵し、その出力軸13の回転位置を検出する出力軸センサ14が設けられている。この出力軸13には、ディテントレバー15が固定されている。
【0021】
また、ディテントレバー15にはL字形のパーキングロッド18が固定され、このパーキングロッド18の先端部に設けられた円錐体19がロックレバー21に当接している。このロックレバー21は、円錐体19の位置に応じて軸22を中心にして上下動してパーキングギヤ20をロック/ロック解除するようになっている。パーキングギヤ20は、自動変速機27の出力軸に設けられ、このパーキングギヤ20がロックレバー21によってロックされると、車両の駆動輪が回り止めされた状態(パーキング状態)に保持される。
【0022】
一方、ディテントレバー15をパーキングレンジ(以下「Pレンジ」と表記する)と他のレンジ(以下「NotPレンジ」と表記する)に保持するためのディテントバネ23が支持ベース17に固定され、このディテントバネ23の先端に設けられた係合部23aがディテントレバー15のPレンジ保持凹部24に嵌まり込んだときに、ディテントレバー15がPレンジの位置に保持され、該ディテントバネ23の係合部23aがディテントレバー15のNotPレンジ保持凹部25に嵌まり込んだときに、ディテントレバー15がNotPレンジの位置に保持されるようになっている。
【0023】
Pレンジでは、パーキングロッド18がロックレバー21に接近する方向に移動して、円錐体19の太い部分がロックレバー21を押し上げてロックレバー21の凸部21aがパーキングギヤ20に嵌まり込んでパーキングギヤ20をロックした状態となり、それによって、自動変速機27の出力軸(駆動輪)がロックされた状態(パーキング状態)に保持される。
【0024】
一方、NotPレンジでは、パーキングロッド18がロックレバー21から離れる方向に移動して、円錐体19の太い部分がロックレバー21から抜け出てロックレバー21が下降し、それによって、ロックレバー21の凸部21aがパーキングギヤ20から外れてパーキングギヤ20のロックが解除され、自動変速機27の出力軸が回転可能な状態(走行可能な状態)に保持される。
【0025】
尚、前述した出力軸センサ14は、モータ12の減速機構26の出力軸13の回転角度に応じた電圧を出力する回転センサ(例えばポテンショメータ)によって構成され、その出力電圧によって現在のレンジがPレンジとNotPレンジのいずれであるかを確認できるようになっている。
【0026】
次に、図2に基づいてモータ12の構成を説明する。本実施形態では、モータ12として、スイッチトリラクタンスモータ(以下「SRモータ」と表記する)が用いられている。このSRモータ12は、ステータ31とロータ32が共に突極構造を持つモータで、永久磁石が不要で構造が簡単であるという利点がある。円筒状のステータ31の内周部には、例えば12個の突極31aが等間隔に形成され、これに対して、ロータ32の外周部には、例えば8個の突極32aが等間隔に形成され、ロータ32の回転に伴い、ロータ32の各突極32aがステータ31の各突極31aと微小ギャップを介して順番に対向するようになっている。ステータ31の12個の突極31aには、U相、V相、W相の合計6個の巻線33と、U’相、V’相、W’相の合計6個の巻線34が順番に巻回されている。尚、ステータ31とロータ32の突極31a,32aの数は適宜変更しても良いことは言うまでもない。
【0027】
本実施形態の巻線33,34の巻回順序は、ステータ31の12個の突極31aに対して、例えば、V相→W相→U相→V相→W相→U相→V’相→W’相→U’相→V’相→W’相→U’相の順序で巻回されている。図3に示すように、U相、V相、W相の合計6個の巻線33と、U’相、V’相、W’相の合計6個の巻線34は、2系統のモータ励磁部35,36を構成するように結線されている。一方のモータ励磁部35は、U相、V相、W相の合計6個の巻線33をY結線して構成され(同じ相の2個の巻線33はそれぞれ直列に接続されている)、他方のモータ励磁部36は、U’相、V’相、W’相の合計6個の巻線34をY結線して構成されている(同じ相の2個の巻線34はそれぞれ直列に接続されている)。2つのモータ励磁部35,36は、U相とU’相が同時に通電され、V相とV’相が同時に通電され、W相とW’相が同時に通電される。
【0028】
これら2つのモータ励磁部35は、車両に搭載されたバッテリ40を電源として、それぞれ別個のモータドライバ37,38によって駆動される。このように、モータ励磁部35,36とモータドライバ37,38をそれぞれ2系統ずつ設けることで、一方の系統が故障しても、他方の系統でSRモータ12を回転させることができるようになっている。図3に示すモータドライバ37,38の回路構成例では、各相毎にトランジスタ等のスイッチング素子39を1個ずつ設けたユニポーラ駆動方式の回路構成としているが、各相毎にスイッチング素子を2個ずつ設けたバイポーラ駆動方式の回路構成を採用しても良い。尚、本発明は、モータ励磁部とモータドライバをそれぞれ1系統ずつ設けた構成としても良いことは言うまでもない。
【0029】
各モータドライバ37,38の各スイッチング素子39のオン/オフは、ECU41(通電制御手段)によって制御される。図4に示すように、このECU41と各モータドライバ37,38は、レンジ切換制御装置42に搭載され、このレンジ切換制御装置42には、Pレンジへの切換操作を行うPレンジスイッチ43と、NotPレンジへの切換操作を行うNotPレンジスイッチ44の操作信号が入力される。Pレンジスイッチ43又はNotPレンジスイッチ44の操作により選択されたレンジは、インストルメントパネル(図示せず)に設けられたレンジ表示部45に表示される。
【0030】
SRモータ12には、ロータ32の回転位置を検出するためのエンコーダ46が設けられている。このエンコーダ46は、例えば磁気式のロータリエンコーダにより構成されており、その具体的な構成は、図5及び図6に示すように、N極とS極が円周方向に交互に等ピッチで着磁された円環状のロータリマグネット47がロータ32の側面に同軸状に固定され、このロータリマグネット47に対向する位置に、3個のホールIC等の磁気検出素子48,49,50が配置された構成となっている。本実施形態では、ロータリマグネット47のN極とS極の着磁ピッチが7.5°に設定されている。このロータリマグネット47の着磁ピッチ(7.5°)は、SRモータ12の励磁1回当たりのロータ32の回転角度と同じに設定されている。後述するように、1−2相励磁方式でSRモータ12の通電相の切り換えを6回行うと、全ての通電相の切り換えが一巡してロータ32とロータリマグネット47が一体的に7.5°×6=45°回転する。このロータリマグネット47の45°の回転角度範囲に存在するN極とS極の数は、合計6極となっている。
【0031】
更に、ロータ32の基準回転位置に相当する位置のN極(N’)とその両側のS極(S’)がそれ以外の磁極よりも径方向の幅が広くなるように形成されている。尚、本実施形態では、SRモータ12の通電相の切り換えが一巡する間にロータ32とロータリマグネット47が一体的に45°回転することを考慮して、ロータ32の基準回転位置に相当する幅広な着磁部分(N’)が45°ピッチで形成されており、従って、ロータリマグネット47全体として、基準回転位置に相当する幅広な着磁部分(N’)が合計8個形成されている。尚、基準回転位置に相当する幅広な着磁部分(N’)は、ロータリマグネット47全体として、1個のみ形成した構成としても良い。
【0032】
このロータリマグネット47に対して3個の磁気検出素子48,49,50が次のような位置関係で配置されている。A相信号を出力する磁気検出素子48とB相信号を出力する磁気検出素子49は、ロータリマグネット47の幅狭な着磁部分(N,S)と幅広な着磁部分(N’,S’)の両方に対向し得る位置の同一円周上に配置されている。一方、Z相信号を出力する磁気検出素子50は、ロータリマグネット47の幅狭な着磁部分(N,S)よりも径方向外側又は内側の位置で、且つ、幅広な着磁部分(N’,S’)のみに対向し得る位置に配置されている。A相信号とB相信号を出力する2個の磁気検出素子48,49の間隔は、図7に示すように、A相信号とB相信号の位相差が、電気角で90°(機械角で3.75°)となるように設定されている。ここで、“電気角”はA・B相信号の発生周期を1周期(360°)とした場合の角度で、“機械角”は機械的な角度(ロータ32の1回転を360°とした場合の角度)であり、A相信号の立ち下がり(立ち上がり)からB相信号の立ち下がり(立ち上がり)までにロータ32が回転する角度がA相信号とB相信号の位相差の機械角に相当する。また、Z相信号を出力する磁気検出素子50は、Z相信号とB相信号(又はA相信号)との位相差が0となるように配置されている。
【0033】
各磁気検出素子48,49,50の出力は、N極(N’極)と対向したときにハイレベル“1”となり、S極(S’極)と対向したときにローレベル“0”となる。尚、Z相信号用の磁気検出素子50の出力は、ロータ32の基準回転位置に相当する幅広なN’極に対向する毎にハイレベル“1”となり、それ以外の位置では、ローレベル“0”となる。
【0034】
本実施形態では、ECU41が後述する図8のエンコーダカウンタルーチンによってA相信号とB相信号の立ち上がり/立ち下がりの両方のエッジをカウントして、そのエンコーダカウント値に応じてSRモータ12の通電相を切り換えることでロータ32を回転駆動する。この際、A相信号とB相信号の発生順序によってロータ32の回転方向を判定し、正回転(Pレンジ→NotPレンジの回転方向)ではエンコーダカウント値をカウントアップし、逆回転(NotPレンジ→Pレンジの回転方向)ではエンコーダカウント値をカウントダウンする。これにより、ロータ32が正回転/逆回転のいずれの方向に回転しても、エンコーダカウント値とロータ32の回転位置との対応関係が維持されるため、正回転/逆回転のいずれの回転方向でも、エンコーダカウント値によってロータ32の回転位置(回転角度)を検出して、その回転位置に対応した相の巻線33,34に通電してロータ32を回転駆動する。
【0035】
図7は、ロータ32を逆回転方向(NotPレンジ→Pレンジの回転方向)に回転させたときのエンコーダ46の出力波形と通電相の切換パターンを示している。逆回転方向(NotPレンジ→Pレンジの回転方向)と正回転方向(Pレンジ→NotPレンジの回転方向)のいずれの場合も、ロータ32が7.5°回転する毎に1相通電と2相通電とを交互に切り換えるようになっており、ロータ32が45°回転する間に、例えば、U相通電→UW相通電→W相通電→VW相通電→V相通電→UV相通電の順序で通電相の切り換えを一巡するようになっている。そして、この通電相の切り換え毎に、ロータ32が7.5°ずつ回転して、A相、B相信号用の磁気検出素子48,49に対向するロータリマグネット47の磁極がN極→S極(N’極→S’極)又はS極→N極(S’極→N’極)に変化してA相信号とB相信号のレベルが交互に反転し、それによって、ロータ32が7.5°回転する毎に、エンコーダカウント値が2ずつカウントアップ(又はカウントダウン)する。また、通電相の切り換えが一巡してロータ32が45°回転する毎に、Z相用の磁気検出素子50がロータ32の基準回転位置に相当する幅広なN’極に対向して、Z相信号がハイレベル“1”となる。尚、本明細書では、A相、B相、Z相信号がハイレベル“1”となることを、A相、B相、Z相信号が出力されると言う場合がある。
【0036】
このようなエンコーダ46付きのSRモータ12でレンジ切換制御を行う場合は、指令シフトレンジ(目標位置)がPレンジからNotPレンジ又はその反対方向に切り換えられる毎に、ロータ32を回転駆動して、エンコーダカウント値に基づいてSRモータ12の通電相を順次切り換えることでロータ32を目標位置に向かって回転駆動するフィードバック制御(以下「F/B制御」と表記する)を実行し、エンコーダカウント値が目標位置に応じて設定された目標カウント値に到達した時点で、ロータ32が目標位置に到達したと判断してF/B制御を終了し、ロータ32を目標位置で停止させるようにしている。
【0037】
このSRモータ12のF/B制御では、エンコーダ46のA相・B相信号出力タイミングに同期して通電相を切り換えるため、F/B制御の途中で、何等かの原因でロータ32の回転が一旦停止して、エンコーダ46からA相・B相信号が出力されなくなると、F/B制御では通電相の切り換えを行うことができなくなってしまい、ロータ32を目標位置まで回転駆動できない。
【0038】
そこで、本実施形態では、レンジ切換制御装置42のECU41は、SRモータ12のF/B制御開始からロータ32が目標位置に回転駆動されるまで、所定周期(例えば1ms周期)でエンコーダカウント値に基づいて通電相を設定する時間同期通電相設定処理をF/B制御と並行して実行する。
【0039】
この構成では、F/B制御の途中で、何等かの原因でロータ32の回転が一旦停止してエンコーダ46からA相・B相信号が出力されなくなった場合でも、時間同期通電相設定処理によってその時点のエンコーダカウント値に基づいて通電相が設定されるため、ロータ32の回転が停止した状態でも、時間同期通電相設定処理によって通電相の切り換えを行うことができて、可能な限りロータ32を目標位置まで回転駆動することができ、SRモータ12の駆動制御(レンジ切換制御)の信頼性を向上することができる。
【0040】
ところで、F/B制御の途中で、何等かの原因でロータ32の回転が逆転することがあるため、逆転を検出したときには、直ちに通電相をホールド(固定)して逆転を止める必要がある(逆転を止めないと逆転し続けてしまうためである)。一般に、逆転の検出方法は、エンコーダカウント値の前回値と今回値とを比較して、エンコーダカウント値の増減方向が反転したか否かで、逆転の有無を判定するようにしている(図26参照)。
【0041】
しかし、図27に示すように、F/Bと時間同期通電相設定処理の両方で通電相を切り換えると、前回のF/B処理によるエンコーダカウント値の前回値が時間同期通電相設定処理によって更新されてしまうため、実際にロータ32が逆転していても、エンコーダカウント値の前回値と今回値が同じになって停止と判定されてしまい、その結果、時間同期通電相設定処理によって通電相を切り換えて逆転し続けてしまうという不具合を発生する。
【0042】
そこで、本実施形態では、レンジ切換制御装置42のECU41は、ロータ32を目標位置へ回転駆動する途中で該ロータ32の回転方向が逆転したことを検出したときに通電相を前回の通電相にホールド(固定)して、逆転を止めるようにしている。
【0043】
この場合、逆転検出方法は、ロータ32をエンコーダカウント値がカウントアップする方向に回転駆動しているときには該エンコーダカウント値の最大値をECU41のメモリ(図示せず)に逐次記憶しておき、現在のエンコーダカウント値と前記最大値とを比較することで逆転の有無を判定し、ロータ32をエンコーダカウント値がカウントダウンする方向に回転駆動しているときには該エンコーダカウント値の最小値をメモリに逐次記憶しておき、現在のエンコーダカウント値と前記最小値とを比較することで逆転の有無を判定するようにしている。このようにすれば、前回のF/B処理によるエンコーダカウント値の前回値が時間同期通電相設定処理によって更新されるという事情があっても、エンコーダカウント値の最大値・最小値を用いて逆転検出を行うことができる。
【0044】
ところで、図28に示すように、F/B制御中(ロータ32の回転中)に目標位置が切り換えられると、F/B制御の途中でロータ32の回転方向を強制的に逆転させなければならないことがある。このような場合、ロータ32の回転中に目標位置が切り換えられても、ロータ32の慣性があるためにロータ32の回転方向を即座に逆転させることは不可能であり、実際には、目標位置が切り換えられてからロータ32の回転方向が逆転するまでに若干の時間を要するため、その間は、切り換え後の目標位置から見て、ロータ32が“逆転”している状態となる。このため、逆転検出を正確に行い過ぎると(換言すれば後述する不感帯がないと)、F/B制御の途中で目標位置が切り換えられた場合に、目標位置の切り換え直後のロータ32の慣性による過渡的な挙動が“逆転”と判定されて、SRモータ12が強制的に停止されてしまう不具合が発生する。
【0045】
この対策として、本実施形態では、現在のエンコーダカウント値を前記最大値又は前記最小値と比較して逆転の有無を判定する際に、前記最大値及び前記最小値に対してそれぞれ所定カウント値分の不感帯を設定し、この不感帯内では逆転と判定しないようにしている。このようにすれば、F/B制御の途中で目標位置が切り換えられた場合でも、目標位置の切り換え直後のロータ32の慣性による過渡的な挙動を不感帯によって“逆転”と判定せずに済み、F/B制御の途中で目標位置が切り換えられた場合でも、ロータ32を目標位置まで回転駆動することができる。
【0046】
また、本実施形態では、逆転検出により通電相がホールドされている状態を検出したときにオープンループ制御に切り換え、エンコーダカウント値の情報をフィードバックせずに通電相を順次切り換えると共に、その通電相の切換回数をカウントしてそのカウント値に基づいてロータ32を目標位置まで回転駆動するようにしている。これにより、逆転検出により通電相がホールドされている状態から自動的にF/B制御可能な状態に復帰することができる。
以下、レンジ切換制御装置42のECU41によって実行される各ルーチンの処理内容を説明する。
【0047】
[エンコーダカウンタ]
図8に示すエンコーダカウンタルーチンの処理内容を説明する。本ルーチンは、AB相割り込み処理によりA相信号とB相信号の立ち上がり/立ち下がりの両方のエッジに同期して起動され、A相信号とB相信号の立ち上がり/立ち下がりの両方のエッジを次のようにしてカウントする。本ルーチンが起動されると、まずステップ301で、A相信号とB相信号の値A(i) 、B(i) を読み込み、次のステップ302で、図9のカウントアップ値ΔN算出マップを検索して、A相信号とB相信号の今回値A(i) 、B(i) と、前回値A(i-1) 、B(i-1) に応じたカウントアップ値ΔNを算出する。
【0048】
ここで、A相信号とB相信号の今回値A(i) 、B(i) と、前回値A(i-1) 、B(i-1) を用いる理由は、A相信号とB相信号の発生順序によってロータ32の回転方向を判定するためであり、図10に示すように、正回転(Pレンジ→NotPレンジの回転方向)ではカウントアップ値ΔNをプラス値にしてエンコーダカウント値Ncntをカウントアップし、逆回転(NotPレンジ→Pレンジの回転方向)ではカウントアップ値ΔNをマイナス値にしてエンコーダカウント値Ncntをカウントダウンする。
【0049】
カウントアップ値ΔNの算出後、ステップ303に進み、前回のエンコーダカウント値Ncntに上記ステップ302で算出したカウントアップ値ΔNを加算して、今回のエンコーダカウント値Ncntを求める。この後、ステップ304に進み、次回のカウント処理のために、A相信号とB相信号の今回値A(i) 、B(i) をそれぞれA(i-1) 、B(i-1) として記憶して本ルーチンを終了する。
以上説明したエンコーダカウンタルーチンは、特許請求の範囲でいうエンコーダカウント手段としての役割を果たす。
【0050】
[制御モード設定]
図11乃至図13に示す制御モード設定ルーチンは、初期駆動終了後に所定周期(例えば1ms周期)で実行される。ここで、初期駆動とは、ECU41への電源投入後にエンコーダカウント値と実際のロータ32の回転位置とを対応させるための処理であり、初期駆動時には、SRモータ12の通電相の切り換えを所定のタイムスケジュールで一巡させてエンコーダ46のA相信号及びB相信号のエッジをカウントし、初期駆動終了時のエンコーダカウント値とロータ32の回転位置(通電相)との対応関係を学習する。具体的には、初期駆動終了時のエンコーダカウント値を初期位置ずれ学習値として学習し、その後のF/B制御等の際にエンコーダカウント値を初期位置ずれ学習値で補正することで、初期駆動終了時のエンコーダカウント値と通電相(ロータ32の回転位置)とのずれを補正して、F/B制御等の際に正しい通電相を選択できるようにしている。
【0051】
図11乃至図13に示す制御モード設定ルーチンは、初期駆動終了後に所定周期(例えば1ms周期)で制御モード判定値modeを0、1、3、4、5のいずれかに設定して、下記のように制御モードを指定する。
【0052】
mode=0:通電オフ(スタンバイ)
mode=1:通常駆動
(F/B制御開始位置停止保持処理、時間同期通電相設定処理、
F/B制御)
mode=3:目標位置停止保持処理
mode=4:反転位置停止保持処理
mode=5:オープンループ制御
【0053】
制御モード設定ルーチンが起動されると、まずステップ401で、システム故障フラグXfailoffがレンジ切換制御装置42の故障を意味するONにセットされているか否かを判定し、もし、Xfailoff=ONに設定されていれば、ステップ402に進み、SRモータ12を通電オフ状態に維持するための処理を実行する。これにより、回転方向指示値D=0(停止)、通電フラグXon=OFF(通電オフ)、F/B許可フラグXfb=OFF(F/B制御禁止)、制御モード判定値mode=0(通電オフ)にセットする。
【0054】
一方、システム故障フラグXfailoffがOFF(故障無し)の場合は、ステップ401からステップ403に進み、フェールセーフ処理実行フラグXfsop=OFF、且つ、リカバリ処理実行フラグXrcv=OFFであるか否かを判定する。もし、フェールセーフ処理実行フラグXfsopとリカバリ処理実行フラグXrcvのいずれか一方又は両方がONにセットされている場合は、ステップ404に進み、オープンループ制御を実行するために、回転方向指示値D=0(停止)、制御モード判定値mode=5(オープンループ制御)、F/B許可フラグXfb=OFF(F/B制御禁止)にセットする。
【0055】
フェールセーフ処理実行フラグXfsopとリカバリ処理実行フラグXrcvの両方がOFFにセットされている場合は、ステップ405に進み、通電フラグXon=ON(通電オン)にセットされているか否かを判定し、通電フラグXon=OFF(通電オフ)にセットされている場合は、ステップ406に進み、目標カウント値Acntとエンコーダカウント値Ncntとの差(目標位置とロータ32と位置との差)を求めて、この差(Acnt−Ncnt)に基づいて正回転(Pレンジ→NotPレンジ方向への回転)、逆回転(NotPレンジ→Pレンジ方向への回転)、停止のいずれに該当するか判定する。この際、エンコーダカウント値Ncntは、初期駆動で学習された初期位置ずれ学習値Gcntによって補正された値を用いる。
Ncnt=Ncnt−Gcnt
【0056】
目標カウント値Acntとエンコーダカウント値Ncntとの差(Acnt−Ncnt)が+Kth以上(例えば+10°以上)であれば、ロータ32を正回転方向(Pレンジ→NotPレンジの回転方向)に回転駆動する必要があると判断して、ステップ407に進み、回転方向指示値D=1(正回転)、通電フラグXon=ON(通電オン)、制御モード判定値mode=1(F/B制御開始位置停止保持処理及びF/B制御)にセットする。
【0057】
目標カウント値Acntとエンコーダカウント値Ncntとの差(Acnt−Ncnt)が−Kth以下(例えば−10°以下)であれば、ロータ32を逆回転方向(NotPレンジ→Pレンジの回転方向)に回転駆動する必要があると判断して、ステップ409に進み、回転方向指示値D=−1(逆回転)、通電フラグXon=ON(通電オン)、制御モード判定値mode=1(F/B制御開始位置停止保持処理及びF/B制御)にセットする。
【0058】
目標カウント値Acntとエンコーダカウント値Ncntとの差(Acnt−Ncnt)が−Kthから+Kthの範囲内(例えば−10°から+10°の範囲内)であれば、ロータ32を目標位置にディテントバネ23のバネ力により保持することが可能である(SRモータ12への通電は不要)と判断して、ステップ408に進み、SRモータ12を通電オフ状態に維持するために、回転方向指示値D=0(停止)、通電フラグXon=OFF(通電オフ)、制御モード判定値mode=0(通電オフ)にセットする。
【0059】
一方、前記ステップ405で、通電フラグXon=ON(通電オン)にセットされていると判定された場合は、図12のステップ410〜415の処理によって、指令シフトレンジ(目標位置)が反転されたか否かを判定し、反転されていれば、回転方向指示値Dを反転させる。
【0060】
具体的には、まずステップ410で、回転方向指示値D=1(正回転)であるか否かを判定し、回転方向指示値D=1(正回転)であれば、ステップ411に進み、目標カウント値Acntとエンコーダカウント値Ncntとの差(Acnt−Ncnt)がマイナス値であるか否かで、ロータ32の回転方向を正回転から逆回転に反転させる必要があるか否かを判定し、その必要があれば、ステップ412に進み、回転方向指示値D=−1(逆回転)にセットする。
【0061】
これに対して、上記ステップ410で、回転方向指示値Dが1(正回転)でないと判定された場合(つまりD=0又は−1の場合)は、ステップ413に進み、回転方向指示値D=−1(逆回転)であるか否かを判定し、回転方向指示値D=−1(逆回転)であれば、ステップ414に進み、目標カウント値Acntとエンコーダカウント値Ncntとの差(Acnt−Ncnt)がプラス値であるか否かで、ロータ32の回転方向を逆回転から正回転に反転させる必要があるか否かを判定し、その必要があれば、ステップ415に進み、回転方向指示値D=1(正回転)にセットする。
【0062】
以上のようにして、回転方向指示値Dが反転された場合は、ステップ416に進み、ロータ32の回転方向を反転させるために、制御モード判定値mode=4(反転位置停止保持処理)、F/B許可フラグXfb=OFF(F/B制御禁止)にセットしてステップ417に進む。これに対し、回転方向指示値Dが反転されない場合は、上記ステップ416の処理を行わずにステップ417に進む。
【0063】
このステップ417では、制御モード判定値mode=4(反転位置停止保持処理)にセットされているか否かを判定し、「Yes」であれば、ステップ418に進み、通電フラグXon=ON(通電オン)にセットして、反転位置停止保持処理を実行する。
【0064】
これに対して、上記ステップ417で「No」と判定された場合(反転位置停止保持処理ではない場合)は、図13のステップ419〜421で、F/B制御の終了タイミングであるか否かを判定する。具体的には、まずステップ419で、回転方向指示値D≧0(正回転又は停止)であるか否かを判定し、回転方向指示値D≧0であれば、ステップ420に進み、目標カウント値Acntとエンコーダカウント値Ncntとの差(Acnt−Ncnt)が+Kref以下(例えば+0.5°以下)であるか否かで、F/B制御の終了タイミングであるか否かを判定する。また、回転方向指示値D=−1(逆回転)であれば、ステップ421に進み、目標カウント値Acntとエンコーダカウント値Ncntとの差(Acnt−Ncnt)が−Kref以上(例えば−0.5°以上)であるか否かで、F/B制御の終了タイミングであるか否かを判定する。
【0065】
つまり、図14に示すように、F/B制御の終了判定値Krefを例えば通電相の位相進み分(例えば2〜4カウント分)に設定することで、目標カウント値Acntよりも通電相の位相進み分だけ前のタイミングでF/B制御を終了するようにしたものである。これにより、F/B制御の最後の通電相がロータ32を目標位置(目標カウント値Acnt)に停止保持する通電相と一致するようになる。
【0066】
上記ステップ420又は421で「No」と判定された場合(F/B制御の終了タイミングでない場合)は、ステップ422に進み、目標位置停止保持処理の時間をカウントする停止保持時間カウンタCTholdをリセットする。
【0067】
一方、上記ステップ420又は421で「Yes」と判定された場合(F/B制御の終了タイミングである場合)は、ステップ423に進み、F/B許可フラグXfb=OFF(F/B制御禁止)にセットし、F/B制御を終了して目標位置停止保持処理に移行する。そして、次のステップ424で、停止保持時間カウンタCTholdをカウントアップして、目標位置停止保持処理の時間をカウントする。
【0068】
この後、ステップ425に進み、目標位置停止保持処理の時間CTholdが所定時間(例えば50ms)に達したか否かを判定し、目標位置停止保持処理の時間CTholdが所定時間(例えば50ms)に達していなければ、ステップ426に進み、目標位置停止保持処理を続行するために、回転方向指示値D=0(停止)、通電フラグXon=ON(通電オン)、制御モード判定値mode=3(目標位置停止保持処理)に維持する。
【0069】
その後、目標位置停止保持処理の時間CTholdが所定時間(例えば50ms)に達した時点で、ステップ427に進み、SRモータ12の通電をオフするために、回転方向指示値D=0(停止)、通電フラグXon=OFF(通電オフ)、制御モード判定値mode=0(通電オフ)にセットする。
以上説明した制御モード判定値modeの設定例が図15のタイムチャートに示されている。
【0070】
[時間同期モータ制御]
図16に示す時間同期モータ制御ルーチンは、初期駆動終了後に所定周期(例えば1ms周期)で起動され、通常駆動(F/B制御開始位置停止保持処理、時間同期通電相設定処理、F/B制御)、目標位置停止保持処理、反転位置停止保持処理を実行する。
【0071】
本ルーチンが起動されると、まずステップ501で、制御モード判定値mode=1(通常駆動)であるか否かを判定し、制御モード判定値mode=1であれば、ステップ505に進み、後述する図17に示すmode1ルーチンを実行して、F/B制御開始位置停止保持処理時及び時間同期通電相設定処理時の通電相を設定するための通電相判定値Mptnを算出する。
【0072】
一方、上記ステップ501で、制御モード判定値mode=1でないと判定された場合は、ステップ502に進み、F/B許可フラグXfb=OFF(F/B制御禁止)であるか否かを判定し、F/B許可フラグXfb=ON(F/B制御実行)の場合は、以降の処理を行うことなく、本ルーチンを終了する。この場合は、後述する図22に示すF/B制御ルーチンによって通電相の設定と通電処理が実行される。
【0073】
本ルーチンでは、制御モード判定値mode=1の場合は、F/B制御中であっても、上記ステップ505の処理(図17のmode1ルーチン)が実行されるため、F/B制御中は、図22のF/B制御ルーチンによってエンコーダ46のA相・B相信号出力タイミングに同期して通電相を設定するF/B処理と、図17のmode1ルーチンによって所定周期で通電相を設定する時間同期通電相設定処理とが並行して実行される。これにより、F/B制御の途中で、何等かの原因でロータ32が一旦停止しても、時間同期通電相設定処理によって通電相判定値Mptnが算出され、ロータ32が目標位置に向かって回転駆動される。
【0074】
これに対し、上記ステップ502で、F/B許可フラグXfb=OFF(F/B制御禁止)と判定された場合は、ステップ503、504で、制御モード判定値mode=3,4のいずれかに該当するか否かを判定し、制御モード判定値mode=3(目標位置停止保持処理)の場合は、ステップ503からステップ506に進み、後述する図18に示すmode3ルーチンを実行して、目標位置停止保持処理実行時の通電相を設定するための通電相判定値Mptnを算出する。
【0075】
また、制御モード判定値mode=4(反転位置停止保持処理)の場合は、ステップ504からステップ507に進み、後述する図19に示すmode4ルーチンを実行して、反転位置停止保持処理実行時の通電相を設定するための通電相判定値Mptnを算出する。
【0076】
以上のようにして、制御モード判定値mode=1,3,4の場合は、通電相判定値Mptnを算出した後、ステップ508に進み、後述する図20に示す通電処理ルーチンを実行して、通常駆動、目標位置停止保持処理、反転位置停止保持処理を実行する。
【0077】
一方、上記ステップ503、504で、いずれも「No」と判定された場合、つまり、制御モード判定値mode=0,5の場合は、ステップ508に進み、後述する図20に示す通電処理ルーチンを実行して、通電オフ又はオープンループ制御を実行する。
【0078】
[mode1]
図17に示すmode1ルーチンは、図16の時間同期モータ制御ルーチンのステップ505で起動されるサブルーチンであり、F/B制御開始位置停止保持処理時及び時間同期通電相設定処理時の通電相判定値Mptn(通電相)を次のようにして設定する。
【0079】
本ルーチンが起動されると、まずステップ511で、F/B制御開始位置停止保持処理の時間をカウントする通電時間カウンタCT1をカウントアップし、次のステップ512で、F/B制御開始位置停止保持処理の時間CT1が所定時間(例えば10ms)を越えたか否かを判定する。
【0080】
もし、F/B制御開始位置停止保持処理の時間CT1が所定時間(例えば10ms)を越えていなければ、ステップ513に進み、停止保持時通電相記憶済みフラグXhold=OFF(未記憶)であるか否か(つまりF/B制御開始位置停止保持処理の開始直前のタイミングであるか否か)を判定し、停止保持時通電相記憶済みフラグXhold=OFFであれば、ステップ514に進み、F/B制御開始位置停止保持処理時の通電相判定値Mptnを現在の位置カウンタ値(Ncnt−Gcnt)にセットする。
【0081】
Mptn=Ncnt−Gcnt
ここで、位置カウンタ値(Ncnt−Gcnt)は、エンコーダカウント値Ncntを初期駆動時に学習された初期位置ずれ学習値Gcntで補正した値であり、ロータ32の現在位置を正確に表した値となっている。
【0082】
この後、ステップ515に進み、通電相判定値Mptnを“12”で割り算して、その余りMptn%12を求める。ここで、“12”は、通電相を一巡させる間のエンコーダカウント値Ncnt(通電相判定値Mptn)の増減量に相当する。このMptn%12の値に基づいて、図21の変換テーブルによって通電相が決定される。
【0083】
そして、次のステップ516で、Mptn%12=2,3,6,7,10,11であるか否かによって1相通電(U相通電、V相通電、W相通電)であるか否かを判定し、1相通電であれば、ステップ517に進み、通電相判定値Mptnを1ステップ分に相当する“2”だけ増加して2相通電(UV相通電、VW相通電、UW相通電)に補正する。これにより、F/B制御開始位置停止保持処理を1相通電と比べて保持トルクの大きい2相通電で実行することで、ロータ32がF/B制御開始位置付近で振動することを防止して、ロータ32をF/B制御開始位置に確実に停止保持できるようにする。
【0084】
そして、次のステップ518で、停止保持時通電相記憶済みフラグXhold=ON(記憶済み)にセットして本ルーチンを終了する。この後、本ルーチンが起動されたときには、ステップ513で「No」と判定され、ステップ514〜518の処理が実行されない。これにより、F/B制御開始位置停止保持処理時の通電相判定値Mptn(通電相)を設定する処理は、F/B制御開始位置停止保持処理の開始直前に1回のみ実行される。
【0085】
その後、F/B制御開始位置停止保持処理の時間CT1が所定時間(例えば10ms)を越えた時点で、ステップ512で「Yes」と判定されて、F/B制御開始位置停止保持処理を終了し、F/B制御に移行する。F/B制御中は、所定周期(例えば1ms周期)で本ルーチンを起動する毎に、ステップ519で、後述する図23に示す通電相設定ルーチンを実行し、通電相判定値Mptnを算出する。この処理が特許請求の範囲でいう第2の通電相設定手段としての役割を果たす。尚、図23の通電相設定ルーチンは、後述する図22に示すF/B制御ルーチンのステップ602でも起動される。この後、ステップ520に進み、F/B許可フラグXfb=ON(F/B制御実行)にセットする。
【0086】
前記図11〜図13の制御モード設定ルーチンでは、F/B制御により目標カウント値Acntとエンコーダカウント値Ncntとの差(Acnt−Ncnt)が所定値以下になった時点で、ロータ32が目標位置に到達した(F/B制御の終了タイミング)と判断して、F/B許可フラグXfb=OFFにセットし、F/B制御を終了して、制御モード判定値mode=3(目標位置停止保持処理)にセットし、その後、所定時間(例えば50ms)が経過した時点で、制御モード判定値mode=0(通電オフ)にセットする(図13のステップ419以降の処理参照)。
【0087】
従って、F/B制御終了後は、図17のmode1ルーチンが起動されないため、ステップ519の時間同期通電相設定処理による通電相の設定は、F/B制御開始からロータ32が目標位置に到達するまで(つまりF/B制御が終了するまで)実行される。
【0088】
図24はUW相から回転を開始する場合に最初に通電する相を説明するタイムチャートである。この場合、正回転(Pレンジ→NotPレンジ方向への回転)を開始する場合は、通電相判定値Mptnは、エンコーダカウント値Ncnt、初期位置ずれ学習値Gcnt、正回転方向位相進み量K1を用いて次式により算出される。
Mptn=Ncnt−Gcnt+K1
【0089】
ここで、正回転方向位相進み量K1を例えば4とすると、通電相判定値Mptnは、次式により算出される。
Mptn=Ncnt−Gcnt+4
UW相から正回転を開始する場合は、mod(Ncnt−Gcnt)は4となるため、Mptn%12=4+4=8となり、最初の通電相はUV相となる。
【0090】
一方、UW相から逆回転(NotPレンジ→Pレンジ方向への回転)を開始する場合は、逆回転方向位相進み量K2を例えば3とすると、通電相判定値Mptnは、次式により算出される。
Mptn=Ncnt−Gcnt−K2=Ncnt−Gcnt−3
UW相から逆回転を開始する場合は、Mptn%12=4−3=1となり、最初の通電相はVW相となる。
【0091】
このように、正回転方向位相進み量K1と逆回転方向位相進み量K2をそれぞれ4と3に設定することで、正回転方向と逆回転方向の通電相の切換パターンを対称にすることができ、正回転方向と逆回転方向のいずれの場合も、ロータ32の現在位置から2ステップ分ずらした位置の相を最初に励磁して回転を開始することができる。
【0092】
[mode3]
図18に示すmode3ルーチンは、図16の時間同期モータ制御ルーチンのステップ506で起動されるサブルーチンであり、目標位置停止保持処理時の通電相判定値Mptn(通電相)を次のようにして設定する。
【0093】
本ルーチンが起動されると、まずステップ531で、F/B制御終了時のMptn%12=2,3,6,7,10,11であるか否かによってF/B制御終了時の通電相が1相通電(U相通電、V相通電、W相通電)であるか否かを判定し、1相通電であれば、ステップ532〜534の処理によって、それまで行っていたF/B制御の回転方向に応じて通電相判定値Mptnを2だけ増加又は減少させることで、当該1相通電の次のステップの2相通電に変更する。
【0094】
この際、ステップ532で、回転方向を次のようにして判定する。本ルーチンに入る直前(F/B制御終了時)に、図13のステップ426で、回転方向指示値Dが0(停止)にセットされるため、回転方向指示値Dを見ても回転方向を判定することができない。そこで、本ルーチンでは、F/B制御終了時の通電相判定値Mptnと位置カウント値(Ncnt−Gcnt)との間に、通電相の位相進み量K1,K2分の差があることに着目し、F/B制御終了時の通電相判定値Mptnと位置カウント値(Ncnt−Gcnt)との大小関係によって回転方向を次のように判定する。
【0095】
Mptn>Ncnt−Gcntの場合は、正回転(Pレンジ→NotPレンジの回転方向)と判定して、ステップ533に進み、通電相判定値Mptnを2だけ増加させることで、2相通電に補正する。
【0096】
一方、Mptn<Ncnt−Gcntの場合は、逆回転(NotPレンジ→Pレンジの回転方向)と判定して、ステップ534に進み、通電相判定値Mptnを2だけ減少させることで、2相通電に補正する。
尚、Mptn=Ncnt−Gcntの場合は、停止と判定して、通電相は変更しない。
【0097】
このように、目標位置停止保持処理についても、F/B制御開始位置停止保持処理と同じく、1相通電と比べて保持トルクの大きい2相通電で実行することで、ロータ32が目標位置付近で振動することを防止して、ロータ32を目標位置で確実に停止保持できるようにする。
【0098】
[mode4]
図19に示すmode4ルーチンは、図16の時間同期モータ制御ルーチンのステップ507で起動されるサブルーチンであり、反転位置停止保持処理時の通電相判定値Mptn(通電相)を次のようにして設定する。
【0099】
本ルーチンが起動されると、まずステップ541で、反転位置停止保持処理の時間をカウントする通電時間カウンタCT4をカウントアップし、次のステップ542で、反転位置停止保持処理の時間CT4が所定時間(例えば50ms)を越えたか否かを判定する。
【0100】
もし、反転位置停止保持処理の時間CT4が所定時間(例えば50ms)を越えていなければ、ステップ543に進み、Mptn%12=2,3,6,7,10,11であるか否かによって現在の通電相が1相通電(U相通電、V相通電、W相通電)であるか否かを判定し、1相通電であれば、ステップ544〜546の処理によって、それまで行っていたF/B制御の回転方向に応じて通電相判定値Mptnを2だけ増加又は減少させることで、当該1相通電の次のステップの2相通電に変更する。このステップ543〜546の処理は、前記図18のmode3ルーチンのステップ531〜534の処理と同じである。
【0101】
このように、反転位置停止保持処理についても、F/B制御開始位置停止保持処理や目標位置停止保持処理と同じく、1相通電と比べて保持トルクの大きい2相通電で実行することで、ロータ32が反転位置付近で振動することを防止して、ロータ32を反転位置で確実に停止保持できるようにする。
【0102】
その後、反転位置停止保持処理の時間CT4が所定時間(例えば50ms)を越えた時点で、ステップ542で「Yes」と判定されて、反転位置停止保持処理を終了し、F/B制御を再開する。これにより、最初に、ステップ547で、反転位置停止保持処理時の通電相判定値Mptnに、回転方向に応じて通電相の位相進み分のカウント値(例えば4又は3)を加算又は減算してF/B制御再開時の最初の通電相判定値Mptnを設定し、それによって、ロータ32の回転駆動を開始する。この後、ステップ548に進み、F/B許可フラグXfb=ON(F/B制御実行)、通電時間カウンタCT4=0、制御モード判定値mode=1(通常駆動)にセットして本ルーチンを終了する。
【0103】
[通電処理]
図20に示す通電処理ルーチンは、図16の時間同期モータ制御ルーチンのステップ508で起動されるサブルーチンである。尚、本ルーチンは、後述する図22のF/B制御ルーチンのステップ603でも起動される。
【0104】
図20の通電処理ルーチンが起動されると、まずステップ551で、制御モード判定値mode=0(通電オフ)であるか否かを判定し、制御モード判定値mode=0(通電オフ)であれば、ステップ552に進み、SRモータ12の全相の通電をオフしてスタンバイ状態とする。
【0105】
一方、上記ステップ551で、「No」と判定されれば、ステップ553に進み、制御モード判定値mode=5(オープンループ制御)であるか否かを判定し、制御モード判定値mode=5(オープンループ制御)であれば、ステップ554に進み、オープンループ制御を実行する。このオープンループ制御は、エンコーダ46の故障又はSRモータ12の動作異常が発生したときに、例えば1ms周期の時間同期処理によって通電相を設定してロータ32を目標位置まで回転駆動する。
【0106】
また、上記ステップ551、553で、いずれも「No」と判定された場合、つまり、制御モード判定値mode=1,3,4(通常駆動、目標位置停止保持処理、反転位置停止保持処理)の場合は、ステップ555に進み、Mptn%12に応じて図21の変換テーブルによって通電相を設定し、その通電相の巻線33,34に通電する。
【0107】
[F/B制御]
次に、図22に示すF/B制御ルーチンの処理内容を説明する。本ルーチンは、AB相割り込み処理により実行され、初期駆動終了後にF/B制御実行条件が成立しているときに、ロータ32の回転位置(エンコーダカウント値Ncnt−Gcnt)が目標位置(目標カウント値Acnt)から例えば0.5°以内に到達するまで、エンコーダカウント値Ncntと初期位置ずれ学習値Gcntとに基づいて通電相を切り換えてロータ32を回転させる。
【0108】
図22のF/B制御ルーチンが起動されると、まずステップ601で、F/B許可フラグXfbがONにセットされているか否か(F/B制御実行条件が成立しているか否か)を判定し、F/B許可フラグXfbがOFF(F/B制御実行条件が不成立)であれば、以降の処理を行うことなく、本ルーチンを終了する。
【0109】
これに対し、F/B許可フラグXfbがONにセットされていれば、ステップ602に進み、後述する図23の通電相設定ルーチンを実行して、現在のエンコーダカウント値Ncntと初期位置ずれ学習値Gcntとに基づいて通電相を設定し(この処理が特許請求の範囲でいう第1の通電相設定手段としての役割を果たす)、次のステップ603で、図20の通電処理ルーチンを実行する。
【0110】
[通電相設定]
図23に示す通電相設定ルーチンは、図22のF/B制御ルーチンのステップ602と図17のmode1ルーチンのステップ519で起動されるサブルーチンであり、特許請求の範囲でいう逆転検出手段及び通電相ホールド手段としての役割を果たす。本ルーチンが起動されると、まずステップ611で、目標位置への回転方向を指示する回転方向指示値Dが正回転(Pレンジ→NotPレンジの回転方向)を意味する「1」であるか否かを判定する。その結果、回転方向指示値D=1(正回転)と判定されれば、ステップ612に進み、F/B開始時の1回目の励磁であるか否かを判定し、F/B開始時の1回目の励磁であると判定されれば、ステップ613に進み、後述する最大値Ncntmaxの初期値として現在のエンコーダカウント値Ncntをセットして、ステップ614に進むが、F/B開始時の1回目の励磁でなければ、上記ステップ613の処理を飛び越してステップ614に進む。
【0111】
このステップ614では、正回転駆動実行条件が成立しているか否かを次の2つの条件[A-1] 、[A-2] のいずれか一方を満たしている否かで判定する。
[A-1] 正回転駆動中に逆転が検出されていないこと
[A-2] F/B開始時の1回目の励磁であること
【0112】
上記[A-1] の条件は、現在のエンコーダカウント値Ncntが現在までのエンコーダカウント値の最大値Ncntmax以上であるか、又は最大値Ncntmaxよりも小さくなっても、不感帯ΔNnを越えて小さくならないことである。
Ncnt≧Ncntmax−ΔNn
【0113】
ここで、不感帯ΔNnは、例えば正回転駆動の途中で目標位置が切り換えられたときのロータ32の慣性による過渡的な挙動を“逆転”と判定するのを回避するためのものであり、本実施形態では、不感帯ΔNnを例えば2〜4カウントに設定している。
【0114】
上記2つの条件[A-1] 、[A-2] のいずれか一方を満たせば、正回転駆動実行条件が成立し、ステップ615に進み、現在のエンコーダカウント値Ncnt、初期位置ずれ学習値Gcnt、正回転方向位相進み量K1、速度位相進み補正量Ksを用いて通電相判定値Mptnを次式により更新する。
Mptn=Ncnt−Gcnt+K1+Ks
【0115】
ここで、正回転方向位相進み量K1は、ロータ32を正回転させるのに必要な通電相の位相進み量(ロータ32の現在の回転位相に対する通電相の位相進み量)であり、例えばK1=4に設定されている。
【0116】
また、速度位相進み補正量Ksは、ロータ32の回転速度に応じて設定される位相進み補正量であり、例えば、低速域では、速度位相進み補正量Ksが0に設定され、高速になるに従って、速度位相進み補正量Ksが例えば1又は2に増加される。これにより、ロータ32の回転速度に適した通電相となるように通電相判定値Mptnが補正される。
【0117】
通電相判定値Mptnの更新後、ステップ616に進み、現在のエンコーダカウント値Ncntが最大値Ncntmaxよりも大きいか否かを判定し、大きければ、ステップ617に進み、ECU42のメモリに記憶されている最大値Ncntmaxの記憶データを現在のエンコーダカウント値Ncntで書き換える。ロータ32が正回転している間は、エンコーダカウント値Ncntが周期的にカウントアップされるため、エンコーダカウント値の最大値Ncntmaxが周期的に更新される。
【0118】
一方、正回転駆動中に何等かの原因で逆転が発生してエンコーダカウント値Ncntがカウントダウンされたときには、上記ステップ616で「No」と判定され、エンコーダカウント値の最大値Ncntmaxの記憶データを更新せずに本ルーチンが終了する。これにより、正回転駆動中は、エンコーダカウント値の最大値NcntmaxがECU42のメモリに記憶される。
【0119】
一方、上記ステップ614で、上記2つの条件[A-1] 、[A-2] を両方とも満たさない場合、つまり、正回転駆動中に逆転が検出され(Ncnt<Ncntmax−ΔNn)、かつ2回目以降の励磁である場合は、正回転駆動実行条件が成立せず、そのまま本ルーチンを終了する。この場合は、逆転防止のために通電相判定値Mptnが更新されず、通電相が前回の通電相にホールドされて前回の通電相に通電され、ロータ32の逆転を抑制する方向に制動トルクが発生する。
【0120】
また、上記ステップ611で、回転方向指示値D=−1(逆回転)、つまりNotPレンジ→Pレンジの回転方向と判定された場合は、ステップ618に進み、F/B開始時の1回目の励磁であるか否かを判定し、F/B開始時の1回目の励磁であると判定されれば、ステップ619に進み、後述する最小値Ncntminの初期値として現在のエンコーダカウント値Ncntをセットして、ステップ620に進むが、F/B開始時の1回目の励磁でなければ、上記ステップ619の処理を飛び越してステップ620に進む。
【0121】
このステップ620では、逆回転駆動実行条件が成立しているか否かを次の2つの条件[B-1] 、[B-2] のいずれか一方を満たしている否かで判定する。
[B-1] 逆回転駆動中に逆転(正回転)が検出されていないこと
[B-2] F/B開始時の1回目の励磁であること
【0122】
上記[B-1] の条件は、現在のエンコーダカウント値Ncntが現在までのエンコーダカウント値の最小値Ncntmin以下であるか、又は最小値Ncntminよりも大きくなっても、不感帯ΔNpを越えて大きくならないことである。
Ncnt≦Ncntmin+ΔNp
【0123】
ここで、不感帯ΔNpは、例えば逆回転駆動の途中で目標位置が切り換えられたときのロータ32の慣性による過渡的な挙動を“逆転”と判定するのを回避するためのものであり、本実施形態では、不感帯ΔNpを例えば2〜4カウントに設定している。
【0124】
上記2つの条件[B-1] 、[B-2] のいずれか一方を満たせば、逆回転駆動実行条件が成立し、ステップ621に進み、現在のエンコーダカウント値Ncnt、初期位置ずれ学習値Gcnt、逆回転方向位相進み量K2、速度位相進み補正量Ksを用いて通電相判定値Mptnを次式により更新する。
Mptn=Ncnt−Gcnt−K2−Ks
【0125】
ここで、逆回転方向位相進み量K2は、ロータ32を逆回転させるのに必要な通電相の位相進み量(ロータ32の現在の回転位相に対する通電相の位相進み量)であり、例えばK2=3に設定されている。速度位相進み補正量Ksは正回転の場合と同じように設定される。
【0126】
通電相判定値Mptnの更新後、ステップ622に進み、現在のエンコーダカウント値Ncntが最小値Ncntminよりも小さいか否かを判定し、小さければ、ステップ623に進み、ECU42のメモリに記憶されている最小値Ncntminの記憶データを現在のエンコーダカウント値Ncntで書き換える。ロータ32が逆回転している間は、エンコーダカウント値Ncntが周期的にカウントダウンされるため、エンコーダカウント値の最小値Ncntminが周期的に更新される。
【0127】
一方、逆回転駆動中に何等かの原因で逆転が発生してエンコーダカウント値Ncntがカウントアップされたときには、上記ステップ622で「No」と判定され、エンコーダカウント値の最小値Ncntminの記憶データを更新せずに本ルーチンが終了する。これにより、逆回転駆動中は、エンコーダカウント値の最小値NcntminがECU42のメモリに記憶される。
【0128】
一方、上記ステップ620で、上記2つの条件[B-1] 、[B-2] を両方とも満たさない場合、つまり、逆回転駆動中に逆転が検出され(Ncnt>Ncntmax+ΔNp)、かつ2回目以降の励磁である場合は、逆回転駆動実行条件が成立せず、そのまま本ルーチンを終了する。この場合は、逆転防止のために通電相判定値Mptnが更新されず、通電相が前回の通電相にホールドされて前回の通電相に通電され、ロータ32の逆転を抑制する方向に制動トルクが発生する。
【0129】
以上のようにして、今回の通電相判定値Mptnを決定した後、図20の通電処理ルーチンを実行し、F/B制御中は、ステップ555で、図21の変換テーブルを検索して、Mptn%12に対応する通電相を選択し、その通電相の巻線33,34に通電する。
【0130】
図30は、不感帯ΔNnを2カウントに設定した場合の制御例を示している。エンコーダカウント値Ncntが最大値Ncntmaxに対する不感帯ΔNnの領域内であれば、逆転とは判定されず、通電相がホールドされない。不感帯ΔNnの領域内では、エンコーダカウント値Ncntが減少すれば、通電相判定値Mptnも減少して通電相が切り換えられる。その後、エンコーダカウント値Ncntが不感帯ΔNnを越えて小さくなった時点で、逆転と判定されて、通電相が前回の通電相にホールドされる。
【0131】
[フェールセーフ処理]
図25に示すフェールセーフ処理ルーチンは、所定周期で起動され、特許請求の範囲でいうオープンループ駆動手段としての役割を果たす。本ルーチンが起動されると、まずステップ701で、F/B制御中であるか否かを判定し、F/B制御中でなければ、そのまま本ルーチンを終了するが、F/B制御中であれば、ステップ702に進み、通電相ホールド中(モータ停止中)であるか否かを判定する。
【0132】
通電相ホールド中でなければ、そのまま本ルーチンを終了するが、通電相ホールド中であれば、ステップ702に進み、オープンループ制御に切り換える。このオープンループ制御では、エンコーダカウント値の情報をフィードバックせずに通電相を順次切り換えると共に、その通電相の切換回数をカウントしてそのカウント値に基づいてロータ32を目標位置まで回転駆動する。このようにすれば、逆転検出により通電相がホールドされている状態から自動的にF/B制御可能な状態に復帰することができる。
【0133】
以上説明した本実施形態では、SRモータ12のF/B制御開始からロータ32が目標位置に回転駆動されるまで、所定周期でエンコーダカウント値に基づいて通電相を設定する時間同期通電相設定処理をF/B制御と並行して実行するようにしたので、F/B制御の途中で、何等かの原因でロータ32の回転が一旦停止してエンコーダ46からA相・B相信号が出力されなくなった場合でも、時間同期通電相設定処理によってその時点のエンコーダカウント値に基づいて通電相を設定することができて、可能な限りロータ32を目標位置まで回転駆動することができる。
【0134】
しかも、本実施形態では、F/B制御中にエンコーダカウント値の最大値・最小値を逐次記憶しておき、現在のエンコーダカウント値を最大値・最小値と比較することで逆転の有無を判定するようにしたので、前回のF/B処理によるエンコーダカウント値の前回値が時間同期通電相設定処理によって更新されるという事情があっても(図27参照)、エンコーダカウント値の最大値・最小値を用いて逆転検出を行うことができる。これにより、F/B制御中に逆転が発生したときに通電相を前回の通電相にホールドすることが可能となり、時間同期通電相設定処理によって逆転し続けてしまうという不具合を解消できる。
【0135】
尚、逆転検出方法は本実施形態の方法に限定されず、例えば、A相信号とB相信号の発生順序によってロータ32の回転方向を判定して逆転を検出するようにしても良い。
【0136】
また、本実施形態では、現在のエンコーダカウント値を最大値又は最小値と比較して逆転の有無を判定する際に、最大値及び最小値に対してそれぞれ所定カウント値分の不感帯を設定し、この不感帯内では逆転と判定しないようにしたので、F/B制御の途中で目標位置が切り換えられた場合でも、目標位置の切り換え直後のロータ32の慣性による過渡的な挙動を不感帯によって“逆転”と判定せずに済み、F/B制御の途中で目標位置が切り換えられた場合でも、ロータ32を目標位置まで回転駆動することができる。
【0137】
但し、本発明は、不感帯を設ける構成に限定されず、例えば、常にモータ停止状態からF/B制御を開始するシステム等、本質的に逆転が発生しにくいシステムに本発明を適用する場合は、図29に示すように、不感帯をなくした構成としても良い。この構成では、現在のエンコーダカウント値が最大値よりも1カウントでも小さくなれば(又は最小値よりも1カウントでも大きくなれば)、逆転と判定され、直ちに通電相がホールドされる。
【0138】
尚、本実施形態では、F/B制御開始からロータ32が目標位置に回転駆動されるまでの全期間にわたって時間同期通電相設定処理を行うようにしたので、ロータ32がどの様なタイミングで停止しても、時間同期通電相設定処理によってロータ32の停止直後に遅れずに通電相を設定することができ、ロータ32の停止時間を短くすることができる利点がある。
【0139】
しかし、本発明は、ロータ32の回転速度が所定値以下の期間にロータ32が目標位置に回転駆動されるまで時間同期通電相設定処理を実行するようにしても良い。このようにすれば、ロータ32の回転速度が一時停止する可能性のある回転速度まで低下したときのみ、時間同期通電相設定処理を実行すれば良いため、ECU41のCPUの演算負荷を軽減できる利点がある。
【0140】
或は、F/B制御の途中でロータ32が停止したときのみ、時間同期通電相設定処理を実行するようにしても良い。
尚、本実施形態では、F/B制御中に、1相通電と2相通電とを交互に切り換える1−2相励磁方式で駆動するようにしたが、1相通電のみで駆動する1相励磁方式、又は、2相通電のみで駆動する2相励磁方式を採用しても良い。
【0141】
また、本発明に用いるエンコーダは、磁気式のエンコーダ46に限定されず、例えば、光学式のエンコーダやブラシ式のエンコーダを用いても良い。
また、本発明に用いるモータは、SRモータ12に限定されず、エンコーダの出力信号のカウント値に基づいてロータの回転位置を検出してモータの通電相を順次切り換えるブラシレス型のモータであれば、SRモータ以外のブラシレス型のモータを用いても良い。
【0142】
また、本実施形態のレンジ切換装置は、PレンジとNotPレンジの2つのレンジを切り換える構成であるが、例えば、ディテントレバー15の回動動作に連動して自動変速機のレンジ切換弁とマニュアルバルブを切り換えて、自動変速機のP、R、N、D等の各レンジを切り換えるレンジ切換装置にも本発明を適用して実施できる。
【0143】
その他、本発明は、レンジ切換装置に限定されず、SRモータ等のブラシレス型のモータを駆動源とする各種の装置に適用して実施できることは言うまでもない。
【図面の簡単な説明】
【図1】本発明の一実施形態を示すレンジ切換装置の斜視図
【図2】SRモータの構成を説明する図
【図3】SRモータを駆動する回路構成を示す回路図
【図4】レンジ切換装置の制御システム全体の構成を概略的に示す図
【図5】エンコーダのロータリマグネットの構成を説明する平面図
【図6】エンコーダの側面図
【図7】(a)はエンコーダの出力波形を示すタイムチャート、(b)は通電相切り換えパターンを示すタイムチャート
【図8】エンコーダカウンタルーチンの処理の流れを示すフローチャート
【図9】カウントアップ値ΔN算出マップの一例を示す図
【図10】指令レンジシフト、A相信号、B相信号、エンコーダカウント値の関係を示すタイムチャート
【図11】制御モード設定ルーチンの処理の流れを示すフローチャート(その1)
【図12】制御モード設定ルーチンの処理の流れを示すフローチャート(その2)
【図13】制御モード設定ルーチンの処理の流れを示すフローチャート(その3)
【図14】F/B制御から目標位置停止保持処理へ移行するタイミングを説明するタイムチャート
【図15】SRモータの制御例を示すタイムチャート
【図16】時間同期モータ制御ルーチンの処理の流れを示すフローチャート
【図17】mode1ルーチンの処理の流れを示すフローチャート
【図18】mode3ルーチンの処理の流れを示すフローチャート
【図19】mode4ルーチンの処理の流れを示すフローチャート
【図20】通電処理ルーチンの処理の流れを示すフローチャート
【図21】1−2相励磁方式の場合のMptn%12から通電相への変換テーブルの一例を示す図
【図22】F/B制御ルーチンの処理の流れを示すフローチャート
【図23】通電相設定ルーチンの処理の流れを示すフローチャート
【図24】UW相から回転を開始する時の通電処理を説明するタイムチャート
【図25】フェールセーフ処理ルーチンの処理の流れを示すフローチャート
【図26】従来の通電相ホールド処理の制御例を説明するタイムチャート
【図27】比較例の通電相ホールド処理の制御例を説明するタイムチャート
【図28】F/B制御の途中で目標位置が切り換えられたときのエンコーダカウント値の挙動を説明するタイムチャート
【図29】不感帯を設けない場合の本発明の通電相ホールド処理の制御例を説明するタイムチャート
【図30】不感帯を設けた場合の本発明の通電相ホールド処理の制御例を説明するタイムチャート
【符号の説明】
11…レンジ切換機構、12…SRモータ、14…出力軸センサ、15…ディテントレバー、18…パーキングロッド、20…パーキングギヤ、21…ロックレバー、23…ディテントバネ、24…Pレンジ保持凹部、25…NotPレンジ保持凹部、26…減速機構、27…自動変速機、31…ステータ、32…ロータ、33,34…巻線、35,36…モータ励磁部、37,38…モータドライバ、41…ECU(通電制御手段,第1の通電相設定手段,第2の通電相設定手段,エンコーダカウント手段,逆転検出手段,通電相ホールド手段,オープンループ駆動手段)、43…Pレンジスイッチ、44…NotPレンジスイッチ、46…エンコーダ、47…ロータリマグネット、48…A相信号用の磁気検出素子、49…B相信号用の磁気検出素子、50…Z相信号用の磁気検出素子。[0001]
BACKGROUND OF THE INVENTION
The present invention relates to a motor control device that rotationally drives a rotor to a target position by detecting the rotational position of the rotor based on the count value of the pulse signal of the encoder and sequentially switching the energized phase of the motor.
[0002]
[Prior art]
In recent years, brushless motors such as switched reluctance motors, which are increasing in demand as simple and inexpensive motors, are equipped with an encoder that outputs a pulse signal in synchronization with the rotation of the rotor. And the rotor is rotationally driven by detecting the rotational position of the rotor based on the encoder count value and sequentially switching the energized phase. Since such a motor with an encoder can detect the rotational position of the rotor based on the encoder count value after startup, position switching for rotating the rotor to a target position by a feedback control system (F / B control system) It is used as a drive source for various position switching devices that perform control (positioning control) (see, for example, Patent Document 1).
[0003]
When performing F / B control with such a motor with an encoder, the energized phase is switched based on the encoder count value in synchronization with the encoder pulse signal output timing, and the rotor is driven to rotate toward the target position. When the value reaches the target count value set according to the target position, it is determined that the rotor has reached the target position, the F / B control is terminated, and the rotor is stopped at the target position.
[0004]
[Patent Document 1]
JP 2001-271917 A (
[0005]
[Problems to be solved by the invention]
In the conventional F / B control of the motor, since the energized phase is switched in synchronization with the pulse signal output timing of the encoder, the rotation of the rotor is temporarily stopped for some reason during the F / B control. If the pulse signal is not output from, the energized phase cannot be switched, and the rotor cannot be rotated to the target position.
[0006]
In order to solve such problems, the present inventors have energized by time synchronization processing separately from switching of energized phases by F / B control, as described in the specification of Japanese Patent Application No. 2002-276521. An application has been filed in which the phase switching function is provided so that the energized phase can be switched by time synchronization processing even when the rotation of the rotor is stopped.
[0007]
During the F / B control, the rotation of the rotor may be reversed for some reason. When a reverse rotation is detected, it is necessary to immediately hold (fix) the energized phase to stop the reverse rotation (stop the reverse rotation). Otherwise it will continue to reverse). Generally, in the reverse rotation detection method, the previous value and the current value of the encoder count value are compared, and the presence / absence of reverse rotation is determined based on whether the increase / decrease direction of the encoder count value is reversed (FIG. 26). reference).
[0008]
However, as shown in FIG. 27, if the energized phase is switched in both F / B and time synchronization processing, the previous value of the encoder count value obtained by the previous F / B processing is updated by the time synchronization processing. Even if the rotor is rotating in reverse, the previous value of the encoder count value is the same as the current value, and it is determined that the rotor has stopped. appear.
[0009]
The present invention has been made in consideration of these circumstances, and the purpose of the present invention is to make the rotor as far as possible even when the rotation of the rotor is temporarily stopped for some reason during the F / B control of the motor. An object of the present invention is to provide a motor control device that can be rotationally driven to a target position and can stop the reverse rotation when the reverse rotation occurs.
[0010]
[Means for Solving the Problems]
In order to achieve the above object, the motor control device according to
[0011]
In this configuration, even when the rotation of the rotor is temporarily stopped for some reason during the motor F / B control and the pulse signal is not output from the encoder, the encoder count at that time is counted at a predetermined cycle by time synchronization processing. Since the energized phase can be set based on the value, the energized phase can be switched even when the rotation of the rotor is stopped, and the rotor can be rotated to the target position as much as possible. In addition, if the rotation direction of the rotor is reversed during the rotational drive of the rotor to the target position, the reverse rotation can be detected and the energized phase can be fixed to stop the reverse rotation.
[0012]
In this case, as a specific example of the reverse rotation detection means, as in
[0013]
Incidentally, as shown in FIG. 28, when the target position is switched during F / B control (rotation of the rotor), the rotation direction of the rotor must be forcibly reversed during the F / B control. is there. In such a case, even if the target position is switched during rotation of the rotor, it is impossible to reverse the rotation direction of the rotor immediately due to the inertia of the rotor. In practice, the target position is switched. After that, since it takes some time for the rotor to rotate in the reverse direction, the rotor is in the “reverse” state as viewed from the target position after switching. For this reason, if the reverse rotation detection is performed excessively (in other words, there is no dead zone to be described later), when the target position is switched during the F / B control, a transient due to the inertia of the rotor immediately after the target position is switched. A problem occurs that the motor is forcibly stopped due to the determination that the behavior is “reverse”.
[0014]
As a countermeasure against this, when the current encoder count value is compared with the maximum value or the minimum value to determine the presence or absence of reverse rotation, a predetermined count is applied to each of the maximum value and the minimum value. It is preferable to set a dead band corresponding to the value, and not to determine that the rotation is reversed within this dead band. In this way, even when the target position is switched in the middle of the F / B control, the transient behavior due to the inertia of the rotor immediately after switching of the target position does not have to be determined as “reverse rotation” due to the dead zone. Even when the target position is switched during the / B control, the rotor can be driven to rotate to the target position.
[0015]
Further, as in
[0016]
In this case, as in
[0017]
Further, as in
[0018]
The invention according to
[0019]
DETAILED DESCRIPTION OF THE INVENTION
Hereinafter, an embodiment in which the present invention is applied to a vehicle range switching device will be described with reference to the drawings.
[0020]
First, the configuration of the
[0021]
Further, an L-shaped
[0022]
On the other hand, a
[0023]
In the P range, the
[0024]
On the other hand, in the NotP range, the
[0025]
The
[0026]
Next, the configuration of the
[0027]
The winding order of the
[0028]
These two
[0029]
On / off of each switching
[0030]
The
[0031]
Further, the N pole (N ′) at the position corresponding to the reference rotation position of the
[0032]
Three
[0033]
The output of each
[0034]
In the present embodiment, the
[0035]
FIG. 7 shows an output waveform of the
[0036]
When performing range switching control with such an
[0037]
In the F / B control of the
[0038]
Therefore, in the present embodiment, the
[0039]
In this configuration, even when the rotation of the
[0040]
By the way, since the rotation of the
[0041]
However, as shown in FIG. 27, when the energized phase is switched in both the F / B and the time-synchronized energized phase setting process, the previous value of the encoder count value by the previous F / B process is updated by the time-synchronized energized phase setting process. Therefore, even if the
[0042]
Therefore, in the present embodiment, the
[0043]
In this case, in the reverse rotation detection method, when the
[0044]
By the way, as shown in FIG. 28, when the target position is switched during F / B control (during rotation of the rotor 32), the rotation direction of the
[0045]
As a countermeasure, in the present embodiment, when the current encoder count value is compared with the maximum value or the minimum value to determine the presence / absence of reverse rotation, the maximum value and the minimum value are respectively counted by a predetermined count value. The dead zone is set so that the reverse rotation is not determined within this dead zone. In this way, even when the target position is switched in the middle of the F / B control, the transient behavior due to the inertia of the
[0046]
Further, in this embodiment, when the state where the energized phase is held is detected by the reverse rotation detection, the control is switched to open loop control, the energized phase is sequentially switched without feedback of the encoder count value information, and The number of times of switching is counted, and the
Hereinafter, processing contents of each routine executed by the
[0047]
[Encoder counter]
The processing contents of the encoder counter routine shown in FIG. 8 will be described. This routine is started in synchronization with both the rising and falling edges of the A phase signal and the B phase signal by the AB phase interrupt processing, and the rising and falling edges of the A phase signal and the B phase signal are followed. Count as follows. When this routine is started, first, in
[0048]
Here, the reason why the current values A (i) and B (i) of the A-phase signal and the B-phase signal and the previous values A (i-1) and B (i-1) are used is as follows. This is because the rotation direction of the
[0049]
After calculating the count-up value ΔN, the process proceeds to step 303, and the current encoder count value Ncnt is obtained by adding the count-up value ΔN calculated in
The encoder counter routine described above serves as encoder counting means in the claims.
[0050]
[Control mode setting]
The control mode setting routine shown in FIGS. 11 to 13 is executed at a predetermined cycle (for example, 1 ms cycle) after the end of the initial drive. Here, the initial drive is a process for making the encoder count value correspond to the actual rotational position of the
[0051]
The control mode setting routine shown in FIG. 11 to FIG. 13 sets the control mode determination value mode to 0, 1, 3, 4, or 5 at a predetermined cycle (for example, 1 ms cycle) after the end of the initial drive. Specify the control mode as follows.
[0052]
mode = 0: energization off (standby)
mode = 1: Normal drive
(F / B control start position stop holding process, time synchronization energized phase setting process,
F / B control)
mode = 3: target position stop holding process
mode = 4: Reverse position stop holding process
mode = 5: Open loop control
[0053]
When the control mode setting routine is started, first, in
[0054]
On the other hand, if the system failure flag Xfailoff is OFF (no failure), the process proceeds from
[0055]
If both the fail-safe process execution flag Xfsop and the recovery process execution flag Xrcv are set to OFF, the process proceeds to step 405 to determine whether or not the energization flag Xon = ON (energization on) is set. If the flag Xon is set to OFF (energization off), the process proceeds to step 406, where a difference between the target count value Acnt and the encoder count value Ncnt (difference between the target position and the
Ncnt = Ncnt-Gcnt
[0056]
If the difference (Acnt−Ncnt) between the target count value Acnt and the encoder count value Ncnt is + Kth or more (for example, + 10 ° or more), the
[0057]
If the difference (Acnt−Ncnt) between the target count value Acnt and the encoder count value Ncnt is −Kth or less (for example, −10 ° or less), the
[0058]
If the difference (Acnt−Ncnt) between the target count value Acnt and the encoder count value Ncnt is within the range of −Kth to + Kth (for example, within the range of −10 ° to + 10 °), the
[0059]
On the other hand, if it is determined in
[0060]
Specifically, first, in
[0061]
On the other hand, when it is determined in
[0062]
As described above, when the rotation direction instruction value D is reversed, the process proceeds to step 416, and in order to reverse the rotation direction of the
[0063]
In this
[0064]
On the other hand, if it is determined “No” in step 417 (not the reverse position stop holding process), it is determined in
[0065]
That is, as shown in FIG. 14, by setting the end determination value Kref of the F / B control to, for example, a phase advance amount (for example, 2 to 4 counts) of the energized phase, the phase of the energized phase is greater than the target count value Acnt. The F / B control is terminated at the timing before the advance amount. As a result, the last energized phase of the F / B control coincides with the energized phase that stops and holds the
[0066]
When it is determined as “No” in the above-described
[0067]
On the other hand, if “Yes” is determined in
[0068]
Thereafter, the process proceeds to step 425, where it is determined whether or not the target position stop holding process time CThold has reached a predetermined time (for example, 50 ms), and the target position stop holding process time CThold has reached a predetermined time (for example, 50 ms). If not, the process proceeds to step 426, and in order to continue the target position stop holding process, the rotation direction instruction value D = 0 (stop), the energization flag Xon = ON (energization on), the control mode determination value mode = 3 (target The position stop holding process) is maintained.
[0069]
Thereafter, when the target position stop holding processing time CThold reaches a predetermined time (for example, 50 ms), the process proceeds to step 427 to turn off the
A setting example of the control mode determination value mode described above is shown in the time chart of FIG.
[0070]
[Time synchronous motor control]
The time-synchronized motor control routine shown in FIG. 16 is started at a predetermined period (for example, 1 ms period) after the end of the initial drive, and is normally driven (F / B control start position stop holding process, time-synchronized energized phase setting process, F / B control). ), The target position stop holding process and the reverse position stop holding process are executed.
[0071]
When this routine is started, it is first determined in
[0072]
On the other hand, if it is determined in
[0073]
In this routine, when the control mode determination value mode = 1, the processing of step 505 (
[0074]
On the other hand, if it is determined in
[0075]
When the control mode determination value mode = 4 (reverse position stop holding process), the process proceeds from
[0076]
As described above, in the case of the control mode determination value mode = 1, 3 and 4, after calculating the energization phase determination value Mptn, the process proceeds to step 508, and an energization processing routine shown in FIG. Normal driving, target position stop holding processing, and reverse position stop holding processing are executed.
[0077]
On the other hand, if both of the above-mentioned
[0078]
[Mode1]
The mode1 routine shown in FIG. 17 is a subroutine started in
[0079]
When this routine is started, first, in
[0080]
If the time CT1 of the F / B control start position stop holding process does not exceed a predetermined time (for example, 10 ms), the process proceeds to step 513, and whether the energized phase stored flag Xhold = OFF (not stored) at the time of stop holding. (That is, whether or not it is the timing immediately before the start of the F / B control start position stop holding process), and if the stopped holding energized phase stored flag Xhold = OFF, the process proceeds to step 514, where F / B The energized phase determination value Mptn during the B control start position stop holding process is set to the current position counter value (Ncnt−Gcnt).
[0081]
Mptn = Ncnt−Gcnt
Here, the position counter value (Ncnt−Gcnt) is a value obtained by correcting the encoder count value Ncnt with the initial position deviation learning value Gcnt learned during initial driving, and is a value that accurately represents the current position of the
[0082]
Thereafter, the process proceeds to step 515, where the energized phase determination value Mptn is divided by “12” to obtain the
[0083]
In the
[0084]
In the
[0085]
Thereafter, when the time CT1 of the F / B control start position stop holding process exceeds a predetermined time (for example, 10 ms), “Yes” is determined in
[0086]
In the control mode setting routine of FIGS. 11 to 13, when the difference (Acnt−Ncnt) between the target count value Acnt and the encoder count value Ncnt becomes equal to or smaller than a predetermined value by F / B control, the
[0087]
Accordingly, since the
[0088]
FIG. 24 is a time chart illustrating a phase that is first energized when rotation is started from the UW phase. In this case, when starting normal rotation (rotation in the P range → NotP range direction), the energized phase determination value Mptn uses the encoder count value Ncnt, the initial misalignment learning value Gcnt, and the positive rotation direction phase advance amount K1. Is calculated by the following equation.
Mptn = Ncnt−Gcnt + K1
[0089]
Here, assuming that the forward rotation direction phase advance amount K1 is 4, for example, the energized phase determination value Mptn is calculated by the following equation.
Mptn = Ncnt−
When starting normal rotation from the UW phase, mod (Ncnt−Gcnt) is 4, so
[0090]
On the other hand, when reverse rotation (rotation in the NotP range → P range direction) is started from the UW phase, when the reverse rotation direction phase advance amount K2 is set to 3, for example, the energized phase determination value Mptn is calculated by the following equation. .
Mptn = Ncnt-Gcnt-K2 = Ncnt-Gcnt-3
When reverse rotation is started from the UW phase,
[0091]
Thus, by setting the forward rotation direction phase advance amount K1 and the reverse rotation direction phase advance amount K2 to 4 and 3, respectively, the switching pattern of the energized phases in the forward rotation direction and the reverse rotation direction can be made symmetric. In both cases of the forward rotation direction and the reverse rotation direction, the phase at a position shifted by two steps from the current position of the
[0092]
[Mode3]
The mode3 routine shown in FIG. 18 is a subroutine started in
[0093]
When this routine is started, first, in
[0094]
At this time, in
[0095]
In the case of Mptn> Ncnt−Gcnt, it is determined that the rotation is normal (the rotation direction from the P range to the NotP range), the process proceeds to step 533, and the energized phase determination value Mptn is increased by 2, thereby correcting to the 2-phase energization. .
[0096]
On the other hand, in the case of Mptn <Ncnt−Gcnt, it is determined that the rotation is reverse (the rotation direction of the NotP range → P range), the process proceeds to step 534, and the energized phase determination value Mptn is decreased by 2 so that 2-phase energization is achieved. to correct.
In addition, when Mptn = Ncnt−Gcnt, it is determined to be stopped and the energized phase is not changed.
[0097]
As described above, the target position stop holding process is executed by two-phase energization having a holding torque larger than that of the one-phase energization, similarly to the F / B control start position stop holding process, so that the
[0098]
[Mode4]
The mode4 routine shown in FIG. 19 is a subroutine started in
[0099]
When this routine is started, first, in
[0100]
If the reverse position stop holding processing time CT4 does not exceed a predetermined time (for example, 50 ms), the process proceeds to step 543, where the current value depends on whether
[0101]
As described above, the reverse position stop holding process is executed by two-phase energization having a larger holding torque than the one-phase energization, as in the F / B control start position stop holding process and the target position stop holding process. The
[0102]
Thereafter, when the time CT4 of the reverse position stop holding process exceeds a predetermined time (for example, 50 ms), it is determined as “Yes” in
[0103]
[Energization processing]
The energization processing routine shown in FIG. 20 is a subroutine started in
[0104]
When the energization processing routine of FIG. 20 is started, first, at
[0105]
On the other hand, if “No” is determined in
[0106]
Further, when it is determined as “No” in the
[0107]
[F / B control]
Next, processing contents of the F / B control routine shown in FIG. 22 will be described. This routine is executed by the AB phase interruption process, and when the F / B control execution condition is satisfied after the end of the initial drive, the rotational position of the rotor 32 (encoder count value Ncnt−Gcnt) becomes the target position (target count value). The
[0108]
When the F / B control routine of FIG. 22 is started, first in
[0109]
On the other hand, if the F / B permission flag Xfb is set to ON, the process proceeds to step 602, and an energized phase setting routine shown in FIG. 23 described later is executed to determine the current encoder count value Ncnt and the initial position deviation learning value. Based on Gcnt, an energized phase is set (this process serves as the first energized phase setting means in the claims), and in the
[0110]
[Energized phase setting]
The energization phase setting routine shown in FIG. 23 is a subroutine started in
[0111]
In this
[A-1] No reverse rotation detected during forward rotation
[A-2] First excitation at the start of F / B
[0112]
The condition [A-1] does not decrease beyond the dead zone ΔNn even if the current encoder count value Ncnt is greater than or equal to the maximum encoder count value Ncntmax up to the present, or smaller than the maximum value Ncntmax. That is.
Ncnt ≧ Ncntmax−ΔNn
[0113]
Here, the dead zone ΔNn is for avoiding, for example, determining that the transient behavior due to the inertia of the
[0114]
If either one of the two conditions [A-1] and [A-2] is satisfied, the forward rotation drive execution condition is satisfied, and the process proceeds to step 615, where the current encoder count value Ncnt, the initial misregistration learning value Gcnt. The energized phase determination value Mptn is updated by the following equation using the forward rotation direction phase advance amount K1 and the speed phase advance correction amount Ks.
Mptn = Ncnt−Gcnt + K1 + Ks
[0115]
Here, the positive rotation direction phase advance amount K1 is the phase advance amount of the energized phase necessary for normal rotation of the rotor 32 (the phase advance amount of the energized phase with respect to the current rotational phase of the rotor 32), for example, K1 = 4 is set.
[0116]
The speed phase advance correction amount Ks is a phase advance correction amount that is set according to the rotational speed of the
[0117]
After updating the energized phase determination value Mptn, the process proceeds to step 616 to determine whether or not the current encoder count value Ncnt is larger than the maximum value Ncntmax. If so, the process proceeds to step 617 and is stored in the memory of the
[0118]
On the other hand, when the encoder count value Ncnt is counted down for some reason during the forward rotation drive and the encoder count value Ncnt is counted down, “No” is determined in the
[0119]
On the other hand, if both of the two conditions [A-1] and [A-2] are not satisfied in
[0120]
If it is determined in
[0121]
In this
[B-1] Reverse rotation (forward rotation) is not detected during reverse rotation drive
[B-2] First excitation at the start of F / B
[0122]
The condition [B-1] does not exceed the dead zone ΔNp even if the current encoder count value Ncnt is less than or equal to the minimum encoder count value Ncntmin up to the present or greater than the minimum value Ncntmin. That is.
Ncnt ≦ Ncntmin + ΔNp
[0123]
Here, the dead zone ΔNp is for avoiding, for example, determining that the transient behavior due to the inertia of the
[0124]
If either one of the two conditions [B-1] and [B-2] is satisfied, the reverse rotation drive execution condition is satisfied, and the process proceeds to step 621, where the current encoder count value Ncnt, the initial misregistration learning value Gcnt The energized phase determination value Mptn is updated by the following equation using the reverse rotation direction phase advance amount K2 and the speed phase advance correction amount Ks.
Mptn = Ncnt-Gcnt-K2-Ks
[0125]
Here, the reverse rotation direction phase advance amount K2 is a phase advance amount of the energized phase necessary to reversely rotate the rotor 32 (phase advance amount of the energized phase with respect to the current rotation phase of the rotor 32), for example, K2 = 3 is set. The speed phase advance correction amount Ks is set in the same manner as in the case of forward rotation.
[0126]
After updating the energized phase determination value Mptn, the process proceeds to step 622 to determine whether or not the current encoder count value Ncnt is smaller than the minimum value Ncntmin. If it is smaller, the process proceeds to step 623 and stored in the memory of the
[0127]
On the other hand, when the reverse rotation occurs for some reason during the reverse rotation driving and the encoder count value Ncnt is counted up, “No” is determined in the
[0128]
On the other hand, if both of the two conditions [B-1] and [B-2] are not satisfied in
[0129]
After determining the current energized phase determination value Mptn as described above, the energization processing routine of FIG. 20 is executed, and during the F / B control, the conversion table of FIG. The energized phase corresponding to% 12 is selected, and the
[0130]
FIG. 30 shows a control example when the dead zone ΔNn is set to 2 counts. If the encoder count value Ncnt is within the range of the dead zone ΔNn with respect to the maximum value Ncntmax, it is not determined to be reverse and the energized phase is not held. In the range of the dead zone ΔNn, when the encoder count value Ncnt decreases, the energized phase determination value Mptn also decreases and the energized phase is switched. Thereafter, when the encoder count value Ncnt becomes smaller than the dead zone ΔNn, it is determined that the encoder is reversely rotated, and the energized phase is held in the previous energized phase.
[0131]
[Fail-safe processing]
The fail-safe processing routine shown in FIG. 25 is started at a predetermined cycle, and serves as an open loop driving means in the claims. When this routine is started, it is first determined in
[0132]
If the energized phase is not being held, the present routine is terminated as it is, but if the energized phase is being held, the routine proceeds to step 702 to switch to open loop control. In this open loop control, the energized phases are sequentially switched without feeding back the encoder count value information, and the number of times the energized phases are switched is counted, and the
[0133]
In the present embodiment described above, the time-synchronized energized phase setting process for setting the energized phase based on the encoder count value at a predetermined period from the start of the F / B control of the
[0134]
Moreover, in this embodiment, the maximum / minimum encoder count value is sequentially stored during the F / B control, and the current encoder count value is compared with the maximum / minimum value to determine the presence or absence of reverse rotation. Therefore, even if there is a circumstance that the previous value of the encoder count value by the previous F / B process is updated by the time-synchronized energized phase setting process (see FIG. 27), the maximum / minimum value of the encoder count value Reverse rotation detection can be performed using the value. This makes it possible to hold the energized phase at the previous energized phase when a reverse rotation occurs during F / B control, and to solve the problem of continuing the reverse rotation by the time-synchronized energized phase setting process.
[0135]
Note that the reverse rotation detection method is not limited to the method of the present embodiment. For example, the reverse rotation may be detected by determining the rotation direction of the
[0136]
In the present embodiment, when comparing the current encoder count value with the maximum value or the minimum value to determine the presence or absence of reverse rotation, a dead zone corresponding to the predetermined count value is set for each of the maximum value and the minimum value, Since the reverse rotation is not determined within the dead zone, even when the target position is switched during the F / B control, the transient behavior due to the inertia of the
[0137]
However, the present invention is not limited to the configuration in which the dead zone is provided. For example, when the present invention is applied to a system that is essentially difficult to reverse, such as a system that always starts F / B control from a motor stop state, As shown in FIG. 29, the dead zone may be eliminated. In this configuration, if the current encoder count value becomes smaller by 1 count than the maximum value (or if it becomes larger by 1 count than the minimum value), it is determined that the rotation is reversed, and the energized phase is immediately held.
[0138]
In this embodiment, the time-synchronized energized phase setting process is performed over the entire period from the start of the F / B control until the
[0139]
However, according to the present invention, the time-synchronized energized phase setting process may be executed until the
[0140]
Alternatively, the time-synchronized energized phase setting process may be executed only when the
In this embodiment, during the F / B control, the driving is performed by the 1-2 phase excitation method in which the one-phase energization and the two-phase energization are alternately switched. However, the one-phase excitation that is driven only by the one-phase energization. Alternatively, a two-phase excitation method that drives only by two-phase energization may be employed.
[0141]
The encoder used in the present invention is not limited to the
Further, the motor used in the present invention is not limited to the
[0142]
In addition, the range switching device of the present embodiment is configured to switch between two ranges of the P range and the NotP range. For example, the range switching valve and the manual valve of the automatic transmission are interlocked with the turning operation of the
[0143]
In addition, the present invention is not limited to the range switching device, and it goes without saying that the present invention can be applied to various devices using a brushless type motor such as an SR motor as a drive source.
[Brief description of the drawings]
FIG. 1 is a perspective view of a range switching device showing an embodiment of the present invention.
FIG. 2 is a diagram illustrating the configuration of an SR motor
FIG. 3 is a circuit diagram showing a circuit configuration for driving an SR motor.
FIG. 4 is a diagram schematically showing the configuration of the entire control system of the range switching device.
FIG. 5 is a plan view illustrating the configuration of a rotary magnet of an encoder
FIG. 6 is a side view of the encoder.
7A is a time chart showing an output waveform of an encoder, and FIG. 7B is a time chart showing an energized phase switching pattern.
FIG. 8 is a flowchart showing a flow of processing of an encoder counter routine.
FIG. 9 is a diagram showing an example of a count-up value ΔN calculation map
FIG. 10 is a time chart showing the relationship between command range shift, phase A signal, phase B signal, and encoder count value.
FIG. 11 is a flowchart showing the flow of processing of a control mode setting routine (part 1).
FIG. 12 is a flowchart showing a flow of processing of a control mode setting routine (part 2).
FIG. 13 is a flowchart (No. 3) showing the flow of processing of a control mode setting routine.
FIG. 14 is a time chart for explaining the timing for shifting from F / B control to target position stop holding processing;
FIG. 15 is a time chart showing an example of control of an SR motor.
FIG. 16 is a flowchart showing a flow of processing of a time synchronous motor control routine.
FIG. 17 is a flowchart showing a process flow of a mode1 routine.
FIG. 18 is a flowchart showing a process flow of a mode3 routine.
FIG. 19 is a flowchart showing a process flow of a mode4 routine.
FIG. 20 is a flowchart showing a flow of processing of an energization processing routine.
FIG. 21 is a diagram showing an example of a conversion table from
FIG. 22 is a flowchart showing the flow of processing of an F / B control routine.
FIG. 23 is a flowchart showing a flow of processing of an energized phase setting routine.
FIG. 24 is a time chart for explaining energization processing when rotation is started from the UW phase.
FIG. 25 is a flowchart showing a flow of processing of a fail-safe processing routine.
FIG. 26 is a time chart for explaining a control example of conventional energized phase hold processing;
FIG. 27 is a time chart for explaining a control example of energized phase hold processing in a comparative example;
FIG. 28 is a time chart for explaining the behavior of the encoder count value when the target position is switched during F / B control.
FIG. 29 is a time chart for explaining a control example of energized phase hold processing according to the present invention when no dead zone is provided.
FIG. 30 is a time chart for explaining a control example of energized phase hold processing according to the present invention when a dead zone is provided.
[Explanation of symbols]
DESCRIPTION OF
Claims (7)
前記モータのフィードバック制御中に前記エンコーダのパルス信号出力タイミングに同期して前記エンコーダカウント値に基づいて通電相を設定する第1の通電相設定手段と、
前記ロータが前記目標位置に回転駆動されるまで時間同期処理によって所定周期で前記エンコーダカウント値に基づいて通電相を設定する第2の通電相設定手段と、
前記第1及び第2の各通電相設定手段によって通電相が設定される毎にその通電相の巻線に通電する通電制御手段と、
前記ロータを前記目標位置へ回転駆動する途中で該ロータの回転方向が逆転したときにその逆転を検出する逆転検出手段と、
前記逆転検出手段で逆転を検出したときに前記通電制御手段で通電する通電相を前回の通電相に固定する通電相ホールド手段と
を備えていることを特徴とするモータ制御装置。An encoder that outputs a pulse signal in synchronization with rotation of a rotor of a motor that rotationally drives a control target, and an encoder count unit that counts a count value of the pulse signal of the encoder (hereinafter referred to as “encoder count value”); In the motor control device that sequentially switches the energized phase of the motor so as to detect the rotational position of the rotor based on the encoder count value during the feedback control of the motor and to rotationally drive the rotor to the target position,
First energized phase setting means for setting an energized phase based on the encoder count value in synchronization with the pulse signal output timing of the encoder during feedback control of the motor;
Second energized phase setting means for setting an energized phase based on the encoder count value at a predetermined period by time synchronization processing until the rotor is rotationally driven to the target position;
Energization control means for energizing the winding of the energized phase each time the energized phase is set by the first and second energized phase setting means;
Reverse rotation detection means for detecting the reverse rotation when the rotation direction of the rotor is reversed in the middle of rotationally driving the rotor to the target position;
A motor control apparatus comprising: an energized phase holding unit that fixes an energized phase energized by the energization control unit to a previous energized phase when reverse rotation is detected by the reverse rotation detecting unit.
前記逆転検出手段は、前記ロータを前記エンコーダカウント値がカウントアップする方向に回転駆動しているときには該エンコーダカウント値の最大値を逐次記憶しておき、現在のエンコーダカウント値と前記最大値とを比較することで逆転の有無を判定し、前記ロータを前記エンコーダカウント値がカウントダウンする方向に回転駆動しているときには該エンコーダカウント値の最小値を逐次記憶しておき、現在のエンコーダカウント値と前記最小値とを比較することで逆転の有無を判定することを特徴とする請求項1に記載のモータ制御装置。The encoder count means switches the count-up / count-down of the encoder count value in accordance with the forward / reverse rotation of the rotor;
The reverse rotation detection means sequentially stores the maximum value of the encoder count value when the rotor is rotationally driven in the direction in which the encoder count value is counted up, and the current encoder count value and the maximum value are stored. A comparison is made to determine the presence or absence of reverse rotation. When the rotor is driven to rotate in the direction in which the encoder count value counts down, the minimum value of the encoder count value is sequentially stored, and the current encoder count value and the The motor control device according to claim 1, wherein the presence or absence of reverse rotation is determined by comparing with a minimum value.
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2003074824A JP3871130B2 (en) | 2003-03-19 | 2003-03-19 | Motor control device |
US10/674,437 US6992451B2 (en) | 2002-10-07 | 2003-10-01 | Motor control apparatus operable in fail-safe mode |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2003074824A JP3871130B2 (en) | 2003-03-19 | 2003-03-19 | Motor control device |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2004282970A JP2004282970A (en) | 2004-10-07 |
JP3871130B2 true JP3871130B2 (en) | 2007-01-24 |
Family
ID=33290299
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2003074824A Expired - Fee Related JP3871130B2 (en) | 2002-10-07 | 2003-03-19 | Motor control device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3871130B2 (en) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4577243B2 (en) * | 2006-03-14 | 2010-11-10 | トヨタ自動車株式会社 | Shift control device for transmission |
JP4462281B2 (en) | 2007-03-01 | 2010-05-12 | 株式会社デンソー | Shift-by-wire system |
JP5333881B2 (en) * | 2007-04-27 | 2013-11-06 | 日立工機株式会社 | Electric tool |
JP2016014435A (en) * | 2014-07-02 | 2016-01-28 | 株式会社デンソー | Shift range switching control unit |
JP6510582B2 (en) * | 2017-04-03 | 2019-05-08 | ミネベアミツミ株式会社 | Motor drive control device, motor drive control method and tube pump |
JP7009936B2 (en) * | 2017-11-06 | 2022-01-26 | 株式会社デンソー | Shift range controller |
EP3916359B1 (en) * | 2019-01-25 | 2023-08-30 | Mitsubishi Electric Corporation | Angle detection device |
-
2003
- 2003-03-19 JP JP2003074824A patent/JP3871130B2/en not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JP2004282970A (en) | 2004-10-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US6992451B2 (en) | Motor control apparatus operable in fail-safe mode | |
US7161314B2 (en) | Motor control apparatus having current supply phase correction | |
JP5454962B2 (en) | Motor control device | |
JP4936069B2 (en) | Motor control device | |
JP5648854B2 (en) | Motor control device | |
JP5093624B2 (en) | Motor control device | |
JP3800529B2 (en) | Motor control device | |
JP2007336611A (en) | Control device of synchronous motor | |
JP3849864B2 (en) | Motor control device | |
JP2004023890A (en) | Motor controller | |
JP4082164B2 (en) | Motor control device | |
JP3871130B2 (en) | Motor control device | |
JP4189953B2 (en) | Position switching control device | |
JP6547663B2 (en) | Control device | |
JP3947922B2 (en) | Motor control device | |
JP3849931B2 (en) | Motor control device | |
JP3849627B2 (en) | Motor control device | |
JP5472044B2 (en) | Motor control device | |
JP3888278B2 (en) | Motor control device | |
JP3888940B2 (en) | Motor control device | |
JP3800532B2 (en) | Motor control device | |
JP3849629B2 (en) | Motor control device | |
JP2004023889A (en) | Motor controller | |
JP4748611B2 (en) | Position switching control device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20050418 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20060720 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20060928 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20061011 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 3871130 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20101027 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20101027 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20111027 Year of fee payment: 5 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20121027 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20121027 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20131027 Year of fee payment: 7 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
LAPS | Cancellation because of no payment of annual fees |