JP2001055198A - 自動操縦装置 - Google Patents

自動操縦装置

Info

Publication number
JP2001055198A
JP2001055198A JP11232437A JP23243799A JP2001055198A JP 2001055198 A JP2001055198 A JP 2001055198A JP 11232437 A JP11232437 A JP 11232437A JP 23243799 A JP23243799 A JP 23243799A JP 2001055198 A JP2001055198 A JP 2001055198A
Authority
JP
Japan
Prior art keywords
acceleration
command
steering
control
correcting
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
JP11232437A
Other languages
English (en)
Other versions
JP3959538B2 (ja
Inventor
Rui Hirokawa
類 廣川
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.)
Mitsubishi Electric Corp
Original Assignee
Mitsubishi Electric Corp
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 Mitsubishi Electric Corp filed Critical Mitsubishi Electric Corp
Priority to JP23243799A priority Critical patent/JP3959538B2/ja
Publication of JP2001055198A publication Critical patent/JP2001055198A/ja
Application granted granted Critical
Publication of JP3959538B2 publication Critical patent/JP3959538B2/ja
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

(57)【要約】 【課題】 飛しょう体の発生横加速度を制御するために
複数の操舵翼に舵角指令を出力する自動操縦装置におい
て、重力加速度の影響により発生横加速度に誤差を生じ
るという問題があった。 【解決手段】 重力による発生加速度誤差を補正するた
めの補正加速度信号を計算する補正計算手段と、機体を
制御するために与えられた信号からピッチ系、ヨー系、
ロール系の各操舵指令を計算する操舵指令計算手段と、
それらの操舵指令から各操舵翼への舵角指令を計算する
舵角指令計算手段とを備えて自動操縦装置を構成した。

Description

