JP2016159868A - 自動運転装置 - Google Patents

Abstract

【課題】自動運転に関わる制御が不安定になることを抑制すること。
【解決手段】自動運転装置１は、所定周期毎に入力される各種指令値に基づいて、操舵機構７のモータ２１のモータ回転角制御を行うＥＰＳ用マイコン５０、及び車両の状態判定条件に応じて制御系を切り替える自動運転用マイコン３０を備えている。また、自動運転装置１は、操舵機構７に生じる振動を検出する実モータ回転角速度ωｒに所定値以上の振動が重畳しているかを検出する振動検出手段を備えている。そして、自動運転用マイコン３０は、位置制御中において、車両が直進状態且つ振動検出手段がモータ回転角速度に重畳している所定値以上の振動成分を検出した場合、一時的に位置制御部５１を切り離すべく速度制御２の制御系に切り替えるようにした。
【選択図】図４

Description

本発明は、自動運転装置に関するものである。

従来、運転者によるステアリングホイールの操作を必要なしに自動的に操舵機構を操舵することで、車両の自動運転を可能にする自動運転装置がある。自動運転装置では、自動的に操舵機構を操舵するために、目標とするステアリングホイールの操舵角とステアリングホイールの実際の操舵角との偏差を解消するようにフィードバックする位置制御が行われるなかで、操舵機構を操舵するトルクの発生源たるモータに供給する電流が制御されている。

そして、自動運転装置における車両の自動運転中には、ステアリングホイールに意図しない振動を生じることもあり、こうした意図しない振動を抑制することができるようにしたものもある（例えば、特許文献１）。特許文献１では、上記位置制御が行われるなかで、上記偏差に意図しない振動成分を加味した上でモータに供給する電流を制御することとしている。

特開２００３−２３７６０７号公報

ところで、特許文献１では、上記偏差に振動成分を加味することとしているが、こうした振動成分が、例えば、直進時に轍や路面の石等により急な衝撃に起因するとき、目標とする操舵角を定め難いことから上記位置制御だと応答が追い付かず、却って振動を発生させる要因となりうる。もっとも、上記位置制御におけるゲインを高めることでその応答を早くしたとしても、オーバーシュートの発生が多くなって振動を抑制するどころか振動を発生させる要因となりうる。したがって、自動運転に関わる制御が不安定になる懸念があった。

本発明は、このような実情を鑑みてなされたものであり、その目的は、自動運転に関わる制御が不安定になることを抑制することができる自動運転装置を提供することにある。

上記課題を解決する自動運転装置は、所定周期毎に入力される指令状態量に基づいて、操舵機構のモータの状態量制御を行う第１の制御手段、及び車両の状態判定条件に応じて状態量制御を選択する第２の制御手段を備える。また、第１の制御手段は、 モータを含む操舵機構のアクチュエータの位置制御部、速度制御部、及び電流制御部から構成される第１の構成手段と、操舵機構のアクチュエータの速度制御部、及び電流制御部から構成される第２の構成手段と、操舵機構のアクチュエータの電流制御部から構成される第３の構成手段の３つの構成手段を有する。また、第２の制御手段は、車両の状態判定条件に応じて、状態量制御として第１の構成手段、第２の構成手段、又は第３の構成手段を選択するとともに、所定周期毎に入力される指令状態量を生成する。またさらに、自動運転装置は、モータの回転角を検出するモータ回転角検出手段と、モータの回転角を微分してモータ回転角速度を演算するモータ回転角速度演算手段と、前記モータ回転角速度に所定値以上の振動成分が重畳しているかを検出する振動検出手段を更に備える。そして、第２の構成手段は、状態量制御として第１の構成手段の選択中における指令状態量の変化幅が所定範囲内であって、さらに振動検出手段にて所定値以上の振動成分が検出された場合には、一時的に位置制御部を切り離すべく前記状態量制御を第２の構成手段に切り替える。

一般に、自動運転装置における位置制御部では比例制御（所謂、Ｐ制御）が行われるとともに、速度制御部では比例制御にさらに積分制御（動作）や微分制御（動作）を加えた制御（所謂、ＰＩＤ制御）が行われる。すなわちこの場合、速度制御部では、位置制御部よりも応答が早いということが言える。

そして、上記構成のように、操舵機構への車両の振動が、モータ回転角速度に所定値以上の振動成分を重畳するなかでモータの状態量制御が位置制御部を切り離した状態での速度制御部によって行われるとき、それまでの位置制御部を通じた状態量制御よりも応答が早い状態量制御が行われることとなる。すなわちこの場合、例えば、操舵機構への振動として、直進時に轍や路面の石等により急な衝撃に起因した振動が生じているとき、制御自体が振動を発生させる要因になることなく状態量制御を行うことができる。

もっとも、一時的でも位置制御部を切り離してしまうとき、指令状態量に基づく状態量制御ができないこととなる。その点、上記構成によれば、一時的に位置制御部が切り離されるのは、指令状態量の変化幅が所定範囲内であって、指令状態量に基づく状態量制御の必要性が比較的に低い場面であることとしている。すなわちこの場合、指令状態量に基づく状態量制御ができないにもかかわらず、車両の自動運転への影響を最小限に止めることができる。

したがって、上記のように構成された自動運転装置では、自動運転に関わる制御が不安定になることを抑制することができる。
また、上記自動運転装置において、第１の制御手段は、第２の構成手段の選択中における速度制御部を、振動検出手段が検出するモータ回転角速度に重畳している所定値以上の振動成分を抑制する振動抑制制御を行う振動抑制部に接続することが好ましい。

上記構成によれば、振動検出手段でモータ回転角速度に重畳している所定値以上の振動成分が検出されるとき、こうした振動成分の抑制が積極的に行われることとなる。すなわち、位置制御部による状態量制御が行われる場合よりも応答が早いなかで、振動検出手段で検出されるモータ回転角速度に重畳している所定値以上の振動成分を好適に抑制することができる。

このように振動を抑える方法として具体的には、振動抑制部は、振動検出手段が検出するモータ回転角速度に重畳している所定値以上の振動成分を分析する振動分析部と、振動分析部の分析結果に基づき振動検出手段が検出するモータ回転角速度に重畳している所定値以上の振動成分に対して逆相の速度をモータに発生させるための指令状態量を速度制御部に出力する指令状態量出力部と、を有することが好ましい。

