JP2021043988A - 道路特徴決定装置 - Google Patents

Abstract

【課題】歩道との境である道路端部、道路中心及び車線中心などを特定する道路特徴決定装置を提供する。【解決手段】道路特徴決定装置において、構造物下部端点抽出手段６は、横断面において、端部の構造物の頂点から水平方向に最小歩道幅より短い所定距離移動した位置における表面点を見いだし、見いだした表面点と、前記頂点との間を結ぶ直線を設定する。さらに、当該直線に対する垂線が最も長い表面点を構造物下部端点として抽出する。道路端部点抽出手段８は、構造物下部端点から所定距離の範囲の表面点の平均点を決定し、当該平均点と前記走行点との間を結ぶ直線を設定し、さらに、当該直線に対する垂線が最も長い表面点を道路端部点として抽出する。このようにして、各横断面において、道路端部点を抽出する。【選択図】図１

Description

この発明は、道路などを走行しながら計測した表面形状の三次元測定データ等に基づいて、道路の特徴を決定する装置に関するものである。

道路の形状を計測によって特定し、道路端部、道路中心、車線中心などの道路形状データを得ることができれば、自動車の自動運転、運転補助制御などに利用することができる。

たとえば、特許文献１においては、道路の傾斜を正確に測定することのできる方法が開示されている。この方法によれば、道路の場所による傾斜などを測定し、傾斜の変化を連続的に得ることができる。

また、特許文献２においては、自動車の速度や操舵角をセンサによって取得し、これらデータに基づいて、道路の曲率を推定するシステムが開示されている。これにより、道路の曲率を推定して、衝突の回避などに用いることができる。

さらに、特許文献３においては、道路上の移動を三次元軌跡データとして取得し、道路のカーブ部分において直線と円弧とを緩和曲線（クロソイド曲線）によって接続する装置が開示されている。

特開平１１−１００８０９ 特開２０１２−１３１４９６ 特開２０１４−１６００６４

しかしながら、特許文献１や特許文献２の技術においては、道路の傾斜や道路の曲率を特定することができるものの、歩道との境である道路端部を特定したり、道路中心、車線中心などを特定することはできなかった。

また、特許文献３では、道路の直線部と曲線部をクロソイド曲線で結ぶことで、より正確に道路特徴を得ることができる。しかし、特許文献３においては、まず、直線部、円弧部を決めてから、クロソイド曲線を決定している。しかし、直線部の始点・終点、円弧部の始点・終点などは明確に決定することが難しく、そのために誤差の大きいクロソイド曲線を決定する可能性があった。

さらに、上記各特許文献のいずれにおいても、道路の分岐部分における道路中心線や車線中心線をどのように扱うと好ましいかを検討しておらず、問題としてすら認識されていなかった。

この発明は上記の問題のうち少なくとも一つを解決して、精度の良い道路特徴決定装置を提供することを目的とする。

この発明のいくつかの独立して適用可能な特徴を以下に示す。

(1)(3)この発明に係る道路特徴決定装置は、道路上を走行しながら計測された表面点による三次元計測データに基づいて、道路特徴を決定する道路特徴決定装置であって、前記走行方向に垂直な横断面を所定間隔で設定する横断面設定手段と、前記走行の軌跡を結ぶ走行線と、前記横断面との交点を走行点として決定する走行点決定手段と、前記横断面において、端部の構造物の頂点から水平方向に最小歩道幅より短い所定距離移動した位置における表面点と、前記頂点との間を結ぶ直線を設定し、当該直線に対する垂線が最も長い表面点を構造物下部端点として抽出する構造物下部端点抽出手段と、前記構造物下部端点から前記所定距離の範囲の表面点の平均点を決定し、当該平均点と前記走行点との間を結ぶ直線を設定し、当該直線に対する垂線が最も長い表面点を道路端部点として抽出する道路端部点抽出手段と、各横断面における道路端部点を結んで道路端部を決定する道路端部決定手段とを備えている。

したがって、歩道と車道を区別して、道路端部を正確に特定することができる。

(2)(4)この発明に係る道路特徴決定装置は、前記横断面における左右の道路端部点の中間点を道路中心点として抽出する道路中心点抽出手段と、各横断面における道路中心点を結んで道路中心線を決定する道路中心決定手段とを備えている。

したがって、道路中心線を正確に決定することができる。

(5)(7)(15)(17)この発明に係る道路特徴決定装置は、表面点のうち所定の輝度以上の点が所定距離以上連続している点を区分線として抽出する区分線抽出手段と、前記区分線の欠損部分を補完して、区分線を決定する区分線決定手段とを備えている。

したがって、車線を区分する区分線を正確に得ることができる。

(6)(8)(16)(18)この発明に係る道路特徴決定装置は、区分線と道路端部との中心または隣接する前記区分線の中心に車線中心線を決定する車線中心線決定手段を備えている。

したがって、車線中心線を正確に得ることができる。

(9)(19)この発明に係る道路特徴決定装置は、区分線決定手段は、区分線を抽出できない区間においては、左右の道路端部間の距離と、最小車線幅とに基づいて、区分線を生成することを特徴としている。

したがって、白線や黄色線のない道路においても、車線を推定することができる。

(10)(11)(20)(21)この発明に係る道路特徴決定装置は、三次元計測データに基づいて抽出されたカーブ近傍における道路中心線または車線中心線に基づいて、直線および円弧を抽出する直線・円弧抽出手段と、前記円弧の中心から、前記直線に対して垂線を設定し、前記円弧の中心をクロソイド終点における曲率半径の中心として、前記垂線に対する接線角を変化させてクロソイド曲線を生成し、クロソイド終点が前記円弧と合致するクロソイド曲線を決定するクロソイド曲線決定手段と、決定したクロソイド曲線に基づいて、前記直線の端点と円弧の端点を決定し、直線、クロソイド曲線、円弧を接続する接続手段とを備えている。

したがって、適切なクロソイド曲線によって、中心線の直線と円弧を接続することができる。

(12)(22)この発明に係る道路特徴決定装置は、クロソイド曲線決定手段は、クロソイド終点の前記直線に対する垂直な位置が、前記円弧の終点の前記直線に対する垂直な位置と合致するかどうかによってクロソイド曲線を決定することを特徴としている。

したがって、適切なクロソイド曲線を決定することができる。

