JPH0569896A - Automatic flight control system - Google Patents

Automatic flight control system

Info

Publication number
JPH0569896A
JPH0569896A JP26317591A JP26317591A JPH0569896A JP H0569896 A JPH0569896 A JP H0569896A JP 26317591 A JP26317591 A JP 26317591A JP 26317591 A JP26317591 A JP 26317591A JP H0569896 A JPH0569896 A JP H0569896A
Authority
JP
Japan
Prior art keywords
flight
point
target
roll
course
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
JP26317591A
Other languages
Japanese (ja)
Other versions
JPH07115674B2 (en
Inventor
Keiichi Yokoi
圭一 横井
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.)
Japan Steel Works Ltd
Technical Research and Development Institute of Japan Defence Agency
Original Assignee
Japan Steel Works Ltd
Technical Research and Development Institute of Japan Defence Agency
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 Japan Steel Works Ltd, Technical Research and Development Institute of Japan Defence Agency filed Critical Japan Steel Works Ltd
Priority to JP26317591A priority Critical patent/JPH07115674B2/en
Publication of JPH0569896A publication Critical patent/JPH0569896A/en
Publication of JPH07115674B2 publication Critical patent/JPH07115674B2/en
Anticipated expiration legal-status Critical
Expired - Lifetime legal-status Critical Current

Links

Abstract

PURPOSE:To attain flight in the shortest arrival required time by improving accuracy of reaching a target flight point FTP while substantially reducing a load on control of a pilot. CONSTITUTION:A target roll attitude for turning by a predetermined turn rate toward a flight course to TIP is set from flight information to FTP and from a level of deviation between a flight direction of an airframe and a nose azimuth, and a command for a roll attitude of the airframe to follow up to the target roll attitude is output (step l). After finishing a turn, the roll attitude of the airframe is returned to a horizontal and controlled so as to prevent detaching from the course (step 2). The target roll attitude necessary for turning by the predetermined turn rate toward the flight course to the FTP is set to output the command for the roll attitude of the airframe to follow up to the target roll attitude (step 3). The roll attitude of the airframe is returned to the horizontal in accordance with approaching the predetermined flight course to the target flight point, and the roll attitude is controlled so as to prevent detaching from the predetermined flight course.

Description

【発明の詳細な説明】Detailed Description of the Invention

【0001】[0001]

【産業上の利用分野】本発明は、航空機(ヘリコプタ)に
おける目標飛行点(FTP)への誘導飛行を自動化し、パ
イロットの負荷を軽減するための自動飛行制御システム
(AFCS)に関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to an automatic flight control system for automating guided flight to a target flight point (FTP) in an aircraft (helicopter) and reducing the load on a pilot.
(AFCS).

【0002】[0002]

【従来の技術】従来、ヘリコプタにおける自動飛行制御
システムは、図11に示すように、パイロットの操縦に
より航法装置からの目標飛行点への方位、距離、情報に
基づき手動操縦により目標飛行点へ飛行するのが一般的
である。
2. Description of the Related Art Conventionally, as shown in FIG. 11, an automatic flight control system for a helicopter has conventionally operated a pilot to fly to a target flight point based on the direction, distance and information from the navigation device to the target flight point. It is common to do.

【0003】[0003]

【発明が解決しようとする課題】従来の自動飛行制御シ
ステムは、パイロットの手動操縦が主体となるもので、
以下の問題点を有する。
The conventional automatic flight control system is mainly based on manual pilot operation.
It has the following problems.

【0004】(ア) パイロットの操縦上の負荷が大き
い。
(A) The pilot has a large operational load.

【0005】(イ) パイロットの熟練度によって目標飛
行点(FTP)への到達精度及び到達所要時間が大きく左
右される。
(A) The accuracy of reaching the target flight point (FTP) and the time required to reach it greatly depend on the skill of the pilot.

【0006】本発明は上記実情に鑑みてなされたもの
で、目標飛行点への誘導飛行を完全自動化して、パイロ
ットの操縦上の負荷を大幅に軽減すると共に目標飛行点
(FTP)への到達精度を平均的に良好なものとし、更に
最短の到達所要時間での飛行を可能とする自動飛行制御
システムを提供することを目的とする。
The present invention has been made in view of the above circumstances, and the guidance flight to the target flight point is fully automated to significantly reduce the pilot's operational load and to achieve the target flight point.
It is an object of the present invention to provide an automatic flight control system that makes the accuracy of reaching (FTP) good on average and that enables flight in the shortest required arrival time.

【0007】[0007]

【課題を解決するための手段】本発明は、目標飛行点へ
の飛行情報を与える航法機能を有するヘリコプタの自動
飛行制御システムにおいて、目標飛行点への自動飛行モ
ードがエンゲージされた後、エンゲージされた時の対気
速度よりバンク角を算出し、所定の旋回率で旋回を行う
ためのコマンドをロール・サーボに出力する第1の手
段、自動飛行モードがエンゲージされた後、所定の旋回
率での旋回を終了した場合には、ターン・イン・ポイン
ト手前の見越し旋回点までは飛行コースに対するずれを
修正して飛行コースに乗せるようにロール姿勢制御を行
うためのコマンドをロール・サーボに出力する第2の手
段、目標飛行点への進入コースを指定した場合には、上
記第2の手段の後目標飛行点への進入コースに向け所定
旋回率での旋回を行うためのコマンドを出力し、旋回後
は目標飛行点への進入コースに対するずれを修正しつつ
FTPオン・トップ以前にロール姿勢を水平に戻すため
のコマンドをロール・サーボに出力する手段からなるロ
ール系統制御サブシステムと、上記目標飛行点への自動
飛行モードがエンゲージされた後、釣合旋回モード(オ
ート・ターン・コーディネーション・モード)を実行す
るためのコマンドをヨー・サーボに出力するヨー系統制
御サブシステムと、上記目標飛行点への自動飛行モード
がエンゲージされた時の対気速度を保持するためのコマ
ンドをピッチ・サーボに出力するピッチ系サブシステム
と、ロール系統制御サブシステムのモード切換を行うモ
ード制御サブシステムとを備え、任意の飛行条件から目
標飛行点へ自動的に誘導飛行させることを特徴とするも
のである。
SUMMARY OF THE INVENTION The present invention is an automatic flight control system for a helicopter having a navigation function for providing flight information to a target flight point, after the automatic flight mode to the target flight point is engaged and then engaged. The first means to calculate the bank angle from the airspeed at the time of rotation and output the command to make a turn at a predetermined turn rate to the roll servo, after the automatic flight mode is engaged, at the predetermined turn rate When the turn is finished, the command for controlling the roll attitude is output to the roll servo to correct the deviation from the flight course and put it on the flight course up to the prospective turn point before the turn-in point. When the second means, the approach course to the target flight point, is designated, the vehicle turns at a predetermined turn rate toward the approach course to the target flight point after the second means. Command to output to the roll servo the command to return the roll attitude to the horizontal position before FTP on top while correcting the deviation with respect to the approach course to the target flight point after turning. After the control subsystem and the automatic flight mode to the target flight point are engaged, the yaw system control subsystem that outputs the command to execute the balanced turning mode (auto turn coordination mode) to the yaw servo Mode switching between the system, the pitch system subsystem that outputs commands to the pitch servo to maintain the airspeed when the automatic flight mode to the target flight point is engaged, and the roll system control subsystem Equipped with a mode control subsystem, it automatically guides flight from any flight condition to the target flight point. It is a feature.

【0008】[0008]

【作用】本発明における自動飛行制御システムは、次の
4つのステップにより飛行制御を行う。
The automatic flight control system according to the present invention controls flight by the following four steps.