本発明によれば、自動運転に関わる制御が不安定になることを抑制することができる。

自動運転装置の概略を示す図。 自動運転装置における自動運転ＥＣＵの制御構成を示すブロック図。 自動運転装置におけるＥＰＳＥＣＵの制御構成を示すブロック図。 自動運転用マイコンの処理手順を示すフローチャート。

以下、電動パワーステアリング装置（以下、「ＥＰＳ」という）を備えた自動運転装置の一実施形態を説明する。
図1に示すように、車両には、運転者のステアリング操作を補助する電動パワーステアリング装置（以下、「ＥＰＳ」という）を有する自動運転装置１が搭載される。ＥＰＳは、運転者のステアリング操作に基づいて転舵輪１２、１２を転舵させる操舵機構７、運転者のステアリング操作を補助する操舵力補助装置としてのＥＰＳアクチュエータ２０、及びＥＰＳアクチュエータ２０の作動を制御するＥＰＳＥＣＵ２８を備える。

操舵機構７は、運転者により操作されるステアリングホイール２、及びステアリングホイール２と一体回転するステアリングシャフト３を備える。ステアリングシャフト３は、ステアリングホイール２の中心に連結されたコラムシャフト８、コラムシャフト８の下端部に連結されたインターミディエイトシャフト９、及びインターミディエイトシャフト９の下端部に連結されたピニオンシャフト１０からなる。ピニオンシャフト１０の下端部は、ピニオンシャフト１０に交わる方向へ延びるラック軸５（正確にはラック歯４が形成された部分）に噛合される。したがって、ステアリングシャフト３の回転運動は、ピニオンシャフト１０、及びラック軸５からなる、ラックアンドピニオン機構６によりラック軸５の往復直線運動に変換される。こうした往復直線運動が、ラック軸５の両端にそれぞれ連結されたタイロッド１１を介して左右の転舵輪１２、１２にそれぞれ伝達されることにより、これら転舵輪１２、１２の転舵角が変更される。

ＥＰＳアクチュエータ２０は、コラム型のＥＰＳアクチュエータであり、アシスト力の発生源であるモータ２１を備える。モータ２１としては、ブラシレスモータなどが採用される。モータ２１は、減速機構２２を介してコラムシャフト８に連結される。減速機構２２は、モータ２１の回転を減速し、当該減速した回転力をコラムシャフト８に伝達する。すなわち、ステアリングシャフト３にモータ２１のトルクがアシスト力（操舵補助力）として付与されることにより、運転者のステアリング操作が補助される。

また、本実施形態の自動運転装置１は、所定周期毎に生成する指令状態量としての自動運転指令操舵角データθｓ*に基づいて操舵機構７のモータ２１の状態量制御、すなわちモータ回転角制御を行う。自動運転装置１は、自動運転指令操舵角データθｓ*を車内ネットワーク９０（ＣＡＮ）を介して、ＥＰＳＥＣＵ２８に所定周期毎に送信する上位コントローラである自動運転ＥＣＵ２９を備える。

ＥＰＳＥＣＵ２８、及び自動運転ＥＣＵ２９は、車両に設けられる各種のセンサの検出結果を運転者の要求あるいは走行状態を示す情報として取得し、これら取得される各種の情報に応じて上記モータ回転角制御を行う。すなわち、ＥＰＳＥＣＵ２８には、モータ回転角検出手段であるモータ回転角度センサ２３が接続される。また、自動運転ＥＣＵ２９には、カーナビ等のＧＰＳ２４、車速センサ２５、及び操舵角センサ２６が接続される。

モータ回転角度センサ２３は、モータ２１に設けられてモータ２１の実モータ回転角度θｒを検出する。ＧＰＳ２４は、車両の上位位置情報θconを検出する。車速センサ２５は、車速ＳＰを検出する。操舵角センサ２６は、磁気式の回転角センサであって、コラムシャフト８に設けられて操舵角θｓを検出する。

次に、自動運転装置１における電気的構成について、詳しく説明する。
図２に示すように、自動運転ＥＣＵ２９は、ＧＰＳ２４で検出される上位位置情報θcon、車速センサ２５で検出される車速ＳＰ、及び操舵角センサ２６で検出される操舵角θｓをそれぞれ入力とする。なお、その他、自動運転ＥＣＵ２９は、自動運転モード切替判定部３３（速度制御１）の有効無効を判定する判定信号（速度制御）や、自動運転モード切替判定部３４（電流制御）の有効無効を判定する判定信号（電流制御）も入力とする。

そして、自動運転ＥＣＵ２９は、上記各種入力に基づき指令状態量である自動運転指令操舵角データθｓ*、自動運転指令操舵速度データωｓ１*、自動運転指令モータ電流データＩｒ１*、及び振動抑制時自動運転指令操舵速度データωｓ２*を車内ネットワーク９０（ＣＡＮ）を介して、ＥＰＳＥＣＵ２８に送信する。またさらに、自動運転ＥＣＵ２９は、自動運転モード切替フラグＦＬＧ１（速度制御１）、自動運転モード切替フラグＦＬＧ２（電流制御）、及び自動運転モード切替フラグＦＬＧ３（速度制御２）を車内ネットワーク９０（ＣＡＮ）を介して、ＥＰＳＥＣＵ２８に送信する。

ここで、自動運転ＥＣＵ２９の各機能について、詳しく説明する。
自動運転ＥＣＵ２９は、マイクロプロセッシングユニット等からなる第２の制御手段としての自動運転用マイコン３０を備える。自動運転用マイコン３０は、車速ＳＰ、及び上位位置情報θconに基づき最適な自動運転指令操舵角データθｓ*を生成する自動運転指令操舵角度データθｓ*生成部３１を有する。

なお、自動運転用マイコン３０は、上位ＥＣＵよりの判定信号（速度制御）に基づき自動運転車両異常フラグＦＬＧＡＢ１（ＯＮにて異常：速度制御１）のＯＮ、及びＯＦＦを切り替えることで、自動運転指令操舵角度データθｓ*生成部３１の機能の停止（ＦＬＧＡＢ１＝ＯＮ）、及び継続（ＦＬＧＡＢ１＝ＯＦＦ）を切り替える自動運転モード切替判定部３３（速度制御１）を有する。これにより、状態判定条件である車両における異常が想定される自動運転車両異常に陥ったとき、自動運転車両異常フラグＦＬＧＡＢ１をＯＮにして、一時的に位置制御部５１（後述する比例制御）を切り離す。

