KR20190001832A - Inertial navigation system with adaptive time delay compensation and rapid initial alignment method thereof - Google Patents

Inertial navigation system with adaptive time delay compensation and rapid initial alignment method thereof Download PDF

Info

Publication number
KR20190001832A
KR20190001832A KR1020170081984A KR20170081984A KR20190001832A KR 20190001832 A KR20190001832 A KR 20190001832A KR 1020170081984 A KR1020170081984 A KR 1020170081984A KR 20170081984 A KR20170081984 A KR 20170081984A KR 20190001832 A KR20190001832 A KR 20190001832A
Authority
KR
South Korea
Prior art keywords
time delay
sins
mins
alignment
navigation data
Prior art date
Application number
KR1020170081984A
Other languages
Korean (ko)
Other versions
KR101990405B1 (en
Inventor
이형섭
한경준
이상우
유명종
Original Assignee
국방과학연구소
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 국방과학연구소 filed Critical 국방과학연구소
Priority to KR1020170081984A priority Critical patent/KR101990405B1/en
Publication of KR20190001832A publication Critical patent/KR20190001832A/en
Application granted granted Critical
Publication of KR101990405B1 publication Critical patent/KR101990405B1/en

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/18Stabilised platforms, e.g. by gyroscope
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/183Compensation of inertial measurements, e.g. for temperature effects
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01DMEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
    • G01D1/00Measuring arrangements giving results other than momentary value of variable, of general application
    • G01D1/04Measuring arrangements giving results other than momentary value of variable, of general application giving integrated values

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Navigation (AREA)

Abstract

The present invention relates to an inertial navigation system with an adaptive time delay compensation function, capable of quickly and precisely attaining initial alignment in a movable platform without launching elevation limit, and a rapid initial alignment method thereof. According to the present invention, the rapid initial alignment method comprises: a step of loading a flying object on a launcher, and comparing speed and posture information between a main inertial navigation system (MINS) of the launcher and a subordinated inertial navigation system (SINS) of the flying object to estimate a misalignment angle and time delay between the MINS and the SINS; a step of storing the estimated misalignment angle and time delay; and a step of performing mixed alignment, which performs re-transfer alignment based on the stored misalignment angle and time delay to re-estimate the misalignment angle and time delay of the SINS changed by an internal gap of the launcher, to perform the initial alignment of the flying object. The initial alignment of the flying object having a concept of consecutive launching operation is able to be quickly and precisely performed in the movable platform.

Description

시간지연 적응 보상기능을 갖는 관성항법장치 및 그의 급속 초기정렬 방법 {INERTIAL NAVIGATION SYSTEM WITH ADAPTIVE TIME DELAY COMPENSATION AND RAPID INITIAL ALIGNMENT METHOD THEREOF}TECHNICAL FIELD [0001] The present invention relates to an inertial navigation apparatus having a time delay adaptive compensation function, and a rapid initial alignment method thereof. BACKGROUND OF THE INVENTION < RTI ID = 0.0 >

본 발명은 기동 플랫폼에서 발사고각 제한 없이 신속하고 정밀하게 초기정렬을 달성할 수 있는 관성항법장치 및 그의 급속 초기정렬방법에 관한 것이다. The present invention relates to an inertial navigation device and its rapid initial alignment method capable of achieving initial alignment quickly and precisely without launch angle limitation in a launch platform.

관성 항법 장치는 비행기, 배, 자동차, 탄 등 항체(vehicle)의 항법정보인 위치, 속도 및 자세 정보를 얻기 위해 사용하는 장치로서, 가속도계와 자이로스코프로부터 각각 측정된 가속도 및 각속도 정보를 토대로 실시간으로 항법 방정식을 적분하여 위치, 속도 및 자세를 계산한다. 관성 항법 장치는 적분형 시스템으로 시간이 경과 할수록 오차가 누적되기 때문에 정확한 위치, 속도 및 자세를 계산하기 위해서는 정확한 초기 위치, 속도 및 자세가 요구되며, 이때 초기 자세를 결정하는 과정을 초기정렬이라 한다.The inertial navigation system is a device used to obtain position, speed and attitude information, which is navigation information of an aircraft such as an airplane, a ship, a car, and a bullet. The inertial navigation system is a real-time navigation system based on acceleration and angular velocity information measured from an accelerometer and a gyroscope Integrate the navigation equation to calculate position, velocity and posture. Since the inertial navigation system is an integral system, errors accumulate as time passes. Therefore, to calculate accurate position, velocity, and posture, accurate initial position, velocity, and posture are required. .

일반적으로 초기정렬은 항법장치의 가속도계 및 자이로스코프의 출력을 이용하여 직접 자세를 계산하는 자체정렬과, 정밀도가 높은 주 관성 항법장치(MINS, Master Inertial Navigation System)의 자세를 제공받아 상대적으로 정밀도가 낮은 종 관성 항법장치(SINS, Salve Inertial Navigation System)의 정렬을 수행하는 전달정렬이 있다. In general, the initial alignment is based on a self-alignment to calculate the direct posture using the accelerometer and gyroscope output of the navigation system, and a posture of a highly accurate Master Inertial Navigation System (MINS). There is a transfer alignment that performs alignment of a low inertial navigation system (SINS).

기동 플랫폼에서 연속발사 운용개념을 갖은 항체의 초기정렬을 위해서는 신속성 및 정확성이 동시에 요구된다. 자체정렬의 경우는 정밀한 초기정렬이 가능하지만 정밀 정확도 달성을 위해 많은 시간이 소요되기 때문에 파이로충격(Pyro-shock)에 의해 비정렬각이 변하는 경우 신속한 재정렬이 어렵다. The initial alignment of the antibody with the concept of continuous firing operation in the maneuvering platform requires both promptness and accuracy. In the case of self-alignment, precise initial alignment is possible, but since it takes a long time to achieve accurate accuracy, it is difficult to re-arrange quickly if the un-alignment angle changes due to pyro shock.

반면에, 전달정렬의 일종으로 MINS의 자세를 한순간만 이용하는 원샷(One-shot) 정렬의 경우는 필터를 이용하지 않고, 주 관성 항법장치(MINS)의 자세를 직접 종 관성 항법장치(SINS)의 자세로 사용하므로 신속한 정렬이 가능하다. 하지만, MINS와 SINS 사이의 비정렬각이 오차로 작용하기 때문에 정밀 정확도를 달성하기는 어렵다. On the other hand, in the case of one-shot alignment using MINS attitude as a sort of transfer alignment, the attitude of the main navigation system (MINS) It is used in posture, so it is possible to arrange quickly. However, it is difficult to achieve precise accuracy because the misalignment angle between MINS and SINS acts as an error.

상기와 같은 문제를 보완한 방법으로 급속 원샷 정렬기법이 있다. 이 방법은 가속도계 출력을 이용하여 수평 및 수직 비정렬각을 찾는 방법이다. 그런데 이 방법은 수직 비정렬각을 찾기 위해 90도의 피치각이 요구되어 수직 발사대에만 적용가능하고 가속도계 출력을 이용하기 때문에 정지 플랫폼에는 적용 가능하지만 기동 플렛폼에 적용하기에는 무리가 있다. A quick one-shot sorting method is a method to overcome the above problem. This method uses a accelerometer output to find horizontal and vertical non-alignment angles. However, this method is applicable to stationary platforms because it requires a 90 ° pitch angle to find the vertical unassisted angles and is applicable only to vertical launchers and uses accelerometer output, but it is not applicable to mobile platforms.

상기와 같은 문제를 보완하기 위한 또 다른 방법으로 신속 초기정렬이 있다. 이 방법은 전달정렬을 이용하여 수직 비정렬각을 찾기 때문에 고각구동 제한 없이 정렬을 수행할 수 있는 이점이 있다. 하지만 이 방법 역시 가속도계 측정값을 이용하여 수평 비정렬각을 찾기 때문에 기동 플랫폼에서 정밀 정확도를 달성하기 어려운 실정이다. Another method to overcome the above problem is rapid initial alignment. This method has the advantage of being able to perform the alignment without the elevation drive limit because it uses the transfer alignment to find the vertical non-alignment angle. However, this method also finds the horizontal unaligned angle using the accelerometer measurement value, so it is difficult to achieve accurate accuracy in the launch platform.

본 발명의 일 목적은 기동 플랫폼에서 발사고각 제한 없이 신속하고 정밀하게 초기정렬을 수행할 수 있는 관성 항법장치 및 그의 급속 초기정렬 방법을 제공하는데 있다. It is an object of the present invention to provide an inertial navigation device and its rapid initial alignment method capable of performing initial alignment quickly and precisely without launch angle limitation in a launch platform.

본 발명의 다른 목적은 사전전달정렬을 통해 추정된 시간 지연값 변화와 시간지연에 존재하는 지터링(jittering)을 보상할 수 있는 관성 항법장치 및 그의 급속 초기정렬 방법을 제공하는데 있다. It is another object of the present invention to provide an inertial navigation device and its rapid initial alignment method capable of compensating jittering present in time delay variation and time delay value estimated through pre-transfer alignment.

상기와 같은 목적을 달성하기 위하여 본 발명의 실시예에 따른 관성항법장치는, 기동 플랫폼에서 연속발사 운용개념을 갖은 항체의 초기정렬을 수행하는 관성항법장치에 있어서, 발사대에 장착된 주 관성 항법장치(MINS); 및 (a)발사대의 항체내에 장착되며, 주 관성 항법장치(MINS)의 속도 및 자세정보를 비교하여 MINS와 SINS사이의 비정렬각과 시간지연을 추정하는 사전전달정렬을 수행하고, (b) 상기 추정된 비정렬각과 시간지연을 재전달정렬을 수행하여 발사대 내부 유격에 의해 변화되는 SINS의 비정렬각 및 시간 지연을 재추정하는 혼합정렬을 수행함에 의해 항체의 초기정렬을 수행하는 종 관성 항법장치(SINS);를 포함한다. According to an aspect of the present invention, there is provided an inertial navigation apparatus for performing initial alignment of an antibody having a concept of continuous firing operation in a maneuver platform, (MINS); And (a) performing a pre-transfer alignment to estimate the un-alignment angle and time delay between MINS and SINS by comparing the speed and attitude information of the main inertial navigation system (MINS) mounted in the antibody of the launch pad, and (b) A longitudinal inertial navigation system that performs initial sorting of the antibody by performing mixed sorting to reorder the unassociated angles and time delays of SINS, SINS).

