以下、本発明にかかる監視システムの実施の形態について説明する。
図1は、監視システム1の全体構成を模式に示した図である。監視システム1は、監視領域Eに設置される警備装置2、飛行ロボット3、レーザセンサ4、建物内センサ5、対処員端末6と、ネットワークを介して接続される監視センタ内に設置されたセンタ装置7から構成されている。センタ装置7は、警備装置2とIP網にて接続され、警備装置2から飛行ロボット3の撮影した画像や建物内センサ5の検知信号などを受信し、モニタに表示する。なお、監視員は、このモニタを視て監視領域Eの状況を把握し、適切な対応を行う。また、ネットワークをIP網として説明しているが、一般公衆回線網、携帯電話網など画像の送受信に支障がなければこれに限るものではない。
飛行ロボット3は、警備装置2からの無線による飛行制御信号に基づいて撮影しながら飛行し、撮影した画像を警備装置2に送信する。図2は、飛行ロボット3の機能ブロックを示した図である。
飛行ロボット3は、警備装置2との無線通信を行うためのアンテナ31、上昇/下降/方向転換/前進などの飛行するための4つのロータ32、ロータ32に駆動力を提供するモータ等からなるロータ駆動部33、鉛直下方にレーザーを投受光して飛行ロボット3の現在高度を計測する高度センサ34、水平方向かつ周囲にレーザーを投受光して飛行ロボット3の周辺状況を計測する測距センサ35、飛行ロボット3の前方をカラー画像にて撮影するカメラ36、周囲が暗いときに点灯しカメラ36での撮影を補助するLED照明である照明37、飛行ロボット3の全体を制御するロボ制御部38、飛行ロボット3の各部に電力を供給するリチウムポリマー電池である電源39から構成されている。
また、ロボ制御部38は、アンテナ31を介して警備装置2との無線通信を制御するロボ通信制御手段381、カメラ36の撮影開始/終了やカメラ36が撮影した画像を取得してロボ通信制御手段381から警備装置2へ送信するなどの処理をするカメラ制御手段382、測距センサ35および高度センサ34が測定した高度情報および周辺物体と自機との距離データをスキャンデータとして通信制御手段381から警備装置2へ送信するなどの処理をするスキャン手段383、警備装置2からの飛行制御信号に基づいてロータ駆動部33を制御して飛行ロボット3を目標位置に飛行するように制御する飛行制御手段384から構成されている。
次に、対処員端末6について説明する。対処員端末6は、監視センタより監視領域Eへの出動要請を受けた緊急対処員によって所持される携帯端末である。対処員端末6は、警備装置2から無線通信によって飛行ロボット3が撮影した画像や飛行ロボット3に関する情報を受信する。また、対処員端末6は、端末の現在の位置情報や飛行ロボット3を制御するための操作信号を警備装置2に送信する。図3は、対処員端末6の機能ブロックを示した図である。図4は、対処員端末6のイメージを示した図である。
対処員端末6は、GPS衛星(図示しない)からGPS信号を受信するGPS受信手段611と、警備装置2との無線通信を行うための警備装置通信手段612とからなる通信部61、対処員端末6を制御する端末制御部62、対処員端末6の処理に必要なプログラムや各種のデータ、パラメータなどを記憶しているROM/RAMなどの周辺部品にて構成される端末記憶部63、液晶ディスプレイ等の情報表示デバイスである表示部64と、キーボードやタッチパネル等の情報入力デバイスである操作部65から構成されている。なお、図示しないが各部への電力を供給する電源部も備えている。
ここで、端末記憶部63に記憶されている情報について説明する。監視空間マップ631は、監視領域Eを3次元にて表現した情報であって、地面から飛行ロボット3の飛行に必要な程度の高さまでの監視空間を表現したマップ情報である。監視空間マップ631には、予め監視領域E内の建物や当該建物の窓や扉の3次元情報、監視領域E内に設置されたレーザセンサ4の位置など監視領域E内に存在する物体の情報が3次元情報として記憶されている。なお、後述する警備装置2の記憶部24にも監視空間マップ241が記憶されている。端末記憶部63に記憶されている監視空間マップ631と、記憶部24に記憶されている監視空間マップ241は同一の情報でもよいし、それぞれが用いられて実行される処理に必要な情報が含まれていれば情報量に違いがあるものでもよい。監視空間マップ241については後述する。端末記憶部63には、監視空間マップ631以外に対処員端末6の機能を実現するための各種プログラムが記憶されている。
次に端末制御部62について説明する。なお、端末制御部62は、端末記憶部63には図示していないソフトウェアモジュールを読み出して、CPU等にて各処理を行うものである。
端末位置算出手段621は、GPS受信手段611が受信するGPS信号から対処員端末6の現在位置情報(緯度・経度・高度情報)を算出し、警備装置通信手段612を介して警備装置2に算出した現在位置情報を端末位置として送信する。ここで、端末位置算出手段621は、対処員端末6の電源がONになっている間、所定間隔(例えば、数十ミリ秒間隔)でGPS受信手段611が受信するGPS信号について端末位置を算出し、警備装置2に送信する。また、本実施の形態では、GPS信号を用いた端末位置の算出を説明しているが、これに限るものではない。対処員端末6の現在位置情報を特定可能であれば、他の電波測位方式やICタグ、画像処理技術などを用いて端末位置を算出するようにしてもよい。
表示/操作制御手段622は、警備装置2から送信される飛行ロボット3が撮影した画像や飛行ロボットの現在位置情報(飛行位置)を含んだ飛行ロボット3に関する情報(ロボ情報)を警備装置通信手段612にて受信すると、そのロボ情報を表示部64に表示し、対処員端末6の利用者である緊急対処員がロボ情報を把握できるようにする。また、端末記憶部63に記憶された監視空間マップ631等を用いて、緊急対処員が飛行ロボット3を操作するのに必要な情報を表示部64に表示する。
ここで、図4を参照して対処員端末6の表示の一例を説明する。図4は、緊急対処員が監視領域Eに到着し、飛行ロボット3に目標位置を指示したときの表示部64の表示例を示している。表示部64には、監視空間マップ631を用いて生成した監視領域Eの全体を俯瞰できる構造図643と、飛行ロボット3が撮影した現在の撮影画像641が表示されている。また、対処員端末6の現在位置(緊急対処員の現在位置)を示す対処員アイコン646、飛行ロボット3の現在位置を示す飛行ロボットアイコン642、緊急対処員が飛行ロボット3を飛行させたい目標位置(指示目標位置)として設定した目標位置アイコン645が構造図634上に表示されている。更に、緊急対処員が指示目標位置を設定する際に使用するカーソル644が表示されている。また、緊急対処員が飛行ロボット3の制御モードを自律飛行モードから他律飛行モードまたは他律飛行モードから自律飛行モードへ移行させる為に操作するボタン647が表示されている。本表示例では、制御モードが他律飛行モード中であるので、ボタン647を押下すると自律飛行モードへの移行操作となるという意味で「自律飛行」と表示している。なお、自律飛行モードから他律飛行モードへの移行操作となるという意味では「他律飛行」と表示される。また、図示はしないが、指示目標位置における飛行ロボット3の撮影方向を表示するようにしてもよい。このように、対処員端末6の表示部64を緊急対処員が見れば、監視領域Eにおける自己位置、飛行ロボット3の位置、飛行ロボット3の目標位置を瞬時に把握できる。なお、図4に示した表示は一例であり、表示部64上の表示態様はこれに限るものではない。
さらに、表示/操作制御手段622は、操作部65の入力信号を基に、表示部64の構造図643上から指示目標位置を指定する。そして、指定された指示目標位置の監視空間マップ631に対応する3次元座標を警備装置通信手段612から警備装置2に送信する。指示目標位置を指定する操作は、まず、操作部65を用いてカーソル644を移動し、構造図643から飛行ロボット3を飛行させたい位置にカーソル644を合わせて操作部65を押下する。次に、カーソル644を合わせた位置(水平方向の位置)について、監視マップ631から構造図643を2次元に射影したときの視軸上の位置(垂直方向の位置と奥行き方向の位置)を決定するために、そのまま操作部65を長押しする。すると、押下した時間に応じて目標位置アイコン645のサイズが順次変化する。目標位置アイコン645のサイズは、人間の感覚に合致するように監視領域Eを構造図643の視軸方向と同じ方向から見たときの飛行ロボット3のサイズに対応している。つまり、視点から遠いほど目標位置アイコン645は小さく、視点から近いほど目標位置アイコン645は大きくなる。緊急対処員の意図する視軸上の位置(アイコン645のサイズ)になったら操作部65にて決定操作をする。これにより、指示目標位置の3次元座標が指定される。また、指示目標位置入力手段623は、指示目標位置の指定に加えて、前述したように飛行ロボット3の撮影方向を指定するようにしてもよい。この場合は、指定された指示目標位置と撮影方向を警備装置2に送信する。なお、撮影方向を指定しない場合は、飛行ロボットの進行方向を撮影方向とすればよい。緊急対処員は、監視空間マップ631に基づいた構造図643を参照して指示目標位置を指定することによって、監視領域Eにある建物の死角や窓や扉などの位置を考慮することが可能になる。なお、本実施形態の指示目標位置の指定は一例であり、指定の方法はこれに限るものではない。飛行ロボット3を飛行させたい位置を指示目標位置として警備装置2に送信できるものであればよい。
また、図示しないが、表示/操作制御手段622は、飛行ロボット3が自律飛行モード中に緊急対処員が操作部65を操作し、カーソル644にてボタン647を押下すると、警備装置通信手段612から警備装置2に移行操作信号を送信する。また、表示/操作制御手段622は、飛行ロボット3が他律飛行モード中に緊急対処員が操作部65を操作し、カーソル644にてボタン647を押下すると、警備装置通信手段612から警備装置2に操作終了信号を送信する。また、図示しないが、表示/操作制御手段622は、飛行ロボット3が他律飛行モード中に緊急対処員が操作部65を操作し、着陸操作を行うと、警備装置通信手段612から警備装置2に着陸信号を送信する。着陸信号には、飛行ロボット3の着陸待機場所の位置が指示目標位置として含まれている。
次に、図5、図6、図8、図9、図10、図11を参照して、警備装置2について詳細に説明する。図9に示す監視領域Eの建屋Bの内部に警備装置2は設置されている。警備装置2は、建屋B内への侵入者を検知するための適宜の場所に設置された建物内センサ5、監視領域E内であって駐車場等の建屋Bの外を検知領域とするレーザセンサ4とそれぞれ接続されている。
図5は、警備装置2の機能ブロックを示す図である。警備装置2は、監視領域Eを監視センタが監視する警備セット状態と監視センタで監視しない警備解除状態との切替操作を行う警備モード切替部21と、レーザセンサ4や建物内センサ5などの各種センサからの信号の入力を受けるセンサインタフェース22、飛行ロボット3との通信を行う飛行ロボット通信部25、飛行ロボット3が撮影した画像、各種センサが検知した異常信号などについて、センタ装置7とネットワークを介して通信を行う監視センタ通信部26、警備装置2の処理に必要なプログラムや各種のデータ、パラメータなどを記憶しているROM/RAMなどの周辺部品にて構成される記憶部24、および警備装置2の全体を統括制御するCPU、MPUなどから成る警備制御部23から構成されている。
ここで、記憶部24に記憶されている情報について説明する。まず、監視空間マップ241は、対処員端末6の端末記憶部63に記憶された監視空間マップ631の説明にて前述したように監視領域Eを3次元にて表現した情報であって、地面から飛行ロボット3の飛行に必要な程度の高さまでの監視空間を表現したマップ情報である。図9を参照して説明すると、本実施の形態では、監視領域Eと外部を仕切る塀の存在、建屋B、レーザセンサ4の設置位置、扉や窓のように人が出入り可能な開口部を含んだ建屋B内部の3次元情報が登録されている。また、本実施の形態では、監視空間マップ241と監視空間マップ631は同じ情報である。
建物内センサ配置情報242は、各建物内センサ5の監視場所の監視空間マップ241における位置情報である。これは、予め警備計画によって決められており、建物内センサ5ごとに監視空間マップ241上の位置が対応付けられている。建物内センサ配置情報242は、建物内センサ5に、センサ属性、検知対象を示す空間領域、最寄りの開口位置の3次元座標を対応付けた情報である。センサ属性は、建物内センサ5の機能を示しており、「扉」は扉の開閉をマグネットセンサにて検知するという属性、「空間センサ」は領域内の人体が発する熱を検出する熱センサや画像センサなど所定空間内に人体の存在を検出するという属性、「窓センサ」は、窓の開閉を検知または窓の破壊を検知するという属性を示している。空間領域は、建物内センサ5が対象としている監視ブロックを示している。
また、開口位置は、建物内センサ5が検知した場合に、賊が建屋Bから出てくる可能性が高い場所として、飛行ロボット3の目標位置の算出に用いられる。図9を参照して、建物内センサ配置情報242の一例を説明すると、例えば、センサ5fについては、窓の開閉を監視するセンサであり、監視ブロックB3への侵入を検知し、最寄りの開口位置の3次元座標はセンサ5fが設置されている窓の監視空間マップ241上の位置(x1,y1,z1)であることが対応付けられている。
レーザセンサパラメータ243は、レーザセンサ4の監視空間マップ241における位置、レーザセンサ4の検知領域における位置と監視空間マップ241上の位置との対応関係を含む情報であり、レーザセンサ4にて物体検知した位置を監視空間マップ241上の位置に変換するためのパラメータである。
各種パラメータ244は、警備装置2が監視領域Eを監視するために必要なセンタ装置7のIPアドレスや飛行ロボット3との通信のためのデータなど種々のパラメータである。記憶部24には、これら以外に警備装置2の機能を実現するための各種プログラムが記憶されている。
次に、警備制御部23について詳細に説明する。なお、警備制御部23は、記憶部24には図示していないソフトウェアモジュールを読み出して、CPU等にて各処理を行うものである。
レーザセンサ解析モジュール231は、センサインタフェース22から入力されるレーザセンサ4の信号を解析処理するソフトウェアである。具体的には、レーザセンサ4がレーザー光にて検知エリアを走査した結果である探査信号を時系列に解析する。検知エリアに新たな進入物体等がなければ、時系列に入力されるレーザセンサ4の探査信号はあまり変化しないので、移動物体なしとの解析結果となる。他方、検知エリアに新たな進入物体等があれば、レーザセンサ4の探査信号に変化が生じ、変化が出た検知エリアでの位置を解析して求める。更に、記憶部24のレーザセンサパラメータ243を用いて、監視空間マップ241上の位置に変換し、進入物体の位置・大きさ・移動方向を算出し、進入物体を監視空間マップ241上で追跡する。また、進入物体が停止すると、その後の信号の変化がなくなるので、追跡していた自動車等の物体が、駐車したと判定することができる。
また、レーザセンサ解析モジュール231の解析結果は、後述する異常判定モジュール232やロボ制御モジュール233に出力される。
ここで、レーザセンサ4は、屋外に設置されて、監視領域Eの駐車場や建屋Bの周囲への進入を監視している。図7は、レーザセンサ4の検知エリアを示した図である。同図に示すように、レーザセンサ4−1が監視領域Eの左上から建屋B方向を検知エリアとして設置され、レーザセンサ4−2が監視領域Eの右下から建屋B方向の裏手を検知エリアとするように設置されている。
レーザセンサ4は、予め設定された検知エリアを走査するように、放射状にレーザー光である探査信号を送信し、検知エリア内の物体に反射して戻ってきた探査信号を受信する。そして、送信と受信の時間差から物体までの距離を算出し、その探査信号を送信した方向と算出した距離を求める。
そしてレーザセンサ4は、所定周期で検知エリアを走査した走査単位の結果を警備装置2に送信する。これにより、警備装置2のレーザセンサ解析モジュール231にて、監視領域Eにおける屋外での物体配置状況や人物の有無、自動車の追跡などが可能となる。本実施の形態では、地上を走行する自動車や人間の進入監視を目的としているため、水平方向に1段での走査としているが、監視目的によっては、鉛直方向にも複数段の走査をするようにしてもよい。
図5に戻って、異常判定モジュール232は、警備モード切替部21からの警備セット/解除信号、建物内センサ5、レーザセンサ4からの信号を受信し、監視領域Eに異常が発生したか否かを判定する。異常判定モジュール232は、警備モード切替部21から警備セット信号を受信すると監視領域Eを警戒する警備セットモードとし、警備解除信号を受信すると監視領域Eを警戒していない警備解除モードに設定する。そして、警備解除モードでは、建物内センサ5やレーザセンサ4からの検知信号を受信しても、特段の処理は行わない。他方、警備セットモードでは、建物内センサ5やレーザセンサ4からの検知信号を受信すると異常発生と判定し、監視センタ通信部26からセンタ装置6に異常通報する。異常通報とともに、ロボ制御モジュール233に対して飛行ロボット3の起動制御を実行する。そして、飛行ロボット通信部25から受信した飛行ロボット3が撮影した画像を監視センタ通信部26からセンタ装置6に送信する処理を異常状態の解除がされるまで継続する。なお、異常状態の解除方法は種々存在するが、本発明との関連性が低いので説明は省略する。
ロボ制御モジュール233は、異常判定モジュール232にて飛行ロボット3の起動信号を受けると、飛行ロボット通信部25から飛行ロボット3の飛行制御を行う。
ここで、図6を参照してロボ制御モジュール233を説明する。図6は、ロボ制御モジュール233の機能ブロック図である。ロボ制御モジュール233は、飛行ロボット3が到達するべき目標位置を決める目標位置設定手段イと、目標位置設定手段イが設定した目標位置に到達するための飛行経路を算出する飛行経路算出手段ロと、飛行経路算出手段ロが算出した飛行経路にて飛行するように飛行ロボット3へ飛行制御信号を生成して送信するロボ制御手段ハと、飛行ロボット3の監視空間マップ241上における現在の位置情報である飛行位置を順次算出する飛行位置算出手段ニから構成されている。目標位置設定手段イの詳細については後述する。
飛行位置算出手段ニは、飛行ロボット3のスキャン手段383が取得したスキャンデータを受信し、このスキャンデータが監視空間マップ241に合致する場所を算出することにより、飛行位置を算出する。なお、飛行ロボット3は、起動を開始するまでは、所定の着陸待機場所に所在しているので、その位置が飛行位置となっている。なお、本実施の形態では、スキャンデータに基づいて現在位置を算出しているが、これに限らず飛行ロボット3にGPS信号の受信機能を設けて、GPS信号に基づいて現在位置を算出してもよい。
図5に戻って、画像処理モジュール234は、飛行ロボット通信部25から受信した飛行ロボット3が撮影した画像を処理する。
画像処理モジュール234は、飛行ロボット3が撮影した画像に人物が写っているか判定する。すなわち、飛行ロボット3が撮影した画像をキャプチャし、キャプチャした画像に対して種々の人物の画像学習した学習識別器を用いて人物の有無を判定する。例えば、開口を形成する窓枠を認識し、その窓枠内に写っている画像に対して、顔及び肩のシルエットについて学習した学習識別器を適用させる。つまり、窓枠内に顔と肩のシルエットに類似するテクスチャを呈する画像が存在すれば人物ありと判定することになる。
制御モード切替モジュール235は、飛行ロボット3の現在の飛行位置、緊急対処員の現在の位置(対処員位置)、および自律飛行モードから他律飛行モードに移行したい旨の移行操作信号を用いて飛行ロボット3の制御モードを切り替える処理を行う。制御モードには、飛行ロボット3の目標位置を自動的に決定する自律飛行モードと、対処員端末6から送信される指示目標位置を飛行ロボット3の目標位置として決定する他律飛行モードがある。各モードにおける目標位置の決定については、目標位置設定手段イの詳細とともに後述する。
図8を参照して、制御モード切替モジュール235を説明する。図8は、制御モード切替モジュール235の機能ブロック図である。まず、到着検知手段ホは、対処員端末6を所持した緊急対処員が監視領域E内に到着したことを検知する。具体的には、対処員端末通信部27から順次受信する端末位置(緯度・経度・高度情報)が監視空間マップ241上に存在するかを判定する。そして、到着検知手段ホは、端末位置が監視空間マップ241上に存在する場合に緊急対処員が監視領域Eに到着したことを検知する。さらに、監視空間マップ241上の対処員端末6の位置を対処員位置として順次算出し、飛行ロボット通信部25を介して飛行ロボット3に順次送信する。
ロボ情報送信手段ヘは、飛行ロボット通信部25から受信した飛行ロボット3が撮影した画像や飛行位置算出手段ニで算出した飛行位置をロボ情報として対処員端末通信部27を介して対処員端末6に送信する。本実施の形態では、ロボ情報送信手段ヘは、到着検知手段ホが緊急対処員の到着を検知したときにロボ情報を対処員端末6に送信する。
視認可否判定手段トは、対処員端末6を所持した緊急対処員から飛行ロボット3が視認可能であるか否かを判定する。具体的には、まず、監視空間マップ241上にて、飛行位置と対処員位置を用いて、両者の監視空間における距離を算出する。そして、両者の監視空間における距離が予め設定した視認可能距離内であれば緊急対処員から飛行ロボット3が視認可能であると判定する。視認可能距離は、監視領域E内に障害物がない場合において緊急対処員は対処員位置の3次元座標を中心として360度を視認できると想定し、その中心から目視可能な距離(例えば、20m)を予め設定すればよい。さらに、監視空間マップ241に含まれる建屋Bの3次元情報や塀の存在などの物理的な制約条件を考慮し、両者間の距離が視認可能距離内であっても飛行位置と対処員位置の間に建物などの障害物が存在する場合には視認可能ではないと判定する。なお、視認可否判定手段トによる視認可否の判定処理は、この方法に限らない。
操作信号検出手段チは、対処員端末通信部27を介して対処員端末6から移行操作信号を受信したか否かを判定する。移行操作信号は、対処員端末6を所持した緊急対処員が自律飛行モードから他律飛行モードへの移行を指示する旨の信号である。なお、移行操作信号の受信だけではなく対処員端末6から指示目標位置を受信したことをもって移行操作信号を受信したとしてもよい。また、操作信号検出手段チは、対処員端末6から、他律飛行モードから自律飛行モードへの移行を指示する旨の操作終了信号を受信すると、その旨を制御モード切替手段リに出力する。
制御モード切替手段リは、到着検知手段ホの検知結果、操作信号検出手段チの判定結果、視認可否判定手段トの判定結果を用いて飛行ロボット3の制御モードを自律飛行モードから他律飛行モードに移行する。具体的には、制御モード切替手段リは、飛行ロボット3が起動すると自律飛行モードの制御モード信号をロボ制御モジュール233および対処員端末6に送信する。そして、到着検知手段ホによって緊急対処員が到着したこと検知され、かつ操作信号検出手段チによって対処員端末6から移行操作信号を受信したことが検出され、かつ視認可否判定手段トによって視認可能であると判定されたとき他律飛行モードの制御モード信号をロボ制御モジュール233および対処員端末6に送信することで飛行ロボット3の制御モードを自律飛行モードから他律飛行モードに移行する。ここで、視認可否判定手段トの判定結果を用いずに、到着検知手段ホにて緊急対処員位置の到着を検知し、かつ操作信号検出手段チによって対処員端末6から移行操作信号を受信したことが検出されたとき他律飛行モードの制御モード信号をロボ制御モジュール233および対処員端末6に送信し、飛行ロボット3の制御モードを自律飛行モードから他律飛行モードに移行するようにしてもよい。また、他律飛行モード中において、対処員端末6から操作終了信号を受信したことが検出されたとき自律飛行モードの制御モード信号をロボ制御モジュール233および対処員端末6に送信し、飛行ロボット3の制御モードを他律飛行モードから自律飛行モードに移行する。
次に、図6に戻って、ロボ制御モジュール233の目標位置設定手段イについて詳細を説明する。目標位置設定手段イは、制御モード切替手段リから受信した制御モード信号を記憶し、制御モードに応じて目標位置の設定処理を変える。
まず、自律飛行モードの制御信号を受信した際の目標位置の設定について説明する。目標位置設定手段イは、自律飛行モードの場合、レーザセンサ4の解析結果や建物内センサ5の検知結果、対処員位置検出手段ホが検出した対処員位置を用いて、飛行ロボット3の目標位置を自動的に設定する。例えば、レーザセンサ解析モジュール231にて自動車を検出した場合、レーザセンサ解析モジュール231が算出した進入物体である自動車の監視空間マップ241上の位置の上方5m程度の高度を目標位置とする。なお、ここで、5m程度というのは、飛行ロボット3が自動車の全体を撮影可能な程度の高さである。また、目標位置設定手段イは、建物内センサ5が侵入者を検出すると、建物内センサ配置情報242を参照して、対応する開口位置を撮影できる位置を目標位置に設定する。例えば、建物内センサ5fが検知すると、開口位置(x1,y1,z1)を監視空間マップ241による建屋Bの壁や塀などの障害物を考慮した上で、極力正面を撮影できる位置を目標位置とする。また、到着検知手段ホにて緊急対処員が監視領域Eに到着したことが検知され、対処員位置が算出されると、順次算出される対処員位置の3次元座標を目標位置として順次設定する。つまり、緊急対処員が監視領域Eに到着すると飛行ロボット3は緊急対処員の存在する位置へ移動する。
次に、他律飛行モードの制御信号を受信した際の目標位置の設定について説明する。目標位置設定手段イは、他律飛行モードの場合、対処員端末6の操作によって目標位置を決定する。具体的には、対処員端末6から受信した指示目標位置の3次元座標を目標位置に設定する。また、対処員端末6から着陸信号を受信すると、予め記憶している着陸待機場所の3次元座標を目標位置として設定する。つまり、対処員端末6を所持している緊急対処員が飛行ロボット3に撮影・監視してほしい位置を対処員端末6を用いて指示し、飛行ロボット3は、その意思に従って移動を行う。
次に、このように構成された監視システム1の動作イメージについて、図4、図9、図10、図11を参照して説明する。図9は、警備セットモード中に、賊が自動車9を使って、建屋Bに侵入したときの様子を示している。まず、図9(a)のように、自動車9が進入してくると、レーザセンサ4の信号に基づき、警備装置2にて異常を検出する。警備装置2は、異常の発生に伴ってセンタ装置7に異常通報するとともに、飛行ロボット3の制御を開始する。また、賊は自動車9から降りた後にセンサ5fの設置されている窓から建物B内に侵入しており、このタイミングでセンサ5fが検知する。ここで、飛行ロボット3は、自律飛行モードで制御されているので、着陸待機場所から自動車9の位置まで飛行し、自動車9の上空の高高度位置で自動車9を撮影する。その後、図9(b)のように、建物内センサ5fの検知結果に基づいて、賊が侵入した場所を撮影している。
図10は、異常通報を受けた監視センタから監視領域Eへの対処指示を受けて急行した対処員端末6を所持する緊急対処員8が監視領域Eに現れたときの様子を示している。まず、図10(a)のように、緊急対処員8が監視領域E内に到着すると、対処員端末6の端末位置に基づいて、警備装置2にて対処員位置を検出する。警備装置2は、緊急対処員8の到着に伴って、対処員端末6にロボ情報を順次送信する。そして、緊急対処員8は、飛行ロボット3と協働して監視を行うために、対処員端末6を操作し、移行操作信号を警備装置2に送信するとともに、対処員端末6に表示されたロボ情報を参照して飛行ロボット3の存在する位置に移動を開始する。また、警備装置2は、緊急対処員8の到着に伴って、対処員位置を飛行ロボット3の目標位置として設定することで飛行ロボット3を緊急対処員8の存在する位置へ移動させる。その後、図10(b)のように飛行ロボット3のいる方向に移動した緊急対処員8と、緊急対処員8のいる方向に移動した飛行ロボット3との位置関係が変わり、緊急対処員8から飛行ロボット3を視認できる位置になると、警備装置2は、緊急対処員8と飛行ロボット3が協働して監視を行えるように自律飛行モードから他律飛行モードに飛行ロボット3の制御モードを移行する。
図11は、飛行ロボット3の制御モードが他律飛行モードに移行した後、緊急対処員8と飛行ロボット3が協働して監視領域Eを監視している様子を示している。緊急対処員8は、図4のように表示された対処員端末6の表示部64を参照し、操作部65を操作し、飛行ロボットに撮像・監視させたい位置を指示目標位置として指定する。その結果、飛行ロボット3は、警備装置2によって指示目標位置の3次元座標が目標位置として設定されたので、図11のように対処員端末6にて指定された位置に移動し、監視領域Eの撮影を行う。一方、飛行ロボット3に移動の指示を出した緊急対処員8は、飛行ロボット3が向かった位置とは反対側の建物B付近を監視する。また、図示しないが、このとき、対処員端末6の表示部64には、飛行ロボット3が向かった位置にて撮像された画像が表示されており、その画像を確認することで緊急対処員は建物Bによって死角になる位置も同時に監視することができる。また、建物B内に侵入した賊が逃走する可能性のある開口部を緊急対処員8と飛行ロボット3によって監視することができるため、賊を挟みうちにすることが可能になる。
次に、警備装置2による飛行ロボット3の制御のための処理について、図12、図13、図14を参照して説明する。まず、図12は、制御モードを切り替える処理のフローである。本フローは、レーザセンサ4または建物内センサ5の検出信号に基づき、警備装置2にて異常を検出したことで開始する。異常を検知すると、警備装置2は、飛行ロボット3を起動するとともに、制御モードを自律飛行モードに設定する。(S100、S101)
その後、到着検知手段ホは、端末位置が監視空間マップ241上に存在するか否かを判定し、存在する場合には緊急対処員が到着したと検知する。到着を検知すると、到着検知手段ホは、順次算出した対処員位置を飛行ロボット3の目標位置として順次設定し、飛行ロボット3に対処員位置の通知を開始する。また、ロボ情報送信手段ヘは、対処員端末6に、ロボ情報として飛行ロボットが撮影した画像と飛行位置算出手段ニにて順次算出した飛行位置の通知を開始する。なお、飛行ロボット3への対処員位置の通知および対処員端末6へのロボ情報の通知は、監視領域Eの異常状態がクリアするまで継続される。(S102、S103、S104)
視認可否判定手段トは、飛行位置と対処員位置と監視空間マップ241を用いて、緊急対処員から飛行ロボット3が視認可能な位置になったか否かを判定し、視認可能な位置になったと判定するとS106に進む。(S105)
その後、操作信号検出手段チは、視認可能な位置において、対処員端末6から制御モードを他律飛行モードに移行する旨の移行操作信号を受信したか否かを判定する。受信していた場合、制御モード切替手段リは、制御モードを自律飛行モードから他律飛行モードに移行する。S102、S105、S106にて、緊急対処員の到着を検知したこと、視認可能な位置になったこと、移行操作信号を受信したこと、これらの条件を合わせて満たした場合に制御モード切替手段リは、制御モードを自律飛行モードから他律飛行モードに移行する。このため、S102、S105、S106にて、それぞれ条件を満たさない場合(NOの場合)は、S102へ戻り、条件を満たすまで処理を繰り返す。このとき一度S103およびS104にて通知処理が開始されている場合、S103、S104は省略される。これにより、緊急対処員が飛行ロボット3を目視にて確認でき、緊急対処員の意思がない限り安易に他律飛行モードに移行できないようにできる。(S106、S107)
他律飛行モード中において、対処員端末6から他律飛行モードから自律飛行モードへ移行する旨の操作終了信号を受信すると、S101に戻り、制御モード切替手段リは、制御モードを他律飛行モードから自律飛行モードに移行する。これにより、他律飛行モードから自律飛行モードへの移行は、自律飛行モードから他律飛行モードへの移行に比べて容易に行うことができる。なお、本実施の形態では、自律飛行モードから他律飛行モードへの移行の条件として、S105にある緊急対処員が飛行ロボット3を視認可能な位置に所在していることとしたが、いち早く自律飛行モードから他律飛行モードに移行させたい場合は、かかる条件を削除して緩和してもよい。(S108)
次に図13を参照して、自律飛行モードにおける飛行ロボット3の制御のための処理を説明する。図13は、自律飛行モード中の飛行制御フローである。本フローは、自律飛行モードに設定されることで開始する。まず、自律飛行モードへの移行が他律飛行モードから移行されたものである(飛行ロボット3の起動時に自律飛行モードに設定されたものではない)場合には、後述するS210にてYESだった場合と同様にS202に進み、対処員位置を目標位置として設定してS203以降の処理を行う。飛行ロボット3の起動時に自律飛行モードに設定されたものであれば、S201に進みレーザセンサ4の検知結果を取得する。(S200、S201)
S201からS202へ進んだ場合、例えば、目標位置設定手段イは、レーザセンサ解析モジュール231が解析した自動車9の重心位置である現在位置から3.5m離れた高高度(例えば高度5m)の位置を監視空間マップ241上の位置として目標位置に設定する。(S202)
次に、レーザセンサ解析モジュール231は、レーザセンサ4からの信号に基づいて自動車9の位置を追跡する。(S203)
そして、飛行経路算出手段ロは、ステップS202にて設定された目標位置、飛行ロボット3の飛行位置、監視空間マップ241を用いて、経路探索アルゴリズムにより、飛行経路を計算する。経路探索アルゴリズムは、飛行位置と目標位置を設定すれば、監視空間マップ241の配置状況および飛行ロボット3の大きさ等を考慮して、安全にかつ最短で到着できる経路を算出する(S204)。
そして、追跡の結果、例えば、自動車9が移動しているか否かを判定し、追跡対象である自動車9が移動していれば、目標位置を自動車9の移動に合わせて変更設定し、S204と同様に飛行経路を再度算出する。(S205、S206)
自動車9が移動していない場合、ロボ制御手段ハは、飛行ロボット3が飛行経路算出手段ロの算出した経路を飛行できるように、飛行ロボット3の飛行制御信号を算出する。具体的な飛行制御信号は、飛行ロボット3にある4つのロータ32のそれぞれの回転数である。そして、飛行ロボット通信部25から無線信号にて飛行制御信号を送信する。飛行ロボット3は、アンテナ31から飛行制御信号を受信すると、受信した飛行制御信号に基づいて飛行する。具体的には、アンテナ31から受信した飛行制御信号が飛行制御手段384に入力され、ロータ駆動部33から各ロータ32の回転数を個別に制御して飛行する。(S207)
飛行が開始された後は、これらのステップS205〜ステップS207を繰り返し処理して、自動車9を追跡しつつ撮影を行う。飛行ロボット3が目標位置に到着すると、ロボ制御手段ハは、飛行ロボット3が目標位置にて待機飛行を行えるよう、飛行ロボット3の飛行制御信号を算出し、飛行ロボット3に送信する。飛行ロボット3は、アンテナ31から待機飛行に関する飛行制御信号を受信すると、受信した飛行制御信号に基づいて待機飛行する。(S208、S209)
ここで、図13に示すフローに記載しなかったが、飛行ロボット3が最初に飛行制御信号を受信すると、カメラ制御手段382がカメラ36を起動させて、警備装置2への撮影画像の送信を開始する。また、スキャン手段383が測距センサ35、高度センサ34を起動し、警備装置2にスキャンデータの送信を開始する。
その後、S210では、目標位置設定手段イは、到着検知手段ホにて算出された対処員位置の入力があるか否かを判定し、入力がある場合は、対処員位置をS202にて目標位置として設定し、S203にて対処員位置を追跡対象として追跡し、対処員位置を目標位置としてS204からS208を実行する。対処員位置の入力がない場合は、新たにセンサの検知があったかを確認し、新たなセンサの検知がない場合にはS209の待機飛行を継続する。新たにセンサの検知があった場合は、S201にて、その検知情報を取得し、検知情報に基づいて目標位置を設定し、その設定された目標位置についてS203からS208を実行する。例えば、新たに検知したセンサが建物内センサ5fであった場合を例に説明すると、建物内センサ配置情報242から検知した建物内センサ5fに対応する開口位置を目標位置として設定する。この場合の目標位置は、開口位置から3m程度手前側、且つ高度が「z2」となる監視空間マップ241上の位置を目標位置に設定する。なお、これらの値は、例示であり、カメラ36の性能や搭載パラメータ、塀との距離など監視空間マップ241上の制約条件を考慮して設定される。また、開口位置は、自動車のように移動することがないのでS203、S205、S206の追跡に関する処理は実行しないようにしてもよい。(S210,S211)
また、S211にて画像処理モジュール234にて賊を撮影できたことを認識した場合に新たなセンサが検知したとしてもよい。詳細には説明しないが、この場合、自動車9を追跡する例で説明したように、S201およびS202にてレーザセンサ解析モジュール231が捉えた賊の位置を目標位置として設定し、S203にて賊を追跡対象として追跡するようにすればよい。この場合、S208にて目標位置に到着し、賊の撮影が終われば、賊を俯瞰的に撮影する位置に移動してS209にて待機飛行するようにもよい。
本実施の形態では、警備装置2の警備制御部23にて、飛行ロボット3をコントロールするようにしたが、警備装置2機能の全部または一部を適宜に飛行ロボット3に搭載するようにしてもよい。
図13のフローは、制御モードが他律飛行モードに移行すれば終了し、他律飛行モードに移行した後は、図14のフローに従って処理を行う。
次に、図14を参照して、他律飛行モードにおける飛行ロボット3の制御のための処理を説明する。図14は、他律飛行モード中の飛行制御フローである。本フローは、他律飛行モードに設定されることで開始する。まず、ロボ制御手段ハは、飛行ロボット3が他律飛行モードに移行した位置で待機飛行が行えるよう、飛行ロボット3の飛行制御信号を算出し、飛行ロボット3に送信する。飛行ロボット3は、アンテナ31から待機飛行に関する飛行制御信号を受信すると、受信した飛行制御信号に基づいて待機飛行する。(S300)
その後、対処員端末6からの指示目標位置を受信するまで待機飛行を継続する。対処員端末6からの指示目標位置を受信すると、目標位置設定手段イは、その指示目標位置を目標位置として設定する。ここで、指示目標位置の座標をそのまま目標位置として設定してもよいが、指示目標位置の座標から1m程度手前側となる監視空間マップ241上の位置を目標位置として設定してもよい。なお、これらの値は、例示であり、カメラ36の性能や搭載パラメータ、塀との距離など監視空間マップ241上の制約条件を考慮して設定される。(S301、S302)
その後、飛行経路算出手段ロは、ステップS301にて設定された目標位置、飛行ロボット3の飛行位置、監視空間マップ241を用いて、経路探索アルゴリズムにより、飛行経路を計算する。経路探索アルゴリズムは、飛行位置と目標位置を設定すれば、監視空間マップ241の配置状況および飛行ロボット3の大きさ等を考慮して、安全にかつ最短で到着できる経路を算出する(S303)。
そして、ロボ制御手段ハは、飛行ロボット3が飛行経路算出手段ロの算出した経路を飛行できるように、飛行ロボット3の飛行制御信号を算出する。具体的な飛行制御は図13のS206で説明したものと同様である。(S304)
その後、飛行ロボット3が目標位置に到着すると、対処員端末6から着陸信号を受信するまでS300からS307を繰り返す。飛行ロボット3が目標位置に到着していない場合は、新たな指示目標位置を受信していないかを確認し、受信していた場合は、その指示目標位置をS302にて設定し、受信していない場合は、飛行ロボット3が目標位置に到着するまでS304の飛行制御を継続し、S305以下を繰り返し実行する。対処員端末6から着陸信号を受信すると、予め記憶されている着陸待機場所の座標を指示目標位置とし、その指示目標位置を目標位置として設定し、飛行経路算出手段ロによって着陸待機場所までの飛行経路を算出し、ロボ制御手段ハは、飛行ロボット3が飛行経路算出手段ロの算出した経路を飛行できるように、飛行ロボット3の飛行制御信号を算出し、飛行ロボット3を着陸飛行させる。飛行ロボットが着陸待機場所に到着すると、ロボ制御手段ハは、飛行ロボット3を停止して、本フローを終了する。(S305、S306、S307、S308)