• 대한전기학회
Mobile QR Code QR CODE : The Transactions of the Korean Institute of Electrical Engineers
  • COPE
  • kcse
  • 한국과학기술단체총연합회
  • 한국학술지인용색인
  • Scopus
  • crossref
  • orcid

  1. (Agency for Defense Development, Republic of Korea.)
  2. (Handong Global University, Republic of Korea.)



Long-term period SDINS error, Analytic solution, Underwater vehicle navigation

1. 서 론

잠항 이동체는 해저탐사, 수중 감시/정찰과 같이 민간·군수 분야에서 다양한 목적으로 활용되고 있으며, 이러한 임무들을 성공적으로 수행하기 위해서는 이동체의 위치와 같은 거동 정보를 정확히 제공하는 항법 정보가 전제되어야 한다[1-5]. 대다수의 이동체는 항법 정보를 획득하는 방법으로 기준 위성에서 송신된 전파 신호를 이용하는 위성항법장치(GPS: global positioning system)를 고려할 수 있으나, 수중 작전을 펼치는 잠항 이동체의 특수한 운용 환경에서는 전파 신호 수신이 불가능하여 그 활용이 지극히 제한된다[6]. 이러한 문제를 해결하기 위해, 잠항 이동체는 내압선체에 탑재된 가속도계/각속도계와 같은 관성센서 측정치로부터 이동체의 거동 정보를 출력하는 순수항법 알고리듬이 내장된 스트랩다운형 관성항법장치(SDINS: strap-down inertial navigation system)를 주 항법센서로 채택하여 사용하는 것으로 알려져 있다[7,8].

SDINS는 그림 1과 같이 관성센서를 통해 이동체의 거동으로 비롯되는 동체 회전각속도와 비력(specific force)을 측정한 다음, 이를 자세 및 항법 컴퓨터에서 적분하는 순수항법 연산을 거쳐 항법 정보를 산출한다[9]. 위와 같은 구조로 인해, 순수항법 출력에는 잠항 이동체의 초기 정렬 과정에서 필연적으로 발생하는 운동 정보(위치/속도/자세) 오차 및 관성센서에 내재한 편향 오차(bias)가 누적되고, 이는 순수항법 오차를 유발하는 주 요인으로 작용한다[9,10]. 이때, 수직면 순수항법 위치오차는 잠항 이동체의 안정적인 심도 정보 제공을 목적으로 설계되는 수직 채널 안정화 루프를 통해 억제되는 반면 수평면 순수항법 위치오차의 경우 슐러 진동(Schuler oscillation), 지구 자전과 밀접한 관계에 놓인 24시간/푸코 주기(Earth rotation/Foucault period)를 갖는 주기 오차들과 함께 시간이 지나며 점차 증가하는 현상이 관측된다[9-12]. 항법 정보는 잠항 이동체의 경로 설정, 작전영역 구획화를 위한 아군 세력과의 위치 공유 등 많은 상황에서 필수적으로 활용될뿐더러, 최근 비약적인 기술 발전으로 잠항 이동체의 수중 체류시간이 늘어나고 있어 장시간 운항하는 잠항 이동체의 임무 성공률 제고를 위해서는 위와 같은 수평면 순수항법 위치 정보가 지니는 다양한 오차 특성을 면밀히 검토하여야 한다.

그림 1. SDINS 구성도

Fig. 1. Configuration of SDINS

../../Resources/kiee/KIEE.2025.74.4.655/fig1.png

전술한 수평면 순수항법 위치오차 분석을 위해, 그림 1의 SDINS M&S 프로그램을 설계한 다음 잠항 이동체의 궤적정보 참값과 순수항법 출력 간 차이를 직접 비교하는 방식, 혹은 SDINS 오차전파(error propagation) 모델을 활용하여 칼만필터 오차공분산에 관한 시간 전파 및 측정치 갱신으로 순수항법 성능을 분석하는 공분산 해석(covariance analysis) 기반의 연구 결과들이 발표되었다[13-18]

. 그러나, 위 방법들은 SDINS의 다양한 오차 요인들에 의한 출력이 합성된 채로 이에 관한 경향성을 확인하는 기초적인 결과만을 제시하였다. 특히 SDINS 위치 출력에 포함된 주기 오차들에 대한 명확한 해석이 어렵다는 한계가 존재하는데, 이는 순수항법 위치오차 특성에 관한 개별적인 분석이 제한됨을 의미하는 것이다.

한편, SDINS 오차전파 모델로 기술되는 상태천이 행렬(state transition matrix)로부터 산출된 해석 해(analytic solution)와 같은 수학적 도구를 토대로 수평면 순수항법 위치오차를 분석하는 기법이 제안된 바 있다[9,19,20]. 전술한 방법들과 달리, 해석 해 기반의 순수항법 위치오차 분석은 오차전파 모델에서 정의되는 오차 상태변수(순수항법 오차 요인) 별로 주기 오차와 더불어 서서히 증가하는 오차 영향을 손쉽게 살펴볼 수 있다. 하지만, 현재까지 공개된 해석 해는 정북방향에 한정하여 슐러 진동인 중주기(medium-term period) 오차 특성을 분석하거나, 정북/정동방향을 모두 고려하더라도 초기 운동 정보에 의한 오차 및 푸코 주기가 누락된 채 슐러/지구 자전주기 일부만을 다루는 간략화된 장주기(long-term period) 오차 해석 수준에 불과하다. 이는 비교적 임무 수행시간이 길지 않은 이동체에 탑재된 SDINS를 운용한다는 가정 하에 오차전파 모델을 과도하게 축소하여 해석 해를 유도하였음에 기인한다. 따라서, 장시간 임무를 수행하는 잠항 이동체의 수평면 순수항법 위치오차를 수학적으로 분석하기 위해서는 정북/정동방향에 대한 위치오차에 관하여 초기 운동 정보에 따른 오차 및 중/장주기 오차 특성을 함께 검토 가능한 보완된 해석 해가 산출되어야 함을 알 수 있다.

전술한 문제를 해결하기 위해, 본 논문에서는 장시간 운용하는 잠항 이동체에 적합한 SDINS 오차전파 모델을 이용하여 확장된 SDINS 장주기 오차 해석 해를 도출하고, 이를 통해 초기 운동 정보 및 관성센서 편향 오차에 의한 순수항법 위치오차 특성 분석 방법을 제안한다[21,22]. 제안된 방법은 기존의 해석 해 결과에 더하여 비정렬 오차에 의한 영향 및 푸코 주기를 수학적으로 기술할 수 있어 이들 오차가 순수항법 위치에 어떠한 영향을 미치는지 정량적으로 해석할 수 있다. 더욱이, 점진적으로 증가하는 순수항법 위치오차 특성 역시 적절히 모사되므로 장시간 임무 수행을 위한 잠항 이동체의 SDINS 항법오차 분석에 있어 향상된 정확도를 제공한다. 이로부터, 제안된 해석 해는 잠항 이동체의 작전성능 평가를 위한 SDINS 성능분석/예측 도구, 체계개발 및 성능개량을 위한 항법필터 구조 설계 개념의 타당성 입증 등에 활용될 수 있을 것으로 기대된다. 컴퓨터 모의실험을 통해 통상적으로 활용하는 SDINS 순수항법 오차 모델 및 SDINS M&S 출력과 비교분석을 수행함으로써 제안된 해석 해의 유용성을 확인한다.

2. 잠항 이동체의 SDINS 오차 모델

본 절에서는 잠항 이동체의 SDINS 오차를 표현하기 위한 기호 및 좌표계를 정의하고, 이를 통해 순수항법 오차방정식을 기술함으로써 통상적인 15차 SDINS 오차전파 모델을 유도한다. 도출된 모델은 이후 장주기 위치오차 해석 해를 산출하기 위한 기초 자료로 활용한다.

2.1 기호 및 좌표계 정의

잠항 이동체의 SDINS 오차 모델을 유도하기 위해 사용하는 주요 변수는 아래와 같이 요약된다.

$ X^{I}$, $ Y^{I}$, $ Z^{I}$ :관성 좌표계

$ X^{E}$, $ Y^{E}$, $ Z^{E}$ : 지구고정 좌표계

$ X^{N}$, $ Y^{N}$, $ Z^{N}$ : 항법 좌표계

$ X^{B}$, $ Y^{B}$, $ Z^{B}$ : 동체 좌표계

