技術 走行指令生成装置

0001

本発明は、自動車やロボット向けの走行指令生成装置に係り、特に、衝突を回避する走行指令を高速に演算する走行指令生成装置に関する。

0002

近年、自動車の安全性向上のため、カメラやレーダーといったセンサから自車周囲の障害物をセンシングし、衝突の可能性が高いと判断した場合、警告の表示や、衝突を回避するために緊急ブレーキを行う、といった予防安全技術が進展している。

0003

予防安全技術では、障害物の将来位置を予測し、予測に基づき警告表示や、衝突回避指令を生成しているため、障害物の将来位置の予測精度向上が重要である。

0004

特許文献１では、障害物の確率的な挙動を考慮した将来位置予測に基づき衝突確率を演算し、衝突の可能性が高い場合、運転者へ警告を表示する技術を開示している。

0005

特開２００８−１５８９６９号公報

0006

特許文献１で開示された発明は、運転者が自車レーン上をほぼ定速で運転を続ける場合を仮定し、障害物と自車との衝突確率を演算しているが、自動走行制御といったさらに高度な運転支援を行う場合、複数の自車速度プロファイルにおいて、障害物と自車との衝突確率を演算し、衝突確率が最小となる最適速度プロファイルを探索する繰り返し演算が必要となる。この場合、自動走行用の速度指令演算時間が増大し、一定の制御周期内に制御が間に合わない可能性がある。

0007

本発明は上記点に鑑みて、自動走行制御における、障害物と自車との衝突確率の高速化を実現することを目的とする。

0008

上記目的を達成するために、本発明は、
複数障害物の存在確率分布から、前記複数障害物と自車との衝突を回避する走行指令を生成する走行指令生成装置において、
前記複数障害物の存在確率分布から、固定進路上の移動距離L、および時刻Tを入力とし、前記複数障害物と自車との衝突確率を出力とする衝突確率テーブルを生成し、前記衝突確率テーブルより、前記複数障害物と自車との衝突を回避する走行指令を生成することを特徴とする。

0009

さらに本発明は、固定進路上の移動距離L、および時刻Tを入力とした場合、固定進路上でL移動した時の自車領域をS生成し、時刻Tにおける前記複数障害物の存在確率分布の前記自車領域S内の積分値、または、平均値、または、最大値を計算することにより前記衝突確率テーブルを生成する。

0010

さらに本発明は、一定期間における前記衝突確率テーブルの積算値、または最大値を最小化する走行指令の探索を行う。

0011

さらに本発明は、前記衝突確率テーブルを複数個備えることにより前記走行指令を並列演算する。

0012

本発明によれば、自車の固定進路における障害物との衝突確率演算結果を再利用することから、自車の最適走行指令の探索における衝突確率の繰返し演算を高速化する。

0013

さらに、本発明によれば、衝突確率演算結果の容量が小さくできるため、衝突確率演算結果を高速アクセス可能な小型メモリに配置することにより、さらなる演算高速化が実現できる。

0014

本発明の第一の実施形態による、走行指令生成装置の全体ブロック図
本発明の第一の実施形態による、動的地図生成部（１０）が生成する動的地図の概念図
本発明の第一の実施形態による、障害物予測部（１１）が生成する障害物存在確率分布予測の概念図
本発明の第一の実施形態による、進路生成部（１２）が生成する自車進路の概念図
本発明の第一の実施形態による、衝突確率演算部（１３）のフローチャート
図５に示すフローチャートの衝突確率演算ステップ（５３）の演算方法説明図
本発明の第一の実施形態による、衝突確率演算部（１３）が出力する衝突確率テーブルの概念図
本発明の第一の実施形態による、速度指令生成部（１４）のフローチャート
本発明の第二の実施形態による、衝突確率演算部（１３）のフローチャート
本発明の第三の実施形態による、走行指令生成装置の全体ブロック図

0015

以下、図１〜図８を用いて、本発明の第一の実施形態による走行指令生成装置の構成及び動作について説明する。

