(19)【発行国】日本国特許庁(JP)
(12)【公報種別】特許公報(B2)
(11)【特許番号】
(24)【登録日】2023-12-19
(45)【発行日】2023-12-27
(54)【発明の名称】運転支援装置
(51)【国際特許分類】
G08G 1/16 20060101AFI20231220BHJP
B60R 21/00 20060101ALI20231220BHJP
B60T 7/12 20060101ALI20231220BHJP
【FI】
G08G1/16 C
B60R21/00 310
B60T7/12 C
(21)【出願番号】P 2022532268
(86)(22)【出願日】2021-02-05
(86)【国際出願番号】 JP2021004259
(87)【国際公開番号】W WO2021255982
(87)【国際公開日】2021-12-23
【審査請求日】2022-11-21
(31)【優先権主張番号】P 2020105409
(32)【優先日】2020-06-18
(33)【優先権主張国・地域又は機関】JP
(73)【特許権者】
【識別番号】509186579
【氏名又は名称】日立Astemo株式会社
(74)【代理人】
【識別番号】110002572
【氏名又は名称】弁理士法人平木国際特許事務所
(72)【発明者】
【氏名】三苫 寛人
(72)【発明者】
【氏名】永崎 健
【審査官】白石 剛史
(56)【参考文献】
【文献】特開2018-154174(JP,A)
【文献】特開2005-157652(JP,A)
(58)【調査した分野】(Int.Cl.,DB名)
G08G 1/16
B60T 7/12
B60R 21/00
(57)【特許請求の範囲】
【請求項1】
対向車の対地速度、自車と対向車との相対位置、および自車の状態に基づき、前記自車の予測進行路および前記対向車の予測進行路を算出し、
前記自車の右折時または左折時の前記対向車との衝突可能性を判定し、
前記自車と前記対向車とが衝突する衝突予想時刻を計算し、
前記衝突予想時刻から所定時間前までの間の前記自車の移動量に基づいて、前記自車のブレーキを制御する運転支援装置であって、
前記移動量は、少なくとも前記対向車から見た前記自車の横方向移動量を含
み、
前記自車が横移動しているが前記自車の横方向移動量が所定の閾値以下の場合のみ、前記自車のブレーキを作動させ、前記自車が横移動しているが前記自車の横方向移動量が所定の閾値より大きい場合は、前記自車のブレーキを作動させないことを特徴とする、運転支援装置。
【請求項2】
前記対向車から見た前記自車の横方向移動量は、
前記衝突予想時刻から前記所定時間前までの間の前記対向車から見た前記自車の横方向移動量であり、前記衝突予想時刻から前記所定時間前の前記自車の位置から、
前記衝突予想時刻から前記所定時間前の前記対向車の予測進行路への垂線もしくは法線の長さであることを特徴とする、請求項1に記載の運転支援装置。
【請求項3】
前記所定の閾値は、車線幅1つ分以上かつ車線幅2つ分未満であることを特徴とする、請求項
1に記載の運転支援装置。
【請求項4】
前記自車の横方向移動量に応じて、前記自車のブレーキの作動タイミングを変更することを特徴とする、請求項1に記載の運転支援装置。
【発明の詳細な説明】
【技術分野】
【0001】
本発明は、他車両を検出し、当該他車両との衝突を回避/軽減する運転支援装置に関する。
【背景技術】
【0002】
他車両との衝突を回避/軽減する運転支援装置として、例えば特許文献1に開示されたものがある。特許文献1では、他車両との衝突部位、および、衝突角度を考慮して、ブレーキ制御を行うことが記載されている。
【先行技術文献】
【特許文献】
【0003】
【発明の概要】
【発明が解決しようとする課題】
【0004】
上記特許文献1では、衝突部位、および、衝突角度を考慮して、衝突の影響度合からブレーキ制御を行うが、例えば交差点手前において、右折レーンに車線変更して進入する場合、一時的に右折と同様な動きとなり、実際には衝突しない対向車線に存在する対向車との衝突が予想され、間違って不必要なブレーキ制御を行う可能性がある。
【0005】
本発明は、上記の状況を考慮したものであり、より適切なブレーキ制御を行うことのできる運転支援装置を提供することを目的とする。
【課題を解決するための手段】
【0006】
前記課題を解決するために、本発明に係る運転支援装置は、対向車の対地速度、自車と対向車との相対位置、および自車の状態に基づき、前記自車の予測進行路および前記対向車の予測進行路を算出し、前記自車の右折時または左折時の前記対向車との衝突可能性を判定し、前記自車と前記対向車とが衝突する衝突予想時刻を計算し、前記衝突予想時刻から所定時間前までの間の前記自車の移動量に基づいて、前記自車のブレーキを制御し、前記移動量は、少なくとも前記対向車から見た前記自車の横方向移動量を含むことを特徴とする。
【発明の効果】
【0007】
本発明によれば、必要に応じてブレーキをかけることができるため、より適切なブレーキ制御を行うことができる。
【0008】
上記した以外の課題、構成及び効果は以下の実施形態の説明により明らかにされる。
【図面の簡単な説明】
【0009】
【
図1】本発明の一実施形態に係る運転支援装置の全体構成図。
【
図4】距離算出処理部の距離算出処理動作の説明図。
【
図7】衝突判定処理部の衝突判定処理動作の説明図。
【発明を実施するための形態】
【0010】
以下、本発明の実施形態について、図面を参照し、詳細に説明する。
【0011】
図1に、本実施形態に係る運転支援装置の全体構成を説明する図を示す。運転支援装置100は、外界認識センサとしてのステレオカメラ101、ヨーレート・自車速等の自車両の状態を示す車両情報を取得する車両情報ユニット102、車両制御を行うユニットとしてのブレーキコントロールユニット103、ブレーキアクチュエータ104、これらセンサ、ユニット間の情報を伝達するCAN(Controller Area Network)105を備える。
図1に示す運転支援装置100は、車両に搭載され、自車両と他車両との衝突を推定し、衝突すると推定された場合には、ブレーキ制御を行うことによって、衝突を回避/軽減するものである。
【0012】
車両情報ユニット102は、自車にかかるヨー方向の旋回角度変化を検出したヨーレート、車輪の回転数から検出した自車速を、CAN105に送信する。
【0013】
ステレオカメラ101は、
図2に示すように構成されている。カメラ201、202は、車両前方が撮影されるように水平方向に一定距離を置いて、同じ高さで車室内ルームミラー付近に設置される。これらのカメラは、CCDやCMOS等のイメージセンサを備え、それぞれ同期しており、同じタイミングでサンプリングされる。
【0014】
画像取得部203と画像取得部204は、それぞれカメラ201とカメラ202で撮像された画像を以降の処理部で画像処理ができるように輝度値をデジタルに変換、また、カメラ201とカメラ202で撮像された画像を2つのカメラ間での撮像環境や撮像特性の差異をなくすよう補正し、次の処理に画像データを渡す。
【0015】
距離算出処理部205では、画像取得部203で取得された画像を固定のブロックサイズ(例えば、4×4[pix])で分割し、分割されたブロック毎に実空間での距離を算出する。
図3に、ステレオカメラを用いた一般的な距離計測原理を示す。図中の記号Dは、レンズ302、レンズ303の面から計測点301までの距離を表し、fはレンズ302およびレンズ303と撮像面304および撮像面305との距離(焦点距離)を表し、bはレンズ302とレンズ303の中心間の距離(基線長)を表し、dは計測点301がレンズ302を通して撮像面304に撮像される位置と、計測点301がレンズ303を通して撮像面305に撮像される位置との差(視差)を示す。これらの記号の間には、三角形の相似の関係より以下の数式(1)が成り立つ。
(数1) D=b×f/d …(1)
【0016】
数式(1)より、焦点距離fと基線長bは、カメラの構成により決まる定数であるので、距離Dを求めるには、左右のレンズでの見え方のズレである視差dを求めれば良い。この視差dを求める方法を、
図4を用いて説明する。
図4は、カメラ201を左に、カメラ202を右に設置した場合に、カメラ201で撮像した画像を左画像(基準画像)、カメラ202で撮像した画像を右画像(参照画像)として表している。
図4に示されるように、基準画像を固定サイズで区切ったブロックサイズ(例えば、4×4[pix]サイズ)の画像401と、参照画像上で画像401と同じ高さ、同じ大きさの画像402から、一定の画素離れた画像403までを1画素ずつずらし、1画素毎に一致度を算出し、最も一致度の高いブロックを探索することで、右画像の中から同じ対象の画像を見つけることができ、左画像のブロック401の視差dを算出することができる。一致度に関しては、各画素同士の輝度差の絶対値の総和(Sum of the Absolute Differences : SAD)を用いることで算出できる。このとき、横軸を視差[pix]、縦軸を一致度(SAD)とすると、
図5のようなグラフになり、最小値501が最も一致度の高い視差となる。以上より、視差dが求まるので、数式(1)を用いて、ブロック毎の実空間での距離Dを算出することができる。また、基準画像を固定サイズで区切ったブロックサイズの画像401にテクスチャが無い場合、もしくは、左右で同じ画像が見つからない場合(例えば、カメラ正面のフロントガラスが雨滴等の影響で同じ対象の左右の画像が異なってしまった場合)は、
図6に示すように、最小値601は存在するものの、一致度が相対的に低くならず、信頼度が低いため、無効視差として扱う。有効視差とするか無効視差とするかは、一致度の最小値が閾値を下回り、かつ、周辺の一致度平均と最小値の差が閾値を上回るかどうかで決定する。
【0017】
立体物抽出処理部206では、距離算出処理部205で求めた画像全体に渡りブロック毎に距離の求まった距離画像を用いて、立体物を抽出する。まず、距離画像のブロック列毎に、一定距離単位で分割したヒストグラムを作成し、頻度が高くピークとなった距離(代表距離)のヒストグラムの数が閾値(距離に応じて可変)以上であれば、そのブロック列には立体物候補有りとする。次に、隣接するブロック列において、立体物候補有りで、ヒストグラムのピークとなった代表距離同士の差が閾値(距離に応じて可変)以下の場合、同じ立体物としてグルーピングする。最終的に、グルーピングされた立体物の幅が閾値(距離に応じて可変)以上の場合、立体物として登録する。立体物として登録された後、同じ立体物となった列の距離周辺のブロックを距離画像上でグルーピングし、距離画像上での位置(画像上での下端、上端、左端、右端)と、グルーピングされた距離の平均により立体物までの実空間での距離を算出する。以降、この結果求まった立体物を抽出立体物(自車との相対位置、高さ、幅などをパラメータとして持つ)と呼ぶ。
【0018】
立体物追跡処理部207では、立体物抽出処理部206で求まった抽出立体物を時系列で追跡し、自車の挙動による相対位置の変化を差し引いた抽出立体物の位置の変化量より対地速度(前後方向速度、左右方向速度)を算出し、さらには、自車との相対位置、高さ、幅、対地速度等のパラメータのフィルタリングを行い、追跡立体物(フィルタされた自車との相対位置、高さ、幅、対地速度等をパラメータとして持つ)として出力する。より詳細には、以下の処理を各フレームで実行することで実現する。1つ前の処理フレームの追跡立体物がある場合は、自車挙動による変化(ヨーレートと自車速から相対的に移動する位置変化量)と、追跡立体物の持っている対地速度パラメータから、今回の処理フレームで存在するであろう予測位置を算出する。この予測位置と、今回の処理フレームで検出された抽出立体物とを比較し、各パラメータの差分が閾値以下の場合には、同一物体と判断して、前回の処理フレームの追跡立体物のパラメータを、今回の処理フレームの抽出立体物のパラメータを用いて更新する。更新の方法についての詳細は述べないが、例えばカルマンフィルタを用いて観測値として抽出立体物を設定し、誤差分散は実際に計測される値から求めることで実現できる。また、1つ前の処理フレームの追跡立体物のどれともマッチングしない抽出立体物は、初期検知の立体物として、そのまま追跡立体物に新規で登録する。この際、1つのフレームだけだと速度が算出できないため、対地速度をゼロとして設定する。
【0019】
上記追跡立体物の情報を基に、立体物追跡処理部207では、追跡立体物の進行路(予測進行路)を推定することができる。
【0020】
CAN情報取得部208では、車両情報ユニット102からCAN105を介して送信されたヨーレート、自車速を取得する。この取得された情報を基に、自車進行路推定処理部209では、自車の進行路(予測進行路)を推定する。具体的には、取得された自車速V[m/s]とヨーレートr[rad/s]から、以下の式(2)を用いて、自車の旋回半径R[m]を求め、これを自車の推定進行路(予測進行路)として用いる。
(数2) R=V/r …(2)
【0021】
衝突判定処理部210では、
図7に示すように自車701の旋回半径Rから算出される自車701の推定進行路702と、追跡立体物703の対地速度から算出される追跡立体物703の推定進行路704から、自車701と追跡立体物703が衝突するか否かを判定する。具体的には、以下の式(3)、(4)を用いて、自車701の予測される前後方向位置x_s(t)と左右方向位置y_s(t)を0.1秒単位で3秒間分(t=0.1、0.2、0.3、…、2.9、3.0)算出する。
(数3) x_s(t)=Rsin(r×t) …(3)
(数4) y_s(t)=R(1-cos(r×t)) …(4)
【0022】
また、以下の式(5)、(6)を用いて、追跡立体物703の予想される前後方向位置x_o(t)と左右方向位置y_o(t)を0.1秒単位で3秒間分計算する。ただし、現在の自車701の座標系から見た前後方向の対地速度をxv_t(0)、左右方向の対地速度をyv_o(0)とする。
(数5) x_o(t)=x_o(0)+xv_o(0)×t …(5)
(数6) y_o(t)=y_o(0)+yv_o(0)×t …(6)
【0023】
次に、式(3)、(4)、(5)、(6)で得られた値を用いて、各時間tにおける自車701と追跡立体物703との距離d(t)を以下の式(7)により求める。
(数7) d(t)=√((x_s(t)-x_o(t))^2
+(y_s(t)-y_o(t))^2) …(7)
【0024】
得られた距離d(t)の最小値が所定の閾値(例えば、1m)以下となったときのtを衝突予想時刻t_hitとし、衝突予想時刻が存在する場合は、追跡立体物703との衝突可能性ありと判断する。
【0025】
横移動量判定処理部211では、衝突判定処理部210で衝突可能性ありと判断された場合に、求まった衝突予想時刻t_hitを用いて、自車701に対してどのような制御をするかを判断するための横移動量を判定する。具体的には、衝突予想時刻t_hitのときの自車701の位置705と、衝突予想時刻t_hitから所定時間t_past(例えば、2秒)前の自車701の位置706を、式(3)、(4)を用いて、t=t_hit、t_hit-t_pastとしてそれぞれ算出する。このとき、自車701の座標系から見た追跡立体物703の進行方向角度θ_oを以下の式(8)により求める。
(数8) θ_o=π/2-atan(xv_o(0)/yv_o(0)) …(8)
【0026】
この角度を用いた以下の式(9)により、衝突予想時刻t_hitから所定時間t_past前の追跡立体物703から見た自車701の横位置y_so(t_hit-t_past)を算出し、以下の式(10)により、その絶対値d_h[m]を横位置変化量(横方向移動量とも呼ぶ)707として算出する。
(数9) y_so(t)=y_s(t)cos(θ_o)-x_s(t)sin(θ_o) …(9)
(数10) d_h=|y_so(t_hit-t_past)| …(10)
【0027】
すなわち、ここで求まった横位置変化量d_hは、衝突予想時刻t_hitから所定時間t_past前までの間の追跡立体物703から見た自車701の横位置変化量(横方向移動量)であり、衝突予想時刻t_hitから所定時間t_past前の自車701の位置706から、追跡立体物703の推定進行路704(ここでは、直進走行を想定)へ引いた垂線の長さに相当する。
【0028】
制御処理部212では、横移動量判定処理部211で求まった横位置変化量d_hを用いて、自車701に対してどのような制御をするかを判断する。求まった横位置変化量d_hが所定の閾値(例えば、5m)より大きい場合は、ブレーキ制御を行わず(すなわち、車両制御を行うユニットとしてのブレーキコントロールユニット103へブレーキアクチュエータ104を作動させる制御指令を送信せず)、所定の閾値以下の場合は(のみ)、ブレーキ制御を行う(すなわち、車両制御を行うユニットとしてのブレーキコントロールユニット103へ制御指令を送信してブレーキアクチュエータ104を作動させる)。
【0029】
これにより、
図8に示すような片側一車線の交差点において自車801が自車801の推定進行路802の軌道で右折し、追跡立体物である対向車803が対向車803の推定進行路804の軌道で直進するシーンにおいては、横位置変化量807(d_h)が車線幅1つ分程度(3.5m程度)の大きさとなり、横位置変化量d_hが所定の閾値以下となるため、必要なブレーキ制御を行うことができる。
【0030】
逆に、
図9に示すような交差点手前において、右折レーンに車線変更して進入する場合、自車901の推定進行路902に示すように一時的に右折と同様な動きとなり、実際には衝突しない対向車線に存在する推定進行路904の軌道で直進する対向車903との衝突が予想されるが、横位置変化量907(d_h)は車線幅2つ分程度(7m程度)の大きな値となるため、横位置変化量d_hは所定の閾値よりも大きく、間違ったブレーキ制御を防ぐことができる。
【0031】
また、
図10に示す自車1001が自車1001の推定進行路1002の軌道で右折し、対向車1003が対向車1003の推定進行路1004で直進するシーン(対向車線が2車線で、自車1001の車線から離れた側の車線を対向車1003が走行するシーン)においては、横位置変化量1007(d_h)が車線幅2つ分程度(7m程度)の大きさとなり、横位置変化量d_hが所定の閾値よりも大きくなるため、本シーンにおいてもブレーキ制御がされなくなるが、対向車1003から見た横位置変化量1007(d_h)が大きい場合は、対向車1003から自車1001が移動していると視認されやすく、対向車1003もブレーキをかける可能性も高く、システムによるブレーキをかける必要がないと考えられる。また、対向車1003から見た横位置変化量1007(d_h)が小さい場合は、自車1001が移動しているかどうかを視認しにくく、対向車1003がブレーキをかける可能性が低いため、システムによるブレーキをかける必要があると考えられる。上記した本実施形態は、本シーンにおいても適切なブレーキ制御を行うことが可能である。
【0032】
一方、白線を検知して、その後の自車両の動きを予測することも可能であるが、実環境においては、積雪や降雨により白線が見えない場合があるため、白線検知を用いない本実施形態は有効と考えられる。
【0033】
また、衝突予想時刻から所定時間前の時間までの間の対向車から見た自車の横位置変化量を用いることで、例えば、右折レーンで車両が右に傾いている状態で一度停車してから動き出した場合にも、横方向移動量は(自車から見た横方向移動量よりも)小さく算出されるため、対向車から見て視認されにくいシーンにおいてもブレーキを適切に作動させることができる。
【0034】
なお、ブレーキ制御を行うか否かの判断に用いる横位置変化量(横方向移動量)d_hに対する閾値は、任意に設定可能であるが、
図8~
図10等に示すシーンを考慮すると、車線幅1つ分以上であり、車線幅2つ分未満であることが望ましいと考えられる。あるいは、対向車線が2車線以上の場合には、対向車線のうち最も自車に近い(自車の走行車線側の)車線の車線幅1つ分以上であり、対向車線のうち自車に近い(自車の走行車線側の)車線の車線幅2つ分未満であることが望ましいと考えられる。
【0035】
以上で説明したように、本実施形態の運転支援装置100は、対向車の対地速度、自車と対向車との相対位置、および自車の状態に基づき、前記自車の予測進行路および前記対向車の予測進行路を算出し、前記自車の右折時または左折時の前記対向車との衝突可能性を判定し、前記自車と前記対向車とが衝突する衝突予想時刻を計算し、前記衝突予想時刻から所定時間前までの間の前記自車の移動量に基づいて、前記自車のブレーキを制御し、前記移動量は、少なくとも前記対向車から見た前記自車の横方向移動量を含む。
【0036】
また、前記自車の横方向移動量が所定の閾値以下の場合のみ、前記自車のブレーキを作動させ、前記自車の横方向移動量が所定の閾値より大きい場合は、前記自車のブレーキを作動させない。
【0037】
以上で説明した本実施形態により、必要に応じてブレーキをかけることができるため、より適切なタイミングでブレーキ制御を行うことができる。
【0038】
上記実施形態では、対向車の予測進行路を直線と仮定したが、対向車の旋回半径を推定して曲線の予測進行路としても良い。具体的には、
図11に示すように、自車1101が自車1101の予測進行路1102の軌道で右折中に、対向車1103が対向車1103の予測進行路1104の軌道で右にカーブしている場合、衝突予想位置1105(衝突予想時刻t_hitのときの自車1101の位置1105)から所定時間前の自車1101の位置1106における、対向車1103の予測進行路1104に対する法線方向の横位置を算出し、その絶対値を横位置変化量(横方向移動量)1107として用いる。つまり、衝突予想時刻t_hitから所定時間前の自車1101の位置1106から、対向車1103の予測進行路1104(ここでは、カーブ走行を想定)への法線の長さを、対向車1103から見た自車1101の横位置変化量(横方向移動量)1107とする。これにより、カーブ中のシーンにおいても適切な横位置変化量を算出することができ、より適切な判定を行うことができる。
【0039】
また、上記実施形態では、自車の予測進行路を単純に現在のパラメータに基づく旋回半径から算出したが、より正確な対向車から見た横位置変化量を算出するために、過去の実際の進行路を一定時間保持しておき、それを用いて自車の予測進行路を算出しても良い。
【0040】
また、対向車の予測進行路を2台のカメラを有するステレオカメラ(で取得した画像)を用いて算出したが、単眼カメラ、ミリ波レーダー、レーザーレーダー等の外界認識センサ(で取得したセンサ情報)を用いて対向車の予測進行路を算出してもよい。また、外部サーバとの通信または車々間通信を介して、対向車情報(対地速度、位置、予測進行路等)を取得することで対向車の予測進行路を算出してもよい。
【0041】
さらには、上記実施形態では、横位置変化量に応じてブレーキ制御の実施の有無を切り替えたが、横位置変化量に応じてブレーキ制御のタイミングを変えても良い。例えば、横位置変化量が所定の閾値より大きい場合は、横位置変化量が所定の閾値以下の場合と比べて、ブレーキ制御のタイミング(すなわち、ブレーキの作動タイミング)を遅らせても良い。
【0042】
上記実施形態は、例えば交差点での右折時の対向車との衝突を回避/軽減することを想定したが、左折時においても同様に適用可能であることは勿論である。
【0043】
なお、本発明は上記した実施形態に限定されるものではなく、様々な変形形態が含まれる。例えば、上記した実施形態は本発明を分かりやすく説明するために詳細に説明したものであり、必ずしも説明した全ての構成を備えるものに限定されるものではない。
【0044】
また、上記の各構成、機能、処理部、処理手段等は、それらの一部又は全部を、例えば集積回路で設計する等によりハードウェアで実現してもよい。また、上記の各構成、機能等は、プロセッサがそれぞれの機能を実現するプログラムを解釈し、実行することによりソフトウェアで実現してもよい。各機能を実現するプログラム、テーブル、ファイル等の情報は、メモリや、ハードディスク、SSD(Solid State Drive)等の記憶装置、または、ICカード、SDカード、DVD等の記録媒体に置くことができる。
【0045】
また、制御線や情報線は説明上必要と考えられるものを示しており、製品上必ずしも全ての制御線や情報線を示しているとは限らない。実際には殆ど全ての構成が相互に接続されていると考えてもよい。
【符号の説明】
【0046】
100 運転支援装置
101 ステレオカメラ
102車両情報ユニット
103 ブレーキコントロールユニット
104 ブレーキアクチュエータ
105 CAN
201、202 カメラ
203、204 画像取得部
205 距離算出処理部
206 立体物抽出処理部
207 立体物追跡処理部
208 CAN情報取得部
209 自車進行路推定処理部
210 衝突判定処理部
211 横移動量判定処理部
212 制御処理部