$\lambda$, $\Lambda$, $-h$ : 위도, 경도, 심도

$ V^{N}\equiv \begin{bmatrix}v^{N}& v^{E}& v^{D}\end{bmatrix}^{T}$ : 항법 좌표계 속도 벡터 및 그 성분

$ f^{N}\equiv \begin{bmatrix}f^{N}& f^{E}& f^{D}\end{bmatrix}^{T}$ : 항법 좌표계 비력 벡터 및 그 성분

$ f^{B}\equiv \begin{bmatrix}f^{X}& f^{Y}& f^{Z}\end{bmatrix}^{T}$ : 동체 좌표계 비력 벡터 및 그 성분

$ g^{N}$ : 항법 좌표계 중력가속도 벡터

$R_{E}$, $R_{N}$ : 횡, 자오선 곡률반경

$R_{EE}$, $R_{NN}$ : 위도에 대한 $R_{E}$, $R_{N}$의 변화율

$R_{o}$, $g_{o}$ : 구(球)로 근사된 지구모델 반경, 중력가속도

$\omega_{s}$ : 슐러(Schuler) 주기

$\omega_{e}$, $\omega_{f}$ : 24시간, 푸코(Foucault) 주기

$\omega_{IB}^{B}\equiv \begin{bmatrix}p & q & r\end{bmatrix}^{T}$ : 관성 좌표계에 대한 동체 좌표계의 회전각속도 벡터

$\omega_{IE}^{E}\equiv \begin{bmatrix}0 & 0 &\omega_{e}\end{bmatrix}^{T}$ : 관성 좌표계에 대한 지구고정 좌표계의 회전각속도 벡터

$\omega_{IE}^{N}\equiv \begin{bmatrix}\omega^{N}& 0 &\omega^{D}\end{bmatrix}^{T}$ : 항법 좌표계에서 표현된 $\omega_{IE}^{E}$

$\omega_{EN}^{N}\equiv \begin{bmatrix}\rho^{N}&\rho^{E}&\rho^{D}\end{bmatrix}^{T}$ : 지구고정 좌표계에 대한 항법 좌표계의 회전각속도 벡터

그림 2. 관성, 지구고정 및 항법 좌표계

Fig. 2. Coordinate system: I-, E-, and N-frame

../../Resources/kiee/KIEE.2025.74.4.655/fig2.png

$\mu_{\times}$ : 임의의 벡터 $\mu$에 대한 왜대칭행렬 (skew-symmetric matrix)

$C_{\eta}^{\xi}$ : $\eta$ 좌표계에서 $\xi$ 좌표계로의 변환 행렬

$\psi$, $\theta$, $\phi$ : 요, 피치, 롤 자세

$\delta\psi$, $\delta\theta$, $\delta\phi$ : 요, 피치, 롤 자세 오차

$\delta\lambda$, $\delta\Lambda$, $-\delta h$ : 위도, 경도, 심도 오차

$\delta P^{N}\equiv \begin{bmatrix}\delta p^{N}&\delta p^{E}&\delta p^{D}\end{bmatrix}^{T}$ : 항법 좌표계 위치오차 벡터 및 그 성분

$\delta V^{N}\equiv \begin{bmatrix}\delta v^{N}&\delta v^{E}&\delta v^{D}\end{bmatrix}^{T}$ : 항법 좌표계 속도오차 벡터 및 그 성분

$\delta\phi\equiv \begin{bmatrix}\delta\alpha &\delta\beta &\delta\gamma\end{bmatrix}^{T}$ : 정렬자세 오차 벡터 및 그 성분

$ B_{a}^{N}\equiv \begin{bmatrix}b_{a}^{N}& b_{a}^{E}& b_{a}^{D}\end{bmatrix}^{T}$ : 항법 좌표계 가속도계 편향 오차 벡터 및 그 성분

$ B_{\omega}^{N}\equiv \begin{bmatrix}b_{\omega}^{N}& b_{\omega}^{E}& b_{\omega}^{D}\end{bmatrix}^{T}$ : 항법 좌표계 각속도계 편향 오차 벡터 및 그 성분

전술한 변수들이 정의되는 좌표계는 다음과 같다.

▪ 관성 좌표계 (I-frame)

그림 2와 같이 원점은 지구모델 중심, $ X^{I}$축은 지구모델 중심에서 춘분점(vernal equinox) 방향, $ Z^{I}$축은 지구 자전축 방향, $ Y^{I}$축은 오른손 법칙으로 표현되는 직교 좌표계로 정의된다.

▪ 지구고정 좌표계(E-frame)

원점은 지구모델 중심, $ X^{E}$축은 지구 중심에서 적도평면과 본초자오선(Greenwich meridian)이 만나는 지점을 잇는 방향, $ Z^{E}$축은 지구 자전축 방향, $ Y^{E}$축은 오른손 법칙으로 결정되는 직교 좌표계로 정의된다. 명칭에서 유추할 수 있듯, 지구에 고정되어 $ Z^{E}$축을 기준으로 24시간 주기 $\omega_{e}$만큼 지구 자전을 따라 함께 회전하는 좌표계이다.

▪ 항법 좌표계 (N-frame)

원점은 잠항 이동체에 장착된 SDINS의 위치(통상 잠항 이동체의 무게중심으로 가정, 그림 3 참조), $ X^{N}$축은 정북방향, $ Y^{N}$축은 정동방향, $ Z^{N}$축은 잠항 이동체가 기준으로 삼는 지구모델의 국지 수평면에 수직하여 지구 중심으로 향하는 방향으로 정의된다. 항법 좌표계는 NED(North-East-Down) 좌표계로도 불리며, 잠항 이동체의 위치(위도 $\lambda$, 경도 $\Lambda$)를 이용하여 지구고정 좌표계와 항법 좌표계 간 좌표변환 행렬 $C_{E}^{N}$을 다음과 같이 나타낼 수 있다.

그림 3. 동체 좌표계

Fig. 3. Coordinate system: B-frame

../../Resources/kiee/KIEE.2025.74.4.655/fig3.png
(1)
$C_{E}^{N}= R_{y}\left(-\dfrac{\pi}{2}-\lambda\right)R_{z}(\Lambda)$

위 식에서 $R_{\xi}(\epsilon)$은 $\xi$축을 각도 $\epsilon$만큼 회전시킨 회전변환 행렬을 의미하며, 축 별 회전변환 행렬을 아래와 같이 방향코사인 행렬(direction cosine matrix)로 기술할 수 있다.

$R_{x}(\epsilon)=\begin{bmatrix}1 & 0 & 0 \\ 0 & c\epsilon & s\epsilon \\ 0 & -s\epsilon & c\epsilon\end{bmatrix}$, $R_{y}(\epsilon)=\begin{bmatrix}c\epsilon & 0 & -s\epsilon \\ 0 & 1 & 0 \\ s\epsilon & 0 & c\epsilon\end{bmatrix}$, $R_{z}(\epsilon)=\begin{bmatrix}c\epsilon & s\epsilon & 0 \\ -s\epsilon & c\epsilon & 0 \\ 0 & 0 & 1\end{bmatrix}$,

$c\epsilon\equiv \cos\epsilon$, $s\epsilon\equiv \sin\epsilon$.

▪ 동체 좌표계 (B-frame)

그림 3과 같이 원점은 잠항 이동체의 무게중심, $ X^{B}$축은 잠항 이동체의 함수 방향, $ Z^{B}$축은 잠항 이동체의 하단 방향, $ Y^{B}$축은 오른손 법칙을 따르는 직교 좌표계이다. 항법 좌표계에서 동체 좌표계로의 좌표변환 행렬 $C_{N}^{B}$는 식 (2)와 같이 축 별 자세각과 회전변환 행렬로 표현된다.

(2)
$C_{N}^{B}= R_{x}(\phi)R_{y}(\theta)R_{z}(\psi)$

2.2 관성센서 편향 오차를 포함하는 SDINS 오차전파 모델

잠항 이동체의 SDINS 오차전파 모델을 유도하기 위해, 아래와 같이 항법 좌표계 상의 순수항법 방정식을 고려해 보자.