0016

図１は、本発明の第一の実施形態による走行指令生成装置の全体ブロック図である。

0017

走行指令生成装置（１）は、センサ（７）からの障害物情報、GPS（８）からの自車情報をネットワーク経由で入力し、入力した情報から走行制御に必要な指令値を演算し、ネットワーク経由で、車両制御ECU（９）に出力する。車両制御ECU（９）は、入力した走行制御用の指令値に基づき、図示していない、各種アクチュエータを駆動し、車両運動を制御する。なお、本図におけるセンサ（７）は、具体的にはカメラやレーダー等であり、表記上１つに集約して記載している。また、走行指令生成装置（１）は、走行制御のため、GPS（７）の他、図示していない自車状態を測定するセンサからデータを入力している。

0018

走行指令生成装置（１）は、IF１（４）、地図DB（５）、演算ユニット（２）、外部記憶部（３）、IF２、から構成される。

0019

IF１（４）は、センサ（７）からの障害物情報、GPS（８）からの自車情報をネットワーク経由で入力するための物理インターフェースであり、入力された情報を演算ユニット（２）へ出力する。地図DB（５）は、走行制御に必要となる静的な地図情報を格納したデータベースであり、演算ユニット（２）からの要求に応じて必要な地図情報を演算ユニット（２）へ出力する。

0020

演算ユニット（２）は、センサ（７）からの障害物情報、GPS（８）からの自車情報、地図DB（５）から静的な地図情報を入力し、これらの情報から、走行制御に必要な指令値を演算し、ネットワーク経由で、車両制御ECU（９）に走行指令値を出力する。

0021

演算ユニット（２）は、具体的にはマイクロプロセッサや、FPGA等の半導体チップで実装される。

0022

演算ユニット（２）は、演算ユニット内に格納出来ないサイズの中間データを外部記憶部（３）に格納する。外部記憶部（３）は、具体的にはSDRAM等の半導体メモリで実装される。

0023

IF２（６）は、演算ユニット（２）が演算した走行指令値をネットワーク経由で出力するための物理インターフェースである。

0024

演算ユニット（２）内には、動的地図生成部（１０）、障害物予測部（１１）、進路生成部（１２）、衝突確率演算部（１３）、速度指令生成部（１４）、の機能、および内部記憶部（１５）から構成される。動的地図生成部（１０）、障害物予測部（１１）、進路生成部（１２）、衝突確率演算部（１３）、速度指令生成部（１４）、の各機能はソフトウエア、またはハードウエアで実装される。

0025

動的地図生成部（１０）は、センサ（７）からの障害物情報、GPS（８）からの自車情報、地図DB（５）から静的な地図情報を入力し、これらを統合することにより、走行制御に必要な動的地図を生成する。図２は、動的地図生成部（１０）が生成する動的地図の概念図であり、交差点の例を示している。センサ（７）からの障害物情報、GPS（８）からの自車情報、地図DB（５）から静的な地図情報を統合することにより、自車（２０）の位置、および速度、歩道（２４）位置、白線（２５）位置、障害物O1〜３（２１）〜（２３）の位置、および速度の動的データベースを生成し、外部記憶部（３）に保持する。

0026

障害物予測部（１１）は、動的地図生成部（１０）が生成した動的地図より障害物情報を抽出し、障害物の存在確率分布の予測を行う。図3は、図２で示した動的地図における障害物O1〜３（２１）〜（２３）を例に存在確率分布の予測結果を示したものである。T=0(s)のフレームでは、センサデータからの情報に基づき、各障害物の初期位置を示している。次にT=1(s)のフレームでは、センサデータからの速度情報、および確率的な挙動を考慮し、存在確率分布が速度方向に移動、空間的に拡散し、障害物O1〜３（２１）〜（２３）に対応した存在確率分布は、それぞれ（３１１）〜（３１３）となっている。最後に、T=２(s)のフレームでは、T=1のフレームより、さらに速度方向に移動、空間的に拡散し、障害物O1〜３（２１）〜（２３）に対応した存在確率分布は、それぞれ（３２１）〜（３２３）となっている。なお、本図では、T=0、１、３(s)の各フレームにおける障害物の存在確率分布を示しているが、実際はさらに細かい時間ステップΔT、例えばΔT=0.1(s)間隔で障害物の存在確率分布が生成されている。ここで生成した障害物の存在確率分布データは必要に応じて外部記憶部（３）に格納される。

