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
Links
- 230000001133 acceleration Effects 0.000 claims abstract description 102
- 230000005484 gravity Effects 0.000 claims abstract description 10
- 230000004044 response Effects 0.000 claims description 3
- 238000000034 method Methods 0.000 claims description 2
- 101100491336 Dictyostelium discoideum anapc1 gene Proteins 0.000 abstract description 3
- 101100491339 Schizosaccharomyces pombe (strain 972 / ATCC 24843) cut4 gene Proteins 0.000 abstract description 3
- 238000010586 diagram Methods 0.000 description 12
- 238000007796 conventional method Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000004043 responsiveness Effects 0.000 description 1
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
複数の操舵翼に舵角指令を出力する自動操縦装置におい
て、重力加速度の影響により発生横加速度に誤差を生じ
るという問題があった。 【解決手段】 重力による発生加速度誤差を補正するた
めの補正加速度信号を計算する補正計算手段と、機体を
制御するために与えられた信号からピッチ系、ヨー系、
ロール系の各操舵指令を計算する操舵指令計算手段と、
それらの操舵指令から各操舵翼への舵角指令を計算する
舵角指令計算手段とを備えて自動操縦装置を構成した。
Description
せることにより目標と会合する経路に飛しょう体の経路
を誘導することを目的とした飛しょう体の自動操縦装置
に関する。
体50の簡略化した構成例を示す図である。飛しょう体
の加速度及び角速度は、図に示すピッチ系、ヨー系、ロ
ール系を基準として定義する。図において、20は自動
操縦装置、40は横加速度を発生させるための横加速度
指令を出力する誘導装置、41は機体の横加速度、角速
度、姿勢角、速度、高度等の運動を検出する慣性装置、
42は自動操縦装置から出力された操舵翼の舵角指令信
号を受けて操舵翼を駆動する操舵装置、43は操舵翼で
ある。また、図5は従来の方法による自動操縦装置の構
成を示すブロック図である。図において、1は、重力に
より発生する飛しょう体の横加速度を補正するための加
速度指令補正計算部、2は加速度指令及び慣性装置が出
力した横加速度、角速度からピッチ系、ヨー系、ロール
系の各操舵指令を出力する舵角指令計算部、3はピッチ
系、ヨー系、ロール系の各操舵指令から複数の操舵翼4
3に関する操舵指令を計算する操舵翼舵角指令計算部で
ある。さらに、20は自動操縦装置全体を示す。
れる。加速度指令補正計算部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を計算し、操舵装置に出力する。
角指令計算部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のように設定する。
る従来の自動操縦装置においては、図7に示すように重
力加速度の影響により横加速度指令に対して発生加速度
にバイアス誤差を生じてしまうという問題があった。バ
イアス発生する方向は重力の方向と同じ鉛直面内であ
り、その大きさeは数3のように計算できる。数2およ
び数3より前記加速度バイアス誤差eは、速度が小さい
時に大きくなる。このため、超音速で飛しょうする飛し
ょう体では大きな加速度バイアス誤差を発生しないが、
特に低速の飛しょう体においては大きな誤差を発生し、
飛しょう体の姿勢制御においてその精度が劣化する。
れたものであり、重力加速度により発生する加速度バイ
アス誤差を打ち消し、制御性能を向上させるものであ
る。
う体の自動操縦装置は、飛しょう体の発生横加速度を制
御するために複数の操舵翼に舵角指令を出力する自動操
縦装置において、重力による発生加速度誤差を補正する
ための補正加速度指令を計算する補正計算手段と、前記
補正計算手段で計算された補正加速度指令、加速度指令
及び慣性装置からの加速度情報に基づき機体の姿勢を制
御するための操舵指令を計算する操舵指令計算手段と、
前記操舵指令から各操舵翼への舵角指令を計算する舵角
指令計算手段とを備えたものである。
置は、第1の発明による自動操縦装置において、前記補
正加速度指令に対して飛しょう体の速度および高度に応
じてリミット処理を行うリミッタを備えたものである。
置は、第1の発明による自動操縦装置において、前記加
速度指令に対して慣性装置の高度情報に基づき計算した
重力加速度を用いて、発生加速度誤差を補正するための
補正加速度指令を計算する手段を有したものである。
る自動操縦装置の実施の形態1を示すブロック図であ
る。図において、1は、重力により発生する飛しょう体
の横加速度を補正するための加速度指令補正計算部、2
は加速度指令及び慣性装置が出力した横加速度、角速度
からピッチ系、ヨー系、ロール系の各操舵指令を出力す
る舵角指令計算部、3はピッチ系、ヨー系、ロール系の
各操舵指令から複数の操舵翼43に関する操舵指令を計
算する操舵翼舵角指令計算部である。さらに、7は自動
操縦装置全体を示す。加速度指令補正計算部1におい
て、8、9、11はゲイン、9、10は加算器である。
横加速度に関する誤差eを打ち消すために、数4を用い
て重力補正用加速度指令agpおよびagyを計算す
る。
を行い、補正後の加速度指令apc1およびayc1を
出力する。この後、舵角指令計算部2においてピッチ・
ヨー・ロール系の操舵指令dpc、dyc、drcを計算し、操
舵翼舵角指令計算部3において各操舵翼に関する操舵指
令d1c、d2c、d3c、d4cを計算する。操舵指令d1c、d2c、
d3c、d4cは操舵装置に出力する。
生する横加速度誤差eのピッチ系成分epおよびヨー系
成分eyは、数5のように計算できる。epと数1によ
る従来の加速度指令補正信号agpの和と数4で計算さ
れるagpは大きさが同じで方向が逆のため、数4で計
算される補正加速度指令agpが入力された場合、ep
を打ち消すことができる。同様に誤差のヨー系成分ey
と数1による従来の加速度指令補正信号agyの和とa
gyは大きさが同じで方向が逆のため、agyによりe
yを打ち消すことができる。よって、横加速度の誤差e
を打ち消すことができる。
縦装置の実施の形態2を示すブロック図である。図にお
いて、12はリミッタである。横加速度に関する誤差e
を打ち消すために、重力補正用加速度指令agpおよび
agyを計算する。その際、補正加速度指令の大きさa
gにリミット処理を行う。agpおよびagyの計算式
は数6のようになる。リミット処理を行う際の閾値は、
飛しょう体の運動特性(例えば飛しょう体の速度および
高度)に応じて適当な値を設定する。運動特性に対して
過大な加速度指令が舵角指令計算部2に入力された場合
には、操舵可能な舵角を超えた指令が発生し、制御系が
不安定になる可能性がある。補正加速度指令にリミット
処理を行うことにより、過大な加速度指令の入力を防止
することができる。
縦装置の実施の形態3を示すブロック図である。図にお
いて、13は乗算器、14は慣性装置から出力される飛
しょう高度に基づき重力加速度を計算する重力加速度計
算部である。地球上において重力は概ね地球中心までの
距離の2乗に反比例して増加する。重力加速度の計算
は、数7を用いる。重力補正用加速度指令agpおよび
agyを計算には数4を用いる。数7による補正された
重力加速度は、第1の発明において用いた高度によらず
一定の値g0よりも真の重力加速度に近く、計算に用い
た重力加速度と真の重力加速度の差により加速度バイア
ス誤差が発生することを防止することができる。
発生する横加速度の誤差を補正加速度指令により打ち消
すことができ、制御性能を向上させることができる。
加えて、補正加速度指令にリミット処理を行うことによ
り、制御系が不安定になることを防止することができ、
制御系の安定性が向上する。
加えて、飛しょう体の高度から重力加速度を計算し、補
正加速度指令を計算することにより補正加速度指令の精
度を向上させる効果があり、結果として制御性能を向上
させることができる。
構成を表すブロック図である。
構成を表すブロック図である。
構成を表すブロック図である。
である。
ブロック図である。
部の構成を表すブロック図である。
す図である。
Claims (3)
- 【請求項1】 飛しょう体の発生横加速度を制御するた
めに複数の操舵翼に舵角指令を出力する自動操縦装置に
おいて、重力による発生加速度誤差を補正するための補
正加速度指令を計算する補正計算手段と、前記補正計算
手段で計算された補正加速度指令、加速度指令及び慣性
装置からの加速度情報に基づき機体の姿勢を制御するた
めの操舵指令を計算する操舵指令計算手段と、前記操舵
指令から各操舵翼への舵角指令を計算する舵角指令計算
手段とを備えたことを特徴とする自動操縦装置。 - 【請求項2】前記補正加速度指令に対して飛しょう体の
速度および高度に応じてリミット処理を行うリミッタを
備えたことを特徴とする請求項1記載の自動操縦装置。 - 【請求項3】前記加速度指令に対して慣性装置の高度情
報に基づき計算した重力加速度を用いて、発生加速度誤
差を補正するための補正加速度指令を計算する手段を有
したことを特徴とする請求項1記載の自動操縦装置。
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)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2016153706A (ja) * | 2015-02-20 | 2016-08-25 | 三菱重工業株式会社 | 飛しょう体誘導システム、飛しょう体誘導方法及びプログラム |
Citations (8)
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 | 飛しょう体の制御装置 |
-
1999
- 1999-08-19 JP JP23243799A patent/JP3959538B2/ja not_active Expired - Fee Related
Patent Citations (8)
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)
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 |