(3)
$\dot{\lambda}=\dfrac{v^{N}}{R_{N}+ h}$, $\dot{\Lambda}=\dfrac{v^{E}}{\left(R_{E}+ h\right)\cos\lambda}$, $-\dot{h}= v^{D}$
(4)
$\dot{ V^{N}}= C_{B}^{N} f^{B}-\left(2 \omega_{IE}^{N}+ \omega_{EN}^{N}\right)\times V^{N}+ g^{N}$
(5)
$\dot{C_{B}^{N}}= C_{B}^{N}\left(\omega_{NB}^{B}\right)_{\times}$ , $\omega_{NB}^{B}= \omega_{IB}^{B}- C_{N}^{B}\left(\omega_{IE}^{N}+ \omega_{EN}^{N}\right)$

비선형 미분방정식으로 이루어진 (3-5)에 대하여, 섭동(perturbation) 방법을 적용함으로써 다음과 같은 선형화된 순수항법 오차방정식을 얻을 수 있다.

(6)
$\delta\dot{\lambda}$$=\dfrac{1}{R_{N}+ h}·\delta v^{N}+\dfrac{R_{NN}\rho^{E}}{R_{N}+ h}·\delta\lambda +\dfrac{\rho^{E}}{R_{N}+ h}·\delta h$ $\delta\dot{\Lambda}$$=\dfrac{\sec\lambda}{R_{E}+ h}·\delta v^{E}$ $+\rho^{N}\sec\lambda\left(\tan\lambda -\dfrac{R_{EE}}{R_{E}+h}\right)·\delta\lambda -\dfrac{\rho^{N}\sec\lambda}{R_{E}+ h}·\delta h$ $-\delta\dot{h}=\delta v^{D}$
(7)
$\dot{\delta V^{N}}= f^{N}_{\times}\delta\phi + C_{B}^{N}\delta f^{B}-\left(2 \omega_{IE}^{N}+ \omega_{EN}^{N}\right)\times \delta V^{N}$ $-\left(2 \delta\omega_{IE}^{N}+ \delta\omega_{EN}^{N}\right)\times V^{N}- \delta g^{N}$
(8)
$\dot{\delta\phi}= -\left(\omega_{IE}^{N}+ \omega_{EN}^{N}\right)\times \delta\phi +\left(\delta\omega_{IE}^{N}+ \delta\omega_{EN}^{N}\right)- C_{B}^{N}\delta\omega_{IB}^{B}$

여기서 $\delta\mu$는 섭동에 의한 임의의 벡터 $\mu$의 오차를, $C_{B}^{N}$은 동체-항법 좌표계 간 좌표변환 행렬($C_{B}^{N}=\left(C_{N}^{B}\right)^{T}$)을 의미한다.

전술한 오차방정(6-8)은 편향/환산계수 오차 등을 내재한 관성센서 오차 성분(가속도계 $C_{B}^{N}\delta f^{B}$, 각속도계 $C_{B}^{N}\delta\omega_{IB}^{B}$)을 포함하고 있다. 잘 알려져 있듯, 관성센서의 오차 요인 중 편향 오차 성분이 순수항법 오차에 가장 우세한 영향을 미치므로 아래와 같이 편향 오차로 대체할 수 있다[23].

(9)
$C_{B}^{N}\delta f^{B}\approx B_{a}^{N}$, $C_{B}^{N}\delta\omega_{IB}^{B}\approx B_{\omega}^{N}$
(10)
$\dot{B}_{a}^{N}= 0^{3\times 1}$, $\dot{B}_{\omega}^{N}= 0^{3\times 1}$

이제, (6-10)을 종합함으로써 순수항법 오차방정(6-8)에 관하여 다음과 같이 일반적인 15차 SDINS 오차전파 모델로 쓸 수 있다[9].

(11)
$\delta\dot{x}= F \delta x$,

$\delta x =\left[\begin{matrix}\delta\alpha &\delta\beta &\delta\gamma &\vdots &\delta v^{N}&\delta v^{E}&\delta v^{D}&\vdots &\delta\lambda &\delta\Lambda &\delta h &\vdots & b_{\omega}^{N}& b_{\omega}^{E}& b_{\omega}^{D}&\vdots & b_{a}^{N}& b_{a}^{E}& b_{a}^{D}\end{matrix}\right]^{T}$,

$F =\left[\begin{matrix}F_{11}&F_{12}&F_{13}&-I^{3\times 3}&0^{3\times 3}\\F_{21}&F_{22}&F_{23}&0^{3\times 3}&I^{3\times 3}\\ 0^{3\times 3}&F_{32}& F_{33}&0^{3\times 3}&0^{3\times 3}\\0^{6\times 3}& 0^{6\times 3}&0^{6\times 3}&0^{6\times 3}&0^{6\times 3}\end{matrix}\right]$.

(11)의 SDINS 오차전파 모델을 기술하기 위하여 사용한 부행렬(sub-matrix)들에 관한 정의를 부록 A에 정리하였다.

3. 잠항 이동체의 수평면 SDINS 장주기 위치오차 해석 해

본 절에서는 장시간 운용하는 잠항 이동체의 수평면 SDINS 위치 정보가 지니는 다양한 오차 특성을 수학적으로 검토하기 위한 해석 해를 산출한다. 먼저, 잠항 이동체 탑재 SDINS의 수직 채널 특성과 주기 오차가 유발되는 원인을 토대로 전술한 15차 SDINS 오차전파 모델을 12차 오차 시스템으로 근사한다. 다음으로, 상태천이 행렬(state transition matrix)의 성질을 이용하여 SDINS 위치오차를 분석 가능한 해석 해를 얻는다. 유도된 해석 해는 상태변수로 정의되는 초기 운동 정보 오차 및 관성센서 편향 오차가 장시간에 걸쳐 SDINS 위치오차에 미치는 영향을 정량적으로 확인하는 데 용이하다.

3.1 근사화된 수평면 SDINS 오차전파 모델

본 논문에서 제안하는 수평면 SDINS 장주기 위치오차 해석 해를 산출하기 위한 기본 가정은 다음과 같다.

(A1) 잠항 이동체는 안정적인 심도 정보 획득을 목적으로 수직 채널 안정화 루프를 도입함으로써 수직면 상의 순수항법 오차를 억제한다 ($-\delta h =\delta v^{D}= b_{a}^{D}= 0$).

(A2) SDINS 위치오차에 포함되는 주기 오차는 초기 운동 정보와 관성센서 편향 오차에서 비롯되며, 잠항 이동체의 운동 변화와는 무관하다 ($ V^{N}= 0$, $f^{N}= f^{E}= 0$).

(A3) 지구는 구(球)체이며, 그 반경은 WGS84 지구타원체 모델의 장반경이다 ($R_{E}= R_{N}= R_{o}$, $R_{EE}= R_{NN}= 0$).

(A4) 중력가속도는 위도 변화와 무관하며, 적도의 중력가속도로 일정하다 ($f^{D}= -g_{o}$).

위 가정들로부터, 전술한 15차 SDINS 오차전파 모델을 아래와 같이 수평면 12차 오차 모델로 근사할 수 있다.

(12)
$\delta\dot{x}_{L}= F_{L}\delta x_{L}$,

$\delta x_{L}=\left[\begin{matrix}\delta\alpha &\delta\beta &\delta\gamma &\vdots &\delta v^{N}&\delta v^{E}&\vdots &\delta\lambda &\delta\Lambda &\vdots & b_{\omega}^{N}& b_{\omega}^{E}& b_{\omega}^{D}&\vdots & b_{a}^{N}& b_{a}^{E}\end{matrix}\right]^{T}$,

$F_{L}=\left[\begin{matrix}F_{11}^{L}& F_{12}^{L}& F_{13}^{L}& -I^{3\times 3}& 0^{3\times 2}\\ F_{21}^{L}& F_{22}^{L}& 0^{2\times 2}& 0^{2\times 3}& I^{2\times 2}\\ 0^{2\times 3}& F_{32}^{L}& 0^{2\times 2}& 0^{2\times 3}& 0^{2\times 2}\\ 0^{5\times 3}& 0^{5\times 2}& 0^{5\times 2}& 0^{5\times 3}& 0^{5\times 2}\end{matrix}\right]$,

$F_{11}^{L}=\begin{bmatrix}0 &\omega^{D}& 0 \\ -\omega^{D}& 0 &\omega^{N}\\ 0 & -\omega^{N}& 0\end{bmatrix}$, $F_{12}^{L}=\begin{bmatrix}0 & R_{o}^{-1}\\ -R_{o}^{-1}& 0 \\0 &\dfrac{\omega^{D}}{\omega^{N}}R_{o}^{-1}\end{bmatrix}$, $F_{13}^{L}=\begin{bmatrix}\omega^{D}& 0 \\ 0 & 0 \\ -\omega^{N}& 0\end{bmatrix}$,