すなわちこの場合、自動運転用マイコン３０は、自動運転モード切替フラグＦＬＧ１（速度制御１）を自動運転モード切替指令部３５（速度制御１）からＥＰＳＥＣＵ２８へ出力するとともに、最適な指令状態量である自動運転指令操舵速度データωｓ１*を自動運転指令操舵速度データωｓ１*生成部３６で生成する。

またさらに、自動運転用マイコン３０は、自動運転指令操舵速度データωｓ１*生成部３６で生成した自動運転指令操舵速度データωｓ１*を自動運転指令操舵速度データωｓ１*出力部３７を介して、ＥＰＳＥＣＵ２８へ出力する。これにより、モータ回転角制御の制御系として、後述する速度制御部５３、及び電流制御部５５がアクティブとなる速度制御の制御系（第２の構成手段）が選択され、これによる速い制御周期（後述する比例制御＋積分制御＋微分制御）によって指令値（指令状態量）に対して、モータ回転角制御が早く追従できるようになる。

また、自動運転用マイコン３０は、上位ＥＣＵよりの判定信号（電流制御）に基づき、自動運転車両異常フラグＦＬＧＡＢ２（ＯＮにて異常：電流制御）のＯＮ、及びＯＦＦを切り替えることで、自動運転指令操舵角度データθｓ*生成部３１の機能の停止（ＦＬＧＡＢ２＝ＯＮ）、及び継続（ＦＬＧＡＢ２＝ＯＦＦ）を切り替える自動運転モード切替判定部３４（電流制御）を有する。これにより、状態判定条件である車両における異常が想定される自動運転車両異常に陥ったとき、自動運転車両異常フラグＦＬＧＡＢ２をＯＮにして、一時的に位置制御部５１（後述する比例制御）を切り離す。

すなわちこの場合、自動運転用マイコン３０は、自動運転モード切替フラグＦＬＧ２（電流制御）を自動運転モード切替指令部３８（電流制御）からＥＰＳＥＣＵ２８へ出力するとともに、最適な指令状態量である自動運転指令モータ電流データＩｒ１*を自動運転指令モータ電流データＩｒ１*生成部３９で生成する。またさらに、自動運転用マイコン３０は、自動運転指令モータ電流データＩｒ１*生成部３９で生成した自動運転指令モータ電流データＩｒ１*を自動運転指令モータ電流データＩｒ１*出力部４０を介して、ＥＰＳＥＣＵ２８へ出力する。これにより、モータ回転角制御の制御系として、後述する電流制御部５５のみがアクティブとなる電流制御の制御系（第３の構成手段）が選択され、これによる速い制御周期（後述する比例制御＋積分制御＋微分制御）によって指令値（指令状態量）に対して、モータ回転角制御が早く追従できるようになる。

一方、自動運転用マイコン３０は、自動運転指令操舵角度データθｓ*生成部３１において、車速ＳＰ、及び上位位置情報θconの入力後、自動運転車両異常フラグＦＬＧＡＢ１がＯＦＦ、且つ自動運転車両異常フラグＦＬＧＡＢ２がＯＦＦの場合、車両、及び路面状態を正常と判断して、所定周期毎に自動運転指令操舵角度データθｓ*を生成する。すなわちこの場合、モータ回転角制御の制御系として、後述する位置制御部５１、速度制御部５３、及び電流制御部５５がアクティブとなる位置制御の制御系（第１の構成手段）が選択される。またさらに、自動運転用マイコン３０は、生成した自動運転指令操舵角度データθｓ*を、自動運転指令操舵角度データθｓ*出力部３２を介して、ＥＰＳＥＣＵ２８へ出力する。なお、自動運転指令操舵角度データθｓ*は、自動運転指令操舵角度データθｓ*出力部３２を介して、自動運転指令操舵速度データωｓ１*生成部３６や自動運転指令モータ電流データＩｒ１*生成部３９、またさらに後述する振動検出手段である振動判定部４１aに対しても出力される。

また、自動運転用マイコン３０は、車両の走行状態、及び車両の振動状態に基づき自動運転車両異常フラグＦＬＧＡＢ１のＯＮ、及びＯＦＦを切り替えることで、自動運転指令操舵角度データθｓ*生成部３１の機能の停止（ＦＬＧＡＢ１＝ＯＮ）、及び継続（ＦＬＧＡＢ１＝ＯＦＦ）を切り替える自動運転モード切替判定部（速度制御１）を有する。

こうした車両の走行状態としては、車両の直進状態が操舵角θｓと、自動運転指令操舵角データθｓ*の直近指令値（θｓ（ｎ）*）、及びそれのさらに直近指令値（θｓ（ｎ−１）*）に基づく指令偏差値Δθｓ*とから特定される。またこうした振動状態としては、轍や路面の石等により急な衝撃に起因した車両の操舵機構７への振動の発生が実モータ回転速度ωｒから特定される。

自動運転用マイコン３０は、状態判定条件である車両が直進状態、且つ操舵機構７への振動の発生を判断する場合、自動運転車両異常フラグＦＬＧＡＢ１をＯＮにして、一時的に位置制御部５１（後述する比例制御）を切り離す。

すなわちこの場合、自動運転用マイコン３０は、自動運転モード切替フラグＦＬＧ３（速度制御２）を自動運転モード切替指令部４２（速度制御２）からＥＰＳＥＣＵ２８へ出力するとともに、最適な指令状態量である振動抑制時自動運転指令操舵速度データωｓ２*を振動抑制部４６で生成し、ＥＰＳＥＣＵ２８へ出力する。そして、モータ回転角制御の制御系として、速度制御部５３と電流制御部５５がアクティブとなる速度制御２の制御系（第２の構成手段）が選択され、これによる速い制御周期（後述する比例制御＋積分制御＋微分制御）によって指令値（指令状態量）に対して、モータ回転角制御が早く追従できるようになる。

