Deprecated: The each() function is deprecated. This message will be suppressed on further calls in /home/zhenxiangba/zhenxiangba.com/public_html/phproxy-improved-master/index.php on line 456
JP2888271B2 - 無人飛翔体の姿勢制御装置 - Google Patents
[go: Go Back, main page]

JP2888271B2 - 無人飛翔体の姿勢制御装置 - Google Patents

無人飛翔体の姿勢制御装置

Info

Publication number
JP2888271B2
JP2888271B2 JP6060752A JP6075294A JP2888271B2 JP 2888271 B2 JP2888271 B2 JP 2888271B2 JP 6060752 A JP6060752 A JP 6060752A JP 6075294 A JP6075294 A JP 6075294A JP 2888271 B2 JP2888271 B2 JP 2888271B2
Authority
JP
Japan
Prior art keywords
memory
attitude control
control device
altitude
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.)
Expired - Lifetime
Application number
JP6060752A
Other languages
English (en)
Other versions
JPH07271440A (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.)
NEC Corp
Original Assignee
Nippon Electric Co 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 Nippon Electric Co Ltd filed Critical Nippon Electric Co Ltd
Priority to JP6060752A priority Critical patent/JP2888271B2/ja
Publication of JPH07271440A publication Critical patent/JPH07271440A/ja
Application granted granted Critical
Publication of JP2888271B2 publication Critical patent/JP2888271B2/ja
Anticipated expiration legal-status Critical
Expired - Lifetime legal-status Critical Current

Links

Landscapes

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

Description