【発明の詳細な説明】
【0001】
【発明の属する技術分野】本発明は、横加速度を発生さ
せることにより目標と会合する経路に飛しょう体の経路
を誘導することを目的とした飛しょう体の自動操縦装置
に関する。
【0002】
【従来の技術】図4は自動操縦装置を搭載した飛しょう
体50の簡略化した構成例を示す図である。飛しょう体
の加速度及び角速度は、図に示すピッチ系、ヨー系、ロ
ール系を基準として定義する。図において、20は自動
操縦装置、40は横加速度を発生させるための横加速度
指令を出力する誘導装置、41は機体の横加速度、角速
度、姿勢角、速度、高度等の運動を検出する慣性装置、
42は自動操縦装置から出力された操舵翼の舵角指令信
号を受けて操舵翼を駆動する操舵装置、43は操舵翼で
ある。また、図5は従来の方法による自動操縦装置の構
成を示すブロック図である。図において、1は、重力に
より発生する飛しょう体の横加速度を補正するための加
速度指令補正計算部、2は加速度指令及び慣性装置が出
力した横加速度、角速度からピッチ系、ヨー系、ロール
系の各操舵指令を出力する舵角指令計算部、3はピッチ
系、ヨー系、ロール系の各操舵指令から複数の操舵翼4
3に関する操舵指令を計算する操舵翼舵角指令計算部で
ある。さらに、20は自動操縦装置全体を示す。
【0003】従来の自動操縦装置は上記のように構成さ
れる。加速度指令補正計算部1において誘導装置40か
らのピッチ系横加速度指令apcおよびヨー系横加速度指
令aycに対して慣性装置41から出力されるピッチ系姿
勢角qおよびロール系姿勢角fを用いて重力により発生す
る飛しょう体の横加速度を補正するための加速度指令ag
p、agyを数1により計算し、加算器10により補正を行
い、補正後の加速度指令apc1およびayc1を出力する。慣
性装置41から出力される飛しょう体のピッチ系横加速
度amp、ヨー系横加速度amy及びロール系角速度p、ピッ
チ系角速度q,、ヨー系角速度r等の信号を用いて、舵角
指令計算部2において機体を制御するために必要なピッ
チ系・ヨー系・ロール系の操舵指令dpc、dyc、drcを計
算する。当該操舵指令を用いて操舵翼舵角指令計算部3
において4枚の操舵翼に関する操舵指令d1c、d2c、d3c、
d4cを計算し、操舵装置に出力する。
【0004】
【数1】 従来の自動操縦装置の舵角指令計算部2は、ピッチ系舵
角指令計算部4、ヨー系舵角指令計算部5、ロール系舵
角指令計算部6から構成される。横加速度制御に関係す
るのは、ピッチ系舵角指令計算部4、ヨー系舵角指令計
算部5であるが、両者は同じ構造を有するためピッチ系
舵角指令計算部4について図6を用いて説明する。飛し
ょう体のピッチ系舵角指令計算部においては、通常、図
に示すような横加速度及び角速度をフィードバック量と
する3ループ加速度制御系が使用される。以下にその構
成を説明する。30、31、32、33はそれぞれC
0、C1、C2、C3を値とするゲイン、34は減算
器、35は積分器である。ゲインC1、C2、C3は応
答性と安定性に関する条件より値を設定し、ゲインC0
は、横加速度指令に対する発生加速度のゲインが1とな
るようにゲインC1および飛しょう体の速度Vmを用い
て数2のように設定する。
【0005】
【数2】
【0006】
【発明が解決しようとする課題】図6に示す構成を有す
る従来の自動操縦装置においては、図7に示すように重
力加速度の影響により横加速度指令に対して発生加速度
にバイアス誤差を生じてしまうという問題があった。バ
イアス発生する方向は重力の方向と同じ鉛直面内であ
り、その大きさeは数3のように計算できる。数2およ
び数3より前記加速度バイアス誤差eは、速度が小さい
時に大きくなる。このため、超音速で飛しょうする飛し
ょう体では大きな加速度バイアス誤差を発生しないが、
特に低速の飛しょう体においては大きな誤差を発生し、
飛しょう体の姿勢制御においてその精度が劣化する。
【0007】
【数3】
【0008】この発明は係る課題を解決するためになさ
れたものであり、重力加速度により発生する加速度バイ
アス誤差を打ち消し、制御性能を向上させるものであ
る。
【0009】
【課題を解決するための手段】第1の発明による飛しょ
う体の自動操縦装置は、飛しょう体の発生横加速度を制
御するために複数の操舵翼に舵角指令を出力する自動操
縦装置において、重力による発生加速度誤差を補正する
ための補正加速度指令を計算する補正計算手段と、前記
補正計算手段で計算された補正加速度指令、加速度指令
及び慣性装置からの加速度情報に基づき機体の姿勢を制
御するための操舵指令を計算する操舵指令計算手段と、
前記操舵指令から各操舵翼への舵角指令を計算する舵角
指令計算手段とを備えたものである。
【0010】第2の発明による飛しょう体の自動操縦装
置は、第1の発明による自動操縦装置において、前記補
正加速度指令に対して飛しょう体の速度および高度に応
じてリミット処理を行うリミッタを備えたものである。
【0011】第3の発明による飛しょう体の自動操縦装
置は、第1の発明による自動操縦装置において、前記加
速度指令に対して慣性装置の高度情報に基づき計算した
重力加速度を用いて、発生加速度誤差を補正するための
補正加速度指令を計算する手段を有したものである。
【0012】
【発明の実施の形態】実施の形態1.図1は本発明によ
る自動操縦装置の実施の形態1を示すブロック図であ
る。図において、1は、重力により発生する飛しょう体
の横加速度を補正するための加速度指令補正計算部、2
は加速度指令及び慣性装置が出力した横加速度、角速度
からピッチ系、ヨー系、ロール系の各操舵指令を出力す
る舵角指令計算部、3はピッチ系、ヨー系、ロール系の
各操舵指令から複数の操舵翼43に関する操舵指令を計
算する操舵翼舵角指令計算部である。さらに、7は自動
操縦装置全体を示す。加速度指令補正計算部1におい
て、8、9、11はゲイン、9、10は加算器である。
横加速度に関する誤差eを打ち消すために、数4を用い
て重力補正用加速度指令agpおよびagyを計算す
る。
【0013】
【数4】
【0014】続いて、加算器10により加速度補正計算
を行い、補正後の加速度指令apc1およびayc1を
出力する。この後、舵角指令計算部2においてピッチ・
ヨー・ロール系の操舵指令dpc、dyc、drcを計算し、操
舵翼舵角指令計算部3において各操舵翼に関する操舵指
令d1c、d2c、d3c、d4cを計算する。操舵指令d1c、d2c、
d3c、d4cは操舵装置に出力する。
【0015】ここで、数3で計算される鉛直下方向に発
生する横加速度誤差eのピッチ系成分epおよびヨー系
成分eyは、数5のように計算できる。epと数1によ
る従来の加速度指令補正信号agpの和と数4で計算さ
れるagpは大きさが同じで方向が逆のため、数4で計
算される補正加速度指令agpが入力された場合、ep
を打ち消すことができる。同様に誤差のヨー系成分ey
と数1による従来の加速度指令補正信号agyの和とa
gyは大きさが同じで方向が逆のため、agyによりe
yを打ち消すことができる。よって、横加速度の誤差e
を打ち消すことができる。
【0016】
【数5】
【0017】実施の形態2.図2は本発明による自動操
縦装置の実施の形態2を示すブロック図である。図にお
いて、12はリミッタである。横加速度に関する誤差e
を打ち消すために、重力補正用加速度指令agpおよび
agyを計算する。その際、補正加速度指令の大きさa
gにリミット処理を行う。agpおよびagyの計算式
は数6のようになる。リミット処理を行う際の閾値は、
飛しょう体の運動特性(例えば飛しょう体の速度および
高度)に応じて適当な値を設定する。運動特性に対して
過大な加速度指令が舵角指令計算部2に入力された場合
には、操舵可能な舵角を超えた指令が発生し、制御系が
不安定になる可能性がある。補正加速度指令にリミット
処理を行うことにより、過大な加速度指令の入力を防止
することができる。
【0018】
【数6】
【0019】実施の形態3.図3は本発明による自動操
縦装置の実施の形態3を示すブロック図である。図にお
いて、13は乗算器、14は慣性装置から出力される飛
しょう高度に基づき重力加速度を計算する重力加速度計
算部である。地球上において重力は概ね地球中心までの
距離の2乗に反比例して増加する。重力加速度の計算
は、数7を用いる。重力補正用加速度指令agpおよび
agyを計算には数4を用いる。数7による補正された
重力加速度は、第1の発明において用いた高度によらず
一定の値g0よりも真の重力加速度に近く、計算に用い
た重力加速度と真の重力加速度の差により加速度バイア
ス誤差が発生することを防止することができる。
【0020】
【数7】
【0021】
【発明の効果】第1の発明によれば、重力加速度により
発生する横加速度の誤差を補正加速度指令により打ち消
すことができ、制御性能を向上させることができる。
【0022】第2の発明によれば、第1の発明の効果に
加えて、補正加速度指令にリミット処理を行うことによ
り、制御系が不安定になることを防止することができ、
制御系の安定性が向上する。
【0023】第3の発明によれば、第1の発明の効果に
加えて、飛しょう体の高度から重力加速度を計算し、補
正加速度指令を計算することにより補正加速度指令の精
度を向上させる効果があり、結果として制御性能を向上
させることができる。
【図面の簡単な説明】
【図1】 本発明の実施の形態1による自動操縦装置の
構成を表すブロック図である。
【図2】 本発明の実施の形態2による自動操縦装置の
構成を表すブロック図である。
【図3】 本発明の実施の形態3による自動操縦装置の
構成を表すブロック図である。
【図4】 飛しょう体の制御系の構成を表すブロック図
である。
【図5】 従来の形態による自動操縦装置の構成を表す
ブロック図である。
【図6】 自動操縦装置におけるピッチ系舵角指令計算
部の構成を表すブロック図である。
【図7】 従来の形態における発生横加速度の誤差を表
す図である。
【符号の説明】
1 加速度指令補正計算部 2 舵角指令計算部 3 操舵翼舵角指令計算部 4 ピッチ系舵角指令計算部 5 ヨー系舵角指令計算部 6 ロール系舵角指令計算部 7 本発明による自動操縦装置 8 ゲイン 9 ゲイン 10 加算器 11 ゲイン 12 リミッタ 13 乗算器 14 重力加速度計算部 20 従来の方式による自動操縦装置 30 ゲイン 31 ゲイン 32 ゲイン 33 ゲイン 34 減算器 35 積分器 40 誘導装置 41 慣性装置 42 操舵装置 43 操舵翼 50 飛しょう体