振動抑制部４６は、振動検出手段である振動判定部４１aでの判断に用いられる実モータ回転速度ωｒに基づき振動の位相等を分析する振動分析部４３を有する。また、振動抑制部４６は、振動分析部４３での分析の結果に応じて、発生している振動を打ち消しうる速度をモータ２１に発生可能にする振動抑制時自動運転指令操舵速度データωｓ２*を生成する振動抑制時自動運転指令操舵速度データωｓ２*生成部４４を有する。こうした振動抑制時自動運転指令操舵速度データωｓ２*として、振動抑制時自動運転指令操舵速度データωｓ２*生成部４４は、振動分析部４３で分析された振動に対して、逆相となる速度を発生させるためのデータを生成することとなる。なお、振動抑制部４６は、振動抑制フラグＦＬＧＡＢ３（ＯＮにて異常：速度制御２）がＯＮされているとき、振動抑制時自動運転指令操舵速度データωｓ２*を生成する。

また、振動抑制部４６は、振動抑制時自動運転指令操舵速度データωｓ２*生成部４４で生成した振動抑制時自動運転指令操舵速度データωｓ２*をＥＰＳＥＣＵ２８へ出力する指令状態量出力部としての振動抑制時自動運転指令操舵速度データωｓ２*出力部４５を有する。一方、自動運転用マイコン３０は、車両が直進状態且つ操舵機構７への振動の発生を判断しない場合、振動抑制フラグＦＬＧＡＢ３をＯＮしないで、それまでの自動運転を継続する。

また、図３に示すように、ＥＰＳＥＣＵ２８は、自動運転ＥＣＵ２９より車内ネットワーク９０（ＣＡＮ）を介して送信されてくる、指令状態量である自動運転指令操舵角データθｓ*、自動運転指令操舵速度データωｓ１*、自動運転指令モータ電流データＩｒ１*、及び振動抑制時自動運転指令操舵速度データωｓ２*をそれぞれ入力する。そして、ＥＰＳＥＣＵ２８は、モータ２１を回転させるモータ回転制御指令を生成し、モータ２１に出力する。

またさらに、ＥＰＳＥＣＵ２８は、車内ネットワーク９０（ＣＡＮ）を介して送信されてくる、各自動運転モード切替フラグＦＬＧ１（速度制御１）、自動運転モード切替フラグＦＬＧ２（電流制御）、及び自動運転モード切替フラグＦＬＧ３（速度制御２）をそれぞれ入力する。そして、ＥＰＳＥＣＵ２８は、各自動運転モード切替フラグＦＬＧ１（速度制御１）、自動運転モード切替フラグＦＬＧ２（電流制御）、及び自動運転モード切替フラグＦＬＧ３（速度制御２）に応じてその時にアクティブにされる制御部による制御系にてモータ回転角制御を制御する。

次に、ＥＰＳＥＣＵ２８の各機能について、詳しく説明する。
ＥＰＳＥＣＵ２８は、マイクロプロセッシングユニット等からなる第１の制御手段としてのＥＰＳ用マイコン５０と、モータ２１の実モータ電流Ｉｒを検出する電流センサ６１と、ＰＷＭ信号に基づきモータ２１へ駆動電力を供給するように駆動するインバータ回路等の駆動回路部５７とを備える。

ＥＰＳ用マイコン５０は、自動運転モード切替フラグＦＬＧ１（速度制御１）、自動運転モード切替フラグＦＬＧ２（電流制御）、及び自動運転モード切替フラグＦＬＧ３（速度制御２）の入力に応じた制御系を構成する、位置制御部５１、速度制御部５３、及び電流制御部５５と、各制御系を通じて生成されたモータ回転制御指令をＰＷＭ信号として出力するＰＷＭ出力部５６を有する。

また、ＥＰＳ用マイコン５０は、自動運転モード切替フラグＦＬＧ１（速度制御１）、又は自動運転モード切替フラグＦＬＧ３（速度制御２）を入力（ＯＮ）するとき、位置制御部５１の切り離し、速度制御部５３、及び電流制御部５５がアクティブにされる制御系への切り替えを行う自動運転モード切替部５２（速度制御）を有する。また、ＥＰＳ用マイコン５０は、自動運転モード切替フラグＦＬＧ２（電流制御）を入力（ＯＮ）するとき、位置制御部５１の切り離し、電流制御部５５のみがアクティブにされる制御系への切り替えを行う自動運転モード切替部５４（電流制御）を有する。

また、ＥＰＳ用マイコン５０は、所定周期で入力する自動運転指令操舵角データθｓ*、自動運転指令操舵速度データωｓ１*、及び振動抑制時自動運転指令操舵速度データωｓ２*を、所定の変換係数を用いて操舵角θｓに関わる情報から実モータ回転角度θｒに関わる情報にそれぞれ変換する操舵角／モータ回転角度変換器５９、操舵速度／モータ回転速度変換器１（６０a）、及び操舵速度／モータ回転速度変換器２（６０ｂ）を有する。操舵角／モータ回転角度変換器５９は、自動運転指令操舵角データθｓ*を自動運転指令モータ回転角度データθｒ*に変換する。また、操舵速度／モータ回転速度変換器１（６０a）は、自動運転指令操舵速度データωｓ１*を自動運転指令モータ回転速度データωｒ１*に変換する。さらにまた、操舵速度／モータ回転速度変換器２（６０ｂ）は、振動抑制時自動運転指令操舵速度データωｓ２*を振動抑制時自動運転指令モータ回転速度データωｒ２*に変換する。

ここで、位置制御部５１、速度制御部５３、及び電流制御部５５の機能について、自動運転モード切替部５２（速度制御）、及び自動運転モード切替部５４（電流制御）の機能と合わせて、さらに詳しく説明する。

位置制御部５１は、操舵角／モータ回転角度変換器５９で変換される自動運転指令モータ回転角度データθｒ*と、その時にモータ回転角度センサ２３で検出される実モータ回転角度θｒとを位置減算器７０が減算して得られるモータ回転角度偏差値Δθｒを入力する。またさらに、位置制御部５１は、モータ回転角度偏差値Δθｒを入力すると、比例制御（Ｐ制御）を行い、位置制御部より生成された指令モータ回転速度データωｒ０*を生成し、該位置制御部より生成された指令モータ回転速度データωｒ０*を自動運転モード切替部５２（速度制御）のa接点５２a に対して出力する。