$F_{21}^{L}=\begin{bmatrix}0 & g_{o}& 0 \\ -g_{o}& 0 & 0\end{bmatrix}$, $F_{22}^{L}=\begin{bmatrix}0 & 2\omega^{D}\\ -2\omega^{D}& 0\end{bmatrix}$, $F_{32}^{L}=\begin{bmatrix}R_{o}^{-1}& 0 \\ 0 & R_{o}^{-1}\sec(\lambda)\end{bmatrix}$.

근사화된 수평면 12차 SDINS 오차전파 모델의 두드러진 특성을 확인하기 위해 그림 4와 같이 블록선도로 도시하였다. 그림 4로부터 정북 및 정동방향에 관한 중주기 특성인 슐러 루프(Schuler loop)뿐만 아니라, 여러 결합 성분들을 통해 SDINS 위치오차가 지니는 장주기를 손쉽게 볼 수 있다. SDINS 주기 오차 및 그 크기를 정리하면 다음과 같다.

▪ 슐러 주기 (Schuler period ; $\omega_{s}\equiv \sqrt{g_{o}/R_{o}}$)

지구 곡률에 의한 기울기 오차가 있는 항법 좌표계에서 관성센서 측정치를 적분하고, 그 결과(속도/위치)를 이용하여 다시 항법 좌표계를 정의하는 궤환 루프로 인해 발생하는 불안정 주기이며, 약 84분으로 계산된다.

그림 4. 근사화된 수평면 SDINS 오차전파 모델

Fig. 4. Approximated error propagation model of the SDINS

../../Resources/kiee/KIEE.2025.74.4.655/fig4.png

▪ 24시간 주기 (Earth rotation period ; $\omega_{e}$)

대표적인 장주기 특성으로, 지구 자전(24시간)이 직접적으로 영향을 미치는 주기이다 ($\omega_{e}^{2}\ll \omega_{s}^{2}$).

▪ 푸코 주기 (Foucault period ; $\omega_{f}\equiv \omega_{e}\sin\lambda$)

장주기 특성 중 하나이며, 지구 자전에 의해 변조된 슐러 주기로서 정북/정동방향 간 90$^{\circ}$ 변조 위상차가 존재한다. 잠항 이동체의 위도 $\lambda$에 따라 그 주기가 달라지며, 중위도 지역에서 약 40시간의 값을 갖는다 ($\omega_{f}^{2}\ll \omega_{s}^{2}$).

3.2 수평면 SDINS 위치오차 해석 해

(12)의 수평면 SDINS 오차전파 모델에서 각 항법오차 요인들이 순수항법 위치오차에 미치는 영향을 수학적으로 분석하기 위한 해석 해 산출을 위해, 다음과 같이 상태천이 행렬의 형태로 표현해 보자.

표 1 수평면 SDINS 장주기 위치오차 해석 해

Table 1 Analytic solution of long-term period SDINS position error

오차 요인

정북방향 $f_{\lambda ,\: \chi}(·)$

정동방향$f_{\Lambda ,\: \chi}(·)$

$\delta\alpha_{0}$ $-\omega_{f}\left\{\dot{p}_{s}(t)p_{f}(t)- p_{e}(t)\right\}$ $\sec\lambda\left\{\dot{p}_{s}(t)\dot{p}_{f}(t)-\sin^{2}\lambda·\dot{p}_{e}(t)\right\}-\cos\lambda$
$\delta\beta_{0}$ $-\dot{p}_{s}(t)\dot{p}_{f}(t)+\dot{p}_{e}(t)$ $-\omega_{e}\tan\lambda\left\{\dot{p}_{s}(t)p_{f}(t)- p_{e}(t)\right\}$
$\delta\gamma_{0}$ $-\omega_{e}\cos\lambda\left\{p_{s}(t)\dot{p}_{f}(t)- p_{e}(t)\right\}$ $-\omega_{e}\omega_{f}· p_{s}(t)p_{f}(t)+\sin\lambda\left\{1 -\dot{p}_{e}(t)\right\}$
$\delta v_{0}^{N}$ $\left(2g_{o}\right)^{-1}·\dot{p}_{s}(t)\ddot{p}_{f}(t)+ R_{o}^{-1}· p_{s}(t)\dot{p}_{f}(t)$ $R_{o}^{-1}\omega_{e}\tan\lambda· p_{s}(t)p_{f}(t)$
$\delta v_{0}^{E}$ $-R_{o}^{-1}\omega_{f}· p_{s}(t)p_{f}(t)$ $R_{o}^{-1}\sec\lambda· p_{s}(t)\dot{p}_{f}(t)$
$\delta\lambda_{0}$ $- p_{s}(t)\ddot{p}_{f}(t)+\dot{p}_{e}(t)$ $-\omega_{e}\tan\lambda\left\{p_{s}(t)\dot{p}_{f}(t)- p_{e}(t)\right\}$
$\delta\Lambda_{0}$ $0$ $1$
$b_{\omega}^{N}$ $\sin\lambda\left[\omega_{e}· p_{s}(t)p_{f}(t)+\omega_{e}^{-1}\left\{\dot{p}_{e}(t)- 1\right\}\right]$ $\sec\lambda\left\{- p_{s}(t)\dot{p}_{f}(t)+\sin^{2}\lambda· p_{e}(t)\right\}+\cos\lambda· t$
$b_{\omega}^{E}$ $p_{s}(t)\dot{p}_{f}(t)- p_{e}(t)$ $\tan\lambda\left[\omega_{e}\left\{p_{s}(t)p_{f}(t)+\omega_{s}^{-2}·\dot{p}_{s}(t)\dot{p}_{f}(t)\right\}+\omega_{e}^{-1}\left\{\dot{p}_{e}(t)- 1\right\}\right]$
$b_{\omega}^{D}$ $-\cos\lambda\left[R_{o}\omega_{e}·\dot{p}_{s}(t)\dot{p}_{f}(t)-\omega_{e}^{-1}\left\{\dot{p}_{e}(t)- 1\right\}\right]$ $\sin\lambda\left\{p_{e}(t)- t\right\}$
$b_{a}^{N}$ $g_{o}^{-1}\left\{p_{s}(t)\ddot{p}_{f}(t)-\dot{p}_{s}(t)\dot{p}_{f}(t)+ 1\right\}$ $g_{o}^{-1}\omega_{e}\tan\lambda\left\{p_{s}(t)\dot{p}_{f}(t)-\dot{p}_{s}(t)p_{f}(t)\right\}$
$b_{a}^{E}$ $g_{o}^{-1}\omega_{f}\left\{\dot{p}_{s}(t)p_{f}(t)+ p_{s}(t)\dot{p}_{f}(t)\right\}$ $g_{o}^{-1}\sec\lambda\left\{p_{s}(t)\ddot{p}_{f}(t)-\dot{p}_{s}(t)\dot{p}_{f}(t)- 1\right\}$

$p_{s}(t)\equiv \omega_{s}^{-1}·\sin\omega_{s}t$, $p_{e}(t)\equiv \omega_{e}^{-1}·\sin\omega_{e}t$, $p_{f}(t)\equiv \omega_{f}^{-1}·\sin\omega_{f}t$

(13)
$\delta x_{L}(t)=\Phi(t-t_{0})\delta x_{L}\left(t_{0}\right)$, $\Phi(t)=\exp(F_{L}t)$.

여기서 $\Phi(0)= I$, $\delta x_{L}(t_{0})$는 초기 항법오차를 나타낸다.

(13)의 상태천이 행렬에서, 아래와 같이 라플라스 역변환 관계를 이용하여 항법오차 해석 해를 유도할 수 있다.

(14)
$\Phi(t)= L^{-1}\left\{\left(s I - F_{L}\right)^{-1}\right\}$

위 식에서 $s$는 라플라스 연산자를, $L^{-1}\{·\}$는 라플라스 역변환 관계를 뜻한다.

(14)에서 위도 및 경도 오차, 다시 말해 상태천이 행렬 $\Phi(t)$의 6행 및 7행 성분들의 선형 조합으로 수평면 SDINS 장주기 위치오차 해석 해를 기술할 수 있다.

