JP3911492B2 - 車両用走行支援装置 - Google Patents
車両用走行支援装置 Download PDFInfo
- Publication number
- JP3911492B2 JP3911492B2 JP2003183043A JP2003183043A JP3911492B2 JP 3911492 B2 JP3911492 B2 JP 3911492B2 JP 2003183043 A JP2003183043 A JP 2003183043A JP 2003183043 A JP2003183043 A JP 2003183043A JP 3911492 B2 JP3911492 B2 JP 3911492B2
- Authority
- JP
- Japan
- Prior art keywords
- route
- basic
- target
- vehicle
- path
- 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
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D15/00—Steering not otherwise provided for
- B62D15/02—Steering position indicators ; Steering position determination; Steering aids
- B62D15/027—Parking aids, e.g. instruction means
- B62D15/0285—Parking performed automatically
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60T—VEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
- B60T2201/00—Particular use of vehicle brake systems; Special systems using also the brakes; Special software modules within the brake system controller
- B60T2201/10—Automatic or semi-automatic parking aid systems
Landscapes
- Engineering & Computer Science (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Traffic Control Systems (AREA)
Description
【０００１】
【発明の属する技術分野】
本発明は、目標位置への走行経路を求めて、この経路に沿って車両が走行するよう、その走行を支援する車両用走行支援装置に関する。
【０００２】
【従来の技術】
自動操舵や操舵指示を用いて、車両を目標位置へと誘導する技術が知られている（例えば、特許文献１参照）。目標位置へ車両を的確に誘導するとともに、その目標位置における車両の方位角を目標方位角に合致させるため、３つの基本となる軌道パターンを用意し、位置、方位角、曲率の誤差を補償するために３次方程式を解き、求めた解を用いて、これらの軌道パターンを相似変換することで目標軌道を設定するものである。
【０００３】
【特許文献１】
特開平５−２９７９３５号公報（段落００５４〜００６８、図７）
【０００４】
【発明が解決しようとする課題】
しかしながら、この手法では３次方程式を解く必要があり、複素数を含む演算を行うことになるため、演算負荷が大きくなり、リアルタイムで計算を行うのは、既存の車載の演算装置では困難である。演算能力の高い演算装置を利用することはコストアップにつながり、好ましくない。
【０００５】
そこで本発明は、車載の演算装置でのリアルタイムでの経路演算に適したアルゴリズムにより経路計算を行う車両用走行支援装置を提供することを課題とする。
【０００６】
【課題を解決するための手段】
上記課題を解決するため、本発明に係る車両用走行支援装置は、目標位置へ至る経路を算出して、該経路に沿って車両を誘導する車両用走行支援装置において、目標位置における車両の向きに対する現在の車両の向きである偏向角の初期位置における角度である初期偏向角を求める偏向角検出手段と、走行距離に応じて所定の条件で操舵を行うことにより、初期偏向角から偏向角０の状態へと移行する基本経路を走行距離と操舵角または旋回曲率の対応として求める基本経路算出手段と、目標位置における車両方向をＺ方向、Ｚ方向に直交する方向をＸ方向とするとき、任意の係数倍した基本経路のＺ方向の長さが初期位置と目標位置とのＺ方向の距離以下となり、かつ任意の係数倍した基本経路のＸ方向の長さが初期位置と目標位置とのＸ方向の距離以下となるように、任意の係数により基本経路を相似拡大し、相似拡大後の基本経路のＺ方向の長さが初期位置と目標位置とのＺ方向の距離未満である場合、及び相似拡大後の基本経路のＸ方向の長さが初期位置と目標位置とのＸ方向の距離未満である場合の少なくともいずれかであるときは、相似拡大後の基本経路の前後の少なくとも一方に直線経路を付与して初期位置から目標位置へと至る目標経路を算出する目標経路算出手段と、を備えているものである。
【０００７】
現在の車両の向きから所定の条件で操舵を行って目標位置における車両の向きと一致させる基本経路は、方位角のみに着目しているため、比較的簡単な演算で経路を求めることができる。こうして設定した経路に直線経路を付与して目標経路を算出するので、経路算出が簡単であり、また、精度よく経路を算出することができる。また、基本経路を相似拡大すると、経路全体で変更される偏向角は元の基本経路と同一となるが、操舵速度を遅くすることができるため、自動操舵装置への負荷を低減することができ、また、操舵遅れの発生も抑制されるので、目標位置への誘導精度がさらに向上する。
【０００８】
あるいは本発明に係る車両用走行支援装置は、目標位置へ至る経路を算出して、該経路に沿って車両を誘導する車両用走行支援装置において、目標位置における車両の向きに対する現在の車両の向きである偏向角の初期位置における角度である初期偏向角を求める偏向角検出手段と、走行距離に応じて所定の条件で操舵を行うことにより、初期偏向角から所定の偏向角へと移行する第１の基本経路を走行距離と操舵角または旋回曲率の対応として求める第１基本経路算出手段と、走行距離に応じて所定の条件で操舵を行うことにより、所定の偏向角から偏向角０の状態へと移行する第２の基本経路を走行距離と操舵角または旋回曲率の対応として求める第２基本経路算出手段と、目標位置における車両方向をＺ方向、Ｚ方向に直交する方向をＸ方向とするとき、任意の第１の係数倍した第１基本経路と任意の第２の係数倍した第２基本経路とのＺ方向の長さの和が初期位置と目標位置とのＺ方向の距離以下となり、かつ任意の第１の係数倍した第１基本経路と任意の第２の係数倍した第２基本経路とのＸ方向の長さの和が初期位置と目標位置とのＸ方向の距離以下となるように、任意の第１の係数により第１基本経路を相似拡大し、任意の第２の係数により第２基本経路を相似拡大し、相似拡大後の第１基本経路と第２基本経路とのＺ方向の長さの和が初期位置と目標位置とのＺ方向の距離未満である場合、及び相似拡大後の第１基本経路と第２基本経路とのＸ方向の長さの和が初期位置と目標位置とのＸ方向の距離未満である場合の少なくともいずれかであるときは、相似拡大後の第１基本経路と第２基本経路の中間及び前後の少なくともいずれか一箇所に直線経路を付与して初期位置から目標位置へと至る目標経路を算出する目標経路算出手段と、を備えているものである。
【０００９】
この手法によれば、縦列駐車のように経路の途中まで偏向角を増大させ、その後偏向角を減少させて目標位置での車両方向に一致させる経路を設定する必要がある場合でも、同様に方位角変化のみに着目して基本経路（この場合は、第１基本経路と第２基本経路の２つの基本経路を有する。）を設定し、この前後または中間に直線経路を付与することで目標経路を算出するので、経路算出が簡単であり、また、精度よく経路を算出することができる。
【００１０】
これら基本経路の各々は、少なくとも、走行距離に対する旋回曲率の設定された変化速度で旋回曲率を変化させる段階から構成されていることが好ましい。舵角増大、減少段階での走行距離に対する旋回曲率変化量を一定とすると、走行距離に対する旋回曲率変化の図形は台形として表される。旋回曲率変化量の走行距離に対する積分値、つまり、この図形の面積が偏向角の変化量に合致するから、偏向角を所定量偏向するのに必要な基本経路の演算式が簡略化できる。
【００１１】
設定した目標経路を走行するよう自動的に操舵を行う自動操舵手段をさらに備えていると、経路に沿った誘導を確実に行うことができ、好ましい。
【００１２】
この目標経路の設定は、初期位置における操舵角が略０の場合に設定を行うことが好ましい。操舵角が略０の場合に設定を行うことで、経路演算における方位角以外の影響を排除することができ、演算の精度が向上し、目標位置への誘導精度が向上する。
【００１４】
【発明の実施の形態】
以下、添付図面を参照して本発明の好適な実施の形態について詳細に説明する。説明の理解を容易にするため、各図面において同一の構成要素に対しては可能な限り同一の参照番号を附し、重複する説明は省略する。
【００１５】
以下、本発明に係る走行支援装置として駐車支援装置を例に説明する。図１は、本発明の実施形態である駐車支援装置１００のブロック構成図である。この駐車支援装置１００は、自動操舵装置２０を備えており、制御装置である駐車支援ＥＣＵ１により制御される。駐車支援ＥＣＵ１は、ＣＰＵ、ＲＯＭ、ＲＡＭ、入力信号回路、出力信号回路、電源回路などにより構成され、後述する後方カメラ３２で取得された画像を処理する画像処理部１０と、自動操舵装置の制御を行う操舵制御部１１を有している。この画像処理部１０と操舵制御部１１とは駐車支援ＥＣＵ１内でハード的に区分されていてもよいが、共通のＣＰＵ、ＲＯＭ、ＲＡＭ等を用い、ソフト的に区分されていてもよい。
【００１６】
ステアリングホイール２２の動きを転舵輪２５に伝えるステアリングシャフト２１には、ステアリングシャフト２１の操舵量を検出する操舵角センサ２３と、操舵力を付与する操舵アクチュエータ２４が接続されている。ここで、操舵アクチュエータ２４は、自動操舵時に操舵力を付与するほか、運転者の操舵時にアシスト操舵力を付与するパワーステアリング装置を兼ねてもよい。操舵制御部１１は、操舵アクチュエータ２４の駆動を制御するとともに、操舵角センサ２３の出力信号が入力される。
【００１７】
また、操舵制御部１１には、操舵角センサ２３の出力のほか、各輪に配置されてその車輪速を検出する車輪速センサ４１と、車両の加速度を検出する加速度センサ４２の出力が入力されている。
【００１８】
駐車支援ＥＣＵ１の前述した画像処理部１０には、車両後部に配置されて、後方画像を取得する後方カメラ３２の出力信号である画像信号が入力されるほか、駐車支援にあたって運転者の操作入力を受け付ける入力手段３１と、運転者に対して画像により情報を表示するモニタ３４と、音声により情報を提示するスピーカー３３が接続されている。
【００１９】
次に、この駐車支援装置における支援動作を具体的に説明する。まず、支援動作の第１の制御形態について説明する。この第１の制御形態においては、図２に示されるように、道路２１０に面して設けられた車庫２２０内に、後退によって車両２００を収容する、いわゆる車庫入れ操作の支援を行う。図３は、この第１の制御形態の制御フローチャートであり、図５、図６は、この制御における支援経路の設定を説明する図である。ここで、図５が走行距離と曲率の関係として支援経路を説明する図であり、図６は、車両と目標位置の位置関係とともに経路を説明する図である。
【００２０】
図３に示される制御は、運転者が入力手段３１を操作して、駐車支援制御の開始を駐車支援ＥＣＵ１に指示してから、指示した目標駐車位置近傍へ到達するまで、あるいは、目標駐車位置へ１回の後退で到達することができないと判定されるまで、運転者が入力手段３１から支援動作をキャンセルしない限り駐車支援ＥＣＵ１により実行され続ける。
【００２１】
具体的には、運転者は、任意の駐車支援の開始位置へと車両を移動させ、モニタ３４に表示されている後方カメラ３２で撮像した後方画像中で目標位置を確認した後、入力手段３１を操作して、この駐車支援制御を開始する。目標位置がモニタ３４の表示画像中で確認できない場合には、確認可能な位置へと車両を移動させて支援をスタートさせる。以下、この駐車支援の開始位置における車両２００の基準点（以下の説明では、車両の後輪の車軸中心を基準点として説明する。もちろん、他の位置、例えば、車両の後端の中心や重心、片側の前端あるいは後端等を基準点にとってもよい。）をＡ点とし、この位置での車両を２００ａで表すものとする。
【００２２】
駐車支援ＥＣＵ１は、操舵角センサ２３の出力から操舵角δの絶対値としきい値δthとを比較する（ステップＳ１）。δがδth以下であって十分に小さいときには、舵角中立状態であると判定し、駐車支援制御への移行を許可し、ステップＳ２へと移行する。図Ｘに示されるように、中立付近では、ステアリングホイール２２、ステアリングシャフト２１の回転量である操舵角δに対して転舵輪２５の転舵量である曲率γは小さく設定されているため、このしきい値δthは、γが略０の範囲を規定しうるよう設定されていればよく、例えば、１５度程度に設定される。これに対して、舵角が中立状態でない場合には、ステップＳ４０へと移行し、スピーカ３３とモニタ３４により、運転者に対して、舵角が制御範囲から外れている旨を報知し、ステアリングホイール２２を操作して、舵角中立状態へと戻すよう促し、再びステップＳ１へと戻る。これにより、運転者が据え切り操作等によって舵角を略中立状態に戻すと駐車支援制御へと移行することができる。
【００２３】
ステップＳ２では、運転者はモニタ３４に表示されている後方カメラ３２で撮像した画像を見ながら、入力手段３１を操作することにより、画面上に表示されている駐車枠を動かして目標駐車位置へと移動させることにより目標駐車位置の設定を行う。
【００２４】
駐車支援ＥＣＵ１は、画像認識処理により目標駐車位置における車両位置２００ｇ、具体的には、基準点Ｇの位置と、その位置における車両の方向を求める（ステップＳ４）。このＧ点の位置は、例えば現在の車両位置における基準点Ａに対する相対座標として求めればよい。以下、図２に示されるように、目標位置Ｇ点を原点とし、目標位置における車両の向きをｚ軸方向にとり、これに直交する方向をｘ軸にとった座標系により説明する。以下、現在の車両の向きとｚ軸のなす角度を偏向角θと称する。また、Ａ点の位置を座標（ｘ0，ｚ0）で表す。
【００２５】
次に、現在位置（初期位置Ａ点）、現在の偏向角θ0から、偏向角θを０にする最短経路（以下、基本経路と称する。）Ｐ0を算出する（ステップＳ６）。この走行軌跡Ｐ0は、走行距離に対する旋回曲率（＝旋回半径の逆数）変化として設定される。図５（ａ）は、この基本経路Ｐ0の走行距離−旋回曲率線図を示している。
【００２６】
この最短経路Ｐ0は、舵角を増大させる過程（過程１）と、増大した状態で舵角を維持する過程（過程２）と、舵角を中立に戻す過程（過程３）の３つの過程からなり、過程１と過程３においては、走行距離に対する旋回曲率の変化量（旋回曲率の変化速度）を一定としている。この旋回曲率の変化速度は、車速が走行支援時の上限値の場合であっても、操舵アクチュエータ２４の最大操舵速度での曲率変化量を下回るように設定されている。これにより、確実に操舵が行える経路を算出しうる。このとき設定される軌跡の代表例は、まず、初期位置Ｂ点からＣ点まで旋回曲率の走行距離に対する変化速度を一定として旋回曲率を増大させていき、Ｃ点で操舵角、旋回曲率が設定最大値で、旋回半径が設定最小旋回半径（Ｒmin、曲率γmax＝１／Ｒmin）となる状態に移行する（過程１）。Ｃ点からＤ点まではこの操舵角（旋回曲率、旋回半径）を維持する（過程２）。Ｄ点からは逆に旋回曲率の走行距離に対する変化速度を一定として旋回曲率を減少させて、Ｅ点で舵角０の中立状態へと移行する（過程３）。この結果、走行軌跡Ｐは、ＣＤ間が半径Ｒminの円弧であり、ＢＣ間、ＤＥ間は、それぞれ一端が曲率１／Ｒmin、他端が曲率０のクロソイド曲線となる。
【００２７】
偏向角θが小さい場合には、円弧区間を有しない場合もありうる。ここでＢＥ間の偏向角θの変化量Δθは、以下の（１）式で表せる。
【００２８】
【数１】
ここで、γ（ｐ）は、走行距離ｐにおける曲率を表す。すなわち、偏向角の変化量Δθは、図５（ａ）に示される走行軌跡の面積Ｓ0に合致する。この面積はＢＣ間の経路長をＬ1（ＤＥ間の経路長も同じＬ1になる。）、ＣＤ間の経路長をＬ2とすると、円弧区間が存在するときは、γmax×（Ｌ1＋Ｌ2）で表せる。一方、Δθが小さい場合には、走行距離に対する曲率変化量を増大時はω、減少時は−ωで一定とした場合、その面積はＬ1×ω2で表せる。したがって、簡単な演算で経路を求めることができる。
【００２９】
次に、この基本経路Ｐ0のＸ方向、Ｚ方向のそれぞれの長さを求める（ステップＳ８）。基本経路Ｐ0のＸ方向の長さＸｆとＺ方向の長さＺｆは、以下の（２）（３）式から求めることができる。
【００３０】
【数２】
ここで、θ（ｐ）は走行距離ｐにおける偏向角である。
【００３１】
続いて、基本経路Ｐ0に直線経路を付与して目標経路Ｐ1を設定する（ステップＳ１０）。すなわち、図６に示されるように、基本経路Ｐ0の両端を延長してＡ点からＧ点へと至る経路を求める。具体的には、Ａ点から基本経路Ｐ0の始点Ｂ点へと至る直線経路の経路長をＬ0、基本経路Ｐ0の終点Ｅ点からＧ点へと至る直線経路の経路長をＬ3とすると、次の（４）（５）式が成り立つ。
【００３２】
【数３】
Ｌ0、Ｌ3以外は既知であるから、２式からＬ0、Ｌ3を簡単に求めることができる。
【００３３】
図５（ｂ）にこうして設定された目標経路Ｐ1の走行距離に対する曲率の対応を示す。図６には、この目標経路Ｐ1が描く軌跡を示している。この経路Ｐ1においては、目標経路が車両の速度、加速度に依存しない。そのため、走行時に経路に追従する制御が簡略化できる利点がある。
【００３４】
続く、ステップＳ１２では、経路が設定できたか否かを判定する。具体的には、Ｌ0、Ｌ3のいずれもが負でない。つまり、０か正であれば経路が設定できたと判断される。Ｌ0が負の場合とは、基本経路Ｐ0のＸ方向の長さＸｆが、Ａ点とＧ点とのＸ方向の距離（ｘ0）を上回る場合であり、Ｌ3が負の場合とは、基本経路Ｐ0のＺ方向の長さＺｆが、Ａ点とＧ点とのＺ方向の長さｚ0から初期直線経路のＺ軸方向の長さＬ0×ｓｉｎθを差し引いた長さを超えている場合である。Ａ点から目標位置Ｇ点に到達する経路が正しく設定できないと判定した場合には、ステップＳ５０に移行し、現在位置Ａからは目標位置Ｇ点に到達できない旨をモニタ３４やスピーカー３３を用いて運転者に報知し、処理を終了する。運転者は、必要であれば、車両２００を移動させて再度駐車支援動作を作動させればよい。
【００３５】
目標経路が設定できた場合には、ステップＳ１４に移行して、実際の支援制御を開始する。ここで、駐車支援ＥＣＵ１は、シフトレバーが後退位置に設定されたら、図示していない駆動系に対して、エンジンのトルクアップ制御を行うよう指示することが好ましい。トルクアップ制御とは、エンジンを通常のアイドル時より高い回転数で回転させることで、駆動力の高い状態（トルクアップ状態）に移行させるものである。これにより、運転者がアクセル操作を行うことなく、ブレーキペダルのみで調整できる車速範囲が拡大し、車両のコントロール性が向上する。運転者がブレーキペダルを操作すると、そのペダル開度に応じて各輪に付与される制動力を調整することで車速の調整を行う。このとき、車輪速センサ３２で検出している車速が上限車速を超えないよう各車輪に付与する制動力を制御することで上限車速のガードを行うことが好ましい。
【００３６】
誘導制御においては、まず、車両の現在位置の判定を行う（ステップＳ１４）。この現在位置判定は、後方カメラ３２で撮像している画像における特徴点の移動を基に判定することも可能であるし、車輪速センサ４１や加速度センサ４２の出力を基にした走行距離変化と操舵角センサ２３の出力を基にした舵角変化を基にして判定を行うこともできる。
【００３７】
そして、この現在位置（走行距離）を基に先に設定した走行距離−操舵角の設定経路に基づいて実際の舵角制御を行う（ステップＳ１６）。具体的には、操舵制御部１１は、操舵角センサ２３の出力を監視しながら、操舵アクチュエータ２４を制御してステアリングシャフト２１を駆動し、転舵輪２５の舵角が設定した舵角変位（曲率）に合致するよう制御する。
【００３８】
こうして設定した経路に沿った移動が行われるので、運転者は進路上の安全確認と車速調整に専念することができる。進路上に障害物や歩行者等が存在した場合は、運転者がブレーキペダルを踏み込むと、それに応じた制動力が各車輪へと付与されるので安全に減速、停止することができる。
【００３９】
舵角制御後は、現在位置が目標経路上からずれていないかを判定し、ずれが大きい場合には経路修正を要すると判定する（ステップＳ１８）。この目標経路からのずれは、目標位置と現在の位置のずれ、あるいは、目標操舵量と実際の操舵量のずれを走行距離に対して積算すること等により求めることができる。経路修正を要する場合には、ステップＳ６へと移行することで、経路を設定し直す。
【００４０】
一方、目標経路とのずれが小さい場合には、ステップＳ２０へと移行し、目標駐車位置Ｇ点近傍に到達したか否かを判定する。目標駐車位置へ到達していない場合には、ステップＳ１４へと戻ることで、支援制御を継続する。目標駐車位置へと到達したと判定された場合には、ステップＳ２２へと移行し、モニタ３４、スピーカー３３により運転者に目標駐車位置へと到達した旨を報知して処理を終了する。
【００４１】
このように、基本経路を求め、必要ならその両端またはいずれか一方に直線経路を付与することで経路設定を行うので、経路演算のアルゴリズムが単純化され、また、計算も簡略化できるので、演算負荷が小さくて済み、少ない計算機資源で容易にリアルタイムでの演算を行うことができる。また、計算に際して精度の低下もないため、目的位置へ高精度で誘導することができる。
【００４２】
次に、支援動作の第２の制御形態について説明する。この第２の制御形態は、図７に示されるように、道路２１１の脇に沿って駐車している前車両２１０と後車両２０２の間の駐車スペース２２１に自車両２００を後退によって収容する、いわゆる縦列駐車操作の支援を行うものである。図８は、この第２の制御形態の制御フローチャートであり、図９は、この制御における支援経路の設定を説明する図である。
【００４３】
この実施形態は、基準点と目標位置との関係を求めるまでの処理は、上述した第１の実施形態と同様である。まず、舵角を逆方向に転換する中間位置である切り返し点Ｍ点までの経路Ｐ52を目標駐車位置Ｇ点から逆算により求める（ステップＳ３１）。以下、この中間位置Ｍ点の位置座標を（ｘM、ｚM）で表す。この中間位置Ｍ点における偏向角θMは予め設定された値を採るものとする。ここで、計算を簡略化するため、経路Ｐ52は、中間位置Ｍ点からは、走行距離に対する曲率変化量を−ωで変化させるものとし、Ｎ点で、曲率が−γmaxに達したら、曲率を−γmaxで維持したまま目標位置Ｇ点へと至る経路であるものとする（以下、第２の基本経路と称する）。
【００４４】
ＭＮ間の経路長をＬ51、ＮＧ間の経路長をＬ52とすると、この経路Ｐ52の走行距離と曲率の関係は図９（ａ）に示されるようになる。そして、上述したようにこの走行距離−曲率曲線の面積Ｓが偏向角の変化量に合致するから、目標位置で偏向角θを０にするためには、この面積ＳがθMに合致する必要がある。したがって、以下の（６）（７）式が成立する。
【００４５】
【数４】
以上の関係からＬ51とＬ52が求まる。こうして設定される経路Ｐ52が第２の基本経路にあたる。
【００４６】
次に、こうして設定した経路Ｐ52を基にして中間地点Ｍの位置座標を求める（ステップＳ３２）。まず、Ｇ点からＮ点までは、円弧区間となるから、この部分における偏向角変動量θCは、円弧の中心角に等しい。したがって、Ｎ点の座標を（ｘN，ｚN）とすると、以下の（８）〜（１０）式が成り立つ。
【００４７】
【数５】
これらの式と先ほど求めたＬ52からＮ点の位置座標を求めることができる。さらに、Ｎ点の位置からＭ点の位置を逆算する。Ｍ点の位置関係については、以下の（１１）〜（１３）式が成立する。
【００４８】
【数６】
この式から中間地点Ｍ点の位置を算出することができる。
【００４９】
続いて、初期位置Ａ点からＭ点までの経路算出を行う。この経路算出手法は、車庫入れの経路算出手法と類似する。すなわち、まず、ステップＳ６と同様の手法により、現在の偏向角０から偏向角θMの状態に移行するための基本経路（第１の基本経路）Ｐ4を算出する（ステップＳ３３）。
【００５０】
次に、ステップＳ８と同様の手法により、この第１の基本経路Ｐ4のＸ方向、Ｚ方向のそれぞれの長さを求める（ステップＳ３４）。続いて、ステップＳ１０と同様の手法により基本経路Ｐ4に直線経路を付与してＭ点までの目標経路Ｐ51を設定する（ステップＳ３５）。図９（ｂ）はこうして設定した第１の基本経路Ｐ4の走行距離に対する曲率変化量を示したグラフである。この目標経路Ｐ51とＭ点からの目標経路Ｐ52とを組み合わせることで、Ａ点からＧ点へと至る経路Ｐ5が求まる（ステップＳ３６）。図９（ｃ）はこうして設定した経路Ｐ5を示したものである。
【００５１】
ここでは、第１の基本経路Ｐ4側に直線経路を付与する例を説明したが、第２の基本経路Ｐ52側でハンドルを中立に戻す操作を行う場合には、第２の基本経路側に直線経路を付与することもできる。また、第１の基本経路、第２の基本経路の双方に直線経路を付与することも可能である。
【００５２】
経路設定後の実際の誘導処理は、図３に示される処理と同一であることから、その説明は省略する。本制御形態によれば、第１の制御形態における車庫入れ操作の場合と同様に、縦列駐車の支援操作においても基本経路を求め、必要なら直線経路を付与して実際の誘導経路を設定することで、経路演算のアルゴリズムが単純化され、また、計算も簡略化できるので、演算負荷が小さくて済み、少ない計算機資源で容易にリアルタイムでの演算を行うことができる。また、計算に際して精度の低下もないため、目的位置へ高精度で誘導することができる。
【００５３】
次に、支援動作の第３の制御形態について説明する。この第３の制御形態は、上述した第１の制御形態と同様に、車庫入れ操作の支援を行うものである。本実施形態では、基本経路Ｐ0からの目標経路の設定方法のみが異なる。具体的には、図１０にその設定部分のフローチャートを示すように、基本経路Ｐ0に直線経路を付与して目標経路を設定するのではなく、基本経路Ｐ0を相似拡大した経路Ｐ2に直線経路を付与して目標経路Ｐ3を生成する（ステップＳ１１）。
【００５４】
図１１は設定される経路の位置関係を示す図である。相似拡大の倍率をεとし、この相似拡大経路Ｐ2の始点をＢ’、終点をＥ’で表す。そして、Ａ点からＢ’点へと至る直線経路の経路長をＬ0、Ｅ’点からＧ点へと至る直線経路の経路長をＬ3とすると、次の（１４）（１５）式が成り立つ。
【００５５】
【数７】
ここでεは、Ｚｆ／Ｘｆがｚ0／ｘ0以下のとき、つまり、基本経路Ｐ0のＺ方向とＸ方向の比が、目標経路のＺ方向とＸ方向の比に比べて小さく、横（Ｘ方向）に長い場合には、ε≦ｘ0／Ｘｆに設定すればよい。逆に基本経路が縦に長い場合には、例えば、ε＝ｘ0／Ｘｆとすると、相似拡大経路の終点が目標駐車位置Ｇ点を通過してしまうので、これより小さい値、に設定する必要がある。この場合、εの最大値は、Ｌ3を０とした時の値であり、（１４）（１５）式より
【００５６】
【数８】
となる。最大値でなく、これを下回る任意の値を用いてもよい。相似拡大係数εを設定すれば、（１４）（１５）式より各直線区間の長さを計算できる。これにより、目標経路Ｐ3を設定することができる。
【００５７】
ここで、こうして設定された目標経路Ｐ3における相似変換経路Ｐ2においては、基本経路Ｐ0において、Ａ点から走行距離ｐ離れた位置における曲率がγ（ｐ）で表されるとき、そのＡ点から走行距離εｐ離れた位置における曲率が、γ（ｐ）／εとして表される。図１２に示されるように、この相似拡大経路Ｐ2は、基本経路Ｐ0を距離方向にε倍に引き延ばすとともに、曲率方向に１／ε倍へと圧縮（旋回半径をε倍に拡大）したものである。したがって、相似変換経路Ｐ2の走行距離−曲率線図における面積は、基本経路Ｐ0の走行距離−曲率線図における面積は合致し、偏向角の変化量は同一に保たれる。
【００５８】
この相似変換によって、曲率の最大値は基本経路のγmaxから１／ε倍のγmax／εへと低下し、操舵速度ωは１／ε2に低下させることができるので、操舵アクチュエータ２４の負荷を減らすことができ、操舵制御の制御性が向上する。
【００５９】
ここでは、車庫入れについて基本経路を相似変換する例を説明したが、縦列駐車の場合も同様に基本経路を相似変換することが可能である。この場合、基本経路が第１の基本経路と第２の基本経路２つあることになる。その相似拡大は、それぞれの基本経路を同じ倍率で相似拡大してもいいが、それぞれの基本経路を異なる倍率で相似拡大してもよく、さらには、一方の基本経路はそのまま維持して他方の基本経路のみを相似拡大してもよい。ところで、縦列駐車の場合、切り返し点以降の経路のＺ方向の長さは、前車両２０１に接触しないよう前車両２０１と後車両２０２との間隔に比べてできるだけ短くすることが好ましい。そのため、基本経路の相似拡大は、第１の基本経路の相似拡大を優先して行うことが好ましい。
【００６０】
ここでは、初期操舵角（旋回曲率）が略０の場合に、経路を設定し、初期操舵角（旋回曲率）が大きい場合には、経路設定を行わない例を説明したが、初期操舵角が大きい場合には、初期操舵角を略０とする据え切り操作を運転者に指示するようにしてもよい。このようにすれば、初期操舵角が略０でない場合であっても、支援制御を中止することなく、そのまま継続することができるため、操作性が向上する。
【００６１】
なお、基本経路は、演算によって求めてもよいが、駐車支援ＥＣＵ１内に、偏向角θに対して状態量をマップ形式で保持しておいてもよい。このようにすると、駐車支援ＥＣＵ１の演算能力を高くする必要がなく、また、経路の算出をより高速で行うことができる。
【００６２】
以上の説明では、自動操舵機能を有する駐車支援装置における実施例を説明してきたが、操舵を自動的に行う技術だけでなく、運転者に対して適切な操舵量を指示する操舵ガイダンスを行う技術においても同様に用いることができる。また、駐車支援装置に限らず、経路に応じた移動を誘導する走行支援装置、レーンキープシステム等にも適用可能である。
【００６３】
【発明の効果】
以上説明したように本発明によれば、車両の向きを目標の向きに一致させるための基本経路を求め、この基本経路に必要ならば直線経路を付与することで目標経路を算出することで、目標経路を算出するため、目標経路算出のアルゴリズムが簡略化され、演算能力の高くない車載演算装置においてもリアルタイムで経路演算を行うことができる。
【００６４】
さらに、基本経路を相似拡大して目標経路設定を行えば、誘導時の操舵速度を小さくすることができるため、操舵負荷を抑制することができるので、目標位置への誘導精度を向上させることができる。
【図面の簡単な説明】
【図１】本発明の実施形態である駐車支援装置１００のブロック構成図である。
【図２】図１の装置の第１の制御形態における駐車支援である車庫入れ操作を説明する図である。
【図３】図１の装置における第１の制御形態の制御を示すフローチャートである。
【図４】図１の装置における操舵角δと旋回曲率γの関係を示す図である。
【図５】図３の制御形態で設定される支援経路を走行距離と曲率の関係として説明する図である。
【図６】図３の制御形態で設定される支援経路を車両と目標位置の位置関係とともに説明する図である。
【図７】図１の装置の第２の制御形態における駐車支援である縦列駐車操作を説明する図である。
【図８】図１の装置における第２の制御形態の制御を示すフローチャートである。
【図９】図８の制御形態で設定される支援経路を走行距離と曲率の関係として説明する図である。
【図１０】図１の装置における第３の制御形態の特徴部分を示すフローチャートである。
【図１１】図１０の制御形態により設定される経路の位置関係を示す図である。
【図１２】図１０の制御形態により設定される経路を走行距離と曲率の関係として説明する図である。
【符号の説明】
１…駐車支援ＥＣＵ、１０…画像処理部、１１…操舵制御部、２０…自動操舵装置、３１…入力手段、３２…後方カメラ、３３…スピーカー、３４…モニタ、４１…車輪速センサ、４２…加速度センサ、２４…操舵アクチュエータ、２２…ステアリングホイール、２１…ステアリングシャフト、２３…操舵角センサ、１００…駐車支援装置、２００…車両、２０１…前車両、２０２…後車両、２１０、２１１…道路、２２０…車庫、２２１…駐車スペース。
【発明の属する技術分野】
本発明は、目標位置への走行経路を求めて、この経路に沿って車両が走行するよう、その走行を支援する車両用走行支援装置に関する。
【０００２】
【従来の技術】
自動操舵や操舵指示を用いて、車両を目標位置へと誘導する技術が知られている（例えば、特許文献１参照）。目標位置へ車両を的確に誘導するとともに、その目標位置における車両の方位角を目標方位角に合致させるため、３つの基本となる軌道パターンを用意し、位置、方位角、曲率の誤差を補償するために３次方程式を解き、求めた解を用いて、これらの軌道パターンを相似変換することで目標軌道を設定するものである。
【０００３】
【特許文献１】
特開平５−２９７９３５号公報（段落００５４〜００６８、図７）
【０００４】
【発明が解決しようとする課題】
しかしながら、この手法では３次方程式を解く必要があり、複素数を含む演算を行うことになるため、演算負荷が大きくなり、リアルタイムで計算を行うのは、既存の車載の演算装置では困難である。演算能力の高い演算装置を利用することはコストアップにつながり、好ましくない。
【０００５】
そこで本発明は、車載の演算装置でのリアルタイムでの経路演算に適したアルゴリズムにより経路計算を行う車両用走行支援装置を提供することを課題とする。
【０００６】
【課題を解決するための手段】
上記課題を解決するため、本発明に係る車両用走行支援装置は、目標位置へ至る経路を算出して、該経路に沿って車両を誘導する車両用走行支援装置において、目標位置における車両の向きに対する現在の車両の向きである偏向角の初期位置における角度である初期偏向角を求める偏向角検出手段と、走行距離に応じて所定の条件で操舵を行うことにより、初期偏向角から偏向角０の状態へと移行する基本経路を走行距離と操舵角または旋回曲率の対応として求める基本経路算出手段と、目標位置における車両方向をＺ方向、Ｚ方向に直交する方向をＸ方向とするとき、任意の係数倍した基本経路のＺ方向の長さが初期位置と目標位置とのＺ方向の距離以下となり、かつ任意の係数倍した基本経路のＸ方向の長さが初期位置と目標位置とのＸ方向の距離以下となるように、任意の係数により基本経路を相似拡大し、相似拡大後の基本経路のＺ方向の長さが初期位置と目標位置とのＺ方向の距離未満である場合、及び相似拡大後の基本経路のＸ方向の長さが初期位置と目標位置とのＸ方向の距離未満である場合の少なくともいずれかであるときは、相似拡大後の基本経路の前後の少なくとも一方に直線経路を付与して初期位置から目標位置へと至る目標経路を算出する目標経路算出手段と、を備えているものである。
【０００７】
現在の車両の向きから所定の条件で操舵を行って目標位置における車両の向きと一致させる基本経路は、方位角のみに着目しているため、比較的簡単な演算で経路を求めることができる。こうして設定した経路に直線経路を付与して目標経路を算出するので、経路算出が簡単であり、また、精度よく経路を算出することができる。また、基本経路を相似拡大すると、経路全体で変更される偏向角は元の基本経路と同一となるが、操舵速度を遅くすることができるため、自動操舵装置への負荷を低減することができ、また、操舵遅れの発生も抑制されるので、目標位置への誘導精度がさらに向上する。
【０００８】
あるいは本発明に係る車両用走行支援装置は、目標位置へ至る経路を算出して、該経路に沿って車両を誘導する車両用走行支援装置において、目標位置における車両の向きに対する現在の車両の向きである偏向角の初期位置における角度である初期偏向角を求める偏向角検出手段と、走行距離に応じて所定の条件で操舵を行うことにより、初期偏向角から所定の偏向角へと移行する第１の基本経路を走行距離と操舵角または旋回曲率の対応として求める第１基本経路算出手段と、走行距離に応じて所定の条件で操舵を行うことにより、所定の偏向角から偏向角０の状態へと移行する第２の基本経路を走行距離と操舵角または旋回曲率の対応として求める第２基本経路算出手段と、目標位置における車両方向をＺ方向、Ｚ方向に直交する方向をＸ方向とするとき、任意の第１の係数倍した第１基本経路と任意の第２の係数倍した第２基本経路とのＺ方向の長さの和が初期位置と目標位置とのＺ方向の距離以下となり、かつ任意の第１の係数倍した第１基本経路と任意の第２の係数倍した第２基本経路とのＸ方向の長さの和が初期位置と目標位置とのＸ方向の距離以下となるように、任意の第１の係数により第１基本経路を相似拡大し、任意の第２の係数により第２基本経路を相似拡大し、相似拡大後の第１基本経路と第２基本経路とのＺ方向の長さの和が初期位置と目標位置とのＺ方向の距離未満である場合、及び相似拡大後の第１基本経路と第２基本経路とのＸ方向の長さの和が初期位置と目標位置とのＸ方向の距離未満である場合の少なくともいずれかであるときは、相似拡大後の第１基本経路と第２基本経路の中間及び前後の少なくともいずれか一箇所に直線経路を付与して初期位置から目標位置へと至る目標経路を算出する目標経路算出手段と、を備えているものである。
【０００９】
この手法によれば、縦列駐車のように経路の途中まで偏向角を増大させ、その後偏向角を減少させて目標位置での車両方向に一致させる経路を設定する必要がある場合でも、同様に方位角変化のみに着目して基本経路（この場合は、第１基本経路と第２基本経路の２つの基本経路を有する。）を設定し、この前後または中間に直線経路を付与することで目標経路を算出するので、経路算出が簡単であり、また、精度よく経路を算出することができる。
【００１０】
これら基本経路の各々は、少なくとも、走行距離に対する旋回曲率の設定された変化速度で旋回曲率を変化させる段階から構成されていることが好ましい。舵角増大、減少段階での走行距離に対する旋回曲率変化量を一定とすると、走行距離に対する旋回曲率変化の図形は台形として表される。旋回曲率変化量の走行距離に対する積分値、つまり、この図形の面積が偏向角の変化量に合致するから、偏向角を所定量偏向するのに必要な基本経路の演算式が簡略化できる。
【００１１】
設定した目標経路を走行するよう自動的に操舵を行う自動操舵手段をさらに備えていると、経路に沿った誘導を確実に行うことができ、好ましい。
【００１２】
この目標経路の設定は、初期位置における操舵角が略０の場合に設定を行うことが好ましい。操舵角が略０の場合に設定を行うことで、経路演算における方位角以外の影響を排除することができ、演算の精度が向上し、目標位置への誘導精度が向上する。
【００１４】
【発明の実施の形態】
以下、添付図面を参照して本発明の好適な実施の形態について詳細に説明する。説明の理解を容易にするため、各図面において同一の構成要素に対しては可能な限り同一の参照番号を附し、重複する説明は省略する。
【００１５】
以下、本発明に係る走行支援装置として駐車支援装置を例に説明する。図１は、本発明の実施形態である駐車支援装置１００のブロック構成図である。この駐車支援装置１００は、自動操舵装置２０を備えており、制御装置である駐車支援ＥＣＵ１により制御される。駐車支援ＥＣＵ１は、ＣＰＵ、ＲＯＭ、ＲＡＭ、入力信号回路、出力信号回路、電源回路などにより構成され、後述する後方カメラ３２で取得された画像を処理する画像処理部１０と、自動操舵装置の制御を行う操舵制御部１１を有している。この画像処理部１０と操舵制御部１１とは駐車支援ＥＣＵ１内でハード的に区分されていてもよいが、共通のＣＰＵ、ＲＯＭ、ＲＡＭ等を用い、ソフト的に区分されていてもよい。
【００１６】
ステアリングホイール２２の動きを転舵輪２５に伝えるステアリングシャフト２１には、ステアリングシャフト２１の操舵量を検出する操舵角センサ２３と、操舵力を付与する操舵アクチュエータ２４が接続されている。ここで、操舵アクチュエータ２４は、自動操舵時に操舵力を付与するほか、運転者の操舵時にアシスト操舵力を付与するパワーステアリング装置を兼ねてもよい。操舵制御部１１は、操舵アクチュエータ２４の駆動を制御するとともに、操舵角センサ２３の出力信号が入力される。
【００１７】
また、操舵制御部１１には、操舵角センサ２３の出力のほか、各輪に配置されてその車輪速を検出する車輪速センサ４１と、車両の加速度を検出する加速度センサ４２の出力が入力されている。
【００１８】
駐車支援ＥＣＵ１の前述した画像処理部１０には、車両後部に配置されて、後方画像を取得する後方カメラ３２の出力信号である画像信号が入力されるほか、駐車支援にあたって運転者の操作入力を受け付ける入力手段３１と、運転者に対して画像により情報を表示するモニタ３４と、音声により情報を提示するスピーカー３３が接続されている。
【００１９】
次に、この駐車支援装置における支援動作を具体的に説明する。まず、支援動作の第１の制御形態について説明する。この第１の制御形態においては、図２に示されるように、道路２１０に面して設けられた車庫２２０内に、後退によって車両２００を収容する、いわゆる車庫入れ操作の支援を行う。図３は、この第１の制御形態の制御フローチャートであり、図５、図６は、この制御における支援経路の設定を説明する図である。ここで、図５が走行距離と曲率の関係として支援経路を説明する図であり、図６は、車両と目標位置の位置関係とともに経路を説明する図である。
【００２０】
図３に示される制御は、運転者が入力手段３１を操作して、駐車支援制御の開始を駐車支援ＥＣＵ１に指示してから、指示した目標駐車位置近傍へ到達するまで、あるいは、目標駐車位置へ１回の後退で到達することができないと判定されるまで、運転者が入力手段３１から支援動作をキャンセルしない限り駐車支援ＥＣＵ１により実行され続ける。
【００２１】
具体的には、運転者は、任意の駐車支援の開始位置へと車両を移動させ、モニタ３４に表示されている後方カメラ３２で撮像した後方画像中で目標位置を確認した後、入力手段３１を操作して、この駐車支援制御を開始する。目標位置がモニタ３４の表示画像中で確認できない場合には、確認可能な位置へと車両を移動させて支援をスタートさせる。以下、この駐車支援の開始位置における車両２００の基準点（以下の説明では、車両の後輪の車軸中心を基準点として説明する。もちろん、他の位置、例えば、車両の後端の中心や重心、片側の前端あるいは後端等を基準点にとってもよい。）をＡ点とし、この位置での車両を２００ａで表すものとする。
【００２２】
駐車支援ＥＣＵ１は、操舵角センサ２３の出力から操舵角δの絶対値としきい値δthとを比較する（ステップＳ１）。δがδth以下であって十分に小さいときには、舵角中立状態であると判定し、駐車支援制御への移行を許可し、ステップＳ２へと移行する。図Ｘに示されるように、中立付近では、ステアリングホイール２２、ステアリングシャフト２１の回転量である操舵角δに対して転舵輪２５の転舵量である曲率γは小さく設定されているため、このしきい値δthは、γが略０の範囲を規定しうるよう設定されていればよく、例えば、１５度程度に設定される。これに対して、舵角が中立状態でない場合には、ステップＳ４０へと移行し、スピーカ３３とモニタ３４により、運転者に対して、舵角が制御範囲から外れている旨を報知し、ステアリングホイール２２を操作して、舵角中立状態へと戻すよう促し、再びステップＳ１へと戻る。これにより、運転者が据え切り操作等によって舵角を略中立状態に戻すと駐車支援制御へと移行することができる。
【００２３】
ステップＳ２では、運転者はモニタ３４に表示されている後方カメラ３２で撮像した画像を見ながら、入力手段３１を操作することにより、画面上に表示されている駐車枠を動かして目標駐車位置へと移動させることにより目標駐車位置の設定を行う。
【００２４】
駐車支援ＥＣＵ１は、画像認識処理により目標駐車位置における車両位置２００ｇ、具体的には、基準点Ｇの位置と、その位置における車両の方向を求める（ステップＳ４）。このＧ点の位置は、例えば現在の車両位置における基準点Ａに対する相対座標として求めればよい。以下、図２に示されるように、目標位置Ｇ点を原点とし、目標位置における車両の向きをｚ軸方向にとり、これに直交する方向をｘ軸にとった座標系により説明する。以下、現在の車両の向きとｚ軸のなす角度を偏向角θと称する。また、Ａ点の位置を座標（ｘ0，ｚ0）で表す。
【００２５】
次に、現在位置（初期位置Ａ点）、現在の偏向角θ0から、偏向角θを０にする最短経路（以下、基本経路と称する。）Ｐ0を算出する（ステップＳ６）。この走行軌跡Ｐ0は、走行距離に対する旋回曲率（＝旋回半径の逆数）変化として設定される。図５（ａ）は、この基本経路Ｐ0の走行距離−旋回曲率線図を示している。
【００２６】
この最短経路Ｐ0は、舵角を増大させる過程（過程１）と、増大した状態で舵角を維持する過程（過程２）と、舵角を中立に戻す過程（過程３）の３つの過程からなり、過程１と過程３においては、走行距離に対する旋回曲率の変化量（旋回曲率の変化速度）を一定としている。この旋回曲率の変化速度は、車速が走行支援時の上限値の場合であっても、操舵アクチュエータ２４の最大操舵速度での曲率変化量を下回るように設定されている。これにより、確実に操舵が行える経路を算出しうる。このとき設定される軌跡の代表例は、まず、初期位置Ｂ点からＣ点まで旋回曲率の走行距離に対する変化速度を一定として旋回曲率を増大させていき、Ｃ点で操舵角、旋回曲率が設定最大値で、旋回半径が設定最小旋回半径（Ｒmin、曲率γmax＝１／Ｒmin）となる状態に移行する（過程１）。Ｃ点からＤ点まではこの操舵角（旋回曲率、旋回半径）を維持する（過程２）。Ｄ点からは逆に旋回曲率の走行距離に対する変化速度を一定として旋回曲率を減少させて、Ｅ点で舵角０の中立状態へと移行する（過程３）。この結果、走行軌跡Ｐは、ＣＤ間が半径Ｒminの円弧であり、ＢＣ間、ＤＥ間は、それぞれ一端が曲率１／Ｒmin、他端が曲率０のクロソイド曲線となる。
【００２７】
偏向角θが小さい場合には、円弧区間を有しない場合もありうる。ここでＢＥ間の偏向角θの変化量Δθは、以下の（１）式で表せる。
【００２８】
【数１】
【００２９】
次に、この基本経路Ｐ0のＸ方向、Ｚ方向のそれぞれの長さを求める（ステップＳ８）。基本経路Ｐ0のＸ方向の長さＸｆとＺ方向の長さＺｆは、以下の（２）（３）式から求めることができる。
【００３０】
【数２】
【００３１】
続いて、基本経路Ｐ0に直線経路を付与して目標経路Ｐ1を設定する（ステップＳ１０）。すなわち、図６に示されるように、基本経路Ｐ0の両端を延長してＡ点からＧ点へと至る経路を求める。具体的には、Ａ点から基本経路Ｐ0の始点Ｂ点へと至る直線経路の経路長をＬ0、基本経路Ｐ0の終点Ｅ点からＧ点へと至る直線経路の経路長をＬ3とすると、次の（４）（５）式が成り立つ。
【００３２】
【数３】
【００３３】
図５（ｂ）にこうして設定された目標経路Ｐ1の走行距離に対する曲率の対応を示す。図６には、この目標経路Ｐ1が描く軌跡を示している。この経路Ｐ1においては、目標経路が車両の速度、加速度に依存しない。そのため、走行時に経路に追従する制御が簡略化できる利点がある。
【００３４】
続く、ステップＳ１２では、経路が設定できたか否かを判定する。具体的には、Ｌ0、Ｌ3のいずれもが負でない。つまり、０か正であれば経路が設定できたと判断される。Ｌ0が負の場合とは、基本経路Ｐ0のＸ方向の長さＸｆが、Ａ点とＧ点とのＸ方向の距離（ｘ0）を上回る場合であり、Ｌ3が負の場合とは、基本経路Ｐ0のＺ方向の長さＺｆが、Ａ点とＧ点とのＺ方向の長さｚ0から初期直線経路のＺ軸方向の長さＬ0×ｓｉｎθを差し引いた長さを超えている場合である。Ａ点から目標位置Ｇ点に到達する経路が正しく設定できないと判定した場合には、ステップＳ５０に移行し、現在位置Ａからは目標位置Ｇ点に到達できない旨をモニタ３４やスピーカー３３を用いて運転者に報知し、処理を終了する。運転者は、必要であれば、車両２００を移動させて再度駐車支援動作を作動させればよい。
【００３５】
目標経路が設定できた場合には、ステップＳ１４に移行して、実際の支援制御を開始する。ここで、駐車支援ＥＣＵ１は、シフトレバーが後退位置に設定されたら、図示していない駆動系に対して、エンジンのトルクアップ制御を行うよう指示することが好ましい。トルクアップ制御とは、エンジンを通常のアイドル時より高い回転数で回転させることで、駆動力の高い状態（トルクアップ状態）に移行させるものである。これにより、運転者がアクセル操作を行うことなく、ブレーキペダルのみで調整できる車速範囲が拡大し、車両のコントロール性が向上する。運転者がブレーキペダルを操作すると、そのペダル開度に応じて各輪に付与される制動力を調整することで車速の調整を行う。このとき、車輪速センサ３２で検出している車速が上限車速を超えないよう各車輪に付与する制動力を制御することで上限車速のガードを行うことが好ましい。
【００３６】
誘導制御においては、まず、車両の現在位置の判定を行う（ステップＳ１４）。この現在位置判定は、後方カメラ３２で撮像している画像における特徴点の移動を基に判定することも可能であるし、車輪速センサ４１や加速度センサ４２の出力を基にした走行距離変化と操舵角センサ２３の出力を基にした舵角変化を基にして判定を行うこともできる。
【００３７】
そして、この現在位置（走行距離）を基に先に設定した走行距離−操舵角の設定経路に基づいて実際の舵角制御を行う（ステップＳ１６）。具体的には、操舵制御部１１は、操舵角センサ２３の出力を監視しながら、操舵アクチュエータ２４を制御してステアリングシャフト２１を駆動し、転舵輪２５の舵角が設定した舵角変位（曲率）に合致するよう制御する。
【００３８】
こうして設定した経路に沿った移動が行われるので、運転者は進路上の安全確認と車速調整に専念することができる。進路上に障害物や歩行者等が存在した場合は、運転者がブレーキペダルを踏み込むと、それに応じた制動力が各車輪へと付与されるので安全に減速、停止することができる。
【００３９】
舵角制御後は、現在位置が目標経路上からずれていないかを判定し、ずれが大きい場合には経路修正を要すると判定する（ステップＳ１８）。この目標経路からのずれは、目標位置と現在の位置のずれ、あるいは、目標操舵量と実際の操舵量のずれを走行距離に対して積算すること等により求めることができる。経路修正を要する場合には、ステップＳ６へと移行することで、経路を設定し直す。
【００４０】
一方、目標経路とのずれが小さい場合には、ステップＳ２０へと移行し、目標駐車位置Ｇ点近傍に到達したか否かを判定する。目標駐車位置へ到達していない場合には、ステップＳ１４へと戻ることで、支援制御を継続する。目標駐車位置へと到達したと判定された場合には、ステップＳ２２へと移行し、モニタ３４、スピーカー３３により運転者に目標駐車位置へと到達した旨を報知して処理を終了する。
【００４１】
このように、基本経路を求め、必要ならその両端またはいずれか一方に直線経路を付与することで経路設定を行うので、経路演算のアルゴリズムが単純化され、また、計算も簡略化できるので、演算負荷が小さくて済み、少ない計算機資源で容易にリアルタイムでの演算を行うことができる。また、計算に際して精度の低下もないため、目的位置へ高精度で誘導することができる。
【００４２】
次に、支援動作の第２の制御形態について説明する。この第２の制御形態は、図７に示されるように、道路２１１の脇に沿って駐車している前車両２１０と後車両２０２の間の駐車スペース２２１に自車両２００を後退によって収容する、いわゆる縦列駐車操作の支援を行うものである。図８は、この第２の制御形態の制御フローチャートであり、図９は、この制御における支援経路の設定を説明する図である。
【００４３】
この実施形態は、基準点と目標位置との関係を求めるまでの処理は、上述した第１の実施形態と同様である。まず、舵角を逆方向に転換する中間位置である切り返し点Ｍ点までの経路Ｐ52を目標駐車位置Ｇ点から逆算により求める（ステップＳ３１）。以下、この中間位置Ｍ点の位置座標を（ｘM、ｚM）で表す。この中間位置Ｍ点における偏向角θMは予め設定された値を採るものとする。ここで、計算を簡略化するため、経路Ｐ52は、中間位置Ｍ点からは、走行距離に対する曲率変化量を−ωで変化させるものとし、Ｎ点で、曲率が−γmaxに達したら、曲率を−γmaxで維持したまま目標位置Ｇ点へと至る経路であるものとする（以下、第２の基本経路と称する）。
【００４４】
ＭＮ間の経路長をＬ51、ＮＧ間の経路長をＬ52とすると、この経路Ｐ52の走行距離と曲率の関係は図９（ａ）に示されるようになる。そして、上述したようにこの走行距離−曲率曲線の面積Ｓが偏向角の変化量に合致するから、目標位置で偏向角θを０にするためには、この面積ＳがθMに合致する必要がある。したがって、以下の（６）（７）式が成立する。
【００４５】
【数４】
【００４６】
次に、こうして設定した経路Ｐ52を基にして中間地点Ｍの位置座標を求める（ステップＳ３２）。まず、Ｇ点からＮ点までは、円弧区間となるから、この部分における偏向角変動量θCは、円弧の中心角に等しい。したがって、Ｎ点の座標を（ｘN，ｚN）とすると、以下の（８）〜（１０）式が成り立つ。
【００４７】
【数５】
【００４８】
【数６】
【００４９】
続いて、初期位置Ａ点からＭ点までの経路算出を行う。この経路算出手法は、車庫入れの経路算出手法と類似する。すなわち、まず、ステップＳ６と同様の手法により、現在の偏向角０から偏向角θMの状態に移行するための基本経路（第１の基本経路）Ｐ4を算出する（ステップＳ３３）。
【００５０】
次に、ステップＳ８と同様の手法により、この第１の基本経路Ｐ4のＸ方向、Ｚ方向のそれぞれの長さを求める（ステップＳ３４）。続いて、ステップＳ１０と同様の手法により基本経路Ｐ4に直線経路を付与してＭ点までの目標経路Ｐ51を設定する（ステップＳ３５）。図９（ｂ）はこうして設定した第１の基本経路Ｐ4の走行距離に対する曲率変化量を示したグラフである。この目標経路Ｐ51とＭ点からの目標経路Ｐ52とを組み合わせることで、Ａ点からＧ点へと至る経路Ｐ5が求まる（ステップＳ３６）。図９（ｃ）はこうして設定した経路Ｐ5を示したものである。
【００５１】
ここでは、第１の基本経路Ｐ4側に直線経路を付与する例を説明したが、第２の基本経路Ｐ52側でハンドルを中立に戻す操作を行う場合には、第２の基本経路側に直線経路を付与することもできる。また、第１の基本経路、第２の基本経路の双方に直線経路を付与することも可能である。
【００５２】
経路設定後の実際の誘導処理は、図３に示される処理と同一であることから、その説明は省略する。本制御形態によれば、第１の制御形態における車庫入れ操作の場合と同様に、縦列駐車の支援操作においても基本経路を求め、必要なら直線経路を付与して実際の誘導経路を設定することで、経路演算のアルゴリズムが単純化され、また、計算も簡略化できるので、演算負荷が小さくて済み、少ない計算機資源で容易にリアルタイムでの演算を行うことができる。また、計算に際して精度の低下もないため、目的位置へ高精度で誘導することができる。
【００５３】
次に、支援動作の第３の制御形態について説明する。この第３の制御形態は、上述した第１の制御形態と同様に、車庫入れ操作の支援を行うものである。本実施形態では、基本経路Ｐ0からの目標経路の設定方法のみが異なる。具体的には、図１０にその設定部分のフローチャートを示すように、基本経路Ｐ0に直線経路を付与して目標経路を設定するのではなく、基本経路Ｐ0を相似拡大した経路Ｐ2に直線経路を付与して目標経路Ｐ3を生成する（ステップＳ１１）。
【００５４】
図１１は設定される経路の位置関係を示す図である。相似拡大の倍率をεとし、この相似拡大経路Ｐ2の始点をＢ’、終点をＥ’で表す。そして、Ａ点からＢ’点へと至る直線経路の経路長をＬ0、Ｅ’点からＧ点へと至る直線経路の経路長をＬ3とすると、次の（１４）（１５）式が成り立つ。
【００５５】
【数７】
【００５６】
【数８】
【００５７】
ここで、こうして設定された目標経路Ｐ3における相似変換経路Ｐ2においては、基本経路Ｐ0において、Ａ点から走行距離ｐ離れた位置における曲率がγ（ｐ）で表されるとき、そのＡ点から走行距離εｐ離れた位置における曲率が、γ（ｐ）／εとして表される。図１２に示されるように、この相似拡大経路Ｐ2は、基本経路Ｐ0を距離方向にε倍に引き延ばすとともに、曲率方向に１／ε倍へと圧縮（旋回半径をε倍に拡大）したものである。したがって、相似変換経路Ｐ2の走行距離−曲率線図における面積は、基本経路Ｐ0の走行距離−曲率線図における面積は合致し、偏向角の変化量は同一に保たれる。
【００５８】
この相似変換によって、曲率の最大値は基本経路のγmaxから１／ε倍のγmax／εへと低下し、操舵速度ωは１／ε2に低下させることができるので、操舵アクチュエータ２４の負荷を減らすことができ、操舵制御の制御性が向上する。
【００５９】
ここでは、車庫入れについて基本経路を相似変換する例を説明したが、縦列駐車の場合も同様に基本経路を相似変換することが可能である。この場合、基本経路が第１の基本経路と第２の基本経路２つあることになる。その相似拡大は、それぞれの基本経路を同じ倍率で相似拡大してもいいが、それぞれの基本経路を異なる倍率で相似拡大してもよく、さらには、一方の基本経路はそのまま維持して他方の基本経路のみを相似拡大してもよい。ところで、縦列駐車の場合、切り返し点以降の経路のＺ方向の長さは、前車両２０１に接触しないよう前車両２０１と後車両２０２との間隔に比べてできるだけ短くすることが好ましい。そのため、基本経路の相似拡大は、第１の基本経路の相似拡大を優先して行うことが好ましい。
【００６０】
ここでは、初期操舵角（旋回曲率）が略０の場合に、経路を設定し、初期操舵角（旋回曲率）が大きい場合には、経路設定を行わない例を説明したが、初期操舵角が大きい場合には、初期操舵角を略０とする据え切り操作を運転者に指示するようにしてもよい。このようにすれば、初期操舵角が略０でない場合であっても、支援制御を中止することなく、そのまま継続することができるため、操作性が向上する。
【００６１】
なお、基本経路は、演算によって求めてもよいが、駐車支援ＥＣＵ１内に、偏向角θに対して状態量をマップ形式で保持しておいてもよい。このようにすると、駐車支援ＥＣＵ１の演算能力を高くする必要がなく、また、経路の算出をより高速で行うことができる。
【００６２】
以上の説明では、自動操舵機能を有する駐車支援装置における実施例を説明してきたが、操舵を自動的に行う技術だけでなく、運転者に対して適切な操舵量を指示する操舵ガイダンスを行う技術においても同様に用いることができる。また、駐車支援装置に限らず、経路に応じた移動を誘導する走行支援装置、レーンキープシステム等にも適用可能である。
【００６３】
【発明の効果】
以上説明したように本発明によれば、車両の向きを目標の向きに一致させるための基本経路を求め、この基本経路に必要ならば直線経路を付与することで目標経路を算出することで、目標経路を算出するため、目標経路算出のアルゴリズムが簡略化され、演算能力の高くない車載演算装置においてもリアルタイムで経路演算を行うことができる。
【００６４】
さらに、基本経路を相似拡大して目標経路設定を行えば、誘導時の操舵速度を小さくすることができるため、操舵負荷を抑制することができるので、目標位置への誘導精度を向上させることができる。
【図面の簡単な説明】
【図１】本発明の実施形態である駐車支援装置１００のブロック構成図である。
【図２】図１の装置の第１の制御形態における駐車支援である車庫入れ操作を説明する図である。
【図３】図１の装置における第１の制御形態の制御を示すフローチャートである。
【図４】図１の装置における操舵角δと旋回曲率γの関係を示す図である。
【図５】図３の制御形態で設定される支援経路を走行距離と曲率の関係として説明する図である。
【図６】図３の制御形態で設定される支援経路を車両と目標位置の位置関係とともに説明する図である。
【図７】図１の装置の第２の制御形態における駐車支援である縦列駐車操作を説明する図である。
【図８】図１の装置における第２の制御形態の制御を示すフローチャートである。
【図９】図８の制御形態で設定される支援経路を走行距離と曲率の関係として説明する図である。
【図１０】図１の装置における第３の制御形態の特徴部分を示すフローチャートである。
【図１１】図１０の制御形態により設定される経路の位置関係を示す図である。
【図１２】図１０の制御形態により設定される経路を走行距離と曲率の関係として説明する図である。
【符号の説明】
１…駐車支援ＥＣＵ、１０…画像処理部、１１…操舵制御部、２０…自動操舵装置、３１…入力手段、３２…後方カメラ、３３…スピーカー、３４…モニタ、４１…車輪速センサ、４２…加速度センサ、２４…操舵アクチュエータ、２２…ステアリングホイール、２１…ステアリングシャフト、２３…操舵角センサ、１００…駐車支援装置、２００…車両、２０１…前車両、２０２…後車両、２１０、２１１…道路、２２０…車庫、２２１…駐車スペース。
Claims (5)
- 目標位置へ至る経路を算出して、該経路に沿って車両を誘導する車両用走行支援装置において、
目標位置における車両の向きに対する現在の車両の向きである偏向角の初期位置における角度である初期偏向角を求める偏向角検出手段と、
走行距離に応じて所定の条件で操舵を行うことにより、初期偏向角から偏向角０の状態へと移行する基本経路を走行距離と操舵角または旋回曲率の対応として求める基本経路算出手段と、
目標位置における車両方向をＺ方向、前記Ｚ方向に直交する方向をＸ方向とするとき、
任意の係数倍した前記基本経路のＺ方向の長さが初期位置と目標位置とのＺ方向の距離以下となり、かつ前記任意の係数倍した前記基本経路のＸ方向の長さが初期位置と目標位置とのＸ方向の距離以下となるように、前記任意の係数により前記基本経路を相似拡大し、
相似拡大後の前記基本経路のＺ方向の長さが初期位置と目標位置とのＺ方向の距離未満である場合、及び前記相似拡大後の前記基本経路のＸ方向の長さが初期位置と目標位置とのＸ方向の距離未満である場合の少なくともいずれかであるときは、相似拡大後の基本経路の前後の少なくとも一方に直線経路を付与して初期位置から目標位置へと至る目標経路を算出する目標経路算出手段と、
を備えていることを特徴とする車両用走行支援装置。 - 目標位置へ至る経路を算出して、該経路に沿って車両を誘導する車両用走行支援装置において、
目標位置における車両の向きに対する現在の車両の向きである偏向角の初期位置における角度である初期偏向角を求める偏向角検出手段と、
走行距離に応じて所定の条件で操舵を行うことにより、初期偏向角から所定の偏向角へと移行する第１の基本経路を走行距離と操舵角または旋回曲率の対応として求める第１基本経路算出手段と、
走行距離に応じて所定の条件で操舵を行うことにより、前記所定の偏向角から偏向角０の状態へと移行する第２の基本経路を走行距離と操舵角または旋回曲率の対応として求める第２基本経路算出手段と、
目標位置における車両方向をＺ方向、前記Ｚ方向に直交する方向をＸ方向とするとき、
任意の第１の係数倍した前記第１基本経路と任意の第２の係数倍した前記第２基本経路とのＺ方向の長さの和が初期位置と目標位置とのＺ方向の距離以下となり、かつ前記任意の第１の係数倍した前記第１基本経路と前記任意の第２の係数倍した前記第２基本経路とのＸ方向の長さの和が初期位置と目標位置とのＸ方向の距離以下となるように、前記任意の第１の係数により前記第１基本経路を相似拡大し、前記任意の第２の係数により前記第２基本経路を相似拡大し、
相似拡大後の前記第１基本経路と前記第２基本経路とのＺ方向の長さの和が初期位置と目標位置とのＺ方向の距離未満である場合、及び相似拡大後の前記第１基本経路と前記第２基本経路とのＸ方向の長さの和が初期位置と目標位置とのＸ方向の距離未満である場合の少なくともいずれかであるときは、相似拡大後の前記第１基本経路と前記第２基本経路の中間及び前後の少なくともいずれか一箇所に直線経路を付与して初期位置から目標位置へと至る目標経路を算出する目標経路算出手段と、
を備えていることを特徴とする車両用走行支援装置。 - 前記基本経路の各々は、少なくとも、走行距離に対する旋回曲率の設定された変化速度で旋回曲率を変化させる段階から構成されていることを特徴とする請求項１または２に記載の車両用走行支援装置。
- 設定した目標経路を走行するよう自動的に操舵を行う自動操舵手段をさらに備えていることを特徴とする請求項１〜３のいずれか１項に記載の車両用走行支援装置。
- 前記目標経路の設定は、初期位置における操舵角が０の場合に設定を行うことを特徴とする請求項１〜４のいずれか１項に記載の車両用走行支援装置。
Priority Applications (5)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2003183043A JP3911492B2 (ja) | 2003-06-26 | 2003-06-26 | 車両用走行支援装置 |
| US10/871,013 US7487020B2 (en) | 2003-06-26 | 2004-06-21 | Driving assist apparatus and method for vehicle |
| EP04014864A EP1491430B1 (en) | 2003-06-26 | 2004-06-24 | Driving assist apparatus and method for vehicle |
| DE602004012024T DE602004012024T2 (de) | 2003-06-26 | 2004-06-24 | Fahrhilfeverfahren und -vorrichtung für ein Fahrzeug |
| CNB2004100598613A CN100549888C (zh) | 2003-06-26 | 2004-06-25 | 用于车辆的驾驶辅助装置及其方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2003183043A JP3911492B2 (ja) | 2003-06-26 | 2003-06-26 | 車両用走行支援装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2005014775A JP2005014775A (ja) | 2005-01-20 |
| JP3911492B2 true JP3911492B2 (ja) | 2007-05-09 |
Family
ID=33411108
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2003183043A Expired - Fee Related JP3911492B2 (ja) | 2003-06-26 | 2003-06-26 | 車両用走行支援装置 |
Country Status (5)
| Country | Link |
|---|---|
| US (1) | US7487020B2 (ja) |
| EP (1) | EP1491430B1 (ja) |
| JP (1) | JP3911492B2 (ja) |
| CN (1) | CN100549888C (ja) |
| DE (1) | DE602004012024T2 (ja) |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP3378738A1 (en) | 2017-03-23 | 2018-09-26 | Aisin Seiki Kabushiki Kaisha | Vehicle traveling assistance apparatus |
| US20220281523A1 (en) * | 2021-03-04 | 2022-09-08 | Dr. Ing. H.C. F. Porsche Aktiengesellschaft | Method and apparatus for lane control of a vehicle |
Families Citing this family (59)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| DE10256770A1 (de) * | 2002-12-05 | 2004-06-17 | Bayerische Motoren Werke Ag | Verfahren zum Lenken eines rückwärts in eine Parklücke einzuparkenden Fahrzeugs |
| JP3818653B2 (ja) * | 2003-06-26 | 2006-09-06 | トヨタ自動車株式会社 | 車両用走行支援装置 |
| JP3818654B2 (ja) * | 2003-06-26 | 2006-09-06 | トヨタ自動車株式会社 | 車両用走行支援装置 |
| JP4023478B2 (ja) * | 2004-08-03 | 2007-12-19 | 株式会社デンソー | 駐車支援システム |
| WO2006069976A2 (de) * | 2004-12-24 | 2006-07-06 | Continental Teves Ag & Co. Ohg | Verfahren und einparkhilfeeinrichtung zum lenken eines fahrzeugs in eine parklücke |
| JP4769528B2 (ja) * | 2005-09-14 | 2011-09-07 | 富士通テン株式会社 | 駐車支援装置 |
| DE102005058809A1 (de) * | 2005-12-09 | 2007-06-14 | Hella Kgaa Hueck & Co. | Bahnplanung |
| JP4640220B2 (ja) * | 2006-03-09 | 2011-03-02 | トヨタ自動車株式会社 | 車両用ステアリングシステム |
| JP2008089517A (ja) * | 2006-10-04 | 2008-04-17 | Sony Corp | 方位判別装置、方位判別方法及び方位判別プログラム |
| US8190316B2 (en) * | 2006-10-06 | 2012-05-29 | Yamaha Hatsudoki Kabushiki Kaisha | Control apparatus for marine vessel propulsion system, and marine vessel running supporting system and marine vessel using the same |
| US8983765B2 (en) * | 2006-10-11 | 2015-03-17 | GM Global Technology Operations LLC | Method and system for lane centering control |
| JP2008143430A (ja) * | 2006-12-12 | 2008-06-26 | Toyota Motor Corp | 駐車支援装置 |
| DE102007009745A1 (de) * | 2007-02-28 | 2008-09-04 | Continental Automotive Gmbh | Einparkhalbautomat |
| JP5105149B2 (ja) | 2007-04-18 | 2012-12-19 | アイシン精機株式会社 | 駐車支援装置 |
| JP4466718B2 (ja) * | 2007-11-01 | 2010-05-26 | トヨタ自動車株式会社 | 走行軌跡生成方法及び走行軌跡生成装置 |
| DE102007055391A1 (de) * | 2007-11-20 | 2009-05-28 | Valeo Schalter Und Sensoren Gmbh | Verfahren und Vorrichtung zur Bahnplanung beim Einparken eines Fahrzeugs |
| JP4433060B2 (ja) * | 2008-02-18 | 2010-03-17 | トヨタ自動車株式会社 | 駐車支援装置 |
| DE102008002699A1 (de) * | 2008-06-27 | 2009-12-31 | Robert Bosch Gmbh | Vorrichtung und Verfahren zum Steuern einer automatischen Lenkung eines Fahrzeugs und Vorrichtung und Verfahren zum Überprüfen einer Ausführbarkeit einer vorgegebenen Soll-Fahrtrichtungsgröße für ein Fahrzeug |
| WO2010098216A1 (ja) | 2009-02-26 | 2010-09-02 | アイシン精機株式会社 | 駐車支援装置 |
| JP2010202010A (ja) * | 2009-03-02 | 2010-09-16 | Aisin Seiki Co Ltd | 駐車支援装置 |
| DE102009024063A1 (de) * | 2009-06-05 | 2010-12-09 | Valeo Schalter Und Sensoren Gmbh | Verfahren zum Bestimmen einer Lenkkurve für Lenkeinschläge von lenkbaren Rädern eines Fahrzeugs und Parkassistenzsystem für ein Fahrzeug |
| DE102009027941A1 (de) * | 2009-07-22 | 2011-01-27 | Robert Bosch Gmbh | Vorrichtung zum Rangieren eines Fahrzeugs mittels Rangierzügen mit wenigstens einer Trajektorie |
| DE102009028261A1 (de) * | 2009-08-05 | 2011-02-10 | Robert Bosch Gmbh | Verfahren und Steuerung zur Kalibrierung einer automatisch lenkenden Einparkhilfe |
| DE102009044389B4 (de) | 2009-11-02 | 2024-06-06 | Witte-Velbert Gmbh & Co. Kg | Tür- oder Heckklappenöffnungseinrichtung |
| DE102009060169A1 (de) * | 2009-12-23 | 2011-06-30 | Volkswagen AG, 38440 | Automatisches Vorwärtseinparken in Kopfparklücken |
| GB2464413B (en) * | 2010-01-05 | 2014-07-02 | Protean Electric Ltd | Control Device for a Vehicle |
| DE102010000964A1 (de) * | 2010-01-18 | 2011-07-21 | Robert Bosch GmbH, 70469 | Verfahren zur Unterstützung eines Fahrers eines Kraftfahrzeuges |
| JP5418673B2 (ja) * | 2010-06-09 | 2014-02-19 | 日産自動車株式会社 | 駐車モード選択装置及び方法 |
| DE102011119462A1 (de) * | 2011-06-16 | 2012-12-20 | Daimler Ag | Verfahren zum Betreiben eines Seitenwindassistenten für ein Fahrzeug und Seitenwindassistent für ein Fahrzeug |
| US8849007B2 (en) | 2011-10-19 | 2014-09-30 | Crown Equipment Corporation | Identifying, evaluating and selecting possible pallet board lines in an image scene |
| FR2983449B1 (fr) * | 2011-12-06 | 2014-01-10 | Renault Sa | Procede d'aide au parcage pour un vehicule automobile |
| KR101360424B1 (ko) * | 2011-12-09 | 2014-02-10 | 현대자동차주식회사 | 차량용 주차궤적 도출방법 |
| FR2993376B1 (fr) * | 2012-07-12 | 2014-07-25 | Renault Sa | Procede de controle de trajectoire d'un vehicule autonome a roues directrices |
| JP6107158B2 (ja) * | 2013-01-18 | 2017-04-05 | 株式会社ジェイテクト | 電動パワーステアリング装置 |
| CN103507789B (zh) * | 2013-10-14 | 2016-04-06 | 江苏大学 | 一种用于车辆360度全转向的装置及其方法 |
| EP3086994B1 (de) * | 2013-12-23 | 2018-03-28 | ADC Automotive Distance Control Systems GmbH | Park-assistenzsystem und verfahren zum einparken eines fahrzeuges in eine parkgarage |
| DE102014200687A1 (de) * | 2014-01-16 | 2015-07-16 | Robert Bosch Gmbh | Verfahren zum Betreiben eines Fahrzeugs |
| JP6062406B2 (ja) * | 2014-09-12 | 2017-01-18 | アイシン精機株式会社 | 駐車支援装置および駐車支援方法 |
| JP6006765B2 (ja) * | 2014-09-12 | 2016-10-12 | アイシン精機株式会社 | 運転支援装置 |
| KR102036050B1 (ko) * | 2014-12-30 | 2019-10-24 | 주식회사 만도 | 차선 변경 장치 및 방법 |
| JP6642820B2 (ja) * | 2015-10-21 | 2020-02-12 | 日立オートモティブシステムズ株式会社 | 駐車経路算出装置、駐車支援装置および駐車経路算出方法 |
| US10144453B2 (en) * | 2016-04-13 | 2018-12-04 | Cnh Industrial America Llc | System and method for controlling a vehicle |
| US9990535B2 (en) | 2016-04-27 | 2018-06-05 | Crown Equipment Corporation | Pallet detection using units of physical length |
| JP6854095B2 (ja) * | 2016-07-01 | 2021-04-07 | フォルシアクラリオン・エレクトロニクス株式会社 | 駐車支援装置 |
| JP6415631B1 (ja) * | 2017-04-17 | 2018-10-31 | 三菱電機株式会社 | 駐車支援装置および駐車支援方法 |
| JP2018184149A (ja) * | 2017-04-27 | 2018-11-22 | アイシン精機株式会社 | 駐車支援装置 |
| US10483322B2 (en) * | 2017-06-08 | 2019-11-19 | Taiwan Semiconductor Manufacturing Co., Ltd. | Memory device and method for fabricating the same |
| CN107450308B (zh) * | 2017-06-21 | 2020-05-05 | 合肥中导机器人科技有限公司 | 存储设备、机器人 |
| CN107340772B (zh) * | 2017-07-11 | 2020-05-22 | 北京超星未来科技有限公司 | 一种面向无人驾驶的拟人化参考轨迹规划方法 |
| CN107817790B (zh) * | 2017-09-05 | 2020-12-22 | 百度在线网络技术（北京）有限公司 | 一种计算车辆轨迹的曲率的方法和装置 |
| JP7062983B2 (ja) * | 2018-02-06 | 2022-05-09 | 株式会社アイシン | 走行支援装置 |
| WO2019217588A1 (en) | 2018-05-08 | 2019-11-14 | Continental Automotive Systems, Inc. | User-adjustable trajectories for automated vehicle reversing |
| US11603100B2 (en) * | 2018-08-03 | 2023-03-14 | Continental Autonomous Mobility US, LLC | Automated reversing by following user-selected trajectories and estimating vehicle motion |
| JP7199905B2 (ja) | 2018-10-18 | 2023-01-06 | フォルシアクラリオン・エレクトロニクス株式会社 | 自動運転制御装置、および自動運転経路演算方法 |
| CN112141085A (zh) * | 2019-06-27 | 2020-12-29 | 松下知识产权经营株式会社 | 车辆和停车辅助装置 |
| US11247724B2 (en) * | 2019-08-16 | 2022-02-15 | Ford Global Technologies, Llc | Vehicle parking control |
| CN110440824A (zh) * | 2019-08-27 | 2019-11-12 | 广州小鹏汽车科技有限公司 | 一种路径规划方法及路径规划系统 |
| JP7205701B2 (ja) * | 2019-10-11 | 2023-01-17 | トヨタ自動車株式会社 | 車両警報装置 |
| CN113759888B (zh) * | 2020-06-08 | 2024-07-19 | 北京京东乾石科技有限公司 | 一种指引线平滑方法、装置、设备和存储介质 |
Family Cites Families (20)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US4931930A (en) * | 1988-04-19 | 1990-06-05 | Industrial Technology Research Institute | Automatic parking device for automobile |
| US5219036A (en) * | 1989-04-05 | 1993-06-15 | Wagner Fordertechnik Gmbh & Co. | Navigation system and process for guiding unmanned industrial trucks without guide wire |
| JP2785472B2 (ja) * | 1990-10-25 | 1998-08-13 | トヨタ自動車株式会社 | 自動駐車装置 |
| JP3034121B2 (ja) * | 1992-04-17 | 2000-04-17 | 株式会社豊田中央研究所 | 無人車の制御装置 |
| JP3396893B2 (ja) * | 1992-05-25 | 2003-04-14 | 株式会社デンソー | 車両の車庫誘導装置 |
| JPH0944243A (ja) * | 1995-08-01 | 1997-02-14 | Komatsu Ltd | 移動体の走行コース作成装置 |
| JP3266828B2 (ja) * | 1997-07-16 | 2002-03-18 | 本田技研工業株式会社 | 車両の自動操舵装置 |
| JP4109798B2 (ja) | 1999-06-22 | 2008-07-02 | 本田技研工業株式会社 | 車両の自動操舵装置 |
| JP4129101B2 (ja) * | 1999-07-02 | 2008-08-06 | 本田技研工業株式会社 | 車両の自動操舵装置 |
| DE19940007A1 (de) | 1999-08-24 | 2001-03-08 | Bosch Gmbh Robert | Verfahren und Vorrichtung zur Unterstützung des Einparkens eines Kraftfahrzeugs |
| JP4092054B2 (ja) | 1999-11-16 | 2008-05-28 | 本田技研工業株式会社 | 車両の自動操舵装置 |
| US6314341B1 (en) * | 1999-11-26 | 2001-11-06 | Yutaka John Kanayama | Method of recording trajectory data and sensor data for a manually-driven vehicle |
| US6476730B2 (en) * | 2000-02-29 | 2002-11-05 | Aisin Seiki Kabushiki Kaisha | Assistant apparatus and method for a vehicle in reverse motion |
| JP2001255937A (ja) * | 2000-03-10 | 2001-09-21 | Toshiba Corp | 車両用自動走行制御装置 |
| JP3881553B2 (ja) * | 2002-01-11 | 2007-02-14 | トヨタ自動車株式会社 | 走行制御装置 |
| JP3692082B2 (ja) * | 2002-01-23 | 2005-09-07 | トヨタ自動車株式会社 | 駐車支援装置 |
| DE10256770A1 (de) | 2002-12-05 | 2004-06-17 | Bayerische Motoren Werke Ag | Verfahren zum Lenken eines rückwärts in eine Parklücke einzuparkenden Fahrzeugs |
| JP4263534B2 (ja) * | 2003-05-16 | 2009-05-13 | トヨタ自動車株式会社 | 車両用走行支援装置 |
| JP4291625B2 (ja) * | 2003-05-29 | 2009-07-08 | トヨタ自動車株式会社 | 車両用走行支援装置 |
| JP4058389B2 (ja) * | 2003-06-26 | 2008-03-05 | トヨタ自動車株式会社 | 車両用走行支援装置 |
-
2003
- 2003-06-26 JP JP2003183043A patent/JP3911492B2/ja not_active Expired - Fee Related
-
2004
- 2004-06-21 US US10/871,013 patent/US7487020B2/en active Active
- 2004-06-24 DE DE602004012024T patent/DE602004012024T2/de not_active Expired - Lifetime
- 2004-06-24 EP EP04014864A patent/EP1491430B1/en not_active Expired - Lifetime
- 2004-06-25 CN CNB2004100598613A patent/CN100549888C/zh not_active Expired - Lifetime
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP3378738A1 (en) | 2017-03-23 | 2018-09-26 | Aisin Seiki Kabushiki Kaisha | Vehicle traveling assistance apparatus |
| US10800404B2 (en) | 2017-03-23 | 2020-10-13 | Aisin Seiki Kabushiki Kaisha | Vehicle traveling assistance apparatus |
| US20220281523A1 (en) * | 2021-03-04 | 2022-09-08 | Dr. Ing. H.C. F. Porsche Aktiengesellschaft | Method and apparatus for lane control of a vehicle |
| US11820370B2 (en) * | 2021-03-04 | 2023-11-21 | Dr. Ing. H. C. F. Porsche Ag | Method and apparatus for lane control of a vehicle |
Also Published As
| Publication number | Publication date |
|---|---|
| JP2005014775A (ja) | 2005-01-20 |
| US7487020B2 (en) | 2009-02-03 |
| EP1491430A2 (en) | 2004-12-29 |
| CN100549888C (zh) | 2009-10-14 |
| EP1491430A3 (en) | 2005-06-15 |
| CN1577199A (zh) | 2005-02-09 |
| DE602004012024T2 (de) | 2009-03-26 |
| DE602004012024D1 (de) | 2008-04-10 |
| EP1491430B1 (en) | 2008-02-27 |
| US20050021203A1 (en) | 2005-01-27 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP3911492B2 (ja) | 車両用走行支援装置 | |
| JP3818653B2 (ja) | 車両用走行支援装置 | |
| JP4058389B2 (ja) | 車両用走行支援装置 | |
| JP3818654B2 (ja) | 車両用走行支援装置 | |
| JP4345391B2 (ja) | 駐車支援装置 | |
| WO2006101005A1 (ja) | 車両の操舵制御装置 | |
| JP4291625B2 (ja) | 車両用走行支援装置 | |
| JP4167562B2 (ja) | 車両用走行支援装置 | |
| JP3896995B2 (ja) | 車両用走行支援装置 | |
| JP4248335B2 (ja) | 車両用走行支援装置 | |
| JP3866223B2 (ja) | 車両用走行支援装置 | |
| CN113260553B (zh) | 转向控制装置和转向控制方法 | |
| JP4185957B2 (ja) | 車両用走行支援装置 | |
| JP4321380B2 (ja) | 車両用走行支援装置 | |
| JP3934082B2 (ja) | 走行支援装置 | |
| JP2008296638A (ja) | 駐車支援装置、表示装置、目標軌跡設定方法 | |
| JP4097563B2 (ja) | 車両用走行支援装置 | |
| JP2006123605A (ja) | 自動誘導装置 | |
| JP3896994B2 (ja) | 車両用走行支援装置 | |
| JP2007168545A (ja) | 走行支援装置 | |
| JP4433923B2 (ja) | 駐車支援装置 | |
| JP5655919B2 (ja) | 車線逸脱防止装置 | |
| JP2008068828A (ja) | 操舵ギヤ比の自動変更により駐車操舵が支援される車輌 | |
| JP5692324B2 (ja) | 車線逸脱防止装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20050207 |
|
| A711 | Notification of change in applicant |
Free format text: JAPANESE INTERMEDIATE CODE: A711 Effective date: 20050523 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A821 Effective date: 20050523 |
|
| A711 | Notification of change in applicant |
Free format text: JAPANESE INTERMEDIATE CODE: A711 Effective date: 20050523 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20061010 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20061017 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20061218 |
|
| RD03 | Notification of appointment of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7423 Effective date: 20061218 |
|
| 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: 20070116 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20070129 |
|
| R151 | Written notification of patent or utility model registration |
Ref document number: 3911492 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110202 Year of fee payment: 4 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120202 Year of fee payment: 5 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120202 Year of fee payment: 5 |
|
| S531 | Written request for registration of change of domicile |
Free format text: JAPANESE INTERMEDIATE CODE: R313532 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130202 Year of fee payment: 6 |
|
| R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140202 Year of fee payment: 7 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| LAPS | Cancellation because of no payment of annual fees |