【0009】(1) ステップ1a. ロール系統制御サ
ブシステムは、航空機の有する航法機能から入力された
目標飛行点FTPへの飛行情報と、機体の飛行方向と機
首方位とのずれの大きさ(以下、偏流角という)を使用し
て、目標飛行点FTPへの進入コースを指定した場合に
は、航法機能が設定したターン・イン・ポイントへの所
定飛行コースに向かって所定の旋回率で旋回するのに必
要な目標ロール姿勢を設定し、機体のロール姿勢を目標
ロール姿勢に追従させるためのコマンドを導出して、ロ
ール・サーボに出力する。また、目標飛行点FTPへの
進入コースを指定しない場合には、上記のターン・イン
・ポイントへの所定飛行コースに代わり目標飛行点FT
Pへの所定飛行コースに向かって同様のコマンドをロー
ル・サーボへ出力する。
(1) Step 1a. The roll system control subsystem uses the flight information to the target flight point FTP input from the navigation function of the aircraft and the size of the deviation between the flight direction of the aircraft and the heading (hereinafter referred to as the drift angle). Therefore, when the approach course to the target flight point FTP is specified, the target roll attitude necessary for turning at the predetermined turn rate toward the predetermined flight course to the turn-in point set by the navigation function is set. The command to set the roll attitude of the machine to follow the target roll attitude is derived and output to the roll servo. When the approach course to the target flight point FTP is not specified, the target flight point FT is used instead of the predetermined flight course to the turn-in point described above.
The same command is output to the roll servo toward the predetermined flight course to P.

【0010】b. ヨー系統制御サブシステムは、オー
ト・ターン・コーディネーション・モードがエンゲージ
され、横加速度をゼロとするためのコマンドをヨー・サ
ーボへ出力する。
B. The yaw system control subsystem is engaged in the auto turn coordination mode, and outputs a command for zeroing the lateral acceleration to the yaw servo.

【0011】c. ピッチ系統制御サブシステムは、エ
ンルート・ナブ・モードがエンゲージされた時の対気速
度を目標対気速度とし、機体の対気速度を目標対気速度
に追従させるためのコマンドを導出してピッチ・サーボ
に出力する。
C. The pitch system control subsystem sets the airspeed when the enroute nab mode is engaged as the target airspeed and derives a command to make the airspeed of the aircraft follow the target airspeed. Output to servo.

【0012】d. モード制御サブシステムは、航空機
の有する航法機能法から入力した飛行情報に基づいて、
目標飛行点FTPへの進入コースを指定した場合及び指
定しない場合を判定し、ロール系統制御サブシステムの
モード切換を制御する。
D. The mode control subsystem, based on the flight information input from the navigation function method of the aircraft,
It determines whether the approach course to the target flight point FTP is designated or not, and controls the mode switching of the roll system control subsystem.

【0013】(2) ステップ2ロール系統制御サブシス
テムは、旋回終了後所定飛行コースに接近するにつれて
機体のロール姿勢を水平に戻し、所定飛行コースから離
脱されないようにロール姿勢コントロールを行う。
(2) Step 2 The roll system control subsystem returns the roll posture of the machine body to the horizontal position as it approaches the predetermined flight course after the turning, and controls the roll posture so as not to be separated from the predetermined flight course.

【0014】ヨー系統制御サブシステムは、所定飛行コ
ースに向かって釣合旋回を可能とするためのコマンドを
ヨー・サーボに出力する。
The yaw system control subsystem outputs a command to the yaw servo to enable a balanced turn toward a predetermined flight course.

【0015】ピッチ系統制御サブシステムは、対気速度
を保持するためのコマンドをピッチ・サーボに出力す
る。
The pitch system control subsystem outputs a command for maintaining the airspeed to the pitch servo.

【0016】モード制御サブシステムは、目標飛行点F
TPへの進入コースを指定した場合には、対気速度及び
見越し旋回時定数より、ステップ3への移行を判定する
旋回開始見越し距離を導出し、ロール系統制御サブシス
テムへ出力する。目標飛行点FTPへの進入コースを指
定しない場合には、FTPオン・トップの判定を行う。
The mode control subsystem uses the target flight point F
When the approach course to TP is designated, the turning start anticipation distance for determining the transition to step 3 is derived from the airspeed and the anticipatory turning time constant, and is output to the roll system control subsystem. When the approach course to the target flight point FTP is not designated, the FTP on top is determined.

【0017】(3) ステップ3目標飛行点FTPへの進
入コースを指定した場合には、ロール系統制御サブシス
テムは目標飛行点FTPへの所定飛行コースに向かっ
て、所定の旋回率で旋回するのに必要な目標ロール姿勢
を設定し、機体のロール姿勢を目標ロール姿勢に追従さ
せるためのコマンドを導出して、ロール・サーボに出力
する。
(3) Step 3 When the approach course to the target flight point FTP is designated, the roll system control subsystem turns at a predetermined turn rate toward a predetermined flight course to the target flight point FTP. The target roll attitude required for the above is set, and a command for causing the roll attitude of the machine body to follow the target roll attitude is derived and output to the roll servo.

【0018】ヨー系統制御サブシステムは、所定飛行コ
ースに向かって釣合旋回を可能とするためのコマンドを
ヨー・サーボに出力する。
The yaw system control subsystem outputs a command to the yaw servo to enable a balanced turn toward a predetermined flight course.

【0019】ピッチ系統制御サブシステムは、対気速度
を保持するためのコマンドをピッチ・サーボに出力す
る。
The pitch system control subsystem outputs a command for maintaining the airspeed to the pitch servo.

【0020】(4) ステップ4目標飛行点FTPへの進
入コースを指定した場合には、ロール系統制御サブシス
テムは、目標飛行点FTPへの所定飛行コースに接近す
るにつれて機体のロール姿勢を水平に戻し、所定飛行コ
ースから離脱されないようにロール姿勢コントロールを
行う。
(4) Step 4 When the approach course to the target flight point FTP is designated, the roll system control subsystem makes the roll attitude of the aircraft horizontal as the predetermined flight course to the target flight point FTP is approached. Roll back and control the roll attitude so as not to leave the flight course.

【0021】ヨー系統制御サブシステムは、所定飛行コ
ースに向かって釣合旋回を可能とするためのコマンドを
ヨー・サーボに出力する。
The yaw system control subsystem outputs a command to the yaw servo for enabling a balanced turn toward a predetermined flight course.

【0022】ピッチ系統制御サブシステムは、対気速度
を保持するためのコマンドをピッチ・サーボに出力す
る。
The pitch system control subsystem outputs a command for maintaining airspeed to the pitch servo.

【0023】モード制御サブシステムは、航法機能より
入力した飛行情報に基づいて、FTPオン・トップの判
定を行う。
The mode control subsystem makes an FTP-on-top determination based on the flight information input from the navigation function.

【0024】上記のようにしてステップ1〜4の制御に
より航空機(ヘリコプタ)を任意の飛行条件から目標飛行
点FTPへ自動的に誘導飛行させる。
As described above, the aircraft (helicopter) is automatically guided to the target flight point FTP from arbitrary flight conditions by the control of steps 1 to 4.

【0025】[0025]

【実施例】以下、図面を参照して本発明の一実施例を説
明する。
DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS An embodiment of the present invention will be described below with reference to the drawings.