(15)
$\delta p^{\eta}= R_{o}·\sum_{\forall\chi\in \delta x_{L}}f_{\xi ,\: \chi}\left(R_{o},\: g_{o},\: \lambda ,\: \omega_{s},\: \omega_{e},\: \omega_{f}\right)\delta\chi_{0}$, $\eta\in\{N ,\: E\}$, $\xi\in\{\lambda ,\: \Lambda\}$.

여기서 $\delta\chi_{0}$는 오차전파 모델의 초기값을 의미하며, 표 1에 기재된 각 오차 상태변수 $\delta\chi$의 해석 해 성분 $f_{\xi ,\: \chi}(·)$은 전술한 주기 성분 간 크기에 따른 대소관계를 적용하여 정리한 결과이다.

위 식으로부터 알 수 있듯, 기존 방법들과 달리 제안된 해석 해는 장시간 특성에 관한 수평면 위치오차의 수학적 검토가 가능하다. 제안된 해석 해가 갖는 수학적 구조로부터 손쉽게 확인 가능한 주요 특성들을 아래와 같이 요약하였다.

(1) 제안된 해석 해는 지구모델 파라미터 $R_{o}$, $g_{o}$와 잠항 이동체의 위도 $\lambda$, 그리고 주기 성분 $\omega_{s}$, $\omega_{e}$, $\omega_{f}$로 모델링 된다.

(2) 기존의 오차 해석 해에서 볼 수 있는 슐러 주기함수 $p_{s}(t)$ 및 지구 자전주기 $p_{e}(t)$와 더불어, 푸코 주기 특성을 나타내는 $p_{f}(t)$가 반영되어 있다.

(3) 관성센서 편향 오차, 초기 정렬자세 오차 요인들이 야기하는 수평면 순수항법 위치오차에는 편향 성분이 포함된다.

(4) 초기 경도오차 $\delta\Lambda_{0}$는 정북방향 위치오차에 영향을 미치지 않으며, 정동방향 위치오차에서 초기 오차의 크기만큼 편향 성분으로 표현된다.

(5) 항법 좌표계 상의 각속도계 편향 오차 $b_{\omega}^{N}$ 및 $b_{\omega}^{D}$가 각각 지니는 $\cos\lambda· t$, $\sin\lambda· t$ 성분으로 인해, 시간이 지남에 따라 정동방향 위치오차가 점진적으로 증가 및 발산한다.

4. 모의실험

4.1 모의실험 조건

제안된 수평면 SDINS 장주기 위치오차 해석 해의 유용성을 확인하기 위해 컴퓨터 모의실험을 수행하였다. 이를 위해, 그림 5의 6-자유도 잠항 이동체 시뮬레이터에 표 2의 초기 위치 및 명령을 입력하여 그림 6과 같이 수평면에서 42시간 등속 이동하는 잠항 이동체 궤적을 모의하였다. 식 (11)의 일반적인 SDINS 오차전파 모델을 이용하여 산출된 항법오차를 참값으로 간주하고 각 오차 요인에 의한 순수항법 위치오차 해석 해와의 유사성을 먼저 확인한 다음, (3-5)의 순수항법 방정식으로 설계한 SDINS M&S S/W에서 출력된 위치오차와 전체 오차 요인에 따른 해석 해의 합산 결과를 비교 분석하였다. 더불어, 부록 B에 기술된 기존의 간략화된 정북/정동방향 장주기 및 정북방향 중주기 위치오차 해석 해(표 3, 표 4 참조) 기반의 오차분석 결과를 추가함으로써 해당 채널에서의 SDINS 위치오차 모의 수준을 함께 비교하였다. 수평면 순수항법 오차를 유발하는 SDINS 오차 규격은 잠항 이동체의 SDINS 보정항법 관련 연구결과에서 제시한 모의실험 지표를 도입하였으며, 그 값을 표 2에 정리하였다[2]. 참고로, 해당 파라미터를 이용하여 설계한 SDINS M&S S/W 출력의 수평면 거리오차 RMSE(root mean square error) 최대치는 24시간 시점에서 약 1.4 해리(약 2.5 [km])에 이른다.

그림 5. 6-자유도 잠항 이동체 시뮬레이터

Fig. 5. 6-DOF underwater vehicle motion simulator

../../Resources/kiee/KIEE.2025.74.4.655/fig5.png

표 2 모의실험 조건 [2]

Table 2 Simulation condition

구분

파라미터

초기

위치

수평면

$\begin{bmatrix}\lambda_{0}&\Lambda_{0}\end{bmatrix}$ $\begin{bmatrix}36.1317 & 129.6317\end{bmatrix}$$[\deg]$

심도

$-h_{0}$ $0.0$$[{m}]$

명령

속력

$V_{cmd}$ $7.0$$[{m}/{s}]$

침로

$\psi_{cmd}$ $45.0$$[\deg]$

심도

$-h_{cmd}$ $0.0$$[{m}]$

초기

운동 정보 오차

$\begin{bmatrix}\delta\alpha_{0}&\delta\beta_{0}&\delta\gamma_{0}\end{bmatrix}$ $\begin{bmatrix}0.01 & 0.01 & 0.03\end{bmatrix}$$[{}{arc}\min]$
$\begin{bmatrix}\delta v_{0}^{N}&\delta v_{0}^{E}\end{bmatrix}$ $\begin{bmatrix}0.1 & 0.1\end{bmatrix}$$[{m}/{s}]$
$\begin{bmatrix}\delta p_{0}^{N}&\delta p_{0}^{E}\end{bmatrix}$ $\begin{bmatrix}10.0 & 10.0\end{bmatrix}$$[{m}]$

관성센서 편향 오차

(동체 좌표계)

$\begin{bmatrix}b_{a}^{X}& b_{a}^{Y}& b_{a}^{Z}\end{bmatrix}$ $\begin{bmatrix}4.0 & 4.0 & 4.0\end{bmatrix}$$[\mu{g}]$
$\begin{bmatrix}b_{\omega}^{X}& b_{\omega}^{Y}& b_{\omega}^{Z}\end{bmatrix}$ $\begin{bmatrix}2.0 & 2.0 & 2.0\end{bmatrix}$$[{mdeg}/{hr}]$

그림 6. 모의실험 궤적

Fig. 6. Simulation trajectory

../../Resources/kiee/KIEE.2025.74.4.655/fig6.png

4.2 모의실험 결과 분석

전술한 모의실험 조건을 토대로, 제안된 해석 해를 이용하여 각 요인들이 수평면 SDINS 위치오차에 미치는 영향을 분석한다. 먼저, 초기 정렬자세 오차에 의한 영향을 그림 7그림 8에 도시하였다. 제한된 채널(정북방향) 및 오차 요인에 대하여 슐러 주기만을 모의함에 따라 약 3시간 이후에는 유효한 결과를 제공하기 어려운 기존의 중주기 위치오차 해석 방법과 달리, 제안된 해석 기법은 모든 초기 정렬자세 오차 요인에서 슐러 주기와 함께 장주기 성분 및 편향 오차를 표현할 수 있어 참값 오차정보와 유사한 수치를 산출한다. 구체적으로, 제안된 해석 해의 정렬자세 기울기오차(tilt error) $\delta\alpha_{0}$, $\delta\beta_{0}$는 크기가 최대 약 40 [m], 헤딩오차(heading error) $\delta\gamma_{0}$는 약 80 [m] 내에서 슐러/푸코 및 24시간 주기로 진동하는 위치오차를 야기한다. 또한, 표 1에서 알 수 있듯 정동방향의 초기 오차 요인 $\delta\alpha_{0}$ 및 $\delta\gamma_{0}$에서 각각 $-\cos\lambda$, $\sin\lambda$ 만큼의 편향 오차를 지니고 있어 위치오차 참값의 편향치를 적절한 수준으로 모사한다.

그림 7. 초기 정렬자세 오차에 의한 정북방향 위치 오차

Fig. 7. North position error by initial misalignment attitude error

../../Resources/kiee/KIEE.2025.74.4.655/fig7.png

그림 8. 초기 정렬자세 오차에 의한 정동방향 위치 오차

Fig. 8. East position error by initial misalignment attitude error

../../Resources/kiee/KIEE.2025.74.4.655/fig8.png

