(57)【特許請求の範囲】
【請求項１】
道路の路面を広角カメラで撮影した画像から車線区分線のエッジ情報を検出する区分線検出部と、
前記区分線検出部が第１の時間区間内の１つ以上の時刻における画像から検出したエッジ情報に基づいて、前記道路の道路形状パラメータのうちの曲率及び幅を求める第１のパラメータ推定部と、
前記第１のパラメータ推定部が求めた曲率及び幅を格納する格納部と、
前記第１のパラメータ推定部が求めた曲率及び幅を第２の時間区間における曲率及び幅として用い、前記区分線検出部が該第２の時間区間における画像から検出したエッジ情報に基づいて、前記道路形状パラメータのうちの曲率及び幅以外のパラメータを求め、該曲率及び幅を含む該道路形状パラメータを出力する第２のパラメータ推定部と
を備えることを特徴とする道路形状推定装置。
【請求項２】
前記第１のパラメータ推定部は、前記車線区分線が破線である場合、前記区分線検出部が検出したエッジ情報に基づいて、該破線の第１の切れ目に対応する第１の画像と該破線の第２の切れ目に対応する第２の画像を検出し、該第１の画像を検出した第１の時刻から該第２の画像を検出した第２の時刻までを前記第１の時間区間とみなして前記曲率及び幅を求めることを特徴とする請求項１記載の道路形状推定装置。
【請求項３】
前記第１のパラメータ推定部は、前記区分線検出部がエッジ情報を検出する度にフレームカウンタの値をインクリメントし、該フレームカウンタの初期値に対応する第１の時刻から該フレームカウンタの値が所定値を超えた第２の時刻までを前記第１の時間区間とみなして前記曲率及び幅を求めることを特徴とする請求項１記載の道路形状推定装置。
【請求項４】
前記第１のパラメータ推定部は、前記道路形状パラメータに含まれる、前記広角カメラの横方向オフセット及びヨー角のそれぞれを等速運動又は等加速度運動で表したモデルを用いて、前記曲率及び幅を求めることを特徴とする請求項１記載の道路形状推定装置。
【請求項５】
前記第１のパラメータ推定部は、前記広角カメラのピッチ角を等速運動、等加速度運動、又は時間に関してより高次の項を含む高次運動で表したモデルを用いて、前記曲率及び幅を求めることを特徴とする請求項４記載の道路形状推定装置。
【請求項６】
請求項１乃至５のいずれか１項に記載の道路形状推定装置と、
前記道路形状推定装置から出力される道路形状パラメータに基づいて、車両が車線を逸脱したか否かを判定する逸脱判定装置と、
前記車両が前記車線を逸脱した場合に警報を出力する逸脱警報装置と
を備えることを特徴とする車線逸脱警報システム。
【請求項７】
請求項１乃至５のいずれか１項に記載の道路形状推定装置と、
前記道路形状推定装置から出力される道路形状パラメータに基づいて、車両がふらついているか否かを判定するふらつき判定装置と、
前記車両がふらついている場合に、車線上での走行を維持するように該車両を操舵する車両操舵装置と
を備えることを特徴とする車両操舵システム。
【請求項８】
第１の時間区間内の１つ以上の時刻における道路の路面を広角カメラで撮影した画像から車線区分線のエッジ情報を検出し、
前記１つ以上の時刻における画像から検出したエッジ情報に基づいて、前記道路の道路形状パラメータのうちの曲率及び幅を求め、
第２の時間区間における画像から車線区分線のエッジ情報を検出し、
得られた曲率及び幅を前記第２の時間区間における曲率及び幅として用い、該第２の時間区間における画像から検出したエッジ情報に基づいて、前記道路形状パラメータのうちの曲率及び幅以外のパラメータを求め、
前記曲率及び幅を含む前記道路形状パラメータを出
力する
処理をコンピュータに実行させるプログラム。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、道路形状推定装置及びプログラムに関する。
【背景技術】
【０００２】
カメラを車両の進行方向又は進行方向と逆向きに取り付け、撮影された映像に含まれる車線区分線を検出して、車線区分線の情報から走行車線と車両との位置関係を求め、道路形状を推定する方法は古くから研究・開発されている。
【０００３】
例えば、カメラで撮影した車両前方の路面画像から、縦方向に複数個所で横方向に画像を走査し、輝度（濃淡）の変化箇所として車線区分線のエッジを検出し、エッジ情報に基づいて走行車線と車両との位置関係を推定する方法が知られている。この方法では、画像から検出されたエッジ点を縦方向に繋ぐことで車線区分線を識別し、道路形状モデルと車線区分線の位置とを照合して路面上の車線区分線の位置が決定される。
【０００４】
また、車線区分線が破線の場合に、車両の走行中における複数時刻の路面画像から得られる車線区分線の位置を重ね合わせて線分の間隙を埋めることで、破線を長い線分として検出する方法も知られている。この方法では、検出された長い線分を道路形状モデルと照合することで、安定して路面上の車線区分線の位置を決定することができる。
【先行技術文献】
【特許文献】
【０００５】
【特許文献１】特開２００６−１２１９１号公報
【非特許文献】
【０００６】
【非特許文献１】高橋新，二宮芳樹，「走行レーン認識におけるロバストなレーンマーキング候補選択の一手法」，電子情報通信学会論文誌  Ｄ−ＩＩ  Ｖｏｌ．Ｊ８１−Ｄ−ＩＩ  Ｎｏ．８  ｐｐ．１９０４−１９１１，１９９８年８月
【発明の概要】
【発明が解決しようとする課題】
【０００７】
上述した従来の道路形状推定方法には、以下のような問題がある。
従来の道路形状推定方法は、車両に搭載されるカメラが、画角が３０度程度の比較的画角が狭いカメラを車両に搭載することを前提としている。狭角カメラを用いると、得られる画像の分解能が高いため、路面の奥行き方向で遠方まで解像度高く撮影でき、手前から奥までの長い範囲で撮影することができる。このため、車線区分線が破線であっても、画像中には進行方向に沿って複数の破線線素を観測することができる。
【０００８】
一方、ドライブレコーダ用カメラのような、画角が１２０度程度の広角カメラを用いると、幅広い角度範囲を撮影することができる代わりに、画像の分解能は低くなる。このため、路面上の進行方向で見ると手前側の短い距離までしか撮影できない制約があり、車線区分線が破線の場合は、車両に最も近い破線線素が走行車線の左右に１本ずつしか観測できない。以下の説明では、破線線素を破線ブロックと記載する場合がある。
【０００９】
図１は、セダン形状の車両のルームミラー裏に前向きにカメラを設置し、高速道路の破線カーブ路を撮影した画像を模式的に表している。この例では、破線ブロック（白線部分）の長さは８ｍで、破線ブロック間の間隙（非白線部分）の長さは１２ｍの一般的な状況を想定している。画像１０１は、画角３０度の狭角カメラで撮影した画像であり、画像１０２は、画角１２０度の広角カメラで撮影した画像である。画像１０２中の矩形領域１２１は、同じ状況で狭角カメラが撮影可能な範囲を表している。
【００１０】
図１から分かるように、狭角カメラでは、破線路であっても進行方向に沿って複数の破線ブロックが撮影できるため、単一時刻の画像から複数の破線ブロックを検出することで、道路形状を推定することが可能である。特に、破線カーブ路であっても、図２に示すように複数の破線ブロックが撮影できるため、単一時刻の画像からカーブの曲率を推定することもできる。このように、狭角カメラを使用する場合は、従来の方法でも道路形状を推定することができる。
【００１１】
一方、広角カメラの画像１０２では、手前側の黒色領域１２２が示すように、車内のダッシュボードと車両の前方ボンネット部分で路面が隠されてしまう上、分解能が不足するため路面の手前側しか撮影できない。このため、破線路の場合は、進行方向に沿って最も車両に近い破線ブロックが、短い線素として走行車線の左右に１本ずつしか観測できないことが分かる。
【００１２】
特に、破線カーブ路の場合は、図３に示すように、走行車線の左右に破線ブロック３０１及び３０２が観測されるのみである。このような状況で従来の道路形状推定方法を適用すると、推定される車線区分線３１１及び３１２の形状は、破線ブロック３０１及び３０２を延長した直線と誤認されることになる。このため、本来の車線区分線３２１及び３２２と推定される車線区分線３１１及び３１２との間に距離誤り３３１及び３３２を生じてしまう。
【００１３】
例えば、前方映像を用いた車線逸脱警報システムでは、車両の前方に映る映像から車線形状を推定する。画角が３０度の狭角カメラでは５０ｍ程度先の映像が用いられ、画角が１２０度の広角カメラでは２０ｍ程度先の映像が用いられる。そして、推定された車線形状を車両の真横まで延長してから、車両と車線との横方向の距離を算出する。このため、遠方で検出された破線ブロックの傾き（直線か曲線か）を誤って推定し、車線を真横まで延長すると、わずかな誤差であっても車両の真横では誤差が拡大される。例えば、広角カメラで検出された破線ブロックを直線的に延長すると、４０ｃｍ強の誤差を生じる。この結果、車線逸脱警報システムは誤った警報を発することになる。
【００１４】
このような誤りを防ぐために、複数時刻の路面画像から得られる複数の破線ブロックの情報を重ね合わせることで、破線ブロックの傾きを精度良く推定する方法が考えられる。しかしながら、車両の走行時の挙動によっては、進行方向に対して横方向に映像が変化する。横方向に車両が動くと、図４に示すように、時刻Ｔ１〜Ｔ３の３つの画像を重ね合わせても、車線区分線の破線が重ならずに不連続な形状となり、道路形状を正しく推定することはできない。
【００１５】
本発明の課題は、車線区分線が破線のカーブ路であっても、カメラの画角に依らずに道路の路面を撮影した画像から精度良く道路形状を推定することである。
【課題を解決するための手段】
【００１６】
道路形状推定装置は、区分線検出部、第１のパラメータ推定部、格納部、及び第２のパラメータ推定部を含む。
区分線検出部は、道路の路面を撮影した画像から車線区分線のエッジ情報を検出する。第１のパラメータ推定部は、区分線検出部が第１の時間区間内の１つ以上の時刻における画像から検出したエッジ情報に基づいて、道路の道路形状パラメータのうちの曲率及び幅を求める。格納部は、第１のパラメータ推定部が求めた曲率及び幅を格納する。
【００１７】
第２のパラメータ推定部は、第１のパラメータ推定部が求めた曲率及び幅を第２の時間区間における曲率及び幅として用い、区分線検出部が第２の時間区間における画像から検出したエッジ情報に基づいて、曲率及び幅以外の道路形状パラメータを求める。そして、曲率及び幅を含む道路形状パラメータを出力する。
【発明の効果】
【００１８】
上述した道路形状推定装置によれば、車線区分線が破線のカーブ路であっても、カメラの画角に依らずに道路の路面を撮影した画像から精度良く道路形状を推定することができる。
【図面の簡単な説明】
【００１９】
【図１】狭角カメラ及び広角カメラにより撮影された画像を示す図である。
【図２】狭角カメラにより撮影された破線カーブ路の画像を示す図である。
【図３】広角カメラにより撮影された破線カーブ路の画像を示す図である。
【図４】広角カメラにより撮影された画像の重ね合わせ結果を示す図である。
【図５】道路形状モデルを示す図である。
【図６】カメラの観測系モデルを示す図である。
【図７】道路形状パラメータの時間的な変化パターンを示す図である。
【図８】道路形状パラメータと観測情報の関係を示す図である。
【図９】時間区間を示す図である。
【図１０】第１の道路形状推定装置の機能的構成図である。
【図１１】道路形状推定処理のフローチャートである。
【図１２】第２の道路形状推定装置の機能的構成図である。
【図１３】区分線検出処理のフローチャートである。
【図１４】デジタル画像を示す図である。
【図１５】エッジ画像を示す図である。
【図１６】エッジ画像から検出された境界エッジ線を示す図である。
【図１７】区間決定処理のフローチャートである。
【図１８】第３の道路形状推定装置の機能的構成図である。
【図１９】車線逸脱警報システムの構成図である。
【図２０】車両操舵システムの構成図である。
【図２１】情報処理装置の構成図である。
【発明を実施するための形態】
【００２０】
以下、図面を参照しながら、実施形態を詳細に説明する。
図５は、道路形状モデルの例を示している。ここでは、車線の中央線Ｌｃにおける曲率半径をＲとし、車線の各位置で水平方向（Ｘ軸方向）に測って道路幅（車線幅）が常にＷとなるモデルを考える。このモデルでは、中央線Ｌｃに直交する方向での車線幅がＷとならないため、実際の車線とは異なるが、カメラによる観測点から比較的近い範囲では誤差が小さく、解析的な取り扱いが簡単になる。
【００２１】
図６に示すように、カメラの中心を原点Ｏとして、原点Ｏから横方向に路面座標系のＸ軸をとり、縦方向に路面座標系のＺ軸をとる。この場合、ＸＺ平面に垂直な方向が路面座標のＹ軸となる。そして、原点Ｏを路面上に垂直に投影した点をＲＯとする。図５の道路形状モデルにおける各記号の意味は以下の通りである。
【００２２】
Ｌｃ：車線の中央線
Ｌｒ：車線の右側の車線区分線
Ｌｌ：車線の左側の車線区分線
Ｗ：道路幅
Ｒ：曲率半径
ｅ：点ＲＯから中央線Ｌｃまでの距離
Ｐ：車線区分線Ｌｒ又はＬｌ上の着目点
Ａ：車線区分線ＬｒとＸＹ平面の交点
Ｂ：着目点ＰをＸＹ平面に垂直に投影した点
Ｃ：曲率中心
Ｄ：ＸＹ平面から着目点Ｐまでの距離
【００２３】
距離ｅは、カメラから道路中央までの距離（カメラの横方向オフセット）を表し、距離Ｄは、カメラから着目点Ｐまでの奥行き方向の距離を表す。このとき、着目点Ｐ（Ｘ，Ｚ）のＸ座標Ｐｘ及びＺ座標Ｐｚは、次式で与えられる。
【００２４】
【数１】
0005780140.tif 000002
【００２５】
式（１）が車線の路面上での位置を与える基礎式である。ただし、ｋは車線区分線Ｌｒ及びＬｌを区別するための定数で、着目点Ｐが右側の車線区分線Ｌｒ上にあるときはｋ＝１、左側の車線区分線Ｌｌ上にあるときはｋ＝−１である。曲率半径Ｒは、右カーブ、すなわち曲率中心ＣがＸ軸の正区間にある場合は正値とし、左カーブ、すなわち曲率中心ＣがＸ軸の負区間にある場合は負値とする。
【００２６】
基礎式（１）は、平方根を含んでいるため、解析的な取り扱いが難しい。そこで、曲率半径Ｒが極端に小さくない通常の走行時を想定して、基礎式（１）の近似化を行う。例えば、平方根の１次近似として、テーラー展開の第１項までを用いると、次式のようになる。
【００２７】
【数２】
0005780140.tif 000003
【００２８】
式（２）を用いると、基礎式（１）は以下のように書き改められる。
【数３】
0005780140.tif 000004
式（３）が１次近似での基礎式となる。
【００２９】
次に、路面上の車線区分線をカメラで観測したときの車線区分線の位置のモデルを導出する。
【００３０】
図６は、カメラの観測系モデルの例を示している。カメラの中心は路面から高さＨの位置にあり、カメラは車両の進行方向に対して、ピッチ角φ、ヨー角θ、ロール角０で設置されているとする。ピッチ角φ及びヨー角θは、カメラ座標系から路面座標系への座標系の変換を正の回転方向に取る。したがって、路面座標系からカメラ座標系へは、座標点の変換が回転の正方向となる。また、カメラの焦点距離はｆとする。このとき、路面座標（Ｘ，Ｙ，Ｚ）からカメラ座標（ｘｃ、ｙｃ、ｚｃ）への座標変換を考える。
【００３１】
路面座標系での点Ｐの座標（Ｘ，Ｙ，Ｚ）をピッチ角φとヨー角θを持つカメラ座標系での座標（ｘｃ，ｙｃ，ｚｃ）で表すと、次式のようになる。
【００３２】
【数４】
0005780140.tif 000005
【００３３】
この点をカメラで観測した画像の中央からｘ軸を右向きに、ｙ軸を下向きに取り、画像座標を（ｘ，ｙ）とすると、着目点Ｐの画像座標（ｐｘ，ｐｙ）は次式で与えられる。
【００３４】
【数５】
0005780140.tif 000006
【００３５】
式（５）のＸ及びＺに近似基礎式（３）の（Ｐｘ，Ｐｚ）を代入し、ＹにＨを代入すると、画像上での車線区分線の位置関係として次式が得られる。
【００３６】
【数６】
0005780140.tif 000007
【００３７】
式（６）から媒介変数であるＤを除けば、ｐｘとｐｙの関係式が求められる。実際には、式（６）の形のままではＤについて容易に解けないため、関係式の導出が困難である。そこで、式（６）中の各項のオーダーを考慮して、式（６）の近似化を行う。
【００３８】
具体的には、各回転角φ及びθは大きくても２０度程度であり、それほど大きくないため、ｓｉｎ系の値は０．１程度である。Ｄ、Ｒ、Ｗ、Ｈ、及びｅの単位をメートルとすると、式（６）中のｐｘ及びｐｙの分母において、第１項のｃｏｓ（φ）ｓｉｎ（θ）に乗算される数値は２程度であるから、第１項は０．２程度の値を持つ。また、第２項のＨの値も２程度であるから、第２項も０．２程度の値を持つ。これに対して、第３項のＤの値は３０程度であり、第３項はｃｏｓ系の積なので３０程度の値を持つ。したがって、分母では第３項が支配的で第１項及び第２項はほとんど影響を与えない。ｐｙの分子についても同様である。したがって、最初の近似式として、次式が得られる。
【００３９】
【数７】
0005780140.tif 000008
【００４０】
式（７）のｐｙの式からＤを求めて、ｐｘの式に代入し、（ｐｘ，ｐｙ）を（ｘ，ｙ）と書き改めると、次式が得られる。
【００４１】
【数８】
0005780140.tif 000009
【００４２】
式（８）が、画像中の車線区分線上の点のｘ座標とｙ座標の関係式であり、画像座標系における基礎式となる。ここで、回転角φ及びθを微小とみなして、ｓｉｎφ＝φ、ｃｏｓφ＝１、ｓｉｎθ＝θ、ｃｏｓθ＝１とすると、次式が得られる。
【００４３】
【数９】
0005780140.tif 000010
【００４４】
式（９）が、道路形状モデルを表す最終的な近似式である。式（９）の道路曲率ρは、曲率半径Ｒの逆数に相当する。なお、カメラの横方向オフセットｅとして、カメラと道路上の基準位置との横方向の相対距離を表す別のパラメータを用いることも可能である。
【００４５】
映像中の各時刻における画像（フレーム）から車線区分線の位置（ｘ，ｙ）が検出できれば、式（９）を用いて道路形状パラメータ（ρ，Ｗ，ｅ，φ，θ）を推定することができる。これにより、路面上の車線区分線の形状と車両の位置及び方向との関係を求めて、道路形状を推定することができる。
【００４６】
この道路形状推定方法は以下のように定式化できる。式（９）から分かるように、左右両方の車線区分線の位置が検出できる場合、道路形状を規定するには５つの道路形状パラメータ（ρ，Ｗ，ｅ，φ，θ）を定める必要がある。一方、短い直線状の線素として左右の破線ブロックが観測される場合の画像から得られる情報は、左右いずれか一方の破線ブロックの基準点の位置（ｘ，ｙ）、その破線ブロックの傾き、及び左右の破線ブロックの間の横方向の距離の合計４つの数値である。したがって、道路形状パラメータの自由度５に対して、１フレームから得られる観測情報の数は４であるから、拘束条件が不足し、一意に道路形状パラメータを求めることはできない。
【００４７】
道路形状パラメータと観測情報の関係は複数のフレームを用いた場合でも変わらない。Ｎフレームの画像から求めるべき道路形状パラメータの自由度は５Ｎであり、Ｎフレームの画像から得られる観測情報の数は４Ｎであるから、単に時系列での入力フレーム数を増やしても、道路形状パラメータを定めることはできない。
【００４８】
そこで、時間的に連続した複数時刻の画像を用いることを前提として、道路形状パラメータに適切な拘束条件を設けることで、求めるべき道路形状パラメータの数を削減することが考えられる。これにより、時系列に得られる破線ブロックの情報から道路形状パラメータを推定することが可能になる。
【００４９】
まず、破線ブロックが遠方から見え始める周期について考える。先にも示したように、高速道路では、破線ブロックの長さは８ｍで、破線ブロック間の間隙の長さは１２ｍであるから、破線ブロックと間隙の長さの合計は２０ｍである。この場合、車両の走行速度を１００ｋｍ／ｈとすると、破線ブロックが遠方で見え始める周期は０．７秒程度である。一例として、時系列の路面映像に対して、この破線ブロックが見え始めるタイミングを時間的な分割点として時間区間を定義することが可能である。このとき、１００ｋｍ／ｈでは０．７秒毎の時間区間に分割されることになる。
【００５０】
次に、道路形状パラメータ（ρ，Ｗ，ｅ，φ，θ）について考える。図７は、道路形状パラメータの時間的な変化パターンを示している。
【００５１】
図７から分かるように、道路曲率ρと道路幅Ｗは、地形によって変動するパラメータである。高速道路ではカーブ路に入る際に緩和区間が設けられており、道路曲率ρは、設計走行速度に対して３秒以上の時間で変化することが規定されている。このため、道路曲率ρは、３秒程度の時間スケールで変化する。例えば、１秒間に１０回程度の処理を行う場合、３秒程度の時間スケールの変化は非常に遅い変化である。したがって、区間内では、道路曲率ρと道路幅Ｗの変化はほとんどなく一定値とみなしても差し支えない。つまり、区間内では、道路曲率ρと道路幅Ｗの自由度は全体で２である。
【００５２】
また、オフセットｅとヨー角θは、車両の挙動によって変化する量であり、オフセットｅの変化速度の最大値は１．０ｍ／ｓ程度に見積もられることが一般的である。したがって、０．７秒程度の区間内では一定値とはみなせない。ただし、車両の挙動は連続的な運動であり、１秒程度の時間では、等速運動又は等加速度運動のような低次の運動モデルで近似することが可能である。例えば、等加速度運動で近似する場合、１パラメータ当たりの自由度は３であるから、区間内では、オフセットｅとヨー角θの自由度は全体で６である。
【００５３】
残りのピッチ角φは、路面の凹凸や傾き等により変化し、その変化速度は突発的で速い。このため、ピッチ角φは、フレーム毎に個別に表す必要がある。したがって、区間内のフレーム数をＮとすると、ピッチ角φの自由度はＮである。
【００５４】
以上より、Ｎフレームの区間内で求めるべき道路パラメータの自由度は、２＋６＋Ｎ＝８＋Ｎとなる。これに対して、Ｎフレームから得られる観測情報の数は４Ｎであるから、次の不等式が成り立つ場合に、道路パラメータを求めることができる。
８＋Ｎ＜４Ｎ      （１１）
【００５５】
式（１１）より、フレーム数Ｎが３以上の場合に、道路パラメータを推定することが可能であることが分かる。
【００５６】
次に、道路パラメータにこのような拘束条件を設けた場合の道路パラメータ算出方法について述べる。区間内のフレームの順番（時刻）を表す添え字をｍ（ｍ＝１，２，．．．，Ｎ）とし、１フレームの画像から得られた複数の車線区分線のエッジ点を区別する添え字をｊ（ｊ＝１，２，．．．，Ｎｅ）として式（９）を書き改めると、次式のようになる。
【００５７】
【数１０】
0005780140.tif 000011
【００５８】
式（２１）の各記号の意味は以下の通りである。
（ｘｊｍ，ｙｊｍ）：区間内のｍ番目のフレームから得られるｊ番目のエッジ点の座標
ρｍ：区間内のｍ番目のフレームにおける道路曲率
Ｗｍ：区間内のｍ番目のフレームにおける道路幅
ｅｍ：区間内のｍ番目のフレームにおけるオフセット
θｍ：区間内のｍ番目のフレームにおけるヨー角
φｍ：区間内のｍ番目のフレームにおけるピッチ角
【００５９】
まず、道路曲率及び道路幅については、区間内では一定値とみなせるので、区間内における道路曲率及び道路幅をそれぞれρ＊及びＷ＊とする。
また、オフセットｅｍ及びヨー角θｍについては、それぞれ等加速度運動を仮定して、次式で近似する。
【００６０】
【数１１】
0005780140.tif 000012
【００６１】
式（２２）において、Ａｅ、Ｂｅ、及びＣｅは、オフセットｅｍの等加速度運動パラメータであり、Ａθ、Ｂθ、及びＣθは、ヨー角θｍの等加速度運動パラメータである。このとき、式（２１）は、次式のように書き改められる。
【００６２】
【数１２】
0005780140.tif 000013
【００６３】
式（２３）における道路形状パラメータは（ρ＊，Ｗ＊，φｍ，Ａｅ，Ｂｅ，Ｃｅ，Ａθ，Ｂθ，Ｃθ）であり、区間内におけるパラメータの数は８＋Ｎである。ここで、式（２３）の右辺をＦｊｍ（ρ＊，Ｗ＊，φｍ，Ａｅ，Ｂｅ，Ｃｅ，Ａθ，Ｂθ，Ｃθ）と記し、各パラメータを以下のように記す。
【００６４】
【数１３】
0005780140.tif 000014
【００６５】
Ｆｊｍ（ρ＊，Ｗ＊，φｍ，Ａｅ，Ｂｅ，Ｃｅ，Ａθ，Ｂθ，Ｃθ）は非線形関数であるが、これを式（２４）を用いて線形化した関数Ｇｊｍは、次式で与えられる。
【００６６】
【数１４】
0005780140.tif 000015
【００６７】
ここで、残差ｓｊｍを次式のように定義する。
【数１５】
0005780140.tif 000016
【００６８】
残差ｓｊｍの二乗値を、区間内の全フレーム（ｍ＝１，２，．．．，Ｎ）と各フレーム内のすべての車線区分線上のエッジ点（ｊ＝１，２，．．．，Ｎｅ）で積分した結果の１／２を総残差Ｓとする。
【００６９】
【数１６】
0005780140.tif 000017
【００７０】
最適パラメータはＳを最小にする値なので、Ｓを各パラメータで偏微分した結果を０と置く。例えば、Ｓをρ＊で偏微分した結果を０と置くと、次式が得られる。
【００７１】
【数１７】
0005780140.tif 000018
【００７２】
式（２８）のｍに関する総和記号は、ｍが１からＮまでの総和を表す。他のパラメータについても同様の偏微分操作を行うことで、８＋Ｎ個の連立一次方程式が得られる。この連立一次方程式を解くことで、変化量を示すパラメータ（Δρ＊，ΔＷ＊，Δφｍ，ΔＡｅ，ΔＢｅ，ΔＣｅ，ΔＡθ，ΔＢθ，ΔＣθ）が求められる。そして、各パラメータの値が十分小さくなるまで、次式の代入操作を行って演算を繰り返す。
【００７３】
【数１８】
0005780140.tif 000019
【００７４】
このような繰り返し演算により、最終的な道路形状パラメータ（ρ＊，Ｗ＊，φｍ，Ａｅ，Ｂｅ，Ｃｅ，Ａθ，Ｂθ，Ｃθ）が求められる。
【００７５】
図８は、道路形状パラメータと観測情報の数の関係を示している。道路形状パラメータに対して拘束条件を課さない場合は、道路形状パラメータを推定することができない。一方、道路曲率ρ及び道路幅Ｗに拘束条件を課した場合は、Ｎフレームの区間内の道路形状パラメータの自由度は２＋３Ｎであり、観測情報の数は４Ｎである。したがって、Ｎが２以上であれば、道路形状パラメータを推定することができる。さらにオフセットｅ及びヨー角θにも拘束条件を課した場合は、区間内の道路形状パラメータの自由度は８＋Ｎになるため、Ｎが３以上であれば、道路形状パラメータを推定することができる。
【００７６】
上述したように、破線ブロックが遠方から見え始めるタイミングを区間の分割点とすると、区間の長さは１００ｋｍ／ｈの走行速度で０．７秒程度となる。１秒当たり１０フレームの画像処理を前提とすると、０．７秒の区間内には７フレームが存在するので、Ｎ＝７となり、Ｎが３以上という条件を満足する。したがって、常に道路形状パラメータを推定することができることが分かる。
【００７７】
ただし、この方法では複数のフレームの情報を必要とするので、区間毎に間欠的にしか道路形状パラメータを求めることができない。一方、車線逸脱警報システム等のようにリアルタイム性を必要とするシステムでは、フレーム毎に道路形状パラメータを推定することが望ましい。
【００７８】
そこで、図９に示すように、映像を時系列の区間に分割して、現在の区間（ｔ）における各フレームの道路形状パラメータ推定には、前区間（ｔ−１）において推定された道路曲率ρ及び道路幅Ｗを用いる。上述したように、道路曲率ρ及び道路幅Ｗは変化速度が非常に遅いため、区間（ｔ−１）と区間（ｔ）ではほぼ同じ値とみなすことができる。
【００７９】
区間（ｔ）では、区間（ｔ−１）において推定された道路曲率ρ及び道路幅Ｗを固定値として用い、各フレームの画像から得られる車線区分線のエッジ情報を用いて残りのオフセットｅ、ピッチ角φ、及びヨー角θを推定する。次の区間（ｔ＋１）における各フレームの道路形状パラメータ推定には、現在の区間（ｔ）において推定された道路曲率ρ及び道路幅Ｗが用いられる。
【００８０】
このように、道路曲率ρ及び道路幅Ｗは、前区間の全時刻における情報を用いて間欠的に求めておき、他の道路形状パラメータは、各時刻におけるフレームから得られる情報を用いてフレーム毎に求める。これにより、処理対象のフレーム毎に、遅れることなく道路形状パラメータを推定することが可能になる。
【００８１】
ここで、区間（ｔ）における各フレームから求められる道路形状パラメータの自由度について言及しておく。左右両方の車線区分線が観測される場合、道路曲率ρ及び道路幅Ｗは区間（ｔ−１）で求めた値に固定されるので、求めるべき道路形状パラメータは、オフセットｅ、ピッチ角φ、及びヨー角θの３つである。これに対して、１フレームから得られる車線区分線の情報の数は４であり、拘束条件の数の方が多いため、一意に道路形状パラメータを推定することができる。
【００８２】
なお、車線区分線が実線である場合も、同様の方法により道路形状パラメータを推定することが可能である。この場合、車線区分線が途切れることなく常に遠方から見えているため、毎フレームが区間として認識されることになる。また、カーブ路では、広角カメラで撮影しても、狭角カメラで撮影したときと同じように道路曲率に応じて曲がった曲線として車線区分線を検出できるので、１フレームの画像でもすべての道路形状パラメータを推定することができる。したがって、区間毎に道路形状パラメータを推定する処理は、事実上フレーム毎に実行されることになる。
【００８３】
図１０は、道路形状推定装置の機能的構成例を示している。図１０の道路形状推定装置１００１は、区分線検出部１０１１、第１のパラメータ推定部１０１２、格納部１０１３、及び第２のパラメータ推定部１０１４を含む。
【００８４】
図１１は、図１０の道路形状推定装置１００１による道路形状推定処理の例を示すフローチャートである。まず、区分線検出部１０１１は、第１の時間区間内の１つ以上の時刻における道路の路面を撮影した画像から車線区分線のエッジ情報を検出する（ステップ１１０１）。次に、第１のパラメータ推定部１０１２は、ステップ１１０１において検出されたエッジ情報に基づいて、道路形状パラメータのうちの曲率及び幅を求め、格納部１０１３に格納する（ステップ１１０２）。
【００８５】
次に、区分線検出部１０１１は、第２の時間区間における画像から車線区分線のエッジ情報を検出する（ステップ１１０３）。第２のパラメータ推定部１０１４は、得られた曲率及び幅を第２の時間区間における曲率及び幅として用い、ステップ１１０３において検出されたエッジ情報に基づいて、曲率及び幅以外の道路形状パラメータを求める（ステップ１１０４）。そして、曲率及び幅を含む道路形状パラメータを出力する（ステップ１１０５）。
【００８６】
このような道路形状推定装置によれば、車線区分線が破線のカーブ路であっても、カメラの画角に依らずに道路の路面を撮影した画像から精度良く道路形状を推定することができる。
【００８７】
図１２は、道路形状推定装置の別の機能的構成例を示している。図１２の道路形状推定装置は、映像入力部１２０２、区分線検出部１２０３、第１のパラメータ推定部１２０４、格納部１２０５、及び第２のパラメータ推定部１２０６を含む。第１のパラメータ推定部１２０４は、区分線情報保存部１２１１、格納部１２１２、区間決定部１２１３、及び、曲率及び幅推定部１２１４を含む。
【００８８】
映像入力部１２０２は、外部のカメラ１２０１により撮影された映像を受け取り、区分線検出部１２０３に出力する。このとき、入力された映像がアナログ映像であればデジタル画像に変換し、カラー映像であればモノクロ濃淡画像に変換してから、区分線検出部１２０３に出力する。出力されるデジタル画像は、例えば、縦横にあらかじめ決められた大きさの２次元配列情報である。
【００８９】
区分線検出部１２０３は、入力されるデジタル画像から、路面上に存在する車線区分線を示す領域の境界線を構成するエッジ点群を検出し、そのエッジ点群の情報をエッジ情報としてパラメータ推定部１２０４及び１２０６に転送する。このとき、区分線検出部１２０３は、デジタル画像内で輝度値が急変する点をエッジ点として検出し、エッジ点の列を車線区分線の境界線として検出する。
【００９０】
パラメータ推定部１２０４の区分線情報保存部１２１１は、入力されたエッジ情報を格納部１２１２に格納する。区間決定部１２１３は、入力されたエッジ情報に基づいてエッジ点の位置を評価し、区間の完了（区間の切れ目）か否かを判定する。評価の結果、区間の完了が検出された場合、実行トリガを曲率及び幅推定部１２１４に出力し、区間の完了が検出されない場合は、実行トリガを出力しない。
【００９１】
曲率及び幅推定部１２１４は、実行トリガが入力された場合にのみ、格納部１２１２に格納された当該区間のエッジ情報から、区間の道路曲率及び道路幅を求め、得られた道路曲率及び道路幅を格納部１２０５に格納する。実行トリガが入力されない場合は、区間の道路曲率及び道路幅を求めない。
【００９２】
一方、パラメータ推定部１２０６は、入力されたエッジ情報と格納部１２０５に格納された道路曲率及び道路幅を用いて、残りの道路形状パラメータであるオフセット、ピッチ角、及びヨー角を求める。そして、道路形状パラメータを外部に出力し、ヨー角を格納部１２１２に格納する。
【００９３】
このような道路形状推定装置によれば、車線区分線が破線のカーブ路であっても、カメラの画角に依らずに道路の路面を撮影した画像から精度良く道路形状を推定することができる。特に、広角カメラを用いた場合でも、実線又は破線等の車線区分線の線種や、直線路又はカーブ路等の道路状態に影響されず、常に安定して道路形状を推定することができる。
【００９４】
図１３は、図１２の区分線検出部１２０３による区分線検出処理の例を示すフローチャートである。まず、区分線検出部１２０３は、入力されるデジタル画像に対してソベルオペレータ等の微分オペレータを適用し、輝度が急変するエッジ点の列からなるエッジ画像を生成する（ステップ１３０１）。例えば、図１４のようなデジタル画像からは、図１５のようなエッジ画像が生成される。
【００９５】
次に、エッジ画像内のあらかじめ路面領域として定めた探索範囲から、車線区分線の境界エッジ点を検出する（ステップ１３０２）。このとき、探索範囲に存在するエッジ点のうち、エッジ画像の左右の中央より左側にあるエッジ点を左側車線区分線のエッジ点とみなす。そして、そのエッジ点の左側の輝度が大きく（明るく）右側の輝度が低い（暗い）エッジ点を、左側車線区分線の境界エッジ点として検出する。また、探索範囲に存在するエッジ点のうち、エッジ画像の左右の中央より右側にあるエッジ点を右側車線区分線のエッジ点とみなす。そして、そのエッジ点の左側の輝度が小さく右側の輝度が大きいエッジ点を、右側車線区分線の境界エッジ点として検出する。
【００９６】
次に、得られた左側及び右側のそれぞれの境界エッジ点について、周囲画素の連結性を用いたラベル付け処理を行い、複数の境界エッジ点を統合して境界エッジ線を検出する（ステップ１３０３）。これにより、左側及び右側のそれぞれについて、１つ以上の境界エッジ線が得られる。例えば、図１５のエッジ画像の探索範囲１５０１からは、図１６のような左側の境界エッジ線１６０１と右側の境界エッジ線１６０２が検出される。
【００９７】
検出された左側の境界エッジ線の集合ＳＥＬは、次式のように記述される。
【数１９】
0005780140.tif 000020
【００９８】
ＥＬｉは、左側の境界エッジ線のうちｉ番目（ｉ＝１，２，．．．，ＮＥＬ）の境界エッジ線を表し、ＮＥＬは、左側の境界エッジ線の数を表す。同様に、右側の境界エッジ線の集合ＳＥＲは、次式のように記述される。
【００９９】
【数２０】
0005780140.tif 000021
【０１００】
ＥＲｉは、右側の境界エッジ線のうちｉ番目（ｉ＝１，２，．．．，ＮＥＬ）の境界エッジ線を表す。また、左側の境界エッジ線ＥＬｉは、ＮＰＬｉ個のエッジ点の列であり、次式のように記述される。
【０１０１】
【数２１】
0005780140.tif 000022
【０１０２】
ＰＬｉｊは、左側のｉ番目の境界エッジ線のｊ番目（ｊ＝１，２，．．．，ＮＰＬｉ）のエッジ点の画像座標（ｘＬｉｊ，ｙＬｉｊ）を表す。同様に、右側の境界エッジ線ＥＲｉは、ＮＰＲｉ個のエッジ点の列であり、次式のように記述される。
【０１０３】
【数２２】
0005780140.tif 000023
【０１０４】
ＰＲｉｊは、右側のｉ番目の境界エッジ線のｊ番目（ｊ＝１，２，．．．，ＮＰＲｉ）のエッジ点の画像座標（ｘＲｉｊ，ｙＲｉｊ）を表す。
【０１０５】
区分線情報保存部１２１１は、入力された境界エッジ線の集合ＳＥＬ及びＳＥＲを、格納部１２１２内の現在の区間におけるｍ番目のフレームに対応する格納領域にＳＥＬｍ及びＳＥＲｍとして格納する。
【０１０６】
【数２３】
0005780140.tif 000024
【０１０７】
そして、次のフレームの格納領域を指し示すように、ｍを１だけインクリメントする。なお、ｍの値は、道路形状推定装置の起動時に１に初期化されているものとする。
【０１０８】
区間決定部１２１３は、入力された境界エッジ線の集合ＳＥＬ及びＳＥＲを用いて、次のような操作により、区間の更新の有無を決定する。
【０１０９】
まず、以下のような２つの操作を定義する。ただし、図３に示したように、画像座標系のｙ軸は下向きが正である。
【０１１０】
ＧＥＴ＿ＴＯＰ（Ｓ）：＝｛集合Ｓに含まれる各境界エッジ線の上端のエッジ点のうち、最も上側にあるエッジ点のｙ座標を返す。集合Ｓが空であればＮＵＬＬを返す。｝
ＧＥＴ＿ＢＯＴＨ＿ＴＯＰ（Ｓ１，Ｓ２）：＝ＭＩＮ（ＧＥＴ＿ＴＯＰ（Ｓ１），ＧＥＴ＿ＴＯＰ（Ｓ２））
【０１１１】
図１７は、以上の操作を用いた区間決定処理の例を示すフローチャートである。まず、区間決定部１２１３は、左右の境界エッジ線のエッジ点のうち最も上側にあるエッジ点のｙ座標ＹＴＯＰを、次式により求める（ステップ１７０１）。
ＹＴＯＰ＝ＧＥＴ＿ＢＯＴＨ＿ＴＯＰ（ＳＥＬ，ＳＥＲ）
【０１１２】
ここで、画像から境界エッジ線がまったく検出されなかった場合、つまりＳＥＬ及びＳＥＲが空の場合は、ＹＴＯＰ＝ＮＵＬＬとする。
【０１１３】
次に、ＹＴＯＰがＮＵＬＬか否かをチェックする（ステップ１７０２）。ＹＴＯＰがＮＵＬＬであれば（ステップ１７０２，ＹＥＳ）、処理を終了する。ＹＴＯＰがＮＵＬＬでなければ（ステップ１７０２，ＮＯ）、ＹＴＯＰを、格納部１２１２に格納されたＹＴＯＰＬＡＳＴと比較する（ステップ１７０３）。ＹＴＯＰＬＡＳＴは、前回の区間決定処理で求められた評価したＹＴＯＰである。
【０１１４】
ＹＴＯＰがＹＴＯＰＬＡＳＴより小さければ（ステップ１７０３，ＹＥＳ）、検出された境界エッジ線が車両の手前で見切れて、次の境界エッジ線が遠方から見え始めたことが分かる。そこで、区間の更新が発生したと判断して、曲率及び幅推定部１２１４に実行トリガを出力する（ステップ１７０４）。ＹＴＯＰがＹＴＯＰＬＡＳＴ以上であれば（ステップ１７０３，ＮＯ）、実行トリガを出力しない。
【０１１５】
そして、ステップ１７０１で得られたＹＴＯＰによりＹＴＯＰＬＡＳＴを更新する（ステップ１７０５）。更新されたＹＴＯＰＬＡＳＴは、次回の区間決定処理で用いられる。
曲率及び幅推定部１２１４は、区間決定部１２１３から実行トリガを受け取ると、格納部１２１２に格納されている（ＳＥＬ１，ＳＥＲ１），（ＳＥＬ２，ＳＥＲ２），．．．，（ＳＥＬｍ，ＳＥＲｍ）から、区間内の道路曲率ρ＊及び道路幅Ｗ＊を推定し、格納部１２０５に格納する。そして、格納部１２１２内の境界エッジ線の集合を消去し、区間内のフレームの順番ｍの値を１に初期化する。
【０１１６】
区間内の道路曲率ρ＊及び道路幅Ｗ＊は、例えば、上述した式（２３）を用いて推定することができる。式（２３）の道路形状パラメータ（ρ＊，Ｗ＊，φｍ，Ａｅ，Ｂｅ，Ｃｅ，Ａθ，Ｂθ，Ｃθ）のうち、ピッチ角φｍは、パラメータ推定部１２０６によりフレーム毎に推定され格納部１２１２に格納されている値を用いることができる。したがって、ピッチ角φｍは求めるべきパラメータから除外され、求めるべきパラメータは（ρ＊，Ｗ＊，Ａｅ，Ｂｅ，Ｃｅ，Ａθ，Ｂθ，Ｃθ）の８個である。これらの８個のパラメータに対して式（２３）は線形であるから、式（２３）の右辺Ｆｊｍは、次式のように記述することができる。
【０１１７】
【数２４】
0005780140.tif 000025
【０１１８】
ここで、残差ｓｊｍを次式のように定義する。
【数２５】
0005780140.tif 000026
【０１１９】
総残差Ｓは、式（６１）の残差ｓｊｍを用いて式（２７）と同様に定義できる。最適パラメータはＳを最小にする値なので、Ｓを各パラメータで偏微分した結果を０と置く。例えば、Ｓをρ＊で偏微分した結果を０と置くと、次式が得られる。
【０１２０】
【数２６】
0005780140.tif 000027
【０１２１】
式（６３）のｊに関する総和記号は、ｊが１からＮｅまでの総和を表す。他のパラメータについても同様の偏微分操作を行うことで、８個の連立一次方程式が得られる。この連立一次方程式を解くことで、パラメータ（ρ＊，Ｗ＊，Ａｅ，Ｂｅ，Ｃｅ，Ａθ，Ｂθ，Ｃθ）が求められる。
【０１２２】
このような曲率及び幅推定処理の手順は、以下のようになる。
１．Ｒ１１＝Ｒ１２＝Ｒ１３＝Ｒ１４＝Ｒ１５＝Ｒ１６＝Ｒ１７＝Ｒ１８＝Ｒ１９＝０
Ｒ２１＝Ｒ２２＝Ｒ２３＝Ｒ２４＝Ｒ２５＝Ｒ２６＝Ｒ２７＝Ｒ２８＝Ｒ２９＝０
Ｒ３１＝Ｒ３２＝Ｒ３３＝Ｒ３４＝Ｒ３５＝Ｒ３６＝Ｒ３７＝Ｒ３８＝Ｒ３９＝０
Ｒ４１＝Ｒ４２＝Ｒ４３＝Ｒ４４＝Ｒ４５＝Ｒ４６＝Ｒ４７＝Ｒ４８＝Ｒ４９＝０
Ｒ５１＝Ｒ５２＝Ｒ５３＝Ｒ５４＝Ｒ５５＝Ｒ５６＝Ｒ５７＝Ｒ５８＝Ｒ５９＝０
Ｒ６１＝Ｒ６２＝Ｒ６３＝Ｒ６４＝Ｒ６５＝Ｒ６６＝Ｒ６７＝Ｒ６８＝Ｒ６９＝０
Ｒ７１＝Ｒ７２＝Ｒ７３＝Ｒ７４＝Ｒ７５＝Ｒ７６＝Ｒ７７＝Ｒ７８＝Ｒ７９＝０
Ｒ８１＝Ｒ８２＝Ｒ８３＝Ｒ８４＝Ｒ８５＝Ｒ８６＝Ｒ８７＝Ｒ８８＝Ｒ８９＝０
２．ｔｇｔ＝−１
３．ｔｇｔ＝ｔｇｔ＋１
４．ｉｆ  ｔｇｔ＝＝０  ｔｈｅｎ
エッジ集合Ｅ＝ＳＥＬｍ，ＮＥ＝ＳＥＬｍの要素数，ｋ＝−１
ｅｌｓｅ  ｉｆ  ｔｇｔ＝＝１  ｔｈｅｎ
エッジ集合Ｅ＝ＳＥＲｍ，ＮＥ＝ＳＥＲｍのエッジ数，ｋ＝１
ｅｌｓｅ  ｇｏｔｏ  １２  ｅｎｄｉｆ
５．ｊ＝０
６．ｊ＝ｊ＋１
７．ｉｆ  ｊ＞＝ＮＥ  ｔｈｅｎ  ｇｏｔｏ  ３  ｅｎｄｉｆ
８．エッジ集合Ｅからｊ番目の要素であるエッジ点の位置（ｘｊ，ｙｊ）を取得する。
９．式（４２）〜（５０）から（ａｊ，ｂｊ，ｃｊ，ｄｊ，ｅｊ，ｆｊ，ｇｊ，ｈｊ，ｑｊ）を算出する。
１０．Ｒ１１＋＝ａｊａｊ，Ｒ１２＋＝ａｊｂｊ，Ｒ１３＋＝ａｊｃｊ，Ｒ１４＋＝ａｊｄｊ，
Ｒ１５＋＝ａｊｅｊ，Ｒ１６＋＝ａｊｆｊ，Ｒ１７＋＝ａｊｇｊ，Ｒ１８＋＝ａｊｈｊ，
Ｒ１９＋＝ａｊｑｊ，
Ｒ２１＋＝ｂｊａｊ，Ｒ２２＋＝ｂｊｂｊ，Ｒ２３＋＝ｂｊｃｊ，Ｒ２４＋＝ｂｊｄｊ，
Ｒ２５＋＝ｂｊｅｊ，Ｒ２６＋＝ｂｊｆｊ，Ｒ２７＋＝ｂｊｇｊ，Ｒ２８＋＝ｂｊｈｊ，
Ｒ２９＋＝ｂｊｑｊ，
Ｒ３１＋＝ｃｊａｊ，Ｒ３２＋＝ｃｊｂｊ，Ｒ３３＋＝ｃｊｃｊ，Ｒ３４＋＝ｃｊｄｊ，
Ｒ３５＋＝ｃｊｅｊ，Ｒ３６＋＝ｃｊｆｊ，Ｒ３７＋＝ａｊｇｊ，Ｒ３８＋＝ｃｊｈｊ，
Ｒ３９＋＝ｃｊｑｊ，
Ｒ４１＋＝ｄｊａｊ，Ｒ４２＋＝ｄｊｂｊ，Ｒ４３＋＝ｄｊｃｊ，Ｒ４４＋＝ｄｊｄｊ，
Ｒ４５＋＝ｄｊｅｊ，Ｒ４６＋＝ｄｊｆｊ，Ｒ４７＋＝ｄｊｇｊ，Ｒ４８＋＝ｄｊｈｊ，
Ｒ４９＋＝ｄｊｑｊ，
Ｒ５１＋＝ｅｊａｊ，Ｒ５２＋＝ｅｊｂｊ，Ｒ５３＋＝ｅｊｃｊ，Ｒ５４＋＝ｅｊｄｊ，
Ｒ５５＋＝ｅｊｅｊ，Ｒ５６＋＝ｅｊｆｊ，Ｒ５７＋＝ｅｊｇｊ，Ｒ５８＋＝ｅｊｈｊ，
Ｒ５９＋＝ｅｊｑｊ，
Ｒ６１＋＝ｆｊａｊ，Ｒ６２＋＝ｆｊｂｊ，Ｒ６３＋＝ｆｊｃｊ，Ｒ６４＋＝ｆｊｄｊ，
Ｒ６５＋＝ｆｊｅｊ，Ｒ６６＋＝ｆｊｆｊ，Ｒ６７＋＝ｆｊｇｊ，Ｒ６８＋＝ｆｊｈｊ，
Ｒ６９＋＝ｆｊｑｊ，
Ｒ７１＋＝ｇｊａｊ，Ｒ７２＋＝ｇｊｂｊ，Ｒ７３＋＝ｇｊｃｊ，Ｒ７４＋＝ｇｊｄｊ，
Ｒ７５＋＝ｇｊｅｊ，Ｒ７６＋＝ｇｊｆｊ，Ｒ７７＋＝ｇｊｇｊ，Ｒ７８＋＝ｇｊｈｊ，
Ｒ７９＋＝ｇｊｑｊ，
Ｒ８１＋＝ｑｊａｊ，Ｒ８２＋＝ｑｊｂｊ，Ｒ８３＋＝ｑｊｃｊ，Ｒ８４＋＝ｑｊｄｊ，
Ｒ８５＋＝ｑｊｅｊ，Ｒ８６＋＝ｑｊｆｊ，Ｒ８７＋＝ｑｊｇｊ，Ｒ８８＋＝ｑｊｈｊ，
Ｒ８９＋＝ｑｊｑｊ
１１．ｇｏｔｏ  ６
１２．以下の連立方程式の解を数値計算により求める。
【数２７】
0005780140.tif 000028
１３．終了
【０１２３】
パラメータ推定部１２０６は、区分線検出部１２０３から入力されるＳＥＬ及びＳＥＲと格納部１２０５に格納されている道路曲率ρ＊及び道路幅Ｗ＊から、オフセットｅ、ピッチ角φ、及びヨー角θを求める。そして、ピッチ角φを、格納部１２１２内の現在の区間におけるｍ番目のフレームに対応する格納領域に格納し、道路曲率ρ＊、道路幅Ｗ＊、オフセットｅ、ピッチ角φ、及びヨー角θを外部に出力する。
【０１２４】
オフセットｅ、ピッチ角φ、及びヨー角θは、例えば、上述した式（９）を用いて推定することができる。式（９）の道路曲率ρ及び道路幅Ｗを一定値とみなしてρ＊及びＷ＊と書くと、次式が得られる。
【０１２５】
【数２８】
0005780140.tif 000029
【０１２６】
式（７１）の各記号の意味は以下の通りである。
（ｘｊ，ｙｊ）：現在のフレームから得られるｊ番目のエッジ点の座標
ｅ：現在のフレームにおけるオフセット
θ：現在のフレームにおけるヨー角
φ：現在のフレームにおけるピッチ角
【０１２７】
式（７１）のパラメータは（φ，ｅ，θ）の３個である。ここで、式（７１）の右辺をＫ（φ，ｅ，θ）と記し、各パラメータを以下のように記す。
【０１２８】
【数２９】
0005780140.tif 000030
【０１２９】
（φ０，ｅ０，θ０）は初期値であり、前のフレームの処理により求められた値が初期値として用いられる。Ｋ（φ，ｅ，θ）は非線形関数であるが、これを式（７２）を用いて線形化した関数Ｊは、次式で与えられる。
【０１３０】
【数３０】
0005780140.tif 000031
【０１３１】
ここで、残差ｓｊを次式のように定義する。
【数３１】
0005780140.tif 000032
【０１３２】
残差ｓｊの二乗値を、フレーム内のすべての車線区分線上のエッジ点（ｊ＝１，２，．．．，Ｎｅ）で積分した結果の１／２を総残差Ｓとする。
【０１３３】
【数３２】
0005780140.tif 000033
【０１３４】
最適パラメータはＳを最小にする値なので、Ｓを各パラメータで偏微分した結果を０と置くと、次のような連立一次方程式が得られる。
【０１３５】
【数３３】
0005780140.tif 000034
【０１３６】
この連立一次方程式を解くことで、変化量を示すパラメータ（Δφ，Δｅ，Δθ）が求められる。そして、各パラメータの値が十分小さくなるまで、次式の代入操作を行って演算を繰り返す。
【０１３７】
【数３４】
0005780140.tif 000035
【０１３８】
このような繰り返し演算により、最終的な道路形状パラメータ（φ，ｅ，θ）が求められる。
【０１３９】
このような道路形状パラメータ推定処理の手順は、以下のようになる。
１．（φ０，ｅ０，θ０）を前のフレームの値に初期化する。
２．Ｒ１１＝Ｒ１２＝Ｒ１３＝Ｒ１４＝０
Ｒ２１＝Ｒ２２＝Ｒ２３＝Ｒ２４＝０
Ｒ３１＝Ｒ３２＝Ｒ３３＝Ｒ３４＝０
３．ｔｇｔ＝−１
４．ｔｇｔ＝ｔｇｔ＋１
５．ｉｆ  ｔｇｔ＝＝０  ｔｈｅｎ
エッジ集合Ｅ＝ＳＥＬ，ＮＥ＝ＳＥＬの要素数，ｋ＝−１
ｅｌｓｅ  ｉｆ  ｔｇｔ＝＝１  ｔｈｅｎ
エッジ集合Ｅ＝ＳＥＲ，ＮＥ＝ＳＥＲのエッジ数，ｋ＝１
ｅｌｓｅ  ｇｏｔｏ  １３  ｅｎｄｉｆ
６．ｊ＝０
７．ｊ＝ｊ＋１
８．ｉｆ  ｊ＞＝ＮＥ  ｔｈｅｎ  ｇｏｔｏ  ４  ｅｎｄｉｆ
９．エッジ集合Ｅからｊ番目の要素であるエッジ点の位置（ｘｊ，ｙｊ）を取得する。
１０．式（７３）及び（７５）から（ａｊ，ｂｊ，ｃｊ，ｄｊ）を算出する。
１１．Ｒ１１＋＝ａｊａｊ，Ｒ１２＋＝ａｊｂｊ，Ｒ１３＋＝ａｊｃｊ，Ｒ１４＋＝ａｊｄｊ，
Ｒ２１＋＝ｂｊａｊ，Ｒ２２＋＝ｂｊｂｊ，Ｒ２３＋＝ｂｊｃｊ，Ｒ２４＋＝ｂｊｄｊ，
Ｒ３１＋＝ｃｊａｊ，Ｒ３２＋＝ｃｊｂｊ，Ｒ３３＋＝ｃｊｃｊ，Ｒ３４＋＝ｃｊｄｊ
１２．ｇｏｔｏ  ７
１３．以下の連立方程式の解を数値計算により求める。
【数３５】
0005780140.tif 000036
１４．解の収束性を検査する。
ｉｆ  ｜Δφ｜＞ＴｈＲ  ｏｒ  ｜Δｅ｜＞ＴｈＲ  ｏｒ  ｜Δθ｜＞ＴｈＲ
ｔｈｅｎ
【数３６】
0005780140.tif 000037
ｇｏｔｏ  ２
ｅｌｓｅ
φ＝φ０，ｅ＝ｅ０，θ＝θ０
ｅｎｄｉｆ
１５．終了
ＴｈＲは解の収束性を評価するための微小な閾値である。
【０１４０】
図１２の道路形状推定装置では、区間の完了を検出する度に実行トリガを曲率及び幅推定部１２１４に出力しているが、所定数のフレームが入力される度に実行トリガを出力することも可能である。
【０１４１】
図１８は、このような道路形状推定装置の機能的構成例を示している。図１８の道路形状推定装置は、図１２のパラメータ推定部１２０６をパラメータ推定部１８０１に置き換えた構成を有し、パラメータ推定部１８０１は、図１２の区間決定部１２１３を区間フレームカウント部１８１１に置き換えた構成を有する。
【０１４２】
区間フレームカウント部１８１１は、区分線検出部１２０３からエッジ情報が入力される度にフレームカウンタの値ｍを１だけインクリメントし、ｍが所定値を超えたとき、実行トリガを曲率及び幅推定部１２１４に出力し、ｍを１に初期化する。ｍが所定値を超えていなければ、実行トリガを出力しない。この場合、フレームカウンタの初期値に対応する時刻から所定値を超えた時刻までの時間が区間として認識される。道路形状推定装置の他の動作は、図１２の場合と同様である。
【０１４３】
図１２及び図１８の曲率及び幅推定部１２１４では、オフセットｅｍ及びヨー角θｍの拘束条件として等加速度運動モデルを用いているが、代わりに等速運動モデルを用いていることも可能である。この場合、オフセットｅｍ及びヨー角θｍについては、それぞれ等速度運動を仮定して、次式で近似する。
【０１４４】
【数３７】
0005780140.tif 000038
【０１４５】
式（８１）において、Ａｅ及びＢｅは、オフセットｅｍの等速度運動パラメータであり、Ａθ及びＢθは、ヨー角θｍの等速度運動パラメータである。このとき、式（２１）は、次式のように書き改められる。
【０１４６】
【数３８】
0005780140.tif 000039
【０１４７】
式（８２）の道路形状パラメータ（ρ＊，Ｗ＊，φｍ，Ａｅ，Ｂｅ，Ａθ，Ｂθ）のうち、ピッチ角φｍは求めるべきパラメータから除外され、求めるべきパラメータは（ρ＊，Ｗ＊，Ａｅ，Ｂｅ，Ａθ，Ｂθ）の６個である。これらの６個のパラメータに対して式（８２）は線形であるから、式（８２）の右辺Ｆｊｍは、次式のように記述することができる。
【０１４８】
【数３９】
0005780140.tif 000040
【０１４９】
ここで、残差ｓｊｍを次式のように定義する。
【数４０】
0005780140.tif 000041
【０１５０】
総残差Ｓは、式（１０１）の残差ｓｊｍを用いて式（２７）と同様に定義できる。最適パラメータはＳを最小にする値なので、Ｓを各パラメータで偏微分した結果を０と置く。例えば、Ｓをρ＊で偏微分した結果を０と置くと、次式が得られる。
【０１５１】
【数４１】
0005780140.tif 000042
【０１５２】
他のパラメータについても同様の偏微分操作を行うことで、６個の連立一次方程式が得られる。この連立一次方程式を解くことで、パラメータ（ρ＊，Ｗ＊，Ａｅ，Ｂｅ，Ａθ，Ｂθ）が求められる。
【０１５３】
このような曲率及び幅推定処理の手順は、以下のようになる。
１．Ｒ１１＝Ｒ１２＝Ｒ１３＝Ｒ１４＝Ｒ１５＝Ｒ１６＝Ｒ１７＝０
Ｒ２１＝Ｒ２２＝Ｒ２３＝Ｒ２４＝Ｒ２５＝Ｒ２６＝Ｒ２７＝０
Ｒ３１＝Ｒ３２＝Ｒ３３＝Ｒ３４＝Ｒ３５＝Ｒ３６＝Ｒ３７＝０
Ｒ４１＝Ｒ４２＝Ｒ４３＝Ｒ４４＝Ｒ４５＝Ｒ４６＝Ｒ４７＝０
Ｒ５１＝Ｒ５２＝Ｒ５３＝Ｒ５４＝Ｒ５５＝Ｒ５６＝Ｒ５７＝０
Ｒ６１＝Ｒ６２＝Ｒ６３＝Ｒ６４＝Ｒ６５＝Ｒ６６＝Ｒ６７＝０
２．ｔｇｔ＝−１
３．ｔｇｔ＝ｔｇｔ＋１
４．ｉｆ  ｔｇｔ＝＝０  ｔｈｅｎ
エッジ集合Ｅ＝ＳＥＬｍ，ＮＥ＝ＳＥＬｍの要素数，ｋ＝−１
ｅｌｓｅ  ｉｆ  ｔｇｔ＝＝１  ｔｈｅｎ
エッジ集合Ｅ＝ＳＥＲｍ，ＮＥ＝ＳＥＲｍのエッジ数，ｋ＝１
ｅｌｓｅ  ｇｏｔｏ  １２  ｅｎｄｉｆ
５．ｊ＝０
６．ｊ＝ｊ＋１
７．ｉｆ  ｊ＞＝ＮＥ  ｔｈｅｎ  ｇｏｔｏ  ３  ｅｎｄｉｆ
８．エッジ集合Ｅからｊ番目の要素であるエッジ点の位置（ｘｊ，ｙｊ）を取得する。
９．式（８４）〜（９０）から（ａｊ，ｂｊ，ｃｊ，ｄｊ，ｅｊ，ｆｊ，ｑｊ）を算出する。
１０．Ｒ１１＋＝ａｊａｊ，Ｒ１２＋＝ａｊｂｊ，Ｒ１３＋＝ａｊｃｊ，Ｒ１４＋＝ａｊｄｊ，
Ｒ１５＋＝ａｊｅｊ，Ｒ１６＋＝ａｊｆｊ，Ｒ１７＋＝ａｊｑｊ，
Ｒ２１＋＝ｂｊａｊ，Ｒ２２＋＝ｂｊｂｊ，Ｒ２３＋＝ｂｊｃｊ，Ｒ２４＋＝ｂｊｄｊ，
Ｒ２５＋＝ｂｊｅｊ，Ｒ２６＋＝ｂｊｆｊ，Ｒ２７＋＝ｂｊｑｊ，
Ｒ３１＋＝ｃｊａｊ，Ｒ３２＋＝ｃｊｂｊ，Ｒ３３＋＝ｃｊｃｊ，Ｒ３４＋＝ｃｊｄｊ，
Ｒ３５＋＝ｃｊｅｊ，Ｒ３６＋＝ｃｊｆｊ，Ｒ３７＋＝ｃｊｑｊ，
Ｒ４１＋＝ｄｊａｊ，Ｒ４２＋＝ｄｊｂｊ，Ｒ４３＋＝ｄｊｃｊ，Ｒ４４＋＝ｄｊｄｊ，
Ｒ４５＋＝ｄｊｅｊ，Ｒ４６＋＝ｄｊｆｊ，Ｒ４７＋＝ｄｊｑｊ，
Ｒ５１＋＝ｅｊａｊ，Ｒ５２＋＝ｅｊｂｊ，Ｒ５３＋＝ｅｊｃｊ，Ｒ５４＋＝ｅｊｄｊ，
Ｒ５５＋＝ｅｊｅｊ，Ｒ５６＋＝ｅｊｆｊ，Ｒ５７＋＝ｅｊｑｊ，
Ｒ６１＋＝ｆｊａｊ，Ｒ６２＋＝ｆｊｂｊ，Ｒ６３＋＝ｆｊｃｊ，Ｒ６４＋＝ｆｊｄｊ，
Ｒ６５＋＝ｆｊｅｊ，Ｒ６６＋＝ｆｊｆｊ，Ｒ６７＋＝ｆｊｑｊ
１１．ｇｏｔｏ  ６
１２．以下の連立方程式の解を数値計算により求める。
【数４２】
0005780140.tif 000043
１３．終了
【０１５４】
ところで、オフセットｅｍ及びヨー角θｍに加えて、ピッチ角φｍにも拘束条件を設けることが可能である。ここでは、ピッチ角φｍに対して、時間に関する３次の項までを含む高次運動を仮定する。この場合、以下に示すように、式（２２）にピッチ角φｍの近似式が追加される。
【０１５５】
【数４３】
0005780140.tif 000044
【０１５６】
式（１１１）において、Ａｅ、Ｂｅ、及びＣｅは、オフセットｅｍの等加速度運動パラメータであり、Ａθ、Ｂθ、及びＣθは、ヨー角θｍの等加速度運動パラメータである。また、Ａφ、Ｂφ、Ｃφ、及びＤφは、ピッチ角φｍの高次運動パラメータである。このとき、式（２１）は、次式のように書き改められる。
【０１５７】
【数４４】
0005780140.tif 000045
【０１５８】
式（１１２）における道路形状パラメータは（ρ＊，Ｗ＊，Ａφ，Ｂφ，Ｃφ，Ｄφ，Ａｅ，Ｂｅ，Ｃｅ，Ａθ，Ｂθ，Ｃθ）であり、区間内におけるパラメータの数は１２である。ここで、式（１１２）の右辺をＦｊｍ（ρ＊，Ｗ＊，Ａφ，Ｂφ，Ｃφ，Ｄφ，Ａｅ，Ｂｅ，Ｃｅ，Ａθ，Ｂθ，Ｃθ）と記し、各パラメータを以下のように記す。
【０１５９】
【数４５】
0005780140.tif 000046
【０１６０】
Ｆｊｍ（ρ＊，Ｗ＊，Ａφ，Ｂφ，Ｃφ，Ｄφ，Ａｅ，Ｂｅ，Ｃｅ，Ａθ，Ｂθ，Ｃθ）は非線形関数であるが、これを式（１１３）を用いて線形化した関数Ｇｊｍは、次式で与えられる。
【０１６１】
【数４６】
0005780140.tif 000047
0005780140.tif 000048
【０１６２】
ここで、残差ｓｊｍを次式のように定義する。
【数４７】
0005780140.tif 000049
【０１６３】
総残差Ｓは、式（１１５）の残差ｓｊｍを用いて式（２７）と同様に定義できる。最適パラメータはＳを最小にする値なので、Ｓを各パラメータで偏微分した結果を０と置く。例えば、Ｓをρ＊で偏微分した結果を０と置くと、次式が得られる。
【０１６４】
【数４８】
0005780140.tif 000050
【０１６５】
他のパラメータについても同様の偏微分操作を行うことで、１２個の連立一次方程式が得られる。この連立一次方程式を解くことで、変化量を示すパラメータ（Δρ＊，ΔＷ＊，ΔＡφ，ΔＢφ，ΔＣφ，ΔＤφ，ΔＡｅ，ΔＢｅ，ΔＣｅ，ΔＡθ，ΔＢθ，ΔＣθ）が求められる。そして、各パラメータの値が十分小さくなるまで、次式の代入操作を行って演算を繰り返す。
【０１６６】
【数４９】
0005780140.tif 000051
【０１６７】
このような繰り返し演算により、最終的な道路形状パラメータ（ρ＊，Ｗ＊，Ａφ，Ｂφ，Ｃφ，Ｄφ，Ａｅ，Ｂｅ，Ｃｅ，Ａθ，Ｂθ，Ｃθ）が求められる。
【０１６８】
このような曲率及び幅推定処理の手順は、以下のようになる。
１．（ρ＊０，Ｗ＊０，Ａφ０，Ｂφ０，Ｃφ０，Ｄφ０，Ａｅ０，Ｂｅ０，Ｃｅ０，Ａθ０，Ｂθ０，Ｃθ０）を前のフレームの値に初期化する。
２．Ｒ０１０１＝Ｒ０１０２＝Ｒ０１０３＝Ｒ０１０４＝Ｒ０１０５
＝Ｒ０１０６＝Ｒ０１０７＝Ｒ０１０８＝Ｒ０１０９＝Ｒ０１１０
＝Ｒ０１１１＝Ｒ０１１２＝０Ｒ１１３＝０
Ｒ０２０１＝Ｒ０２０２＝Ｒ０２０３＝Ｒ０２０４＝Ｒ０２０５
＝Ｒ０２０６＝Ｒ０２０７＝Ｒ０２０８＝Ｒ０２０９＝Ｒ０２１０
＝Ｒ０２１１＝Ｒ０２１２＝Ｒ０２１３＝０
Ｒ０３０１＝Ｒ０３０２＝Ｒ０３０３＝Ｒ０３０４＝Ｒ０３０５
＝Ｒ０３０６＝Ｒ０３０７＝Ｒ０３０８＝Ｒ０３０９＝Ｒ０３１０
＝Ｒ０３１１＝Ｒ０３１２＝Ｒ０３１３＝０
Ｒ０４０１＝Ｒ０４０２＝Ｒ０４０３＝Ｒ０４０４＝Ｒ０４０５
＝Ｒ０４０６＝Ｒ０４０７＝Ｒ０４０８＝Ｒ０４０９＝Ｒ０４１０
＝Ｒ０４１１＝Ｒ０４１２＝Ｒ０４１３＝０
Ｒ０５０１＝Ｒ０５０２＝Ｒ０５０３＝Ｒ０５０４＝Ｒ０５０５
＝Ｒ０５０６＝Ｒ０５０７＝Ｒ０５０８＝Ｒ０５０９＝Ｒ０５１０
＝Ｒ０５１１＝Ｒ０５１２＝Ｒ０５１３＝０
Ｒ０６０１＝Ｒ０６０２＝Ｒ０６０３＝Ｒ０６０４＝Ｒ０６０５
＝Ｒ０６０６＝Ｒ０６０７＝Ｒ０６０８＝Ｒ０６０９＝Ｒ０６１０
＝Ｒ０６１１＝Ｒ０６１２＝Ｒ０６１３＝０
Ｒ０７０１＝Ｒ０７０２＝Ｒ０７０３＝Ｒ０７０４＝Ｒ０７０５
＝Ｒ０７０６＝Ｒ０７０７＝Ｒ０７０８＝Ｒ０７０９＝Ｒ０７１０
＝Ｒ０７１１＝Ｒ０７１２＝Ｒ０７１３＝０
Ｒ０８０１＝Ｒ０８０２＝Ｒ０８０３＝Ｒ０８０４＝Ｒ０８０５
＝Ｒ０８０６＝Ｒ０８０７＝Ｒ０８０８＝Ｒ０８０９＝Ｒ０８１０
＝Ｒ０８１１＝Ｒ０８１２＝Ｒ０８１３＝０
Ｒ０９０１＝Ｒ０９０２＝Ｒ０９０３＝Ｒ０９０４＝Ｒ０９０５
＝Ｒ０９０６＝Ｒ０９０７＝Ｒ０９０８＝Ｒ０９０９＝Ｒ０９１０
＝Ｒ０９１１＝Ｒ０９１２＝Ｒ０９１３＝０
Ｒ１００１＝Ｒ１００２＝Ｒ１００３＝Ｒ１００４＝Ｒ１００５
＝Ｒ１００６＝Ｒ１００７＝Ｒ１００８＝Ｒ１００９＝Ｒ１０１０
＝Ｒ１０１１＝Ｒ１０１２＝Ｒ１０１３＝０
Ｒ１１０１＝Ｒ１１０２＝Ｒ１１０３＝Ｒ１１０４＝Ｒ１１０５
＝Ｒ１１０６＝Ｒ１１０７＝Ｒ１１０８＝Ｒ１１０９＝Ｒ１１１０
＝Ｒ１１１１＝Ｒ１１１２＝Ｒ１１１３＝０
Ｒ１２０１＝Ｒ１２０２＝Ｒ１２０３＝Ｒ１２０４＝Ｒ１２０５
＝Ｒ１２０６＝Ｒ１２０７＝Ｒ１２０８＝Ｒ１２０９＝Ｒ１２１０
＝Ｒ１２１１＝Ｒ１２１２＝Ｒ１２１３＝０
３．ｔｇｔ＝−１
４．ｔｇｔ＝ｔｇｔ＋１
５．ｉｆ  ｔｇｔ＝＝０  ｔｈｅｎ
エッジ集合Ｅ＝ＳＥＬｍ，ＮＥ＝ＳＥＬｍの要素数，ｋ＝−１
ｅｌｓｅ  ｉｆ  ｔｇｔ＝＝１  ｔｈｅｎ
エッジ集合Ｅ＝ＳＥＲｍ，ＮＥ＝ＳＥＲｍのエッジ数，ｋ＝１
ｅｌｓｅ  ｇｏｔｏ  １３  ｅｎｄｉｆ
６．ｊ＝０
７．ｊ＝ｊ＋１
８．ｉｆ  ｊ＞＝ＮＥ  ｔｈｅｎ  ｇｏｔｏ  ４  ｅｎｄｉｆ
９．エッジ集合Ｅからｊ番目の要素であるエッジ点の位置（ｘｊ，ｙｊ）を取得する。
１０．式（１１４）及び（１１６）から（ａｊ，ｂｊ，ｃｊ，ｄｊ，ｅｊ，ｆｊ，ｇｊ，ｈｊ，ｍｊ，ｎｊ，ｏｊ，ｐｊ，ｑｊ）を算出する。
１１．Ｒ０１０１＋＝ａｊａｊ，Ｒ０１０２＋＝ａｊｂｊ，Ｒ０１０３＋＝ａｊｃｊ，
Ｒ０１０４＋＝ａｊｄｊ，Ｒ０１０５＋＝ａｊｅｊ，Ｒ０１０６＋＝ａｊｆｊ，
Ｒ０１０７＋＝ａｊｇｊ，Ｒ０１０８＋＝ａｊｈｊ，Ｒ０１０９＋＝ａｊｍｊ，
Ｒ０１１０＋＝ａｊｎｊ，Ｒ０１１１＋＝ａｊｏｊ，Ｒ０１１２＋＝ａｊｐｊ，
Ｒ０１１３＋＝ａｊｑｊ，
Ｒ０２０１＋＝ｂｊａｊ，Ｒ０２０２＋＝ｂｊｂｊ，Ｒ０２０３＋＝ｂｊｃｊ，
Ｒ０２０４＋＝ｂｊｄｊ，Ｒ０２０５＋＝ｂｊｅｊ，Ｒ０２０６＋＝ｂｊｆｊ，
Ｒ０２０７＋＝ｂｊｇｊ，Ｒ０２０８＋＝ｂｊｈｊ，Ｒ０２０９＋＝ｂｊｍｊ，
Ｒ０２１０＋＝ｂｊｎｊ，Ｒ０２１１＋＝ｂｊｏｊ，Ｒ０２１２＋＝ｂｊｐｊ，
Ｒ０２１３＋＝ｂｊｑｊ，
Ｒ０３０１＋＝ｃｊａｊ，Ｒ０３０２＋＝ｃｊｂｊ，Ｒ０３０３＋＝ｃｊｃｊ，
Ｒ０３０４＋＝ｃｊｄｊ，Ｒ０３０５＋＝ｃｊｅｊ，Ｒ０３０６＋＝ｃｊｆｊ，
Ｒ０３０７＋＝ｃｊｇｊ，Ｒ０３０８＋＝ｃｊｈｊ，Ｒ０３０９＋＝ｃｊｍｊ，
Ｒ０３１０＋＝ｃｊｎｊ，Ｒ０３１１＋＝ｃｊｏｊ，Ｒ０３１２＋＝ｃｊｐｊ，
Ｒ０３１３＋＝ｃｊｑｊ，
Ｒ０４０１＋＝ｄｊａｊ，Ｒ０４０２＋＝ｄｊｂｊ，Ｒ０４０３＋＝ｄｊｃｊ，
Ｒ０４０４＋＝ｄｊｄｊ，Ｒ０４０５＋＝ｄｊｅｊ，Ｒ０４０６＋＝ｄｊｆｊ，
Ｒ０４０７＋＝ｄｊｇｊ，Ｒ０４０８＋＝ｄｊｈｊ，Ｒ０４０９＋＝ｄｊｍｊ，
Ｒ０４１０＋＝ｄｊｎｊ，Ｒ０４１１＋＝ｄｊｏｊ，Ｒ０４１２＋＝ｄｊｐｊ，
Ｒ０４１３＋＝ｄｊｑｊ，
Ｒ０５０１＋＝ｅｊａｊ，Ｒ０５０２＋＝ｅｊｂｊ，Ｒ０５０３＋＝ｅｊｃｊ，
Ｒ０５０４＋＝ｅｊｄｊ，Ｒ０５０５＋＝ｅｊｅｊ，Ｒ０５０６＋＝ｅｊｆｊ，
Ｒ０５０７＋＝ｅｊｇｊ，Ｒ０５０８＋＝ｅｊｈｊ，Ｒ０５０９＋＝ｅｊｍｊ，
Ｒ０５１０＋＝ｅｊｎｊ，Ｒ０５１１＋＝ｅｊｏｊ，Ｒ０５１２＋＝ｅｊｐｊ，
Ｒ０５１３＋＝ｅｊｑｊ，
Ｒ０６０１＋＝ｆｊａｊ，Ｒ０６０２＋＝ｆｊｂｊ，Ｒ０６０３＋＝ｆｊｃｊ，
Ｒ０６０４＋＝ｆｊｄｊ，Ｒ０６０５＋＝ｆｊｅｊ，Ｒ０６０６＋＝ｆｊｆｊ，
Ｒ０６０７＋＝ｆｊｇｊ，Ｒ０６０８＋＝ｆｊｈｊ，Ｒ０６０９＋＝ｆｊｍｊ，
Ｒ０６１０＋＝ｆｊｎｊ，Ｒ０６１１＋＝ｆｊｏｊ，Ｒ０６１２＋＝ｆｊｐｊ，
Ｒ０６１３＋＝ｆｊｑｊ，
Ｒ０７０１＋＝ｇｊａｊ，Ｒ０７０２＋＝ｇｊｂｊ，Ｒ０７０３＋＝ｇｊｃｊ，
Ｒ０７０４＋＝ｇｊｄｊ，Ｒ０７０５＋＝ｇｊｅｊ，Ｒ０７０６＋＝ｇｊｆｊ，
Ｒ０７０７＋＝ｇｊｇｊ，Ｒ０７０８＋＝ｇｊｈｊ，Ｒ０７０９＋＝ｇｊｍｊ，
Ｒ０７１０＋＝ｇｊｎｊ，Ｒ０７１１＋＝ｇｊｏｊ，Ｒ０７１２＋＝ｇｊｐｊ，
Ｒ０７１３＋＝ｇｊｑｊ，
Ｒ０８０１＋＝ｈｊａｊ，Ｒ０８０２＋＝ｈｊｂｊ，Ｒ０８０３＋＝ｈｊｃｊ，
Ｒ０８０４＋＝ｈｊｄｊ，Ｒ０８０５＋＝ｈｊｅｊ，Ｒ０８０６＋＝ｈｊｆｊ，
Ｒ０８０７＋＝ｈｊｇｊ，Ｒ０８０８＋＝ｈｊｈｊ，Ｒ０８０９＋＝ｈｊｍｊ，
Ｒ０８１０＋＝ｈｊｎｊ，Ｒ０８１１＋＝ｈｊｏｊ，Ｒ０８１２＋＝ｈｊｐｊ，
Ｒ０８１３＋＝ｈｊｑｊ，
Ｒ０９０１＋＝ｍｊａｊ，Ｒ０９０２＋＝ｍｊｂｊ，Ｒ０９０３＋＝ｍｊｃｊ，
Ｒ０９０４＋＝ｍｊｄｊ，Ｒ０９０５＋＝ｍｊｅｊ，Ｒ０９０６＋＝ｍｊｆｊ，
Ｒ０９０７＋＝ｍｊｇｊ，Ｒ０９０８＋＝ｍｊｈｊ，Ｒ０９０９＋＝ｍｊｍｊ，
Ｒ０９１０＋＝ｍｊｎｊ，Ｒ０９１１＋＝ｍｊｏｊ，Ｒ０９１２＋＝ｍｊｐｊ，
Ｒ０９１３＋＝ｍｊｑｊ，
Ｒ１００１＋＝ｎｊａｊ，Ｒ１００２＋＝ｎｊｂｊ，Ｒ１００３＋＝ｎｊｃｊ，
Ｒ１００４＋＝ｎｊｄｊ，Ｒ１００５＋＝ｎｊｅｊ，Ｒ１００６＋＝ｎｊｆｊ，
Ｒ１００７＋＝ｎｊｇｊ，Ｒ１００８＋＝ｎｊｈｊ，Ｒ１００９＋＝ｎｊｍｊ，
Ｒ１０１０＋＝ｎｊｎｊ，Ｒ１０１１＋＝ｎｊｏｊ，Ｒ１０１２＋＝ｎｊｐｊ，
Ｒ１０１３＋＝ｎｊｑｊ，
Ｒ１１０１＋＝ｏｊａｊ，Ｒ１１０２＋＝ｏｊｂｊ，Ｒ１１０３＋＝ｏｊｃｊ，
Ｒ１１０４＋＝ｏｊｄｊ，Ｒ１１０５＋＝ｏｊｅｊ，Ｒ１１０６＋＝ｏｊｆｊ，
Ｒ１１０７＋＝ｏｊｇｊ，Ｒ１１０８＋＝ｏｊｈｊ，Ｒ１１０９＋＝ｏｊｍｊ，
Ｒ１１１０＋＝ｏｊｎｊ，Ｒ１１１１＋＝ｏｊｏｊ，Ｒ１１１２＋＝ｏｊｐｊ，
Ｒ１１１３＋＝ｏｊｑｊ，
Ｒ１２０１＋＝ｐｊａｊ，Ｒ１２０２＋＝ｐｊｂｊ，Ｒ１２０３＋＝ｐｊｃｊ，
Ｒ１２０４＋＝ｐｊｄｊ，Ｒ１２０５＋＝ｐｊｅｊ，Ｒ１２０６＋＝ｐｊｆｊ，
Ｒ１２０７＋＝ｐｊｇｊ，Ｒ１２０８＋＝ｐｊｈｊ，Ｒ１２０９＋＝ｐｊｍｊ，
Ｒ１２１０＋＝ｐｊｎｊ，Ｒ１２１１＋＝ｐｊｏｊ，Ｒ１２１２＋＝ｐｊｐｊ，
Ｒ１２１３＋＝ｐｊｑｊ
１２．ｇｏｔｏ  ７
１３．以下の連立方程式の解を数値計算により求める。
【数５０】
0005780140.tif 000052
１４．解の収束性を検査する。
ｉｆ  ｜Δρ＊０｜＞ＴｈＲ  ｏｒ  ｜ΔＷ＊０｜＞ＴｈＲ  ｏｒ
｜ΔＡφ０｜＞ＴｈＲ  ｏｒ  ｜ΔＢφ０｜＞ＴｈＲ  ｏｒ
｜ΔＣφ０｜＞ＴｈＲ  ｏｒ  ｜ΔＤφ０｜＞ＴｈＲ  ｏｒ
｜ΔＡｅ０｜＞ＴｈＲ  ｏｒ  ｜ΔＢｅ０｜＞ＴｈＲ  ｏｒ
｜ΔＣｅ０｜＞ＴｈＲ  ｏｒ  ｜ΔＡθ０｜＞ＴｈＲ  ｏｒ
｜ΔＢθ０｜＞ＴｈＲ  ｏｒ  ｜ΔＣθ０｜＞ＴｈＲ
ｔｈｅｎ
【数５１】
0005780140.tif 000053
ｇｏｔｏ  ２
ｅｌｓｅ
ρ＊＝ρ＊０，Ｗ＊＝Ｗ＊０，
Ａφ＝Ａφ０，Ｂφ＝Ｂφ０，Ｃφ＝Ｃφ０，Ｄφ＝Ｄφ０，
Ａｅ＝Ａｅ０，Ｂｅ＝Ｂｅ０，Ｃｅ＝Ｃｅ０，
Ａθ＝Ａθ０，Ｂθ＝Ｂθ０，Ｃθ＝Ｃθ０
ｅｎｄｉｆ
１５．終了
ＴｈＲは解の収束性を評価するための微小な閾値である。
【０１６９】
なお、オフセットｅｍ及びヨー角θｍに対して等速運動を仮定してもよく、ピッチ角φｍに対して時間に関するより高次の項までを含む高次運動を仮定してもよい。
【０１７０】
以上説明した道路形状パラメータの計算式（１）〜（１１９）は一例に過ぎず、別の座標系、別の拘束条件等に基づいて異なる定式化を行っても構わない。
【０１７１】
図１９は、道路形状推定装置を用いた車線逸脱警報システムの構成例を示している。図１９の車線逸脱警報システムは、カメラ１２０１、道路形状推定装置１９０１、距離計算装置１９０２、逸脱判定装置１９０３、及び逸脱警報装置１９０４を含む。道路形状推定装置１９０１の動作は上述した通りである。
【０１７２】
距離計算装置１９０２は、道路形状推定装置１９０１から出力される道路形状パラメータに基づいて、車両と左右の車線区分線との距離を計算する。逸脱判定装置１９０３は、計算された距離を閾値と比較して、車両が車線を逸脱したか否かを判定する。逸脱警報装置１９０４は、車両が車線を逸脱した場合に警報を出力する。これにより、運転者は、直ちに車両を操舵して車線に戻すことが可能になる。
【０１７３】
図２０は、道路形状推定装置を用いた車両操舵システムの構成例を示している。図２０の車両操舵システムは、カメラ１２０１、道路形状推定装置１９０１、距離計算装置１９０２、ふらつき判定装置２００１、及び車両操舵装置２００２を含む。
【０１７４】
ふらつき判定装置２００１は、距離計算装置１９０２により計算された距離を閾値と比較して、車両がふらついているか否かを判定する。車両操舵装置２００２は、車両がふらついている場合に、車線上での走行を維持するように車両を自動操舵して、車両のふらつきを解消する。これにより、車線からの逸脱を未然に防止することが可能になる。
【０１７５】
図１０、図１２、及び図１８−図２０の道路形状推定装置は、例えば、図２１に示すような情報処理装置（コンピュータ）を用いて実現可能である。
【０１７６】
図２１の情報処理装置は、映像入力部１２０２、Central Processing Unit （ＣＰＵ）２１０１、メモリ２１０２、出力部２１０３、外部記憶装置２１０４、媒体駆動装置２１０５、及びネットワーク接続装置２１０６を備える。これらはバス２１０７により互いに接続されている。
【０１７７】
メモリ２１０２は、例えば、Read Only Memory（ＲＯＭ）、Random Access Memory（ＲＡＭ）、フラッシュメモリ等の半導体メモリであり、処理に用いられるプログラム及びデータを格納する。例えば、ＣＰＵ２１０１は、メモリ２１０２を利用してプログラムを実行することにより、道路形状推定装置の処理を行う。メモリ２１０２は、図１０の格納部１０１３、又は図１２及び図１８の格納部１２０５及び１２１２としても使用できる。
【０１７８】
映像入力部１２０２は、カメラからの映像信号を取り込み、時系列な画像としてメモリ２１０２に格納する。出力部２１０３は、例えば、外部装置とのインタフェースであり、道路形状パラメータを含む処理結果の出力に用いられる。
【０１７９】
外部記憶装置２１０４は、例えば、磁気ディスク装置、光ディスク装置、光磁気ディスク装置、テープ装置等である。この外部記憶装置２１０４には、ハードディスクドライブも含まれる。情報処理装置は、外部記憶装置２１０４にプログラム及びデータを格納しておき、それらをメモリ２１０２にロードして使用することができる。
【０１８０】
媒体駆動装置２１０５は、可搬型記録媒体２１０８を駆動し、その記録内容にアクセスする。可搬型記録媒体２１０８は、メモリデバイス、フレキシブルディスク、光ディスク、光磁気ディスク等である。この可搬型記録媒体２１０８には、Compact Disk Read Only Memory （ＣＤ−ＲＯＭ）、Digital Versatile Disk（ＤＶＤ）、Universal Serial Bus（ＵＳＢ）メモリ等も含まれる。ユーザ又はオペレータは、この可搬型記録媒体２１０８にプログラム及びデータを格納しておき、それらをメモリ２１０２にロードして使用することができる。
【０１８１】
このように、各種処理に用いられるプログラム及びデータを格納するコンピュータ読み取り可能な記録媒体には、メモリ２１０２、外部記憶装置２１０４、及び可搬型記録媒体２１０８のような、物理的な（非一時的な）記録媒体が含まれる。
【０１８２】
ネットワーク接続装置２１０５は、通信ネットワークに接続され、通信に伴うデータ変換を行う通信インタフェースである。情報処理装置は、プログラム及びデータを外部の装置からネットワーク接続装置２１０５を介して受け取り、それらをメモリ２１０２にロードして使用することもできる。
【０１８３】
なお、情報処理装置が図２１のすべての構成要素を含む必要はなく、用途や条件に応じて一部の構成要素を省略することも可能である。例えば、情報処理装置が可搬型記録媒体２１０８にアクセスしない場合は、媒体駆動装置２１０５を省略してもよく、情報処理装置が通信ネットワークに接続されない場合は、ネットワーク接続装置２１０５を省略してもよい。
【０１８４】
開示の実施形態とその利点について詳しく説明したが、当業者は、特許請求の範囲に明確に記載した本発明の範囲から逸脱することなく、様々な変更、追加、省略をすることができるであろう。
【符号の説明】
【０１８５】
１０１、１０２  画像
１２１  矩形領域
１２２  黒色領域
３０１、３０２  破線ブロック
３１１、３１２、３２１、３２２、車線区分線
３３１、３３２  距離誤り
１００１、１９０１  道路形状推定装置
１０１１、１２０３  区分線検出部
１０１２、１２０４、１８０１  第１のパラメータ推定部
１０１３、１２０５、１２１２  格納部
１０１４、１２０６  第２のパラメータ推定部
１２０１  カメラ
１２０２  映像入力部
１２１１  区分線情報保存部
１２１３  区間決定部
１２１４  曲率及び幅推定部
１５０１  探索範囲
１６０１、１６０２  境界エッジ線
１８１１  区間フレームカウント部
１９０２  距離計算装置
１９０３  逸脱判定装置
１９０４  逸脱警報装置
２００１  ふらつき判定装置
２００２  車両操舵装置
２１０１  ＣＰＵ
２１０２  メモリ
２１０３  出力部
２１０４  外部記憶装置
２１０５  媒体駆動装置
２１０６  ネットワーク接続装置
２１０７  バス
２１０８  可搬型記録媒体
【図５】
0005780140.tif 000054
【図６】
0005780140.tif 000055
【図７】
0005780140.tif 000056
【図８】
0005780140.tif 000057
【図９】
0005780140.tif 000058
【図１０】
0005780140.tif 000059
【図１１】
0005780140.tif 000060
【図１２】
0005780140.tif 000061
【図１３】
0005780140.tif 000062
【図１９】
0005780140.tif 000063
【図２０】
0005780140.tif 000064
【図１】
0005780140.tif 000065
【図２】
0005780140.tif 000066
【図３】
0005780140.tif 000067
【図４】
0005780140.tif 000068
【図１４】
0005780140.tif 000069
【図１５】
0005780140.tif 000070
【図１６】
0005780140.tif 000071
【図１７】
0005780140.tif 000072
【図１８】
0005780140.tif 000073
【図２１】
0005780140.tif 000074