(13)(14)(23)(24)この発明に係る道路特徴決定装置は、三次元計測データに基づいて抽出された道路端部線を、前記走行の軌跡を結ぶ走行線の右側にある右側道路端部線と、左側にある左側道路端部線に分類する分類手段と、右側道路端部線と左側道路端部線が接する位置を分岐開始位置とし、分岐開始位置から直線を延長し、当該直線が道路端部線に接する位置を分岐終了位置とする分岐範囲判断手段と、分岐開始位置から分岐終了位置まで双方の道路中心線または車線中央線を延長して生成し、分岐終了位置においては、双方の道路中心線を結ぶように道路中央線または車線中央線を生成する中央線生成手段とを備えている。

したがって、分岐部分においても中心線を接続することができる。

「横断面設定手段」は、実施形態においては、ステップＳ１がこれに対応する。

「走行点決定手段」は、実施形態においては、ステップＳ１５、Ｓ１７がこれに対応する。

「構造物下部端点抽出手段」は、実施形態においては、ステップＳ３４〜Ｓ３７がこれに対応する。

「道路端部点抽出手段」は、実施形態においては、ステップＳ４３〜Ｓ４７がこれに対応する。

「道路端部決定手段」は、実施形態においては、ステップＳ７がこれに対応する。

「プログラム」とは、ＣＰＵにより直接実行可能なプログラムだけでなく、ソース形式のプログラム、圧縮処理がされたプログラム、暗号化されたプログラム等を含む概念である。

この発明の第１の実施形態による道路特徴決定装置の機能ブロック図である。 道路特徴決定装置のハードウエア構成である。 道路端部・中心決定処理のフローチャートである。 横断面設定処理のフローチャートである。 三次元計測データの例である。 横断面に投影された点群データの例である。 道路端点抽出処理のフローチャートである。 道路端点抽出処理のフローチャートである。 道路端点抽出処理を説明するための図である。 第２の実施形態による道路特徴決定装置の機能ブロック図である。 区分線・車線中心線決定処理のフローチャートである。 区分線抽出処理を説明するための図である。 他の例による区分線決定処理を説明するための図である。 第３の実施形態による道路特徴決定装置の機能ブロック図である。 中心線接続処理のフローチャートである。 中心線接続処理のフローチャートである。 中心線接続処理のフローチャートである。 平面における直線の接続を説明するための図である。。 縦断面における直線の接続を説明するための図である。。 直線と円弧の接続を説明するための図である。 直線と円弧の接続を説明するための図である。 円弧と円弧の接続を説明するための図である。 第４の実施形態による道路特徴決定装置の機能ブロック図である。 分岐処理のフローチャートである。 分岐部特定・中央線補完処理のフローチャートである。 分岐部特定・中央線補完処理のフローチャートである。 分岐部における中央線の接続を説明するための図である。 分岐部における中央線の接続を説明するための図である。 分岐部における中央線の接続を説明するための図である。 交差点における中央線の接続を説明するための図である。

１．第１の実施形態
1.1全体構成
図１に、この発明の一実施形態による道路特徴決定装置の機能ブロック図を示す。

この実施形態における道路特徴決定装置は、道路上を走行しながら計測された表面点による三次元計測データを受けて、道路端部および道路中心の決定を行う。

横断面設定手段２は、三次元計測データにおいて、走行方向に垂直な横断面を所定間隔で設定する。走行点決定手段４は、走行の軌跡を結ぶ走行線と、横断面との交点を走行点として決定する。

構造物下部端点抽出手段６は、横断面において、端部の構造物の頂点から水平方向に最小歩道幅より短い所定距離移動した位置における表面点を見いだす。見いだした表面点と、前記頂点との間を結ぶ直線を設定する。さらに、当該直線に対する垂線が最も長い表面点を構造物下部端点として抽出する。

道路端部点抽出手段８は、構造物下部端点から所定距離の範囲の表面点の平均点を決定し、当該平均点と前記走行点との間を結ぶ直線を設定する。さらに、当該直線に対する垂線が最も長い表面点を道路端部点として抽出する。このようにして、各横断面において、道路端部点が抽出される。

道路端部決定手段１０は、各横断面における道路端部点を接続して道路端部線を生成し、道路端部を決定する。これにより、道路端部の形状を連続的に得ることができる。

さらに、道路中心点抽出手段１２は、各横断面における左右の道路端部点の中間点を道路中心点として抽出する。道路中心決定手段１４は、各横断面における道路中心点を結んで道路中心線を決定する。

1.2ハードウエア構成
図２に、道路特徴決定装置のハードウエア構成を示す。ＣＰＵ３０には、メモリ３２、ディズプレイ３４、ハードディスク３６、ＣＤ−ＲＯＭドライブ３８、キーボード／マウス４０が接続されている。

ハードディスク３６には、オペレーティングシステム４２、道路特徴決定プログラム４４が記録されている。道路特徴決定プログラム４４は、オペレーティングシステム４２と協働してその機能を発揮するものである。

これらプログラムは、ＤＶＤ−ＲＯＭ４６に記録されていたものを、ＣＤ−ＲＯＭドライブ３８を介して、ハードディスク３６にインストールしたものである。なお、インターネットを介して、サーバ装置（図示せず）からダウンロードしてインストールしたものであってもよい。

1.3道路端部・中心決定処理
1.3.1全体フローチャート
図３に、道路特徴決定プログラム４４の道路端部・中心決定処理における全体フローチャートを示す。

ＣＰＵ３０は、三次元計測データをＤＶＤ−ＲＯＭなどから読み込んで、ハードディスク３６に記録する。三次元計測データは、自動車や無人航空機（ＵＡＶ）などにレーダ測距装置を積載し、走行しながら計測して得られたものであり、道路近傍の表面形状を示すデータである。また、この三次元計測データには、自動車の位置を時間的変化にて示す走行点のデータが含まれる。三次元点群データとして、たとえば、ＭＭＳ点群データを用いることができる。

ＣＰＵ３０は、ハードディスク３６から三次元計測データを読み出し、所定間隔にて横断面を設定する（ステップＳ１）。続いて、ＣＰＵ３０は、設定した各横断面において、道路の左側端部点を抽出する（ステップＳ３）。さらに、設定した各横断面において、道路の右側端部点を抽出する（ステップＳ４）。次に、ＣＰＵ３０は、各横断面において、左側端部点と右側端部点の中心を中心点として抽出する（ステップＳ５）。

