(57)【特許請求の範囲】
【請求項１】
路側に設置された道路監視用のセンサカメラと、このセンサカメラが検出したデータを処理する記憶機能および演算機能を有した路側処理装置とを具え、
位置検出可能な検出器を搭載した車両を道路線形基準線に沿って、センサカメラの視野内を走行させ、該センサカメラ視野内における、前記車両を表した位置データを該車両で検出するとともに、この位置データに対応して該車両を表した角度データを前記センサカメラで検出し、
これらの位置データおよび角度データの組合わせからなる所定組数の計測データを、前記路側処理装置に記憶させ、この路側処理装置は、これらの所定組数の計測データから、最小二乗法を用いて、校正用パラメータを求め、この校正用パラメータを、前記センサカメラの取付位置及び取付角度としていることを特徴とするセンサ検出位置と道路線形のマッチング方法。
【請求項２】
前記校正用パラメータは、前記センサカメラの取付位置座標および取付角度を表わしたそれぞれ１つの値をとる各定数（ｘｃ、ｙｃ、ｈｃ、θｃ、δｃ）からなり、
前記位置データは、前記車両の位置座標を表わした組ごとに異なる値をとる各変数（ｘｉ、ｙｉ、ｈｉ）からなり、前記角度データは、前記センサカメラから車両への角度を表わした組ごとに異なる値をとる各変数（θｉ、δｉ）からなり、前記計測データは、前記車両の位置および角度を表わした組ごとに異なる値をとる各変数（ｘｉ、ｙｉ、ｈｉ、θｉ、δｉ）からなり、
前記校正用パラメータと前記計測データとの関係を規定した所定式を設定し、
前記校正用パラメータは、前記所定式に各組の計測データを代入して、各組ごとに導き出される残差の二重和を、すべての組から総計したとき、この総和が最小となるように決定していることを特徴とする請求項１記載のセンサ検出位置と道路線形のマッチング方法。
【請求項３】
前記所定式に基づき、各組における残差の二重和を総和して評価する評価関数Ｒを導入し、この評価関数Ｒを、前記校正用パラメータの各定数（ｘｃ、ｙｃ、ｈｃ、θｃ、δｃ）で偏微分した式をそれぞれ０とした５本の連立方程式を立てて解くことにより、これらの各定数（ｘｃ、ｙｃ、ｈｃ、θｃ、δｃ）を決定していることを特徴とする請求項２に記載のセンサ検出位置と道路線形のマッチング方法。
【請求項４】
前記路側処理装置は、前記車両側で検出した車両の位置データを、道路線形データとして記憶することを特徴とする請求項１ないし３のいずれかに記載のセンサ検出位置と道路線形のマッチング方法。
【請求項５】
前記位置検出可能な検出器を搭載した車両は、ＧＰＳ搭載車であることを特徴とする請求項１ないし４のいずれかに記載のセンサ検出位置と道路線形のマッチング方法。
【請求項６】
前記校正用パラメータは、３個組数以上の計測データを用いて決定していることを特徴とする請求項１ないし５のいずれかに記載のセンサ検出位置と道路線形のマッチング方法。
【発明の詳細な説明】
【０００１】
【発明の属する技術分野】
本発明は、センサ検出位置と道路線形のマッチング方法に関し、詳しくは、正確な位置が特定できる目標物を検出した画像をもとにして、自己の取り付け位置及び角度を求めるセンサカメラの較正および道路線形データを入力する方法に関する。
【課題を解決するための手段】
【０００２】
【従来の技術】
従来、道路監視用のセンサカメラでは、そのセンサカメラを取り付けた時の取付位置及び角度の較正が必ず必要になる。また、このデータを使用して安全に関するサービスを行おうとすると、道路線形のデータを計算機内に記憶させておく必要がある。
【０００３】
従来のセンサカメラの較正方法を図２に示す。図２の上部がセンサカメラの取付状況を横から見た図であり、下図が上から見た図である。１がセンサカメラ、２が目標物、３が道路、４が道路線形データとして記憶する道路線形基準線である。従来のセンサカメラの較正方法は、絶対位置座標がわかっている道路上の３個の目標物をセンサカメラの視野に入れて、これを検出することにより、センサカメラの取付座標（ｘｃ、ｙｃ、ｈｃ）、取付角（θｃ、δｃ）を求めるものである。ただし、θｃが高さ方向取付角であり、δｃはｘｙ平面取付角である。
【０００４】
今、目標物が設置されている点をＰ１、Ｐ２、Ｐ３とし、各点の座標値を（ｘ１、ｙ１、ｈ１）、（ｘ２、ｙ２、ｈ２）、（ｘ３、ｙ３、ｈ３）、各点のセンサカメラでの検出角を（θ１、δ１）、（θ２、δ２）、（θ３、δ３）とすると、図２より、次の関係式が得られる。
【数１】
0003543116.tif 000002
求めたいのは、センサカメラ較正用パラメータ（ｘｃ、ｙｃ、ｈｃ、θｃ、δｃ）であり、上記６個の式の中から、５個を選択し、これを解くことにより、５個のパラメータを求めていた。
【０００５】
また、道路線形データについては、道路線形基準線の複数の点列データとして、本較正作業とは別に入力していた。
【０００６】
しかし、この方法では、下記の問題点があった。
（１）検出角θ１、θ２、θ３、δ１、δ２、δ３は、誤差を伴って、検出されるものであり、これをもとに算出されたパラメータｘｃ、ｙｃ、ｈｃ、θｃ、δｃも、おのずと誤差をともなうものとなり、正確な較正ができないという結果になる。
（２）センサカメラの設置位置がわかっても、道路線形データの入力は、別作業として行っていた。
【０００７】
【発明が解決しようとする課題】
本発明は、上記の従来の方法による問題点を解決し、センサカメラ位置の較正と道路線形データの入力を同時に行う方法を提供することを目的とする。
【０００８】
【課題を解決するための手段】
上記目的を達成するために、本発明は、路側に設置された道路監視用のセンサカメラと、このセンサカメラが検出したデータを処理する記憶機能および演算機能を有した路側処理装置とを具え、位置検出可能な検出器を搭載した車両を道路線形基準線に沿って、センサカメラの視野内を走行させ、該センサカメラ視野内における、前記車両を表した位置データを該車両で検出するとともに、この位置データに対応して該車両を表した角度データを前記センサカメラで検出し、これらの位置データおよび角度データの組合わせからなる所定組数の計測データを、前記路側処理装置に記憶させ、この路側処理装置は、これらの所定組数の計測データから、最小二乗法を用いて、校正用パラメータを求め、この校正用パラメータを、前記センサカメラの取付位置及び取付角度としていることを特徴とするセンサ検出位置と道路線形のマッチング方法である。
【０００９】
【発明の実施の形態】
本発明の発明の実施の形態を図面を参照して説明する。図１は、本発明の１実施形態を示すものであり、絶対位置検出が可能な車両をセンサカメラの視野内を走行させることにより、センサカメラ位置の較正と道路線形データの入力を同時に行うものである。
【００１０】
図１において、１が較正対象となるセンサカメラ、２がＧＰＳ等の絶対位置座標の検出が可能な位置検出器を搭載した車両、３が道路線形を入力対象とする道路、４が入力すべき道路線形基準線であり、また路側には、図示しない路側処理装置が設けられており、この路側処理装置は、記憶機能および演算機能を有して、センサカメラ１が検出したデータを所定に処理するようにしている。
【００１１】
車両２は、道路線形基準線４上を走行し、センサカメラ１のカメラ視野内における適当なタイミングでそのときの位置座標（ｘｉ、ｙｉ、ｈｉ）（ｉ＝１，２，・・・，Ｎ）を検出し、車両２の位置データとして記憶する。ただし、ここで、Ｎは、位置データを取得した時点を時系列順に示すように附された番号である。それと同時に、センサカメラ１は、その視野の中に捕らえた当該車両１の検出角θｉ、回転角δｉを検出し、このセンサカメラ１が検出した角度データ（θｉ、δｉ）（ｉ＝１，２，・・・，Ｎ）として路側処理装置に記憶する。
【００１２】
車両２側に記憶された位置データを、有線、無線などの通信や、記憶媒体を介するなどのように、何らかの一般的な手段や方法を用いて、路側処理装置に転送し、この路側処理装置で位置データおよび角度データからなるＮ組の計測データとして記憶する。そして、このＮ組の計測データ（ｘｉ、ｙｉ、ｈｉ、θｉ、δｉ）（ｉ＝１，Ｎ）（Ｎは、３以上）から、路側処理装置は、センサカメラ１の較正用パラメータ（ｘｃ、ｙｃ、ｈｃ、θｃ、δｃ）を決定するとともに、位置データ（ｘｉ、ｙｉ、ｈｉ）（ｉ＝１，Ｎ）を道路線形データとして記憶する。
【００１３】
本発明においては、従来基準として使用していた固定目標物の代わりに、位置検出が可能な車両を用いている。これにより、道路上に特別な目標物の設置を不要にしている。
【００１４】
センサカメラの較正手順は次の通りである。計測データ（ｘｉ、ｙｉ、ｈｉ、θｉ、δｉ）（ｉ＝１，Ｎ）とセンサカメラ較正用パラメータ（ｘｃ、ｙｃ、ｈｃ、θｃ、δｃ）の間には、以下の式の関係があるはずである。しかしながら、センサの検出時には検出誤差が存在するために以下の式は、完全な等式としては成立していない。すなわち、下記の（７），（８）式において、それぞれ左辺を右辺に移項すると、理論的な数式上では、左辺の項は０となるはずである。しかしながら、このように移項した式に、実際に検出した計測データ（ｘｉ、ｙｉ、ｈｉ、θｉ、δｉ）を代入して算定すると、少なくとも（θｉ、δｉ）には検出誤差が含まれているので、この左辺の項は、０とならずに、推測値と実際に検出した測定値との差である残差が算出される。しかも、この残差は、Ｎ組のそれぞれの組みの計測データに含まれる検出誤差同士が、一致することは殆ど考えられず互いに異なったものとなるので、各計測データを代入して算出する毎に、それぞれ異なる値をとる。したがって、（７），（８）式において、測定値である計測データに対して、係数とみなせるセンサカメラ較正用パラメータを、最小二乗法の手法を用いて、求めることができる。この最小二乗法とは、残差の二乗和が最小となるように各係数を求める手法とされている。
【数２】
0003543116.tif 000003
【００１５】
そこで、次の評価関数Ｒを導入し、この関数を最小化するようにセンサカメラ較正用パラメータ（ｘｃ、ｙｃ、ｈｃ、θｃ、δｃ）を決定する。
【数３】
0003543116.tif 000004
【００１６】
具体的には、次の手順で求める
評価関数Ｒが最小となるためには、次の条件が必要である。
【数４】
0003543116.tif 000005
これにより、５個の方程式が得られ、これを解くことにより、センサカメラ較正用パラメータ（ｘｃ、ｙｃ、ｈｃ、θｃ、δｃ）が求めらる。
【００１７】
この発明の方法によれば、式において生じる誤差が最小となる解としてセンサカメラ較正用パラメータ（ｘｃ、ｙｃ、ｈｃ、θｃ、δｃ）が提供されるので、センサカメラ１の較正作業における計測誤差の影響を最小化できる。すなわち、計測誤差の影響を最小化して較正されたものとして得たセンサカメラ較正用パラメータを、センサカメラによる各種の検出を行なうために必要な基準となるセンサカメラの取付位置及び取付角度とすることができる。
【００１８】
さらに、道路線形基準線に沿って、車両を走行させることにより、車両位置の計測結果そのものを道路線形データとして使用することができるため、道路線形の入力を別作業で行う必要がなくなる。また、工事などで、走行基準線を変更する場合でも、その走行基準線に沿って、車両を走らせることで、自動的に道路線形データの変更が可能である
【００１９】
【発明の効果】
本発明により、センサカメラの較正が正確に行うことができ、さらに、車両で検出した位置座標がそのまま道路線形とすることができる。
【図面の簡単な説明】
【図１】本発明のセンサカメラの較正方法及び道路線形データの入力方法を示す図である。
【図２】従来のセンサカメラの較正方法を示す図である。
【符号の説明】
１  センサカメラ
２  位置検出器を搭載した車両
３  道路
４  道路線形基準線
５  目標物
【図１】
0003543116.tif 000006
【図２】
0003543116.tif 000007