JP6249864B2 - 飛翔体の慣性航法システム - Google Patents

Description

本発明は、飛翔体の慣性航法システムに関する。

飛翔体の慣性航法システム(INS: Inertial Navigation System)として、ジャイロを有する慣性航法装置が広く使用されている。ジャイロは、３軸の回転角速度を検出し、ジンバルを使用したジャイロや、レーザージャイロ、半導体を利用した加速度センサを組み合わせたものなどが知られている。慣性航法装置は、短時間での精度は良好であるが、長時間では誤差が累積して精度が低下するという問題がある。

さらに、ジャイロを有する慣性航法装置は、ジャイロが検出した角速度から飛行方向を検出し、加速度センサにより検出した飛行速度および高度計により検出した高度などから、位置を算出する。慣性航法装置が検出できるのは飛行方向のみであり、機首方向（飛行方向）は飛行方向に一致しているものとして飛行データを算出している。そのため、飛翔体が風により機首方向（飛行方向）を維持したまま横すべり（スライド）すると、位置ずれ分を加味して機首方向を算出するため、実際の機首方向と算出された機首方向に誤差が発生するという問題がある。

近年、ＧＰＳを使用した移動位置検出システムが広く利用されており、飛翔体の慣性航法システムにおいて、ジャイロを有する慣性航法装置にＧＰＳ機能を付加して精度を向上することが行われている。ＧＰＳによる移動位置検出は、長時間での平均的な誤差が小さく、ジャイロを有する慣性航法装置に組み合わせることにより、長時間での誤差の累積を小さくできる。

しかし、ＧＰＳで検出できるのは位置であり、位置変化から移動方向と移動量を検出するのみであり、上記の横すべりに起因する機首方向算出における誤差は、ＧＰＳによる移動位置検出結果を利用して補正することはできない。

一方、特許文献１は、地上の目標物を高分解能で撮影し、画像誘導方式によって飛翔体を目標物に誘導する誘導装置を記載している。特許文献１によれば、画像安定化装置が、ジャイロの出力から算出された姿勢角に応じて目標物を追尾し、常に目標物を高分解能で撮影可能にする。
特許文献１は、横すべりに起因する機首方向算出における誤差については何ら記載していない。

また、特許文献２は、撮影した周囲画像から道路等を走行する車両の姿勢角を標定するナビゲーションシステムを記載しているが、そもそも飛翔体について記載していない。

特許第２９４５９３３号公報 特許第４９８６８８３号公報

以上説明したように、ジャイロによる慣性航法を利用する飛翔体の慣性航法システムでは、横すべりに起因する機首方向算出において誤差が発生するが、この誤差を低減することが難しかった。

本発明は、横すべりに起因する機首方向算出における誤差を低減した飛翔体の慣性航法システムの実現を目的とする。

上記目的を実現するため、本発明の飛翔体の慣性航法システムは、慣性航法装置と、地上の画像を撮影する撮像装置と、慣性航法装置の検出した慣性データおよび撮像装置が撮影した地上の画像から、飛行データを算出する処理装置と、を備え、処理装置は、慣性データから補正前飛行データを算出する飛行データ算出部と、撮像装置が撮影した地上の画像の変化から、補正前飛行データを補正する補正部と、を備えることを特徴とする。

本発明によれば、撮影した地上の画像の変化から横すべりを検出し、機首方向を含む飛行データを補正する。

一般的なものと同様に、慣性航法装置は、３軸の回転角速度を含む慣性データを出力し、飛行データ算出部は、慣性データに加速度センサおよび高度計等からのデータを合わせて飛行速度、飛行位置、高度および姿勢角を含む補正前飛行データを算出する。

補正部は、撮影した地上の画像の変化から検出した横すべりを利用して、補正前飛行データの飛行位置、速度および姿勢角（機首方向）を補正する。

補正部は、時間間隔をおいて撮影された複数の地上の画像における対応部分の位置変化と、補正前飛行データにより予測される時間間隔における対応部分の画像中での位置変化の差から横すべり角を算出し、算出した横すべり角に基づいて、補正前飛行データの飛行位置、速度および姿勢角を補正する。位置変化を検出する部分は、画像中で領域分割処理等により特定し、その外形形状のマッチング処理などにより特定する。

