JP3852842B2 - 飛翔体の位置姿勢計測装置 - Google Patents
飛翔体の位置姿勢計測装置 Download PDFInfo
- Publication number
- JP3852842B2 JP3852842B2 JP2003142968A JP2003142968A JP3852842B2 JP 3852842 B2 JP3852842 B2 JP 3852842B2 JP 2003142968 A JP2003142968 A JP 2003142968A JP 2003142968 A JP2003142968 A JP 2003142968A JP 3852842 B2 JP3852842 B2 JP 3852842B2
- Authority
- JP
- Japan
- Prior art keywords
- flying object
- information measured
- posture
- attitude
- measures
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Images
Description
【０００１】
【発明の属する技術分野】
本発明は、機体を自己制御して計画した空路を自律的に飛行しながら、例えば航空写真の撮影や地形測定，森林・海洋の監視等を行う自律飛行飛翔体において、自律飛行制御に求められる飛翔体の飛行位置及び姿勢を精度良く計測する技術に関する。
【０００２】
【従来の技術】
近年、環境計測や各種のＧＩＳ（地理情報システム）構築のための測量など、写真測量とリモートセンシングの応用分野の成長が目覚ましく、環境計測や災害地監視など空中撮影に対するニーズが高まっている。従来ではこのような計測を行うために、人工衛星のデータを用いたり、人が操縦する航空機を利用するなどの方法がとられている。
【０００３】
ところで、人工衛星のデータは希望する日時・場所のデータが撮影されていない場合が多く、航空機は運用費用が高いため、比較的安価に空中から画像等のデータを取得する手法の開発が望まれていた。このような要望から、模型用ラジオコントロール飛行機にカメラ類を搭載して空中撮影を行う手法が注目されているが、使用可能な範囲が電波が届く数百メートルの範囲に限定される問題があった。
【０００４】
【発明が解決しようとする課題】
本発明が解決しようとする課題は、従来のこれらの問題点を解消し、飛翔体の飛行位置や姿勢を高精度に計測し、計画した所定の空路を自律的に飛行しながら航空写真の撮影や地形測定，森林・海洋監視を低コストで実施できるようにする飛翔体の位置姿勢計測装置を提供することにある。
【０００５】
【課題を解決するための手段】
かかる課題を解決した本発明の構成は、
１） 航空機・ヘリコプター又は飛行船の飛翔体に機体のヨー・ピッチ・ロールの角度と角速度を検出計算して姿勢を計測する３軸のジャイロ装置を設け、飛翔体に機体の位置を計測するＧＰＳ装置を設け、ジャイロ装置で計測した姿勢情報をＧＰＳ装置で計測した位置情報で定期的又は不定期的に補正する姿勢補正手段を飛翔体に設け、同姿勢補正手段で補正した位置姿勢情報を出力するようにし、しかも飛翔体に地平を検出して機体の姿勢を計測する放射温度式傾斜センサを設け、ジャイロ装置で計測した姿勢情報を放射温度式傾斜センサで計測した姿勢情報で定期的又は不定期的に補正する姿勢補正手段を飛翔体に設け、同姿勢補正手段で補正した姿勢情報を出力するようにした飛翔体の位置姿勢計測装置
２） 航空機・ヘリコプター又は飛行船の飛翔体に機体のヨーの角度と角速度を検出計算して位置を計測するジャイロ装置を設け、飛翔体に地平を検出して機体の姿勢を計測する放射温度式傾斜センサを設け、ジャイロ装置で計測した姿勢情報を放射温度式傾斜センサで計測した姿勢情報で定期的又は不定期的に補正する姿勢補正手段を飛翔体に設け、飛翔体に機体の位置を計測するＧＰＳ装置を設け、飛翔体に気圧差を検出して高度を検出する気圧センサを設け、ジャイロ装置で計測した姿勢情報をＧＰＳ装置で計測した位置情報で定期的又は不定期的に補正する姿勢補正手段を設け、同姿勢補正手段で補正した位置姿勢情報を出力するようにし、しかも飛翔体に天空方向と地面方向の各放射温度を計測する放射温度計を設け、放射温度式傾斜センサで検出した放射温度情報を放射温度計で計測した放射温度情報で定期的又は不定期的に補正する放射温度補正手段を飛翔体に設け、天候の変動による姿勢の誤測定を防止できるようにした飛翔体の位置姿勢計測装置
３） 飛翔体に気圧差を検出して高度を計測する気圧センサを設け、同気圧センサで計測した高度情報をＧＰＳ装置で計測した高度情報で定期的又は不定期的に補正する高度補正手段を飛翔体に設け、同高度補正手段で補正した高度情報を出力するようにした前記１）記載の飛翔体の位置姿勢計測装置
４） 飛翔体に地磁気を検出して方位を計測する地磁気センサを設け、ジャイロ装置で計測した方位情報を地磁気センサで計測した方位情報で定期的又は不定期的に補正する方位補正手段を飛翔体に設け、同方位補正手段で補正した方位情報を出力するようにした前記１）又は３）いずれか記載の飛翔体の位置姿勢計測装置
にある。
【０００６】
【作用】
ジャイロ装置は出発地から連続的に計測できるが、長時間計測を継続するとドリフトで計測値が徐々にずれる問題がある。一方、ＧＰＳ装置は正確な絶対位置を計測できるが、連続的に計測できないため、高速で飛行する場合は計測が遅れる問題がある。本発明では、ジャイロ装置とＧＰＳ装置を併用し、ジャイロ装置で連続的に計測しながら定期的又は不定期的にＧＰＳ装置で絶対位置を計測してジャイロ装置の計測ずれを補正することで、風等の影響を受けずに高速度域でも連続的に正確な計測ができる。
【０００７】
【発明の実施の形態】
本発明では、より高精度な計測を行えるようにするため、地平を検出して機体の姿勢を計測する放射温度式傾斜センサとジャイロ装置で計測した姿勢情報を放射温度式傾斜センサで計測した姿勢情報で定期的又は不定期的に補正する姿勢補正手段を設けたり、気圧差を検出して高度を計測する気圧センサで計測した高度情報をＧＰＳ装置で計測した高度情報で定期的又は不定期的に補正する高度補正手段を設けたり、地磁気を検出して方位を計測する地磁気センサとジャイロ装置で計測した方位情報を地磁気センサで計測した方位情報で定期的又は不定期的に補正する方位補正手段を設けてもよい。
【０００８】
また、天空方向と地面方向の各放射温度を計測する放射温度計を設け、放射温度式傾斜センサで検出した放射温度情報を放射温度計で計測した放射温度情報に定期的又は不定期的に補正する放射温度補正手段を設け、天候の変動による姿勢の誤測定を防止できるようにしてもよい。本発明でいう飛翔体は、航空機，ヘリコプター，飛行船である。以下、本発明の実施例を図面に基づいて具体的に説明する。
【０００９】
【実施例】
図１〜５に示す実施例は、３軸のジャイロ装置とＧＰＳ装置と２軸の放射温度式傾斜センサと気圧センサと３軸の地磁気センサを設けた飛翔体の位置姿勢計測装置の例である。図１は実施例の位置姿勢計測装置の配置図、図２は実施例の位置姿勢計測装置のブロック図、図３は実施例の飛行方向の計測を示す説明図、図４は実施例の飛行姿勢の計測を示す説明図、図５は実施例の位置姿勢計測のフローである。図中、１は機体、２はＧＰＳ装置、３はジャイロ装置、４は放射温度式傾斜センサ、５は気圧センサ、６は地磁気センサ、７は補正装置、８は空路情報部、９は航行制御装置、Ａは飛翔体である。
【００１０】
実施例の飛翔体Ａは、図１に示すように機体１の前上部にＧＰＳ装置２を設け、機体１の重心位置にヨー・ピッチ・ロールの角度と角速度をそれぞれ検出して機体１の姿勢を連続的に計測する３軸のジャイロ装置３を設け、機体１の重心位置上方に放射温度分布から地平を検出して機体１のピッチ・ロールの姿勢角をそれぞれ計測する２軸の放射温度式傾斜センサ４を設け、機体１の後部に地上からの気圧差を検出して飛行高度を計測する気圧センサ５を設け、ジャイロ装置３の各軸方向部に地磁気を検出して各方位をそれぞれ計測する３軸の地磁気センサ６を設けている。
【００１１】
図２に示すように、ジャイロ装置３のずれた計測値をＧＰＳ装置２・放射温度式傾斜センサ４・気圧センサ５・地磁気センサ６の各計測値に補正する補正装置７を機体１に設け、予め定めた計画空路の情報が記録された空路情報部８を機体１に設け、同空路情報部８の空路情報と補正装置７で計測した飛行路を対比しながら計画空路に沿って飛行するように機体１の姿勢・向き・速度を制御する航行制御装置９を機体１に設けている。
【００１２】
図３において、ｐ０は出発点の座標、ｐｉは現在点の計測座標、ｐｉ−１は前回あるいは数回前の計測座標、ｐｇは目標点の座標を示している。飛翔体Ａの方向制御は、ジャイロ装置３でヨー・ピッチ・ロールの角度でもって、出発点ｐ０から現在位置ｐｉ（Ｘｉ，Ｙｉ）までの飛行で発生する姿勢角変化により方向角θｉを算出し、同計算値と空路情報部８の計画空路とを対比しながら航行制御装置９で飛行制御が成される。ＧＰＳ装置２では数秒おきに絶対位置ｐｉ（Ｘｉ，Ｙｉ）を計測し、前回あるいは数回前の計測値ｐｉ−１（Ｘｉ−１，Ｙｉ−１）とを用いて機体の進行方向角ξｉを算出する。補正装置７はジャイロ装置３で算出した方向角θｉとＧＰＳ装置２で算出した方向角ξｉとを対比してずれ値を算出し、風などによる影響を考慮した後ジャイロ装置３の計測値を補正する。ジャイロ装置３は、その補正された計測値から計測を再開するとともに、航行制御装置９はＧＰＳ装置２の計測位置ｐｉ（Ｘｉ，Ｙｉ）が計画空路からずれている場合はそのズレを補正するように機体１の方向を修正制御する。
【００１３】
飛翔体Ａの姿勢制御は、ジャイロ装置３でピッチとロールの角度を連続的に計測し、予め定めた計画空路に沿って飛行できるように所要の姿勢角に航空制御装置９で成される。図４（ａ），（ｂ）に示すように放射温度式傾斜センサ４では定期的又は不定期的に機体１の前方及び側方の各放射温度分布から地平を検出して仮想水平線を設定し、同仮想水平線からのずれ角で機体１のピッチｘとロールｙの角度を計測し、補正装置７がジャイロ装置３の計測角度と放射温度式傾斜センサ４の計測角度とのずれ値を算出してジャイロ装置３の計測値を補正する。補正装置７はその補正された計測値から計測を再開するとともに、航空制御装置９は計画空路に沿って飛行できるように機体１を所要の姿勢角に修正制御する。
【００１４】
また、気圧センサ５では地上からの気圧差を検出して飛行中の高度を定期的又は不定期的に計測し、補正装置７がＧＰＳ装置２の計測高度と気圧センサ５の計測高度とのずれ値を算出して気圧センサ５の計測値を補正する。補正装置７はその補正された計測値から計測を再開するとともに、航行制御装置９は補正装置７の計測高度が計画空路からずれている場合はそのずれを補正するように機体１を所要の高度に修正制御する。
【００１５】
さらに、地磁気センサ６では地磁気を検出して機体１の向きを定期的又は不定期的に計測し、補正装置７がジャイロ装置３の計測したヨーの角度と地磁気センサ６の計測方位とのずれ値を算出してジャイロ装置３の計測値を補正する。ジャイロ装置３はその補正された計測値から計測を再開するとともに、航行制御装置９は補正装置７の計測方位が目標点ｐｇからずれている場合はそのずれを補正するように機体１の向きを所要の角度に修正制御する。
【００１６】
実施例１はこのように構成したから、ジャイロ装置とＧＰＳ装置を併用することで、ジャイロ装置で連続的に計測しながら定期的又は不定期的にＧＰＳ装置で絶対位置を計測してジャイロ装置の計測ずれが補正され、風等の影響を受けずに高速度域でも連続的に正確な計測ができた。また、放射温度式傾斜センサと気圧センサと地磁気センサで機体の姿勢と飛行中の高度及び方位を計測してジャイロ装置の計測ずれを補正することで、より高精度な位置計測が成され、正確な自律飛行制御が行えるようになった。
【００１７】
図６に示すのは、実施例の飛翔体Ａから地磁気センサを省略した他の例である。図６は実施例の他の例の位置姿勢計測装置の概念図である。この実施例の他の例の飛翔体Ａは、機体１の方位をジャイロ装置３のみで計測するため、比較的速度が遅い場合において低コストで実施される。その他、符号、構成、使用は実施例と同じである。
【００１８】
図７に示すのは、実施例の飛翔体Ａから地磁気センサを省略し、しかもヨー角のみ計測する１軸のジャイロ装置を用いた他の例である。図７は実施例の他の例の位置姿勢計測装置の概念図である。この実施例の他の例の飛翔体Ａは、機体１の向きをジャイロ装置３のみで計測するとともに姿勢角を放射温度式傾斜センサのみで計測するため、比較的安定な機体で飛行する場合においてより低コストで実施される。その他、符号、構成、使用は実施例と同じである。
【００１９】
図８に示すのは、図７に示す実施例の他の例の飛翔体に放射温度計を機体の上下に設けた他の例である。図８は実施例の他の例の位置姿勢計測装置の概念図である。図中、１０は放射温度計である。この実施例の他の例の飛翔体Ａは、図８に示すように機体１の上下に放射温度計１０をそれぞれ設けて天空方向と地面方向の各放射温度を定期的又は不定期的に計測し、その計測値と放射温度式傾斜センサ４で検出した天空方向と地面方向の放射温度差とを対比してずれがある場合に補正し、例えば天候の変動（晴天から曇天など）による機体１の姿勢の誤測定を防止できるようにしている。その他、符号、構成、作用は実施例と同じである。
【００２０】
【発明の効果】
以上説明したように、本発明によれば飛翔体の飛行位置や姿勢を高精度に計測し、計画した所定の空路を自律的に飛行しながら航空写真の撮影や地形測定，森林・海洋監視を低コストで実施し得る飛翔体の位置姿勢計測装置を提供できる。
【図面の簡単な説明】
【図１】実施例の位置姿勢計測装置の配置図である。
【図２】実施例の位置姿勢計測装置のブロック図である。
【図３】実施例の飛行方向の計測を示す説明図である。
【図４】実施例の飛行姿勢の計測を示す説明図である。
【図５】実施例の位置姿勢計測のフローである。
【図６】実施例の他の例の位置姿勢計測装置の配置図である。
【図７】実施例の他の例の位置姿勢計測装置の配置図である。
【図８】実施例の他の例の位置姿勢計測装置の配置図である。
【符号の説明】
１ 機体
２ ＧＰＳ装置
３ ジャイロ装置
４ 放射温度式傾斜センサ
５ 気圧センサ
６ 地磁気センサ
７ 補正装置
８ 空路情報部
９ 航行制御装置
１０ 放射温度計
Ａ 飛翔体
【発明の属する技術分野】
本発明は、機体を自己制御して計画した空路を自律的に飛行しながら、例えば航空写真の撮影や地形測定，森林・海洋の監視等を行う自律飛行飛翔体において、自律飛行制御に求められる飛翔体の飛行位置及び姿勢を精度良く計測する技術に関する。
【０００２】
【従来の技術】
近年、環境計測や各種のＧＩＳ（地理情報システム）構築のための測量など、写真測量とリモートセンシングの応用分野の成長が目覚ましく、環境計測や災害地監視など空中撮影に対するニーズが高まっている。従来ではこのような計測を行うために、人工衛星のデータを用いたり、人が操縦する航空機を利用するなどの方法がとられている。
【０００３】
ところで、人工衛星のデータは希望する日時・場所のデータが撮影されていない場合が多く、航空機は運用費用が高いため、比較的安価に空中から画像等のデータを取得する手法の開発が望まれていた。このような要望から、模型用ラジオコントロール飛行機にカメラ類を搭載して空中撮影を行う手法が注目されているが、使用可能な範囲が電波が届く数百メートルの範囲に限定される問題があった。
【０００４】
【発明が解決しようとする課題】
本発明が解決しようとする課題は、従来のこれらの問題点を解消し、飛翔体の飛行位置や姿勢を高精度に計測し、計画した所定の空路を自律的に飛行しながら航空写真の撮影や地形測定，森林・海洋監視を低コストで実施できるようにする飛翔体の位置姿勢計測装置を提供することにある。
【０００５】
【課題を解決するための手段】
かかる課題を解決した本発明の構成は、
１） 航空機・ヘリコプター又は飛行船の飛翔体に機体のヨー・ピッチ・ロールの角度と角速度を検出計算して姿勢を計測する３軸のジャイロ装置を設け、飛翔体に機体の位置を計測するＧＰＳ装置を設け、ジャイロ装置で計測した姿勢情報をＧＰＳ装置で計測した位置情報で定期的又は不定期的に補正する姿勢補正手段を飛翔体に設け、同姿勢補正手段で補正した位置姿勢情報を出力するようにし、しかも飛翔体に地平を検出して機体の姿勢を計測する放射温度式傾斜センサを設け、ジャイロ装置で計測した姿勢情報を放射温度式傾斜センサで計測した姿勢情報で定期的又は不定期的に補正する姿勢補正手段を飛翔体に設け、同姿勢補正手段で補正した姿勢情報を出力するようにした飛翔体の位置姿勢計測装置
２） 航空機・ヘリコプター又は飛行船の飛翔体に機体のヨーの角度と角速度を検出計算して位置を計測するジャイロ装置を設け、飛翔体に地平を検出して機体の姿勢を計測する放射温度式傾斜センサを設け、ジャイロ装置で計測した姿勢情報を放射温度式傾斜センサで計測した姿勢情報で定期的又は不定期的に補正する姿勢補正手段を飛翔体に設け、飛翔体に機体の位置を計測するＧＰＳ装置を設け、飛翔体に気圧差を検出して高度を検出する気圧センサを設け、ジャイロ装置で計測した姿勢情報をＧＰＳ装置で計測した位置情報で定期的又は不定期的に補正する姿勢補正手段を設け、同姿勢補正手段で補正した位置姿勢情報を出力するようにし、しかも飛翔体に天空方向と地面方向の各放射温度を計測する放射温度計を設け、放射温度式傾斜センサで検出した放射温度情報を放射温度計で計測した放射温度情報で定期的又は不定期的に補正する放射温度補正手段を飛翔体に設け、天候の変動による姿勢の誤測定を防止できるようにした飛翔体の位置姿勢計測装置
３） 飛翔体に気圧差を検出して高度を計測する気圧センサを設け、同気圧センサで計測した高度情報をＧＰＳ装置で計測した高度情報で定期的又は不定期的に補正する高度補正手段を飛翔体に設け、同高度補正手段で補正した高度情報を出力するようにした前記１）記載の飛翔体の位置姿勢計測装置
４） 飛翔体に地磁気を検出して方位を計測する地磁気センサを設け、ジャイロ装置で計測した方位情報を地磁気センサで計測した方位情報で定期的又は不定期的に補正する方位補正手段を飛翔体に設け、同方位補正手段で補正した方位情報を出力するようにした前記１）又は３）いずれか記載の飛翔体の位置姿勢計測装置
にある。
【０００６】
【作用】
ジャイロ装置は出発地から連続的に計測できるが、長時間計測を継続するとドリフトで計測値が徐々にずれる問題がある。一方、ＧＰＳ装置は正確な絶対位置を計測できるが、連続的に計測できないため、高速で飛行する場合は計測が遅れる問題がある。本発明では、ジャイロ装置とＧＰＳ装置を併用し、ジャイロ装置で連続的に計測しながら定期的又は不定期的にＧＰＳ装置で絶対位置を計測してジャイロ装置の計測ずれを補正することで、風等の影響を受けずに高速度域でも連続的に正確な計測ができる。
【０００７】
【発明の実施の形態】
本発明では、より高精度な計測を行えるようにするため、地平を検出して機体の姿勢を計測する放射温度式傾斜センサとジャイロ装置で計測した姿勢情報を放射温度式傾斜センサで計測した姿勢情報で定期的又は不定期的に補正する姿勢補正手段を設けたり、気圧差を検出して高度を計測する気圧センサで計測した高度情報をＧＰＳ装置で計測した高度情報で定期的又は不定期的に補正する高度補正手段を設けたり、地磁気を検出して方位を計測する地磁気センサとジャイロ装置で計測した方位情報を地磁気センサで計測した方位情報で定期的又は不定期的に補正する方位補正手段を設けてもよい。
【０００８】
また、天空方向と地面方向の各放射温度を計測する放射温度計を設け、放射温度式傾斜センサで検出した放射温度情報を放射温度計で計測した放射温度情報に定期的又は不定期的に補正する放射温度補正手段を設け、天候の変動による姿勢の誤測定を防止できるようにしてもよい。本発明でいう飛翔体は、航空機，ヘリコプター，飛行船である。以下、本発明の実施例を図面に基づいて具体的に説明する。
【０００９】
【実施例】
図１〜５に示す実施例は、３軸のジャイロ装置とＧＰＳ装置と２軸の放射温度式傾斜センサと気圧センサと３軸の地磁気センサを設けた飛翔体の位置姿勢計測装置の例である。図１は実施例の位置姿勢計測装置の配置図、図２は実施例の位置姿勢計測装置のブロック図、図３は実施例の飛行方向の計測を示す説明図、図４は実施例の飛行姿勢の計測を示す説明図、図５は実施例の位置姿勢計測のフローである。図中、１は機体、２はＧＰＳ装置、３はジャイロ装置、４は放射温度式傾斜センサ、５は気圧センサ、６は地磁気センサ、７は補正装置、８は空路情報部、９は航行制御装置、Ａは飛翔体である。
【００１０】
実施例の飛翔体Ａは、図１に示すように機体１の前上部にＧＰＳ装置２を設け、機体１の重心位置にヨー・ピッチ・ロールの角度と角速度をそれぞれ検出して機体１の姿勢を連続的に計測する３軸のジャイロ装置３を設け、機体１の重心位置上方に放射温度分布から地平を検出して機体１のピッチ・ロールの姿勢角をそれぞれ計測する２軸の放射温度式傾斜センサ４を設け、機体１の後部に地上からの気圧差を検出して飛行高度を計測する気圧センサ５を設け、ジャイロ装置３の各軸方向部に地磁気を検出して各方位をそれぞれ計測する３軸の地磁気センサ６を設けている。
【００１１】
図２に示すように、ジャイロ装置３のずれた計測値をＧＰＳ装置２・放射温度式傾斜センサ４・気圧センサ５・地磁気センサ６の各計測値に補正する補正装置７を機体１に設け、予め定めた計画空路の情報が記録された空路情報部８を機体１に設け、同空路情報部８の空路情報と補正装置７で計測した飛行路を対比しながら計画空路に沿って飛行するように機体１の姿勢・向き・速度を制御する航行制御装置９を機体１に設けている。
【００１２】
図３において、ｐ０は出発点の座標、ｐｉは現在点の計測座標、ｐｉ−１は前回あるいは数回前の計測座標、ｐｇは目標点の座標を示している。飛翔体Ａの方向制御は、ジャイロ装置３でヨー・ピッチ・ロールの角度でもって、出発点ｐ０から現在位置ｐｉ（Ｘｉ，Ｙｉ）までの飛行で発生する姿勢角変化により方向角θｉを算出し、同計算値と空路情報部８の計画空路とを対比しながら航行制御装置９で飛行制御が成される。ＧＰＳ装置２では数秒おきに絶対位置ｐｉ（Ｘｉ，Ｙｉ）を計測し、前回あるいは数回前の計測値ｐｉ−１（Ｘｉ−１，Ｙｉ−１）とを用いて機体の進行方向角ξｉを算出する。補正装置７はジャイロ装置３で算出した方向角θｉとＧＰＳ装置２で算出した方向角ξｉとを対比してずれ値を算出し、風などによる影響を考慮した後ジャイロ装置３の計測値を補正する。ジャイロ装置３は、その補正された計測値から計測を再開するとともに、航行制御装置９はＧＰＳ装置２の計測位置ｐｉ（Ｘｉ，Ｙｉ）が計画空路からずれている場合はそのズレを補正するように機体１の方向を修正制御する。
【００１３】
飛翔体Ａの姿勢制御は、ジャイロ装置３でピッチとロールの角度を連続的に計測し、予め定めた計画空路に沿って飛行できるように所要の姿勢角に航空制御装置９で成される。図４（ａ），（ｂ）に示すように放射温度式傾斜センサ４では定期的又は不定期的に機体１の前方及び側方の各放射温度分布から地平を検出して仮想水平線を設定し、同仮想水平線からのずれ角で機体１のピッチｘとロールｙの角度を計測し、補正装置７がジャイロ装置３の計測角度と放射温度式傾斜センサ４の計測角度とのずれ値を算出してジャイロ装置３の計測値を補正する。補正装置７はその補正された計測値から計測を再開するとともに、航空制御装置９は計画空路に沿って飛行できるように機体１を所要の姿勢角に修正制御する。
【００１４】
また、気圧センサ５では地上からの気圧差を検出して飛行中の高度を定期的又は不定期的に計測し、補正装置７がＧＰＳ装置２の計測高度と気圧センサ５の計測高度とのずれ値を算出して気圧センサ５の計測値を補正する。補正装置７はその補正された計測値から計測を再開するとともに、航行制御装置９は補正装置７の計測高度が計画空路からずれている場合はそのずれを補正するように機体１を所要の高度に修正制御する。
【００１５】
さらに、地磁気センサ６では地磁気を検出して機体１の向きを定期的又は不定期的に計測し、補正装置７がジャイロ装置３の計測したヨーの角度と地磁気センサ６の計測方位とのずれ値を算出してジャイロ装置３の計測値を補正する。ジャイロ装置３はその補正された計測値から計測を再開するとともに、航行制御装置９は補正装置７の計測方位が目標点ｐｇからずれている場合はそのずれを補正するように機体１の向きを所要の角度に修正制御する。
【００１６】
実施例１はこのように構成したから、ジャイロ装置とＧＰＳ装置を併用することで、ジャイロ装置で連続的に計測しながら定期的又は不定期的にＧＰＳ装置で絶対位置を計測してジャイロ装置の計測ずれが補正され、風等の影響を受けずに高速度域でも連続的に正確な計測ができた。また、放射温度式傾斜センサと気圧センサと地磁気センサで機体の姿勢と飛行中の高度及び方位を計測してジャイロ装置の計測ずれを補正することで、より高精度な位置計測が成され、正確な自律飛行制御が行えるようになった。
【００１７】
図６に示すのは、実施例の飛翔体Ａから地磁気センサを省略した他の例である。図６は実施例の他の例の位置姿勢計測装置の概念図である。この実施例の他の例の飛翔体Ａは、機体１の方位をジャイロ装置３のみで計測するため、比較的速度が遅い場合において低コストで実施される。その他、符号、構成、使用は実施例と同じである。
【００１８】
図７に示すのは、実施例の飛翔体Ａから地磁気センサを省略し、しかもヨー角のみ計測する１軸のジャイロ装置を用いた他の例である。図７は実施例の他の例の位置姿勢計測装置の概念図である。この実施例の他の例の飛翔体Ａは、機体１の向きをジャイロ装置３のみで計測するとともに姿勢角を放射温度式傾斜センサのみで計測するため、比較的安定な機体で飛行する場合においてより低コストで実施される。その他、符号、構成、使用は実施例と同じである。
【００１９】
図８に示すのは、図７に示す実施例の他の例の飛翔体に放射温度計を機体の上下に設けた他の例である。図８は実施例の他の例の位置姿勢計測装置の概念図である。図中、１０は放射温度計である。この実施例の他の例の飛翔体Ａは、図８に示すように機体１の上下に放射温度計１０をそれぞれ設けて天空方向と地面方向の各放射温度を定期的又は不定期的に計測し、その計測値と放射温度式傾斜センサ４で検出した天空方向と地面方向の放射温度差とを対比してずれがある場合に補正し、例えば天候の変動（晴天から曇天など）による機体１の姿勢の誤測定を防止できるようにしている。その他、符号、構成、作用は実施例と同じである。
【００２０】
【発明の効果】
以上説明したように、本発明によれば飛翔体の飛行位置や姿勢を高精度に計測し、計画した所定の空路を自律的に飛行しながら航空写真の撮影や地形測定，森林・海洋監視を低コストで実施し得る飛翔体の位置姿勢計測装置を提供できる。
【図面の簡単な説明】
【図１】実施例の位置姿勢計測装置の配置図である。
【図２】実施例の位置姿勢計測装置のブロック図である。
【図３】実施例の飛行方向の計測を示す説明図である。
【図４】実施例の飛行姿勢の計測を示す説明図である。
【図５】実施例の位置姿勢計測のフローである。
【図６】実施例の他の例の位置姿勢計測装置の配置図である。
【図７】実施例の他の例の位置姿勢計測装置の配置図である。
【図８】実施例の他の例の位置姿勢計測装置の配置図である。
【符号の説明】
１ 機体
２ ＧＰＳ装置
３ ジャイロ装置
４ 放射温度式傾斜センサ
５ 気圧センサ
６ 地磁気センサ
７ 補正装置
８ 空路情報部
９ 航行制御装置
１０ 放射温度計
Ａ 飛翔体
Claims (4)
- 航空機・ヘリコプター又は飛行船の飛翔体に機体のヨー・ピッチ・ロールの角度と角速度を検出計算して姿勢を計測する３軸のジャイロ装置を設け、飛翔体に機体の位置を計測するＧＰＳ装置を設け、ジャイロ装置で計測した姿勢情報をＧＰＳ装置で計測した位置情報で定期的又は不定期的に補正する姿勢補正手段を飛翔体に設け、同姿勢補正手段で補正した位置姿勢情報を出力するようにし、しかも飛翔体に地平を検出して機体の姿勢を計測する放射温度式傾斜センサを設け、ジャイロ装置で計測した姿勢情報を放射温度式傾斜センサで計測した姿勢情報で定期的又は不定期的に補正する姿勢補正手段を飛翔体に設け、同姿勢補正手段で補正した姿勢情報を出力するようにした飛翔体の位置姿勢計測装置。
- 航空機・ヘリコプター又は飛行船の飛翔体に機体のヨーの角度と角速度を検出計算して位置を計測するジャイロ装置を設け、飛翔体に地平を検出して機体の姿勢を計測する放射温度式傾斜センサを設け、ジャイロ装置で計測した姿勢情報を放射温度式傾斜センサで計測した姿勢情報で定期的又は不定期的に補正する姿勢補正手段を飛翔体に設け、飛翔体に機体の位置を計測するＧＰＳ装置を設け、飛翔体に気圧差を検出して高度を検出する気圧センサを設け、ジャイロ装置で計測した姿勢情報をＧＰＳ装置で計測した位置情報で定期的又は不定期的に補正する姿勢補正手段を設け、同姿勢補正手段で補正した位置姿勢情報を出力するようにし、しかも飛翔体に天空方向と地面方向の各放射温度を計測する放射温度計を設け、放射温度式傾斜センサで検出した放射温度情報を放射温度計で計測した放射温度情報で定期的又は不定期的に補正する放射温度補正手段を飛翔体に設け、天候の変動による姿勢の誤測定を防止できるようにした飛翔体の位置姿勢計測装置。
- 飛翔体に気圧差を検出して高度を計測する気圧センサを設け、同気圧センサで計測した高度情報をＧＰＳ装置で計測した高度情報で定期的又は不定期的に補正する高度補正手段を飛翔体に設け、同高度補正手段で補正した高度情報を出力するようにした請求項１記載の飛翔体の位置姿勢計測装置。
- 飛翔体に地磁気を検出して方位を計測する地磁気センサを設け、ジャイロ装置で計測した方位情報を地磁気センサで計測した方位情報で定期的又は不定期的に補正する方位補正手段を飛翔体に設け、同方位補正手段で補正した方位情報を出力するようにした請求項１又は３いずれか記載の飛翔体の位置姿勢計測装置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2003142968A JP3852842B2 (ja) | 2003-05-21 | 2003-05-21 | 飛翔体の位置姿勢計測装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2003142968A JP3852842B2 (ja) | 2003-05-21 | 2003-05-21 | 飛翔体の位置姿勢計測装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2004345435A JP2004345435A (ja) | 2004-12-09 |
| JP3852842B2 true JP3852842B2 (ja) | 2006-12-06 |
Family
ID=33530873
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2003142968A Expired - Fee Related JP3852842B2 (ja) | 2003-05-21 | 2003-05-21 | 飛翔体の位置姿勢計測装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP3852842B2 (ja) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN105698747A (zh) * | 2015-12-09 | 2016-06-22 | 中国空气动力研究与发展中心超高速空气动力研究所 | 一种光幕靶测速中杆状飞行物体姿态参数获取方法 |
Families Citing this family (12)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US7428450B1 (en) | 2003-12-16 | 2008-09-23 | Garmin International, Inc | Method and system for using a database and GPS position data to generate bearing data |
| JP2008201183A (ja) * | 2007-02-17 | 2008-09-04 | Morioka Seiko Instruments Inc | 姿勢制御装置 |
| KR101074279B1 (ko) * | 2008-03-10 | 2011-10-19 | 주식회사 제이캐스트 | 와이맥스 통신방식을 사용하는 비행체를 이용한 감시시스템 |
| KR101213975B1 (ko) | 2010-11-05 | 2012-12-20 | 국방과학연구소 | 비행 중 정렬 장치 및 그 방법 |
| US8996598B2 (en) * | 2012-06-15 | 2015-03-31 | The Boeing Company | Latency compensation |
| KR101220233B1 (ko) * | 2012-06-26 | 2013-01-15 | 대원항업 주식회사 | 자세계를 이용한 항공기의 정사 영상 촬영 및 도화 시스템 |
| CN103076011B (zh) * | 2012-12-26 | 2015-12-23 | 北京兴华机械厂 | 一种用于弹体稳定控制用的微机械陀螺组合 |
| CN103712598B (zh) * | 2013-12-31 | 2014-12-17 | 渤海大学 | 一种小型无人机姿态确定方法 |
| US20150355310A1 (en) * | 2014-06-06 | 2015-12-10 | Faro Technologies, Inc. | Metrology instrument system and method of operating |
| JP2018084528A (ja) * | 2016-11-25 | 2018-05-31 | 株式会社トプコン | 航空写真測量装置及び航空写真測量方法 |
| JP6256898B1 (ja) * | 2017-07-25 | 2018-01-10 | 竹中 正次 | 横風着陸安全装置 |
| WO2020188954A1 (ja) * | 2019-03-15 | 2020-09-24 | 日本電気株式会社 | 制御システム、制御装置、制御対象物、制御方法、及び制御プログラム |
-
2003
- 2003-05-21 JP JP2003142968A patent/JP3852842B2/ja not_active Expired - Fee Related
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN105698747A (zh) * | 2015-12-09 | 2016-06-22 | 中国空气动力研究与发展中心超高速空气动力研究所 | 一种光幕靶测速中杆状飞行物体姿态参数获取方法 |
| CN105698747B (zh) * | 2015-12-09 | 2018-06-05 | 中国空气动力研究与发展中心超高速空气动力研究所 | 一种光幕靶测速中杆状飞行物体姿态参数获取方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| JP2004345435A (ja) | 2004-12-09 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| KR100761011B1 (ko) | 카메라형 태양센서를 이용한 관성항법시스템의자세보정장치 및 방법 | |
| CN109813311B (zh) | 一种无人机编队协同导航方法 | |
| JP4782111B2 (ja) | 輸送手段の位置、姿勢、および／または飛行方向を推定するシステムおよび方法 | |
| US9057627B2 (en) | Low cost flight instrumentation system | |
| US6493631B1 (en) | Geophysical inertial navigation system | |
| CN104503466B (zh) | 一种微小型无人机导航装置 | |
| US9488978B2 (en) | Method for controlling a multi-rotor rotary-wing drone, with cross wind and accelerometer bias estimation and compensation | |
| US6389333B1 (en) | Integrated flight information and control system | |
| US6473676B2 (en) | Method, apparatus and computer program product for estimating airplane attitude with reduced sensor set | |
| JP5383801B2 (ja) | 位置及び経路地図表示用の位置及び経路地図データを生成する装置及び当該データ提供方法 | |
| JP3852842B2 (ja) | 飛翔体の位置姿勢計測装置 | |
| CN105094138A (zh) | 一种用于旋翼无人机的低空自主导航系统 | |
| US8255101B2 (en) | Method and device for estimating at least one wind characteristic on an aircraft | |
| JP6375504B2 (ja) | 経緯度誤差共有システム | |
| CN109782789B (zh) | 一种无人机在卫星导航数据失效后的安全飞行控制方法 | |
| JP6347469B2 (ja) | 気象観測システム | |
| JP2007232443A (ja) | 慣性航法装置およびその誤差補正方法 | |
| KR20140034716A (ko) | 항공우주 플랫폼의 각도 방향을 측정하는 시스템 및 방법 | |
| CN109084760A (zh) | 一种楼宇间导航系统 | |
| US20050040985A1 (en) | System and method for providing improved accuracy relative positioning from a lower end GPS receiver | |
| EP4015993B1 (en) | Aircraft sensor system synchronization | |
| JP2010214979A (ja) | 計算機及び着陸経路計算プログラム及び記録媒体 | |
| US20190063925A1 (en) | Systems and Methods with Dead-Reckoning | |
| JP2022520118A (ja) | 無人航空機の高度から風向および風速度の測定値を決定するためのシステムおよび方法 | |
| US20070088496A1 (en) | Automatic heading and reference system |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20051220 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20060220 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20060706 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20060707 |
|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20060808 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20060901 |
|
| R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100915 Year of fee payment: 4 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100915 Year of fee payment: 4 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110915 Year of fee payment: 5 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120915 Year of fee payment: 6 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130915 Year of fee payment: 7 |
|
| LAPS | Cancellation because of no payment of annual fees |