JP3705094B2 - 車線追従走行制御装置 - Google Patents
車線追従走行制御装置 Download PDFInfo
- Publication number
- JP3705094B2 JP3705094B2 JP2000250426A JP2000250426A JP3705094B2 JP 3705094 B2 JP3705094 B2 JP 3705094B2 JP 2000250426 A JP2000250426 A JP 2000250426A JP 2000250426 A JP2000250426 A JP 2000250426A JP 3705094 B2 JP3705094 B2 JP 3705094B2
- Authority
- JP
- Japan
- Prior art keywords
- camber angle
- lane
- vehicle
- steering
- wheel
- 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)
- Vehicle Body Suspensions (AREA)
- Traffic Control Systems (AREA)
Description
【発明の属する技術分野】
本発明は、自車位置および前方の車線状態を検出し、これらの情報に基づいて車線追従を補助する車線追従走行制御装置の技術分野に属する。
【0002】
【従来の技術】
自車位置および前方の車線状態を検出し、これらの情報に基づいて車輪の舵角を発生することにより車線追従を補助する車線追従走行制御装置であって、ドライバ操舵位置を検出して車輪の舵角を修正する従来技術としては、特開平9−207800号公報に記載の技術が知られている。
【0003】
この公報には、前方車線状態を撮像するCCDカメラを備え、ここから道路白線を抽出することにより、前方の車線状態及び自車両の走行位置を検出し、これらの検出結果に基づいて、自車両が道路白線に沿って追従走行するよう、車輪の舵角を演算し、演算した舵角を発生させる車線追従走行制御装置であって、ドライバの操舵意志を検出する力センサを備え、該力センサにおいて検出された操舵トルクの方向及び大きさに応じて前記車輪の舵角を増減するものである。
【0004】
【発明が解決しようとする課題】
上記従来技術によれば、車線追従走行制御中にドライバがステアリングホイールを操作し、操舵トルクを加えると、車線追従に要する車輪の舵角に対し、操舵トルクに応じて車輪の舵角が増減されるため、車線追従制御中であっても、ドライバの意志を反映した方向へ車両を進めることが可能となる。
【0005】
しかし、従来技術の第1実施例の場合、ステアリングホイールから、車輪の舵角を制御する機構までの間が、機械的にリジッドに接続されているため、ステアリングホイールは、車輪の舵角に合わせた動きしかとれない。
【0006】
そのため、ドライバが操舵トルクを加えてから車輪の舵角が変化する間の制御上の遅れ影響がステアリングホイール上に発生し、ドライバが操舵トルクを加えても、直ちにステアリングホイールは変位せず、ある遅れを伴い変位し、ドライバに違和感を与える。
【0007】
また、ステアリングホイールは、車輪の舵角にステアリングホイール〜車輪の舵角制御機構間のギア比を乗じた角度分変位するため、ステアリングホイールには、操舵トルク分だけでなく、車線追従制御分の変位も発生してしまい、やはりドライバに違和感を与える。
【0008】
さらに、ドライバがステアリングホイールから感じる操舵反力と変位の関係は、本来車輪の舵角と車輪に加わる外力に基づくものであり、これをインフォメーションとしてドライバはステアリングホイールを操作するのである。しかし、上述の従来技術では、操舵反力(=操舵トルク)と、ステアリングホイール変位量の関係は、操舵トルクと、これに応じた車輪の舵角との関係で定まり、該関係は制御ロジックにより決まる。従って、ドライバは実際に車輪に生じるインフォメーションを感じることはできず、違和感を与える。
【0009】
従来技術の第2実施例では、ステアリングホイールと舵角制御機構間に、ばねを介し、ステアリングホイールと舵角制御機構間の相対的な変位を許し、該相対変位に比例した反力をステアリングホイールに発生させている。あるいは、ばねの代わりにモータを介し、ばねを介したときと同様の制御を行っている。
【0010】
これにより、操舵トルクを加えてからステアリングホイールが変位し始めるまでの遅れは無くなる。また、ステアリングホイールに所定のトルクを加えていれば、車輪の舵角が変化しても、それに併せてステアリングホイールが変位することは無い。
【0011】
しかし、ばねを介して車輪の舵角に応じたトルク変動は伝わるため、ドライバが操舵トルクを加えて車輪の舵角が変化する時や、車線追従制御による車輪の舵角の変化に応じたトルクがステアリングホイールに加わり、やはり、ドライバに違和感を与える。
【0012】
また、操舵反力(=操舵トルク)と、これに応じたステアリングホイールの変位量の関係は、ステアリングホイールと操舵角制御機構間に介されたばねのばね定数により決まるため、第1実施例と同様に、ドライバは実際に車輪に生じるインフォメーションを感じることはできず、違和感を与える。
【0013】
以上のように従来技術では、ステアリングホイールにおける操舵反力や変位に、車輪の舵角を制御する際の影響がでてしまいドライバに違和感を与える。また、ドライバは、ステアリングホイールから実際に車輪に生じるインフォメーションを感じることはできず、やはり違和感を与える。
【0014】
本発明は、上記問題点に着目してなされたもので、その目的とするところは、車線追従走行制御中にドライバに違和感を与えることなくステアリングホイールの操作を可能とする車線追従走行制御装置を提供することにある。
【0015】
【課題を解決するための手段】
上記目的を達成するため、請求項1,2記載の発明では、図1のクレーム概念図に示すように、正面からみた車輪中心面が鉛直面となす角度である車輪のキャンバ角を変更するキャンバ角変更手段と、
車両前方の車線形状を検出する車線形状検出手段と、
自車の予測進路を演算する予測進路演算手段と、
前記車線形状検出手段の検出結果と前記予測進路演算手段の演算結果から求めた、前方車線における将来の自車位置を基に、車両を前方車線に追従させるために必要な車輪のキャンバ角を演算する目標キャンバ角演算手段と、
前記キャンバ角変更手段を駆動制御し、車輪のキャンバ角を該目標キャンバ角に制御するキャンバ角制御手段と、
を有することを共通の手段とする。
【0016】
上記共通の手段に加え、請求項1記載の発明では、乗員の操作による操舵量を検出する操舵量検出手段を備え、
前記目標キャンバ角演算手段を、前記車線形状検出手段の検出結果から求めた前方車線方向と、前記予測進路演算手段の演算結果から求めた予測進路方向が異なり、かつ、前記操舵量検出手段の検出結果が所定の値を超えた場合、目標キャンバ角を原点位置に戻す手段としたことを特徴とする。
【0017】
上記共通の手段に加え、請求項2記載の発明では、乗員の方向指示器操作状態を検出する方向指示器操作状態検出手段を備え、
前記目標キャンバ角演算手段を、前記方向指示器操作状態検出手段の検出結果により、乗員による方向指示器の操作が検出されたとき、目標キャンバ角を原点位置に戻す手段としたことを特徴とする。
【0018】
請求項3記載の発明では、請求項1または請求項2に記載の車線追従走行制御装置において、
前記目標キャンバ角演算手段は、前方車線方向と予測進路方向が異なり、かつ、操舵量検出結果が所定の値を超えた場合、目標キャンバ角を第1変化速度により原点位置に戻し、乗員による方向指示器の操作が検出されたとき、目標キャンバ角を第2変化速度により原点位置に戻す手段であり、
前記目標キャンバ角演算手段での目標キャンバ角を原点位置に戻す際の前記第1変化速度を、前記第2変化速度よりも低く設定したことを特徴とする。
【0019】
請求項4記載の発明では、請求項1乃至請求項3の何れか1項に記載の車線追従走行制御装置において、
現在の車線内における自車位置を検出する自車位置検出手段と、
乗員の操作による操舵量を検出する操舵量検出手段と、
自車両の車速を検出する車速検出手段を備え、
前記予測進路演算手段を、検出された自車位置,操舵量及び車速を基に予測進路を演算する手段としたことを特徴とする。
【0020】
請求項5記載の発明では、請求項1乃至請求項4の何れか1項に記載の車線追従走行制御装置において、
前記操舵量検出手段により検出される操舵量を、操舵角又は操舵トルクのいずれかとしたことを特徴とする。
【0021】
【発明の作用および効果】
請求項1,2に記載の発明にあっては、車線形状検出手段において、車両前方の車線形状が検出され、予測進路演算手段において、自車の予測進路が演算される。そして、目標キャンバ角演算手段において、車線形状検出手段の検出結果と予測進路演算手段の演算結果から求めた、前方車線における将来の自車位置を基に、車両を前方車線に追従させるために必要な車輪のキャンバ角が演算され、キャンバ角制御手段において、キャンバ角変更手段を駆動制御し、車輪のキャンバ角が目標キャンバ角に制御される。
【0022】
すなわち、キャンバ角制御により前方車線に追従する走行制御が可能になると共に、キャンバ角制御による車線追従走行制御であるため、車線追従走行制御中にドライバがステアリングホイールを操作して舵角を変化させても、車線追従走行制御(キャンバ角変化)による干渉を受けることが無い。
【0023】
よって、車線追従走行制御中にドライバがステアリングホイールを操作しても、ドライバに違和感を与えることなく、適切にステアリングホイールを操作でき、自車の方向をドライバ操作により制御することができる。
【0024】
上記共通の作用効果に加え、請求項1記載の発明にあっては、操舵量検出手段において、乗員の操作による操舵量が検出される。そして、目標キャンバ角演算手段において、車線形状検出手段の検出結果から求めた前方車線方向と、予測進路演算手段の演算結果から求めた予測進路方向が異なり、かつ、操舵量検出手段の検出結果が所定の値を超えた場合、目標キャンバ角が原点位置に戻される。
【0025】
よって、ドライバが車線追従走行制御から離脱する操作を行ったとき、これを検知し、キャンバ角制御を中止することにより、ドライバの操作による方向制御を妨げないという効果が得られる。
【0026】
上記共通の作用効果に加え、請求項2記載の発明にあっては、方向指示器操作状態検出手段において、乗員の方向指示器操作状態が検出される。そして、目標キャンバ角演算手段において、方向指示器操作状態検出手段の検出結果により、乗員による方向指示器の操作が検出されたとき、目標キャンバ角が原点位置に戻される。
【0027】
よって、ドライバが方向指示器により車線変更の操作を行ったとき、これを検知し、キャンバ角制御を中止することにより、ドライバの操作による方向制御を妨げないという効果が得られる。
【0028】
請求項3記載の発明にあっては、目標キャンバ角演算手段において、前方車線方向と予測進路方向が異なり、かつ、操舵量検出結果が所定の値を超えた場合、目標キャンバ角が第1変化速度により原点位置に戻され、また、乗員による方向指示器の操作が検出されたとき、目標キャンバ角が第2変化速度により原点位置に戻されるとき、目標キャンバ角演算手段での目標キャンバ角を原点位置に戻す際の第1変化速度が、第2変化速度よりも低く設定される。
【0029】
よって、請求項1記載の発明の場合においては、車線追従から離脱操作が検出されると低い第1変化速度によりキャンバ角が徐々に原点位置に戻されるため、ドライバのステアリング操作により車線追従から離脱する方向制御中、車両の動きが自然で違和感のないものとなる。
【0030】
また、請求項2記載の発明の場合においては、方向指示器の操作が検出されると高い第2変化速度に基づいてキャンバ角が素早く原点位置に戻されるため、ドライバによるステアリング操作の開始前にキャンバ角を復帰させることができ、その後のドライバ操作による方向制御を違和感なく行うことができる。
【0031】
請求項4記載の発明にあっては、予測進路演算手段において、自車位置検出手段にて検出された自車位置と、操舵量検出手段にて検出された操舵量と、車速検出手段にて検出された車速を基に予測進路が演算される。
【0032】
よって、現在の車線内における自車位置を基準とし、ステアリング操作による操舵量及びアクセル操作等による車速を基に正確に予測進路を把握することができる。
【0033】
請求項5記載の発明にあっては、操舵量検出手段により検出される操舵量を、操舵角又は操舵トルクのいずれかとしているため、ドライバによる操舵量を確実に検出することができる。
【0034】
【発明の実施の形態】
以下、本発明の実施の形態を図面に基づいて説明する。
【0035】
(実施の形態1)
図2は実施の形態1の車両用車線追従走行制御装置を適用した車両を示す全体システム図であり、車両の前方位置には、進行方向前方を撮像するためのCCDカメラ1及び前方画像に基づいて走路状態を算出する画像処理装置2が設けられている。また、駆動軸や車輪などには、車速を計測するために車速センサ3が設けられ、左右前輪のサスペンション機構には、正面からみた車輪中心面が鉛直面となす角度である車輪のキャンバ角を変更するためのキャンバ角制御アクチュエータ4(キャンバ角変更手段)が設けられている。また、ステアリングシャフトなどには、舵角を検出するための舵角センサ5が設けられている。そして、キャンバ角制御手段としてのコントロールユニット6が搭載されている。
【0036】
前記コントロールユニット6には、画像処理装置2,車速センサ3,舵角センサ5からの信号が入力され、これらの信号に基づいて演算された操舵指令をキャンバ角制御アクチュエータ4に出力する。さらに、コントロールユニット6と画像処理装置2はデジタル通信により接続されており、相互のユニット2,6において演算されている信号を交換することが可能となっている。
【0037】
図3はキャンバ角制御アクチュエータ部分を示す構成図であり、実施の形態1では、ダブルウィッシュボーン形式のサスペンションにおいて、アッパーアーム41の車体取り付け点4aを左右(車幅方向)に移動させることでキャンバ角を制御可能とする例を示す。アッパーアーム41の車体側取り付け点4aは左右方向に可動支持されており、ここへ駆動用モータ42を用いたアクチュエータ機構が取り付けられている。アクチュエータ機構は、駆動用モータ42とボールねじ43から構成され、コントロールユニット6からの駆動電流によって発生する駆動用モータ42の回転を並進運動に変換することでアッパーアーム取り付け点4aを動かす。また、ここには変位センサ44が設けられており、アッパーアーム41の取り付け点4aの左右位置をコントロールユニット6へ出力する。この機構は、左右前輪のサスペンションにそれぞれ設けられている。なお、図3において、45は駆動用モータ42を支持固定するアクチュエータブラケット、46はサスペンションメンバ、47は車体である。
【0038】
図4は画像処理装置部分を示す構成図であり、画像処理装置2は、CCDカメラ1より車両前方の画像情報を受け取り、画像情報から車線情報を抽出する車線抽出処理部21と、抽出された白線情報に基づき走路形状を推定する走路形状推定部22と、推定された走路形状に基づいて車線中心に対する自車位置の偏差情報を算出する位置偏差算出部23から構成され、走路形状推定部22及び位置偏差算出部23における演算結果(横偏差、ヨー角偏差、道路曲率)をコントロールユニット6へ出力する。
【0039】
図5はコントロールユニット部分を示す構成であり、コントロールユニット6には、舵角センサ5の出力、画像処理装置2における位置偏差情報、走路形状情報、キャンバ角制御アクチュエータ4における変位センサ44によるアッパーアーム41の取り付け点4aの左右位置情報が入力され、舵角情報、位置偏差情報に基づいて自車の予測進路を算出する自車進路予測演算部61と、自車の予測進路と走路形状情報との偏差に基づいて自車が車線に追従して走行するために必要なキャンバ角を算出する目標キャンバ角算出部62と、目標キャンバ角とアッパーアーム取り付け点情報に基づき目標とするキャンバ角を実現するようにモータ42の位置決め制御を行うモータ駆動制御部63から構成される。なお、本構成図はモータ駆動制御部63を一系統のみ示しているが、この部分は左右のキャンバ角制御アクチュエータ4,4に対してそれぞれ設けられている。
【0040】
次に、作用を説明する。
【0041】
図6は画像処理装置2における処理を表すフローチャートで、本制御処理は一定の時間間隔のタイマ割り込みによって呼び出される。
【0042】
ステップ601では、CCDカメラ1において撮像した前方走路の画像の取り込みを行う。これは例えば図7に示されるような画像である。
【0043】
ステップ602では、車線抽出処理が行われる。これは、図7に示す走路画像に対して図8に示すように車線エッジ抽出処理を行う。
【0044】
ステップ603では、走路形状推定処理にて抽出された車線エッジを結ぶ線を多項式にて近似し、走路の推定形状とする。
【0045】
ステップ604では、多項式近似した走路のパラメータを基に、道路曲率ρv,自車位置の横偏差yv,ヨー角偏差ψvを算出する。
【0046】
ステップ605では、これらの算出された情報をコントロールユニット6に対して送信する。
【0047】
図9はコントロールユニット6における処理を表すフローチャートで、本制御処理は一定の時間間隔のタイマ割り込みによって呼び出される。
【0048】
ステップ901では、操舵角δを取り込み、キャンバ角制御アクチュエータ4における取り付け点4aの左右位置情報(左輪における値ya_l、及び、右輪における値ya_r)を取り込む。
【0049】
ステップ902では、画像処理装置2との通信処理を行う。画像処理装置2との通信では、道路曲率ρv,車線位置に対する自車の横偏差yv,ヨー角偏差ψvを受信する。
【0050】
ステップ903では、図示しない制御開始SWがONされているかどうかの判断を行い、ONの場合はステップ904へ進み、OFFの場合はステップ907へ進む。制御開始SWがOFFの場合は、ステップ907で目標キャンバ角φcが0かどうかが判断され、0の場合は本制御を終了し、0以外であれば、ステップ908へ進み、徐々にφcを0へ変化させる。
【0051】
以下、制御開始SWがONされている場合の処理について説明する。
【0052】
ステップ904では、現時点の横偏差yv,ヨー角偏差ψv,車速V,操舵角δを用いて自車の予測進路が、図10に示すフローチャートに従って算出された横変位y(t)とヨー角ψ(t)の履歴として予測される。
【0053】
すなわち、図10に示すフローチャートのステップ1001では、予め求めておいた、操舵角δに対するヨーレートの伝達関数G(δ,V)を用いてヨーレートの予測値dψ(t)が算出され、ステップ1002では、画像処理で得られたヨー角ψvを初期値として、dψ(t)を積分することでヨー角ψ(t)の履歴が予測される。また、ステップ1003では、画像処理で得られた横変位yvを初期値として、ヨー角ψ(t)と車速Vの積を積分することで、横変位y(t)の履歴が予測される。このようにして、自車の予測進路が、横変位y(t),ヨー角ψ(t)の履歴として予測される。
【0054】
ステップ905では、予測した自車進路と画像処理で得られた走路形状を図11に示すように比較して所定距離前方の横偏差ypを算出し、これに応じて目標キャンバ角φcが算出される。
ここで、目標キャンバ角φcは、次式に従って算出する。
φc=K1・yp+K2・φ_1
ここで、K1,K2は制御定数、φ_1はアッパーアーム取り付け点情報に基づく現時点のキャンバ角であり、
φ_1=(ya_l+ya_r)/(2・ha)
ha:アッパーアーム取り付け位置高さ
として算出される値である。なお、左右のキャンバ角が異なっていることが起こり得るため、左右の取り付け点位置の平均値を用いて算出している。
【0055】
ステップ906では、目標キャンバ角φcが算出されたら、これを
ya_c=ha・φc
とすることにより、目標取り付け点左右位置に変換し、これを取り付け点横変位目標値としてモータ駆動制御部63に出力する。
【0056】
このモータ駆動制御部63では、アッパーアーム取り付け点左右位置情報及び目標取り付け点左右位置に基づき、モータ駆動電流を出力する。ここでの処理は、図12に示すようなPIDサーボを行う。なお、このサーボ処理は、左右のアクチュエータ4,4のそれぞれについて独立に行われる。
【0057】
以上、本実施の形態1の制御によれば、自車の進路を予測すると共に、画像処理装置2によって得られた走行形状との比較に基づき、将来の偏差を予測し、これに応じたキャンバ角が算出され、サーボ制御される。従って、自車が道路中心から外れて走行しているにも関わらずドライバが修正操舵しない場合には、これを補正するようキャンバ角が制御され、自車の走行位置を車線中央に復帰させることができる。また、曲線路等を走行している場合には、ドライバ操舵が適切で自車が車線からはずれない状況であれば本制御速によってキャンバ角が発生されることはなく、ドライバの操舵に対して妨害する作用も生じない。
【0058】
また、本制御では、車線追従走行制御中に車輪の舵角変化が生じないため、ステアリングホイールに車線追従走行制御の影響が発生せず、ドライバに違和感を与えない。
【0059】
さらに、本制御で変化するキャンバ角は微小(1°程度)なため、本制御による車輪に加わる外力の変化分も小さく、しかも該変化分はキャンバ角制御アクチュエータ4,4で受ける。従って、車輪の舵角と車輪に加わる外力の関係は、車線追従走行制御の実施の如何に関わらずほぼ同等であり、ドライバがステアリングホイールから感じる操舵反力と変位の関係、すなわちインフォメーションもほぼ同等である。このためドライバは、適切にステアリングホイールを操作することが可能となる。
【0060】
なお、本実施の形態1では、アクチュエータとしてアッパーリンク取り付け点を左右に移送させるアクチュエータを左右前輪サスペンションに取り付ける例を示したが、これを図13に示すように、一つのアクチュエータで左右を同時に動かすことも可能であるし、図14に示すように、油圧アクチュエータにより駆動することも可能である。
【0061】
また、本実施の形態1では画像処理に基づき、車線に対する自車位置の計測、道路形状の推定を行っているが、自車位置の計測は、図15に示すように、道路に埋設した磁気マーカを車両前方に搭載した磁気センサで計測することで行うことも可能である。また、道路形状情報は、ナビゲーションシステムの情報を用いて推定することも可能であるし、路車間通信によって道路側から供給される情報を使うことも可能である。
【0062】
さらに、本実施の形態1では、車速と操舵角を用い、操舵角に対するヨーレートの伝達関数G(δ,V)を用いることで予測進路を算出する例を示したが、操舵角を計測する代わりに操舵トルクTを計測し、予め求めておいた、操舵トルクTに対するヨーレートの伝達関数H(T,V)を用いてヨーレートを算出し、これに基づいて予測進路を算出することもできる。
【0063】
(実施の形態2)
図16は実施の形態2における車線追従走行制御処理を表すフローチャートを示す。本実施の形態2は、実施の形態1の構成に加え、ステップ1605及びステップ1606において、予測進路の方向と車線の方向の比較に基づいて、キャンバ角制御を中断し、キャンバ角を所定の初期位置に復帰させる手段を設けたものである。
【0064】
実施の形態1と同様の手順で予測進路を算出した後、ステップ1605において、ドライバによる操舵操作が行われているか否かを検出する。この判断は、操舵角δが所定のしきい値を超えるか否かによって行うものであり、しきい値で定められた範囲を超えた操舵角δが検出された場合にはドライバ操舵操作有りと判断し、ステップ1606へ進む。
【0065】
ステップ1606では、予測進路の方向と車線の方向の比較判断を行う。この比較判断は、図17に示すように、現時点における車線中央からの横変位yvと所定距離前方における予測横変位ypを比較し、これが増加傾向にある場合に制御中断を判断し、目標キャンバ角φcを0へ徐々に変化させるものである。また、制御中断状態にあっても、横変位yvと予測横変位ypの比較において、図18に示すように車線中央へ復帰しつつある場合には、図16の制御フローに従って再度目標キャンバ角φcを算出する。
【0066】
一方、ステップ1605において、操舵操作が行われていないと判断された場合には、予測進路の方向と車線方向の比較判断は行わず、ステップ1607へ進み目標キャンバ角φcの算出を行う。
【0067】
以上説明したように、本実施の形態2における車線追従走行制御装置によれば、ドライバが車線変更を意図した場合には、図17に示すような車線中央から離脱する動きを検出することで自動的にキャンバ角制御を停止し、これを0へ変化させるため、ドライバの操舵操作による車両の動きに対して本車線追従走行制御が影響することがない。また、車線変更終了後には、図18に示すような、車線中央へ接近する動きを検出することで自動的にキャンバ角制御を再開し、ドライバの操舵操作を補助することが可能となる。また、図16の制御フローに示すように、ドライバが操舵操作を行っていない場合には中断判断を行わないため、ドライバの注意が散漫な状態になることによって車線の中央から離脱する場合には、車両を車線中央へ復帰させるよう補助することができる。
【0068】
本実施の形態2においても、実施の形態1と同様に、ドライバの操舵操作の有無を、操舵トルクを用いて同様に判断を行うことが可能である。この場合、ドライバ操舵操作の判断も操舵トルクに基づき、これが所定のしきい値に基づいて定められた範囲にあるか否かによって行われる。
【0069】
(実施の形態3)
図19は実施の形態3における車線追従走行制御処理を表すフローチャートを示す。本実施の形態3は、実施の形態2に加え、ウィンカー操作の有無による中断判断を加えたものである。
【0070】
実施の形態1と同様の手順で予測進路を算出した後、ウィンカー操作の有無を判断する。これは、ウィンカースイッチの状態により、容易に判断することが可能である。
【0071】
ステップ1905では、ウィンカー操作の有無を判断し、ウィンカー操作有りと判断したときは、ステップ1911へ進み、制御中断と判断する。そして、ステップ1913において、目標キャンバ角φcを徐々に0へ変化させる。この過程における目標キャンバ角変化率△φc(第2変化速度)を大きい値として設定し、短時間で目標キャンバ角φcが0へ変化するように設定する。
【0072】
一方、ウィンカー操作なしと判断したときは、ステップ1906へ進み、実施の形態2に示した手順に基づいて制御中断の判断を行い、制御中断と判断された場合には、ステップ1912において、目標キャンバ角変化率△φc(第1変化速度)を小さい値として設定し、ゆっくりと目標キャンバ角φcが0へ変化するように設定する。
【0073】
以上説明したように、本実施の形態3における車線追従走行制御装置によれば、ドライバが車線を変更するのに先立ってウィンカーを操作した場合には、目標キャンバ角が直ちに0に変更されるため、車線変更を行う操作時には、より違和感が少なく操舵を行うことができる。一方、ウィンカー操作を行うことなく車線変更を行った場合には、目標キャンバ角がゆっくりと0に変更されるため、車両の動きを大きく変化させることなく、制御を中断させることができる。
【図面の簡単な説明】
【図1】請求項1に係る発明の車線追従走行制御装置を示すクレーム概念図である。
【図2】実施の形態1における車線追従走行制御装置が適用された車両を示す全体システム図である。
【図3】実施の形態1におけるキャンバ角制御アクチュエータ部分の構成図である。
【図4】実施の形態1における画像処理装置部分のブロック図である。
【図5】実施の形態1におけるコントロールユニット部分の構成を表すブロック図である。
【図6】実施の形態1における画像処理を表すフローチャートである。
【図7】実施の形態1における画像処理装置で捉えた道路画像の一例を表す図である。
【図8】実施の形態1における画像処理装置で捉えた道路画像におけるエッジ抽出状態の一例を表す図である。
【図9】実施の形態1におけるコントロールユニットでの車線追従制御処理を表すフローチャートである。
【図10】実施の形態1における自車の予測進路を演算するフローチャートである。
【図11】実施の形態1における自車予測進路と道路形状の比較の一例を表す図である。
【図12】実施の形態1におけるキャンバ角制御アクチュエータのサーボ制御を表すブロック図である。
【図13】実施の形態1におけるキャンバ角制御アクチュエータ部分の他例を示す構成図である。
【図14】実施の形態1におけるキャンバ角制御アクチュエータ部分の他例を示す構成図である。
【図15】実施の形態1における道路に埋設された磁気マーカによる自車両の位置検出例を表す図である。
【図16】実施の形態2のコントロールユニットでの車線追従制御処理を表すフローチャートである。
【図17】実施の形態2の車線変更判断を表す図である。
【図18】実施の形態2の車線変更終了を表す図である。
【図19】実施の形態3のコントロールユニットでの車線追従制御処理を表すフローチャートである。
【符号の説明】
1 カメラ
2 画像処理装置
3 車速センサ
4 キャンバ角制御アクチュエータ
4a 取り付け点
5 舵角センサ
6 コントロールユニット
21 車線抽出処理部
22 走路形状推定部
23 位置偏差算出部
41 アッパーアーム
42 駆動用モータ
43 ボールねじ
61 自車進路予測演算部
62 目標キャンバ角算出部
63 モータ駆動制御部
Claims (5)
- 正面からみた車輪中心面が鉛直面となす角度である車輪のキャンバ角を変更するキャンバ角変更手段と、
車両前方の車線形状を検出する車線形状検出手段と、
自車の予測進路を演算する予測進路演算手段と、
前記車線形状検出手段の検出結果と前記予測進路演算手段の演算結果から求めた、前方車線における将来の自車位置を基に、車両を前方車線に追従させるために必要な車輪のキャンバ角を演算する目標キャンバ角演算手段と、
前記キャンバ角変更手段を駆動制御し、車輪のキャンバ角を該目標キャンバ角に制御するキャンバ角制御手段と、
乗員の操作による操舵量を検出する操舵量検出手段を備え、
前記目標キャンバ角演算手段を、前記車線形状検出手段の検出結果から求めた前方車線方向と、前記予測進路演算手段の演算結果から求めた予測進路方向が異なり、かつ、前記操舵量検出手段の検出結果が所定の値を超えた場合、目標キャンバ角を原点位置に戻す手段としたことを特徴とする車線追従走行制御装置。 - 正面からみた車輪中心面が鉛直面となす角度である車輪のキャンバ角を変更するキャンバ角変更手段と、
車両前方の車線形状を検出する車線形状検出手段と、
自車の予測進路を演算する予測進路演算手段と、
前記車線形状検出手段の検出結果と前記予測進路演算手段の演算結果から求めた、前方車線における将来の自車位置を基に、車両を前方車線に追従させるために必要な車輪のキャンバ角を演算する目標キャンバ角演算手段と、
前記キャンバ角変更手段を駆動制御し、車輪のキャンバ角を該目標キャンバ角に制御するキャンバ角制御手段と、
乗員の方向指示器操作状態を検出する方向指示器操作状態検出手段を備え、
前記目標キャンバ角演算手段を、前記方向指示器操作状態検出手段の検出結果により、乗員による方向指示器の操作が検出されたとき、目標キャンバ角を原点位置に戻す手段としたことを特徴とする車線追従走行制御装置。 - 請求項1または請求項2に記載の車線追従走行制御装置において、
前記目標キャンバ角演算手段は、前方車線方向と予測進路方向が異なり、かつ、操舵量検出結果が所定の値を超えた場合、目標キャンバ角を第1変化速度により原点位置に戻し、乗員による方向指示器の操作が検出されたとき、目標キャンバ角を第2変化速度により原点位置に戻す手段であり、
前記目標キャンバ角演算手段での目標キャンバ角を原点位置に戻す際の前記第1変化速度を、前記第2変化速度よりも低く設定したことを特徴とする車線追従走行制御装置。 - 請求項1乃至請求項3の何れか1項に記載の車線追従走行制御装置において、
現在の車線内における自車位置を検出する自車位置検出手段と、
乗員の操作による操舵量を検出する操舵量検出手段と、
自車両の車速を検出する車速検出手段を備え、
前記予測進路演算手段を、検出された自車位置,操舵量及び車速を基に予測進路を演算する手段としたことを特徴とする車線追従走行制御装置。 - 請求項1乃至請求項4の何れか1項に記載の車線追従走行制御装置において、
前記操舵量検出手段により検出される操舵量を、操舵角又は操舵トルクのいずれかとしたことを特徴とする車線追従走行制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2000250426A JP3705094B2 (ja) | 2000-08-22 | 2000-08-22 | 車線追従走行制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2000250426A JP3705094B2 (ja) | 2000-08-22 | 2000-08-22 | 車線追従走行制御装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2002063698A JP2002063698A (ja) | 2002-02-28 |
JP3705094B2 true JP3705094B2 (ja) | 2005-10-12 |
Family
ID=18739996
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2000250426A Expired - Fee Related JP3705094B2 (ja) | 2000-08-22 | 2000-08-22 | 車線追従走行制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3705094B2 (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007112227A (ja) * | 2005-10-19 | 2007-05-10 | Toyota Motor Corp | 旋回半径に応じてロール剛性前後比を変更する車輌 |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20020094545A (ko) * | 2001-06-12 | 2002-12-18 | 현대자동차주식회사 | 자동차의 차선 이탈 방지시스템 및 그 제어방법 |
JP4733545B2 (ja) * | 2006-03-27 | 2011-07-27 | 富士重工業株式会社 | 車線認識装置 |
JP4983089B2 (ja) * | 2006-04-28 | 2012-07-25 | 日産自動車株式会社 | 車線逸脱防止装置 |
EP2253489B1 (en) | 2008-02-14 | 2015-04-08 | Fundación Robotiker | Suspension system for motor vehicles and motor vehicle including said system |
JP2009241858A (ja) * | 2008-03-31 | 2009-10-22 | Equos Research Co Ltd | 旋回制御装置及び旋回制御方法 |
JP5152146B2 (ja) * | 2009-10-21 | 2013-02-27 | 株式会社エクォス・リサーチ | キャンバ制御装置 |
JP5246437B2 (ja) * | 2009-10-29 | 2013-07-24 | 株式会社エクォス・リサーチ | 車両用キャンバ角制御装置 |
JP5370681B2 (ja) * | 2010-02-25 | 2013-12-18 | 株式会社エクォス・リサーチ | 車両用キャンバ角制御装置 |
-
2000
- 2000-08-22 JP JP2000250426A patent/JP3705094B2/ja not_active Expired - Fee Related
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007112227A (ja) * | 2005-10-19 | 2007-05-10 | Toyota Motor Corp | 旋回半径に応じてロール剛性前後比を変更する車輌 |
Also Published As
Publication number | Publication date |
---|---|
JP2002063698A (ja) | 2002-02-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6489135B2 (ja) | 車両の運転支援装置 | |
JP6652045B2 (ja) | 自動運転車両 | |
JP3905727B2 (ja) | 車両の車線追従制御装置 | |
US8457868B2 (en) | Lane keeping assist device and lane keeping assist method | |
JP5365084B2 (ja) | 車両用操舵制御装置及び車両用操舵制御方法 | |
JP3835222B2 (ja) | 車線逸脱対応装置 | |
JP5374959B2 (ja) | 車両用走行支援装置 | |
JP5332703B2 (ja) | 車線維持支援装置及び車線維持支援方法 | |
JP5853552B2 (ja) | 車両用走行制御装置 | |
JP5012849B2 (ja) | 車両走行制御装置 | |
JP3738613B2 (ja) | 車線追従装置 | |
US10745046B2 (en) | Steering assist apparatus of vehicle and method for steering assist apparatus | |
JP3707405B2 (ja) | 車線逸脱警告装置 | |
JP4291625B2 (ja) | 車両用走行支援装置 | |
JP5504589B2 (ja) | 車両用操舵制御装置及び車両用操舵制御方法 | |
CN115551756A (zh) | 路径控制模块、相关联的路径控制设备以及相关联的方法 | |
JP5299756B2 (ja) | 車両 | |
JP3705094B2 (ja) | 車線追従走行制御装置 | |
JP5380861B2 (ja) | 車線維持支援装置及び車線維持支援方法 | |
JP5380860B2 (ja) | 車線維持支援装置及び車線維持支援方法 | |
JP2009101809A (ja) | 車両用運転支援装置 | |
JP3956631B2 (ja) | 車両用操舵装置 | |
JP2010158987A (ja) | 車両用転舵制御装置 | |
JP3978283B2 (ja) | 電動パワーステアリング装置 | |
JP2019162918A (ja) | 車両の操舵支援装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
RD04 | Notification of resignation of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7424 Effective date: 20041112 |
|
A977 | Report on retrieval |
Effective date: 20050315 Free format text: JAPANESE INTERMEDIATE CODE: A971007 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20050412 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20050606 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Effective date: 20050705 Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
A61 | First payment of annual fees (during grant procedure) |
Effective date: 20050718 Free format text: JAPANESE INTERMEDIATE CODE: A61 |
|
R150 | Certificate of patent (=grant) or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
LAPS | Cancellation because of no payment of annual fees |