0027

進路生成部（１２）は、動的地図生成部（１０）が生成した動的地図より、道路の形状、および目的地への経路情報を抽出し、近い将来、例えば10(s)の間で自車が通過すべき固定進路を生成する。図４は、図２で示した動的地図における、自車が通過すべき固定進路の例である。本図では、自車が右折する例を示しており、交差点の中央付近、および、右折後の右側レーンの中央を通過する進路（４０）が生成されている。

0028

衝突確率演算部（１３）は、障害物予測部（１１）が出力した障害物の存在確率分布、および、進路生成部（１２）が出力した固定経路を用いて、固定進路上の移動距離L、および時刻Tを入力とし、障害物と自車との衝突確率を出力とする衝突確率テーブルを生成する。

0029

図５は、衝突確率演算部（１３）の処理を示すフローチャートである。

0030

まず、処理ステップ（５０）にて、時間ループのための変数iを初期化する。

0031

次に、処理ステップ（５１）にて、固定進路上の自車移動距離ループのための変数jを初期化する。

0032

次に、処理ステップ（５２）にて、固定進路上の自車位置を計算する。図６に固定進路上の自車位置の計算方法を示す。本処理ステップでは、まずL=ΔL・jにて固定進路上の自車の移動距離を演算する。次に、固定進路の二次元的な形状から、固定進路上でLだけ移動した時の自車位置(x_tmp, y_tmp)を演算する。

0033

次に、処理ステップ（５３）にて、T=ΔT・iの時間フレームにおいて、固定進路上でL=ΔL・jだけ移動した場合の障害物と自車との衝突確率を計算する。図６にT=2の時間フレームにおける、衝突確率の計算方法を示す。まず、自車位置(x_tmp, y_tmp)を中心とした自車領域S（６０）を生成する。次に、衝突確率分布を自車領域S内で積分することで、衝突確率を計算する。なお、衝突確率の演算は、自車領域S内での衝突確率の最大値や、自車領域S内での衝突確率の平均値としても良い。

0034

次に、処理ステップ（５４）にて、移動距離ループの終了判定を行う。所定の移動距離最大値(ΔL・N)まで、処理ステップ（５２）、および処理ステップ（５３）が実行されていれば本ループを抜け、そうでない場合、jをインクリメント（５５）し、処理ステップ（５２）に戻る。

0035

次に、処理ステップ（５５）にて、時間ループの終了判定を行う。所定の時間最大値(ΔT・M)まで、処理ステップ（５２）、および処理ステップ（５３）が実行されていれば本ループを抜けすべての処理を終了する。そうでない場合、iをインクリメント（５７）し、処理ステップ（５１）に戻る。

0036

図５に示す処理がすべて終了すると、時刻ΔT・i(i=0,..,M)において、固定進路上でL=ΔL・jだけ移動した場合の障害物と自車との衝突確率テーブルP[i][j]が生成される。図７に、衝突確率テーブルP[i][]()(i=0, 10, 20)の例を示す。P[i][j]は走行指令値の高速演算のため、高速アクセス可能な内部記憶部（１５）に格納される。内部記憶部（１５）は具体的には半導体チップ内のSRAMで実装される。

0037

図８は、速度指令生成部（１４）の処理を示すフローチャートである。

0038

まず、処理ステップ（８０）にて、出力する速度プロファイルの初期化を行う。速度プロファイルは、現在から特定期間内の将来に渡る速度指令値列であり、V[i](i=0,..,M)の行列に格納している。また、時間刻みは衝突確率演算部（１３）で使用しているものと同一でΔTとなる。

