(57)【要約】  無人飛行装置用の改善された自己位置推定処理を提供する。  無人航空機の周囲にある対象物を照射するための光源と、前記対象物からの反射光を画像データとして取得する集光センサと、前記集光センサにより取得された画像データを用いて無人飛行機の前記対象物に対する相対位置を推定する位置推定部とを備えた無人飛行機用の自己位置推定装置であって、前記光源は、環境光と区別可能な光を放出するレーザと、前記レーザからの光を拡散するための拡散器とを有しており、前記集光センサは、前記対象物からの反射光に対して前記環境光と区別可能な光を感知するように構成された無人飛行機用の自己位置推定装置により、上記課題を解決する。
2019193642.tif 000002
【特許請求の範囲】
【請求項１】
無人航空機の周囲にある対象物を照射するための光源と、
前記対象物からの反射光を画像データとして取得する集光センサと、
前記集光センサにより取得された画像データを用いて無人飛行機の前記対象物に対する相対位置を推定する位置推定部と
を備えた無人飛行機用の自己位置推定装置であって、
前記光源は、環境光と区別可能な光を放出するレーザと、前記レーザからの光を拡散するための拡散器とを有しており、
前記集光センサは、前記対象物からの反射光に対して前記環境光と区別可能な光を感知するように構成された無人飛行機用の自己位置推定装置。
【請求項２】
前記レーザの発光強度、位置及び方向の少なくとも１つを調整する光源制御部を更に備えた請求項１に記載の自己位置推定装置。
【請求項３】
前記環境光と区別可能な光は、所定の帯域の光であり、
前記集光センサは、前記所定の帯域の光を感知するように構成された請求項１又は２に記載の自己位置推定装置。
【請求項４】
前記所定の帯域は、複数の帯域を有しており、前記集光センサは、前記複数の帯域の信号の各々を感知するように構成される請求項３に記載の自己位置推定装置。
【請求項５】
前記光源は、前記複数の帯域の各々が異なる強度の光を照射できるように構成されており、前記集光センサは、前記対象物との距離に応じてどの帯域の光を感知するかを選択できるように構成される請求項４に記載の自己位置推定装置。
【請求項６】
前記集光センサは、画素毎又は画像内の所定の領域毎に、どの帯域の光を感知するかを選択できるように構成される請求項５に記載の自己位置推定装置。
【請求項７】
前記拡散器は、広角レンズを備える請求項１から６のいずれか１つに記載の自己位置推定装置。
【請求項８】
前記拡散器は、前記広角レンズの周囲部から投影される光が中心部から投影される光よりも明るいように放射される光を成形するように構成される請求項７に記載の自己位置推定装置。
【請求項９】
前記光源は、更に、前記拡散器の前段に、コヒーレントなレーザをインコヒーレントなスペクトルに変換する蛍光体リフレクタを備える請求項１から８のいずれか１つに記載の自己位置推定装置。
【請求項１０】
前記自己位置推定装置により推定された前記無人航空機の前記対象物に対する相対位置と、前記無人航空機の速度とを用いて前記無人航空機の飛行を制御する、請求項１から９のいずれか１つに記載の無人飛行機。
【請求項１１】
光源として用いられるレーザから環境光と区別可能な光を放出するステップと、
放出された前記光を拡散して無人航空機の周囲にある対象物に照射するステップと、
前記対象物からの反射光を集光して画像データを取得するステップと、
取得された前記画像データを用いて無人飛行機の前記対象物に対する相対位置を推定するステップと、を備え、
前記画像データを取得するステップは、前記対象物からの反射光に対して前記環境光と区別可能な光を感知することにより前記画像データを取得する方法。
【請求項１２】
光源の発光強度、位置及び方向の少なくとも１つを設定するステップを更に備え、
設定された前記光源を用いて、前記放出するステップと、前記対象物に照射するステップと、前記画像データを取得するステップと、前記推定するステップを行う、請求項１１に記載の方法。
【請求項１３】
前記環境光と区別可能な光は、所定の帯域の光であり、
前記画像データを取得するステップは、前記所定の帯域の光を感知することにより前記画像データを取得する、請求項１１又は１２に記載の方法。
【請求項１４】
前記所定の帯域は、複数の帯域を有しており、前記画像データを取得するステップは、前記複数の帯域の信号の各々を感知する、請求項１３に記載の方法。
【請求項１５】
前記照射するステップは、前記複数の帯域の各々が異なる強度の光を照射し、
前記画像データを取得するステップは、前記対象物との距離に応じてどの帯域の光を感知するかを選択するステップを更に備えている、請求項１４に記載の方法。
【請求項１６】
前記画像データを取得するステップは、画素毎又は画像内の所定の領域毎に、どの帯域の光を感知するかを選択するステップを更に備えている、請求項１５に記載の方法。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、無人航空機に関し、特に、無人航空機用の自己位置推定装置及び自己位置推定方法に関する。
【背景技術】
【０００２】
従来、無人航空機は操縦者が地上の操縦送信器から上空の無人航空機へと制御信号を送信して操縦することにより飛行するか、あるいは自律制御装置を搭載することにより飛行計画に従って自律飛行をしていた。【０００３】
近年、固定翼機、回転翼機を含む無人航空機を自律飛行させるためのさまざまな自律制御装置が開発されている。小型無人ヘリコプタの位置、姿勢、高度、方位を検知するセンサと、小型無人ヘリコプタの舵を動かすサーボモータへの制御指令値を演算する主演算部と、センサからのデータ収集を行い、また主演算部による演算結果をサーボモータへのパルス信号に変換する副演算部とを１つの小型フレームボックスにアセンブリした自律制御装置が提案されている。
自律制御装置を備えた無人航空機においては、Ｖｉｓｕａｌ  ＳＬＡＭ(Simultaneous Localization And Mapping)等を利用して生成した３次元地図データに基づいて無人航空機の位置（高度）を推定することができる。
また、無人航空機においては、特許文献１に記載されるように、光源を備えて無人航空機を制御するものも開発されている。
【先行技術文献】
【特許文献】
【０００４】
【特許文献１】特開２０１７−２２４１２３
【０００５】
Ｖｉｓｕａｌ  ＳＬＡＭ（ＶＳＬＡＭ）では、カメラからの動画像に基づいて特徴点を追跡し、無人航空機（ドローン）の位置の推定を行うと共に環境地図データを作成する。この場合、同じ特徴の領域については、対象物が同じものとみなして推定する。
この点、無人航空機の周辺環境を撮影する際に、照明が十分に出射されないと、露光量の不足やコントラストの低下に繋がる。また、撮影するシーンが影を含む場合がある。この場合も、影の領域は、露光量不足となりコントラストが低下する。一方、影ではない領域は、飽和露光量に達してしまい、コントラストが低下することもある。ドローンの影がドローンと共に移動すると、特徴点を移動させることになり、これは、ＶＳＬＡＭなどの位置推定アルゴリズムに有害なものとなる。
例えば、図７のように、対象物に影（図の斜線領域）ができている場合には、影の領域を別の特徴を有する領域として認識することになり、精度よく対象物の特徴点を認識できない状況が生じ得る。このように対象物に影ができてしまう状況は、対象物に大きな段差が存在する場合や、光源が複数ある環境や、屋外で太陽光と対象物との間に他の物体が存在することなどの場合にも起こり易い。
【発明の概要】
【発明が解決しようとする課題】
【０００６】
したがって、太陽光や外界の光源とそれに伴う影の影響を低減して対象物に対する無人航空機の位置推定が行える装置等を提供することが望ましい。また、段差等を有する対象物に対する無人航空機の位置推定が精度よく行えることが望ましい。
【課題を解決するための手段】
【０００７】
本発明は上述の課題に鑑みてなされたものであり、以下のような特徴を有するものである。すなわち、本発明の１つの特徴によれば、無人航空機の周囲にある対象物を照射するための光源と、前記対象物からの反射光を画像データとして取得する集光センサと、前記集光センサにより取得された画像データを用いて無人飛行機の前記対象物に対する相対位置を推定する位置推定部とを備えた無人飛行機用の自己位置推定装置であって、前記光源は、環境光と区別可能な光を放出するレーザと、前記レーザからの光を拡散するための拡散器とを有しており、前記集光センサは、前記対象物からの反射光に対して前記環境光と区別可能な光を感知するように構成された無人飛行機用の自己位置推定装置が提供される。【０００８】
本発明は、前記レーザの発光強度、位置及び方向の少なくとも１つを調整する光源制御部を更に備えることもできる。【０００９】
また、本発明は、前記環境光と区別可能な光は、所定の帯域の光であり、前記集光センサは、前記所定の帯域の光を感知するように構成することもできる。また、前記所定の帯域は、複数の帯域を有しており、前記集光センサは、前記複数の帯域の信号の各々を感知するように構成することもできる。また、前記光源は、前記複数の帯域の各々が異なる強度の光を照射できるように構成されており、前記集光センサは、前記対象物との距離に応じてどの帯域の光を感知するかを選択できるように構成することもできる。また、前記集光センサは、画素毎又は画像内の所定の領域毎に、どの帯域の光を感知するかを選択できるように構成することもできる。【００１０】
また、本発明は、前記拡散器が広角レンズを備えることもできる。また、前記拡散器は、前記広角レンズの周囲部から投影される光が中心部から投影される光よりも明るいように放射される光を成形するように構成することもできる。【００１１】
また、本発明は、更に、前記拡散器の前段に、コヒーレントなレーザをインコヒーレントなスペクトルに変換する蛍光体リフレクタを備えることもできる。【００１２】
また、本発明は、前記自己位置推定装置により推定された前記無人航空機の前記対象物に対する相対位置と、前記無人航空機の速度とを用いて前記無人航空機の飛行を制御することもできる。【００１３】
また、本発明の別の特徴によれば、光源として用いられるレーザから環境光と区別可能な光を放出するステップと、放出された前記光を拡散して無人航空機の周囲にある対象物に照射するステップと、前記対象物からの反射光を集光して画像データを取得するステップと、取得された前記画像データを用いて無人飛行機の前記対象物に対する相対位置を推定するステップと、を備え、前記画像データを取得するステップは、前記対象物からの反射光に対して前記環境光と区別可能な光を感知することにより前記画像データを取得する方法が提供される。【００１４】
本発明は、光源の発光強度、位置及び方向の少なくとも１つを設定するステップを更に備え、設定された前記光源を用いて、前記放出するステップと、前記対象物に照射するステップと、前記画像データを取得するステップと、前記推定するステップを行うこともできる。【００１５】
また、本発明は、前記環境光と区別可能な光は、所定の帯域の光であり、前記画像データを取得するステップは、前記所定の帯域の光を感知することにより前記画像データを取得することもできる。【００１６】
また、本発明は、前記所定の帯域が、複数の帯域を有しており、前記画像データを取得するステップは、前記複数の帯域の信号の各々を感知することもできる。また、前記照射するステップは、前記複数の帯域の各々が異なる強度の光を照射し、前記画像データを取得するステップは、前記対象物との距離に応じてどの帯域の光を感知するかを選択するステップを更に備えることもできる。また、前記画像データを取得するステップは、画素毎又は画像内の所定の領域毎に、どの帯域の光を感知するかを選択するステップを更に備えることもできる。
【発明の効果】
【００１７】
本発明によれば、外界の光源の影響を受けない無人航空機の位置推定が可能となる。また、ＧＰＳ機能を有しない自律無人飛行機において、自律無人飛行機の位置推定を効率的かつ精度よく行うことを可能とする。
【図面の簡単な説明】
【００１８】
【図１】本発明の一実施形態である無人航空機の斜視図。
【図２】図１の無人航空機を下方向から見た図。
【図３】図１の無人航空機の構成の一実施例を示すブロック図。
【図４】図１の無人航空機用の光源の光学構造の一実施例を示す図。
【図５】無人航空機の位置推定処理の一実施例を示すフローチャート。
【図６】図４の光源による実際の照射例。
【図７】無人航空機で撮影される対象物の影の様子を示す図。
【発明を実施するための形態】
【００１９】
[無人航空機の構成]
図１は、本発明の一実施形態による無人航空機（マルチコプタ）１の外観図である。
図２は、図１の無人航空機（マルチコプタ）１の下面図である。
【００２０】
無人航空機１は、本体部２と、６つのモータ３と、６つのロータ（回転翼）４と、本体部２及び各々のモータ３を接続する６つのアーム５と、着陸脚６と、ローカルセンサ７と、を備える。
【００２１】
６つのロータ４は、各々のモータ３の駆動により回転して揚力を発生させる。本体部２が６つのモータ３の駆動を制御して６つのロータ４各々の回転数、回転方向を制御することにより、上昇、下降、前後左右への飛行、旋回等、無人航空機１の飛行が制御される。着陸脚６は、離着陸時の無人航空機１の転倒防止などに寄与し、無人航空機１の本体部２モータ３、及びロータ４などを保護する。
【００２２】
ローカルセンサ７は、レーザ光源８を用いて無人航空機１の周囲の状況を計測する。ローカルセンサ７は、光源８から主として対象物に対して下方にレーザを照射し、反射して得られた情報を用いて、無人航空機１の周囲にある物体との距離を測定するとともに、周囲にある物体の形状を作成することを可能とする。レーザを照射する方向は一例であるが、少なくとも下方を含むことが好ましい。このように本実施形態では、ローカルセンサ７は、無人航空機１の周囲にある物体に対する無人航空機１の相対位置を計測するために用いられるセンサであり、無人航空機１と周囲にある物体との位置関係を計測できるものであればよい。したがって、例えば、用いるレーザは１つであってもよいし、複数であってもよい。また、ローカルセンサ７は、例えば、画像センサとすることもできる。上記ローカルセンサ７は、好ましくは、ＳＬＡＭ技術を利用する際に用いられる。
【００２３】
例えば、ローカルセンサ７が画像センサである場合、無人航空機１は撮像装置を含む。撮像装置は、イメージセンサなどから構成される単眼カメラ又はステレオカメラを含み、無人航空機１の周囲を撮像することにより、無人航空機１周囲の映像や画像を取得する。この場合、好ましくは、無人航空機１は、カメラの向きを変更可能なモータを備え、飛行制御装置１１は、カメラ及び該モータの動作を制御する。例えば無人航空機１は単眼カメラを用いて連続して画像を取得し、又はステレオカメラを用いて画像を取得するなどし、取得された画像を解析することにより、周囲にある物体との距離や該物体の形状の情報を取得する。撮像装置は、赤外線投影により形状データを取得可能な赤外線デプスセンサであってもよい。
【００２４】
ローカルセンサ７は、本体部２の外部に取り付けられたものとして説明するが、無人航空機１と周囲環境との位置関係を計測できるものであれば本体部２の内部に取り付けられてもよい。
【００２５】
[システム概要]
図３は、図１及び図２の無人航空機１のハードウェア構成図である。無人航空機１の本体部２は、飛行制御装置（フライトコントローラ）１１と、送受信機１２と、センサ１３と、スピードコントローラ（ＥＳＣ：Ｅｌｅｃｔｒｉｃ  Ｓｐｅｅｄ  Ｃｏｎｔｒｏｌｌｅｒ）１４と、バッテリ電源（図示せず）と、を備える。
【００２６】
送受信機１２は、外部との各種データ信号の送受信を行うものであり、アンテナを含む。説明の便宜上、送受信機１２は１つの装置として説明するが、送信機と受信機が別々に設置されていても構わない。
【００２７】
飛行制御装置１１は、各種情報に基づいて演算処理を行い、無人航空機１を制御する。飛行制御装置１１は、プロセッサ２１と、記憶装置２２と、通信用ＩＦ２３と、センサ用ＩＦ２４と、信号変換回路２５と、を備える。これらはバス２６を介して接続される。
【００２８】
プロセッサ２１は、飛行制御装置１１全体の動作を制御するものであり、例えばＣＰＵである。なお、プロセッサとしては、ＭＰＵ等の電子回路が用いられてもよい。プロセッサ２１は、記憶装置２２に格納されているプログラムやデータを読み込んで実行することにより、様々な処理を実行する。
【００２９】
記憶装置２２は、主記憶装置及び補助記憶装置を含む。主記憶装置は、例えばＲＡＭのような半導体メモリである。ＲＡＭは、情報の高速な読み書きが可能な揮発性の記憶媒体であり、プロセッサが情報を処理する際の記憶領域及び作業領域として用いられる。主記憶装置は、読み出し専用の不揮発性記憶媒体であるＲＯＭを含んでいてもよい。この場合、ＲＯＭはファームウェア等のプログラムを格納する。補助記憶装置は、様々なプログラムや、各プログラムの実行に際してプロセッサ２１が使用するデータを格納する。補助記憶装置は、例えばハードディスク装置であるが、情報を格納できるものであればいかなる不揮発性ストレージ又は不揮発性メモリであってもよく、着脱可能なものであっても構わない。補助記憶装置は、例えば、オペレーティングシステム（ＯＳ）、ミドルウェア、アプリケーションプログラム、これらのプログラムの実行に伴って参照され得る各種データなどを格納する。
【００３０】
通信用ＩＦ２３は、送受信機１２と接続するためのインタフェースである。センサ用ＩＦ２４は、ローカルセンサ７により取得されたデータを入力するためのインタフェースである。説明の便宜上、各ＩＦは１つのものとして説明するが、各装置やセンサごとに異なるＩＦを備えることができることは理解される。
【００３１】
信号変換回路２５は、例えばＰＷＭ信号などのパルス信号を生成し、ＥＳＣ１４へ送る。ＥＳＣ１４は、信号変換回路２５により生成されたパルス信号をモータ３への駆動電流へと変換し、該電流をモータ３へ供給する。
【００３２】
バッテリ電源は、リチウムポリマーバッテリやリチウムイオンバッテリ等のバッテリデバイスであり、各構成要素に電力を供給する。なお、モータ３を動作させるためには大きな電源が必要となるため、好ましくは、ＥＳＣ１４は、直接バッテリ電源と接続され、バッテリ電源の電圧や電流を調整して駆動電流をモータ３へ供給する。
【００３３】
好ましくは、記憶装置２２は、無人航空機１の飛行時における姿勢や基本的な飛行動作を制御する飛行制御アルゴリズムが実装された飛行制御プログラムを記憶する。プロセッサ２１が飛行制御プログラムを実行することにより、飛行制御装置１１は、設定された目標高度及び目標速度となるように演算処理を行い、各モータ３の回転数や回転速度を計算して制御指令値データを算出する。このとき飛行制御装置１１は、飛行中の無人航空機１の姿勢などの様々な情報を各種センサから取得し、取得したデータと設定された目標高度及び目標速度とに基づいて演算処理を行う。
【００３４】
飛行制御装置１１の信号変換回路２５は、上記のとおり算出された制御指令値データをＰＷＭ信号へ変換し、ＥＳＣ１４へ送る。ＥＳＣ１４は、信号変換回路２５から受け付けた信号をモータ３への駆動電流へと変換してモータ３へ供給することによりモータ３を回転させる。このようにして、飛行制御装置１１を含む本体部２は、ロータ４の回転速度を制御し、無人航空機１の飛行を制御する。
【００３５】
１つの例では、飛行制御プログラムは、緯度経度や高度を含む飛行ルートや飛行速度などのパラメータを含み、飛行制御装置１１は、目標高度及び目標速度を逐次決定して上記演算処理を行うことにより、無人航空機１を自律的に飛行させる。
【００３６】
１つの例では、飛行制御装置１１は、送受信機１２を介して外部の送信機から上昇下降・前進後退などの指示を受信することで、目標高度及び目標速度を決定して上記演算処理を行うことにより、無人航空機１の飛行を制御する。
【００３７】
[自己位置推定処理]
自己位置推定部３２は、ローカルセンサ７を収集センサとして用いて取得された無人航空機１の周囲にある物体の画像データの点群データに基づいて無人航空機１の自己位置を推定する。自己位置推定部３２が推定する自己位置は、無人航空機１周囲の物体に対する無人航空機１の相対位置である。本実施形態では、自己位置推定部３２は、ＳＬＡＭ技術を利用して無人航空機１の自己位置を推定する。ＳＬＡＭ技術は、既知の技術であるため説明は省略するが、ローカルセンサ７を用いて周囲にある物体認識を行い、該物体認識結果に基づいて自己位置推定と地図作成とを同時に行うものである。
【００３８】
本実施形態では、自己位置推定部３２は、ＳＬＡＭ技術を利用して無人航空機１の相対位置（高度）を推定して出力する。
【００３９】
自己位置推定部３２は、後述する光源を用いて無人航空機１の周囲の点群データを取得する。自己位置推定部３２は、光源から放射されるレーザによる測距距離が所定距離範囲（例えば０．１〜２０ｍ）内の点群データを取得できた場合に推定の演算を開始し、その点群データを取得し始めたタイミングにいた自己位置を基準座標と定める。それから自己位置推定部３２は、取得した点群データを用いて、マップを作成しつつ自己位置を推定する。
自己位置推定部３２は、カメラ等の撮像装置を用いて画像を取得し、取得した画像における物体の位置又は表面上の点を特徴点して抽出し、抽出したパターンと作成されたマップ（又は取得した点群）のパターンをマッチングさせる。
自己位置推定部３２は、作成されたマップとレーザ光源を用いて取得された点群データとの一致度により自己位置推定を行う。自己位置推定部３２は、無人航空機１が十分な点群データを収集した場合に、無人航空機１の相対高度を推定して出力するように構成される。
【００４０】
[光源]
図２に示される通り、光源８は、望ましくは、地表付近の状況を把握できるように無人飛行機の底面側から下向きに取り付けられる。ただし、光源は、地表付近に向けて照射できるように構成されていればよく、無人航空機の他の位置に取り付けられていてもよい。
【００４１】
図４は、光源の光学構造の一実施例を示す。レーザ光源４０は、例えば、帯域特異性を有しており、波長が４２０ｎｍの青色レーザである。レーザ光源４０は、コヒーレント光として出射されると蛍光体リフレクタ４１において人間の眼に安全なものとするようにインコヒーレント光に変換される。蛍光体リフレクタ４１を通った光は、拡散レンズを含む拡散器４２において所定の設定のプロジェクションパターンとして拡散された後に対象物に照射される。
【００４２】
ここで、拡散レンズは、広角レンズ（例えば１１０度）を採用することにより、カメラ側で撮像する際に対象物の広範囲の領域を一度で撮像することができ、一度の撮像で取得できる情報量を増大させることできるようになり、このことはＳＬＡＭ技術を用いた自己位置推定において有用である。
【００４３】
また、拡散レンズは、特に、広角レンズを採用すると、一般に、図６（ａ）に示す通り、レンズの中心付近を通った光はレンズの外側を通った光より相対的に明るい光となるという開口効率特性の影響が大きくなる。すなわち、このように、拡散レンズを通った光のプロジェクションパターンが一様ではなく、また、光源及び取集センサ（カメラ）から対象物までの距離が十分にあることを前提とすると、カメラ側では、画像の外側は暗い像として取得され、画像の内側は明るい像として取得されることになる。したがって、本発明に係る一実施例では、拡散器（拡散レンズ）４２は、図６（ｂ）に示す通り、上記の所定の設定のプロジェクションパターンとして、レンズの周囲部から投影される光が中心部から投影される光よりも明るいように放射される光を成形するように広角の程度に依存して構成されることが望ましい。このような構成にすることにより、広角レンズなどの拡散レンズによる上記の開口効率特性を補償することができる。
【００４４】
また、光源８は、光源制御部９によりその位置及び照射方向を制御できるようになっていることが望ましい。この点、後述する通り、光源が対象物に対してカメラの背後にある場合には、無人航空機自身の影がマシンビジョンシステムによって視認されないように光源の位置及び照射方向を調整するように制御される。また、光源の方向制御により、Ｖｉｓｕａｌ ＳＬＡＭで環境認識に重要な特徴点をハイライトすることが可能となる。
【００４５】
また、光源は、後述の通り、電流を調整することによって強度を可変なものとして照射されるように構成し、Ｖｉｓｕａｌ ＳＬＡＭ処理用に一連の画像を光源の強度を変えながら取得できるようにしてもよい。この点、例えば、対象物が遠い場合には、取得される画像が暗くなりがちであるので、その方向には強い強度で照射するように構成することができる。
【００４６】
なお、光源は、太陽光などの他の光源（環境光）と区別できるような特有の光であればよく、後述の通り、例えば、環境光の影を排除できるものであればよく、青色レーザに限らず、他の所定の狭帯域の光源であってもよい。さらに言えば、光源は、帯域以外にもスペクトル分布、光の強度、点滅パターンの光などを環境光と異なるように構成する光源であってもよい。光源が所定のパターンで点滅する場合の一例として、一定周期の点滅が考えられる。
【００４７】
また、光源は、複数の帯域を照射できる光源（例えば、Ｒ、Ｇ、Ｂ等を含むマルチスペクトル）とすることができる。マルチスペクトル光源は、ダイクロイックミラー等を利用して光を分離し、時間的にそれぞれの帯域を切り替えるように構成してもよいし、同時に複数の帯域を照射できるように構成すると共に各帯域の対象物への照射方向を個別に空間的に調整できるように構成してもよい。
【００４８】
なお、この場合、後述する通り、集光センサは、当該複数の帯域を個別に収集できるようなフィルタを有するように構成される。
【００４９】
[光源及びカメラ（集光センサ・フィルタ）の構成]
- 光源の帯域に対応する集光センサ・フィルタ（他の光源の遮断）
ＳＬＡＭなどのマシンビジョンアルゴリズムは、カメラで視認可能な特徴部のほとんどは固定されており、動かないという前提で処理されることが望ましい。光源が対象物に対してカメラの背後にある場合には、無人航空機自身の影がマシンビジョンシステムによって視認され得ることになる。この影は、特徴点の主要なソースであることが多いが、当該影は、無人飛行機と共に移動することになり、当該影の特徴部は、固定されないことになる。このことは、マシンビジョンの性能を低下させる。
【００５０】
光源がカメラの近傍で無人航空機に固定され得る場合には、光源からの影は、最小化され又はマスクすることが可能である。しかしながら、無人航空機に固定されていないような他の光源からの無人航空機自体の影の影響は、無人航空機の移動と共に不規則に移動し得る。この場合、カメラの撮像に基づく影の領域の認識について精度が低下し、このことは、ＶＳＬＡＭによる無人航空機の位置推定の精度の低下に繋がる。
【００５１】
これに対して、本発明に係る光源とカメラ（フィルタ）の構成によれば、影の影響を低減することが可能となる。すなわち、例えば、上述の通り、光源は、青色レーザとする場合を考える。この場合、光源は、蛍光体リフレクタと拡散器を通ることにより、青色レーザ光をワイドスペクトル光に変換し、この光の大部分は、レーザと同じ４２０ｎｍで対象物によって反射される。マシンビジョンシステムの撮像側では、カメラのレンズに所定のノッチフィルタ（青色４２０ｎｍ）を取り付けておくことによって、対象物から反射される光の多くは、青色ノッチフィルタを通り、集光センサにより画像データとして取得される。一方で、他の光源からの光の大部分は、４２０ｎｍブルーノッチフィルタにより遮断されることになり、また、他の光源により生じる影も特徴点として認識されることなく集光センサにより画像として取得され、他の光源による影の影響も遮断することが可能となる。
また、光源が所定のパターンで点滅する光の場合、対象物からの反射光は、撮像側で順次、動画像として撮像され、集光センサは、光源が所定のパターンで点滅していることに伴って動画像の一連の画像内で光の強度（例えば、画像内のグレースケール値）が上下している箇所を感知するように構成される。このように構成された光源及び集光センサにより、光の強度が上下している画像内の箇所を検知し、その光の画角や大きさ等から反射点の位置を推定することが可能となり、環境光から放出され、その後、対象物から反射された光の影響を低減してＶＳＬＡＭによる無人航空機の位置推定を行うことができる。
【００５２】
- 高ダイナミックレンジ
青色レーザ光源などの特定帯域のレーザ光源について、上述の通り、電流を調整することによって照明の強度を可変なものとして照射され、一連の画像を様々な光源の強度で取得できるようにすることは有用である。すなわち、そのような構成にすることにより、非常に広範囲の明るさで特徴点を抽出できるようになる。このことは、対象物について段差などが存在してカメラから様々な距離の表面が存在するとき、カメラから遠い表面を照射することは、カメラから近い表面より高い光出力を必要とするので有用である。例えば、段差が存在する対象物に対して、１回目の撮像で光源を相対的に弱い光とすることにより、近距離の領域の画像データを取得し、２回目の撮像で光源を相対的に強い光とすることにより、遠距離の領域の画像データを取得するように光源及び収集センサを構成することができる。したがって、収集センサを高ダイナミックレンジに対応すると共に可変なダイナミックレンジとし、様々な照射レベルで一連の画像を取得することによって、各表面からの特徴部が抽出され得る。
【００５３】
- 複数の光源とそれらに対応する複数の集光センサ・フィルタ
上述の通り、光源は、複数の帯域を照射できる光源（マルチスペクトル）とすることができる。一方、この場合、カメラ（集光センサ・フィルタ）は、対応する帯域のそれぞれを検知できるものとすることにより、対象物に対して複数の独立した画像情報を取得することができる。
【００５４】
また、集光センサは、対応する帯域のそれぞれを検知できるものとした上で、更に、対応する帯域ごとに異なる強度の光を照射できるように設定してもよい。これにより、カメラ・光源と対象物との距離に応じて、必要とされる照射光の強度を適応させることが可能となる。また、この場合、集光センサにおいて、画素ごとに検知する帯域を選択できるようにしてもよい。
【００５５】
例えば、３次元的に大きな段差を含んでいる対象物を撮像する場合、カメラから遠方側の表面（段差の下側の領域）を照射することは、カメラから近い表面（段差の上側の領域）より高い光出力を必要とする。この場合に、光源及び集光センサについて、段差の下側である領域の画素に対して、強度の強い光を照射すると共にこの照射光の帯域に対応する帯域のみを検知するように構成し、また、段差の上側である領域の画素に対して、相対的に強度の弱い光を照射すると共にこの照射光の帯域に対応する帯域のみを検知するように構成することにより、例えば、１つの画像内の隣接する画素間でそれぞれ適応した処理とすることが可能となり、画像内で領域毎又は画素単位での可変ダイナミックレンジを実現できる。
【００５６】
ドローン等の飛行物体では、ドローンの移動と共に周囲のシーンが急変することもあり、カメラにおけるこのような可変ダイナミックレンジの実現は、ＶＳＬＡＭを用いた対象の撮像による位置推定処理の遅延を解消するのに有用である。
【００５７】
[処理フロー]
以下に、上述の構成に基づく無人航空機の位置推定のための動作について、一実施例として、地面を光源により照射し、その反射波を画像データとして取得して、無人航空機の位置を推定するフローについて説明する。
【００５８】
まず、無人航空機の光源及び収集センサの設定をする（ステップ１００）。
光源のレーザは、例えば、波長が４２０ｎｍの青色レーザであるとする。光源の設定は、制御部により、必要に応じて、光源の照射光の発光強度の調整と共に位置及び照射方向を調整することができる。
【００５９】
光源の発光強度は、対象物との距離が認識される場合において、対象物との距離が相対的に遠い場合には、強度を強く、対象物との距離が相対的に近い場合には、強度を弱く設定することができる。
【００６０】
ドローン等の無人航空機において、例えば、地上の状態を把握するために本体から地面を照射できるように本体の下面に取り付けられている場合、光源は、３次元的な位置を調整することや、重力方向をベースに方向を調整することが可能であるが、初期段階では重力方向とすることができる。また、光源は、無人航空機自身の影がマシンビジョンシステムによって視認されないようにカメラよりも対象物の近い位置に調整し、また、照射方向を調整してもよい。
【００６１】
次に、Ｓ１００における光源及び集光センサの設定に基づいて、光源から対象物に照射された光の反射波を収集センサにおいて対象物の画像データとして取得する（ステップ２００）。この場合、上述の通り、光源として青色レーザ光を用い、カメラのフィルタは、この青色レーザ光のみを通すので、仮に、対象物に太陽光等の外界からの光源が照射されていたとても、これらの外界からの光源に伴う影等は撮像されずに済むことなり、太陽光による対象物に生じる影による特徴点の誤認等の影響を低減することができる。
【００６２】
次に、Ｓ２００で取得された対象物の画像に基づいて、例えば、ＶＳＬＡＭ処理等を用いて対象物の特徴点の抽出及び追跡並びに環境地図の作成をすることにより、対象物に対する無人飛行機の相対位置の推定を行う（Ｓ３００）。この場合、動物体を検出した場合には、時系列的に取得した画像の差分データ等を用いてそれを除去する。
なお、Ｓ３００の相対位置の推定に関して、上述の通り、青色レーザ光などの特定の帯域の光の反射波を収集した対象物の画像データを用いることに加えて、太陽光などの環境光の反射波を別個に収集した対象物の画像データを更に用いるように構成してもよい。すなわち、例えば、特定の帯域の光を光源として取得した画像データを用いたＶＳＬＡＭ等の位置推定処理と、環境光等を用いて取得した別の画像データを用いたＶＳＬＡＭ等の位置推定処理とをそれぞれ独立して行い、それぞれの信頼度に重み付けして最終的に位置推定を行うようにしてもよい。このような構成を採用することにより、上述の影等の影響がないような撮像条件では従来の画像データを用いたＶＳＬＡＭによる位置推定を用いることも可能となり、環境光を含む全帯域対応の既存のＳＬＡＭと組み合わせて位置推定することが可能となる。
【００６３】
また、図示していないが、上記の無人飛行機の位置推定ステップＳ３００により推定された無人航空機の対象物に対する相対位置と、無人航空機の速度とを用いて無人航空機の飛行を制御するように構成することができる。
【００６４】
なお、ＶＳＬＡＭ処理において、特徴点の抽出及び環境地図の作成等が精度良くスムーズになされない場合には、再度、ステップ１００に戻り、無人航空機の光源及び収集センサの設定をすることができる。
【００６５】
この点、対象物に対する位置推定処理では、対象物から反射される光の露光量に過不足があるかどうかを判定できるように構成しておくことが望ましい。例えば、対象物から反射される光の露光量に過不足がある場合には、撮像画像にコントラストが低い特徴点などを含み不安定な特徴点が多いと、処理に必要な時間が増大し、また、地図構築に悪影響を及ぼし、作成された環境地図と撮像画像を対照させてＶＳＬＡＭ処理による推定が不正確な可能性が出てくるため、Ｓ１００に戻り、光源の発光強度を調整する。また、この場合、ＶＳＬＡＭで環境認識に重要な特徴点をサーチしてハイライトするように光源の方向を制御して撮像エリアをシフトさせてもよい。例えば、対象物のその重要な特徴点が遠い場合には、取得される画像が暗くなりがちであるので、その方向には強い強度で照射するように光源を再設定する。
【００６６】
このように光源を再設定できることは、生成された環境地図と撮像された画像との対照を効率的に行うことに寄与するものであり、特に、対象物に大きな段差形状等が存在している場合のＶＳＬＡＭ処理のエラーを低減するのに有効である。
【００６７】
[変形例]
次に、複数の帯域を照射できる光源と、対応する帯域のそれぞれを検知できる集光センサ・フィルタにより、対象物に対して複数の独立した画像情報を取得する場合について説明する。
【００６８】
ここでは、説明の簡単のために、２つの光源として赤色レーザ及び青色レーザを用いて、段差を有する対象物に対する無人飛行機の相対位置を推定する場合を想定するが、３つ以上の帯域を有する光源及びそれらの帯域それぞれを検知できる集光センサ・フィルタとしてもよい。
【００６９】
まず、赤色レーザ及び青色レーザについて、それぞれの強度及び位置・方向を設定する（Ｓ１００）。この場合、それぞれ異なる強度の光を照射できるように設定することができるが、例えば、初期段階では、赤色レーザ及び青色レーザは、共に同じ強度に設定すると共に、照射方向をそれぞれ異なるものとして設定してもよい。
【００７０】
なお、赤色レーザと青色レーザの光源は、時間的にそれぞれの帯域を切り替えるように構成してもよいし、同時に複数の帯域を照射できるように構成すると共に画像空間的にそれぞれの帯域を切り替えるように構成してもよい。
【００７１】
次に、Ｓ１００の設定に基づいて、光源及び集光センサの設定に基づいて、光源から対象物に照射された光の反射波を収集センサで取得し、対象物の画像を取得する（ステップ２００）。
【００７２】
次に、Ｓ２００で取得された対象物の画像に基づいて、例えば、ＳＬＡＭ処理等を用いて対象物の特徴点の抽出及び追跡並びに環境地図の作成をすることにより、無人飛行機の位置推定を行う（Ｓ３００）。この場合、動物体を検出した場合には、時系列的に取得した画像の差分データ等を用いてそれを除去する。
【００７３】
ここで、対象物が段差を有することが推定される場合に、無人飛行機の位置を効率的に推定するためにＳ１００に戻り、例えば、赤色レーザを相対的に強い強度に再設定し、青色レーザを相対的に弱い強度に再設定する。なお、レーザ強度の強弱設定は赤色と青色で逆であってもよく、各帯域に異なる強度が設定されていればよい。また、対象物における段差の下側である領域（光源から相対的に遠い領域）に対して、強度の強い光の赤色レーザを照射し、段差の上側である領域（光源に相対的に近い領域）に対して、相対的に強度の弱い青色レーザを照射するように光源の位置及び方向を再設定する。なお、赤色レーザ及び青色レーザの照射は、レーザ光源の構成に応じて、同時に行ってもよいし、時系列的に順次行ってもよく、対象物の段差の上側及び下側を含む画素領域についてセンサへの露光量が一定になるように１つの画像として取得されればよい。
【００７４】
次に、集光センサ・フィルタにおいて、対象物における段差の下側である領域の画素に対しては、照射された強度の強い光の赤色レーザのみを検知し、また、段差の上側である領域の画素に対しては、相対的に強度の弱い青色レーザのみを検知することにより、撮影画像を取得する（Ｓ２００）。その後、再度、Ｓ２００で取得された対象物の画像に基づいて、例えば、ＳＬＡＭ処理等を用いて対象物の特徴点の抽出及び追跡並びに環境地図の作成をすることにより、無人飛行機の位置推定を行う（Ｓ３００）。なお、無人飛行機の移動に伴う周辺環境（対象物）等の変化に応じて、無人飛行機の位置を効率的に推定するために再度Ｓ１００に戻るように構成してもよい。また、図示していないが、上記の無人飛行機の位置推定ステップＳ３００により推定された無人航空機の対象物に対する相対位置と、無人航空機の速度とを用いて無人航空機の飛行を制御するように構成することができる。
【００７５】
上述の通り、３次元的に大きな段差を含んでいる対象物を撮像する場合、カメラから遠い側の表面（段差の下側の領域）は、カメラから近い表面（段差の上側の領域）より光源の高い出力を必要とする状況がある。ＳＬＡＭ処理における環境地図を生成しながら光源及び集光センサを再設定する構成により、そのような状況に効率的に対応することが可能となる。また、上述のように青色レーザ及び赤色レーザとそれらの帯域のみを検知可能な構成とすることにより、対象物が大きな段差を有する場合の太陽光等の外光による影の影響を低減することが可能となる。
【００７６】
なお、ここでは、画像内の所定の領域ごとに光源を切り替える構成について説明したが、光源の切り替えは、画素ごとであってもよいし、画像ごとであってもよい。
【００７７】
上述の通り、他の光源や太陽光の影響により、ＶＳＬＡＭ処理における点群データの取得が影の存在により誤ってなされる場合があり、このことは、対象物が段差を含むような場合などには特に顕著になる。本発明に係る光源及び集光センサ・フィルタは、そのような他の光源や太陽光を最小限に抑えることが可能である点において有用である。すなわち、例えば、撮影しようとしている対象物の領域内に、太陽光による別の対象物の影が生じる場合があるが、本発明に係る光源及び収集センサを用いて取得した画像データは、そのような影が除去されたものであり、ＶＳＡＬＭにおいて特徴点の抽出を精度よく行うことが可能となる。また、この観点から、光源は本体に取り付けられるとき、光源によって作られる影が視認されることを避けるようにできる限りカメラに近い位置に配置することが望ましい。
【００７８】
本発明によれば、ＧＰＳ機能を有しない自律無人飛行装置において、処理時間を低減しながら精度よく自己の位置推定を行うことを可能となる。なお、このことは、自律無人飛行装置が、ＧＰＳ機能を搭載することを排除することを意図するものではない。自律無人飛行装置がＧＰＳ機能を搭載していれば、周囲の環境の情報を精度良く収集することができ、更に、本発明による光源及びカメラ（収集センサ）と組み合わせて用いることにより、無人飛行装置の位置推定を従来よりも効率的かつ精度良くに行うことが可能となる。
【００７９】
以上のように、本発明に係る光源及び収集センサ・フィルタの実施の一形態及び実施例について説明してきたが、本発明は、上記の実施例に限定されるものではなく、これに種々の変更を加え得るものであることは容易に理解される。そして、それらが特許請求の範囲の各請求項に記載した事項、及びそれと均等な事項の範囲内にある限り、当然に本発明の技術的範囲に含まれる。上記の実施例は、対象物に対する影及び対象物が段差を有する場合に対してのものであったが、これはあくまでも一例であり、本発明がこの特定の具体例に限定されるものではない。
【産業上の利用可能性】
【００８０】
本発明は、あらゆる用途に用いられる無人航空機の位置推定及び制御のために利用することが可能である。
【符号の説明】
【００８１】
１  無人航空機
２  本体部
３  モータ
４  ロータ（回転翼）
５  アーム
６  着陸脚
７  ローカルセンサ
１１  飛行制御装置
１２  送受信機
１３  センサ
１４  スピードコントローラ（ＥＳＣ）
２１  プロセッサ
２２  記憶装置
２３  通信用ＩＦ
２４  センサ用ＩＦ
２５  信号変換回路
３１  環境取得部
３２  自己位置推定部
４０  レーザ光源
４１  蛍光体リフレクタ
４２  拡散器
【図１】
2019193642.tif 000003
【図２】
2019193642.tif 000004
【図３】
2019193642.tif 000005
【図４】
2019193642.tif 000006
【図５】
2019193642.tif 000007
【図６】
2019193642.tif 000008
【図７】
2019193642.tif 000009
【国際調査報告】
2019193642.tif 000010
2019193642.tif 000011
2019193642.tif 000012
2019193642.tif 000013