ＣＰＵ３０は、すべての横断面について、左端部点、右端部点、中心点を抽出すると、これらを接続して、左端部線、右端部線、中心線を決定する（ステップＳ６）。

以下、各処理ごとに詳細を説明する。

1.3.2横断面の設定
図４に、横断面設定処理（ステップＳ１）の詳細フローチャートを示す。図５に、三次元計測データを模式的に示した例を示す。多数の計測点によって、道路の表面形状が表されている。この実施形態では、各点の測定データとして、Ｘ、Ｙ、Ｚの三次元座標、反射強度、計測時刻が含まれる。さらに、車両の走行位置（走行点）のＸ、Ｙ、Ｚの三次元座標、計測時刻も含まれる。なお、高さ方向のＺ座標は、海抜として得られる。

ＣＰＵ３０は、走行点を計測時刻順に線で結び、走行線を生成する（ステップＳ１１〜Ｓ１４）。次に、ＣＰＵ３０は、各測定点から走行線に対して垂線を引き、交点を生成する（ステップＳ１７）。ＣＰＵ３０は、走行線の起点から前記交点までの距離に基づいて、所定距離ごと（たとえば１０ｃｍごと）に各測定点を１つのグループとする（ステップＳ１９）。グループ化した測定点により、横断面（走行線に垂直な平面）の測定点が得られることになる。また、走行線が横断面と接する点を走行点として得る。

図６に、横断面における測定点の例を示す。この例では、道路部分と歩道部分があり、端部に構造物がある場合が示されている。ただし、測定データにおいては、直接的には、図６に示す形状がわかるのみである。したがって、ＣＰＵ３０は、いずれの部分が道路部分であり、いずれの部分が歩道部分であるかを、後述の道路端点の抽出処理によって得る。

なお、この実施形態では、１０ｃｍごとに測定点をグループ化している。しかし、走行線に沿って、所定の間隔で横断面を設定し、当該横断面に対する垂直距離が５ｃｍ以内の測定点を垂直移動して横断面に移すようにしてもよい。

1.3.3道路端点の抽出
図７、図８に、道路端点抽出処理（ステップＳ３、Ｓ４）の詳細フローチャートを示す。ＣＰＵ３０は、各横断面において左側端部の頂点Ａを抽出する（図９Ａ参照）。さらに、この頂点から内側に所定距離（たとえば０．５ｍ）だけＸ方向に移動した位置にある点Ｂを抽出する。ＣＰＵ３０は、この頂点Ａと点Ｂを結ぶ直線を設定する（ステップＳ３１）。

ＣＰＵ３０は、この頂点Ａと点Ｂの範囲内にある各計測点につき、当該直線に対する垂線を生成し、その距離を算出する（ステップＳ３４）。そして、最も垂直距離の大きい計測点を見いだし、構造物下部の特徴点Ｃとする（ステップＳ３５、Ｓ３６、Ｓ３７）。

上記のようにして、左側の特徴点Ｃが見いだされる。ＣＰＵ３０は、同様にして、右側の特徴点Ｃも見いだす。

次に、ＣＰＵ３０は、図９Ｂ、図９Ｃに示すように、特徴点ＣからＸ方向に所定距離（たとえば０．５ｍ）以内、Ｚ方向に所定距離（たとえば０．１ｍ）以内の計測点を抽出し、そのＸ、Ｙ、Ｚ座標の平均値を算出し、仮点Ｄを求める（ステップＳ３９）。

ＣＰＵ３０は、仮点Ｄと走行点とを直線で結ぶ（ステップＳ４０）。次に、ＣＰＵ３０は、仮点Ｄと走行点Ｅの間にある各計測点につき（ステップＳ４３）、当該直線との垂直距離を算出する（ステップＳ４４）。最も垂直距離の大きい計測点を見いだし、道路端点Ｆとする（ステップＳ４５、Ｓ４６、Ｓ４７）。図９では、左側の道路端点Ｆの決定について説明しているが、右側の道路端点Ｆについても同様にして決定する。

1.3.4道路中心点の決定
続いて、ＣＰＵ３０は、図９Ｄに示すように、各横断面において、左側道路端点と右側道路端点の座標を平均し、道路中心点Ｇ（両点のＸ座標の平均値を持つ）を算出する（図３のステップＳ５）。

以上の各処理により、各横断面において、左側道路端点、右側道路端点、道路中心点を得ることができる。

1.3.5道路端部線・道路中心線の決定
ＣＰＵ３０は、各横断面における左側道路端点、右側道路端点を線で結び、左側道路端部線、右側道路端部線を得る。さらに、道路中心点を線で結び、道路中心線を得る（ステップＳ７）。

1.4その他
(1)上記実施形態では、左右の道路端部線に加えて、道路中心線を得るようにしている。しかし、道路端部線、道路中心線のいずれか一方のみを得るようにしてもよい。

(2)上記実施形態では、道路の両端に歩道がある場合について説明した。歩道がない道路の場合には、特徴点Ｃをそのまま道路端部点として抽出すればよい。また、仮点ＤのＺ座標がが走行点ＥのＺ座標より小さい場合や、仮点Ｄと走行点ＥとのＺ座標の差が、所定値（たとえば１ｃｍ）を下回っている場合には、歩道がないと判断すればよい。

(3)上記実施形態では、道路端部線、道路中心線を決定するようにしている。これに加えて、あるいはこれに代えて、道路の横断勾配を決定するようにしてもよい。横断面において、左右の道路端部線を結ぶ直線の勾配を算出することにより決定することができる。

(4)上記実施形態では、道路特徴決定装置をスタンドアローンのＰＣとして構成している。しかし、サーバ装置として構成してもよい。この場合、三次元計測データは、インターネットなどを介して接続された端末装置から、道路特徴決定装置であるサーバ装置に送信するようにすればよい。また、決定された道路端部線、道路中心線は、サーバ装置から端末装置に対して送信する。

(5)図９Ａ、図９Ｂにおいて、０．５ｍ内側に直線を引くための点を設けている。しかし、歩道の幅よりも小さい長さであれば、これより大きくても小さくてもよい。

(6)上記変形例は、互いに組み合わせて実施することが可能である。また、その本質に反しない限り、本実施形態および変形例を、他の実施形態においても適用することができる。

２．第２の実施形態
2.1全体構成
図１０に、この発明の第２の実施形態による道路特徴決定装置の機能ブロック図を示す。