【発明の詳細な説明】
【0001】
【産業上の利用分野】本発明は無人飛翔体の姿勢制御装
置に関し、特に射撃訓練用の標的や無人偵察機として運
用される無人飛翔体の姿勢制御装置に関するものであ
る。
【0002】
【従来の技術】従来のこの種の飛翔体の姿勢制御方式
は、速度、高度及び大気の状態、あるいは自機の重心位
置、重量に全く無関係に一定の制御ゲインでエルロンや
エレベータの各操舵角量を決定して、ピッチ、ロール、
ヨー等の各制御を行なうようになっている。
【0003】この種の姿勢制御の従来例としては、特開
昭60−148798号公報、特開平2−150909
号公報、特開平3−153496号公報及び特開平4−
364505号公報等に開示の如く、種々の技術が提案
されている。
【0004】しかしながら、これ等技術の全てにおいて
は、上述した様に、速度、高度及び大気の状態、あるい
は自機の重心位置、重量に無関係に一定の制御ゲインで
もって姿勢制御を行なう方式となっている。
【0005】
【発明が解決しようとする課題】従来のこの種の無人飛
翔体の姿勢制御方式では、その姿勢制御ゲインが飛翔体
の環境に無関係に常にある一定に定められているため
に、これ等環境変化に対応した最適制御が行なえないと
いう欠点がある。
【0006】そこで、本発明はこの様な従来技術の欠点
を解消すべくなされたものであって、その目的とすると
ころは、速度、高度、温度等の大気状態に応じた最適制
御をなすことが可能な無人飛翔体の姿勢制御装置を提供
することにある。
【0007】本発明の他の目的は、燃料消費に起因する
重量、重心位置の変化に応じて最適制御をなすことが可
能な無人飛翔体の姿勢制御装置を提供することである。
【0008】
【課題を解決するための手段】本発明による無人飛翔体
の姿勢制御装置は、高度及び大気温度に対する大気密度
が予め算出されて格納された第1のメモリと、大気密度
及び速度に対する飛翔体の姿勢制御のための最適ゲイン
が予め算出されて格納された第2のメモリと、前記飛翔
体の速度を検出する速度検出手段と、前記飛翔体の高度
を検出する高度検出手段と、大気温度を検出する温度検
出手段と、前記高度検出手段及び前記温度検出手段の検
出結果により前記第1のメモリから大気密度を読出し、
この読出された大気密度及び前記速度検出手段による検
出速度により前記第2のメモリから前記最適ゲインを読
出してこの最適ゲインにより姿勢制御をなす制御手段と
を含むことを特徴としている。
【0009】
【0010】
【作用】飛翔体の対気速度、高度、大気温度の各検出デ
ータに基づき、これ等各検出データに対応した最適の姿
勢制御ゲインを決定し、この制御ゲインに基づいてピッ
チ、ロール、ヨーク等の姿勢制御を行なうもので、速度
や高度、更には大気温度に応じた最適の姿勢制御を可能
とする。
【0011】
【0012】
【実施例】以下、本発明の実施例について図面を参照し
て詳述する。
【0013】図1は本発明の一実施例のシステムブロッ
ク図である。図において、対気速度計1は速度Vを検出
測定するものであり、気圧高度計2は高度Hを検出測定
するものであり、温度センサ3は大気温度Tを検出測定
するものである。また、ジャイロ5が設けられており、
ピッチ角θ及びロール角φが検出される。
【0014】制御装置4はこれ等検出データV,H,T
を用いて最適の姿勢制御ゲインKを算出決定し、この最
適ゲインKを用いてジャイロ5からのピッチ角データθ
及びロール角データφにもとづき、エルロンやエレベー
タ等の姿勢制御用の昇降舵、補助翼、方向舵等を駆動す
るアクチュエータに対する駆動量(操舵量)δを算出す
るものである。
【0015】更に具体的に説明すると、対気速度計1及
び気圧高度計2により速度V及び高度Hが計測され、そ
の計測データV,Hは制御装置4へ入力される。また、
温度センサ3により周囲の大気温度Tが計測され、その
計測データTが制御装置4へ入力される。
【0016】制御装置4内の最適ゲインメモリ部41に
は、予め最適ゲインK1,K2及びKが、速度V及び大
気密度ρの関数として格納されており、その関数は、 K1=f1(V)…………(1) K2=f2(ρ)…………(2) K =f3(K1,K2)…………(3) と表されるものとする。
【0017】その一例が図1のメモリ41のブロックに
示されているが、これ等(1)〜(3)式の各関数は各
パラメータV,ρに対応して最適ゲインが得られる様に
夫々算出決定されており、ROM(リードオンリメモ
リ)の形式で構成される。
【0018】また、制御装置4のメモリ43には、大気
密度ρが高度H及び温度Tの関数として、 ρ=f4(H,T)………(4) に示される様に予め格納されているものとし、このメモ
リ43もROMの形式で構成される。
【0019】従って、制御装置4のメモリ43において
は、高度H及び温度Tから上記(4)式に従った大気密
度ρが得られる。次に、この大気密度ρと測定速度Vと
から、(1)〜(3)式に従って最適ゲインKがメモリ
41から求められる。そして、この最適ゲインKを用い
て、アクチュエータ駆動量算出部42にて、アクチュエ
ータ駆動量δが、 δ=K・f(θ,φ)………(5) なる予め定められた関数に従って算出される。
【0020】制御装置4では、上述の各演算が無人飛翔
体の飛行中連続して行なわれ、時々刻々変化する速度や
高度に応じて常に最適ゲインの設定が行なわれる。この
最適ゲインに基づいてアクチュエータの駆動量δが算出
され姿勢制御が最適に行われるのである。
【0021】図2は本発明の他の実施例のシステムブロ
ック図であり、図1と同等部分は同一符号により示して
いる。本実施例では、飛翔体の質量、重心位置に応じた
最適でゲインを求めて姿勢制御を行うものであり、燃料
消費に起因して変化する質量、重心位置を燃料残量に応
じて時々刻々求めて最適ゲインKを決定するようになっ
ている。
【0022】図2を参照すると、対気速度計1、気圧高
度計2は速度V及び高度Hを計測してその結果を制御装
置4へ送出する。温度センサ3は周囲の大気温度Tを計
測してその結果を制御装置4へ送出する。また、エンジ
ン(図示せず)の回転速度である回転数データr・p・
mが制御装置4へ入力されている。
【0023】制御装置4内には、最適ゲインK3,K4
及びKが質量m及び重心位置xCGの関数として、 K3=f7(xCG)…………(6) K4=f8(m)…………(7) K=f9(K3,K4)………(8) にて与えられ、予めメモリ41内に格納されている。
【0024】また、制御装置4内のメモリ46には、
心位置xCGが残燃料量Fuel の関数として、 xCG=f6(Fuel )………(9) にて与えられて予め格納されている。
【0025】更に、エンジンの燃料消費率Fc がエンジ
ンの回転数r・p・m、速度V及び大気密度ρの関数と
して、 Fc =f5(r・p・m.V,ρ)…………(10) にて与えられ、予めメモリ44に格納されている。
【0026】更にはまた、大気密度ρが高度H及び温度
Tの関数として、 ρ=f4(H,T)…………(11) にて与えられ、予めメモリ43に格納されている。
【0027】制御装置4では、入力された高度H及び温
度Tから(11)式に基づき決定される大気密度ρがメ
モリ43から求められる。次に、この結果と入力された
速度V及びエンジン回転数r・p・mとから、(10)
式に基づき決定される時々刻々の燃料消費率Fc がメモ
リ44から求められる。
【0028】そして、この燃料消費率Fc を基に、算出
部45にて残燃料量Fuel 及び質量mが算出される。こ
の算出方法としては、燃料消費率Fc の時間積分値によ
り燃料消費量を求め、 Fuel =〔総保有燃料量〕−〔燃料消費量〕…………(12) なる式で残燃料量を求めることができる。
【0029】また、質量mは、 m=〔総質量〕−〔燃料消費量〕…………(13) なる式で求められる。
【0030】そして、Fuel に対応した重心位置xCGが
メモリ46から求められ、このxCGと算出質量mとに対
応する各最適ゲインK3,K4及びKが(6)〜(8)
式に従ってメモリ41から求められる。
【0031】最後に、この最適ゲインKを用いてアクチ
ュエータ駆動量算出部42にて、アクチュエータ駆動量
δが、 δ=K・f(θ,φ) なる予め定められた関数に従って算出されることにな
る。
【0032】本例でも、上述の各演算が飛翔体の飛行中
連続して行なわれ、時々刻々変化する質量及び重心位置
に応じて常に最適な制御ゲインが設定され、よって最適
姿勢制御が可能となるものである。
【0033】尚、各メモリ41,43〜46はROM以
外のメモリでも良く、またソフトウェアによる演算処理
機能で構成しても良い。
【0034】
【発明の効果】以上述べた様に、本発明によれば、時々
刻々変化する飛翔体の速度、高度あるいは質量、重心位
置に対応して姿勢制御のゲインを変化させて常に最適ゲ
イン制御が可能となり、よって従来に比し安定な飛行が
行なえるという効果がある。
【図面の簡単な説明】
【図1】本発明の一実施例のシステムブロック図であ
る。
【図2】本発明の他の実施例のシステムブロック図であ
る。
【符号の説明】
1 対気速度計 2 気圧高度計 3 温度センサ 4 制御装置 5 ジャイロ 41 ゲイン設定メモリ 42 アクチュエータ駆動量算出部 43 大気密度設定メモリ 44 燃料消費率設定メモリ 45 残燃料量及び重量設定メモリ 46 重心位置設定メモリ
───────────────────────────────────────────────────── フロントページの続き (58)調査した分野(Int.Cl.6,DB名) G05D 1/10 B64C 13/18 F42B 15/01 FPAT(QUESTEL) WPI(DIALOG)

