JP2003114098A - Missile guiding device - Google Patents
Missile guiding deviceInfo
- Publication number
- JP2003114098A JP2003114098A JP2001308735A JP2001308735A JP2003114098A JP 2003114098 A JP2003114098 A JP 2003114098A JP 2001308735 A JP2001308735 A JP 2001308735A JP 2001308735 A JP2001308735 A JP 2001308735A JP 2003114098 A JP2003114098 A JP 2003114098A
- Authority
- JP
- Japan
- Prior art keywords
- latitude
- longitude
- altitude
- speed
- target
- 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.)
- Pending
Links
Landscapes
- Aiming, Guidance, Guns With A Light Source, Armor, Camouflage, And Targets (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
Description
【0001】[0001]
【発明の属する技術分野】この発明は、空中を移動して
いる目標に向かって誘導することを目的とする飛しょう
体誘導装置に関するものである。BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a flying body guiding apparatus for guiding a target moving in the air.
【0002】[0002]
【従来の技術】図16は従来の飛しょう体誘導装置を示
すもので、図において1は母機、2は航法計算部、3は
捜索処理部、4は追尾計算部、5は操舵部、6は飛しょ
う体である。従来の飛しょう体誘導装置は上記1〜6で
構成されている。2. Description of the Related Art FIG. 16 shows a conventional vehicle guidance system. In the figure, 1 is a mother aircraft, 2 is a navigation calculation unit, 3 is a search processing unit, 4 is a tracking calculation unit, 5 is a steering unit, 6 Is a flying object. The conventional flying body guidance device is composed of the above 1 to 6.
【0003】また、図17は飛しょう体誘導装置が適用
されるシステム全体を示す外観図である。図において1
は上記母機、6は上記飛しょう体、7は移動目標であ
る。FIG. 17 is an external view showing the entire system to which the flying body guiding device is applied. 1 in the figure
Is the mother aircraft, 6 is the flying object, and 7 is the moving target.
【0004】図16に示されるように、従来の飛しょう
体誘導装置が適用されるシステムにおいては、移動目標
を母機1に搭載されているレーダ装置で検出して、移動
目標の位置・速度情報である初期緯度・初期経度・初期
高度・緯度方向初期速度・経度方向初期速度・高度方向
初期速度及び母機の位置・速度情報である緯度・経度・
高度・緯度方向速度・経度方向速度・高度方向速度を得
て、母機1から分離した後に航法計算部2において母機
1から分離する前に入力された上記移動目標の位置・速
度情報である初期緯度・初期経度・初期高度・緯度方向
初期速度・経度方向初期速度・高度方向初期速度及び上
記母機の位置・速度情報である緯度・経度・高度・緯度
方向速度・経度方向速度・高度方向速度から、移動目標
の位置・速度情報である緯度・経度・高度・緯度方向速
度・経度方向速度・高度方向速度及び飛しょう体の位置
・速度情報である緯度・経度・高度・緯度方向速度・経
度方向速度・高度方向速度・垂直方向姿勢角・水平方向
姿勢角の算出を捜索可能な相対位置になるまで繰り返し
行い、捜索可能な相対位置になった場合に、捜索処理部
3において入力された上記移動目標の位置・速度情報で
ある緯度・経度・高度・緯度方向速度・経度方向速度・
高度方向速度及び上記飛しょう体の位置・速度情報であ
る緯度・経度・高度・緯度方向速度・経度方向速度・高
度方向速度をもとに捜索処理をして、捜索を完了した時
点での移動目標の追尾情報である初期相対速度・初期角
度・初期相対距離を算出して、追尾計算部4において入
力された上記移動目標の追尾情報である初期相対速度・
初期角度・初期相対距離から移動目標の追尾情報である
相対速度・角度・相対距離を算出して、移動目標への誘
導情報を算出して、操舵部5において入力された上記誘
導情報をもとに舵角制御をすることにより移動目標に向
かって誘導することができるようになっていた。As shown in FIG. 16, in a system to which a conventional flying body guidance device is applied, a moving target is detected by a radar device mounted on the mother aircraft 1, and position / speed information of the moving target is detected. The initial latitude, initial longitude, initial altitude, latitude initial speed, longitude initial speed, altitude initial speed, and the position / speed information of the mother plane, which is latitude / longitude.
Altitude / latitude direction velocity / longitude direction velocity / altitude direction velocity is obtained, and the initial latitude which is the position / speed information of the moving target input before separating from the mother machine 1 in the navigation calculation unit 2 after separating from the mother machine 1・ Initial longitude ・ Initial altitude ・ Latitude direction initial speed ・ Longitude direction initial speed ・ Altitude direction initial speed and the position / speed information of the above-mentioned mother machine: latitude / longitude / altitude / latitude direction speed / longitude direction speed / altitude direction speed, Latitude / longitude / altitude / latitude direction velocity / longitude direction velocity / altitude direction velocity, which is the position / speed information of the moving target, and latitude / longitude / altitude / latitude direction velocity / longitude direction velocity, which is the position / speed information of the flying object.・ The altitude velocity / vertical attitude angle / horizontal attitude angle are calculated repeatedly until the searchable relative position is reached, and when the searchable relative position is reached, the search processing unit 3 inputs the values. Latitude, longitude, altitude and latitude direction velocity and longitude direction speed and a position and speed information of the moving target
A search process is performed based on the altitude direction speed and latitude / longitude / altitude / latitude direction speed / longitude direction / altitude direction speed, which is the position / speed information of the above-mentioned flying object, and moves at the time when the search is completed. The initial relative velocity, the initial angle, and the initial relative distance, which are the target tracking information, are calculated, and the initial relative velocity, which is the tracking information of the moving target input in the tracking calculation unit 4, is calculated.
The relative velocity, the angle, and the relative distance, which are the tracking information of the moving target, are calculated from the initial angle and the initial relative distance, and the guiding information to the moving target is calculated. By controlling the rudder angle, the vehicle can be guided toward the moving target.
【0005】[0005]
【発明が解決しようとする課題】従来の飛しょう体誘導
装置は上記のように構成されているので、従来の飛しょ
う体誘導装置においては、移動目標から妨害を受けた場
合に、追尾計算部4において移動目標の追尾情報である
相対速度・角度・相対距離の算出を継続することが困難
になり、移動目標を見失う。移動目標を再発見するため
に、捜索処理部3において捜索可能な広い範囲の領域を
捜索することが必要となり、移動目標を発見するまでに
多くの時間がかかったり、また発見できなかったりし
て、移動目標に向かって誘導することが不可能になる問
題点があった。Since the conventional flying body guiding apparatus is configured as described above, the conventional flying body guiding apparatus has a tracking calculation unit in the case of being disturbed by a moving target. In 4, it becomes difficult to continue calculating the relative speed, angle, and relative distance, which are the tracking information of the moving target, and the moving target is lost. In order to rediscover the moving target, it is necessary for the search processing unit 3 to search a wide range of searchable areas, and it may take a long time to find the moving target, or the moving target may not be found. , There was a problem that it was impossible to guide toward the moving target.
【0006】この発明は、かかる問題点を解決するため
になされたものであり、移動目標から妨害を受けた場合
に、移動目標を見失ったとしても、飛しょう体の位置・
速度情報である緯度・経度・高度・緯度方向速度・経度
方向速度・高度方向速度・垂直方向姿勢角・水平方向姿
勢角と、移動目標の追尾情報である相対速度・相対距離
を使用して、移動目標の位置・速度情報である緯度・経
度・高度・緯度方向速度・経度方向速度・高度方向速度
を逆算し、移動目標の存在範囲を算出して、捜索する範
囲を絞り込むことにより移動目標の捜索を短時間ででき
るようにすることができる飛しょう体誘導装置を得るこ
とを目的としている。The present invention has been made in order to solve such a problem, and when the moving target is obstructed, even if the moving target is lost, the position of the flying object
By using the latitude / longitude / altitude / latitude direction velocity / longitude direction velocity / altitude direction velocity / vertical posture angle / horizontal posture angle, which is velocity information, and relative velocity / relative distance, which is tracking information of the moving target, The position / speed information of the moving target, which is latitude / longitude / altitude / latitude direction speed / longitude direction speed / altitude direction speed, is calculated backwards, the moving target existence range is calculated, and the search range is narrowed down. It is an object of the present invention to obtain a flying body guiding device that enables a search in a short time.
【0007】[0007]
【課題を解決するための手段】第1の発明による飛しょ
う体誘導装置は、母機から分離する前に母機から入力さ
れる移動目標の位置・速度情報である初期緯度・初期経
度・初期高度・緯度方向初期速度・経度方向初期速度・
高度方向初期速度及び母機の位置・速度情報である緯度
・経度・高度・緯度方向速度・経度方向速度・高度方向
速度から、母機から分離した後に移動目標の位置・速度
情報である緯度・経度・高度・緯度方向速度・経度方向
速度・高度方向速度を算出し、飛しょう体の位置・速度
情報である緯度・経度・高度・緯度方向速度・経度方向
速度・高度方向速度・垂直方向姿勢角・水平方向姿勢角
を算出する航法計算部と、この移動目標の位置・速度情
報である緯度・経度・高度・緯度方向速度・経度方向速
度・高度方向速度及び上記飛しょう体の位置・速度情報
である緯度・経度・高度・緯度方向速度・経度方向速度
・高度方向速度が入力され、移動目標の捜索処理を行
い、捜索を完了した時点での移動目標の追尾情報である
初期相対速度・初期角度・初期相対距離を算出する捜索
処理部と、この移動目標の追尾情報である初期相対速度
・初期角度・初期相対距離が入力され、捜索を完了した
時点からの移動目標の追尾情報である相対速度・角度・
相対距離を算出し、この移動目標の追尾情報である相対
速度・角度・相対距離から移動目標への誘導情報を算出
する追尾計算部と、この移動目標への誘導情報が入力さ
れ、飛しょう体を誘導するための舵角制御をする操舵部
と、飛しょう体を誘導している時に移動目標から妨害を
受けて移動目標を見失った場合に、飛しょう体の位置・
速度情報である緯度・経度・高度・緯度方向速度・経度
方向速度・高度方向速度・垂直方向姿勢角・水平方向姿
勢角が入力され、移動目標の追尾情報である相対速度・
相対距離が入力され、移動目標の位置・速度情報である
緯度・経度・高度・緯度方向速度・経度方向速度・高度
方向速度を逆算し、移動目標の存在範囲を算出する目標
存在範囲計算部を設けたものである。[Means for Solving the Problems] A flying body guiding apparatus according to the first invention is an initial latitude, an initial longitude, an initial altitude, which is position / velocity information of a moving target input from a mother aircraft before being separated from the mother aircraft. Initial velocity in latitude direction ・ Initial velocity in longitude direction ・
Altitude / Longitude / Altitude / Latitude / Velocity / Longitude / Altitude direction speed, which is the initial velocity in the altitude direction and position / speed information of the mother machine. The altitude, latitude direction speed, longitude direction speed, altitude direction speed is calculated, and the position / speed information of the flying object is latitude / longitude / altitude / latitude direction speed / longitude direction speed / altitude direction speed / vertical attitude angle / With the navigation calculator that calculates the horizontal attitude angle and the position / speed information of this moving target, which is the latitude / longitude / altitude / latitude direction speed / longitude direction speed / altitude direction speed, and the position / speed information of the above-mentioned flying object. A certain latitude / longitude / altitude / latitude direction velocity / longitude direction velocity / altitude direction velocity is input, search processing of the moving target is performed, and initial relative speed / initial that is tracking information of the moving target at the time when the search is completed. The search processing unit that calculates the degree and the initial relative distance, and the relative information that is the tracking information of the moving target from the time when the search is completed by inputting the initial relative velocity, the initial angle, and the initial relative distance that are the tracking information of this moving target. Speed / angle /
The tracking calculator that calculates the relative distance and calculates the guidance information to the moving target from the relative speed, angle, and relative distance that is the tracking information of the moving target, and the guidance information to the moving target is input, The steering unit that controls the rudder angle to guide the vehicle and the position of the flying object when the moving target is lost due to interference from the moving target while guiding the flying object.
Latitude / longitude / altitude / latitude direction velocity / longitude direction velocity / altitude direction velocity / vertical posture angle / horizontal posture angle, which are velocity information, are input, and relative velocity, which is tracking information of the moving target,
The relative distance is input, and the target existence range calculator that calculates the existence range of the moving target by back-calculating the latitude / longitude / altitude / latitude direction speed / longitude direction / altitude direction speed that is the position / speed information of the moving target is calculated. It is provided.
【0008】また、第2の発明による飛しょう体誘導装
置は、移動目標が上記目標存在範囲計算部で得た上記移
動目標の存在範囲を逸脱した場合に、上記目標存在範囲
計算部で得た上記逆算した移動目標の位置・速度情報で
ある緯度・経度・高度・緯度方向速度・経度方向速度・
高度方向速度が入力され、移動目標を見失った時点から
現時点までの移動目標の移動成分である緯度方向移動成
分・経度方向移動成分・高度方向移動成分を算出し、移
動目標の存在範囲を算出する移動成分計算部を設けたも
のである。Further, in the flying object guiding apparatus according to the second aspect of the present invention, when the moving target deviates from the existing range of the moving target obtained by the target existing range calculating section, the moving target is obtained by the target existing range calculating section. Latitude / longitude / altitude / latitude direction speed / longitude direction speed, which is the position / speed information of the moving target calculated by the above calculation.
Calculate the latitude range movement component, longitude direction movement component, and altitude direction movement component, which are the movement components of the movement target from the time when the movement target is lost and the current time is input, and the existence range of the movement target is calculated. A moving component calculator is provided.
【0009】また、第3の発明による飛しょう体誘導装
置は、複数の移動目標がいる場合で、誘導対象の移動目
標から妨害を受けて誘導対象の移動目標を見失った場合
に、上記航法計算部で得た複数の上記移動目標の位置・
速度情報であるそれぞれの緯度・経度・高度・緯度方向
速度・経度方向速度・高度方向速度が入力され、上記目
標存在範囲計算部で得た上記逆算した誘導対象の移動目
標の位置・速度情報である緯度・経度・高度・緯度方向
速度・経度方向速度・高度方向速度が入力され、複数の
移動目標の位置・速度情報であるそれぞれの緯度・経度
・高度・緯度方向速度・経度方向速度・高度方向速度
と、逆算した誘導対象の移動目標の位置・速度情報であ
る緯度・経度・高度・緯度方向速度・経度方向速度・高
度方向速度の差分を取り、複数の移動目標の中でどの目
標が1番差分が少ないか照合し、1番差分が少ない移動
目標の位置・速度情報である緯度・経度・高度・緯度方
向速度・経度方向速度・高度方向速度と、逆算した誘導
対象の移動目標の位置・速度情報である緯度・経度・高
度・緯度方向速度・経度方向速度・高度方向速度の平均
値を取って、誘導対象の移動目標の位置・速度情報であ
る緯度・経度・高度・緯度方向速度・経度方向速度・高
度方向速度として確定し、2番目に差分が少ない移動目
標の位置・速度情報である緯度・経度・高度・緯度方向
速度・経度方向速度・高度方向速度と、確定した誘導対
象の移動目標の位置・速度情報である緯度・経度・高度
・緯度方向速度・経度方向速度・高度方向速度の差分を
取り、差分を越えない範囲を誘導対象の移動目標の存在
範囲とする目標照合確定部を設けたものである。Further, the flying body guiding apparatus according to the third invention, when there are a plurality of moving targets, and when the moving target of the guiding target is lost due to interference from the moving target of the guiding target, the navigation calculation is performed. Positions of multiple moving targets obtained in the section
The latitude / longitude / altitude / latitude direction velocity / longitude direction velocity / altitude direction velocity, which is the velocity information, is input, and the position / velocity information of the backward movement target of the guidance target obtained by the target existence range calculation unit is used. Latitude / longitude / altitude / latitude direction speed / longitude direction speed / altitude direction speed is input, and each latitude / longitude / altitude / latitude / longitude / latitude direction speed / longitude direction speed / altitude is the position / speed information of multiple moving targets. Direction speed and the position / speed information of the back-calculated moving target to be guided, which is latitude / longitude / altitude / latitude direction speed / longitude direction speed / altitude direction speed. Check if there is the smallest difference and check the latitude / longitude / altitude / latitude direction speed / longitude direction speed / altitude direction speed, which is the position / speed information of the movement target with the smallest difference. Rank・ The average value of the latitude, longitude, altitude, latitude speed, longitude speed, and altitude speed that is the speed information, and the position, speed information, latitude, longitude, altitude, and latitude direction speed of the moving target to be guided.・ Longitudinal direction speed / altitude direction speed is determined, and the position / speed information of the moving target with the second smallest difference is latitude / longitude / altitude / latitude direction speed / longitude direction speed / altitude direction speed, and the confirmed guidance target Target matching that takes the difference between the position and speed information of the moving target of latitude, longitude, altitude, latitude direction speed, longitude direction speed, and altitude direction speed, and sets the range that does not exceed the difference as the existence range of the movement target to be guided. The definite part is provided.
【0010】また、第4の発明による飛しょう体誘導装
置は、複数の移動目標がいる場合で、誘導対象の移動目
標が上記目標照合確定部で得た上記移動目標の存在範囲
を逸脱した場合に、上記航法計算部で得た複数の上記移
動目標の位置・速度情報であるそれぞれの緯度・経度・
高度・緯度方向速度・経度方向速度・高度方向速度が入
力され、上記目標照合確定部で得た確定した誘導対象の
移動目標の位置・速度情報である緯度・経度・高度・緯
度方向速度・経度方向速度・高度方向速度が入力され、
誘導対象の移動目標を見失った時点から現時点までの誘
導対象の移動目標の位置・速度情報である予測緯度・予
測経度・予測高度・予測緯度方向速度・予測経度方向速
度・予測高度方向速度を算出し、複数の移動目標の位置
・速度情報であるそれぞれの緯度・経度・高度・緯度方
向速度・経度方向速度・高度方向速度と、誘導対象の移
動目標の位置・速度情報である予測緯度・予測経度・予
測高度・予測緯度方向速度・予測経度方向速度・予測高
度方向速度の差分を取り、差分を越えない範囲を誘導対
象の移動目標の存在範囲とする誘導対象目標存在範囲計
算部を設けたものである。Further, in the flying body guiding apparatus according to the fourth aspect of the invention, when there are a plurality of moving targets, and the moving target to be guided deviates from the existence range of the moving target obtained by the target collation confirming unit. In addition, the latitude / longitude /
The altitude / latitude direction speed / longitude direction speed / altitude direction speed is input, and the latitude / longitude / altitude / latitude direction speed / longitude, which is the position / speed information of the movement target of the confirmed guidance target obtained in the above-described target matching confirmation unit. Direction speed and altitude Direction speed is entered,
Calculate the predicted latitude, predicted longitude, predicted altitude, predicted latitude direction speed, predicted longitude direction speed, predicted altitude direction speed, which is the position and speed information of the guided target moving target from the time when the target moving target is lost However, the latitude / longitude / altitude / latitude / latitude / velocity / longitude / altitude direction speeds, which are the position / speed information of multiple moving targets, and the predicted latitude / prediction, which is the position / speed information of the moving target to be guided. A guidance target target existence range calculation unit is provided that takes the difference of longitude, predicted altitude, predicted latitude direction speed, predicted longitude direction speed, predicted altitude direction speed, and sets the range that does not exceed the difference as the existence range of the movement target of the guidance target. It is a thing.
【0011】また、第5の発明による飛しょう体誘導装
置は、移動目標との相対距離が短距離の場合で、移動目
標から妨害を受けて移動目標を見失った場合に、上記航
法計算部で得た上記飛しょう体の位置・速度情報である
緯度・経度・高度・緯度方向速度・経度方向速度・高度
方向速度・垂直方向姿勢角・水平方向姿勢角が入力さ
れ、上記追尾計算部で得た上記移動目標の追尾情報であ
る相対速度・相対距離が入力され、移動目標の位置・速
度情報である予測緯度・予測経度・予測高度・予測緯度
方向速度・予測経度方向速度・予測高度方向速度を算出
し、移動目標の追尾情報である予測相対速度・予測角度
・予測相対距離を算出する目標予測計算部を設けたもの
である。Further, in the flying body guiding apparatus according to the fifth aspect of the present invention, when the relative distance from the moving target is short and the moving target is lost due to interference from the moving target, Latitude / longitude / altitude / latitude direction velocity / longitude direction velocity / altitude direction velocity / vertical posture angle / horizontal posture angle, which are the obtained position / velocity information of the above-mentioned flying object, are input, and obtained by the tracking calculation unit. The relative speed / relative distance that is the tracking information of the moving target is input, and the predicted latitude / predicted longitude / predicted altitude / predicted latitude direction speed / predicted longitude direction speed / predicted altitude direction speed that is the position / speed information of the moving target. And a target prediction calculation unit for calculating the predicted relative speed, the predicted angle, and the predicted relative distance, which are the tracking information of the moving target.
【0012】[0012]
【発明の実施の形態】実施の形態1.図1はこの発明の
実施の形態1を示す構成図であり、図において1〜6は
上記飛しょう体誘導装置と全く同一のものである。8は
目標存在範囲計算部で、この発明による飛しょう体誘導
装置は上記1〜6及び8で構成される。BEST MODE FOR CARRYING OUT THE INVENTION Embodiment 1. 1 is a block diagram showing a first embodiment of the present invention. In the figure, 1 to 6 are exactly the same as the above-mentioned flying body guiding device. Reference numeral 8 denotes a target existence range calculation unit, and the flying body guiding apparatus according to the present invention is composed of the above 1 to 6 and 8.
【0013】また、図6、図7、図8、図9、図10、
図11はこの発明の実施の形態1の処理手順を示すフロ
ーチャートである。以下に図6、図7、図8、図9、図
10、図11における処理手順を述べる。図6に示され
るように上記母機1において、移動目標を母機1に搭載
されているレーダ装置で検出する処理手順13を行い、
検出した移動目標の位置・速度情報である初期緯度・初
期経度・初期高度・緯度方向初期速度・経度方向初期速
度・高度方向初期速度を算出する処理手順14を行い、
母機の位置・速度情報である緯度・経度・高度・緯度方
向速度・経度方向速度・高度方向速度を算出する処理手
順15行う。Further, FIG. 6, FIG. 7, FIG. 8, FIG. 9, FIG.
FIG. 11 is a flowchart showing the processing procedure according to the first embodiment of the present invention. The processing procedure in FIGS. 6, 7, 8, 9, 10, and 11 will be described below. As shown in FIG. 6, in the mother machine 1, the processing procedure 13 for detecting the moving target by the radar device mounted on the mother machine 1 is performed,
The processing procedure 14 for calculating the initial latitude, initial longitude, initial altitude, latitude direction initial speed, longitude direction initial speed, and altitude direction initial speed, which are the position and speed information of the detected moving target, is performed.
The processing procedure 15 for calculating the latitude / longitude / altitude / latitude direction speed / longitude direction speed / altitude direction speed which is the position / speed information of the mother machine is performed.
【0014】次に、図7に示されるように上記航法計算
部2において、上記処理手順14で算出された移動目標
の位置・速度情報である初期緯度・初期経度・初期高度
・緯度方向初期速度・経度方向初期速度・高度方向初期
速度と、上記処理手順15で算出された母機の位置・速
度情報である緯度・経度・高度・緯度方向速度・経度方
向速度・高度方向速度の入力処理手順16を行い、飛し
ょう体が母機から分離したかどうかを判定する処理手順
17を行い、飛しょう体が母機から分離した時点から、
移動目標の位置・速度情報である緯度・経度・高度・緯
度方向速度・経度方向速度・高度方向速度を算出する処
理手順18を行い、飛しょう体の位置・速度情報である
緯度PMNS・経度PMEW・高度PMH・緯度方向速度VMNS
・経度方向速度VMEW・高度方向速度VMH・垂直方向姿
勢角AP・水平方向姿勢角AYを算出する処理手順19を
行い、移動目標が捜索可能な相対位置かどうかの判定を
する処理手順20を行い、移動目標が捜索可能な相対位
置でない場合に、上記処理手順18、19を捜索可能に
なるまで行う。Next, as shown in FIG. 7, in the navigation calculation unit 2, the initial latitude / initial longitude / initial altitude / latitude direction initial speed which is the position / speed information of the moving target calculated in the processing procedure 14・ Longitudinal direction initial velocity / altitude direction initial velocity and input process sequence 16 of latitude / longitude / altitude / latitude direction velocity / longitude direction velocity / altitude direction velocity which is the position / speed information of the mother machine calculated in the above-mentioned processing procedure 15 Then, the procedure 17 for determining whether or not the flying object is separated from the mother aircraft is performed. From the time when the flying object is separated from the mother aircraft,
The processing procedure 18 for calculating the latitude / longitude / altitude / latitude direction velocity / longitude direction velocity / altitude direction velocity which is the position / speed information of the moving target is performed, and the latitude PMNS / longitude PMEW which is the position / speed information of the flying object.・ Altitude PMH ・ Latitude direction speed VMNS
・ Longitudinal direction velocity VMEW ・ Altitude direction velocity VMH ・ Vertical posture angle AP ・ Horizontal posture angle AY is calculated, and process step 20 is performed to determine whether the moving target is a searchable relative position. If the moving target is not in the searchable relative position, the above processing steps 18 and 19 are performed until the search becomes possible.
【0015】次に、図8に示されるように上記捜索処理
部3において、上記処理手順20で捜索可能な相対位置
になった場合に、上記処理手順18で算出された移動目
標の位置・速度情報である緯度・経度・高度・緯度方向
速度・経度方向速度・高度方向速度と、上記処理手順1
9で算出された飛しょう体の位置・速度情報である緯度
PMNS・経度PMEW・高度PMH・緯度方向速度VMNS・経
度方向速度VMEW・高度方向速度VMHの入力処理手順2
1を行い、移動目標の位置・速度情報である緯度・経度
・高度・緯度方向速度・経度方向速度・高度方向速度
と、飛しょう体の位置・速度情報である緯度PMNS・経
度PMEW・高度PMH・緯度方向速度VMNS・経度方向速度
VMEW・高度方向速度VMHから移動目標の捜索処理をす
る処理手順22を行い、移動目標の捜索が完了したかど
うかの判定をする処理手順23を行い、捜索を完了した
場合に、捜索を完了した時点での移動目標の追尾情報で
ある初期相対速度・初期角度・初期相対距離を算出する
処理手順24を行う。Next, as shown in FIG. 8, in the search processing section 3, when the relative position becomes a searchable position in the processing procedure 20, the position / speed of the moving target calculated in the processing procedure 18 is calculated. Latitude / longitude / altitude / latitude direction velocity / longitude direction velocity / altitude direction velocity, which is information, and the above processing procedure 1
Input processing procedure 2 of latitude PMNS, longitude PMEW, altitude PMH, latitude direction speed VMNS, longitude direction speed VMEW, altitude direction speed VMH which is the position / speed information of the flying object calculated in 9.
1 is performed and the position / speed information of the moving target is latitude / longitude / altitude / latitude direction speed / longitude direction speed / altitude direction speed, and the position / speed information of the flying object is latitude PMNS / longitude PMEW / altitude PMH.・ The processing procedure 22 for searching the moving target from the latitude direction speed VMNS, the longitude direction speed VMEW, and the altitude direction speed VMH is performed, and the processing procedure 23 for determining whether or not the moving target search is completed is performed, and the search is performed. When the search is completed, the processing procedure 24 for calculating the initial relative velocity / initial angle / initial relative distance, which is the tracking information of the moving target at the time when the search is completed, is performed.
【0016】次に、図9に示されるように上記追尾計算
部4において、上記処理手順24で算出された移動目標
の追尾情報である初期相対速度・初期角度・初期相対距
離の入力処理手順25を行い、上記処理手順23で捜索
が完了した時点から、移動目標の追尾情報である相対速
度V・角度・相対距離Rを算出する処理手順26を行
い、移動目標の追尾情報である相対速度V・角度・相対
距離Rから、移動目標への誘導情報を算出する処理手順
27を行い、移動目標を見失ったかどうかの判定をする
処理手順28を行う。Next, as shown in FIG. 9, in the tracking calculation unit 4, the input processing procedure 25 of the initial relative velocity / initial angle / initial relative distance which is the tracking information of the moving target calculated in the processing procedure 24. Then, from the time when the search is completed in the processing procedure 23, the processing procedure 26 for calculating the relative velocity V, the angle, and the relative distance R which are the tracking information of the moving target is performed, and the relative velocity V which is the tracking information of the moving target is performed. A processing procedure 27 for calculating guide information to the moving target from the angle / relative distance R is performed, and a processing procedure 28 for determining whether or not the moving target is lost.
【0017】次に、図10に示されるように上記操舵部
5において、上記処理手順27で算出された移動目標へ
の誘導情報の入力処理手順29を行い、移動目標への誘
導情報をもとに舵角制御をする処理手順30を行う。Next, as shown in FIG. 10, in the steering section 5, an input processing procedure 29 for inputting guidance information to the moving target calculated in the processing procedure 27 is performed, and based on the guidance information to the moving target. The processing procedure 30 for controlling the steering angle is performed.
【0018】次に、図11に示されるように上記目標存
在範囲計算部8において、上記処理手順19で算出され
た飛しょう体の位置・速度情報である緯度PMNS・経度
PMEW・高度PMH・緯度方向速度VMNS・経度方向速度V
MEW・高度方向速度VMH・垂直方向姿勢角AP・水平方向
姿勢角AYの入力処理手順31を行い、上記処理手順2
6で算出された移動目標の追尾情報である相対速度V・
相対距離Rの入力処理手順32を行い、飛しょう体の位
置・速度情報である緯度PMNS・経度PMEW・高度PMH・
緯度方向速度VMNS・経度方向速度VMEW・高度方向速度
VMH・垂直方向姿勢角AP・水平方向姿勢角AYと、移動
目標の追尾情報である相対速度V・相対距離Rから、移
動目標の位置・速度情報である緯度PTNS・経度PTEW・
高度PTH・緯度方向速度VTNS・経度方向速度VTEW・高
度方向速度VTHをそれぞれ“数1”、“数2”、“数
3”、“数4”、“数5”、“数6”で逆算する処理手
順33を行い、上記処理手順28で移動目標を見失った
と判定した場合に、逆算した移動目標の位置情報である
緯度PTNS・経度PTEW・高度PTHから移動目標の存在範
囲(PTNS±固定値、PTEW±固定値、PTH±固定値)を
算出する処理手順34を行う。上記処理手順13〜34
を行うことにより、移動目標を見失った場合に、移動目
標を捜索する範囲を限定することができるので、見失っ
た移動目標を短時間で再発見することができて、移動目
標に向かって飛しょう体を誘導することができる。Next, as shown in FIG. 11, in the target existence range calculation unit 8, the latitude PMNS, the longitude PMEW, the altitude PMH, and the latitude, which are the position and speed information of the flying object calculated in the processing procedure 19, are described. Directional speed VMNS / longitude directional speed V
MEW / Velocity in altitude direction VMH / Vertical attitude angle AP / Horizontal attitude angle AY
Relative velocity V · which is the tracking information of the moving target calculated in 6
The relative distance R input processing procedure 32 is performed, and the position / speed information of the flying object is latitude PMNS / longitude PMEW / altitude PMH /
Latitude direction speed VMNS, longitude direction speed VMEW, altitude direction speed VMH, vertical attitude angle AP, horizontal attitude angle AY, and relative speed V and relative distance R, which are tracking information of the moving target, from the position and speed of the moving target. Latitude PTNS, longitude PTEW, which is information
Back calculation of altitude PTH / latitude direction speed VTNS / longitude direction speed VTEW / altitude direction speed VTH by “number 1”, “number 2”, “number 3”, “number 4”, “number 5” and “number 6”, respectively. If it is determined in step 28 that the moving target is lost, the range of existence of the moving target (PTNS ± fixed value) is calculated from the latitude information PTNS / longitude PTEW / altitude PTH which is the position information of the moving target calculated backward. , PTEW ± fixed value, PTH ± fixed value) is performed. The above processing procedures 13 to 34
By doing, you can limit the search range of the moving target when you lose sight of the moving target, so you can rediscover the lost moving target in a short time and fly towards the moving target. Can guide the body.
【0019】[0019]
【数1】 [Equation 1]
【0020】[0020]
【数2】 [Equation 2]
【0021】[0021]
【数3】 [Equation 3]
【0022】[0022]
【数4】 [Equation 4]
【0023】[0023]
【数5】 [Equation 5]
【0024】[0024]
【数6】 [Equation 6]
【0025】実施の形態2.図2はこの発明の実施の形
態2を示す構成図であり、図において1〜6は上記飛し
ょう体誘導装置と全く同一のものである。また8は上記
実施の形態1で記載されている装置と全く同一のもので
ある。9は移動成分計算部で、この発明による飛しょう
体誘導装置は上記1〜6及び8、9で構成される。Embodiment 2. 2 is a block diagram showing a second embodiment of the present invention. In the figure, 1 to 6 are exactly the same as the above-mentioned flying body guiding device. Further, 8 is exactly the same as the device described in the first embodiment. Reference numeral 9 denotes a moving component calculator, and the flying body guiding device according to the present invention is composed of the above 1 to 6 and 8 and 9.
【0026】また、図12はこの発明の実施の形態2の
処理手順を示すフローチャートである。以下に図12に
おける処理手順を述べる。上記実施の形態1と同様に図
6に示されるように上記母機1において、移動目標を母
機1に搭載されているレーダ装置で検出する処理手順1
3を行い、検出した移動目標の位置・速度情報である初
期緯度・初期経度・初期高度・緯度方向初期速度・経度
方向初期速度・高度方向初期速度を算出する処理手順1
4を行い、母機の位置・速度情報である緯度・経度・高
度・緯度方向速度・経度方向速度・高度方向速度を算出
する処理手順15行う。FIG. 12 is a flow chart showing the processing procedure of the second embodiment of the present invention. The processing procedure in FIG. 12 will be described below. As in the first embodiment, as shown in FIG. 6, in the mother machine 1, the processing procedure 1 for detecting the moving target by the radar device mounted in the mother machine 1.
3. Procedure 3 for calculating initial position, initial longitude, initial altitude, latitude direction initial speed, longitude direction initial speed, and altitude direction initial speed, which are position and speed information of the detected moving target.
4 is performed, and the processing procedure 15 for calculating the latitude / longitude / altitude / latitude direction velocity / longitude direction velocity / altitude direction velocity, which is the position / speed information of the mother machine, is performed.
【0027】次に、上記実施の形態1と同様に図7に示
されるように上記航法計算部2において、上記処理手順
14で算出された移動目標の位置・速度情報である初期
緯度・初期経度・初期高度・緯度方向初期速度・経度方
向初期速度・高度方向初期速度と、上記処理手順15で
算出された母機の位置・速度情報である緯度・経度・高
度・緯度方向速度・経度方向速度・高度方向速度の入力
処理手順16を行い、飛しょう体が母機から分離したか
どうかを判定する処理手順17を行い、飛しょう体が母
機から分離した時点から、移動目標の位置・速度情報で
ある緯度・経度・高度・緯度方向速度・経度方向速度・
高度方向速度を算出する処理手順18を行い、飛しょう
体の位置・速度情報である緯度PMNS・経度PMEW・高度
PMH・緯度方向速度VMNS・経度方向速度VMEW・高度方
向速度VMH・垂直方向姿勢角AP・水平方向姿勢角AYを
算出する処理手順19を行い、移動目標が捜索可能な相
対位置かどうかの判定をする処理手順20を行い、移動
目標が捜索可能な相対位置でない場合に、上記処理手順
18、19を捜索可能になるまで行う。Next, as in the first embodiment, as shown in FIG. 7, in the navigation calculation unit 2, the initial latitude / initial longitude which is the position / speed information of the moving target calculated in the processing procedure 14 is calculated.・ Initial altitude / latitude direction initial velocity / longitude direction initial velocity / altitude direction initial velocity and latitude / longitude / altitude / latitude direction velocity / longitude direction velocity, which is the position / velocity information of the mother machine calculated in the above processing procedure 15. The altitude direction velocity input processing procedure 16 is performed, and the processing procedure 17 for determining whether or not the flying body is separated from the mother aircraft is performed. From the time when the flying body is separated from the mother aircraft, the position / velocity information of the moving target is obtained. Latitude / longitude / altitude / latitude direction speed / longitude direction speed
The processing procedure 18 for calculating the altitude direction speed is performed, and the position / speed information of the flying object is latitude PMNS / longitude PMEW / altitude PMH / latitude direction speed VMNS / longitude direction speed VMEW / altitude direction speed VMH / vertical attitude angle. The process procedure 19 for calculating the AP / horizontal posture angle AY is performed, and the process procedure 20 for determining whether the moving target is a searchable relative position is performed. If the moving target is not the searchable relative position, the above process is performed. Repeat steps 18 and 19 until it becomes searchable.
【0028】次に、上記実施の形態1と同様に図8に示
されるように上記捜索処理部3において、上記処理手順
20で捜索可能な相対位置になった場合に、上記処理手
順18で算出された移動目標の位置・速度情報である緯
度・経度・高度・緯度方向速度・経度方向速度・高度方
向速度と、上記処理手順19で算出された飛しょう体の
位置・速度情報である緯度PMNS・経度PMEW・高度PMH
・緯度方向速度VMNS・経度方向速度VMEW・高度方向速
度VMHの入力処理手順21を行い、移動目標の位置・速
度情報である緯度・経度・高度・緯度方向速度・経度方
向速度・高度方向速度と、飛しょう体の位置・速度情報
である緯度PMNS・経度PMEW・高度PMH・緯度方向速度
VMNS・経度方向速度VMEW・高度方向速度VMHから、移
動目標の捜索処理をする処理手順22を行い、移動目標
の捜索が完了したかどうかの判定をする処理手順23を
行い、捜索を完了した場合に、捜索を完了した時点での
移動目標の追尾情報である初期相対速度・初期角度・初
期相対距離を算出する処理手順24を行う。Next, as in the case of the first embodiment, as shown in FIG. 8, when the search processing section 3 has reached the relative position where the search can be performed in the processing procedure 20, the calculation is performed in the processing procedure 18. Latitude / longitude / altitude / latitude direction velocity / longitude direction velocity / altitude direction velocity which is the position / velocity information of the moved target, and latitude PMNS which is the position / velocity information of the flying object calculated in the above processing procedure 19.・ Longitude PMEW ・ Altitude PMH
・ Latitude-direction velocity VMNS ・ Longitude-direction velocity VMEW ・ Altitude-direction velocity VMH are input, and the procedure 21 is executed, and the position / velocity information of the moving target is latitude / longitude / altitude / latitude direction velocity / longitude direction velocity / altitude direction velocity. , The position / speed information of the flying object is latitude PMNS / longitude PMEW / altitude PMH / latitude direction speed VMNS / longitude direction speed VMEW / altitude direction speed VMH. When the search for the target is completed, the processing procedure 23 is performed. When the search is completed, the initial relative velocity, the initial angle, and the initial relative distance, which are the tracking information of the moving target at the time of completing the search, are calculated. The processing procedure 24 for calculating is performed.
【0029】次に、上記実施の形態1と同様に図9に示
されるように上記追尾計算部4において、上記処理手順
24で算出された移動目標の追尾情報である初期相対速
度・初期角度・初期相対距離の入力処理手順25を行
い、上記処理手順23で捜索が完了した時点から、移動
目標の追尾情報である相対速度V・角度・相対距離Rを
算出する処理手順26を行い、移動目標の追尾情報であ
る相対速度V・角度・相対距離Rから、移動目標への誘
導情報を算出する処理手順27を行い、移動目標を見失
ったかどうかの判定をする処理手順28を行う。Next, as in the first embodiment, as shown in FIG. 9, in the tracking calculation unit 4, the initial relative velocity, the initial angle, which is the tracking information of the moving target calculated in the processing procedure 24, is calculated. An initial relative distance input processing procedure 25 is performed, and from the time when the search is completed in the above processing procedure 23, a processing procedure 26 of calculating the relative velocity V / angle / relative distance R, which is the tracking information of the moving target, is performed to determine the moving target. The procedure 27 for calculating the guidance information to the moving target is performed from the relative velocity V, the angle, and the relative distance R, which are the tracking information, and the procedure 28 for determining whether or not the moving target is lost.
【0030】次に、上記実施の形態1と同様に図10に
示されるように上記操舵部5において、上記処理手順2
7で算出された移動目標への誘導情報の入力処理手順2
9を行い、移動目標への誘導情報をもとに舵角制御をす
る処理手順30を行う。Next, as in the first embodiment, as shown in FIG. 10, in the steering section 5, the processing procedure 2 is performed.
Input processing procedure 2 for guiding information to the moving target calculated in 7.
9 is performed, and the processing procedure 30 for controlling the steering angle based on the guidance information to the moving target is performed.
【0031】次に、上記実施の形態1と同様に図11に
示されるように上記目標存在範囲計算部8において、上
記処理手順19で算出された飛しょう体の位置・速度情
報である緯度PMNS・経度PMEW・高度PMH・緯度方向速
度VMNS・経度方向速度VMEW・高度方向速度VMH・垂直
方向姿勢角AP・水平方向姿勢角AYの入力処理手順31
を行い、上記処理手順26で算出された移動目標の追尾
情報である相対速度V・相対距離Rの入力処理手順32
を行い、飛しょう体の位置・速度情報である緯度PMNS
・経度PMEW・高度PMH・緯度方向速度VMNS・経度方向
速度VMEW・高度方向速度VMH・垂直方向姿勢角AP・水
平方向姿勢角AYと、移動目標の追尾情報である相対速
度V・相対距離Rから、移動目標の位置・速度情報であ
る緯度PTNS・経度PTEW・高度PTH・緯度方向速度VTN
S・経度方向速度VTEW・高度方向速度VTHをそれぞれ
“数1”、“数2”、“数3”、“数4”、“数5”、
“数6”で逆算する処理手順33を行い、上記処理手順
28で移動目標を見失ったと判定した場合に、逆算した
移動目標の位置情報である緯度PTNS・経度PTEW・高度
PTHから移動目標の存在範囲(PTNS±固定値、PTEW±
固定値、PTH±固定値)を算出する処理手順34を行
う。Next, as in the first embodiment, as shown in FIG. 11, in the target existence range calculation unit 8, the latitude PMNS which is the position / velocity information of the flying object calculated in the processing procedure 19 described above.・ Longitude PMEW ・ Altitude PMH ・ Latitude direction speed VMNS ・ Longitude direction speed VMEW ・ Altitude direction speed VMH ・ Vertical attitude angle AP ・ Horizontal attitude angle AY input processing procedure 31
And the input processing procedure 32 of the relative velocity V and the relative distance R, which is the tracking information of the moving target calculated in the above processing procedure 26.
And the latitude PMNS which is the position and speed information of the flying object.
・ Longitude PMEW ・ Altitude PMH ・ Latitude direction speed VMNS ・ Longitude direction speed VMEW ・ Altitude direction speed VMH ・ Vertical attitude angle AP ・ Horizontal attitude angle AY, and relative speed V and relative distance R that are tracking information of the moving target , Latitude PTNS / Longitude PTEW / Altitude PTH / Latitude Velocity VTN which is position / speed information of moving target
S / longitude direction velocity VTEW / altitude direction velocity VTH are respectively expressed by “number 1”, “number 2”, “number 3”, “number 4”, “number 5”,
When the processing procedure 33 for performing the backward calculation is performed by “Equation 6” and it is determined that the moving target is lost in the above processing procedure 28, the existence of the moving target from the latitude information PTNS / longitude PTEW / altitude PTH which is the position information of the backward calculated moving target. Range (PTNS ± fixed value, PTEW ±
A processing procedure 34 for calculating a fixed value, PTH ± fixed value) is performed.
【0032】次に、図12に示されるように上記移動成
分計算部9において、上記処理手順33で逆算された移
動目標の位置・速度情報である緯度PTNS・経度PTEW・
高度PTH・緯度方向速度VTNS・経度方向速度VTEW・高
度方向速度VTHと、上記処理手順34で算出された移動
目標の存在範囲の入力処理手順35を行い、移動目標が
移動目標の存在範囲を逸脱したかどうかの判定をする処
理手順36を行い、移動目標が移動目標の存在範囲を逸
脱したと判定した場合に、逆算された移動目標の位置・
速度情報である緯度PTNS・経度PTEW・高度PTH・緯度
方向速度VTNS・経度方向速度VTEW・高度方向速度VTH
と、移動目標を見失った時点から現時点までの移動時間
Tから、移動目標を見失った時点から現時点までの移動
目標の移動成分である緯度方向移動成分ΔPNS・経度方
向移動成分ΔPEW・高度方向移動成分ΔPHをそれぞれ
“数7”、“数8”、“数9”で算出する処理手順37
を行い、移動目標の存在範囲(PTNS±ΔPNS、PTEW±
ΔPEW、PTH±ΔPH)を算出する処理手順38を行
う。上記処理手順13〜38を行うことにより、移動目
標が上記目標存在範囲計算部で得た上記移動目標の存在
範囲を逸脱した場合に、移動目標を捜索する範囲を限定
することができるので、見失った移動目標を短時間で再
発見することができて、移動目標に向かって飛しょう体
を誘導することができる。Next, as shown in FIG. 12, in the moving component calculator 9, the latitude PTNS, the longitude PTEW, which is the position / velocity information of the moving target back-calculated in the processing procedure 33.
The altitude PTH, the latitude direction speed VTNS, the longitude direction speed VTEW, the altitude direction speed VTH, and the input processing procedure 35 of the moving target existence range calculated in the above processing procedure 34 are performed, and the moving target deviates from the moving target existence range. If it is determined that the moving target has deviated from the range where the moving target exists, the position of the moving target calculated backward is calculated.
Latitude PTNS, longitude PTEW, altitude PTH, latitude direction speed VTNS, longitude direction speed VTEW, altitude direction speed VTH which is speed information
And the travel time T from the time when the moving target is lost to the present time, the latitude direction moving component ΔPNS, the longitude direction moving component ΔPEW, and the altitude direction moving component, which are the moving components of the moving target from the time when the moving target is lost to the present time. Processing procedure 37 for calculating ΔPH by “Equation 7”, “Equation 8”, and “Equation 9”, respectively
The moving target existence range (PTNS ± ΔPNS, PTEW ±
The processing procedure 38 for calculating ΔPEW, PTH ± ΔPH) is performed. By performing the processing steps 13 to 38, when the moving target deviates from the existing range of the moving target obtained by the target existing range calculation unit, the range in which the moving target is searched can be limited. The moving target can be rediscovered in a short time, and the flying body can be guided toward the moving target.
【0033】[0033]
【数7】 [Equation 7]
【0034】[0034]
【数8】 [Equation 8]
【0035】[0035]
【数9】 [Equation 9]
【0036】実施の形態3.図3はこの発明の実施の形
態3を示す構成図であり、図において1〜6は上記飛し
ょう体誘導装置と全く同一のものである。また8は上記
実施の形態1で記載されている装置と全く同一のもので
ある。10は目標照合確定部で、この発明による飛しょ
う体誘導装置は上記1〜6及び8、10で構成される。Embodiment 3. 3 is a configuration diagram showing a third embodiment of the present invention, in which 1 to 6 are exactly the same as the above-mentioned flying body guiding device. Further, 8 is exactly the same as the device described in the first embodiment. Reference numeral 10 is a target collation confirming unit, and the flying body guiding device according to the present invention is composed of 1 to 6 and 8 and 10 described above.
【0037】また、図13はこの発明の実施の形態3の
処理手順を示すフローチャートである。以下に図13に
おける処理手順を述べる。上記実施の形態1と同様に図
6に示されるように上記母機1において、複数の移動目
標を母機1に搭載されているレーダ装置で検出する処理
手順13を行い、検出した複数の移動目標の位置・速度
情報である初期緯度・初期経度・初期高度・緯度方向初
期速度・経度方向初期速度・高度方向初期速度を算出す
る処理手順14を行い、母機の位置・速度情報である緯
度・経度・高度・緯度方向速度・経度方向速度・高度方
向速度を算出する処理手順15行う。FIG. 13 is a flow chart showing the processing procedure of the third embodiment of the present invention. The processing procedure in FIG. 13 will be described below. As in the first embodiment, as shown in FIG. 6, in the mother machine 1, the processing procedure 13 for detecting a plurality of moving targets by the radar device mounted in the mother machine 1 is performed, and the plurality of detected moving targets are detected. The processing procedure 14 for calculating the initial latitude / initial longitude / initial altitude / latitude direction initial speed / longitude direction initial speed / altitude direction initial speed, which is position / speed information, is performed, and the position / speed information latitude / longitude / The processing procedure 15 for calculating the altitude / latitude direction speed / longitude direction speed / altitude direction speed is performed.
【0038】次に、上記実施の形態1と同様に図7に示
されるように上記航法計算部2において、上記処理手順
14で算出された複数の移動目標の位置・速度情報であ
る初期緯度・初期経度・初期高度・緯度方向初期速度・
経度方向初期速度・高度方向初期速度と、上記処理手順
15で算出された母機の位置・速度情報である緯度・経
度・高度・緯度方向速度・経度方向速度・高度方向速度
の入力処理手順16を行い、飛しょう体が母機から分離
したかどうかを判定する処理手順17を行い、飛しょう
体が母機から分離した時点から、複数の移動目標の位置
・速度情報である緯度・経度・高度・緯度方向速度・経
度方向速度・高度方向速度を算出する処理手順18を行
い、飛しょう体の位置・速度情報である緯度PMNS・経
度PMEW・高度PMH・緯度方向速度VMNS・経度方向速度
VMEW・高度方向速度VMH・垂直方向姿勢角AP・水平方
向姿勢角AYを算出する処理手順19を行い、誘導対象
の移動目標が捜索可能な相対位置かどうかの判定をする
処理手順20を行い、誘導対象の移動目標が捜索可能な
相対位置でない場合に、上記処理手順18、19を捜索
可能になるまで行う。Next, as in the first embodiment, as shown in FIG. 7, in the navigation calculation unit 2, the initial latitude / position which is the position / speed information of the plurality of moving targets calculated in the processing procedure 14 is calculated. Initial longitude / initial altitude / latitude direction initial velocity /
The input processing procedure 16 of the longitude direction initial speed / altitude direction initial speed and the latitude / longitude / altitude / latitude direction speed / longitude direction speed / altitude direction speed which is the position / speed information of the mother machine calculated in the above processing procedure 15 is performed. Perform processing step 17 to determine whether or not the flying object is separated from the mother aircraft, and from the time when the flying object is separated from the mother aircraft, the latitude / longitude / altitude / latitude, which is the position / speed information of a plurality of moving targets. The processing procedure 18 for calculating the directional speed / longitude direction speed / altitude direction speed is performed, and the position / speed information of the flying object is latitude PMNS / longitude PMEW / altitude PMH / latitude direction speed VMNS / longitude direction VMEW / altitude direction. The processing procedure 19 for calculating the velocity VMH, the vertical posture angle AP, and the horizontal posture angle AY is performed, and the processing procedure 20 for determining whether or not the moving target of the guidance target is a searchable relative position is performed. If the movement target elephant is not a relative position that can be searched, it carried out until it can search for the procedure 18, 19.
【0039】次に、上記実施の形態1と同様に図8に示
されるように上記捜索処理部3において、上記処理手順
20で捜索可能な相対位置になった場合に、上記処理手
順18で算出した誘導対象の移動目標の位置・速度情報
である緯度・経度・高度・緯度方向速度・経度方向速度
・高度方向速度と、上記処理手順19で算出された飛し
ょう体の位置・速度情報である緯度PMNS・経度PMEW・
高度PMH・緯度方向速度VMNS・経度方向速度VMEW・高
度方向速度VMHの入力処理手順21を行い、誘導対象の
移動目標の位置・速度情報である緯度・経度・高度・緯
度方向速度・経度方向速度・高度方向速度と、飛しょう
体の位置・速度情報である緯度PMNS・経度PMEW・高度
PMH・緯度方向速度VMNS・経度方向速度VMEW・高度方
向速度VMHから、誘導対象の移動目標の捜索処理をする
処理手順22を行い、誘導対象の移動目標の捜索が完了
したかどうかの判定をする処理手順23を行い、捜索を
完了した場合に、捜索を完了した時点での誘導対象の移
動目標の追尾情報である初期相対速度・初期角度・初期
相対距離を算出する処理手順24を行う。Next, as shown in FIG. 8 in the same manner as in the first embodiment, when the search processing section 3 reaches the relative position where the search can be performed in the processing procedure 20, the calculation is performed in the processing procedure 18. It is the latitude / longitude / altitude / latitude direction velocity / longitude direction velocity / altitude direction velocity which is the position / velocity information of the moving target of the guided object, and the position / velocity information of the flying object calculated in the above processing procedure 19. Latitude PMNS / Longitude PMEW /
The input processing procedure 21 of the altitude PMH, the latitude direction speed VMNS, the longitude direction speed VMEW, and the altitude direction speed VMH is performed, and the latitude / longitude / altitude / latitude direction speed / longitude direction speed which is the position / speed information of the moving target to be guided.・ From the altitude velocity and the position / velocity information of the flying object, latitude PMNS / longitude PMEW / altitude PMH / latitude direction VMNS / longitude direction VMEW / altitude direction VMH, search processing of the moving target to be guided Performing a processing procedure 22 for determining whether or not the search of the moving target to be guided is completed, and performing a processing procedure 23 to search for the moving target to be guided at the time when the search is completed. The processing procedure 24 for calculating the initial relative velocity, the initial angle, and the initial relative distance, which are information, is performed.
【0040】次に、上記実施の形態1と同様に図9に示
されるように上記追尾計算部4において、上記処理手順
24で算出された誘導対象の移動目標の追尾情報である
初期相対速度・初期角度・初期相対距離の入力処理手順
25を行い、上記処理手順23で捜索が完了した時点か
ら、誘導対象の移動目標の追尾情報である相対速度V・
角度・相対距離Rを算出する処理手順26を行い、誘導
対象の移動目標の追尾情報である相対速度V・角度・相
対距離Rから、誘導対象の移動目標への誘導情報を算出
する処理手順27を行い、誘導対象の移動目標を見失っ
たかどうかの判定をする処理手順28を行う。Next, as in the first embodiment, as shown in FIG. 9, in the tracking calculation unit 4, the initial relative velocity, which is the tracking information of the moving target of the guidance target calculated in the processing procedure 24, After the initial angle / initial relative distance input processing procedure 25 is performed and the search is completed in the processing procedure 23, the relative velocity V, which is the tracking information of the moving target of the guidance target,
The processing procedure 26 for calculating the angle / relative distance R is performed, and the processing procedure 27 for calculating the guidance information to the movement target of the guidance target from the relative speed V / angle / relative distance R which is the tracking information of the movement target of the guidance target. Then, a processing procedure 28 for determining whether or not the movement target of the guidance target is lost is performed.
【0041】次に、上記実施の形態1と同様に図10に
示されるように上記操舵部5において、上記処理手順2
7で算出された誘導対象の移動目標への誘導情報の入力
処理手順29を行い、誘導対象の移動目標への誘導情報
をもとに舵角制御をする処理手順30を行う。Next, as in the first embodiment, as shown in FIG. 10, in the steering section 5, the processing procedure 2 is performed.
The procedure 29 of inputting the guidance information to the moving target of the guidance target calculated in 7 is performed, and the processing procedure 30 of controlling the steering angle based on the guidance information to the moving target of the guidance target is performed.
【0042】次に、上記実施の形態1と同様に図11に
示されるように上記目標存在範囲計算部8において、上
記処理手順19で算出された飛しょう体の位置・速度情
報である緯度PMNS・経度PMEW・高度PMH・緯度方向速
度VMNS・経度方向速度VMEW・高度方向速度VMH・垂直
方向姿勢角AP・水平方向姿勢角AYの入力処理手順31
を行い、上記処理手順26で算出された誘導対象の移動
目標の追尾情報である相対速度V・相対距離Rの入力処
理手順32を行い、飛しょう体の位置・速度情報である
緯度PMNS・経度PMEW・高度PMH・緯度方向速度VMNS
・経度方向速度VMEW・高度方向速度VMH・垂直方向姿
勢角AP・水平方向姿勢角AYと、誘導対象の移動目標の
追尾情報である相対速度V・相対距離Rから、誘導対象
の移動目標の位置・速度情報である緯度PTNS・経度PT
EW・高度PTH・緯度方向速度VTNS・経度方向速度VTEW
・高度方向速度VTHをそれぞれ“数1”、“数2”、
“数3”、“数4”、“数5”、“数6”で逆算する処
理手順33を行い、上記処理手順28で誘導対象の移動
目標を見失ったと判定した場合に、逆算した誘導対象の
移動目標の位置情報である緯度PTNS・経度PTEW・高度
PTHから誘導対象の移動目標の存在範囲(PTNS±固定
値、PTEW±固定値、PTH±固定値)を算出する処理手
順34を行う。Next, as in the first embodiment, as shown in FIG. 11, in the target existence range calculation unit 8, the latitude PMNS which is the position / velocity information of the flying object calculated in the processing procedure 19 described above.・ Longitude PMEW ・ Altitude PMH ・ Latitude direction speed VMNS ・ Longitude direction speed VMEW ・ Altitude direction speed VMH ・ Vertical attitude angle AP ・ Horizontal attitude angle AY input processing procedure 31
Then, the input processing procedure 32 of the relative velocity V and the relative distance R, which are the tracking information of the moving target of the guidance target calculated in the processing procedure 26, is performed, and the latitude PMNS and the longitude, which are the position and velocity information of the flying object. PMEW, altitude PMH, latitudinal velocity VMNS
-Longitudinal speed VMEW-Altitude-direction speed VMH-Vertical attitude angle AP-Horizontal attitude angle AY, and relative speed V and relative distance R that are tracking information of the moving target of the guidance target, from the position of the moving target of the guidance target・ Latitude PTNS and longitude PT which are speed information
EW / Altitude PTH / Latitude Velocity VTNS / Longitude VTEW
・ Altitude velocity VTH is calculated by "number 1", "number 2",
When the processing procedure 33 for back-calculating with “Equation 3”, “Equation 4”, “Equation 5”, and “Equation 6” is performed, and when it is determined that the moving target of the guidance target has been lost in the above-mentioned processing procedure 28, the guidance object calculated backward is calculated. The procedure 34 for calculating the existence range (PTNS ± fixed value, PTEW ± fixed value, PTH ± fixed value) of the moving target to be guided from the latitude PTNS / longitude PTEW / altitude PTH, which is the position information of the moving target of FIG.
【0043】次に、図13に示されるように目標照合確
定部10において、上記処理手順18で算出した複数の
移動目標の位置・速度情報である緯度・経度・高度・緯
度方向速度・経度方向速度・高度方向速度の入力処理手
順39を行い、上記処理手順33で逆算した誘導対象の
移動目標の位置・速度情報である緯度PTNS・経度PTEW
・高度PTH・緯度方向速度VTNS・経度方向速度VTEW・
高度方向速度VTHの入力処理手順40を行い、上記処理
手順28で誘導対象の移動目標を見失ったと判定した場
合に、複数の移動目標の位置・速度情報である緯度・経
度・高度・緯度方向速度・経度方向速度・高度方向速度
と、逆算した誘導対象の移動目標の位置・速度情報であ
る緯度PTNS・経度PTEW・高度PTH・緯度方向速度VTN
S・経度方向速度VTEW・高度方向速度VTHの差分を取
り、複数の移動目標の中でどの目標が1番差分が少ない
か照合する処理手順41を行い、1番差分が少ない移動
目標の位置・速度情報である緯度・経度・高度・緯度方
向速度・経度方向速度・高度方向速度と、逆算した誘導
対象の移動目標の位置・速度情報である緯度PTNS・経
度PTEW・高度PTH・緯度方向速度VTNS・経度方向速度
VTEW・高度方向速度VTHの平均値を取って、誘導対象
の移動目標の位置・速度情報である緯度・経度・高度・
緯度方向速度・経度方向速度・高度方向速度として確定
する処理手順42を行い、2番目に差分が少ない移動目
標の位置・速度情報である緯度・経度・高度・緯度方向
速度・経度方向速度・高度方向速度と、確定した誘導対
象の移動目標の位置・速度情報である緯度・経度・高度
・緯度方向速度・経度方向速度・高度方向速度の差分を
取り、差分を越えない範囲を誘導対象の移動目標の存在
範囲とする処理手順43を行う。上記処理手順13〜3
4及び39〜43を行うことにより、誘導対象の移動目
標を見失った場合に、誘導対象の移動目標を捜索する範
囲を限定することができるので、複数の移動目標があっ
たとしても、見失った誘導対象の移動目標を短時間で再
発見することができて、誘導対象の移動目標に向かって
飛しょう体を誘導することができる。Next, as shown in FIG. 13, in the target collation confirming section 10, the latitude / longitude / altitude / latitude direction latitude / longitude direction which is the position / velocity information of the plurality of moving targets calculated in the above processing procedure 18. Velocity / Altitude Direction Velocity input processing procedure 39 is performed, and latitude PTNS / longitude PTEW, which is position / speed information of the moving target of the guidance target, which is calculated back in the processing procedure 33.
・ Altitude PTH ・ Latitude direction speed VTNS ・ Longitude direction speed VTEW ・
When the input processing procedure 40 of the altitude direction velocity VTH is performed and it is determined in the processing procedure 28 that the moving target to be guided is lost, the latitude / longitude / altitude / latitude direction velocity which is the position / speed information of the plurality of moving targets.・ Latitude PTNS / Longitude PTEW / Altitude PTH / Latitude directional VTN
The processing procedure 41 is performed in which the difference between S, the longitude direction velocity VTEW, and the altitude direction velocity VTH is taken, and which of the plurality of moving targets has the smallest difference. Latitude / longitude / altitude / latitude direction speed / longitude direction speed / altitude direction speed which is speed information, and the position / speed information of the moving target of the guidance object that has been calculated backward: latitude PTNS / longitude PTEW / altitude PTH / latitude direction speed VTNS・ The average value of the longitudinal direction velocity VTEW and the altitude direction velocity VTH is taken, and the position / velocity information of the moving target to be guided is the latitude / longitude / altitude.
The processing procedure 42 for determining the latitude direction velocity, longitude direction velocity, and altitude direction velocity is performed, and the position / velocity information of the moving target having the second smallest difference is the latitude / longitude / altitude / latitude direction velocity / longitude direction velocity / altitude. Directional speed and the determined target movement position / velocity information of latitude / longitude / altitude / latitude direction velocity / longitude direction velocity / altitude direction velocity are calculated, and the movement of the guidance target is within the range The processing procedure 43 for setting the target existence range is performed. The above processing procedures 13 to 3
By performing steps 4 and 39 to 43, it is possible to limit the range in which the moving target to be guided is searched when the moving target to be guided is lost, so even if there are multiple moving targets, they are lost. The moving target to be guided can be rediscovered in a short time, and the flying object can be guided toward the moving target to be guided.
【0044】実施の形態4.図4はこの発明の実施の形
態4を示す構成図であり、図において1〜6は上記飛し
ょう体誘導装置と全く同一のものである。また8は上記
実施の形態1で記載されている装置と全く同一のもので
ある。また10は上記実施の形態3で記載されている装
置と全く同一のものである。11は誘導対象目標存在範
囲計算部で、この発明による飛しょう体誘導装置は上記
1〜6及び8、10、11で構成される。Fourth Embodiment 4 is a block diagram showing a fourth embodiment of the present invention. In the figure, 1 to 6 are exactly the same as the above-mentioned flying body guiding device. Further, 8 is exactly the same as the device described in the first embodiment. Further, 10 is exactly the same as the device described in the third embodiment. Reference numeral 11 denotes a guidance target target existence range calculation unit, and the flying body guidance device according to the present invention is composed of the above 1 to 6 and 8, 10 and 11.
【0045】また、図14はこの発明の実施の形態4の
処理手順を示すフローチャートである。以下に図14に
おける処理手順を述べる。上記実施の形態1と同様に図
6に示されるように上記母機1において、複数の移動目
標を母機1に搭載されているレーダ装置で検出する処理
手順13を行い、検出した複数の移動目標の位置・速度
情報である初期緯度・初期経度・初期高度・緯度方向初
期速度・経度方向初期速度・高度方向初期速度を算出す
る処理手順14を行い、母機の位置・速度情報である緯
度・経度・高度・緯度方向速度・経度方向速度・高度方
向速度を算出する処理手順15行う。FIG. 14 is a flow chart showing the processing procedure of the fourth embodiment of the present invention. The processing procedure in FIG. 14 will be described below. As in the first embodiment, as shown in FIG. 6, in the mother machine 1, the processing procedure 13 for detecting a plurality of moving targets by the radar device mounted in the mother machine 1 is performed, and the plurality of detected moving targets are detected. The processing procedure 14 for calculating the initial latitude / initial longitude / initial altitude / latitude direction initial speed / longitude direction initial speed / altitude direction initial speed, which is position / speed information, is performed, and the position / speed information latitude / longitude / The processing procedure 15 for calculating the altitude / latitude direction speed / longitude direction speed / altitude direction speed is performed.
【0046】次に、上記実施の形態1と同様に図7に示
されるように上記航法計算部2において、上記処理手順
14で算出された複数の移動目標の位置・速度情報であ
る初期緯度・初期経度・初期高度・緯度方向初期速度・
経度方向初期速度・高度方向初期速度と、上記処理手順
15で算出された母機の位置・速度情報である緯度・経
度・高度・緯度方向速度・経度方向速度・高度方向速度
の入力処理手順16を行い、飛しょう体が母機から分離
したかどうかを判定する処理手順17を行い、飛しょう
体が母機から分離した時点から、複数の移動目標の位置
・速度情報である緯度・経度・高度・緯度方向速度・経
度方向速度・高度方向速度を算出する処理手順18を行
い、飛しょう体の位置・速度情報である緯度PMNS・経
度PMEW・高度PMH・緯度方向速度VMNS・経度方向速度
VMEW・高度方向速度VMH・垂直方向姿勢角AP・水平方
向姿勢角AYを算出する処理手順19を行い、誘導対象
の移動目標が捜索可能な相対位置かどうかの判定をする
処理手順20を行い、誘導対象の移動目標が捜索可能な
相対位置でない場合に、上記処理手順18、19を捜索
可能になるまで行う。Next, as in the first embodiment, as shown in FIG. 7, in the navigation calculation unit 2, the initial latitude / position which is the position / speed information of the plurality of moving targets calculated in the processing procedure 14 is calculated. Initial longitude / initial altitude / latitude direction initial velocity /
The input processing procedure 16 of the longitude direction initial speed / altitude direction initial speed and the latitude / longitude / altitude / latitude direction speed / longitude direction speed / altitude direction speed which is the position / speed information of the mother machine calculated in the above processing procedure 15 is performed. Perform processing step 17 to determine whether or not the flying object is separated from the mother aircraft, and from the time when the flying object is separated from the mother aircraft, the latitude / longitude / altitude / latitude, which is the position / speed information of a plurality of moving targets. The processing procedure 18 for calculating the directional speed / longitude direction speed / altitude direction speed is performed, and the position / speed information of the flying object is latitude PMNS / longitude PMEW / altitude PMH / latitude direction speed VMNS / longitude direction VMEW / altitude direction. The processing procedure 19 for calculating the velocity VMH, the vertical posture angle AP, and the horizontal posture angle AY is performed, and the processing procedure 20 for determining whether or not the moving target of the guidance target is a searchable relative position is performed. If the movement target elephant is not a relative position that can be searched, it carried out until it can search for the procedure 18, 19.
【0047】次に、上記実施の形態1と同様に図8に示
されるように上記捜索処理部3において、上記処理手順
20で捜索可能な相対位置になった場合に、上記処理手
順18で算出した誘導対象の移動目標の位置・速度情報
である緯度・経度・高度・緯度方向速度・経度方向速度
・高度方向速度と、上記処理手順19で算出された飛し
ょう体の位置・速度情報である緯度PMNS・経度PMEW・
高度PMH・緯度方向速度VMNS・経度方向速度VMEW・高
度方向速度VMHの入力処理手順21を行い、誘導対象の
移動目標の位置・速度情報である緯度・経度・高度・緯
度方向速度・経度方向速度・高度方向速度と、飛しょう
体の位置・速度情報である緯度PMNS・経度PMEW・高度
PMH・緯度方向速度VMNS・経度方向速度VMEW・高度方
向速度VMHから、誘導対象の移動目標の捜索処理をする
処理手順22を行い、誘導対象の移動目標の捜索が完了
したかどうかの判定をする処理手順23を行い、捜索を
完了した場合に、捜索を完了した時点での誘導対象の移
動目標の追尾情報である初期相対速度・初期角度・初期
相対距離を算出する処理手順24を行う。Next, as shown in FIG. 8 in the same manner as in the first embodiment, when the search processing section 3 reaches the relative position where the search can be performed in the processing procedure 20, the calculation is performed in the processing procedure 18. It is the latitude / longitude / altitude / latitude direction velocity / longitude direction velocity / altitude direction velocity which is the position / velocity information of the moving target of the guided object, and the position / velocity information of the flying object calculated in the above processing procedure 19. Latitude PMNS / Longitude PMEW /
The input processing procedure 21 of the altitude PMH, the latitude direction speed VMNS, the longitude direction speed VMEW, and the altitude direction speed VMH is performed, and the latitude / longitude / altitude / latitude direction speed / longitude direction speed which is the position / speed information of the moving target to be guided.・ From the altitude velocity and the position / velocity information of the flying object, latitude PMNS / longitude PMEW / altitude PMH / latitude direction VMNS / longitude direction VMEW / altitude direction VMH, search processing of the moving target to be guided Performing a processing procedure 22 for determining whether or not the search of the moving target to be guided is completed, and performing a processing procedure 23 to search for the moving target to be guided at the time when the search is completed. The processing procedure 24 for calculating the initial relative velocity, the initial angle, and the initial relative distance, which are information, is performed.
【0048】次に、上記実施の形態1と同様に図9に示
されるように上記追尾計算部4において、上記処理手順
24で算出された誘導対象の移動目標の追尾情報である
初期相対速度・初期角度・初期相対距離の入力処理手順
25を行い、上記処理手順23で捜索が完了した時点か
ら、誘導対象の移動目標の追尾情報である相対速度V・
角度・相対距離Rを算出する処理手順26を行い、誘導
対象の移動目標の追尾情報である相対速度V・角度・相
対距離Rから、誘導対象の移動目標への誘導情報を算出
する処理手順27を行い、誘導対象の移動目標を見失っ
たかどうかの判定をする処理手順28を行う。Next, as in the first embodiment, as shown in FIG. 9, in the tracking calculation unit 4, the initial relative velocity, which is the tracking information of the moving target of the guidance target calculated in the processing procedure 24, After the initial angle / initial relative distance input processing procedure 25 is performed and the search is completed in the processing procedure 23, the relative velocity V, which is the tracking information of the moving target of the guidance target,
The processing procedure 26 for calculating the angle / relative distance R is performed, and the processing procedure 27 for calculating the guidance information to the movement target of the guidance target from the relative speed V / angle / relative distance R which is the tracking information of the movement target of the guidance target. Then, a processing procedure 28 for determining whether or not the movement target of the guidance target is lost is performed.
【0049】次に、上記実施の形態1と同様に図10に
示されるように上記操舵部5において、上記処理手順2
7で算出された誘導対象の移動目標への誘導情報の入力
処理手順29を行い、誘導対象の移動目標への誘導情報
をもとに舵角制御をする処理手順30を行う。Next, as in the first embodiment, as shown in FIG. 10, in the steering section 5, the processing procedure 2 is performed.
The procedure 29 of inputting the guidance information to the moving target of the guidance target calculated in 7 is performed, and the processing procedure 30 of controlling the steering angle based on the guidance information to the moving target of the guidance target is performed.
【0050】次に、上記実施の形態1と同様に図11に
示されるように上記目標存在範囲計算部8において、上
記処理手順19で算出された飛しょう体の位置・速度情
報である緯度PMNS・経度PMEW・高度PMH・緯度方向速
度VMNS・経度方向速度VMEW・高度方向速度VMH・垂直
方向姿勢角AP・水平方向姿勢角AYの入力処理手順31
を行い、上記処理手順26で算出された誘導対象の移動
目標の追尾情報である相対速度V・相対距離Rの入力処
理手順32を行い、飛しょう体の位置・速度情報である
緯度PMNS・経度PMEW・高度PMH・緯度方向速度VMNS
・経度方向速度VMEW・高度方向速度VMH・垂直方向姿
勢角AP・水平方向姿勢角AYと、誘導対象の移動目標の
追尾情報である相対速度V・相対距離Rから、誘導対象
の移動目標の位置・速度情報である緯度PTNS・経度PT
EW・高度PTH・緯度方向速度VTNS・経度方向速度VTEW
・高度方向速度VTHをそれぞれ“数1”、“数2”、
“数3”、“数4”、“数5”、“数6”で逆算する処
理手順33を行い、上記処理手順28で誘導対象の移動
目標を見失ったと判定した場合に、逆算した誘導対象の
移動目標の位置情報である緯度PTNS・経度PTEW・高度
PTHから誘導対象の移動目標の存在範囲(PTNS±固定
値、PTEW±固定値、PTH±固定値)を算出する処理手
順34を行う。Next, as in the first embodiment, as shown in FIG. 11, in the target existence range calculation section 8, the latitude PMNS which is the position / speed information of the flying object calculated in the processing procedure 19 is calculated.・ Longitude PMEW ・ Altitude PMH ・ Latitude direction speed VMNS ・ Longitude direction speed VMEW ・ Altitude direction speed VMH ・ Vertical attitude angle AP ・ Horizontal attitude angle AY input processing procedure 31
Then, the input processing procedure 32 of the relative velocity V and the relative distance R, which are the tracking information of the moving target of the guidance target calculated in the processing procedure 26, is performed, and the latitude PMNS and the longitude, which are the position and velocity information of the flying object. PMEW, altitude PMH, latitudinal velocity VMNS
-Longitudinal speed VMEW-Altitude-direction speed VMH-Vertical attitude angle AP-Horizontal attitude angle AY, and relative speed V and relative distance R that are tracking information of the moving target of the guidance target, from the position of the moving target of the guidance target・ Latitude PTNS and longitude PT which are speed information
EW / Altitude PTH / Latitude Velocity VTNS / Longitude VTEW
・ Altitude velocity VTH is calculated by "number 1", "number 2",
When the processing procedure 33 for back-calculating with “Equation 3”, “Equation 4”, “Equation 5”, and “Equation 6” is performed, and when it is determined that the moving target of the guidance target has been lost in the above-mentioned processing procedure 28, the guidance object calculated backward is calculated. The procedure 34 for calculating the existence range (PTNS ± fixed value, PTEW ± fixed value, PTH ± fixed value) of the moving target to be guided from the latitude PTNS / longitude PTEW / altitude PTH, which is the position information of the moving target of FIG.
【0051】次に、上記実施の形態3と同様に図13に
示されるように目標照合確定部10において、上記処理
手順18で算出した複数の移動目標の位置・速度情報で
ある緯度・経度・高度・緯度方向速度・経度方向速度・
高度方向速度の入力処理手順39を行い、上記処理手順
33で逆算した誘導対象の移動目標の位置・速度情報で
ある緯度PTNS・経度PTEW・高度PTH・緯度方向速度V
TNS・経度方向速度VTEW・高度方向速度VTHの入力処理
手順40を行い、上記処理手順28で誘導対象の移動目
標を見失ったと判定した場合に、複数の移動目標の位置
・速度情報である緯度・経度・高度・緯度方向速度・経
度方向速度・高度方向速度と、逆算した誘導対象の移動
目標の位置・速度情報である緯度PTNS・経度PTEW・高
度PTH・緯度方向速度VTNS・経度方向速度VTEW・高度
方向速度VTHの差分を取り、複数の移動目標の中でどの
目標が1番差分が少ないか照合する処理手順41を行
い、1番差分が少ない移動目標の位置・速度情報である
緯度・経度・高度・緯度方向速度・経度方向速度・高度
方向速度と、逆算した誘導対象の移動目標の位置・速度
情報である緯度PTNS・経度PTEW・高度PTH・緯度方向
速度VTNS・経度方向速度VTEW・高度方向速度VTHの平
均値を取って、誘導対象の移動目標の位置・速度情報で
ある緯度・経度・高度・緯度方向速度・経度方向速度・
高度方向速度として確定する処理手順42を行い、2番
目に差分が少ない移動目標の位置・速度情報である緯度
・経度・高度・緯度方向速度・経度方向速度・高度方向
速度と、確定した誘導対象の移動目標の位置・速度情報
である緯度・経度・高度・緯度方向速度・経度方向速度
・高度方向速度の差分を取り、差分を越えない範囲を誘
導対象の移動目標の存在範囲とする処理手順43を行
う。Next, as in the third embodiment, as shown in FIG. 13, in the target collation confirming unit 10, the latitude / longitude / position / velocity / position information of the plurality of moving targets calculated in the processing procedure 18 is calculated. Altitude / Latitude direction speed / Longitude direction speed
Latitude PTNS / longitude PTEW / altitude PTH / latitude direction speed V, which is the position / speed information of the moving target of the guidance target, which is calculated back in step 33, by performing the altitude direction speed input processing procedure 39.
When the input processing procedure 40 of the TNS / longitude-direction speed VTEW / the altitude-direction speed VTH is performed and it is determined in the above-mentioned processing procedure 28 that the moving target of the guidance target is lost, the latitude / longitude which is the position / speed information of the plurality of moving targets. Longitude / Altitude / Latitude direction velocity / Longitude direction velocity / Altitude direction velocity and the backward calculated position / speed information of the moving target of the guidance target: Latitude PTNS / Longitude PTEW / Altitude PTH / Latitude direction velocity VTNS / Longitude direction velocity VTEW. The processing procedure 41 is performed for obtaining the difference in the altitude direction velocity VTH and comparing which of the plurality of moving targets has the smallest difference. The latitude / longitude is the position / speed information of the moving target having the smallest difference.・ Altitude ・ Latitude direction speed ・ Longitude direction speed ・ Altitude direction speed and the position of the moving target of the guidance object that has been calculated backward ・ Latitude PTNS ・ Longitude PTEW ・ Altitude PTH ・ Latitude direction speed VTNS ・ Longitude direction speed VTEW ・Taking the average value of the degrees direction speed VTH, latitude, longitude, altitude and latitude direction velocity and longitude direction speed and a position and speed information of the moving target of inducing target
The processing procedure 42 for determining the altitude direction speed is performed, and the position / speed information of the moving target with the second smallest difference is the latitude / longitude / altitude / latitude direction speed / longitude direction speed / altitude direction speed, and the determined guidance target. Of the moving target position / velocity information, the difference between latitude / longitude / altitude / latitude direction velocity / longitude direction velocity / altitude direction velocity is taken, and the range that does not exceed the difference is set as the existing range of the moving target to be guided. Do 43.
【0052】次に、図14に示されるように誘導対象目
標存在範囲計算部11において、上記処理手順18で算
出した複数の移動目標の位置・速度情報である緯度・経
度・高度・緯度方向速度・経度方向速度・高度方向速度
の入力処理手順44を行い、上記処理手順42で確定し
た誘導対象の移動目標の位置・速度情報である緯度・経
度・高度・緯度方向速度・経度方向速度・高度方向速度
と、上記処理手順43で算出された誘導対象の移動目標
の存在範囲の入力処理手順45を行い、誘導対象の移動
目標が誘導対象の移動目標の存在範囲を逸脱したと判定
した場合に、確定した誘導対象の移動目標の位置・速度
情報である緯度・経度・高度・緯度方向速度・経度方向
速度・高度方向速度から、誘導対象の移動目標を見失っ
た時点から現時点までの誘導対象の移動目標の位置・速
度情報である予測緯度・予測経度・予測高度・予測緯度
方向速度・予測経度方向速度・予測高度方向速度を算出
する処理手順46を行い、複数の移動目標の位置・速度
情報であるそれぞれの緯度・経度・高度・緯度方向速度
・経度方向速度・高度方向速度と、誘導対象の移動目標
の位置・速度情報である予測緯度・予測経度・予測高度
・予測緯度方向速度・予測経度方向速度・予測高度方向
速度の差分を取り、差分を越えない範囲を誘導対象の移
動目標の存在範囲とする処理手順47を行う。上記処理
手順13〜34及び39〜47を行うことにより、移動
目標が上記目標照合確定部で得た上記誘導対象の移動目
標の存在範囲を逸脱した場合に、誘導対象の移動目標を
捜索する範囲を限定することができるので、複数の移動
目標があったとしても、見失った誘導対象の移動目標を
短時間で再発見することができて、誘導対象の移動目標
に向かって飛しょう体を誘導することができる。Next, as shown in FIG. 14, in the guidance target target existence range calculation unit 11, the latitude / longitude / altitude / latitude direction velocities, which are the position / velocity information of the plurality of moving targets calculated in the above processing procedure 18, are calculated.・ Longitudinal direction velocity / Altitude direction velocity input processing procedure 44 is performed, and the position / velocity information of the movement target of the guidance target determined in the above processing procedure 42 is latitude / longitude / altitude / latitude direction velocity / longitude direction velocity / altitude. When it is determined that the directional velocity and the moving target existence range of the guidance target calculated in the above processing procedure 43 are input, and it is determined that the moving target of the guidance target deviates from the existing range of the moving target of the guidance target. , From the time when the target to be guided is lost from the position / speed information of the fixed target to be moved, which is latitude / longitude / altitude / latitude direction speed / longitude direction / altitude direction speed. A plurality of moving targets are subjected to the processing procedure 46 for calculating the predicted latitude, predicted longitude, predicted altitude, predicted latitude direction speed, predicted longitude direction speed, and predicted altitude direction speed, which are the position / speed information of the moving target to be guided in Latitude / Longitude / Altitude / Latitude / Velocity / Longitudinal / Velocity information that is the position / velocity information of each, and predicted latitude / predicted longitude / predicted altitude / prediction that is the position / speed information of the moving target to be guided. A processing procedure 47 is performed in which the difference between the latitude direction velocity, the predicted longitude direction velocity, and the predicted altitude direction velocity is calculated, and the range that does not exceed the difference is set as the existing range of the movement target to be guided. By performing the processing procedures 13 to 34 and 39 to 47, when the moving target deviates from the existing range of the moving target of the guidance target obtained by the target matching confirmation unit, the range of searching the moving target of the guidance target. Even if there are multiple moving targets, it is possible to rediscover the missing moving target of the guiding target in a short time and guide the flying object toward the moving target of the guiding target. can do.
【0053】実施の形態5.図5はこの発明の実施の形
態5を示す構成図であり、図において1〜6は上記飛し
ょう体誘導装置と全く同一のものである。12は目標予
測計算部で、この発明による飛しょう体誘導装置は上記
1〜6及び12で構成される。Embodiment 5. FIG. 5 is a block diagram showing a fifth embodiment of the present invention, in which 1 to 6 are exactly the same as the above-mentioned flying body guiding device. Reference numeral 12 is a target prediction calculation unit, and the flying body guiding apparatus according to the present invention is composed of 1 to 6 and 12.
【0054】また、図15はこの発明の実施の形態5の
処理手順を示すフローチャートである。以下に図15に
おける処理手順を述べる。上記実施の形態1と同様に図
6に示されるように上記母機1において、移動目標を母
機1に搭載されているレーダ装置で検出する処理手順1
3を行い、検出した移動目標の位置・速度情報である初
期緯度・初期経度・初期高度・緯度方向初期速度・経度
方向初期速度・高度方向初期速度を算出する処理手順1
4を行い、母機の位置・速度情報である緯度・経度・高
度・緯度方向速度・経度方向速度・高度方向速度を算出
する処理手順15行う。FIG. 15 is a flow chart showing the processing procedure of the fifth embodiment of the present invention. The processing procedure in FIG. 15 will be described below. As in the first embodiment, as shown in FIG. 6, in the mother machine 1, the processing procedure 1 for detecting the moving target by the radar device mounted in the mother machine 1.
3. Procedure 3 for calculating initial position, initial longitude, initial altitude, latitude direction initial speed, longitude direction initial speed, and altitude direction initial speed, which are position and speed information of the detected moving target.
4 is performed, and the processing procedure 15 for calculating the latitude / longitude / altitude / latitude direction velocity / longitude direction velocity / altitude direction velocity, which is the position / speed information of the mother machine, is performed.
【0055】次に、上記実施の形態1と同様に図7に示
されるように上記航法計算部2において、上記処理手順
14で算出された移動目標の位置・速度情報である初期
緯度・初期経度・初期高度・緯度方向初期速度・経度方
向初期速度・高度方向初期速度と、上記処理手順15で
算出された母機の位置・速度情報である緯度・経度・高
度・緯度方向速度・経度方向速度・高度方向速度の入力
処理手順16を行い、飛しょう体が母機から分離したか
どうかを判定する処理手順17を行い、飛しょう体が母
機から分離した時点から、移動目標の位置・速度情報で
ある緯度・経度・高度・緯度方向速度・経度方向速度・
高度方向速度を算出する処理手順18を行い、飛しょう
体の位置・速度情報である緯度PMNS・経度PMEW・高度
PMH・緯度方向速度VMNS・経度方向速度VMEW・高度方
向速度VMH・垂直方向姿勢角AP・水平方向姿勢角AYを
算出する処理手順19を行い、移動目標が捜索可能な相
対位置かどうかの判定をする処理手順20を行い、移動
目標が捜索可能な相対位置でない場合に、上記処理手順
18、19を捜索可能になるまで行う。Next, as in the first embodiment, as shown in FIG. 7, in the navigation calculation unit 2, the initial latitude / initial longitude which is the position / speed information of the moving target calculated in the processing procedure 14 described above.・ Initial altitude / latitude direction initial velocity / longitude direction initial velocity / altitude direction initial velocity and latitude / longitude / altitude / latitude direction velocity / longitude direction velocity, which is the position / velocity information of the mother machine calculated in the above processing procedure 15. The altitude direction velocity input processing procedure 16 is performed, and the processing procedure 17 for determining whether or not the flying body is separated from the mother aircraft is performed. From the time when the flying body is separated from the mother aircraft, the position / velocity information of the moving target is obtained. Latitude / longitude / altitude / latitude direction speed / longitude direction speed
The processing procedure 18 for calculating the altitude direction speed is performed, and the position / speed information of the flying object is latitude PMNS / longitude PMEW / altitude PMH / latitude direction speed VMNS / longitude direction speed VMEW / altitude direction speed VMH / vertical attitude angle. The process procedure 19 for calculating the AP / horizontal posture angle AY is performed, and the process procedure 20 for determining whether the moving target is a searchable relative position is performed. If the moving target is not the searchable relative position, the above process is performed. Repeat steps 18 and 19 until it becomes searchable.
【0056】次に、上記実施の形態1と同様に図8に示
されるように上記捜索処理部3において、上記処理手順
20で捜索可能な相対位置になった場合に、上記処理手
順18で算出した移動目標の位置・速度情報である緯度
・経度・高度・緯度方向速度・経度方向速度・高度方向
速度と、上記処理手順19で算出された飛しょう体の位
置・速度情報である緯度PMNS・経度PMEW・高度PMH・
緯度方向速度VMNS・経度方向速度VMEW・高度方向速度
VMHの入力処理手順21を行い、移動目標の位置・速度
情報である緯度・経度・高度・緯度方向速度・経度方向
速度・高度方向速度と、飛しょう体の位置・速度情報で
ある緯度PMNS・経度PMEW・高度PMH・緯度方向速度V
MNS・経度方向速度VMEW・高度方向速度VMHから、移動
目標の捜索処理をする処理手順22を行い、移動目標の
捜索が完了したかどうかの判定をする処理手順23を行
い、捜索を完了した場合に、捜索を完了した時点での移
動目標の追尾情報である初期相対速度・初期角度・初期
相対距離を算出する処理手順24を行う。Next, as shown in FIG. 8 in the same manner as in the first embodiment, when the search processing section 3 reaches the relative position where the search can be performed in the processing procedure 20, the calculation is performed in the processing procedure 18. The latitude / longitude / altitude / latitude direction velocity / longitude direction velocity / altitude direction velocity which is the position / velocity information of the moving target, and the latitude PMNS which is the position / velocity information of the flying object calculated in the above processing procedure 19. Longitude PMEW / Altitude PMH /
The input processing procedure 21 of the latitude direction velocity VMNS, the longitude direction velocity VMEW, and the altitude direction velocity VMH is performed, and the position / speed information of the moving target is latitude / longitude / altitude / latitude direction velocity / longitude direction velocity / altitude direction velocity, Latitude PMNS / longitude PMEW / altitude PMH / latitude velocity V, which is the position / velocity information of the flying object.
When the search procedure is completed by performing the procedure 22 for searching the moving target from the MNS / longitude direction velocity VMEW / the altitude direction velocity VMH and performing the process procedure 23 for determining whether or not the search for the moving target is completed. First, the processing procedure 24 for calculating the initial relative velocity / initial angle / initial relative distance, which is the tracking information of the moving target at the time when the search is completed, is performed.
【0057】次に、上記実施の形態1と同様に図9に示
されるように上記追尾計算部4において、上記処理手順
24で算出された移動目標の追尾情報である初期相対速
度・初期角度・初期相対距離の入力処理手順25を行
い、上記処理手順23で捜索が完了した時点から、移動
目標の追尾情報である相対速度V・角度・相対距離Rを
算出する処理手順26を行い、移動目標の追尾情報であ
る相対速度V・角度・相対距離Rから、移動目標への誘
導情報を算出する処理手順27を行い、移動目標を見失
ったかどうかの判定をする処理手順28を行う。Next, as in the first embodiment, as shown in FIG. 9, in the tracking calculation section 4, the initial relative velocity, the initial angle, which is the tracking information of the moving target calculated in the processing procedure 24, is calculated. An initial relative distance input processing procedure 25 is performed, and from the time when the search is completed in the above processing procedure 23, a processing procedure 26 of calculating the relative velocity V / angle / relative distance R, which is the tracking information of the moving target, is performed to determine the moving target. The procedure 27 for calculating the guidance information to the moving target is performed from the relative velocity V, the angle, and the relative distance R, which are the tracking information, and the procedure 28 for determining whether or not the moving target is lost.
【0058】次に、上記実施の形態1と同様に図10に
示されるように上記操舵部5において、上記処理手順2
7で算出された移動目標への誘導情報の入力処理手順2
9を行い、移動目標への誘導情報をもとに舵角制御をす
る処理手順30を行う。Next, as in the first embodiment, as shown in FIG. 10, in the steering section 5, the processing procedure 2 is performed.
Input processing procedure 2 for guiding information to the moving target calculated in 7.
9 is performed, and the processing procedure 30 for controlling the steering angle based on the guidance information to the moving target is performed.
【0059】次に、図15に示されるように目標予測計
算部12において、上記処理手順19で算出された飛し
ょう体の位置・速度情報である緯度PMNS・経度PMEW・
高度PMH・緯度方向速度VMNS・経度方向速度VMEW・高
度方向速度VMHの入力処理手順48を行い、上記処理手
順26で算出した移動目標の追尾情報である相対速度V
・相対距離Rの入力処理手順49を行い、移動目標との
相対距離が短距離かどうかの判定をする処理手順50を
行い、移動目標との相対距離が短距離の場合に、飛しょ
う体の位置・速度情報である緯度PMNS・経度PMEW・高
度PMH・緯度方向速度VMNS・経度方向速度VMEW・高度
方向速度VMHと、移動目標の追尾情報である相対速度V
・相対距離Rから、移動目標の位置・速度情報である予
測緯度・予測経度・予測高度・予測緯度方向速度・予測
経度方向速度・予測高度方向速度を算出する処理手順5
1を行い、移動目標の追尾情報である予測相対速度・予
測角度・予測相対距離を算出する処理手順52を行う。
上記処理手順13〜30及び48〜52を行うことによ
り、移動目標を見失ったけれども再び捜索する時間が無
い場合に、移動目標の追尾情報である予測相対速度・予
測角度・予測相対距離を算出して追尾計算の初期値とし
て使用することにより、移動目標に向かって飛しょう体
の誘導を継続することができる。Next, as shown in FIG. 15, in the target prediction / calculation unit 12, the latitude PMNS / longitude PMEW, which is the position / velocity information of the flying object calculated in the processing procedure 19, is calculated.
The relative speed V, which is the tracking information of the moving target calculated in the above processing procedure 26, is performed by inputting the processing procedure 48 of the altitude PMH, the latitude direction speed VMNS, the longitude direction speed VMEW, and the altitude direction speed VMH.
・ The processing procedure 49 for inputting the relative distance R is performed, and the processing procedure 50 for determining whether the relative distance to the moving target is a short distance is performed. When the relative distance to the moving target is a short distance, Latitude PMNS / longitude PMEW / altitude PMH / latitude direction speed VMNS / longitude direction speed VMEW / altitude direction speed VMH which is position / speed information, and relative speed V which is tracking information of a moving target.
Processing procedure 5 for calculating the predicted latitude, predicted longitude, predicted altitude, predicted latitude direction speed, predicted longitude direction speed, and predicted altitude direction speed, which are the moving target position and speed information, from the relative distance R
1 is performed, and the processing procedure 52 for calculating the predicted relative speed / predicted angle / predicted relative distance, which is the tracking information of the moving target, is performed.
By performing the processing steps 13 to 30 and 48 to 52 described above, when the moving target is lost and there is no time to search again, the predicted relative velocity, the predicted angle, and the predicted relative distance, which are the tracking information of the moving target, are calculated. By using it as an initial value for tracking calculation, it is possible to continue guiding the flying object toward the moving target.
【0060】[0060]
【発明の効果】この発明は、以上説明したように構成さ
れ処理するので、以下に記載されるような効果を奏す
る。Since the present invention is constructed and processed as described above, it has the following effects.
【0061】第1の発明によれば、従来の装置に目標存
在範囲計算部8を設けたことにより、航法計算部2から
入力される飛しょう体の位置・速度情報である緯度・経
度・高度・緯度方向速度・経度方向速度・高度方向速度
・垂直方向姿勢角・水平方向姿勢角と、追尾計算部4か
ら入力される移動目標の追尾情報である相対速度・相対
距離をもとにして、移動目標から妨害を受けて移動目標
を見失ったとしても、移動目標の存在範囲を算出するこ
とで、短時間に移動目標を再発見することができる。According to the first aspect of the present invention, by providing the target existence range calculation unit 8 in the conventional device, the latitude / longitude / altitude which is the position / speed information of the flying object input from the navigation calculation unit 2.・ Latitude direction velocity ・ Longitude direction velocity ・ Altitude direction velocity ・ Vertical posture angle ・ Horizontal posture angle, and the relative velocity and relative distance, which are the tracking information of the moving target input from the tracking calculation unit 4, Even if the moving target is obstructed by the moving target and the moving target is lost, the moving target can be rediscovered in a short time by calculating the existence range of the moving target.
【0062】また、第2の発明によれば、従来の装置に
移動成分計算部9を設けたことにより、目標存在範囲計
算部8から入力される逆算した移動目標の位置・速度情
報である緯度・経度・高度・緯度方向速度・経度方向速
度・高度方向速度をもとにして、移動目標を見失った時
点から現時点までの移動目標の移動成分である緯度方向
移動成分・経度方向移動成分・高度方向移動成分を算出
し、移動目標の存在範囲を算出することで、短時間に移
動目標を再発見することができる。Further, according to the second aspect of the invention, since the moving component calculating section 9 is provided in the conventional apparatus, the latitude which is the backward calculated position / speed information of the moving target input from the target existence range calculating section 8 is obtained.・ Longitude / Altitude ・ Latitude direction velocity ・ Longitude direction velocity ・ Altitude direction velocity The moving target can be rediscovered in a short time by calculating the direction moving component and calculating the existence range of the moving target.
【0063】また、第3の発明によれば、従来の装置に
目標照合確定部10を設けたことにより、航法計算部2
から入力される複数の移動目標の位置・速度情報である
緯度・経度・高度・緯度方向速度・経度方向速度・高度
方向速度と、目標存在範囲計算部8から入力される逆算
した誘導対象の移動目標の位置・速度情報である緯度・
経度・高度・緯度方向速度・経度方向速度・高度方向速
度をもとにして、誘導対象の移動目標から妨害を受けて
誘導対象の移動目標を見失ったとしても、1番差分が少
ない移動目標の位置・速度情報である緯度・経度・高度
・緯度方向速度・経度方向速度・高度方向速度と、逆算
した誘導対象の移動目標の位置・速度情報である緯度・
経度・高度・緯度方向速度・経度方向速度・高度方向速
度の平均値を取って誘導対象の移動目標の位置・速度情
報である緯度・経度・高度・緯度方向速度・経度方向速
度・高度方向速度として確定し、2番目に差分が少ない
移動目標の位置・速度情報である緯度・経度・高度・緯
度方向速度・経度方向速度・高度方向速度と、確定した
誘導対象の移動目標の位置・速度情報である緯度・経度
・高度・緯度方向速度・経度方向速度・高度方向速度の
差分を取り、差分を越えない範囲を誘導対象の移動目標
の存在範囲とすることで、短時間に誘導対象の移動目標
を再発見することができる。Further, according to the third aspect of the invention, the navigation calculation unit 2 is provided by providing the target collation confirmation unit 10 in the conventional device.
Latitude / longitude / altitude / latitude direction velocity / longitude direction velocity / altitude direction velocity, which is the position / velocity information of a plurality of movement targets input from, and the backward calculated guidance target movement input from the target existence range calculation unit 8. Latitude, which is the target position / speed information
Based on the longitude, altitude, latitude direction speed, longitude direction speed, and altitude direction speed, even if you lose sight of the guidance target movement target due to interference from the guidance target movement target, The latitude / longitude / altitude / latitude / latitude / longitude / altitude / direction information, which is the position / speed information, and the latitude / latitude, which is the position / speed information of the moving target of the guidance target, which is calculated backward.
Latitude, longitude, altitude, latitude direction speed, longitude direction speed, altitude direction speed which is the position and speed information of the moving target of the guidance target by taking the average value of longitude, altitude, latitude direction speed, longitude direction speed, altitude direction speed As the position / speed information of the moving target having the second smallest difference, which is the latitude / longitude / altitude / latitude direction speed / longitude direction speed / altitude direction speed, and the position / speed information of the confirmed movement target of the guidance target. The latitude, longitude, altitude, latitude, velocity in the latitude direction, velocity in the longitude direction, and velocity in the altitude direction are calculated, and the range that does not exceed the difference is set as the target movement range. You can rediscover your goals.
【0064】また、第4の発明によれば、従来の装置に
誘導対象目標存在範囲計算部11を設けたことにより、
追尾計算部4から入力される複数の移動目標の位置・速
度情報である緯度・経度・高度・緯度方向速度・経度方
向速度・高度方向速度と、目標照合確定部10から入力
される確定した誘導対象の移動目標の位置・速度情報で
ある緯度・経度・高度・緯度方向速度・経度方向速度・
高度方向速度をもとにして、誘導対象の移動目標を見失
った時点から現時点までの誘導対象の移動目標の位置・
速度情報である予測緯度・予測経度・予測高度・予測緯
度方向速度・予測経度方向速度・予測高度方向速度を算
出し、複数の移動目標の位置・速度情報であるそれぞれ
の緯度・経度・高度・緯度方向速度・経度方向速度・高
度方向速度と、誘導対象の移動目標の位置・速度情報で
ある予測緯度・予測経度・予測高度・予測緯度方向速度
・予測経度方向速度・予測高度方向速度の差分を取り、
差分を越えない範囲を誘導対象の移動目標の存在範囲と
することで、短時間に誘導対象の移動目標を再発見する
ことができる。Further, according to the fourth aspect of the invention, since the guidance target target existence range calculation unit 11 is provided in the conventional apparatus,
Latitude / longitude / altitude / latitude / longitude / latitude / longitude / altitude direction velocities, which are position / velocity information of a plurality of moving targets input from the tracking calculation unit 4, and fixed guidance input from the target matching confirmation unit 10. Latitude, longitude, altitude, latitude direction speed, longitude direction speed, which is the position and speed information of the target moving target.
Based on the speed in the altitude direction, the position of the movement target of the guidance target from the moment when the movement target of the guidance target is lost
Predicted latitude, predicted longitude, predicted altitude, predicted latitude direction speed, predicted longitude direction speed, predicted altitude direction speed, which is speed information, is calculated, and the latitude, longitude, altitude, and each of the positions / speed information of multiple moving targets are calculated. Difference between latitude direction velocity / longitude direction velocity / altitude direction velocity and predicted latitude / prediction longitude / predicted altitude / predicted latitude direction velocity / predicted longitude direction velocity / predicted altitude direction velocity, which is the position / velocity information of the movement target of the guidance target Take
By setting the range that does not exceed the difference as the existence range of the guidance target movement target, the guidance target movement target can be rediscovered in a short time.
【0065】また、第5の発明によれば、従来の装置に
目標予測計算部12を設けたことにより、航法計算部2
から入力される飛しょう体の位置・速度情報である緯度
・経度・高度・緯度方向速度・経度方向速度・高度方向
速度・垂直方向姿勢角・水平方向姿勢角と、追尾計算部
4から入力される移動目標の追尾情報である相対速度・
相対距離をもとにして、移動目標から妨害を受けて移動
目標を見失ったけれども再び捜索する時間が無い場合
に、移動目標の位置・速度情報である予測緯度・予測経
度・予測高度・予測緯度方向速度・予測経度方向速度・
予測高度方向速度を算出して、移動目標の追尾情報であ
る予測相対速度・予測角度・予測相対距離を算出して追
尾計算の初期値として使用することにより、移動目標に
向かって飛しょう体の誘導を継続することができる。Further, according to the fifth aspect of the invention, since the target prediction calculation unit 12 is provided in the conventional device, the navigation calculation unit 2
Latitude / longitude / altitude / latitude direction velocity / longitude direction velocity / altitude direction velocity / vertical attitude angle / horizontal attitude angle, which is the position / velocity information of the flying object, which is input from the tracking calculation unit 4. Relative velocity, which is the tracking information of the moving target
Based on the relative distance, if you lose sight of the moving target due to interference from the moving target, but there is no time to search again, the predicted latitude, predicted longitude, predicted altitude, and predicted latitude that are the position / speed information of the moving target. Directional speed / Predicted longitude Directional speed /
By calculating the predicted altitude direction speed and calculating the predicted relative speed, predicted angle, and predicted relative distance that are the tracking information of the moving target and using it as the initial value for tracking calculation, Induction can continue.
【図1】 この発明による飛しょう体誘導装置の実施の
形態1を示す図である。FIG. 1 is a diagram showing a first embodiment of a flying body guiding device according to the present invention.
【図2】 この発明による飛しょう体誘導装置の実施の
形態2を示す図である。FIG. 2 is a diagram showing a second embodiment of a flying body guiding device according to the present invention.
【図3】 この発明による飛しょう体誘導装置の実施の
形態3を示す図である。FIG. 3 is a diagram showing a third embodiment of the flying body guiding device according to the present invention.
【図4】 この発明による飛しょう体誘導装置の実施の
形態4を示す図である。FIG. 4 is a diagram showing a fourth embodiment of the flying vehicle guiding device according to the present invention.
【図5】 この発明による飛しょう体誘導装置の実施の
形態5を示す図である。FIG. 5 is a diagram showing a fifth embodiment of a flying body guiding device according to the present invention.
【図6】 この発明による飛しょう体誘導装置の実施の
形態1の処理手順を示すフローチャートである。FIG. 6 is a flowchart showing a processing procedure of the first embodiment of the flying vehicle guiding apparatus according to the present invention.
【図7】 この発明による飛しょう体誘導装置の実施の
形態1の処理手順を示すフローチャートである。FIG. 7 is a flowchart showing a processing procedure of Embodiment 1 of the flying vehicle guiding apparatus according to the present invention.
【図8】 この発明による飛しょう体誘導装置の実施の
形態1の処理手順を示すフローチャートである。FIG. 8 is a flowchart showing a processing procedure of the first embodiment of the flying object guiding apparatus according to the present invention.
【図9】 この発明による飛しょう体誘導装置の実施の
形態1の処理手順を示すフローチャートである。FIG. 9 is a flowchart showing a processing procedure of the embodiment 1 of the flying vehicle guiding apparatus according to the present invention.
【図10】 この発明による飛しょう体誘導装置の実施
の形態1の処理手順を示すフローチャートである。FIG. 10 is a flowchart showing a processing procedure of the embodiment 1 of the flying vehicle guiding apparatus according to the present invention.
【図11】 この発明による飛しょう体誘導装置の実施
の形態1の処理手順を示すフローチャートである。FIG. 11 is a flowchart showing a processing procedure of the embodiment 1 of the flying vehicle guiding apparatus according to the present invention.
【図12】 この発明による飛しょう体誘導装置の実施
の形態2の処理手順を示すフローチャートである。FIG. 12 is a flowchart showing a processing procedure of a second embodiment of the flying object guiding apparatus according to the present invention.
【図13】 この発明による飛しょう体誘導装置の実施
の形態3の処理手順を示すフローチャートである。FIG. 13 is a flowchart showing a processing procedure of a third embodiment of the flying object guiding device according to the present invention.
【図14】 この発明による飛しょう体誘導装置の実施
の形態4の処理手順を示すフローチャートである。FIG. 14 is a flowchart showing a processing procedure of a fourth embodiment of the flying object guiding apparatus according to the present invention.
【図15】 この発明による飛しょう体誘導装置の実施
の形態5の処理手順を示すフローチャートである。FIG. 15 is a flowchart showing a processing procedure of a fifth embodiment of the flying vehicle guiding apparatus according to the present invention.
【図16】 従来の飛しょう体誘導装置を示す構成図で
ある。FIG. 16 is a configuration diagram showing a conventional flying body guiding device.
【図17】 飛しょう体誘導装置が適用されるシステム
全体を示す外観図である。FIG. 17 is an external view showing the entire system to which the flying body guiding device is applied.
1 母機 2 航法計算部 3 捜索処理部 4 追尾計算部 5 操舵部 6 飛しょう体 7 移動目標 8 目標存在範囲計算部 9 移動成分計算部 10 目標照合確定部 11 誘導対象目標存在範囲計算部 12 目標予測計算部 1 mother plane 2 Navigation calculator 3 Search processing section 4 Tracking calculation section 5 Steering unit 6 flying body 7 movement target 8 Target existence range calculator 9 Moving component calculator 10 Target verification confirmation section 11 Target Target Existence Range Calculation Unit 12 Target prediction calculator
Claims (5)
る初期緯度・初期経度・初期高度・緯度方向初期速度・
経度方向初期速度・高度方向初期速度及び母機の位置・
速度情報である緯度・経度・高度・緯度方向速度・経度
方向速度・高度方向速度を得て、母機から分離した後
に、移動目標の位置・速度情報である緯度・経度・高度
・緯度方向速度・経度方向速度・高度方向速度を算出
し、飛しょう体の位置・速度情報である緯度・経度・高
度・緯度方向速度・経度方向速度・高度方向速度・垂直
方向姿勢角・水平方向姿勢角を算出する航法計算部と、 上記移動目標の位置・速度情報である緯度・経度・高度
・緯度方向速度・経度方向速度・高度方向速度及び上記
飛しょう体の位置・速度情報である緯度・経度・高度・
緯度方向速度・経度方向速度・高度方向速度が入力さ
れ、捜索処理を行い、捜索を完了した時点での移動目標
の追尾情報である初期相対速度・初期角度・初期相対距
離を算出する捜索処理部と、 上記移動目標の追尾情報である初期相対速度・初期角度
・初期相対距離が入力され、移動目標の追尾情報である
相対速度・角度・相対距離を算出し、移動目標への誘導
情報を算出する追尾計算部と、 上記移動目標への誘導情報が入力され、舵角制御をする
操舵部と、 飛しょう体を誘導している時に移動目標から妨害を受け
て移動目標を見失った場合に、上記航法計算部で得た上
記飛しょう体の位置・速度情報である緯度・経度・高度
・緯度方向速度・経度方向速度・高度方向速度・垂直方
向姿勢角・水平方向姿勢角が入力され、上記追尾計算部
で得た上記移動目標の追尾情報である相対速度・相対距
離が入力され、移動目標の位置・速度情報である緯度・
経度・高度・緯度方向速度・経度方向速度・高度方向速
度を逆算し、移動目標の存在範囲を算出する目標存在範
囲計算部を備えたことを特徴とする飛しょう体誘導装
置。1. An initial latitude, an initial longitude, an initial altitude, an initial velocity in the latitudinal direction, which is position / velocity information of a moving target from the mother machine.
Initial velocity in the longitude direction, initial velocity in the altitude direction, and the position of the mother machine
After obtaining the speed information, latitude / longitude / altitude / latitude direction speed / longitude direction speed / altitude direction speed, and separating from the aircraft, the position / speed information of the moving target is latitude / longitude / altitude / latitude direction speed / Calculates the velocity in the longitude direction and the velocity in the altitude direction, and calculates the position / velocity information of the flying object, which is latitude / longitude / altitude / latitude direction velocity / longitude direction velocity / altitude direction velocity / vertical attitude angle / horizontal attitude angle. The navigation calculation unit that performs the above, and the latitude / longitude / altitude / latitude / velocity / longitude / velocity information that is the position / velocity information of the moving target and the latitude / longitude / altitude that is the position / velocity information of the flying object.・
A search processing unit that calculates the initial relative speed, initial angle, and initial relative distance that is the tracking information of the moving target at the time when the search processing is completed by inputting the latitude direction speed, longitude direction speed, and altitude direction speed. And the initial relative speed / initial angle / initial relative distance, which is the tracking information of the moving target, are input, and the relative speed / angle / relative distance, which is the tracking information of the moving target, are calculated, and guidance information to the moving target is calculated. Tracking calculation unit, the steering unit that controls the steering angle when the guidance information to the moving target is input, and the moving target is obstructed by the moving target while guiding the flying object, The latitude / longitude / altitude / latitude direction velocity / longitude direction velocity / altitude direction velocity / vertical attitude angle / horizontal attitude angle, which are the position / speed information of the flying object obtained by the navigation calculation unit, are input. In the tracking calculator And the relative speed and the relative distance is a tracking information of the mobile target is inputted, latitude and a position and speed information of the moving target
A flying object guide device comprising a target existence range calculation unit that calculates the existence range of a moving target by back-calculating the longitude, altitude, latitude direction speed, longitude direction speed, and altitude direction speed.
た上記移動目標の存在範囲を逸脱した場合に、上記目標
存在範囲計算部で得た上記逆算した移動目標の位置・速
度情報である緯度・経度・高度・緯度方向速度・経度方
向速度・高度方向速度が入力され、移動目標を見失った
時点から現時点までの移動目標の移動成分である緯度方
向移動成分・経度方向移動成分・高度方向移動成分を算
出し、移動目標の存在範囲を算出する移動成分計算部を
備えたことを特徴とする請求項1記載の飛しょう体誘導
装置。2. The position / velocity information of the back-calculated moving target obtained by the target existing range calculating unit when the moving target deviates from the existing range of the moving target obtained by the target existing range calculating unit. Latitude / longitude / altitude / latitude direction velocity / longitude direction velocity / altitude direction velocity is entered, and the movement component of the movement target from the time when the movement target is lost to the present time is the latitude direction movement component / longitude direction movement component / altitude direction The flying object guiding apparatus according to claim 1, further comprising a moving component calculating unit that calculates a moving component and calculates a range in which a moving target exists.
の移動目標から妨害を受けて誘導対象の移動目標を見失
った場合に、上記航法計算部で得た複数の上記移動目標
の位置・速度情報であるそれぞれの緯度・経度・高度・
緯度方向速度・経度方向速度・高度方向速度が入力さ
れ、上記目標存在範囲計算部で得た上記逆算した移動目
標の位置・速度情報である緯度・経度・高度・緯度方向
速度・経度方向速度・高度方向速度が入力され、複数の
移動目標の位置・速度情報であるそれぞれの緯度・経度
・高度・緯度方向速度・経度方向速度・高度方向速度
と、逆算した移動目標の位置・速度情報である緯度・経
度・高度・緯度方向速度・経度方向速度・高度方向速度
の差分を取り、複数の移動目標の中でどの目標が1番差
分が少ないか照合し、1番差分が少ない移動目標の位置
・速度情報である緯度・経度・高度・緯度方向速度・経
度方向速度・高度方向速度と、逆算した移動目標の位置
・速度情報である緯度・経度・高度・緯度方向速度・経
度方向速度・高度方向速度の平均値を取って誘導対象の
移動目標の位置・速度情報である緯度・経度・高度・緯
度方向速度・経度方向速度・高度方向速度として確定
し、2番目に差分が少ない移動目標の位置・速度情報で
ある緯度・経度・高度・緯度方向速度・経度方向速度・
高度方向速度と、確定した誘導対象の移動目標の位置・
速度情報である緯度・経度・高度・緯度方向速度・経度
方向速度・高度方向速度の差分を取り、差分を越えない
範囲を誘導対象の移動目標の存在範囲とする目標照合確
定部を備えたことを特徴とする請求項1記載の飛しょう
体誘導装置。3. When there are a plurality of moving targets, and when the moving target of the guidance target is lost due to interference from the moving target of the guidance target, the positions of the plurality of moving targets obtained by the navigation calculation unit are calculated. Each latitude, longitude, altitude, which is speed information
Latitude / longitude / altitude / latitude / latitude / longitude / speed, which is the back-calculated position / speed information of the moving target obtained by the target existence range calculation unit, when latitude / longitude / altitude speed is input. The altitude direction speed is input, and it is the position / speed information of each moving target, which is the latitude / longitude / altitude / latitude direction speed / longitude direction speed / altitude direction speed, which is the position / speed information of multiple moving targets. The difference of latitude / longitude / altitude / latitude direction velocity / longitude direction velocity / altitude direction velocity is calculated, and which of the multiple movement targets has the smallest difference, the position of the movement target with the smallest difference・ Latitude, longitude, altitude, latitude direction speed, longitude direction speed, altitude direction speed, which is speed information, and the position of the moving target that has been calculated backward, latitude, longitude, altitude, latitude direction speed, longitude direction speed, altitude direction The average of the degrees is determined to determine the position / velocity information of the moving target to be guided as latitude / longitude / altitude / latitude direction velocity / longitude direction velocity / altitude direction velocity, and the position of the moving target with the second smallest difference・ Latitude, longitude, altitude, latitude speed, longitude speed, which is speed information
The altitude direction speed and the position of the fixed target movement target
It has a target matching confirmation unit that takes the difference of latitude / longitude / altitude / latitude direction latitude / longitude direction velocity / altitude direction velocity, which is the speed information, and sets the range that does not exceed the difference as the existence range of the moving target to be guided. The flying body guiding apparatus according to claim 1, wherein:
の移動目標が上記目標照合確定部で得た上記移動目標の
存在範囲を逸脱した場合に、上記航法計算部で得た複数
の上記移動目標の位置・速度情報であるそれぞれの緯度
・経度・高度・緯度方向速度・経度方向速度・高度方向
速度が入力され、上記目標照合確定部で得た確定した誘
導対象の移動目標の位置・速度情報である緯度・経度・
高度・緯度方向速度・経度方向速度・高度方向速度が入
力され、誘導対象の移動目標を見失った時点から現時点
までの誘導対象の移動目標の位置・速度情報である予測
緯度・予測経度・予測高度・予測緯度方向速度・予測経
度方向速度・予測高度方向速度を算出し、複数の移動目
標の位置・速度情報であるそれぞれの緯度・経度・高度
・緯度方向速度・経度方向速度・高度方向速度と、誘導
対象の移動目標の位置・速度情報である予測緯度・予測
経度・予測高度・予測緯度方向速度・予測経度方向速度
・予測高度方向速度の差分を取り、差分を越えない範囲
を誘導対象の移動目標の存在範囲とする誘導対象目標存
在範囲計算部を備えたことを特徴とする請求項1記載の
飛しょう体誘導装置。4. When there are a plurality of moving targets, and when the moving target to be guided deviates from the range of existence of the moving target obtained by the target collation confirming unit, the plurality of the navigation targets obtained by the navigation calculating unit are obtained. The latitude / longitude / altitude / latitude direction velocity / longitude direction velocity / altitude direction velocity, which is the position / velocity information of the moving target, is input, and the position of the determined moving target of the guidance target obtained by the target matching confirmation unit Latitude, longitude, which is speed information
The altitude, latitude direction speed, longitude direction speed, and altitude direction speed are input, and the predicted latitude, predicted longitude, and predicted altitude are the position and speed information of the guidance target movement target from the time when the guidance target movement target is lost.・ Calculates the predicted latitude direction speed, predicted longitude direction speed, and predicted altitude direction speed, and calculates the latitude / longitude / altitude / latitude direction speed / longitude direction speed / altitude direction speed for each position / speed information of multiple moving targets. , The difference of predicted latitude, predicted longitude, predicted altitude, predicted latitude direction speed, predicted longitude direction speed, predicted altitude direction speed, which is the position / speed information of the movement target of the guidance target, is taken, and the range which does not exceed the difference The flying object guiding apparatus according to claim 1, further comprising a guidance target target existing range calculation unit that sets a moving target existing range.
で、移動目標から妨害を受けて移動目標を見失った場合
に、上記航法計算部で得た上記飛しょう体の位置・速度
情報である緯度・経度・高度・緯度方向速度・経度方向
速度・高度方向速度・垂直方向姿勢角・水平方向姿勢角
が入力され、上記追尾計算部で得た上記移動目標の追尾
情報である相対速度・相対距離が入力され、移動目標の
位置・速度情報である予測緯度・予測経度・予測高度・
予測緯度方向速度・予測経度方向速度・予測高度方向速
度を算出し、移動目標の追尾情報である予測相対速度・
予測角度・予測相対距離を算出する目標予測計算部を備
えたことを特徴とする請求項1記載の飛しょう体誘導装
置。5. When the relative distance to the moving target is short and the moving target is lost due to interference from the moving target, the position / speed information of the flying object obtained by the navigation calculation unit is used. A certain latitude / longitude / altitude / latitude direction speed / longitude direction speed / altitude direction speed / vertical attitude angle / horizontal attitude angle is input, and the relative speed is the tracking information of the moving target obtained by the tracking calculation unit. The relative distance is entered, and the predicted latitude, predicted longitude, predicted altitude, and
Predicted latitude direction speed, predicted longitude direction speed, and predicted altitude direction speed are calculated, and the predicted relative speed, which is the tracking information of the moving target,
The flying vehicle guide apparatus according to claim 1, further comprising a target prediction calculation unit that calculates a predicted angle and a predicted relative distance.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2001308735A JP2003114098A (en) | 2001-10-04 | 2001-10-04 | Missile guiding device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2001308735A JP2003114098A (en) | 2001-10-04 | 2001-10-04 | Missile guiding device |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2003114098A true JP2003114098A (en) | 2003-04-18 |
Family
ID=19127995
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2001308735A Pending JP2003114098A (en) | 2001-10-04 | 2001-10-04 | Missile guiding device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2003114098A (en) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006275631A (en) * | 2005-03-28 | 2006-10-12 | Mitsubishi Electric Corp | Infrared guide system |
CN112213719A (en) * | 2020-09-21 | 2021-01-12 | 南京航空航天大学 | Millimeter wave radar rotating device and target tracking method thereof |
-
2001
- 2001-10-04 JP JP2001308735A patent/JP2003114098A/en active Pending
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006275631A (en) * | 2005-03-28 | 2006-10-12 | Mitsubishi Electric Corp | Infrared guide system |
JP4675659B2 (en) * | 2005-03-28 | 2011-04-27 | 三菱電機株式会社 | Infrared induction device |
CN112213719A (en) * | 2020-09-21 | 2021-01-12 | 南京航空航天大学 | Millimeter wave radar rotating device and target tracking method thereof |
CN112213719B (en) * | 2020-09-21 | 2023-09-26 | 南京航空航天大学 | Millimeter wave radar rotating device and target tracking method thereof |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10145690B2 (en) | Map information generation system, method, and program | |
US9410808B2 (en) | Apparatus and method for detecting location information using navigation algorithm | |
US6529821B2 (en) | Route planner with area avoidance capability | |
EP1899778B1 (en) | Method and system for automatically guiding an unmanned vehicle | |
KR101622260B1 (en) | Impact time control guidance method and device | |
KR102182511B1 (en) | Apparatus and method for spoofing unmanned moving object using global navigation satellite system | |
CN104019818A (en) | Layout optimization method of planet navigation orbiter based on prediction track | |
CN106885568A (en) | Unmanned Aerial Vehicle Data treating method and apparatus | |
US20230205234A1 (en) | Information processing device, information processing system, method, and program | |
CN108268960A (en) | Driving locus optimization system | |
CN111409865B (en) | Deep space probe approach segment guidance method based on intersection probability | |
CN112445230B (en) | High-dynamic aircraft multi-mode guidance system and guidance method under large-span complex environment | |
CN110471455B (en) | Black box acoustic beacon search and exploration route planning method based on deep submergence vehicle | |
JP2003114098A (en) | Missile guiding device | |
RU2585204C1 (en) | Method of controlling aircraft when approaching navigation point from given direction | |
CN114217639B (en) | Guiding method and system for traversing visual target point based on unmanned aerial vehicle specified course | |
JP2006284120A (en) | Flying object guidance system | |
JP2014157052A (en) | Navigation device, control method of navigation device, and control program of navigation device | |
WO1995016184A1 (en) | Apparatus for determining position of moving body | |
KR102252826B1 (en) | Device for estimating line of sight rate using acceleration of sight angle and air vehicle including the same | |
KR102252825B1 (en) | Device for estimating line of sight rate by compensating for time delay of directivity angle and air vehicle including the same | |
KR102239699B1 (en) | Guidance system and method for continuous curvature path following | |
KR101987413B1 (en) | System and method for positioning | |
KR20150112294A (en) | Velocity profile generating device and method for generating the same | |
JP2600503Y2 (en) | Aircraft automatic landing gear |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
RD01 | Notification of change of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7421 Effective date: 20040706 |