自動運転モード切替部５２（速度制御）は、入力用の接点として、a接点５２a 、ｂ接点５２ｂ、及びｃ接点５２ｃ、出力用の接点としてｄ接点５２ｄを有する。こうした自動運転モード切替部５２（速度制御）において、a接点５２a には、上述したように位置制御部より生成された指令モータ回転速度データωｒ０*が入力される一方、ｂ接点５２ｂには、自動運転ＥＣＵ２９より車内ネットワーク９０（ＣＡＮ）を介して送信されてくる自動運転指令モータ回転速度データωｒ１*が入力される。さらにまた、ｃ接点５２ｃには、自動運転ＥＣＵ２９より車内ネットワーク９０（ＣＡＮ）を介して送信されてくる振動抑制時自動運転指令モータ回転速度データωｒ２*が入力される。

そして、自動運転モード切替部５２（速度制御）は、自動運転モード切替フラグＦＬＧ１（速度制御１）、及び自動運転モード切替フラグＦＬＧ３（速度制御２）が入力されていないとき、a接点５２a とｄ接点５２ｄとを接続することで、位置制御部５１から入力する位置制御部より生成された指令モータ回転速度データωｒ０*を出力する。一方、自動運転モード切替部５２（速度制御）は、自動運転モード切替フラグＦＬＧ１（速度制御１）が入力されているとき、ｂ接点５２ｂとｄ接点５２ｄとを接続することで、自動運転ＥＣＵ２９より車内ネットワーク９０（ＣＡＮ）を介して送信された自動運転指令操舵速度データωｓ１*に基づく自動運転指令モータ回転速度データωｒ１*を出力する。他方、自動運転モード切替部５２（速度制御）は、自動運転モード切替フラグＦＬＧ３（速度制御２）が入力されているとき、ｃ接点５２ｃとｄ接点５２ｄとを接続することで、自動運転ＥＣＵ２９より車内ネットワーク９０（ＣＡＮ）を介して送信された振動抑制時自動運転指令モータ回転速度データωｒ２*を出力する。

速度制御部５３は、自動運転モード切替部５２（速度制御）が出力する各自動運転指令モータ回転速度データωｒ０*、ωｒ１*、ωｒ２*のいずれかと、その時にモータ回転角度センサ２３で検出される実モータ回転角度θｒをモータ回転角速度演算手段である微分器５８で微分して得られる実モータ回転速度ωｒとを速度減算器７１が減算して得られるモータ回転速度偏差値Δωｒを入力する。またさらに、速度制御部５３は、モータ回転速度偏差値Δωｒを入力すると、比例制御＋積分制御＋微分制御（ＰＩＤ制御）を行い、速度制御部より生成された指令モータ電流データＩｒ０*を生成し、該速度制御部より生成された指令モータ電流データＩｒ０*を自動運転モード切替部５４（電流制御）のa接点５４aに対して出力する。

自動運転モード切替部５４（電流制御）は、入力用の接点として、a接点５４a 、及びｂ接点５４ｂ、出力用の接点としてｃ接点５４ｃを有する。こうした自動運転モード切替部５４（電流制御）において、a接点５４a には、上述したように速度制御部より生成された指令モータ電流データＩｒ０*が入力される一方、ｂ接点５４ｂには、自動運転ＥＣＵ２９より車内ネットワーク９０（ＣＡＮ）を介して送信されてくる自動運転指令モータ電流データＩｒ１*が入力される。

そして、自動運転モード切替部５４（電流制御）は、自動運転モード切替フラグＦＬＧ２（電流制御）が入力されていないとき、a接点５４a とｃ接点５４ｃとを接続することで、速度制御部より生成された指令モータ電流データＩｒ０*を出力する。一方、自動運転モード切替部５４（電流制御）は、自動運転モード切替フラグＦＬＧ２（電流制御）が入力されているとき、ｂ接点５４ｂとｃ接点５４ｃとを接続することで、自動運転ＥＣＵ２９より車内ネットワーク９０（ＣＡＮ）を介して送信された自動運転指令モータ電流データＩｒ１*を出力する。

電流制御部５５は、自動運転モード切替部５４（電流制御）が出力する各自動運転指令モータ電流データＩｒ０*、Ｉｒ１*のいずれかと、その時に電流センサ６１で検出される実モータ電流Ｉｒとを電流減算器７２が減算して得られるモータ電流偏差値ΔＩｒを入力する。またさらに、電流制御部５５は、モータ電流偏差値ΔＩｒを入力すると、比例制御＋積分制御＋微分制御（ＰＩＤ制御）を行い、モータ電圧指令Ｖ*を生成し、該モータ電圧指令Ｖ*をＰＷＭ出力部５６に出力する。そして、ＰＷＭ出力部５６は、駆動回路部５７を駆動させるためのモータ制御信号Ｓｒを生成し、該モータ制御信号Ｓｒを駆動回路部５７に対して出力する。

次に、アクティブにされる制御系の切り替えにおいて、特に自動運転モード切替フラグＦＬＧ３（速度制御２）の出力にかかる自動運転ＥＣＵ２９における自動運転用マイコン３０の処理手順を説明する。

図４に示すように、自動運転用マイコン３０は、自動運転車両異常フラグＦＬＧＡＢ１（ＯＮにて異常：速度制御１）がＯＦＦ、且つ自動運転車両異常フラグＦＬＧＡＢ２（ＯＮにて異常：電流制御）がＯＦＦである位置制御中である、又は振動抑制フラグＦＬＧＡＢ３（ＯＮにて異常：速度制御２）がＯＮである速度制御２中であるか否かを自動運転モード切替判定部４１（速度制御２）にて判定する（ステップＳ１０１）。ステップＳ１０１にて、位置制御中又は速度制御２中のいずれでもないとき（ステップＳ１０１：ＮＯ）、自動運転用マイコン３０は、これまでの制御系による制御を継続させ、自動運転指令操舵角度データθｓ*生成部にて最適な指令状態量である自動運転指令操舵角データθｓ*を生成する。

一方、ステップＳ１０１にて、位置制御中又は速度制御２中のいずれかであるとき（ステップＳ１０１：ＹＥＳ）、自動運転用マイコン３０は、操舵角θｓ、及び指令偏差値Δθｓ*に基づき車両が直進状態であるか否かを自動運転モード切替判定部４１（速度制御２）にて判定する（ステップＳ１０２）。ステップＳ１０２にて、自動運転モード切替判定部４１（速度制御２）は、操舵角θｓの変化幅が閾値αの正負の範囲内（操舵角θｓの絶対値が閾値α以下）であるか否かと、指令偏差値Δθｓ*の変化幅が閾値βの正負の範囲内（指令偏差値Δθｓ*の絶対値が閾値β以下）であるか否かとを判定する。