0039

次に、処理ステップ（８１）にて、現在から特定期間内の将来に渡る、固定経路上の移動距離の演算を行う。移動距離を格納する行列をL1[i](i=0,..,M)とすると、速度プロファイルを用いて以下の通り計算できる。

0040

L1[i+1]=L1[i]+V[i]・ΔT

0041

次に、処理ステップ（８２）にて、障害物と自車との衝突確率Rを計算する。衝突確率演算部（１３）にて、予め時刻ΔT・i、移動距離ΔL・j(j=0,..,N)における衝突確率が演算され、内部記憶部（１５）にテーブルとして保存されているため、対応するテーブルデータを各時刻毎に読み出し、加算することにより、最終的なRを高速に演算することが出来る。

0042

次に、処理ステップ（８３）にて、衝突確率Rが閾値Rthより小さいか判定を行う。判定の結果衝突確率Rが閾値Rthより小さい場合、その速度プロファイルを用いて走行した時に障害物との衝突が発生しないと判断し、処理を終了する。衝突確率Rが閾値Rthより大きい場合、その速度プロファイルを用いて走行した時に障害物との衝突が発生可能性があるため、速度プロファイルを更新（８４）し、処理ステップ（８１）に戻る。なお、処理ステップ（８４）における速度プロファイル更新は、逐次二次計画法や遺伝的アルゴリズム、人工蜂コロニーアルゴリズム等、最適化問題で用いられる各種アルゴリズムを適用する。以上により、障害物との衝突を回避する速度プロファイルV[i](i=0,..,M)を高速に演算することが出来る。

0043

最後に、速度プロファイルの内、最初の値V[0]を速度指令値として選択し、特定の制御周期以内にネットワーク経由で車両制御ECUへ送信する。

0044

以下、図９を用いて、本発明の第二の実施形態による走行指令生成装置の動作について説明する。なお、本発明の第二の実施形態による走行指令生成装置の構成、および動作は、衝突確率演算部（１３）の動作を除き、第一の実施形態と同一であるため、同一部分の説明は省略する。

0045

図９は、本発明の第二の実施形態による衝突確率演算部（１３）の処理を示すフローチャートである。なお、本発明の第二の実施形態による衝突確率演算部（１３）の処理は、処理ステップ（９０）を除き、第一の実施形態と同一であるため、同一部分の説明は省略する。

0046

処理ステップ（９０）にて、移動距離ループの終了判定を行う。自車の移動距離の最大値は、時刻に依存して限定することが出来るため、移動距離ループ変数jの最大値NをN∝k・iの通り、時刻に比例するように計算する。以上により、衝突確率演算部（１３）の演算ループの回数、および、衝突確率テーブルの容量を削減し、さらなる演算高速化が可能となる。

0047

以下、図９を用いて、本発明の第三の実施形態による走行指令生成装置の構成について説明する。なお、本発明の第三の実施形態による走行指令生成装置の構成は、速度指令生成部(14a)(14b)、内部記憶部(15a)(15b)を除き、第一の実施形態と同一であるため、同一部分の説明は省略する。

0048

本発明の第三の実施形態による衝突確率演算部（１３）は同一の衝突確率テーブルを複数生成し、内部記憶部１(15a)、および内部記憶部２(15b)に格納する。

0049

速度指令値生成は、速度指令生成部１(14a)と内部記憶部１(15a)、速度指令生成部２(14b)と内部記憶部２(15ｂ)の二組を用いて並列処理を行い、さらなる高速化が可能となる。なお、本実施例では並列度を2としているが、所定の性能を得るため、さらに並列度を上げても良い。

0050

１…走行指令生成装置
２…演算ユニット
３…外部記憶部
４…IF1
５…地図DB
６…IF2
７…センサ
８…GPS
９…車両制御ECU