JP2005014738A - Vehicular travel support device - Google Patents
Vehicular travel support device Download PDFInfo
- Publication number
- JP2005014738A JP2005014738A JP2003181632A JP2003181632A JP2005014738A JP 2005014738 A JP2005014738 A JP 2005014738A JP 2003181632 A JP2003181632 A JP 2003181632A JP 2003181632 A JP2003181632 A JP 2003181632A JP 2005014738 A JP2005014738 A JP 2005014738A
- Authority
- JP
- Japan
- Prior art keywords
- steering
- state
- vehicle
- point
- route
- 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.)
- Granted
Links
Images
Landscapes
- Traffic Control Systems (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
Description
【0001】
【発明の属する技術分野】
本発明は、目標位置への走行経路を求めて、この経路に沿って車両が走行するよう、その走行を支援する車両用走行支援装置に関する。
【0002】
【従来の技術】
自動操舵や操舵指示を用いて、車両を目標位置へと誘導する技術が知られている(例えば、特許文献1参照)。目標位置へ車両を的確に誘導するとともに、その目標位置における車両の方位角を目標方位角に合致させるため、3つの基本となる軌道パターンを用意し、位置、方位角、曲率の誤差を補償するために3次方程式を解き、求めた解を用いて、これらの軌道パターンを相似変換することで目標軌道を設定するものである。
【0003】
【特許文献1】
特開平5−297935号公報(段落0054〜0068、図6)
【0004】
【発明が解決しようとする課題】
この技術においては、現在の操舵状態にかかわらずに、同じ手法によって経路の設定を行っている。しかしながら、本発明者らの知見によれば、通常、自動車等の車両においては、セルフアライニングトルクによって舵角中立状態に戻ろうとする力が作用するため、舵角を増大させようとする場合と、舵角を中立状態へと戻そうと操舵する場合とで操舵負荷が異なってくる。このため、車両が目的の状態になるまでに必要な走行距離が異なることとなり、目標位置へ正確に至ることができなくなる可能性がある。
【0005】
そこで本発明は、操舵状態に応じた軌跡設定を可能とした車両用走行支援装置を提供することを課題とする。
【0006】
【課題を解決するための手段】
上記課題を解決するため、本発明に係る車両用走行支援装置は、目標位置へと至る経路を算出して、該経路に沿って自動操舵によって車両を誘導する車両用走行支援装置において、この経路は、走行距離に対する旋回曲率として設定され、少なくとも操舵中立状態から操舵状態へと移行する段階については、操舵遅れ時間を考慮した旋回曲率変化を用いて経路設定を行うことを特徴とする。
【0007】
本発明によれば、特にセルフアライニングトルクにより操舵遅れの発生しやすい操舵中立状態から操舵状態へと移行する段階の経路設定について、操舵遅れを考慮した旋回曲率変化を用いて経路設定を行うことで、操舵状態に応じて制御遅れの少ない経路を設定する。このため、操舵状態にかかわらず、操舵の制御遅れの発生を抑制することができ、軌跡設定および誘導の精度も向上する。
【0008】
操舵の中立状態から操舵状態へと移行する段階では、操舵状態から中立状態へと移行する段階に比べて操舵遅れの影響を大きく考慮して経路設定を行うことが好ましい。中立状態から操舵状態へと移行する段階ではセルフアライニングトルクが操舵負荷として作用するのに対し、逆の段階では、セルフアライニングトルクが操舵をアシストする方向へ働くため、操舵遅れは比較的小さくなる。
【0009】
操舵状態から中立状態へと移行する段階の経路はクロソイド曲線を用いて経路設定を行うことが好ましい。この段階では、操舵遅れの影響が少ないため、操舵速度を一定として制御を行うことができる。そのため、経路をクロソイド曲線として設定してもよい。
【0010】
【発明の実施の形態】
以下、添付図面を参照して本発明の好適な実施の形態について詳細に説明する。説明の理解を容易にするため、各図面において同一の構成要素に対しては可能な限り同一の参照番号を附し、重複する説明は省略する。
【0011】
以下、本発明に係る走行支援装置として駐車支援装置を例に説明する。図1は、本発明の実施形態である駐車支援装置100のブロック構成図である。この駐車支援装置100は、自動操舵装置20を備えており、制御装置である駐車支援ECU1により制御される。駐車支援ECU1は、CPU、ROM、RAM、入力信号回路、出力信号回路、電源回路などにより構成され、後述する後方カメラ32で取得された画像を処理する画像処理部10と、自動操舵装置の制御を行う操舵制御部11を有している。この画像処理部10と操舵制御部11とは駐車支援ECU1内でハード的に区分されていてもよいが、共通のCPU、ROM、RAM等を用い、ソフト的に区分されていてもよい。
【0012】
ステアリングホイール22の動きを転舵輪25に伝えるステアリングシャフト21には、ステアリングシャフト21の操舵量を検出する操舵角センサ23と、操舵力を付与する操舵アクチュエータ24が接続されている。ここで、操舵アクチュエータ24は、自動操舵時に操舵力を付与するほか、運転者の操舵時にアシスト操舵力を付与するパワーステアリング装置を兼ねてもよい。操舵制御部11は、操舵アクチュエータ24の駆動を制御するとともに、操舵角センサ23の出力信号が入力される。
【0013】
また、操舵制御部11には、操舵角センサ23の出力のほか、各輪に配置されてその車輪速を検出する車輪速センサ41と、車両の加速度を検出する加速度センサ42の出力が入力されている。
【0014】
駐車支援ECU1の前述した画像処理部10には、車両後部に配置されて、後方画像を取得する後方カメラ32の出力信号である画像信号が入力されるほか、駐車支援にあたって運転者の操作入力を受け付ける入力手段31と、運転者に対して画像により情報を表示するモニタ34と、音声により情報を提示するスピーカー33が接続されている。
【0015】
次に、この駐車支援装置における支援動作を具体的に説明する。この支援動作においては、図2に示されるように、道路210の脇に沿って駐車している前車両201と後車両202の間の駐車スペース220に自車両200を後退によって収容する、いわゆる縦列駐車操作の支援を行うものである。図3は、この支援動作の制御フローチャートであり、図4は、この制御における支援経路の設定を説明する図である。
【0016】
図3に示される制御は、運転者が入力手段16を操作して、駐車支援制御の開始を駐車支援ECU1に指示してから、指示した目標駐車位置近傍へ到達するまで、あるいは、目標駐車位置へ1回の後退で到達することができないと判定されるまで、運転者が入力手段16から支援動作をキャンセルしない限り駐車支援ECU1により実行され続ける。
【0017】
具体的には、運転者は、駐車支援の開始位置へと車両を移動させ、モニタ34に表示されている後方カメラ32で撮像した後方画像中で目標位置を確認した後、入力手段31を操作して、この駐車支援制御を開始する。目標位置がモニタ34の表示画像中で確認できない場合には、確認可能な位置へと車両を移動させて支援をスタートさせる。以下、この駐車支援の開始位置における車両200の基準点(以下の説明では、車両の後輪の車軸中心を基準点として説明する。もちろん、他の位置、例えば、車両の後端の中心や重心、片側の前端あるいは後端等を基準点にとってもよい。)をA点とし、この位置での車両を200aで表すものとする。
【0018】
駐車支援制御200がスタートしたら、運転者は入力手段31により目標駐車位置を設定する(ステップS2)。ここで、運転者は、モニタ34に表示されている後方カメラ32で撮像した画像を見ながら、入力手段31を操作することにより、画面上に表示されている駐車枠240を動かして目標駐車位置へと移動させることにより目標駐車位置の設定を行う。この駐車枠240は、目標駐車位置において車両が占める領域より前後方向、左右方向とも大きめに設定されている。
【0019】
駐車支援ECU1の画像処理部10は、画像認識処理により目標駐車位置における車両位置200g、具体的には、基準点Gの位置と、その位置における車両の方向を求める(ステップS4)。このG点の位置は、例えば現在の車両位置における基準点Aに対する相対座標として求めればよい。以下、図2に示されるように、目標位置G点を原点とし、目標位置における車両の向きをz軸方向にとり、これに直交する方向をx軸にとった座標系により説明する。また、誘導中における現在の車両の向きとz軸のなす角度を偏向角θ(初期位置における偏向角をθ0とする。)と称する。
【0020】
次に誘導経路の算出を行う。まず、目標位置G点から図2に示される中点M(A点とG点の距離的な中間点を意味するものではない。)までの移動経路を逆算する(ステップS6)。この移動経路は、走行距離pに対する旋回曲率γ(旋回半径Rの逆数)の変化として規定される。ここで、中点Mにおいては、舵角0の中立状態であり、その偏向角θは、固定値θ1(例えば、35°)に設定される。そして、目標位置G点においては、舵角中立状態でかつ偏向角θは0となる。そして、目標位置G点からM点へと至る経路(実際の誘導においては、中点Mから、目標位置G点へと至る。)の走行距離に対する旋回曲率変化は図4(a)に示されるグラフにより表される。この軌跡は、図4(a)に示されるように、M点からN点までは、旋回曲率を徐々に負側に増大させ(例えば、旋回曲率γの走行距離pに対する変化速度dγ/dpをM点からの走行距離に比例して変化させる)、N点からは旋回曲率γの走行距離pに対する変化速度dγ/dpを一定(−ωmax)に維持して、旋回曲率γを負側に増大させていき、O点で最大値−γmax(このとき、舵角も負側の最大値−δmaxとなり、旋回半径は最小値Rminとなる。)に到達させてから、P点までは、その旋回曲率−γmaxを維持して(舵角、旋回半径も維持される。)、P点からG点までは旋回曲率γの走行距離pに対する変化速度dγ/dpを一定(ωmax)に維持して、旋回曲率γを増大させ(絶対値は減少させ)てG点で旋回曲率γを0、つまり舵角δが0の中立状態へと移行する。
【0021】
ここで、座標(x,z)において、距離p0からp1までの偏向角変化量Δθは、以下の式1により表される。
【数1】
【0022】
つまり、走行距離pに対して旋回曲率γを積分した結果が偏向角の変化量Δθとなる。すなわち、図4(a)に示されるハッチング部分の面積S0がθ1に一致するよう各点間の距離を設定すればよい。
【0023】
一方、中点Mの位置座標は、設定した走行軌跡を基にして以下の式から求めることができる。
【数2】
【0024】
θ1を固定値とし、旋回曲率の最大変化速度ωmaxも固定した場合には、M点から目標駐車位置へと至る走行軌跡は常に同一となるので、予めこの走行軌跡を求めておいて、駐車支援ECU1内のROM等に格納しておいてもよい。この場合、本ステップではROM内から軌跡を読み出す処理を行う。
【0025】
次に、初期位置A点から、この中点Mまでの走行軌跡を走行距離pに対する旋回曲率γの変化として求める(ステップS8)。図4(b)は、求めたM点までの走行軌跡を示している。このM点までの走行軌跡は、A点から舵角中立状態のままB点まで後退し、B点からD点まで舵角(旋回曲率)を増大させ、D点からE点までは舵角(旋回曲率)を最大舵角で保持し、E点からF点までは舵角(旋回曲率)を低下させて舵角中立状態へ戻し、F点からM点までは再び舵角中立状態のまま後退させる。E点からF点までの旋回曲率γの走行距離pに対する変化速度は一定値−ωmaxであるが、B点からD点までの旋回曲率γの変化速度は、B点からC点までは、この変化速度をB点からの走行距離に応じて増大させてC点でωmaxに到達させ、その後、D点までは一定値ωmaxとしている。ここで、図4(b)にハッチングで示される面積S1がθ1に一致するように経路長を設定することで、M点へ至る経路を設定することができる。
【0026】
ステップS10ではこうして設定したA点からM点までの経路にM点からG点までの経路を接続することでA点からG点へ至る経路を設定する。こうして設定された走行軌跡P0は、図2に示されるように、AB間、FM間が直線、DE間とOP間が半径Rmin(曲率γmax)の円弧であり、EF間、PG間、CD間、NO間は、クロソイド曲線であり、BC間、MN間はクロソイド曲線と直線とをつなぐ曲線区間となる。
【0027】
本実施形態においては、このように舵角中立状態から操舵状態へと移行する初期段階において、旋回曲率の走行距離に対する変化量の絶対値を値0から走行距離に対して増大させていく制御を行っている。前述したように、操舵時にはセルフアライニングトルクによって舵角中立状態へと戻ろうとする力が作用するので、舵角中立状態から操舵状態へと操舵を行う場合には、その逆、つまり、操舵状態から舵角を中立へ戻そうと操舵を行う場合に比べて操舵負荷が大きくなる。本実施形態では、このように操舵負荷が大きいと予想される状態、つまり、舵角中立状態から操舵状態へと移行する初期段階には、設定した目標経路における旋回曲率の変化速度を低く抑えることで、操舵制御開始時のセルフアライニングトルクに起因する操舵遅れを考慮した経路を設定することが可能となる。こうして設定した経路に基づいて操舵を行うと、設定した経路と実際の走行経路とのずれの発生を抑制することができ、車両を目標位置へと確実に誘導することができる。
【0028】
次に、経路が設定できたか否かを判定する(ステップS12)。前車両201と後車両202との間隔が短いなどの理由で、現在位置A点から目標位置G点に到達する経路を設定不能と判定した場合には、ステップS40に移行し、現在位置Aからは目標位置G点に到達できない旨をモニタ34やスピーカー33を用いて運転者に報知し、処理を終了する。運転者は、必要であれば、車両200を移動させて別の駐車位置へと移動して、再度駐車支援動作を作動させればよい。
【0029】
ここで、駐車支援ECU1は、シフト状態センサ44により、シフトレバーが後退位置に設定されたことを検知したら、図示していない駆動系に対して、エンジンのトルクアップ制御を行うよう指示することが好ましい。トルクアップ制御とは、エンジンを通常のアイドル時より高い回転数で回転させることで、駆動力の高い状態(トルクアップ状態)に移行させるものである。これにより、運転者がアクセル操作を行うことなく、ブレーキペダルのみで調整できる車速範囲が拡大し、車両のコントロール性が向上する。運転者がブレーキペダルを操作すると、そのペダル開度に応じて各輪に付与される制動力を調整することで車速の調整を行う。このとき、車輪速センサ32で検出している車速が上限車速を超えないよう各車輪に付与する制動力を制御することで上限車速のガードを行うことが好ましい。
【0030】
誘導制御においては、まず、車両の現在位置の判定を行う(ステップS14)。この現在位置判定は、後方カメラ32で撮像している画像における特徴点の移動を基に判定することも可能であるし、車輪速センサ41や加速度センサ42の出力を基にした走行距離変化と操舵角センサ23の出力を基にした舵角変化から曲率変化を求めて、これにより自車位置の判定を行えばよい。
【0031】
そして、この現在位置(走行距離)を基に先に設定した走行距離−操舵角の設定軌跡に基づいて実際の舵角制御を行う(ステップS16)。具体的には、操舵制御部11は、操舵角センサ23の出力を監視しながら、操舵アクチュエータ24を制御してステアリングシャフト21を駆動し、転舵輪25を転動させて、設定した旋回曲率が実現されるよう制御する。舵角制御に合わせて現在の舵角制御状態をモニタ34、スピーカー33により運転者に報知することが好ましい。
【0032】
前述したように、本実施形態では、少なくとも中立状態から操舵状態へ移行する初期の段階(図4に示されるB点からC点の状態だけでなく、操舵状態から中立状態を超えて逆方向の操舵状態へと至る場合の中立状態から操舵状態へ移行する初期段階、つまり、M点からM点の状態を含む。)において、操舵速度を抑制している。
【0033】
図5(a)(b)は、それぞれ従来の技術と本実施形態において、旋回曲率の目標値と実際の旋回曲率変化を比較して示す図である。図5(a)に示されるように、従来の技術によれば、中立状態から操舵状態へ移行する時点でも走行距離に対する旋回曲率の変化量が所定値として目標経路を設定しているが、実際には、セルフアライニングトルクに対抗して操舵を行う必要上、旋回曲率の変化量が上述の所定値に達するまでに時間がかかり、その分だけ旋回曲率が上昇するのが遅れて、これが経路からのずれとして現れることになる。
【0034】
これに対して、本実施形態では、図5(b)に示されるように、操舵遅れを考慮して目標とする旋回曲率の変化量を抑制しているので、目標としている旋回曲率に制御結果を合致させることができる。すなわち、セルフアライニングトルクに起因する操舵の遅れを考慮して、自動操舵により得られる操舵量、旋回曲率を目標とする操舵状態へ適切に追従させることが可能となる。このため、設定した経路に沿って確実に車両を誘導することができる。
【0035】
こうして設定した経路に沿った移動が行われるので、運転者は進路上の安全確認と車速調整に専念することができる。進路上に障害物や歩行者等が存在した場合は、運転者がブレーキペダルを踏み込むと、それに応じた制動力が各車輪へと付与されるので安全に減速、停止することができる。
【0036】
舵角制御後は、現在位置が目標経路上からずれていないかを判定し、ずれが大きい場合には経路修正を要すると判定する(ステップS18)。この目標経路からのずれは、目標位置と現在の位置のずれ、あるいは、目標操舵量と実際の操舵量のずれを走行距離に対して積算すること等により求めることができる。経路修正を要する場合には、ステップS6へと戻ることで、経路を設定し直す。
【0037】
一方、目標経路とのずれが小さい場合には、ステップS20へと移行し、目標駐車位置G点近傍に到達したか否かを判定する。目標駐車位置へ到達していない場合には、ステップS14へと戻ることで、支援制御を継続する。目標駐車位置へと到達したと判定された場合には、ステップS22へと移行し、モニタ34、スピーカー33により運転者に目標駐車位置へと到達した旨を報知して処理を終了する。
【0038】
ここでは、中立状態から操舵状態へと移行する際(上述したように中立状態を超えて操舵を続行する場合を含む。)に、操舵遅れ時間を考慮して旋回曲率の変化量を抑制する制御を行うこととしたが、操舵状態から中立状態あるいは操舵保持状態へと移行する場合(図4に示されるD点、F点、N点の直前)や操舵保持状態から操舵状態へと移行する場合(図4に示されるE点、O点の直後)についても操舵遅れ時間を考慮して旋回曲率の変化量を抑制する制御を行ってもよい。上述したように旋回曲率の絶対値が大きくなる方向に制御する際にセルフアライニングトルクによる操舵遅れが発生しやすく、旋回曲率の絶対値を小さくなる方向に制御する場合にはセルフアライニングトルクが操舵負荷を減らす方向に作用することとなるが、この場合にも操舵量を抑制することで、操舵負荷と制御量をバランスさせて適切な制御を行うことができる。操舵保持状態へ移行する場合にも保持状態への移行をスムースにして適切な制御を行うことが可能となる。
【0039】
以上の説明では、後退による縦列駐車を例に説明したが、本発明は車庫入れ駐車の場合や前進での駐車支援にも適応可能である。また、駐車支援装置に限らず、経路に応じた移動を自動操舵を用いて誘導する走行支援装置、レーンキープシステム等にも適用可能である。
【0040】
【発明の効果】
以上説明したように本発明によれば、少なくとも操舵中立状態から操舵状態へと移行する際(操舵中立状態を超えて操舵する場合を含む。)に、操舵の時間遅れを考慮して旋回曲率の走行距離に対する変化量を低く抑えることにより、セルフアライニングトルクに起因して操舵遅れが発生した場合でも目標とする旋回曲率と実際に得られる旋回曲率とのずれの発生を抑制することができる。このため、車両を経路に沿って確実に誘導することができ、誘導精度が向上する。
【図面の簡単な説明】
【図1】本発明の実施形態である駐車支援装置100のブロック構成図である。
【図2】図1の装置で行う縦列駐車の支援動作を説明する図である。
【図3】図2の支援動作の第1の制御形態の制御処理を示すフローチャートである。
【図4】図3の制御における設定走行軌跡を説明する図である。
【図5】目標経路と実際の経路への追従状態を本実施形態と従来の技術とで比較して示す図である。
【符号の説明】
1…駐車支援ECU、10…画像処理部、11…操舵制御部、20…自動操舵装置、31…入力手段、32…後方カメラ、33…スピーカー、34…モニタ、41…車輪速センサ、42…加速度センサ、24…操舵アクチュエータ、22…ステアリングホイール、21…ステアリングシャフト、23…操舵角センサ、100…駐車支援装置、200…車両、201…前車両、202…後車両、210道路、220…駐車スペース。[0001]
BACKGROUND OF THE INVENTION
The present invention relates to a vehicular travel support device that obtains a travel route to a target position and supports the travel so that the vehicle travels along the route.
[0002]
[Prior art]
A technique for guiding a vehicle to a target position using automatic steering or a steering instruction is known (see, for example, Patent Document 1). In order to accurately guide the vehicle to the target position and match the azimuth angle of the vehicle at the target position with the target azimuth angle, three basic trajectory patterns are prepared to compensate for errors in position, azimuth angle, and curvature. Therefore, a target equation is set by solving a cubic equation and performing a similar transformation on these orbital patterns using the obtained solution.
[0003]
[Patent Document 1]
JP-A-5-297935 (paragraphs 0054-0068, FIG. 6)
[0004]
[Problems to be solved by the invention]
In this technique, the route is set by the same method regardless of the current steering state. However, according to the knowledge of the present inventors, usually, in a vehicle such as an automobile, a force to return to the steering angle neutral state acts by the self-aligning torque, so that the steering angle is increased. The steering load differs depending on the case of steering to return the rudder angle to the neutral state. For this reason, the required travel distances differ until the vehicle reaches the target state, and it may not be possible to reach the target position accurately.
[0005]
SUMMARY OF THE INVENTION An object of the present invention is to provide a vehicular travel support apparatus that can set a trajectory according to a steering state.
[0006]
[Means for Solving the Problems]
In order to solve the above-described problem, a vehicle travel support apparatus according to the present invention calculates a route to a target position and guides the vehicle by automatic steering along the route. Is set as a turning curvature with respect to the travel distance, and at least at the stage of transition from the steering neutral state to the steering state, the route is set by using a turning curvature change in consideration of the steering delay time.
[0007]
According to the present invention, the route setting is performed using the turning curvature change in consideration of the steering delay, especially for the route setting at the stage of shifting from the steering neutral state where the steering delay is likely to occur due to the self-aligning torque. Thus, a route with less control delay is set according to the steering state. For this reason, it is possible to suppress the occurrence of steering control delay regardless of the steering state, and the accuracy of trajectory setting and guidance is also improved.
[0008]
In the stage of transition from the neutral state of steering to the steering state, it is preferable to set the route in consideration of the influence of the steering delay as compared with the stage of transition from the steering state to the neutral state. At the stage of transition from the neutral state to the steering state, the self-aligning torque acts as a steering load, whereas at the opposite stage, the self-aligning torque works in the direction of assisting the steering, so the steering delay is relatively small. Become.
[0009]
It is preferable to set the route using the clothoid curve for the route in the transition from the steering state to the neutral state. At this stage, since the influence of the steering delay is small, the control can be performed with the steering speed kept constant. Therefore, the route may be set as a clothoid curve.
[0010]
DETAILED DESCRIPTION OF THE INVENTION
DESCRIPTION OF EXEMPLARY EMBODIMENTS Hereinafter, preferred embodiments of the invention will be described in detail with reference to the accompanying drawings. In order to facilitate the understanding of the description, the same reference numerals are given to the same components in the drawings as much as possible, and duplicate descriptions are omitted.
[0011]
Hereinafter, a parking assistance device will be described as an example of the driving assistance device according to the present invention. FIG. 1 is a block configuration diagram of a
[0012]
A
[0013]
In addition to the output of the
[0014]
The
[0015]
Next, the assistance operation in this parking assistance device will be specifically described. In this support operation, as shown in FIG. 2, the
[0016]
The control shown in FIG. 3 is performed until the driver reaches the vicinity of the instructed target parking position after the driver operates the input means 16 to instruct the parking assist ECU 1 to start the parking assist control. Until it is determined that the vehicle cannot be reached by one backward movement, the parking assistance ECU 1 continues to execute unless the driver cancels the assistance operation from the input means 16.
[0017]
Specifically, the driver moves the vehicle to the parking assistance start position, confirms the target position in the rear image captured by the
[0018]
When the parking assist
[0019]
The
[0020]
Next, the guidance route is calculated. First, the travel path from the target position G point to the midpoint M shown in FIG. 2 (which does not mean the intermediate point between the points A and G) is calculated backward (step S6). This movement route is defined as a change in the turning curvature γ (the reciprocal of the turning radius R) with respect to the travel distance p. Here, at the middle point M, the steering angle is in a neutral state, and the deflection angle θ is set to a fixed value θ 1 (for example, 35 °). At the target position G, the steering angle is neutral and the deflection angle θ is zero. Then, the turning curvature change with respect to the travel distance of the route from the target position G point to the M point (in the actual guidance, from the middle point M to the target position G point) is shown in FIG. Represented by a graph. As shown in FIG. 4 (a), the trajectory gradually increases the turning curvature from the M point to the N point to the negative side (for example, the change speed dγ / dp of the turning curvature γ with respect to the travel distance p is increased). From the point N, the change rate dγ / dp of the turning curvature γ with respect to the running distance p is kept constant (−ωmax), and the turning curvature γ is increased to the negative side. After reaching the maximum value −γmax at point O (at this time, the steering angle also becomes the maximum value −δmax on the negative side, and the turning radius becomes the minimum value Rmin), the turning is performed until point P. The curvature -γmax is maintained (the steering angle and the turning radius are also maintained), and the change speed dγ / dp with respect to the travel distance p of the turning curvature γ is kept constant (ωmax) from the point P to the point G. Increase the turning curvature γ (decrease the absolute value) and set the turning curvature γ to 0 at point G. That is, the steering angle δ shifts to a neutral state of zero.
[0021]
Here, at the coordinates (x, z), the deflection angle change amount Δθ from the distance p 0 to p 1 is expressed by the following equation 1.
[Expression 1]
[0022]
That is, the result of integrating the turning curvature γ with respect to the travel distance p is the deflection angle change amount Δθ. That may be set the distance between the points to the area S 0 of the hatched portion is equal to theta 1 shown in Figure 4 (a).
[0023]
On the other hand, the position coordinates of the midpoint M can be obtained from the following equation based on the set traveling locus.
[Expression 2]
[0024]
When θ 1 is a fixed value and the maximum turning speed ωmax of the turning curvature is also fixed, the traveling locus from the point M to the target parking position is always the same. You may store in ROM etc. in assistance ECU1. In this case, in this step, a process of reading the locus from the ROM is performed.
[0025]
Next, a travel locus from the initial position A to the middle point M is obtained as a change in the turning curvature γ with respect to the travel distance p (step S8). FIG. 4B shows the travel locus up to the obtained M point. The travel trajectory up to point M retreats from point A to the point B with the steering angle neutral, increases the steering angle (turning curvature) from the point B to the point D, and the steering angle (from the point D to the point E ( (Turning curvature) is maintained at the maximum steering angle, the steering angle (turning curvature) is lowered from point E to point F to return to the steering angle neutral state, and from point F to point M, the steering angle is again neutral while the steering angle is neutral. Let The changing speed of the turning curvature γ from the point E to the point F with respect to the travel distance p is a constant value −ωmax, but the changing speed of the turning curvature γ from the point B to the point D is from this point to the point C. The change speed is increased in accordance with the travel distance from point B to reach ωmax at point C, and thereafter, a constant value ωmax is set up to point D. Here, by setting the path length so that the area S 1 indicated by hatching in FIG. 4B matches θ 1 , the path to the point M can be set.
[0026]
In step S10, the path from point A to point G is set by connecting the path from point M to point G to the path from point A to point M thus set. As shown in FIG. 2, the travel locus P 0 set in this way is a straight line between AB and FM, an arc with radius Rmin (curvature γmax) between DE and OP, and between EF, PG, CD Between and NO is a clothoid curve, and between BC and MN is a curve section connecting the clothoid curve and a straight line.
[0027]
In this embodiment, in the initial stage of shifting from the steering angle neutral state to the steering state in this way, control is performed to increase the absolute value of the amount of change of the turning curvature with respect to the travel distance from the value 0 to the travel distance. Is going. As described above, since the force to return to the steering angle neutral state is applied by the self-aligning torque at the time of steering, when steering from the steering angle neutral state to the steering state, the opposite, that is, the steering state The steering load becomes larger than when steering is performed to return the steering angle to neutral. In this embodiment, in the state where the steering load is expected to be large in this way, that is, in the initial stage of transition from the steering angle neutral state to the steering state, the rate of change of the turning curvature in the set target route is kept low. Thus, it is possible to set a route in consideration of the steering delay due to the self-aligning torque at the start of the steering control. When steering is performed based on the route thus set, the occurrence of a deviation between the set route and the actual travel route can be suppressed, and the vehicle can be reliably guided to the target position.
[0028]
Next, it is determined whether or not a route has been set (step S12). If it is determined that the route from the current position A to the target position G cannot be set because the distance between the
[0029]
Here, if the parking assist ECU 1 detects that the shift lever is set to the reverse position by the shift state sensor 44, the parking assist ECU 1 may instruct a drive system (not shown) to perform engine torque-up control. preferable. The torque-up control is to shift the engine to a high driving force state (torque-up state) by rotating the engine at a higher rotational speed than during normal idling. As a result, the vehicle speed range that can be adjusted only with the brake pedal without the driver performing the accelerator operation is expanded, and the controllability of the vehicle is improved. When the driver operates the brake pedal, the vehicle speed is adjusted by adjusting the braking force applied to each wheel according to the pedal opening. At this time, it is preferable to guard the upper limit vehicle speed by controlling the braking force applied to each wheel so that the vehicle speed detected by the
[0030]
In the guidance control, first, the current position of the vehicle is determined (step S14). The current position can be determined based on the movement of the feature points in the image captured by the
[0031]
Then, the actual steering angle control is performed based on the travel distance-steer angle setting locus previously set based on the current position (travel distance) (step S16). Specifically, the steering control unit 11 monitors the output of the
[0032]
As described above, in this embodiment, at least the initial stage of transition from the neutral state to the steering state (not only the state from the point B to the point C shown in FIG. 4 but also the reverse direction beyond the neutral state from the steering state. In the initial stage of transition from the neutral state to the steering state when reaching the steering state, that is, including the state from the M point to the M point), the steering speed is suppressed.
[0033]
FIGS. 5 (a) and 5 (b) are diagrams showing a comparison between the target value of the turning curvature and the actual change in turning curvature in the conventional technique and the present embodiment, respectively. As shown in FIG. 5 (a), according to the conventional technique, the amount of change in the turning curvature with respect to the travel distance is set as a predetermined value even at the time of transition from the neutral state to the steering state. Since it is necessary to steer against the self-aligning torque, it takes time for the amount of change in the turning curvature to reach the above-mentioned predetermined value, and the turning curvature is delayed by that much, which is It will appear as a deviation from.
[0034]
On the other hand, in the present embodiment, as shown in FIG. 5B, since the amount of change in the target turning curvature is suppressed in consideration of the steering delay, the control result is set to the target turning curvature. Can be matched. That is, in consideration of the steering delay caused by the self-aligning torque, the steering amount obtained by automatic steering and the turning curvature can be appropriately followed to the target steering state. For this reason, it is possible to reliably guide the vehicle along the set route.
[0035]
Since the movement along the route set in this way is performed, the driver can concentrate on safety confirmation on the route and vehicle speed adjustment. When an obstacle, a pedestrian, or the like is present on the course, when the driver steps on the brake pedal, a braking force corresponding to the step is applied to each wheel, so that the vehicle can be decelerated and stopped safely.
[0036]
After the steering angle control, it is determined whether or not the current position has deviated from the target route. If the deviation is large, it is determined that route correction is required (step S18). The deviation from the target route can be obtained by integrating the deviation between the target position and the current position or the deviation between the target steering amount and the actual steering amount with respect to the travel distance. When route correction is required, the route is reset by returning to step S6.
[0037]
On the other hand, when the deviation from the target route is small, the process proceeds to step S20, and it is determined whether or not the vicinity of the target parking position G point has been reached. If the target parking position has not been reached, the support control is continued by returning to step S14. If it is determined that the vehicle has reached the target parking position, the process proceeds to step S22, the
[0038]
Here, the control for suppressing the amount of change in the turning curvature in consideration of the steering delay time when transitioning from the neutral state to the steering state (including the case where the steering is continued beyond the neutral state as described above). However, when shifting from the steering state to the neutral state or the steering holding state (immediately before points D, F, and N shown in FIG. 4) or when shifting from the steering holding state to the steering state Also for (immediately after point E and point O shown in FIG. 4), control for suppressing the amount of change in the turning curvature may be performed in consideration of the steering delay time. As described above, a steering delay due to self-aligning torque is likely to occur when controlling in a direction in which the absolute value of the turning curvature increases, and when controlling in a direction to decrease the absolute value of the turning curvature, the self-aligning torque is In this case, by controlling the steering amount, the steering load and the control amount can be balanced and appropriate control can be performed. Even in the case of shifting to the steering holding state, it is possible to perform appropriate control with smooth transition to the holding state.
[0039]
In the above description, parallel parking by reversal has been described as an example, but the present invention can also be applied to parking support in garage parking or forward parking. Further, the present invention is not limited to a parking assistance device, and can be applied to a traveling assistance device that guides movement according to a route using automatic steering, a lane keeping system, and the like.
[0040]
【The invention's effect】
As described above, according to the present invention, at least when shifting from the steering neutral state to the steering state (including the case of steering beyond the steering neutral state), the turning curvature is taken into consideration. By keeping the amount of change with respect to the travel distance low, even when a steering delay occurs due to self-aligning torque, it is possible to suppress the occurrence of deviation between the target turning curvature and the actually obtained turning curvature. For this reason, the vehicle can be reliably guided along the route, and the guidance accuracy is improved.
[Brief description of the drawings]
FIG. 1 is a block configuration diagram of a
FIG. 2 is a diagram illustrating parallel parking support operation performed by the apparatus of FIG. 1;
FIG. 3 is a flowchart showing a control process of a first control form of the support operation of FIG. 2;
4 is a diagram for explaining a set travel locus in the control of FIG. 3; FIG.
FIG. 5 is a diagram showing a state of following a target route and an actual route in comparison between the present embodiment and a conventional technique.
[Explanation of symbols]
DESCRIPTION OF SYMBOLS 1 ... Parking assistance ECU, 10 ... Image processing part, 11 ... Steering control part, 20 ... Automatic steering device, 31 ... Input means, 32 ... Rear camera, 33 ... Speaker, 34 ... Monitor, 41 ... Wheel speed sensor, 42 ... Acceleration sensor, 24 ... steering actuator, 22 ... steering wheel, 21 ... steering shaft, 23 ... steering angle sensor, 100 ... parking assist device, 200 ... vehicle, 201 ... front vehicle, 202 ... rear vehicle, 210 road, 220 ... parking space.
Claims (3)
前記経路は、走行距離に対する旋回曲率として設定され、少なくとも操舵中立状態から操舵状態へと移行する段階については、操舵遅れ時間を考慮した旋回曲率変化を用いて経路設定を行うことを特徴とする車両用走行支援装置。In a vehicle travel support device that calculates a route to a target position and guides the vehicle by automatic steering along the route,
The vehicle is characterized in that the route is set as a turning curvature with respect to a travel distance, and at least at the stage of transition from a steering neutral state to a steering state, the route is set using a turning curvature change in consideration of a steering delay time. Travel support device.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2003181632A JP3896995B2 (en) | 2003-06-25 | 2003-06-25 | Vehicle travel support device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2003181632A JP3896995B2 (en) | 2003-06-25 | 2003-06-25 | Vehicle travel support device |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2005014738A true JP2005014738A (en) | 2005-01-20 |
JP3896995B2 JP3896995B2 (en) | 2007-03-22 |
Family
ID=34182283
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2003181632A Expired - Fee Related JP3896995B2 (en) | 2003-06-25 | 2003-06-25 | Vehicle travel support device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3896995B2 (en) |
Cited By (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006321291A (en) * | 2005-05-17 | 2006-11-30 | Fuji Heavy Ind Ltd | Method for generating travel track of vehicle, and parking support device using it |
WO2008072473A1 (en) * | 2006-12-12 | 2008-06-19 | Toyota Jidosha Kabushiki Kaisha | Parking support device |
EP2011701A1 (en) * | 2006-04-25 | 2009-01-07 | Toyota Jidosha Kabushiki Kaisha | Parking assistance device and parking assistance method |
JP2011518706A (en) * | 2008-04-03 | 2011-06-30 | ヴァレオ・シャルター・ウント・ゼンゾーレン・ゲーエムベーハー | Method and apparatus for assisting motor vehicle driver to leave parking space |
US8130120B2 (en) | 2007-02-27 | 2012-03-06 | Toyota Jidosha Kabushiki Kaisha | Parking assistance device |
US9174674B2 (en) | 2008-02-18 | 2015-11-03 | Toyota Jidosha Kabushiki Kaisha | Parking assisting apparatus |
EP3124361A1 (en) * | 2015-07-31 | 2017-02-01 | Aisin Seiki Kabushiki Kaisha | Parking assistance device, parking assistance method, and non-transitory computer readable medium storing program |
WO2017073159A1 (en) * | 2015-10-27 | 2017-05-04 | クラリオン株式会社 | Parking assistance device |
JP2017202725A (en) * | 2016-05-10 | 2017-11-16 | 本田技研工業株式会社 | Drive skill determination apparatus |
CN109572686A (en) * | 2017-09-29 | 2019-04-05 | 松下知识产权经营株式会社 | Parking assist apparatus |
JP2019147480A (en) * | 2018-02-27 | 2019-09-05 | パナソニックIpマネジメント株式会社 | Parking support device |
JP2019147481A (en) * | 2018-02-27 | 2019-09-05 | パナソニックIpマネジメント株式会社 | Parking support device |
JP2019156393A (en) * | 2019-04-26 | 2019-09-19 | パナソニックIpマネジメント株式会社 | Parking support device |
JP2020062977A (en) * | 2018-10-18 | 2020-04-23 | クラリオン株式会社 | Automatic driving controller and automatic driving route calculation method |
CN111942375A (en) * | 2020-08-24 | 2020-11-17 | 米传科技(上海)有限公司 | Automatic parking system based on millimeter wave radar and 5G |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH10287260A (en) * | 1997-04-15 | 1998-10-27 | Honda Motor Co Ltd | Automatic steering device for vehicle |
JPH11208496A (en) * | 1998-01-26 | 1999-08-03 | Honda Motor Co Ltd | Automatic steering device for vehicle |
JP2001063599A (en) * | 1999-06-22 | 2001-03-13 | Honda Motor Co Ltd | Automatic steering device for vehicle |
JP2001138941A (en) * | 1999-11-16 | 2001-05-22 | Honda Motor Co Ltd | Automatic steering system for vehicle |
JP2002019632A (en) * | 2000-07-06 | 2002-01-23 | Nissan Motor Co Ltd | Control device for lane follow-up driving |
JP3293166B2 (en) * | 1992-05-14 | 2002-06-17 | 株式会社デンソー | Garage guidance system for vehicles |
JP2003507263A (en) * | 1999-08-24 | 2003-02-25 | ローベルト ボツシユ ゲゼルシヤフト ミツト ベシユレンクテル ハフツング | Method and apparatus for assisting car parking |
JP2004078703A (en) * | 2002-08-20 | 2004-03-11 | Nippon Yusoki Co Ltd | Turning controller |
JP2004338638A (en) * | 2003-05-16 | 2004-12-02 | Toyota Motor Corp | Travel assistance device for vehicle |
JP2004351960A (en) * | 2003-05-27 | 2004-12-16 | Honda Motor Co Ltd | Automatic steering device of vehicle |
JP2004352000A (en) * | 2003-05-28 | 2004-12-16 | Honda Motor Co Ltd | Automatic steering device of vehicle |
-
2003
- 2003-06-25 JP JP2003181632A patent/JP3896995B2/en not_active Expired - Fee Related
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3293166B2 (en) * | 1992-05-14 | 2002-06-17 | 株式会社デンソー | Garage guidance system for vehicles |
JPH10287260A (en) * | 1997-04-15 | 1998-10-27 | Honda Motor Co Ltd | Automatic steering device for vehicle |
JPH11208496A (en) * | 1998-01-26 | 1999-08-03 | Honda Motor Co Ltd | Automatic steering device for vehicle |
JP2001063599A (en) * | 1999-06-22 | 2001-03-13 | Honda Motor Co Ltd | Automatic steering device for vehicle |
JP2003507263A (en) * | 1999-08-24 | 2003-02-25 | ローベルト ボツシユ ゲゼルシヤフト ミツト ベシユレンクテル ハフツング | Method and apparatus for assisting car parking |
JP2001138941A (en) * | 1999-11-16 | 2001-05-22 | Honda Motor Co Ltd | Automatic steering system for vehicle |
JP2002019632A (en) * | 2000-07-06 | 2002-01-23 | Nissan Motor Co Ltd | Control device for lane follow-up driving |
JP2004078703A (en) * | 2002-08-20 | 2004-03-11 | Nippon Yusoki Co Ltd | Turning controller |
JP2004338638A (en) * | 2003-05-16 | 2004-12-02 | Toyota Motor Corp | Travel assistance device for vehicle |
JP2004351960A (en) * | 2003-05-27 | 2004-12-16 | Honda Motor Co Ltd | Automatic steering device of vehicle |
JP2004352000A (en) * | 2003-05-28 | 2004-12-16 | Honda Motor Co Ltd | Automatic steering device of vehicle |
Cited By (23)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006321291A (en) * | 2005-05-17 | 2006-11-30 | Fuji Heavy Ind Ltd | Method for generating travel track of vehicle, and parking support device using it |
EP2011701A1 (en) * | 2006-04-25 | 2009-01-07 | Toyota Jidosha Kabushiki Kaisha | Parking assistance device and parking assistance method |
EP2011701A4 (en) * | 2006-04-25 | 2010-05-05 | Toyota Motor Co Ltd | Parking assistance device and parking assistance method |
US8542128B2 (en) | 2006-04-25 | 2013-09-24 | Toyota Jidosha Kabushiki Kaisha | Parking assist apparatus and method |
WO2008072473A1 (en) * | 2006-12-12 | 2008-06-19 | Toyota Jidosha Kabushiki Kaisha | Parking support device |
US8130120B2 (en) | 2007-02-27 | 2012-03-06 | Toyota Jidosha Kabushiki Kaisha | Parking assistance device |
US9174674B2 (en) | 2008-02-18 | 2015-11-03 | Toyota Jidosha Kabushiki Kaisha | Parking assisting apparatus |
JP2011518706A (en) * | 2008-04-03 | 2011-06-30 | ヴァレオ・シャルター・ウント・ゼンゾーレン・ゲーエムベーハー | Method and apparatus for assisting motor vehicle driver to leave parking space |
EP3124361A1 (en) * | 2015-07-31 | 2017-02-01 | Aisin Seiki Kabushiki Kaisha | Parking assistance device, parking assistance method, and non-transitory computer readable medium storing program |
JP2017081398A (en) * | 2015-10-27 | 2017-05-18 | クラリオン株式会社 | Park assisting-device |
US11407406B2 (en) | 2015-10-27 | 2022-08-09 | Clarion Co., Ltd. | Parking assistance device |
WO2017073159A1 (en) * | 2015-10-27 | 2017-05-04 | クラリオン株式会社 | Parking assistance device |
US10562525B2 (en) | 2015-10-27 | 2020-02-18 | Clarion Co., Ltd. | Parking assistance device |
JP2017202725A (en) * | 2016-05-10 | 2017-11-16 | 本田技研工業株式会社 | Drive skill determination apparatus |
CN109572686A (en) * | 2017-09-29 | 2019-04-05 | 松下知识产权经营株式会社 | Parking assist apparatus |
JP2019064431A (en) * | 2017-09-29 | 2019-04-25 | パナソニックIpマネジメント株式会社 | Parking support device |
JP2019147480A (en) * | 2018-02-27 | 2019-09-05 | パナソニックIpマネジメント株式会社 | Parking support device |
JP2019147481A (en) * | 2018-02-27 | 2019-09-05 | パナソニックIpマネジメント株式会社 | Parking support device |
JP7122697B2 (en) | 2018-02-27 | 2022-08-22 | パナソニックIpマネジメント株式会社 | parking assist device |
JP2020062977A (en) * | 2018-10-18 | 2020-04-23 | クラリオン株式会社 | Automatic driving controller and automatic driving route calculation method |
JP2019156393A (en) * | 2019-04-26 | 2019-09-19 | パナソニックIpマネジメント株式会社 | Parking support device |
CN111942375B (en) * | 2020-08-24 | 2021-02-19 | 米传科技(上海)有限公司 | Automatic parking system based on millimeter wave radar and 5G |
CN111942375A (en) * | 2020-08-24 | 2020-11-17 | 米传科技(上海)有限公司 | Automatic parking system based on millimeter wave radar and 5G |
Also Published As
Publication number | Publication date |
---|---|
JP3896995B2 (en) | 2007-03-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP3818654B2 (en) | Vehicle travel support device | |
JP4058389B2 (en) | Vehicle travel support device | |
JP3911492B2 (en) | Vehicle travel support device | |
JP3818653B2 (en) | Vehicle travel support device | |
JP6652045B2 (en) | Self-driving vehicle | |
JP3896995B2 (en) | Vehicle travel support device | |
JP4291625B2 (en) | Vehicle travel support device | |
JP2019156327A (en) | Vehicle lane deviation prevention controller | |
JP4167562B2 (en) | Vehicle travel support device | |
JPH11198844A (en) | Steering effort controller | |
JP3866223B2 (en) | Vehicle travel support device | |
JP5301877B2 (en) | Vehicle steering control device | |
JP4248335B2 (en) | Vehicle travel support device | |
JP3934082B2 (en) | Driving support device | |
JP4321380B2 (en) | Vehicle travel support device | |
JP2004338638A (en) | Travel assistance device for vehicle | |
JP2007191156A (en) | Travel supporting device for vehicle | |
JP7203617B2 (en) | Steering control device and steering control method | |
JP3896994B2 (en) | Vehicle travel support device | |
JP2010158987A (en) | Vehicular steering control device | |
JP4097563B2 (en) | Vehicle travel support device | |
JP3313625B2 (en) | Vehicle steering system | |
JP4433923B2 (en) | Parking assistance device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20050621 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20060606 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20060803 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20060919 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20061019 |
|
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: 20061128 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20061211 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110105 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120105 Year of fee payment: 5 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130105 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130105 Year of fee payment: 6 |
|
LAPS | Cancellation because of no payment of annual fees |