다음으로, 수평면 상의 초기 속도/위치오차가 유발하는 SDINS 위치오차를 그림 9~그림 12에 나타내었다. 초기 속도/위치오차에 의한 SDINS 위치오차를 슐러 주기와 단순한 편향 오차만으로 분석해야 했던 중주기 해석 해와 다르게, 제안된 해석 해는 장주기 오차 성분들을 손쉽게 관찰할 수 있어 이들이 갖는 위치오차 특성 확인이 용이하다. 한편, 모의실험 조건에서 언급한 24시간 경과 시 위치오차 크기(약 2.5 [km]) 측면에서 전술한 정렬자세 오차와 더불어 초기 속도/위치오차, 다시 말해 초기 운동 정보 오차에 의한 수평면 SDINS 위치오차 크기가 수십 ~ 수백 [m]로 작은 수준임을 볼 수 있다. 이는 순수항법 위치오차를 야기하는 다양한 SDINS 오차 요인 중 관성센서 편향 오차의 영향이 우세함을 암시하는 것이다. 이러한 이유로 간략화된 장주기 위치오차 분석 기법은 해석해산출 과정에서 상기 오차 요인들을 의도적으로 생략하였으나, 순수항법의 위치오차 특성을 정밀하게 분석하기 위한 측면에서는 제안된 해석 해 대비 한계가 존재함을 알 수 있다.

그림 9. 초기 속도 오차에 의한 정북방향 위치 오차

Fig. 9. North position error by initial velocity error

../../Resources/kiee/KIEE.2025.74.4.655/fig9.png

그림 10. 초기 속도 오차에 의한 정동방향 위치 오차

Fig. 10. East position error by initial velocity error

../../Resources/kiee/KIEE.2025.74.4.655/fig10.png

그림 11. 초기 위치 오차에 의한 정북방향 위치 오차

Fig. 11. North position error by initial position error

../../Resources/kiee/KIEE.2025.74.4.655/fig11.png

그림 12. 초기 위치 오차에 의한 정동방향 위치 오차

Fig. 12. East position error by initial position error

../../Resources/kiee/KIEE.2025.74.4.655/fig12.png

이제, 관성센서 오차에 의한 순수항법 성능을 분석해 보자. 가속도계 및 각속도계에 내재한 편향 오차가 생성하는 수평면 SDINS 위치오차는 그림 13~그림 16과 같다. 가속도계 편향 오차 관련 결과(그림 13그림 14 참조)에 따르면, 기존 해석 기법들은 단순히 슐러 주기에 의한 위치오차 특성만이 검출되나 제안된 해석 해는 지구 자전에 의해 변조된 슐러 주기인 푸코 진동을 함께 기술하고 있어 위치오차에 관하여 세밀한 수학적 검토가 가능하다. 이때, 위치오차 크기를 감안하면 $b_{a}^{N}$에 의한 순수항법 오차는 $b_{a}^{E}$에 비하여 미미하므로 사전에 정동방향 가속도계 편향 오차 $b_{a}^{E}$의 크기를 알 수 있을 경우 제안된 장주기 해석 해를 바탕으로 SDINS 위치오차의 주된 진폭 변화를 분석 및 예측할 수 있다. 더욱이, 그림 15그림 16의 각속도계 편향 오차 역시 기존의 중주기 오차 해석만으로는 설명이 어려운 장주기 특성은 물론, 시간에 따라 점진적으로 증가하는 위치오차 특성까지 반영되어 있다. 이에 더하여, 동일한 장주기 해석 해의 결과임에도 제안된 방법은 푸코 주기에 의한 영향이 포함되어 있으므로 기존 기법보다 정밀한 위치오차 분석을 시도할 수 있다. 게다가, 제안된 해석 해로부터 수평면 SDINS 위치오차 발산을 직접적으로 유발하는 주 요인이 각속도계 편향 오차임을 명확히 할 수 있어 이를 적절히 추정 혹은 보상하는 보정 알고리듬 등의 요구사항을 손쉽게 도출할 수 있다. 나아가, 각속도계 제원과 장주기 해석 해를 이용하여 오차 크기를 정량적 수치로 관측함으로써 잠항 이동체 운용조건에 적합한 SDINS 정확도를 판별하거나 잠항 이동체의 항법성능 예측에 관한 수학적인 지표화가 가능하다.

그림 13. 가속도계 편향 오차에 의한 정북방향 위치 오차

Fig. 13. North position error by accelerometer bias

../../Resources/kiee/KIEE.2025.74.4.655/fig13.png

그림 14. 가속도계 편향 오차에 의한 정동방향 위치 오차

Fig. 14. East position error by accelerometer bias

../../Resources/kiee/KIEE.2025.74.4.655/fig14.png

그림 15. 각속도계 편향 오차에 의한 정북방향 위치 오차

Fig. 15. North position error by gyroscope bias

../../Resources/kiee/KIEE.2025.74.4.655/fig15.png

그림 16. 각속도계 편향 오차에 의한 정동방향 위치 오차

Fig. 16. East position error by gyroscope bias

../../Resources/kiee/KIEE.2025.74.4.655/fig16.png

마지막으로, 모든 오차 요인을 합산한 수평면 순수항법 위치오차와 SDINS M&S S/W의 위치오차 출력 및 그 차이를 각각 그림 17그림 18에 도시하였다. 정북방향의 경우, 오차가 발산하는 중주기 해석 해와 달리 장주기 해석 기법들은 그 정도가 높지 않은 채로 SDINS에서 출력된 위치 근방에 놓여 있음을 알 수 있다. 정동방향에서는 기존 및 제안된 장주기 해석 해 모두 음의 방향으로 위치오차 크기가 증가하고 있다. 이러한 특성은 섭동 방식으로 유도된 선형 오차전파 모델로부터 도출한 해석 해가 비선형 순수항법 방정식을 온전히 모사하는 관점에 있어 일부 제한됨을 나타내는 것이다. 그럼에도 불구하고, 간략화된 장주기 해석 해와 다르게 제안된 기법은 초기 운동 정보에 의한 순수항법 오차 및 푸코 주기를 포함하고 있어 위치오차 참값과의 차에 따른 진폭 수준이 작게 유지된다. 이러한 특성은 제안된 해석 해가 장시간 SDINS 운용 시 필연적으로 나타나는 중/장주기와 선형적으로 증가하는 위치오차 크기 성분을 적절한 수준으로 모의할 수 있음을 의미하는 것이다. 이상의 결과로부터, 제안된 수평면 SDINS 장주기 위치오차 해석 해는 장시간 운용하는 잠항 이동체의 보정 기법 설계를 위한 기초자료 및 체계개발을 위한 SDINS 성능지표 검출 등에 용이하게 활용할 수 있을 것으로 판단된다.

그림 17. 모든 오차 요인에 의한 정북방향 위치 오차

Fig. 17. North position error by all error sources

../../Resources/kiee/KIEE.2025.74.4.655/fig17.png

그림 18. 모든 오차 요인에 의한 정동방향 위치 오차

Fig. 18. East position error by all error sources

../../Resources/kiee/KIEE.2025.74.4.655/fig18.png

5. 결 론

본 논문에서는 장시간 임무를 수행하는 잠항 이동체의 주 항법센서인 SDINS가 지닌 수평면 위치오차를 수학적으로 분석 가능한 방법을 다루었다. 이를 위해, SDINS 위치오차의 주 요인으로 알려진 초기 운동 정보 오차와 관성센서 편향 오차를 상태변수로 가지며 긴 운용 시간에 의한 오차를 표현할 수 있는 근사화된 수평면 오차전파 모델을 유도하였다. 이로부터, 수평면 순수항법 위치오차 해석 해를 산출함으로써 각 오차 요인별로 그 특성을 정량적으로 분석하는 방법을 제시하였다. 모의실험 결과로부터, 비교적 짧은 운용 시간을 갖는 이동체의 정북방향 슐러 주기만을 관측할 수 있었던 SDINS 중주기 해석 기법, 정북/정동방향에서 초기 비정렬 오차 요인을 의도적으로 무시한 간략화된 장주기 해석 해와 달리 제안된 장주기 해석 해는 24시간 및 푸코 주기와 함께 오차가 점진적으로 증가하는 경향 및 편향 특성 역시 적절히 설명할 수 있음을 확인하였다.

정리하면, 제안된 해석 해는 SDINS 위치오차의 물리적 해석 및 이를 보정하기 위한 알고리듬 설계 과정에서의 이론적 근거 자료, 잠항 이동체의 작전성능 평가를 위한 SDINS 성능분석 및 예측 도구, 나아가 잠항 이동체의 체계개발/성능개량 시 요구 조건을 도출하기 위한 SDINS 성능지표 산출 등 다양하게 활용할 수 있을 것으로 기대된다.