본 발명의 실시예에 따라 상기 종 관성 항법장치(SINS)는 혼합정렬 수행시 상기 저장된 X축, Y축, Z축 비정렬각 중에서 X축과 Y축 비정렬각은 재추정하고 Z축 비정렬각은 유지하며, 상기 저장된 시간지연은 10ms 단위로 변화를 재추정할 수 있다. According to an embodiment of the present invention, the longitudinal inertial navigation apparatus (SINS) re-estimates the X-axis and Y-axis unassisted angles among the stored X-axis, Y-axis, and Z- And the stored time delay can be re-estimated in units of 10ms.

본 발명의 실시예에 따라 상기 종 관성 항법장치(SINS)는 혼합정렬 수행 시 사전전달정렬을 통해 추정한 시간 지연값이 변하거나 시간지연에 지터링이 존재하는 경우 시간지연 변화와 지터링에 의한 시각동기 오차를 감소시키기 위하여 시간지연 보상을 수행할 수 있다. In accordance with an embodiment of the present invention, the longitudinal inertial navigation apparatus (SINS) may be configured to change the time delay value estimated through pre-transfer sorting in the mixed alignment operation or to change the time delay by jittering Time delay compensation can be performed to reduce the time synchronization error.

본 발명의 실시예에 따라 상기 종 관성 항법장치(SINS)는 SINS의 속도증분과 각도증분을 이용하여 항법을 수행하여 SINS의 항법 데이터를 이동 버퍼에 순차 저장하고, 사전전달정렬을 통해 구한 MINS와 SINS간의 비정렬각 및 시간지연을 근거로 상기 이동 버퍼에 저장된 항법 데이터중에서 MINS의 항법 데이터와 시각동기가 일치하는 제1항법 데이터 및 그와 이웃하는 복수의 항법 데이타를 샘플링하며, 상기 샘플링된 제1항법 데이타를 이용하여 칼만필터에 대한 시간 전파를 수행하고 MINS로부터 각속도를 포함하는 항법 데이타를 수신하여, 상기 수신된 각속도에 따라 시간지연 보상여부를 결정하여 시간지연 변화와 지터링에 의한 시각동기 오차를 감소시킬 수 있다. According to an embodiment of the present invention, the longitudinal inertial navigation apparatus (SINS) performs navigation using the speed increment and angle increment of SINS, sequentially stores the navigation data of the SINS in the moving buffer, Sampling the first navigation data and the neighboring navigation data having the same time synchronization with the navigation data of the MINS among the navigation data stored in the movement buffer based on the un-alignment angle and the time delay between the SINSs, Time navigation of the Kalman filter is performed using the navigation data and the navigation data including the angular velocity is received from the MINS to determine whether to compensate for the time lag according to the received angular velocity, The error can be reduced.

본 발명의 실시예에 따라 상기 종 관성 항법장치(SINS)는 수신된 각속도의 RSS가 소정값 미만이면 시간지연 보상없이 제1항법 데이타와 MINS의 항법 데이타를 이용하여 칼만필터의 측정값을 생성하고, 수신된 각속도의 RSS가 소정값 이상이면 시간지연 보상을 위하여 상기 샘플링된 복수의 항법 데이타와 MINS의 항법 데이타를 이용하여 칼만필터에 대한 복수의 측정값 후보를 생성하여, 상기 생성된 복수의 칼만필터 측정값 후보중에서 RSS가 최소인 칼만필터 측정값을 선택하여 칼만필터 측정값을 갱신할 수 있다. According to an embodiment of the present invention, when the RSS of the received angular velocity is less than a predetermined value, the SINS generates measurement values of the Kalman filter using the first navigation data and the MINS navigation data without time delay compensation Generates a plurality of measurement value candidates for the Kalman filter using the sampled plurality of navigation data and the MINS navigation data for the time delay compensation when the RSS of the received angular velocity is equal to or greater than a predetermined value, The Kalman filter measurement value can be updated by selecting the Kalman filter measurement value having the minimum RSS among the filter measurement value candidates.

상기와 같은 목적을 달성하기 위하여 본 발명의 실시예에 따른 관성항법장치의 초기정렬방법은, 발사대(관)에 항체를 장착하고 발사관의 주 관성 항법장치 (MINS)와 항체내의 종 관성 항법장치(SINS)의 속도 및 자세정보를 비교하여 MINS와 SINS사이의 비정렬각과 시간지연을 추정하는 사전전달정렬을 수행하는 단계; 상기 추정된 비정렬각과 시간지연을 저장하는 단계; 및 상기 저장된 비정렬각과 시간지연을 이용하여 재전달정렬을 수행하여 발사관 내부 유격에 의해 변화되는 SINS의 비정렬각 및 시간 지연을 재추정하는 혼합정렬을 수행하여 항체의 초기정렬을 수행하는 단계;를 포함한다. In order to accomplish the above object, an initial alignment method for an inertial navigation system according to an embodiment of the present invention includes mounting an antibody on a launching platform (tube), attaching a main navigation device (MINS) Performing pre-transfer alignment for estimating an un-alignment angle and a time delay between MINS and SINS by comparing the speed and attitude information of the SINS; Storing the estimated non-alignment angle and time delay; And carrying out initial sorting of the antibody by carrying out re-delivery sorting using the stored uncombined angle and time delay to perform mixed sorting to re-estimate the unaligned angle and time delay of the SINS changed by the internal tube clearance .

본 발명의 실시예에 따라 상기 혼합정렬 수행시 상기 저장된 X축, Y축, Z축 비정렬각 중에서 X축과 Y축 비정렬각은 재추정하고 Z축 비정렬각은 유지하며, 상기 저장된 시간지연은 10ms 단위로 변화를 재추정할 수 있다.According to an embodiment of the present invention, the X-axis and Y-axis unassisted angles are re-estimated and the Z-axis unassisted angles are maintained among the stored X-, Y-, and Z- The delay can be re-estimated in 10ms increments.

본 발명의 실시예에 따라 상기 초기정렬을 수행하는 단계는 혼합정렬 수행 시 사전전달정렬을 통해 추정한 시간 지연값이 변하거나 시간지연에 지터링이 존재하는 경우 시간지연 변화와 지터링에 의한 시각동기 오차를 감소시키기 위하여 시간지연 보상을 수행하는 단계;를 포함할 수 있다.According to an exemplary embodiment of the present invention, performing the initial sorting may include a step of changing a time delay estimated by pre-transfer sorting in the case of mixed alignment, or a time delay change due to jittering And performing time delay compensation to reduce the synchronization error.

본 발명의 실시예에 따라 상기 시간지연 보상을 수행하는 단계는 SINS의 속도증분과 각도증분을 이용하여 항법을 수행하여 SINS의 항법 데이터를 이동 버퍼에 순차 저장하는 단계; 사전전달정렬을 통해 구한 MINS와 SINS간의 비정렬각 및 시간지연을 근거로 상기 이동 버퍼에 저장된 항법 데이터중에서 MINS의 항법 데이터와 시각동기가 일치하는 제1항법 데이터 및 그와 이웃하는 복수의 항법 데이타를 샘플링하는 단계; 상기 샘플링된 제1항법 데이타를 이용하여 칼만필터에 대한 시간 전파를 수행하고 MINS로부터 각속도를 포함하는 항법 데이타를 수신하는 단계; 및 상기 수신된 각속도에 따라 시간지연 보상여부를 결정하여 시간지연 변화와 지터링에 의한 시각동기 오차를 감소시키는 단계;를 포함할 수 있다.The step of performing time delay compensation according to an embodiment of the present invention includes the steps of performing navigation using a speed increment and an angle increment of SINS to sequentially store SINS navigation data in a moving buffer; The first navigation data in which the navigation data of the MINS coincides with the navigation data of the MINS among the navigation data stored in the movement buffer based on the un-alignment angle and the time delay between the MINS and the SINS obtained through the pre-transfer sorting and a plurality of navigation data ; ≪ / RTI > Performing time propagation for the Kalman filter using the sampled first navigation data and receiving navigation data including angular velocity from MINS; And determining whether to compensate for the time delay according to the received angular velocity, thereby reducing time delay variation and time synchronization error due to jittering.