【0026】本発明に係る目標飛行点FTPへのヘリコ
プタの自動飛行制御システムは、目標飛行点FTPへの
進入コースを指定した場合には、図1に示す飛行経路を
とり、ステップ1〜4の制御を実行して航空機を目標飛
行点FTPへ自動的に誘導飛行させる。
The automatic helicopter flight control system to the target flight point FTP according to the present invention takes the flight route shown in FIG. The control is executed to automatically guide the aircraft to the target flight point FTP.

【0027】また、目標飛行点FTPへの進入コースを
指定しない場合には、図2に示す飛行経路をとり、ステ
ップ1,2の制御を実行して航空機を目標飛行点FTP
へ自動的に誘導飛行させる。
When the approach course to the target flight point FTP is not designated, the flight route shown in FIG. 2 is taken and the control of steps 1 and 2 is executed to set the aircraft to the target flight point FTP.
Automatically guided flight to.

【0028】上記各ステップ1〜4については詳細を後
述する。
Details of steps 1 to 4 will be described later.

【0029】しかして、上記の飛行制御を実行する制御
システムは、次の(1)〜(4)のサブシステムから構成さ
れる。
Therefore, the control system for executing the above flight control is composed of the following subsystems (1) to (4).

【0030】(1) 自動飛行のモードを飛行状況に応じ
て切換るためのモード制御サブシステム。
(1) A mode control subsystem for switching the mode of automatic flight according to the flight situation.

【0031】(2) 所定の飛行コースに機体を乗せるよ
うにロール姿勢をコントロールするためのコマンドをロ
ール・サーボに出力するロール系統制御サブシステム。
(2) A roll system control subsystem which outputs a command for controlling the roll attitude to the roll servo so that the aircraft is put on a predetermined flight course.

【0032】(3) ロール系統制御サブシステムが効果
的に機能するように、横滑りをコントロールするための
コマンドをヨー・サーボに出力するヨー系統制御サブシ
ステム。
(3) A yaw system control subsystem that outputs a command for controlling sideslip to the yaw servo so that the roll system control subsystem functions effectively.

【0033】(4) 飛行速度をコントロールするための
コマンドをピッチ・サーボに出力するピッチ系統制御サ
ブシステム。
(4) A pitch system control subsystem for outputting a command for controlling the flight speed to the pitch servo.

【0034】上記各サブシステムは、図3乃至図9に示
すように構成される。
Each of the above subsystems is constructed as shown in FIGS.

【0035】図3は上記モード制御サブシステムにおけ
るオン・トップ判定/旋回開始判定部の構成を示すブロ
ック図である。航法機能から送られてくるよりターン・
イン・ポイント・オン・トップ判定信号は、−1信号立
上がり判定回路1を介してフリップフロップ回路2のセ
ット端子Sに入力される。このフリップフロップ回路2
のQ出力信号がターン・イン・ポイント・オン・トップ
信号A15として取り出される。
FIG. 3 is a block diagram showing the configuration of the on-top determination / turning start determination unit in the mode control subsystem. Turn from the navigation function
The in-point-on-top determination signal is input to the set terminal S of the flip-flop circuit 2 via the -1 signal rise determination circuit 1. This flip-flop circuit 2
Q output signal is taken out as a turn-in-point-on-top signal A15.

【0036】また、旋回開始見越し距離生成部3は、目
標飛行点FTPへの進入コースを指定した場合に、対気
速度UA、見越し旋回時定数Cp14を使用して旋回開
始見越し距離STEN を生成し、図4に示すロール系統制
御サブシステムに出力すると共に、減算器4の−端子を
介してオン・オフ判定回路5に入力する。このオン・オ
フ判定回路5の出力信号は、上記フリップフロップ回路
2の出力信号と共にオア回路6を介してフリップフロッ
プ回路7のセット端子Sに入力される。そして、このフ
リップフロップ回路7のQ出力信号がターン・イン開始
フラグA16として、図4に示すロール系統制御サブシ
ステムに出力される。
When the approach course to the target flight point FTP is designated, the turning start anticipation distance generator 3 generates the turning start anticipation distance STEN using the airspeed UA and the anticipatory turning time constant Cp14. , And to the on / off determination circuit 5 via the minus terminal of the subtractor 4. The output signal of the ON / OFF determination circuit 5 is input to the set terminal S of the flip-flop circuit 7 via the OR circuit 6 together with the output signal of the flip-flop circuit 2. Then, the Q output signal of the flip-flop circuit 7 is output to the roll system control subsystem shown in FIG. 4 as the turn-in start flag A16.

【0037】また、航法機能からのターン・イン・ポイ
ント距離は、減算器4の+端子に入力されると共に、オ
ン・オフ判定回路8を介して−1信号立上がり判定回路
9に入力される。この−1信号立上がり判定回路9の出
力信号により、上記フリップフロップ回路2,7がリセ
ットされる。
The turn-in point distance from the navigation function is input to the + terminal of the subtractor 4 and also to the -1 signal rise determination circuit 9 via the on / off determination circuit 8. The flip-flop circuits 2 and 7 are reset by the output signal of the -1 signal rise determination circuit 9.

【0038】更に、航法機能からのFTPオン・トップ
判定信号は、フリップフロップ回路11のリセット端子
Rに入力されると共に、−1信号立上がり判定回路12
を介してフリップフロップ回路11のセット端子Sに入
力される。このフリップフロップ回路11の出力信号が
FTPオン・トップ信号A17として出力する。
Further, the FTP on-top determination signal from the navigation function is input to the reset terminal R of the flip-flop circuit 11 and the -1 signal rise determination circuit 12
Is input to the set terminal S of the flip-flop circuit 11 via. The output signal of the flip-flop circuit 11 is output as the FTP on-top signal A17.

【0039】図4乃至図8はロール系制御サブシステム
の各部の構成及び航法機能からの飛行情報を示すもの
で、図4は横誘導制御則、図5は偏流角計算処理部、図
6は航法機能からの飛行情報、図7は機首方位偏差修正
処理部、図8はロール・オートパイロット制御則であ
る。
FIGS. 4 to 8 show the configuration of each part of the roll control subsystem and flight information from the navigation function. FIG. 4 is a lateral guidance control law, FIG. 5 is a drift angle calculation processing part, and FIG. Flight information from the navigation function, FIG. 7 is a nose heading deviation correction processing unit, and FIG. 8 is a roll autopilot control law.

【0040】図4に示す横誘導制御則において、磁気機
首方位φは、減算器21の+端子に入力される。一方、
航法機能からの目標飛行点FTPへの進入コースφFTP
及びターン・イン・ポイントTIPの進入コース方位φ
TIPは、図3に示したモード制御サブシステムからのタ
ーン・イン開始フラグA16により作動する切換スイッ
チ22により選択され、上記減算器21の一端子に入力
される。上記航法機能からの各種飛行情報を図6に示
す。
In the lateral guidance control law shown in FIG. 4, the magnetic heading φ is input to the + terminal of the subtractor 21. on the other hand,
Approach course φFTP from the navigation function to the target flight point FTP
And turn-in point TIP approach course direction φ
The TIP is selected by the changeover switch 22 operated by the turn-in start flag A16 from the mode control subsystem shown in FIG. 3, and input to one terminal of the subtractor 21. Various flight information from the navigation function is shown in FIG.

