(57)【特許請求の範囲】
【請求項１】
照射部にて移動目標に対し光波を照射し、前記光波の反射光を撮像部にて受光して撮像視野内の前記移動目標に関する画像情報を得て、この画像情報に基づいて駆動部にて前記光波の照射方向と前記移動目標からの光波の反射方向とを一致させるべく前記照射部及び前記撮像部を駆動して前記移動目標を追跡する目標追跡装置において、
前記照射部から前記光波の照射方向に対応する前記照射部の姿勢情報を取得する取得手段と、
この取得手段で得られた姿勢情報と、前記撮像部で得られる前記画像情報とに基づいて前記光波の照射方向と前記撮像部の指向方向との間の偏向角誤差を算出する演算手段と、
この演算手段で求められた偏向角誤差に基づいて、前記光波の照射方向と前記撮像部の指向方向との間の偏向角を補正すべく前記照射部を制御する制御手段とを具備することを特徴とする目標追跡装置。
【請求項２】
前記演算手段は、前記取得手段で得られた姿勢情報を前記撮像部の出力画像の座標系に換算した前記移動目標への光波照射方向座標を求め、この光波照射方向座標から前記撮像部の出力画像中の反射光目標座標を減算することで前記偏向角誤差を算出し、
前記制御手段は、前記照射部を駆動するための指令値から前記偏向角誤差を減算した指令値を算出して、この算出した指令値に基づいて前記照射部を制御することを特徴とする請求項１記載の目標追跡装置。
【請求項３】
前記照射部は、ミラーを用いて光波を照射し、
前記取得手段は、前記照射部からミラー角度情報を取得し、
前記制御手段は、前記照射部を駆動するための指令値から前記偏向角誤差を減算した指令値を算出して、この算出した指令値に基づいて前記照射部のミラーを駆動させることを特徴とする請求項１記載の目標追跡装置。
【請求項４】
照射部にて移動目標に対し光波を照射し、前記光波の反射光を撮像部にて受光して撮像視野内の前記移動目標に関する画像情報を得て、この画像情報に基づいて駆動部にて前記光波の照射方向と前記移動目標からの光波の反射方向とを一致させるべく前記照射部及び前記撮像部を駆動して前記移動目標を追跡する目標追跡方法において、
前記照射部から前記光波の照射方向に対応する前記照射部の姿勢情報を取得し、
この姿勢情報と、前記撮像部で得られる前記画像情報とに基づいて前記光波の照射方向と前記撮像部の指向方向との間の偏向角誤差を算出し、
この偏向角誤差に基づいて、前記光波の照射方向と前記撮像部の指向方向との間の偏向角を補正すべく前記照射部を制御することを特徴とする目標追跡方法。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明の実施形態は、撮像装置を用いて移動目標を撮影し、その撮像情報から移動目標を追跡する目標追跡装置及び目標追跡方法に関する。
【背景技術】
【０００２】
従来より、目標追跡装置にあっては、撮像器を搭載して、その撮像画像を解析することで移動目標の検出・追跡を行うものがある。この場合、光波照射器から目標物に照射した光波の反射光の方向（反射光目標位置）に基づいて目標物を追跡するので、撮像器で見る目標物からの反射光の方向と送信器から目標物への照射方向とは、一致していることが望まれる。
【０００３】
目標物からの反射光の方向と送信器から目標物への照射方向との間には、撮像器及び光波照射器の取付け精度による固定的な偏向角や、追跡駆動装置の動作軸の偏心等による追跡方向に依存する偏向角等が生じる。
【０００４】
従来は、上記の固定的及び追跡方向に依存する偏向角については、事前に計測したデータをもとに、固定的は偏向角については一定値を、追跡方向に依存する偏向角については、追跡駆動装置の追跡方向に対応する角度に応じた可変の値を補正角度として光波照射器駆動信号における光波照射方向の指令値に加算していた。
【先行技術文献】
【特許文献】
【０００５】
【特許文献１】特開平８−２０１５１７号公報
【発明の概要】
【発明が解決しようとする課題】
【０００６】
ところで、光波照射方向の指令値への補正の誤差や、外乱等の影響によって生じる偏向角誤差については修正できない。
【０００７】
本発明の目的は、目標に対して精度よく光波を照射し得る目標追跡装置及び目標追跡方法を提供することにある。
【課題を解決するための手段】
【０００８】
実施形態によれば、照射部にて移動目標に対し光波を照射し、光波の反射光を撮像部にて受光して撮像視野内の移動目標に関する画像情報を得て、この画像情報に基づいて駆動部にて光波の照射方向と移動目標からの光波の反射方向とを一致させるべく照射部及び撮像部を駆動して移動目標を追跡する目標追跡装置において、照射部から光波の照射方向に対応する照射部の姿勢情報を取得する取得手段と、この取得手段で得られた姿勢情報と、撮像部で得られる画像情報とに基づいて光波の照射方向と撮像部の指向方向との間の偏向角誤差を算出する演算手段と、この演算手段で求められた偏向角誤差に基づいて、光波の照射方向と撮像部の指向方向との間の偏向角を補正すべく駆動部を制御する制御手段とを備えた目標追跡装置を提供できる。
【図面の簡単な説明】
【０００９】
【図１】実施形態の目標追跡装置の構成を示すブロック図。
【図２】同実施形態において、目標物からの放射光を基に目標物を追跡中に、反射光による目標が出現した場合の撮像器画像を模式的に示した図。
【図３】従来の方法によって追跡動作を継続した場合の撮像器画像を模式的に示した図。
【図４】同実施形態の方法によって追跡動作を継続した場合の撮像器画像を模式的に示した図。
【図５】同実施形態における駆動制御装置の制御処理手順を示すフローチャート。
【発明を実施するための形態】
【００１０】
以下、実施の形態について、図面を参照して説明する。
【００１１】
図１は、一実施形態に係る目標追跡装置の構成を示すブロック図である。
【００１２】
図１において、符号１１は光学装置で、追跡駆動装置１２によって例えば高低方向及び方位方向に回動自在に支持され、内部に光波照射器１１１及び撮像器１１２を備える。
【００１３】
光波照射器１１１において、光源１１１ａから発生する光はレンズ１１１ｃで集光され、例えばミラー１１１ｂを介して所定方向に向けて照射される。この光波の反射光と目標物Ｔからの放射光は撮像器１１２に入射される。撮像器１１２において、光波の反射光及び目標物Ｔからの放射光は、画像データとして画像処理装置１３に送られる。
【００１４】
画像処理装置１３は、撮像器１１２から送られた画像データに基づいて、目標方向情報（放射光による目標座標）と反射光方向情報(反射光目標座標)とを算出し、これら目標方向情報及び反射光方向情報を駆動制御装置１４に出力する。
【００１５】
駆動制御装置１４は、目標方向情報及び反射光方向情報に基づいて追跡駆動信号を生成する。この追跡駆動信号は、追跡駆動装置１２に供給され、光波照射器１１１の光波照射方向及び撮像器１１２の撮像視野を目標中心に位置させる制御に供される。
【００１６】
ところで、本実施形態では、駆動制御装置１４に、取得部１４１と、演算部１４２と、光波照射器制御部１４３とを備えている。取得部１４１は、光波照射器１１１から光波の照射方向に対応した光波照射器１１１の例えばミラー１１１ｂの角度等の情報、つまり光波照射方向情報を取得する。
【００１７】
演算部１４２は、取得部１４１により得られた光波照射方向情報を撮像器画像の座標系に換算して目標物Ｔへの光波照射方向座標を算出し、この光波照射方向座標と画像処理装置１３で得られる反射光目標座標との差から光波照射器１１１の偏向角誤差を算出する。光波照射器制御部１４３は、目標物Ｔの追跡のための反射光方向情報に基づく光波照射方向の指令値から、光波照射器１１１の偏向角誤差を減算したものを光波照射方向の指令値として光波照射器１１１内のミラー１１１ｂを駆動することによって、光波の照射方向と撮像器１１２の指向方向との間の偏向角を校正（補正）する。
【００１８】
上記構成において、以下にその動作を説明する。  
図２は、目標物Ｔからの放射光を基に目標物Ｔを追跡中に、反射光による目標が出現した場合の撮像器画像を模式的に示したものである。
【００１９】
追跡駆動装置１２は、撮像器１１２の指向方向を目標物Ｔからの放射光が来る方向に一致させるべく、追跡動作を行う。しかし、光波照射器１１１から目標物Ｔへの照射光は拡がり角をもつため、目標物Ｔから反射光が返っているときにおいても、補正角度の誤差や外乱等の影響によって、撮像器１１２から見た目標物Ｔの方向と光波照射方向との間には微小な角度の差異（以下、光波照射器１１１の偏向角誤差と称する）が存在する場合がありうる。
【００２０】
図３は、図２の状態から、従来の方法によって追跡動作を継続した場合の撮像器画像を模式的に示したものである。
【００２１】
撮像器画像において、反射光による像が目標方向として検出されると、追跡駆動装置１２は、撮像器１１２の指向方向を目標方向、すなわち反射光が来る方向に一致させるべく追跡動作を行うが、光波の照射方向と撮像器１１２の指向方向との間には、光波照射器１１１の偏向角誤差がそのまま残っている。
【００２２】
そこで、本実施形態では、上記偏向角誤差を求めてこの偏向角誤差分で光波照射器１１１の光波照射方向を補正するようにした。図４は、図２の状態から、本実施形態の方法によって追跡動作を継続した場合の撮像器画像を模式的に示したものである。
【００２３】
撮像器画像において反射光による像とは別に目標からの放射光による像も捕らえられ、画像処理装置１３によって反射光による像からは反射光目標座標（反射光方向情報）が、放射光による像からは放射光による目標座標（目標方向情報）が算出される。これら算出結果は、駆動制御装置１４に供給される。
【００２４】
すると、駆動制御装置１４は、図５に示す制御処理手順を実行する。まず、駆動制御装置１４は、画像処理装置１３からの反射光方向情報の到来を監視しており（ステップＳＴ５ａ）、反射光方向情報が到来すると（Ｙｅｓ）、光波照射器１１１のセンサ等から光波の照射方向に対応した角度等の情報（光波照射方向情報）を取得し（ステップＳＴ５ｂ）、光波照射方向情報を撮像器画像の座標系に換算して目標物への光波照射方向座標を算出し、次式によって光波照射器１１１の偏向角誤差を算出する（ステップＳＴ５ｃ）。
【００２５】
光波照射器の偏向角誤差＝  
撮像器画像の座標系に換算した目標物への光波照射方向座標−反射光目標座標
そして、駆動制御装置１４は、光波照射器１１１への光波照射器駆動信号について、元々の目標物Ｔの追跡のための反射光方向情報に基づく光波照射方向の指令値から、光波照射器１１１の偏向角誤差を減算することによって、光波の照射方向と撮像器１１２の指向方向との間の偏向角を校正（補正）する（ステップＳＴ５ｄ）。
【００２６】
上記校正（補正）処理は、この次に校正（補正）されるときまで、継続させる。  
これによって、目標物Ｔに対して精度よく光波を照射させることができる。
【００２７】
以上のように上記実施形態によれば、駆動制御装置１４において、光波照射器１１１から得られるミラー１１１ｂの角度等の情報と、撮像器１１２の画像情報から得られる反射光方向情報との差異分を光波照射器１１１への指令値から減算することによって、光波の照射方向と撮像器１１２の指向方向との間の偏向角を補正することができる。これにより、目標物Ｔに対して精度よく光波を照射させることができる。
【００２８】
なお、上記実施形態では、光波照射器１１１内のミラー１１１ｂを駆動させる例について説明したが、ミラー１１１ｂ以外の駆動機構を制御するものであってもよい。その他、上記実施形態そのままに限定されるものではなく、実施段階ではその要旨を逸脱しない範囲で構成要素を変形して具体化できる。また、上記実施形態に開示されている複数の構成要素の適宜な組み合わせにより、種々の発明を形成できる。例えば、実施形態に示される全構成要素から幾つかの構成要素を削除してもよい。さらに、異なる実施形態にわたる構成要素を適宜組み合わせてもよい。
【符号の説明】
【００２９】
１１…光学装置、１２…追跡駆動装置、１３…画像処理装置、１４…駆動制御装置、１１１…光波照射器、１１２…撮像器、１１１ａ…光源、１１１ｂ…ミラー、１１１ｃ…レンズ、１４１…取得部、１４２…演算部、１４３…光波照射器制御部、Ｔ…目標物。
【図１】
0005611735.tif 000002
【図２】
0005611735.tif 000003
【図３】
0005611735.tif 000004
【図４】
0005611735.tif 000005
【図５】
0005611735.tif 000006