そして、自動運転モード切替判定部４１（速度制御２）は、操舵角θｓ、及び指令偏差値Δθｓ*の各変化幅がそれぞれ閾値の正負の範囲内（操舵角θｓの絶対値が閾値α以下且つ指令偏差値Δθｓ*の絶対値が閾値β以下）であるときに車両が直進状態であることを判定する。閾値αは、操舵角θｓが操舵中点（車両が直進することとなる操舵角）であるとして経験的に導かれる値に設定される。

続いて、ステップＳ１０２にて、車両が直進状態であるとき（ステップＳ１０２：ＹＥＳ）自動運転用マイコン３０は、実モータ回転速度ωｒに所定値以上の振動成分が重畳しているか否かを自動運転モード切替判定部４１（速度制御２）における振動検出手段である振動判定部４１aにて判定する（ステップＳ１０３）。ステップＳ１０３にて、振動判定部４１aは、振動の強さ（振幅の大きさや、振動の長さ等）が所定の閾値を超えるか否かを判定し、振動の強さが所定の閾値を超える場合、操舵機構７への振動の発生を判定する。所定の閾値は、操舵機構７への振動として運転者が不快に思うとして経験的に導かれる値に設定される。

ステップＳ１０３にて、操舵機構７に振動が発生しているとき（ステップＳ１０３：ＹＥＳ）、自動運転用マイコン３０は、自動運転モード切替判定部４１（速度制御２）を通じて振動抑制フラグＦＬＧＡＢ３（ＯＮにて異常：速度制御２）をＯＮする（ステップＳ１０４）。またさらに、ステップＳ１０４にて、自動運転用マイコン３０は、速度制御２中となるように、自動運転モード切替判定部４１（速度制御２）を通じて自動運転モード切替フラグＦＬＧ３（速度制御２）をＥＰＳＥＣＵ２８に対して出力する。その後、自動運転用マイコン３０は、振動抑制部４６において、振動分析部４３の分析結果に基づき振動抑制時自動運転指令操舵速度データωｓ２*生成部４４にて最適な指令状態量である振動抑制時自動運転指令操舵速度データωｓ２*を生成し、指令状態量出力部である振動抑制時自動運転指令操舵速度データωｓ２*出力部４５を通じて振動抑制時自動運転指令操舵速度データωｓ２*をＥＰＳＥＣＵ２８へ出力する。

一方、ステップＳ１０２にて、車両が直進状態でないとき（ステップＳ１０２：ＮＯ）、又は操舵機構７に振動が発生していないとき（ステップＳ１０３：ＮＯ）、自動運転用マイコン３０は、位置制御中となるよう制御する（ステップＳ１０５）。すなわちこの場合、自動運転用マイコン３０は、そもそも位置制御中であれば該位置制御中を継続する一方、そもそも速度制御２中であれば振動抑制フラグＦＬＧＡＢ３（ＯＮにて異常：速度制御２）をＯＦＦして位置制御中となるように、その旨を示す情報をＥＰＳＥＣＵ２８に対して出力する。その後、自動運転用マイコン３０は、自動運転指令操舵角度データθｓ*生成部３１にて最適な指令状態量である自動運転指令操舵角データθｓ*を生成する。

以上に説明した自動運転装置１によれば、以下の（１）〜（３）に示す作用及び効果を奏する。
（１）図３に示すように、自動運転モード切替フラグＦＬＧ３（速度制御２）がＯＮされるとき、自動運転モード切替部５２（速度制御）には、指令状態量である自動運転指令操舵角データθｓ*に関わる位置制御部より生成された指令モータ回転速度データωｒ０*、及び自動運転指令モータ回転速度データωｒ１*の代わりに、振動抑制部４６により生成される振動抑制時自動運転指令モータ回転速度データωｒ２*が入力される。すなわちこの場合、自動運転モード切替部５２（速度制御）は、操舵機構７に発生している振動の分析に基づく振動抑制時自動運転指令モータ回転速度データωｒ２*を出力する。

続いて、速度制御部５３は、操舵機構７に発生している振動の分析に基づく指令モータ回転速度データωｒｒ*（この場合は、振動抑制時自動運転指令モータ回転速度データωｒ２*と等価）と、実モータ回転速度ωｒとを速度減算器７１が減算して得られる、操舵機構７に発生している振動を抑制するためのモータ回転速度偏差値Δωｒを入力する。またさらに、速度制御部５３は、モータ回転速度偏差値Δωｒを入力すると、速度制御部より生成された指令モータ電流データＩｒ０*を電流減算器７２に出力する。電流減算器７２は、指令モータ電流データＩｒｒ*（この場合は、速度制御部より生成された指令モータ電流データＩｒ０*と等価）から電流センサ６１で検出される実モータ電流Ｉｒを減算し、モータ電流偏差値ΔＩｒを出力する。そして、電流減算器７２から出力されたモータ電流偏差値ΔＩｒは、電流制御部５５に入力され、電流制御部５５は、操舵機構７に発生している振動を抑制するためのモータ電圧指令Ｖ*を生成し、該モータ電圧指令Ｖ*をＰＷＭ出力部５６に出力する。そして、ＰＷＭ出力部５６は、操舵機構７に発生している振動を抑制するように、駆動回路部５７を駆動させるためのモータ制御信号Ｓｒを生成し、該モータ制御信号Ｓｒを駆動回路部５７に対して出力することとなる。

したがって、自動運転モード切替フラグＦＬＧ３（速度制御２）がＯＮされるとき、ＥＰＳ用マイコン５０は、振動分析部の分析結果に基づき振動検出手段が検出するモータ回転角速度に重畳している所定値以上の振動成分に対して逆相の速度をモータ２１によって発生させるように、モータ回転角制御を行うこととなる。

このように、車両が直進状態においてモータ回転角速度に重畳している所定値以上の振動成分が検出されるなかでモータ回転角制御が位置制御部５１を切り離した状態での速度制御部５３によって行われるとき、それまでの位置制御部５１を通じたモータ回転角制御よりも応答が早い（４倍程早い制御周期にて）モータ回転角制御が行われることとなる。すなわちこの場合、操舵機構７への振動として、車両の直進状態時に轍や路面の石等により急な衝撃に起因した振動が生じているとき、制御自体が振動を発生させる要因になることなくモータ回転角制御を行うことができる。

