(57)【要約】【課題】本願発明は、正確な計測を可能とした位置計測装置を提供する。【解決手段】位置計測装置１は、対象物の位置を計測するものであり、通常モード又は静止モードの何れか一方が手動で選択されるモード選択手段１０と、カメラ映像に含まれる対象物を認識する対象物認識手段１１と、２点の位置方向情報の差分を動座標基底ベクトルに分解する動座標基底ベクトル分解手段１３と、微分形式の動座標系で角度及び距離を算出し、この角度及び距離から対象物の位置を算出する対象物位置検出手段１４と、対象物の位置を地図上に表示する地図表示手段１５とを備える。【選択図】図１
2014211311.tif 000002
【特許請求の範囲】
【請求項１】
距離の計測基準となる計測基準物と、前記距離の計測対象である計測対象物との両方が移動しているときに、前記計測基準物が位置する計測点と前記計測対象物が位置する計測対象点との距離を計測する計測装置であって、
前記計測基準物の位置及び前記計測対象物に対する計測基準物の方向を示す位置方向情報が２点分入力され、当該２点の位置方向情報の差分を動座標基底ベクトルに分解することで、微分形式の動座標系で前記方向の変化を示す角度を算出する角度算出手段と、
前記角度算出手段で算出された角度から、動座標数理により、前記微分形式の動座標系で前記計測点と前記計測対象点との距離を算出する距離算出手段と、
を備えることを特徴とする計測装置。
【請求項２】
距離の計測基準となる計測基準物と、前記距離の計測対象である計測対象物との少なくとも一方が静止しているときに、前記計測基準物が位置する計測点と前記計測対象物が位置する計測対象点との距離を計測する計測装置であって、
前記計測基準物の位置及び前記計測対象物に対する計測基準物の方向を示す位置方向情報と、前記距離を計測するためのスケールの寸法を示すスケール情報とが入力され、当該位置方向情報及び当該スケール情報を動座標基底ベクトルに分解することで、微分形式の動座標系で前記方向の変化を示す角度を算出する角度算出手段と、
前記角度算出手段で算出した角度から、動座標数理により、前記微分形式の動座標系で前記計測点と前記計測対象点との距離を算出する距離算出手段と、
を備えることを特徴とする計測装置。
【請求項３】
前記計測基準物としての撮影カメラで撮影された撮影画像に含まれる計測対象物をテンプレートマッチングにより抽出し、抽出した前記計測対象物を近似する図形に変換し、前記撮影画像に含まれる計測対象物を認識する計測対象物認識手段と、
前記角度算出手段で算出された角度と、前記距離算出手段で算出された距離と、前記計測対象物認識手段で認識された計測対象物の面積とを用いて、前記撮影カメラを制御するカメラ制御手段と、
をさらに備えることを特徴とする請求項１又は請求項２に記載の計測装置。
【請求項４】
前記位置方向情報が示す計測点の位置及び方向と、前記距離算出手段で算出された距離とから、予め設定された位置算出式により、前記計測対象点の位置を算出する位置算出手段、
をさらに備えることを特徴とする請求項１から請求項３の何れか一項に記載の計測装置。
【請求項５】
コンピュータを、請求項１又は請求項２に記載の計測装置として機能させるための計測プログラム。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、微分形式の動座標系を用いて、計測点と計測対象点との距離を計測する計測装置及びそのプログラムに関する。
【背景技術】
【０００２】
従来から、計測技術として、三点からの距離を用いる三点法が知られている。この計測技術は、無線、赤外線、レーザ、カメラなどの計測手段を用いて実現されている。近年、ＩＴ産業の進展に伴い、例えば、ゲームソフト製作の人体構造生成技術や動画像処理技術の分野でも、このような計測技術が利用されている（非特許文献１，２）。
【０００３】
また、従来から、三点法以外の計測技術も知られている（非特許文献３）。この非特許文献３に記載の技術は、計測対象物の付近にある、サイズが既知のスケールを撮影することで、このスケールを基準として、計測対象物の位置及び寸法を求めるものである。
【先行技術文献】
【非特許文献】
【０００４】
【非特許文献１】株式会社エル・エー・ビー、モーションキャプチャ＆アニメーション統合ソフトウェア「ＰＶ  ＳＴＵＤＩＯ  ３Ｄ」、http://www.privatestudio.co.jp/pvs3d.html
【非特許文献２】株式会社ライブラリー、動画像処理専用機「なのはなシリーズ」、http://www.library-inc.co.jp/products/nanohana/03.htm
【非特許文献３】株式会社アイティーティー、単眼ビデオカメラによるリアルタイム三次元計測「シングルビュー ３Ｄ」、http://www.ittc.co.jp/sproduct/photocalc/SingleView3D/SingleView3D.htm
【発明の概要】
【発明が解決しようとする課題】
【０００５】
しかし、前記した計測技術では、静止座標系を用いているため、バイアス誤差及びランダム誤差などの誤差に関する問題と、計測点数及び不定に関する問題とが生じる。計測点（基準点）又は計測対象点の一方が移動する場合、これら問題の影響を受け、特に、計測点と計測対象点の双方が移動する場合、これら問題が顕著となる。
【０００６】
まず、誤差に関する問題について説明する。
任意点Ｐの位置の真値を（ｘ＾，ｙ＾，ｚ＾）とし、計測誤差を（εｘ，εｙ，εｚ）とする。この場合、任意点Ｐの位置の計測値が（ｘ＾＋εｘ，ｙ＾＋εｙ，ｚ＾＋εｚ）となり、静止座標系では個々の計測値の真値に誤差が加算されることになる。
【０００７】
次に、計測点数及び不定に関する問題について説明する。
非特許文献１，２に記載の技術では、三点法の原理により３点以上の計測が必要になり、誤差を軽減するためには多くの計測点（例えば、非特許文献２に記載の技術では８点）が必要となる。また、非特許文献３に記載の技術では、計測点が３点未満のため、寸法が既知のスケールが複数（例えば、５点）必要になる。そして、非特許文献１〜３に記載の技術では、それぞれの計測条件が整わない場合、計測値が不定になるという問題がある。
【０００８】
そこで、本願発明は、前記した問題を解決し、正確な計測を可能とした計測装置及びそのプログラムを提供することを課題とする。
【課題を解決するための手段】
【０００９】
前記した課題に鑑みて、本願第１発明に係る計測装置は、距離の計測基準となる計測基準物と、距離の計測対象である計測対象物との両方が移動しているときに、計測基準物が位置する計測点と計測対象物が位置する計測対象点との距離を計測する計測装置であって、角度算出手段と、距離算出手段と、を備えることを特徴とする。
【００１０】
かかる構成によれば、計測装置は、角度算出手段によって、計測基準物の方向を示す位置方向情報が２点分入力され、２点の位置方向情報の差分を動座標基底ベクトルに分解することで、微分形式の動座標系で方向の変化を示す角度を算出する。
この位置方向情報は、計測基準物の位置と、計測対象物に対する計測基準物の方向とを示す。
【００１１】
また、計測装置は、距離算出手段によって、角度算出手段で算出された角度から、動座標数理により、微分形式の動座標系で計測点と計測対象点との相対的な距離を算出する。
【００１２】
ここで、任意点Ｐの位置の真値を（ｘ＾，ｙ＾，ｚ＾）とし、（Ｐ＋ΔＰ）点の位置の真値を（ｘ＾＋Δｘ＾，ｙ＾＋Δｙ＾，ｚ＾＋Δｚ＾）とし、Ｐ点とΔＰ点との位置の計測誤差を（εｘ，εｙ，εｚ）とする。この場合、（Ｐ＋ΔＰ）点とＰ点との位置の差が（Δｘ＾，Δｙ＾，Δｚ＾）となり、バイアス誤差が相殺される。このように、計測装置は、相対的な角度を算出することで、誤差を相殺することができる。
【００１３】
また、前記した課題に鑑みて、本願第２発明に係る計測装置は、距離の計測基準となる計測基準物と、距離の計測対象である計測対象物との少なくとも一方が静止しているときに、計測基準物が位置する計測点と計測対象物が位置する計測対象点との距離を計測する計測装置であって、角度算出手段と、距離算出手段と、を備えることを特徴とする。
【００１４】
かかる構成によれば、計測装置は、角度算出手段によって、位置方向情報と、スケール情報とが入力され、位置方向情報及びスケール情報を動座標基底ベクトルに分解することで、微分形式の動座標系で方向の変化を示す角度を算出する。
このスケール情報は、距離を計測するためのスケールの寸法を示す。
【００１５】
また、計測装置は、距離算出手段によって、角度算出手段で算出した角度から、動座標数理により、微分形式の動座標系で計測点と計測対象点との距離を算出する。
【００１６】
ここで、任意点Ｐの位置の真値を（ｘ＾，ｙ＾，ｚ＾）とし、（Ｐ＋ΔＰ）点の位置の真値を（ｘ＾＋Δｘ＾，ｙ＾＋Δｙ＾，ｚ＾＋Δｚ＾）とし、Ｐ点とΔＰ点との位置の計測誤差を（εｘ，εｙ，εｚ）とする。この場合、（Ｐ＋ΔＰ）点とＰ点との位置の差が（Δｘ＾，Δｙ＾，Δｚ＾）となり、バイアス誤差が相殺される。このように、計測装置は、相対的な角度を算出することで、誤差を相殺することができる。
【００１７】
また、本願第３発明に係る計測装置は、計測基準物としての撮影カメラで撮影された撮影画像に含まれる計測対象物をテンプレートマッチングにより抽出し、抽出した計測対象物を近似する図形に変換することで、撮影画像に含まれる計測対象物を認識する計測対象物認識手段と、角度算出手段で算出された角度と、距離算出手段で算出された距離と、計測対象物認識手段で認識された計測対象物の面積とを用いて、撮影カメラを制御するカメラ制御手段と、をさらに備えることを特徴とする。
かかる構成によれば、計測装置は、計測対象物を向くように撮影カメラを正確に制御することができる。
【００１８】
また、本願第４発明に係る計測装置は、位置方向情報が示す計測点の位置及び方向と、距離算出手段で算出された距離とから、予め設定された位置算出式により、計測対象点の位置を算出する位置算出手段、をさらに備えることを特徴とする。
【００１９】
なお、本願第１，２発明に係る計測装置は、コンピュータが備えるＣＰＵ（Central Processing Unit）、メモリ、ＨＤＤ（Hard Disk Drive）などのハードウェア資源を、前記した各手段として協調動作させるための計測プログラムとして実現することもできる。この計測プログラムは、通信回線を介して配布してもよく、ＣＤ−ＲＯＭやフラッシュメモリ等の記録媒体に書き込んで配布してもよい（本願第５発明）。
【発明の効果】
【００２０】
本願発明によれば、以下のような優れた効果を奏する。
本願第１，２，５発明によれば、相対的な角度を算出するため、誤差が相殺され、正確に計測を行うことができる。
本願第３発明によれば、計測対象物を向くように撮影カメラを正確に制御することができる。
本願第４発明によれば、正確な計測対象物の位置を提示することができる。
【図面の簡単な説明】
【００２１】
【図１】本願発明の第１，２実施形態に係る位置計測装置の構成を示すブロック図である。
【図２】本願発明の第１実施形態において、対象物の変換を説明する説明図であり、（ａ）はカメラ映像から抽出した対象物を示し、（ｂ）は対象物に近似する形状の図形を示す。
【図３】本願発明の第１実施形態において、カメラ位置情報及び撮影方向情報を説明する説明図である。
【図４】本願発明の第１実施形態において、動座標基底ベクトルへの分解を説明する説明図である。
【図５】図１の位置計測装置の動作を示すフローチャートである。
【図６】本願発明の第２実施形態において、スケールを説明する説明図である。
【図７】本願発明の第２実施形態において、動座標基底ベクトルへの分解を説明する説明図である。
【図８】本願発明の第３実施形態に係るカメラ制御装置の構成を示すブロック図である。
【図９】本願発明の第３実施形態において、動座標基底ベクトルへの分解を説明する説明図である。
【図１０】本願発明の第３実施形態において、角度及び距離の算出を説明する説明図であり、（ａ）は仮想的な２台の撮影カメラを示し、（ｂ）は（ａ）の一点鎖線部分の拡大図であり、（ｃ）は（ｂ）の交点部分の拡大図である。
【図１１】本願発明の第３実施形態において、距離の移動平均を説明する説明図である。
【図１２】本願発明に係る計測装置の構成を示すブロック図である。
【図１３】参考例１において、計測装置の動作原理を説明する説明図である。
【発明を実施するための形態】
【００２２】
以下、本発明の実施形態について、適宜図面を参照しながら詳細に説明する。なお、各実施形態において、同一の機能を有する手段には同一の符号を付し、説明を省略した。
【００２３】
[位置計測装置の概略]
図１を参照し、位置計測装置１の概略について、説明する。
位置計測装置（計測装置）１は、計測基準物が位置する計測点と対象物が位置する計測対象点との距離を計測し、この距離に基づいて対象物の位置を計測するものである。
【００２４】
本実施形態では、距離の計測基準となる計測基準物が、１台の撮影カメラ９２（図３）であることとする。この計測基準物は、撮影カメラ９２に限定されず、無線器、赤外線照射装置又はレーザ照射装置であってもよい。
また、本実施形態では、距離の計測対象である対象物９０（図３）が、撮影カメラ９２で撮影される被写体であることとする。
なお、対象物９０が、請求項に記載の計測対象物に相当する。
【００２５】
位置計測装置１は、撮影カメラ９２及び対象物９０の両方が移動する通常モード、又は、撮影カメラ９２が静止する静止モードの何れかで処理を行うこととする。以下、第１実施形態で通常モードを説明した後、第２実施形態で静止モードを説明する。
【００２６】
（第１実施形態：通常モード）
[位置計測装置の構成]
位置計測装置１の構成について、説明する。
図１に示すように、位置計測装置１は、モード選択手段１０と、対象物認識手段（計測対象物認識手段）１１と、入力手段１２と、動座標基底ベクトル分解手段（角度算出手段）１３と、対象物位置検出手段１４と、地図表示手段１５とを備える。
【００２７】
モード選択手段１０は、通常モード又は静止モードの何れか一方が、手動で選択されるものである。本実施形態では、モード選択手段１０は、通常モードが予め選択されていることとする。つまり、位置計測装置１は、通常モードの場合、第１実施形態で説明する処理を行い、静止モードの場合、第２実施形態で説明する処理を行う。
【００２８】
また、モード選択手段１０は、位置計測装置１が通常サンプリングを行う通常サンプリングモード、又は、高速サンプリングを行う高速サンプリングモードの何れか一方が、手動で選択されてもよい。例えば、モード選択手段１０は、対象物が高速で移動する場合、高速サンプリングモードが選択される。そして、モード選択手段１０は、通常サンプリングモード又は高速サンプリングモードを示す選択モード情報を、入力手段１２に出力する。
【００２９】
対象物認識手段１１は、撮影カメラ９２で対象物が撮影されたカメラ映像（撮影画像）が入力され、このカメラ映像に含まれる対象物を認識するものである。そして、対象物認識手段１１は、対象物の認識結果を入力手段１２に出力する。
【００３０】
図２に示すように、対象物認識手段１１は、カメラ映像に含まれる対象物９０を抽出し、抽出した対象物９０を近似する図形９１に変換することが好ましい。例えば、対象物認識手段１１は、対象物９０を様々な角度から撮影した事前データ（テンプレート画像）を予め登録しておく。また、対象物認識手段１１は、事前データを用いたテンプレートマッチングを行い、カメラ映像から対象物９０を抽出する（図２（ａ））。そして、対象物認識手段１１は、抽出した対象物９０の輪郭に最も近い図形９１を求める（図２（ｂ））。すなわち、対象物認識手段１１は、対象物９０を、円形、矩形、三角形のように、この対象物９０に近似した簡易な形状の図形９１に変換する。これによって、対象物認識手段１１は、対象物９０の認識率を向上させることができる。
【００３１】
入力手段１２は、外部から、カメラ情報と、カメラ位置情報と、撮影方向情報とが入力されるものである。また、入力手段１２は、モード選択手段１０から選択モード情報が入力され、対象物認識手段１１から対象物９０の認識結果が入力される。
【００３２】
カメラ情報は、撮影カメラ９２のピントを示す情報である。
カメラ位置情報は、撮影カメラ９２の位置を示す情報である。
撮影方向情報は、対象物９０に対する撮影カメラ９２の方向を示す情報である。
このカメラ位置情報及び撮影方向情報が、特許請求の範囲に記載の位置方向情報に相当する。
【００３３】
なお、入力手段１２は、モード選択手段１０から入力された選択モード情報が高速サンプリングモードを示す場合、高いサンプリング周波数で対象物９０を認識することを対象物認識手段１１に指示してもよい。
【００３４】
＜カメラ位置情報及び撮影方向情報＞
図３を参照し、カメラ位置情報及び撮影方向情報について、具体的に説明する（適宜図１参照）。
【００３５】
図３では、撮影カメラ９２を黒丸で図示し、対象物９０を黒三角で図示した（図４，図６，図７も同様）。また、図３では、時刻ｔにおける対象物の位置を符号９０ｔと図示し、時刻ｔ+１における対象物の位置を符号９０ｔ+１と図示した（図４も同様）。
【００３６】
図３に示すように、入力手段１２は、時刻ｔの計測値として、カメラ位置Ｐｔ＝（ｘｔ，ｙｔ，ｚｔ）を示すカメラ位置情報と、撮影方向Ｄｔ＝（φｔ，θｔ）を示す撮影方向情報とが入力される。この撮影方向Ｄｔは、カメラ位置Ｐｔから対象物の位置９０ｔを指している。また、時刻ｔにおいて、φｔがＸ軸及びＹ軸上での撮影方向を示し、θｔがＸ軸、Ｙ軸及びＺ軸上での撮影方向を示している。
【００３７】
また、入力手段１２は、時刻ｔ＋１の計測値として、カメラ位置Ｐｔ+１＝（ｘｔ+１，ｙｔ+１，ｚｔ+１）を示すカメラ位置情報と、撮影方向Ｄｔ+１＝（φｔ+１，θｔ+１）を示す撮影方向情報とが入力される。この撮影方向Ｄｔ+１は、カメラ位置Ｐｔ+１から対象物の位置９０ｔ+１を指している。また、時刻ｔ＋１において、φｔ+１がＸ軸及びＹ軸上での撮影方向を示し、θｔ+１がＸ軸、Ｙ軸及びＺ軸上での撮影方向を示している。
【００３８】
このように、入力手段１２は、時刻ｔ，ｔ＋１という２点分のカメラ位置情報及び撮影方向情報が入力される。そして、入力手段１２は、入力された２点分のカメラ位置Ｐｔ，Ｐｔ+１と、撮影方向Ｄｔ，Ｄｔ+１と、対象物９０の認識結果とを、動座標基底ベクトル分解手段１３に出力する。
【００３９】
図１に戻り、位置計測装置１の構成について、説明を続ける。
動座標基底ベクトル分解手段１３は、入力手段１２から入力された２点分のカメラ位置情報及び撮影方向情報の差分を動座標基底ベクトルに分解することで、微分形式の動座標系で撮影方向の変化を示す角度を算出するものである。
この角度は、後記する差分（Δφｔ+１，Δθｔ+１）のことである。
【００４０】
＜動座標基底ベクトルへの分解＞
図４を参照し、動座標基底ベクトルへの分解について、具体的に説明する（適宜図１参照）。
【００４１】
図４に示すように、動座標基底ベクトル分解手段１３は、カメラ位置Ｐｔ，Ｐｔ+１について、時刻ｔと時刻ｔ＋１との差分ΔＰｔ+１＝（ｘｔ+１−ｘｔ，ｙｔ+１−ｙｔ，ｚｔ+１−ｚｔ）を算出する。また、動座標基底ベクトル分解手段１３は、撮影方向Ｄｔ，Ｄｔ+１について、時刻ｔと時刻ｔ＋１との差分（Δφｔ+１，Δθｔ+１）＝（φｔ+１−φｔ，θｔ+１−θｔ）を算出する。
【００４２】
そして、動座標基底ベクトル分解手段１３は、下記の式（１）に示すように、カメラ位置の差分ΔＰｔ+１と、撮影方向の差分Δφｔ+１，Δθｔ+１とを、動座標基底ベクトルＥ１ｔ+１，Ｅ２ｔ+１，Ｅ３ｔ+１に分解する。
【００４３】
【数１】
2014211311.tif 000003
【００４４】
微分形式（微分又は差分）の動座標系は、動座標数理を用いた座標系であり、例えば、下記の参考文献１，２に記載されている。
参考文献１：栗田稔、“微分形式とその応用”、２００２年６月２２日、現代数学社
参考文献２：Ｈ．フランダース、“微分形式の理論”、１９６７年６月３０日、岩波書店
【００４５】
動座標基底ベクトルとは、微分形式の動座標系を表すための基底ベクトルのことである。ここで、微分形式の動座標系が３次元であるため、３つの動座標基底ベクトルＥ１ｔ+１，Ｅ２ｔ+１，Ｅ３ｔ+１が用いられる。
【００４６】
その後、動座標基底ベクトル分解手段１３は、撮影方向Ｄｔ，Ｄｔ+１の変化を示す角度Δφｔ+１，Δθｔ+１を対象物位置検出手段１４に出力する。さらに、動座標基底ベクトル分解手段１３は、動座標基底ベクトルＥ１ｔ+１，Ｅ２ｔ+１，Ｅ３ｔ+１と、カメラ位置Ｐｔ+１と、撮影方向Ｄｔ+１とを、対象物位置検出手段１４に出力する。
【００４７】
図１に戻り、位置計測装置１の構成について、説明を続ける。
対象物位置検出手段１４は、動座標基底ベクトル分解手段１３より入力された角度Δφｔ+１，Δθｔ+１から、動座標数理により、微分形式の動座標系で計測点と計測対象点との距離を算出するものである。さらに、対象物位置検出手段１４は、算出した距離と、カメラ位置Ｐｔ+１と、撮影方向Ｄｔ+１とから、予め設定された位置算出式により、計測対象点の位置を算出する。
この対象物位置検出手段１４が、特許請求の範囲に記載の距離算出手段及び位置算出手段に相当する。
【００４８】
具体的には、対象物位置検出手段１４は、式（２）及び式（３）で表される距離算出式により、動座標基底ベクトルＥ１ｔ+１，Ｅ２ｔ+１，Ｅ３ｔ+１と、角度Δφｔ+１，Δθｔ+１とに基づいて、計測点から計測対象点までの距離ｒｔ+１を算出する。
【００４９】
【数２】
2014211311.tif 000004
【００５０】
【数３】
2014211311.tif 000005
【００５１】
次に、対象物位置検出手段１４は、式（４）で表される位置算出式により、カメラ位置Ｐｔ+１＝（ｘｔ+１，ｙｔ+１，ｚｔ+１）と、撮影方向Ｄｔ+１＝（φｔ+１，θｔ+１）と、距離ｒｔ+１とに基づいて、対象物の位置Ｐｍｔ+１を算出する。
【００５２】
【数４】
2014211311.tif 000006
【００５３】
その後、対象物位置検出手段１４は、算出した対象物の位置Ｐｍｔ+１を、地図表示手段１５に出力する。
【００５４】
地図表示手段１５は、対象物位置検出手段１４から入力された対象物の位置Ｐｍｔ+１を、地図上に表示するものである。例えば、地図表示手段１５は、この対象物の位置Ｐｍｔ+１を地図座標系に変換して、変換された対象物の位置Ｐｍｔ+１を示すマーカを、ディスプレイに表示された地図に合成する。
【００５５】
[位置計測装置の動作]
図５を参照し、位置計測装置１の動作について、説明する（適宜図１参照）。
位置計測装置１は、対象物認識手段１１によって、カメラ映像に含まれる対象物９０を認識する（ステップＳ１）。
【００５６】
位置計測装置１は、入力手段１２によって、カメラ情報、カメラ位置情報、撮影方向情報などの各種情報が入力される（ステップＳ２）。
位置計測装置１は、動座標基底ベクトル分解手段１３によって、動座標基底ベクトルへの分解を行う（ステップＳ３）。
【００５７】
位置計測装置１は、対象物位置検出手段１４によって、微分形式の動座標系で計測点と計測対象点との距離を算出する（ステップＳ４）。
位置計測装置１は、対象物位置検出手段１４によって、計測対象点の位置を算出する（ステップＳ５）。
位置計測装置１は、地図表示手段１５によって、対象物の位置Ｐｍｔ+１を地図上に表示する（ステップＳ６）。
【００５８】
[作用・効果]
以上のように、位置計測装置１は、相対的な角度Δφｔ+１，Δθｔ+１を算出するため、バイアス誤差を相殺し、正確に距離ｒｔ+１を算出することができる。その結果、位置計測装置１は、対象物の正確な位置Ｐｍｔ+１を地図上に表示することができる。
【００５９】
さらに、位置計測装置１は、時刻ｔ，時刻ｔ＋１，…というように順次処理を繰り返すことで、対象物認識手段１１における対象物の認識結果に基づいて、移動する対象物を補足（追跡）し、その位置を地図上にリアルタイムで表示することができる。
【００６０】
なお、位置計測装置１（対象物位置検出手段１４）は、例えば、撮影カメラ９２が自動でピントを合わせる場合、カメラ情報を用いて、撮影カメラから対象物までの距離を求めてもよい。
【００６１】
（第２実施形態：静止モード）
[位置計測装置の構成]
図１に戻り、位置計測装置１Ｂの構成について、第１実施形態と異なる点を説明する。
本実施形態では、第１実施形態と異なり、撮影カメラが静止し、対象物が移動していることとする。従って、モード選択手段１０では、静止モードが予め選択されている。
【００６２】
また、本実施形態では、位置計測装置１を符号１Ｂと記載し、入力手段１２を符号１２Ｂと記載し、動座標基底ベクトル分解手段１３を符号１３Ｂと記載し、対象物位置検出手段１４を符号１４Ｂと記載し、第１実施形態と区別することとした。
なお、対象物認識手段１１及び地図表示手段１５は、第１実施形態と同様のため、説明を省略する。
【００６３】
入力手段１２Ｂは、外部から、カメラ情報、カメラ位置情報及び撮影方向情報に加え、スケール情報がさらに入力されるものである。
【００６４】
図６に示すように、スケール９３とは、対象物９０の付近にあり、距離を計測するための物体（例えば、普通自動車）である。
スケール情報とは、スケール９３の寸法を示す情報である。図６の例では、スケール情報は、普通自動車の高さが１．５メートルで幅が２メートルといった情報である。この他、スケール情報は、電柱の高さが１４メートル、大人の身長が１．６メートル、又は、２階建て住居の高さが６メートルといった情報であってもよい。
【００６５】
そして、入力手段１２Ｂは、カメラ位置Ｐｔ＝（ｘｔ，ｙｔ，ｚｔ）と、撮影方向Ｄｔ＝（φｔ，θｔ）と、対象物９０の認識結果と、スケールΔＰｔ＝（Δｘｔ，Δｙｔ，Δｚｔ）とを、動座標基底ベクトル分解手段１３Ｂに出力する。
【００６６】
動座標基底ベクトル分解手段１３Ｂは、入力手段１２Ｂから入力された撮影方向情報とスケール情報とを動座標基底ベクトルに分解することで、微分形式の動座標系で撮影方向の変化を示す角度を算出するものである。
【００６７】
＜動座標基底ベクトルへの分解＞
図７を参照し、動座標基底ベクトルへの分解について、具体的に説明する（適宜図１参照）。
【００６８】
図７に示すように、動座標基底ベクトル分解手段１３Ｂは、下記の式（５）に示すように、撮影方向Ｄｔ＝（φｔ，θｔ）と、対象物の認識結果と、スケール情報ΔＰｔ＝（Δｘｔ，Δｙｔ，Δｚｔ）とを、動座標基底ベクトルＥ１ｔ，Ｅ２ｔ，Ｅ３ｔに分解する。
【００６９】
【数５】
2014211311.tif 000007
【００７０】
その後、動座標基底ベクトル分解手段１３Ｂは、撮影方向Ｄｔの変化を示す角度Δφｔ，Δθｔを対象物位置検出手段１４Ｂに出力する。さらに、動座標基底ベクトル分解手段１３Ｂは、動座標基底ベクトルＥ１ｔ，Ｅ２ｔ，Ｅ３ｔと、カメラ位置Ｐｔと、撮影方向Ｄｔとを、対象物位置検出手段１４Ｂに出力する。
【００７１】
図１に戻り、位置計測装置１Ｂの構成について、説明を続ける。
対象物位置検出手段１４Ｂは、動座標基底ベクトル分解手段１３Ｂより入力された角度Δφｔ，Δθｔから、動座標数理により、微分形式の動座標系で計測点と計測対象点との距離を算出するものである。さらに、対象物位置検出手段１４Ｂは、算出した距離と、カメラ位置Ｐｔと、撮影方向Ｄｔとから、予め設定された位置算出式により、計測対象点の位置を算出する。
【００７２】
具体的には、対象物位置検出手段１４Ｂは、式（６）で表される距離算出式により、動座標基底ベクトルＥ２ｔ，Ｅ３ｔと、角度Δφｔ，Δθｔと、撮影方向φｔとに基づいて、計測点から計測対象点までの距離ｒｔを算出する。
【００７３】
【数６】
2014211311.tif 000008
【００７４】
次に、対象物位置検出手段１４Ｂは、式（７）で表される位置算出式により、カメラ位置Ｐｔ＝（ｘｔ，ｙｔ，ｚｔ）と、撮影方向Ｄｔ＝（φｔ，θｔ）と、距離ｒｔとに基づいて、対象物の位置Ｐｍｔを算出する。
【００７５】
【数７】
2014211311.tif 000009
【００７６】
その後、対象物位置検出手段１４Ｂは、算出した対象物の位置Ｐｍｔを、地図表示手段１５に出力する。
【００７７】
[作用・効果]
以上のように、位置計測装置１Ｂは、撮影カメラが静止している場合でも、第１実施形態と同様の効果を奏する。
また、第１，２実施形態では、対象物が移動することとして説明したが、撮影カメラ（計測基準物）が移動し、対象物（計測対象物）が移動又は静止してもよい。
【００７８】
（第３実施形態）
[カメラ制御装置の構成]
図８を参照し、カメラ制御装置２の構成について、説明する。
【００７９】
カメラ制御装置（計測装置）２は、計測点と計測対象点との方向が変化した角度、及び、計測点と計測対象点との距離を算出し、これら角度及び距離に基づいて、撮影カメラ９２を制御するものである。図８に示すように、カメラ制御装置２は、対象物認識手段２０と、角度算出手段２１１，２１２と、距離算出手段２２と、面積算出手段２３と、ズーム制御手段２４と、パン・チルト制御手段２５とを備える。
【００８０】
本実施形態では、計測基準物が静止した被写体９０（図３）であり、対象物が撮影カメラ９２であることとする。
また、本実施形態では、１台の撮影カメラ９２が移動することとし、移動前の撮影カメラ９２１と、移動後の撮影カメラ９２２とを仮想的に２台の撮影カメラ９２として扱うこととする。
以後、１台目の撮影カメラに符号９２１を付し、２台目の撮影カメラに符号９２２を付して説明する。
【００８１】
撮影カメラ９２は、カメラ本体９２ａと、雲台９２ｂとを備える。
カメラ本体９２ａは、ズーム制御信号に基づいて、レンズのズームを駆動する。
雲台９２ｂは、カメラ本体９２ａを搭載すると共に、パン・チルト制御信号に基づいて、カメラ本体９２ａをパン方向及びチルト方向に駆動する。
【００８２】
対象物認識手段２０は、画像認識・追跡手段２０１，２０２を備える。
画像認識・追跡手段２０１は、撮影カメラ９２１のカメラ映像（撮影画像）が入力され、このカメラ映像に含まれる被写体９０を認識するものである。そして、対象物認識手段２０１は、被写体９０の認識結果（画面上の座標）を角度算出手段２１１及び面積算出手段２３に出力する。
【００８３】
画像認識・追跡手段２０２は、撮影カメラ９２２のカメラ映像を対象とする以外、画像認識・追跡手段２０１と同様のため、説明を省略する。
【００８４】
角度算出手段２１１は、撮影カメラ９２１について、カメラ位置情報及び撮影方向情報の差分を動座標基底ベクトルに分解することで、微分形式の動座標系で方向の変化を示す角度を算出するものである。
なお、本実施形態では、被写体９０の位置が既知（固定）であり、撮影カメラ９２に対する姿勢制御の結果として、撮影方向が定まるため、カメラ位置情報及び撮影方向情報を外部から入力せずともよい。
【００８５】
具体的には、角度算出手段２１１は、図９に示すように、下記の式（８）〜式（１０）を用いて、動座標基底ベクトルｅｘ１〜ｅｚ３への分解を行い、角度φ，θを算出する。
【００８６】
この図９では、撮影カメラ９２１が原点Ｏ＝（０，０，０）に位置し、撮影カメラ９２２（図９では省略）が任意の場所に位置することとする。また、被写体９０の位置Ｐは、デカルト座標で（ｘ，ｙ，ｚ）で表される。また、点Ｏ−Ｐ間の距離がｒである。すなわち、この図９は、デカルト座標（ｘ，ｙ，ｚ）と、球座標系（ｒ，θ，φ）との対応関係を表している。ここで、距離ｒも、距離の差分ｄｒも未知であることとする。
【００８７】
【数８】
2014211311.tif 000010
【００８８】
【数９】
2014211311.tif 000011
【００８９】
【数１０】
2014211311.tif 000012
【００９０】
その後、角度算出手段２１１は、算出した動座標基底ベクトルｅｘ１〜ｅｚ３と、角度φ，θとを、距離算出手段２２に出力する。
角度算出手段２１２は、撮影カメラ９２２を対象とする以外、角度算出手段２１１と同様のため、説明を省略する。
【００９１】
距離算出手段２２は、角度算出手段２１１，２１２より入力された角度から、動座標数理により、微分形式の動座標系で計測点と計測対象点との距離を算出するものである。
【００９２】
ここで、距離ｒを求める説明を簡易にするため、式（９）のｄｘ及びｄｙが変化し、ｄｚが一定の場合を考える。すなわち、ｄｚ＝０、ｄθ＝０、ｓｉｎθ＝１が成立する。この場合、下記の式（１１）から式（１２）を導き出すことができる。
【００９３】
【数１１】
2014211311.tif 000013
【００９４】
【数１２】
2014211311.tif 000014
【００９５】
そして、式（１２）を下記の式（１３）に代入して、式（１４）を導き出すことができる。さらに、式（１４）を距離ｒで解いて、式（１５）を導き出すことができる。従って、距離算出手段２２は、式（１５）で表される距離算出式を用いて、距離ｒを算出する。
【００９６】
【数１３】
2014211311.tif 000015
【００９７】
【数１４】
2014211311.tif 000016
【００９８】
【数１５】
2014211311.tif 000017
【００９９】
ここで、ｄφを微小とし、ｄφがｓｉｎｄφに近似する場合、下記の式（１６）が成立する。従って、距離算出手段２２は、下記の式（１７）及び式（１８）を用いて、距離の差分ｄｒを算出する。ここで、ｄｓは、任意の２点間の距離を表す。
【０１００】
【数１６】
2014211311.tif 000018
【０１０１】
【数１７】
2014211311.tif 000019
【０１０２】
【数１８】
2014211311.tif 000020
【０１０３】
図１０（ａ）に示すように、時刻ｔにおける撮影カメラ９２１を符号９２ｔで図示し、時刻ｔ+１における撮影カメラ９２２を符号９２ｔ+１で図示した。この場合、図１０（ｂ）に示すように、距離算出手段２２は、撮影カメラ９２ｔ，９２ｔ+１の光軸交点で、基底による動きの抽出を行って、時刻ｔにおける距離方向の基底ベクトルｅｒｔと、角度方向の基底ベクトルｅθｔ，ｅφｔとを抽出する（時刻ｔ+１も同様）。図１０（ｃ）に示すように、距離算出手段２２は、動座標数理による動きの接続を行って、基底ベクトルｅｒｔと基底ベクトルｅｒｔ+１との差分を、距離の差分ｄｒとして算出する。
【０１０４】
その後、距離算出手段２２は、距離ｒ及び距離の差分ｄｒをズーム制御手段２４に出力し、角度φ，θをパン・チルト制御手段２５に出力する。
なお、距離算出手段２２に入力された直交座標は、デカルト座標系で撮影カメラ９２と被写体９０との位置を表すために用いられる。
【０１０５】
図８に戻り、カメラ制御装置２の構成について、説明を続ける。
面積算出手段２３は、角度算出手段２１１，２１２から入力された被写体９０の面積を算出するものである。例えば、面積算出手段２３は、被写体９０のエッジを抽出し、このエッジ領域の面積を求める。そして、面積算出手段２３は、算出した被写体９０の面積をズーム制御手段２４に出力する。
【０１０６】
ズーム制御手段２４は、距離算出手段２２から入力された距離ｒ及び距離の差分ｄｒと、面積算出手段２３から入力された被写体９０の面積とに基づいて、撮影カメラ９２（カメラ本体９２ａ）のズームを制御するものである。
【０１０７】
例えば、ズーム制御手段２４は、距離ｒが遠くなる程、撮影カメラ９２がズームインし、距離ｒが近くなる程、撮影カメラ９２がズームアウトするようなズーム制御信号を生成し、カメラ本体９２ａに出力する。
【０１０８】
このとき、ズーム制御手段２４は、距離ｒの移動平均を用いて、ズーム制御を行うことが好ましい。図１１に示すように、ズーム制御手段２４は、距離ｒの計算値（黒丸で図示）から、距離ｒの移動平均９４を算出する。そして、ズーム制御手段２４は、この移動平均９４で表される距離ｒに基づいて、ズーム制御信号を生成する。これによって、カメラ制御装置２は、ズーム制御の誤差を低減することができる。
【０１０９】
また、例えば、ズーム制御手段２４は、被写体９０の面積が狭くなる程、撮影カメラ９２がズームインし、被写体９０の面積が広くなる程、撮影カメラ９２がズームアウトするようなズーム制御信号を生成し、カメラ本体９２ａに出力する。
【０１１０】
パン・チルト制御手段２５は、距離算出手段２２から入力された角度φ，θに基づいて、撮影カメラ９２（雲台９２ｂ）のパン及びチルトを制御するものである。つまり、パン・チルト制御手段２５は、この角度φ，θに基づいて、撮影カメラ９２が被写体９０を向くようなパン・チルト制御信号を生成し、雲台９２ｂに出力する。
ズーム制御手段２４及びパン・チルト制御手段２５が、特許請求の範囲に記載のカメラ制御手段に相当する。
【０１１１】
[作用・効果]
以上のように、カメラ制御装置２は、相対的な角度φ，θｔを算出するため、バイアス誤差が相殺され、正確に距離ｒを算出することができる。その結果、カメラ制御装置２は、被写体９０を向くように撮影カメラ９２を正確に制御することができる。
【０１１２】
なお、前記した実施形態では、本願発明に係る計測装置の一例として、位置計測装置１，１Ｂ及びカメラ制御装置２を説明したが、本願発明はこれらに限定されない。すなわち、図１２に示すように、本願発明に係る計測装置３は、角度算出手段２１１，２１２と、距離算出手段２２とを備えることで、実現可能である。
【０１１３】
また、第３実施形態では、被写体９０の位置を計測しないこととして説明したが、図１の対象物位置検出手段１４（１４Ｂ）と同様の手法で、被写体９０の位置を計測してもよい。この場合、カメラ制御装置２は、計測した被写体９０の位置に基づいて、この撮影カメラ９２のズーム比を制御することができる。
【０１１４】
（参考例１：計測装置の動作原理）
図１３を参照し、参考例１として、本願発明に係る計測装置の動作原理について、説明する。
【０１１５】
図１３に示すように、１台目の撮影カメラ９２１が原点（０，０，０）に配置され、２台目の撮影カメラ９２２が座標（ｘ０，ｙ０，ｚ０）に配置されていることとする。
【０１１６】
また、対象物の位置がＰ１からＰ２に移動し、その移動量ΔＰ＝（Δｘ，Δｙ，Δｚ）が不明であることとする。
また、撮影カメラ９２１から位置Ｐ１までの距離がｒ１であり、撮影カメラ９２１から位置Ｐ２までの距離がｒ１´である。
【０１１７】
また、撮影カメラ９２２から位置Ｐ１までの距離がｒ２であり、撮影カメラ９２２から位置Ｐ２までの距離がｒ２´である。
また、Δｒ１＝ｒ１−ｒ２であり、Δｒ２＝ｒ１´−ｒ２´である。また、撮影カメラ９２１の角度がφ１，θ１であり、撮影カメラ９２２の角度がφ２，θ２である。
【０１１８】
撮影カメラ９２１から見て、ΔＰは、下記の式（１９）で表すことができる。また、撮影カメラ９２２から見て、ΔＰは、下記の式（２０）で表すことができる。
【０１１９】
【数１９】
2014211311.tif 000021
【０１２０】
【数２０】
2014211311.tif 000022
【０１２１】
式（１９）及び式（２０）より、距離ｒ１，ｒ２は、下記の式（２１）で表すことができる。
【０１２２】
【数２１】
2014211311.tif 000023
【０１２３】
また、撮影カメラ９２１について、式（２２）〜式（２４）に示すように、角度φ１，θ１を動座標基底ベクトルｅ１１，ｅ２１，ｅ３１に分解する。
【０１２４】
【数２２】
2014211311.tif 000024
【０１２５】
【数２３】
2014211311.tif 000025
【０１２６】
【数２４】
2014211311.tif 000026
【０１２７】
また、撮影カメラ９２２について、式（２５）〜式（２７）に示すように、角度φ２，θ２を動座標基底ベクトルｅ１２，ｅ２２，ｅ３２に分解する。
【０１２８】
【数２５】
2014211311.tif 000027
【０１２９】
【数２６】
2014211311.tif 000028
【０１３０】
【数２７】
2014211311.tif 000029
【０１３１】
前記した式（２１）〜式（２７）を解くことで、距離ｒ１，ｒ２と、移動量ΔＰとを求めることができる。
【０１３２】
（参考例２：参考例１の別解法）
参考例２として、参考例１の別解法について、説明する。
【０１３３】
ここで、動座標基底ベクトルｅ１，ｅ２，ｅ３は、下記の式（２８）で表される。また、移動量ｄＰ＝Ｐ２−Ｐ１は、下記の式（２９）で表される。
【０１３４】
【数２８】
2014211311.tif 000030
【０１３５】
【数２９】
2014211311.tif 000031
【０１３６】
式（２８）及び式（２９）を連立方程式で解くと、下記の式（３０）が成立し、２台の撮影カメラ９２１，９２２から見て、移動量ｄＰが等しくなる。この式（３０）を、式（３１）の微分方程式として解く。
【０１３７】
【数３０】
2014211311.tif 000032
【０１３８】
【数３１】
2014211311.tif 000033
【０１３９】
なお、φＡ，θＡ，ｅ１Ａ〜ｅ３Ａは、撮影カメラ９２１についての角度φ，θと、動座標基底ベクトルｅ１〜ｅ３である。また、φＢ，θＢ，ｅ１Ｂ〜ｅ３Ｂは、撮影カメラ９２２についての角度φ，θと、動座標基底ベクトルｅ１〜ｅ３である。
ここで、式（３２）が成立し、ｔ＝０のときにｒ＝ｒ１であるから、式（３３）が成立する。
【０１４０】
【数３２】
2014211311.tif 000034
【０１４１】
【数３３】
2014211311.tif 000035
【０１４２】
式（３３）の‘Ｃ’を式（３２）に代入して式（３４）が得られ、この式を２台の撮影カメラに対応した式（３５）及び式（３６）に変換する。
【０１４３】
【数３４】
2014211311.tif 000036
【０１４４】
【数３５】
2014211311.tif 000037
【０１４５】
【数３６】
2014211311.tif 000038
【０１４６】
ここで、式（３７）のように位置Ｐを定義し、Ｘ軸方向で考えると、式（３８）及び式（３９）が成立する。
【０１４７】
【数３７】
2014211311.tif 000039
【０１４８】
【数３８】
2014211311.tif 000040
【０１４９】
【数３９】
2014211311.tif 000041
【０１５０】
また、Ｘ軸方向と同様、Ｙ軸方向で考えると、式（４０）及び式（４１）が成立する。
【０１５１】
【数４０】
2014211311.tif 000042
【０１５２】
【数４１】
2014211311.tif 000043
【０１５３】
また、Ｘ軸方向と同様、Ｚ軸方向で考えると、式（４２）及び式（４３）が成立する。
【０１５４】
【数４２】
2014211311.tif 000044
【０１５５】
【数４３】
2014211311.tif 000045
【０１５６】
前記した式（３９）、式（４１）及び式（４３）により、距離ｒＡｘ，ｒＢｘ，ｒＡｙ，ｒＢｙ，ｒＡｚ，ｒＢｚを求めることができる。以上のように、参考例１，２の何れでも、計算結果が一致する。
【符号の説明】
【０１５７】
１，１Ｂ  位置計測装置
１０  モード選択手段
１１，２０  対象物認識手段（計測対象物認識手段）
１２，１２Ｂ  入力手段
１３，１３Ｂ  動座標基底ベクトル分解手段（角度算出手段）
１４，１４Ｂ  対象物位置検出手段（距離算出手段及び位置算出手段）
１５  地図表示手段
２  カメラ制御装置
２０１，２０２  画像認識・追跡手段
２１１，２１２  角度算出手段
２２  距離算出手段
２３  面積算出手段
２４  ズーム制御手段（カメラ制御手段）
２５  パン・チルト制御手段（カメラ制御手段）
【図１】
2014211311.tif 000046
【図２】
2014211311.tif 000047
【図３】
2014211311.tif 000048
【図４】
2014211311.tif 000049
【図５】
2014211311.tif 000050
【図６】
2014211311.tif 000051
【図７】
2014211311.tif 000052
【図８】
2014211311.tif 000053
【図９】
2014211311.tif 000054
【図１０】
2014211311.tif 000055
【図１１】
2014211311.tif 000056
【図１２】
2014211311.tif 000057
【図１３】
2014211311.tif 000058