(57)【特許請求の範囲】
【請求項１】
始点と終点をつなぐ道路の３次元形状を示す道路情報を取得する道路情報取得手段と、
前記道路情報に基づいて、前記道路情報を、交差点の始点、終点を含むカーブ・右左折区間の３次元道路情報であるカーブ・右左折区間情報と、センターラインの位置を含む直進区間の３次元道路情報である直進区間情報とに分割する道路分割手段と、
前記直進区間情報のセンターラインの３次元位置情報に基づいて、前記直進区間における３次元の走行すべき位置を示す３次元直進区間軌跡を算出する直進軌跡算出手段と、
前記カーブ・右左折区間情報の交差点の始点、終点情報に基づいて、前記カーブ・右左折区間における３次元の走行すべき位置を示す３次元カーブ・右左折区間軌跡を算出する曲線軌跡算出手段と、
前記３次元カーブ・右左折区間軌跡と、前記３次元直進区間軌跡とを結合することにより、前記道路における３次元走行軌跡を定める軌跡結合手段と、
を備える走行支援装置。
【請求項２】
請求項１に記載の走行支援装置において、
前記曲線軌跡算出手段は、
前記カーブ・右左折区間の少なくとも始端及び終端に基づいて、前記３次元カーブ・右左折区間軌跡の候補である候補ラインを算出する候補ライン算出手段と、前記候補ラインの曲率に基づいて、前記候補ラインの妥当性を判断し、前記候補ラインが妥当であると判断したときに当該候補ラインを前記３次元カーブ・右左折区間軌跡として定める判定手段と、を備える走行支援装置。
【請求項３】
請求項１または２のいずれか一項に記載の走行支援装置において、
前記曲線軌跡算出手段は、前記３次元カーブ・右左折区間軌跡の始端及び終端の曲率が０となるように前記３次元カーブ・右左折区間軌跡を算出し、
前記直進軌跡算出手段は、前記３次元直進区間軌跡の始端及び終端の曲率が０となるように前記３次元カーブ・右左折区間軌跡を算出し、
前記曲線軌跡算出手段は、前記直進軌跡算出手段が前記３次元直進区間軌跡を算出した後に前記３次元カーブ・右左折区間軌跡を前記道路の前記始点に近い順又は遠い順に算出し、かつ前記３次元カーブ・右左折区間軌跡の始端及び終端における接線方向を、当該始端又は終端に接続する前記３次元直進区間軌跡又は前記３次元カーブ・右左折区間軌跡の端部における接線方向に一致させる走行支援装置。
【請求項４】
請求項１〜３のいずれか一項に記載の走行支援装置において、
前記道路分割手段は、前記道路の曲率を算出することにより、前記カーブ・右左折区間を認識する走行支援装置。
【請求項５】
請求項１〜４のいずれか一項に記載の走行支援装置において、
前記直進区間は曲率が基準値未満の区間であり、前記カーブ・右左折区間は曲率が基準値以上の区間である走行支援装置。
【請求項６】
コンピュータが実施する走行支援方法であって、
道路情報取得手段が、始点と終点をつなぐ道路の３次元形状を示す道路情報を取得し、
道路分割手段が、前記道路情報に基づいて、前記道路情報を、交差点の始点、終点を含むカーブ・右左折区間の３次元道路情報であるカーブ・右左折区間情報と、センターラインの位置を含む直進区間の３次元道路情報である直進区間情報とに分割し、
直進軌跡算出手段が前記直進区間情報のセンターラインの３次元位置情報に基づいて、前記直進区間における３次元の走行すべき位置を示す３次元直進区間軌跡を算出し、
曲線軌跡算出手段が、前記カーブ・右左折区間情報の交差点の始点、終点情報に基づいて、前記カーブ・右左折区間における３次元の走行すべき位置を示す３次元カーブ・右左折区間軌跡を算出し、
軌跡結合手段が、前記３次元カーブ・右左折区間軌跡と、前記３次元直進区間軌跡とを結合することにより、前記道路における走行軌跡を定義する走行支援方法。
【請求項７】
コンピュータを、道路で走行すべき走行軌跡を算出する走行支援装置として機能させるためのプログラムであって、
前記コンピュータを、
始点と終点をつなぐ道路の３次元形状を示す道路情報を取得する道路情報取得手段と、
前記道路情報に基づいて、前記道路情報を、交差点の始点、終点を含むカーブ・右左折区間の３次元道路情報であるカーブ・右左折区間情報と、センターラインの位置を含む直進区間の３次元道路情報である直進区間情報とに分割する道路分割手段と、
前記直進区間情報のセンターラインの３次元位置情報に基づいて、前記直進区間における３次元の走行すべき位置を示す３次元直進区間軌跡を算出する直進軌跡算出手段と、
前記カーブ・右左折区間情報の交差点の始点、終点情報に基づいて、前記カーブ・右左折区間における３次元の走行すべき位置を示す３次元カーブ・右左折区間軌跡を算出する曲線軌跡算出手段と、
前記３次元カーブ・右左折区間軌跡と、前記３次元直進区間軌跡とを結合することにより、前記道路における３次元走行軌跡を定める軌跡結合手段として機能させるためのプログラム。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、道路において移動体が進むべき走行軌跡を算出することにより、移動体の走行を支援する走行支援装置、走行支援方法、及びプログラムに関する。
【背景技術】
【０００２】
近年、自動車などの移動体の走行を支援する走行支援システムの開発が進められている。走行支援システムを実現することにより、自動車を自動走行、例えば隊列走行させることが可能になる。この走行支援システムの主な機能の一つに、道路において移動体が進むべき走行軌跡を算出することが挙げられる。例えば特許文献１には、移動体が進むべき走行軌跡を、Ｂ−スプライン曲線を用いて３次元的に算出することが記載されている。
【先行技術文献】
【特許文献】
【０００３】
【特許文献１】特開２００９−２９４４４６号公報
【発明の概要】
【発明が解決しようとする課題】
【０００４】
上記した特許文献の技術を含め、今までの走行軌跡算出方法は、経路の曲率の変化が小さい場合を想定したものがほとんどである。しかし、一般道や高速道路を含む公道など、通常通行する道路において目的地に到達するまでには、交差点などの曲率の変化が大きい場所を通過する必要がある場合がほとんどである。このため、従来の走行軌跡の算出方法では、通常通行する道路において走行軌跡を高い精度で算出することは難しいことが判明した。
【０００５】
本発明の目的は、始点と終点をつなぐ道路が曲率の変化が小さい区間と曲率の変化が大きい区間の双方を含んでいても、高い精度で走行軌跡を算出することができる走行支援装置、走行支援方法、及びプログラムを提供することにある。
【課題を解決するための手段】
【０００６】
本発明によれば、始点と終点をつなぐ道路の３次元形状を示す道路情報を取得する道路情報取得手段と、
前記道路情報に基づいて、前記道路情報を、交差点の始点、終点を含むカーブ・右左折区間の３次元道路情報であるカーブ・右左折区間情報と、センターラインの位置を含む直進区間の３次元道路情報である直進区間情報とに分割する道路分割手段と、
前記直進区間情報のセンターラインの３次元位置情報に基づいて、前記直進区間における３次元の走行すべき位置を示す３次元直進区間軌跡を算出する直進軌跡算出手段と、
前記カーブ・右左折区間情報の交差点の始点、終点情報に基づいて、前記カーブ・右左折区間における３次元の走行すべき位置を示す３次元カーブ・右左折区間軌跡を算出する曲線軌跡算出手段と、
前記３次元カーブ・右左折区間軌跡と、前記３次元直進区間軌跡とを結合することにより、前記道路における３次元走行軌跡を定める軌跡結合手段と、
を備える走行支援装置が提供される。
【０００７】
本発明によれば、コンピュータが実施する走行支援方法であって、
道路情報取得手段が、始点と終点をつなぐ道路の３次元形状を示す道路情報を取得し、
道路分割手段が、前記道路情報に基づいて、前記道路情報を、交差点の始点、終点を含むカーブ・右左折区間の３次元道路情報であるカーブ・右左折区間情報と、センターラインの位置を含む直進区間の３次元道路情報である直進区間情報とに分割し、
直進軌跡算出手段が前記直進区間情報のセンターラインの３次元位置情報に基づいて、前記直進区間における３次元の走行すべき位置を示す３次元直進区間軌跡を算出し、
曲線軌跡算出手段が、前記カーブ・右左折区間情報の交差点の始点、終点情報に基づいて、前記カーブ・右左折区間における３次元の走行すべき位置を示す３次元カーブ・右左折区間軌跡を算出し、
軌跡結合手段が、前記３次元カーブ・右左折区間軌跡と、前記３次元直進区間軌跡とを結合することにより、前記道路における走行軌跡を定義する走行支援方法が提供される。
【０００８】
本発明によれば、コンピュータを、道路で走行すべき走行軌跡を算出する走行支援装置として機能させるためのプログラムであって、
前記コンピュータを、
始点と終点をつなぐ道路の３次元形状を示す道路情報を取得する道路情報取得手段と、
前記道路情報に基づいて、前記道路情報を、交差点の始点、終点を含むカーブ・右左折区間の３次元道路情報であるカーブ・右左折区間情報と、センターラインの位置を含む直進区間の３次元道路情報である直進区間情報とに分割する道路分割手段と、
前記直進区間情報のセンターラインの３次元位置情報に基づいて、前記直進区間における３次元の走行すべき位置を示す３次元直進区間軌跡を算出する直進軌跡算出手段と、
前記カーブ・右左折区間情報の交差点の始点、終点情報に基づいて、前記カーブ・右左折区間における３次元の走行すべき位置を示す３次元カーブ・右左折区間軌跡を算出する曲線軌跡算出手段と、
前記３次元カーブ・右左折区間軌跡と、前記３次元直進区間軌跡とを結合することにより、前記道路における３次元走行軌跡を定める軌跡結合手段として機能させるためのプログラムが提供される。
【発明の効果】
【０００９】
本発明によれば、始点と終点をつなぐ道路が曲率の変化が小さい区間と曲率の変化が大きい区間の双方を含んでいても、高い精度で走行軌跡を算出することができる。
【図面の簡単な説明】
【００１０】
【図１】第１の実施形態に係る走行支援装置の構成を示すブロック図である。
【図２】走行支援装置が行う処理の考え方を説明する図である。
【図３】直進軌跡算出部の機能構成を示すブロック図である。
【図４】カーブ・右左折区間軌跡算出部の機能構成を示すブロック図である。
【図５】直進軌跡算出部及びカーブ・右左折区間軌跡算出部が走行軌跡を算出するときの条件の一部を説明するための概念図である。
【図６】走行支援装置が行う処理を説明するためのフローチャートである。
【図７】図６のステップＳ４０の詳細を説明するためのフローチャートである。
【図８】図６のステップＳ６０の詳細を説明するためのフローチャートである。
【図９】図６のステップＳ８０の詳細を説明するためのフローチャートである。
【図１０】第２の実施形態に係る走行支援システムの構成を示す図である。
【発明を実施するための形態】
【００１１】
以下、本発明の実施の形態について、図面を用いて説明する。尚、すべての図面において、同様な構成要素には同様の符号を付し、適宜説明を省略する。なお、以下の実施形態において「記憶」には、メモリ上に一時的に記憶する場合と、ハードディスクなどに記憶させて保存する場合の双方が含まれる。このため、記憶部は、ハード構成上は、メモリである場合や、ハードディスクやストレージ等である場合などがある。
【００１２】
図１は、第１の実施形態に係る走行支援装置１０の構成を示すブロック図である。本実施形態に係る走行支援装置１０は、道路情報取得部１００、区間分割部１２０、直進軌跡算出部１４０、カーブ・右左折区間軌跡算出部１６０、及び軌跡結合部１８０を備える。道路情報取得部１００は、道路情報を取得する。道路情報は、始点と終点をつなぐ道路の形状を示す情報である。区間分割部１２０は、道路情報に基づいて、道路情報をカーブ・右左折区間であることを示すカーブ・右左折区間情報と、直進区間であることを示す直進区間情報と、に分割する。ここでの分割は、道路の線形形状を示す線形形状情報を用いて行われる。線形形状情報は、例えば曲率の大きさを示す情報（曲率や曲率変化率を示す情報）を含んでいる。以下の説明では、曲率の大きさを示す情報を用いる場合を想定して行う。直進軌跡算出部１４０は、直進区間情報に基づいて、直進区間における走行軌跡である直進区間軌跡を算出する。カーブ・右左折区間軌跡算出部１６０は、カーブ・右左折区間情報に基づいて、カーブ・右左折区間における走行軌跡であるカーブ・右左折区間軌跡を、直進区間軌跡とは異なる方法で算出する。軌跡結合部１８０は、カーブ・右左折区間軌跡と、直進区間軌跡とを結合することにより、始点と終点をつなぐ道路の全域における走行軌跡を定義する。以下、詳細に説明する。
【００１３】
まず走行支援装置１０の詳細を説明する前に、図２を用いて走行支援装置１０が行う処理の考え方を説明する。車両などの移動体が自動走行を行うためには、始点（例えば出発地点）から終点（例えば目的地）までのルートを探索した上で、そのルートにおける走行軌跡を具体的に設定する必要がある。一般的に終点までのルートには、交差点など、曲率の変化が大きい場所を含む場合がほとんどである。走行支援装置１０は、始点から終点までのルートを、曲率が基準値以上であるカーブ・右左折区間と、曲率が基準値未満である直進区間とに分割し、カーブ・右左折区間と直進区間とで、別々のアルゴリズムを用いて走行軌跡を算出する。
【００１４】
道路情報取得部１００が取得する道路情報は、道路の等級を示す情報、交差点であることを示す交差点情報と、交差点の相互間を接続する直進部であることを示す直進部情報とを含んでいる。交差点情報は、交差点の始点、終点、及び縁石の位置を示す３次元位置情報を含んでいる。この３次元位置情報は、例えば測量などにより予め定められている。また直進部情報は、直進部のセンターラインの位置を示す３次元位置情報、及び直進部の幅を示す幅情報を含んでいる。センターラインの３次元位置情報は、例えば以下のようにして定められる。まず、車両に計測装置を搭載する。次いで、この車両で直進部を走行しつつ計測装置でセンターラインの３次元的な位置を計測する。なおこの方法では、センターラインの３次元位置情報のみではなく、上述した交差点情報を含めた各種の道路の3次元位置情報を計測により求めることができる。
【００１５】
次に、図１を用いて走行支援装置１０の詳細について説明する。区間分割部１２０は、道路情報取得部１００が取得した交差点情報及びセンターラインの３次元位置情報に基づいて、道路を直進区間とカーブ・右左折区間とに分割し、直進区間情報及びカーブ・右左折区間情報を生成する。直進区間情報及びカーブ・右左折区間情報には、共に、上述した道路情報のうちその区間に該当する部分の情報と、その区間の始点及び終点の位置を示す３次元位置情報が含まれている。区間分割部１２０が行う具体的な処理については、フローチャートを用いて後述する。
【００１６】
直進軌跡算出部１４０は、区間分割部１２０によって直進区間として認識された区間の直進区間情報を取得する。そして直進軌跡算出部１４０は、例えばＢ−スプライン曲線を用いることにより、直進区間軌跡を算出する。
【００１７】
カーブ・右左折区間軌跡算出部１６０は、区間分割部１２０によってカーブ・右左折区間として認識された区間のカーブ・右左折区間情報を取得する。そしてカーブ・右左折区間軌跡算出部１６０は、直進軌跡算出部１４０とは異なるアルゴリズムを用いて、カーブ・右左折区間軌跡を算出する。カーブ・右左折区間軌跡算出部１６０が行う具体的な処理については、フローチャートを用いて後述する。
【００１８】
軌跡結合部１８０は、カーブ・右左折区間軌跡と、直進区間軌跡とを結合することにより、道路情報取得部１００が取得した道路情報に示される道路における走行軌跡を定義する。具体的には、軌跡結合部１８０は、あるカーブ・右左折区間軌跡又は直進区間軌跡の終端と、その次に位置するカーブ・右左折区間軌跡又は直進区間軌跡の始端とを重ねる処理を順次行うことにより、道路全体の走行軌跡を定義する。
【００１９】
記憶処理部２００は、軌跡結合部１８０が算出した走行軌跡を記憶手段に記憶させる処理を行う。ここで記憶手段は、持ち運びが可能なリムーバブルメディアであってもよいし、ストレージやハードディスクなどの据え置き型の記憶装置であってもよい。また記憶処理部２００は、インターネットなどの通信回線を介して、物理的に離れている場所に設置されている記憶装置に走行軌跡を記憶させてもよい。
【００２０】
図３は、直進軌跡算出部１４０の機能構成を示すブロック図である。直進軌跡算出部１４０は、直進区間情報取得部１４２、区間軌跡算出部１４４、及び直進区間軌跡記憶部１４６を備えている。
【００２１】
直進区間情報取得部１４２は、区間分割部１２０が生成した直進区間情報を取得する。区間軌跡算出部１４４は、直進区間情報を用いて、例えばＢ−スプライン曲線を用いた処理を行うことにより、直進区間それぞれごとに直進区間軌跡を算出する。ここで区間軌跡算出部１４４は、複数の直進区間がある場合、始点に近い側から順、又は終点に近い側から順に、直進区間軌跡を算出する。直進区間軌跡記憶部１４６は、区間軌跡算出部１４４が算出した直進区間軌跡を記憶する。
【００２２】
図４は、カーブ・右左折区間軌跡算出部１６０の機能構成を示すブロック図である。カーブ・右左折区間軌跡算出部１６０は、カーブ・右左折区間情報取得部１６２、通過点定義部１６４、候補ライン算出部１６６、判定部１６８、定数入力部１７０、最終判定部１７２、及びカーブ・右左折区間軌跡記憶部１７４を備えている。
【００２３】
カーブ・右左折区間情報取得部１６２は、区間分割部１２０が生成したカーブ・右左折区間情報を取得する。通過点定義部１６４は、カーブ・右左折区間別に、そのカーブ・右左折区間における経路が通過すべき通過点の３次元位置情報を、少なくとも１つ定める。ただし、ここで通過点を定めなくても、始点及び終点のみで後述する処理を行えることもある。通過点定義部１６４は通過点の３次元位置情報を定める。候補ライン算出部１６６は、通過点、並びにカーブ・右左折区間の始点及び終点に基づいて、カーブ・右左折区間軌跡の候補である候補ラインを算出する。候補ライン算出部１６６は、例えばＢ−スプライン曲線を用いて候補ラインを算出する。
【００２４】
判定部１６８は、候補ラインの曲率及び曲率変化率に基づいて、候補ラインの妥当性を判断し、候補ラインが妥当であると判断したときに当該候補ラインをカーブ・右左折区間軌跡として定める。具体的には、判定部１６８は、下記（１）式により定められるＥ（Ｘ）が最小であると判断したときに、その候補ラインをカーブ・右左折区間軌跡として定める。
【数１】
0005971369.tif 000002
ただし、κは候補ラインの曲率であり、κ′は候補ラインの曲率変化率であり、sは候補ラインの曲線長であり、Ｘはカーブ・右左折区間の始点、終点、及び通過点を含む変数組であり、ａ及びｂは定数である。またａ＋ｂは、例えば１であるように定められているが、これに限定されない。
【００２５】
定数入力部１７０は、式（１）における定数ａ及びｂの入力を受け付ける。判定部１６８は、定数入力部１７０に入力された定数ａ及びｂを用いて、上述した判定を行う。
【００２６】
式（１）のうち第１項は、候補ラインの曲率の線積分値であり、第２項は、候補ラインの曲率変化率の線積分値である。そして定数ａ及びｂは、これら第１項及び第２項のうちいずれを重要視するかによって、それらの値が定められる。定数ａ及びｂは、カーブ・右左折区間の形状等によって適宜定められる。
【００２７】
最終判定部１７２は、判定部１６８によって定められたカーブ・右左折区間軌跡が、予め定められた許容条件を満たしているか否かを判断する。ここで用いられる許容条件は、走行軌跡の曲率の許容範囲、走行軌跡の勾配の許容値、道路の端や縁石からの距離の許容値、軌道の縦断方向の勾配又は横断方向の勾配の許容値である。これら許容条件は予め定められており、最終判定部１７２は、図示しない記憶手段からこれら許容条件を読み込む。
【００２８】
カーブ・右左折区間軌跡記憶部１７４は、最終判定部１７２によって許容条件を満たしていると判断されたカーブ・右左折区間軌跡を記憶する。
【００２９】
なお、図１、図３、及び図４に示した走行支援装置１０の各構成要素は、ハードウエア単位の構成ではなく、機能単位のブロックを示している。走行支援装置１０の各構成要素は、任意のコンピュータのＣＰＵ、メモリ、メモリにロードされた本図の構成要素を実現するプログラム、そのプログラムを格納するハードディスクなどの記憶ユニット、ネットワーク接続用インタフェースを中心にハードウエアとソフトウエアの任意の組合せによって実現される。そして、その実現方法、装置には様々な変形例があることは、当業者には理解されるところである。
【００３０】
図５は、直進軌跡算出部１４０及びカーブ・右左折区間軌跡算出部１６０が走行軌跡を算出するときの条件の一部を説明するための概念図である。上記したように軌跡結合部１８０は、あるカーブ・右左折区間軌跡又は直進区間軌跡の終端と、その次に位置するカーブ・右左折区間軌跡又は直進区間軌跡の始端とを重ねる処理を順次行う。ここで２つの走行軌跡のつながりを滑らかにするためには、走行軌跡の終端及びその次の走行軌跡の始端それぞれにおいて、曲率χを０にして、かつ接線方向を一致させるのが好ましい。そこで直進軌跡算出部１４０及びカーブ・右左折区間軌跡算出部１６０は、いずれも、走行軌跡の始端及び終端それぞれにおいて、曲率χを０にして、かつ接線Ｌを、その部分に接続する他の走行軌跡の端部における接線方向に一致させることを、カーブ・右左折区間軌跡又は直進区間軌跡の設定条件に加えている。
【００３１】
図６は、走行支援装置１０が行う処理を説明するためのフローチャートである。まず道路情報取得部１００は、始点と終点をつなぐ道路に関する道路情報を取得する（ステップＳ２０）。道路情報取得部１００は、例えば以下のようにして道路情報を取得する。道路情報取得部１００は、さまざまな道路の道路情報を記憶しているデータベースから情報を取得することが可能になっている。まず道路情報取得部１００は、走行支援装置１０に入力された情報から、始点と終点を特定する情報を認識する。そして道路情報取得部１００は、認識した始点と終点に基づいて、始点から終点までの経路を認識し、その経路に相当する道路の道路情報をデータベースから取得する。
【００３２】
次いで区間分割部１２０は、道路情報取得部１００が取得した道路情報が示す道路を、直進区間とカーブ・右左折区間に分割し、直進区間情報及びカーブ・右左折区間情報を生成する（ステップＳ４０）。
【００３３】
次いで直進軌跡算出部１４０は、直進区間軌跡の算出処理を行う（ステップＳ６０）。次いでカーブ・右左折区間軌跡算出部１６０は、カーブ・右左折区間軌跡の算出処理を行う（ステップＳ８０）。その後、軌跡結合部１８０は各走行軌跡の結合処理を行い、始点と終点をつなぐ道路の全域における走行軌跡を定義する（ステップＳ１００）。そして記憶処理部２００は、ステップＳ１００で定義された走行軌跡を記憶する処理を行う（ステップＳ１２０）。
【００３４】
図７は、図６のステップＳ４０、すなわち区間分割部１２０が行う処理の詳細を説明するためのフローチャートである。上述したように、道路情報には交差点情報、及びセンターラインの３次元位置情報が含まれている。そこで区間分割部１２０は、まず交差点情報によって定められている区間をカーブ・右左折区間として認識する（ステップＳ４２）。また区間分割部１２０は、センターラインの３次元位置情報に基づいて道路の曲率の変化率を算出し（ステップＳ４４）、この変化率が基準値以上の領域をカーブ・右左折区間として認識する（ステップＳ４６）。そして区間分割部１２０は、カーブ・右左折区間として認識されなかった区間を直進区間として認識する（ステップＳ４８）。
【００３５】
図８は、図６のステップＳ６０、すなわち直進軌跡算出部１４０が行う処理の詳細を説明するためのフローチャートである。まず直進区間情報取得部１４２は、区間分割部１２０から直進区間情報を取得する（ステップＳ６２）。複数の直進区間がある場合、直進区間情報取得部１４２は複数の直進区間それぞれに対応する直進区間情報を取得する。
【００３６】
次いで区間軌跡算出部１４４は、始点に近い順、又は終点に近い順に直進区間を選択し、選択した直進区間における直進区間軌跡を、以下のようにして算出する。なお以下の説明は、始点に近い順に直進区間を選択する場合を示している。
【００３７】
まず区間軌跡算出部１４４は、選択した直進区間の前に位置する区間が直進区間である場合（ステップＳ６４：Ｙｅｓ）、その直進区間の直進区間軌跡を直進区間軌跡記憶部１４６から取得する（ステップＳ６６）。
【００３８】
そして区間軌跡算出部１４４は、選択した直進区間の直進区間情報を用いて、直進区間軌跡を算出する（ステップＳ６８）。直進軌跡算出部１４０は、例えばＢ−スプライン曲線を用いることにより、直進区間軌跡を算出する。例えば直進軌跡算出部１４０は、後述する式（２）を用いて直線区間軌跡を算出する。ただし直進区間軌跡の算出処理には様々な方法を用いることができる。この処理において区間軌跡算出部１４４は、直進区間軌跡の始端及び終端それぞれにおいて曲率が０となるようにする。また区間軌跡算出部１４４は、前の区間が直進区間であり、その直進区間の直進区間情報を取得している場合、図５を用いて説明したように、現在選択している直進区間の直進区間軌跡の始端の接線方向が、ステップＳ６４において取得した直進区間軌跡の終端の接線方向と一致するようにする。
【００３９】
そして区間軌跡算出部１４４は、算出した直進区間軌跡を直進区間軌跡記憶部１４６に記憶させる。そして区間軌跡算出部１４４は、ステップＳ６４〜ステップＳ７０に示した処理を、全ての直進区間に対して行う（ステップＳ７２）。
【００４０】
図９は、図６のステップＳ８０、すなわちカーブ・右左折区間軌跡算出部１６０が行う処理の詳細を説明するためのフローチャートである。本図に示す処理において、式（１）におけるａ，ｂは、予め定数入力部１７０を介して判定部１６８に入力されている。
【００４１】
まずカーブ・右左折区間情報取得部１６２は、区間分割部１２０からカーブ・右左折区間情報を取得する（ステップＳ８２）。複数のカーブ・右左折区間がある場合、カーブ・右左折区間情報取得部１６２は複数のカーブ・右左折区間それぞれに対応するカーブ・右左折区間情報を取得する。
【００４２】
次いでカーブ・右左折区間軌跡算出部１６０は、始点に近い順、又は終点に近い順にカーブ・右左折区間を選択し、選択したカーブ・右左折区間に対して以下の処理を行う。なお以下の説明は、始点に近い順にカーブ・右左折区間を選択する場合を示している。
【００４３】
まず通過点定義部１６４は、選択したカーブ・右左折区間における経路が通過すべき通過点の３次元位置情報を、少なくとも１つ定める（ステップＳ８４）。次いで候補ライン算出部１６６は、選択したカーブ・右左折区間の前に位置する区間が直進区間である場合は、その直進区間の直進区間軌跡を直進区間軌跡記憶部１４６から取得し、選択したカーブ・右左折区間の前に位置する区間がカーブ・右左折区間である場合は、そのカーブ・右左折区間のカーブ・右左折区間軌跡をカーブ・右左折区間軌跡記憶部１７４から取得する。また候補ライン算出部１６６は、選択したカーブ・右左折区間の後に位置する区間が直進区間である場合は、その直進区間の直進区間軌跡を直進区間軌跡記憶部１４６から取得する（ステップＳ８６）。
【００４４】
次いで候補ライン算出部１６６、判定部１６８、及び最終判定部１７２は、始点に近い順にカーブ・右左折区間を選択し、選択したカーブ・右左折区間におけるカーブ・右左折区間軌跡を、以下のようにして算出する。
【００４５】
まず候補ライン算出部１６６は、通過点、並びにカーブ・右左折区間の始点及び終点に基づいて、カーブ・右左折区間軌跡の候補である候補ラインを算出する（ステップＳ８８）。
【００４６】
候補ライン算出部１６６は、Ｂ−スプライン曲線を用いて候補ラインを算出する場合、まずカーブ・右左折区間の始端、終端、及び通過点それぞれの３次元位置情報を認識する。また候補ライン算出部１６６は、ステップＳ８６において取得した走行軌跡のうち、現在処理しているカーブ・右左折区間の前の区間における走行軌跡の終端の接線方向を、候補ラインの始点における接線方向として認識する。さらに候補ライン算出部１６６は、ステップＳ８６において、現在処理しているカーブ・右左折区間の後の区間における走行軌跡を取得している場合、その走行軌跡の始端の接線方向を、候補ラインの終端における接線方向として認識する。
【００４７】
次いで候補ライン算出部１６６は、認識した３次元位置情報および接線方向を用いて、Ｂ−スプライン曲線における制御点（Ｐ１，Ｐ２，・・・，Ｐｎ）を算出する。制御点は、例えば３次元位置情報および接線方向を正規化して、自由変数にマッピングすることにより算出される。次いで候補ライン算出部１６６は、制御点及び既定関数Ｎｉ，ｐを用いて、以下の式（２）に基づいて、候補ラインｒ（ｔ）を生成する。
【００４８】
【数２】
0005971369.tif 000003
ここでαは現在処理しているカーブ・右左折区間の始端であり、βは現在処理しているカーブ・右左折区間の終端である。ｔは、αとβの間で正規化されている変数である。なお上述したＢ−スプライン曲線を用いて候補ラインを算出する処理は、上述した直進区間軌跡の算出にも用いられる。
【００４９】
次いで判定部１６８は、上述した式（１）を用いて、候補ラインにおけるＥ（Ｘ）の値を算出する（ステップＳ９０）。そして判定部１６８は、Ｅ（Ｘ）が最小値であると判断したときに、そのときの候補ラインを、カーブ・右左折区間軌跡として認識する（ステップＳ９２：Ｙｅｓ）。なお判定部１６８は、Ｅ（Ｘ）が最小値ではないと判断したとき（ステップＳ９２：Ｎｏ）、今回算出したＥ（Ｘ）の値を記憶した後、候補ライン算出部１６６に制御点を変更させた上で、ステップＳ８８〜ステップＳ９２の処理を再び行わせる。
【００５０】
そして最終判定部１７２は、判定部１６８によって定められたカーブ・右左折区間軌跡が、予め定められた許容条件を満たしているか否かを判断する（ステップＳ９４）。最終判定部１７２は、カーブ・右左折区間軌跡が許容条件を満たしていると判断したとき（ステップＳ９４：Ｙｅｓ）、カーブ・右左折区間軌跡をカーブ・右左折区間軌跡記憶部１７４に記憶させる（ステップＳ９６）。また最終判定部１７２は、カーブ・右左折区間軌跡が許容条件を満たしていないと判断したとき（ステップＳ９４：Ｎｏ）、式（１）における定数ａ，ｂなどの設定情報を変更した（ステップＳ９５）上で、ステップＳ８８〜ステップＳ９４に示した処理を再度行う。なおこの設定情報の変更は、走行支援装置１０が行ってもよいし、走行支援装置１０の使用者が行ってもよい。
【００５１】
カーブ・右左折区間軌跡算出部１６０は、ステップＳ８４〜ステップＳ９６に示した処理を、全てのカーブ・右左折区間に対して行う（ステップＳ９８）
【００５２】
次に、本実施形態の作用及び効果について説明する。本実施形態によれば、始点と終点を結ぶ道路を、直進区間とカーブ・右左折区間とに分割し、直進区間とカーブ・右左折区間とで別々の方法を用いて走行軌跡を算出している。このため、道路が曲率の変化が小さい区間と曲率の変化が大きい区間の双方を含んでいても、高い精度で走行軌跡を算出することができる
【００５３】
またカーブ・右左折区間軌跡を算出するカーブ・右左折区間軌跡算出部１６０は、カーブ・右左折区間軌跡の候補である候補ラインの曲率及び曲率変化率に基づいて、その候補ラインの妥当性を判断している。そして候補ラインが妥当であると判断したときに、その候補ラインをカーブ・右左折区間軌跡を定めている。従って、滑らかなカーブ・右左折区間軌跡を得ることができる。
【００５４】
またカーブ・右左折区間軌跡算出部１６０は、上述した式（１）を用いて候補ラインの妥当性を判断している。ここで式（１）における定数ａ及びｂを、カーブ・右左折区間の形状等によって適宜定めることにより、さらに滑らかなカーブ・右左折区間軌跡を得ることができる。
【００５５】
また直進軌跡算出部１４０及びカーブ・右左折区間軌跡算出部１６０は、いずれも走行軌跡の始端及び終端の曲率が０となるようにしている。このため、互いに前後している２つの走行軌跡をつなぐときに、つなぎ目を滑らかにすることができる。
【００５６】
特に本実施形態では、ある走行軌跡の終端の接線方向と、その次の起動の始端の接線方向とを互いに一致させている。このため、互いに前後している２つの走行軌跡をつなぐときに、つなぎ目をさらに滑らかにすることができる。
【００５７】
図１０の各図は、第２の実施形態に係る走行支援システムの構成を示す図である。この走行支援システムは、走行支援装置１０及び車両制御装置３０を備えている。走行支援装置１０の構成は第１の実施形態と同様である。車両制御装置３０は、自動車等の車両を自動運転するための装置であり、出発地から目的地までの経路を示す経路情報を、走行支援装置１０から取得する。経路情報には、第１の実施形態で示した走行軌跡を示す情報が含まれている。
【００５８】
図１０（ａ）に示す例では、経路情報は、リムーバブルメディア２０を介して車両制御装置３０に渡される。図１０（ｂ）に示す例では、経路情報は、インターネット等の通信網４０及び無線通信装置５０を介して、車両制御装置３０に渡される。なお走行支援装置１０が経路情報を車両制御装置３０に渡す経路は、これらの例に限定されない。
【００５９】
以上、図面を参照して本発明の実施形態について述べたが、これらは本発明の例示であり、上記以外の様々な構成を採用することもできる。
以下、参考形態の例を付記する。
１．
始点と終点をつなぐ道路の３次元形状を示す道路情報を取得する道路情報取得手段と、
前記道路情報に基づいて、前記道路情報を、交差点の始点、終点を含むカーブ・右左折区間の３次元道路情報であるカーブ・右左折区間情報と、センターラインの位置、道路幅を含む直進区間の３次元道路情報である直進区間情報とに分割する道路分割手段と、
前記直進区間情報のセンターラインの３次元位置情報に基づいて、前記直進区間における３次元の走行軌跡である３次元直進区間軌跡を算出する直進軌跡算出手段と、
前記カーブ・右左折区間情報の交差点の始点、終点情報に基づいて、前記カーブ・右左折区間における３次元の走行軌跡である３次元カーブ・右左折区間軌跡を算出する曲線軌跡算出手段と、
前記３次元カーブ・右左折区間軌跡と、前記３次元直進区間軌跡とを結合することにより、前記道路における３次元走行軌跡を定める軌跡結合手段と、
を備える走行支援装置。
２．
１．に記載の走行支援装置において、
前記曲線軌跡算出手段は、
前記カーブ・右左折区間の少なくとも始端及び終端に基づいて、前記３次元カーブ・右左折区間軌跡の候補である候補ラインを算出する候補ライン算出手段と、前記候補ラインの曲率に基づいて、前記候補ラインの妥当性を判断し、前記候補ラインが妥当であると判断したときに当該候補ラインを前記３次元カーブ・右左折区間軌跡として定める判定手段と、を備える走行支援装置。
３．
１．または２のいずれか一つに記載の走行支援装置において、
前記曲線軌跡算出手段は、前記３次元カーブ・右左折区間軌跡の始端及び終端の曲率が０となるように前記３次元カーブ・右左折区間軌跡を算出し、
前記直進軌跡算出手段は、前記３次元直進区間軌跡の始端及び終端の曲率が０となるように前記３次元カーブ・右左折区間軌跡を算出し、
前記曲線軌跡算出手段は、前記直進軌跡算出手段が前記３次元直進区間軌跡を算出した後に前記３次元カーブ・右左折区間軌跡を前記道路の前記始点に近い順又は遠い順に算出し、かつ前記３次元カーブ・右左折区間軌跡の始端及び終端における接線方向を、当該始端又は終端に接続する前記３次元直進区間軌跡又は前記３次元カーブ・右左折区間軌跡の端部における接線方向に一致させる走行支援装置。
４．
１．〜３．のいずれか一つに記載の走行支援装置において、
前記道路分割手段は、前記道路の曲率を算出することにより、前記カーブ・右左折区間を認識する走行支援装置。
５．
１．〜４．のいずれか一つに記載の走行支援装置において、
前記直進区間は曲率が基準値未満の区間であり、前記カーブ・右左折区間は曲率が基準値以上の区間である走行支援装置。
６．
コンピュータが実施する走行支援方法であって、
道路情報取得手段が、始点と終点をつなぐ道路の３次元形状を示す道路情報を取得し、
道路分割手段が、前記道路情報に基づいて、前記道路情報を、交差点の始点、終点を含むカーブ・右左折区間の３次元道路情報であるカーブ・右左折区間情報と、センターラインの位置、道路幅を含む直進区間の３次元道路情報である直進区間情報とに分割し、
直進軌跡算出手段が前記直進区間情報のセンターラインの３次元位置情報に基づいて、前記直進区間における３次元の走行軌跡である３次元直進区間軌跡を算出し、
曲線軌跡算出手段が、前記カーブ・右左折区間情報の交差点の始点、終点情報に基づいて、前記カーブ・右左折区間における３次元の走行軌跡である３次元カーブ・右左折区間軌跡を算出し、
軌跡結合手段が、前記３次元カーブ・右左折区間軌跡と、前記３次元直進区間軌跡とを結合することにより、前記道路における走行軌跡を定義する走行支援方法。
７．
コンピュータを、道路で走行すべき走行軌跡を算出する走行支援装置として機能させるためのプログラムであって、
前記コンピュータを、
始点と終点をつなぐ道路の３次元形状を示す道路情報を取得する道路情報取得手段と、
前記道路情報に基づいて、前記道路情報を、交差点の始点、終点を含むカーブ・右左折区間の３次元道路情報であるカーブ・右左折区間情報と、センターラインの位置、道路幅を含む直進区間の３次元道路情報である直進区間情報とに分割する道路分割手段と、
前記直進区間情報のセンターラインの３次元位置情報に基づいて、前記直進区間における３次元の走行軌跡である３次元直進区間軌跡を算出する直進軌跡算出手段と、
前記カーブ・右左折区間情報の交差点の始点、終点情報に基づいて、前記カーブ・右左折区間における３次元の走行軌跡である３次元カーブ・右左折区間軌跡を算出する曲線軌跡算出手段と、
前記３次元カーブ・右左折区間軌跡と、前記３次元直進区間軌跡とを結合することにより、前記道路における３次元走行軌跡を定める軌跡結合手段として機能させるためのプログラム。
【符号の説明】
【００６０】
１０ 走行支援装置
２０ リムーバブルメディア
３０ 車両制御装置
４０ 通信網
５０ 無線通信装置
１００ 道路情報取得部
１２０ 区間分割部
１４０ 直進軌跡算出部
１４２ 直進区間情報取得部
１４４ 区間軌跡算出部
１４６ 直進区間軌跡記憶部
１６０ カーブ・右左折区間軌跡算出部
１６２ カーブ・右左折区間情報取得部
１６４ 通過点定義部
１６６ 候補ライン算出部
１６８ 判定部
１７０ 定数入力部
１７２ 最終判定部
１７４ カーブ・右左折区間軌跡記憶部
１８０ 軌跡結合部
２００ 記憶処理部
【図１】
0005971369.tif 000004
【図２】
0005971369.tif 000005
【図３】
0005971369.tif 000006
【図４】
0005971369.tif 000007
【図５】
0005971369.tif 000008
【図６】
0005971369.tif 000009
【図７】
0005971369.tif 000010
【図８】
0005971369.tif 000011
【図９】
0005971369.tif 000012
【図１０】
0005971369.tif 000013