この実施形態における道路特徴決定装置は、道路上を走行しながら計測された表面点による三次元計測データを受けて、車線区分線および車線中心線の決定を行う。

区分線抽出手段２０は、三次元計測データに基づいて、反射強度（輝度）が所定値以上で、所定長さ継続する箇所を車線区分線として抽出する。区分線決定手段２２は、断続する車線区分線に基づいて車線区分線の欠損部分を補完し、区分線を決定する。

道路端部線決定手段２６は、三次元計測データに基づいて、道路の端部線を決定する。道路端部線決定手段２６としては、第１の実施形態による手法を用いることができる。区分線決定手段２２は、前記輝度差による車線区分線が抽出されない場合、道路端部線に基づいて得られた道路幅に基づき、車線区分線を決定する。

車線中心線決定手段２４は、車線区分線と道路端部線に基づいて、車線中心線を決定する。

このようにして決定された車線中心線は、自動車の自動運転制御などに用いることができる。

2.2ハードウエア構成
この実施形態による道路特徴決定装置のハードウエア構成は、図２と同様である。

2.3区分線決定・車線中心決定処理
道路特徴決定プログラム４４の車線区分線・車線中心線決定処理におけるフローチャートを示す。

ＣＰＵ３０は、三次元計測データの各点について、所定の輝度より大きい部分を抽出する。道路に車線を区分するための白線や黄色線がひかれていると、この部分での反射が大きくなり輝度が周りよりも高くなる。したがって、所定長さ以上にわたって輝度の高い部分を抽出することにより車線区分線を抽出することができる。

たとえば、図１２Ｂに示すように、白線や黄色線を抽出することができる。図１２Ｂにおいて、断続的な車線区分領域Ｒが抽出されている。横断面にて示すと、図１２Ａのようになる。なお、領域ＲＥのように輝度の高い部分が所定以上の長さ継続しない場合には、抽出しない。

図１２Ｂに示すように、白線もしくは黄色線の車線区分領域Ｒが検出されると（ステップＳ８１）、ＣＰＵ３０は、領域Ｒの道路幅方向に関する中心を車線区分点とする。ＣＰＵ３０は、各横断面における車線区分点をつないで、車線区分線ＤＬを決定する（ステップＳ８２）。

なお、白線や黄色線が断続する場合、白線や黄色線がない部分においては、近傍における道路端部から白線・黄色線までの距離ｄの位置に白線や黄色線があるものとして車線区分線ＤＬを決定する（図１２Ｃ参照）。

白線や黄色線が引かれておらず、これらを抽出できない場合もある。この場合、ＣＰＵ３０は、道路幅Ｄに基づき、次のようにして車線区分線ＤＬを決定する（ステップＳ８３）。まず、三次元計測データに基づいて、図３の処理に基づいて、各横断面における左右の道路端部点を決定する。さらに、この左右の道路端部点に基づき、道路幅Ｄを算出する（図１３Ａ参照）。なお、道路端部点、道路幅Ｄが与えられている場合には、これを用いればよい。

ＣＰＵ３０は、道路幅Ｄと予め定められた最小車線幅ｄとに基づいて、Ｄ／ｄを算出し、少数以下を切り捨てて、車線数Ｃを算出する。たとえば、道路幅Ｄが８．５ｍであり、設定された最小車線幅ｄが２．７５ｍであれば、Ｄ／ｄは３．０９となる（図１３Ｂ参照）。これを切り捨てて、車線数Ｃとして３が求まることになる。なお、最小車線幅ｄは、道路の種類（一般道路か高速道路か）によって変えるようにしてもよい。

次に、ＣＰＵ３０は、道路幅Ｄを車線数で除して車線幅を算出し、これによって、車線区分点を決定する（図１３Ｃ参照）。各横断面の車線区分点をつないで、車線区分線を決定する。

以上のようにして、白線や黄色線がある場合にはこれに基づいて車線区分線を決定し、ない場合には道路幅Ｄに基づいて車線区分線を決定する。車線区分線を決定すると、ＣＰＵ３０は、図１３Ｄに示すように、各車線の中心に車線中心線を決定する（ステップＳ８４）。

2.4その他
（1）上記実施形態では、白線・黄色線のない部分について、近傍の白線・黄色線がある部分における道路端部からの距離ｄに基づいて、車線区分線を補完するようにしている。しかし、白線・黄色線のある部分における車線区分線を接続して補完を行うようにしてもよい。

(2)上記変形例は、互いに組み合わせて実施することが可能である。また、その本質に反しない限り、本実施形態および変形例を、他の実施形態においても適用することができる。

３．第３の実施形態
3.1全体構成
図１４に、この発明の第３の実施形態による道路特徴決定装置の機能ブロック図を示す。

この実施形態における道路特徴決定装置は、道路上を走行しながら計測された表面点による三次元計測データを受けて、車線中心線の直線、円弧とクロソイド曲線を決定する。

直線・円弧抽出手段３０は、三次元計測データを受けて、車線中心線の直線と円弧を抽出する。クロソイド曲線決定手段３２は、前記円弧の中心から、前記直線に対して垂線を設定し、前記円弧の中心をクロソイド終点における距離率半径の中心として、前記垂線に対する接線角を変化させてクロソイド曲線を生成し、クロソイド終点が前記円弧と合致するクロソイド曲線を決定する。接続手段３４は、決定したクロソイド曲線に基づいて、前記直線の端点と円弧の端点とを決定し、直線、クロソイド曲線、円弧を接続する。

以上のようにして、カーブ部分におけるクロソイド曲線を含む曲がり度合いを正確に決定することができる。

3.2ハードウエア構成
この実施形態による道路特徴決定装置のハードウエア構成は、図２と同様である。

3.3曲線部決定処理
図１５〜図１７に、道路特徴決定プログラム４４の曲線部決定処理を含む中心線接続処理におけるフローチャートを示す。ＣＰＵ３０は、三次元計測データに基づいて、道路中心点または車線中心点を決定する（ステップＳ９１）。これは、たとえば、第１の実施形態、第２の実施形態に示す処理によって実現することができる。

次に、ＣＰＵ３０は、ハフ変換によって直線部分を抽出する（ステップＳ９２）。この直線として抽出された中心点を判断対象から取り除く（ステップＳ９３）。続いて、ＣＰＵ３０は、ＲＡＮＳＡＣ法によって円弧部分を抽出する（ステップＳ９４）。さらに、ノイズを除去するため、各線のグループ化を行い、点数の少ないグループを削除する（ステップＳ９５）。