【0041】図6において、RTIP :ターン・イン・ポ
イントTIPまでの距離、RFTP :目標飛行点FTPま
での距離、θDTIP : ターン・イン・ポイント・コース
・デビエーション、θDFTP :FTPコース・デビエー
ション、φTIP : ターン・イン・ポイントTIPへの進
入コース方位、φFTP :目標飛行点FTPへの進入コー
ス方位、である。デビエーションは設定コース基準であ
り、各角度は基準軸から右回りを正としている。図の例
では、θDTIP、θDFTP とも負、φFTP は正、φTIP は
負である。
In FIG. 6, RTIP: distance to turn-in point TIP, RFTP: distance to target flight point FTP, θDTIP: turn-in-point course deviation, θDFTP: FTP course deviation, φTIP: Turn-in-point TIP approach course azimuth, φFTP: approach-point azimuth FTP approach target course. Deviation is based on the set course, and each angle is positive in the clockwise direction from the reference axis. In the illustrated example, both θDTIP and θDFTP are negative, φFTP is positive, and φTIP is negative.

【0042】そして、図4において、減算器21の出力
信号φeは、加算器23に入力される。また、この加算
器23には、図5に示す偏流角計算処理部20からの偏
流角A20がスイッチ24を介して入力される。図5に
示す偏流角計算処理部20は、縦対地速度UB 及び横対
地速度VB に基づき、「arctan(VB / UB )」の演算処理
を行って偏流角A20を求めている。
In FIG. 4, the output signal φe of the subtractor 21 is input to the adder 23. Further, the drift angle A20 from the drift angle calculation processing unit 20 shown in FIG. 5 is input to the adder 23 via the switch 24. The drift angle calculation processing unit 20 shown in FIG. 5 obtains the drift angle A20 by performing an arithmetic processing of "arctan (VB / UB)" based on the vertical ground speed UB and the horizontal ground speed VB.

【0043】そして、上記図4において加算器23の出
力信号は、リミッタ25によりリミットされてφeLと
なり、更に機首方位偏差修正処理部26により修正処理
される。この機首方位偏差修正処理部26により修正さ
れた信号φeTは、ゲイン(磁気機首方位用ゲインスケジ
ューラ)27を介して加算器28に入力される。上記機
首方位偏差修正処理部26は、図7に示すように構成さ
れるもので、その詳細については後述する。
Then, in FIG. 4, the output signal of the adder 23 is limited to φeL by the limiter 25, and is further corrected by the heading deviation correction processing unit 26. The signal φeT corrected by the heading deviation correction processing unit 26 is input to the adder 28 via the gain (gain heading scheduler for magnetic heading) 27. The heading deviation correction processing unit 26 is configured as shown in FIG. 7, and details thereof will be described later.

【0044】航法機能からの目標飛行点FTPへのコー
ス・デビエーションθDFTP は、ゲイン・スケジューラ
29に入力される。また、目標飛行点FTPへの距離R
FTPが乗算器30aに入力されると共に、対気速度が速度
比演算回路31、ゲイン切換点速度調整回路32を介し
て乗算器30aに入力され、その乗算結果がゲイン・ス
ケジューラ29に送られる。また、上記速度調整回路3
2の出力は、ターン・イン・ポイントへの距離RTIP と
共に乗算器30bを介してゲイン・スケジューラ34に
入力される。更に、このゲイン・スケジューラ34に
は、ターン・イン・ポイントTIPへのコース・デビエ
ーションθDTIP が入力される。
The course deviation θDFTP from the navigation function to the target flight point FTP is input to the gain scheduler 29. Also, the distance R to the target flight point FTP
The FTP is input to the multiplier 30a, the airspeed is input to the multiplier 30a via the speed ratio calculation circuit 31 and the gain switching point speed adjustment circuit 32, and the multiplication result is sent to the gain scheduler 29. In addition, the speed adjusting circuit 3
The output of 2 is input to gain scheduler 34 via multiplier 30b with the distance RTIP to the turn-in point. Further, the course deviation θDTIP to the turn-in point TIP is input to the gain scheduler 34.

【0045】上記ゲイン・スケジューラ29,34の出
力信号は、ターンイン開始フラグA16により動作する
切換スイッチ33により選択され、リミッタ35を介し
てゲイン(コース・デビエーション比例ゲイン)36,3
7に入力される。ゲイン36の出力信号は、スイッチ3
8を介してフェードイン・アウト回路39に入力され
る。そして、ゲイン36とフェードイン・アウト回路3
9の出力信号が加算器40により加算された後、加算器
28を介してバンク角リミッタ41に入力される。この
バンク角リミッタ41には、対気速度UA がレートリミ
ッタ42、ゲイン43、tan -1の関数器44、リミッタ
45を介してバンク角リミット値A47として入力され
る。バンク角リミッタ41の出力信号は、レートリミッ
タ46を介して基準ロール角シフトコマンドA48とし
て出力される。
The output signals of the gain schedulers 29 and 34 are selected by the changeover switch 33 operated by the turn-in start flag A16, and the gains (coarse deviation proportional gains) 36 and 3 are output via the limiter 35.
Input to 7. The output signal of the gain 36 is the switch 3
8 is input to the fade-in / out circuit 39. Then, the gain 36 and the fade-in / out circuit 3
The output signals of 9 are added by the adder 40, and then input to the bank angle limiter 41 via the adder 28. The air speed UA is input to the bank angle limiter 41 as a bank angle limit value A47 via a rate limiter 42, a gain 43, a function unit 44 of tan −1 , and a limiter 45. The output signal of the bank angle limiter 41 is output as a reference roll angle shift command A48 via the rate limiter 46.

【0046】しかして、上記機首方位偏差修正処理部2
6は、図7(a)に示すように切換スイッチ51,52,5
3により構成される。切換スイッチ51,52は、切換
接点a,b,cを備え、接点aに左旋回コマンド定数54(B
R31 )、接点bにリミッタ25からの機首方位φeL、接
点cに右旋回コマンド定数55(−BR31 )が入力され
る。切換スイッチ51は、左旋回コマンドA56(ター
ン・イン・ポイント)ONが与えられた時に接点aが閉
じ、右旋回コマンドA57(ターン・イン・ポイント)O
Nが与えられた時に接点cが閉じ、それ以外では接点bが
閉じる。上記切換スイッチ51を介して取出される信号
は、切換スイッチ53の接点aに入力される。
Therefore, the heading deviation correction processing unit 2
6 is a selector switch 51, 52, 5 as shown in FIG.
It is composed of 3. The changeover switches 51, 52 are provided with changeover contacts a, b, c, and a left turn command constant 54 (B
R31), the nose bearing φeL from the limiter 25 is input to the contact point b, and the right turn command constant 55 (-BR31) is input to the contact point c. The changeover switch 51 closes the contact a when the left turn command A56 (turn-in point) ON is given, and the right turn command A57 (turn-in point) O.
The contact c is closed when N is given, and the contact b is closed otherwise. The signal taken out via the changeover switch 51 is input to the contact a of the changeover switch 53.

【0047】一方、切換スイッチ52は、左旋回コマン
ドA58(FTP)ONが与えられた時に接点aが閉じ、
右旋回コマンドA59(FTP)ONが与えられた時に接
点cが閉じ、それ以外では接点bが閉じる。上記切換スイ
ッチ52を介して取出される信号は、切換スイッチ53
の接点bに入力される。この切換スイッチ53は、ター
ン・イン開始フラグA16がONの時に接点bが閉じ、
それ以外では接点aが閉じる。そして、切換スイッチ5
3を介して取出される信号が、修正された機首方位φe
Tとなる。上記左旋回コマンド及び右旋回コマンドは、
図7(b)に示すようにターン・イン・ポイント・コース
またはFTPコースへ乗るために必要な旋回角θの絶対
値が90°以上ある間のみ航法機能から入力される。
On the other hand, in the changeover switch 52, the contact a is closed when the left turn command A58 (FTP) ON is given,
The contact point c is closed when the right turn command A59 (FTP) ON is given, and the contact point b is closed otherwise. The signal extracted via the changeover switch 52 is the changeover switch 53.
Input to contact point b. This changeover switch 53 has the contact b closed when the turn-in start flag A16 is ON,
Otherwise, contact a closes. And the changeover switch 5
The signal extracted via 3 is the corrected heading φe
It becomes T. The above left turn command and right turn command are
As shown in FIG. 7 (b), it is input from the navigation function only while the absolute value of the turning angle θ required to get on the turn-in point course or the FTP course is 90 ° or more.