Claims (3)

    【特許請求の範囲】
  1. 【請求項1】 飛しょう体の発生横加速度を制御するた
    めに複数の操舵翼に舵角指令を出力する自動操縦装置に
    おいて、重力による発生加速度誤差を補正するための補
    正加速度指令を計算する補正計算手段と、前記補正計算
    手段で計算された補正加速度指令、加速度指令及び慣性
    装置からの加速度情報に基づき機体の姿勢を制御するた
    めの操舵指令を計算する操舵指令計算手段と、前記操舵
    指令から各操舵翼への舵角指令を計算する舵角指令計算
    手段とを備えたことを特徴とする自動操縦装置。
  2. 【請求項2】前記補正加速度指令に対して飛しょう体の
    速度および高度に応じてリミット処理を行うリミッタを
    備えたことを特徴とする請求項1記載の自動操縦装置。
  3. 【請求項3】前記加速度指令に対して慣性装置の高度情
    報に基づき計算した重力加速度を用いて、発生加速度誤
    差を補正するための補正加速度指令を計算する手段を有
    したことを特徴とする請求項1記載の自動操縦装置。
JP23243799A 1999-08-19 1999-08-19 自動操縦装置 Expired - Fee Related JP3959538B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP23243799A JP3959538B2 (ja) 1999-08-19 1999-08-19 自動操縦装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP23243799A JP3959538B2 (ja) 1999-08-19 1999-08-19 自動操縦装置