본 발명의 실시예에 따라 상기 시각동기 오차를 감소시키는 단계는 상기 수신된 각속도의 RSS가 소정값 미만이면 시간지연 보상없이 제1항법 데이타와 MINS의 항법 데이타를 이용하여 칼만필터의 측정값을 생성하는 단계; 및 상기 수신된 각속도의 RSS가 소정값 이상이면 시간지연 보상을 위하여 상기 샘플링된 복수의 항법 데이타와 MINS의 항법 데이타를 이용하여 칼만필터에 대한 복수의 측정값 후보를 생성하는 단계; 및 상기 생성된 복수의 칼만필터 측정값 후보중에서 RSS가 최소인 칼만필터 측정값을 선택하여 칼만필터 측정값을 갱신하는 단계;를 포함할 수 있다.According to an embodiment of the present invention, the step of decreasing the time synchronization error may include generating the measured value of the Kalman filter using the first navigation data and the MINS navigation data without time delay compensation when the RSS of the received angular velocity is less than a predetermined value ; And generating a plurality of measurement value candidates for the Kalman filter using the sampled plurality of navigation data and the MINS navigation data for time delay compensation if the RSS of the received angular velocity is greater than or equal to a predetermined value; And updating the Kalman filter measurement value by selecting a Kalman filter measurement value having the minimum RSS among the plurality of generated Kalman filter measurement value candidates.

상기와 같은 실시예에 따라 본 발명은 기동 플랫폼에서 연속발사 운용개념을 갖은 항체의 급속 초기정렬을 위하여 사전전달정렬과 혼합정렬을 결합한 관성 항법 장치(시스템)의 급속 초기정렬기법을 제공함으로써 기동 플랫폼에서 발사 고각제한 없이 신속하고 정밀하게 초기정렬을 수행할 수 있는 효과가 있으며, 사전전달정렬을 통해 추정한 시간 지연값이 변하거나 시간지연에 지터링(jittering)이 존재하는 경우 시간지연 보상부를 통해 시간 지연 및 지터링을 보상함으로써 정렬오차를 감소시킬 수 있고 수렴시간을 개선시킬 수 있는 효과가 있다. According to the present invention as described above, the present invention provides a rapid initial sorting technique of an inertial navigation system (system) that combines pre-delivery sorting and mixed sorting for rapid initial sorting of antibodies having a concept of continuous firing operation in a maneuvering platform, The initial alignment can be performed quickly and precisely without limitation of the launch angle limit. If there is a change in the estimated time delay value through the pre-delivery alignment or there is jittering in the time delay, It is possible to reduce the alignment error and compensate for the convergence time by compensating the time delay and the jitter.

도 1은 본 발명에 적용되는 관성 항법 장치의 일부 구성도.
도 2는 본 발명의 실시예에 따른 관성 항법 장치의 급속 초기정렬방법의 수행순서를 나타낸 흐름도.
도 3은 본 발명의 실시예에 따른 혼합정렬 수행시 시간지연을 적응적으로 보상하는 방법의 흐름도.
도 4는 순수 항법으로 계산된 후 이동 버퍼에 저장되는 SINS의 항법 데이타를 나타낸 실시예.
도 5는 이동 버퍼에 저장된 항법 데이타 중에서 MINS의 항법 데이터와 시각동기가 근접하는 복수의 항법 데이터를 샘플링하는 방법을 나타낸 실시예.
도 6은 입력 각속도에 따라 시간지연 보상여부를 결정하여 샘플링된 복수의 항법데이터를 선택적으로 적용하는 동작을 나타낸 흐름도.
BRIEF DESCRIPTION OF THE DRAWINGS Fig. 1 is a partial schematic view of an inertial navigation system applied to the present invention; Fig.
FIG. 2 is a flowchart illustrating a procedure for performing a rapid initial alignment method of an inertial navigation system according to an embodiment of the present invention; FIG.
3 is a flow diagram of a method for adaptively compensating for time delay in performing mixed alignment in accordance with an embodiment of the present invention.
FIG. 4 shows an example of navigation data of SINS stored in a moving buffer after being calculated by pure navigation.
5 is a view showing a method of sampling a plurality of navigation data in which MINS navigation data and time synchronization are close to each other among navigation data stored in a moving buffer.
6 is a flowchart illustrating an operation of determining whether to compensate for time delay according to an input angular velocity and selectively applying a plurality of sampled navigation data.

이하 첨부된 도면들을 참조하여 본 발명의 바람직한 실시예를 설명한다.DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS Hereinafter, preferred embodiments of the present invention will be described with reference to the accompanying drawings.

이하의 설명에서 사용되는 구성요소에 대한 접미사 "모듈" 및 "부"는 명세서 작성의 용이함만이 고려되어 부여되거나 혼용되는 것으로서, 그 자체로 서로 구별되는 의미 또는 역할을 갖는 것은 아니다. The suffix "module" and " part "for the components used in the following description are given or mixed in consideration of ease of specification, and do not have their own meaning or role.

본 명세서에서 제1, 제2 등과 같이 서수를 포함하는 용어는 다양한 구성요소들을 설명하는데 사용될 수 있지만, 상기 구성요소들은 상기 용어들에 의해 한정되지는 않는다. 상기 용어들은 하나의 구성요소를 다른 구성요소로부터 구별하는 목적으로만 사용된다. 이에 더하여 단수의 표현은 문맥상 명백하게 다르게 뜻하지 않는 한, 복수의 표현을 포함한다. Although the terms including ordinals such as first, second, etc. in this specification can be used to describe various elements, the elements are not limited by the terms. The terms are used only for the purpose of distinguishing one component from another. In addition, the singular forms "a," "an," and "the" include plural referents unless the context clearly dictates otherwise.

본 명세서에서 어떤 부분이 어떤 구성요소를 "포함"한다고 할 때, 이는 특별히 반대되는 기재가 없는 한 다른 구성요소를 더 포함할 수 있는 것을 의미한다.Whenever a component is referred to as "including" an element herein, it is to be understood that it may include other elements, unless the context otherwise requires.

또한, 본 명세서에 개시된 실시 예를 설명함에 있어서 관련된 공지 기술에 대한 구체적인 설명이 본 명세서에 개시된 실시 예의 요지를 흐릴 수 있다고 판단되는 경우 그 상세한 설명을 생략한다. 또한, 첨부된 도면은 본 명세서에 개시된 실시 예를 쉽게 이해할 수 있도록 하기 위한 것일 뿐, 첨부된 도면에 의해 본 명세서에 개시된 기술적 사상이 제한되지 않으며, 본 발명의 사상 및 기술 범위에 포함되는 모든 변경, 균등물 내지 대체물을 포함하는 것으로 이해되어야 한다. In the following description of the embodiments of the present invention, a detailed description of related arts will be omitted when it is determined that the gist of the embodiments disclosed herein may be blurred. It is to be understood that both the foregoing general description and the following detailed description are exemplary and explanatory and are intended to provide further explanation of the invention as claimed. , ≪ / RTI > equivalents, and alternatives.

본 발명은 기동 플랫폼에서 발사 고각제한 없이 신속하고 정밀하게 초기정렬을 달성하기 위하여, 특히 기동 플랫폼에서 연속발사 운용개념을 갖은 항체의 급속 초기정렬을 위하여 사전전달정렬과 혼합정렬을 결합한 관성 항법 장치(시스템)의 급속 초기정렬기법을 제안한다. 이에 더하여 본 발명은 사전정렬을 통해 추정한 시간 지연값이 변하거나 시간지연에 지터링(jittering)이 존재하는 경우 정렬오차를 줄일 수 있는 시간지연 보상기법을 제안한다. The present invention relates to an inertial navigation device which combines pre-delivery alignment and mixed alignment for rapid initial alignment of antibodies with a concept of continuous firing operation in a maneuvering platform, in order to achieve quick and precise initial alignment in a maneuvering platform, System). In addition, the present invention proposes a time delay compensation scheme that can reduce the alignment error when the time delay value estimated through the pre-sorting changes or jittering occurs in the time delay.

도 1은 본 발명에 적용되는 관성 항법 장치의 일부 구성도이다. 1 is a schematic view of an inertial navigation system applied to the present invention.