【0048】図8は、ロール系統制御サブシステムにお
けるロール・オート・パイロット制御則を示している。
同図に示すように減算器61の+端子にロール姿勢φが
入力され、−端子に図4から送られてくる基準ロール角
シフトコマンドA48が入力され、その減算結果がゲイ
ン62を介して加算器63に入力される。また、この加
算器63には、ロール・レートPがゲイン(比例ゲイン)
64,65を介して入力され、その加算出力が加算器6
6に入力される。また、上記減算器61の出力がゲイン
67、積分器68を介して加算器66に入力される。そ
して、この加算器66の出力がロール・トリム・シフト
・コマンドA69としてロール・トリム・サーボへ送ら
れる。
FIG. 8 shows a roll auto pilot control law in the roll system control subsystem.
As shown in the figure, the roll attitude φ is input to the + terminal of the subtractor 61, the reference roll angle shift command A48 sent from FIG. 4 is input to the − terminal, and the subtraction result is added via the gain 62. Input to the container 63. In addition, the roll rate P is gained (proportional gain) in the adder 63.
64 and 65, and the addition output is the adder 6
6 is input. The output of the subtractor 61 is input to the adder 66 via the gain 67 and the integrator 68. The output of the adder 66 is sent to the roll trim servo as a roll trim shift command A69.

【0049】図9は、ヨー系統制御サーボシステムの構
成を示している。横加速度Nrは、ゲイン71及び積分
器72を介して加算器73に入力される。また、横加速
度Nr及びロール・レートPは、それぞれゲイン74,7
5を介して加算器76に入力され、その加算出力が加算
器73に入力される。そして、この加算器73の出力信
号がヨー・トリム・シフト・コマンドA77としてヨー
・トリム・サーボへ送られる。
FIG. 9 shows the configuration of the yaw system control servo system. The lateral acceleration Nr is input to the adder 73 via the gain 71 and the integrator 72. Further, the lateral acceleration Nr and the roll rate P are gains 74 and 7, respectively.
It is input to the adder 76 via 5, and the addition output is input to the adder 73. Then, the output signal of the adder 73 is sent to the yaw trim servo as a yaw trim shift command A77.

【0050】図10は、ピッチ系統制御サブシステムの
構成を示している。ピッチ・レートqは、ゲイン81を
介して加算器82に入力される。ピッチ姿勢角θは、減
算器83の+端子に入力されると共に、切換スイッチ8
4の端子aに入力される。この切換スイッチ84は、共
通接点が減算器83の−端子に接続されると共に、周期
計算処理の前回値を記憶するためのメモリ85を介して
自己の端子bに接続される。切換スイッチ84は、サイ
クリック・トリム・リリースの際に接点aが閉じ、それ
以外では接点bが閉じる。そして、減算器83の出力
は、ゲイン86を介して加算器82に入力される。
FIG. 10 shows the configuration of the pitch system control subsystem. The pitch rate q is input to the adder 82 via the gain 81. The pitch attitude angle θ is input to the + terminal of the subtracter 83, and the changeover switch 8
4 is input to the terminal a. A common contact of the changeover switch 84 is connected to the-terminal of the subtractor 83, and is also connected to its own terminal b via a memory 85 for storing the previous value of the cycle calculation process. In the changeover switch 84, the contact a is closed at the time of cyclic trim release, and the contact b is closed at other times. Then, the output of the subtractor 83 is input to the adder 82 via the gain 86.

【0051】一方、対気速度UA は、減算器87の+端
子に入力されると共に、切換スイッチ88の端子aに入
力される。この切換スイッチ88は、共通接点が減算器
87の−端子に接続されると共に、周期計算処理の前回
値を記憶するためのメモリ89を介して自己の端子bに
接続される。切換スイッチ88は、サイクリック・トリ
ム・リリースの際に接点aが閉じ、それ以外では接点bが
閉じる。そして、減算器87の出力は、ゲイン90を介
して加算器82に入力される。
On the other hand, the airspeed UA is input to the + terminal of the subtractor 87 and the terminal a of the changeover switch 88. The changeover switch 88 has a common contact connected to the-terminal of the subtractor 87, and is also connected to its own terminal b via a memory 89 for storing the previous value of the cycle calculation process. In the changeover switch 88, the contact a is closed at the time of cyclic trim release, and the contact b is closed at other times. Then, the output of the subtractor 87 is input to the adder 82 via the gain 90.

【0052】また、減算器87の出力は、ゲイン91を
介して積分器92に入力される。この積分器92は、サ
イクリック・トリム・リリースによりリセットされる。
この積分器92の出力は、加算器82の出力と加算器9
3で加算され、その加算出力がピッチ・トリム・シフト
・コマンドA95としてピッチ・トリム・サーボへ送ら
れる。
The output of the subtractor 87 is input to the integrator 92 via the gain 91. This integrator 92 is reset by cyclic trim release.
The output of the integrator 92 is the output of the adder 82 and the adder 9
3 is added, and the added output is sent to the pitch trim servo as a pitch trim shift command A95.

【0053】次に上記本発明システムにより、図1、図
2に示す自動誘導飛行を行う場合の動作を説明する。本
発明に係る自動飛行制御システムにおいては、以下に示
すステップ1〜4の制御動作を実行する。
Next, the operation of the system of the present invention for carrying out the automatic guided flight shown in FIGS. 1 and 2 will be described. In the automatic flight control system according to the present invention, the following control operations of steps 1 to 4 are executed.

【0054】(1) ステップ1ステップ1は、図1、図
2に示すように目標飛行点FTPへの自動飛行モード
(以下、エンルート・ナブ・モードという)からターン・
イン・ポイントTIPもしくは目標飛行点FTPへの所
定飛行コースに移行するまでのフェイズをいう。
(1) Step 1 Step 1 is an automatic flight mode to the target flight point FTP as shown in FIGS.
Turn from (hereinafter referred to as enroute nab mode)
In-point TIP or the phase until transition to the predetermined flight course to the target flight point FTP.

【0055】a. 図3に示すモード制御サブシステム
は、各ロジック回路により、航法機能から入力した目標
飛行点FTPへの飛行情報を使用して、目標飛行点FT
Pへの進入コースを指定した場合及び進入コースを指定
しない場合を判定する。
A. The mode control subsystem shown in FIG. 3 uses the flight information to the target flight point FTP input from the navigation function by each logic circuit, and uses the target flight point FT.
It is judged whether the approach course to P is specified or not.