補正部は、補正前飛行データに基づいて、時間間隔をおいて撮影された複数の地上の画像における重なり部分を決定する画像比較範囲決定部を備え、重なり部分において位置変化を調べる対応部分を決定することが望ましい。これにより、画像処理を行う範囲が限定され、演算処理量を低減できる。

補正部は、補正前慣性飛行データに基づいて、１つの画像において決定した対応部分に対応する部分を他の画像で探索することが望ましい。これにより、他の画像での対応部分の探索が容易になり、演算処理量をさらに低減できる。

補正部は、複数個の対応部分の位置変化を算出し、複数個の対応部分の位置変化の平均を横すべり角の算出に使用することが望ましい。これにより、横すべり角の算出誤差を低減できる。なお、補正部は、横すべり角の算出誤差を低減できる平均以外の他の算出手法を使用してもよい。

補正部は、複数個の対応部分から算出した複数の横すべり角の分散を算出し、算出した分散が所定値以下の時にのみ、算出した横すべり角に基づいて、補正前飛行データの飛行位置および姿勢角を補正する。もし算出した分散が所定値以上の時には、算出した横すべり角の誤差が大きいと考えられるので、補正前飛行データの飛行位置および姿勢角は補正しないようにすることが望ましい。なお、補正部は、算出した横すべり角の信頼度を評価できる分散以外の他の手法を使用してもよい。

補正部は、補正前飛行データに基づいて、複数の地上の画像における重なり部分の画像の倍率、移動および回転を補正することが望ましい。これにより、横すべり角の算出誤差を低減できる。

本発明によれば、飛翔体が上空から撮影した地上の画像の変化に基づいて横すべりを算出するので、算出した横すべりに応じて位置・機首方向を補正することができる。

図１は、実施形態の飛翔体の慣性航法システムの概略構成を示す図である。 図２は、処理装置の機能ブロック図である。 図３は、横すべり角の発生および横すべり角による機首方向の誤差を説明する図である。 図４は、撮像装置で地上を撮影する様子を示す図である。 図５は、図４のようにして撮影した２つの画像の位置関係を示す図であり、（Ａ）は横すべりが無い場合を、（Ｂ）は横すべりがある場合を示す。 図６は、２つの画像の重なり部分に存在する特徴像の対応関係を示す図であり、（Ａ）は横すべりが無い場合を、（Ｂ）は横すべりがある場合を示す。 図７は、２つの画像をそのまま重ねた場合の、上記の特徴像、特徴対応像の関係を示す図であり、（Ａ）は横すべりが無い場合を、（Ｂ）は横すべりがある場合を、（Ｃ）はそれらを重ねた場合を、それぞれ示す。 図８は、飛翔体の高度が異なる場合の影響を説明する図である。 図９は、時間間隔をおいて撮影される２つの画像の高度の違いによる重なり部分の大きさの違いを説明する図である。 図１０は、比較する２つの画像を撮影する時の高度が異なる場合を示す図である。 図１１は、倍率調整により特徴像および特徴対応像の倍率変化を示す図である。 図１２は、特徴像および特徴対応像の探索範囲を説明する図である。

図１は、実施形態の飛翔体の慣性航法システムの概略構成を示す図である。
実施形態の飛翔体の慣性航法システム１０は、航空機、ヘリコプター等の飛翔体１に搭載され、自立航法を行うための飛行データを出力する。慣性航法システム１０は、慣性航法装置１１と、撮像装置１２と、処理装置１３と、を有する。慣性航法装置１１は、ジャイロおよびＧＰＳを有する。ここでは、加速度センサや高度計など飛行軌跡に関係するデータを発生する要素も慣性航法装置１１に含まれ、慣性航法装置１１の出力する慣性データには速度・加速度・高度などのデータも含まれるとして説明する。撮像装置１２は、可視カメラおよび／または赤外線カメラなどを有し、地上１００の画像を上空から撮影する。撮像装置１２は、広角の光学系により比較的広い範囲の画像を撮影する。処理装置１３は、コンピュータなどでソフトウエアにより実現され、慣性航法装置１１からの慣性データに基づいて、飛行位置、高度、機首方向などの飛行データを発生する。慣性航法装置１１および撮像装置１２は、広く知られているものが使用され、本発明を限定するものではないので、慣性航法装置１１および撮像装置１２についての説明は省略する。