도 1을 참조하면, 발사대(관)에 장착된 항체(e.g.,탄) 안에는 종 관성 항법장치(SINS)(100)가 있으며, 상기 항체 외부의 발사대에는 정밀 항법장치인 주 관성 항법장치(MINS)(200)가 있다. 이와 같은 장치(시스템)에서는 MINS(200)에서 제공하는 속도 및 자세를 전달행렬의 측정치로 사용하여 항체 내에 있는 SINS(100)의 초기자세를 구하게 된다. 본 발명에서 제시된 초기정렬 방법은 사전전달정렬과 혼합정렬을 결합하였으며 내용은 아래와 같다. Referring to FIG. 1, there is a longitudinal inertial navigation system (SINS) 100 in an antibody (eg, tan) mounted on a launching platform (tube), and a main navigation system (MINS) (200). In such an apparatus (system), the initial posture of the SINS 100 in the antibody is obtained using the velocity and attitude provided by the MINS 200 as a measurement value of the transfer matrix. The initial alignment method proposed in the present invention combines pre-transfer alignment and mixed alignment, and the contents are as follows.

1. 사전전달정렬기법1. Pre-delivery sorting technique

사전전달정렬 기법은 정렬시간단축을 위해 MINS와 SINS의 비정렬각 및 시간지연을 미리 찾는 것이다. 여기서 시간지연은 MINS의 정보가 통신에 의해 전달정렬 필터가 동작하는 SINS까지 전송되는데 소요되는 시간이다. 이를 위하여 본 발명은 기준이 되는 MINS(200)의 관성측정 정보를 SINS(100)의 관성측정 정보(항법정보)와 연속적으로 비교하고, 칼만필터를 통해 SINS(100)의 자세를 추정하는 전달정렬 방법을 사용한다. 이 방법은 시간이 수 십초 이상 소요되기 때문에 발사대에 항체(e.g., 탄)를 장착 후 1회 수행한다. The pre-delivery sorting technique is to find out the un-alignment angle and the time delay of MINS and SINS in order to shorten the sorting time. Here, the time delay is the time required for the MINS information to be transmitted to the SINS in which the forwarding sort filter is operated by communication. In order to achieve this, the present invention continuously compares the inertia measurement information of the MINS 200, which is a reference, with the inertia measurement information (navigation information) of the SINS 100, Method. Since this method takes more than a few tens of seconds, mount the antibody (eg, carbon) on the launch pad and perform it once.

전달정렬에 사용되는 항법정보는 가속도, 각속도, 속도 및 자세 정보 등이 있으며 일반적으로 가관측성이 우수한 속도 및 자세정합 전달정렬 방법이 많이 사용된다. 속도 및 자세정합 전달정렬 방법은 MINS와 SINS의 속도 및 자세정보를 이용하여 MINS와 SINS사이의 장착 비정렬각을 추정함으로써 SINS의 초기 자세를 추정하는 방법이다. 상기 속도 및 자세정합 전달정렬의 시스템 모델은 수학식 1과 같이 나타낼 수 있으며, 상태변수는 10차로 속도(3), 자세(3), 비정렬각(3) 및 시간지연(1)로 구성된다. The navigation information used in the forward alignment includes acceleration, angular velocity, speed and attitude information, and speed and attitude alignment alignment methods are generally used, which have excellent visibility. The velocity and posture matching transfer alignment method is a method of estimating the initial posture of SINS by estimating the mounting non-alignment angle between MINS and SINS using MINS and SINS speed and attitude information. The system model of the velocity and posture matching transfer alignment can be expressed as Equation 1 and the state variable is composed of 10th order speed (3), posture (3), unassociated angle (3) and time delay (1) .

[수학식 1][Equation 1]

Figure pat00001
Figure pat00001

여기서

Figure pat00002
,
Figure pat00003
은 항법좌표계의 속도 오차와 자세 오차,
Figure pat00004
는 장착 비정렬각 오차,
Figure pat00005
는 MINS에서 SINS로의 시간지연 오차이다. here
Figure pat00002
,
Figure pat00003
The velocity error and the attitude error of the navigation coordinate system,
Figure pat00004
Mounting error,
Figure pat00005
Is the time delay error from MINS to SINS.