【0056】b. 図4〜図8に示すロール系統制御サ
ブシステムは、目標飛行点FTPへの進入コースを指定
した場合には、図4においてターン・イン・ポイントT
IPへの進入コース方位φTIP 、ターン・イン・ポイン
トTIPへの距離RTIP 、ターン・イン・ポインTIP
へのコース・デビエーションθDTIP 、左/右旋回コマ
ンドA56,A57(図7)及び磁気機首方位φと図5に
示す回路の出力である偏流角A20を使用して、所望飛
行コースに向かった最大でも所定の旋回率で旋回するの
に必要なロール姿勢をリミット値A47とする基準ロー
ル角シフト・コマンドA48を生成し、図8に示す回路
(ロール・オートパイロット制御則)に入力してロール・
トリム・シフト・コマンドA69を生成する。
B. When the roll course control subsystem shown in FIGS. 4 to 8 designates the approach course to the target flight point FTP, the turn-in point T in FIG.
Entry course direction to IP φTIP, distance to turn-in point TIP RTIP, turn-in point TIP
To the desired flight course using the course deviation θDTIP, the left / right turn commands A56, A57 (FIG. 7) and the magnetic heading φ and the drift angle A20 which is the output of the circuit shown in FIG. The circuit shown in FIG. 8 generates a reference roll angle shift command A48 that sets the roll attitude necessary for turning at a predetermined turning rate at the maximum to a limit value A47.
(Roll autopilot control law)
Generate a trim shift command A69.

【0057】目標飛行点FTPへの進入コースを指定し
ない場合には、図4において目標飛行点FTPへの進入
コース方位φFTP 、目標飛行点FTPへの距離RFTP 、
目標飛行点FTPへのコース・デビエーションθDFTP
、左/右旋回コマンドA58,A59(図7)及び磁気機
首方位φと図5に示す回路の出力である偏流角A20を
使用して、所望飛行コースに向かった最大でも所定の旋
回率で旋回するのに必要なロール姿勢をリミット値A4
7とする基準ロール角シフト・コマンドA48を生成
し、図8に示す回路(ロール・オートパイロット制御則)
に入力してロール・トリム・コマンドA69を生成す
る。
When the approach course to the target flight point FTP is not specified, the approach course direction φFTP to the target flight point FTP and the distance RFTP to the target flight point FTP in FIG.
Course deviation θDFTP to target flight point FTP
, The left / right turn commands A58, A59 (FIG. 7) and the magnetic heading φ and the output of the circuit shown in FIG. Limit value A4 for the roll posture required to turn at
The circuit shown in FIG. 8 for generating the standard roll angle shift command A48 of 7 (roll autopilot control law)
To generate a roll trim command A69.

【0058】c. 図9に示すヨー系統制御サブシステ
ムは、横加速度Nrとロール・レートPを使用して旋回
を横滑りなく円滑に行わせるためのヨー・トリム・シフ
ト・コマンドA77を生成する。
C. The yaw system control subsystem shown in FIG. 9 uses the lateral acceleration Nr and the roll rate P to generate the yaw trim shift command A77 for smoothly performing the turning without skidding.

【0059】d. 図10に示すピッチ系統制御サブシ
ステムは、エンルート・ナブ・モードがエンゲージした
時の対気速度UA を目標対気速度A94とし、機体の対
気速度UA を目標対気速度に追従させるためのピッチ・
トリム・シフト・コマンドA95を生成する。
D. The pitch system control subsystem shown in FIG. 10 sets the airspeed UA when the enroute nab mode is engaged as the target airspeed A94, and the pitch for making the airspeed UA of the aircraft follow the target airspeed.・
Trim shift command A95 is generated.

【0060】(2) ステップ2ステップ2は、旋回を終
了した後、図1に示すように目標飛行点FTPへの進入
コースを指定した場合には、図2に示すようにターン・
イン・ポイント・オン・トップまでのフェイズを目標飛
行点FTPへの進入コースを指定しない場合には、FT
Pオン・トップまでのフェイズをいう。
(2) Step 2 In step 2, after the turning is completed, if the approach course to the target flight point FTP is designated as shown in FIG. 1, the turn as shown in FIG.
If you do not specify the approach course to the target flight point FTP during the phase up to in point on top, FT
It means the phase to P on top.

【0061】a. モード制御サブシステムは、図3に
おいて、目標飛行点FTPへの進入コースを指定した場
合には、対気速度UA 及び見越し旋回時定数CP14 を使
用して旋回開始見越し距離生成部3により旋回開始見越
し距離STEN を生成し、さらにフリップフロップ回路7
を通してターン・イン開始フラグA16を生成し、図4
に示す回路(横誘導制御則)に入力してロール系統制御サ
ブシステムのモード切換を行う。
A. In FIG. 3, when the approach course to the target flight point FTP is designated, the mode control subsystem uses the airspeed UA and the anticipatory turning time constant CP14 to turn anticipation by the turning start anticipation distance generation unit 3 Generates the distance STEN, and further flip-flop circuit 7
The turn-in start flag A16 is generated through
Input to the circuit (lateral guidance control law) shown in to switch the mode of the roll system control subsystem.

【0062】そして、ターン・イン・ポイントTIPに
到達した時点でターン・イン・ポイント・オン・トップ
を判定回路1により判定し、ターン・イン・ポイント・
オン・トップ信号A15を生成する。
Then, when the turn-in point TIP is reached, the turn-in-point-on-top is judged by the judging circuit 1, and the turn-in point
The on-top signal A15 is generated.

【0063】目標飛行点FTPへの進入コースを指定し
ない場合には、FTPオン・トップを判定回路12によ
り判定し、FTPオン・トップ信号A17を生成する。
When the approach course to the target flight point FTP is not designated, the FTP on-top is determined by the determination circuit 12 and the FTP on-top signal A17 is generated.

【0064】b. ロール系統制御サブシステムは、ス
テップ1のbで示した内容と、同様にして図4〜図8に
よりロール姿勢A70をコントロールするためのロール
・トリム・シフト・コマンドA69を生成する。なお、
ロール姿勢A70は目標飛行点FTPへの進入コースを
指定した場合には、図4に示すターン・イン・ポイント
TIPへのコース・デビエーションθDTIP をターン・
イン・ポイントTIPへの距離RTIP をパラメータとす
る関数によりターン・イン・ポイントTIPへ近付くに
つれて小さくすることによって徐々に水平に移していく
ことができる。また、目標飛行点FTPへの進入コース
を指定しない場合には、図4に示す目標飛行点FTPへ
のコース・デビエーションθDFTP を目標飛行点FTP
への距離RFTP をパラメータとする関数により目標飛行
点FTPへ近付くにつれて小さくすることによって徐々
に水平に移していくことができる。
B. The roll system control subsystem generates a roll trim shift command A69 for controlling the roll attitude A70 in the same manner as the content shown in step 1b according to FIGS. In addition,
When the roll attitude A70 specifies the approach course to the target flight point FTP, the course deviation θDTIP to the turn-in point TIP shown in FIG. 4 is turned.
The distance to the in-point TIP can be gradually moved horizontally by decreasing the distance as it approaches the turn-in point TIP by a function having the parameter RTIP as a parameter. When the approach course to the target flight point FTP is not specified, the course deviation θDFTP to the target flight point FTP shown in FIG. 4 is set to the target flight point FTP.
The distance to the target flight point FTP can be gradually decreased by decreasing the distance RFTP to the target flight point FTP.

【0065】更に、目標飛行点FTPへの進入コースを
指定した場合には、ターン・イン・ポイントTIPの手
前より図3のモード制御サブシステムから入力したター
ン・イン・開始フラグA16を使用して見越し旋回を行
うことができる。
Further, when the approach course to the target flight point FTP is designated, the turn-in / start flag A16 input from the mode control subsystem of FIG. 3 is used before the turn-in point TIP. Can make anticipatory turns.

【0066】c. ヨー系統制御サブシステムは、ステ
ップ1のcで示した内容と同様にして図9により横加速
度Nrをコントロールするためのヨー・トリム・シフト
・コマンドA77を生成する。
C. The yaw system control subsystem generates the yaw trim shift command A77 for controlling the lateral acceleration Nr according to FIG. 9 in the same manner as the content shown in step 1c.

