(57)【特許請求の範囲】
【請求項１】
相対座標が既知である３点以上の基準点のうちのいずれか３点である第１の基準点が、第１の視点から第１の撮像装置により撮像された第１の基準画像と、前記３点以上の基準点のうちのいずれか３点であり、前記３点の第１の基準点と同一又は異なる第２の基準点が、第２の視点から第２の撮像装置により撮像された第２の基準画像とを取得する画像取得部と、
前記第１の撮像装置で撮像された画像における画素毎に、当該画素に投影される三次元座標系の各点と前記第１の視点とを結ぶ線分と、前記第１の撮像装置の光軸とのなす角度である第１の画素視点投影角の情報と、前記第２の撮像装置で撮像された画像における画素毎に、当該画素に投影される前記三次元座標系の各点と前記第２の視点とを結ぶ線分と、前記第２の撮像装置の光軸とのなす角度である第２の画素視点投影角の情報とを保持する記憶部と、
前記第１の画素視点投影角の情報を用いて、前記第１の基準画像に投影される前記３点の第１の基準点に対応する前記第１の画素視点投影角である３つの第１の基準視点投影角を取得する第１の視点投影角抽出部と、
前記第２の画素視点投影角の情報を用いて、前記第２の基準画像に投影される前記３点の第２の基準点に対応する前記第２の画素視点投影角である３つの第２の基準視点投影角を取得する第２の視点投影角抽出部と、
前記３つの第１の基準視点投影角と前記３点の第１の基準点の相対座標とを用いて、前記第１の基準画像の撮像面である第１の撮像面と前記３点の基準点を含む第１の基準平面とのなす第１の傾斜角を算出する第１の傾斜角算出部と、
前記３つの第２の基準視点投影角と前記３点の第２の基準点の相対座標とを用いて、前記第２の基準画像の撮像面である第２の撮像面と前記３点の第２の基準点を含む第２の基準平面とのなす第２の傾斜角を算出する第２の傾斜角算出部と、
前記３点の第１の基準点と前記３点の第２の基準点との相対位置関係と、前記第１の傾斜角と、前記第２の傾斜角とを用いて、前記第１の撮像装置の光軸方向と、前記第２の撮像装置の光軸方向と、前記第１の撮像装置が、当該第１の撮像装置の光軸を中心として回転している角度である第１の回転角と、前記第２の撮像装置が、当該第２の撮像装置の光軸を中心として回転している角度である第２の回転角とを算出する設定情報算出部とを備える
三次元座標計測装置。
【請求項２】
前記画像取得部は、さらに、前記第１の視点から前記第１の撮像装置により対象点が撮像された第１の対象画像と、前記第２の視点から前記第２の撮像装置により前記対象点が撮像された第２の対象画像とを取得し、
前記記憶部は、さらに、前記第１の視点と前記第２の視点との相対位置を示す視点間情報とを保持し、
前記三次元座標計測装置は、さらに、
前記第１の画素視点投影角の情報を用いて、前記第１の対象画像に投影される前記対象点に対応する前記第１の画素視点投影角である第１の対象視点投影角を取得する第３の視点投影角抽出部と、
前記第２の画素視点投影角の情報を用いて、前記第２の対象画像に投影される前記対象点に対応する前記第２の画素視点投影角である第２の対象視点投影角を取得する第４の視点投影角抽出部と、
前記第１及び第２の対象視点投影角と、前記第１及び第２の撮像装置の光軸方向と、前記視点間情報と、前記第１及び第２の回転角とを用いて、前記対象点の前記三次元座標を算出する座標算出部とを備える
請求項１記載の三次元座標計測装置。
【請求項３】
前記座標算出部は、
前記第１の対象視点投影角と、前記第１の撮像装置の光軸方向と、前記第１の回転角とを用いて、前記第１の視点と前記第２の視点とを結ぶ線分と、前記第１の視点と前記対象点とを結ぶ線分とがなす角度である第１の対象角を算出し、
前記第２の対象視点投影角と、前記第２の撮像装置の光軸方向と、前記第２の回転角とを用いて、前記第１の視点と前記第２の視点とを結ぶ線分と、前記第２の視点と前記対象点とを結ぶ線分とがなす角度である第２の対象角を算出し、
前記視点間情報と、前記第１の対象角と、前記第２の対象角とを用いて、前記対象点の三次元座標を算出する
請求項２記載の三次元座標計測装置。
【請求項４】
前記設定情報算出部は、
前記第１の撮像装置の光軸方向を示す情報として、前記第１の視点を通り、かつ、前記第１の視点と前記第２の視点とを結ぶ線分と垂直である第１の基準線と、前記第１の撮像装置の光軸とのなす角度である第１の撮影角を算出し、
前記第２の撮像装置の光軸方向を示す情報として、前記第２の視点を通り、かつ、前記第１の視点と前記第２の視点とを結ぶ線分と垂直であり、かつ、前記第１の基準線と平行な第２の基準線と、前記第２の撮像装置の光軸とのなす角度である第２の撮影角を算出し、
前記座標算出部は、
前記第１の視点と前記第２の視点とを結ぶ線分と前記第１の基準線とがなす角度と、前記第１の視点投影角と、前記第１の撮影角と、前記第１の回転角とを用いて前記第１の対象角を算出し、
前記第１の視点と前記第２の視点とを結ぶ線分と前記第２の基準線とがなす角度と、前記第２の視点投影角と、前記第２の撮影角と、前記第２の回転角とを用いて前記第２の対象角を算出する
請求項３記載の三次元座標計測装置。
【請求項５】
前記設定情報算出部は、
前記３点の第１の基準点と前記３点の第２の基準点との相対位置関係と、前記第１の傾斜角と、前記第２の傾斜角とを用いて、前記第１の視点及び前記第２の視点の三次元座標を算出し、
前記第１の視点及び前記第２の視点の三次元座標から、前記第１の視点と前記第２の視点との相対位置を示す視点間情報を算出する
請求項１に記載の三次元座標計測装置。
【請求項６】
相対座標が既知である３点以上の基準点のうちのいずれか３点である第１の基準点が、第１の視点から第１の撮像装置により撮像された第１の基準画像と、前記３点以上の基準点のうちのいずれか３点であり、前記３点の第１の基準点と同一又は異なる第２の基準点が、第２の視点から第２の撮像装置により撮像された第２の基準画像とを取得するステップと、
前記第１の撮像装置で撮像された画像における画素毎に、当該画素に投影される三次元座標系の各点と前記第１の視点とを結ぶ線分と、前記第１の撮像装置の光軸とのなす角度である第１の画素視点投影角の情報と、前記第２の撮像装置で撮像された画像における画素毎に、当該画素に投影される前記三次元座標系の各点と前記第２の視点とを結ぶ線分と、前記第２の撮像装置の光軸とのなす角度である第２の画素視点投影角の情報とを保持するステップと、
前記第１の画素視点投影角の情報を用いて、前記第１の基準画像に投影される前記３点の第１の基準点に対応する前記第１の画素視点投影角である３つの第１の基準視点投影角を取得するステップと、
前記第２の画素視点投影角の情報を用いて、前記第２の基準画像に投影される前記３点の第２の基準点に対応する前記第２の画素視点投影角である３つの第２の基準視点投影角を取得するステップと、
前記３つの第１の基準視点投影角と前記３点の第１の基準点の相対座標とを用いて、前記第１の基準画像の撮像面である第１の撮像面と前記３点の基準点を含む第１の基準平面とのなす第１の傾斜角を算出するステップと、
前記３つの第２の基準視点投影角と前記３点の第２の基準点の相対座標とを用いて、前記第２の基準画像の撮像面である第２の撮像面と前記３点の第２の基準点を含む第２の基準平面とのなす第２の傾斜角を算出するステップと、
前記３点の第１の基準点と前記３点の第２の基準点との相対位置関係と、前記第１の傾斜角と、前記第２の傾斜角とを用いて、前記第１の撮像装置の光軸方向と、前記第２の撮像装置の光軸方向と、前記第１の撮像装置が、当該第１の撮像装置の光軸を中心として回転している角度である第１の回転角と、前記第２の撮像装置が、当該第２の撮像装置の光軸を中心として回転している角度である第２の回転角とを算出するステップとを含む
三次元座標計測方法。
【請求項７】
請求項６に記載の三次元座標計測方法をコンピュータに実行させるためのプログラム。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、異なる視点から対象点が撮影された２枚の画像を用いて、当該対象点の三次元座標を計測する三次元座標計測装置及び三次元座標計測方法に関する。
【背景技術】
【０００２】
画像を用いて相対点の座標を計測する方法として、ステレオ法が知られている。【０００３】
ステレオ法は、異なる位置に置かれた２つのカメラ（撮像装置）で対象点を撮像する、または、１つのカメラで異なる２つの位置から対象点を撮像する。そしてステレオ法は、この２つの画像を用いて、対象点の座標を算出する。具体的には、ステレオ法は、人間の両眼視のように、視差に基づく画像の微妙な違いに基づき、対象点の三次元座標を算出する（例えば、特許文献１及び特許文献２参照）。
【先行技術文献】
【特許文献】
【０００４】
【特許文献１】特開平９−７９８４５号公報
【特許文献２】特開平７−２１８２５１号公報
【発明の概要】
【発明が解決しようとする課題】
【０００５】
しかしながら、特許文献１記載の技術では、２台のカメラは平行ステレオ配置にしなければならず、正確なカメラの設定が必要となる。【０００６】
それに対して、特許文献２記載の技術は、カメラの撮影方向のずれを補正することで、２台のカメラが平行ステレオ配置からずれている場合でも、対象点の三次元座標を算出することを可能としている。【０００７】
ただし、特許文献２記載の技術では、２台のカメラの配置がステレオ配置から大きくずれる場合には、補正を行うことができないという課題を有する。【０００８】
そこで、本発明は、２台のカメラの設定の自由度を向上できる三次元座標計測装置を提供することを目的とする。
【課題を解決するための手段】
【０００９】
上記目的を達成するために、本発明の一形態に係る三次元座標計測装置は、対象点の三次元座標を計測する三次元座標計測装置であって、第１の視点から第１の撮像装置により前記対象点が撮像された第１の対象画像と、第２の視点から第２の撮像装置により前記対象点が撮像された第２の対象画像とを取得する画像取得部と、前記第１の撮像装置で撮像された画像における画素毎に、当該画素に投影される三次元座標系の各点と前記第１の視点とを結ぶ線分と、前記第１の撮像装置の光軸とのなす角度である第１の画素視点投影角の情報と、前記第２の撮像装置で撮像された画像における画素毎に、当該画素に投影される前記三次元座標系の各点と前記第２の視点とを結ぶ線分と、前記第２の撮像装置の光軸とのなす角度である第２の画素視点投影角の情報と、前記第１の撮像装置の光軸方向を示す第１の光軸情報と、前記第２の撮像装置の光軸方向を示す第２の光軸情報と、前記第１の視点と前記第２の視点との相対位置を示す視点間情報とを保持する記憶部と、前記第１の画素視点投影角の情報を用いて、前記第１の対象画像に投影される前記対象点に対応する前記第１の画素視点投影角である第１の対象視点投影角を取得する第１の視点投影角抽出部と、前記第２の画素視点投影角の情報を用いて、前記第２の対象画像に投影される前記対象点に対応する前記第２の画素視点投影角である第２の対象視点投影角を取得する第２の視点投影角抽出部と、前記第１及び第２の対象視点投影角と、前記第１及び第２の撮像装置の光軸方向と、前記視点間情報とを用いて、前記対象点の三次元座標を算出する座標算出部とを備える。【００１０】
この構成によれば、本発明の一形態に係る三次元座標計測装置は、２台のカメラが平行ステレオ配置でない場合でも、視点投影角を用いて対象点の三次元座標を容易に算出できる。このように、本発明の一形態に係る三次元座標計測装置は、２台のカメラの設定の自由度を向上できる。【００１１】
また、前記記憶部は、さらに、前記第１の撮像装置が、当該第１の撮像装置の光軸を中心として回転している角度である第１の回転角を示す情報と、前記第２の撮像装置が、当該第２の撮像装置の光軸を中心として回転している角度である第２の回転角を示す情報とを保持し、前記座標算出部は、前記第１及び第２の対象視点投影角と、前記第１及び第２の撮像装置の光軸方向と、前記視点間情報と、前記第１及び第２の回転角とを用いて、前記対象点の前記三次元座標を算出してもよい。【００１２】
この構成によれば、本発明の一形態に係る三次元座標計測装置は、カメラが、当該カメラの光軸を中心に回転している場合でも対象点の三次元座標を容易に算出できる。【００１３】
また、前記座標算出部は、前記第１の対象視点投影角と、前記第１の撮像装置の光軸方向と、前記第１の回転角とを用いて、前記第１の視点と前記第２の視点とを結ぶ線分と、前記第１の視点と前記対象点とを結ぶ線分とがなす角度である第１の対象角を算出し、前記第２の対象視点投影角と、前記第２の撮像装置の光軸方向と、前記第２の回転角とを用いて、前記第１の視点と前記第２の視点とを結ぶ線分と、前記第２の視点と前記対象点とを結ぶ線分とがなす角度である第２の対象角を算出し、前記視点間情報と、前記第１の対象角と、前記第２の対象角とを用いて、前記対象点の三次元座標を算出してもよい。【００１４】
また、前記第１の光軸情報は、前記第１の視点を通り、かつ、前記第１の視点と前記第２の視点とを結ぶ線分と垂直である第１の基準線と、前記第１の撮像装置の光軸とのなす角度である第１の撮影角を示す情報であり、前記第２の光軸情報は、前記第２の視点を通り、かつ、前記第１の視点と前記第２の視点とを結ぶ線分と垂直であり、かつ、前記第１の基準線と平行な第２の基準線と、前記第２の撮像装置の光軸とのなす角度である第２の撮影角を示す情報であり、前記座標算出部は、前記第１の視点と前記第２の視点とを結ぶ線分と前記第１の基準線とがなす角度と、前記第１の視点投影角と、前記第１の撮影角と、前記第１の回転角とを用いて前記第１の対象角を算出し、前記第１の視点と前記第２の視点とを結ぶ線分と前記第２の基準線とがなす角度と、前記第２の視点投影角と、前記第２の撮影角と、前記第２の回転角とを用いて前記第２の対象角を算出してもよい。【００１５】
また、前記画像取得部は、さらに、相対座標が既知である３点以上の基準点のうちのいずれか３点である第１の基準点が、前記第１の視点から前記第１の撮像装置により撮像された第１の基準画像と、前記３点以上の基準点のうちのいずれか３点である第２の基準点が、前記第２の視点から前記第２の撮像装置により撮像された第２の基準画像とを取得し、前記三次元座標計測装置は、さらに、前記第１の画素視点投影角の情報を用いて、前記第１の基準画像に投影される前記３点の第１の基準点に対応する前記第１の画素視点投影角である３つの第１の基準視点投影角を取得する第３の視点投影角抽出部と、前記第２の画素視点投影角の情報を用いて、前記第２の基準画像に投影される前記３点の第２の基準点に対応する前記第２の画素視点投影角である３つの第２の基準視点投影角を取得する第４の視点投影角抽出部と、前記３つの第１の基準視点投影角と前記３点の第１の基準点の相対座標とを用いて、前記第１の基準画像の撮像面である第１の撮像面と前記３点の基準点を含む第１の基準平面とのなす第１の傾斜角を算出する第１の傾斜角算出部と、前記３つの第２の基準視点投影角と前記３点の第２の基準点の相対座標とを用いて、前記第２の基準画像の撮像面である第２の撮像面と前記３点の第２の基準点を含む第２の基準平面とのなす第２の傾斜角を算出する第２の傾斜角算出部と、前記３点の第１の基準点と前記３点の第２の基準点との相対位置関係と、前記第１の傾斜角と、前記第２の傾斜角とを用いて、前記第１の撮像装置の光軸方向と、前記第２の撮像装置の光軸方向と、前記第１の回転角と、前記第２の回転角とを算出する設定情報算出部とを備えてもよい。【００１６】
この構成によれば、本発明の一形態に係る三次元座標計測装置は、視点投影角を用いて、第１及び第２の撮像装置の光軸方向を容易に算出できる。【００１７】
また、前記設定情報算出部は、前記３点の第１の基準点と前記３点の第２の基準点との相対位置関係と、前記第１の傾斜角と、前記第２の傾斜角とを用いて、前記第１の視点及び前記第２の視点の三次元座標を算出し、前記第１の視点及び前記第２の視点の三次元座標から、前記視点間情報を算出してもよい。【００１８】
この構成によれば、本発明の一形態に係る三次元座標計測装置は、視点投影角を用いて視点間距離を容易に算出できる。【００１９】
なお、本発明は、このような三次元座標計測装置として実現できるだけでなく、三次元座標計測装置に含まれる特徴的な手段をステップとする三次元座標計測方法として実現したり、そのような特徴的なステップをコンピュータに実行させるプログラムとして実現したりすることもできる。そして、そのようなプログラムは、ＣＤ−ＲＯＭ等の非一時的なコンピュータ読み取り可能な記録媒体、及びインターネット等の伝送媒体を介して流通させることができるのは言うまでもない。
【発明の効果】
【００２０】
本発明は、２台のカメラの設定の自由度を向上できる三次元座標計測装置を提供できる。
【図面の簡単な説明】
【００２１】
【図１】図１は、本発明の実施の形態に係る三次元座標計測装置を含むシステムの構成を示す図である。
【図２】図２は、本発明の実施の形態に係る三次元座標計測装置のブロック図である。
【図３】図３は、本発明の実施の形態に係る三次元座標計測処理を説明するための図である。
【図４】図４は、本発明の実施の形態に係る三次元計測処理のフローチャートである。
【図５】図５は、本発明の実施の形態に係る、第１の調整動作時における、三次元座標計測装置を含むシステムの構成を示す図である。
【図６】図６は、本発明の実施の形態に係るカメラ設定検出部のブロック図である。
【図７】図７は、本発明の実施の形態に係る第１の調整動作のフローチャートである。
【図８】図８は、本発明の実施の形態に係る、第１の調整動作を説明するための図である。
【図９Ａ】図９Ａは、本発明の実施の形態に係る、第１の撮像面に投影される基準点を示す図である。
【図９Ｂ】図９Ｂは、本発明の実施の形態に係る、第２の撮像面に投影される基準点を示す図である。
【図１０】図１０は、本発明の実施の形態に係る傾斜角算出処理のフローチャートである。
【図１１】図１１は、本発明の実施の形態に係る傾斜角算出処理を説明するための図である。
【図１２】図１２は、本発明の実施の形態に係る傾斜角算出処理を説明するための図である。
【図１３】図１３は、本発明の実施の形態に係る第１の調整動作を説明するための図である。
【図１４】図１４は、本発明の実施の形態に係る、第２の調整動作時における、三次元座標計測装置を含むシステムの構成を示す図である。
【図１５】図１５は、本発明の実施の形態に係る第２の調整動作のフローチャートである。
【図１６】図１６は、本発明の実施の形態に係る視点投影角を説明するための図である。
【図１７Ａ】図１７Ａは、本発明の実施の形態に係る、歪み補正前の画像例を示す図である。
【図１７Ｂ】図１７Ｂは、本発明に実施の形態に係る、歪み補正後の画像例を示す図である。
【図１８】図１８は、本発明の実施の形態に係る第２の調整動作を説明するための図である。
【発明を実施するための形態】
【００２２】
以下、本発明の実施の形態について図面を用いて詳細に説明する。なお、以下で説明する実施の形態は、いずれも本発明の好ましい一具体例を示すものである。以下の実施の形態で示される数値、形状、材料、構成要素、構成要素の配置位置及び接続形態、ステップ、ステップの順序などは、一例であり、本発明を限定する主旨ではない。本発明は、請求の範囲だけによって限定される。よって、以下の実施の形態における構成要素のうち、本発明の最上位概念を示す独立請求項に記載されていない構成要素については、本発明の課題を達成するのに必ずしも必要ではないが、より好ましい形態を構成するものとして説明される。
【００２３】
本発明の実施の形態に係る三次元座標計測装置は、異なる視点より対象点が撮影された２つの画像から、各画像における対象点の視点投影角を抽出する。そして、当該三次元座標計測装置は、当該視点投影角を用いて、対象点の座標を算出する。
【００２４】
これにより、本発明の実施の形態に係る三次元座標計測装置は、２台のカメラが平行ステレオ配置でない場合でも対象点の三次元座標を算出できる。このように、本発明の実施の形態に係る三次元座標計測装置は、２台のカメラの設定の自由度を向上できる。
【００２５】
まず、本発明の実施の形態に係る三次元座標計測装置を含む三次元座標計測システムの構成を説明する。
【００２６】
図１は、本発明の実施の形態に係る三次元座標計測システムの構成を示す図である。
【００２７】
図１に示す三次元座標計測システムは、対象構造物５０に含まれる対象点Ｗの三次元座標を計測する。この三次元座標計測システムは、三次元座標計測装置９０と、撮像装置であるカメラ１０Ａ及び１０Ｂと、ケーブル３０Ａ及び３０Ｂとを含む。
【００２８】
カメラ１０Ａは、対象構造物５０を、第１の視点Ｍ１から撮像することにより画像データ６０Ａを生成する第１の撮像装置である。カメラ１０Ｂは、対象構造物５０を、第２の視点Ｍ２から撮像することにより画像データ６０Ｂを生成する第２の撮像装置である。ここで、第１の視点Ｍ１及び第２の視点Ｍ２は、カメラ１０Ａ及び１０Ｂの撮影レンズの主点の位置に対応している。また、図１中、２点鎖線で書かれているＯ１及びＯ２は、それぞれカメラ１０Ａ及び１０Ｂの光軸（撮影レンズの光軸）を示している。
【００２９】
また、カメラ１０Ａとカメラ１０Ｂとの相対位置関係と、光軸Ｏ１及びＯ２とは予め設定されている。例えば、カメラ１０Ａとカメラ１０Ｂとは所定の部材を介して連結されている。これにより、カメラ１０Ａとカメラ１０Ｂとの相対位置関係と、カメラ１０Ａ及びカメラ１０Ｂの向き（光軸）とは固定されている。
【００３０】
カメラ１０Ａで生成された画像データ６０Ａは、ケーブル３０Ａを介して、三次元座標計測装置９０へ送られる。カメラ１０Ｂで生成された画像データ６０Ｂは、ケーブル３０Ｂを介して、三次元座標計測装置９０へ送られる。
【００３１】
ケーブル３０Ａ及び３０Ｂは、例えば、ＵＳＢ（Ｕｎｉｖｅｒｓａｌ  Ｓｅｒｉａｌ  Ｂｕｓ）ケーブルである。なお、ケーブル３０Ａ及び３０Ｂは、ＵＳＢ以外のケーブルであってもよい。また、カメラ１０Ａ及び１０Ｂは、画像データ６０Ａ及び６０Ｂを、無線通信を介して、三次元座標計測装置９０へ送ってもよい。また、カメラ１０Ａ、１０Ｂ及び三次元座標計測装置９０に着脱可能な記録媒体を用いて、画像データ６０Ａ及び６０Ｂを三次元座標計測装置９０へ送ってもよい。
【００３２】
三次元座標計測装置９０は、例えば、パーソナルコンピュータである。この三次元座標計測装置９０は、画像データ６０Ａ及び６０Ｂを用いて対象点Ｗの三次元座標を計測する。
【００３３】
図２は、本発明の実施の形態に係る三次元座標計測装置９０の特徴的な機能構成を示すブロック図である。例えば、図２に示す処理部の機能は、パーソナルコンピュータに含まれるプロセッサがプログラムを実行することにより実現される。
【００３４】
この三次元座標計測装置９０は、異なる視点から対象点Ｗが撮影された２枚の画像を用いて、対象点Ｗの三次元座標１１２を算出する。ここで、三次元座標１１２は、例えば、第１の視点Ｍ１を原点とする三次元座標系における座標である。なお、三次元座標１１２の三次元座標系は、これに限定されるものではなく任意の三次元座標系でもよい。また、三次元座標１１２は、予め定められた点と対象点との相対座標であってもよいし、予め定められた点と対象点Ｗとの距離を示す情報であってもよい。ここで予め定められた点とは、例えば、第１の視点Ｍ１又は第２の視点Ｍ２である。なお、この予め定められた点は、第１の視点Ｍ１と第２の視点Ｍ２との間に存在する任意の点であってもよい。
【００３５】
図２に示すように三次元座標計測装置９０は、画像取得部１０１と、記憶部１０２と、第１の視点投影角抽出部１０３Ａと、第２の視点投影角抽出部１０３Ｂと、座標算出部１０５と、カメラ設定検出部１０６とを備える。
【００３６】
画像取得部１０１は、第１の視点Ｍ１からカメラ１０Ａにより対象点Ｗが撮像された第１の対象画像（画像データ６０Ａ）と、第２の視点Ｍ２からカメラ１０Ｂにより対象点Ｗが撮像された第２の対象画像（画像データ６０Ｂ）とを取得する。
【００３７】
記憶部１０２は、第１の視点投影角情報１１１Ａと、第２の視点投影角情報１１１Ｂと、第１の撮影角θＡと、第２の撮影角θＢと、視点間距離ｄとを保持する。
【００３８】
図３は、カメラ１０Ａ及び１０Ｂと対象点Ｗとの関係を示す図である。図３に示す第１の基準線Ｌは、第１の視点Ｍ１を通り、かつ、第１の視点Ｍ１と第２の視点Ｍ２とを結ぶ線分Ｍ１Ｍ２と垂直な直線である。基準線Ｒは、第２の視点Ｍ２を通り、かつ、線分Ｍ１Ｍ２と垂直な直線である。また、基準線Ｌ及び基準線Ｒは平行線である。
【００３９】
なお、図３では二次元の座標及び角度等を図示しているが、実際には、三次元の座標及び角度等が用いられる。また、この場合でも、以下に示す方法と同様の方法を用いることができるので、ここでは説明の簡略化のために図３を用いて説明を行う。
【００４０】
第１の撮影角θＡは、第１の基準線Ｌと、カメラ１０Ａの光軸Ｏ１とのなす角度である。第２の撮影角θＢは、第２の基準線Ｒと、カメラ１０Ｂの光軸Ｏ２とのなす角度である。言い換えると、第１の撮影角θＡは、カメラ１０Ａの光軸方向を示す第１の光軸情報であり、第２の撮影角θＢは、カメラ１０Ｂの光軸方向を示す第２の光軸情報である。
【００４１】
視点間距離ｄは、第１の視点Ｍ１と第２の視点Ｍ２との間の距離と、第１の視点Ｍ１と第２の視点Ｍ２との配置関係とを示す。ここで第１の視点Ｍ１と第２の視点Ｍ２との配置関係とは、例えば、カメラ１０Ａ（第１の視点Ｍ１）及びカメラ１０Ｂ（第１の視点Ｍ２）のうちいずれか右側に配置されており、いずれが左側に配置されているかを示す情報である。つまり、視点間距離ｄは、第１の視点Ｍ１と第２の視点Ｍ２との相対座標（相対位置）を示す相対位置情報である。
【００４２】
第１の視点投影角情報１１１Ａは、カメラ１０Ａで撮影された画像における、各画素の視点投影角（本発明の第１の画素視点投影角に相当）を示す情報である。ここで視点投影角とは、画素に投影される三次元座標系の各点と視点とを結ぶ線分と、撮像装置（カメラ）の光軸とのなす角度である。また、視点投影角は、カメラの設定に応じて決定される値であり、カメラの設定状態ごとに一意に決定される値である。例えば、第１の視点投影角情報１１１Ａは、複数の画素の各々に対応する視点投影角を示すテーブルである。
【００４３】
第２の視点投影角情報１１１Ｂは、カメラ１０Ｂで撮影された画像における、各画素の視点投影角（本発明の第２の画素視点投影角に相当）を示す情報である。例えば、第２の視点投影角情報１１１Ｂは、複数の画素の各々に対応する視点投影角を示すテーブルである。
【００４４】
また、これらの第１の視点投影角情報１１１Ａと、第２の視点投影角情報１１１Ｂと、第１の撮影角θＡと、第２の撮影角θＢと、視点間距離ｄとは、予め記憶部１０２に記憶されていてもよいし、後述するように、カメラ設定検出部１０６により算出されてもよい。
【００４５】
また、第１の視点投影角情報１１１Ａと、第２の視点投影角情報１１１Ｂと、第１の撮影角θＡと、第２の撮影角θＢと、視点間距離ｄとは、複数の記憶部１０２に分割して記憶されていてもよい。
【００４６】
第１の視点投影角抽出部１０３Ａは、第１の視点投影角情報１１１Ａを用いて、第１の対象画像に投影される対象点Ｗに対応する視点投影角θＡ１（本発明の第１の対象視点投影角に相当）を取得する。
【００４７】
第２の視点投影角抽出部１０３Ｂは、第２の視点投影角情報１１１Ｂを用いて、第２の対象画像に投影される対象点Ｗに対応する視点投影角θＢ１（本発明の第２の対象視点投影角に相当）を取得する。
【００４８】
座標算出部１０５は、第１の視点投影角抽出部１０３Ａ及び第２の視点投影角抽出部１０３Ｂにより取得された対象視点投影角θＡ１及びθＢ１と、第１の撮影角θＡ及び第２の撮影角θＢと、視点間距離ｄとを用いて、対象点Ｗの三次元座標１１２を算出する。
【００４９】
座標算出部１０５により算出された対象点Ｗの三次元座標１１２は、例えば、三次元座標計測装置９０が備える表示部（図示せず）に表示される。なお、三次元座標１１２は、三次元座標計測装置９０の外部に出力されてもよいし、三次元座標計測装置９０が備える記憶部に記憶されてもよい。
【００５０】
カメラ設定検出部１０６は、第１の視点投影角情報１１１Ａと、第２の視点投影角情報１１１Ｂと、第１の撮影角θＡと、第２の撮影角θＢと、視点間距離ｄとを算出し、算出した第１の視点投影角情報１１１Ａと、第２の視点投影角情報１１１Ｂと、第１の撮影角θＡと、第２の撮影角θＢと、視点間距離ｄとを記憶部に記憶する。
【００５１】
次に、三次元座標計測装置９０の動作を説明する。
【００５２】
図４は、三次元座標計測装置９０による三次元座標計測処理のフローチャートである。
【００５３】
まず、画像取得部１０１は、第１の対象画像及び第２の対象画像を取得する（Ｓ１０１）。ここで、第１の対象画像は、第１の視点Ｍ１からカメラ１０Ａにより対象点Ｗが撮像された画像である。第２の対象画像は、第２の視点Ｍ２からカメラ１０Ｂにより対象点Ｗが撮像された画像である。
【００５４】
次に、第１の視点投影角抽出部１０３Ａは、第１の対象画像から対象点Ｗの座標を抽出する。そして、第１の視点投影角抽出部１０３Ａは、第１の視点投影角情報１１１Ａを参照して、抽出した対象点Ｗの座標に対応する視点投影角θＡ１を取得する。同様に、第２の視点投影角抽出部１０３Ｂは、第２の対象画像から対象点Ｗの座標を抽出する。そして、第２の視点投影角抽出部１０３Ｂは、第２の視点投影角情報１１１Ｂを参照して、抽出した対象点Ｗの座標に対応する視点投影角θＢ１を取得する（Ｓ１０２）。
【００５５】
次に、座標算出部１０５は、第１の撮影角θＡと、第２の撮影角θＢと、視点投影角θＡ１及びθＢ１とを用いて、図３に示す第１の対象角θＡ２及び第２の対象角θＢ２を算出する（Ｓ１０３）。ここで、図３に示すように、第１の対象角θＡ２は、線分Ｍ１Ｍ２と、線分Ｍ１Ｗとのなす角度である。第２の対象角θＢ２は、線分Ｍ１Ｍ２と、線分Ｍ２Ｗとのなす角度である。
【００５６】
具体的には、座標算出部１０５は、下記（式１）を用いて、第１の対象角θＡ２を算出する。また、座標算出部１０５は、下記（式２）を用いて、第２の対象角θＢ２を算出する。
【００５７】
θＡ２＝θＬ−θＡ−θＡ１      （式１）
θＢ２＝θＲ−θＢ−θＢ１      （式２）
【００５８】
ここで、θＬは、第１の基準線Ｌと線分Ｍ１Ｍ２とがなす角度である。θＲは、第２の基準線Ｒと線分Ｍ１Ｍ２とがなす角度である。また、ここでは、θＬ及びθＲは、共に９０度である。
【００５９】
次に、座標算出部１０５は、第１の対象角θＡ２と、第２の対象角θＢ２と、視点間距離ｄとを用いて、対象点Ｗの三次元座標１１２を算出する（Ｓ１０４）。
【００６０】
ここで、第１の対象角θＡ２と第２の対象角θＢ２とから、対象点Ｗ、第１の視点Ｍ１及び第２の視点Ｍ２を頂点とする三角形ＷＭ１Ｍ２の３つの内角が分かる。さらに、三角形ＷＭ１Ｍ２の一辺Ｍ１Ｍ２の長さ（視点間距離ｄ）が既知なので、対象点Ｗの三次元座標１１２を算出する。
【００６１】
また、視点間距離ｄは、第１の視点Ｍ１と第２の視点Ｍ２との相対位置関係を示す情報である。言い換えると、この視点間距離ｄを用いて、任意の三次元座標系において、第１の視点Ｍ１及び第２の視点Ｍ２の三次元座標を定義できる。例えば、座標算出部１０５は、第１の視点Ｍ１の座標を原点（０，０，０）とし、第２の視点Ｍ２の座標を（ｄ，０，０）とする三次元座標系を設定する。そして、座標算出部１０５は、設定した三次元座標系における対象点Ｗの座標を算出する。
【００６２】
また、例えば、三次元座標算出部１０５は、以下の方法で対象点Ｗの三次元座標１１２を算出できる。
【００６３】
まず、座標算出部１０５は、第１の対象角θＡ２を用いて、第１の視点Ｍ１と対象点Ｗとを通る第１のベクトルを算出する。具体的には、座標算出部１０５は、第１の視点Ｍ１を通り、かつ、第１の対象角θＡ２で示される方向のベクトルを第１のベクトルとして算出する。なお、座標算出部１０５は、第１の対象角θＡ２の代わりに、第１の撮影角θＡ及び視点投影角θＡ１を用いてもよい。
【００６４】
同様に、座標算出部１０５は、第２の対象角θＢ２を用いて、第２の視点Ｍ２と対象点Ｗとを通る第２のベクトルを算出する。また、座標算出部１０５は、第２の対象角θＢ２の代わりに、第２の撮影角θＢ及び視点投影角θＢ１を用いてもよい。
【００６５】
次に、座標算出部１０５は、第１のベクトルと第２のベクトルとの最接近点の座標を、対象点Ｗの三次元座標１１２として算出する。
【００６６】
以上の処理により、三次元座標計測装置９０は、対象点Ｗの三次元座標１１２を算出できる。
【００６７】
このように、本発明の実施の形態に係る三次元座標計測装置９０は、カメラ１０Ａ及びカメラ１０Ｂで撮影された画像の各画素に対する視点投影角を予め保持しておき、保持する視点投影角を用いて、対象点Ｗの三次元座標１１２を算出する。具体的には、三次元座標計測装置９０は、異なる視点より対象点が撮影された２つの画像から、各画像における対象点の視点投影角を抽出する。そして、当該三次元座標計測装置は、当該視点投影角を用いて、対象点の座標を算出する。
【００６８】
これにより、本発明の実施の形態に係る三次元座標計測装置９０は、対象点Ｗの三次元座標を容易に算出できる。さらに、三次元座標計測装置９０は、第１の撮影角θＡ及び第２の撮影角θＢを用いることで、２台のカメラが平行ステレオ配置でない場合でも対象点Ｗの三次元座標を算出できる。このように、本発明の実施の形態に係る三次元座標計測装置９０は、２台のカメラの設定の自由度を向上できる。
【００６９】
また、上記特許文献１及び特許文献２記載の技術では、撮像画像に必須の情報が必要になる。具体的には、特許文献１ではナンバープレートが必要であり、特許文献２では「実空間における互いに変更な少なくとも２本の直線」が必要である。一方で、本実施の形態に係る三次元座標計測装置９０では、これらの情報が必要ない。
【００７０】
なお、上記説明では、第１の基準線Ｌは、第１の視点Ｍ１を通り、かつ線分Ｍ１Ｍ２に垂直な直線を用いる例を述べたが、第１の基準線Ｌは、第１の視点Ｍ１を通る直線であればよい。この場合でも、上記と同様の処理を行うことができる。同様に、第２の基準線Ｒは、第２の視点Ｍ２を通る直線であればよい。言い換えると、第１の撮影角θＡ及び第２の撮影角θＢは、カメラ１０Ａ及び１０Ｂの光軸方向を示す情報であればよい。例えば、第１の基準線Ｌ及び第２の基準線Ｒは、互いに平行かつ線分Ｍ１Ｍ２に対して垂直でない直線であってもよい。また、線分Ｍ１Ｍ２と、カメラの光軸とのなす角を、第１の撮影角θＡ及び第２の撮影角θＢとして用いてもよい。
【００７１】
また、視点間距離ｄは、第１の視点Ｍ１と第２の視点Ｍ２との相対位置関係を示す情報であればよい。例えば、視点間距離ｄの代わりに、三次元座標系における第１の視点Ｍ１の座標及び第２の視点Ｍ２の座標を用いてもよい。
【００７２】
次に、カメラ設定検出部１０６による第１の撮影角θＡ、第２の撮影角θＢ及び視点間距離ｄを検出する第１の調整動作を説明する。なお、第１の調整動作時には、第１の視点投影角情報１１１Ａ及び第２の視点投影角情報１１１Ｂは、記憶部１０２に保持されている。
【００７３】
図５は、第１の調整動作時における、本実施の形態に係る三次元座標計測システムの構成を示す図である。
【００７４】
図５に示すように、第１の調整動作時には、カメラ１０Ａは、第１の視点Ｍ１から基準構造物４０を撮像することで画像データ６１Ａ（第１の基準画像）を生成する。カメラ１０Ｂは、第２の視点Ｍ２から基準構造物４０を撮像することで、画像データ６１Ｂ（第２の基準画像）を生成する。
【００７５】
基準構造物４０は、三次元座標系において、相対座標が既知である３点の基準点Ａ、Ｂ、Ｃを有している。言い換えると、点Ａ、Ｂ、Ｃによって定義される三角形を基準構造物４０と呼ぶ。
【００７６】
図６は、カメラ設定検出部１０６の構成を示すブロック図である。図６に示すように、カメラ設定検出部１０６は、第３の視点投影角抽出部１２１Ａと、第４の視点投影角抽出部１２１Ｂと、第１の傾斜角算出部１２２Ａと、第２の傾斜角算出部１２２Ｂと、設定情報算出部１２３とを備える。
【００７７】
第３の視点投影角抽出部１２１Ａは、第１の視点投影角情報１１１Ａを用いて、第１の基準画像に投影される基準点Ａ、Ｂ及びＣの各々に対応する３つの視点投影角（本発明の第１の基準視点投影角に相当）を取得する。
【００７８】
第４の視点投影角抽出部１２１Ｂは、第２の視点投影角情報１１１Ｂを用いて、第２の基準画像に投影される基準点Ａ、Ｂ及びＣの各々に対応する３つの視点投影角（本発明の第２の基準視点投影角に相当）を取得する。
【００７９】
第１の傾斜角算出部１２２Ａは、３つの第１の基準視点投影角と、３点の基準点Ａ、Ｂ及びＣの相対座標とを用いて、第１の傾斜角を算出する。ここで、第１の傾斜角は、第１の基準画像の撮像面である第１の撮像面と、３点の基準点Ａ、Ｂ及びＣを含む基準平面とのなす角度である。
【００８０】
第２の傾斜角算出部１２２Ｂは、３つの第２の基準視点投影角と、３点の基準点Ａ、Ｂ及びＣの相対座標とを用いて、第２の傾斜角を算出する。ここで、第２の傾斜角は、第２の基準画像の撮像面である第２の撮像面と、３点の基準点Ａ、Ｂ及びＣを含む基準平面とのなす角度である。
【００８１】
設定情報算出部１２３は、第１の傾斜角と、第２の傾斜角とを用いて、第１の撮影角θＡと、第２の撮影角θＢとを算出する。また、設定情報算出部１２３は、第１の傾斜角と、第２の傾斜角とを用いて、第１の視点Ｍ１及び第２の視点Ｍ２の三次元座標を算出する。そして、設定情報算出部１２３は、第１の視点Ｍ１及び第２の視点Ｍ２の三次元座標から、視点間距離ｄを算出する。
【００８２】
図７は、三次元座標計測装置９０による第１の調整動作のフローチャートである。
【００８３】
まず、画像取得部１０１は、図８に示すように、第１の基準画像及び第２の基準画像を取得する（Ｓ１１１）。
【００８４】
なお、本実施の形態では、説明の簡略化のため、第１の基準画像及び第２の基準画像に含まれる３点の基準点が同一である場合を例に説明するが、第１の基準画像及び第２の基準画像に含まれる３点の基準点は異なってもよい。言い換えると、第１の基準画像は、相対座標が既知である３点以上の基準点のうちのいずれか３点である第１の基準点が、第１の視点Ｍ１からカメラ１０Ａにより撮像された画像であればよい。また、第２の基準画像は、上記３点以上の基準点のうちのいずれか３点である第２の基準点が、第２の視点Ｍ１からカメラ１０Ｂにより撮像された画像であればよい。この場合、各演算処理において、さらに、第１の基準点と第２の基準点との相対位置関係を考慮することで、第１の基準点と第２の基準点とが同じ場合と同様の処理を行うことができる。
【００８５】
次に、第３の視点投影角抽出部１２１Ａは、図９Ａに示すように、例えば、第１の基準画像における光学中心位置Ｃｐ１を原点として、第１の取得画像に投影される基準点Ａ、Ｂ及びＣである点Ａ０１、Ｂ０１及びＣ０１の座標を第１の基準画像から抽出する。次に、第３の視点投影角抽出部１２１Ａは、第１の視点投影角情報１１１Ａを用いて、抽出した点Ａ０１、Ｂ０１及びＣ０１の座標に対応する第１の基準視点投影角を抽出する。同様に、第４の視点投影角抽出部１２１Ｂは、図９Ｂに示すように、例えば、第２の基準画像における光学中心位置Ｃｐ２を原点として、第２の基準画像に投影される基準点Ａ、Ｂ及びＣである点Ａ０２、Ｂ０２及びＣ０２の座標を第２の基準画像から抽出する。次に、第４の視点投影角抽出部１２１Ｂは、第２の視点投影角情報１１１Ｂを用いて、抽出した点Ａ０２、Ｂ０２及びＣ０２の座標に対応する第２の基準視点投影角を抽出する（Ｓ１１２）。
【００８６】
次に、第１の傾斜角算出部１２２Ａは、第１の基準画像の撮像面である第１の撮像面と、基準点Ａ、Ｂ及びＣを含む基準平面とのなす角である第１の傾斜角を算出する。同様に、第２の傾斜角算出部１２２Ｂは、第２の基準画像の撮像面である第２の撮像面と、基準点Ａ、Ｂ及びＣを含む基準平面とのなす角である第２の傾斜角を算出する（Ｓ１１３）。
【００８７】
以下、この第１及び第２の傾斜角を算出する処理の一例を詳細に説明する。
【００８８】
図１０は、第１の傾斜角及び第２の傾斜角を算出する処理（Ｓ１１３）のフローチャートである。また、図１１は、図１０に示す処理を説明するための図である。以下、図１０及び図１１を用いて、第１の傾斜角を算出する処理を説明する。
【００８９】
まず、第１の傾斜角算出部１２２Ａは、３点の基準点Ａ、Ｂ及びＣのうちいずれか１点、例えば、点Ａを原点とするＸ１−Ｙ１−Ｚ１座標系を設定する（Ｓ１４１）。このとき、第１の傾斜角算出部１２２Ａは、Ｘ１軸及びＹ１軸を、第１の視点Ｍ１より撮像された第１の撮像面と平行になるように設定する。また、第１の傾斜角算出部１２２Ａは、Ｚ１軸を、第１の視点Ｍ１より撮像された第１の撮像面と垂直になるように設定する。
【００９０】
次に、第１の傾斜角算出部１２２Ａは、基準点Ｂ及びＣと同等な仮想点Ｂ１及びＣ１の座標を設定する（Ｓ１４２）。ここで、点Ｂ１は点Ｂに相当し、点Ｃ１は点Ｃに相当する。例えば、本実施の形態では、点Ｂ１の座標を（Ｂ１ｘ，０，０）、点Ｃ１の座標を（０，Ｃ１ｙ，０）と設定する。
【００９１】
そして、第１の傾斜角算出部１２２Ａは、点Ｂ１及びＣ１を、Ｘ１軸まわりに角度α１ｎ、Ｙ１軸まわりに角度β１ｎ、Ｚ１軸まわりに角度γ１ｎ、細かく別々に回転させた複数の変換基準点である、点Ｂ１ｎ’（Ｂ１ｎｘ’，Ｂ１ｎｙ’，Ｂ１ｎｚ’）及び点Ｃ１ｎ’（Ｃ１ｎｘ’，Ｃ１ｎｙ’，Ｃ１ｎｚ’）を算出する（Ｓ１４３）。ここで、ｎ＝１、２、３・・・である。
【００９２】
次に、第１の傾斜角算出部１２２Ａは、第３の視点投影角抽出部１２１Ａにより抽出された視点投影角を用いて、点Ｂ１ｎ’及び点Ｃ１ｎ’を、Ｘ１−Ｙ１平面に投影させた複数の変換投影基準点である、点Ｂ１ｎ”（Ｂ１ｎｘ”，Ｂ１ｎｙ”，０）及び点Ｃ１ｎ”（Ｃ１ｎｘ”，Ｃ１ｎｙ”，０）を算出する（Ｓ１４４）。ここで、ｎ＝１、２、３・・・である。
【００９３】
ここで、第３の視点投影角抽出部１２１Ａにより抽出された、点Ｂ０１のＺ１−Ｘ１面の視点投影角をε１ｘ、点Ｂ０１のＺ１−Ｙ１面の視点投影角をε１ｙ、点Ｃ０１のＺ１−Ｘ１面の視点投影角をφ１ｘ、点Ｃ０１のＺ１−Ｙ１面の視点投影角をφ１ｙとする。第１の撮像面における基準点Ａ、Ｂ、Ｃである点Ａ０１、Ｂ０１、Ｃ０１を結ぶ三角形Ａ０１Ｂ０１Ｃ０１と、点Ａ、点Ｂ１ｎ”、点Ｃ１ｎ”を結ぶ三角形ＡＢ１ｎ”Ｃ１ｎ”が相似となるときには、図１２に示すように、∠Ｂ１ｎ’Ｍ１Ｃｐ１及び∠Ｂ１ｎ”Ｍ１Ｃｐ１はε１ｘとなる。
【００９４】
したがって、Ｂ１ｎｘ”は、（式３）で示される。
【００９５】
【数１】
0005629874.tif 000002
【００９６】
同様にして、Ｂ１ｎｙ”、Ｃ１ｎｘ”及びＣ１ｎｙ”の各々は、（式４）〜（式６）で表される。
【００９７】
【数２】
0005629874.tif 000003
【００９８】
【数３】
0005629874.tif 000004
【００９９】
【数４】
0005629874.tif 000005
【０１００】
最後に、第１の傾斜角算出部１２２Ａは、三角形Ａ０１Ｂ０１Ｃ０１と、三角形ＡＢ１ｎ”Ｃ１ｎ”とが最も相似となる変換投影基準点Ｂ１”及びＣ１”を決定することにより、第１の傾斜角（α１，β１，γ１）を算出する（Ｓ１４５）。
【０１０１】
具体的な相似比較計算法として、線分Ａ０１Ｂ０１を、線分ＡＢ１ｎ”と同じ長さにするとともに、点Ａ０１を点Ａと一致させるように点Ｂ０１及び点Ｃ０１を移動させる。この状態において、線分Ｂ０１Ｂ１ｎ”の長さと線分Ｃ０１Ｃ１ｎ”の長さとの和が最小となるように、第１の傾斜角（α１，β１，γ１）を算出する方法がある。
【０１０２】
ただし、相似比較計算法は、上記の方法に限られない。例えば、線分Ａ０１Ｂ０１を、線分ＡＢ１ｎ”と同じ長さにするとともに、線分Ａ０１Ｂ０１を線分ＡＢ１ｎ”と一致させるように点Ｃ０１を移動させる。そして、この状態において、点Ｃ０１と点Ｃ１ｎ”とのずれ量が最小となるように、第１の傾斜角（α１，β１，γ１）を算出してもよい。
【０１０３】
同様にして、第２の傾斜角算出部１２２Ｂは、第２の撮像面と、基準点を含む平面とのなす角である第２の傾斜角（α２，β２，γ２）を算出する。
【０１０４】
このようにして、第１の傾斜角及び第２の傾斜角が算出される。
【０１０５】
以上、傾斜角の算出について、実施の形態に基づいて説明したが、第１及び第２の傾斜角の算出方法は、この実施の形態に限定されるものではない。
【０１０６】
例えば、本実施の形態では、第１の傾斜角算出部１２２Ａは、座標が既知である３点の基準点Ａ、Ｂ及びＣのうちいずれか１点を原点とするＸ１−Ｙ１−Ｚ１座標系を設定していたが、原点は、座標が既知である３点の基準点以外から選定してもよい。
【０１０７】
また、例えば、第１の傾斜角算出部１２２Ａは、点Ａを、点Ａの視点投影角線上のある位置に置く。そして、第１の傾斜角算出部１２２Ａは、点Ｂを、点Ｂの視点投影角線上をある指定ピッチで、かつある範囲内を順次スライドさせる。このとき、第１の傾斜角算出部１２２Ａは、点Ｂの位置ごとに線分ＡＢを軸とした円周上に点Ｃを配置する。そして、第１の傾斜角算出部１２２Ａは、当該円周上の位置のうち、点Ｃが、点Ｃの視点投影角線に最接近した条件を記憶しておく。このように、第１の傾斜角算出部１２２Ａは、点Ｂを順次スライドさせて、その時の点Ｃの最接近点を算出する。そして、第１の傾斜角算出部１２２Ａは、点Ｂの全てのスライド位置に対応する点Ｃの最接近点のうち、最も接近した最接近点の条件から傾斜角を算出してもよい。
【０１０８】
また、例えば、第１の傾斜角算出部１２２Ａは、点Ａを点Ａの視点投影角線上のある位置に置くとともに、点Ｂを点Ｂの視点投影角線上又はその近傍に置く。このとき、点Ｃは線分ＡＢを軸とした円周上に存在する。よって、第１の傾斜角算出部１２２Ａは、円周上の位置のうち、点Ｃが、点Ｃの視点投影角線に最接近した条件を記憶しておく。そして、第１の傾斜角算出部１２２Ａは、点Ａをある範囲内を移動させるとともに、移動させた位置ごとに上記の計算を行う。そして、第１の傾斜角算出部１２２Ａは、点Ａの全ての位置に対応する点Ｃの最接近点のうち、最も接近した最接近点の条件から傾斜角を算出してもよい。
【０１０９】
再度、図７を用いて、三次元座標計測装置９０による処理を説明する。
【０１１０】
図７において、第１及び第２の傾斜角の算出処理（Ｓ１１３）が完了した後、設定情報算出部１２３は、第１の視点Ｍ１及び第２の視点Ｍ２の座標（相対座標）を算出する（Ｓ１１４）。
【０１１１】
具体的には、設定情報算出部１２３は、２本のベクトルを算出する。ここで、２本のベクトルとは、例えば、ステップＳ１４５において決定した点Ｂ１”（点Ｂ１ｎ”）と、そのときの点Ｂ１ｎ’に対応するＢ１’とを結ぶ直線Ｂ１’Ｂ１”、及び、ステップＳ１４５において決定した点Ｃ１”（点Ｃ１ｎ”）と、そのときの点Ｃ１ｎ’に対応するＣ１’とを結ぶ直線Ｃ１’Ｃ１”とである。
【０１１２】
そして、設定情報算出部１２３は、２本のベクトルの最接近点の座標を算出することにより、第１の視点Ｍ１との三次元座標を算出する。
【０１１３】
同様の方法により、設定情報算出部１２３は、第２の視点Ｍ２の三次元座標を算出する。
【０１１４】
なお、以下の方法を用いて、第１の視点Ｍ１の三次元座標を算出してもよい。
【０１１５】
ここで、点Ａと点Ｂと点Ｍ１とを結ぶ三角形ＡＢＭ１において、線分ＡＢの長さ並びに∠Ｍ１ＡＢ及び∠Ｍ１ＢＡは既知である。よって、三角形ＡＢＭ１を用いて、第１の視点Ｍ１の三次元座標を算出することができる。また、∠ＡＭ１Ｂが視点投影角により既知であるので、同様に、三角形ＡＢＭ１を用いて、第１の視点Ｍ１の三次元座標を算出することができる。
【０１１６】
次に、設定情報算出部１２３は、第１の視点Ｍ１の三次元座標と、第２の視点Ｍ２の三次元座標とを用いて、視点間距離ｄを算出する（Ｓ１１５）。
【０１１７】
さらに、設定情報算出部１２３は、第１の撮影角θＡ及び第２の撮影角θＢを算出する（Ｓ１１６）。具体的には、上記の処理により、第１の視点Ｍ１と、第２の視点Ｍ２と、基準点Ａ、Ｂ及びＣとの三次元座標が算出されている。よって、設定情報算出部１２３は、例えば、基準点Ａ、第１の視点Ｍ１、及び第２の視点Ｍ２の座標から、図１３に示す角θＡ４及びθＢ４を算出する。さらに、設定情報算出部１２３は、下記（式７）を用いて、第１の撮影角θＡを算出する。また、設定情報算出部１２３は、下記（式８）を用いて、第２の撮影角θＢを算出する。
【０１１８】
θＡ＝θＬ−θＡ３−θＡ４      （式７）
θＢ＝θＲ−θＢ３−θＢ４      （式８）
【０１１９】
ここで、θＬは、第１の基準線Ｌと線分Ｍ１Ｍ２とがなす角度である。θＲは、第２の基準線Ｒと線分Ｍ１Ｍ２とがなす角度である。また、ここでは、θＬ及びθＲは、共に９０度である。また、θＡ３は、第１の基準画像における基準点Ａの視点投影角であり、θＢ３は第２の基準画像における基準点Ａの視点投影角である。
【０１２０】
このように、設定情報算出部１２３は、第１の撮影角θＡ及び第２の撮影角θＢを算出できる。
【０１２１】
なお、設定情報算出部１２３による第１の撮影角θＡ及び第２の撮影角θＢの算出方法は上記の方法に限らない。例えば、光軸Ｏ１は、第１の撮像面に垂直なので、第１の傾斜角から光軸Ｏ１の方向を算出し、光軸Ｏ１の方向から第１の撮影角θＡを算出してもよい。なお、第２の撮影角θＢに関しても同様である。
【０１２２】
そして、設定情報算出部１２３により算出された、第１の撮影角θＡ、第２の撮影角θＢ及び視点間距離ｄは、記憶部１０２に記憶される。
【０１２３】
以上より、本実施の形態では、基準構造物４０を用いて容易に第１の撮影角θＡ、第２の撮影角θＢ及び視点間距離ｄを算出できる。これにより、撮影現場においてカメラ１０Ａ及び１０Ｂの配置等が変わった場合でも、容易に第１の撮影角θＡ、第２の撮影角θＢ及び視点間距離ｄを算出できる。例えば、対象物又は測定環境に応じて、カメラ１０Ａ及び１０Ｂの配置等を調整する場合、及び、振動等でカメラ１０Ａ及び１０Ｂの配置がずれた場合でも、容易に再調整が可能となる。
【０１２４】
次に、カメラ設定検出部１０６による第１の視点投影角情報１１１Ａ及び第２の視点投影角情報１１１Ｂを検出する第２の調整動作を説明する。なお、第２の調整動作時には、２つのカメラ１０Ａ及び１０Ｂの相対位置は固定されている必要はなく、個別に第２の調整動作を行うことが可能である。また、第１の視点投影角情報１１１Ａを検出する処理と、第２の視点投影角情報１１１Ｂを検出する処理とは同様なので、以下では、第１の視点投影角情報１１１Ａを検出する処理のみを説明する。
【０１２５】
図１４は、第２の調整動作時における、三次元座標計測装置９０を含むシステムの構成を示す図である。
【０１２６】
カメラ１０Ａは、視点Ｍからキャリブレーション板７０を撮像する。ここで、視点Ｍは、カメラ１０Ａの撮影レンズの主点の位置に対応している。また、図１４中、２点鎖線で書かれているＯは、撮影レンズの光軸（カメラの光軸）を示している。
【０１２７】
キャリブレーション板７０は、剛性が高い透明な板であり、表面には碁盤の目が記されている。また、キャリブレーション板７０には、糸７１によって錘７２が取り付けられている。
【０１２８】
カメラ設定検出部１０６は、視点Ｍより、キャリブレーション板７０、糸７１及び錘７２が撮像された画像データ６２Ａを用いて、画像ピクセルの歪み補正を行う。さらに、カメラ設定検出部１０６は、任意の画像ピクセル（画素）の視点投影角（本発明の第１及び第２の画素視点投影角に相当する）を算出する。
【０１２９】
図１５は、第２の調整動作のフローチャートである。
【０１３０】
第２の調整動作において、カメラ設定検出部１０６は、撮像面の中心点である光学中心位置Ｃｐを設定し（Ｓ２０１）、歪み補正を行い（Ｓ２０２）、任意の画像ピクセル（画素）の視点投影角θを算出する（Ｓ２０３）。
【０１３１】
ここで、任意の画像ピクセルの視点投影角θとは、図１６に示すように、画像上の任意の画像ピクセルＰの二次元座標に投影される三次元空間上の任意の点Ｐ３と視点Ｍとを結ぶ線分と、カメラの光軸Ｏとのなす角のことである。なお、図１６において、カメラの光軸Ｏと撮像面とは直交する。よって、視点Ｍと、カメラの光軸Ｏと撮像面の交点である光学中心位置Ｃｐとの距離ｘと、例えば、光学中心位置Ｃｐを原点とする、任意の画像ピクセルＰの二次元座標とを用いて、任意の画像ピクセルＰの視点投影角θを算出することができる。
【０１３２】
まず、光学中心位置Ｃｐの設定を行う（Ｓ２０１）。ここでキャリブレーション板７０は水準器などにより、水平が保たれているものとする。次に、キャリブレーション板７０を上方からカメラ１０Ａで撮像する。そして、撮像面を、（１）キャリブレーション板７０と糸７１との取り付け位置と、錘７２と糸７１との取り付け位置とが重なるように、（２）糸７１の取り付け位置を中心に、碁盤の目の表示が対称になるように調整する。このときの、キャリブレーション板７０上の糸７１の取り付け位置が光学中心位置Ｃｐとなる。
【０１３３】
次に、カメラ設定検出部１０６は、画像の歪み補正を行うためのパラメータを算出する（Ｓ２０２）。図１７Ａに示すように、歪み補正前においては、キャリブレーション板７０を撮影したときの画像は、カメラ１０Ａの撮影レンズの特性により碁盤の目が歪んだ画像となる。カメラ設定検出部１０６は、撮像した画像に正規化処理を行うことにより、撮像した画像を図１７Ｂに示すような画像に調整するためのパラメータを算出する。そして、上述した対象点Ｗの三次元座標の計測処理及び第１の調整動作を含む以降の処理においては、例えば、画像取得部１０１において、当該パラメータを用いた、カメラ１０Ａで撮影された画像に対する、歪み補正が行われる。
【０１３４】
最後に、カメラ設定検出部１０６は、任意の画像ピクセルＰの視点投影角θを算出する（Ｓ２０３）。
【０１３５】
図１８は、キャリブレーション板と視点との距離を算出するための処理を説明するための図である。
【０１３６】
まず、カメラ設定検出部１０６は、図１７Ｂに示すような、キャリブレーション板７０を撮影した歪み補正後の画像である、移動前の板の画像を取得する。次に、キャリブレーション板７０を水平に保ったまま、キャリブレーション板７０を視点Ｍに距離ｙ接近させる。カメラ設定検出部１０６は、この状態において、キャリブレーション板７０を撮像した歪み補正後の画像である、移動後の板の画像を取得する。そして、カメラ設定検出部１０６は、移動前の板の画像と移動後の板の画像を用いて、例えば、光学中心位置Ｃｐを原点とする、点Ｐ１’、及び点Ｐ２’の二次元座標を抽出する。
【０１３７】
ここで、視点Ｍと光学中心位置Ｃｐとを結ぶ直線と、キャリブレーション板７０の表面との交点をＣ１とする。また、キャリブレーション板７０表面の任意の点をＰ１とする。また、視点ＭとＰ１とを結ぶ直線と、撮像面との交点をＰ１’とする。また、移動前のキャリブレーション板７０表面のＰ１に対応する、移動後のキャリブレーション板７０表面の点をＰ２とする。また、視点ＭとＰ２とを結ぶ直線と、撮像面との交点をＰ２’とする。また、点Ｐ２と点Ｐ２’とを通る直線と、移動前のキャリブレーション板７０の表面との交点をＱとする。
【０１３８】
このとき、線分Ｐ１Ｑの長さｄ１は、下記（式９）で表される。
【０１３９】
【数５】
0005629874.tif 000006
【０１４０】
ここで、ｄ２は線分Ｃ１Ｐ１の長さ、ｄ３は線分Ｐ１’Ｐ２’の長さ、ｄ４は線分ＣｐＰ１’の長さを示す。
【０１４１】
また、点Ｑの視点投影角θ１は、下記（式１０）で表される。
【０１４２】
【数６】
0005629874.tif 000007
【０１４３】
したがって、キャリブレーション板７０と視点Ｍとの距離ｚは、下記（式１１）で表される。
【０１４４】
【数７】
0005629874.tif 000008
【０１４５】
ここで、ｄ５は、線分Ｃ１Ｑの長さを示す。
【０１４６】
そして、キャリブレーション板７０と視点Ｍとの距離ｚを用いて、例えば、図１８に示すＰ１’の視点投影角θ２は、（式１２）で表される。
【０１４７】
【数８】
0005629874.tif 000009
【０１４８】
視点Ｍと光学中心位置Ｃｐとを結ぶ線分の長さｘは、（式１３）で表される。
【０１４９】
【数９】
0005629874.tif 000010
【０１５０】
したがって、任意のピクセル点Ｐの視点投影角θは、（式１４）を用いて算出することができる。
【０１５１】
【数１０】
0005629874.tif 000011
【０１５２】
ここで、ｄ６は、線分ＣｐＰの長さを示す。
【０１５３】
つまり、光学中心位置Ｃｐを原点とする、任意の画像ピクセルＰの二次元座標は既知であるため、任意の画像ピクセルＰの視点投影角θを算出することができる。
【０１５４】
なお、上記説明では、キャリブレーション板７０には碁盤の目が記されているものとしていたが、キャリブレーション板には、間隔が既知である印が記されていてもよい。
【０１５５】
また、上記説明では、キャリブレーション時に糸及び錘を用いる例を述べたが、糸及び錘の代わりに、キャリブレーション板に対して垂直に照射される、ランプ光源からの光線又はレーザ光を用いてもよい。
【０１５６】
以上のように、カメラ設定検出部１０６は、カメラ１０Ａにより撮影された画像における画素ごとの視点投影角を算出し、当該画素ごとの視点投影角を示す第１の視点投影角情報１１１Ａを、記憶部１０２に記憶する。同様に、カメラ設定検出部１０６は、カメラ１０Ｂにより撮影された画像における画素ごとの視点投影角を算出し、当該画素ごとの視点投影角を示す第２の視点投影角情報１１１Ｂを、記憶部１０２に記憶する。
【０１５７】
以上、本発明の実施の形態に係る三次元座標計測装置について説明したが、本発明は、この実施の形態に限定されるものではない。
【０１５８】
例えば、上記説明では、第１の視点投影角情報１１１Ａは、複数の画素の各々に対応する視点投影角を示すテーブルあるとしたが、画素と視点投影角との対応関係を示す式であってもよい。例えば、当該式とは、上記（式１４）である。この場合、第１の視点投影角抽出部１０３Ａは、この（式１４）を用いて、第１の対象画像における対象点Ｗの視点投影角を算出すればよい。なお、この場合、カメラ設定検出部１０６は、上記（式１３）を用いて、視点Ｍと光学中心位置Ｃｐとの距離ｘを求めておく必要がある。同様に、第２の視点投影角情報１１１Ｂは、画素と視点投影角との対応関係を示す式であってもよい。
【０１５９】
また、上記説明では、２つの視点から撮影を行う例を述べたが、３つ以上の視点から撮影を行ってもよい。
【０１６０】
また、相対座標が既知である基準点の数は、４点以上であってもよい。この場合、第１及び第２の基準画像の各々には、この４点以上の基準点のうち、少なくとも３点の基準点が撮影されていればよい。また、各第１の基準画像及び第２の基準画像に撮影される少なくとも３点の基準点の組み合わせは異なってもよい。さらに、４点以上の基準点は同一平面に配置されるのではなく、立体的に配置されていることが好ましい。例えば、三角錐、又は四角錐の頂点のうち４点以上を基準点として用いることができる。これにより、広範囲で安定的な角度検出を行える。例えば、上述した３点の基準点のみを用いる場合では、３点の基準点を含む平面と視点との角度が無いと誤差が発生しやすくなる。一方で、例えば、２つの視点から、上記三角錐の異なる面を撮影することで、このような場合でも安定して角度検出を行える。
【０１６１】
この場合、第１及び第２の傾斜角は、異なる基準平面（第１及び第２の基準平面）に対する角度である。なお、第１及び第２の傾斜角はどちらかの基準平面に合わせたものであってもよい。または、第１及び第２の傾斜角は、三次元座標系で統一された角度で算出されてもよい。
【０１６２】
また、相対座標が既知である基準点の数を多く用いて、非線形近似計算を行うことにより、第１の傾斜角及び第２の傾斜角を算出してもよい。
【０１６３】
また、例えば、相対座標が既知である３点の基準点Ａ、Ｂ、Ｃと、第１の撮像面における基準点Ａ、Ｂ，Ｃである点Ａ０１，Ｂ０１、Ｃ０１とのうち、点Ａと点Ａ０１、点Ｂと点Ｂ０１、点Ｃと点Ｃ０１のそれぞれが対応づけられない場合には、特別なマーカー又はラインを使用することにより、対応関係を識別することができる。
【０１６４】
また、基準点の回転による反転（裏返り）及び誤った解（傾斜角）の算出を防ぐために相対座標が既知の検証用の基準点を用いてもよい。
【０１６５】
また、誤った解を算出しないために制限（例えば、回転条件）を加えてもよい。
【０１６６】
また、上記説明は、三次元座標計測時において、カメラ１０Ａ及び１０Ｂの撮像面のベースライン（画像の水平画素方向）と、第１の視点Ｍ１と第２の視点Ｍ２とを結ぶ線分Ｍ１Ｍ２とが平行な場合を前提として説明している。言い換えると、カメラ１０Ａ及びカメラ１０Ｂが光軸を中心として回転していない場合を前提としている。なお、カメラ１０Ａ及びカメラ１０Ｂの少なくとも一方が、光軸を中心として回転して設定されている場合には、以下の処理を行えばよい。
【０１６７】
例えば、記憶部１０２は、予めカメラ１０Ａの光軸を中心とした第１の回転角と、カメラ１０Ｂの光軸を中心とした第２の回転角とを保持している。そして、三次元座標計測時には、画像取得部１０１は、カメラ１０Ａから取得した第１の対象画像を第１の回転角に応じて回転する補正を行う。同様に、画像取得部１０１は、カメラ１０Ｂから取得した第２の対象画像を第２の回転角に応じて回転する補正を行う。そして、三次元座標計測装置９０は、補正後の第１の対象画像及び第２の対象画像に対して上述した処理を行うことで対象点Ｗの三次元座標を算出する。
【０１６８】
なお、第１の回転角及び第２の回転角に応じて補正を行う対象は、第１及び第２の対象画像に限らない。例えば、座標算出部１０５が、第１及び第２の回転角を加味し、対象点の三次元座標を算出してもよい。
【０１６９】
また、この第１及び第２の回転角は、以下の方法で検出できる。例えば、カメラ設定検出部１０６は、上述した方法により、線分Ｍ１Ｍ２とベースラインとが平行な場合の各基準点Ａ、Ｂ、Ｃの第１及び第２の基準視点投影角を算出しておく。さらに、カメラ設定検出部１０６は、実際の設定状態（カメラ１０Ａ及びカメラ１０Ｂが光軸を中心として回転している場合）の各基準点Ａ、Ｂ、Ｃの第１及び第２の基準視点投影角を算出する。そして、カメラ設定検出部１０６は、算出した２つの第１の基準視点投影角の角度差に基づき第１の回転角を算出する。同様に、カメラ設定検出部１０６は、算出した２つの第２の基準視点投影角の角度差に基づき第２の回転角を算出する。
【０１７０】
また、上記で用いた視点投影角等の角度の情報は、角度そのものを示す値に限らず、例えば、２点の座標で表されるベクトルであってもよい。
【０１７１】
また、本発明の実施の形態に係る、三次元座標計測装置の機能の一部または全てを、ＣＰＵ等のプロセッサがプログラムを実行することにより実現してもよい。
【０１７２】
さらに、構成要素間の接続関係は、本発明を具体的に説明するために例示するものであり、本発明の機能を実現する接続関係はこれに限定されない。
【０１７３】
また、ブロック図における機能ブロックの分割は一例であり、複数の機能ブロックを一つの機能ブロックとして実現したり、一つの機能ブロックを複数に分割したり、一部の機能を他の機能ブロックに移してもよい。また、類似する機能を有する複数の機能ブロックの機能を上記三次元座標計測装置が並列または時分割に処理してもよい。
【０１７４】
さらに、本発明は上記プログラムであってもよいし、上記プログラムが記録された非一時的なコンピュータ読み取り可能な記録媒体であってもよい。また、上記プログラムは、インターネット等の伝送媒体を介して流通させることができるのは言うまでもない。
【０１７５】
また、上記三次元座標計測装置の構成は、本発明を具体的に説明するために例示するためのものであり、本発明に係る三次元座標計測装置は、上記構成の全てを必ずしも備える必要はない。言い換えると、本発明に係る三次元座標計測装置は、本発明の効果を実現できる最小限の構成のみを備えればよい。
【０１７６】
例えば、上記説明では、三次元座標計測装置９０は、カメラ設定検出部１０６を備えなくてもよい。または、カメラ設定検出部１０６は、上記第１の調整動作及び第２の調整動作の一方を行う機能のみを有してもよい。
【０１７７】
また、上記のステップが実行される順序は、本発明を具体的に説明するために例示するためのものであり、上記以外の順序であってもよい。また、上記ステップの一部が、他のステップと同時（並列）に実行されてもよい。
【０１７８】
さらに、本発明の主旨を逸脱しない限り、本実施の形態に対して当業者が思いつく範囲内の変更を施した各種変形例も本発明に含まれる。
【産業上の利用可能性】
【０１７９】
本発明は、三次元座標計測装置に適用できる。
【符号の説明】
【０１８０】
１０Ａ、１０Ｂ  カメラ
３０Ａ、３０Ｂ  ケーブル
４０  基準構造物
５０  対象構造物
６０Ａ、６０Ｂ、６１Ａ、６１Ｂ、６２Ａ  画像データ
７０  キャリブレーション板
７１  糸
７２  錘
９０  三次元座標計測装置
１０１  画像取得部
１０２  記憶部
１０３Ａ  第１の視点投影角抽出部
１０３Ｂ  第２の視点投影角抽出部
１０５  座標算出部
１０６  カメラ設定検出部
１１１Ａ  第１の視点投影角情報
１１１Ｂ  第２の視点投影角情報
１１２  三次元座標
１２１Ａ  第３の視点投影角抽出部
１２１Ｂ  第４の視点投影角抽出部
１２２Ａ  第１の傾斜角算出部
１２２Ｂ  第２の傾斜角算出部
１２３  設定情報算出部
【図１】
0005629874.tif 000012
【図２】
0005629874.tif 000013
【図３】
0005629874.tif 000014
【図４】
0005629874.tif 000015
【図５】
0005629874.tif 000016
【図６】
0005629874.tif 000017
【図７】
0005629874.tif 000018
【図８】
0005629874.tif 000019
【図９Ａ】
0005629874.tif 000020
【図９Ｂ】
0005629874.tif 000021
【図１０】
0005629874.tif 000022
【図１１】
0005629874.tif 000023
【図１２】
0005629874.tif 000024
【図１３】
0005629874.tif 000025
【図１４】
0005629874.tif 000026
【図１５】
0005629874.tif 000027
【図１６】
0005629874.tif 000028
【図１７Ａ】
0005629874.tif 000029
【図１７Ｂ】
0005629874.tif 000030
【図１８】
0005629874.tif 000031