続いて、ＣＰＵ３０は、各線について以下の処理を行う。まず、ＣＰＵ３０は、処理対象とする線が、直線かどうかを判断する（ステップＳ９７）。直線であれば、その勾配（縦断面における角度）を算出する（ステップＳ９８）。円弧であれば、円の中心点座標と半径を算出する（ステップＳ９９）。

すべての線について上記のように直線の勾配、円の中心座標・半径を算出すると、ＣＰＵ３０は、各線を対象として以下の処理を実行する。まず、ＣＰＵ３０は、処理対象とする線が直線であるかを判断する（ステップＳ１０３）。対象線が直線であれば、隣接する次の線が直線であるかを判断する（ステップＳ１０４）。次の線が直線であれば、直線と直線が連続していることになるので、直線間の補完処理を行う（ステップＳ１０６）。

直線間の補完処理を、図１８Ａ、Ｂ、Ｃに示す。まず、ＣＰＵ３０は、両直線を延長してその交点を求める（図１８Ａ）。さらに、一方の直線の端点から、垂線を引く。また、両直線の交点から、両直線のなす角度を２等分する直線を引く。この垂線と２等分線との交わる点を求める（図１８Ｂ）。この交点を中心点として、円弧を描く（図１８Ｃ）。他方の直線とこの円弧が交わる点まで、円弧を設ける。なお、他方の直線と円弧が交わらない場合、他方の直線と円弧が交わるように他方の直線を伸ばす。このようにして、ＸＹ平面において、直線と直線の接合部を補完する。

また、ＹＺ平面（縦断面）においても、直線と直線の接合部の補完を行う。ＣＰＵ３０は、縦断面において両直線を延長し、その交点を求める（図１９Ａ）。さらに、その交点からｄだけ離れた点を通り、両直線に接する放物線を生成する（図１９Ｂ）。

また、対象線が直線であり（ステップＳ１０３がＹＥＳ）、次の線が曲線である場合には（ステップＳ１０４がＮＯ）、直線と曲線をクロソイド曲線によって接合するための補完を行う（ステップＳ１０７）。

図２０Ａに示すように、直線部と円弧とが接しない。これは、道路のカーブにおいては、直線と円弧が接続されるのではなく、その間にクロソイド曲線が設けられるからである。そこで、ＣＰＵ３０は、ステップＳ１０７において、このクロソイド曲線を推定するようにしている。

まず、ＣＰＵ３０は、図２０Ｂに示すように、クロソイド曲線のパラメータを変化させながら、最も適切なクロソイド曲線を決定する。さらに、図２０Ｃに示すように、決定したクロソイド曲線によって、直線と円弧を接続する。

図２１Ａ、Ｂ、Ｃに、適切なクロソイド曲線を示すための処理の詳細を示す。まず、ＣＰＵ３０は、円弧の中心Ｍから直線に対して垂線を引く（図２１Ａ）。次に、図２１Ｂに示すように、直線上の点をクロソイド開始点とし、垂線との角度τの位置をクロソイド終点としてクロソイド曲線を生成する。この際、角度τを0〜90まで0.01間隔で変えながらクロソイド曲線を生成する。

ＣＰＵ３０は、角度τを変えて生成したクロソイド曲線のクロソイド終点のクロソイド開始点からの距離Ｙと、直線から円弧までの距離ｄとが合致するクロソイド曲線を見いだす。さらに、図２１Ｃに示すように、見いだしたクロソイド曲線に基づいて、クロソイド開始点Ｓを直線の終点とし、当該クロソイド曲線によって直線と円弧とを接合する。

また、対象線が曲線であり（ステップＳ１０３がＮＯ）、次の線が曲線である場合には（ステップＳ１０４がＮＯ）、曲線と曲線を接合するための補完を行う（ステップＳ１０８）。処理の詳細を、図２２に示す。

ＣＰＵ３０は、円弧と円弧の中心点を結ぶ直線を設定する。さらに、この直線を、半径の小さい方の円弧の側に延長し、円弧からＤの位置に点を設定する。Ｄは、以下の式によって決定する。

Ｄ＝元直線距離×小さい円半径/（大きい円半径−小さい円半径）
ＣＰＵ３０は、設定した点から２つの円弧に接する直線を引く。この直線により、円弧と円弧を接続する。