부록 A. 일반적인 SDINS 오차전파 모델

2.2절에서 15차 SDINS 오차전파 모델의 시스템 행렬 $F$를 표현하는 데 사용한 부행렬들은 다음과 같이 정의된다.

$F_{11}\equiv -\left(\omega_{IE}^{N}+ \omega_{EN}^{N}\right)_{\times}$, $F_{12}\equiv \begin{bmatrix}0 &\dfrac{1}{R_{E}+ h}& 0 \\ -\dfrac{1}{R_{N}+h}& 0 & 0 \\ 0 & -\dfrac{\tan\lambda}{R_{E}+h}& 0\end{bmatrix}$,

$F_{13}\equiv \begin{bmatrix}\Omega^{D}-\dfrac{\rho^{N}R_{EE}}{R_{E}+ h}& 0 & -\dfrac{\rho^{N}}{R_{E}+ h}\\ -\dfrac{\rho^{E}R_{NN}}{R_{N}+ h}& 0 & -\dfrac{\rho^{E}}{R_{N}+ h}\\ -\left(\Omega^{N}+\rho^{N}\sec^{2}\lambda +\dfrac{\rho^{D}R_{EE}}{R_{E}+h}\right)& 0 & -\dfrac{\rho^{D}}{R_{E}+ h}\end{bmatrix}$, $F_{21}\equiv f^{N_{\times}}$,

$F_{22}\equiv \begin{bmatrix}\dfrac{v^{D}}{R_{N}+h}& 2\left(\Omega^{D}+\rho^{D}\right)& -\rho^{E}\\ -\left(\Omega^{D}+\rho^{D}\right)&\dfrac{v^{N}\tan\lambda + v^{D}}{R_{E}+ h}& 2\Omega^{N}+\rho^{N}\\ 2\rho^{E}& -2\left(\Omega^{N}+\rho^{N}\right)& 0\end{bmatrix}$,

$F_{23}\equiv \begin{bmatrix}\left(\dfrac{\rho^{E}R_{NN}}{R_{N}+ h}-\left(\rho^{N}\sec^{2}\lambda + 2\Omega^{N}\right)v^{E}\\ -\rho^{N}\rho^{E}R_{EE}\right)& 0 &\dfrac{\rho^{E}}{R_{N}+h}v^{D}-\rho^{N}\rho^{D}\\\left(\left(2\Omega^{N}+\rho^{N}\sec^{2}\lambda +\dfrac{\rho^{D}R_{EE}}{R_{E}+ h}\right)v^{N}\\ -\left(\dfrac{\rho^{N}R_{EE}}{R_{E}+ h}- 2\Omega^{D}\right)v^{D}\right)& 0 &\dfrac{\rho^{D}}{R_{E}+h}v^{N}-\dfrac{\rho^{N}}{R_{E}+h}v^{D}\\\left(\rho^{N}\right)^{2}R_{EE}+\left(\rho^{E}\right)^{2}R_{NN}- 2\Omega^{D}v^{E}& 0 &\left(\rho^{N}\right)^{2}+\left(\rho^{E}\right)^{2}\end{bmatrix}$,

표 3 간략화된 SDINS 장주기 위치오차 해석 해 [20]

Table 3 Simplified analytic solution of long-term period SDINS position error

오차 요인

정북방향 $f_{\lambda ,\: \chi}(·)$

정동방향 $f_{\Lambda ,\: \chi}(·)$

$b_{\omega}^{N}$ $-\left[\dfrac{\omega_{f}}{\omega_{s}^{2}-\omega_{e}^{2}}·\left\{\dot{p}_{s}(t)-\left(\dfrac{\omega_{s}}{\omega_{e}}\right)^{2}·\dot{p}_{e}(t)\right\}+\dfrac{\omega_{f}}{\omega_{e}^{2}}\right]$ $-\dfrac{\sec\lambda\left\{\omega_{s}^{2}-\left(\omega_{e}\cos\lambda\right)^{2}\right\}}{\omega_{s}^{2}-\omega_{e}^{2}}· p_{s}(t)+\dfrac{\left(\omega_{s}\tan\lambda\right)^{2}}{\omega_{s}^{2}-\omega_{e}^{2}}· p_{e}(t)+\cos\lambda· t$
$b_{\omega}^{E}$ $\dfrac{\omega_{s}^{2}}{\omega_{s}^{2}-\omega_{e}^{2}}\left\{p_{s}(t)- p_{e}(t)\right\}$ $-\left[\dfrac{\tan\lambda}{\omega_{e}}\left\{1 -\dot{p}_{e}(t)\right\}+\dfrac{\omega_{e}\tan\lambda}{\omega_{s}^{2}-\omega_{e}^{2}}\left\{\dot{p}_{s}(t)-\dot{p}_{e}(t)\right\}\right]$
$b_{\omega}^{D}$ $-\dfrac{\omega_{e}\cos\lambda}{\omega_{s}^{2}-\omega_{e}^{2}}·\dot{p}_{s}(t)+\dfrac{\omega_{s}^{2}\cos\lambda}{\omega_{e}\left(\omega_{s}^{2}-\omega_{e}^{2}\right)}·\dot{p}_{e}(t)-\dfrac{\cos\lambda}{\omega_{e}}$ $-\dfrac{\omega_{e}\omega_{f}}{\omega_{s}^{2}+\omega_{e}^{2}}· p_{s}(t)+\dfrac{\omega_{s}^{2}\sin\lambda}{\omega_{s}^{2}+\omega_{e}^{2}}· p_{e}(t)-\sin\lambda· t$
$b_{a}^{N}$ $g_{o}^{-1}\left\{1 -\dot{p}_{e}(t)\right\}$ $0$
$b_{a}^{E}$ $0$ $g_{o}^{-1}\sec\lambda\left\{1 - p_{s}(t)\right\}$

$p_{s}(t)\equiv \omega_{s}^{-1}·\sin\omega_{s}t$, $p_{e}(t)\equiv \omega_{e}^{-1}·\sin\omega_{e}t$

$F_{32}\equiv \begin{bmatrix}\dfrac{1}{R_{N}+h}& 0 & 0 \\ 0 &\dfrac{\sec\lambda}{R_{E}+h}& 0 \\ 0 & 0 & -1\end{bmatrix}$,

$F_{33}\equiv \begin{bmatrix}\dfrac{R_{NN}\rho^{E}}{R_{N}+h}& 0 &\dfrac{\rho^{E}}{R_{N}+h}\\\dfrac{\rho^{N}}{\cos\lambda}\left(\tan\lambda -\dfrac{R_{EE}}{R_{E}+h}\right)& 0 & -\dfrac{\rho^{N}\sec\lambda}{R_{E}+ h}\\ 0 & 0 & 0\end{bmatrix}$,

$\rho^{N}\equiv \dfrac{v^{E}}{R_{E}+ h}$, $\rho^{E}\equiv -\dfrac{v^{N}}{R_{N}+ h}$, $\rho^{D}\equiv -\dfrac{v^{E}\tan\lambda}{R_{E}+ h}$,

$R_{E}\equiv \dfrac{R_{o}}{\left(1-e^{2}\sin^{2}\lambda\right)^{1/2}}$, $R_{N}\equiv \dfrac{1-e^{2}}{1-e^{2}\sin^{2}\lambda}R_{E}$,

$R_{EE}\equiv \dfrac{e^{2}\sin 2\lambda}{2\left(1-e^{2}\right)}R_{N}$, $R_{NN}\equiv 3\dfrac{R_{N}}{R_{E}}R_{EE}$,

$\omega^{N}\equiv \omega_{e}\cos\lambda$, $\omega^{D}\equiv -\omega_{e}\sin\lambda$.

부록 B. 비교대상 SDINS 위치오차 해석 해

본 논문에서 비교대상으로 선정한 정북/정동방향을 모두 고려하는 간략화된 장주기 위치오차 해석 해, 단일채널(정북방향) 상의 중주기 위치오차 해석 해에 대하여 각각 표 3표 4에 정리하였다.

표 4 정북방향 SDINS 중주기 위치오차 해석 해 [9]

Table 4 Analytic solution of medium-term period SDINS position error

오차 요인

정북방향 $f_{\lambda ,\: \chi}^{M}(·)$