Claims (2)

    (57)【特許請求の範囲】
  1. 【請求項1】 高度及び大気温度に対する大気密度が予
    め算出されて格納された第1のメモリと、 大気密度及び速度に対する飛翔体の姿勢制御のための最
    適ゲインが予め算出されて格納された第2のメモリと、 前記飛翔体の速度を検出する速度検出手段と、 前記飛翔体の高度を検出する高度検出手段と、 大気温度を検出する温度検出手段と、 前記高度検出手段及び前記温度検出手段の検出結果によ
    り前記第1のメモリから大気密度を読出し、この読出さ
    れた大気密度及び前記速度検出手段による検出速度によ
    り前記第2のメモリから前記最適ゲインを読出してこの
    最適ゲインにより姿勢制御をなす制御手段と、 を含むことを特徴とする無人飛翔体の姿勢制御装置。
  2. 【請求項2】 前記第1及び第2のメモリは読出し専用
    メモリであることを特徴とする請求項1記載の無人飛翔
    体の姿勢制御装置。
JP6060752A 1994-03-30 1994-03-30 無人飛翔体の姿勢制御装置 Expired - Lifetime JP2888271B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP6060752A JP2888271B2 (ja) 1994-03-30 1994-03-30 無人飛翔体の姿勢制御装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP6060752A JP2888271B2 (ja) 1994-03-30 1994-03-30 無人飛翔体の姿勢制御装置