【0067】d. 図10に示すピッチ系統制御サブシ
ステムは、ステップ1のdで示した内容と同様にして、
対気速度UA をコントロールするためのピッチ・トリム
・シフト・コマンドA95を生成する。
D. The pitch system control subsystem shown in FIG. 10 is similar to the content shown in step 1 d,
Generates a pitch trim shift command A95 for controlling airspeed UA.

【0068】(3) ステップ3ステップ3は、図1に示
すように目標飛行点FTPへの進入コースを指定した場
合のターン・イン・ポイントTIPの到達後からの目標
飛行点FTPへ向かっての旋回終了までのフェイズをい
う。
(3) Step 3 In Step 3, as shown in FIG. 1, when the approach course to the target flight point FTP is designated, the turn-in point TIP is reached toward the target flight point FTP after the arrival of the turn-in point TIP. The phase until the end of turning.

【0069】a. ロール系統制御サブシステム(図4〜
図8)は、ステップ1のbの目標飛行点FTPへの進入コ
ースを指定しない場合で示した内容と同様にして、ロー
ル姿勢φ(図8)をコントロールするためのロール・トリ
ム・シフト・コマンドA69を生成する。
A. Roll system control subsystem (Fig. 4 ~
8) is a roll trim shift command for controlling the roll attitude φ (FIG. 8) in the same manner as the content shown in the case of not designating the approach course to the target flight point FTP in step 1b. Generate A69.

【0070】b. ヨー系統制御サブシステム(図9)
は、ステップ1のcで示した内容と同様にして横加速度
Nrをコントロールするためのヨー・トリム・シフト・
コマンドA77を生成する。
B. Yaw system control subsystem (Fig. 9)
Is the yaw trim shift control for controlling the lateral acceleration Nr in the same manner as that described in step 1c.
Generates command A77.

【0071】c. ピッチ系統制御サブシステム(図1
0)は、ステップ1のdで示した内容と同様にして対気速
度UA をコントロールするためのピッチ・トリム・シフ
ト・コマンドA95を生成する。
C. Pitch system control subsystem (Fig. 1
0) generates a pitch trim shift command A95 for controlling the airspeed UA in the same manner as the content indicated by d in step 1.

【0072】(4) ステップ4ステップ4は、図1に示
すように目標飛行点FTPへの進入コースを指定した場
合の旋回終了後からFTPイン・トップまでのフェイズ
をいう。
(4) Step 4 Step 4 refers to the phase from the end of turning to the FTP in top when the approach course to the target flight point FTP is designated as shown in FIG.

【0073】a. 図3に示すモード系統制御サブシス
テムは、FTPオン・トップを判定し、FTPオン・ト
ップ信号A17を生成する。
A. The mode system control subsystem shown in FIG. 3 determines the FTP on-top and generates the FTP on-top signal A17.

【0074】b. ロール系統制御サブシステム(図4〜
図8)は、ステップ1のb及びステップ2の目標飛行点F
TPの進入コースを指定しない場合で示した内容と同様
にしてロール姿勢φ(図8)をコントロールするためのロ
ール・トリム・シフト・コマンドA69を生成する。
B. Roll system control subsystem (Fig. 4 ~
8) shows the target flight point F in step 1b and step 2
A roll trim shift command A69 for controlling the roll posture φ (FIG. 8) is generated in the same manner as the content shown when the TP entry course is not designated.

【0075】c. ヨー系統制御サブシステムは、ステ
ップ1のcで示した内容と同様にして図9により横加速
度11をコントロールするためのヨー・トリム・コマン
ド13を生成する。
C. The yaw system control subsystem generates a yaw trim command 13 for controlling the lateral acceleration 11 according to FIG. 9 in the same manner as the content shown in step 1 c.

【0076】d. ピッチ系統制御サブシステム(図1
0)は、ステップ1のdで示した内容と同様にして対気速
度UA をコントロールするためのピッチ・トリム・シフ
ト・コマンドA95を生成する。
D. Pitch system control subsystem (Fig. 1
0) generates a pitch trim shift command A95 for controlling the airspeed UA in the same manner as the content indicated by d in step 1.

【0077】[0077]

【発明の効果】本発明は、前述のように構成されている
ので、以下に記載するような効果を奏する。
Since the present invention is constructed as described above, it has the following effects.

【0078】(1) 目標飛行点FTPへの進入コースを
指定した場合には、目標飛行点FTPへ向かっての旋回
に際して見越し旋回を実施することにより目標飛行点F
TPへの到達精度を良好なものにすることができる。
(1) When the approach course to the target flight point FTP is specified, the anticipatory turn is carried out when turning toward the target flight point FTP so that the target flight point F is reached.
It is possible to improve the accuracy of reaching TP.

【0079】(2) 目標飛行点FTPへの進入コースを
指定した場合及び進入コースを指定しない場合に応じて
エンルート・ナブ・モードをエンゲージできるので、目
標飛行点FTPへの完全な自動誘導飛行が可能である。
(2) Since the enroute nab mode can be engaged depending on whether the approach course to the target flight point FTP is designated or not, the fully automatic guided flight to the target flight point FTP is possible. It is possible.

【0080】(3) 旋回中のロール姿勢を一定に保つこ
とができるので、パイロットの乗り心地感覚を損なうこ
とがない。
(3) Since the roll posture during turning can be kept constant, the ride comfort of the pilot is not impaired.

【0081】(4) これらによりパイロットの操縦上の
負荷を大幅に軽減し、目標飛行点FTPへの到達精度及
び到達所要時間を平均的に良好なものにすることができ
る。
(4) With these, the pilot's operational load can be significantly reduced, and the accuracy of reaching the target flight point FTP and the time required to reach it can be improved on average.

【図面の簡単な説明】[Brief description of drawings]

【図1】本発明の一実施例に係る自動飛行制御システム
における目標飛行点FTPへの進入コースを指定した場
合の飛行経路図である。
FIG. 1 is a flight route diagram when an approach course to a target flight point FTP is designated in an automatic flight control system according to an embodiment of the present invention.

【図2】同実施例における目標飛行点FTPへの進入コ
ースを指定しない場合の飛行経路図である。
FIG. 2 is a flight route diagram when the approach course to the target flight point FTP is not designated in the embodiment.

【図3】同実施例におけるモード制御サブシステムを示
すブロック図である。
FIG. 3 is a block diagram showing a mode control subsystem in the embodiment.

【図4】同実施例におけるロール系統制御サブシステム
の横誘導制御則を示すブロック図である。
FIG. 4 is a block diagram showing a lateral guidance control law of the roll system control subsystem in the embodiment.

【図5】同実施例におけるロール系統制御サブシステム
の偏流角計算処理を示すブロック図である。
FIG. 5 is a block diagram showing a drift angle calculation process of the roll system control subsystem in the embodiment.

【図6】同実施例における航法機能からの飛行情報デー
タを示す説明図である。
FIG. 6 is an explanatory diagram showing flight information data from a navigation function in the same embodiment.

【図7】同実施例におけるロール系統制御サブシステム
の機首方位偏差修正処理部を示す回路構成図である。
FIG. 7 is a circuit configuration diagram showing a nose heading deviation correction processing unit of the roll system control subsystem in the embodiment.

【図8】同実施例におけるロール系統制御サブシステム
のロール・オートパイロット制御則を示す説明図であ
る。
FIG. 8 is an explanatory diagram showing a roll autopilot control law of the roll system control subsystem in the embodiment.

【図9】同実施例におけるヨー系統制御サブシステムを
示すブロック図である。
FIG. 9 is a block diagram showing a yaw system control subsystem in the embodiment.