3.4その他
(1）上記実施形態では、車線中心線の接合について説明した。しかし、道路中心線、道路端部線についても同様に適用することができる。

(2)上記変形例は、互いに組み合わせて実施することが可能である。また、その本質に反しない限り、本実施形態および変形例を、他の実施形態においても適用することができる。

４．第４の実施形態
4.1全体構成
図２３に、この発明の第４の実施形態による道路特徴決定装置の機能ブロック図を示す。

この実施形態における道路特徴決定装置は、分岐部分における中心線の処理を行う。分類手段４０は、道路端部線を、走行線の右側にある右側道路端部線と、走行線の左側にある左側道路端部線に分類する。分岐範囲判断手段４２は、右側道路端部線と左側道路端部線が接する位置を分岐開始位置とする。さらに、分岐開始位置から直線を延長し、当該直線が道路端部線に接する位置を分岐酋長位置とする。

中央線生成手段４４は、分岐開始位置から分岐終了位置まで双方の道路中心線または車線中央線を延長する。さらに、分岐終了位置に置いて、双方の道路中心線を結ぶように道路中央線または車線中央線を生成する。

4.2ハードウエア構成
この実施形態による道路特徴決定装置のハードウエア構成は、図２と同様である。

4.3分岐処理
図２４に、道路特徴決定プログラムの分岐処理のフローチャートを示す。ＣＰＵ３０は、まず、分岐部を特定する（ステップＳ１１０）。さらに、特定した各分岐部について、分岐区間を特定する（ステップＳ１１２）。続いて、分岐区間において、中央線を接続する（ステップＳ１１３）。このようにして、分岐部分における中央線の補完を行うことができる。

図２５、図２６に、ステップＳ１１２、Ｓ１１３の詳細を示す。ＣＰＵ３０は、各道路端部線につき走行線の右側にあるか左側にあるかを判断する（ステップＳ１２０）。図２７Ａに示すように、右側であるか左側であるかを記録する。次に、各道路端部線を、繋がっているもの同士でグループ化する（ステップＳ１２１）。

ＣＰＵ３０は、上記で生成した各クラスタについて次の処理を行う。まず、クラスタ内に右側道路端部線と左側道路端部線の双方があるかどうかを判断する（ステップＳ１２３）。図２７Ｂに示すように、クラスタ２には、双方があるので、分岐であると判断することができる。さらに、右側と左側の交差部分Ｚ（図２７Ｃ参照）を分岐開始点とする（ステップＳ１２４）。以上のようにして分岐を抽出して、開始点を決定することができる。

ＣＰＵ３０は、各分岐について、分岐部で車線数が変化するかどうかを判断する（ステップＳ１３０）。たとえば、図２８Ａに示すように、分岐部において車線数が変わらなければ、中心線は上手く引かれているので、特段の処理を行わない。しかし、図２８Ｂや図２８Ｃに示すように、分岐部において車線数が変わっていれば、ＣＰＵ３０は、以下に示すように中心線の補完を行う。

まず、分岐開始点Ｚから、図２９Ａ、図２９Ｂに示すように、直線の道路境界線を伸ばす（ステップＳ１３１）。さらに、ＣＰＵ３０は、伸ばした直線と他の道路境界線との交点Ｑを求め、分岐終了点とする（ステップＳ１３２）。

ＣＰＵ３０は、分岐開始点Ｚから分岐終了点Ｑまでの分岐部において、双方の中央線を延長する（ステップＳ１３４）。分岐終了点Ｑでは、両方の中心線の端点を直線Ｋで結ぶ(図２９Ａ参照）。なお、図２９Ｂのように、中央線を延長しただけで両方の中央線が接続される場合には、そのままとする。

また、図３０に示すように、交差点においても、道路中央線、車線中央線が途切れるが、上記と同じ手法にて接続を行うことができる。

４．その他
その本質に反しない限り、本実施形態を、他の実施形態においても適用することができる。

Claims (31)

1. 道路上を走行しながら計測された表面点による三次元計測データに基づいて、道路特徴を決定する道路特徴決定装置であって、
   前記走行方向に垂直な横断面を所定間隔で設定する横断面設定手段と、
   前記走行の軌跡を結ぶ走行線と、前記横断面との交点を走行点として決定する走行点決定手段と、
   前記横断面において、端部の構造物の頂点から水平方向に最小歩道幅より短い所定距離移動した位置における表面点と、前記頂点との間を結ぶ直線を設定し、当該直線に対する垂線が最も長い表面点を構造物下部端点として抽出する構造物下部端点抽出手段と、
   前記構造物下部端点から前記所定距離の範囲の表面点の平均点を決定し、当該平均点と前記走行点との間を結ぶ直線を設定し、当該直線に対する垂線が最も長い表面点を道路端部点として抽出する道路端部点抽出手段と、
   各横断面における道路端部点を結んで道路端部を決定する道路端部決手段と、
   を備えた道路特徴決定装置。
2. 請求項１の道路特徴決定装置において、
   前記横断面における左右の道路端部点の中間点を道路中心点として抽出する道路中心点抽出手段と、
   各横断面における道路中心点を結んで道路中心線を決定する道路中心決定手段と、
   をさらに備えた道路特徴決定装置。
3. コンピュータによって、道路上を走行しながら計測された表面点による三次元計測データに基づいて、道路特徴を決定する道路特徴決定装置を実現するための道路特徴決定プログラムであって、コンピュータを、
   前記走行方向に垂直な横断面を所定間隔で設定する横断面設定手段と、
   前記走行の軌跡を結ぶ走行線と、前記横断面との交点を走行点として決定する走行点決定手段と、
   前記横断面において、端部の構造物の頂点から水平方向に最小歩道幅より短い所定距離移動した位置における表面点と、前記頂点との間を結ぶ直線を設定し、当該直線に対する垂線が最も長い表面点を構造物下部端点として抽出する構造物下部端点抽出手段と、
   前記構造物下部端点から前記所定距離の範囲の表面点の平均点を決定し、当該平均点と前記走行点との間を結ぶ直線を設定し、当該直線に対する垂線が最も長い表面点を道路端部点として抽出する道路端部点抽出手段と、
   各横断面における道路端部点を結んで道路端部を決定する道路端部決手段として機能させるための道路特徴決定プログラム。
4. 請求項３の道路特徴決定プログラムにおいて、コンピュータをさらに
   前記横断面における左右の道路端部点の中間点を道路中心点として抽出する道路中心点抽出手段と、
   各横断面における道路中心点を結んで道路中心線を決定する道路中心決定手段として機能させるための道路特徴決定プログラム。
5. 請求項１または２の装置において、
   前記表面点のうち所定の輝度以上の点が所定距離以上連続している点を区分線として抽出する区分線抽出手段と、
   前記区分線の欠損部分を補完して、区分線を決定する区分線決定手段と、
   をさらに備えた装置。
6. 請求項５の装置において、
   前記区分線と道路端部との中心または隣接する前記区分線の中心に車線中心線を決定する車線中心線決定手段をさらに備えた装置。
7. 請求項３または４のプログラムにおいて、コンピュータを、さらに
   前記表面点のうち所定の輝度以上の点が所定距離以上連続している点を区分線として抽出する区分線抽出手段と、
   前記区分線の欠損部分を補完して、区分線を決定する区分線決定手段として機能させるためのプログラム。
8. 請求項７のプログラムにおいて、コンピュータを、さらに
   前記区分線と道路端部との中心または隣接する前記区分線の中心に車線中心線を決定する車線中心線決定手段として機能させるためのプログラム。
9. 請求項５から８のいずれかの装置またはプログラムにおいて、
   前記区分線決定手段は、区分線を抽出できない区間においては、左右の道路端部間の距離と、最小車線幅とに基づいて、区分線を生成することを特徴とする装置またはプログラム。
10. 請求項１、２、５、６、９のいずれかの装置において、
    前記三次元計測データに基づいて抽出されたカーブ近傍における道路中心線または車線中心線に基づいて、直線および円弧を抽出する直線・円弧抽出手段と、
    前記円弧の中心から、前記直線に対して垂線を設定し、前記円弧の中心をクロソイド終点における曲率半径の中心として、前記垂線に対する接線角を変化させてクロソイド曲線を生成し、クロソイド終点が前記円弧と合致するクロソイド曲線を決定するクロソイド曲線決定手段と、
    決定したクロソイド曲線に基づいて、前記直線の端点と円弧の端点を決定し、直線、クロソイド曲線、円弧を接続する接続手段と、
    を備えた装置。
11. 請求項３、４、７、８、９のいずれかのプログラムにおいて、コンピュータを、さらに
    前記三次元計測データに基づいて抽出されたカーブ近傍における道路中心線または車線中心線に基づいて、直線および円弧を抽出する直線・円弧抽出手段と、
    前記円弧の中心から、前記直線に対して垂線を設定し、前記円弧の中心をクロソイド終点における曲率半径の中心として、前記垂線に対する接線角を変化させてクロソイド曲線を生成し、クロソイド終点が前記円弧と合致するクロソイド曲線を決定するクロソイド曲線決定手段と、
    決定したクロソイド曲線に基づいて、前記直線の端点と円弧の端点を決定し、直線、クロソイド曲線、円弧を接続する接続手段として機能させるためのプログラム。
12. 請求項１０の装置または請求項１１のプログラムにおいて、
    前記クロソイド曲線決定手段は、クロソイド終点の前記直線に対する垂直な位置が、前記円弧の終点の前記直線に対する垂直な位置と合致するかどうかによってクロソイド曲線を決定することを特徴とする装置またはプログラム。
13. 請求項１、２、５、６、９、１０、１２のいずれかの装置において、
    前記三次元計測データに基づいて抽出された道路端部線を、前記走行の軌跡を結ぶ走行線の右側にある右側道路端部線と、左側にある左側道路端部線に分類する分類手段と、
    右側道路端部線と左側道路端部線が接する位置を分岐開始位置とし、分岐開始位置から直線を延長し、当該直線が道路端部線に接する位置を分岐終了位置とする分岐範囲判断手段と、
    分岐開始位置から分岐終了位置まで双方の道路中心線または車線中央線を延長して生成し、分岐終了位置においては、双方の道路中心線を結ぶように道路中央線または車線中央線を生成する中央線生成手段と、
    を備えた装置。
14. 請求項３、４、７、８、９、１１、１２のいずれかのプログラムにおいて、コンピュータを、さらに
    前記三次元計測データに基づいて抽出された道路端部線を、前記走行の軌跡を結ぶ走行線の右側にある右側道路端部線と、左側にある左側道路端部線に分類する分類手段と、
    右側道路端部線と左側道路端部線が接する位置を分岐開始位置とし、分岐開始位置から直線を延長し、当該直線が道路端部線に接する位置を分岐終了位置とする分岐範囲判断手段と、
    分岐開始位置から分岐終了位置まで双方の道路中心線または車線中央線を延長して生成し、分岐終了位置においては、双方の道路中心線を結ぶように道路中央線または車線中央線を生成する中央線生成手段として機能させるためのプログラム。
15. 道路上を走行しながら計測された表面点による三次元計測データに基づいて、道路特徴を決定する道路特徴決定装置であって、
    前記表面点のうち所定の輝度以上の点が所定距離以上連続している点を区分線として抽出する区分線抽出手段と、
    前記区分線の欠損部分を補完して、区分線を決定する区分線決定手段と、
    を備えた道路特徴決定装置。
16. 請求項１５の道路特徴決定装置において、
    前記区分線と道路端部との中心または隣接する前記区分線の中心に車線中心線を決定する車線中心線決定手段をさらに備えた道路特徴決定装置。
17. 道路上を走行しながら計測された表面点による三次元計測データに基づいて、道路特徴を決定する道路特徴決定装置をコンピュータによって実現するための道路特徴決定プログラムであって、コンピュータを、
    前記表面点のうち所定の輝度以上の点が所定距離以上連続している点を区分線として抽出する区分線抽出手段と、
    前記区分線の欠損部分を補完して、区分線を決定する区分線決定手段として機能させるための道路特徴決定プログラム。
18. 請求項１７の道路特徴決定プログラムにおいて、コンピュータをさらに
    前記区分線と道路端部との中心または隣接する前記区分線の中心に車線中心線を決定する車線中心線決定手段として機能させるための道路特徴決定プログラム。
19. 請求項１５〜１８のいずれかの装置またはプログラムにおいて、
    前記区分線決定手段は、区分線を抽出できない区間においては、左右の道路端部間の距離と、最小車線幅とに基づいて、区分線を生成することを特徴とする装置またはプログラム。
20. 請求項１５、１６、１９のいずれかの装置において、
    前記三次元計測データに基づいて抽出されたカーブ近傍における道路中心線または車線中心線に基づいて、直線および円弧を抽出する直線・円弧抽出手段と、
    前記円弧の中心から、前記直線に対して垂線を設定し、前記円弧の中心をクロソイド終点における曲率半径の中心として、前記垂線に対する接線角を変化させてクロソイド曲線を生成し、クロソイド終点が前記円弧と合致するクロソイド曲線を決定するクロソイド曲線決定手段と、
    決定したクロソイド曲線に基づいて、前記直線の端点と円弧の端点を決定し、直線、クロソイド曲線、円弧を接続する接続手段と、
    を備えた装置。
21. 請求項１７、１８、１９のいずれかのプログラムにおいて、コンピュータを、さらに
    前記三次元計測データに基づいて抽出されたカーブ近傍における道路中心線または車線中心線に基づいて、直線および円弧を抽出する直線・円弧抽出手段と、
    前記円弧の中心から、前記直線に対して垂線を設定し、前記円弧の中心をクロソイド終点における曲率半径の中心として、前記垂線に対する接線角を変化させてクロソイド曲線を生成し、クロソイド終点が前記円弧と合致するクロソイド曲線を決定するクロソイド曲線決定手段と、
    決定したクロソイド曲線に基づいて、前記直線の端点と円弧の端点を決定し、直線、クロソイド曲線、円弧を接続する接続手段として機能させるためのプログラム。
22. 請求項２０の装置または請求項２１のプログラムにおいて、
    前記クロソイド曲線決定手段は、クロソイド終点の前記直線に対する垂直な位置が、前記円弧の終点の前記直線に対する垂直な位置と合致するかどうかによってクロソイド曲線を決定することを特徴とする装置またはプログラム。
23. 請求項１５、１６、１９、２０、２２のいずれかの装置において、
    前記三次元計測データに基づいて抽出された道路端部線を、前記走行の軌跡を結ぶ走行線の右側にある右側道路端部線と、左側にある左側道路端部線に分類する分類手段と、
    右側道路端部線と左側道路端部線が接する位置を分岐開始位置とし、分岐開始位置から直線を延長し、当該直線が道路端部線に接する位置を分岐終了位置とする分岐範囲判断手段と、
    分岐開始位置から分岐終了位置まで双方の道路中心線または車線中央線を延長して生成し、分岐終了位置においては、双方の道路中心線を結ぶように道路中央線または車線中央線を生成する中央線生成手段と、
    を備えた装置。
24. 請求項１７、１８、１９、２１、２２のいずれかのプログラムにおいて、コンピュータを、さらに
    前記三次元計測データに基づいて抽出された道路端部線を、前記走行の軌跡を結ぶ走行線の右側にある右側道路端部線と、左側にある左側道路端部線に分類する分類手段と、
    右側道路端部線と左側道路端部線が接する位置を分岐開始位置とし、分岐開始位置から直線を延長し、当該直線が道路端部線に接する位置を分岐終了位置とする分岐範囲判断手段と、
    分岐開始位置から分岐終了位置まで双方の道路中心線または車線中央線を延長して生成し、分岐終了位置においては、双方の道路中心線を結ぶように道路中央線または車線中央線を生成する中央線生成手段として機能させるためのプログラム。
25. 道路上を走行しながら計測された表面点による三次元計測データに基づいて、道路特徴を決定する道路特徴決定装置であって、
    前記三次元計測データに基づいて抽出されたカーブ近傍における道路中心線または車線中心線に基づいて、直線および円弧を抽出する直線・円弧抽出手段と、
    前記円弧の中心から、前記直線に対して垂線を設定し、前記円弧の中心をクロソイド終点における曲率半径の中心として、前記垂線に対する接線角を変化させてクロソイド曲線を生成し、クロソイド終点が前記円弧と合致するクロソイド曲線を決定するクロソイド曲線決定手段と、
    決定したクロソイド曲線に基づいて、前記直線の端点と円弧の端点を決定し、直線、クロソイド曲線、円弧を接続する接続手段と、
    を備えた道路特徴決定装置。
26. コンピュータによって、道路上を走行しながら計測された表面点による三次元計測データに基づいて、道路特徴を決定する道路特徴決定装置を実現するための道路特徴決定プログラムであって、コンピュータを
    前記三次元計測データに基づいて抽出されたカーブ近傍における道路中心線または車線中心線に基づいて、直線および円弧を抽出する直線・円弧抽出手段と、
    前記円弧の中心から、前記直線に対して垂線を設定し、前記円弧の中心をクロソイド終点における曲率半径の中心として、前記垂線に対する接線角を変化させてクロソイド曲線を生成し、クロソイド終点が前記円弧と合致するクロソイド曲線を決定するクロソイド曲線決定手段と、
    決定したクロソイド曲線に基づいて、前記直線の端点と円弧の端点を決定し、直線、クロソイド曲線、円弧を接続する接続手段として機能させるための道路特徴決定プログラム。
27. 請求項２５の装置または請求項２６のプログラムにおいて、
    前記クロソイド曲線決定手段は、クロソイド終点の前記直線に対する垂直な位置が、前記円弧の終点の前記直線に対する垂直な位置と合致するかどうかによってクロソイド曲線を決定することを特徴とする装置またはプログラム。
28. 請求項２５または２７の装置において、
    前記三次元計測データに基づいて抽出された道路端部線を、前記走行の軌跡を結ぶ走行線の右側にある右側道路端部線と、左側にある左側道路端部線に分類する分類手段と、
    右側道路端部線と左側道路端部線が接する位置を分岐開始位置とし、分岐開始位置から直線を延長し、当該直線が道路端部線に接する位置を分岐終了位置とする分岐範囲判断手段と、
    分岐開始位置から分岐終了位置まで双方の道路中心線または車線中央線を延長して生成し、分岐終了位置においては、双方の道路中心線を結ぶように道路中央線または車線中央線を生成する中央線生成手段と、
    を備えた装置。
29. 請求項２６または２７のプログラムにおいて、コンピュータを、さらに、
    前記三次元計測データに基づいて抽出された道路端部線を、前記走行の軌跡を結ぶ走行線の右側にある右側道路端部線と、左側にある左側道路端部線に分類する分類手段と、
    右側道路端部線と左側道路端部線が接する位置を分岐開始位置とし、分岐開始位置から直線を延長し、当該直線が道路端部線に接する位置を分岐終了位置とする分岐範囲判断手段と、
    分岐開始位置から分岐終了位置まで双方の道路中心線または車線中央線を延長して生成し、分岐終了位置においては、双方の道路中心線を結ぶように道路中央線または車線中央線を生成する中央線生成手段として機能させるためのプログラム。
30. 道路上を走行しながら計測された表面点による三次元計測データに基づいて、道路特徴を決定する道路特徴決定装置であって、
    前記三次元計測データに基づいて抽出された道路端部線を、前記走行の軌跡を結ぶ走行線の右側にある右側道路端部線と、左側にある左側道路端部線に分類する分類手段と、
    右側道路端部線と左側道路端部線が接する位置を分岐開始位置とし、分岐開始位置から直線を延長し、当該直線が道路端部線に接する位置を分岐終了位置とする分岐範囲判断手段と、
    分岐開始位置から分岐終了位置まで双方の道路中心線または車線中央線を延長して生成し、分岐終了位置においては、双方の道路中心線を結ぶように道路中央線または車線中央線を生成する中央線生成手段と、
    を備えた道路特徴決定装置。
31. コンピュータによって、道路上を走行しながら計測された表面点による三次元計測データに基づいて、道路特徴を決定する道路特徴決定装置を実現するための道路特徴決定プログラムであって、コンピュータを
    前記三次元計測データに基づいて抽出された道路端部線を、前記走行の軌跡を結ぶ走行線の右側にある右側道路端部線と、左側にある左側道路端部線に分類する分類手段と、
    右側道路端部線と左側道路端部線が接する位置を分岐開始位置とし、分岐開始位置から直線を延長し、当該直線が道路端部線に接する位置を分岐終了位置とする分岐範囲判断手段と、
    分岐開始位置から分岐終了位置まで双方の道路中心線または車線中央線を延長して生成し、分岐終了位置においては、双方の道路中心線を結ぶように道路中央線または車線中央線を生成する中央線生成手段として機能させるための道路特徴決定プログラム。
    
    
    

Images