Publications (2)

Publication Number Publication Date
JPH07271440A JPH07271440A (ja) 1995-10-20
JP2888271B2 true JP2888271B2 (ja) 1999-05-10

Family

ID=13151324

Family Applications (1)

Application Number Title Priority Date Filing Date
JP6060752A Expired - Lifetime JP2888271B2 (ja) 1994-03-30 1994-03-30 無人飛翔体の姿勢制御装置

Country Status (1)

Country Link
JP (1) JP2888271B2 (ja)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2018053862A1 (zh) * 2016-09-26 2018-03-29 深圳市大疆创新科技有限公司 动力系统配置方法、装置、无人机、服务器及用户终端
JP6726222B2 (ja) 2018-03-07 2020-07-22 株式会社Subaru 飛行制御システム
JP7723938B2 (ja) * 2021-02-22 2025-08-15 株式会社Liberaware 無人飛行体の制御方法、無人飛行体およびプログラム

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US3831909A (en) * 1972-11-03 1974-08-27 Ford Motor Co Carburetor choke altitude compensation
JPS5968020A (ja) * 1982-10-12 1984-04-17 Mitsubishi Electric Corp 飛しよう体のオ−トパイロツト
JPH01107698U (ja) * 1988-01-14 1989-07-20
JPH03194400A (ja) * 1989-12-25 1991-08-26 Mitsubishi Electric Corp 飛しょう体の飛しょう制御装置
JPH04316998A (ja) * 1991-04-17 1992-11-09 Mitsubishi Electric Corp フライトコントロール装置

Also Published As

Publication number Publication date
JPH07271440A (ja) 1995-10-20

Similar Documents

Publication Publication Date Title
US4814764A (en) Apparatus and method for warning of a high yaw condition in an aircraft
Mokhtari et al. Dynamic feedback controller of Euler angles and wind parameters estimation for a quadrotor unmanned aerial vehicle
US5797105A (en) Air active control aircraft using three dimensional true airspeed detection system
CN104335128B (zh) 用于用侧风和加速度计偏差估计和补偿来控制多旋翼的旋翼无人机的方法
JP2005297922A (ja) 航空機の自動離陸装置、自動着陸装置及び自動離着陸装置並びに航空機の自動離陸方法、自動着陸方法及び自動離着陸方法
CN104900092B (zh) 用于确定飞行器的回避导引律的方法、电子系统和飞行器
EP4053504B1 (en) Systems and methods for model based inertial navigation for a spinning projectile
US20200264209A1 (en) System and method for determining wind direction and velocity measurement from altitude for an unmanned aerial vehicle
IL204390A (en) Method and instrument for predicting the vertical velocity of a helicopter
US20140326824A1 (en) Determination of angle of incidence
JP2888271B2 (ja) 無人飛翔体の姿勢制御装置
RU2042170C1 (ru) Система управления боковым движением беспилотного малоразмерного летательного аппарата
JP3436722B2 (ja) 制御装置
JP4369261B2 (ja) 無人ヘリコプタ用制御装置
US2984435A (en) Missile terminal guidance system controller
CN114208019A (zh) 马达控制装置、移动体、马达控制方法以及程序
JP3185081B2 (ja) 無人ヘリコプタの姿勢制御装置
US11592840B2 (en) Driving control device for remote controlled helicopter
CN113492971B (zh) 飞行装置及其控制方法和控制装置
JP2008143398A (ja) 飛翔体制御システムおよび飛翔体の飛行制御方法
CN112486218B (zh) 一种直升机的控制方法和系统
JP2001325245A (ja) ハイブリッドフィルタ
JP2733598B2 (ja) 水中航走体用速度計測装置
JPH07232699A (ja) 飛行体の姿勢制御装置
JP7399534B1 (ja) 飛行体の制御システム