Publications (2)

Publication Number Publication Date
JP2001055198A true JP2001055198A (ja) 2001-02-27
JP3959538B2 JP3959538B2 (ja) 2007-08-15

Family

ID=16939260

Family Applications (1)

Application Number Title Priority Date Filing Date
JP23243799A Expired - Fee Related JP3959538B2 (ja) 1999-08-19 1999-08-19 自動操縦装置

Country Status (1)

Country Link
JP (1) JP3959538B2 (ja)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2016153706A (ja) * 2015-02-20 2016-08-25 三菱重工業株式会社 飛しょう体誘導システム、飛しょう体誘導方法及びプログラム

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5361900A (en) * 1976-11-10 1978-06-02 Martin Marietta Corp Gravity compensating device for guided missile or missile
JPS59221600A (ja) * 1983-06-01 1984-12-13 三菱電機株式会社 飛しよう体
JPH0272914U (ja) * 1988-11-24 1990-06-04
JPH06161556A (ja) * 1992-11-17 1994-06-07 Mitsubishi Electric Corp オートパイロット装置
JPH07325622A (ja) * 1994-06-01 1995-12-12 Mitsubishi Electric Corp 自動操縦装置
JP2000055591A (ja) * 1998-08-07 2000-02-25 Mitsubishi Electric Corp 飛しょう体の制御装置
JP2000074596A (ja) * 1998-08-27 2000-03-14 Tech Res & Dev Inst Of Japan Def Agency 自動操縦装置
JP2000121293A (ja) * 1998-10-21 2000-04-28 Mitsubishi Electric Corp 飛しょう体の制御装置

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5361900A (en) * 1976-11-10 1978-06-02 Martin Marietta Corp Gravity compensating device for guided missile or missile
JPS59221600A (ja) * 1983-06-01 1984-12-13 三菱電機株式会社 飛しよう体
JPH0272914U (ja) * 1988-11-24 1990-06-04
JPH06161556A (ja) * 1992-11-17 1994-06-07 Mitsubishi Electric Corp オートパイロット装置
JPH07325622A (ja) * 1994-06-01 1995-12-12 Mitsubishi Electric Corp 自動操縦装置
JP2000055591A (ja) * 1998-08-07 2000-02-25 Mitsubishi Electric Corp 飛しょう体の制御装置
JP2000074596A (ja) * 1998-08-27 2000-03-14 Tech Res & Dev Inst Of Japan Def Agency 自動操縦装置
JP2000121293A (ja) * 1998-10-21 2000-04-28 Mitsubishi Electric Corp 飛しょう体の制御装置

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2016153706A (ja) * 2015-02-20 2016-08-25 三菱重工業株式会社 飛しょう体誘導システム、飛しょう体誘導方法及びプログラム

