JP3959538B2 - 自動操縦装置 - Google Patents

自動操縦装置 Download PDF

Info

Publication number
JP3959538B2
JP3959538B2 JP23243799A JP23243799A JP3959538B2 JP 3959538 B2 JP3959538 B2 JP 3959538B2 JP 23243799 A JP23243799 A JP 23243799A JP 23243799 A JP23243799 A JP 23243799A JP 3959538 B2 JP3959538 B2 JP 3959538B2
Authority
JP
Japan
Prior art keywords
acceleration
command
steering
gain
flying object
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.)
Expired - Fee Related
Application number
JP23243799A
Other languages
English (en)
Other versions
JP2001055198A (ja
Inventor
類 廣川
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

Images

Description

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

  1. 飛しょう体の発生横加速度を制御するために複数の操舵翼に舵角指令を出力する自動操縦装置において、
    発生横加速度に対するバイアス誤差を打ち消すための補正係数agを重量加速度gに乗じた結果に基づいて、重力による発生加速度誤差を補正するための補正加速度指令を計算する補正計算手段と、
    前記補正計算手段で計算された補正加速度指令、加速度指令及び慣性装置からの加速度情報に基づき機体の姿勢を制御するための操舵指令を計算する操舵指令計算手段と、
    前記操舵指令から各操舵翼への舵角指令を計算する舵角指令計算手段と、
    前記補正加速度指令に対して飛しょう体の速度および高度に応じてリミット処理を行うリミッタとを備え、
    上記舵角指令計算手段は、横加速度及び角速度をフィードバック量とする加速度制御系で構成されるピッチ系舵角指令計算部を有し、その制御系の加速度系のゲイン C 、角速度系のゲイン C について、ゲイン C 及び飛しょう体の速度 V mによって横加速度指令に対する発生加速度のゲインが1となるように、
    Figure 0003959538
    としてゲイン C が設定されるとき、上記補正係数agは、
    Figure 0003959538
    として設定されることを特徴とする自動操縦装置。
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 JP2001055198A (ja) 2001-02-27
JP3959538B2 true 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)

Families Citing this family (1)

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

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4123019A (en) * 1976-11-10 1978-10-31 Martin Marietta Corporation Method and system for gravity compensation of guided missiles or projectiles
JPS59221600A (ja) * 1983-06-01 1984-12-13 三菱電機株式会社 飛しよう体
JPH0272914U (ja) * 1988-11-24 1990-06-04
JP3028888B2 (ja) * 1992-11-17 2000-04-04 三菱電機株式会社 オートパイロット装置
JP3316715B2 (ja) * 1994-06-01 2002-08-19 三菱電機株式会社 自動操縦装置
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 飛しょう体の制御装置

Also Published As

Publication number Publication date
JP2001055198A (ja) 2001-02-27

Similar Documents

Publication Publication Date Title
JPH04262993A (ja) 航空機の制御システムおよび制御装置
JP3638685B2 (ja) 望ましくない横向き運動を減少するための方向舵修正コマンドを生成する方法およびシステム
JP3645038B2 (ja) 航空機の飛行制御装置
JPH0375399B2 (ja)
JP5052165B2 (ja) 船舶用自動操舵装置
JP4617990B2 (ja) 自動飛行制御装置、自動飛行制御方法及び自動飛行制御プログラム
CN113156985A (zh) 基于预设性能的固定翼无人机避障鲁棒抗扰飞行控制方法
JP3959538B2 (ja) 自動操縦装置
WO2021070518A1 (ja) 航空機の位置制御システム、航空機および航空機の位置制御方法
JP2009208587A (ja) 四輪車両及びプログラム
WO2022101893A1 (ja) 航空機の制御システム、航空機、航空機の制御方法及びプログラム
JP4537121B2 (ja) 回転翼航空機の高度制御装置
CN116203840A (zh) 可重复使用运载器自适应增益调度控制方法
CN110647161A (zh) 基于状态预测补偿的欠驱动uuv水平面轨迹跟踪控制方法
US3540678A (en) Method of and apparatus for controlling the transverse acceleration and roll damping of steerable aerodynamic bodies
RU2323464C2 (ru) Способ и устройство управления ориентируемой ракетой посредством привода, следящего за ориентацией траектории
JPH06195125A (ja) 飛翔体の飛行制御装置
CN110209197B (zh) 一种飞行器控制系统设计方法
CN114895698A (zh) 一种时变状态约束下四旋翼无人机轨迹跟踪控制方法
JP3028888B2 (ja) オートパイロット装置
CN113608534A (zh) 一种无人艇跟踪控制方法及系统
JP2557816B2 (ja) 垂直平面内における重航空機の操縦方法および装置
JPH05285276A (ja) 遠隔操縦式ヘリコプタの制御装置
JP2020047063A (ja) 制御装置、及びその制御方法並びに制御プログラム、構造体
EP0357660B1 (en) Correction of errors in autopilots

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