図２は、処理装置１３の機能ブロック図である。
処理装置１３は、飛行データ算出部２１と、補正部２２と、を有する。飛行データ算出部２１は、慣性航法装置１１の出力する慣性データに基づいて、飛行位置、高度、機首方向などを含む補正前飛行データを発生する。飛行データ算出部２１は、慣性航法システムで広く知られているものが使用され、本発明を限定するものではないので、飛行データ算出部２１についての説明は省略する。

補正部２２は、飛行データ算出部２１の出力する補正前飛行データおよび撮像装置１２の出力する地上の複数の撮影画像に基づいて横すべり角を算出し、補正前飛行データの位置および姿勢角を補正して飛行データとして出力する。なお、説明を簡単にするために、ここでは２つの画像に基づいて横すべり角を算出する例を説明する。

補正部２２は、画像選択範囲設定部３１と、画像対応付け処理部３２と、視点変換処理部３３と、横すべり角算出部３４と、位置及び姿勢角補正部３５と、を有する。

画像選択範囲設定部３１は、撮像装置１２の出力する撮影画像から横すべり角の算出に利用する画像および画像における範囲を選択する。なお、画像選択範囲設定部３１から、撮像装置１２に撮影タイミング等の指示を行うようにしてもよい。

画像対応付け処理部３２は、比較する画像範囲において、一方の画像で地上の物体を特徴像として決定し、他方の画像でこの物体に対応する特徴対応像を探索し、対応付ける処理を行う。対応付ける特徴像と特徴対応像の組は１つに限定されず、２組以上であることが望ましい。後述するように、特徴像の対応付けは、２つの画像の撮影間隔の間の飛行距離を考慮して行う。

視点変換処理部３３は、撮像装置１２の光軸が地上に対して傾いている時の画像を、地上に対して垂直な光軸となる画像に変換すると共に、比較する画像の倍率（縮尺）を一致させるように変換する。撮像装置１２の光軸が地上に対して傾くのは、機体が水平飛行している時でも機体に搭載された撮像装置１２の光軸が傾いている場合や、機体の機首が地上に対して傾く場合や、機体が機首方向の軸の回りを回転する場合などがある。視点変換処理部３３は、補正前飛行データから、撮影時の撮像装置１２の光軸の地上に対する傾きおよび高度に基づいて、画像を線形変換する。なお、画像の倍率は、比較する２つの画像の重なり部分が同じ倍率になるように変換すればよい。

視点変換処理部３３における処理は、画像選択範囲設定部３１および画像対応付け処理部３２における処理を実行する前に行われる場合も、後に行われる場合もあり得る。例えば、傾きおよび倍率を合わせた後、画像選択範囲設定部３１により２つの画像が重なる範囲を求め、その重なる範囲で特徴像を特定して対応する特徴対応像を探索して特定する。または、傾きおよび倍率を合わせる前に、飛行データに基づいて画像選択範囲設定部３１により２つの画像が重なる範囲を求め、一方の画像の重なる範囲で特徴像をまず特定する。その後、他方の画像の重なる範囲で特徴対応像を求め、特徴像および特徴対応像の部分についてのみ傾きおよび倍率を合わせるようにしてもよい。

横すべり角算出部３４は、２つの画像中で対応付けられた特徴像と特徴対応像を、補正前飛行データに基づき、重ね合わせる。横すべりが無ければ、重ね合わせた特徴像と特徴対応像の位置は一致するはずである。特徴像と特徴対応像に機首方向に垂直な方向の差が生じていた場合、横すべりに起因するものと捉えることができ、位置ずれから横すべり角を算出することができる。

前述のように、画像対応付け処理部３２が対応付ける特徴像と特徴対応像の組は１組に限定されず、複数組であることが望ましい。特徴像と特徴対応像の組が複数組ある場合には、横すべり角算出部３４は、複数組の特徴像と特徴対応像について位置調整を行い、各組について横すべり角を算出し、一例として複数組の横すべり角の平均を横すべり角とする。これにより、算出される横すべり角の誤差を低減できる。なお、平均以外の他の算出手法を使用して、横すべり角の算出誤差を低減してもよい。

さらに、横すべり角算出部３４は、一例として複数組の横すべり角の分散を算出し、算出した横すべり角の分散が所定値以下の時にのみ、算出した横すべり角を決定し、分散が所定値より大きい時には算出不能とする。これにより、算出した横すべり角の信頼度が向上する。なお、分散以外の他の手法を使用して、算出した横すべり角の信頼度を評価してもよい。