Also Published As

Publication number Publication date
JP3959538B2 (ja) 2007-08-15

Similar Documents

Publication Publication Date Title
US6757570B1 (en) System and method for adaptive control of uncertain nonlinear processes
US8340841B2 (en) Method of estimating an angle of attack and an angle of sideslip of an aircraft
JPH04262993A (ja) 航空機の制御システムおよび制御装置
Lavretsky F/A-18 autonomous formation flight control system design
JP4644522B2 (ja) 小型無人ヘリコプタの自律飛行制御装置及び自律飛行制御方法
US6871816B2 (en) Proactive optical trajectory following system
GB1561650A (en) Aircraft control system
US3946968A (en) Apparatus and method for aerodynamic cross-coupling reduction
JPS61188299A (ja) 自動キヤンバ制御装置及び制御方法
JP2007290647A (ja) 無人ヘリコプタおよび外部環境推定装置
JP4617990B2 (ja) 自動飛行制御装置、自動飛行制御方法及び自動飛行制御プログラム
CN113156985A (zh) 基于预设性能的固定翼无人机避障鲁棒抗扰飞行控制方法
JP3436722B2 (ja) 制御装置
JP2001055198A (ja) 自動操縦装置
JP2008143398A (ja) 飛翔体制御システムおよび飛翔体の飛行制御方法
RU2323464C2 (ru) Способ и устройство управления ориентируемой ракетой посредством привода, следящего за ориентацией траектории
JP4316772B2 (ja) 移動体
US3540678A (en) Method of and apparatus for controlling the transverse acceleration and roll damping of steerable aerodynamic bodies
KR20150107662A (ko) 모듈화된 쿼드 로터 제어 시스템 및 그의 제어 방법
US9889926B2 (en) Air vehicles and systems for preemptive turbulence mitigation
JP3028888B2 (ja) オートパイロット装置
JP2005349871A (ja) 回転翼航空機の高度制御装置
JPH059806B2 (ja)
US20230242281A1 (en) Rocket control system and method of controlling landing operation of rocket
CN112182889B (zh) 一种考虑风干扰的舰载机着舰纵向运动线性模型的构建方法

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20040122

RD01 Notification of change of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7421

Effective date: 20040628

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20051018

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20051213

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20060203

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20060905

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20061101

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20061128

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20070126

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20070430

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

Free format text: PAYMENT UNTIL: 20100525

Year of fee payment: 3

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

Free format text: PAYMENT UNTIL: 20110525

Year of fee payment: 4

LAPS Cancellation because of no payment of annual fees