JP7482757B2 - 航空機の位置制御システム、航空機、及び航空機の位置制御方法 - Google Patents
航空機の位置制御システム、航空機、及び航空機の位置制御方法 Download PDFInfo
- Publication number
- JP7482757B2 JP7482757B2 JP2020189571A JP2020189571A JP7482757B2 JP 7482757 B2 JP7482757 B2 JP 7482757B2 JP 2020189571 A JP2020189571 A JP 2020189571A JP 2020189571 A JP2020189571 A JP 2020189571A JP 7482757 B2 JP7482757 B2 JP 7482757B2
- Authority
- JP
- Japan
- Prior art keywords
- aircraft
- relative
- acceleration
- attitude
- landing point
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims description 21
- 230000001133 acceleration Effects 0.000 claims description 156
- 238000012545 processing Methods 0.000 claims description 97
- 238000009499 grossing Methods 0.000 claims description 48
- 238000012937 correction Methods 0.000 claims description 44
- 230000000295 complement effect Effects 0.000 claims description 34
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical group C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 claims description 28
- 238000013016 damping Methods 0.000 claims description 7
- 230000010355 oscillation Effects 0.000 claims description 3
- 239000003550 marker Substances 0.000 description 27
- 238000010586 diagram Methods 0.000 description 15
- 238000003384 imaging method Methods 0.000 description 8
- 230000008859 change Effects 0.000 description 6
- 230000008569 process Effects 0.000 description 6
- 238000006073 displacement reaction Methods 0.000 description 4
- 230000000694 effects Effects 0.000 description 4
- 238000005259 measurement Methods 0.000 description 3
- 230000003534 oscillatory effect Effects 0.000 description 3
- 230000004044 response Effects 0.000 description 3
- 238000012546 transfer Methods 0.000 description 3
- 230000000452 restraining effect Effects 0.000 description 2
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 2
- 206010034719 Personality change Diseases 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 239000003086 colorant Substances 0.000 description 1
- 150000001875 compounds Chemical class 0.000 description 1
- 230000004069 differentiation Effects 0.000 description 1
- 230000006698 induction Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/12—Target-seeking control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64D—EQUIPMENT FOR FITTING IN OR TO AIRCRAFT; FLIGHT SUITS; PARACHUTES; ARRANGEMENT OR MOUNTING OF POWER PLANTS OR PROPULSION TRANSMISSIONS IN AIRCRAFT
- B64D45/00—Aircraft indicators or protectors not otherwise provided for
- B64D45/04—Landing aids; Safety measures to prevent collision with earth's surface
- B64D45/08—Landing aids; Safety measures to prevent collision with earth's surface optical
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
- G05D1/106—Change initiated in response to external conditions, e.g. avoidance of elevated terrain or of no-fly zones
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/20—Control system inputs
- G05D1/24—Arrangements for determining position or orientation
- G05D1/244—Arrangements for determining position or orientation using passive navigation aids external to the vehicle, e.g. markers, reflectors or magnetic means
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/60—Intended control result
- G05D1/656—Interaction with payloads or external entities
- G05D1/686—Maintaining a relative position with respect to moving targets, e.g. following animals or humans
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
- B64U2101/00—UAVs specially adapted for particular uses or applications
- B64U2101/30—UAVs specially adapted for particular uses or applications for imaging, photography or videography
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
- B64U2201/00—UAVs characterised by their flight controls
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D2107/00—Specific environments of the controlled vehicles
- G05D2107/25—Aquatic environments
- G05D2107/27—Oceans
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D2109/00—Types of controlled vehicles
- G05D2109/20—Aircraft, e.g. drones
- G05D2109/25—Rotorcrafts
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D2111/00—Details of signals used for control of position, course, altitude or attitude of land, water, air or space vehicles
- G05D2111/10—Optical signals
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Feedback Control In General (AREA)
- Navigation (AREA)
Description
本開示は、航空機の位置制御システム、航空機、及び航空機の位置制御方法に関するものであり、特に、航空機の空間安定ホバリングのための位置制御に関するものとなっている。
従来、機体姿勢変化時に生じるビーム長変化速度に起因するドプラ周波数偏移による速度誤差の影響を低減し、良好な精度で位置情報を出力する機能を付加したドプラ航法装置が知られている(例えば、特許文献1参照)。このドプラ航法装置では、ビーム長変化により生じる速度誤差を補正する補正量を求めている。
特許文献1では、航空機から地表面へ向けて電波を送信するドプラ航法装置を用いている。ドプラ航法装置では、速度誤差を補正して機体の速度を計測している。ドプラ航法装置において計測した機体の速度は、機体の位置を飛行制御するために用いられる。飛行制御において、補正後の機体の速度を用いることができれば、目標着地点から位置がずれにくいものにすることができる。
一方で、機体の位置を飛行制御するために、機体の加速度を計測し、計測した加速度に基づく飛行制御を行うことが知られている。
航空機を目標座標に安定的にホバリングさせる場合、入力情報として、加速度計により計測した機体の加速度を用いて、航空機の飛行制御を行う。この場合、加速度計により取得した加速度の出力値には、ドリフト現象によるドリフト成分が含まれることがある。ドリフト成分を含む加速度の出力値を用いて、航空機をホバリングさせると、精度の良い加速度を得ることが困難であることから、本来の目標着地点から位置がずれてしまい、目標着地点上の高精度なホバリングが困難となる。
そこで、本開示は、空間上における航空機の位置を安定的に保持させることができる航空機の位置制御システム、航空機、及び航空機の位置制御方法を提供することを課題とする。
本開示の航空機の位置制御システムは、動揺する目標着地点に対して、空間上の目標座標に航空機を保持させる航空機の位置制御システムであって、前記航空機の加速度と前記航空機の姿勢とに基づいて、前記航空機の加速度を補正した第1姿勢補正加速度を出力する加速度補正処理部と、前記第1姿勢補正加速度と前記航空機の慣性速度とに基づいて、前記第1姿勢補正加速度に含まれるドリフト成分を除去した第2姿勢補正加速度を出力する相補フィルタと、前記第2姿勢補正加速度と、前記航空機と前記目標着地点との間の相対座標とに基づいて、前記相対座標を平滑化した平滑化相対座標を出力する平滑化処理部と、を備える。
本開示の航空機は、航空機の加速度を取得する加速度取得部と、前記航空機の姿勢を取得する姿勢取得部と、前記航空機の慣性速度を取得する慣性速度取得部と、前記航空機の相対座標を取得する相対座標取得部と、上記の航空機の位置制御システムと、を備える。
本開示の航空機の位置制御方法は、動揺する目標着地点に対して、空間上の所定座標に航空機を保持させる航空機の位置制御方法であって、前記航空機の加速度と前記航空機の姿勢とに基づいて、前記航空機の加速度を補正した第1姿勢補正加速度を出力するステップと、前記第1姿勢補正加速度と前記航空機の慣性速度とに基づいて、前記第1姿勢補正加速度に含まれるドリフト成分を除去した第2姿勢補正加速度を出力するステップと、前記第2姿勢補正加速度と、前記航空機と前記目標着地点との間の相対座標とに基づいて、前記相対座標を平滑化した平滑化相対座標を出力するステップと、を備える。
本開示によれば、目標着地点が動揺する場合であっても、その影響を受けず、目標着地点の動揺の平均的な位置を、航空機側で得られる情報のみで、安定的に保持させることができる。
以下に、本開示に係る実施形態を図面に基づいて詳細に説明する。なお、この実施形態によりこの発明が限定されるものではない。また、下記実施形態における構成要素には、当業者が置換可能かつ容易なもの、あるいは実質的に同一のものが含まれる。さらに、以下に記載した構成要素は適宜組み合わせることが可能であり、また、実施形態が複数ある場合には、各実施形態を組み合わせることも可能である。
[実施形態]
図1は、本実施形態にかかる航空機の位置制御システムの一例を示す概略構成図であり、図2は、本実施形態にかかる航空機が目標着地点に向かう様子を示す説明図である。
図1は、本実施形態にかかる航空機の位置制御システムの一例を示す概略構成図であり、図2は、本実施形態にかかる航空機が目標着地点に向かう様子を示す説明図である。
図1に示すように、航空機1は、回転翼機としての飛行体(例えばヘリコプタ、ドローン等)である。本実施形態において、航空機1は、無人機である。なお、航空機1は、前進、後進、横進、旋回、ホバリングが可能な飛行体であればよく、有人機であってもよい。航空機1は、位置制御システム100を搭載しており、位置制御システム100により飛行が制御され、図2に示す目標着地点2に着地する。
(目標着地点)
本実施形態において、目標着地点2は、図2に示すように、船舶5上に設けられている。このため、航空機1は、水上を移動する移動体としての船舶5に着地(着艦)する。なお、船舶5には、図示省略するが、目標着地点2に航空機1を着地させた際に、航空機1を拘束するための拘束装置が設けられている。ただし、目標着地点2は、船舶5に限らず、地上を移動する移動体としての車両等に設けられてもよいし、移動しない設備、地面に設けられてもよい。
本実施形態において、目標着地点2は、図2に示すように、船舶5上に設けられている。このため、航空機1は、水上を移動する移動体としての船舶5に着地(着艦)する。なお、船舶5には、図示省略するが、目標着地点2に航空機1を着地させた際に、航空機1を拘束するための拘束装置が設けられている。ただし、目標着地点2は、船舶5に限らず、地上を移動する移動体としての車両等に設けられてもよいし、移動しない設備、地面に設けられてもよい。
目標着地点2には、航空機1が目標着地点2の位置を捕捉するためのマーカー7が設けられている。図3は、目標着地点に設けられるマーカーの一例を示す説明図である。図示するように、マーカー7は、例えば白黒の2色で色分けされたARマーカーであり、正方形状のマーカーである。なお、マーカー7は、ARマーカーに限らず、画像処理により目標着地点2の位置を捕捉することができるマーカーであればよく、例えばヘリポートの着地点を示すHマーク、Rマーク等であってもよい。また、マーカー7は、船舶5に異なる形状のマーカーが複数設けられてもよく、航空機1は、異なるマーカー7のいずれかに対応した目標着地点2に誘導されるものであってもよい。また、本実施形態では、目標着地点2の位置を捕捉するために、船舶5にマーカー7を設けたが、目標着地点2の位置を取得可能な構成であれば、特に限定されない。
(位置制御システム)
本実施形態にかかる航空機の位置制御システム100は、飛行中の航空機1を目標着地点2に着地させるために、航空機1の位置を制御するシステムである。位置制御システム100は、航空機1に搭載される。位置制御システム100は、図1に示すように、カメラ10と、航法装置20と、制御部30とを備える。
本実施形態にかかる航空機の位置制御システム100は、飛行中の航空機1を目標着地点2に着地させるために、航空機1の位置を制御するシステムである。位置制御システム100は、航空機1に搭載される。位置制御システム100は、図1に示すように、カメラ10と、航法装置20と、制御部30とを備える。
カメラ10は、航空機1に図示しないジンバルを介して搭載された撮影装置である。カメラ10は、マーカー7を撮影することができれば、単眼カメラ、複眼カメラ、赤外線カメラ等であってもよい。カメラ10は、航空機1から目標着地点2に設けられたマーカー7を撮影するために設けられる。カメラ10は、図示しないジンバルを介して撮影方向を調整可能とされている。本実施形態において、カメラ10は、その撮影範囲B(図2参照)が、一例として、鉛直方向の真下を向くように制御部30によって制御される。なお、カメラ10は、撮影範囲Bが、鉛直方向に対して斜め前方側を向くように制御部30によって制御されてもよい。また、カメラ10は、ジンバルを省いてもよく、撮影方向が鉛直方向の下方側を向くように、航空機1の機体直下に固定してもよい。
航法装置20は、例えば、慣性航法装置(INS:Inertial Navigation System)である。なお、本実施形態において、航法装置20は、慣性航法装置に適用して説明するが、特に限定されず、いずれの航法装置20を用いてもよい。また、航法装置20は、位置の計測精度を向上させるために、GPS(Global Positioning System)を含んだ慣性航法装置としてもよい。本実施形態では、GPSを含んだ慣性航法装置に適用して説明するが、GPSに特に限定されず、精度よく位置を計測可能な位置計測部であればよく、例えば、準天頂衛星システムを用いたものであってもよいし、航法装置20のみで精度よく位置を計測可能であれば、GPS等の位置計測部を省いた構成であってもよい。
GPSを含んだ航法装置20は、航空機1のロール方向、ヨー方向およびピッチ方向の姿勢角、航空機1の機体速度、慣性速度、機体加速度、機首方位および地球座標系における位置座標等を取得する。なお、航法装置20は、航空機1の姿勢角を検出する姿勢角センサ、航空機1の機体速度を検出する速度センサ、航空機1の機体加速度を検出する加速度センサ、航空機1の機首方位を検出するセンサを有するものであってもよい。航法装置20は、取得した航空機1の姿勢角、機体速度、慣性速度、機体加速度、機首方位および位置座標を、制御部30に出力する。このように、航法装置20は、航空機1の加速度を取得する加速度取得部、航空機1の姿勢を取得する姿勢取得部、航空機1の慣性速度を取得する慣性速度取得部として機能している。
また、位置制御システム100は、図1に示すように、航空機1の地表面または水面からの高度を検出する高度センサ25を備えている。高度センサ25は、例えば、レーザ高度計であり、航空機1から目標着地点2までの相対高度Δh(図2参照)を計測している。なお、高度センサ25としては、電波高度計を用いてもよいし、気圧高度計を用いてもよく、いずれの高度計を用いてもよい。また、これらの高度計を、使用環境に応じて、すなわち地表面からの高度、海面からの高度を計測するために、適宜組み合わせて適用してもよい。高度センサ25は、検出した航空機1の相対高度Δhを制御部30に出力する。なお、高度センサ25は、航空機1の高度を計測して制御部30に出力し、制御部30は、後述する誘導演算部34において、航空機1の高度に基づいて、目標着地点2までの相対高度Δhを算出するものであってもよい。また、位置制御システム100は、高度センサ25に限らず、後述する画像処理部32において、カメラ10で撮影したマーカー7を含む画像に画像処理を施すことで、航空機1と船舶5との相対高度Δhを算出するものであってもよい。
(制御部)
制御部30は、画像処理部32と、誘導演算部34と、飛行制御部36とを有する。なお、制御部30は、航空機1に設けられた図示しないジンバルを介して、カメラ10の撮影方向を制御する図示しない撮影制御部を備えている。本実施形態では、上述したように、カメラ10の撮影範囲Bが鉛直方向の真下を向くように調整される。
制御部30は、画像処理部32と、誘導演算部34と、飛行制御部36とを有する。なお、制御部30は、航空機1に設けられた図示しないジンバルを介して、カメラ10の撮影方向を制御する図示しない撮影制御部を備えている。本実施形態では、上述したように、カメラ10の撮影範囲Bが鉛直方向の真下を向くように調整される。
(画像処理部)
画像処理部32は、カメラ10で撮影された画像に画像処理を施して、マーカー7すなわち目標着地点2の中心(Cx,Cy)(図3参照)を算出する。ここでの中心(Cx,Cy)は、カメラ10で撮影された画像の中心を原点とするカメラ固定座標系における座標点であり、画像中心からの画素数により算出することができる。具体的には、画像処理部32は、図3に示すように、画像処理によってマーカー7の角部同士の間を延びる対角線Ldを2つ特定し、特定した2つの対角線Ldの交点をマーカー7の中心(Cx,Cy)とする。なお、目標着地点2は、マーカー7の中心(Cx,Cy)に限定されず、マーカー7の四隅のいずれかであってもよいし、マーカー7の中心からオフセットした位置であってもよい。画像処理部32は、算出したマーカー7の中心(Cx,Cy)を誘導演算部34に出力する。
画像処理部32は、カメラ10で撮影された画像に画像処理を施して、マーカー7すなわち目標着地点2の中心(Cx,Cy)(図3参照)を算出する。ここでの中心(Cx,Cy)は、カメラ10で撮影された画像の中心を原点とするカメラ固定座標系における座標点であり、画像中心からの画素数により算出することができる。具体的には、画像処理部32は、図3に示すように、画像処理によってマーカー7の角部同士の間を延びる対角線Ldを2つ特定し、特定した2つの対角線Ldの交点をマーカー7の中心(Cx,Cy)とする。なお、目標着地点2は、マーカー7の中心(Cx,Cy)に限定されず、マーカー7の四隅のいずれかであってもよいし、マーカー7の中心からオフセットした位置であってもよい。画像処理部32は、算出したマーカー7の中心(Cx,Cy)を誘導演算部34に出力する。
また、画像処理部32は、カメラ10で撮影したマーカー7を含む画像に画像処理を施すことで、マーカー7の向きを特定し、航法装置20で取得される航空機1の機首方位と対応づけることで、船舶5の船首方位を算出してもよい。なお、画像処理部32は、上述したように、カメラ10で撮影したマーカー7を含む画像に画像処理を施すことで、航空機1と船舶5との相対高度Δhを算出するものであってもよい。
(誘導演算部)
誘導演算部34は、航空機1を目標着地点2に誘導するための航空機1の制御量を算出する。制御量は、航空機1の機体速度、姿勢角、姿勢角の変化レート等を調整するための制御量である。誘導演算部34は、制御量を算出するために、航空機1と目標着地点2との相対座標を算出する。具体的に、誘導演算部34は、相対座標として、航空機1と目標着地点2との相対位置(X,Y)、航空機1と目標着地点2との相対高度Δhおよび航空機1と目標着地点2との相対速度等を算出する。相対位置(X,Y)は、水平方向における航空機1と目標着地点2との距離となる。相対高度Δhは、鉛直方向における航空機1と目標着地点2との距離となる。
誘導演算部34は、航空機1を目標着地点2に誘導するための航空機1の制御量を算出する。制御量は、航空機1の機体速度、姿勢角、姿勢角の変化レート等を調整するための制御量である。誘導演算部34は、制御量を算出するために、航空機1と目標着地点2との相対座標を算出する。具体的に、誘導演算部34は、相対座標として、航空機1と目標着地点2との相対位置(X,Y)、航空機1と目標着地点2との相対高度Δhおよび航空機1と目標着地点2との相対速度等を算出する。相対位置(X,Y)は、水平方向における航空機1と目標着地点2との距離となる。相対高度Δhは、鉛直方向における航空機1と目標着地点2との距離となる。
誘導演算部34は、画像処理部32で算出されたマーカー7の中心(Cx,Cy)と、カメラ10の方位すなわち航空機1の機首方位と、航空機1の高度(目標着地点2に対する相対高度Δh)とに基づいて、航空機1と目標着地点2との相対位置(X,Y)を算出する。なお、本実施形態では、カメラ10の方位と航空機1の機首方位とを一致させているが、特に限定されず、カメラ10の方位と航空機1の機首方位とを一致させなくてもよい。このように、画像処理部32および誘導演算部34は、航空機1と目標着地点2との相対位置を取得する相対位置取得部(相対座標取得部)として機能する。
また、誘導演算部34は、高度センサ25で検出された航空機1の高度に基づいて、目標着地点2までの相対高度Δhを算出する。したがって、高度センサ25および誘導演算部34は、航空機1と目標着地点2との相対高度Δhを取得する相対高度取得部(相対座標取得部)として機能する。なお、画像処理部32において、カメラ10で撮影したマーカー7を含む画像に画像処理を施すことで、航空機1と船舶5との相対高度Δhを算出する場合は、画像処理部32が相対高度取得部となる。
また、誘導演算部34は、航空機1と目標着地点2との相対速度を算出する。したがって、誘導演算部34は、航空機1と目標着地点2との相対速度を取得する相対速度取得部として機能する。より詳細には、誘導演算部34は、相対位置(X,Y)と機体速度(Vx、Vy)とに基づいて、航空機1と目標着地点2との相対速度(ΔVx,ΔVy)を算出する相対速度演算処理を実行する。したがって、誘導演算部34は、航空機1と目標着地点2との相対速度(ΔVx,ΔVy)を取得する相対速度取得部として機能する。
そして、誘導演算部34は、相対位置(X,Y)、相対高度Δh、相対速度(ΔVx,ΔVy)および機体加速度に基づいて、フィードバック制御(例えばPID制御)により制御量を算出する。なお、フィードバック制御は、PID制御に限らず、P制御、PI制御、PD制御等であってもよい。誘導演算部34は、算出した制御量C´(図4、図5参照)を飛行制御部36に出力する。
(飛行制御部)
飛行制御部36は、誘導演算部34で算出された制御量にしたがって、航空機1の各構成要素を制御して航空機1を飛行させる。飛行制御部36は、制御量にしたがって各回転翼のブレードピッチ角、回転数等を制御し、航空機1の機体速度、姿勢角、姿勢角の変化レート等を調整する。それにより、航空機1は、目標着地点2へと誘導される。なお、本実施形態では、画像処理部32および誘導演算部34を飛行制御部36とは別の機能部として説明するが、飛行制御部36、画像処理部32および誘導演算部34は、一体の機能部であってもよい。すなわち、飛行制御部36において画像処理部32および誘導演算部34の処理を行ってもよい。
飛行制御部36は、誘導演算部34で算出された制御量にしたがって、航空機1の各構成要素を制御して航空機1を飛行させる。飛行制御部36は、制御量にしたがって各回転翼のブレードピッチ角、回転数等を制御し、航空機1の機体速度、姿勢角、姿勢角の変化レート等を調整する。それにより、航空機1は、目標着地点2へと誘導される。なお、本実施形態では、画像処理部32および誘導演算部34を飛行制御部36とは別の機能部として説明するが、飛行制御部36、画像処理部32および誘導演算部34は、一体の機能部であってもよい。すなわち、飛行制御部36において画像処理部32および誘導演算部34の処理を行ってもよい。
(航空機の位置制御)
次に、図4及び図5を参照して、本実施形態にかかる航空機1の位置制御について説明する。航空機1の位置制御では、空間上において安定的にホバリングを実行する空間安定ホバリングを実行している。ここで、図8を参照して、空間安定ホバリングについて説明する。図8は、本実施形態にかかる航空機の位置制御に関する一例の説明図である。図8のラインL1は、波等の動揺により経時的に変化する目標着地点2の位置である。図8に示すように、空間安定ホバリングは、航空機1と目標着地点2との相対高度Δh及び相対位置(X,Y)が、波等の動揺により経時的に変化する場合であっても、航空機1と、動揺による変位量を平滑化(平均化)した目標着地点2との相対高度Δh及び相対位置(X,Y)が、目標相対高度及び目標相対位置と一致するように、ホバリングを実行する飛行制御である。相対位置(X,Y)及び相対高度Δhを、高度センサ25等を用いて計測する場合、お互いの運動を含んだ瞬時値となるため、動揺などによる変化も含まれてしまう。そのため、動揺などによる変化を取り除く平滑化処理が必要となり、その平滑化された位置/高度に対して制御を行う必要がある。つまり、空間安定ホバリングでは、平滑化された(平均的な)相対高度Δhと目標相対高度との差分がゼロとなるように、航空機1が飛行制御され、また、平滑化された(平均的な)相対位置(X,Y)と目標相対位置との差分がゼロとなるように、航空機1が飛行制御される。
次に、図4及び図5を参照して、本実施形態にかかる航空機1の位置制御について説明する。航空機1の位置制御では、空間上において安定的にホバリングを実行する空間安定ホバリングを実行している。ここで、図8を参照して、空間安定ホバリングについて説明する。図8は、本実施形態にかかる航空機の位置制御に関する一例の説明図である。図8のラインL1は、波等の動揺により経時的に変化する目標着地点2の位置である。図8に示すように、空間安定ホバリングは、航空機1と目標着地点2との相対高度Δh及び相対位置(X,Y)が、波等の動揺により経時的に変化する場合であっても、航空機1と、動揺による変位量を平滑化(平均化)した目標着地点2との相対高度Δh及び相対位置(X,Y)が、目標相対高度及び目標相対位置と一致するように、ホバリングを実行する飛行制御である。相対位置(X,Y)及び相対高度Δhを、高度センサ25等を用いて計測する場合、お互いの運動を含んだ瞬時値となるため、動揺などによる変化も含まれてしまう。そのため、動揺などによる変化を取り除く平滑化処理が必要となり、その平滑化された位置/高度に対して制御を行う必要がある。つまり、空間安定ホバリングでは、平滑化された(平均的な)相対高度Δhと目標相対高度との差分がゼロとなるように、航空機1が飛行制御され、また、平滑化された(平均的な)相対位置(X,Y)と目標相対位置との差分がゼロとなるように、航空機1が飛行制御される。
図4は、平滑化された航空機の相対高度を算出する一例のブロック図である。図5は、平滑化された航空機の相対位置を算出する一例のブロック図である。航空機1の位置制御では、誘導演算部34が、図4及び図5に示すブロック図に基づいて、目標着地点2に対して、空間上の目標座標に航空機を保持させる空間安定ホバリングに関する位置制御を行っている。このため、誘導演算部34は、空間安定ホバリングを実行するための航空機1の制御量を算出している。
(相対高度に関する空間安定ホバリング)
図4では、平滑化相対高度と目標相対高度との差分がゼロとなるように、空間安定ホバリングに関する位置制御を実行している。誘導演算部34は、加速度補正処理部41と、相補フィルタ42と、平滑化処理部43と、フィードバック制御部44とを備えている。なお、加速度補正処理部41、相補フィルタ42及び平滑化処理部43は、誘導演算部34によって実現されていてもよいし、誘導演算部34とは別体の処理部によって実現されていてもよいし、それらの組み合わせによって実現されていてもよく、特に限定されない。
図4では、平滑化相対高度と目標相対高度との差分がゼロとなるように、空間安定ホバリングに関する位置制御を実行している。誘導演算部34は、加速度補正処理部41と、相補フィルタ42と、平滑化処理部43と、フィードバック制御部44とを備えている。なお、加速度補正処理部41、相補フィルタ42及び平滑化処理部43は、誘導演算部34によって実現されていてもよいし、誘導演算部34とは別体の処理部によって実現されていてもよいし、それらの組み合わせによって実現されていてもよく、特に限定されない。
加速度補正処理部41は、航空機1の加速度と航空機1の姿勢とに基づいて、航空機1の加速度を補正した第1姿勢補正加速度を出力している。姿勢補正加速度とは、機体軸座標系の加速度を、航空機1の姿勢角に基づいて座標変換を行い、慣性空間座標系の加速度に変換したものである。具体的に、加速度補正処理部41には、航法装置20において取得された航空機1の加速度が入力され、また、航法装置20において取得された航空機1の姿勢角が入力される。入力される加速度としては、縦方向(機体座標系における前後方向)、横方向(機体座標系における左右方向)、及び垂直方向(機体座標系における上下方向)の加速度である。また、入力される姿勢角としては、ピッチ軸、ロール軸及びヨー軸における姿勢角である。加速度補正処理部41は、航空機1の加速度と航空機1の姿勢角とが入力されると、垂直方向における航空機1の加速度を補正した第1姿勢補正加速度を算出する。加速度補正処理部41は、算出した第1姿勢補正加速度を相補フィルタ42へ向けて出力する。
相補フィルタ42は、第1姿勢補正加速度と航空機1の慣性速度とに基づいて、第1姿勢補正加速度に含まれるドリフト成分を除去した第2姿勢補正加速度を出力している。具体的に、相補フィルタ42には、加速度補正処理部41から出力された第1姿勢補正加速度が入力され、また、航法装置20において取得された垂直方向における航空機1の慣性速度が入力される。入力される慣性速度は、航空機1を原点とした航空機慣性系における速度である。相補フィルタ42は、第1姿勢補正加速度と航空機1の慣性速度とが入力されると、第1姿勢補正加速度の出力値に含まれる低周波成分を除去した高周波成分と、慣性速度の微分値に含まれる低周波成分とを合成して、垂直方向における第2姿勢補正加速度を出力している。
図6は、相補フィルタでの処理の一例を示すブロック図である。図6に示すように、相補フィルタ42は、擬似微分フィルタ51と、ローパスフィルタ52と、ハイパスフィルタ53とを含んでいる。擬似微分フィルタ51は、慣性速度に擬似微分を施して、加速度成分とするフィルタである。擬似微分フィルタ51の伝達関数G1(S)は、下記の式(1)で表される。式(1)中の“s”は、演算子であり、“τ1”は、時定数である。
G1(S)=s/(τ1・s+1) …(1)
ローパスフィルタ52は、擬似微分フィルタ51から入力される慣性速度の微分値に対し、所定のカットオフ周波数以上の周波数を減衰させるフィルタである。ローパスフィルタ52の伝達関数G2(s)は、式(2)により表される。式(2)中の“s”は、演算子であり、“τ2”は、時定数である。したがって、所定のカットオフ周波数は、“1/τ2”となる。これにより、慣性速度の微分値をローパスフィルタ52に通すことで、慣性速度の微分値に含まれる低周波成分を得ることができる。
G2(S)=1/(τ2・s+1) …(2)
ハイパスフィルタ53は、第1姿勢補正加速度に対し、所定のカットオフ周波数未満の周波数を減衰させるフィルタである。ハイパスフィルタ53の伝達関数G3(s)は、式(3)により表される。式(3)中の“s”は、演算子であり、“τ2”は、ローパスフィルタ52と共通の時定数である。したがって、ハイパスフィルタ53においても、所定のカットオフ周波数は、“1/τ2”となる。これにより、垂直方向における第1姿勢補正加速度をハイパスフィルタ53に通すことで、第1姿勢補正加速度に含まれる高周波成分を得ることができる。
G3(S)=τ2・s/(τ2・s+1) …(3)
そして、相補フィルタ42は、ローパスフィルタ52から出力された慣性速度の微分値に含まれる低周波成分と、ハイパスフィルタ53から出力された第1姿勢補正加速度に含まれる高周波成分とを合成して、第2姿勢補正加速度として算出する。これにより、相補フィルタ42は、第1姿勢補正加速度に含まれるドリフト成分としての低周波成分を除去する。この後、相補フィルタ42は、算出した第2姿勢補正加速度を平滑化処理部43へ向けて出力する。
平滑化処理部43は、目標着地点2が動揺により変化する場合であっても、航空機1と、動揺による変位量を平滑化(平均化)した目標着地点2との相対高度Δhが目標相対高度と一致するように、飛行制御するための処理を行っている。平滑化処理部43は、第2姿勢補正加速度と、相対高度Δhとに基づいて、相対高度Δhを平滑化した平滑化相対高度Δhを出力している。具体的に、平滑化処理部43には、相補フィルタ42から出力された第2姿勢補正加速度が入力され、また、誘導演算部34により算出された相対高度Δhが入力される。平滑化処理部43は、第2姿勢補正加速度と相対高度Δhとが入力されると、航空機1と、動揺による変位量を平滑化(平均化)した目標着地点2との相対高度Δhを目標相対高度と一致させるための、平滑化相対高度Δhを算出する。そして、平滑化処理部43は、算出した平滑化相対高度Δhを減算回路部45へ向けて出力する。減算回路部は、目標相対高度を取得し、取得した目標相対高度と、平滑化処理部43から入力された平滑化相対高度Δhとの差分を算出する。そして、減算回路部45は、算出した差分をフィードバック制御部44へ向けて出力する。
フィードバック制御部44は、航空機1の慣性速度を取得し、取得した航空機1の慣性速度と、減算回路部45から入力された目標相対高度と平滑化相対高度Δhとの差分とに基づいて、制御量C´を算出する。そして、フィードバック制御部44は、算出した制御量C´を飛行制御部36へ向けて出力する。飛行制御部36は、制御量C´に基づいて飛行制御を実行する。なお、飛行制御部36による飛行制御の一例として、航空機1がヘリコプタである場合、ヘリコプタに設けられる回転ブレードのコレクティブピッチ角の角度を変更する飛行制御を行う。
ここで、図9を参照して、平滑化処理部43の相対高度に関する信号処理について説明する。図9は、平滑化処理部の相対高度から平滑化相対高度までのボード線図である。図9は、その横軸が周波数となっており、その縦軸が、ゲイン(dB)及び位相(deg)となっている。図9において、動揺が発生する周波数の帯域が、動揺周波数帯域fとなっており、動揺周波数帯域fを含む動揺周波数帯域f以上の周波数の帯域を、周波数帯f1(第1の周波数帯)とし、動揺周波数帯域f1よりも低い周波数の帯域を、周波数帯f2(第2の周波数帯)とする。
平滑化処理部43は、入力信号にゲインをかけて出力信号を増幅している。入力信号は、相対高度Δhであり、出力信号は、平滑化相対高度Δhである。図9に示すように、周波数帯f1は、周波数帯f2に比して、十分にゲインが低いものとなっていることから、周波数帯f1における動揺の影響を低減している。また、周波数帯f2は、減衰係数が大きく(ζ>0.7)なっており、低周波の外乱応答が振動的にならないようにしている。減衰係数ζの値を大きくすると、オーバーシュートは抑えられ、ζ>0.7であれば、望ましい結果が得られる。
(相対位置に関する空間安定ホバリング)
図5では、平滑化相対位置と目標相対位置との差分がゼロとなるように、空間安定ホバリングに関する位置制御を実行している。誘導演算部34は、加速度補正処理部41と、相補フィルタ42と、平滑化処理部43と、フィードバック制御部44と、カルマンフィルタ46と、相対速度推定処理部47とを備えている。なお、加速度補正処理部41、相補フィルタ42、平滑化処理部43、カルマンフィルタ46及び相対速度推定処理部47は、誘導演算部34により実現されていてもよいし、誘導演算部34とは別体の処理部によって実現されていてもよいし、それらの組み合わせによって実現されていてもよく、特に限定されない。なお、図5では、ピッチ軸の方向となるX方向の成分と、ロール軸の方向となるY方向の成分とを併記して図示しており、誘導演算部34により各成分の制御量をそれぞれ算出している。
図5では、平滑化相対位置と目標相対位置との差分がゼロとなるように、空間安定ホバリングに関する位置制御を実行している。誘導演算部34は、加速度補正処理部41と、相補フィルタ42と、平滑化処理部43と、フィードバック制御部44と、カルマンフィルタ46と、相対速度推定処理部47とを備えている。なお、加速度補正処理部41、相補フィルタ42、平滑化処理部43、カルマンフィルタ46及び相対速度推定処理部47は、誘導演算部34により実現されていてもよいし、誘導演算部34とは別体の処理部によって実現されていてもよいし、それらの組み合わせによって実現されていてもよく、特に限定されない。なお、図5では、ピッチ軸の方向となるX方向の成分と、ロール軸の方向となるY方向の成分とを併記して図示しており、誘導演算部34により各成分の制御量をそれぞれ算出している。
加速度補正処理部41は、上記と同様に、航空機1の加速度と航空機1の姿勢とに基づいて、航空機1の加速度を補正した第1姿勢補正加速度を出力している。また、加速度補正処理部41は、航空機1の加速度と航空機1の姿勢角とが入力されると、縦方向及び横方向における航空機1の加速度を補正した第1姿勢補正加速度を算出する。加速度補正処理部41は、算出した第1姿勢補正加速度を相補フィルタ42へ向けて出力する。
相補フィルタ42は、上記と同様に、第1姿勢補正加速度と航空機1の慣性速度とに基づいて、第1姿勢補正加速度に含まれるドリフト成分を除去した第2姿勢補正加速度を出力している。具体的に、相補フィルタ42には、加速度補正処理部41から出力された第1姿勢補正加速度が入力され、また、航法装置20において取得された縦方向及び横方向における航空機1の慣性速度が入力される。相補フィルタ42は、第1姿勢補正加速度と航空機1の慣性速度とが入力されると、第1姿勢補正加速度の出力値に含まれる低周波成分を除去した高周波成分と、慣性速度の微分値に含まれる低周波成分とを合成して、縦方向及び横方向における第2姿勢補正加速度を出力している。相補フィルタ42は、第2姿勢補正加速度を平滑化処理部43及びフィードバック制御部44へ向けて出力する。なお、相補フィルタ42については、図6と同様である。
カルマンフィルタ46は、相対位置(X,Y)に基づく推定を行い、推定後の推定相対位置(X,Y)を出力している。具体的に、カルマンフィルタ46には、誘導演算部34により算出された相対位置(X,Y)が入力される。カルマンフィルタ46は、相対位置(X,Y)が入力されると、相対位置(X,Y)の時間変化を推定することで、推定相対位置(X,Y)を算出する。カルマンフィルタ46は、算出した推定相対位置(X,Y)を平滑化処理部43へ向けて出力する。
平滑化処理部43は、第2姿勢補正加速度と、推定相対位置(X,Y)とに基づいて、推定相対位置(X,Y)を平滑化した平滑化相対位置(X,Y)を出力している。具体的に、平滑化処理部43には、相補フィルタ42から出力された第2姿勢補正加速度が入力され、また、カルマンフィルタ46により算出された推定相対位置(X,Y)が入力される。平滑化処理部43は、第2姿勢補正加速度と推定相対位置(X,Y)とが入力されると、航空機1と、動揺による変位量を平滑化(平均化)した目標着地点2との相対位置を目標相対位置と一致させるための、平滑化相対位置(X,Y)を算出する。そして、平滑化処理部43は、算出した平滑化相対位置(X,Y)をフィードバック制御部44へ向けて出力する。
相対速度推定処理部47は、相対位置(X,Y)と航空機1の機体速度とに基づいて、推定相対速度を出力している。具体的に、相対速度推定処理部47には、誘導演算部34により算出された相対位置(X,Y)が入力され、また、航法装置20において取得された縦方向及び横方向における航空機1の機体速度が入力される。相対速度推定処理部47は、入力された相対位置(X,Y)と機体速度とから、相対速度を推定し、推定相対速度としてフィードバック制御部44へ向けて出力する。
フィードバック制御部44は、相補フィルタ42から入力された第2姿勢補正加速度と、平滑化処理部43から入力された平滑化相対位置(X,Y)と、相対速度推定処理部47から入力された推定相対速度とに基づいて、制御量C´を算出する。そして、フィードバック制御部44は、算出した制御量C´を飛行制御部36へ向けて出力する。飛行制御部36は、制御量C´に基づいて飛行制御を実行する。なお、飛行制御部36による飛行制御の一例として、航空機1がヘリコプタである場合、ヘリコプタのメインロータを縦方向及び横方向に傾ける飛行制御を行う。
ここで、図10を参照して、平滑化処理部43の相対位置に関する信号処理について説明する。図10は、平滑化処理部の相対位置から平滑化相対位置までのボード線図である。図10は、その横軸が周波数となっており、その縦軸が、ゲイン(dB)及び位相(deg)となっている。図10において、図9と同様に、動揺が発生する周波数の帯域が、動揺周波数帯域fとなっており、動揺周波数帯域fを含む動揺周波数帯域f以上の周波数の帯域を、周波数帯f1(第1の周波数帯)とし、動揺周波数帯域f1よりも低い周波数の帯域を、周波数帯f2(第2の周波数帯)とする。
平滑化処理部43は、入力信号にゲインをかけて出力信号を増幅している。入力信号は、推定相対位置(X,Y)であり、出力信号は、平滑化相対位置(X,Y)である。図10に示すように、周波数帯f1は、図9と同様に、周波数帯f2に比して、十分にゲインが低いものとなっていることから、周波数帯f1における動揺の影響を低減している。また、周波数帯f2は、相対高度と同様に、減衰係数が大きく(ζ>0.7)なっており、低周波の外乱応答が振動的にならないようにしている。減衰係数ζの値を大きくすると、オーバーシュートは抑えられ、ζ>0.7であれば、望ましい結果が得られる。
(航空機の位置制御方法)
次に、図7を参照して、本実施形態にかかる航空機1の位置制御システム100を用いた位置制御方法、具体的には、平滑化処理部43における平滑化相対高度Δh及び平滑化相対位置(X,Y)を算出するまでの平滑化処理について説明する。図7は、本実施形態にかかる航空機の位置制御方法に関する一例を示すフローチャートである。なお、図7では、相対高度及び相対位置に関する平滑化処理となっており、また、平滑化処理部43から平滑化相対高度Δh及び平滑化相対位置(X,Y)を出力するまでの平滑化処理となっている。
次に、図7を参照して、本実施形態にかかる航空機1の位置制御システム100を用いた位置制御方法、具体的には、平滑化処理部43における平滑化相対高度Δh及び平滑化相対位置(X,Y)を算出するまでの平滑化処理について説明する。図7は、本実施形態にかかる航空機の位置制御方法に関する一例を示すフローチャートである。なお、図7では、相対高度及び相対位置に関する平滑化処理となっており、また、平滑化処理部43から平滑化相対高度Δh及び平滑化相対位置(X,Y)を出力するまでの平滑化処理となっている。
平滑化処理では、先ず、加速度補正処理部41が、入力される航空機1の加速度と航空機1の姿勢とに基づいて、第1姿勢補正加速度を出力する(ステップS1)。ステップS1では、相対高度Δhに関する位置制御の場合、加速度補正処理部41が、垂直方向における第1姿勢補正加速度を出力する。また、ステップS1では、相対位置(X,Y)に関する位置制御の場合、加速度補正処理部41が、縦方向及び横方向における第1姿勢補正加速度を出力する。
続いて、航空機1の位置制御方法では、相補フィルタ42が、第1姿勢補正加速度と航空機1の慣性速度とに基づいて、第2姿勢補正加速度を出力する(ステップS2)。ステップS2では、第1姿勢補正加速度の低周波成分を除去することで、第1姿勢補正加速度に含まれるドリフト成分を除去する。ステップS2では、相対高度Δhに関する位置制御の場合、相補フィルタ42が、垂直方向における第2姿勢補正加速度を出力する。また、ステップS2では、相対位置(X,Y)に関する位置制御の場合、相補フィルタ42が、縦方向及び横方向における第2姿勢補正加速度を出力する。
この後、航空機1の位置制御方法では、平滑化処理部43が、垂直方向における第2姿勢補正加速度及び相対高度Δhと、縦方向及び横方向における第2姿勢補正加速度及び推定相対位置(X,Y)とに基づいて、平滑化相対高度Δh及び平滑化相対位置(X,Y)を出力する。
以上のように、実施形態に記載の航空機1の位置制御システム100、航空機1及び航空機1の位置制御方法は、例えば、以下のように把握される。
第1の態様に係る航空機1の位置制御システム100は、動揺する目標着地点2に対して、空間上の目標座標に航空機1を保持させる航空機1の位置制御システム100であって、前記航空機1の加速度と前記航空機1の姿勢とに基づいて、前記航空機1の加速度を補正するための第1姿勢補正加速度を出力する加速度補正処理部41と、前記第1姿勢補正加速度と前記航空機1の慣性速度とに基づいて、前記第1姿勢補正加速度に含まれるドリフト成分を除去した第2姿勢補正加速度を出力する相補フィルタ42と、前記第2姿勢補正加速度と、前記航空機1と前記目標着地点2との間の相対座標とに基づいて、前記相対座標を平滑化した平滑化相対座標を出力する平滑化処理部43と、を備える。
この構成によれば、取得される航空機1の加速度に基づいて出力される第1姿勢補正加速度に含まれるドリフト成分を、相補フィルタ42において除去することができる。このため、ドリフト成分が除去された第2姿勢補正加速度を用いて、平滑化相対座標を取得することができるため、目標着地点2が動揺する場合であっても、空間上における航空機1の位置を安定的に保持させることができる。
第2の態様として、前記相補フィルタ42は、前記第1姿勢補正加速度の出力値に含まれる低周波成分を除去した高周波成分と、前記慣性速度の微分値に含まれる低周波成分と、を合成して、前記第2姿勢補正加速度を出力する。
この構成によれば、第1姿勢補正加速度の出力値に含まれる低周波成分を除去することで、ドリフト成分を好適に除去することができる。また、除去した低周波成分を、慣性速度により好適に補間することができる。
第3の態様として、前記相対座標は、前記航空機と目標着地点との鉛直方向における相対高度Δh、及び前記航空機と目標着地点との水平面内における相対位置(X,Y)の少なくとも一方を含む。
この構成によれば、相対高度Δh及び相対位置(X,Y)において、航空機1の位置を安定的に保持させることができる。
第4の態様として、前記平滑化処理部43は、前記相対座標が前記相対位置(X,Y)を含む場合、前記平滑化相対座標として、平滑化相対位置を出力し、前記航空機1の機体速度と前記相対位置(X,Y)とに基づいて、前記航空機1と前記目標着地点2との間の相対速度を推定した推定相対速度を出力する相対速度推定処理部47を、さらに備え、前記推定相対速度と前記平滑化相対位置とに基づいて、前記航空機1を飛行制御する。
この構成によれば、相対位置(X,Y)において、目標着地点2に対する位置制御を精度よく行うことができる。
第5の態様として、前記相対座標が前記相対位置(X,Y)を含む場合、前記相対位置(X,Y)に基づいて推定した推定相対位置を出力するカルマンフィルタ46を、さらに備え、前記平滑化処理部43は、前記第2姿勢補正加速度と前記推定相対位置とに基づいて、前記平滑化相対座標として、平滑化相対位置を出力する。
この構成によれば、相対位置(X,Y)において、精度のよい平滑化相対位置を出力することができる。このため、相対位置(X,Y)において、航空機1の位置を安定的に精度よく保持させることができる。
第6の態様として、前記平滑化処理部は、前記相対座標にゲインをかけて前記平滑化相対座標を出力しており、前記動揺が発生する動揺周波数帯域以上の周波数の帯域を、第1の周波数帯とし、前記動揺周波数帯域よりも低い周波数の帯域を、第2の周波数帯とすると、前記第1の周波数帯における前記ゲインは、前記第2の周波数帯における前記ゲインに対して低く、前記第2の周波数帯における減衰係数ζが、ζ>0.7となっている。
この構成によれば、第1の周波数帯f1は、第2の周波数帯に比して、十分にゲインが低いものとなっていることから、第1の周波数帯f1における動揺の影響を低減することができる。また、第2の周波数帯f2は、減衰係数が大きく(ζ>0.7)なることから、低周波の外乱応答が振動的にならないようにすることができる。
第7の態様に係る航空機1は、航空機の加速度を取得する加速度取得部と、前記航空機の姿勢を取得する姿勢取得部と、前記航空機の慣性速度を取得する慣性速度取得部と、前記航空機の相対座標を取得する相対座標取得部と、上記の航空機1の位置制御システム100と、を備える。
この構成によれば、目標着地点2が動揺する場合であっても、目標着地点2に対する位置が安定的となるように、飛行制御される航空機1を提供することができる。
第8の態様に係る航空機1の位置制御方法は、動揺する目標着地点に対して、空間上の所定座標に航空機を保持させる航空機の位置制御方法であって、前記航空機の加速度と前記航空機の姿勢とに基づいて、前記航空機の加速度を補正するための第1姿勢補正加速度を出力するステップと、前記第1姿勢補正加速度と前記航空機の慣性速度とに基づいて、前記第1姿勢補正加速度に含まれるドリフト成分を除去した第2姿勢補正加速度を出力するステップと、前記第2姿勢補正加速度と、前記航空機と前記目標着地点との間の相対座標とに基づいて、前記相対座標を平滑化した平滑化相対座標を出力するステップと、を備える。
この構成によれば、取得される航空機1の加速度に基づいて出力される第1姿勢補正加速度に含まれるドリフト成分を、相補フィルタ42において除去することができる。このため、ドリフト成分が除去された第2姿勢補正加速度を用いて、平滑化相対座標を取得することができるため、目標着地点2が動揺する場合であっても、空間上における航空機1の位置を安定的に保持させることができる。
1 航空機
2 目標着地点
5 船舶
7 マーカー
10 カメラ
20 航法装置
30 制御部
32 画像処理部
34 誘導演算部
36 飛行制御部
41 加速度補正処理部
42 相補フィルタ
43 平滑化処理部
46 カルマンフィルタ
47 相対速度推定処理部
51 擬似微分フィルタ
52 ローパスフィルタ
53 ハイパスフィルタ
100 位置制御システム
2 目標着地点
5 船舶
7 マーカー
10 カメラ
20 航法装置
30 制御部
32 画像処理部
34 誘導演算部
36 飛行制御部
41 加速度補正処理部
42 相補フィルタ
43 平滑化処理部
46 カルマンフィルタ
47 相対速度推定処理部
51 擬似微分フィルタ
52 ローパスフィルタ
53 ハイパスフィルタ
100 位置制御システム
Claims (8)
- 動揺する目標着地点に対して、空間上の目標座標に航空機を保持させる航空機の位置制御システムであって、
前記航空機の加速度と前記航空機の姿勢とに基づいて、前記航空機の加速度を補正した第1姿勢補正加速度を出力する加速度補正処理部と、
前記第1姿勢補正加速度と前記航空機の慣性速度とに基づいて、前記第1姿勢補正加速度に含まれるドリフト成分を除去した第2姿勢補正加速度を出力する相補フィルタと、
前記第2姿勢補正加速度と、前記航空機と前記目標着地点との間の相対座標とに基づいて、前記相対座標を平滑化した平滑化相対座標を出力する平滑化処理部と、を備える航空機の位置制御システム。 - 前記相補フィルタは、
前記第1姿勢補正加速度の出力値に含まれる低周波成分を除去した高周波成分と、前記慣性速度の微分値に含まれる低周波成分と、を合成して、前記第2姿勢補正加速度を出力する請求項1に記載の航空機の位置制御システム。 - 前記相対座標は、前記航空機と目標着地点との鉛直方向における相対高度、及び前記航空機と目標着地点との水平面内における相対位置の少なくとも一方を含む請求項1または2に記載の航空機の位置制御システム。
- 前記平滑化処理部は、前記相対座標が前記相対位置を含む場合、前記平滑化相対座標として、平滑化相対位置を出力し、
前記航空機の機体速度と前記相対位置とに基づいて、前記航空機と前記目標着地点との間の相対速度を推定した推定相対速度を出力する相対速度推定処理部を、さらに備え、
前記推定相対速度と前記平滑化相対位置とに基づいて、前記航空機を飛行制御する請求項3に記載の航空機の位置制御システム。 - 前記相対座標が前記相対位置を含む場合、
前記相対位置に基づいて推定した推定相対位置を出力するカルマンフィルタを、さらに備え、
前記平滑化処理部は、前記第2姿勢補正加速度と前記推定相対位置とに基づいて、前記平滑化相対座標として、平滑化相対位置を出力する請求項3または4に記載の航空機の位置制御システム。 - 前記平滑化処理部は、前記相対座標にゲインをかけて前記平滑化相対座標を出力しており、
前記動揺が発生する動揺周波数帯域以上の周波数の帯域を、第1の周波数帯とし、
前記動揺周波数帯域よりも低い周波数の帯域を、第2の周波数帯とすると、
前記第1の周波数帯における前記ゲインは、前記第2の周波数帯における前記ゲインに対して低く、
前記第2の周波数帯における減衰係数ζが、ζ>0.7となっている請求項1から5のいずれか1項に記載の航空機の位置制御システム。 - 航空機の加速度を取得する加速度取得部と、
前記航空機の姿勢を取得する姿勢取得部と、
前記航空機の慣性速度を取得する慣性速度取得部と、
前記航空機の相対座標を取得する相対座標取得部と、
請求項1から6のいずれか1項に記載の航空機の位置制御システムと、を備える航空機。 - 動揺する目標着地点に対して、空間上の所定座標に航空機を保持させる航空機の位置制御方法であって、
前記航空機の加速度と前記航空機の姿勢とに基づいて、前記航空機の加速度を補正した第1姿勢補正加速度を出力するステップと、
前記第1姿勢補正加速度と前記航空機の慣性速度とに基づいて、前記第1姿勢補正加速度に含まれるドリフト成分を除去した第2姿勢補正加速度を出力するステップと、
前記第2姿勢補正加速度と、前記航空機と前記目標着地点との間の相対座標とに基づいて、前記相対座標を平滑化した平滑化相対座標を出力するステップと、を備える航空機の位置制御方法。
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2020189571A JP7482757B2 (ja) | 2020-11-13 | 2020-11-13 | 航空機の位置制御システム、航空機、及び航空機の位置制御方法 |
PCT/IB2022/050232 WO2022101894A1 (ja) | 2020-11-13 | 2022-01-13 | 航空機の位置制御システム、航空機、及び航空機の位置制御方法 |
EP22723004.2A EP4227215A4 (en) | 2020-11-13 | 2022-01-13 | AIRCRAFT POSITION CONTROL SYSTEM, AIRCRAFT AND AIRCRAFT POSITION CONTROL METHOD |
US18/036,507 US20240012433A1 (en) | 2020-11-13 | 2022-01-13 | Aircraft position control system, aircraft, and aircraft position control method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2020189571A JP7482757B2 (ja) | 2020-11-13 | 2020-11-13 | 航空機の位置制御システム、航空機、及び航空機の位置制御方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2022078701A JP2022078701A (ja) | 2022-05-25 |
JP7482757B2 true JP7482757B2 (ja) | 2024-05-14 |
Family
ID=81600875
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2020189571A Active JP7482757B2 (ja) | 2020-11-13 | 2020-11-13 | 航空機の位置制御システム、航空機、及び航空機の位置制御方法 |
Country Status (4)
Country | Link |
---|---|
US (1) | US20240012433A1 (ja) |
EP (1) | EP4227215A4 (ja) |
JP (1) | JP7482757B2 (ja) |
WO (1) | WO2022101894A1 (ja) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2010043370A1 (en) | 2008-10-13 | 2010-04-22 | Universite De Mediterranee | Steering aid method and system for landing on a target of a moving platform, and a 3 d vehicle equipped as such |
CN105059558A (zh) | 2015-07-16 | 2015-11-18 | 珠海云洲智能科技有限公司 | 无人船载无人机起降*** |
JP2020112557A (ja) | 2014-10-17 | 2020-07-27 | ソニー株式会社 | 装置、方法及びプログラム |
CN111895988A (zh) | 2019-12-20 | 2020-11-06 | 北京空天技术研究所 | 无人机导航信息更新方法及装置 |
WO2021070517A1 (ja) | 2019-10-11 | 2021-04-15 | 三菱重工業株式会社 | 垂直離着陸機の自動着陸システム、垂直離着陸機および垂直離着陸機の着陸制御方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11183603A (ja) | 1997-12-24 | 1999-07-09 | Mitsubishi Electric Corp | ドプラ航法装置 |
JP4253239B2 (ja) * | 2003-10-07 | 2009-04-08 | 富士重工業株式会社 | 画像認識を用いた航法装置 |
-
2020
- 2020-11-13 JP JP2020189571A patent/JP7482757B2/ja active Active
-
2022
- 2022-01-13 EP EP22723004.2A patent/EP4227215A4/en active Pending
- 2022-01-13 US US18/036,507 patent/US20240012433A1/en active Pending
- 2022-01-13 WO PCT/IB2022/050232 patent/WO2022101894A1/ja active Application Filing
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2010043370A1 (en) | 2008-10-13 | 2010-04-22 | Universite De Mediterranee | Steering aid method and system for landing on a target of a moving platform, and a 3 d vehicle equipped as such |
JP2020112557A (ja) | 2014-10-17 | 2020-07-27 | ソニー株式会社 | 装置、方法及びプログラム |
CN105059558A (zh) | 2015-07-16 | 2015-11-18 | 珠海云洲智能科技有限公司 | 无人船载无人机起降*** |
WO2021070517A1 (ja) | 2019-10-11 | 2021-04-15 | 三菱重工業株式会社 | 垂直離着陸機の自動着陸システム、垂直離着陸機および垂直離着陸機の着陸制御方法 |
CN111895988A (zh) | 2019-12-20 | 2020-11-06 | 北京空天技术研究所 | 无人机导航信息更新方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
WO2022101894A1 (ja) | 2022-05-19 |
EP4227215A1 (en) | 2023-08-16 |
JP2022078701A (ja) | 2022-05-25 |
US20240012433A1 (en) | 2024-01-11 |
EP4227215A4 (en) | 2024-04-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4253239B2 (ja) | 画像認識を用いた航法装置 | |
CA2513514C (en) | Compensation for overflight velocity when stabilizing an airborne camera | |
WO2021070518A1 (ja) | 航空機の位置制御システム、航空機および航空機の位置制御方法 | |
KR101769602B1 (ko) | 옵티컬 플로우와 imu 및 초음파센서를 이용한 호버링용 위치보정장치 및 위치보정방법 | |
Wynn et al. | Visual servoing with feed-forward for precision shipboard landing of an autonomous multirotor | |
US11644850B2 (en) | Aircraft | |
WO2022101893A1 (ja) | 航空機の制御システム、航空機、航空機の制御方法及びプログラム | |
JP7482757B2 (ja) | 航空機の位置制御システム、航空機、及び航空機の位置制御方法 | |
EP2598841A1 (en) | Method for compensating drift in a position measuring device | |
KR101340158B1 (ko) | 고정 표적을 이용한 무인항공기의 표적 위치 보정 방법 및 컴퓨터 판독 가능한 기록매체 | |
KR101769603B1 (ko) | 호버링용 위치보정장치 | |
JP7523323B2 (ja) | 航空機の位置制御システム、航空機及び航空機の位置制御方法 | |
WO2022101895A1 (ja) | 航空機の位置制御システム、航空機及び航空機の位置制御方法 | |
WO2024157977A1 (ja) | 航空機の位置制御システム、航空機及び航空機の位置制御方法 | |
JP2015193347A (ja) | 飛翔体の慣性航法システム | |
WO2024157973A1 (ja) | 垂直離着陸機の位置制御システム、垂直離着陸機及び垂直離着陸機の位置制御方法 | |
JP2024104215A (ja) | 垂直離着陸機の位置制御システム、垂直離着陸機及び垂直離着陸機の位置制御方法 | |
Krasil’shchikov et al. | Analysis of conditions for ensuring operation of an intertial satellite navigation system of an unmannded aerial vehicle during interference | |
WO2022101892A1 (ja) | 垂直離着陸機の自動着陸システム、垂直離着陸機および垂直離着陸機の着陸制御方法 | |
WO2023127289A1 (ja) | 垂直離着陸機の自動発着システム、垂直離着陸機および垂直離着陸機の発着制御方法 | |
KR102093888B1 (ko) | 보조 항법 장치 및 보조 항법 장치의 제어 방법 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20230809 |
|
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: 20240402 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20240430 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 7482757 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |