JP4148022B2 - 車両用操舵制御装置 - Google Patents
車両用操舵制御装置 Download PDFInfo
- Publication number
- JP4148022B2 JP4148022B2 JP2003144892A JP2003144892A JP4148022B2 JP 4148022 B2 JP4148022 B2 JP 4148022B2 JP 2003144892 A JP2003144892 A JP 2003144892A JP 2003144892 A JP2003144892 A JP 2003144892A JP 4148022 B2 JP4148022 B2 JP 4148022B2
- Authority
- JP
- Japan
- Prior art keywords
- steering
- vehicle
- sensitivity
- control device
- steering control
- 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
- Steering Control In Accordance With Driving Conditions (AREA)
- Power Steering Mechanism (AREA)
Description
【０００１】
【発明の属する技術分野】
この発明は、自車両が目標経路に沿って追従走行するように自動操舵を行う車両用操舵制御装置に関する。
【０００２】
【従来の技術】
従来の車両用操舵制御装置としては、既知の経路に対して車両位置を逐次照合しつつ、目標経路をトレースする技術が考案されている。例えば、高速域や急カーブにおける適切な制御を目的として、車速が大きいほど制御量が減少するよう制御ゲインを変更する方法や、目標経路の曲率半径が大きいほど制御量が減少するよう制御ゲインを変更する方法等が知られている（特許文献１参照）。
【０００３】
【特許文献１】
特開平１０−１６７０９８号公報
【０００４】
【発明が解決しようとする課題】
しかしながら、上記従来の車両用操舵制御装置にあっては、交差点等の道路半径が小さい個所等を徐行により走行する場合、経路に対する誤差補正のための操舵として、左右フル転舵に近い状態でハンドルを切ることが繰り返されるため、ドライバに違和感を与えるという問題があった。
【０００５】
これは、一般的に、高速域から低速域まで自動操舵を行う場合、操舵に対する車両の応答が低速である程鈍くなるため、経路誤差に対する操舵ゲインは低速であるほど大きく設定する必要があることに起因している。
【０００６】
本発明は、上記問題に着目してなされたもので、その目的とするところは、低速域において大きな修正舵が繰り返されることに起因する違和感の発生を防止できる車両用操舵制御装置を提供することにある。
【０００７】
【課題を解決するための手段】
上記目的を達成するため、本発明にあっては、前方注視点において自車両が通過する際の基準経路との横偏差に応じて操舵量を算出することで、自車両を基準経路に沿って走行させる車両用操舵制御装置において、自車両を走行させる基準経路を検出する基準経路検出手段と、自車速を検出する車速検出手段と、検出された基準経路における所定時間もしくは所定距離前方の前方注視点を設定する前方注視点設定手段と、設定された前方注視点における基準経路に対する横偏差を検出する横偏差検出手段と、検出された横偏差に応じた操舵量を算出する際の操舵感度を設定する操舵感度設定手段と、設定された操舵感度に基づいて操舵量を算出する操舵量算出手段と、検出された車速が予め設定された設定車速以下であるとき、設定された操舵感度を低下させる操舵感度低下手段と、を設けたことを特徴とする。
【０００８】
【発明の効果】
本発明の車両用操舵制御装置にあっては、操舵感度低下手段は、車速が予め設定された設定車速よりも小さいとき、操舵感度を低下させるため、低速域において大きな修正舵の繰り返しに起因する違和感の発生を防止でき、適切な操舵制御を実施できる。
【０００９】
【発明の実施の形態】
以下、本発明の車両用操舵制御装置を実現する実施の形態を、図面に示す第１実施例に基づいて説明する。
【００１０】
（第１実施例）
まず、構成を説明する。
図１は、第１実施例の車両用操舵制御装置を示すシステム構成図であり、図中、１ＦＬ、１ＦＲ、１ＲＬおよび１ＲＲはそれぞれ左前輪、右前輪、左後輪および右後輪であり、後輪１ＲＬおよび１ＲＲは、エンジン２の駆動力が自動変速機３、プロペラシャフト４、最終減速装置５および車軸６を順に介して伝達される駆動輪である。
【００１１】
また、前輪１ＦＬおよび１ＦＲは、ステアリングギヤ７、ステアリングシャフト８を介してステアリングホイール９に連結された操舵輪であり、ステアリングシャフト８には、電動モータで構成された操舵アクチュエータ１０が連結されている。この操舵アクチュエータ１０は、後述するコントローラ１６から出力される操舵制御量δＣに応じて、前輪１ＦＬおよび１ＦＲの操舵方向、操舵角、および操舵速度を制御するように構成されている。
【００１２】
また、各車輪１ＦＬ〜１ＲＲには、車輪の回転速度に応じた周波数の車輪速ＶＦＬ〜ＶＲＲを出力する車輪速センサ１１ＦＬ〜１１ＲＲが配設されている。さらに、車両には、前後加速度Ｘｇを検出する前後加速度センサ１２と、横加速度Ｙｇを検出する横加速度センサ１３と、ヨーレートφを検出するヨーレートセンサ１７とが備えられている。
【００１３】
また、車両には、人工衛星から送られる衛星電波を受信して現在の自車位置を検出するＧＰＳ１４と、所定領域の道路地図情報を記憶したＣＤ−ＲＯＭやＤＶＤ−ＲＯＭ等の記憶媒体がセットされた記憶ユニット１５（道路半径算出手段および道路幅検出手段に相当）とが搭載されている。
【００１４】
これら、各車輪速センサ１１ＦＬ〜１１ＲＲで検出する車輪速ＶＦＬ〜ＶＲＲと、前後加速度センサ１２で検出される前後加速度Ｘｇと、横加速度センサ１３で検出される横加速度Ｙｇと、ヨーレートセンサ１７で検出されるヨーレートφと、ＧＰＳ１４で検出された自車位置情報と、記憶ユニット１５に記憶された道路地図情報とが、例えばマイクロコンピュータで構成されたコントローラ１６に入力される。このコントローラ１６では、図２の操舵制御処理を常時実行することで前述した操舵アクチュエータ１０に対する操舵制御量δＣの出力を制御し、自動操舵により自車両を基準経路に沿って走行させるように構成されている。
【００１５】
次に、作用を説明する。
［操舵制御処理］
図２は、コントローラ１６において実行される操舵制御処理の流れを示すフローチャートである。この処理は、図示せざるオペレーティングシステムで一定時間毎に定時割り込み遂行される。
【００１６】
ステップＳ１０１では、ＧＰＳ１４で検出された自車位置に従って、記憶ユニット１５に記憶された道路地図情報を読み込み、道路地図情報を構成するノードデータ（Ｘ，Ｙ）のうち、図３に示すように、自車位置を基準とし前後に所定距離だけとった範囲（Ｘo，Ｙo）〜（Ｘn，Ｙn）を常時バッファに保有し、ステップＳ１０２へ移行する（基準経路検出手段に相当）。ここで、前方側の距離は、例えば、車速Ｖに所定時間ｔ１を乗じた値（＝Ｖ・ｔ１）、または、予め設定した最小値のうち大きい方に設定する。
【００１７】
ステップＳ１０２では、各種センサから出力される各車輪速ＶＦＬ〜ＶＲＲと、前後加速度Ｘｇと、横加速度Ｙｇと、ヨーレートφとを読み込み、ステップＳ１０３へ移行する。
【００１８】
ステップＳ１０３では、各車輪速ＶＦＬ〜ＶＲＲの平均から車速Ｖを算出し、ステップＳ１０４へ移行する（車速検出手段に相当）。
【００１９】
ステップＳ１０４では、図４に示すＦＢ前方注視時間算出マップを参照し、ステップＳ１０３において算出された車速Ｖから、フィードバック（以下ＦＢ）制御用のＦＢ前方注視時間Ｔ_fbを設定し、ステップＳ１０５へ移行する。算出マップは、図４に示すように、横軸が車速Ｖを、縦軸がＦＢ前方注視時間Ｔ_fbを表している。
【００２０】
ステップＳ１０５では、ステップＳ１０４で算出されたＦＢ前方注視時間Ｔ_fbからＦＢ前方注視点Ｐ_fbを算出し、ステップＳ１０６へ移行する。具体的には、ステップＳ１０４において算出されたＦＢ前方注視時間Ｔ_fbに車速Ｖを乗じることにより、ＦＢ前方注視時間Ｔ_fbが経過する間に自車両が進む距離Ｄ_fb（＝Ｔ_fb・Ｖ）を算出し、現在の自車位置から距離Ｄ_fb分だけ進んだ地点における最寄りのノードを前方注視点Ｐ_fbとして設定する（前方注視点設定手段に相当）。
【００２１】
ステップＳ１０６では、ステップＳ１０５において算出されたＦＢ前方注視点Ｐ_fbを自車両が通過するときの基準経路に対する横偏差ＹＥを算出し、ステップＳ１０７へ移行する（横偏差検出手段に相当）。
【００２２】
横偏差ＹＥは、自車両の車両姿勢から求まる横偏差ＹＳと、車両旋回状態から求まる横偏差ＹＰとを加算して算出する。
【００２３】
車両のスリップ角θＳは、前後加速度Ｘｇおよび横加速度Ｙｇを用いて下記の式(1)のように表される。
θＳ＝tan−１（Ｙｇ／Ｘｇ） …(1)
【００２４】
また、図５に示すような基準座標上における自車両のヨー角をε１、第２前方注視点Ｐ２を通り速度ベクトルＶに直角な直線Ｃと基準経路との交点Ｑにおける基準座標に対する基準経路のずれ角をεＴとすると、基準経路に対する自車両のヨー角εＲは、下記の式(2)のように表すことができる。
εＲ＝εＴ−ε１ …(2)
【００２５】
さらに、初期状態における基準経路と自車位置との横偏差をＹＵとしたとき、車両姿勢に応じた横偏差ＹＳは下記の式(3)のように表されるので、この式に従って、ＹＵ、Ｄ２、εＲおよびθＳから車両姿勢に応じた横偏差ＹＳを算出する。
ＹＳ＝ＹＵ＋Ｄ_fb・tan（εＲ＋θＳ） …(3)
【００２６】
次に、車両が定常円旋回を行っている場合を想定すると、スリップレートを無視することができるので、車両旋回状態から求まる横偏差ＹＰは、下記の式(4)で表すことができる。
ＹＰ＝Ｄ_fb・tanβ …(4)
なお、この式中のβは、下記の式(5)で表すことができる。
β＝１／２・sin−１（Ｄ_fb・ε１／Ｘｇ） …(5)
【００２７】
したがって、式(4)，(5)から車両旋回状態に応じた横偏差ＹＰを算出し、これに式(3)により算出された横偏差ＹＳを加算することにより、基準経路に対する横偏差ＹＥ（＝ＹＳ＋ＹＰ）を算出できる。
【００２８】
ステップＳ１０７では、ステップＳ１０６において算出された横偏差ＹＥから指令操舵角を算出するための操舵ゲイン（操舵感度）Ｋsを設定し、ステップＳ１０８へ移行する（操舵感度設定手段に相当）。
【００２９】
自然法則として車両の構造が同一であれば、運動は低速であるほど操舵に対する応答が低下する。よって、誤差修正能力を維持するためには、誤差（横偏差）ＹＥを修正するための操舵角を決定する操舵ゲインＫsを大きく設定する。
【００３０】
しかしながら、交差点等で車速Ｖを極低速に落として走行するとき、操舵ゲインＫsが大きな値に保たれている場合には、ドライバが操舵する場合と反して左右に大操舵による修正操舵が繰り返される。
【００３１】
こうした領域においては、多少の誤差を許容することでスムーズで違和感のない操舵を行うために、図６に示すように、車速Ｖがある車速Ｖ１以下の領域では操舵ゲインＫsを低下させる（操舵感度低下手段に相当）。これにより、スムーズで違和感のない操舵が可能となる。
【００３２】
さらに、この際に設定するＦＢ前方注視時間Ｔ_fbは、図７に示すように、ある車速Ｖ２を境にして大きくなるようにしても良い（前方注視点調節手段に相当）。この際、図６のＶ１と図７のＶ２との関係は、Ｖ１＞Ｖ２となるように設定すると良いが、これを規定するものではない。
【００３３】
このように、車速Ｖの低下に応じて前方注視点Ｐ_fbを延長することにより、車両の将来のヨー角誤差に対する操舵感度を高めたことになり、将来誤差を小さくすることに重みを置くことで過度な操舵が行われないようにするものである。
【００３４】
また、図２に示したフローチャート内の図、および図６は車速Ｖ１に対して操舵ゲインＫｓを規定した場合の説明であるが、道路半径Ｒに応じて操舵ゲインＫsを設定しても良い。
【００３５】
例えば、図８に示すように、ある道路半径（第１設定半径）Ｒ１以下となった場合に、操舵ゲインＫsを低下させる（操舵感度低下手段に相当）。また、図９に示すようなマップ形状としても良い。
【００３６】
さらに、図８もしくは図９のように操舵ゲインＫsを設定した場合に、FB前方注時間Ｔ_fbを図１０のように設定しても良い（前方注視点調節手段に相当）。このとき、Ｒ２（第２設定半径）＜Ｒ１となるように設定すると良いが、これを規定するものではない。
【００３７】
このように、道路半径Ｒの減少に応じて前方注視点Ｐ_fbを延長することによって、車両の将来のヨー角誤差に対する操舵感度を高めたことになり、将来誤差を小さくすることに重みを置くことで過度な操舵が行われないようにするものである。
【００３８】
ここで、操舵ゲインＫｓは、車速Ｖに応じて設定された操舵ゲインＫs_velと、道路半径Ｒに応じて設定された操舵ゲインＫs_radiusのうち、小さい方を最終的に使用する操舵ゲインＫsとして選択するようにしても良い。また、前方注視時間Ｔ_fbに関しては、車速Ｖに応じて設定されたＦＢ前方注視時間Ｔ_fbと道路半径Ｒに応じて設定されたＦＢ前方注視時間Ｔ_fbのうち、長い方を選択するようにしても良い。
【００３９】
なお、ここまでのプロセスで算出された操舵ゲインＫsは、道路幅によって道路幅が広い場合に操舵ゲインＫsを低下する量を大きめにする図１１のような補正係数Ｋs_hoseiを用いて、下記の式(6)のように補正しても良い。
Ｋs＝Ｋs×Ｋs_hosei …(6)
【００４０】
また、同様に前方注視時間Ｔ_fbについては、図１２のような補正をかけることで、道路幅が太い場合により将来の車両のヨー角を重視するにするようにしても良い。
前方注視時間Ｔ_fb＝前方注視時間Ｔ_fb×前方注視時間Ｔ_fb_hosei …(7)
【００４１】
以上により最終的な操舵ゲインＫｓと前方注視点Ｐ_fbとが決定されるが、さらに、車両がこのように多少の誤差を許容しスムーズな操舵を行うかどうか、もしくは操舵ゲインＫsを高く保つかどうかを、周囲の障害物の状況に応じて選択するようにする。
【００４２】
特に、経路上正面以外の側方の障害物がレーザレーダ（障害物検出手段）などにより一定距離以下で検出されている場合には、図１３のように操舵ゲインＫsを低下させない。なお、障害物を検知しなくとも、ＧＰＳ１４により市街路を走行している場合、もしくはコントローラ１６より障害物回避状況である旨の指令が与えられた場合などにおいても同様に図１３のゲインマップを選択するようにする（道路半径に応じた操舵ゲインＫsも障害物の検出等がされている場合には操舵ゲインＫsを低下させないように選択するものとする）。
【００４３】
図２のフローチャートに戻り、ステップＳ１０８では、下記の式(8)から横変位ＹＥを修正するための操舵量δfbを算出する（操舵量算出手段に相当）。
δfb＝Ｋs・ＹＥ＋Ｋd・（dＹＥ／dt） …(8)
ここで、ＫsおよびＫdは係数であり、直線走行時の外乱に対して追従誤差が経路から逸脱する程拡大しないよう、最適な値を実験から求めることが望ましい。
【００４４】
なお、最終的な操舵指令δcomは、下記の式(9)に示すように、上記の前方注視点誤差を修正するための操舵δfbに、走行中の道路半径に基づき決定したフィードフォワード（以下ＦＦ）制御による操舵量δffを加算した値となる。
δcom＝δfb+δff …(9)
【００４５】
ステップＳ１０９では、ステップＳ１０８において算出された操舵制御量δcomを操舵アクチュエータ１０に出力し、本制御を終了する。
【００４６】
すなわち、車速Ｖがある車速Ｖ１以下の低速域で操舵ゲインＫsを低下させるため、大きな修正舵が繰り返し行われることなくスムーズで違和感のない操舵が可能となる。
【００４７】
車速Ｖがある車速Ｖ２（Ｖ１＞Ｖ２）以下のとき、車速Ｖの減少に応じてFB前方注視時間Ｔ_fbを延長し、FB前方注視点Ｐ_fbを大きくするため、車両の将来のヨー角誤差に対する操舵ゲインＫsが高められ、将来誤差を小さくすることに重みを置くことで過度な操舵を防止できる。よって、大きな修正舵が繰り返されず、適切な操舵が実施される。
【００４８】
道路半径Ｒがある道路半径Ｒ１以下のとき、操舵ゲインＫsを低下するため、大きな修正舵が繰り返し行われることなく適切な操舵が行われる。
【００４９】
道路半径Ｒがある道路半径Ｒ２以下のとき、道路半径Ｒの減少に応じてFB前方注視時間Ｔ_fbを延長し、FB前方注視点Ｐ_fbを大きくするため、車両の将来のヨー角誤差に対する操舵ゲインＫsが高められ、将来誤差を小さくすることに重みを置くことで過度な操舵を防止できる。よって、大きな修正舵が繰り返されず、適切な操舵が実施される。
【００５０】
操舵ゲインＫsを低下させる度合いを道路幅に応じて設定するため、広い道路で多少の誤差の拡大が許容できる場合には大きな修正舵が繰り返し行われることなく、よりスムーズで適切な操舵が可能となる。
【００５１】
車速Ｖに応じて設定した操舵ゲインＫs_velと、道路半径Ｒに応じて設定した操舵ゲインＫs_radiusのうち、低い方を選択するため、車速Ｖと道路半径Ｒの双方に応じて最適な操舵ゲインＫsとFB前方注視時間Ｔ_fbが設定されるので、大きな修正舵が繰り返し行われることなく、よりスムーズで適切な操舵が可能となる。
【００５２】
車速Ｖもしくは道路半径Ｒに応じて操舵ゲインＫsを低下させるか否かを、周囲障害物の有無によって選択するため、障害物回避動作等で追従誤差を小さくしたい場合に対応しつつ、大きな修正操舵が繰り返し行われることなく、よりスムーズで適切な操舵が可能となる。
【００５３】
以上、本発明の車両用操舵制御装置を第１実施例に基づき説明してきたが、具体的な構成については、この第１実施例に限られるものではなく、特許請求の範囲の各請求項に係る発明の要旨を逸脱しない限り、設計の変更や追加等は許容される。
【図面の簡単な説明】
【図１】第１実施例の車両用操舵制御装置を示すシステム構成図である。
【図２】コントローラにおいて実行される操舵制御処理の流れを示すフローチャートである。
【図３】ＦＢ前方注視点の算出方法を示す説明図である。
【図４】ＦＢ前方注視時間算出マップである。
【図５】ＦＢ前方注視点における誤差の算出方法を示す説明図である。
【図６】車速に応じた操舵ゲイン設定マップである。
【図７】車速に応じたＦＢ前方注視点設定マップである。
【図８】道路半径に応じた操舵ゲイン設定マップである。
【図９】道路半径に応じた操舵ゲイン設定マップである。
【図１０】道路半径に応じたＦＢ前方注視点設定マップである。
【図１１】道路幅に応じたゲイン補正係数設定マップである。
【図１２】道路幅に応じたＦＢ前方注視点補正係数設定マップである。
【図１３】障害物検出時における車速に応じた操舵ゲイン設定マップである。
【符号の説明】
１ＦＬ 左前輪
１ＦＲ 右前輪
１ＲＬ 左後輪
１ＲＲ 右後輪
２ エンジン
３ 自動変速機
４ プロペラシャフト
５ 最終減速装置
６ 車軸
７ ステアリングギヤ
８ ステアリングシャフト
９ ステアリングホイール
１０ 操舵アクチュエータ
１１ＦＬ 左前輪車輪速センサ
１１ＦＲ 右前輪車輪速センサ
１１ＲＬ 左後輪車輪速センサ
１１ＲＲ 右後輪車輪速センサ
１２ 前後加速度センサ
１３ 横加速度センサ
１４ ＧＰＳ
１５ 記憶ユニット
１６ コントローラ
１７ ヨーレートセンサ
【発明の属する技術分野】
この発明は、自車両が目標経路に沿って追従走行するように自動操舵を行う車両用操舵制御装置に関する。
【０００２】
【従来の技術】
従来の車両用操舵制御装置としては、既知の経路に対して車両位置を逐次照合しつつ、目標経路をトレースする技術が考案されている。例えば、高速域や急カーブにおける適切な制御を目的として、車速が大きいほど制御量が減少するよう制御ゲインを変更する方法や、目標経路の曲率半径が大きいほど制御量が減少するよう制御ゲインを変更する方法等が知られている（特許文献１参照）。
【０００３】
【特許文献１】
特開平１０−１６７０９８号公報
【０００４】
【発明が解決しようとする課題】
しかしながら、上記従来の車両用操舵制御装置にあっては、交差点等の道路半径が小さい個所等を徐行により走行する場合、経路に対する誤差補正のための操舵として、左右フル転舵に近い状態でハンドルを切ることが繰り返されるため、ドライバに違和感を与えるという問題があった。
【０００５】
これは、一般的に、高速域から低速域まで自動操舵を行う場合、操舵に対する車両の応答が低速である程鈍くなるため、経路誤差に対する操舵ゲインは低速であるほど大きく設定する必要があることに起因している。
【０００６】
本発明は、上記問題に着目してなされたもので、その目的とするところは、低速域において大きな修正舵が繰り返されることに起因する違和感の発生を防止できる車両用操舵制御装置を提供することにある。
【０００７】
【課題を解決するための手段】
上記目的を達成するため、本発明にあっては、前方注視点において自車両が通過する際の基準経路との横偏差に応じて操舵量を算出することで、自車両を基準経路に沿って走行させる車両用操舵制御装置において、自車両を走行させる基準経路を検出する基準経路検出手段と、自車速を検出する車速検出手段と、検出された基準経路における所定時間もしくは所定距離前方の前方注視点を設定する前方注視点設定手段と、設定された前方注視点における基準経路に対する横偏差を検出する横偏差検出手段と、検出された横偏差に応じた操舵量を算出する際の操舵感度を設定する操舵感度設定手段と、設定された操舵感度に基づいて操舵量を算出する操舵量算出手段と、検出された車速が予め設定された設定車速以下であるとき、設定された操舵感度を低下させる操舵感度低下手段と、を設けたことを特徴とする。
【０００８】
【発明の効果】
本発明の車両用操舵制御装置にあっては、操舵感度低下手段は、車速が予め設定された設定車速よりも小さいとき、操舵感度を低下させるため、低速域において大きな修正舵の繰り返しに起因する違和感の発生を防止でき、適切な操舵制御を実施できる。
【０００９】
【発明の実施の形態】
以下、本発明の車両用操舵制御装置を実現する実施の形態を、図面に示す第１実施例に基づいて説明する。
【００１０】
（第１実施例）
まず、構成を説明する。
図１は、第１実施例の車両用操舵制御装置を示すシステム構成図であり、図中、１ＦＬ、１ＦＲ、１ＲＬおよび１ＲＲはそれぞれ左前輪、右前輪、左後輪および右後輪であり、後輪１ＲＬおよび１ＲＲは、エンジン２の駆動力が自動変速機３、プロペラシャフト４、最終減速装置５および車軸６を順に介して伝達される駆動輪である。
【００１１】
また、前輪１ＦＬおよび１ＦＲは、ステアリングギヤ７、ステアリングシャフト８を介してステアリングホイール９に連結された操舵輪であり、ステアリングシャフト８には、電動モータで構成された操舵アクチュエータ１０が連結されている。この操舵アクチュエータ１０は、後述するコントローラ１６から出力される操舵制御量δＣに応じて、前輪１ＦＬおよび１ＦＲの操舵方向、操舵角、および操舵速度を制御するように構成されている。
【００１２】
また、各車輪１ＦＬ〜１ＲＲには、車輪の回転速度に応じた周波数の車輪速ＶＦＬ〜ＶＲＲを出力する車輪速センサ１１ＦＬ〜１１ＲＲが配設されている。さらに、車両には、前後加速度Ｘｇを検出する前後加速度センサ１２と、横加速度Ｙｇを検出する横加速度センサ１３と、ヨーレートφを検出するヨーレートセンサ１７とが備えられている。
【００１３】
また、車両には、人工衛星から送られる衛星電波を受信して現在の自車位置を検出するＧＰＳ１４と、所定領域の道路地図情報を記憶したＣＤ−ＲＯＭやＤＶＤ−ＲＯＭ等の記憶媒体がセットされた記憶ユニット１５（道路半径算出手段および道路幅検出手段に相当）とが搭載されている。
【００１４】
これら、各車輪速センサ１１ＦＬ〜１１ＲＲで検出する車輪速ＶＦＬ〜ＶＲＲと、前後加速度センサ１２で検出される前後加速度Ｘｇと、横加速度センサ１３で検出される横加速度Ｙｇと、ヨーレートセンサ１７で検出されるヨーレートφと、ＧＰＳ１４で検出された自車位置情報と、記憶ユニット１５に記憶された道路地図情報とが、例えばマイクロコンピュータで構成されたコントローラ１６に入力される。このコントローラ１６では、図２の操舵制御処理を常時実行することで前述した操舵アクチュエータ１０に対する操舵制御量δＣの出力を制御し、自動操舵により自車両を基準経路に沿って走行させるように構成されている。
【００１５】
次に、作用を説明する。
［操舵制御処理］
図２は、コントローラ１６において実行される操舵制御処理の流れを示すフローチャートである。この処理は、図示せざるオペレーティングシステムで一定時間毎に定時割り込み遂行される。
【００１６】
ステップＳ１０１では、ＧＰＳ１４で検出された自車位置に従って、記憶ユニット１５に記憶された道路地図情報を読み込み、道路地図情報を構成するノードデータ（Ｘ，Ｙ）のうち、図３に示すように、自車位置を基準とし前後に所定距離だけとった範囲（Ｘo，Ｙo）〜（Ｘn，Ｙn）を常時バッファに保有し、ステップＳ１０２へ移行する（基準経路検出手段に相当）。ここで、前方側の距離は、例えば、車速Ｖに所定時間ｔ１を乗じた値（＝Ｖ・ｔ１）、または、予め設定した最小値のうち大きい方に設定する。
【００１７】
ステップＳ１０２では、各種センサから出力される各車輪速ＶＦＬ〜ＶＲＲと、前後加速度Ｘｇと、横加速度Ｙｇと、ヨーレートφとを読み込み、ステップＳ１０３へ移行する。
【００１８】
ステップＳ１０３では、各車輪速ＶＦＬ〜ＶＲＲの平均から車速Ｖを算出し、ステップＳ１０４へ移行する（車速検出手段に相当）。
【００１９】
ステップＳ１０４では、図４に示すＦＢ前方注視時間算出マップを参照し、ステップＳ１０３において算出された車速Ｖから、フィードバック（以下ＦＢ）制御用のＦＢ前方注視時間Ｔ_fbを設定し、ステップＳ１０５へ移行する。算出マップは、図４に示すように、横軸が車速Ｖを、縦軸がＦＢ前方注視時間Ｔ_fbを表している。
【００２０】
ステップＳ１０５では、ステップＳ１０４で算出されたＦＢ前方注視時間Ｔ_fbからＦＢ前方注視点Ｐ_fbを算出し、ステップＳ１０６へ移行する。具体的には、ステップＳ１０４において算出されたＦＢ前方注視時間Ｔ_fbに車速Ｖを乗じることにより、ＦＢ前方注視時間Ｔ_fbが経過する間に自車両が進む距離Ｄ_fb（＝Ｔ_fb・Ｖ）を算出し、現在の自車位置から距離Ｄ_fb分だけ進んだ地点における最寄りのノードを前方注視点Ｐ_fbとして設定する（前方注視点設定手段に相当）。
【００２１】
ステップＳ１０６では、ステップＳ１０５において算出されたＦＢ前方注視点Ｐ_fbを自車両が通過するときの基準経路に対する横偏差ＹＥを算出し、ステップＳ１０７へ移行する（横偏差検出手段に相当）。
【００２２】
横偏差ＹＥは、自車両の車両姿勢から求まる横偏差ＹＳと、車両旋回状態から求まる横偏差ＹＰとを加算して算出する。
【００２３】
車両のスリップ角θＳは、前後加速度Ｘｇおよび横加速度Ｙｇを用いて下記の式(1)のように表される。
θＳ＝tan−１（Ｙｇ／Ｘｇ） …(1)
【００２４】
また、図５に示すような基準座標上における自車両のヨー角をε１、第２前方注視点Ｐ２を通り速度ベクトルＶに直角な直線Ｃと基準経路との交点Ｑにおける基準座標に対する基準経路のずれ角をεＴとすると、基準経路に対する自車両のヨー角εＲは、下記の式(2)のように表すことができる。
εＲ＝εＴ−ε１ …(2)
【００２５】
さらに、初期状態における基準経路と自車位置との横偏差をＹＵとしたとき、車両姿勢に応じた横偏差ＹＳは下記の式(3)のように表されるので、この式に従って、ＹＵ、Ｄ２、εＲおよびθＳから車両姿勢に応じた横偏差ＹＳを算出する。
ＹＳ＝ＹＵ＋Ｄ_fb・tan（εＲ＋θＳ） …(3)
【００２６】
次に、車両が定常円旋回を行っている場合を想定すると、スリップレートを無視することができるので、車両旋回状態から求まる横偏差ＹＰは、下記の式(4)で表すことができる。
ＹＰ＝Ｄ_fb・tanβ …(4)
なお、この式中のβは、下記の式(5)で表すことができる。
β＝１／２・sin−１（Ｄ_fb・ε１／Ｘｇ） …(5)
【００２７】
したがって、式(4)，(5)から車両旋回状態に応じた横偏差ＹＰを算出し、これに式(3)により算出された横偏差ＹＳを加算することにより、基準経路に対する横偏差ＹＥ（＝ＹＳ＋ＹＰ）を算出できる。
【００２８】
ステップＳ１０７では、ステップＳ１０６において算出された横偏差ＹＥから指令操舵角を算出するための操舵ゲイン（操舵感度）Ｋsを設定し、ステップＳ１０８へ移行する（操舵感度設定手段に相当）。
【００２９】
自然法則として車両の構造が同一であれば、運動は低速であるほど操舵に対する応答が低下する。よって、誤差修正能力を維持するためには、誤差（横偏差）ＹＥを修正するための操舵角を決定する操舵ゲインＫsを大きく設定する。
【００３０】
しかしながら、交差点等で車速Ｖを極低速に落として走行するとき、操舵ゲインＫsが大きな値に保たれている場合には、ドライバが操舵する場合と反して左右に大操舵による修正操舵が繰り返される。
【００３１】
こうした領域においては、多少の誤差を許容することでスムーズで違和感のない操舵を行うために、図６に示すように、車速Ｖがある車速Ｖ１以下の領域では操舵ゲインＫsを低下させる（操舵感度低下手段に相当）。これにより、スムーズで違和感のない操舵が可能となる。
【００３２】
さらに、この際に設定するＦＢ前方注視時間Ｔ_fbは、図７に示すように、ある車速Ｖ２を境にして大きくなるようにしても良い（前方注視点調節手段に相当）。この際、図６のＶ１と図７のＶ２との関係は、Ｖ１＞Ｖ２となるように設定すると良いが、これを規定するものではない。
【００３３】
このように、車速Ｖの低下に応じて前方注視点Ｐ_fbを延長することにより、車両の将来のヨー角誤差に対する操舵感度を高めたことになり、将来誤差を小さくすることに重みを置くことで過度な操舵が行われないようにするものである。
【００３４】
また、図２に示したフローチャート内の図、および図６は車速Ｖ１に対して操舵ゲインＫｓを規定した場合の説明であるが、道路半径Ｒに応じて操舵ゲインＫsを設定しても良い。
【００３５】
例えば、図８に示すように、ある道路半径（第１設定半径）Ｒ１以下となった場合に、操舵ゲインＫsを低下させる（操舵感度低下手段に相当）。また、図９に示すようなマップ形状としても良い。
【００３６】
さらに、図８もしくは図９のように操舵ゲインＫsを設定した場合に、FB前方注時間Ｔ_fbを図１０のように設定しても良い（前方注視点調節手段に相当）。このとき、Ｒ２（第２設定半径）＜Ｒ１となるように設定すると良いが、これを規定するものではない。
【００３７】
このように、道路半径Ｒの減少に応じて前方注視点Ｐ_fbを延長することによって、車両の将来のヨー角誤差に対する操舵感度を高めたことになり、将来誤差を小さくすることに重みを置くことで過度な操舵が行われないようにするものである。
【００３８】
ここで、操舵ゲインＫｓは、車速Ｖに応じて設定された操舵ゲインＫs_velと、道路半径Ｒに応じて設定された操舵ゲインＫs_radiusのうち、小さい方を最終的に使用する操舵ゲインＫsとして選択するようにしても良い。また、前方注視時間Ｔ_fbに関しては、車速Ｖに応じて設定されたＦＢ前方注視時間Ｔ_fbと道路半径Ｒに応じて設定されたＦＢ前方注視時間Ｔ_fbのうち、長い方を選択するようにしても良い。
【００３９】
なお、ここまでのプロセスで算出された操舵ゲインＫsは、道路幅によって道路幅が広い場合に操舵ゲインＫsを低下する量を大きめにする図１１のような補正係数Ｋs_hoseiを用いて、下記の式(6)のように補正しても良い。
Ｋs＝Ｋs×Ｋs_hosei …(6)
【００４０】
また、同様に前方注視時間Ｔ_fbについては、図１２のような補正をかけることで、道路幅が太い場合により将来の車両のヨー角を重視するにするようにしても良い。
前方注視時間Ｔ_fb＝前方注視時間Ｔ_fb×前方注視時間Ｔ_fb_hosei …(7)
【００４１】
以上により最終的な操舵ゲインＫｓと前方注視点Ｐ_fbとが決定されるが、さらに、車両がこのように多少の誤差を許容しスムーズな操舵を行うかどうか、もしくは操舵ゲインＫsを高く保つかどうかを、周囲の障害物の状況に応じて選択するようにする。
【００４２】
特に、経路上正面以外の側方の障害物がレーザレーダ（障害物検出手段）などにより一定距離以下で検出されている場合には、図１３のように操舵ゲインＫsを低下させない。なお、障害物を検知しなくとも、ＧＰＳ１４により市街路を走行している場合、もしくはコントローラ１６より障害物回避状況である旨の指令が与えられた場合などにおいても同様に図１３のゲインマップを選択するようにする（道路半径に応じた操舵ゲインＫsも障害物の検出等がされている場合には操舵ゲインＫsを低下させないように選択するものとする）。
【００４３】
図２のフローチャートに戻り、ステップＳ１０８では、下記の式(8)から横変位ＹＥを修正するための操舵量δfbを算出する（操舵量算出手段に相当）。
δfb＝Ｋs・ＹＥ＋Ｋd・（dＹＥ／dt） …(8)
ここで、ＫsおよびＫdは係数であり、直線走行時の外乱に対して追従誤差が経路から逸脱する程拡大しないよう、最適な値を実験から求めることが望ましい。
【００４４】
なお、最終的な操舵指令δcomは、下記の式(9)に示すように、上記の前方注視点誤差を修正するための操舵δfbに、走行中の道路半径に基づき決定したフィードフォワード（以下ＦＦ）制御による操舵量δffを加算した値となる。
δcom＝δfb+δff …(9)
【００４５】
ステップＳ１０９では、ステップＳ１０８において算出された操舵制御量δcomを操舵アクチュエータ１０に出力し、本制御を終了する。
【００４６】
すなわち、車速Ｖがある車速Ｖ１以下の低速域で操舵ゲインＫsを低下させるため、大きな修正舵が繰り返し行われることなくスムーズで違和感のない操舵が可能となる。
【００４７】
車速Ｖがある車速Ｖ２（Ｖ１＞Ｖ２）以下のとき、車速Ｖの減少に応じてFB前方注視時間Ｔ_fbを延長し、FB前方注視点Ｐ_fbを大きくするため、車両の将来のヨー角誤差に対する操舵ゲインＫsが高められ、将来誤差を小さくすることに重みを置くことで過度な操舵を防止できる。よって、大きな修正舵が繰り返されず、適切な操舵が実施される。
【００４８】
道路半径Ｒがある道路半径Ｒ１以下のとき、操舵ゲインＫsを低下するため、大きな修正舵が繰り返し行われることなく適切な操舵が行われる。
【００４９】
道路半径Ｒがある道路半径Ｒ２以下のとき、道路半径Ｒの減少に応じてFB前方注視時間Ｔ_fbを延長し、FB前方注視点Ｐ_fbを大きくするため、車両の将来のヨー角誤差に対する操舵ゲインＫsが高められ、将来誤差を小さくすることに重みを置くことで過度な操舵を防止できる。よって、大きな修正舵が繰り返されず、適切な操舵が実施される。
【００５０】
操舵ゲインＫsを低下させる度合いを道路幅に応じて設定するため、広い道路で多少の誤差の拡大が許容できる場合には大きな修正舵が繰り返し行われることなく、よりスムーズで適切な操舵が可能となる。
【００５１】
車速Ｖに応じて設定した操舵ゲインＫs_velと、道路半径Ｒに応じて設定した操舵ゲインＫs_radiusのうち、低い方を選択するため、車速Ｖと道路半径Ｒの双方に応じて最適な操舵ゲインＫsとFB前方注視時間Ｔ_fbが設定されるので、大きな修正舵が繰り返し行われることなく、よりスムーズで適切な操舵が可能となる。
【００５２】
車速Ｖもしくは道路半径Ｒに応じて操舵ゲインＫsを低下させるか否かを、周囲障害物の有無によって選択するため、障害物回避動作等で追従誤差を小さくしたい場合に対応しつつ、大きな修正操舵が繰り返し行われることなく、よりスムーズで適切な操舵が可能となる。
【００５３】
以上、本発明の車両用操舵制御装置を第１実施例に基づき説明してきたが、具体的な構成については、この第１実施例に限られるものではなく、特許請求の範囲の各請求項に係る発明の要旨を逸脱しない限り、設計の変更や追加等は許容される。
【図面の簡単な説明】
【図１】第１実施例の車両用操舵制御装置を示すシステム構成図である。
【図２】コントローラにおいて実行される操舵制御処理の流れを示すフローチャートである。
【図３】ＦＢ前方注視点の算出方法を示す説明図である。
【図４】ＦＢ前方注視時間算出マップである。
【図５】ＦＢ前方注視点における誤差の算出方法を示す説明図である。
【図６】車速に応じた操舵ゲイン設定マップである。
【図７】車速に応じたＦＢ前方注視点設定マップである。
【図８】道路半径に応じた操舵ゲイン設定マップである。
【図９】道路半径に応じた操舵ゲイン設定マップである。
【図１０】道路半径に応じたＦＢ前方注視点設定マップである。
【図１１】道路幅に応じたゲイン補正係数設定マップである。
【図１２】道路幅に応じたＦＢ前方注視点補正係数設定マップである。
【図１３】障害物検出時における車速に応じた操舵ゲイン設定マップである。
【符号の説明】
１ＦＬ 左前輪
１ＦＲ 右前輪
１ＲＬ 左後輪
１ＲＲ 右後輪
２ エンジン
３ 自動変速機
４ プロペラシャフト
５ 最終減速装置
６ 車軸
７ ステアリングギヤ
８ ステアリングシャフト
９ ステアリングホイール
１０ 操舵アクチュエータ
１１ＦＬ 左前輪車輪速センサ
１１ＦＲ 右前輪車輪速センサ
１１ＲＬ 左後輪車輪速センサ
１１ＲＲ 右後輪車輪速センサ
１２ 前後加速度センサ
１３ 横加速度センサ
１４ ＧＰＳ
１５ 記憶ユニット
１６ コントローラ
１７ ヨーレートセンサ
Claims (7)
- 前方注視点において自車両が通過する際の基準経路との横偏差に応じて操舵量を算出することで、自車両を基準経路に沿って走行させる車両用操舵制御装置において、
自車両を走行させる基準経路を検出する基準経路検出手段と、
自車速を検出する車速検出手段と、
検出された基準経路における所定時間もしくは所定距離前方の前方注視点を設定する前方注視点設定手段と、
設定された前方注視点における基準経路に対する横偏差を検出する横偏差検出手段と、
検出された横偏差に応じた操舵量を算出する際の操舵感度を設定する操舵感度設定手段と、
設定された操舵感度に基づいて操舵量を算出する操舵量算出手段と、
検出された車速が予め設定された設定車速以下であるとき、設定された操舵感度を低下させる操舵感度低下手段と、
を設けたことを特徴とする車両用操舵制御装置。 - 請求項１に記載の車両用操舵制御装置において、
検出された車速が設定車速以下であるとき、設定された前方注視点の位置を自車からの距離が大きくなるように調節する前方注視点調節手段を設けたことを特徴とする車両用操舵制御装置。 - 前方注視点において自車両が通過する際の基準経路との横偏差に応じて操舵量を算出することで、自車両を基準経路に沿って走行させる車両用操舵制御装置において、
自車両を走行させるための基準経路を検出する基準経路検出手段と、
検出された経路の半径を算出する道路半径算出手段と、
検出された基準経路における所定時間もしくは所定距離前方の前方注視点を設定する前方注視点設定手段と、
設定された前方注視点における基準経路に対する横偏差を検出する横偏差検出手段と、
検出された横偏差に応じた操舵量を算出する際の操舵感度を設定する操舵感度設定手段と、
設定された操舵感度に基づいて操舵量を算出する操舵量算出手段と、
検出された道路半径が予め設定された第１設定半径以下であるとき、設定された操舵感度を低下させる操舵感度低下手段と、
を設けたことを特徴とする車両用操舵制御装置。 - 請求項３に記載の車両用操舵制御装置において、
算出された道路半径が予め設定された第２設定半径以下であるとき、設定された前方注視点の位置を自車からの距離が大きくなるように調節する前方注視点調節手段と、
を設けたことを特徴とする車両用操舵制御装置。 - 請求項１ないし請求項４のいずれか１項に記載の車両用操舵制御装置において、
道路幅を検出する道路幅検出手段を設け、
前記操舵感度低下手段は、検出された道路幅が大きくなると操舵感度を低下させることを特徴とする車両用操舵制御装置。 - 請求項１ないし請求項５のいずれか１項に記載の車両用操舵制御装置において、
前記操舵感度設定手段は、車速に応じて設定した操舵感度と道路半径に応じて設定した操舵感度のうち、低い方を選択することを特徴とする車両用操舵制御装置。 - 請求項１ないし請求項６のいずれか１項に記載の
障害物を検出する障害物検出手段を設け、
前記操舵感度低下手段は、障害物の有無に基づいて操舵感度を低下させるか否かを選択することを特徴とする車両用操舵制御装置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2003144892A JP4148022B2 (ja) | 2003-05-22 | 2003-05-22 | 車両用操舵制御装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2003144892A JP4148022B2 (ja) | 2003-05-22 | 2003-05-22 | 車両用操舵制御装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2004345504A JP2004345504A (ja) | 2004-12-09 |
| JP4148022B2 true JP4148022B2 (ja) | 2008-09-10 |
Family
ID=33532229
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2003144892A Expired - Fee Related JP4148022B2 (ja) | 2003-05-22 | 2003-05-22 | 車両用操舵制御装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP4148022B2 (ja) |
Families Citing this family (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP5291640B2 (ja) * | 2010-01-14 | 2013-09-18 | 株式会社豊田中央研究所 | 操舵装置 |
| JP5393495B2 (ja) * | 2010-01-14 | 2014-01-22 | 株式会社豊田中央研究所 | 操舵装置 |
-
2003
- 2003-05-22 JP JP2003144892A patent/JP4148022B2/ja not_active Expired - Fee Related
Also Published As
| Publication number | Publication date |
|---|---|
| JP2004345504A (ja) | 2004-12-09 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP4231910B2 (ja) | 車線維持装置 | |
| JP4696720B2 (ja) | 自動操舵制御装置 | |
| JP4586962B2 (ja) | 車両の姿勢制御装置 | |
| JP2641743B2 (ja) | 四輪操舵車の後輪制御方法 | |
| JP2018103761A (ja) | 自動運転車両 | |
| JP4468509B2 (ja) | 車両用操舵装置 | |
| CN102951201B (zh) | 机动车 | |
| JP6419671B2 (ja) | 車両用操舵装置および車両用操舵方法 | |
| JP2010188884A (ja) | 車線維持支援装置及び車線維持支援方法 | |
| CN100439178C (zh) | 在过度转向抑制控制中计算驾驶员的反方向转向操作的车辆 | |
| JP5380861B2 (ja) | 車線維持支援装置及び車線維持支援方法 | |
| JP7188236B2 (ja) | 車両制御装置 | |
| JP5380860B2 (ja) | 車線維持支援装置及び車線維持支援方法 | |
| JP3933085B2 (ja) | 車両用自動操舵装置 | |
| JP4622453B2 (ja) | 自動操舵車両 | |
| JP2010149636A (ja) | 車両 | |
| JP4599835B2 (ja) | 車両用自動操舵制御装置 | |
| JP4687471B2 (ja) | 電動車両の駆動力制御装置、自動車及び電動車両の駆動力制御方法 | |
| JP4148022B2 (ja) | 車両用操舵制御装置 | |
| CN114407880B (zh) | 一种无人驾驶紧急避障路径跟踪方法 | |
| JP4403962B2 (ja) | 自動操舵制御装置 | |
| JP2006069497A (ja) | ステアリング装置 | |
| JP7268990B2 (ja) | 車両の自動操舵制御装置 | |
| JP3182972B2 (ja) | 車両の後輪操舵制御装置 | |
| JP3707199B2 (ja) | 車両の自動操舵装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| RD04 | Notification of resignation of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7424 Effective date: 20051117 |
|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20060403 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20080321 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20080401 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20080514 |
|
| 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: 20080603 |
|
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20080616 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110704 Year of fee payment: 3 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 4148022 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: 20120704 Year of fee payment: 4 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120704 Year of fee payment: 4 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130704 Year of fee payment: 5 |
|
| LAPS | Cancellation because of no payment of annual fees |