속도 및 자세정합 전달정렬의 성능은 MINS와 SINS가 장착되어 있는 항체의 속도 및 자세운동에 의해 결정된다. 따라서, 속도 및 자세정합 전달정렬 방법에서 측정치로 사용되는 정보는 속도 및 자세이고, 추정기로 칼만필터를 사용하며, 속도정합에 사용되는 속도는 항법좌표계에서의 속도를 사용한다. 상기 속도 및 자세정합 전달정렬 방법에서 자세정합으로는 오일러(Euler)각 자세정합, 쿼터니언(Quaternion) 자세정합 및 DCM((Direction Cosine Matrix) 자세정합 방법 등이 있으며, 상기 방법 중에서 수렴성능이 상대적으로 좋은 DCM 자세정합 방식이 주로 사용된다. 속도 및 자세정합 전달정렬에서 칼만필터의 측정치는 SINS 와 MINS의 속도 차 및 SINS와 MINS의 자세 차로 구성되며, 측정 방정식은 각각 아래의 수학식 2 및 수학식 4에 도시되어 있다. The performance of the velocity and posture matching delivery alignment is determined by the velocity and attitude motion of the antibody with MINS and SINS. Therefore, the information used as a measurement in the velocity and posture matching transfer alignment method is velocity and attitude, and Kalman filter is used as an estimator. The velocity used in the velocity matching uses the velocity in the navigation coordinate system. In the speed and posture matching transfer alignment method, there are Euler posture matching, Quaternion posture matching, and DCM (Direction Cosine Matrix) posture matching methods as the posture matching. Among these methods, The measured values of the Kalman filter in the velocity and attitude matching transfer arrangements are composed of the speed difference between SINS and MINS and the attitude difference between SINS and MINS, and the measurement equations are expressed by the following equations (2) and 4.

[수학식 2]&Quot; (2) "

Figure pat00006
Figure pat00006

[수학식 3]&Quot; (3) "

Figure pat00007
Figure pat00007

여기서 는 SINS의 속도,

Figure pat00009
는 MINS 속도,
Figure pat00010
는 지렛대 효과에 의한 속도,
Figure pat00011
는 MINS와 SINS간의 속도 차이며
Figure pat00012
은 MINS 속도의 미분값 그리고
Figure pat00013
는 속도측정잡음이다. here The speed of SINS,
Figure pat00009
MINS speed,
Figure pat00010
The speed due to the lever effect,
Figure pat00011
Is the speed difference between MINS and SINS
Figure pat00012
Is the derivative of the MINS velocity and
Figure pat00013
Is the velocity measurement noise.

[수학식 4]&Quot; (4) "

Figure pat00014
Figure pat00014

여기서

Figure pat00015
는 시간지연 오차에 의한 자세변환 벡터,
Figure pat00016
은 SINS의 자세변환행렬(DCM),
Figure pat00017
은 MINS의 자세 변환행렬(DCM)의 전치행렬,
Figure pat00018
는 칼만필터에서 추정한 장착 비정렬각을 자세변환행렬(DCM)로 변환한 값, 그리고
Figure pat00019
은 자세측정잡음이다. 상기 수학식 3과 수학식 4의 측정 방정식을 정리하면 수학식 5와 같이 나타낼 수 있다. here
Figure pat00015
Is an attitude conversion vector due to a time delay error,
Figure pat00016
(DCM) of the SINS,
Figure pat00017
Is the transposition matrix of the attitude conversion matrix (DCM) of the MINS,
Figure pat00018
Is a value obtained by converting a mounting unassisted angle estimated by the Kalman filter to an attitude conversion matrix (DCM), and
Figure pat00019
Is the attitude measurement noise. The measurement equations of Equations (3) and (4) can be summarized as Equation (5).

[수학식 5] &Quot; (5) "

Figure pat00020
Figure pat00020

여기서, here,

Figure pat00021
이다.
Figure pat00021
to be.

2. 혼합정렬기법2. Mixed alignment technique

사전전달정렬을 통해 찾은 비정렬각이 발사 플랫폼의 고기동 또는 발사충격에 의해 변하게 되면 정렬오차가 증가하게 되기 때문에 발사 전 재정렬이 필요하다. 기존의 가속도계 출력을 이용하여 재정렬하는 방법은 기동 플랫폼과 같이 진동이 발생하고 가속도가 변하는 경우에는 적용할 수 없다. 전달정렬기법의 경우 기동 중에 수행 가능하지만 방위각 오차를 추정하기 위해 수 십초의 시간이 소요되기 때문에 수초 내에 정렬을 완료할 수 없다. 따라서, 본 발명은 전달정렬을 이용한 재 정렬방법인 혼합정렬기법을 개발하였다. Alignment errors increase as the unaligned angle found through pre-alignment aligns with the launch or launch impact of the launch platform, requiring re-alignment prior to launch. The method of rearranging using the existing accelerometer output can not be applied when the vibration occurs and the acceleration changes as in the case of the starting platform. In the case of the forward alignment method, it is possible to perform alignment during the start, but it takes several tens of seconds to estimate the azimuth error. Accordingly, the present invention has developed a hybrid sorting technique that is a sorting method using transfer sorting.

혼합정렬은 사전전달정렬을 수행하여 추정 및 저장한 비정렬각과 시간지연을 이용하여 재전달정렬을 수행하는 방법이다. 제안한 방법은 전달정렬을 사용하여 기동 플랫폼에서 적용 가능하고, 비정렬각과 시간지연을 미리 추정하여 사용하고 추가로 발생하는 부분만 재추정하기 때문에 수초 내 정렬이 가능하다. Mixed sorting is a method of performing re-transfer sorting by using pre-transfer sorting and estimating and storing the non-sorting angle and time delay. The proposed method can be applied in the launching platform using forwarding alignment, it can be aligned within a few seconds because it estimates the unassigned angle and time delay in advance and re - estimates only the part that occurs.

도 2는 본 발명의 실시예에 따른 관성 항법 장치의 급속 초기정렬방법의 수행순서를 나타낸 흐름도이다. 2 is a flowchart illustrating a procedure for performing a rapid initial sorting method of an inertial navigation system according to an embodiment of the present invention.

도 2를 참조하면, 먼저 발사관에 항체(e.g., 탄)를 장착하고 사전전달정렬을 수행하여(S100, S110), 발사관에 장착된 MINS(200)와 항체 내 SINS(100) 사이의 X축, Y축, Z축의 비정렬각과 시간지연을 추정하고 저장한다(S120). 2, first, an antibody (eg, carbon) is attached to a tube of a prolapse and pre-transfer alignment is performed (S100 and S110), and the X axis between the MINS 200 mounted on the tube and the SINS 100 in the antibody, Y-axis, and Z-axis and the time delay are estimated and stored (S120).

이어서 발사 플랫폼의 고기동에 의해 증가되는 정렬오차를 줄이기 위하여 발사 전에 항체를 선택하고 재정렬방법인 혼합정렬을 수행한다(S130, S140). 이때, 혼합정렬은 사전전달정렬을 통해 구해져 저장부에 저장된 X축, Y축, Z축 비정렬각과 시간지연을 이용한다. 즉, 발사관 내부 유격에 의해 SINS의 비정렬이 변화 가능한 축은 X축과 Y축이기 때문에 Z축의 비정렬각은 혼합정렬 수행 시 재추정하지 않고 저장된 Z축 비정렬각을 동일하게 사용한다. 시간지연은 사전전달정렬을 통해 추정한 값을 10ms 단위로 적용하고 ms단위의 변화를 재추정한다. Then, in order to reduce the alignment error which is increased by the action of the launch platform, the antibody is selected before firing and mixed alignment is performed (S130, S140). In this case, the mixed alignment is obtained through pre-alignment and uses the X-axis, Y-axis, and Z-axis non-alignment angles and time delay stored in the storage unit. That is, since the axes that can change the non-alignment of SINS due to the internal tube clearance are the X axis and the Y axis, the unassisted angles of the Z axis are not re-estimated when performing the mixed alignment, The time delay applies the estimated value through the pre-delivery sort in units of 10ms and re-estimates the change in ms.

혼합정렬이 완료되면 항법(탄 발사)을 수행하고 항법 진입 확인이 적합한지 즉, 화탄 발사가 정상인지 확인한다(S150, S160). 확인결과 탄 발사가 정상이면(탄착지점 및 발사거리 등 체크를 통해), 상기 단계(S130)에서 다시 항체(e.g.,탄)를 선택한 후 단계(S140~S160)를 반복 수행한다. 이와 같이 본 발명은 사전전달정렬과 혼합정렬을 결합한 초기정렬을 수행하여 정렬 정확도를 확보할 수 있을 뿐만 아니라 수초 내에 급속정렬을 수행할 수 있다. 따라서 기동 플랫폼에서 연속발사에 적합한 방법임을 알 수 있다. When the mixed alignment is completed, the navigation is carried out (S150, S160). If it is determined that the shot is normal (through a check of a shot point and a firing distance, etc.), an antibody (e.g., shot) is selected again in the step S130 and steps S140 to S160 are repeated. As described above, the present invention can perform initial alignment in combination with pre-delivery alignment and mixed alignment to ensure alignment accuracy, and can perform rapid alignment within a few seconds. Therefore, it can be seen that this method is suitable for continuous launch in the launch platform.

3. 시간지연 적응 보상기법 3. Time delay adaptive compensation scheme

혼합정렬 수행 시 사전정렬을 통해 추정한 시간 지연값이 변하거나 시간지연에 지터링(jittering)이 존재하는 경우 정렬오차가 증가할 수 있다. 종래의 방법은 시간지연을 일정한 상수로 가정하여 모델링하기 때문에 외부 인가되는 운동이 큰 경우, 시간지연 변하는 경우, 또는 시간지연이 큰 경우에는 근사화된 모델이 부정확하여 전달정렬 성능이 저하된다. Alignment error may increase when the time delay value estimated through pre-alignment changes when jitter alignment is performed or when there is jittering in time delay. In the conventional method, since the time delay is modeled assuming a constant value, when the external applied motion is large, the time delay is changed, or the time delay is large, the approximated model is inaccurate and the transfer alignment performance is degraded.

따라서 본 발명은 상기와 같은 모델링 오차를 줄이기 위한 시간지연 보상방법을 제안한다. Therefore, the present invention proposes a time delay compensation method for reducing the modeling error as described above.

도 3은 본 발명의 실시예에 따른 혼합정렬 수행시 시간지연을 적응적으로 보상하는 방법의 흐름도이고, 도 4는 순수 항법으로 계산된 후 이동 버퍼에 저장되는 SINS의 항법 데이타를 나타내고, 도 5는 이동 버퍼에 저장된 항법 데이타 중에서 MINS의 항법 데이터와 시각동기가 근접하는 복수의 항법 데이터를 샘플링하는 방법을 나타낸다. FIG. 3 is a flow chart of a method of adaptively compensating time delay in performing mixed alignment according to an embodiment of the present invention, FIG. 4 shows SINS navigation data stored in a shift buffer after being calculated by pure navigation, Shows a method of sampling a plurality of navigation data in which the MINS navigation data and the time synchronization are close to each other among the navigation data stored in the movement buffer.

도 3을 참조하면, 항법부는 SINS(200)에서 출력되는 속도증분과 각도증분을 이용하여 항법을 수행하고(S200), 상기 항법으로 계산한 SINS의 항법 데이터인 위치, 속도, 자세 및 가속도값을 도 4에 도시된 바와같이 N 크기의 갖는 이동 버퍼에 순차적으로 저장한다(S210). 시간지연 보상부는 도 2에 개시된 사전전달정렬을 통해 구한 MINS와 SINS간의 비정렬각(θ) 및 시간지연(δT)를 저장부로부터 전달받아, 도 5에 도시된 바와같이 이동 버퍼에 저장된 복수의 SINS의 항법 데이터중에서 MINS의 시간 지연된 항법 데이터와 시각동기가 일치하는 제1항법 데이터(Nav(k-d))를 선택(샘플링)하고(S220), 상기 제1항법 데이터를 중심으로 앞뒤로 두 샘플링시간의 항법 데이터(Nav(k-d-2)∼Nav(k-d+2))를 추가로 선택한다 (S230). 이러한 방법으로 항법 데이터를 선택하는 이유는 지터링(jittering)을 보상하기 위함이다. Referring to FIG. 3, the navigation unit performs the navigation using the speed increment and angle increment output from the SINS 200 (S200), and calculates the position, speed, posture, and acceleration values of the SINS Is stored in the moving buffer having the size of N as shown in FIG. 4 (S210). The time delay compensation unit receives the un-alignment angle [theta] and the time delay [Delta] T between the MINS and the SINS obtained through the pre-transfer alignment disclosed in FIG. 2 from the storage unit, (Sampling) the first navigation data Nav (kd) whose time synchronization with the time-delayed navigation data of the MINS coincides with the navigation data of the first navigation data SINS (S220) The navigation data Nav (kd-2) to Nav (k-d + 2) are further selected (S230). The reason for choosing navigation data in this way is to compensate for jittering.

다음 단계로 상기 시간지연 보상부에서 시간지연이 보상된 다섯 샘플링의 항법데이터(Nav{5}) 중의 제1항법 데이타(Nav[k-d])와 상기 MINS로부터 수신한 위치, 속도, 자세, 각속도를 이용하여 칼만필터에 대한 시간 전파를 수행한다. 시간 전파식은 아래와 같다. In the next step, the first navigation data (Nav [kd]) of the five-sampling navigation data (Nav {5}) whose time delay is compensated in the time delay compensation unit and the first navigation data To perform time propagation for the Kalman filter. The time propagation equation is as follows.

[수학식 6]&Quot; (6) "

Figure pat00022
Figure pat00022

[수학식 7]&Quot; (7) "

Figure pat00023
Figure pat00023

[수학식 8]&Quot; (8) "

Figure pat00024
Figure pat00024

여기서here

Figure pat00025
이다.
Figure pat00025
to be.

Figure pat00026
: 항법좌표계에서의 지구회전 각속도
Figure pat00026
: Earth rotation angular velocity in the navigation coordinate system

Figure pat00027
: 항법좌표계에서의 지구에 대한 항법 회전 각속도
Figure pat00027
: Navigation rotation angular velocity for the earth in the navigation coordinate system

Figure pat00028
: 항법좌표계에서의 가속도계 출력
Figure pat00028
: Accelerometer Output in Navigation Coordinate System

이후 시간지연 보상부는 MINS의 입력 각속도를 근거로 상기 시간지연이 보상된 다섯 샘플링의 항법데이터(Nav{5})를 선택적으로 적용하여 칼만필터 측정값을 생성 및 갱신하고(S260, S270), 상기 갱신된 칼만필터로 비정렬각을 추정함으로써 SINS의 자세를 보정한다(S280, S290). Thereafter, the time delay compensation unit generates and updates the Kalman filter measurement values (S260, S270) by selectively applying the navigation data (Nav {5}) of the five samplings compensated for the time delay based on the input angular speed of the MINS, The attitude of the SINS is corrected by estimating the non-alignment angle with the updated Kalman filter (S280, S290).

도 6은 입력 각속도에 따라 시간지연 보상여부를 결정하여 샘플링된 복수의 항법데이터를 선택적으로 적용하는 동작을 나타낸 흐름도이다. 6 is a flowchart illustrating an operation of determining whether to compensate for time delay according to an input angular velocity and selectively applying a plurality of sampled navigation data.

도 6에 도시된 바와같이, 시간지연 보상부는 입력 각속도의 값(RSS)이 기 설정된 값보다 큰지 체크하여 지터링 보상을 조건부 적용한다(S300). 이는 SINS의 성능에 따라서 지터링 보상을 조건부 적용할 경우 초기정렬성능을 향상시킬 수 있는 ㅈ장점이 있다. 만약, 입력 각속도의 값이 기 설정값보다 작아 조건을 불만족 시킬 경우 시간지연 보상부는 지터링 보상을 수행하지 않고 Nav[k-d]와 MINS 항법정보를 이용하여 칼만필터 속도 측정값과 자세 측정값을 생성 및 갱신한다(S310). As shown in FIG. 6, the time delay compensation unit checks whether the value (RSS) of the input angular velocity is greater than a predetermined value and applies jitter compensation conditionally (S300). This is advantageous in that the initial alignment performance can be improved when the jitter compensation is conditionally applied according to the performance of the SINS. If the input angular velocity is less than the preset value and the condition is unsatisfactory, the time delay compensator generates the Kalman filter velocity measurement value and the attitude measurement value using Nav [kd] and MINS navigation information without performing jitter compensation (S310).

반면에, 입력 각속도의 값이 기 설정값보다 커서 조건을 만족시킬 경우 시간지연 보상부는 지터링 보상을 수행하기 위해 항법 데이타 (Nav[5])와 MINS의 항법 데이타를 이용하여 총 5개의 칼만필터 측정값(속도, 자세) 후보군을 생성하고(S320), 상기 생성된 5개의 측정값 후보군 중에서 측정값의 신호세기(RSS)값이 최소가 되는 샘플인 Nav[k-d+s]를 선택함으로써(S330) 상기 단계(S270)를 통해 상기 선택된 항법 데이타를 이용하여 칼만필터 측정값을 갱신한다(S330). 이때 칼만필터의 측정값 생성식은 수학식 5와 동일하며 측정치 갱신식은 아래의 수학식 8 내지 10과 같다. On the other hand, if the input angular velocity is larger than the preset value and the condition is satisfied, the time delay compensation unit uses the navigation data (Nav [5]) and the MINS navigation data to perform jitter compensation, A candidate group of measured values (velocity, posture) is generated (S320), and Nav [k-d + s] is selected as a sample that minimizes the RSS value of the measurement value among the generated five measured value candidate groups (S330), the Kalman filter measurement value is updated using the selected navigation data through step S270 (S330). In this case, the measurement value generation formula of the Kalman filter is the same as in Equation (5), and the measurement value update equation is as shown in the following Equations (8) to (10).

[수학식 8]&Quot; (8) "

Figure pat00029
Figure pat00029

[수학식 9]&Quot; (9) "

Figure pat00030
Figure pat00030

[수학식 10]&Quot; (10) "

Figure pat00031
Figure pat00031

여기서 P는 상태변수 x의 오차 공분산이고, Q는 공정잡음이다. 그리고 R은 측정잡음으로 MINS의 속도오차와 자세오차이다. 초기오차 공분산, 공정잡음, 측정잡음을 행렬로 나타내면 아래 수학식 11과 같다. Where P is the error covariance of the state variable x, and Q is the process noise. And R is the speed error and the attitude error of the MINS due to the measurement noise. The initial error covariance, process noise, and measurement noise can be expressed by the following mathematical expression (11).

[수학식 11]&Quot; (11) "

Figure pat00032
Figure pat00032

따라서, 갱신된 상태변수를 이용하여 비정렬각을 추정 하고 SINS자세를 보정한다. 이와 같이 적응 이동 버퍼를 이용한 시간지연 보상 방법은 시간지연의 영향을 최소화시키고 지터링(jittering)의 영향도 감소시킴으로써 정렬오차를 감소시키고 수렴시간 개선 효과를 나타냈다. Therefore, we use the updated state variables to estimate the unaligned angle and correct the SINS posture. In this way, the time delay compensation method using the adaptive moving buffer minimizes the influence of the time delay and reduces the influence of the jittering, thereby reducing the alignment error and improving the convergence time.

상술한 바와같이 본 발명은 기동 플랫폼에서 연속발사 운용개념을 갖은 항체의 급속 초기정렬을 위하여 사전전달정렬과 혼합정렬을 결합한 관성 항법 장치(시스템)의 급속 초기정렬기법을 제공함으로써 기동 플랫폼에서 발사 고각제한 없이 신속하고 정밀하게 초기정렬을 수행할 수 있는 장점이 있다. As described above, the present invention provides a rapid initial alignment technique of an inertial navigation system (system) that combines pre-delivery alignment and mixed alignment for rapid initial alignment of antibodies having a concept of continuous launch operation in a maneuvering platform, There is an advantage that initial alignment can be performed quickly and precisely without limitation.

이에 더하여 본 발명은 사전전달정렬을 통해 추정한 시간 지연값이 변하거나 시간지연에 지터링(jittering)이 존재하는 경우 시간지연 보상부를 통해 시간 지연 및 지터링을 보상함으로써 정렬오차를 감소시킬 수 있고 수렴시간을 개선시킬 수 있는 효과가 있다. In addition, the present invention can reduce the alignment error by compensating the time delay and jitter through the time delay compensation unit when the time delay value estimated through pre-alignment is changed or jittering is present in the time delay The convergence time can be improved.

상기와 같이 설명된 본 발명에 따른 시간지연 적응 보상기능을 갖는 관성항법장치 및 그의 급속 초기정렬 방법은 상기 설명된 실시예들의 구성과 방법이 한정되게 적용될 수 있는 것이 아니라, 상기 실시예들은 그 기술적 사상이나 필수적 특징을 변경하지 않고서 다른 구체적인 형태로 실시될 수 있다는 것을 이해할 수 있을 것이다. 그러므로, 상술한 실시예들은 모든 면에서 예시적인 것이며 한정적인 것이 아닌 것으로서 이해해야만 한다. The inertial navigation apparatus having the time delay adaptive compensation function according to the present invention and the rapid initial alignment method thereof according to the present invention described above can be applied not only to the configuration and method of the embodiments described above, It will be understood that the invention may be embodied in other specific forms without departing from the spirit or essential characteristics thereof. Therefore, it should be understood that the above-described embodiments are to be considered in all respects as illustrative and not restrictive.

100 : SINS 200 : MINS100: SINS 200: MINS

Claims (10)

기동 플랫폼에서 연속발사 운용개념을 갖은 항체의 초기정렬을 수행하는 관성 항법장치에 있어서,
발사대에 장착된 주 관성 항법장치(MINS); 및
상기 발사대의 항체내에 장착되어, 상기 주 관성 항법장치(MINS)로부터 속도 및 자세정보를 전달받아 주 관성 항법장치(MINS)와의 비정렬각과 시간지연을 추정하는 사전전달정렬을 수행하는 종 관성 항법장치(SINS);로 구성되며,
상기 종 관성 항법장치(SINS)는
상기 추정된 비정렬각과 시간지연을 이용하여 재전달정렬을 수행하여, 발사대 내부 유격에 의해 변화되는 SINS의 비정렬각 및 시간 지연을 재추정하는 혼합정렬을 수행하는 것을 특징으로 하는 관성항법장치.
1. An inertial navigation device for performing initial alignment of an antibody having a concept of continuous firing operation in a maneuvering platform,
A main navigation system (MINS) mounted on the launch pad; And
And a longitudinal inertial navigation device mounted in the body of the launching platform for performing pre-transfer alignment to receive the speed and attitude information from the main inertial navigation system (MINS) to estimate the un-alignment angle and time delay with the main navigation system (MINS) (SINS)
The longitudinal inertial navigation system (SINS)
And performs a mixed rearrangement to rearrange the unassociated angles and the time delays of the SINS that are changed by the launch pad inner clearance by performing the rearrangement rearrangement using the estimated unaligned angle and the time delay.
제1항에 있어서, 상기 종 관성 항법장치(SINS)는
혼합정렬 수행시 상기 저장된 X축, Y축, Z축 비정렬각 중에서 X축과 Y축 비정렬각은 재추정하고 Z축 비정렬각은 유지하며, 상기 저장된 시간지연은 10ms 단위로 변화를 재추정하는 것을 특징으로 하는 관성항법장치의 초기정렬방법.
The apparatus of claim 1, wherein the longitudinal inertial navigation system (SINS)
The X-axis and Y-axis unassisted angles are re-estimated and the Z-axis unassisted angles are maintained among the stored X-axis, Y-axis, and Z-axis unassisted angles in the mixed alignment operation. Wherein said initial alignment method comprises the steps of:
제1항에 있어서, 상기 종 관성 항법장치(SINS)는
혼합정렬 수행 시 사전전달정렬을 통해 추정한 시간 지연값이 변하거나 시간지연에 지터링이 존재하는 경우 시간지연 변화와 지터링에 의한 시각동기 오차를 감소시키기 위하여 시간지연 보상을 수행하는 것을 특징으로 하는 관성항법장치의 초기정렬방법.
The apparatus of claim 1, wherein the longitudinal inertial navigation system (SINS)
Time delay compensation is performed in order to reduce the time lag change due to jittering and the time synchronization error due to jittering when the time delay value estimated through pre- The initial alignment method of the inertial navigation device.
제3항에 있어서, 상기 종 관성 항법장치(SINS)는
SINS의 속도증분과 각도증분을 이용하여 항법을 수행하여 SINS의 항법 데이터를 이동 버퍼에 순차 저장하고,
사전전달정렬을 통해 구한 MINS와 SINS간의 비정렬각 및 시간지연을 근거로 상기 이동 버퍼에 저장된 항법 데이터중에서 MINS의 항법 데이터와 시각동기가 일치하는 제1항법 데이터 및 그와 이웃하는 복수의 항법 데이타를 샘플링하며,
상기 샘플링된 제1항법 데이타를 이용하여 칼만필터에 대한 시간 전파를 수행하고 MINS로부터 각속도를 포함하는 항법 데이타를 수신하여,
상기 수신된 각속도에 따라 시간지연 보상여부를 결정하여 시간지연 변화와 지터링에 의한 시각동기 오차를 감소시키는 것을 특징으로 하는 관성항법장치.
4. The method of claim 3, wherein the longitudinal inertial navigation system (SINS)
SINS speed and angle increments are used to carry out the navigation to store the navigation data of the SINS in the moving buffer,
The first navigation data in which the navigation data of the MINS coincides with the navigation data of the MINS among the navigation data stored in the movement buffer based on the un-alignment angle and the time delay between the MINS and the SINS obtained through the pre-transfer sorting and a plurality of navigation data / RTI >
Performs time propagation for the Kalman filter using the sampled first navigation data, receives navigation data including angular velocity from the MINS,
And determines whether or not to compensate for time delay according to the received angular velocity, thereby reducing time delay variation and time synchronization error due to jittering.
제4항에 있어서, 상기 종 관성 항법장치(SINS)는
수신된 각속도의 값이 소정값 미만이면 시간지연 보상없이 제1항법 데이타와 MINS의 항법 데이타를 이용하여 칼만필터의 측정값을 생성하고,
수신된 각속도의 값이 소정값 이상이면 시간지연 보상을 위하여 상기 샘플링된 복수의 항법 데이타와 MINS의 항법 데이타를 이용하여 칼만필터에 대한 복수의 측정값 후보를 생성하여,
상기 생성된 복수의 칼만필터 측정값 후보중에서 RSS가 최소인 칼만필터 측정값을 선택하여 칼만필터 측정값을 갱신하는 것을 특징으로 하는 관성항법장치.
5. The method of claim 4, wherein the longitudinal inertial navigation system (SINS)
If the value of the received angular velocity is less than the predetermined value, the measurement value of the Kalman filter is generated using the first navigation data and the MINS navigation data without time delay compensation,
Generating a plurality of measurement value candidates for the Kalman filter using the sampled plurality of navigation data and MINS navigation data for time delay compensation if the received angular velocity is greater than or equal to a predetermined value,
Wherein the Kalman filter measurement value is updated by selecting a Kalman filter measurement value having the minimum RSS among the plurality of generated Kalman filter measurement value candidates.
기동 플랫폼에서 연속발사 운용개념을 갖은 항체의 초기정렬방법에 있어서,
발사대에 항체를 장착하고 발사대의 주 관성 항법장치(MINS)와 항체내의 종 관성 항법장치(SINS)의 속도 및 자세정보를 비교하여 MINS와 SINS사이의 비정렬각과 시간지연을 추정하는 사전전달정렬을 수행하는 단계;
상기 추정된 비정렬각과 시간지연을 저장하는 단계;
상기 저장된 비정렬각과 시간지연을 이용하여 재전달정렬을 수행하여 발사대 내부 유격에 의해 변화되는 SINS의 비정렬각 및 시간 지연을 재추정하는 혼합정렬을 수행하는 단계; 및
상기 혼합정렬에 의해 재추정된 SINS의 비정렬각 및 시간 지연을 근거로 항체의 초기정렬을 수행하는 단계;를 포함하는 것을 특징으로 하는 관성항법장치의 급속 초기정렬방법.
In an initial alignment method of an antibody having a concept of continuous firing operation in an activated platform,
Pre-delivery alignment, which estimates the un-alignment angle and time delay between MINS and SINS by mounting the antibody on the launch pad and comparing the speed and attitude information of the MINS of the launcher with the SINS of the antibody, ;
Storing the estimated non-alignment angle and time delay;
Performing hybrid sorting by performing re-delivery sorting using the stored unassembled angles and time delays to re-estimate unassociated angles and time delays of SINS that are varied by the launch pad internal clearance; And
And performing an initial alignment of the antibody on the basis of the un-alignment angle and the time delay of the SINS re-estimated by the mixed alignment.
제6항에 있어서, 상기 혼합정렬 수행시 상기 저장된 X축, Y축, Z축 비정렬각 중에서 X축과 Y축 비정렬각은 재추정하고 Z축 비정렬각은 유지하며, 상기 저장된 시간지연은 10ms 단위로 변화를 재추정하는 것을 특징으로 하는 관성항법장치의 급속 초기정렬방법.7. The method of claim 6, wherein the X-axis and Y-axis unassisted angles are re-estimated and the Z-axis unassisted angles are maintained among the stored X-, Y-, and Z- Wherein the change is re-estimated in units of 10 ms. 제6항에 있어서, 상기 초기정렬을 수행하는 단계는
혼합정렬 수행 시 사전전달정렬을 통해 추정한 시간 지연값이 변하거나 시간지연에 지터링이 존재하는 경우 시간지연 변화와 지터링에 의한 시각동기 오차를 감소시키기 위하여 시간지연 보상을 수행하는 단계;를 포함하는 것을 특징으로 하는 관성항법장치의 급속 초기정렬방법.
7. The method of claim 6, wherein performing the initial alignment comprises:
Performing time delay compensation in order to reduce the time delay variation and the time synchronization error due to jittering when the time delay value estimated through the pre-transfer alignment changes or the jitter is present in the time delay when performing the mixed alignment; Wherein the rapid initial alignment method of the inertial navigation device is characterized by comprising:
제8항에 있어서, 상기 시간지연 보상을 수행하는 단계는
SINS의 속도증분과 각도증분을 이용하여 항법을 수행하여 SINS의 항법 데이터를 이동 버퍼에 순차 저장하는 단계;
사전전달정렬을 통해 구한 MINS와 SINS간의 비정렬각 및 시간지연을 근거로 상기 이동 버퍼에 저장된 항법 데이터중에서 MINS의 항법 데이터와 시각동기가 일치하는 제1항법 데이터 및 그와 이웃하는 복수의 항법 데이타를 샘플링하는 단계;
상기 샘플링된 제1항법 데이타를 이용하여 칼만필터에 대한 시간 전파를 수행하고 MINS로부터 각속도를 포함하는 항법 데이타를 수신하는 단계; 및
상기 수신된 각속도에 따라 시간지연 보상여부를 결정하여 시간지연 변화와 지터링에 의한 시각동기 오차를 감소시키는 단계;를 포함하는 것을 특징으로 하는 관성항법장치의 급속 초기정렬방법.
9. The method of claim 8, wherein performing the time delay compensation comprises:
Storing navigation data of SINS in a moving buffer by performing navigation using a speed increment and an angle increment of SINS;
The first navigation data in which the navigation data of the MINS coincides with the navigation data of the MINS among the navigation data stored in the movement buffer based on the un-alignment angle and the time delay between the MINS and the SINS obtained through the pre-transfer sorting and a plurality of navigation data ; ≪ / RTI >
Performing time propagation for the Kalman filter using the sampled first navigation data and receiving navigation data including angular velocity from MINS; And
And determining whether to compensate for time delay according to the received angular velocity, thereby reducing a time delay change and a time synchronization error due to jittering.
제9항에 있어서, 상기 시각동기 오차를 감소시키는 단계는
상기 수신된 각속도의 값이 소정값 미만이면 시간지연 보상없이 제1항법 데이타와 MINS의 항법 데이타를 이용하여 칼만필터의 측정값을 생성하는 단계; 및
상기 수신된 각속도의 값이 소정값 이상이면 시간지연 보상을 위하여 상기 샘플링된 복수의 항법 데이타와 MINS의 항법 데이타를 이용하여 칼만필터에 대한 복수의 측정값 후보를 생성하는 단계; 및
상기 생성된 복수의 칼만필터 측정값 후보중에서 RSS가 최소인 칼만필터 측정값을 선택하여 칼만필터 측정값을 갱신하는 단계;를 포함하는 것을 특징으로 하는 관성항법장치의 급속 초기정렬방법.
10. The method of claim 9, wherein reducing the time synchronization error comprises:
Generating a measured value of the Kalman filter using the first navigation data and the MINS navigation data without time delay compensation if the received angular velocity is less than a predetermined value; And
Generating a plurality of measurement value candidates for the Kalman filter using the sampled plurality of navigation data and the MINS navigation data for time delay compensation if the received angular velocity is greater than or equal to a predetermined value; And
And selecting a Kalman filter measurement value having the minimum RSS among the plurality of generated Kalman filter measurement candidate values to update the Kalman filter measurement value.
KR1020170081984A 2017-06-28 2017-06-28 Inertial navigation system with adaptive time delay compensation and rapid initial alignment method thereof KR101990405B1 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
KR1020170081984A KR101990405B1 (en) 2017-06-28 2017-06-28 Inertial navigation system with adaptive time delay compensation and rapid initial alignment method thereof

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
KR1020170081984A KR101990405B1 (en) 2017-06-28 2017-06-28 Inertial navigation system with adaptive time delay compensation and rapid initial alignment method thereof

Publications (2)

Publication Number Publication Date
KR20190001832A true KR20190001832A (en) 2019-01-07
KR101990405B1 KR101990405B1 (en) 2019-06-18

Family

ID=65017079

Family Applications (1)

Application Number Title Priority Date Filing Date
KR1020170081984A KR101990405B1 (en) 2017-06-28 2017-06-28 Inertial navigation system with adaptive time delay compensation and rapid initial alignment method thereof

Country Status (1)

Country Link
KR (1) KR101990405B1 (en)

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110006456A (en) * 2019-04-24 2019-07-12 北京星网宇达科技股份有限公司 A kind of detection vehicle alignment methods, device and equipment
CN110567454A (en) * 2019-09-08 2019-12-13 东南大学 SINS/DVL tightly-combined navigation method in complex environment
KR102140706B1 (en) * 2019-06-05 2020-08-03 국방과학연구소 Method of precise transfer alignment with horizontal alignment after transfer alignment
CN112985368A (en) * 2021-02-09 2021-06-18 西北工业大学 Rapid compass alignment method of underwater vehicle before launching of mobile carrying platform
CN113551665A (en) * 2021-06-25 2021-10-26 中国科学院国家空间科学中心 High dynamic motion state sensing system and sensing method for motion carrier
WO2022042241A1 (en) * 2020-08-31 2022-03-03 蓝箭航天空间科技股份有限公司 Initial alignment method for distributed navigation system of recoverable carrier rocket
CN114136340A (en) * 2021-11-29 2022-03-04 重庆华渝电气集团有限公司 Method for eliminating influence of misalignment angle error on initial alignment
CN117848389A (en) * 2024-03-08 2024-04-09 浙江航天润博测控技术有限公司 Navigation alignment method, navigation equipment and navigation system

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH11281392A (en) * 1998-03-31 1999-10-15 Tech Res & Dev Inst Of Japan Def Agency Inertial navigation system
KR101741076B1 (en) * 2016-04-28 2017-06-15 국방과학연구소 Apparatus for compensating time delay of inertial navigation system and method thereof

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH11281392A (en) * 1998-03-31 1999-10-15 Tech Res & Dev Inst Of Japan Def Agency Inertial navigation system
KR101741076B1 (en) * 2016-04-28 2017-06-15 국방과학연구소 Apparatus for compensating time delay of inertial navigation system and method thereof

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
박찬주 外. 한국항공우주학회지 36(11). 2008.11. 1079-1086 (8 pages) *
이형섭 外. 전기학회논문지 64(12). 2015.12. 1742-1747 (6pages) *
이형섭 外. 전기학회논문지 65(6). 2016.06. 1038-1044 (7 pages) *

Cited By (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110006456A (en) * 2019-04-24 2019-07-12 北京星网宇达科技股份有限公司 A kind of detection vehicle alignment methods, device and equipment
CN110006456B (en) * 2019-04-24 2021-05-14 北京星网宇达科技股份有限公司 Method, device and equipment for detecting alignment of vehicle
KR102140706B1 (en) * 2019-06-05 2020-08-03 국방과학연구소 Method of precise transfer alignment with horizontal alignment after transfer alignment
CN110567454A (en) * 2019-09-08 2019-12-13 东南大学 SINS/DVL tightly-combined navigation method in complex environment
WO2022042241A1 (en) * 2020-08-31 2022-03-03 蓝箭航天空间科技股份有限公司 Initial alignment method for distributed navigation system of recoverable carrier rocket
CN112985368A (en) * 2021-02-09 2021-06-18 西北工业大学 Rapid compass alignment method of underwater vehicle before launching of mobile carrying platform
CN112985368B (en) * 2021-02-09 2022-10-14 西北工业大学 Rapid compass alignment method of underwater vehicle before launching of mobile carrying platform
CN113551665A (en) * 2021-06-25 2021-10-26 中国科学院国家空间科学中心 High dynamic motion state sensing system and sensing method for motion carrier
CN113551665B (en) * 2021-06-25 2023-08-11 中国科学院国家空间科学中心 High-dynamic motion state sensing system and sensing method for motion carrier
CN114136340A (en) * 2021-11-29 2022-03-04 重庆华渝电气集团有限公司 Method for eliminating influence of misalignment angle error on initial alignment
CN117848389A (en) * 2024-03-08 2024-04-09 浙江航天润博测控技术有限公司 Navigation alignment method, navigation equipment and navigation system
CN117848389B (en) * 2024-03-08 2024-05-17 浙江航天润博测控技术有限公司 Navigation alignment method, navigation equipment and navigation system

Also Published As

Publication number Publication date
KR101990405B1 (en) 2019-06-18

Similar Documents

Publication Publication Date Title
KR101990405B1 (en) Inertial navigation system with adaptive time delay compensation and rapid initial alignment method thereof
CN111381217B (en) Missile-borne SAR motion compensation method based on low-precision inertial navigation system
KR100815152B1 (en) Apparatus and method for integrated navigation using multi filter fusion
RU2530705C2 (en) Method and system for evaluation of moving body trajectory
CN112697141A (en) Inertial navigation/odometer moving base posture and position alignment method based on reverse navigation
US20100259614A1 (en) Delay Compensated Feature Target System
US20090324236A1 (en) Method and system for laser based communication
CN111351481A (en) Transmission alignment method based on emission inertial coordinate system
JP2012112738A (en) Tracking device and tracking method
CN110285834B (en) Quick and autonomous readjustment method for double-inertial navigation system based on one-point position information
KR101823774B1 (en) Method for estimating geometric information of target using adaptive guidance filter with strapdown image seeker
CN112179217B (en) Guidance method and device for solid launch vehicle, storage medium, and electronic device
CA2699137A1 (en) Hybrid inertial system with non-linear behaviour and associated method of hybridization by multi-hypothesis filtering
JP5338464B2 (en) Inertial navigation device, flying object, and navigation data calculation method
Gamagedara et al. Quadrotor state estimation with IMU and delayed real-time kinematic GPS
CN113794497B (en) Mobile satellite communication antenna terminal with anti-interference positioning function
US6650287B1 (en) Method for determining the position of reference axes in an inertial navigation system of an object in respect with the basic coordinates and embodiments thereof
EP1846731A2 (en) System for interferometric sensing
KR102140706B1 (en) Method of precise transfer alignment with horizontal alignment after transfer alignment
US10657805B2 (en) Vehicle to vehicle communication device
Yang et al. Transfer alignment design and evaluation
JP4846784B2 (en) Vehicle trajectory measuring device
US6142412A (en) Highly accurate long range optically-aided inertially guided type missile
KR101977749B1 (en) Apparatus and method for estimating position of vehicle using road slope
Braun Performance analysis of GNSS-aided inertial navigation systems on spinning flight vehicles

Legal Events

Date Code Title Description
A201 Request for examination
E902 Notification of reason for refusal
E701 Decision to grant or registration of patent right
GRNT Written decision to grant