JKSPE
[ REGULAR ]
Journal of the Korean Society for Precision Engineering - Vol. 39, No. 1, pp.35-44
ISSN: 1225-9071 (Print) 2287-8769 (Online)
Print publication date 01 Jan 2022
Received 29 Aug 2021 Revised 18 Oct 2021 Accepted 20 Oct 2021
DOI: https://doi.org/10.7736/JKSPE.021.093

무인수상정의 1차 동적 모델 식별 및 예인형 무인수중정 경로 계획을 이용한 무인수상정의 경로 추종 제어

구평모1, # ; 유재관1 ; 이원희1
1LIG넥스원 무인체계연구소
Path-Following Control for Unmanned Surface Vessel Using 1st System of Identified Unmanned Surface Vessel Dynamic Model and Path-Planning of Towed Unmanned Underwater Vehicles
Pyung Mo Ku1, # ; Jae Kwan Ryu1 ; Won Hee Lee1
1Unmanned Systems Research Institute, LIGNex1 Co., Ltd.

Correspondence to: # pyungmo.ku@lignex1.com, TEL: +82-31-8026-7671

Copyright © The Korean Society for Precision Engineering
This is an Open-Access article distributed under the terms of the Creative Commons Attribution Non-Commercial License (http://creativecommons.org/licenses/by-nc/3.0) which permits unrestricted non-commercial use, distribution, and reproduction in any medium, provided the original work is properly cited.

Abstract

This paper proposes a simplified path-following control method for an Unmanned Surface Vessel (USV) considering towed Unmanned Underwater Vehicles (UUV). For dealing with an effective USV dynamic model, 1st order of the linear system with time delay and gain value are applied rather than applying a non-linear dynamic model, and it is identified with real vessel data from several straight and turning experiments. Then, USV attitude and velocity are controlled by multi-loop Proportional-Derivative (PD) and proportional controller. A USV guidance scheme is derived through a UUV guidance scheme to support autonomous navigation for towed UUV, and combination of cross track and Line of Sight (LOS) guidance is presented for adaptive path following. Finally, to validate the performance of the proposed USV path-following control method with respect to the towed UUV guidance scheme, the results of simulations are presented.

Keywords:

Unmanned surface vessel, Unmanned underwater vehicle, Dynamic model, Attitude control, Velocity control, Path-following control

키워드:

무인수상정, 무인수중정, 동적 모델, 자세 제어, 속도 제어, 경로 추종 제어

1. 서론

무인수상정 및 무인수중정과 같은 해양무인체계는 다양한 범위로 관심이 커지고 있다. 민수 분야에서는 해저 자원 탐사, 해저 지형 조사, 구조 및 재난 방제 등에 활용 가능하고, 국방 분야에서는 작전해역 및 주요 항만의 감시정찰, 대기뢰전, 대잠전, 대수상함전, 특수전 등에 활용 가능하다.1-4 그동안은 무인수상정 및 무인수중정에 대하여 개별적으로 연구가 진행됐지만, 최근에는 무인수상정과 예인형 무인수중정을 함께 연동하는 해양무인복합체계 개발이 진행되고 있다. Fig. 1과 같이 대표적으로 ECA Group사의 Inspector 및 H300V,5 Thales사와 L3 ASV사의 Halcyon 및 SAAB사의 Seaeye,6 그리고Northrop Grumman사의 MCM 및 AQS-24가 개발되었다.7

Fig. 1

Development case of unmanned maritime integrated system

이러한 무인수상정과 예인형 무인수중정 결합시스템은 무인수중정 운용의 단점을 보완해준다. 운용 시나리오에 따라 무인수상정의 빠른 기동성과 경로점 자율 운항을 이용하여 무인수중정의 광역 탐색이 가능하고, 강조류 하에서도 무인수상정의 예인을 도움 받아 무인수중정의 정밀 탐색이 가능하다. 또한 예인케이블을 통해 무인수상정의 위치 정보를 받아 무인수중정의 위치 추정이 가능하여, 무인수상정은 무인수중정으로부터 상태 정보를 실시간으로 받을 수 있어 무인수상정의 대응 속도가 빠르다. 무인수상정 및 예인형 무인수중정의 임무수행을 효과적으로 적용하려면, 우선적으로 무인수상정 및 무인수중정의 경로 추종 제어 설계가 선행되야 한다. 하지만 무인수상정 및 무인수중정이 결합된 형태의 경로 추종 제어에 대한 연구는 많이 부족한 상태이다.

본 논문에서는 예인형 무인수중정이 무인수상정의 동력 도움을 받아 무인수중정의 탐색 범위를 넓힐 수 있도록 기본적이고 실질적인 무인수상정의 경로 추종제어 설계를 제안한다. 경로추종 제어 설계를 하기 위해서는 선제적으로 무인수상정 동적 모델 및 식별이 필요하다. 일반적으로 무인수상정 동적 모델은 유체력, 풍력, 파고 등 외란의 외력이 존재하기에 상당히 비선형적이다.8 비선형적인 무인수상정 동적 모델로 제어기 설계하는 것은 단순한 작업이 아니므로, 선형적으로 단순화된 무인수상정 동적 모델들이 연구됐다.9-14 단순화된 무인수상정 동적 모델 중 1차 시스템의 속도 모델11,12과 각속도 모델13,14을 선정하여, 직진 및 선회 실선시험을 통해 가속도 및 등속도 데이터와 각가속도 및 등각속도 데이터를 이용한 동적 모델 식별 방법을 제안하였고, 속도별 직진 및 선회 실선 시험을 확보하여 동적 모델을 속도에 따라 가변적으로 적응될 수 있게 설계하였다. 무인수상정 속도 및 자세 제어기는 계산량도 적고 효과적인 PID 제어로 선정하였으며, 무인수상정의 경로계획상의 수선거리별로 회전 반경을 다르게 하여 무인수상정 경로선을 동적으로 추정할 수 있도록 기존의 LOS 방법을 보완하였다. 최종적으로 예인형 무인수중정이 경로계획을 추종될 수 있도록 무인수상정 운동에 따른 예인형 무인수중정 운동 모델 관계를 역이용하여 예인형 무인수중정 경로계획을 기반한 무인수상정의 경로계획을 제안하였다.

논문의 구성은 다음과 같다. 2장에서는 무인수상정 및 예인형 무인수중정 운동 모델을 설명하고, 무인수상정 동적 모델 식별 방법을 제안한다. 3장에서는 무인수상정 제어와 예인형 무인수중정 경로계획 기반 무인수상정 경로계획을 제안한다. 4장에서는 성능 검증을 위해 시뮬레이션을 통해 분석한다. 마지막으로 5장에서 결론을 맺는다.


2. 무인수상정 및 예인형 무인수중정 시스템

2.1 무인수상정 및 예인형 무인수중정 운동 모델

본 운동 모델은 Fig. 2와 같이 2차원 평면상 운동을 가정하여 무인수상정 및 예인형 무인수중정에 대한 운동모델은 식(1)과 같다.

Fig. 2

Kinematics of USV and towed UUV

η˙=Rψv(1) 

여기서 위치벡터(η)는 pxi, pvi, ψT, 속도벡터(v)는 vxb, vvb, rT이며, 회전행렬은 식(2)와 같다.

Rψ=cos(ψ)-sin(ψ)0-sin(ψ)cos(ψ)0001(2) 

무인수상정과 예인형 무인수중정은 예인케이블 장력이 존재하고 케이블의 방향과 예인형 무인수중정의 자세가 같다는 가정하에 트렉터-트레일러 관계15로 정의하였다. 무인수중정의 진행방향 속도(vxb,UUV)는 식(3)과 같으며, 각속도(rzb,UUV)는 식(4)와 같다. 여기서, φ식(5)와 같이 무인수상정의 자세와 예인형 무인수중정 자세와의 차분값이다. φ의 업데이트는 식(6)과 같으므로 식(4)식(6)에 대입하여 식(7)φ의 업데이트를 표현한다.

vxb,UUV=vxb,USVcosϕ(3) 
rzb,UUV=-vxb,USVsinϕL(4) 
ϕ=ψUUV-ψUSV(5) 
ϕ˙=rzb,UUZ-rzb,USV(6) 
ϕ˙=vxb,USVsinϕL-rzb,USV(7) 

2.2 무인수상정 동적 모델 식별

Nomoto 모델은 식(8)과 같이 입력 조타각에 대한 출력 헤딩 및 각속도 동적 모델설계에 가장 널리 사용되고 있다.16,17 1차 선형 시스템 형태의 가장 간단한 동적 모델이므로 몇 가지 기동시험을 통해 게인 Kr와 시정수 Tr를 도출하여 입력 조타각(δS)에 대한 출력 각속도(r) 동적 모델 설계에 식별을 할 수 있다.

본 논문에서는 Figs. 3부터 5와 같이 빨간색 영역의 각가속도 선회 구간(1, 2)과 파란색 영역의 등각속도 선회 구간(2, 3)으로 구분하여 각속도(r) 동적 모델에 대한 게인 Kr와 시정수 Tr를 도출한다. 우선, 식(9)와 같이 식(8)을 임의의 t 시간 동안 적분을 하면 식(10)으로 표현할 수 있다. 식(11)식(10)을 등각속도 구간(2, 3)에 대해 적용하였고, r23은 0과 같으므로 식(11)식(12)로 정리하여 게인 K^r을 추정한다. 추정된 게인 Kr을 이용하여 각가속도 구간(1, 2)에 대하여 식(13)에 적용하고, 식(14)과 같이 시정수 T^r을 추정한다.

Fig. 3

Steer input of USV curve maneuvering

Fig. 4

Angular velocity output of USV curve maneuvering

Fig. 5

Heading output of USV curve maneuvering

Trr˙+r=KrδS(8) 
Tr0tr˙dt+0trdt=Kr0tδSdt(9) 
Trr0t+ψ0t=Kr0tδSdt(10) 
Trr23+ψ23=Kr23δSdt(11) 
K^r=ψ3-ψ2/23δSdt(12) 
Trr12+ψ12=Kr12δSdt(13) 
Tr=K^r12δSdt-ψ2-ψ2/r2-r1(14) 

각속도 동적 식별 계수를 추정하는 방법대로, 입력 추력(δT)에 대한 출력 속도(v) 동적 모델도 게인 Kv와 시정수 Tv를 가지는 1차 선형 시스템으로 가정한다.11,12 Figs. 67과 같이 빨간색 영역의 가속도 직진 구간(1, 2)과 파란색 영역의 등속도 직진 구간(2, 3)으로 구분하여, 식(15)부터 식(21)과 같이 게인 K^v과 시정수 T^v를 추정한다.

Fig. 6

Thrust input of USV straight maneuvering

Fig. 7

Velocity output of USV straight maneuvering

Tvv˙+v=KvδT(15) 
Tv0tv˙dt+0tvdt=Kv0tδTdt(16) 
Tvv0t+0tvdt=Kv0tδTdt(17) 
Tvv23+23vdt=Kv23δTdt(18) 
K^v=23vdt/23δSdt(19) 
Tvv12+12vdt=Kv12δTdt(20) 
T^v=K^v12δTdt-12vdt/v2-v1(21) 

3. 무인수상정 경로 추종 제어

3.1 무인수상정 제어

식별된 무인수상정 동적모델을 이용하여 자세 및 속도 제어기를 설계한다. 자세 제어기는 Fig. 8과 같이 이중 루프 피드백 구조로 비례미분 제어기로 구성하였다. 구성한 자세 제어기 구조의 입력 조타각(δS)은 식(22)와 같으며, 식(8)을 자세변수에 대한 미분값으로 표현하고, 이를 입력 조타각(δS)에 대해 정리하면 식(23)과 같다. 식(22)식(23)은 같으므로 식(24)와 같이 정리될 수 있으며, 이는 식(25)와 같이 디자인 제어 파라미터 감쇠비(ζ)와 공진주파수(ωn)를 가지는 2차 시스템이다.18 식(24)식(25)는 같으므로 자세 제어 비례 게인(K1)와 자세 제어 미분 게인(K2)는 식(25)식(26)과 같이 동적 모델 계수(Kr, Tr)와 함께 나타낼 수 있다.

Fig. 8

Attitude control of USV scheme

δS=K1K2ψc-ψ-ψ˙(22) 
δS=1KrTrψ¨+ψ˙(23) 
ψ¨+1+KrK1Trψ˙+KrK1K2Trψ=KrK1K2Trψc(24) 
ψ¨+2ζωnψ˙+ωn2ψ=ωn2ψc(25) 
K1=2ζωnTr-1/Kr(26) 
K2=wn2Tr/2ζωnTr-1(27) 

속도 제어기는 Fig. 9와 같이 비례 제어기로 구성하였다. 구성한 속도 제어기 구조의 입력 추력(δT)은 식(28)과 같으며, 식(15)를 입력 추력(δT)에 대해 정리하면 식(29)와 같다. 식(28)식(29)는 같으므로 식(30)과 같이 정리될 수 있으며, 속도 제어 비례 게인(K1)는 식(25)의 자세 제어 미분 게인(K1)과 같은 상에 있으므로 식(31)로 표현할 수 있다.

Fig. 9

Velocity control of USV scheme

δT=K1vc-v(28) 
δT=1KvTvv˙+1(29) 
v˙+1+KvK1Tvv=KvK1Tvvc(30) 
K1=2ζωnTv-1/Kv(31) 

3.2 예인형 무인수중정 기반 무인수상정 경로 추종

예인형 무인수중정의 운동은 식(3)부터 식(7)에서 알 수 있듯이 무인수상정의 운동과 예인케이블 길이에 의해 종속된다. 종속된 관계를 역이용하여 무인수중정의 각속도, 자세, 속도와 같은 경로계획 프로파일이 정해진다면, 무인수상정의 경로계획을 세울 수 있다. 식(32)는 무인수중정의 각속도(rz,profileb,UUN) 프로파일을 충족하기 위한 지향되어야 할 무인수중정과 무인수상정과의 자세 차이(φdesird)를 말한다. 식(32)φdesird가 결정되면, 식(33)과 같이 지향되어야 할 무인수상정의 자세(ψdesiredUSV)값이 된다. 그리고 식(34)는 무인수중정의 속도(vx,profileb, UUV) 프로파일을 충족하기 위한 지향되어야 할 무인수상정의 속도(vx,desirdb, USV)를 나타낸다. 지향되어야 할 무인수상정의 속도 및 자세가 결정되면, 식(1)에 따라 무인수상정의 경로가 결정되며, 이는 무인수상정의 경로점으로 이용하여 유도명령을 내릴 수 있다.

ϕdesired=sin-1Lrz,profileb,UUV/vzb,USV(32) 
ψdesiredUSV=ψprofileUUV-ϕdesired(33) 
vx,desirdb, USV=vx,profileb, UUV/cosϕdesiredη˙=Rψv(34) 

Fig. 10은 무인수상정의 경로점에 대한 유도기법을 설명한다. 무인수상정의 현재 위치(xUSVlocal,yUSVlocal)와 첫 번째 경로점(x1wp,y1wp) 및 두 번째 경로점(x2wp,y2wp)이 있다면, 기존의 무인수상정 Line of Sight (LOS) 지향벡터(l) 및 LOS 지향자세(ψl)를 통해 유도명령을 내릴 수 있다.19 LOS 방법으로는 위치 및 자세가 점진적으로 경로계획과 수렴하여 경로계획 오차가 줄어들지만, 경로계획 오차가 존재한 상태로 경로 추종이 이루어지므로 효율적인 경로 추종 방법이 필요하다.

Fig. 10

Guidance of USV scheme

본 논문에서는 경로 추종 효율을 높이고자, 수선거리(d)를 도입한다. 수선거리(d)는 현재의 위치를 기준으로 이전 경로점 및 다음 경로점의 경로선과의 최단거리이다. 수선거리(d)에 따라 Table 1과 같이 원거리에서는 수선위치(xUSVlocal,yUSVlocal) 방향(d)으로의 지향자세(ψd)를 추가하였고 수선거리(d)가 원거리가 아닐 때는 거리별로 회전반경(R)을 조절하여 기존의 LOS 방법의 지향자세(ψR,ψl)를 적용하였다.

Heading desired of USV respect to perpendicular distance


4. 시뮬레이션 검증

4.1 무인수상정 동적 모델 식별 결과

무인수상정의 동적 모델은 특정 속도(u0)에 따라 달라지므로, 속도에 따른 적응 모델이 필요하다. 본 논문에서는 속도 구간(4.87-16.02 m/s)의 9개 직진 시험 데이터과 조타각 ±10° 내외인 상태에서 속도 구간(4.02-8.74 m/s)의 6개 선회 시험 데이터를 획득하였다. 획득한 시험 데이터를 바탕으로 추정한 동적 모델 식별 계수(K^v,T^v,K^r,T^r) 분포는 Figs. 11부터 14와 같이 속도에 따라 선형적으로 나타나므로, 최소제곱법을 통해 1차 선형 모델로 가정하였다. 동적 모델 식별 계수 결과는 Table 2와 같다.

Fig. 11

Coefficient (K^v) identification versus velocity of dynamic model (Velocity versus RPM)

Fig. 12

Coefficient (T^v) identification versus velocity of dynamic model (Velocity versus RPM)

Fig. 13

Coefficient (K^r) identification versus velocity of dynamic model (Angular velocity versus steer)

Fig. 14

Coefficient (T^r) identification versus velocity of dynamic model (Angular velocity versus steer)

Dynamic model identification coefficients of USV respect to velocity

동적 모델 식별 계수를 적용한 동적 모델을 검증하고자 입력 값에 대한 시험 데이터와 모델 결과값을 비교하였다. Fig. 15의 파란색은 입력 조타각(δr)에 대한 출력 각속도(r) 시험 데이터이며, 빨간색은 입력 조타각(δr)에 대한 각속도(r) 동적 모델 결과이다. 시험 데이터 각속도와 각속도 동적 모델 결과와 유사함을 확인하였다. 마찬가지로 Fig. 16의 파란색은 입력 추력(δT)에 대한 출력 속도(v) 시험 데이터이며, 빨간색은 입력 추력(δT)에 대한 속도(v) 동적 모델 결과이다. 시험 데이터 속도와 속도 동적 모델 결과와 유사함을 확인하였다.

Fig. 15

USV angular velocity dynamic model

Fig. 16

USV velocity dynamic model

4.2 무인수상정 제어 결과

Fig. 17은 무인수상정의 헤딩 명령에 따른 헤딩 결과이다. 초기 헤딩 0에서 100° 헤딩 명령을 주었을 때, 헤딩 명령값으로 수렴함을 확인하였다. 그리고 Fig. 18은 무인수상정의 속도 명령에 따른 속도 결과이다. 초기 속도 0에서 5 m/s 속도 명령을 주었을 때, 속도 명령값으로 근접함을 확인하였다.

Fig. 17

USV heading control

Fig. 18

USV velocity control

4.3 무인수상정 경로 추종 제어 결과

4.3.1 무인수상정 경로 추종 제어

무인수중정 계획경로 기반 무인수상정 경로 추종 제어 검증에 앞서, 무인수상정만의 경로 추종 제어를 검증하였다. Figs. 1920과 같이 속도 및 자세 제어 명령값으로 출력됨을 확인하였으며, 21과 같이 7개의 경로점 설정 후 초기 헤딩 90° 및 초기 속도 0 m/s에서 주행을 시작하여 경로계획에 따라 추종됨을 확인하였다. 특히 시작 지점과 Fig. 21의 ① 경로점은 원거리이므로 ① 경로점과 ② 경로점과의 수선 방향으로 진입하였다. 그 결과, ① 경로점 진입 이전부터 경로선 방향과 일치하게 되므로 경로계획을 동적으로 추종할 수 있음을 확인하였다.

Fig. 19

USV velocity control for waypoints

Fig. 20

USV heading control for waypoints

Fig. 21

USV path-following control for waypoints

4.3.2 예인형 무인수중정 경로계획 기반 무인수상정 경로 추종 제어

예인형 무인수중정 경로계획 기반 무인수상정 경로 추종 제어를 확인하기 앞서, 예인형 무인수중정의 경로계획은 Table 3과 같이 설정하였다. 무인수중정 경로계획에 따른 무인수상정의 경로계획(속도, 자세, 위치)은 Figs. 22부터 24와 같다.

Profile of UUV path plan

Fig. 22

USV velocity plan respect to UUV path plan

Fig. 23

USV attitude plan respect to UUV path plan

Fig. 24

USV path plan respect to UUV path plan

예인형 무인수중정 경로계획 기반 무인수상정 경로 추종 제어를 바탕으로 예인형 무인수중정 운동 결과를 확인하였다. Figs. 2526은 초록색은 예인형 무인수중정 경로계획을, 파란색은 예인형 무인수중정 경로계획에 따른 무인수상정의 경로 계획을 나타낸다. 핑크색 점선은 무인수상정의 경로 추종 제어 결과이며, 빨간색 점선은 무인수상정 경로 추종 제어에 따른 예인형 무인수중정 경로 결과이다. Figs. 25는 기존의 LOS 방법을 적용한 결과이며, 26은 기존의 LOS 방법과 경로선과 수선 방향인 지향자세(ψd)를 결합한 결과이다. 제안한 유도명령기법을 통해 무인수상정과 무인수중정 모두 경로계획에 손실 없이 추종할 수 있음을 확인하였다.

Fig. 25

USV and UUV path following using conventional LOS vector method

Fig. 26

USV and UUV path following using combined method of perpendicular and LOS vector


5. 결론

본 논문은 무인수상정 동력을 도움을 받아 무인수중정의 탐색 범위를 넓힐 수 있도록 기본적이고, 실질적인 무인수상정의 경로추종제어 설계를 제안하였다. 무인수상정의 1차 시스템의 동적 모델 식별 방법을 제안하였으며, 속도에 따라 가변적으로 동적 모델이 적응될 수 있게 설계하였다. 또한 기존의 PID 제어 방법을 활용하고, LOS 유도 명령 보완을 통하여 무인수상정의 경로 추종제어를 설계하였다. 마지막으로 예인형 무인수중정과 무인수상정의 운동 모델 관계를 역이용하여 예인형 무인수중정 경로계획을 기반한 무인수상정의 경로 추종 제어를 설계하였다. 제안된 설계 기법을 통해 무인수상정 및 예인형 무인수중정의 경로 계획대로 추종 및 효율성을 확인하였다.

NOMENCLATURE

pxi,USV,pvi,USVm : USV Position in the Inertia Frame W.R.T North, East Direction
vxi,USV,vvi,USVm/s : USV Velocity in the Inertia Frame W.R.T North, East Direction
pxi,UUV,pvi,UUVm : UUV Position in the Inertia Frame W.R.T North, East Direction
vxi,UUV,vvi,UUVm/s : UUV Velocity in the Inertia Frame W.R.T North, East Direction
vxb,USV,vvb,USVm/s : USV Velocity in the Body Frame W.R.T Surge, Sway Direction
vxb,UUV,vvb,UUVm/s : UUV Velocity in the Body Frame W.R.T Surge, Sway Direction
ψUSV [rad] : USV Heading
ψUUV [rad] : UUV Heading
ωzb,USVrad/s : USV Angular Velocity
ωzb,UUVrad/s : UUV Angular Velocity
φ [rad] : Difference with ψUUV and ψUSV
L [m] : Towed Cable Length
R(ψ) : Rotation Matrix (From Body Frame to Inertia Frame)
δS [rad] : USV Steer Input
δT [rpm] : USV Thrust Input

REFERENCES

  • Manley, J. E., “Unmanned Surface Vehicles, 15 Years of Development,” Oceans, pp. 1-4, 2008. [https://doi.org/10.1109/OCEANS.2008.5289429]
  • Bertram, V., “Unmanned Surface Vehicles-A Survey,” Skibsteknisk Selskab, Copenhagen, Denmark, Vol. 1, pp. 1-14, 2008.
  • Heo, J., Kim, J., and Kwon, Y., “Technology Development of Unmanned Underwater Vehicles (UUVs),” Journal of Computer and Communications, Vol. 5, No. 7, Paper No. 76166, 2017.
  • Lee, J. E., “Technology Development Trends Analysis and Development Plan of Unmanned Underwater Vehicle,” Journal of the Korea Academia-Industrial Cooperation Society, Vol. 20, No. 9, pp. 233-239, 2019.
  • ECA Group, “Subsea World News: ECA Group Shows Off USV/ROV Combo for Subsea IMR Operations,” https://www.ecagroup.com/en/business/subsea-world-news-eca-group-shows-off-usvrov-combo-for-subsea-imr-operations, (Accessed 13 DECEMBER 2021)
  • Unmanned Systems Technology, “[Video] Thales, ASV & SAAB Complete Unmanned Mine Countermeasures Exercise,” https://www.unmannedsystemstechnology.com/2013/10/video-thales-asv-saab-complete-unmanned-mine-countermeasures-exercise, (Accessed 13 DECEMBER 2021)
  • Northrop Grumman, “Northrop Grumman Successfully Completes Initial In-Water Testing of the AQS-24 Mine Hunting Sonar Using a Next Generation Deploy and Retrieval Payload,” https://news.northropgrumman.com/news/releases/northrop-grumman-successfully-completes-initial-in-water-testing-of-the-aqs-24-mine-hunting-sonar-using-a-next-generation-deploy-and-retrieval-payload, (Accessed 13 DECEMBER 2021)
  • Fossen, T. I., “Handbook of Marine Craft Hydrodynamics and Motion Control,” John Wiley & Sons, 2011. [https://doi.org/10.1002/9781119994138]
  • Abkowitz, M. A., “Lectures on Ship Hydrodynamics-Steering and Manoeuvrability,” Proc. of the Transportation Research Board 101st Annual Meeting, Paper No. HY-5, 1964.
  • Norrbin, N. H., “Theory and Observations on the Use of a Mathematical Model for Ship Manoeuvring in Deep and Confined Waters,” Proc. of the Transportation Research Board 101st Annual Meeting, Paper No. SSPA-Pub-68, 1971.
  • Sonnenburg, C. R. and Woolsey, C. A., “Modeling, Identification, and Control of an Unmanned Surface Vehicle,” Journal of Field Robotics, Vol. 30, No. 3, pp. 371-398, 2013. [https://doi.org/10.1002/rob.21452]
  • Shin, J., Kwak, D. J., and Lee, Y.-I., “Adaptive Path-Following Control for an Unmanned Surface Vessel Using an Identified Dynamic Model,” IEEE/ASME Transactions on Mechatronics, Vol. 22, No. 3, pp. 1143-1153, 2017. [https://doi.org/10.1109/TMECH.2017.2651057]
  • Nomoto, K., Taguchi, K., Honda, K., and Hirano, S., “On the Steering Qualities of Ships,” Journal of Zosen Kiokai, Vol. 1956, No. 99, pp. 75-82, 1956. [https://doi.org/10.2534/jjasnaoe1952.1956.99_75]
  • Mishra, P., Panigrahi, S., and Das, S., “Ships Steering Autopilot Design by Nomoto Model,” International Journal on Mechanical Engineering and Robotic, Vol. 3, No. 3, pp. 37-41, 2015.
  • Wi, Y.-U., Kim, H.-H., Ha, Y.-S., and Jin, G.-G., “Backward Path Tracking Control of a Trailer Type Robot Using a RCGS-Based Model,” Journal of Institute of Control, Robotics and Systems, Vol. 7, No. 9, pp. 717-722, 2001.
  • Al-Awad, N. A., “Model Reference Adaptive Control-Based Genetic Algorithm Design for Heading Ship Motion,” Acta Polytechnica, Vol. 60, No. 3, 2020. [https://doi.org/10.14311/AP.2020.60.0197]
  • Yu, Z., Bao, X., and Nonami, K., “Course Keeping Control of an Autonomous Boat Using Low Cost Sensors,” Journal of System Design and Dynamics, Vol. 2, No. 1, pp. 389-400, 2008.s [https://doi.org/10.1299/jsdd.2.389]
  • Temiz, I., “An Investigation on the Ship Rudder with Different Control System,” Elektronika ir Elektrotechnika, Vol. 105, No. 9, pp. 28-32, 2010.
  • Fossen, T. I., Breivik, M., and Skjetne, R., “Line-of-Sight Path Following of Underactuated Marine Craft,” IFAC Proceedings Volumes, Vol. 36, No. 21, pp. 211-216, 2003. [https://doi.org/10.1016/S1474-6670(17)37809-6]
Pyung Mo Ku

Research Engineer in LIGNex1. His research interest is GNC M&S of unmanned systems.

E-mail: pyungmo.ku@lignex1.com

Jae Kwan Ryu

Chief Research Engineer in LIGNex1. His research interest is Unmanned systems (USV, UGV).

E-mail: jaekwan.ryu@lignex1.com

Won Hee Lee

Chief Research Engineer in LIGNex1. His research interest is Unmanned systems (USV, UGV).

E-mail: wonhee.lee@lignex1.com

Fig. 1

Fig. 1
Development case of unmanned maritime integrated system

Fig. 2

Fig. 2
Kinematics of USV and towed UUV

Fig. 3

Fig. 3
Steer input of USV curve maneuvering

Fig. 4

Fig. 4
Angular velocity output of USV curve maneuvering

Fig. 5

Fig. 5
Heading output of USV curve maneuvering

Fig. 6

Fig. 6
Thrust input of USV straight maneuvering

Fig. 7

Fig. 7
Velocity output of USV straight maneuvering

Fig. 8

Fig. 8
Attitude control of USV scheme

Fig. 9

Fig. 9
Velocity control of USV scheme

Fig. 10

Fig. 10
Guidance of USV scheme

Fig. 11

Fig. 11
Coefficient (K^v) identification versus velocity of dynamic model (Velocity versus RPM)

Fig. 12

Fig. 12
Coefficient (T^v) identification versus velocity of dynamic model (Velocity versus RPM)

Fig. 13

Fig. 13
Coefficient (K^r) identification versus velocity of dynamic model (Angular velocity versus steer)

Fig. 14

Fig. 14
Coefficient (T^r) identification versus velocity of dynamic model (Angular velocity versus steer)

Fig. 15

Fig. 15
USV angular velocity dynamic model

Fig. 16

Fig. 16
USV velocity dynamic model

Fig. 17

Fig. 17
USV heading control

Fig. 18

Fig. 18
USV velocity control

Fig. 19

Fig. 19
USV velocity control for waypoints

Fig. 20

Fig. 20
USV heading control for waypoints

Fig. 21

Fig. 21
USV path-following control for waypoints

Fig. 22

Fig. 22
USV velocity plan respect to UUV path plan

Fig. 23

Fig. 23
USV attitude plan respect to UUV path plan

Fig. 24

Fig. 24
USV path plan respect to UUV path plan

Fig. 25

Fig. 25
USV and UUV path following using conventional LOS vector method

Fig. 26

Fig. 26
USV and UUV path following using combined method of perpendicular and LOS vector

Table 1

Heading desired of USV respect to perpendicular distance

Condition ψdesired
d > 2R ψd
R< d < 2R ψR2
0.5R< d <R ψR1
d < 0.5R ψ1

Table 2

Dynamic model identification coefficients of USV respect to velocity

Coefficient f(u)
Kv 0.0004·u + 0.0014
Tv 1.1737·u - 2.2474
Kr -0.0113·u + 0.7176
Tr -0.1534·u + 2.6341

Table 3

Profile of UUV path plan

No T [sec] vxUUN [m/s] ψUUV [deg] Description
1 0-50 4 45 200 m North-east
2 50-81.4 4 45 → 225.1
(= -134.9)
R = 40 m, Half rotation
(Clockwise)
3 81.4-131.1 4 -134.9 200 m South-west
4 131.4-162.8 4 -134.9→-315
(= 45)
R = 40 m, Half rotation
(Counter clockwise)
5 162.8-212.8 4 45 200 m North-east