(19)【発行国】日本国特許庁(JP)
(12)【公報種別】特許公報(B2)
(11)【特許番号】
(24)【登録日】2024-09-24
(45)【発行日】2024-10-02
(54)【発明の名称】装置、方法及びプログラム
(51)【国際特許分類】
G01C 21/20 20060101AFI20240925BHJP
G08G 5/00 20060101ALI20240925BHJP
G01S 19/45 20100101ALI20240925BHJP
【FI】
G01C21/20
G08G5/00 A
G01S19/45
(21)【出願番号】P 2023026661
(22)【出願日】2023-02-22
(62)【分割の表示】P 2022004617の分割
【原出願日】2015-09-16
【審査請求日】2023-03-06
(31)【優先権主張番号】P 2014212311
(32)【優先日】2014-10-17
(33)【優先権主張国・地域又は機関】JP
(73)【特許権者】
【識別番号】000002185
【氏名又は名称】ソニーグループ株式会社
(74)【代理人】
【識別番号】110002147
【氏名又は名称】弁理士法人酒井国際特許事務所
(72)【発明者】
【氏名】佐部 浩太郎
(72)【発明者】
【氏名】武田 晴登
(72)【発明者】
【氏名】ドゥール ペーター
(72)【発明者】
【氏名】清水 悟
(72)【発明者】
【氏名】澤田 務
(72)【発明者】
【氏名】鈴木 康輔
【審査官】高島 壮基
(56)【参考文献】
【文献】特開2001-091635(JP,A)
【文献】中国特許出願公開第103697889(CN,A)
(58)【調査した分野】(Int.Cl.,DB名)
G01C 21/00-21/36
G01S 19/45
G08G 1/00-99/00
(57)【特許請求の範囲】
【請求項1】
GPS(Global Positioning System)信号を受信するGPS信号受信機と、
飛行体の気圧計により測定した気圧に対応する高度を推定する推定部と、
前記GPS信号受信機が受信したGPS信号と、前記推定部が推定した高度に基づいて、
前記飛行体の位置が所定の位置条件を満たす場合に、前記GPS信号受信機が受信したGPS信号に基づく第1位置推定方式、及び、前記推定部が推定した高度に基づく第2位置推定方式の中からいずれか一方の位置推定方式に基づいて、前記飛行体の位置を推定する位置推定部と、
を備え、
前記位置推定部は、
前記GPS信号受信機が受信したGPS信号に基づく第1位置推定方式に基づいて推定された前記飛行体の位置と、前記推定部が推定した高度に基づく第2位置推定方式に基づいて推定された前記飛行体の位置との平均に基づいて、前記飛行体の位置を推定する、
装置。
【請求項2】
前記位置推定部は、
前記GPS信号受信機が受信したGPS信号に基づいて推定された前記飛行体の位置と前記GPS信号受信機が受信したGPS信号に基づく第1位置推定方式に対応する重みとを乗算した重み付きの位置と、前記推定部が推定した高度に基づいて推定された前記飛行体の位置と前記推定部が推定した高度に基づく第2位置推定方式に対応する重みとを乗算した重み付きの位置との和に基づいて、前記飛行体の位置を推定する、
請求項1に記載の装置。
【請求項3】
前記第1位置推定方式に対応する重みおよび前記第2位置推定方式に対応する重みは、それぞれの位置推定方式の信頼度に応じた値である、
請求項2に記載の装置。
【請求項4】
前記位置推定部は、
前記飛行体の位置が、GPS衛星の捕捉状況が所定の条件を満たすエリアとGPS衛星の捕捉状況が前記所定の条件を満たさないエリアとの境界から所定の範囲内である所定の切替え位置になった場合に、前記第1及び第2位置推定方式の中からいずれか一方の位置推定方式に基づいて、前記飛行体の位置を推定する、
請求項1に記載の装置。
【請求項5】
前記位置推定部は、
前記飛行体の位置が、GPS衛星の捕捉状況が所定の条件を満たすエリアから所定の切替え位置になった場合には、前記第1及び第2位置推定方式の中から前記第2位置推定方式に基づいて、前記飛行体の位置を推定し、
前記飛行体の位置が、GPS衛星の捕捉状況が所定の条件を満たさないエリアから前記所定の切替え位置になった場合には、前記第1及び第2位置推定方式の中から前記第1位置推定方式に基づいて、前記飛行体の位置を推定する、
請求項1に記載の装置。
【請求項6】
前記装置は、前記飛行体、又は前記飛行体のためのモジュールである、請求項1に記載の装置。
【請求項7】
プロセッサにより、
GPS(Global Positioning System)信号を受信することと、
飛行体の気圧計により測定した気圧に対応する高度を推定することと、
前記受信したGPS信号と、前記推定した高度に基づいて、
前記飛行体の位置が所定の位置条件を満たす場合に、前記受信したGPS信号に基づく第1位置推定方式、及び、前記推定した高度に基づく第2位置推定方式の中からいずれか一方の位置推定方式に基づいて、前記飛行体の位置を推定することと、
を含み、
前記受信したGPS信号に基づく第1位置推定方式に基づいて推定された前記飛行体の位置と、前記推定した高度に基づく第2位置推定方式に基づいて推定された前記飛行体の位置との平均に基づいて、前記飛行体の位置を推定する、
方法。
【請求項8】
GPS(Global Positioning System)信号を受信することと、
飛行体の気圧計により測定した気圧に対応する高度を推定することと、
前記受信したGPS信号と、前記推定した高度に基づいて、
前記飛行体の位置が所定の位置条件を満たす場合に、前記受信したGPS信号に基づく第1位置推定方式、及び、前記推定した高度に基づく第2位置推定方式の中からいずれか一方の位置推定方式に基づいて、前記飛行体の位置を推定することと、
をプロセッサに実行させ、
前記受信したGPS信号に基づく第1位置推定方式に基づいて推定された前記飛行体の位置と、前記推定した高度に基づく第2位置推定方式に基づいて推定された前記飛行体の位置との平均に基づいて、前記飛行体の位置を推定する、
プログラム。
【発明の詳細な説明】
【技術分野】
【0001】
本開示は、装置、方法及びプログラムに関する。
【背景技術】
【0002】
航空旅客機では、高精度な慣性センサとGPS(Global Positioning System)受信機との組合せを用いた姿勢推定及び位置推定などにより、自動飛行などの機能が実現されている。近年、慣性センサの小型化及び低価格化が進み、その結果、小型の飛行体にも慣性センサ及びGPS受信機が搭載され、位置推定及び姿勢推定などが行われている。
【0003】
例えば、特許文献1には、GPS受信機及び慣性センサとの組合せを用いて移動体の静止を判定する技術が、開示されている。
【先行技術文献】
【特許文献】
【0004】
【発明の概要】
【発明が解決しようとする課題】
【0005】
しかし、航空旅客機とは異なり、小型の飛行体は、GPS受信機を用いた位置推定が困難な場所で飛行し得る。一般的に小型の飛行体の慣性センサは精度が低いので、GPS受信機を用いた位置推定が困難になると、飛行体の位置が適切に推定されなくなる。その結果、飛行体を望み通りに飛行させることができなくなり得る。
【0006】
そこで、飛行体の位置をより良好に推定することを可能にする仕組みが提供されることが望ましい。
【課題を解決するための手段】
【0007】
本開示によれば、GPS(Global Positioning System)信号を受信するGPS信号受信機と、飛行体の気圧計により測定した気圧に対応する高度を推定する推定部と、前記GPS信号受信機が受信したGPS信号と、前記推定部が推定した高度に基づいて、前記飛行体の位置を推定する位置推定部と、を備え、前記位置推定部は、前記GPS信号受信機が受信したGPS信号に基づく第1位置推定方式と、前記推定部が推定した高度に基づく第2位置推定方式とのいずれか一方の位置推定方式に基づいて、前記飛行体の位置を推定する、装置が提供される。
【0008】
また、本開示によれば、プロセッサにより、GPS(Global Positioning System)信号を受信することと、飛行体の気圧計により測定した気圧に対応する高度を推定することと、前記受信したGPS信号と、前記推定した高度に基づいて、前記飛行体の位置を推定することと、を含み、前記受信したGPS信号に基づく第1位置推定方式と、前記推定した高度に基づく第2位置推定方式とのいずれか一方の位置推定方式に基づいて、前記飛行体の位置を推定する、方法が提供される。
【0009】
また、本開示によれば、GPS(Global Positioning System)信号を受信することと、飛行体の気圧計により測定した気圧に対応する高度を推定することと、前記受信したGPS信号と、前記推定した高度に基づいて、前記飛行体の位置を推定することと、をプロセッサに実行させ、前記受信したGPS信号に基づく第1位置推定方式と、前記推定した高度に基づく第2位置推定方式とのいずれか一方の位置推定方式に基づいて、前記飛行体の位置を推定する、ためのプログラムが提供される。
【発明の効果】
【0010】
以上説明したように本開示によれば、飛行体の位置をより良好に推定することが可能になる。なお、上記の効果は必ずしも限定的なものではなく、上記効果とともに、又は上記効果に代えて、本明細書に示されたいずれかの効果、又は本明細書から把握され得る他の効果が奏されてもよい。
【図面の簡単な説明】
【0011】
【
図1】ジャイロセンサと加速度センサとの組合せを用いた姿勢推定の第1の例を説明するための説明図である。
【
図2】ジャイロセンサと加速度センサとの組合せを用いた姿勢推定の第2の例を説明するための説明図である。
【
図3】慣性センサと他のセンサとの組合せを用いた位置推定の一例を説明するための説明図である。
【
図4】本開示の実施形態に係るシステムの概略的な構成の一例を示す説明図である。
【
図5】同実施形態に係る飛行体の構成の一例を示すブロック図である。
【
図6】ジンバルを用いて飛行体に設置された単眼の撮像装置による撮像の第1の例を説明するための説明図である。
【
図7】ジンバルを用いて飛行体に設置された単眼の撮像装置による撮像の第2の例を説明するための説明図である。
【
図8】マーカの配置の例を説明するための説明図である。
【
図9】モーションキャプチャが用いられるケースの一例を説明するための説明図である。
【
図10】各位置推定方式の特徴を説明するための説明図である。
【
図11】時間遅れパラメータに従った位置推定の例を説明するための説明図である。
【
図12】時間遅れパラメータなしでの位置推定の結果の一例を説明するための説明図である。
【
図13】時間遅れパラメータに従った位置推定の結果の一例を説明するための説明図である。
【
図14】位置推定方式の選択(切替え)の第1の例を説明するための説明図である。
【
図15】位置推定方式の選択(切替え)の第2の例を説明するための説明図である。
【
図16】位置推定方式の選択(切替え)の第2の例を説明するための説明図である。
【
図17】同実施形態に係る位置推定処理の概略的な流れの一例を示すフローチャートである。
【
図18】同実施形態に係る第1の選択処理の概略的な流れの一例を示すフローチャートである。
【
図19】同実施形態に係る第2の選択処理の概略的な流れの一例を示すフローチャートである。
【発明を実施するための形態】
【0012】
以下に添付の図面を参照しながら、本開示の好適な実施の形態について詳細に説明する。なお、本明細書及び図面において、実質的に同一の機能構成を有する構成要素については、同一の符号を付することにより重複説明を省略する。
【0013】
また、本明細書及び図面において、実質的に同一の機能構成を有する要素を、同一の符号の後に異なるアルファベットを付して区別する場合もある。例えば、実質的に同一の機能構成を有する複数の要素を、必要に応じてモータ120A、120B及び120Cのように区別する。ただし、実質的に同一の機能構成を有する複数の要素の各々を特に区別する必要がない場合、同一符号のみを付する。例えば、モータ120A、120B及び120Cを特に区別する必要が無い場合には、単にモータ120と称する。
【0014】
なお、説明は以下の順序で行うものとする。
1.基本的な姿勢推定及び位置推定
2.システムの概略的な構成
3.飛行体の構成
4.本実施形態に係る位置推定
5.処理の流れ
6.まとめ
【0015】
<1.基本的な姿勢推定及び位置推定>
まず、
図1~
図3を参照して、基本的な姿勢推定及び位置推定の例を説明する。
【0016】
(1)慣性センサ
例えば、飛行体の慣性センサは、当該飛行体の角速度を検出するジャイロセンサ(又は角速度センサ)と、当該飛行体の加速度を測定する加速度センサを含む。上記慣性センサは、デジタルコンパス(又は地磁気センサ)をさらに含み得る。
【0017】
(2)姿勢推定
(a)角速度からの推定
例えば、飛行体の姿勢の変化は、ジャイロセンサにより検出される角速度を積分することにより算出される。そのため、飛行体の姿勢の初期値と、当該飛行体の姿勢の変化とから、当該飛行体の姿勢が算出される。
【0018】
ジャイロセンサにより検出される角速度は、短期的には高い信頼性を有するが、時間とともに緩やかに変化するドリフト特性を有する。そのため、ジャイロセンサにより検出される角速度(及び初期値)のみから姿勢を算出する場合には、当該姿勢には、時間とともに誤差が蓄積される。
【0019】
(b)加速度からの推定
例えば、飛行体がホバリングしており移動していないと仮定すると、加速度センサにより検出される重力方向から、上記飛行体の姿勢を算出することができる。
【0020】
加速度センサにより検出される加速度は、振動などの影響により高周波のノイズを含む。しかし、重力方向は時間によらず常に同じであるので、加速度センサは、長期的には高い信頼性を有する。
【0021】
(c)センサフュージョン
上述したジャイロセンサの特性と加速度センサの特性とを利用して相補フィルタを構成することにより、信頼性の高い姿勢を算出することが可能である。このように複数のセンサを組み合わせることは、センサフュージョンと呼ばれ得る。以下、
図1及び
図2を参照して具合例を説明する。
【0022】
図1は、ジャイロセンサと加速度センサとの組合せを用いた姿勢推定の第1の例を説明するための説明図である。
図1を参照すると、加速度センサにより検出される加速度から、姿勢y1(t)が算出され、ジャイロセンサにより検出される角速度から、姿勢y2(t)が算出される。y1(t)は、x(t)+n1(t)で表され、y2(t)は、x(t)+n2(t)で表される。x(t)は、飛行体の実際の姿勢であり、n1(t)は、加速度センサに起因する高周波のノイズであり、n2(t)は、ジャイロセンサに起因する低周波のノイズである。姿勢y1(t)は高周波のノイズn1(t)を含むので、姿勢y1(t)をローパスフィルタ11に通すことにより、姿勢y1(t)から高周波のノイズn1(t)がカットされる。一方、姿勢y2(t)は低周波のノイズn2(t)を含むので、姿勢y2(t)をハイパスフィルタ13に通すことにより、姿勢y2(t)から低周波のノイズn2(t)がカットされる。例えば、ローパスフィルタ11及びハイパスフィルタ13は、相補的なフィルタである。そのため、以下のように、ローパスフィルタ11の出力値とハイパスフィルタ13の出力値を足し合わせることにより、ノイズのない元の信号が得られる。
【0023】
【0024】
図2は、ジャイロセンサと加速度センサとの組合せを用いた姿勢推定の第2の例を説明するための説明図である。
図2を参照すると、
図1の例と同様に、加速度センサにより検出される加速度から、姿勢y1(t)が算出され、ジャイロセンサにより検出される角速度から、姿勢y2(t)が算出される。とりわけこの例では、ハイパスフィルタ13を使用する代わりに、姿勢y1(t)から姿勢y2(t)が差し引かれ、その結果として得られる差分(即ち、n1(t)-n2(t))が、ローパスフィルタ11に通される。その結果、低周波のノイズn2(t)のマイナス値が出力される。そして、以下のように、姿勢y2(t)から低周波のノイズn2(t)が差し引かれ、その結果、ノイズのない元の信号が得られる。
【0025】
【0026】
なお、このようにハイパスフィルタ13を用いないことにより、ハイパスフィルタ13での遅延をなくすことが可能になる。
【0027】
(3)位置推定
(a)慣性センサを用いた位置推定
上述したように算出される姿勢に基づいて、加速度センサにより検出される加速度(即ち、加速度センサの座標系の加速度)が、地上座標系の加速度(例えば、地面からの加速度)に変換される。
【0028】
さらに、変換後の加速度を積分することにより、上記飛行体の速度の変化が算出される。そのため、上記飛行体の速度の初期値と、上記飛行体の速度の変化とから、上記飛行体の速度が算出される。
【0029】
さらに、上記速度を積分することにより、上記飛行体の位置の変化が算出される。そのため、上記飛行体の位置の初期値と、上記飛行体の位置の変化とから、上記飛行体の位置が算出される。
【0030】
加速度センサにより検出される加速度はノイズを含む。そのため、当該加速度から算出される上記飛行体の位置には、時間とともに誤差が蓄積される。
【0031】
(b)センサフュージョン
上述したような誤差の蓄積を回避するために、慣性センサと他のセンサとの組合せを用いたより信頼性の高い位置推定が実現される。例えば、慣性センサとGPS受信機との組合せを用いた位置推定が実現される。以下、
図3を参照して具合例を説明する。
【0032】
図3は、慣性センサと他のセンサとの組合せを用いた位置推定の一例を説明するための説明図である。
図3を参照すると、加速度センサにより検出される加速度の変換により、地上座標系の加速度aが得られる。加速度aは、部分21において補正され、部分23において積分され、その結果、速度の変化が算出される。既に算出された速度vは、部分21において補正され、部分23において上記変化が加えられる。その結果、更新後の速度vUが得られる。また、更新後の速度vUは、部分23において積分され、その結果、位置の変化が算出される。既に算出された位置pは、部分21において補正され、部分23において上記変化が加えられる。その結果、更新後の位置pUが得られる。さらに、他のセンサ(例えば、GPS受信機)を用いて生成された位置pxと、更新後の位置pUとの差分(例えば、px-pU)が誤差eとして算出され、当該誤差eが、フィルタ25に通される。その結果、加速度の補正値△a、速度の補正値△v、及び位置の補正値△pが出力される。そして、これらの補正値が、部分21における補正に使用される。このように、他のセンサ(例えば、GPS受信機)により慣性センサが補完される。
【0033】
なお、フィルタ25における処理は、以下のように表される。
【0034】
【0035】
△at、△vt及び△ptは、更新後の補正値であり、△at-1、△vt-1及び△pt-1は、更新前の補正値である。k1、k2及びk3は、フィルタ25の時定数Tcを用いて以下のように表される。
【0036】
【0037】
<2.システムの概略的な構成>
次に、
図4を参照して、本開示の実施形態に係るシステム1の概略的な構成を説明する。
図4は、本開示の実施形態に係るシステム1の概略的な構成の一例を示す説明図である。
図4を参照すると、システム1は、飛行体100、制御装置200及び操縦装置300を含む。
【0038】
(1)飛行体100
飛行体100は、飛行することが可能な装置である。例えば、飛行体100は、複数のロータ(例えば、4つのロータ)により飛行することが可能である。例えば、飛行体100は、各ロータの回転を制御することで、静止ホバリング、移動(上昇、下降、水平移動、及び斜め方向への移動など)及び回転などを行う。なお、飛行体100は、ロータではなく他の機構により飛行することが可能な装置であってもよい。
【0039】
例えば、飛行体100は、飛行体100の姿勢及び位置を自ら推定し、当該姿勢及び当該位置に基づいて飛行を制御することが可能である。例えば、飛行体100は、指定された飛行経路に基づいて自動で飛行する。
【0040】
例えば、飛行体100は、他の装置(例えば、制御装置200)と通信する。飛行体100は、他の装置と直接的に無線通信を行ってもよく、中継ノードとの無線通信を行うことにより、当該中継ノードを介して他の装置と通信してもよい。
【0041】
例えば、飛行体100は、撮像装置を備え、当該撮像装置を用いて飛行中に撮像を行う。飛行体100は、当該撮像により生成される撮像画像を保存してもよく、制御装置200などの他の装置へ送信してもよい。当該撮像画像は、静止画像であってもよく、動画像であってもよい。
【0042】
(2)制御装置200
制御装置200は、飛行体100の飛行に関する制御を実行する装置である。例えば、当該制御は、飛行体100のための飛行情報(例えば、飛行経路を示す情報など)の生成及び提供、並びに/又は、飛行体100への指示(例えば、離陸指示及び/若しくは帰還指示など)などを含む。
【0043】
例えば、制御装置200は、飛行体100と通信する。制御装置200は、飛行体100と直接的に無線通信を行ってもよく、中継ノードを介して飛行体100と通信してもよい。
【0044】
例えば、制御装置200は、飛行体100による撮像により生成される撮像画像を取得し、必要に応じて表示する。当該撮像画像は、動画像であってもよく、制御装置200は、当該動画像をストリーミングで取得し、表示してもよい。
【0045】
一例として、制御装置200は、ノート型コンピュータ又はタブレット端末などの持ち運び可能な装置である。なお、当然ながら、制御装置200は、この例に限定されず、他の種類の装置であってもよい。
【0046】
(3)操縦装置300
操縦装置300は、ユーザが飛行体100を操縦することを可能にする装置である。一例として、操縦装置300は、プロポーショナルシステム(又はプロポ)である。
【0047】
例えば、操縦装置300は、制御装置200に接続される。操縦装置300は、ユーザによる操作に応じて、飛行体の動作に関する制御情報を生成し、当該制御情報を制御装置200へ送信する。制御装置200は、当該制御情報を飛行体100へ送信してもよく、当該制御情報から別の制御情報を生成して当該別の制御情報を飛行体100へ送信してもよい。
【0048】
<3.飛行体の構成>
次に、
図5を参照して、本開示の実施形態に係る飛行体100の構成の一例を説明する。
図5は、本開示の実施形態に係る飛行体100の構成の一例を示すブロック図である。
図5参照すると、飛行体100は、ロータ110、モータ120、センサ部130、撮像部140、記憶部150、無線通信部160、処理部170及びバッテリ190を備える。
【0049】
(1)ロータ110及びモータ120
ロータ110A~110Dは、回転により揚力を生じさせることにより、飛行体100を飛行させる。
【0050】
(2)モータ120
モータ120A~120Dは、処理部170(制御部181)による制御に応じて、ロータ110A~110Dを回転させる。例えば、モータ120は、処理部170(制御部181)による制御に応じて、ロータ110の回転数を変化させる。
【0051】
(2)センサ部130
センサ部130は、1つ以上のセンサを含む。例えば、センサ部130は、慣性センサ131、GPS受信機133、気圧計135及び超音波センサ137を含む。
【0052】
例えば、慣性センサ131は、加速度センサ及びジャイロセンサを含む。慣性センサ131は、地磁気センサをさらに含んでもよい。
【0053】
なお、センサ部130に含まれるセンサは、これらの例に限られない。センサ部130は、上述したセンサのうちの1つ以上のセンサ(慣性センサ131を除く)を含まなくてもよい。また、センサ部130は、他のセンサを含んでもよい。
【0054】
(3)撮像部140
撮像部140は、撮像を行い、撮像画像を生成する。当該撮像画像は、静止画像であってもよく、動画像であってもよい。上記撮像画像は、記憶部150に保存されてもよく、無線通信部160を介して他の装置へ送信されてもよい。
【0055】
撮像部140は、1つ以上の撮像装置を含む。当該1つ以上の撮像装置の各々は、レンズ及びイメージセンサなどを含む。上記1つ以上の撮像装置は、赤外線撮像装置及び/又は全方位撮像装置を含んでもよい。
【0056】
(4)記憶部150
記憶部150は、様々な情報を記憶する。記憶部150は、飛行体100の動作のためのプログラム、及び/又は各種データを記憶する。
【0057】
例えば、記憶部150は、不揮発性メモリ(例えば、メモリカードなど)を含む。記憶部150は、不揮発性メモリの代わりに、又は不揮発性メモリとともに、磁気記憶装置(例えば、ハードディスクドライブ)を含んでもよい。
【0058】
(5)無線通信部160
無線通信部160は、無線通信を行う。無線通信部160は、他の装置(例えば、制御装置200)と直接的に無線通信を行ってもよく、他の装置との通信のために、中継ノードとの無線通信を行ってもよい。
【0059】
例えば、無線通信部160は、アンテナ、RF(Radio Frequency)回路及び/又はベースバンドプロセッサなどを含む。
【0060】
(6)処理部170
処理部170は、飛行体100の様々な処理を行う。処理部170は、選択部171、情報取得部173、情報生成部175、姿勢推定部177、位置推定部179及び制御部181を含む。なお、処理部170は、これらの構成要素以外の他の構成要素をさらに含み得る。即ち、処理部170は、これらの構成要素の動作以外の動作も行い得る。
【0061】
例えば、処理部170は、回路(circuitry)を含む。より具体的には、例えば、処理部170は、1つ以上の集積回路(integrated circuit)を含む。例えば、当該1つ以上の集積回路は、処理部170の動作のためのプログラムを保持する。例えば、選択部171、情報取得部173、情報生成部175、姿勢推定部177、位置推定部179及び制御部181は、上記プログラムとして実装され得る。上記1つ以上の集積回路は、SoC(System-on-a-Chip)、マイクロコントローラ及び/又は他のプロセッサなどを含んでもよい。
【0062】
(a)姿勢推定部177
姿勢推定部177は、飛行体100の姿勢を推定する。
【0063】
例えば、姿勢推定部177は、慣性センサ131を用いて生成される情報を取得し、当該情報から飛行体100の姿勢を推定する。例えば、当該情報は、慣性センサ131に含まれるジャイロセンサにより検出される角速度を示す情報と、慣性センサ131に含まれる加速度センサにより検出される加速度を示す情報とを示す。飛行体100の姿勢推定については、例えば、基本的な姿勢推定として上述したとおりである。よって、ここでは詳細な説明を省略する。
【0064】
(b)位置推定部179
位置推定部179は、飛行体100の位置を推定する。この点については後に詳細に説明する。
【0065】
(c)制御部181
制御部181は、飛行体100の飛行に関する制御を行う。
【0066】
(c-1)ロータ110の制御
例えば、制御部181は、ロータ110の回転を制御する。具体的には、例えば、制御部181は、モータ120の動作を制御することにより、ロータ110の回転を制御する。
【0067】
例えば、制御部181は、ロータ110A、110B、110C、110Dの各々の回転数を調整することにより、飛行体100に、静止ホバリング、移動(上昇、下降、水平移動、及び斜め方向への移動など)及び回転などを行わせる。
【0068】
より具体的には、例えば、各ロータの回転数の調整により、飛行体100の姿勢(ロール軸、ピッチ軸及びヨー軸の傾き)を変化させることができる。そのため、例えば、ロール軸及びピッチ軸に飛行体100を傾けることができ、その結果、水平方向への推進力が発生し、飛行体100は水平方向に移動する。また、例えば、ロータの回転数の増加又は減少により、上下方向の移動速度が変化する。
【0069】
(c-2)飛行体100の姿勢の制御
例えば、制御部181は、飛行体100の姿勢を制御する。
【0070】
例えば、制御部181は、姿勢推定部177により推定される飛行体100の姿勢と目標姿勢との誤差を修正する。より具体的には、例えば、制御部181は、当該誤差を算出し、当該誤差を修正するための、ロータ110の回転(又はモータ120の動作)を算出する。そして、制御部181は、上述したようにロータ110の回転を制御する。
【0071】
(c-3)飛行体100の位置の制御
例えば、制御部181は、飛行体100の位置を制御する。
【0072】
-制御の例
例えば、制御部181は、位置推定部179により推定される飛行体100の位置から目標位置へ飛行体100を移動させる。より具体的には、例えば、制御部181は、飛行体100の上記位置から上記目標位置への移動を算出し、当該移動を生み出す目標姿勢を算出する。そして、上述したように、制御部181は、飛行体100の姿勢と上記目標姿勢との誤差を修正する。
【0073】
-目標位置の取得の例
一例として、制御部181は、保持している飛行経路情報から1つ以上の目標位置を取得する。上記飛行経路情報が、1つ以上の目標位置を示してもよく、制御部181が、上記飛行経路情報から1つ以上の目標位置を算出してもよい。
【0074】
別の例として、制御装置200が、目標位置を示す情報を飛行体100へ送信し、制御装部181は、当該目標位置を示す当該情報を取得してもよい。
【0075】
(c-4)その他
選択部171、情報取得部173及び情報生成部175の動作は、位置推定部179の動作と同様に、後に詳細に説明する。
【0076】
(7)バッテリ190
バッテリ190は、飛行体100を動作させるための電力を蓄える。バッテリ190は、放電のみが可能な一次電池であってもよく、充電も可能な二次電池であってもよい。
【0077】
<4.本開示の実施形態に係る位置推定>
次に、
図6~16を参照して、本開示の実施形態に係る位置推定の例を説明する。
【0078】
(1)複数の位置推定方式
本開示の実施形態では、飛行体100の位置を推定するための複数の位置推定方式が用意される。例えば、上記複数の位置推定方式は、GPS受信機を用いる方式、飛行体100に設置された撮像装置を用いる方式、飛行体100を撮像する撮像装置を用いる方式、気圧計を用いる方式、及び超音波センサを用いる方式のうちの、少なくとも1つを含む。
【0079】
(a)GPS受信機を用いる方式
例えば、位置推定方式として、GPS受信機を用いる方式がある。
【0080】
GPS受信機は、複数のGPS衛星からの信号の受信に応じて位置を推定する。即ち、GPS受信機は、複数のGPS衛星からの信号の受信に応じて、緯度、経度及び高度を算出する。そのため、飛行体100のGPS受信機133は、飛行体100の位置を推定する。即ち、飛行体100のGPS受信機133は、飛行体100の緯度、経度及び高度を算出する。
【0081】
(b)飛行体100に設置された撮像装置を用いる方式
例えば、位置推定方式として、飛行体100に設置された撮像装置を用いる方式がある。
【0082】
(b-1)SLAM
例えば、飛行体100に設置された撮像装置を用いる方式は、SLAM(Simultaneous Localization and Mapping)を含む。
【0083】
-単眼SLAM
例えば、単眼の撮像装置を用いるSLAM(以下、「単眼SLAM」と呼ぶ)がある。単眼SLAMでは、移動により発生する撮像画像内の特徴点の視差を利用して、当該特徴点の3次元位置とカメラの位置及び姿勢とが同時に推定される。
【0084】
この方式では、特徴点が、遠くに存在する大きいものなのか、又は近くに存在する小さいものなのかが不定となるので、既知の大きさの特徴点を初期化の際に提示することが必要となる。また、飛行体100がその場で回転するようなケースでは、特徴点の視差が生じないので、特徴点の距離が不定となり、また、新たな特徴点を利用して位置及び姿勢を推定することが困難になり得る。
【0085】
これらの弱点を補うために、例えば、単眼の撮像装置の光軸が飛行体100の上下方向の軸となるように、当該単眼の撮像装置が飛行体100に設置される。さらに、上記単眼の撮像装置がジンバルを用いて飛行体100に設置される。即ち、光軸が飛行体100の上下方向の軸となるようにジンバルを用いて飛行体100に設置された単眼の撮像装置を用いるSLAM(以下、「ジンバル付き単眼SLAM」と呼ぶ)が、位置推定方式として用意される。例えば、上記光軸は、鉛直軸である。以下、この点について、
図6及び
図7を参照して具体例を説明する。
【0086】
図6は、ジンバルを用いて飛行体100に設置された単眼の撮像装置による撮像の第1の例を説明するための説明図である。
図6を参照すると、飛行体100が示されている。この例では、光軸41が鉛直軸(鉛直方向43の軸)となるように、ジンバルを用いて単眼の撮像装置が飛行体100の上側に設置される。ジンバルの使用により、光軸41は、飛行体100が傾いたとしても、鉛直軸のまま維持される。そのため、上記単眼の撮像装置は、常に、鉛直方向43とは反対の方向の範囲45を撮像する。
【0087】
図7は、ジンバルを用いて飛行体100に設置された単眼の撮像装置による撮像の第2の例を説明するための説明図である。
図7を参照すると、飛行体100が示されている。この例では、光軸41が鉛直軸(鉛直方向43の軸)となるように、ジンバルを用いて単眼の撮像装置が飛行体100の下側に設置される。ジンバルの使用により、光軸41は、飛行体100が傾いたとしても、鉛直軸のまま維持される。そのため、上記単眼の撮像装置は、常に、鉛直方向43の範囲47を撮像する。
【0088】
このように、光軸が飛行体100の上下方向となるように単眼の撮像装置を飛行体100に設置することにより、例えば、視差を生じさせにくいその場での回転を飛行体100のロール軸及びピッチ軸と対応させることが可能になる。飛行体100は、移動のために、ロール軸及びピッチ軸への傾きを生じさせるが、当該傾きは、±15度程度の範囲内である。よって、回転によって特徴点が新たなものに置き換えられる可能性は低いので、位置の推定が困難になりにくい。さらに、ジンバルを用いた設置により、例えば、鉛直方向の範囲、又は鉛直方向の反対の方向の範囲を常に撮像することが可能になる。そのため、位置推定のロバスト性が向上し得る。
【0089】
なお、例えば、飛行体100の離着陸場所(例えば、ヘリポート)のテクスチャパターンが予め記憶されれば、飛行体100の離陸時に、上記離着陸場所が既知の大きさの特徴点として使用され得る。これにより、位置推定がより正確になり得る。
【0090】
-ステレオSLAM
例えば、ステレオ撮像装置を用いるSLAM(以下、「ステレオSLAM」と呼ぶ)がある。ステレオSLAMでは、2つのカメラの視差を利用して特徴点の3次元位置が推定される。そのため、飛行体100の移動なしでも、位置の推定が可能である。また、既知の大きさの特徴点がなくても、位置の推定が可能である。
【0091】
-SLAMの特徴
SLAMでは、移動量に応じて、推定される位置に誤差が蓄積される。そのため、飛行体100が長距離にわたり移動する場合には、慣性センサと同様にドリフトが発生し得る。しかし、慣性センサよりも誤差の量が少なくなり得ること、及び、同一の特徴点が用いられる場合には誤差が大きくならないことから、SLAMは、慣性センサを用いた位置推定を補完し得る。
【0092】
(b-2)マーカ
例えば、飛行体100に設置された撮像装置を用いる方式は、マーカが配置されている既知の位置と、飛行体100に設置された撮像装置により生成される上記マーカの撮像画像とに基づいて、上記飛行体の位置を推定する方式を含む。
【0093】
例えば、あるエリア内に複数のマーカが設置され、当該複数のマーカの各々の位置が、飛行体100において予め保持される。飛行体100が上記あるエリア内で飛行する場合に、飛行体100に設置された撮像装置が撮像を行い、当該撮像により生成される撮像画像内の各マーカの位置と、各マーカの既知の位置とから、飛行体100の位置が推定される。一例として、上記撮像装置は、全方位の撮像を可能にする全方位カメラである。一例として、上記複数のマーカの各々は、発光マーカ(例えば、発行LED(Light-Emitting Diode))であり、撮像画像には光る塊として映る。以下、
図8を参照してマーカの配置の例を説明する。
【0094】
図8は、マーカの配置の例を説明するための説明図である。
図8を参照すると、エリア51と、エリア51を飛行する飛行体100とが示されている。エリア51には、4つのマーカ53が配置されている。飛行体100に設置された撮像装置(例えば、全方位カメラ)は撮像を行い、その結果、4つのマーカ53を撮像する。そして、撮像画像内の上記4つのマーカ53の各々の位置と、上記4つのマーカ53の既知の位置とから、飛行体100の位置が推定される。
【0095】
例えば、全方位カメラの撮像画像内における中心からマーカへの方向が、実際の全方位カメラから当該マーカへの方向と一致する。そのため、マーカiの位置(Mix,Miy)及び観測方向Theta(ギリシャ文字)、並びに、飛行体100の推定位置(x,y)及び推定方向alpha(ギリシャ文字)は、以下のように表される。
【0096】
【0097】
3つの未知数(即ち、x、y、alpha(ギリシャ文字))があり、4つの観測点(4つのマーカ)があるので、非線形最適化問題で上記3つの未知数が算出される。
【0098】
当然ながら、推定位置(x,y)及び推定方向alpha(ギリシャ文字)の算出の手法は、上述した例に限定されない。一例として、推定位置(x,y)及び推定方向alpha(ギリシャ文字)の複数の候補が予め用意され、当該複数の候補に含まれる候補から、上述した式に従って観測方向theta(ギリシャ文字)が算出されてもよい。そして、算出された当該観測方向と、撮像画像から得られる実際の観測方向との差分が、誤差として算出され、さらに、算出される当該誤差から、上記候補の尤度が算出されてもよい。そして、上記複数の候補の各々の尤度に基づいて、上記複数の候補のうちの1つの候補が選択され、当該1つの候補が飛行体100の位置及び方向として推定されてもよい。この際に、パーティクルフィルタが用いられてもよい。
【0099】
なお、屋外では、発光マーカは、太陽光の反射などに起因して撮像画像内で埋もれてしまう可能性がある。フィルタによる可視光のカットによっても分離が困難となり得る。そのため、例えば、発光マーカは、特定の発光パターンを有してもよい。そして、撮像画像の中から、上記特定の発光パターンを有する発光マーカが検出されてもよい。
【0100】
以上のような位置推定方式(即ち、マーカの撮像画像に基づく位置推定の方式)では、時間に比例した誤差の蓄積がない。そのため、当該位置推定方式は、慣性センサを用いた位置推定を補完し得る。
【0101】
(c)飛行体を撮像する撮像装置を用いる方式
例えば、位置推定方式として、飛行体100を撮像する撮像装置を用いる方式がある。
【0102】
例えば、モーションキャプチャでは、撮像装置により飛行体100が撮像され、撮像画像に基づいて飛行体100の位置及び動きが算出される。以下、
図9を参照して、モーションキャプチャが用いられるケースの一例を説明する。
【0103】
図9は、モーションキャプチャが用いられるケースの一例を説明するための説明図である。例えば、情報処理装置400は、撮像装置410、420により生成される撮像画像に基づいて、飛行体100の位置及び動きを算出する。そして、情報処理装置400は、当該位置(及び当該動き)を示す情報を、飛行体100へ送信する。一例として、情報処理装置400は、制御装置200を介して、上記情報を飛行体100へ送信する。なお、情報処理装置400は、直接的に、又は中継ノードを介して、上記情報を飛行体100へ送信してもよい。また、情報処理装置400と制御装置200とは、同一の装置であってもよい。
【0104】
以上のような位置推定方式(即ち、飛行体100を撮像する撮像装置を用いる方式)では、時間に比例した誤差の蓄積がない。そのため、当該位置推定方式は、慣性センサを用いた位置推定を補完し得る。
【0105】
(d)気圧計を用いる方式
例えば、位置推定方式として、気圧計を用いる方式がある。
【0106】
例えば、飛行体100の気圧計135により測定される気圧から、飛行体100の高度が推定される。具体的には、飛行体100の気圧計135により測定される気圧に対応する高度が、飛行体100の高度として推定される。
【0107】
気圧計を用いる方式では、時間に比例した誤差の蓄積がない。そのため、当該位置推定方式は、慣性センサを用いた位置推定を補完し得る。
【0108】
(e)超音波センサを用いる方式
例えば、位置推定方式として、超音波センサを用いる方式がある。
【0109】
例えば、飛行体100の超音波センサ137は、鉛直方向に超音波を発し、当該超音波の反射波を受信する。そして、上記超音波の発信から上記反射波の受信までの時間から、飛行体100の高度が推定される。
【0110】
超音波センサを用いる方式では、時間に比例した誤差の蓄積がない。そのため、当該位置推定方式は、慣性センサを用いた位置推定を補完し得る。
【0111】
(f)各方式の特徴
上述した位置推定方式は、それぞれ異なる特徴を有する。以下、この点について
図10を参照して具体例を説明する。
【0112】
図10は、各位置推定方式の特徴を説明するための説明図である。
図10を参照すると、各位置推定方式の精度(分解能及び/又は位置の誤差)、サンプリングの周期、時間遅れ、フィルタ時定数、使用環境、及び慣性センサとの相性が示されている。上記時間遅れは、位置推定に伴う時間遅れである。上記フィルタ時定数は、補正値の算出に用いるフィルタの時定数であり、位置推定のノイズの特性に応じた値となる。例えば、GPS受信機を用いる方式では、精度は5~10メートルであり、サンプリングの周期は2~5Hzであり、位置推定に伴う時間遅れは400~600ミリ秒である。単眼SLAMでは、精度は数センチメートル、サンプリングの周期は30Hz程度であり、位置推定に伴う時間遅れは30~100ミリ秒である。このように、精度、周期、時間遅れ、フィルタ時定数、使用環境、及び慣性センサとの相性などは、位置推定方式によって異なる。
【0113】
(2)位置推定方式の選択及び位置推定
情報取得部173は、飛行体100の位置を推定するための複数の位置推定方式の中から選択された位置推定方式を示す情報を取得する。位置推定部179は、上記位置推定方式用のパラメータに従って、飛行体100の慣性センサ131を用いて生成される第1の情報と、上記位置推定方式を通じて生成される第2の情報とから、飛行体100の位置を推定する。
【0114】
(a)複数の位置推定方式
例えば、上記複数の位置推定方式は、GPS受信機を用いる方式、飛行体100に設置された撮像装置を用いる方式、飛行体100を撮像する撮像装置を用いる方式、気圧計を用いる方式、及び超音波センサを用いる方式のうちの、少なくとも1つを含む。これらの位置推定方式についての説明は、上述したとおりである。
【0115】
(b)位置推定方式を示す情報の取得
第1の例として、後述するように、選択部171が、上記複数の位置推定方式の中から位置推定方式を動的に選択する。そして、情報取得部173は、上記位置推定方式を示す情報を取得する。
【0116】
第2の例として、ユーザが、上記複数の位置推定方式の中から位置推定方式を静的に選択してもよく、当該位置推定方式を示す情報が、飛行体100において保持されてもよい。そして、情報取得部173は、当該情報を取得してもよい。
【0117】
例えば、上記位置推定方式を示す上記情報は、上記位置推定方式の識別情報である。
【0118】
(c)慣性センサ131を用いて生成される第1の情報
例えば、慣性センサ131は、加速度センサを含み、慣性センサ131を用いて生成される上記第1の情報は、飛行体100の加速度を示す情報を含む。
【0119】
例えば、慣性センサ131を用いて生成される上記第1の情報は、飛行体100の姿勢を示す情報をさらに含む。当該姿勢は、上述したように姿勢推定部177により推定される。
【0120】
(d)位置推定方式を通じて生成される第2の情報
例えば、上記位置推定方式を通じて生成される上記第2の情報は、飛行体100の位置を示す情報である。
【0121】
(d-1)第1の例:GPS受信機を用いる方式のケース
第1の例として、上記位置推定方式は、GPS受信機を用いる方式である。この場合に、例えば、情報生成部175は、GPS受信機133の出力情報(飛行体100の緯度、経度及び高度を示す情報)を取得し、当該出力情報から、飛行体100の位置を示す上記第2の情報(例えば、所定の位置を原点とする飛行体100の位置を示す情報)を生成する。そして、位置推定部179は、上記第2の情報を取得する。
【0122】
(d-2)第2の例:飛行体100に設置された撮像装置を用いる方式のケース
第2の例として、上記位置推定方式は、飛行体100に設置された撮像装置を用いる方式(例えば、SLAM、又はマーカの撮像画像に基づく位置推定の方式)である。この場合に、例えば、情報生成部175は、撮像部140に含まれる撮像装置により生成される撮像画像を取得し、当該撮像画像に基づいて、飛行体100の位置を示す上記第2の情報を生成する。そして、位置推定部179は、上記第2の情報を取得する。
【0123】
(d-3)第3の例:飛行体100を撮像する撮像装置を用いる方式のケース
第3の例として、上記位置推定方式は、飛行体100を撮像する撮像装置を用いる方式である。
図9を再び参照すると、例えば、情報処理装置400が、飛行体100の位置を示す上記第2の情報を生成し、当該第2の情報が、飛行体100へ送信される。そして、位置推定部179は、上記第2の情報を取得する。
【0124】
(d-4)第4の例:気圧計を用いる方式のケース
第4の例として、上記位置推定方式は、気圧計を用いる方式である。この場合に、例えば、情報生成部175は、気圧計135の出力情報(気圧を示す情報)を取得し、当該出力情報から、飛行体100の位置を示す上記第2の情報(例えば、飛行体100の高度を示す情報)を生成する。そして、位置推定部179は、上記第2の情報を取得する。
【0125】
(d-5)第5の例:超音波センサを用いる方式
第5の例として、上記位置推定方式は、超音波センサを用いる方式である。この場合に、例えば、位置推定部179は、超音波センサ137の出力情報(距離を示す情報)を、飛行体100の位置を示す上記第2の情報(例えば、飛行体100の高度を示す情報)として取得する。
【0126】
(e)パラメータに従った位置の推定
(e-1)パラメータの保持
例えば、上記複数の位置推定方式の各々用のパラメータが、飛行体100において保持される。一例として、上記複数の位置推定方式の各々用のパラメータを含むテーブルが保持される。そして、位置推定部179は、保持されているパラメータを取得する。
【0127】
(e-2)パラメータの例:時間遅れに関するパラメータ
例えば、上記位置推定方式用の上記パラメータは、上記位置推定方式での位置推定に伴う時間遅れに関するパラメータ(以下、「時間遅れパラメータ」と呼ぶ)を含む。
【0128】
-時間遅れパラメータの例
一例として、上記時間遅れパラメータは、上記位置推定方式での位置推定に伴う上記時間遅れである。別の例として、上記時間遅れパラメータは、上記位置推定方式での位置推定に伴う上記時間遅れと、慣性センサを用いた位置推定に伴う時間遅れとの差分であってもよい。各位置推定方式についての時間遅れの例は、
図10を参照して説明したとおりである。
【0129】
-位置推定の例
例えば、位置推定部179は、上記時間遅れパラメータに従って、上記位置推定方式を通じて生成される上記第2の情報から補正値を算出する。そして、位置推定部179は、慣性センサ131を用いて生成される上記第1の情報と上記補正値とから、飛行体100の位置を推定する。
【0130】
より具体的には、例えば、位置推定部179は、上記時間遅れパラメータに従って、既に推定された飛行体100の位置を示す第3の情報を取得する。そして、位置推定部179は、上記位置推定方式を通じて生成される上記第2の情報と、上記第3の情報とから、上記補正値を算出する。以下、
図3及び
図11を参照して具体例を説明する。
【0131】
図3を再び参照すると、例えば、位置推定部179は、上記第1の情報(慣性センサ131を用いて生成される情報)として、加速度aを示す情報を取得する。そして、位置推定部179は、加速度aを示す当該情報と、フィルタ25により出力される補正値(加速度の補正値△a、速度の補正値△v、及び位置の補正値△)とから、飛行体の位置pUを推定する。また、位置推定部179は、位置推定方式を通じて生成される第2の情報として、位置pxを示す情報を取得し、既に推定された飛行体100の位置を示す第3の情報として、位置pUを示す情報を取得する。そして、位置推定部179は、位置pxを示す情報と、位置pUを示す情報とから、位置pxと位置pUとの差分を誤差eとして算出し、誤差eをフィルタ25に通すことにより、上記補正値(加速度の補正値△a、速度の補正値△v、及び位置の補正値△)を算出する。とりわけ、位置推定部179は、上記位置推定方式での位置推定に伴う時間遅れに関するパラメータ(即ち、時間遅れパラメータ)に従って、位置pUを示す情報(第3の情報)を取得する。
【0132】
図11は、時間遅れパラメータに従った位置推定の例を説明するための説明図である。
図11を参照すると、飛行体100の位置pUを示す第3の情報61と、位置推定方式を通じて生成される第2の情報63(位置pxを示す情報)とが示されている。例えば、慣性センサ131を用いた位置推定に伴う時間遅れ65(即ち、第3の情報61の生成に伴う時間遅れ)は、位置推定方式(例えば、GPS受信機を用いる方式)での位置推定に伴う時間遅れ67(即ち、第2の情報の生成に伴う時間遅れ)よりも非常に短い。そのため、例えば、単純に、時間T3で得られる第2の情報63Aと、その時点で最新である第3の情報61Fとが取得され、第2の情報63Aにより示される位置pxと、第3の情報61Fにより示される位置pUとの差分が誤差eとして算出されると、誤差eは、不適切な値になり得る。即ち、異なる時間の位置の差分が誤差eとして算出されてしまう。そこで、例えば、位置推定部179は、時間遅れ67を示すパラメータ(又は時間遅れ67と時間遅れ65との差分を示すパラメータ)に従って、時間T3よりも時間遅れ67だけ前の時間T1あたりの位置を示す第3の情報61A及び第2の情報63Aを取得する。そして、位置推定部179は、第2の情報63Aにより示される位置pxと、第3の情報61Aにより示される位置pUとの差分を、誤差eとして算出する。同様に、位置推定部179は、時間T2あたりの位置を示す第3の情報61F及び第2の情報63Bを取得する。そして、位置推定部179は、第2の情報63Bにより示される位置pxと、第3の情報61Fにより示される位置pUとの差分を、誤差eとして算出する。なお、位置pU(即ち、第3の情報61)は、誤差eの算出のために、少なくとも時間遅れ67に相当する期間にわたり保持される。
【0133】
例えばこのように、位置推定方式用の時間遅れパラメータに従って飛行体100の位置が推定される。これにより、例えば、当該位置推定方式に合った適切な補正値が算出される。その結果、飛行体100の位置がより良好に推定され得る。以下、この点について
図12及び
図13を参照して具体例を説明する。
【0134】
図12は、時間遅れパラメータなしでの位置推定の結果の一例を説明するための説明図である。この例では、位置推定方式として、GPS受信機を用いた方式が使用される。飛行体100の移動に応じて、慣性センサを用いて推定される位置1010が変化する。一方、GPS受信機を用いて推定される位置1020は、飛行体100の移動の直後には変化しない。この例では、上記位置推定方式(即ち、GPS受信機を用いた方式)用の時間遅れパラメータなしで位置推定が行われるので、位置1010が変化するにもかかわらず、変化しない位置1020に起因して、推定位置1030は元の位置に引き戻されてしまう。
【0135】
図13は、時間遅れパラメータに従った位置推定の結果の一例を説明するための説明図である。この例でも、位置推定方式として、GPS受信機を用いた方式が使用される。飛行体100の移動に応じて、慣性センサを用いて推定される位置1010が変化する。一方、GPS受信機を用いて推定される位置1020は、飛行体100の移動の直後には変化しない。この例では、上記位置推定方式(即ち、GPS受信機を用いた方式)用の時間遅れパラメータに従って位置推定が行われるので、変化しない位置1020に起因する推定位置1030の引き戻しが小さくなり、良好な推定位置1030が得られる。
【0136】
(e-3)パラメータの例:ノイズの特性に関するパラメータ
例えば、上記位置推定方式用の上記パラメータは、上記位置推定方式での位置推定に伴うノイズの特性に関するパラメータ(以下、「ノイズ特性パラメータ」と呼ぶ)を含む。
【0137】
-ノイズ特性パラメータの例
一例として、上記ノイズ特性パラメータは、補正値の算出に用いるフィルタの時定数である。
図3を再び参照すると、上記ノイズ特性パラメータは、例えば、フィルタ25の時定数である。各位置推定方式についてのフィルタ時定数の例は、
図10を参照して説明したとおりである。
【0138】
別の例として、上記ノイズ特性パラメータは、上記ノイズの帯域であってもよい。そして、上記ノイズ特性パラメータ(上記ノイズの帯域)から、フィルタの時定数が算出されてもよい。
【0139】
-位置推定の例
例えば、位置推定部179は、上記ノイズ特性パラメータに従って、上記位置推定方式を通じて生成される上記第2の情報から補正値を算出する。そして、位置推定部179は、慣性センサ131を用いて生成される上記第1の情報と上記補正値とから、飛行体100の位置を推定する。
【0140】
図3を再び参照すると、例えば、フィルタ25の時定数Tcとして、複数の位置推定方式の中から選択された位置推定方式用の時定数(即ち、ノイズ特性パラメータ)が設定される。当該時定数は、上記位置推定方式での位置推定に伴うノイズの特性に対応する時定数である。位置推定部179は、位置推定方式を通じて生成される第2の情報として、位置pxを示す情報を取得し、位置pxと、既に推定された飛行体100の位置pUとの差分を、誤差eとして算出する。そして、位置推定部179は、フィルタ25(時定数Tc=ノイズ特性パラメータ)に、誤差eを通すことにより、補正値(加速度の補正値△a、速度の補正値△v、及び位置の補正値△)を算出する。そして、位置推定部179は、慣性センサ131を用いて生成される第1の情報(例えば、加速度aを示す情報)と上記補正値とから、飛行体100の位置pUを推定する。
【0141】
例えばこのように、位置推定方式用のノイズ特性パラメータに従って飛行体100の位置が推定される。これにより、例えば、当該位置推定方式に合った適切な補正値が算出される。その結果、飛行体の位置がより良好に推定され得る。
【0142】
以上のように、位置推定部179は、複数の位置推定方式の中から選択された位置推定方式用のパラメータに従って、飛行体100の位置を推定する。これにより、例えば、GPS受信機を用いる位置推定方式のみではなく、他の位置推定方式を適用することが可能になる。そのため、GPS受信機による位置推定が困難であっても、飛行体100の位置をより良好に推定することが可能になる。また、複数の位置推定方式の中で位置推定方式が切り替えられる場合でも、位置推定方式の特徴(例えば、時間遅れ、及び/又はノイズ特性など)が位置推定において反映されるので、飛行体100の位置がより良好に推定され得る。また、複数の位置推定方式の中で位置推定方式の切替えをより容易に行うことが可能になる。
【0143】
(3)位置推定方式の動的な選択
例えば、選択部171は、飛行体100の飛行中に上記複数の位置推定方式の中から位置推定方式を動的に選択する。即ち、飛行体100の飛行中に、上記複数の位置推定方式の中で、位置推定方式が切り替えられる。
【0144】
(a)初期値の引渡し
例えば、新たな位置推定方式が選択される場合に、当該新たな位置推定方式での位置推定のために、位置推定の初期値が提供される。
【0145】
(a-1)各構成要素の動作
例えば、選択部171は、上記複数の位置推定方式の中から第1の位置推定方式を選択する。すると、情報取得部173は、上記第1の位置推定方式を示す情報を取得する。そして、位置推定部179は、上記第1の位置推定方式用のパラメータに従って、慣性センサ131を用いて生成される第1の情報と、上記第1の位置推定方式を通じて生成される第2の情報とから、飛行体100の位置を推定する。
【0146】
さらに、選択部171は、上記第1の位置推定方式の選択の後に、上記複数の位置推定方式の中から第2の位置推定方式を選択する。とりわけ、選択部171は、推定される上記位置を上記第2の位置推定方式での位置推定の初期値として提供する。例えば、情報生成部175が、上記第2の位置推定方式での位置推定を行い、選択部171は、情報生成部175に、推定される上記位置を上記初期値として提供する。
【0147】
そして、情報取得部173は、上記第2の位置推定方式を示す情報を取得する。その後、位置推定部179は、上記第2の位置推定方式用のパラメータに従って、慣性センサ131を用いて生成される第1の情報と、上記第2の位置推定方式を通じて生成される第2の情報とから、飛行体100の位置を推定する。
【0148】
(a-2)位置推定方式の例
例えば、上記第2の位置推定方式は、飛行体100の相対位置を推定するための方式である。より具体的には、例えば、上記第2の位置推定方式は、飛行体100に設置された撮像装置を用いる方式(例えば、SLAM、又はマーカの撮像画像に基づく位置推定の方式)である。
【0149】
例えば、上記第1の位置推定方式は、飛行体100の絶対位置を推定するための方式である。より具体的には、例えば、上記第1の位置推定方式は、GPS受信機を用いる方式、飛行体100を撮像する撮像装置を用いる方式、気圧計を用いる方式、又は超音波センサを用いる方式である。なお、上記第1の位置推定方式も、飛行体100の相対位置を推定するための方式であってもよい。
【0150】
(a-3)具体的な例
図3を再び参照すると、例えば、選択部171は、第1の位置推定方式(例えば、GPS受信機を用いる方式)を選択する。すると、位置推定部179は、慣性センサ131を用いて生成される第1の情報(例えば、加速度aを示す情報など)と、上記第1の位置推定方式を通じて生成される第2の情報(位置pxを示す情報)とから、飛行体100の位置pUを推定する。その後、例えば、選択部171は、第2の位置推定方式(例えば、SLAM)を選択し、位置pUを、上記第2の位置推定方式での位置推定の初期値として、情報生成部175に提供する。すると、情報生成部175は、上記第2の位置推定方式での位置推定の初期値として、位置pUを設定し、上記第2の位置推定方式を通じて第2の情報(位置pxを示す情報)を生成する。そして、位置推定部179は、慣性センサ131を用いて生成される第1の情報(例えば、加速度aを示す情報など)と、上記第2の位置推定方式を通じて情報生成部175により生成される上記第2の情報(位置pxを示す情報)とから、飛行体100の位置pUを推定する。
【0151】
(a-4)その他
例えば、上記第2の位置推定方式が、飛行体100の絶対位置を推定するための方式(例えば、GPS受信機を用いる方式など)である場合には、選択部171は、推定される上記位置を、上記第2の位置推定方式での位置推定の初期値として提供しない。
【0152】
選択部171は、飛行体100の推定された上記位置に加えて、姿勢推定部177により推定される飛行体100の姿勢も、上記第2の位置推定方式での位置推定のための姿勢の初期値として提供してもよい。
【0153】
例えば以上のように、新たな位置推定方式が選択される場合に、当該新たな位置推定方式での位置推定のために、位置推定の初期値が提供される。これにより、例えば、シームレスな位置推定を行うことが可能になる。また、絶対位置を推定するための方式での位置推定の値を、相対位置を推定するための方式に引き継ぐことが可能になる。また、相対位置を推定するための方式での位置推定の値が、選択のたびにリセットされるので、誤差の蓄積が減少し得る。
【0154】
(b)選択のトリガ
(b-1)位置条件
例えば、選択部171は、飛行体100の位置が所定の位置条件を満たす場合に、上記複数の位置推定方式の中から位置推定方式を新たに選択する。
【0155】
より具体的には、例えば、選択部171は、飛行体100の位置が所定の切替え位置になる場合に、上記複数の位置推定方式の中から位置推定方式を新たに選択する。以下、
図14~
図16を参照して具体例を説明する。
【0156】
-第1の例
図14は、位置推定方式の選択(切替え)の第1の例を説明するための説明図である。
図14を参照すると、橋71が示されている。この例では、飛行体100は、橋71の裏側全体を撮像するために、StartからGoalまでの経路に沿って飛行する。即ち、飛行体100は、GPS衛星73からの電波が十分に届くエリア75と、GPS衛星73からの電波が届きにくいエリア77との間を、行き来する。この場合に、選択部171は、飛行体100がエリア75からエリア77に入る際に、位置推定方式としてSLAM(例えば、ステレオSLAM)を新たに選択する。即ち、選択部171は、飛行体100の位置がエリア75とエリア77との境界の位置(又は当該境界付近の位置)になると、位置推定方式としてSLAM(例えば、ステレオSLAM)を新たに選択する。ここで、既に推定された位置が、SLAMでの位置推定の初期値として引き継がれる。また、既に推定された姿勢も、SLAMでの位置推定のための姿勢の初期値として引き継がれ得る。一方、選択部171は、飛行体100がエリア77からエリア75に入る際に、位置推定方式として、GPSを用いる方式を新たに選択する。即ち、選択部171は、飛行体100の位置がエリア77とエリア75との境界の位置(又は当該境界付近の位置)になると、位置推定方式として、GPSを用いる方式を新たに選択する。このように、位置推定方式の切替え(即ち、GPSを用いる方式とSLAMとの切替え)が行われる。
【0157】
なお、飛行体100が屋内と屋外を行き来する場合にも、位置推定方式が同様に選択され得る。
【0158】
-第2の例
図15は、位置推定方式の選択(切替え)の第2の例を説明するための説明図である。
図15を参照すると、高層ビル81が示されている。この例では、飛行体100は、高層ビル81の間のパスを含む経路に沿って飛行する。即ち、飛行体100は、GPS衛星からの電波が十分に届くエリア83、及びGPS衛星からの電波が届きにくいエリア85(即ち、高層ビル81の間のエリア)を飛行する。この場合に、選択部171は、飛行体100がエリア83からエリア85に入る際に、位置推定方式としてSLAM(例えば、ステレオSLAM)を新たに選択する。即ち、選択部171は、飛行体100の位置がエリア83とエリア85との境界の位置(又は当該境界付近の位置)になると、位置推定方式としてSLAM(例えば、ステレオSLAM)を新たに選択する。ここで、既に推定された位置が、SLAMでの位置推定の初期値として引き継がれる。また、既に推定された姿勢も、SLAMでの位置推定のための姿勢の初期値として引き継がれ得る。一方、選択部171は、飛行体100がエリア85からエリア83に入る際に、位置推定方式として、GPSを用いる方式を新たに選択する。即ち、選択部171は、飛行体100の位置がエリア85とエリア83との境界の位置(又は当該境界付近の位置)になると、位置推定方式として、GPSを用いる方式を新たに選択する。このように、位置推定方式の切替え(即ち、GPSを用いる方式とSLAMとの切替え)が行われる。
【0159】
なお、飛行体100が山の谷を飛行する場合にも、位置推定方式が同様に選択され得る。
【0160】
-第3の例
図16は、位置推定方式の選択(切替え)の第3の例を説明するための説明図である。
図16を参照すると、競技場91が示されている。競技場91には、マーカ93が配置されている。この例では、飛行体100は、競技場91の内外を飛行する。即ち、飛行体100は、マーカ93を撮像不能なエリア95と、マーカ93を撮像可能なエリア97とを飛行する。この場合に、選択部171は、飛行体100がエリア95からエリア97に入る際に、位置推定方式として、マーカの撮像画像に基づく位置推定の方式を新たに選択する。即ち、選択部171は、飛行体100の位置がエリア95とエリア97との境界の位置(又は当該境界付近の位置)になると、位置推定方式として、マーカの撮像画像に基づく位置推定の方式を新たに選択する。ここで、既に推定された位置が、マーカの撮像画像に基づく位置推定の初期値として引き継がれる。また、既に推定された姿勢が、マーカの撮像画像に基づく位置推定のための姿勢の初期値として引き継がれ得る。一方、選択部171は、飛行体100がエリア97からエリア95に入る際に、位置推定方式として、GPSを用いる方式を新たに選択する。即ち、選択部171は、飛行体100の位置がエリア97とエリア95との境界の位置(又は当該境界付近の位置)になると、位置推定方式として、GPSを用いる方式を新たに選択する。このように、位置推定方式の切替え(即ち、GPSを用いる方式と、マーカの撮像画像に基づく位置推定の方式との切替え)が行われる。
【0161】
なお、飛行体100が、マーカが配置されている屋内と、マーカが配置されていない屋外とを行き来する場合にも、位置推定方式が同様に選択され得る。
【0162】
以上のように、飛行体100の位置が上記所定の位置条件を満たす場合に、位置推定方式が新たに選択される。これにより、例えば、所望の位置で位置推定方式を自動で切替えることが可能になる。そのため、飛行体100が位置するエリアに応じて適切な位置推定方式が適用され得る。
【0163】
(b-2)位置推定方式の信頼性
選択部171は、上記複数の位置推定方式の各々について動的に算出される信頼度に基づいて、上記複数の位置推定方式の中から位置推定方式を選択してもよい。
【0164】
上記複数の位置推定方式の各々についての信頼度が、(例えば、0~100の数値に)正規化されてもよい。そして、現在の位置推定方式について算出される信頼度が、他の位置推定方式について算出される信頼度よりも低くなる場合に、選択部171は、上記他の位置推定方式を新たに選択してもよい。
【0165】
GPS受信機を用いた方式についての信頼度は、GPS衛星の捕捉状況(例えば、信号が受信されるGPS衛星の数、及び/又は、GPS衛星により送信される信号の受信感度など)に基づいて算出されてもよい。SLAMについての信頼度は、特徴点の数に基づいて算出されてもよい。マーカの撮像画像に基づく位置推定の方式についての信頼度は、マーカの検出状況に基づいて算出されてもよい。
【0166】
これにより、例えば、より信頼度の高い位置推定方式が適用され、位置推定の精度が向上し得る。
【0167】
例えば以上のように、飛行体100の飛行中に、上記複数の位置推定方式の中から位置推定方式が動的に選択される。これにより、例えば、飛行体100が様々なエリアを飛行する場合に、飛行体100の位置をより良好に推定することが可能になる。
【0168】
(4)位置推定方式の併用
情報取得部173は、上記複数の位置推定方式の中から選択された2つ以上の位置推定方式を示す情報を取得してもよい。そして、位置推定部179は、上記2つ以上の位置推定方式の各々用のパラメータに従って、慣性センサ131を用いて生成される第1の情報と、上記2つ以上の位置推定方式の各々を通じて生成される第2の情報とから、飛行体100の位置を推定してもよい。即ち、2つ以上の位置推定方式が併用されてもよい。
【0169】
例えば、上記2つ以上の位置推定方式の各々を通じて生成される上記第2の情報は、飛行体100の位置を示す情報である。
【0170】
一例として、位置推定部179は、上記2つ以上の位置推定方式を通じて推定される位置の平均(即ち、平均位置)を算出してもよい。そして、位置推定部179は、上記第1の情報と、上記平均(即ち、平均位置)を示す情報とから、飛行体100の位置を推定してもよい。
【0171】
別の例として、位置推定部179は、上記2つ以上の位置推定方式の各々について、位置推定方式を通じて推定される位置に、当該位置推定方式に対応する重みを乗算してもよい。そして、位置推定部179は、上記2つ以上の位置推定方式についての重み付きの位置の和を算出してもよい。そして、位置推定部179は、上記第1の情報と、上記和を示す情報とから、飛行体100の位置を推定してもよい。なお、上記位置推定方式に対応する上記重みは、上記位置推定方式についての信頼度であってもよい。
【0172】
これにより、例えば、位置推定の精度が向上し得る。
【0173】
<5.処理の流れ>
次に、
図17~
図19を参照して、本開示の実施形態に係る処理の例を説明する。
【0174】
(1)位置推定処理
図17は、本開示の実施形態に係る位置推定処理の概略的な流れの一例を示すフローチャートである。
【0175】
情報取得部173は、飛行体100の位置を推定するための複数の位置推定方式の中から選択された位置推定方式を示す情報を取得する(S501)。
【0176】
位置推定部179は、上記位置推定方式用のパラメータを取得し、適用する(S503)。
【0177】
位置推定部179は、飛行体100の慣性センサ131を用いて生成される第1の情報と、上記位置推定方式を通じて生成される第2の情報とから、飛行体100の位置を推定する(S505)。そして、処理はステップS505を繰り返す。
【0178】
(2)選択処理
(a)第1の例
図18は、本開示の実施形態に係る第1の選択処理の概略的な流れの一例を示すフローチャートである。
【0179】
選択部171は、飛行体100の位置を示す情報を取得する(S521)。例えば、当該位置は、位置推定部179により推定される位置である。
【0180】
飛行体100の上記位置が所定の位置条件を満たす場合には(S523:YES)、選択部171は、複数の位置推定方式の中から位置推定方式を新たに選択する(S525)。そして、選択部171は、飛行体100の位置(例えば、位置推定部179により推定される位置)を、上記位置推定方式での位置推定の初期値として提供する(S527)。そして、処理はステップS521へ戻る。
【0181】
飛行体100の上記位置が上記所定の位置条件を満たさない場合には(S523:NO)、処理はステップS521へ戻る。
【0182】
(b)第2の例
図19は、本開示の実施形態に係る第2の選択処理の概略的な流れの一例を示すフローチャートである。
【0183】
選択部171は、複数の位置推定方式の各々についての信頼度を示す情報を取得する(S541)。
【0184】
現在の位置推定方式についての信頼度よりも他の位置推定方式についての信頼度の方が高い場合には(S543:YES)、選択部171は、上記他の位置推定方式を新たに選択する(S545)。そして、選択部171は、飛行体100の位置(例えば、位置推定部179により推定される位置)を、上記他の位置推定方式での位置推定の初期値として提供する(S547)。そして、処理はステップS541へ戻る。
【0185】
現在の位置推定方式についての信頼度の方が他の位置推定方式についての信頼度よりも高い場合には(S543:NO)、処理はステップS541へ戻る。
【0186】
<6.まとめ>
ここまで、
図1~
図19を参照して、本開示の実施形態に係る飛行体100及び各処理を説明した。本開示に係る実施形態によれば、飛行体100は、飛行体100の位置を推定するための複数の位置推定方式の中から選択された位置推定方式を示す情報を取得する情報取得部173と、上記位置推定方式用のパラメータに従って、飛行体100の慣性センサ131を用いて生成される第1の情報と、上記位置推定方式を通じて生成される第2の情報とから、飛行体100の位置を推定する位置推定部179と、を備える。これにより、例えば、飛行体100の位置をより良好に推定することが可能になる。
【0187】
なお、飛行体100のためのモジュールが、情報取得部173及び位置推定部179(並びに、処理部170に含まれる1つ以上の他の構成要素)を備えてもよい。
【0188】
以上、添付図面を参照しながら本開示の好適な実施形態を説明したが、本開示は係る例に限定されないことは言うまでもない。当業者であれば、特許請求の範囲に記載された範疇内において、各種の変更例又は修正例に想到し得ることは明らかであり、それらについても当然に本開示の技術的範囲に属するものと了解される。
【0189】
例えば、本明細書の処理における処理ステップは、必ずしもフローチャート又はシーケンス図に記載された順序に沿って時系列に実行されなくてよい。例えば、処理における処理ステップは、フローチャート又はシーケンス図として記載した順序と異なる順序で実行されても、並列的に実行されてもよい。
【0190】
また、本明細書の装置(例えば、飛行体、又は飛行体のためのモジュール)に備えられるプロセッサ(例えば、CPU、DSPなど)を上記装置の構成要素(例えば、選択部171、情報取得部173、情報生成部175、姿勢推定部177、位置推定部179及び/又は制御部181)として機能させるためのコンピュータプログラム(換言すると、上記プロセッサに上記装置の構成要素の動作を実行させるためのコンピュータプログラム)も作成可能である。また、当該コンピュータプログラムを記録した記録媒体も提供されてもよい。また、上記コンピュータプログラムを記憶するメモリと、上記コンピュータプログラムを実行可能な1つ以上のプロセッサとを備える装置(例えば、飛行体、又は飛行体のためのモジュール)も提供されてもよい。また、上記装置の構成要素(例えば、選択部171、情報取得部173、情報生成部175、姿勢推定部177、位置推定部179及び/又は制御部181)の動作を含む方法も、本開示に係る技術に含まれる。
【0191】
また、本明細書に記載された効果は、あくまで説明的又は例示的なものであって限定的ではない。つまり、本開示に係る技術は、上記効果とともに、又は上記効果に代えて、本明細書の記載から当業者には明らかな他の効果を奏しうる。
【0192】
なお、以下のような構成も本開示の技術的範囲に属する。
(1)
飛行体の位置を推定するための複数の位置推定方式の中から選択された位置推定方式を示す情報を取得する取得部と、
前記位置推定方式用のパラメータに従って、前記飛行体の慣性センサを用いて生成される第1の情報と、前記位置推定方式を通じて生成される第2の情報とから、前記飛行体の位置を推定する位置推定部と、
を備える装置。
(2)
前記パラメータは、前記位置推定方式での位置推定に伴う時間遅れに関するパラメータを含む、前記(1)に記載の装置。
(3)
前記位置推定部は、前記時間遅れに関する前記パラメータに従って、前記第2の情報から補正値を算出し、前記第1の情報と前記補正値とから、前記飛行体の位置を推定する、前記(2)に記載の装置。
(4)
前記位置推定部は、前記時間遅れに関する前記パラメータに従って、既に推定された前記飛行体の位置を示す第3の情報を取得し、前記第2の情報と当該第3の情報とから、前記補正値を算出する、前記(3)に記載の装置。
(5)
前記パラメータは、前記位置推定方式での位置推定に伴うノイズの特性に関するパラメータを含む、前記(1)~(4)のいずれか1項に記載の装置。
(6)
前記位置推定部は、前記ノイズの前記特性に関する前記パラメータに従って、前記第2の情報から補正値を算出し、前記第1の情報と前記補正値とから、前記飛行体の位置を推定する、前記(5)に記載の装置。
(7)
前記ノイズに関する前記パラメータは、前記補正値の算出に用いるフィルタの時定数である、前記(6)に記載の装置。
(8)
前記複数の位置推定方式は、GPS(Global Positioning System)受信機を用いる方式、前記飛行体に設置された撮像装置を用いる方式、前記飛行体を撮像する撮像装置を用いる方式、気圧計を用いる方式、及び超音波センサを用いる方式のうちの、少なくとも1つを含む、前記(1)~(7)のいずれか1項に記載の装置。
(9)
前記飛行体に設置された撮像装置を用いる前記方式は、マーカが配置されている既知の位置と、前記飛行体に設置された撮像装置により生成される前記マーカの撮像画像とに基づいて、前記飛行体の位置を推定する方式を含む、前記(8)に記載の装置。
(10)
前記飛行体に設置された撮像装置を用いる前記方式は、光軸が前記飛行体の上下方向の軸となるようにジンバルを用いて前記飛行体に設置された単眼の撮像装置を用いるSLAM(Simultaneous Localization and Mapping)を含む、前記(8)又は(9)に記載の装置。
(11)
前記第1の情報は、前記飛行体の加速度を示す情報を含み、
前記第2の情報は、前記飛行体の位置を示す情報である、
前記(1)~(10)のいずれか1項に記載の装置。
(12)
前記飛行体の飛行中に前記複数の位置推定方式の中から位置推定方式を動的に選択する選択部をさらに備える、前記(1)~(11)のいずれか1項に記載の装置。
(13)
前記選択部は、前記複数の位置推定方式の中から第1の位置推定方式を選択し、
前記取得部は、前記第1の位置推定方式を示す情報を取得し、
前記位置推定部は、前記第1の位置推定方式用のパラメータに従って、前記慣性センサを用いて生成される第1の情報と、前記第1の位置推定方式を通じて生成される第2の情報とから、前記飛行体の位置を推定し、
前記選択部は、前記第1の位置推定方式の選択の後に、前記複数の位置推定方式の中から第2の位置推定方式を選択し、推定される前記位置を、前記第2の位置推定方式での位置推定の初期値として提供し、
前記取得部は、前記第2の位置推定方式を示す情報を取得し、
前記位置推定部は、前記第2の位置推定方式用のパラメータに従って、前記慣性センサを用いて生成される第1の情報と、前記第2の位置推定方式を通じて生成される第2の情報とから、前記飛行体の位置を推定する、
前記(12)に記載の装置。
(14)
前記第2の位置推定方式は、前記飛行体の相対位置を推定するための方式である、前記(13)に記載の装置。
(15)
前記選択部は、前記飛行体の位置が所定の位置条件を満たす場合に、前記複数の位置推定方式の中から位置推定方式を新たに選択する、前記(12)~(14)のいずれか1項に記載の装置。
(16)
前記選択部は、前記複数の位置推定方式の各々について動的に算出される信頼度に基づいて、前記複数の位置推定方式の中から位置推定方式を選択する、前記(12)~(15)のいずれか1項に記載の装置。
(17)
前記取得部は、前記複数の位置推定方式の中から選択された2つ以上の位置推定方式を示す情報を取得し、
前記位置推定部は、前記2つ以上の位置推定方式の各々用のパラメータに従って、前記慣性センサを用いて生成される第1の情報と、前記2つ以上の位置推定方式の各々を通じて生成される第2の情報とから、前記飛行体の位置を推定する、
前記(1)~(16)のいずれか1項に記載の装置。
(18)
前記装置は、前記飛行体、又は前記飛行体のためのモジュールである、前記(1)~(17)のいずれか1項に記載の装置。
(19)
プロセッサにより、
飛行体の位置を推定するための複数の位置推定方式の中から選択された位置推定方式を示す情報を取得することと、
前記位置推定方式用のパラメータに従って、前記飛行体の慣性センサを用いて生成される第1の情報と、前記位置推定方式を通じて生成される第2の情報とから、前記飛行体の位置を推定することと、
を含む方法。
(20)
飛行体の位置を推定するための複数の位置推定方式の中から選択された位置推定方式を示す情報を取得することと、
前記位置推定方式用のパラメータに従って、前記飛行体の慣性センサを用いて生成される第1の情報と、前記位置推定方式を通じて生成される第2の情報とから、前記飛行体の位置を推定することと、
をプロセッサに実行させるためのプログラム。
【符号の説明】
【0193】
1 システム
51、93 マーカ
100 飛行体
171 選択部
173 情報取得部
179 位置推定部
200 制御装置
300 操縦装置
400 情報処理装置
410、420 撮像装置