もっとも、一時的でも位置制御部５１を切り離してしまうとき、自動運転指令操舵角データθｓ*に基づくモータ回転角制御ができないこととなる。その点、車両が直進状態にあるとき、位置制御中であれば、自動運転指令操舵角データθｓ*の変化、すなわちモータ回転角度偏差値Δθｒが比較的小さく、モータ回転角制御自体の必要性が比較的に低い場面ということとなる。

そこで、本実施形態では、一時的に位置制御部５１が切り離されるのは、車両が直進状態であると判定する場面であって、自動運転指令操舵角データθｓ*に基づくモータ回転角制御の必要性が比較的に低い場面であることとしている。すなわちこの場合、自動運転指令操舵角データθｓ*に基づくモータ回転角制御ができないにもかかわらず、車両の自動運転への影響を最小限に止めることができる。

したがって、上記のように構成された自動運転装置１では、自動運転に関わる制御が不安定になることを抑制することができる。
（２）また、図２に示すように、実モータ回転速度ωｒに所定値以上の振動が重畳しているかを検出する振動検出手段で車両の振動が検出されることで、自動運転モード切替フラグＦＬＧ３（速度制御２）がＯＮされるとき、速度制御部５３と振動抑制部４６とが接続される制御系をなし、こうした振動の抑制が振動抑制部４６によって積極的に行われることとなる。すなわち、位置制御部５１によるモータ回転角制御が行われる場合よりも応答が早い（４倍程早い制御周期の）なかで、振動検出手段で検出される車両の振動を好適に抑制することができる。

（３）またさらに、上述したように、一時的に位置制御部５１が切り離されることとなる車両が直進状態にあるとき、操舵角θｓの変化が少なく操舵（ステアリング操作）による振動が比較的に少ないこととなる。すなわちこの場合、操舵角θｓが連続的に変化される操舵の最中であることから操舵による振動が比較的に多いときよりも、振動検出手段で検出される車両の振動として検出され易くすることができる。したがって、振動検出手段で検出されるモータ回転角速度に重畳している所定値以上の振動成分を好適に抑制することができる。

なお、本実施形態は以下のように変更してもよい。
・自動運転モード切替フラグＦＬＧ３（速度制御２）をＯＮする過程において、ステップＳ１０２では、少なくとも指令偏差値Δθｓ*の変化幅が閾値βの正負の範囲内（指令偏差値Δθｓ*の絶対値が閾値β以下）であるか否かを判定すればよい。車両が直進状態にない場合であっても、自動運転指令操舵角データθｓ*の変化、すなわちモータ回転角度偏差値Δθｒが比較的に小さければ、モータ回転角制御自体の必要性が比較的に低い場面ということができ上記実施形態と同等の効果を奏しうる。

・自動運転モード切替フラグＦＬＧ３（速度制御２）をＯＮする過程において、ステップＳ１０２では、閾値αや閾値を０（零）に定めるように、該ステップＳ１０２の判定に対して幅を持たせないで構成することもできる。

・本実施形態の自動運転装置１は、振動抑制部４６を備えないで構成してもよい。この場合、例えば、自動運転モード切替フラグＦＬＧ３（速度制御２）がＯＮされるとき、振動抑制時自動運転指令モータ回転速度データωｒ２*としては、直近の指令値（自動運転指令操舵角データθｓ*に基づく指令値）を継続的に指令することで、該直近の指令値に対して、モータ回転角制御が早く追従できるようになる。したがって、轍や路面の石等により急な衝撃に起因した車両の操舵機構７への振動が発生していても、位置制御部５１を通じたモータ回転角制御よりも応答が早い（４倍程早い制御周期にて）モータ回転角制御が行われることで、自動運転に関わる制御が不安定になることが抑制される。

・自動運転モード切替フラグＦＬＧ３（速度制御２）のＯＮ及びＯＦＦの切り替えについては、運転者による手動切替によって行われるようにしてもよい。
・本実施形態では、実モータ回転速度ωｒに所定値以上の振動が重畳しているかを検出する振動検出手段によって操舵機構７への振動を検討するようにしたが、ヨーレートセンサで、操舵機構７への振動を抑制するようにしてもよい。

・実モータ回転角度θｒは、操舵角θｓを、所定の変換係数を用いて操舵角θｓに関わる情報から実モータ回転角度θｒに関わる情報にそれぞれ変換して用いることもできる。またさらに、こうして変換された実モータ回転角度θｒから実モータ回転速度ωｒを得ることもできる。

・ＥＰＳ用マイコン５０では、自動運転指令操舵角データθｓ*を入力するとき、まず自動運転指令操舵角データθｓ*と操舵角θｓとを減算して操舵角度偏差値Δθｓを得た後、操舵角／モータ回転角度変換器５９により該操舵角度偏差値Δθｓをモータ回転角度偏差値Δθｒに変換するようにしてもよい。

・位置制御の制御系と、速度制御１の制御系と、電流制御の制御系のそれぞれの切り替えについて、その条件を変更してもよい。例えば、速度制御１の制御系は、ヨーレートＹＲや横Ｇ（車両横加速度）に基づき切り替えられるようにしてもよい。

・本実施形態では、自動運転用マイコン３０及びＥＰＳ用マイコン５０の２個のマイコンを用いて具体化したが、これらの機能を兼ね備えた１個のマイコン（第１の制御手段及び第２の制御手段）で具体化してもよい。

・本実施形態では、自動運転装置１をコラムアシストＥＰＳに具体化したが、自動運転装置１をラックアシストＥＰＳやピニオンアシストＥＰＳに適用してもよい。
・ＥＰＳアクチュエータ２０の駆動源であるモータ２１として、誘導モータやステッピングモータ等、その種類を問わず採用することができる。