位置及び姿勢角補正部３５は、横すべり角算出部３４が算出した横すべり角に基づいて、補正前飛行データの位置および姿勢角を補正して飛行データとして出力する。

以下、処理装置１３の各部の処理を説明する。まず横すべり角の発生およびその影響について説明する。
図３は、横すべり角の発生および横すべり角による機首方向の誤差を説明する図である。

飛翔体（ヘリコプター）１は、時刻ｔでは１Ａの位置を飛行しており、横風が無い状態では機首方向Ｐに飛行し、時刻ｔ＋１では１Ｂの位置を飛行する。ここで横風があり、実際には機首方向Ｐから横すべり角Ｑ傾いたＰ＋Ｑ方向に飛行し、時刻ｔ＋１では１Ｃの位置を飛行する場合が生じたとする。位置１Ｃを飛行している時、飛翔体１の機首方向は、方向Ｐを維持している。

慣性航法装置１１は、飛翔体１の飛行方向しか検出できないので、機首方向はＰであるが、横風のためにＰ＋Ｑの方向に飛行した場合、機首方向はＰ＋Ｑであると仮定して補正前飛行データを算出する。言い換えれば、図３では、横風がある場合、機首方向Ｐを算出できないという問題があり、機首方向Ｐを算出することが求められる。機首方向Ｐを算出するには、横すべり角Ｑを算出し、補正前飛行データの算出した飛行方向Ｐ＋Ｑから横すべり角Ｑを減ずれば算出できる。

実施形態の慣性航法システム１０では、補正部２２が、飛行データ算出部２１の出力する補正前飛行データおよび撮像装置１２の出力する地上の複数の撮影画像に基づいて横すべり角Ｑを算出し、補正前飛行データの算出した飛行方向（＝機首方向）を補正する。さらに、その時点の速度でＰ＋Ｑ方向に飛行した場合と、その時点の速度でＰ方向に飛行し、横風の影響で横すべりした場合の飛行距離は少しではあるが差があるので、その分飛行位置を補正する。

次に、補正部２２における横すべり角の算出方法について説明する。
図４は、撮像装置で地上を撮影する様子を示す図である。

図４では、飛翔体１は、水平に（地上に対して平行に）機首方向を維持しながら飛行しており、時刻ｔとｔ＋１で、撮像装置が地上を撮影する。時刻ｔとｔ＋１は、撮影した２つの画像の一部Ｗが重なるように、言い換えれば２つの画像に地上の同じ部分が含まれるように決定される。

図５は、図４のようにして撮影した２つの画像の位置関係を示す図であり、（Ａ）は横すべりが無い場合を、（Ｂ）は横すべりがある場合を示す。

図５の（Ａ）に示すように、２つの画像は、撮影時刻がずれており、慣性航法装置１１の出力する飛行（移動）速度に撮影の時間間隔を乗じた距離だけ飛行方向にシフトした位置関係にある。そのため、地上の位置が一致するように重ねると、図示のように、時刻ｔの画像に対して、時刻ｔ＋１の画像は飛行方向にずれており、２つの画像はＷで示す部分で重なる。横すべりが無い場合には、２つの画像の２つの側辺（飛行方向に平行な辺）は一致する。

これに対して、横すべりがある場合には、図５の（Ｂ）に示すように、２つの画像は飛行方向だけでなく、飛行方向に垂直な方向にもずれ、２つの画像の２つの側辺にずれが生じる。

図６は、２つの画像の重なり部分に存在する特徴像の対応関係を示す図であり、（Ａ）は横すべりが無い場合を、（Ｂ）は横すべりがある場合を示す。

図６において、２つの画像は、図示の都合で重ならないように飛行方向にさらに所定量ずらしている。Ｔ１からＴ４は、時刻ｔの画像における複数の特徴像である。図６の（Ａ）において、Ｔ１’からＴ４’は、時刻ｔ＋１の画像におけるＴ１からＴ４に対応する複数の特徴像である。図６の（Ｂ）において、Ｔ１’’からＴ４’’は、時刻ｔ＋１の画像におけるＴ１からＴ４に対応する複数の特徴像である。

図６の（Ａ）に示すように、横すべりが無い場合には、Ｔ１’からＴ４’は、Ｔ１からＴ４を飛行方向に所定量ずらした位置関係にある。言い換えれば、飛行方向に所定量ずらさなければ、Ｔ１’からＴ４’は、Ｔ１からＴ４に重なる（一致する）。

これに対して、図６の（Ｂ）に示すように、横すべりがある場合には、Ｔ１’’からＴ４’’は、Ｔ１からＴ４を飛行方向に所定量ずらした上でさらに横すべりの分だけ飛行方向に垂直な方向にずらした位置関係にある。

図７は、２つの画像をそのまま重ねた場合の、上記の特徴像Ｔ１からＴ４、特徴対応像Ｔ１’からＴ４’およびＴ１’’からＴ４’’の関係を示す図であり、（Ａ）は横すべりが無い場合を、（Ｂ）は横すべりがある場合を、（Ｃ）はそれらを重ねた場合を、それぞれ示す。

２つの画像をそのまま重ねた場合、図７の（Ａ）に示すように、Ｔ１’からＴ４’は、Ｔ１からＴ４を、時間間隔の間の飛行量だけ飛行方向にシフトした関係にある。一方、図７の（Ｂ）に示すように、Ｔ１’からＴ４’は、Ｔ１からＴ４を、時間間隔の間の飛行量だけ飛行方向にシフトし、さらに横すべりの分飛行方向に垂直な方向にずらした関係にある。したがって、Ｔ１からＴ４、Ｔ１’からＴ４’およびＴ１’’からＴ４’’を１つに合わせると、図７の（Ｃ）に示すように、Ｔ１からＴ１’に向かうベクトルとＴ１からＴ１’’に向かうベクトル、横すべり角Ｑをなす。他のＴ２〜Ｔ４についても同様である。

以上説明したように、比較する２つの画像の一方における特徴像から、撮影の時間間隔の間の飛行量分シフトしたベクトルと、２つの画像の一方における上記の特徴像に対応する特徴対応像の位置までのベクトルのなす角が、横すべり角である。したがって、この２つのベクトルを算出し、そのなす角を算出すれば横すべり角が算出できる。横すべり角を算出するために利用する特徴像は２つの画像の重なり部分に存在するので、一方の画像で特徴像を特定した後、他方の画像で特徴対応像を探索する場合は、重なり部分に限定される。そのため、画像全体を探索するのに比べて特徴対応像を探索するのが容易で処理時間を短縮できる。

以上、撮像装置１２により撮影した画像から横すべり角を算出する基本的な処理について説明したが、その処理は、撮像装置の光軸が水平な地面に垂直で、同じ倍率で撮影されている２つの画像を比較することにより行われる。もしこの条件が満たされない時には、視点変換処理部３３により２つの画像をこの条件を満たすように変換する必要がある。前述のように、視点変換処理部３３における処理は、画像選択範囲設定部３１および画像対応付け処理部３２における処理を実行する前に行われる場合も、後に行われる場合もあり得る。ここでは、画像選択範囲設定部３１および画像対応付け処理部３２における処理を実行する前に行われる場合を例として説明する。

図８は、飛翔体１の高度が異なる場合の影響を説明する図である。
図８に示すように、撮像装置の画角が同じ場合、飛翔体１の高度が低い場合は地上の撮像範囲は狭く、高度が高い場合は地上の撮像範囲は広くなる。

図９は、時間間隔をおいて撮影される２つの画像の高度の違いによる重なり部分Ｗの大きさの違いを説明する図である。

いま、飛翔体１が同じ飛行速度Ｎ（ｍ／ｓｅｃ）で飛行しており、１秒（ｓｅｃ）間隔で２つの画像を撮影する場合を考える。飛行速度が同じであるから、２つの画像の中心間の距離は、飛翔体１の高度が低い場合も高い場合も同じである。しかし、飛翔体１の高度が低い場合は撮影範囲が狭く、高い場合は撮影範囲が広いため、２つの画像の重なり部分の幅Ｗは、飛翔体１の高度が低い場合は狭く、高い場合は広くなる。本発明では、撮影して比較する２つの画像は重なり部分を有することが必要であり、十分な精度で横すべり角を算出するには、重なり部分がある程度以上の幅を有することが求められる。そこで、撮像装置の光学系の特性、飛翔条件に応じて、適度な重なりを持った２つの画像を取得できるように、撮像レート（撮影の時間間隔）を設定する必要がある。

