Deprecated: The each() function is deprecated. This message will be suppressed on further calls in /home/zhenxiangba/zhenxiangba.com/public_html/phproxy-improved-master/index.php on line 456
JP3933085B2 - Automatic steering device for vehicles - Google Patents
[go: Go Back, main page]

JP3933085B2 - Automatic steering device for vehicles - Google Patents

Automatic steering device for vehicles Download PDF

Info

Publication number
JP3933085B2
JP3933085B2 JP2003108235A JP2003108235A JP3933085B2 JP 3933085 B2 JP3933085 B2 JP 3933085B2 JP 2003108235 A JP2003108235 A JP 2003108235A JP 2003108235 A JP2003108235 A JP 2003108235A JP 3933085 B2 JP3933085 B2 JP 3933085B2
Authority
JP
Japan
Prior art keywords
set time
vehicle
gaze point
steering
calculated
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 - Lifetime
Application number
JP2003108235A
Other languages
Japanese (ja)
Other versions
JP2004314692A (en
Inventor
泰久 早川
健 木村
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nissan Motor Co Ltd
Original Assignee
Nissan Motor Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Nissan Motor Co Ltd filed Critical Nissan Motor Co Ltd
Priority to JP2003108235A priority Critical patent/JP3933085B2/en
Publication of JP2004314692A publication Critical patent/JP2004314692A/en
Application granted granted Critical
Publication of JP3933085B2 publication Critical patent/JP3933085B2/en
Anticipated expiration legal-status Critical
Expired - Lifetime legal-status Critical Current

Links

Images

Landscapes

  • Steering Control In Accordance With Driving Conditions (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Description

【0001】
【発明の属する技術分野】
本発明は、自動操舵を行う車両用自動操舵装置に関するものである。
【0002】
【従来の技術】
従来、この種の車両用自動操舵装置として、例えば、所定時間後に自車両が到達する遠方先読み地点と、上記所定時間より短い所定時間後に自車両が到達する近傍先読み地点とを夫々算出し、次いで遠方先読み地点での道路の曲がり具合に応じたフィードフォワード制御用の操舵量と、近傍先読み地点での道路に対する自車位置のずれ具合に応じたフィードバック制御用の操舵補正量とを夫々算出し、これら操舵量と操舵補正量とに基づいて車両の操舵制御を行うように構成された車両走行制御装置がある(特許文献1参照)。
【0003】
【特許文献1】
特開2000−122719号公報
【0004】
【発明が解決しようとする課題】
しかしながら、上記従来例にあっては、遠方先読み地点及び近傍先読み地点は、各所定時間後に自車両が到達する夫々の地点として算出されるように構成されているので、例えば、低車速であるほど遠方先読み地点及び近傍先読み地点が共に自車両の手前に寄ってしまうことで自車両がカーブに接近しているのにカーブに進入する直前まで操舵が開始されなかったり、逆に高車速であるほど遠方先読み地点及び近傍先読み地点が共に自車両から遠く離れてしまうことで自車両がカーブに十分接近していないのにカーブ手前から操舵が開始されたりして、スムーズな操舵を確保できないという未解決の課題がある。
そこで、本発明は上記従来例の未解決の課題に着目してなされたものであり、スムーズな自動操舵を実現できる車両用自動操舵装置を提供することを目的としている。
【0005】
【課題を解決するための手段】
上記目的を達成するために、本発明の車両用自動操舵装置は、自車速に応じて第1設定時間及び第2設定時間を算出し、自車両を走行させる基準経路で、第1設定時間が経過するときに自車両が通過する第1前方注視地点、及び前記第2設定時間が経過するときに自車両が通過する第2前方注視地点を夫々設定し、当該第1前方注視地点における道路形状に応じた第1操舵量、及び第2前方注視地点を自車両が通過する際の基準経路との横偏差に応じた第2操舵量を夫々算出し、当該第1操舵量及び第2操舵量の加算値に基づいて自車両の操舵制御を行うことを特徴としている。
【0006】
【発明の効果】
本発明の車両用自動操舵装置によれば、自車速に応じて第1設定時間及び第2設定時間を算出し、自車両を走行させる基準経路で、第1設定時間が経過するときに自車両が通過する第1前方注視地点、及び前記第2設定時間が経過するときに自車両が通過する第2前方注視地点を夫々設定し、この第1前方注視地点における道路形状に応じた第1操舵量と、第2前方注視地点を自車両が通過する際の基準経路との横偏差に応じた第2操舵量とを夫々算出し、これらの第1操舵量及び第2操舵量の加算値に基づいて自車両の操舵制御を行うように構成されているので、第1前方注視地点及び第2前方注視地点の双方が、自車速に応じて自車両の手前に寄ったり自車両から遠く離れたりすることを抑制することができ、結果としてスムーズな自動操舵を実現できるという効果が得られる。
【0007】
【発明の実施の形態】
以下、本発明の実施形態を図面に基づいて説明する。
図1は、本発明の一実施形態を示す概略構成図であり、図中、1FL、1FR、1RL及び1RRは夫々左前輪、右前輪、左後輪及び右後輪であり、後輪1RL及び1RRは、エンジン2の駆動力が自動変速機3、プロペラシャフト4、最終減速装置5及び車軸6を順に介して伝達される駆動輪である。
【0008】
また、前輪1FL及び1FRは、ステアリングギヤ7、ステアリングシャフト8を介してステアリングホイール9に連結された操舵輪であり、ステアリングシャフト8には、電動モータで構成された操舵アクチュエータ10が連結されている。この操舵アクチュエータ10は、後述するコントローラ16から出力される操舵制御量δCに応じて、前輪1FL及び1FRの操舵方向、操舵角、及び操舵速度を制御するように構成されている。
【0009】
また、各車輪1FL〜1RRには、車輪の回転速度に応じた周波数の車輪速VFL〜VRRを出力する車輪速センサ11FL〜11RRが配設されている。さらに、車両には、前後加速度Xgを検出する前後加速度センサ12と、横加速度Ygを検出する横加速度センサ13と、ヨーレートφを検出するヨーレートセンサ14とが備えられている。
【0010】
また、車両には、人口衛星から送られる衛星電波を受信して現在の自車位置を検出するGPS14と、所定領域の道路地図情報を記憶したCD−ROMやDVD−ROM等の記憶媒体がセットされた記憶ユニット15とが搭載されている。これら、各車輪速センサ11FL〜11RRで検出する車輪速VFL〜VRRと、前後加速度センサ12で検出される前後加速度Xgと、横加速度センサ13で検出される横加速度Ygと、GPS14で検出する自車位置情報と、記憶ユニット15に記憶された道路地図情報とが、例えばマイクロコンピュータで構成されたコントローラ16に入力される。このコントローラ16では、図2の操舵制御処理を常時実行することで前述した操舵アクチュエータ10に対する操舵制御量δCの出力を制御し、自動操舵により自車両を基準経路に沿って走行させるように構成されている。
【0011】
次に、コントローラ16で常時実行する操舵制御処理を図2のフローチャートに従って説明する。
先ず、ステップS1では、GPS14で検出された自車位置に従って記憶ユニット15に記憶された道路地図情報を読込み、道路地図情報を構成するノードデータ(X,Y)のうち、図2に示すように、自車位置を基準とし前後に所定距離だけとった範囲(Xo,Yo)〜(Xn,Yn)を常時バッファに保有する。ここで、前方側の距離は、例えば、車速Vに所定時間t1を乗じた値(=V・t1)、又は予め設定した最小値のうち大きい方に設定する。
【0012】
次に、ステップS2に移行して、各種センサから出力される各車輪速VFL〜VRRと、前後加速度Xgと、横加速度Ygと、ヨーレートφとを読込んだら、続いて移行するステップS3で各車輪速VFL〜VRRの平均から車速VCを算出する。次に、ステップS4に移行して、図3の設定時間算出マップを参照して、ステップS3で算出した車速VCから第1設定時間T1及び第2設定時間T2を夫々設定する。この設定時間算出マップは、図3に示すように、横軸が車速VCを、縦軸が設定時間Tを夫々表している。そして、第1設定時間T1は、実線で示すように、車速VCが低車速から増加するときに比較的大きな値THから徐々に減少すると共に、その減少率が車速VCの増加に応じて次第に緩やかになるように設定され、一方の第2設定時間T2は、一点鎖線で示すように車速VCが低車速から増加するときに前述したTHよりも小さな値TLから徐々に増加すると共に、その増加率が車速VCの増加に応じて次第に緩やかになるように設定される。また、車速VCが中速域の所定値VMを上回るときに、第1設定時間T1及び第2設定時間T2における大小の関係が逆転するように構成されている。
【0013】
そして、ステップS5に移行して、ステップS4で算出された第1設定時間T1が経過するときに自車両が通過する第1前方注視地点P1を算出する。具体的には、第1設定時間T1に車速VCを乗じてT1が経過する間に自車両が進む距離D1(=T1・VC)を算出し、現在の自車位置から距離D1分だけ進んだ地点における最寄りのノードを夫々第1前方注視地点P1として設定する。
【0014】
次に、ステップS6に移行して、ステップS5で算出された第1前方注視地点P1における道路の曲率半径ρを算出する。先ずは、図4に示すように、P1を中央として前後に所定距離DSをとった地点における最寄りのノードをPF及びPRとし、P1及びPRを結ぶ線分P1Rと、P1及びPFを結ぶ線分P1Fとで成す角度θと、PF及びPRの距離dとを夫々算出する。ここで、所定距離DSは、車速Vに例えば1秒程度の一定時間t2を乗じて算出する。なお、所定距離DSが極めて短くなることを抑制するために最小値DMINを設定し、この最小値DMIN及び車速Vに応じて算出される値のうち大きい方を所定距離DSとして算出してもよい。そして、PF、P1及びPRを通る円弧の中心Oは、線分P1Fの中点aを通る垂直2等分線Aと、線分P1Rの中点bを通る垂直2等分線Bとの交点であり、線分P1Rと線分P1Fとで成す角度θは、垂直2等分線A及びBの成す∠aObに等しくなる。また∠PFOPRは∠aObの2倍であるので、下記(1)式に従って、角度θ及び距離dから曲率半径ρを算出する。
ρ=d/2・sinθ ・・・・・・(1)
【0015】
次に、ステップS7に移行して、ステップS6で算出された第1前方注視地点P1での曲率半径ρと、車両のホイールベースLとに基づいて、下記(2)式より第1操舵量δ1を算出する。
δ1=L/ρ ・・・・・・(2)
そして、ステップS8に移行して、前記ステップS4で算出された第2設定時間T2が経過するときに自車両が通過する第2前方注視地点P2を算出する。具体的には、GPS14から今回読込んだ自車位置及び前回読込んだ自車位置の位置関係から自車両の速度ベクトルVを算出すると共に、第2設定時間T2に車速VCを乗じてT2が経過する間に自車両が進む距離D2(=T2・VC)を算出し、現在の自車位置から速度ベクトルVの延長上を距離D2分だけ進んだ地点を第2前方注視地点P2として設定する。
【0016】
次に、ステップS9に移行して、ステップS7で算出された第2前方注視地点P2を自車両が通過するときの基準経路に対する横偏差YEを算出する。この基準経路に対する横偏差YEは、自車両の車両姿勢から求まる横偏差YSと、車両旋回状態から求まる横偏差YPとを加算して算出する。
先ず、車両のスリップ角θSは、前後加速度Xg及び横加速度Ygを用いて下記(2)式のように表される。
θS=tan-1(Yg/Xg) ・・・・・・(3)
【0017】
また、図5に示すような基準座標上における自車両のヨー角をε1、第2前方注視地点P2を通り速度ベクトルVに直角な直線Cと基準経路との交点Qにおける基準座標に対する基準経路のずれ角をεTとすると、基準経路に対する自車両のヨー角εRを、下記(4)式のように表すことができる。
εR=εT−ε1 ・・・・・・(4)
【0018】
さらに、初期状態における基準経路と自車位置との横偏差をYUとすると、車両姿勢に応じた横偏差YSは下記(5)式のように表されるので、この(5)式に従って、YU、D2、εR及びθSから車両姿勢に応じた横偏差YSを算出する。
S=YU+D2・tan(εR+θS) ・・・・・・(5)
【0019】
次に、車両が定常円旋回を行っているとすると、スリップレートを無視することができるので、車両旋回状態から求まる横偏差YPは、下記(6)式で表すことができ、この(6)式中のβは、下記(7)で表すことができる。したがって、これら(6)及び(7)式を解き、車両旋回状態に応じた横偏差YPを算出する。
P=D2・tanβ ・・・・・・(6)
β=1/2・sin-1(D2・ε1/Xg) ・・・・・・(7)
こうして算出された横偏差YSと横偏差YPとを加算して基準経路に対する横偏差YE(=YS+YP)を算出したら、ステップS10に移行する。
【0020】
このステップS10では、ステップS9で算出された第2前方注視地点P2を通過する基準経路に対する横偏差YEに基づいて、下記(8)式より第2操舵量δ2を算出する。ここで、K1及びK2は係数であり、直線走行時の外乱に対して追従誤差が拡大しないように最適な値を実験から求めることが望ましい。
δ2=K1・YE+K2・(dYE/dt) ・・・・・・(8)
そして、ステップS11に移行して、前記ステップS7で算出された第1操舵量δ1と、ステップS10で算出された第2操舵量δ2とを加算して、操舵制御量δC(=δ1+δ2)を算出してから、続くステップS12に移行して、この操舵制御量δCを操舵アクチュエータ10に出力し、前記ステップS1に戻る。
【0021】
以上より、図1のGPS14及び記憶ユニット15と、図3におけるステップS1の処理とが基準経路検出手段に対応し、図1の各車輪速センサ11FL〜11RRと、図3におけるステップS3の処理とが車速検出手段に対応している。また、ステップS4の処理が第1設定時間算出手段及び第2設定時間算出手段に対応し、ステップS5の処理が第1前方注視地点設定手段に対応し、ステップS6の処理が道路形状検出手段に対応し、ステップS7の処理が第1操舵量算出手段に対応し、ステップS8の処理が第2前方注視地点設定手段に対応し、ステップS9の処理が横偏差検出手段に対応し、ステップS10の処理が第2操舵量算出手段に対応し、図1の操舵アクチュエータ10と、図3におけるステップS11及びステップS12の処理とが操舵制御手段に対応している。
【0022】
次に、上記一実施形態の動作について説明する。
今、自車両を自動操舵で走行させているとすると、コントローラ16で常時実行される操舵制御処理では、先ず、GPS15で検出される自車位置を基準にして所定範囲の道路地図情報を記憶ユニット16から読み出し、自車両を走行させる基準経路を検出している(ステップS1)。
【0023】
そして、図3の設定時間算出マップを参照して自車速Vに応じた第1設定時間T1及び第2設定時間T2を算出し(ステップS4)、自車両が走行する基準経路で、各第1設定時間T1及び第2設定時間T2が経過するときに自車両が通過する第1前方注視地点P1と第2前方注視地点P2とを設定する(ステップS5及びステップS8)。
【0024】
このとき、第1設定時間T1は車速が高いほど短くなるように設定され、逆に第2設定時間T2は車速が高いほど長くなるように設定され、且つ両者の相対的な関係が、低速走行時には第2設定時間T2よりも第1設定時間T1の方が長くなるように、逆に高速走行時には第1設定時間T1よりも第2設定時間T2の方が長くなるように設定される。
【0025】
次に、設定された第1前方注視地点P1における基準経路の曲率半径ρを算出し(ステップS6)、この曲率半径ρに応じて自車両に必要とされるフィードフォワード的な、すなわち車両挙動のスムーズさを向上させる第1操舵量δ1を算出する(ステップS7)。また、比較的近くに設定された第2前方注視地点P2を自車両が通過する際の基準経路との横偏差YEを、現在の車両姿勢及び旋回状態に基づいて算出し(ステップS9)、この横偏差YEに応じて自車両に必要とされるフィードバック的な、すなわち基準経路に対する追従性を向上させる第2操舵量δ2を算出する(ステップS10)。
【0026】
こうして、フィードフォワード的な第1操舵量δ1と、フィードバック的な第2操舵量δ2とを加算して求めた操舵制御量δCを、電動モータで構成された操舵アクチュエータ10に対して出力することにより、操舵輪としての前輪1FL及び1FRの操舵方向、操舵角、及び操舵速度を制御する(ステップS11及びステップS12)。
【0027】
したがって、自車両が低速で走行している場合には、第1前方注視地点P1は比較的遠くに設定されるので、この低速走行状態でカーブに接近するとフィードフォワード的に作用する第1操舵量δ1の値が増加してゆくことにより操舵開始の遅れが防止される。
また、自車両が高速で走行している場合には、第1前方注視地点P1は自車両から遠ざかることが抑制されるので、フィードフォワード的に作用する第1操舵量δ1の増加を抑制し、カーブに十分接近していないのにカーブ手前から操舵が開始されることが防止される。また、フィードバック的に作用する第2操舵量δ2を算出するための第2前方注視地点P2が比較的遠くに設定されることにより、車両挙動のスムーズさが更に向上する。
【0028】
このように、車速Vに応じて第1設定時間T1及び第2設定時間T2の値が変更されるので、第1前方注視地点P1及び第2前方注視地点P2の双方が、自車速に応じて自車両の手前に寄ったり自車両から遠く離れたりすることが抑制され、スムーズな自動操舵が実現される。
【0029】
なお、上記一実施形態においては、設定時間算出マップを図4で示したように、第2設定時間T2は、低速走行時よりも高速走行時の方が長くなるように設定されている場合について説明したが、これに限定されるものではない。例えば、図7(a)に示すように、第2設定時間T2を車速Vの変化に係りなく常に一定値に設定すると共に、第1設定時間T1が低速走行時には第2設定時間T2よりも長く、高速走行時には第2設定時間T2よりも短くなるように設定することにより、第1前方注視地点P1及び第2前方注視地点P2の双方が、車速Vの増加に応じて自車両から遠く離れることを抑制してもよい。また、図7(b)に示すように、車速Vが中速の所定範囲にあるときに、第1設定時間T1及び第2設定時間T2の双方に車速Vが上昇するときと減少するときとでヒステリシスを持たせるようにしてもよい。この場合、第1設定時間T1は、車速Vが増加するときよりも減少するときの方が短くなるようにヒステリシスを持たせ、一方の第2設定時間T2は、車速Vが増加するときよりも減少するときの方が長くなるようにヒステリシスを持たせることが望ましい。また、このような中速走行時のヒステリシスを、車速Vの上昇及び減少で変更する場合に限らず、運転者の好みに応じて変更できるようにしてもよい。
【0030】
また、上記一実施形態においては、GPS14で検出される自車位置と、記憶ユニット15から読込む道路地図情報とに基づいて自車両を走行させる基準経路を検出する場合について説明したが、これに限定されるものではない。すなわち、例えば、道路のインフラストラクチャーが整備された場合に、インフラストラクチャー側との路車間通信によって経路情報を取得したり、或いはCCDカメラやCMOSカメラ等による画像処理により検出される白線に基づいて基準経路を取得したりしてもよい。
【0031】
以上のように、上記一実施形態によれば、ステップS1の処理で、自車位置と道路地図情報とに基づいて自車両を走行させるための基準経路を検出し、ステップS3の処理で、車輪速VFL〜VRRから自車速Vを検出し、ステップS4の処理で、図4の設定時間算出マップから自車速Vに応じて第1設定時間T1及び第2設定時間T2を算出し、ステップS5の処理で、第1設定時間T1が経過するときに自車両が通過する基準経路上の地点を第1前方注視地点P1として設定し、ステップS6の処理で、第1前方注視地点P1における基準経路の曲率半径ρを検出し、ステップS7の処理で、第1前方注視地点P1における基準経路の曲率半径ρに応じて第1操舵量δ1を算出し、ステップS8の処理で、第2設定時間T2が経過するときに自車両が通過する基準経路上の地点を第2前方注視地点P2として設定し、ステップS9の処理で、第2前方注視地点P2を自車両が通過するときの基準経路に対する横偏差YEを検出し、ステップS10の処理で、第2前方注視地点P2での横偏差YEに応じて第2操舵量δ2を算出し、ステップS11及びS12の処理で、第1操舵量δ1及び第2操舵量δ2に基づいて自車両の操舵制御を行うように構成されているので、第1前方注視地点P1及び第2前方注視地点P2の双方が、車速Vに応じて自車両の手前に寄ったり自車両から遠く離れたりすることを抑制することができ、結果としてスムーズな自動操舵を実現できるという効果が得られる。
【0032】
また、ステップS4の処理では、低速走行時よりも高速走行時の方が短くなるように第1設定時間T1を算出しているので、高速走行時に第1前方注視地点P1が自車両から遠く離れることと、低速走行時に第1前方注視地点P1が自車両の手前に寄り過ぎることとを抑制できるという効果が得られる。
また、ステップS4の処理では、高速走行時には、第2設定時間T2よりも短くなるように第1設定時間T1を算出しているので、高速走行時に第1前方注視地点P1が自車両から遠く離れることを確実に抑制できるという効果が得られる。
【0033】
さらに、ステップS4の処理では、低速走行時よりも高速走行時の方が長くなるように第2設定時間T2を算出しているので、フィードバック的に作用する第2操舵量δ2を算出するための第2前方注視地点P2が自車両から離れることにより車両挙動のスムーズさが向上するという効果が得られる。
さらにまた、ステップS4の処理では、高速走行時には、第1設定時間T1よりも長くなるように第2設定時間T2を算出しているので、フィードバック的に作用する第2操舵量δ2を算出するための第2前方注視地点P2が自車両から更に離れることで、より車両挙動のスムーズさが向上するという効果が得られる。
【0034】
また、ステップS9の処理では、車両姿勢と自車両の旋回状態とに基づいて基準経路に対する横偏差YEを算出しているので、第2前方注視地点P2を自車両が通過するときの基準経路に対する横偏差YEを正確に算出できるという効果が得られる。
さらに、基準経路における第1前方注視地点P1の前後に所定距離DSをとった範囲の道路曲率半径ρを検出し、この所定距離DSは、車速Vが早いほど長くなるように構成されているので、運転者に近い感覚で的確に道路曲率半径ρを算出できるという効果が得られる。
【図面の簡単な説明】
【図1】本発明の一実施形態の概略構成図である。
【図2】操舵制御処理の一例を示すフローチャートである。
【図3】道路地図情報の構成を説明した図である。
【図4】設定時間算出マップである。
【図5】第1前方注視地点P1における道路曲率半径ρの算出方法を説明した図である。
【図6】第2前方注視地点P2における横偏差YEの算出方法を説明した図である。
【図7】設定時間算出マップの他の設定例である。
【符号の説明】
10 操舵アクチュエータ
11FL〜11RR 車輪速センサ
12 前後加速度センサ
13 横加速度センサ
14 ヨーレートセンサ
15 ディファレンシャルGPS
16 記憶ユニット
17 コントローラ
[0001]
BACKGROUND OF THE INVENTION
The present invention relates to an automatic steering apparatus for a vehicle that performs automatic steering.
[0002]
[Prior art]
Conventionally, as this type of vehicle automatic steering device, for example, a far-ahead look-ahead point where the host vehicle reaches after a predetermined time and a nearby look-ahead point where the host vehicle reaches after a predetermined time shorter than the predetermined time are calculated. Calculate the steering amount for feed-forward control according to the degree of curve of the road at the distant pre-reading point and the steering correction amount for feedback control according to the degree of deviation of the vehicle position with respect to the road at the pre-reading point, There is a vehicle travel control device configured to perform vehicle steering control based on the steering amount and the steering correction amount (see Patent Document 1).
[0003]
[Patent Document 1]
Japanese Patent Laid-Open No. 2000-122719
[Problems to be solved by the invention]
However, in the above-described conventional example, the far-ahead look-ahead point and the near-ahead look-ahead point are configured to be calculated as the respective points where the host vehicle reaches after each predetermined time. Both the far-ahead look-ahead point and the near-ahead look-ahead point approach the front of the vehicle so that the vehicle is approaching the curve, but the steering is not started until just before entering the curve, or conversely, the higher the vehicle speed. Unresolved that it is impossible to ensure smooth steering because the far-forward look-ahead point and the nearby look-ahead point are both far away from the own vehicle, and the own vehicle is not sufficiently close to the curve, but steering is started from the front of the curve. There is a problem.
Accordingly, the present invention has been made paying attention to the unsolved problems of the above-described conventional example, and an object thereof is to provide an automatic steering device for a vehicle that can realize smooth automatic steering.
[0005]
[Means for Solving the Problems]
To achieve the above object, a vehicular automatic steering device of the present invention calculates a first set time and the second set time in accordance with the vehicle speed, in reference trajectory for running the vehicle, the first set time A first forward gaze point through which the host vehicle passes when the vehicle passes and a second front gaze point through which the vehicle passes when the second set time elapses are set, respectively, and the road shape at the first front gaze point. And a second steering amount corresponding to a lateral deviation from a reference route when the host vehicle passes through the second forward gazing point, respectively. The first steering amount and the second steering amount are calculated. The steering control of the host vehicle is performed based on the added value .
[0006]
【The invention's effect】
According to the vehicle automatic steering device of the present invention, the first vehicle is calculated when the first set time elapses on the reference route for running the host vehicle by calculating the first set time and the second set time according to the host vehicle speed. The first forward gaze point through which the vehicle passes and the second front gaze point through which the host vehicle passes when the second set time elapses are set, and the first steering according to the road shape at the first front gaze point And the second steering amount corresponding to the lateral deviation between the vehicle and the reference route when the host vehicle passes through the second forward gaze point, and the sum of the first steering amount and the second steering amount is calculated . Since the vehicle is configured to perform the steering control based on the vehicle, both the first front gaze point and the second front gaze point may approach the front of the own vehicle or move away from the own vehicle according to the own vehicle speed. Can be suppressed and as a result smooth automatic Effect is obtained that can be realized rudder.
[0007]
DETAILED DESCRIPTION OF THE INVENTION
Hereinafter, embodiments of the present invention will be described with reference to the drawings.
FIG. 1 is a schematic configuration diagram showing an embodiment of the present invention, in which 1FL, 1FR, 1RL, and 1RR are a left front wheel, a right front wheel, a left rear wheel, and a right rear wheel, respectively. 1RR is a drive wheel to which the driving force of the engine 2 is transmitted through the automatic transmission 3, the propeller shaft 4, the final reduction gear 5 and the axle 6 in this order.
[0008]
The front wheels 1FL and 1FR are steering wheels connected to a steering wheel 9 via a steering gear 7 and a steering shaft 8, and a steering actuator 10 composed of an electric motor is connected to the steering shaft 8. . The steering actuator 10 is configured to control the steering direction, the steering angle, and the steering speed of the front wheels 1FL and 1FR according to a steering control amount δ C output from a controller 16 described later.
[0009]
In addition, wheel speed sensors 11FL to 11RR that output wheel speeds V FL to V RR having a frequency corresponding to the rotational speed of the wheels are disposed on the wheels 1FL to 1RR, respectively. Further, the vehicle includes a longitudinal acceleration sensor 12 that detects longitudinal acceleration Xg, a lateral acceleration sensor 13 that detects lateral acceleration Yg, and a yaw rate sensor 14 that detects yaw rate φ.
[0010]
The vehicle is also provided with a GPS 14 that receives satellite radio waves sent from artificial satellites and detects the current vehicle position, and a storage medium such as a CD-ROM or DVD-ROM that stores road map information in a predetermined area. The storage unit 15 is mounted. The wheel speeds VFL to VRR detected by the wheel speed sensors 11FL to 11RR, the longitudinal acceleration Xg detected by the longitudinal acceleration sensor 12, the lateral acceleration Yg detected by the lateral acceleration sensor 13, and the self detected by the GPS 14. The vehicle position information and the road map information stored in the storage unit 15 are input to the controller 16 constituted by, for example, a microcomputer. The controller 16 is configured to control the output of the steering control amount δ C to the steering actuator 10 described above by constantly executing the steering control process of FIG. 2 and to make the vehicle travel along the reference route by automatic steering. Has been.
[0011]
Next, steering control processing that is always executed by the controller 16 will be described with reference to the flowchart of FIG.
First, in step S1, the road map information stored in the storage unit 15 is read according to the vehicle position detected by the GPS 14, and among the node data (X, Y) constituting the road map information, as shown in FIG. The range (Xo, Yo) to (Xn, Yn), which is a predetermined distance before and after the vehicle position as a reference, is always held in the buffer. Here, the distance on the front side is set to, for example, a larger one of a value obtained by multiplying the vehicle speed V by a predetermined time t 1 (= V · t 1 ) or a preset minimum value.
[0012]
Next, the process proceeds to step S2, and after the wheel speeds V FL to V RR output from the various sensors, the longitudinal acceleration Xg, the lateral acceleration Yg, and the yaw rate φ are read, the process proceeds to step S3. The vehicle speed V C is calculated from the average of the wheel speeds V FL to V RR . Next, the process proceeds to step S4, and the first set time T 1 and the second set time T 2 are set from the vehicle speed V C calculated in step S3 with reference to the set time calculation map of FIG. In this set time calculation map, as shown in FIG. 3, the horizontal axis represents the vehicle speed V C , and the vertical axis represents the set time T. The first set time T 1, as shown by the solid line, while gradually decreases from a relatively large value T H when the vehicle speed V C is increased from a low vehicle speed, the decrease rate of the increase of the vehicle speed V C Accordingly, the second set time T 2 is gradually decreased from a value T L smaller than T H described above when the vehicle speed V C increases from the low vehicle speed, as indicated by a one-dot chain line. And the rate of increase is set so as to gradually decrease as the vehicle speed V C increases. Further, when the vehicle speed V C exceeds the predetermined value V M of the medium speed region, the magnitude of the relationship in the first set time T 1 and the second set time T 2 are configured to reverse.
[0013]
Then, the process shifts to step S5, and calculates a first forward fixed point P 1 where the vehicle passes when the first set time T 1 calculated in step S4 has elapsed. Specifically, a distance D 1 (= T 1 · V C ) that the host vehicle travels while T 1 elapses by multiplying the first set time T 1 by the vehicle speed V C is calculated from the current host vehicle position. setting the nearest node in the distance a point advanced D 1 minute only as each first forward fixed point P 1.
[0014]
Then control proceeds to step S6, to calculate the radius of curvature ρ of the road in the first look-ahead point P 1 calculated in step S5. First, as shown in FIG. 4, the nearest node in the point taken a predetermined distance D S around the P 1 as the central and P F and P R, the line segment P 1 P R connecting the P 1 and P R When the angle θ which forms with the line segment P 1 P F connecting the P 1 and P F, respectively calculates the distance d P F and P R. Here, the predetermined distance D S is calculated by multiplying the vehicle speed V by a fixed time t 2 of about 1 second, for example. Note that a minimum value D MIN is set to suppress the predetermined distance D S from becoming extremely short, and the larger one of the values calculated according to the minimum value D MIN and the vehicle speed V is calculated as the predetermined distance D S. May be. Then, the center O of the arc through the P F, P 1 and P R passes through a vertical bisector A which passes through the middle point a of the line segment P 1 P F, the midpoint b of the line segment P 1 P R and an intersection of the vertical bisector B, the angle θ which forms with the line segment P 1 P R and the line segment P 1 P F, equal to ∠aOb formed by the vertical bisectors a and B. Since ∠P F OP R is twice の aOb, the radius of curvature ρ is calculated from the angle θ and the distance d according to the following equation (1).
ρ = d / 2 · sinθ (1)
[0015]
Then, the process proceeds to step S7, and the radius of curvature ρ of the first forward gaze point P 1 calculated in step S6, on the basis of the wheel base L of the vehicle, the following (2) the first steering amount than Formula δ 1 is calculated.
δ 1 = L / ρ (2)
Then, the process proceeds to step S8, calculates a second forward fixed point P 2 where the vehicle passes when the second set time T 2 calculated in the step S4 has elapsed. More specifically, the speed vector V of the host vehicle is calculated from the positional relationship between the host vehicle position read from the GPS 14 this time and the host vehicle position read last time, and the second set time T 2 is multiplied by the vehicle speed V C. The distance D 2 (= T 2 · V C ) that the host vehicle travels while T 2 elapses is calculated, and a second point that is a distance D 2 on the extension of the speed vector V from the current host vehicle position is calculated. It is set as a forward gaze point P 2.
[0016]
Then control proceeds to step S9, it calculates the lateral deviation Y E the second headway point P 2 calculated in step S7 with respect to the reference path when the own vehicle passes. The lateral deviation Y E with respect to the reference route is calculated by adding the lateral deviation Y S obtained from the vehicle posture of the host vehicle and the lateral deviation Y P obtained from the vehicle turning state.
First, the slip angle θ S of the vehicle is expressed by the following equation (2) using the longitudinal acceleration Xg and the lateral acceleration Yg.
θ S = tan −1 (Yg / Xg) (3)
[0017]
The reference to the reference coordinates at the intersection Q of the perpendicular straight line C and the reference path to the own yaw angle epsilon 1 of the vehicle, the second forward fixed point P 2 the street velocity vector V on the reference coordinates as shown in FIG. 5 Assuming that the deviation angle of the route is ε T , the yaw angle ε R of the host vehicle with respect to the reference route can be expressed as the following equation (4).
ε R = ε T −ε 1 (4)
[0018]
Further, if the lateral deviation between the reference route and the vehicle position in the initial state is Y U , the lateral deviation Y S corresponding to the vehicle posture is expressed by the following equation (5). , Y U , D 2 , ε R and θ S, the lateral deviation Y S corresponding to the vehicle attitude is calculated.
Y S = Y U + D 2 · tan (ε R + θ S ) (5)
[0019]
Next, assuming that the vehicle is making a steady circular turn, the slip rate can be ignored. Therefore, the lateral deviation Y P obtained from the vehicle turning state can be expressed by the following equation (6). ) In the formula can be expressed by the following (7). Accordingly, solving these (6) and (7), and calculates the lateral deviation Y P corresponding to the vehicle turning state.
Y P = D 2 · tan β (6)
β = 1/2 · sin −1 (D 2 · ε 1 / Xg) (7)
When the lateral deviation Y S and lateral deviation Y P calculated in this way are added to calculate the lateral deviation Y E (= Y S + Y P ) relative to the reference route, the process proceeds to step S10.
[0020]
In step S10, the second steering amount δ 2 is calculated from the following equation (8) based on the lateral deviation Y E with respect to the reference route passing through the second forward gaze point P 2 calculated in step S9. Here, K 1 and K 2 are coefficients, and it is desirable to obtain an optimum value from an experiment so that the following error does not increase with respect to disturbance during straight running.
δ 2 = K1 · Y E + K2 · (dY E / dt) (8)
Then, the process proceeds to step S11, where the first steering amount δ 1 calculated in step S7 and the second steering amount δ 2 calculated in step S10 are added to obtain a steering control amount δ C (= δ 1 + δ 2 ) is calculated, the process proceeds to the subsequent step S12, the steering control amount δ C is output to the steering actuator 10, and the process returns to step S1.
[0021]
From the above, the GPS 14 and the storage unit 15 in FIG. 1 and the processing in step S1 in FIG. 3 correspond to the reference path detecting means, the wheel speed sensors 11FL to 11RR in FIG. 1, and the processing in step S3 in FIG. Corresponds to vehicle speed detection means. Further, the process of step S4 corresponds to the first set time calculation means and the second set time calculation means, the process of step S5 corresponds to the first forward gaze point setting means, and the process of step S6 corresponds to the road shape detection means. Correspondingly, the process of step S7 corresponds to the first steering amount calculation means, the process of step S8 corresponds to the second forward gaze point setting means, the process of step S9 corresponds to the lateral deviation detection means, The processing corresponds to the second steering amount calculation means, and the steering actuator 10 in FIG. 1 and the processing in steps S11 and S12 in FIG. 3 correspond to the steering control means.
[0022]
Next, the operation of the one embodiment will be described.
Assuming that the host vehicle is currently running by automatic steering, in the steering control process that is always executed by the controller 16, first, the road map information in a predetermined range is stored in the storage unit based on the host vehicle position detected by the GPS 15. A reference route for reading the vehicle and driving the host vehicle is detected (step S1).
[0023]
Then, the first set time T 1 and the second set time T 2 corresponding to the host vehicle speed V are calculated with reference to the set time calculation map of FIG. 3 (step S4). A first forward gaze point P 1 and a second front gaze point P 2 through which the host vehicle passes when the first set time T 1 and the second set time T 2 have passed are set (steps S5 and S8).
[0024]
At this time, the first set time T 1 is set to be shorter as the vehicle speed is higher, and conversely the second set time T 2 is set to be longer as the vehicle speed is higher, and the relative relationship between the two is as becomes longer toward the first set time T 1 than T 2 second set time at the time of low-speed running, reverse so that longer direction of the second set time T 2 than T 1 the first set time during high-speed travel in Set to
[0025]
Next, the radius of curvature ρ of the reference route at the set first forward gaze point P 1 is calculated (step S6), and the feedforward, that is, the vehicle behavior required for the host vehicle is calculated according to the radius of curvature ρ. The first steering amount δ 1 that improves the smoothness of the vehicle is calculated (step S7). Further, a lateral deviation Y E with respect to the reference route when the host vehicle passes through the second forward gaze point P 2 set relatively close is calculated based on the current vehicle posture and turning state (step S9). Based on the lateral deviation Y E , the second steering amount δ 2 that is required for the host vehicle and that improves the followability to the reference route is calculated (step S10).
[0026]
In this way, the steering control amount δ C obtained by adding the feedforward first steering amount δ 1 and the feedback second steering amount δ 2 is output to the steering actuator 10 constituted by the electric motor. As a result, the steering direction, steering angle, and steering speed of the front wheels 1FL and 1FR as the steering wheels are controlled (steps S11 and S12).
[0027]
Therefore, when the host vehicle is traveling at a low speed, the first forward gazing point P 1 is set relatively far, so that the first steering that acts in a feed-forward manner when approaching a curve in this low-speed traveling state. A delay in the start of steering is prevented by increasing the value of the amount δ 1 .
Further, when the host vehicle is traveling at a high speed, the first front gazing point P 1 is suppressed from moving away from the host vehicle, and thus an increase in the first steering amount δ 1 acting in a feedforward manner is suppressed. However, it is possible to prevent the steering from being started before the curve even though the curve is not sufficiently approached. In addition, since the second forward gaze point P 2 for calculating the second steering amount δ 2 acting in a feedback manner is set relatively far, the smoothness of the vehicle behavior is further improved.
[0028]
Thus, since the values of the first set time T 1 and the second set time T 2 are changed according to the vehicle speed V, both the first front gaze point P 1 and the second front gaze point P 2 Depending on the vehicle speed, it is possible to prevent the vehicle from approaching or moving away from the host vehicle, thereby realizing smooth automatic steering.
[0029]
In the above embodiment, when the set time calculation map is shown in FIG. 4, the second set time T 2 is set to be longer at high speed than at low speed. However, the present invention is not limited to this. For example, FIG. 7 (a), the sets the second set time T 2 always a constant value irrespective to the change in vehicle speed V, the at the time of the first set time T 1 is low speed T 2 second set time Longer than the second set time T 2 when traveling at high speed, both the first front gazing point P 1 and the second front gazing point P 2 correspond to the increase in the vehicle speed V. You may suppress moving away from the own vehicle. Further, as shown in FIG. 7B, when the vehicle speed V is within a predetermined range of medium speed, the vehicle speed V decreases when the vehicle speed V increases during both the first set time T 1 and the second set time T 2. You may make it have a hysteresis by occasion. In this case, the first set time T 1 has hysteresis so that the time when the vehicle speed V decreases is shorter than the time when the vehicle speed V increases, while the second set time T 2 is when the vehicle speed V increases. It is desirable to provide hysteresis so that the time when the voltage decreases is longer. In addition, the hysteresis at the time of traveling at medium speed is not limited to changing by increasing and decreasing the vehicle speed V, but may be changed according to the driver's preference.
[0030]
In the above-described embodiment, the case where the reference route for driving the vehicle is detected based on the vehicle position detected by the GPS 14 and the road map information read from the storage unit 15 has been described. It is not limited. That is, for example, when a road infrastructure is established, the route information is acquired by road-to-vehicle communication with the infrastructure side, or based on a white line detected by image processing by a CCD camera, a CMOS camera, or the like. A route may be acquired.
[0031]
As described above, according to the above-described embodiment, the reference route for driving the host vehicle is detected based on the host vehicle position and the road map information in the process of step S1, and the wheel is processed in the process of step S3. The own vehicle speed V is detected from the speeds V FL to V RR, and the first set time T 1 and the second set time T 2 are calculated according to the own vehicle speed V from the set time calculation map of FIG. , by the process at step S5, sets the point on the reference trajectory T 1 first set time passes the own vehicle when the passed as the first forward fixed point P 1, in the process of step S6, the first headway The curvature radius ρ of the reference route at the point P 1 is detected, and the first steering amount δ 1 is calculated according to the curvature radius ρ of the reference route at the first forward gaze point P 1 in the process of step S7. in the process, the host vehicle when the second set time T 2 has elapsed Set the point on the reference path through the second forward fixed point P 2, in the process of step S9, to detect the lateral deviation Y E relative to the reference path when the second headway point P 2 is the vehicle passes In step S10, the second steering amount δ 2 is calculated according to the lateral deviation Y E at the second forward gaze point P 2 , and in steps S11 and S12, the first steering amount δ 1 and the second steering amount δ 2 are calculated. Since the steering control of the host vehicle is performed based on the steering amount δ 2 , both the first front gaze point P 1 and the second front gaze point P 2 are in front of the host vehicle according to the vehicle speed V. It is possible to prevent the vehicle from approaching or moving away from the host vehicle, and as a result, it is possible to achieve smooth automatic steering.
[0032]
Further, the process of step S4, since better at high speeds than at low speeds and calculates the first set time T 1 to be shorter, the first forward fixed point P 1 from the vehicle at the time of high speed and the farther away, the first forward fixed point P 1 during low-speed traveling effect that can be suppressed and it too close to the front of the vehicle.
In the processes of step S4, at the time of high speed running, since the calculated T 1 first set time to be shorter than the second set time T 2, the first forward fixed point P 1 is the vehicle at high speed The effect that it can suppress reliably that it leaves | separates far from is acquired.
[0033]
Furthermore, the process of step S4, since better at high speeds than at low speeds and calculates the second set time T 2 to be longer, and calculates the second steering amount [delta] 2 acting feedback manner effect that smoothness of the vehicle behavior is improved by the second forward fixed point P 2 for leaves from the vehicle.
Furthermore, in the process of step S4, the second set time T 2 is calculated so as to be longer than the first set time T 1 during high speed traveling, so the second steering amount δ 2 acting in a feedback manner is calculated. by the second forward fixed point P 2 to calculate the further away from the vehicle, the effect is obtained that further improved smoothness of the vehicle behavior.
[0034]
Further, in the process of step S9, since the lateral deviation Y E with respect to the reference route is calculated based on the vehicle posture and the turning state of the host vehicle, the reference when the host vehicle passes through the second forward gaze point P 2 is calculated. An effect is obtained that the lateral deviation Y E with respect to the route can be accurately calculated.
Further, a road curvature radius ρ in a range having a predetermined distance D S before and after the first forward gaze point P 1 on the reference route is detected, and the predetermined distance D S is configured to become longer as the vehicle speed V is higher. As a result, the road curvature radius ρ can be accurately calculated with a sense close to that of the driver.
[Brief description of the drawings]
FIG. 1 is a schematic configuration diagram of an embodiment of the present invention.
FIG. 2 is a flowchart illustrating an example of a steering control process.
FIG. 3 is a diagram illustrating a configuration of road map information.
FIG. 4 is a set time calculation map.
FIG. 5 is a diagram illustrating a method for calculating a road curvature radius ρ at a first forward gaze point P 1 .
FIG. 6 is a diagram illustrating a method for calculating a lateral deviation Y E at the second forward gaze point P 2 .
FIG. 7 shows another setting example of the set time calculation map.
[Explanation of symbols]
10 Steering actuators 11FL to 11RR Wheel speed sensor 12 Longitudinal acceleration sensor 13 Lateral acceleration sensor 14 Yaw rate sensor 15 Differential GPS
16 Storage unit 17 Controller

Claims (8)

自車速に応じて第1設定時間及び第2設定時間を算出し、自車両を走行させる基準経路で、前記第1設定時間が経過するときに自車両が通過する第1前方注視地点、及び前記第2設定時間が経過するときに自車両が通過する第2前方注視地点を夫々設定し、当該第1前方注視地点における道路形状に応じた第1操舵量、及び前記第2前方注視地点を自車両が通過する際の基準経路との横偏差に応じた第2操舵量を夫々算出し、当該第1操舵量及び第2操舵量の加算値に基づいて自車両の操舵制御を行うことを特徴とする車両用自動操舵装置。A first set time and a second set time are calculated according to the own vehicle speed , and a first forward gaze point through which the own vehicle passes when the first set time elapses on a reference route for running the own vehicle; and A second forward gaze point through which the host vehicle passes when the second set time elapses is set , and the first steering amount according to the road shape at the first front gaze point and the second front gaze point are determined . A second steering amount is calculated according to a lateral deviation from a reference route when the vehicle passes, and steering control of the host vehicle is performed based on an added value of the first steering amount and the second steering amount. An automatic steering device for vehicles. 自車両を走行させるための基準経路を検出する基準経路検出手段と、自車速を検出する車速検出手段と、
該車速検出手段で検出した自車速に応じて第1設定時間を算出する第1設定時間算出手段と、前記基準経路検出手段が検出した基準経路で、前記第1設定時間算出手段で算出された第1設定時間が経過するときに自車両が通過する地点を第1前方注視地点として設定する第1前方注視地点設定手段と、該第1前方注視地点設定手段で設定した第1前方注視地点における基準経路の形状を検出する経路形状検出手段と、該経路形状検出手段で検出された前記第1前方注視地点における基準経路の形状に応じて第1操舵量を算出する第1操舵量算出手段と、
前記車速検出手段で検出した自車速に応じて第2設定時間を算出する第2設定時間算出手段と、前記基準経路検出手段が検出した基準経路で、前記第2設定時間算出手段で算出された第2設定時間が経過するときに自車両が通過する地点を第2前方注視地点として設定する第2前方注視地点設定手段と、該第2前方注視地点設定手段で設定した第2前方注視地点を自車両が通過するときの基準経路に対する横偏差を検出する横偏差検出手段と、該横偏差検出手段で検出された前記第2前方注視地点での横偏差に応じて第2操舵量を算出する第2操舵量算出手段と、
前記第1操舵量算出手段で算出した第1操舵量、及び前記第2操舵量算出手段で算出した第2操舵量の加算値に基づいて自車両の操舵制御を行う操舵制御手段とを備えることを特徴とする車両用自動操舵装置。
Reference route detection means for detecting a reference route for running the host vehicle, vehicle speed detection means for detecting the host vehicle speed,
The first set time calculating means for calculating the first set time according to the vehicle speed detected by the vehicle speed detecting means, and the reference route detected by the reference route detecting means, calculated by the first set time calculating means. In the first forward gaze point setting means set by the first front gaze point setting means and the first front gaze point setting means for setting the point through which the host vehicle passes as the first front gaze point when the first set time elapses. Route shape detection means for detecting the shape of the reference route, and first steering amount calculation means for calculating the first steering amount according to the shape of the reference route at the first forward gaze point detected by the route shape detection means; ,
A second set time calculating means for calculating a second set time according to the host vehicle speed detected by the vehicle speed detecting means, and a reference route detected by the reference route detecting means, calculated by the second set time calculating means. A second forward gaze point setting means for setting a point through which the host vehicle passes when the second set time elapses as a second front gaze point; and a second front gaze point set by the second front gaze point setting means. A lateral deviation detecting means for detecting a lateral deviation with respect to a reference route when the host vehicle passes, and a second steering amount is calculated according to the lateral deviation at the second forward gaze point detected by the lateral deviation detecting means. A second steering amount calculating means;
Steering control means for performing steering control of the host vehicle based on an addition value of the first steering amount calculated by the first steering amount calculation means and the second steering amount calculated by the second steering amount calculation means. An automatic steering device for a vehicle characterized by the above.
前記第1設定時間算出手段は、低速走行時よりも高速走行時の方が短くなるように第1設定時間を算出することを特徴とする請求項2記載の車両用自動操舵装置。  3. The automatic steering apparatus for a vehicle according to claim 2, wherein the first set time calculating means calculates the first set time so that the speed during high speed travel is shorter than during low speed travel. 前記第1設定時間算出手段は、高速走行時には、前記第2設定時間算出手段で算出される第2設定時間よりも短くなるように第1設定時間を算出することを特徴とする請求項3記載の車両用自動操舵装置。  The said 1st setting time calculation means calculates a 1st setting time so that it may become shorter than the 2nd setting time calculated by the said 2nd setting time calculation means at the time of high speed driving | running | working. Automatic steering device for vehicles. 前記第2設定時間算出手段は、低速走行時よりも高速走行時の方が長くなるように第2設定時間を算出することを特徴とする請求項2乃至4の何れかに記載の車両用自動操舵装置。  5. The vehicle automatic according to claim 2, wherein the second set time calculating means calculates the second set time so that the time during high-speed driving is longer than that during low-speed driving. Steering device. 前記第2設定時間算出手段は、高速走行時には、前記第1設定時間算出手段で算出される第1設定時間よりも長くなるように第2設定時間を算出することを特徴とする請求項5記載の車両用自動操舵装置。  6. The second set time calculating means calculates the second set time so as to be longer than the first set time calculated by the first set time calculating means when traveling at a high speed. Automatic steering device for vehicles. 前記横偏差検出手段は、現在の車両姿勢及び自車両の旋回状態に基づいて基準経路に対する横偏差を算出するように構成されていることを特徴とする請求項2乃至6の何れかに記載の車両用自動操舵装置。The lateral deviation detection means, according to any of claims 2 to 6, characterized in that it is configured to calculate the lateral deviation relative to the reference path based on the turning state of the current vehicle position and the vehicle Automatic steering device for vehicles. 前記道路形状検出手段は、基準経路における第1前方注視地点の前後に所定距離をとった範囲の道路形状を検出し、当該所定距離は、自車速が早いほど長くなるように構成されることを特徴とする請求項2乃至7の何れかに記載の車両用自動操舵装置。  The road shape detecting means detects a road shape in a range that takes a predetermined distance before and after the first forward gaze point on the reference route, and the predetermined distance is configured to be longer as the host vehicle speed is higher. The automatic steering device for a vehicle according to any one of claims 2 to 7.
JP2003108235A 2003-04-11 2003-04-11 Automatic steering device for vehicles Expired - Lifetime JP3933085B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2003108235A JP3933085B2 (en) 2003-04-11 2003-04-11 Automatic steering device for vehicles

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2003108235A JP3933085B2 (en) 2003-04-11 2003-04-11 Automatic steering device for vehicles

Publications (2)

Publication Number Publication Date
JP2004314692A JP2004314692A (en) 2004-11-11
JP3933085B2 true JP3933085B2 (en) 2007-06-20

Family

ID=33469834

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2003108235A Expired - Lifetime JP3933085B2 (en) 2003-04-11 2003-04-11 Automatic steering device for vehicles

Country Status (1)

Country Link
JP (1) JP3933085B2 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20220204051A1 (en) * 2020-12-29 2022-06-30 Trimble Inc. Techniques for maintaining offsets in vehicle formations

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4735676B2 (en) 2008-08-06 2011-07-27 株式会社デンソー Driving support device
JP5429062B2 (en) 2010-06-11 2014-02-26 トヨタ自動車株式会社 Vehicle travel control device
JP5429234B2 (en) * 2011-03-23 2014-02-26 トヨタ自動車株式会社 Information processing apparatus for vehicle
JP6058603B2 (en) 2014-09-12 2017-01-11 アイシン精機株式会社 Vehicle control device
JP6567936B2 (en) * 2015-09-30 2019-08-28 株式会社Subaru Steering support control device
JP6654933B2 (en) * 2016-03-04 2020-02-26 株式会社Soken Steering amount control device and steering amount control method
JP6690450B2 (en) * 2016-07-19 2020-04-28 株式会社デンソー Driving support device
JP7147643B2 (en) * 2019-03-18 2022-10-05 トヨタ自動車株式会社 Driving support device
JP7460328B2 (en) * 2019-03-20 2024-04-02 Thk株式会社 Mobile robot, mobile robot control system, and mobile robot control method

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20220204051A1 (en) * 2020-12-29 2022-06-30 Trimble Inc. Techniques for maintaining offsets in vehicle formations
US11787445B2 (en) * 2020-12-29 2023-10-17 Trimble Inc. Techniques for maintaining offsets in vehicle formations

Also Published As

Publication number Publication date
JP2004314692A (en) 2004-11-11

Similar Documents

Publication Publication Date Title
JP4270259B2 (en) Obstacle avoidance control device
JP4148179B2 (en) Lane maintenance support device
JP4231910B2 (en) Lane keeping device
JP3539362B2 (en) Lane following travel control device
JP5359085B2 (en) Lane maintenance support device and lane maintenance support method
JP5569631B2 (en) Lane maintenance support method and lane maintenance support device
JP6952014B2 (en) Vehicle control device, vehicle control method, and vehicle control system
JP4696720B2 (en) Automatic steering control device
JP5332703B2 (en) Lane maintenance support device and lane maintenance support method
JP4468509B2 (en) Vehicle steering system
JP2018103761A (en) Self-driving vehicle
JPWO2014064805A1 (en) Vehicle travel support device
JP4211686B2 (en) Vehicle steering assist device
JP7188236B2 (en) vehicle controller
JP3933085B2 (en) Automatic steering device for vehicles
JP5790401B2 (en) Vehicle travel support device
JP5380861B2 (en) Lane maintenance support device and lane maintenance support method
JP5380860B2 (en) Lane maintenance support device and lane maintenance support method
JP4622453B2 (en) Self-steering vehicle
JP4333484B2 (en) Road parameter calculation device and vehicle behavior control device
JP4599835B2 (en) Automatic steering control device for vehicle
JP5045108B2 (en) Driving support device
JP4403962B2 (en) Automatic steering control device
JP4148022B2 (en) Vehicle steering control device
JP4240000B2 (en) Vehicle steering control device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20050126

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20070123

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20070209

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: 20070227

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20070312

R150 Certificate of patent or registration of utility model

Ref document number: 3933085

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: 20100330

Year of fee payment: 3

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20110330

Year of fee payment: 4

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20110330

Year of fee payment: 4

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20120330

Year of fee payment: 5

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130330

Year of fee payment: 6

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130330

Year of fee payment: 6

EXPY Cancellation because of completion of term