$\delta\beta_{0}$ $1 -\dot{p}_{s}(t)$
$\delta\gamma_{0}$ $\omega_{e}\cos\lambda\left\{t - p_{s}(t)\right\}$
$\delta v_{0}^{N}$ $R_{o}^{-1}· p_{s}(t)$
$\delta\lambda_{0}$ $1$
$b_{a}^{N}$ $R_{o}^{-1}\omega_{s}^{-2}\left\{1 -\dot{p}_{s}(t)\right\}$
$b_{\omega}^{E}$ $p_{s}(t)- t$
$b_{\omega}^{D}$ $-\omega_{e}\cos\lambda\left[0.5t^{2}-\omega_{s}^{-2}\left\{1 -\dot{p}_{s}(t)\right\}\right]$
$p_{s}(t)\equiv \omega_{s}^{-1}·\sin\omega_{s}t$

Acknowledgements

본 논문은 2025년 정부(방위사업청)의 재원으로 수행된 연구임

References

1 
A. Micallef, S. Krastel and A. Savini, Submarine Geomorphology, Springer, 2017. DOI:10.1007/978-3-319-57852-1DOI
2 
Y. Lee et al., “Gertler-Hagen Hydrodynamic Model Based Velocity Estimation Filter for Long-term Underwater Navigation Without External Position Fix,” Transactions of the Korean Institute of Electrical Engineers, vol. 65, no. 11, pp. 1868-1878, 2016. DOI:10.5370/kiee.2016.65.11.1868DOI
3 
J. Choi et al., “Development of an Autonomous Surface Vehicle and Performance Evaluation of Autonomous Navigation Technologies,” International Journal of Control, Automation and Systems, vol. 18, pp. 535-545, 2020. DOI:10.1007/s12555-019-0686-0DOI
4 
J. González-Garcia et al., “Autonomous Underwater Vehicles: Localization, Navigation, and Communication for Collaborative Missions,” Applied sciences, vol. 10, no. 4, pp. 1-37, 2020. DOI:10.3390/app10041256DOI
5 
J. -K. Kim et al., “Reduced-Order Underwater Vehicle Dynamics Model Determination Considering Navigation Performance,” Transactions of the Korean Institute of Electrical Engineers, vol. 73, no. 6, pp. 1012-1022, 2024. DOI:10.5370/KIEE.2024.73.6.1012DOI
6 
T. Kim, J. Kim and S. W. Byun, “A Comparison of Nonlinear Filter Algorithms for Terrain-referenced Underwater Navigation,” International Journal of Control, Automation and Systems, vol. 16, no. 6, pp. 2977-2989, 2018. DOI:10.1007/s12555-017-0504-5DOI
7 
N. Davari and A. Gholami, “An Asynchronous Adaptive Direct Kalman Filter Algorithm to Improve Underwater Navigation System Performance,” IEEE Sensors Journal, vol. 17, no. 4, pp. 1061-1068, 2016. DOI:10.1109/JSEN.2016.2637402DOI
8 
F. Ehlers, Autonomous Underwater Vehicles: Design and Practice, SciTech Publishing, 2020. DOI:10.1049/SBRA525EDOI
9 
D. Titterton and J. L. Weston, Strapdown Inertial Navigation Technology, IET, 2004. DOI:10.1049/PBRA017EDOI
10 
S. Y. Cho et al., “IMM-based INS/EM-Log Integrated Underwater Navigation with Sea Current Estimation Function,” Journal of Positioning, Navigation, and Timing, vol. 7, no. 3, pp. 165-173, 2018. DOI:10.11003/JPNT.2018.7.3.165DOI
11 
W. G. Heller, “Free-Inertial and Damped-Inertial Navigation Mechanization and Error Equations,” The Analytical Sciences Corporation, Reading, MA, 1975.URL
12 
K. M. Hays et al., “A Submarine Navigator for the 21st Century,” In 2002 IEEE Position Location and Navigation Symposium, pp. 179-188, Apr. 2002. DOI:10.1109/PLANS.2002.998906DOI
13 
Y. -S. Hong, T. -H. Kwon and Y. -S. Kwon, “Performance Analysis of SDINS using Matlab/Simulink,” Journal of Advanced Navigation Technology, vol. 4, no. 2, pp. 132-142, 2000.URL
14 
He. H et al., “A Combination Scheme of Pure Strapdown and Dual-Axis Rotation Inertial Navigation Systems,” Sensors, vol. 23, no. 6, pp. 3091-3102, 2023. DOI:10.3390/s23063091DOI
15 
B. S. Ko et al., “Analysis of Long Term Operating Precision Inertial Navigation System Position Error due to Faulty Initial Attitude,” In 2022 Autumn Annual Conference of Institute of Electronics and Information Engineers, pp. 438-441, July 2022.URL
16 
D. -S. Shim et al., “Error Analysis for a Strapdown Inertial Navigation System,” In 1986 Korea Automatic Control Conference, pp. 286-289, Jan. 1986.URL
17 
K. -L. Yong and J. Kim, “Error Covariance Analysis for Local-Level Inertial Navigation System,” In 1996 The Korean Society for Aeronautical and Space Sciences Spring Conference, pp. 248-253, Apr. 1996.URL
18 
Y. B. Park et al., “Requirement Analysis of Navigation System for Lunar Lander According to Mission Conditions,” Journal of The Korean Society for Aeronautical and Space Sciences, vol. 45, no. 9, pp. 734-745, 2017. DOI:10.5139/JKSAS.2017.45.9.734DOI
19 
B. S. Ko et al., “Analysis of SDINS Performance According to Schuler Period Error Effect,” In 2022 The 53th Korean Institute of Electrical Engineers Summer Conference, pp. 1825-1826, July 2022.URL
20 
H. He et al., “A Fast Intelligent Algorithm-Based Positioning Error Suppression Method for Strap-Down Inertial Navigation System,” IEEE Sensors Journal, vol. 23, no. 5, pp. 5278-5287, 2023. DOI:10.1109/JSEN.2023.3237365DOI
21 
U. -S. Suh et al., “Analytic Solution Derivation for Characteristics Analysis of SDINS Long Term Navigation Error of Underwater Vehicles,” In 2016 The 47th Korean Institute of Electrical Engineers Summer Conference, pp. 1454-1455, July 2016.URL
22 
U. -S. Suh et al., “Analysis of Long-term Period SDINS Error of Underwater Vehicle Using Analytic Solution of Pure Inertial Navigation Error in the Horizontal Channel,” In 2023 The 54th Korean Institute of Electrical Engineers Summer Conference, pp. 1947-1948, July 2023.URL
23 
Y. M. Yoo et al., “A Theoretical Approach to Observability Analysis of the SDINS/GPS in Maneuvering with Horizontal Constant Velocity,” International Journal of Control, Automation, and Systems, vol. 10, no. 2, pp. 298-307, 2012. DOI:10.1007/s12555-012-0210-2DOI

저자소개

서의석(Ui-Suk Suh)
../../Resources/kiee/KIEE.2025.74.4.655/au1.png

2015년 한동대학교 기계제어공학부(공학사), 2017년 동대학원 기계제어공학과(공학석사), 2023년 동대학원 기계제어공학과(박사수료). 2022년~현재 국방과학연구소 제5기술연구원 연구원. 관심분야는 레이다 신호처리 및 표적 추적, 정보융합필터, 자율이동체 항법/제어 등.

나원상(Won-Sang Ra)
../../Resources/kiee/KIEE.2025.74.4.655/au2.png

1998년 연세대학교 전기공학과(공학사), 2000년, 2009년 동 대학원 전기컴퓨터공학과(공학석사), 전기전자공학과(공학박사). 2000년~2009년 국방과학연구소 유도조종부 선임연구원. 2009년~현재 한동대학교 기계제어공학부 교수. 2022년~2023년 Visiting Professor, School of Aerospace, Transport and Manufacturing, Cranfield University, UK. 관심분야는 상태추정 및 정보융합 이론, 레이다 표적 추적 및 식별, 자율이동체 유도조종기법 등.

서태일(Taeil Suh)
../../Resources/kiee/KIEE.2025.74.4.655/au3.png

1997년 포항공과대학교 전자전기공학과(공학사), 1999년, 2004년 동 대학원 전자전기공학과(공학석사), 전자전기공학과(공학박사). 2005년~현재 국방과학연구소 제5기술연구원 책임연구원. 관심분야는 표적 추적필터, 잠수함 표적기동분석, 수상함 사격통제체계 기술 등.