JP2006137278A - Method and device for generating bank angle for flight path - Google Patents

Method and device for generating bank angle for flight path Download PDF

Info

Publication number
JP2006137278A
JP2006137278A JP2004327538A JP2004327538A JP2006137278A JP 2006137278 A JP2006137278 A JP 2006137278A JP 2004327538 A JP2004327538 A JP 2004327538A JP 2004327538 A JP2004327538 A JP 2004327538A JP 2006137278 A JP2006137278 A JP 2006137278A
Authority
JP
Japan
Prior art keywords
bank angle
aircraft
flight
flight path
speed
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.)
Granted
Application number
JP2004327538A
Other languages
Japanese (ja)
Other versions
JP4188899B2 (en
Inventor
Eiji Yoshikuwa
栄二 吉桑
Eiji Kakishita
栄二 柿下
Sei Kunito
聖 國頭
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Kawasaki Heavy Industries Ltd
Original Assignee
Kawasaki Heavy Industries Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Kawasaki Heavy Industries Ltd filed Critical Kawasaki Heavy Industries Ltd
Priority to JP2004327538A priority Critical patent/JP4188899B2/en
Publication of JP2006137278A publication Critical patent/JP2006137278A/en
Application granted granted Critical
Publication of JP4188899B2 publication Critical patent/JP4188899B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

<P>PROBLEM TO BE SOLVED: To provide a method and a device for generating a bank angle for a flight path, in which the bank angle can be controlled with high responsiveness even when speed is varied. <P>SOLUTION: The bank angle ϕ of an aircraft at a current position is determined based on cross track deviation XTE, course deviation CE, and predicted pass point. The bank angle ϕ is thus determined under consideration of not only direction deviation of the aircraft including the cross track deviation XTE and the course deviation CE, but also the predicted pass point determined based on flight speed at the current speed. Therefore, generation of overshoot to a turning path passing the predicted pass point is prevented even where the speed of the aircraft is varied. <P>COPYRIGHT: (C)2006,JPO&NCIPI

Description

本発明は、固定翼機および回転翼機を含む航空機のバンク角を算出する飛行経路のバンク角生成方法およびこの方法を用いた飛行制御方法ならびに飛行経路のバンク角生成装置およびこの装置を用いた飛行制御装置に関する。   The present invention relates to a flight path bank angle generation method for calculating a bank angle of an aircraft including a fixed wing aircraft and a rotary wing aircraft, a flight control method using this method, a flight path bank angle generation apparatus, and this apparatus. The present invention relates to a flight control device.

図4は、従来の技術のバンク角生成方法によってバンク角を生成する手順を説明するための平面図である。この従来の技術は、特許文献1に記載されている。航空機1は、予め設定された飛行経路2上の目標通過点3の手前を飛行経路2から外れて飛行している。このような現在位置4における航空機1の目標通過点3からのずれは、航空機1の進行方向7と飛行経路2とが成す角度であるクロス・トラック偏差θ1と、航空機1の現在位置4と目標通過点3とを結ぶ線分6が飛行経路2に対して成す角度であるコース偏差θ2とによって表される。   FIG. 4 is a plan view for explaining a procedure for generating a bank angle by a conventional bank angle generation method. This conventional technique is described in Patent Document 1. The aircraft 1 flies off the flight path 2 in front of the target passing point 3 on the preset flight path 2. Such deviation from the target passing point 3 of the aircraft 1 at the current position 4 includes a cross-track deviation θ1 that is an angle formed by the traveling direction 7 of the aircraft 1 and the flight path 2, and the current position 4 of the aircraft 1 and the target. This is represented by a course deviation θ2 that is an angle formed by the line 6 connecting the passing point 3 with respect to the flight path 2.

航空機1の現在位置4は、飛行経路2に対して左に逸れているので、航空機1は右に旋回する右バンク角+φをとれば、クロス・トラック偏差θ1を解消することができる。また、航空機1の進行方向7は、飛行経路2から右に逸れているので、左に旋回する左バンク角−φをとれば、コース偏差θ2を解消することができる。   Since the current position 4 of the aircraft 1 deviates to the left with respect to the flight path 2, the cross track deviation θ1 can be eliminated by taking the right bank angle + φ that the aircraft 1 turns to the right. Further, since the traveling direction 7 of the aircraft 1 deviates to the right from the flight path 2, the course deviation θ2 can be eliminated by taking the left bank angle −φ that turns left.

このような相反するバンク角+φ,−φに対して、航空機1が最終的には飛行経路2に復帰し、かつ確実に目標通過点3を通過するように、飛行制御装置の演算処理部によってバンク角φが算出され、このバンク角φに沿った飛行が達成されるように、航空機1の所定の舵面が制御される。   With respect to such conflicting bank angles + φ, −φ, the arithmetic processing unit of the flight control device ensures that the aircraft 1 finally returns to the flight path 2 and passes through the target passing point 3 with certainty. A bank angle φ is calculated, and a predetermined control surface of the aircraft 1 is controlled so that flight along the bank angle φ is achieved.

図5は、図4に関連して述べたバンク角生成方法を実現するバンク角生成装置10の電気的構成を簡略化して示すブロック図である。前述のバンク角生成方法は、バンク角生成装置10によって実現され、前述のクロス・トラック偏差θ1とコース偏差θ2とに基づいて、航空機1のバンク角φを求める。   FIG. 5 is a block diagram showing a simplified electrical configuration of the bank angle generation device 10 that implements the bank angle generation method described with reference to FIG. The bank angle generation method described above is realized by the bank angle generation device 10 and obtains the bank angle φ of the aircraft 1 based on the cross track deviation θ1 and the course deviation θ2.

このバンク角生成装置10は、第1ゲイン乗算器11と、第2ゲイン乗算器12と、減算器13と、リミッタ14とを有する。入力したクロス・トラック偏差θ1は、第1ゲイン乗算器11によって第1ゲインが乗算され、減算器13に入力される。また、入力したコース偏差θ2は、第2ゲイン乗算器12によって第2ゲインが乗算された、減算器13に入力される。減算器13は、前記入力したゲイン乗算後のクロス・トラック偏差θ1とコース偏差θ2とを減算して差分を求める。この差分値は、リミッタ14に入力される。リミッタ14は、入力した差分値がしきい値を超えたとき、一定のリミッタ値を出力する。   The bank angle generation device 10 includes a first gain multiplier 11, a second gain multiplier 12, a subtractor 13, and a limiter 14. The input cross track deviation θ 1 is multiplied by the first gain by the first gain multiplier 11 and input to the subtractor 13. Further, the input course deviation θ2 is input to the subtractor 13 multiplied by the second gain by the second gain multiplier 12. The subtractor 13 subtracts the input cross-track deviation θ1 and the course deviation θ2 after gain multiplication to obtain a difference. This difference value is input to the limiter 14. The limiter 14 outputs a constant limiter value when the input difference value exceeds the threshold value.

特開2002−362495号公報JP 2002-362495 A

前記従来の技術では、航空機の飛行する方位によってバンク角φを算出しているため、速度が変化すると、通過点を通る旋回経路に対してオーバーシュートが生じ、速度の変化に追従してバンク角φを高い応答性で制御することができないという問題がある。   In the prior art, since the bank angle φ is calculated based on the flight direction of the aircraft, if the speed changes, an overshoot occurs in the turning path passing through the passing point, and the bank angle follows the change in speed. There is a problem that φ cannot be controlled with high responsiveness.

本発明の目的は、速度が変化しても、バンク角を高い応答性で制御することができる飛行経路のバンク角生成方法および装置を提供することである。   An object of the present invention is to provide a bank angle generation method and apparatus for a flight path that can control the bank angle with high responsiveness even if the speed changes.

本発明の飛行経路のバンク角生成方法は、航空機に予め設定された飛行経路および航空機の現在位置間のクロス・トラック偏差と、前記飛行経路の方向および航空機の進行方向間のコース偏差と、飛行経路上の飛行速度における現在位置から所定時間後の通過予想点とに基づいて、前記クロス・トラック偏差およびコース偏差を発生させないように、現在位置における航空機のバンク角を生成することを特徴とする飛行経路のバンク角生成方法である。   The flight path bank angle generation method according to the present invention includes a cross-track deviation between a flight path preset in an aircraft and a current position of the aircraft, a course deviation between the direction of the flight path and the traveling direction of the aircraft, A bank angle of the aircraft at the current position is generated so as not to generate the cross track deviation and the course deviation based on a predicted passing point after a predetermined time from the current position at the flight speed on the route. It is a bank angle generation method of a flight path.

また本発明の飛行経路のバンク角生成方法は、前記飛行速度は、対地速度であることを特徴とする。   The flight path bank angle generation method of the present invention is characterized in that the flight speed is a ground speed.

さらに本発明の飛行制御方法は、前記飛行経路のバンク角生成方法によって生成されたバンク角を用いて飛行経路に沿って航空機が飛行するように、航空機の舵面を制御することを特徴とする飛行制御方法である。   Further, the flight control method of the present invention controls the control surface of the aircraft so that the aircraft flies along the flight path using the bank angle generated by the bank angle generation method of the flight path. This is a flight control method.

さらに本発明の飛行経路のバンク角生成装置は、航空機の予め設定される飛行経路に対するクロス・トラック偏差と、前記予め設定される飛行経路の方向に対するコース偏差と、飛行経路上の飛行速度における現在位置から所定時間後の通過予想点とに基づいて、前記クロス・トラック偏差およびコース偏差を打ち消すように、現在位置における航空機のバンク角を生成することを特徴とする飛行経路のバンク角生成装置である。   Furthermore, the flight path bank angle generating apparatus according to the present invention includes a cross track deviation with respect to a predetermined flight path of an aircraft, a course deviation with respect to the direction of the predetermined flight path, and a current flight speed on the flight path. A flight path bank angle generating device for generating an aircraft bank angle at a current position so as to cancel the cross track deviation and course deviation based on a predicted passing point after a predetermined time from a position. is there.

さらに本発明の飛行経路のバンク角生成装置は、前記飛行速度は、対地速度であることを特徴とする。   Furthermore, the flight path bank angle generation device of the present invention is characterized in that the flight speed is a ground speed.

さらに本発明の飛行制御装置は、前記飛行経路のバンク角生成装置によって生成されたバンク角を用いて飛行経路に沿って航空機が飛行するように、航空機の舵面を制御することを特徴とする飛行制御装置である。   Furthermore, the flight control device of the present invention controls the control surface of the aircraft so that the aircraft flies along the flight path using the bank angle generated by the flight path bank angle generation device. It is a flight control device.

本発明の飛行経路のバンク角生成方法によれば、クロス・トラック偏差とコース偏差と通過予想点とに基づいて、現在位置における航空機のバンク角が算出される。航空機には、飛行経路に沿って航空機が飛行するように舵面を制御する飛行制御装置が搭載される。この飛行制御装置は、パイロットによって入力された出発点および到着点ならびにその間の複数の通過点に基づいて、前記飛行経路を生成する。こうして生成された飛行経路は、飛行制御装置の記憶部に飛行データとして設定され、記憶される。   According to the flight path bank angle generating method of the present invention, the bank angle of the aircraft at the current position is calculated based on the cross track deviation, the course deviation, and the predicted passing point. The aircraft is equipped with a flight control device that controls the control surface so that the aircraft flies along the flight path. The flight control device generates the flight path based on a starting point and an arriving point input by a pilot and a plurality of passing points therebetween. The flight path thus generated is set and stored as flight data in the storage unit of the flight control device.

前記クロス・トラック偏差は、航空機の現在位置と、飛行経路上の自機位置との偏差である。また前記コース偏差は、航空機の進行方向と飛行経路とが成す角度である。通過予想点は、飛行経路上で、現在の飛行速度から求めた、現在位置から所定時間後に到達する計算上の位置である。前記飛行経路は、たとえば直線、円形、楕円形およびその他の2次曲線が用いられてもよい。   The cross track deviation is a deviation between the current position of the aircraft and the position of the aircraft on the flight path. The course deviation is an angle formed by the traveling direction of the aircraft and the flight path. The predicted passing point is a calculated position that arrives after a predetermined time from the current position, obtained from the current flight speed on the flight path. As the flight path, for example, a straight line, a circle, an ellipse, and other quadratic curves may be used.

現在位置におけるバンク角は、クロス・トラック偏差およびコース偏差だけでなく、現在の飛行速度から求めた通過予想点をも考慮して算出されるので、航空機の速度が変化しても通過点を通る旋回経路に対してオーバーシュートが生じることが防がれ、速度の変化に応じてバンク角を高い応答性で算出することができる。   The bank angle at the current position is calculated taking into account not only the cross track deviation and course deviation but also the estimated passing point obtained from the current flight speed, so it will pass through the passing point even if the aircraft speed changes. It is possible to prevent an overshoot from occurring on the turning route, and to calculate the bank angle with high responsiveness according to a change in speed.

このようなバンク角は、航空機に搭載されるオートフライトシステムとも呼ばれる航法誘導装置の飛行管理計算機(Flight Management Computer;略称FMC)によって算出され、舵面の制御に用いられることによって、高い旋回性能を実現することができる。また、オートパイロットモードを用いないマニュアル操作によって操縦する場合には、たとえば電子式姿勢指示器(Electronic Attitude Indicator;略称EAI)に前記バンク角を用いて生成したフライトディレクタを表示させ、パイロットに飛行経路の誘導情報を提示するようにしてもよい。   Such a bank angle is calculated by a flight management computer (FMC) of a navigation guidance device also called an auto flight system mounted on an aircraft, and used for control of a control surface, thereby achieving high turning performance. Can be realized. Further, in the case of maneuvering by manual operation without using the autopilot mode, for example, an electronic attitude indicator (abbreviated as EAI) is displayed with a flight director generated using the bank angle, and the flight path is displayed to the pilot. The guidance information may be presented.

また、本発明の飛行経路のバンク角生成方法によれば、前記飛行速度として対地速度が用いられる。この対地速度は、航空機に搭載されるたとえば衛星航法装置によって得られ、水平面内の速度成分の和として算出することができる。   According to the flight path bank angle generation method of the present invention, the ground speed is used as the flight speed. This ground speed is obtained by, for example, a satellite navigation device mounted on an aircraft, and can be calculated as the sum of speed components in a horizontal plane.

さらに、本発明の飛行制御方法によれば、前記飛行経路に沿って航空機が飛行するように、航空機の舵面を制御することによって、航空機の速度が変化しても、速度に応じた最適なバンク角で旋回するように舵面が制御され、通過点を通る旋回経路に対してオーバーシュートを生じることなく、高精度で航空機の飛行を制御することができる。   Furthermore, according to the flight control method of the present invention, even if the speed of the aircraft changes by controlling the control surface of the aircraft so that the aircraft flies along the flight path, the optimal control according to the speed is performed. The control surface is controlled to turn at the bank angle, and the flight of the aircraft can be controlled with high accuracy without causing overshoot to the turning path passing through the passing point.

さらに、本発明の飛行経路のバンク角生成装置によれば、バンク角生成手段は、航空機の予め設定される飛行経路に対するクロス・トラック偏差と、前記予め設定される飛行経路上の目標通過点に対するコース偏差と、飛行経路上の飛行速度における現在位置から所定時間後の通過予想点とに基づいて、前記クロス・トラック偏差およびコース偏差を打ち消すように、現在位置における航空機のバンク角を算出する。飛行制御計算機は、前記バンク角生成手段によって算出されたバンク角に基づいて、舵角を計算して出力する。舵面制御手段は、前記飛行制御計算機から出力される舵角に基づいて、航空機の舵面を制御する。   Further, according to the bank angle generation device for a flight path of the present invention, the bank angle generation means is configured to detect a cross track deviation with respect to a preset flight path of the aircraft and a target passing point on the preset flight path. The bank angle of the aircraft at the current position is calculated so as to cancel out the cross track deviation and the course deviation based on the course deviation and the predicted passing point after a predetermined time from the current position at the flight speed on the flight path. The flight control computer calculates and outputs a steering angle based on the bank angle calculated by the bank angle generation means. The control surface control means controls the control surface of the aircraft based on the steering angle output from the flight control computer.

クロス・トラック偏差とコース偏差と通過予想点とに基づいて、現在位置における航空機のバンク角が算出される。航空機には、飛行経路に沿って航空機が飛行するように舵面を制御する飛行制御装置が搭載される。この飛行制御装置は、パイロットによって入力された出発点および到着点ならびにその間の複数の通過点に基づいて、前記飛行経路を生成する。こうして生成された飛行経路は、飛行制御装置の記憶部に飛行データとして設定され、記憶される。   The bank angle of the aircraft at the current position is calculated based on the cross track deviation, the course deviation, and the expected passing point. The aircraft is equipped with a flight control device that controls the control surface so that the aircraft flies along the flight path. The flight control device generates the flight path based on a starting point and an arriving point input by a pilot and a plurality of passing points therebetween. The flight path thus generated is set and stored as flight data in the storage unit of the flight control device.

前記クロス・トラック偏差は、航空機の現在位置と、飛行経路上の自機位置との偏差である。また前記コース偏差は、航空機の進行方向と飛行経路とが成す角度である。通過予想点は、飛行経路上で現在の飛行速度から求めた、現在位置から所定時間後に到達する計算上の位置である。前記飛行経路は、たとえば直線、円形、楕円形およびその他の2次曲線が用いられてもよい。   The cross track deviation is a deviation between the current position of the aircraft and the position of the aircraft on the flight path. The course deviation is an angle formed by the traveling direction of the aircraft and the flight path. The predicted passing point is a calculated position that is obtained from the current flight speed on the flight path and arrives after a predetermined time from the current position. As the flight path, for example, a straight line, a circle, an ellipse, and other quadratic curves may be used.

現在位置におけるバンク角は、クロス・トラック偏差およびコース偏差だけでなく、現在位置での飛行速度から求めた通過予想点をも考慮して算出されるので、航空機の速度が変化しても通過点を通る旋回経路に対してオーバーシュートが生じることが防がれ、速度の変化に応じてバンク角φを高い応答性で算出することができる。   The bank angle at the current position is calculated taking into account not only the cross track deviation and course deviation but also the estimated passing point obtained from the flight speed at the current position. An overshoot is prevented from occurring with respect to the turning route passing through, and the bank angle φ can be calculated with high responsiveness in accordance with a change in speed.

このようなバンク角は、航空機に搭載されるオートフライトシステムとも呼ばれる航法誘導装置の飛行管理計算機(Flight Management Computer;略称FMC)によって舵面を駆動する各種のアクチュエータのバンク角コマンドとして出力され、舵面が制御される。これによって、高い旋回性能を実現することができる。また、オートパイロットを用いないマニュアル操作によって操縦する場合には、たとえば電子式姿勢指示器(Electronic
Attitude Indicator;略称EAI)によって前記バンク角を用いて生成したフライトディレクタを表示し、パイロットに誘導情報を提示するようにしてもよい。
Such a bank angle is output as a bank angle command of various actuators that drive a control surface by a flight management computer (FMC) of a navigation guidance device called an auto flight system mounted on an aircraft. The surface is controlled. Thereby, high turning performance can be realized. In addition, when maneuvering by manual operation without using an autopilot, for example, an electronic attitude indicator (electronic
The flight director generated using the bank angle may be displayed by Attitude Indicator (abbreviated as EAI), and guidance information may be presented to the pilot.

さらに、本発明の飛行経路のバンク角生成装置によれば、前記飛行速度として対地速度が用いられる。この対地速度は、航空機に搭載されるたとえば衛星航法装置によって得られ、水平面内の速度成分の和として算出することができる。   Furthermore, according to the bank angle generation device for a flight path of the present invention, a ground speed is used as the flight speed. This ground speed is obtained by, for example, a satellite navigation device mounted on an aircraft, and can be calculated as the sum of speed components in a horizontal plane.

さらに、本発明の飛行制御装置によれば、前記飛行経路に沿って航空機が飛行するように、航空機の舵面を制御することによって、航空機の速度が変化しても、速度に応じた最適なバンク角で旋回するように舵面が制御され、通過点を通る旋回経路に対してオーバーシュートを生じることなく、高精度で航空機の飛行を制御することができる。   Furthermore, according to the flight control device of the present invention, even if the speed of the aircraft changes by controlling the control surface of the aircraft so that the aircraft flies along the flight path, the optimal control according to the speed is performed. The control surface is controlled to turn at the bank angle, and the flight of the aircraft can be controlled with high accuracy without causing overshoot to the turning path passing through the passing point.

図1は、本発明の実施の一形態の飛行経路のバンク角生成装置20を示すブロック図であり、図2は図1に示される飛行経路のバンク角生成装置20を含む飛行制御装置21を示すブロック図である。なお、本実施の形態において、飛行経路のバンク角生成装置20によって飛行経路のバンク角生成方法を実現し、飛行制御装置21によって飛行制御方法を実現する。この飛行制御装置21は、パイロットによって入力された出発点および到着点ならびにその間の複数の通過点に基づいて飛行経路を生成し、飛行制御装置の記憶部に飛行データとして設定され、記憶される。また、航空機(後述の図3参照)22は固定翼航空機を想定して説明する。   FIG. 1 is a block diagram showing a flight path bank angle generation apparatus 20 according to an embodiment of the present invention. FIG. 2 shows a flight control apparatus 21 including the flight path bank angle generation apparatus 20 shown in FIG. FIG. In the present embodiment, the flight path bank angle generation device 20 realizes the flight path bank angle generation method, and the flight control apparatus 21 realizes the flight control method. The flight control device 21 generates a flight path based on the departure point and arrival point input by the pilot and a plurality of passing points therebetween, and is set and stored as flight data in the storage unit of the flight control device. The aircraft (see FIG. 3 described later) 22 will be described assuming a fixed-wing aircraft.

航空機22に搭載される飛行制御装置21は、慣性基準装置23、衛星航法装置24、対気諸元計測装置25、バンク角生成装置20、表示装置26、飛行制御計算機27、舵面制御装置28および舵面駆動装置29を含む。   The flight control device 21 mounted on the aircraft 22 includes an inertial reference device 23, a satellite navigation device 24, an air specification measurement device 25, a bank angle generation device 20, a display device 26, a flight control computer 27, and a control surface control device 28. And a control surface driving device 29.

前記バンク角生成装置20は、経路生成部31、基準バンク角コマンド生成部32、クロス・トラック偏差算出部33、コース偏差算出部34、クロス・トラック偏差ゲイン乗算器35、コース偏差ゲイン乗算器36、第1減算器37、第2減算器38、バンク角φリミッタ39およびレートリミッタ40を含む。   The bank angle generation device 20 includes a path generation unit 31, a reference bank angle command generation unit 32, a cross track deviation calculation unit 33, a course deviation calculation unit 34, a cross track deviation gain multiplier 35, and a course deviation gain multiplier 36. , First subtractor 37, second subtractor 38, bank angle φ limiter 39 and rate limiter 40.

慣性基準装置(Inertial Reference System;略称IRS)23は、航空機にジャイロによって常に水平を保つ安定板を搭載し、安定板に高精度の加速度計を直交3軸方向に設けて機体の動きによって生じる加速度を検出し、内臓のコンピュータによって前記加速度の積分計算を繰り返すことによって、速度、飛行距離、飛行方向を求めることができるように構成される。   Inertial Reference System (abbreviated as IRS) 23 is equipped with a stabilization plate that is always kept horizontal by a gyro on the aircraft, and a high-accuracy accelerometer is provided on the stabilization plate in three orthogonal directions. , And by repeating the integral calculation of the acceleration by a built-in computer, the speed, the flight distance, and the flight direction can be obtained.

衛星航法装置(Satellite Navigation System)24は、GPS(Global Positioning
System)とも称される衛星による全世界測位システムを用いて、航空機の3次元位置、速度および時間を探知することができる。
The satellite navigation system 24 is a GPS (Global Positioning System).
A satellite global positioning system, also called System, can be used to detect the three-dimensional position, speed and time of an aircraft.

対気諸元計測装置(Air Data System;略称ADS)25は、ピトー静圧管などによって対気飛行速度の大きさ、方向、高度を同時に計測することができる対気速度計であり、機体から突き出して設けられるプローブによって対気変化を圧力として検出し、検出した圧力を演算処理装置によって電気信号に変換する。   The Air Data System (abbreviated as ADS) 25 is an air speed meter that can simultaneously measure the size, direction, and altitude of the air flight speed using a Pitot static pressure tube, etc. An air change is detected as a pressure by a probe provided, and the detected pressure is converted into an electric signal by an arithmetic processing unit.

表示装置26は、フライトディレクタなどが備えられる液晶ディスプレイ装置によって実現される。   The display device 26 is realized by a liquid crystal display device provided with a flight director or the like.

飛行制御計算機(Flight Control Computer;略称FCC)27は、バンク角生成手段20から出力されたバンク角φに基づいて、舵角コマンドを算出して出力する。   A flight control computer (abbreviated as FCC) 27 calculates and outputs a steering angle command based on the bank angle φ output from the bank angle generation means 20.

舵面制御装置28は、飛行制御計算機27から出力された舵角コマンドに基づいて、舵面制御信号を算出して出力する。舵面制御装置28からの舵面制御信号は、航空機22の姿勢をヨー方向に変位させるラダー、航空機22の姿勢をロール方向に変位させるエルロン、ならびに航空機22の姿勢をピッチ方向に変位させるエレベータおよびスタビレータなどの各種の舵面を駆動するアクチュエータに動作指令として入力され、各舵面を制御する。   The control surface controller 28 calculates and outputs a control surface control signal based on the control angle command output from the flight control computer 27. The control surface control signal from the control surface control device 28 includes a ladder that displaces the attitude of the aircraft 22 in the yaw direction, an aileron that displaces the attitude of the aircraft 22 in the roll direction, an elevator that displaces the attitude of the aircraft 22 in the pitch direction, and An operation command is input to an actuator that drives various control surfaces such as a stabilizer to control each control surface.

図3は、航空機22の通過予想点P1付近の飛行経路mを説明するための平面図である。前記バンク角生成装置20の経路生成部31は、経由点データおよび風データから所定の経路生成ロジックによって経路データを算出して出力する。この経路データとしては、各経路毎の始点位置、終点位置、経路タイプなどを含む。   FIG. 3 is a plan view for explaining the flight path m in the vicinity of the predicted passing point P1 of the aircraft 22. The route generation unit 31 of the bank angle generation device 20 calculates and outputs route data from the waypoint data and wind data by a predetermined route generation logic. The route data includes a start point position, an end point position, a route type, and the like for each route.

基準バンク角コマンド生成部32は、経路生成部31からの前記通過予想点P1と、経路上の飛行位置P2とに基づいて、予め設定された基準バンク角コマンド生成ロジックによって演算処理し、基準バンク角φ0をコマンドとして出力する。クロス・トラック偏差XTEは、航空機22の現在の飛行方向と、飛行経路とが成す角度である。また前記コース偏差CEは、航空機22の進行方向と飛行経路とが成す角度である。通過予想点は、前記飛行経路上の、現在の飛行速度から求めた、現在位置から所定時間後に到達する計算上の位置である。前記飛行経路は、たとえば直線、円形、楕円形およびその他の2次曲線が用いられてもよい。   The reference bank angle command generation unit 32 performs arithmetic processing using a preset reference bank angle command generation logic based on the predicted passing point P1 from the route generation unit 31 and the flight position P2 on the route, The angle φ0 is output as a command. The cross track deviation XTE is an angle formed by the current flight direction of the aircraft 22 and the flight path. The course deviation CE is an angle formed by the traveling direction of the aircraft 22 and the flight path. The predicted passing point is a calculated position that arrives after a predetermined time from the current position, obtained from the current flight speed, on the flight path. As the flight path, for example, a straight line, a circle, an ellipse, and other quadratic curves may be used.

この基準バンク角φ0は、経路旋回偏差をΔCRS_FPとし、航空機22のロールレートなどの旋回性能を考慮して設定される時間をΔtとし、これらから求められる予想旋回率をΔCRS_FT/Δtとし、航空機22の対地速度をVGSとしたとき、基準バンク角φ0は、
φ0=tan−1{(ΔCRS_FP/Δt)・(VGS/g)} …(1)
によって求められる。
The reference bank angle φ0 is set such that the path turning deviation is ΔCRS_FP, the time set in consideration of the turning performance such as the roll rate of the aircraft 22 is Δt, and the expected turning rate obtained therefrom is ΔCRS_FT / Δt. When the ground speed is VGS, the reference bank angle φ0 is
φ0 = tan −1 {(ΔCRS_FP / Δt) · (VGS / g)} (1)
Sought by.

ここに、gは重力加速度である。また、前記時間Δtは、機体の旋回性能に合わせ設定する時間である。   Here, g is a gravitational acceleration. The time Δt is a time set according to the turning performance of the aircraft.

クロス・トラック偏差算出部33は、前記経路生成部31からの経路上の飛行位置と、慣性基準装置23からの現在位置とに基づいて、それらの差分を算出してクロス・トラック偏差XTEを出力する。   The cross track deviation calculation unit 33 calculates a difference between the flight position on the route from the route generation unit 31 and the current position from the inertial reference device 23 and outputs the cross track deviation XTE. To do.

コース偏差算出部34は、前記経路生成部31からの経路のコースとトラック角とに基づいて、それらの差としてコース偏差CEを出力する。   The course deviation calculation unit 34 outputs a course deviation CE as a difference between the course and the track angle of the route from the route generation unit 31.

クロス・トラック偏差ゲイン乗算器35は、クロス・トラック偏差算出部33からのクロス・トラック偏差XTEに予め定める第1ゲインG1を乗じた値を演算して求め、出力する。   The cross track deviation gain multiplier 35 calculates and obtains a value obtained by multiplying the cross track deviation XTE from the cross track deviation calculation unit 33 by a predetermined first gain G1 and outputs the result.

コース偏差ゲイン乗算器36は、コース偏差算出部34からのコース偏差CEに予め定める第2ゲインG2を乗じた値を演算して求め、出力する。   The course deviation gain multiplier 36 calculates and outputs a value obtained by multiplying the course deviation CE from the course deviation calculation unit 34 by a predetermined second gain G2.

第1減算器37は、クロス・トラック偏差ゲイン乗算器35からのクロス・トラック偏差XTEと、コース偏差ゲイン乗算器36からのコース偏差CEとの差分を算出して第1バンク角φ1を求め、出力する。   The first subtractor 37 calculates the difference between the cross track deviation XTE from the cross track deviation gain multiplier 35 and the course deviation CE from the course deviation gain multiplier 36 to obtain the first bank angle φ1, Output.

第2減算器38は、第1減算器37からの第1バンク角φ1と、基準バンク角コマンド生成部32からの基準バンク角φ0との差分を算出して第2バンク角φ2を求め、出力する。   The second subtractor 38 calculates the difference between the first bank angle φ1 from the first subtractor 37 and the reference bank angle φ0 from the reference bank angle command generation unit 32 to obtain the second bank angle φ2 and outputs it. To do.

バンク角リミッタ39は、第2減算器38からの第2バンク角φ2の上限および下限を制限する上下限リミッタであって、第2バンク角φ2が航空機22の旋回性能を超えないように制限された第3バンク角φ3を出力する。   The bank angle limiter 39 is an upper / lower limiter that limits the upper and lower limits of the second bank angle φ2 from the second subtractor 38, and is limited so that the second bank angle φ2 does not exceed the turning performance of the aircraft 22. The third bank angle φ3 is output.

レートリミッタ40は、前記バンク角リミッタ39から出力された、上限および下限が制限された第3バンク角φ3に対して、ロールの速さから決まる上限値および下限値を制限し、この範囲内の値が次の飛行制御計算機27に与えるバンク角φとして出力される。   The rate limiter 40 limits the upper limit value and the lower limit value determined from the roll speed to the third bank angle φ3 output from the bank angle limiter 39 and whose upper limit and lower limit are restricted. The value is output as the bank angle φ given to the next flight control computer 27.

前記レートリミッタ39からのバンク角φは、前記飛行制御計算機27に与えられ、飛行制御計算機27は舵角コマンドを算出する。舵面制御装置28は、飛行制御計算機27によって算出された舵角コマンドに基づいて、舵面制御信号を舵面制御装置28に出力し、この舵面制御信号は舵面駆動装置29に与えられて、航空機22の舵面が制御される。   The bank angle φ from the rate limiter 39 is given to the flight control computer 27, and the flight control computer 27 calculates a steering angle command. The control surface control device 28 outputs a control surface control signal to the control surface control device 28 based on the control angle command calculated by the flight control computer 27, and this control surface control signal is given to the control surface drive device 29. Thus, the control surface of the aircraft 22 is controlled.

以上のような構成によれば、バンク角生成装置20によって、クロス・トラック偏差XTEとコース偏差CEと通過予想点P1とに基づいて、現在位置における航空機のバンク角φが算出される。このようなバンク角φは、クロス・トラック偏差XTEおよびコース偏差CEという航空機22の飛行する方位、すなわち進行方向に関する偏差だけでなく、現在位置での飛行速度から求めた通過予想点P1をも考慮して算出されるので、速度の変化に応じてバンク角φを高い応答性で算出することができ、オートパイロットモードで航行中に航空機22の速度が変化しても、通過予想点P1を通る旋回経路mに対してオーバーシュートが生じることが防がれ、高い旋回性能を実現することができる。   According to the above configuration, the bank angle generating device 20 calculates the bank angle φ of the aircraft at the current position based on the cross-track deviation XTE, the course deviation CE, and the expected passing point P1. Such a bank angle φ takes into account not only the deviation in the flight direction of the aircraft 22, that is, the crossing deviation XTE and the course deviation CE, that is, the deviation in the traveling direction, but also the predicted passing point P 1 obtained from the flight speed at the current position. Therefore, the bank angle φ can be calculated with high responsiveness according to the change in speed, and even if the speed of the aircraft 22 changes during navigation in the autopilot mode, it passes through the predicted passing point P1. An overshoot is prevented from occurring with respect to the turning path m, and high turning performance can be realized.

本発明の実施の他の形態では、オートパイロットモードを用いないマニュアル操作によって操縦する場合には、たとえば電子式姿勢指示器(Electronic Attitude Indicator;略称EAI)によって前記バンク角φを用いて生成したフライトディレクタを表示し、パイロットに誘導情報を提示するようにしてもよい。   In another embodiment of the present invention, when maneuvering by manual operation not using the autopilot mode, for example, a flight generated using the bank angle φ by an electronic attitude indicator (abbreviated as EAI) A director may be displayed to provide guidance information to the pilot.

また、前記飛行速度として対地速度が用いられる。この対地速度は、航空機に搭載される衛星航法装置によって得られ、水平面内の速度成分の和を算出することができる。   The ground speed is used as the flight speed. This ground speed is obtained by a satellite navigation device mounted on an aircraft, and the sum of speed components in a horizontal plane can be calculated.

本発明の実施の一形態の飛行経路のバンク角生成装置20を示すブロック図である。It is a block diagram which shows the bank angle production | generation apparatus 20 of the flight path of one Embodiment of this invention. 図1に示されるバンク角生成装置20を含む飛行制御装置21を簡略化して示すブロック図である。It is a block diagram which simplifies and shows the flight control apparatus 21 containing the bank angle production | generation apparatus 20 shown by FIG. 航空機22の通過予想点P1付近の飛行経路mを説明するための平面図である。4 is a plan view for explaining a flight path m in the vicinity of a predicted passing point P1 of the aircraft 22. FIG. 従来の技術のバンク角生成方法によってバンク角を生成する手順を説明するための平面図である。It is a top view for demonstrating the procedure which produces | generates a bank angle by the bank angle production | generation method of a prior art. 図4に関連して述べたバンク角生成方法を実行するバンク角生成装置10の電気的構成を簡略化して示すブロック図である。FIG. 5 is a block diagram showing a simplified electrical configuration of a bank angle generation device 10 that executes the bank angle generation method described with reference to FIG. 4.

符号の説明Explanation of symbols

20 バンク角生成装置
21 飛行制御装置
22 航空機
23 慣性基準装置
24 衛星航法装置
25 対気諸元計測装置
26 表示装置
27 飛行制御計算機
28 舵面制御装置
29 舵面駆動装置
31 経路生成部
32 基準バンク角コマンド生成部
33 クロス・トラック偏差算出部
34 コース偏差算出部
35 クロス・トラック偏差ゲイン乗算器
36 コース偏差ゲイン乗算器
37 第1減算器
38 第2減算器
39 バンク角リミッタ
40 レートリミッタ
DESCRIPTION OF SYMBOLS 20 Bank angle production | generation apparatus 21 Flight control apparatus 22 Aircraft 23 Inertial reference apparatus 24 Satellite navigation apparatus 25 Air characteristic measurement apparatus 26 Display apparatus 27 Flight control computer 28 Control surface control apparatus 29 Control surface drive apparatus 31 Path | route generation part 32 Reference bank Angle command generator 33 Cross track deviation calculator 34 Course deviation calculator 35 Cross track deviation gain multiplier 36 Course deviation gain multiplier 37 First subtractor 38 Second subtractor 39 Bank angle limiter 40 Rate limiter

Claims (6)

航空機に予め設定された飛行経路および航空機の現在位置間のクロス・トラック偏差と、前記飛行経路の方向および航空機の進行方向間のコース偏差と、飛行経路上の飛行速度における現在位置から所定時間後の通過予想点とに基づいて、前記クロス・トラック偏差およびコース偏差を発生させないように、現在位置における航空機のバンク角を生成することを特徴とする飛行経路のバンク角生成方法。   Cross-track deviation between the preset flight path of the aircraft and the current position of the aircraft, course deviation between the direction of the flight path and the traveling direction of the aircraft, and a predetermined time after the current position at the flight speed on the flight path The flight path bank angle generation method includes generating the bank angle of the aircraft at the current position so as not to generate the cross-track deviation and the course deviation based on a predicted passing point. 前記飛行速度は、対地速度であることを特徴とする請求項1記載の飛行経路のバンク角生成方法。   2. The flight path bank angle generation method according to claim 1, wherein the flight speed is a ground speed. 請求項1または2記載の飛行経路のバンク角生成方法によって生成されたバンク角を用いて飛行経路に沿って航空機が飛行するように、航空機の舵面を制御することを特徴とする飛行制御方法。   A flight control method for controlling a control surface of an aircraft so that the aircraft flies along the flight path using the bank angle generated by the bank angle generation method of the flight path according to claim 1 or 2. . 航空機の予め設定される飛行経路に対するクロス・トラック偏差と、前記予め設定される飛行経路の方向に対するコース偏差と、飛行経路上の飛行速度における現在位置から所定時間後の通過予想点とに基づいて、前記クロス・トラック偏差およびコース偏差を打ち消すように、現在位置における航空機のバンク角を生成することを特徴とする飛行経路のバンク角生成装置。   Based on the cross-track deviation with respect to the predetermined flight path of the aircraft, the course deviation with respect to the direction of the predetermined flight path, and the predicted passing point after a predetermined time from the current position on the flight speed on the flight path A bank angle generating device for a flight path, wherein the bank angle of the aircraft at the current position is generated so as to cancel the cross track deviation and the course deviation. 前記飛行速度は、対地速度であることを特徴とする請求項4記載の飛行経路のバンク角生成装置。   5. The flight path bank angle generation device according to claim 4, wherein the flight speed is a ground speed. 請求項4または5記載の飛行経路のバンク角生成装置によって生成されたバンク角を用いて飛行経路に沿って航空機が飛行するように、航空機の舵面を制御することを特徴とする飛行制御装置。   6. A flight control device that controls a control surface of an aircraft so that the aircraft flies along the flight path using the bank angle generated by the bank angle generation device of the flight path according to claim 4 or 5. .
JP2004327538A 2004-11-11 2004-11-11 Method and apparatus for generating bank angle of flight path Active JP4188899B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2004327538A JP4188899B2 (en) 2004-11-11 2004-11-11 Method and apparatus for generating bank angle of flight path

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2004327538A JP4188899B2 (en) 2004-11-11 2004-11-11 Method and apparatus for generating bank angle of flight path

Publications (2)

Publication Number Publication Date
JP2006137278A true JP2006137278A (en) 2006-06-01
JP4188899B2 JP4188899B2 (en) 2008-12-03

Family

ID=36618364

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2004327538A Active JP4188899B2 (en) 2004-11-11 2004-11-11 Method and apparatus for generating bank angle of flight path

Country Status (1)

Country Link
JP (1) JP4188899B2 (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106529705A (en) * 2016-10-25 2017-03-22 合肥飞友网络科技有限公司 Low-frequency latitude and longitude data supplement optimization flight locus method
CN113492971A (en) * 2020-03-18 2021-10-12 沃科波特有限公司 Flight device and control method and control device thereof

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106529705A (en) * 2016-10-25 2017-03-22 合肥飞友网络科技有限公司 Low-frequency latitude and longitude data supplement optimization flight locus method
CN113492971A (en) * 2020-03-18 2021-10-12 沃科波特有限公司 Flight device and control method and control device thereof
CN113492971B (en) * 2020-03-18 2024-04-30 沃科波特有限公司 Flying device, control method and control device thereof

Also Published As

Publication number Publication date
JP4188899B2 (en) 2008-12-03

Similar Documents

Publication Publication Date Title
RU2544283C2 (en) Data display, flying aid and method of data display
EP3410249B1 (en) System to estimate wind direction and strength using constant bank angle turn
CN111650958B (en) Online path planning method for fixed-wing unmanned aerial vehicle takeoff section cut-in route point
US9618938B2 (en) Field-based torque steering control
US8108133B2 (en) Vehicle position keeping system
US10656650B2 (en) Method for guiding and controlling drone using information for controlling camera of drone
RU2619367C2 (en) Control display of aircraft speed
JP2018517619A (en) System and method for a vertical flight indicator
US7616130B2 (en) Method and a device for processing and displaying aircraft piloting information
US20180052472A1 (en) Trajectory control of a vehicle
CN108562289A (en) Quadrotor laser radar air navigation aid in continuous polygon geometry environment
JP4617990B2 (en) Automatic flight control device, automatic flight control method, and automatic flight control program
US20210215486A1 (en) Positioning guidance method and system
JP4188899B2 (en) Method and apparatus for generating bank angle of flight path
WO2018107733A1 (en) Method and device for controlling airship
JP4198668B2 (en) Aircraft turning path generation method and apparatus
US11048275B1 (en) Enhanced guidance laws for precision operations
KR102067071B1 (en) Method and system for compensation error of circle loitering guidance control in uav
US9889926B2 (en) Air vehicles and systems for preemptive turbulence mitigation
EP4053504B1 (en) Systems and methods for model based inertial navigation for a spinning projectile
Khaghani et al. Autonomous navigation of small UAVs based on vehicle dynamic model
JP5956468B2 (en) Method and system for maneuvering a flying object with a rear propulsion device
Yu et al. A Camera-IMU Sensor Fusion for Robust Lane Information on Lateral Control System
RU2708785C1 (en) Method for automatic control of longitudinal movement of aircraft on landing
Bencatel et al. Video tracking control algorithms for unmanned air vehicles

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20041111

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20070201

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20070821

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20071019

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20080617

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20080806

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: 20080909

A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20080911

R150 Certificate of patent or registration of utility model

Ref document number: 4188899

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

Free format text: JAPANESE INTERMEDIATE CODE: R150

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20110919

Year of fee payment: 3

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20110919

Year of fee payment: 3

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20120919

Year of fee payment: 4

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20120919

Year of fee payment: 4

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130919

Year of fee payment: 5

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20140919

Year of fee payment: 6

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250