図１０は、比較する２つの画像を撮影する時の高度が異なる場合を示す図である。
図１０では、飛翔体１が上昇中に所定の時間間隔で２つの画像を撮影した場合であり、最初に撮影された画像がＡであり、後で撮影された画像がＢである。高さが異なるので、画像の倍率も異なる。ここでの倍率は、地上の所定距離とそれに対応する画像上の距離の比であり、高度が２倍になれば倍率は１／２倍になる。例えば、飛翔体１の高度が５００ｍの時には地上で１０ｍの距離が画像では１０ｍｍとした場合，倍率＝１／１０００であり、高度が１０００ｍの時には地上で１０ｍの距離が画像では５ｍｍとなり、倍率＝１／２０００であり、倍率は１／２となる。

視点変換処理部３３は、比較する２つの画像の倍率を一致させるように倍率を変換する。この変換は、比較する２つの画像の重なり部分の倍率を一致させればよく、２つの画像を撮影する時の高度差に応じて倍率の調整値を設定する。例えば、飛翔体は同じ高度で飛行しているが、地面が斜めの場合があるが、この場合も、比較する２つの画像の重なり部分は飛翔体に対して同じ距離であり、倍率は同じである。

図１０に示すように、画像の倍率が異なるため、画像Ａの特徴像と画像Ｂの特徴対応像の大きさも異なる。上記のように、視点変換処理部３３により２つの画像の倍率が一致するように変換すると、特徴像と特徴対応像の大きさも一致する。

図１１は、倍率調整により特徴像および特徴対応像の倍率変化を示す図である。
図１１において、倍率が不一致のため、画像Ａの特徴像と画像Ｂの特徴対応像の大きさは異なるが、２つの画像ＡとＢを撮影した時の高度差に応じて画像Ａの倍率を画像Ｂの倍率に一致するように画像Ａ’に変換する。画像Ａ’における特徴像と、画像Ｂの特徴対応像の大きさは一致し、対応関係を正確に判定できる。

なお、高度だけでなく、撮像装置の光軸が、２つの画像の撮影時で異なる場合がある。このような場合には、視点変換処理部３３は、撮像装置１２の光軸が地上に対して傾いている時の画像を、地上に対して垂直な光軸となる画像に変換する。

補正部２２で横すべり角算出のために利用する特徴像および特徴対応像は、２つの画像の重なり部分にのみ存在する。重なり部分の範囲は、補正前飛行データから概略知ることができる。

図１２は、特徴像および特徴対応像の探索範囲を説明する図である。
図１２において、Ａが時刻ｔに撮影された画像の一部で、Ｂが時刻ｔ＋１に撮影された画像の一部で、画像ＡとＢは、中心が飛行距離に相当する分、離されて配置されているとする。画像ＡとＢの重なっている部分が重なり部分であり、Ｔが画像Ａにおける特徴像を、Ｔ’が画像Ｂにおける特徴対応像を示す。特徴像Ｔおよび特徴対応像Ｔ’を特定し探索するのは重なり部分に相当する枠Ｃで示した範囲である。したがって、特徴像Ｔおよび特徴対応像Ｔ’を特定し探索する範囲は狭く、探索が容易で処理時間は短い。

特徴像は、重なり部分において、例えば、地上の構造物等の外形等が特定しやすい画像要素を選択することが望ましい。特徴像と特徴対応像が対応するか否かの判定は、例えばパターンマッチングにより行われる。一致度が高いものが選択され、一致度に応じて、後述する信頼度を設定してもよい。

特徴像は、１つでも横すべり角の算出は可能であるが、複数の特徴像を特定し、複数の特徴像と特徴対応像の組のそれぞれから横すべり角を算出し、それらの平均から横すべり角を決定することが望ましい。なお、算出した複数の横すべり角の中間値や最小自乗近似等を算出する平均以外の他の算出手法を使用してもよい。また、算出した複数の横すべり角について分散を算出し、分散に応じて信頼度を設定してもよい。これについても後述する分散以外の他の手法を使用して、算出した横すべり角の信頼度を評価してもよい。

上記の例では、視点変換処理部３３により重なり部分の２つの画像の位置および倍率を合わせる処理を行った後、特徴像および特徴対応像を対応付ける処理および横すべり角の算出処理を行ったが、先に特徴像および特徴対応像を対応付ける処理を行うことも可能である。この場合、２つの画像の重なり部分の大まかな位置関係は補正前飛行データからわかっているので、一方の画像の重なり部分から特徴像を決定し、他方の画像で特徴対応像を探索し対応付ける。その後、特徴像および特徴対応像の部分についてのみ視点変換処理を行うようにしてもよい。

この場合も、特徴像に対する特徴対応像の位置は補正前飛行データから大まかに判明しているのでその範囲を探索すればよく、探索は容易である。特に、１組の特徴像と特徴対応像の対応関係が判明すると、他の特徴像および特徴対応像の組も類似の位置関係を有していると推定されるので、探索は一層容易である。

位置および姿勢角補正部３５は、横すべり角算出部３４の算出した横すべり角に応じて補正前飛行データの機首方向および飛行位置を補正するが、上記の信頼度が低い場合には補正を行わないようにすることが望ましい。

信頼度は、上記の複数の特徴像と特徴対応像の組がある場合の複数の横すべり角の分散や、特徴像と特徴対応像の一致度を利用する。また、横すべり角の算出に用いた特徴像と特徴対応像の組数を利用してもよい。さらに、視点変換処理部３３の変換処理時のシフト量の大きさを利用してもよい。視点変換処理部３３の変換処理時のシフト量が大きくなるのは、撮像装置の光軸が２つの画像の撮像時に大きく変化している場合であり、例えば飛翔体が旋回する場合などが考えられる。このような場合には、視点変換しても２つの画像の重なり範囲内での対応は部分的に大きく異なることが考えられるので、信頼度が低いと判断して機首方向および飛行位置の補正は行わないようにすることが望ましい。さらに、２つの画像の撮像時に機首方向が変化していない場合に限定して、機首方向および飛行位置の補正を行うようにしてもよい。このように、何らかのパラメータを設定し、パラメータに応じて機首方向および飛行位置の補正の有無を決定することが望ましい。

本発明は、慣性航法装置を有し、慣性航法を行う飛翔体の航法に適用可能である。

１ 飛翔体
１０ 慣性航法システム
１１ 慣性航法装置
１２ 撮像装置
１３ 処理装置
２１ 飛行データ算出部
２２ 補正部
３１ 画像選択範囲設定部
３２ 画像対応付け処理部
３３ 視点変換処理部
３４ 横すべり角算出部
３５ 位置及び姿勢角補正部

Claims (7)

1. 慣性航法装置と、
   地上の画像を撮影する撮像装置と、
   前記慣性航法装置の検出した慣性データおよび前記撮像装置が撮影した地上の画像から、飛行データを算出する処理装置と、を備え、
   前記処理装置は、
   前記慣性データから補正前飛行データを算出する飛行データ算出部と、
   前記撮像装置が撮影した地上の画像の変化から、前記補正前飛行データを補正する補正部と、を備え、
   前記補正部は、時間間隔をおいて撮影された複数の地上の画像における対応部分の位置変化と、前記補正前飛行データにより予測される前記時間間隔における前記対応部分の画像中での位置変化の差から横すべり角を算出し、算出した前記横すべり角に基づいて、前記補正前飛行データの飛行位置および姿勢角を補正することを特徴とする飛翔体の慣性航法システム。
2. 前記慣性データは、３軸の回転角速度を含み、
   前記補正前飛行データは、飛行速度、飛行位置、高度および姿勢角を含む請求項１に記載の飛翔体の慣性航法システム。
3. 前記補正部は、前記補正前飛行データに基づいて、時間間隔をおいて撮影された複数の地上の画像における重なり部分を決定する画像比較範囲決定部を備え、前記重なり部分において位置変化を調べる前記対応部分を決定する請求項１に記載の飛翔体の慣性航法システム。
4. 前記補正部は、前記補正前飛行データに基づいて、１つの画像において決定した前記対応部分に対応する部分を他の画像で探索する請求項３に記載の飛翔体の慣性航法システム。
5. 前記補正部は、複数個の前記対応部分の位置変化を算出し、複数個の対応部分の位置変化の平均を横すべり角の算出に使用する請求項１から４のいずれか１項に記載の飛翔体の慣性航法システム。
6. 前記補正部は、複数個の対応部分から算出した複数の横すべり角の分散を算出し、算出した分散が所定値以下の時にのみ、算出した前記横すべり角に基づいて、前記補正前飛行データの飛行位置および姿勢角を補正する請求項５に記載の飛翔体の慣性航法システム。
7. 前記補正部は、前記補正前飛行データに基づいて、前記複数の地上の画像における重なり部分の画像の倍率、移動および回転を補正する請求項１から６のいずれか１項に記載の飛翔体の慣性航法システム。

Images