自動操舵制御装置
【課題】電圧飽和が発生し電流追従誤差が大きくなることを防止する。
【解決手段】転舵輪を転舵するモータ５と、前記モータの電流を検出する電流センサ９と、前記転舵輪の目標舵角の演算または外部からの受信に基づいて目標舵角を設定する目標舵角演算器１１と、前記転舵輪の転舵角を検出する角度センサ７と、前記転舵角が前記目標舵角に追従するように前記モータの目標電流を演算してモータを制御する制御ユニット１０と備え、前記制御ユニット１０は、前記電流センサ９により検出されるモータ電流に基づいてモータ回転速度制限値を設定して前記モータの回転速度を制限する転舵角が目標舵角に追従するようにモータを制御する。
【解決手段】転舵輪を転舵するモータ５と、前記モータの電流を検出する電流センサ９と、前記転舵輪の目標舵角の演算または外部からの受信に基づいて目標舵角を設定する目標舵角演算器１１と、前記転舵輪の転舵角を検出する角度センサ７と、前記転舵角が前記目標舵角に追従するように前記モータの目標電流を演算してモータを制御する制御ユニット１０と備え、前記制御ユニット１０は、前記電流センサ９により検出されるモータ電流に基づいてモータ回転速度制限値を設定して前記モータの回転速度を制限する転舵角が目標舵角に追従するようにモータを制御する。
【発明の詳細な説明】
【技術分野】
【０００１】
この発明は、電動パワーステアリングのモータを用いて転舵輪を自動操舵する自動操舵制御装置に関するものである。
【背景技術】
【０００２】
従来の自動操舵制御装置では、電動パワーステアリングのモータを用いて転舵輪の舵角を制御している（例えば、特許文献１〜３参照）。
【０００３】
すなわち、特許文献１では、転舵角速度が所定値以下となるように、車速の制限値を設定している。また、特許文献２では、舵角偏差が閾値より大きい要因がモータの出力不足であるときに自動操舵制御を継続させ、舵角偏差が閾値より大きく電流が最大電流でないときは自動操舵制御を解除する構成となっている。また、最大操舵速度は、車速、路面摩擦係数およびバッテリ電圧から設定している。さらに、特許文献３では、自動操作制御中に、操舵トルクが閾値以上であり、操舵速度も閾値以上のとき、操舵速度を制限する操舵速度制限部を備えている。
【０００４】
【特許文献１】特開２００１−１３８９４１号公報（段落００２７〜００３６、図５）
【特許文献２】特開２００７−３３１４８０号公報（段落００２８〜００３０、図３）
【特許文献３】特開２００７−３２６４５３号公報（段落００１６、図３）
【発明の開示】
【発明が解決しようとする課題】
【０００５】
このような自動操舵制御装置にあっては、電動パワーステアリングのモータを用いた低コスト、低電圧電源のシステムとなるため、電圧飽和が発生しやすい。電圧飽和が発生すると、電流追従誤差が大きくなる課題がある。また、特許文献１のように、車速の制限値を設定していても、運転者が制限値以上の車速で運転すれば電圧飽和が発生する可能性がある。
【０００６】
また、電圧飽和で電流追従誤差および舵角追従誤差が大きくなっている状態で、路面状況の変化により、モータ負荷が軽くなり電圧飽和から開放された時に、その偏差を低減しようとして角速度が急変する課題がある。
【０００７】
また、電圧飽和が発生している時には、電流は最大電流とならないことがあり、特許文献２の構成では、電圧飽和により、自動操舵制御が解除されやすくなる可能性がある。また、特許文献３においても、電圧飽和に対して操舵速度を制限することはできない。
【０００８】
この発明は、上記のような問題点を解決するためになされたものであり、電圧飽和を防止する自動操舵制御装置を得ることを目的としている。
【課題を解決するための手段】
【０００９】
この発明に係る自動操舵制御装置は、転舵輪を転舵するモータと、前記モータの電流を検出するモータ電流検出手段と、前記転舵輪の目標舵角の演算または外部からの受信に基づいて目標舵角を設定する目標舵角設定手段と、前記転舵輪の転舵角を検出する転舵角検出手段と、前記転舵角が前記目標舵角に追従するように前記モータの目標電流を演算してモータを制御するモータ制御手段と備え、前記モータ制御手段は、前記モータ電流検出手段により検出されるモータ電流に基づいてモータ回転速度制限値を設定して前記モータの回転速度を制限することを特徴とする。
【発明の効果】
【００１０】
この発明によれば、モータ電流に基づいてモータ回転速度を直接制限できるため、車速が高くても電圧飽和を防止でき、電流追従誤差を小さくすることができる、といった従来にない顕著な効果を奏するものである。さらに、電圧飽和を防止でき、電流追従誤差を小さくすることができるため、電圧飽和が発生するようなモータ負荷が高い状況から、路面状況の変化等によりモータ負荷が軽くなった時の角度変化を滑らかにすることができる。
【発明を実施するための最良の形態】
【００１１】
実施の形態１．
図１は、この発明の実施の形態１による自動操舵制御装置を示す構成図である。ステアリングホイール１に連結したステアリング軸２の回転に応じて左右の転舵輪３が転舵される。ステアリング軸２には、トルクセンサ４が配置され、ステアリング軸２に作用する操舵トルクを検出する。モータ５は、減速機構６を介してステアリング軸２に連結しており、モータ５が発生するトルクをステアリング軸２に付与することができる。モータ５には、モータ５のロータの回転角度を検出する角度センサ（転舵角検出手段）７が配置されている。車両の車速は車速センサ８で検出される。また、モータ５に流れる電流はモータ電流検出手段としての電流センサ９で検出される。
【００１２】
制御ユニット１０は、モータ制御手段となるもので、転舵輪３を位置制御する自動操舵制御を実行するために必要なモータ５の目標電流である自動操舵用目標電流を演算する自動操舵制御部１０１と、運転者のステアリング操舵をアシストする電動パワーアシスト制御を実施するために必要なモータ５の目標電流である電動パワーアシスト用目標電流を演算する電動パワーアシスト制御部１０２と、電流センサ９で検出した電流が、電動パワーアシスト用目標電流、または、自動操舵用目標電流に一致するようにモータ５の電流を制御する電流制御部１０３を備えている。また、制御ユニット１０は、ＲＯＭ、ＲＡＭを含むメモリを設けたマイコンとモータ電流を駆動する駆動回路から構成される。
【００１３】
目標舵角演算器１１は、目標舵角設定手段となるもので、自動操舵制御時の目標舵角を演算し、演算した目標舵角を制御ユニット１０に送信する。バッテリ電圧センサ１２は、モータ駆動の電源電圧であるバッテリ電圧を検出する。自動操舵制御が実施されておらず、運転者がステアリングホイール１を操作する手動操舵時は、電動パワーアシスト制御部１０２が演算する電動パワーアシスト用目標電流にモータ５の電流が一致するように電流制御部１０３を駆動する。これにより、手動操舵時は、従来の電動パワーステアリングと同等の操舵制御装置となる。
【００１４】
次に、自動操舵について説明する。自動操舵中は、運転者がステアリング操作をしていない状態で、モータ５を用いてステアリング軸２を回転させ、転舵輪３を自動で転舵させる。例えば、駐車時や高速道路を走行中に、運転者が自動操舵を選択すると、目標舵角演算器１１では、車速センサ８で検出した車速等の車両状態量と車両の目標走行軌跡から、車両を目標走行軌跡に追従させるための目標舵角を演算し、制御ユニット１０に演算した目標舵角を送信する。制御ユニット１０の自動操舵制御部１０１は、取得した目標舵角と角度センサ７によって検出されるロータ回転角から、ステアリング軸２が目標舵角に追従するように自動操舵用目標電流を演算し、自動操舵用目標電流を電流制御部１０３に出力する。
【００１５】
自動操舵時は、電流制御部１０３は、自動操舵制御部１０１が演算した自動操舵用目標電流に、モータ５の電流が追従するように電流制御を行う。これにより、運転者が自動操舵を選択した時には、モータ５がステアリング操作を実施されるため、運転者はステアリング操作なしにアクセルやブレーキの操作のみで駐車や高速道路走行が可能になる。
【００１６】
次に、この発明の要部である自動操舵制御部１０１について図２に示すフローチャートで説明する。なお、フローチャートに示す動作は所定時間の制御周期で繰り返し実行される。まず、ステップＳ１において、外部の自動操舵メインコントローラから目標舵角を受信し、メモリに記憶する。ステップＳ２では、角度センサ６で検出した回転角、電流センサ９で検出したモータ電流、バッテリ電圧センサ１２で検出したバッテリ電圧を読み込みメモリに記憶する。
【００１７】
ステップＳ３では、電流センサ９で検出したモータ電流、バッテリ電圧センサ１２で検出したバッテリ電圧からモータ回転速度制限値を演算する。実施の形態１では、モータ５はブラシレスＤＣモータとし、角度センサ７にはレゾルバを用いる。ただし、モータ５と角度センサ７はこの限りではなく、電動パワーステアリング、および、自動操舵に適したものであるならばよい。例えば、モータ７をブラシ付きＤＣモータとしても良く、角度センサをエンコーダとしてもよく、ステアリング軸２に配置した角度センサを用いてもよい。ここで、ブラシレスＤＣモータのｄｑ軸上で表した電圧方程式は式（１）、トルク算出式は式（２）となる。
【００１８】
【数１】
【００１９】
ただし、Ψａ＝√（３／２Ψｆ）であり、Ψｆは永久磁石による電機子鎖交磁束の最大値、Ｖｄ，Ｖｑは電機子電圧のｄｑ軸成分、ｉｄ，ｉｑは電機子電流のｄｑ軸成分、Ｌｄ，Ｌｑはｄｑ軸のインダクタンス、Ｒａは電機子巻線抵抗、ｐ＝ｄ／ｄｔは微分演算子、Ｐｎは極対数、ωは電気角速度である。
【００２０】
ｄｑ軸のインダクタンスＬｄ，Ｌｑが等しい場合、式（２）よりモータ５が発生するトルクはｑ軸電流ｉｑに比例する。定常的な特性として、微分演算子ｐのかかる項を０とすると、式（１）は、式（３）となる。
【００２１】
【数２】
【００２２】
電機子電圧の大きさ√（Ｖｄ２＋Ｖｑ２）の最大値は、モータに給電するバッテリ電圧の大きさに比例するため、バッテリ電圧がほぼ一定値であるとすると、式（３）からモータ回転速度によって発生する誘起電圧によって、ｑ軸電流ｉｑ、すなわちモータ５が発生するトルクが制限されることが分かる。言い換えると、ｑ軸電流ｉｑにより、発生できるモータ回転速度は制限されることになる。よって、例えば、オルタネータが正常に発電してバッテリ電圧がほぼ１４Ｖである場合のモータ電流とモータ回転速度の関係をマップとしてメモリに保存しておき、検出したｑ軸電流ｉｑに対応したモータ回転角速度をモータ回転速度制限値と設定する。ここで、検出したモータ電流の代わりにモータの目標電流から回転速度制限値を設定してもよい。
【００２３】
また、オルタネータの故障等によるバッテリ電圧の変化によって、モータ５に給電する電圧の最大が変化するため、図３に示すように、各バッテリ電圧に対するモータ電流とモータ回転速度制限値の関係をマップとしてメモリに保存しておき、検出したモータ電流と、検出したバッテリ電圧から、対応する回転速度制限値を設定しても良い。この構成とすることで、バッテリ電圧が変化した場合においても、適切に回転速度制限値を設定することができる。
【００２４】
また、電機子電流のｄｑ軸成分ｉｄ、ｉｑ、および、バッテリ電圧から式（３）を用いて、回転速度制限値を演算してもよい。
【００２５】
次に、ステップＳ４では、目標舵角、モータ回転速度制限値から新たな目標舵角２（θｒｅｆ２）を演算する。このステップＳ４の動作を図４のフローチャートに示す。ここでは、目標舵角はステアリング軸換算した転舵輪３の目標舵角θｒｅｆである。また、減速機構６の減速比を考慮してモータ回転角からステアリング軸換算した転舵輪３の転舵角θｐを演算し、モータ回転速度制限値からステアリング軸換算したモータ回転速度制限値
【００２６】
【数３】
【００２７】
を演算する。
【００２８】
図４に示すフローチャートにおいて、ステップＳ２１では、外部の自動操舵メインコントローラから受信した目標舵角と目標舵角２（θｒｅｆ２）の偏差とフローチャートを繰り返し実行するサンプリング時間Ｔｓとから目標舵角速度を演算する。ただし、フローチャートをはじめに実行する時の目標舵角２（θｒｅｆ２）の初期値は転舵輪の転舵角θｐとする。このように、目標舵角２（θｒｅｆ２）の初期値を転舵輪の転舵角θｐとすることで、自動操舵制御実行時に、受信した目標舵角と転舵角に偏差があっても、滑らかな自動操舵制御が実現できる。
【００２９】
ステップＳ２２では、演算した目標舵角速度の絶対値が、ステップＳ３で設定したモータ回転速度制限値
【００３０】
【数４】
【００３１】
より大きい場合、目標舵角速度の大きさをモータ回転速度制限値
【００３２】
【数５】
【００３３】
で制限する。そして、ステップＳ２３では、目標舵角速度を時間積分することで、新たな目標舵角２（θｒｅｆ２）を演算する。
【００３４】
以上の動作により、目標舵角２（θｒｅｆ２）の変化率は、モータ回転速度制限値
【００３５】
【数６】
【００３６】
で制限されているため、目標舵角２（θｒｅｆ２）に転舵角θｐが追従するようにモータ５を制御することで、モータ５の誘起電圧による電圧飽和を防止することができる。
【００３７】
ステップＳ５では、目標舵角２（θｒｅｆ２）に転舵角θｐが追従するために必要なモータ５の目標電流を演算する。図５に、位置制御のブロック線図を示す。ｓはラプラス演算子である。目標舵角２（θｒｅｆ２）と転舵角θｐの偏差にＰＩＤ制御を実施し、自動操舵用目標電流を演算する。Ｋｐは比例ゲイン、Ｋｉは積分ゲイン、Ｋｄは微分ゲインである。
【００３８】
また、図１の電流制御部１０３では、演算された自動操舵用目標電流と電流センサ９にて検出された電流が一致するように電流を制御する。例えば、自動操舵用目標電流と電流センサ９にて検出された電流の偏差から、ＰＷＭ信号などの電圧指令信号を演算し、駆動回路に出力し、モータ５を駆動することにより、角度追従に必要なモータトルクを出力する。
【００３９】
さらに、電流制御部１０３には、自動操舵用目標電流と電流センサ９にて検出された電流の偏差が電流偏差閾値より大きい時、電流制御部１０３の異常を判定する電流制御器異常判定手段を備える。
【００４０】
以上の構成により、特許文献１のように車速の制限値を設定するのではなく、モータ電流に基づいてモータの回転速度を直接制限するため、電圧飽和を確実に防止することができる。よって、モータの電流追従誤差が小さいモータ制御手段を実現することができる。直接モータ速度を制限するため、電圧飽和を確実に防止でき、外部コントローラから目標舵角だけ受信して角度制御するシステムにも対応でき、車体移動量と目標舵角が対応していない場合においても電圧飽和を防止することができる。
【００４１】
また、モータ電流に基づいてモータの回転速度を制限するため、モータ負荷に応じた適切なモータ回転速度制限が実現できる。据え切りのようなモータ負荷が高い状態では、モータ回転速度制限値を低く設定し、車速がある程度出ている場合はモータ負荷が低いため、モータ回転速度制限値を高く設定できる。
【００４２】
さらに、バッテリ電圧を検出し、バッテリ電圧に基づいてモータ回転速度制限値を設定する構成とすることにより、バッテリ電圧が変動した場合においても、電圧飽和を防止できる。
【００４３】
そして、電圧飽和により電流偏差が大きくなっている状態で、路面状況の変化等により、モータ負荷が軽くなり電圧飽和から開放された時に、その偏差を低減しようと、舵角、または舵角速度速が急変する課題について、本実施の形態により、電圧飽和が発生する状況下ではモータ回転速度を制限し電流偏差を小さく抑えられるため、舵角、および、舵角速度速の急変を防止することができる。
【００４４】
さらに、図５に示すように速度制御の有無に関わらず位置制御において、モータ電流に基づいてモータの回転速度を制限することができ、電圧飽和を防止することができる。よって、モータの電流追従誤差が小さいモータ制御手段を実現できる。また、モータの電流追従誤差を小さくできるため、電流制御器異常の判定の電流偏差閾値を小さく設定でき、電流制御異常を早期に判定できる。
【００４５】
尚、モータ制御手段は、図２のフローチャートに示す動作内容を有する自動操舵制御部１０１及び電流制御部１０３に相当する。また、図２に示すフローチャートのステップＳ２からＳ４、または、図５の速度制限器がモータ回転速度制限手段に相当する。
【００４６】
実施の形態２．
この実施の形態２においては、図１に示す実施の形態１と同様な構成を備える。ただし、ここでは、制御ユニット１０内の自動操舵制御部１０１の動作内容を示す図２に示すフローチャートにおいて、実施の形態１との相違点についてのみ説明する。
【００４７】
この実施の形態２では、ステップＳ３において、角度センサ７で検出した回転角度を２階微分し、回転角加速度を演算し、モータロータの慣性モーメントを乗算することでモータの慣性トルクを演算する。次に、演算した慣性トルクをモータのトルク定数（ＰｎΨａ））で除算することで、慣性トルクのモータ電流換算値を演算する。モータ電流から慣性トルクのモータ電流換算値を引算したものを、補正したモータ電流とする。この補正したモータ電流と、図３に示すマップからモータ回転速度制限値を演算する構成とする。すなわち、自動操舵制御部１０１に、転舵輪３の転舵角加速度を演算（または検出）する転舵角加速度検出手段を備えるようにして、モータ電流と転舵角加速度とに基づいてモータ回転速度制限値を設定してモータの回転速度を制限する。
【００４８】
以上の構成とすることで、モータ電流と転舵角加速度に基づいてモータの回転速度を制限するため、電圧飽和を防止し、さらにモータの回転角加速度が大きいときは、速度制限を緩めることができる。よって、モータの加速度が必要な過渡的応答に対しては速度制限されにくくなり、応答性と両立できる。
【００４９】
また、ステップＳ３において、バッテリ電圧も考慮し、マップを変更しても良い。尚、本実施の形態２では、角度センサ７で検出した回転角度を２階微分して回転角加速度を演算したが、この限りではなく、モータの逆起電圧から推定したモータ角速度や、ステアリング軸２に配置した角度センサ７から演算してもよい。
【００５０】
実施の形態３．
この実施の形態３においては、図１に示す実施の形態１と同様な構成を備える。ただし、ここでは、制御ユニット１０内の自動操舵制御部１０１の動作内容を示す図２に示すフローチャートにおいて、ステップＳ４以降の動作が異なる。この実施の形態３のフローチャートを図６に示す。
【００５１】
この実施の形態３では、ステップＳ３４において、目標舵角と転舵角の偏差から目標舵角速度を演算する。Ｋｐｐは比例ゲインである。ステップＳ３５において、演算した目標舵角速度をステップＳ３で演算したモータ回転速度制限値で制限する。
【００５２】
ステップＳ３６では、制限した目標舵角速度と転舵角θｐを微分した転舵角速度
【００５３】
【数７】
【００５４】
との偏差を演算し、その偏差にＰＩ制御を実施し、自動操舵用目標電流を演算する。
【００５５】
この構成により、電圧飽和を確実に防止できる目標舵角速度を設定することができ、電圧飽和による電流誤差増大を防止した位置速度制御が実現できる。
【００５６】
また、電圧飽和により電流偏差が大きくなっている状態で、路面状況の変化等により、モータ負荷が軽くなり電圧飽和から開放された時に、その偏差を低減しようと、舵角、または舵角速度速が急変する課題について、本実施の形態により、電圧飽和が発生する状況下ではモータ回転速度を制限し電流偏差を小さく抑えられるため、舵角、および、舵角速度の急変を防止することができる。
【００５７】
尚、実施の形態３の位置制御の構成において、図５に示すように目標舵角の後に速度制限器を設け、新たな目標舵角２を演算し、位置制御を実施することも当然可能である。
【００５８】
また、この実施の形態３において、モータ制御手段は、図６のフローチャートに示す動作内容を有する自動操舵制御部１０１及び電流制御部１０３に相当する。また、図６に示すフローチャートのステップＳ２からＳ４、または、図５の速度制限器がモータ回転速度制限手段に相当する。
【図面の簡単な説明】
【００５９】
【図１】この発明の実施の形態１による自動操舵制御装置を示す構成図である。
【図２】この発明の実施の形態１による自動操舵制御部１０１の要部の動作内容を示すフローチャートある。
【図３】この発明の実施の形態１によるモータ電流と回転速度制限値のマップである。
【図４】この発明の実施の形態１によるステップＳ４の詳細な内容を示すフローチャートである。
【図５】この発明の実施の形態１による位置制御のブロック図である。
【図６】この発明の実施の形態３による自動操舵制御部１０１の要部の動作内容を示すフローチャートである。
【符号の説明】
【００６０】
１ ステアリングホイール、２ ステアリング軸、３ 転舵輪、４ トルクセンサ、５ モータ、６ 減速機構、７ 角度センサ、８ 車速センサ、９ 電流センサ、１０ 制御ユニット、１１ 目標舵角演算器、１２ バッテリ電圧センサ、１０１ 自動操舵制御部、１０２ 電動パワーアシスト制御部、１０３ 電流制御部。
【技術分野】
【０００１】
この発明は、電動パワーステアリングのモータを用いて転舵輪を自動操舵する自動操舵制御装置に関するものである。
【背景技術】
【０００２】
従来の自動操舵制御装置では、電動パワーステアリングのモータを用いて転舵輪の舵角を制御している（例えば、特許文献１〜３参照）。
【０００３】
すなわち、特許文献１では、転舵角速度が所定値以下となるように、車速の制限値を設定している。また、特許文献２では、舵角偏差が閾値より大きい要因がモータの出力不足であるときに自動操舵制御を継続させ、舵角偏差が閾値より大きく電流が最大電流でないときは自動操舵制御を解除する構成となっている。また、最大操舵速度は、車速、路面摩擦係数およびバッテリ電圧から設定している。さらに、特許文献３では、自動操作制御中に、操舵トルクが閾値以上であり、操舵速度も閾値以上のとき、操舵速度を制限する操舵速度制限部を備えている。
【０００４】
【特許文献１】特開２００１−１３８９４１号公報（段落００２７〜００３６、図５）
【特許文献２】特開２００７−３３１４８０号公報（段落００２８〜００３０、図３）
【特許文献３】特開２００７−３２６４５３号公報（段落００１６、図３）
【発明の開示】
【発明が解決しようとする課題】
【０００５】
このような自動操舵制御装置にあっては、電動パワーステアリングのモータを用いた低コスト、低電圧電源のシステムとなるため、電圧飽和が発生しやすい。電圧飽和が発生すると、電流追従誤差が大きくなる課題がある。また、特許文献１のように、車速の制限値を設定していても、運転者が制限値以上の車速で運転すれば電圧飽和が発生する可能性がある。
【０００６】
また、電圧飽和で電流追従誤差および舵角追従誤差が大きくなっている状態で、路面状況の変化により、モータ負荷が軽くなり電圧飽和から開放された時に、その偏差を低減しようとして角速度が急変する課題がある。
【０００７】
また、電圧飽和が発生している時には、電流は最大電流とならないことがあり、特許文献２の構成では、電圧飽和により、自動操舵制御が解除されやすくなる可能性がある。また、特許文献３においても、電圧飽和に対して操舵速度を制限することはできない。
【０００８】
この発明は、上記のような問題点を解決するためになされたものであり、電圧飽和を防止する自動操舵制御装置を得ることを目的としている。
【課題を解決するための手段】
【０００９】
この発明に係る自動操舵制御装置は、転舵輪を転舵するモータと、前記モータの電流を検出するモータ電流検出手段と、前記転舵輪の目標舵角の演算または外部からの受信に基づいて目標舵角を設定する目標舵角設定手段と、前記転舵輪の転舵角を検出する転舵角検出手段と、前記転舵角が前記目標舵角に追従するように前記モータの目標電流を演算してモータを制御するモータ制御手段と備え、前記モータ制御手段は、前記モータ電流検出手段により検出されるモータ電流に基づいてモータ回転速度制限値を設定して前記モータの回転速度を制限することを特徴とする。
【発明の効果】
【００１０】
この発明によれば、モータ電流に基づいてモータ回転速度を直接制限できるため、車速が高くても電圧飽和を防止でき、電流追従誤差を小さくすることができる、といった従来にない顕著な効果を奏するものである。さらに、電圧飽和を防止でき、電流追従誤差を小さくすることができるため、電圧飽和が発生するようなモータ負荷が高い状況から、路面状況の変化等によりモータ負荷が軽くなった時の角度変化を滑らかにすることができる。
【発明を実施するための最良の形態】
【００１１】
実施の形態１．
図１は、この発明の実施の形態１による自動操舵制御装置を示す構成図である。ステアリングホイール１に連結したステアリング軸２の回転に応じて左右の転舵輪３が転舵される。ステアリング軸２には、トルクセンサ４が配置され、ステアリング軸２に作用する操舵トルクを検出する。モータ５は、減速機構６を介してステアリング軸２に連結しており、モータ５が発生するトルクをステアリング軸２に付与することができる。モータ５には、モータ５のロータの回転角度を検出する角度センサ（転舵角検出手段）７が配置されている。車両の車速は車速センサ８で検出される。また、モータ５に流れる電流はモータ電流検出手段としての電流センサ９で検出される。
【００１２】
制御ユニット１０は、モータ制御手段となるもので、転舵輪３を位置制御する自動操舵制御を実行するために必要なモータ５の目標電流である自動操舵用目標電流を演算する自動操舵制御部１０１と、運転者のステアリング操舵をアシストする電動パワーアシスト制御を実施するために必要なモータ５の目標電流である電動パワーアシスト用目標電流を演算する電動パワーアシスト制御部１０２と、電流センサ９で検出した電流が、電動パワーアシスト用目標電流、または、自動操舵用目標電流に一致するようにモータ５の電流を制御する電流制御部１０３を備えている。また、制御ユニット１０は、ＲＯＭ、ＲＡＭを含むメモリを設けたマイコンとモータ電流を駆動する駆動回路から構成される。
【００１３】
目標舵角演算器１１は、目標舵角設定手段となるもので、自動操舵制御時の目標舵角を演算し、演算した目標舵角を制御ユニット１０に送信する。バッテリ電圧センサ１２は、モータ駆動の電源電圧であるバッテリ電圧を検出する。自動操舵制御が実施されておらず、運転者がステアリングホイール１を操作する手動操舵時は、電動パワーアシスト制御部１０２が演算する電動パワーアシスト用目標電流にモータ５の電流が一致するように電流制御部１０３を駆動する。これにより、手動操舵時は、従来の電動パワーステアリングと同等の操舵制御装置となる。
【００１４】
次に、自動操舵について説明する。自動操舵中は、運転者がステアリング操作をしていない状態で、モータ５を用いてステアリング軸２を回転させ、転舵輪３を自動で転舵させる。例えば、駐車時や高速道路を走行中に、運転者が自動操舵を選択すると、目標舵角演算器１１では、車速センサ８で検出した車速等の車両状態量と車両の目標走行軌跡から、車両を目標走行軌跡に追従させるための目標舵角を演算し、制御ユニット１０に演算した目標舵角を送信する。制御ユニット１０の自動操舵制御部１０１は、取得した目標舵角と角度センサ７によって検出されるロータ回転角から、ステアリング軸２が目標舵角に追従するように自動操舵用目標電流を演算し、自動操舵用目標電流を電流制御部１０３に出力する。
【００１５】
自動操舵時は、電流制御部１０３は、自動操舵制御部１０１が演算した自動操舵用目標電流に、モータ５の電流が追従するように電流制御を行う。これにより、運転者が自動操舵を選択した時には、モータ５がステアリング操作を実施されるため、運転者はステアリング操作なしにアクセルやブレーキの操作のみで駐車や高速道路走行が可能になる。
【００１６】
次に、この発明の要部である自動操舵制御部１０１について図２に示すフローチャートで説明する。なお、フローチャートに示す動作は所定時間の制御周期で繰り返し実行される。まず、ステップＳ１において、外部の自動操舵メインコントローラから目標舵角を受信し、メモリに記憶する。ステップＳ２では、角度センサ６で検出した回転角、電流センサ９で検出したモータ電流、バッテリ電圧センサ１２で検出したバッテリ電圧を読み込みメモリに記憶する。
【００１７】
ステップＳ３では、電流センサ９で検出したモータ電流、バッテリ電圧センサ１２で検出したバッテリ電圧からモータ回転速度制限値を演算する。実施の形態１では、モータ５はブラシレスＤＣモータとし、角度センサ７にはレゾルバを用いる。ただし、モータ５と角度センサ７はこの限りではなく、電動パワーステアリング、および、自動操舵に適したものであるならばよい。例えば、モータ７をブラシ付きＤＣモータとしても良く、角度センサをエンコーダとしてもよく、ステアリング軸２に配置した角度センサを用いてもよい。ここで、ブラシレスＤＣモータのｄｑ軸上で表した電圧方程式は式（１）、トルク算出式は式（２）となる。
【００１８】
【数１】
【００１９】
ただし、Ψａ＝√（３／２Ψｆ）であり、Ψｆは永久磁石による電機子鎖交磁束の最大値、Ｖｄ，Ｖｑは電機子電圧のｄｑ軸成分、ｉｄ，ｉｑは電機子電流のｄｑ軸成分、Ｌｄ，Ｌｑはｄｑ軸のインダクタンス、Ｒａは電機子巻線抵抗、ｐ＝ｄ／ｄｔは微分演算子、Ｐｎは極対数、ωは電気角速度である。
【００２０】
ｄｑ軸のインダクタンスＬｄ，Ｌｑが等しい場合、式（２）よりモータ５が発生するトルクはｑ軸電流ｉｑに比例する。定常的な特性として、微分演算子ｐのかかる項を０とすると、式（１）は、式（３）となる。
【００２１】
【数２】
【００２２】
電機子電圧の大きさ√（Ｖｄ２＋Ｖｑ２）の最大値は、モータに給電するバッテリ電圧の大きさに比例するため、バッテリ電圧がほぼ一定値であるとすると、式（３）からモータ回転速度によって発生する誘起電圧によって、ｑ軸電流ｉｑ、すなわちモータ５が発生するトルクが制限されることが分かる。言い換えると、ｑ軸電流ｉｑにより、発生できるモータ回転速度は制限されることになる。よって、例えば、オルタネータが正常に発電してバッテリ電圧がほぼ１４Ｖである場合のモータ電流とモータ回転速度の関係をマップとしてメモリに保存しておき、検出したｑ軸電流ｉｑに対応したモータ回転角速度をモータ回転速度制限値と設定する。ここで、検出したモータ電流の代わりにモータの目標電流から回転速度制限値を設定してもよい。
【００２３】
また、オルタネータの故障等によるバッテリ電圧の変化によって、モータ５に給電する電圧の最大が変化するため、図３に示すように、各バッテリ電圧に対するモータ電流とモータ回転速度制限値の関係をマップとしてメモリに保存しておき、検出したモータ電流と、検出したバッテリ電圧から、対応する回転速度制限値を設定しても良い。この構成とすることで、バッテリ電圧が変化した場合においても、適切に回転速度制限値を設定することができる。
【００２４】
また、電機子電流のｄｑ軸成分ｉｄ、ｉｑ、および、バッテリ電圧から式（３）を用いて、回転速度制限値を演算してもよい。
【００２５】
次に、ステップＳ４では、目標舵角、モータ回転速度制限値から新たな目標舵角２（θｒｅｆ２）を演算する。このステップＳ４の動作を図４のフローチャートに示す。ここでは、目標舵角はステアリング軸換算した転舵輪３の目標舵角θｒｅｆである。また、減速機構６の減速比を考慮してモータ回転角からステアリング軸換算した転舵輪３の転舵角θｐを演算し、モータ回転速度制限値からステアリング軸換算したモータ回転速度制限値
【００２６】
【数３】
【００２７】
を演算する。
【００２８】
図４に示すフローチャートにおいて、ステップＳ２１では、外部の自動操舵メインコントローラから受信した目標舵角と目標舵角２（θｒｅｆ２）の偏差とフローチャートを繰り返し実行するサンプリング時間Ｔｓとから目標舵角速度を演算する。ただし、フローチャートをはじめに実行する時の目標舵角２（θｒｅｆ２）の初期値は転舵輪の転舵角θｐとする。このように、目標舵角２（θｒｅｆ２）の初期値を転舵輪の転舵角θｐとすることで、自動操舵制御実行時に、受信した目標舵角と転舵角に偏差があっても、滑らかな自動操舵制御が実現できる。
【００２９】
ステップＳ２２では、演算した目標舵角速度の絶対値が、ステップＳ３で設定したモータ回転速度制限値
【００３０】
【数４】
【００３１】
より大きい場合、目標舵角速度の大きさをモータ回転速度制限値
【００３２】
【数５】
【００３３】
で制限する。そして、ステップＳ２３では、目標舵角速度を時間積分することで、新たな目標舵角２（θｒｅｆ２）を演算する。
【００３４】
以上の動作により、目標舵角２（θｒｅｆ２）の変化率は、モータ回転速度制限値
【００３５】
【数６】
【００３６】
で制限されているため、目標舵角２（θｒｅｆ２）に転舵角θｐが追従するようにモータ５を制御することで、モータ５の誘起電圧による電圧飽和を防止することができる。
【００３７】
ステップＳ５では、目標舵角２（θｒｅｆ２）に転舵角θｐが追従するために必要なモータ５の目標電流を演算する。図５に、位置制御のブロック線図を示す。ｓはラプラス演算子である。目標舵角２（θｒｅｆ２）と転舵角θｐの偏差にＰＩＤ制御を実施し、自動操舵用目標電流を演算する。Ｋｐは比例ゲイン、Ｋｉは積分ゲイン、Ｋｄは微分ゲインである。
【００３８】
また、図１の電流制御部１０３では、演算された自動操舵用目標電流と電流センサ９にて検出された電流が一致するように電流を制御する。例えば、自動操舵用目標電流と電流センサ９にて検出された電流の偏差から、ＰＷＭ信号などの電圧指令信号を演算し、駆動回路に出力し、モータ５を駆動することにより、角度追従に必要なモータトルクを出力する。
【００３９】
さらに、電流制御部１０３には、自動操舵用目標電流と電流センサ９にて検出された電流の偏差が電流偏差閾値より大きい時、電流制御部１０３の異常を判定する電流制御器異常判定手段を備える。
【００４０】
以上の構成により、特許文献１のように車速の制限値を設定するのではなく、モータ電流に基づいてモータの回転速度を直接制限するため、電圧飽和を確実に防止することができる。よって、モータの電流追従誤差が小さいモータ制御手段を実現することができる。直接モータ速度を制限するため、電圧飽和を確実に防止でき、外部コントローラから目標舵角だけ受信して角度制御するシステムにも対応でき、車体移動量と目標舵角が対応していない場合においても電圧飽和を防止することができる。
【００４１】
また、モータ電流に基づいてモータの回転速度を制限するため、モータ負荷に応じた適切なモータ回転速度制限が実現できる。据え切りのようなモータ負荷が高い状態では、モータ回転速度制限値を低く設定し、車速がある程度出ている場合はモータ負荷が低いため、モータ回転速度制限値を高く設定できる。
【００４２】
さらに、バッテリ電圧を検出し、バッテリ電圧に基づいてモータ回転速度制限値を設定する構成とすることにより、バッテリ電圧が変動した場合においても、電圧飽和を防止できる。
【００４３】
そして、電圧飽和により電流偏差が大きくなっている状態で、路面状況の変化等により、モータ負荷が軽くなり電圧飽和から開放された時に、その偏差を低減しようと、舵角、または舵角速度速が急変する課題について、本実施の形態により、電圧飽和が発生する状況下ではモータ回転速度を制限し電流偏差を小さく抑えられるため、舵角、および、舵角速度速の急変を防止することができる。
【００４４】
さらに、図５に示すように速度制御の有無に関わらず位置制御において、モータ電流に基づいてモータの回転速度を制限することができ、電圧飽和を防止することができる。よって、モータの電流追従誤差が小さいモータ制御手段を実現できる。また、モータの電流追従誤差を小さくできるため、電流制御器異常の判定の電流偏差閾値を小さく設定でき、電流制御異常を早期に判定できる。
【００４５】
尚、モータ制御手段は、図２のフローチャートに示す動作内容を有する自動操舵制御部１０１及び電流制御部１０３に相当する。また、図２に示すフローチャートのステップＳ２からＳ４、または、図５の速度制限器がモータ回転速度制限手段に相当する。
【００４６】
実施の形態２．
この実施の形態２においては、図１に示す実施の形態１と同様な構成を備える。ただし、ここでは、制御ユニット１０内の自動操舵制御部１０１の動作内容を示す図２に示すフローチャートにおいて、実施の形態１との相違点についてのみ説明する。
【００４７】
この実施の形態２では、ステップＳ３において、角度センサ７で検出した回転角度を２階微分し、回転角加速度を演算し、モータロータの慣性モーメントを乗算することでモータの慣性トルクを演算する。次に、演算した慣性トルクをモータのトルク定数（ＰｎΨａ））で除算することで、慣性トルクのモータ電流換算値を演算する。モータ電流から慣性トルクのモータ電流換算値を引算したものを、補正したモータ電流とする。この補正したモータ電流と、図３に示すマップからモータ回転速度制限値を演算する構成とする。すなわち、自動操舵制御部１０１に、転舵輪３の転舵角加速度を演算（または検出）する転舵角加速度検出手段を備えるようにして、モータ電流と転舵角加速度とに基づいてモータ回転速度制限値を設定してモータの回転速度を制限する。
【００４８】
以上の構成とすることで、モータ電流と転舵角加速度に基づいてモータの回転速度を制限するため、電圧飽和を防止し、さらにモータの回転角加速度が大きいときは、速度制限を緩めることができる。よって、モータの加速度が必要な過渡的応答に対しては速度制限されにくくなり、応答性と両立できる。
【００４９】
また、ステップＳ３において、バッテリ電圧も考慮し、マップを変更しても良い。尚、本実施の形態２では、角度センサ７で検出した回転角度を２階微分して回転角加速度を演算したが、この限りではなく、モータの逆起電圧から推定したモータ角速度や、ステアリング軸２に配置した角度センサ７から演算してもよい。
【００５０】
実施の形態３．
この実施の形態３においては、図１に示す実施の形態１と同様な構成を備える。ただし、ここでは、制御ユニット１０内の自動操舵制御部１０１の動作内容を示す図２に示すフローチャートにおいて、ステップＳ４以降の動作が異なる。この実施の形態３のフローチャートを図６に示す。
【００５１】
この実施の形態３では、ステップＳ３４において、目標舵角と転舵角の偏差から目標舵角速度を演算する。Ｋｐｐは比例ゲインである。ステップＳ３５において、演算した目標舵角速度をステップＳ３で演算したモータ回転速度制限値で制限する。
【００５２】
ステップＳ３６では、制限した目標舵角速度と転舵角θｐを微分した転舵角速度
【００５３】
【数７】
【００５４】
との偏差を演算し、その偏差にＰＩ制御を実施し、自動操舵用目標電流を演算する。
【００５５】
この構成により、電圧飽和を確実に防止できる目標舵角速度を設定することができ、電圧飽和による電流誤差増大を防止した位置速度制御が実現できる。
【００５６】
また、電圧飽和により電流偏差が大きくなっている状態で、路面状況の変化等により、モータ負荷が軽くなり電圧飽和から開放された時に、その偏差を低減しようと、舵角、または舵角速度速が急変する課題について、本実施の形態により、電圧飽和が発生する状況下ではモータ回転速度を制限し電流偏差を小さく抑えられるため、舵角、および、舵角速度の急変を防止することができる。
【００５７】
尚、実施の形態３の位置制御の構成において、図５に示すように目標舵角の後に速度制限器を設け、新たな目標舵角２を演算し、位置制御を実施することも当然可能である。
【００５８】
また、この実施の形態３において、モータ制御手段は、図６のフローチャートに示す動作内容を有する自動操舵制御部１０１及び電流制御部１０３に相当する。また、図６に示すフローチャートのステップＳ２からＳ４、または、図５の速度制限器がモータ回転速度制限手段に相当する。
【図面の簡単な説明】
【００５９】
【図１】この発明の実施の形態１による自動操舵制御装置を示す構成図である。
【図２】この発明の実施の形態１による自動操舵制御部１０１の要部の動作内容を示すフローチャートある。
【図３】この発明の実施の形態１によるモータ電流と回転速度制限値のマップである。
【図４】この発明の実施の形態１によるステップＳ４の詳細な内容を示すフローチャートである。
【図５】この発明の実施の形態１による位置制御のブロック図である。
【図６】この発明の実施の形態３による自動操舵制御部１０１の要部の動作内容を示すフローチャートである。
【符号の説明】
【００６０】
１ ステアリングホイール、２ ステアリング軸、３ 転舵輪、４ トルクセンサ、５ モータ、６ 減速機構、７ 角度センサ、８ 車速センサ、９ 電流センサ、１０ 制御ユニット、１１ 目標舵角演算器、１２ バッテリ電圧センサ、１０１ 自動操舵制御部、１０２ 電動パワーアシスト制御部、１０３ 電流制御部。
【特許請求の範囲】
【請求項１】
転舵輪を転舵するモータと、
前記モータの電流を検出するモータ電流検出手段と、
前記転舵輪の目標舵角の演算または外部からの受信に基づいて目標舵角を設定する目標舵角設定手段と、
前記転舵輪の転舵角を検出する転舵角検出手段と、
前記転舵角が前記目標舵角に追従するように前記モータの目標電流を演算して前記モータ５を制御するモータ制御手段と
を備え、
前記モータ制御手段は、前記モータ電流検出手段により検出されるモータ電流に基づいてモータ回転速度制限値を設定して前記モータの回転速度を制限する
ことを特徴とする自動操舵制御装置。
【請求項２】
請求項１に記載の自動操舵制御装置において、
前記モータを駆動する電源電圧であるバッテリ電圧を検出するバッテリ電圧検出手段をさらに備え、
前記モータ制御手段は、前記モータ電流と前記バッテリ電圧とに基づいてモータ回転速度制限値を設定してモータの回転速度を制限する
ことを特徴とする自動操舵制御装置。
【請求項３】
請求項１に記載の自動操舵制御装置において、
前記転舵輪の転舵角加速度を検出または演算する転舵角加速度検出手段をさらに備え、
前記モータ制御手段は、前記モータ電流と前記転舵角加速度とに基づいてモータ回転速度制限値を設定してモータの回転速度を制限する
ことを特徴とする自動操舵制御装置。
【請求項４】
請求項１から３までのいずれか１項に記載の自動操舵制御装置において、
前記モータ制御手段は、前記目標舵角と目標舵角２の前回値とから目標舵角速度を演算し、前記目標舵角速度を前記モータ回転速度制限値で制限し、制限した目標舵角速度から前記目標舵角２を演算し、前記転舵角が前記目標舵角２に追従するようにモータを制御する
ことを特徴とする自動操舵制御装置。
【請求項５】
請求項４に記載の自動操舵制御装置において、
前記モータ制御手段は、自動操舵制御を開始する時に、前記目標舵角２の初期値を前記転舵角に一致させる
ことを特徴とする自動操舵制御装置。
【請求項６】
請求項１から３までのいずれか１項に記載の自動操舵制御装置において、
前記モータ制御手段は、前記目標舵角と前記転舵角に基づいて目標舵角速度を演算すると共に、演算された目標舵角速度を前記モータ回転速度制限値で制限し、かつ前記転舵角に基づいて転舵角速度を演算し、制限した目標舵角速度と前記転舵角速度の偏差から目標電流を演算し、前記転舵角速度が前記目標舵角速度に追従するようにモータを制御する
ことを特徴とする自動操舵制御装置。
【請求項７】
請求項１から６までのいずれか１項に記載の自動操舵制御装置において、
前記モータ制御手段は、前記モータの目標電流と前記モータ電流検出手段により検出されるモータ電流との偏差に基づいて電流制御の異常を判定する
ことを特徴とする自動操舵制御装置。
【請求項１】
転舵輪を転舵するモータと、
前記モータの電流を検出するモータ電流検出手段と、
前記転舵輪の目標舵角の演算または外部からの受信に基づいて目標舵角を設定する目標舵角設定手段と、
前記転舵輪の転舵角を検出する転舵角検出手段と、
前記転舵角が前記目標舵角に追従するように前記モータの目標電流を演算して前記モータ５を制御するモータ制御手段と
を備え、
前記モータ制御手段は、前記モータ電流検出手段により検出されるモータ電流に基づいてモータ回転速度制限値を設定して前記モータの回転速度を制限する
ことを特徴とする自動操舵制御装置。
【請求項２】
請求項１に記載の自動操舵制御装置において、
前記モータを駆動する電源電圧であるバッテリ電圧を検出するバッテリ電圧検出手段をさらに備え、
前記モータ制御手段は、前記モータ電流と前記バッテリ電圧とに基づいてモータ回転速度制限値を設定してモータの回転速度を制限する
ことを特徴とする自動操舵制御装置。
【請求項３】
請求項１に記載の自動操舵制御装置において、
前記転舵輪の転舵角加速度を検出または演算する転舵角加速度検出手段をさらに備え、
前記モータ制御手段は、前記モータ電流と前記転舵角加速度とに基づいてモータ回転速度制限値を設定してモータの回転速度を制限する
ことを特徴とする自動操舵制御装置。
【請求項４】
請求項１から３までのいずれか１項に記載の自動操舵制御装置において、
前記モータ制御手段は、前記目標舵角と目標舵角２の前回値とから目標舵角速度を演算し、前記目標舵角速度を前記モータ回転速度制限値で制限し、制限した目標舵角速度から前記目標舵角２を演算し、前記転舵角が前記目標舵角２に追従するようにモータを制御する
ことを特徴とする自動操舵制御装置。
【請求項５】
請求項４に記載の自動操舵制御装置において、
前記モータ制御手段は、自動操舵制御を開始する時に、前記目標舵角２の初期値を前記転舵角に一致させる
ことを特徴とする自動操舵制御装置。
【請求項６】
請求項１から３までのいずれか１項に記載の自動操舵制御装置において、
前記モータ制御手段は、前記目標舵角と前記転舵角に基づいて目標舵角速度を演算すると共に、演算された目標舵角速度を前記モータ回転速度制限値で制限し、かつ前記転舵角に基づいて転舵角速度を演算し、制限した目標舵角速度と前記転舵角速度の偏差から目標電流を演算し、前記転舵角速度が前記目標舵角速度に追従するようにモータを制御する
ことを特徴とする自動操舵制御装置。
【請求項７】
請求項１から６までのいずれか１項に記載の自動操舵制御装置において、
前記モータ制御手段は、前記モータの目標電流と前記モータ電流検出手段により検出されるモータ電流との偏差に基づいて電流制御の異常を判定する
ことを特徴とする自動操舵制御装置。
【図１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図２】
【図３】
【図４】
【図５】
【図６】
【公開番号】特開２０１０−１０００９１（Ｐ２０１０−１０００９１Ａ）
【公開日】平成２２年５月６日（２０１０．５．６）
【国際特許分類】
【出願番号】特願２００８−２７０９５７（Ｐ２００８−２７０９５７）
【出願日】平成２０年１０月２１日（２００８．１０．２１）
【出願人】（０００００６０１３）三菱電機株式会社 (33,312)
【Ｆターム（参考）】
【公開日】平成２２年５月６日（２０１０．５．６）
【国際特許分類】
【出願日】平成２０年１０月２１日（２００８．１０．２１）
【出願人】（０００００６０１３）三菱電機株式会社 (33,312)
【Ｆターム（参考）】
[ Back to top ]