１：自動運転装置、２：ステアリングホイール、３：ステアリングシャフト、
４：ラック歯、５：ラック軸、６：ラックアンドピニオン機構、７：操舵機構、
８：コラムシャフト、９：インターミディエイトシャフト、
１０：ピニオンシャフト、１１：タイロッド、１２：転舵輪、
２０：ＥＰＳアクチュエータ（操舵力補助装置）、２１：モータ、
２２：減速機構、２３：モータ回転角度センサ（モータ回転角検出手段）、
２４：ＧＰＳ、２５：車速センサ、２６：操舵角センサ、
２８：ＥＰＳＥＣＵ、２９：自動運転ＥＣＵ、
３０：自動運転用マイコン（第２の制御手段）、
３１：自動運転指令操舵角度データθｓ*生成部、
３２：自動運転指令操舵角度データθｓ*出力部、
３３：自動運転モード切替判定部（速度制御１）、
３４：自動運転モード切替判定部（電流制御）、
３５：自動運転モード切替指令部（速度制御１）、
３６：自動運転指令操舵速度データωｓ１*生成部、
３７：自動運転指令操舵速度データωｓ１*出力部、
３８：自動運転モード切替指令部（電流制御）、
３９：自動運転指令モータ電流データＩｒ１*生成部、
４０：自動運転指令モータ電流データＩｒ１*出力部、
４１：自動運転モード切替判定部（速度制御２）、
４１a：振動判定部（振動検出手段）、
４２：自動運転モード切替指令部（速度制御２）、４３：振動分析部、
４４：振動抑制時自動運転指令操舵速度データωｓ２*生成部、
４５：振動抑制時自動運転指令操舵速度データωｓ２*出力部（指令状態量出力部）、
４６：振動抑制部、５０：ＥＰＳ用マイコン（第１の制御手段）、
５１：位置制御部（Ｐ制御）、５２：自動運転モード切替部（速度制御）、
５２a：自動運転モード切替部a接点、５２ｂ：自動運転モード切替部ｂ接点、
５２ｃ：自動運転モード切替部ｃ接点、５２ｄ：自動運転モード切替部ｄ接点、
５３：速度制御部（ＰＩＤ制御）、５４：自動運転モード切替部（電流制御）、
５４a：自動運転モード切替部a接点、５４ｂ：自動運転モード切替部ｂ接点、
５４ｃ：自動運転モード切替部ｃ接点、５５：電流制御部（ＰＩＤ制御）、
５６：ＰＷＭ出力部、５７：駆動回路部、
５８：微分器（モータ回転角速度演算手段）、５９：操舵角／モータ回転角度変換器、
６０a：操舵速度／モータ回転速度変換器１、
６０ｂ：操舵速度／モータ回転速度変換器２、６１：電流センサ、
７０：位置減算器、７１：速度減算器、７２：電流減算器、
９０：車内ネットワーク（ＣＡＮ）、
ＳＰ：車速、θｓ：操舵角、θcon：上位位置情報（ＧＰＳ、カーナビ等）、
θｒ：実モータ回転角度、θｓ*：自動運転指令操舵角データ（指令状態量）、
Δθｓ*:指令偏差値、Δθｓ：操舵角度偏差値、
θｒ*：自動運転指令モータ回転角度データ、Δθｒ：モータ回転角度偏差値、
ωｓ１*：自動運転指令操舵速度データ（指令状態量）、
ωｒ０*：位置制御部より生成された指令モータ回転速度データ、
ωｒ１*：自動運転指令モータ回転速度データ、
ωｒ２*：振動抑制時自動運転指令モータ回転速度データ、
ωｒｒ*：指令モータ回転速度データ、
ωｓ２*：振動抑制時自動運転指令操舵速度データ（指令状態量）、
ωｒ：実モータ回転速度、Δωｒ：モータ回転速度偏差値、
Ｉｒ０*：速度制御部より生成された指令モータ電流データ、
Ｉｒ１*：自動運転指令モータ電流データ（指令状態量）、
Ｉｒｒ*：指令モータ電流データ、
Ｉｒ：実モータ電流、ΔＩｒ：モータ電流偏差値、
Ｖ*：モータ電圧指令、Ｓｒ：モータ制御信号、
ＦＬＧ１：自動運転モード切替フラグ（速度制御１）、
ＦＬＧ２：自動運転モード切替フラグ（電流制御）、
ＦＬＧ３：自動運転モード切替フラグ（速度制御２）、
ＦＬＧＡＢ１：自動運転車両異常フラグ（ＯＮにて異常：速度制御１）、
ＦＬＧＡＢ２：自動運転車両異常フラグ（ＯＮにて異常：電流制御）、
ＦＬＧＡＢ３：振動抑制フラグ（ＯＮにて異常：速度制御２）。

Claims (3)

1. 所定周期毎に入力される指令状態量に基づいて、操舵機構のモータの状態量制御を行う第１の制御手段、及び車両の状態判定条件に応じて前記状態量制御を選択する第２の制御手段を備え、
   前記第１の制御手段は、
   前記モータを含む操舵機構のアクチュエータの位置制御部、速度制御部、及び電流制御部から構成される第１の構成手段と、
   前記操舵機構のアクチュエータの速度制御部、及び電流制御部から構成される第２の構成手段と、
   前記操舵機構のアクチュエータの電流制御部から構成される第３の構成手段の３つの構成手段を有し、
   前記第２の制御手段は、車両の状態判定条件に応じて、前記状態量制御として前記第１の構成手段、前記第２の構成手段、又は前記第３の構成手段を選択するとともに、前記所定周期毎に入力される指令状態量を生成する自動運転装置において、
   前記モータの回転角を検出するモータ回転角検出手段と、
   前記モータの回転角を微分してモータ回転角速度を演算するモータ回転角速度演算手段と、
   前記モータ回転角速度に所定値以上の振動成分が重畳しているかを検出する振動検出手段を更に備え、
   前記第２の構成手段は、前記状態量制御として前記第１の構成手段の選択中における前記指令状態量の変化幅が所定範囲内であって、さらに前記振動検出手段にて所定値以上の振動成分が検出された場合には、一時的に前記位置制御部を切り離すべく前記状態量制御を前記第２の構成手段に切り替えること、
   を特徴とする自動運転装置。
2. 前記第１の制御手段は、前記第２の構成手段の選択中における前記速度制御部を、前記振動検出手段が検出するモータ回転角速度に重畳している所定値以上の振動成分を抑制する振動抑制制御を行う振動抑制部に接続する請求項１に記載の自動運転装置。
3. 前記振動抑制部は、
   前記振動検出手段が検出するモータ回転角速度に重畳している所定値以上の振動成分を分析する振動分析部と、
   前記振動分析部の分析結果に基づき前記振動検出手段が検出するモータ回転角速度に重畳している所定値以上の振動成分に対して逆相の速度を前記モータに発生させるための指令状態量を前記速度制御部に出力する指令状態量出力部と、を有する請求項２に記載の自動運転装置。

Images