【図10】同実施例におけるピッチ系統制御サブシステ
ムを示すブロック図である。
FIG. 10 is a block diagram showing a pitch system control subsystem in the embodiment.

【図11】従来技術による目標飛行点への飛行経路を示
す説明図である。
FIG. 11 is an explanatory diagram showing a flight path to a target flight point according to a conventional technique.

【符号の説明】[Explanation of symbols]

1,9,12 −1信号立上がり判定回路 2,7,11 フリップフロップ回路 3 旋回開始見越し距離生成部 5,8 オン・オフ判定回路 20 偏流角計算処理部 25 リミッタ 26 機首方位偏差修正処理部 27 ゲイン(磁気機首方位用ゲインスケジューラ) 29,34 ゲイン・スケジューラ 31 速度比演算回路 35 リミッタ 41 バンク角リミッタ 42,46 レートリミッタ 1,9,12 -1 Signal rising judgment circuit 2,7,11 Flip-flop circuit 3 Turning start anticipation distance generation unit 5,8 ON / OFF judgment circuit 20 Drift angle calculation processing unit 25 Limiter 26 Heading deviation correction processing unit 27 gain (gain scheduler for magnetic heading) 29,34 gain scheduler 31 speed ratio calculation circuit 35 limiter 41 bank angle limiter 42,46 rate limiter

Claims (1)

【特許請求の範囲】[Claims] 【請求項1】 目標飛行点への飛行情報を与える航法機
能を有するヘリコプタの飛行制御システムにおいて、目
標飛行点への自動飛行モードがエンゲージされた後、エ
ンゲージされた時の対気速度よりバンク角を算出し、所
定の旋回率で旋回を行うためのコマンドをロール・サー
ボに出力する第1の手段、自動飛行モードがエンゲージ
された後、所定の旋回率での旋回を終了した場合には、
ターン・イン・ポイント手前の見越し旋回点までは飛行
コースに対するずれを修正して飛行コースに乗せるよう
にロール姿勢制御を行うためのコマンドをロール・サー
ボに出力する第2の手段、目標飛行点への進入コースを
指定した場合には、上記第2の手段の後目標飛行点への
進入コースに向け所定旋回率での旋回を行うためのコマ
ンドを出力し、旋回後は目標飛行点への進入コースに対
するずれを修正しつつ目標飛行点オン・トップ以前にロ
ール姿勢を水平に戻すためのコマンドをロール・サーボ
に出力する手段からなるロール系統制御サブシステム
と、上記目標飛行点への自動飛行モードがエンゲージさ
れた後、釣合旋回モードを実行するためのコマンドをヨ
ー・サーボに出力するヨー系統制御システムと、上記目
標飛行点への自動飛行モードがエンゲージされた時の対
気速度を保持するためのコマンドをピッチ・サーボに出
力するピッチ系サブシステムと、ロール系統制御サブシ
ステムのモード切換を行うモード制御サブシステムとを
備え、任意の飛行条件から目標飛行点へ自動的に誘導飛
行させることを特徴とする自動飛行制御システム。
1. In a flight control system of a helicopter having a navigation function for providing flight information to a target flight point, after the automatic flight mode to the target flight point is engaged, the bank angle is calculated from the airspeed at the time of engagement. When the automatic flight mode is engaged and the turn at the predetermined turn rate is finished, the first means for calculating the command to output to the roll servo the command for turning at the predetermined turn rate,
To the target flight point, the second means to output the command to the roll servo to correct the deviation to the flight course and put it on the flight course until the prospective turning point before the turn-in point is corrected. When the approach course is designated, the command for turning at a predetermined turn rate toward the approach course to the target flight point after the second means is output, and after the turn, the approach to the target flight point is performed. A roll system control subsystem consisting of means for outputting commands to the roll servo to return the roll attitude to the horizontal position before the target flight point on top while correcting the deviation with respect to the course, and the automatic flight mode to the target flight point. After being engaged, the yaw system control system that outputs the command to execute the balanced turning mode to the yaw servo, and the automatic flight to the target flight point above. Arbitrary flight with a pitch subsystem that outputs commands to the pitch servo to maintain the airspeed when the mode is engaged, and a mode control subsystem that switches the mode of the roll system control subsystem An automatic flight control system that automatically guides you from a condition to a target flight point.
JP26317591A 1991-09-12 1991-09-12 Automatic flight control system Expired - Lifetime JPH07115674B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP26317591A JPH07115674B2 (en) 1991-09-12 1991-09-12 Automatic flight control system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP26317591A JPH07115674B2 (en) 1991-09-12 1991-09-12 Automatic flight control system

Publications (2)

Publication Number Publication Date
JPH0569896A true JPH0569896A (en) 1993-03-23
JPH07115674B2 JPH07115674B2 (en) 1995-12-13

Family

ID=17385816

Family Applications (1)

Application Number Title Priority Date Filing Date
JP26317591A Expired - Lifetime JPH07115674B2 (en) 1991-09-12 1991-09-12 Automatic flight control system

Country Status (1)

Country Link
JP (1) JPH07115674B2 (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR100714425B1 (en) * 2004-12-11 2007-05-04 삼성전자주식회사 Oven
JP2016184288A (en) * 2015-03-26 2016-10-20 富士重工業株式会社 Flight path creation device, flight path creation method, and flight path creation program

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR100714425B1 (en) * 2004-12-11 2007-05-04 삼성전자주식회사 Oven
JP2016184288A (en) * 2015-03-26 2016-10-20 富士重工業株式会社 Flight path creation device, flight path creation method, and flight path creation program

Also Published As

Publication number Publication date
JPH07115674B2 (en) 1995-12-13

Similar Documents

Publication Publication Date Title
JP5033790B2 (en) Fly-by-wire static longitudinal stability compensation system
EP0256564B1 (en) Intervention flight management system
US11169524B2 (en) Heading control device and heading control method for ship
JP3645038B2 (en) Aircraft flight control equipment
CA2569227C (en) Systems and methods for controlling dynamic systems
US4633404A (en) Automatic deceleration of aircraft during descent
CN107000756B (en) For running the method and motor vehicle for carrying out longitudinally controlled driver assistance system of motor vehicle
JPH03143800A (en) Autopilot device
US20210255640A1 (en) Vessel-azimuth control apparatus and azimuth controlling method
CN110254696A (en) Unmanned plane mode switch control method, device, storage medium and electronic equipment
CN112650297B (en) Control method and control device for unmanned aerial vehicle, unmanned aerial vehicle and storage medium
JP4434205B2 (en) Motor control device and control method thereof
JPS59160700A (en) Three-cue flight controller for helicopter
US20210114458A1 (en) Speed control device, automatic navigation system and method of controlling speed
JPH0569896A (en) Automatic flight control system
US4862372A (en) Apparatus and methods for generating aircraft control commands using nonlinear feedback gain
JPH04254294A (en) Device and method for controlling instructed operation of aircraft within limit of predetermined flight parameter
US11774985B2 (en) Arithmetic processing device and wireless controlled airplane
JP3377532B2 (en) Automatic flight control system
US20220119108A1 (en) Wireless Controlled Airplane and Arithmetic Processing Device
US2829848A (en) Aircraft control system
JP3814997B2 (en) Preceding vehicle tracking control device
JP3068313B2 (en) Automatic flight control system
JPS60308B2 (en) elevator control device
JPH08193799A (en) Airframe controller

Legal Events

Date Code Title Description
S533 Written request for registration of change of name

Free format text: JAPANESE INTERMEDIATE CODE: R313533

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350

EXPY Cancellation because of completion of term