About the JKSPE | Browse Articles | Editorial Committe | For Reviewers | For Authors | ํ |
Sorry.
You are not permitted to access the full text of articles.
If you have any questions about permissions,
please contact the Society.
์ฃ์กํฉ๋๋ค.
ํ์๋์ ๋ ผ๋ฌธ ์ด์ฉ ๊ถํ์ด ์์ต๋๋ค.
๊ถํ ๊ด๋ จ ๋ฌธ์๋ ํํ๋ก ๋ถํ ๋๋ฆฝ๋๋ค.
HOME > Browse Articles > Archive
[ REGULAR ] | |
Journal of the Korean Society for Precision Engineering - Vol. 39, No. 1, pp. 35-44 | |
Abbreviation: J. Korean Soc. Precis. Eng. | |
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차 동적 모델 식별 및 예인형 무인수중정 경로 계획을 이용한 무인수상정의 경로 추종 제어 | |
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 | |
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. | |
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-4 그동안은 무인수상정 및 무인수중정에 대하여 개별적으로 연구가 진행됐지만, 최근에는 무인수상정과 예인형 무인수중정을 함께 연동하는 해양무인복합체계 개발이 진행되고 있다. Fig. 1과 같이 대표적으로 ECA Group사의 Inspector 및 H300V,5 Thales사와 L3 ASV사의 Halcyon 및 SAAB사의 Seaeye,6 그리고Northrop Grumman사의 MCM 및 AQS-24가 개발되었다.7
이러한 무인수상정과 예인형 무인수중정 결합시스템은 무인수중정 운용의 단점을 보완해준다. 운용 시나리오에 따라 무인수상정의 빠른 기동성과 경로점 자율 운항을 이용하여 무인수중정의 광역 탐색이 가능하고, 강조류 하에서도 무인수상정의 예인을 도움 받아 무인수중정의 정밀 탐색이 가능하다. 또한 예인케이블을 통해 무인수상정의 위치 정보를 받아 무인수중정의 위치 추정이 가능하여, 무인수상정은 무인수중정으로부터 상태 정보를 실시간으로 받을 수 있어 무인수상정의 대응 속도가 빠르다. 무인수상정 및 예인형 무인수중정의 임무수행을 효과적으로 적용하려면, 우선적으로 무인수상정 및 무인수중정의 경로 추종 제어 설계가 선행되야 한다. 하지만 무인수상정 및 무인수중정이 결합된 형태의 경로 추종 제어에 대한 연구는 많이 부족한 상태이다.
본 논문에서는 예인형 무인수중정이 무인수상정의 동력 도움을 받아 무인수중정의 탐색 범위를 넓힐 수 있도록 기본적이고 실질적인 무인수상정의 경로 추종제어 설계를 제안한다. 경로추종 제어 설계를 하기 위해서는 선제적으로 무인수상정 동적 모델 및 식별이 필요하다. 일반적으로 무인수상정 동적 모델은 유체력, 풍력, 파고 등 외란의 외력이 존재하기에 상당히 비선형적이다.8 비선형적인 무인수상정 동적 모델로 제어기 설계하는 것은 단순한 작업이 아니므로, 선형적으로 단순화된 무인수상정 동적 모델들이 연구됐다.9-14 단순화된 무인수상정 동적 모델 중 1차 시스템의 속도 모델11,12과 각속도 모델13,14을 선정하여, 직진 및 선회 실선시험을 통해 가속도 및 등속도 데이터와 각가속도 및 등각속도 데이터를 이용한 동적 모델 식별 방법을 제안하였고, 속도별 직진 및 선회 실선 시험을 확보하여 동적 모델을 속도에 따라 가변적으로 적응될 수 있게 설계하였다. 무인수상정 속도 및 자세 제어기는 계산량도 적고 효과적인 PID 제어로 선정하였으며, 무인수상정의 경로계획상의 수선거리별로 회전 반경을 다르게 하여 무인수상정 경로선을 동적으로 추정할 수 있도록 기존의 LOS 방법을 보완하였다. 최종적으로 예인형 무인수중정이 경로계획을 추종될 수 있도록 무인수상정 운동에 따른 예인형 무인수중정 운동 모델 관계를 역이용하여 예인형 무인수중정 경로계획을 기반한 무인수상정의 경로계획을 제안하였다.
논문의 구성은 다음과 같다. 2장에서는 무인수상정 및 예인형 무인수중정 운동 모델을 설명하고, 무인수상정 동적 모델 식별 방법을 제안한다. 3장에서는 무인수상정 제어와 예인형 무인수중정 경로계획 기반 무인수상정 경로계획을 제안한다. 4장에서는 성능 검증을 위해 시뮬레이션을 통해 분석한다. 마지막으로 5장에서 결론을 맺는다.
본 운동 모델은 Fig. 2와 같이 2차원 평면상 운동을 가정하여 무인수상정 및 예인형 무인수중정에 대한 운동모델은 식(1)과 같다.
(1) |
여기서 위치벡터(η)는
(2) |
무인수상정과 예인형 무인수중정은 예인케이블 장력이 존재하고 케이블의 방향과 예인형 무인수중정의 자세가 같다는 가정하에 트렉터-트레일러 관계15로 정의하였다. 무인수중정의 진행방향 속도(
(3) |
(4) |
(5) |
(6) |
(7) |
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)에 대해 적용하였고,
(8) |
(9) |
(10) |
(11) |
(12) |
(13) |
(14) |
각속도 동적 식별 계수를 추정하는 방법대로, 입력 추력(δT)에 대한 출력 속도(v) 동적 모델도 게인 Kv와 시정수 Tv를 가지는 1차 선형 시스템으로 가정한다.11,12 Figs. 6과 7과 같이 빨간색 영역의 가속도 직진 구간(1, 2)과 파란색 영역의 등속도 직진 구간(2, 3)으로 구분하여, 식(15)부터 식(21)과 같이 게인
(15) |
(16) |
(17) |
(18) |
(19) |
(20) |
(21) |
식별된 무인수상정 동적모델을 이용하여 자세 및 속도 제어기를 설계한다. 자세 제어기는 Fig. 8과 같이 이중 루프 피드백 구조로 비례미분 제어기로 구성하였다. 구성한 자세 제어기 구조의 입력 조타각(δS)은 식(22)와 같으며, 식(8)을 자세변수에 대한 미분값으로 표현하고, 이를 입력 조타각(δS)에 대해 정리하면 식(23)과 같다. 식(22)와 식(23)은 같으므로 식(24)와 같이 정리될 수 있으며, 이는 식(25)와 같이 디자인 제어 파라미터 감쇠비(ζ)와 공진주파수(ωn)를 가지는 2차 시스템이다.18 식(24)와 식(25)는 같으므로 자세 제어 비례 게인(K1)와 자세 제어 미분 게인(K2)는 식(25)와 식(26)과 같이 동적 모델 계수(Kr, Tr)와 함께 나타낼 수 있다.
(22) |
(23) |
(24) |
(25) |
(26) |
(27) |
속도 제어기는 Fig. 9와 같이 비례 제어기로 구성하였다. 구성한 속도 제어기 구조의 입력 추력(δT)은 식(28)과 같으며, 식(15)를 입력 추력(δT)에 대해 정리하면 식(29)와 같다. 식(28)과 식(29)는 같으므로 식(30)과 같이 정리될 수 있으며, 속도 제어 비례 게인(K1)는 식(25)의 자세 제어 미분 게인(K1)과 같은 상에 있으므로 식(31)로 표현할 수 있다.
(28) |
(29) |
(30) |
(31) |
예인형 무인수중정의 운동은 식(3)부터 식(7)에서 알 수 있듯이 무인수상정의 운동과 예인케이블 길이에 의해 종속된다. 종속된 관계를 역이용하여 무인수중정의 각속도, 자세, 속도와 같은 경로계획 프로파일이 정해진다면, 무인수상정의 경로계획을 세울 수 있다. 식(32)는 무인수중정의 각속도(
(32) |
(33) |
(34) |
Fig. 10은 무인수상정의 경로점에 대한 유도기법을 설명한다. 무인수상정의 현재 위치(
본 논문에서는 경로 추종 효율을 높이고자, 수선거리(
Condition | ψdesired |
---|---|
R< |
|
0.5R< |
|
무인수상정의 동적 모델은 특정 속도(u0)에 따라 달라지므로, 속도에 따른 적응 모델이 필요하다. 본 논문에서는 속도 구간(4.87-16.02 m/s)의 9개 직진 시험 데이터과 조타각 ±10° 내외인 상태에서 속도 구간(4.02-8.74 m/s)의 6개 선회 시험 데이터를 획득하였다. 획득한 시험 데이터를 바탕으로 추정한 동적 모델 식별 계수(
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 |
동적 모델 식별 계수를 적용한 동적 모델을 검증하고자 입력 값에 대한 시험 데이터와 모델 결과값을 비교하였다. Fig. 15의 파란색은 입력 조타각(δr)에 대한 출력 각속도(r) 시험 데이터이며, 빨간색은 입력 조타각(δr)에 대한 각속도(r) 동적 모델 결과이다. 시험 데이터 각속도와 각속도 동적 모델 결과와 유사함을 확인하였다. 마찬가지로 Fig. 16의 파란색은 입력 추력(δT)에 대한 출력 속도(v) 시험 데이터이며, 빨간색은 입력 추력(δT)에 대한 속도(v) 동적 모델 결과이다. 시험 데이터 속도와 속도 동적 모델 결과와 유사함을 확인하였다.
Fig. 17은 무인수상정의 헤딩 명령에 따른 헤딩 결과이다. 초기 헤딩 0에서 100° 헤딩 명령을 주었을 때, 헤딩 명령값으로 수렴함을 확인하였다. 그리고 Fig. 18은 무인수상정의 속도 명령에 따른 속도 결과이다. 초기 속도 0에서 5 m/s 속도 명령을 주었을 때, 속도 명령값으로 근접함을 확인하였다.
무인수중정 계획경로 기반 무인수상정 경로 추종 제어 검증에 앞서, 무인수상정만의 경로 추종 제어를 검증하였다. Figs. 19와 20과 같이 속도 및 자세 제어 명령값으로 출력됨을 확인하였으며, 21과 같이 7개의 경로점 설정 후 초기 헤딩 90° 및 초기 속도 0 m/s에서 주행을 시작하여 경로계획에 따라 추종됨을 확인하였다. 특히 시작 지점과 Fig. 21의 ① 경로점은 원거리이므로 ① 경로점과 ② 경로점과의 수선 방향으로 진입하였다. 그 결과, ① 경로점 진입 이전부터 경로선 방향과 일치하게 되므로 경로계획을 동적으로 추종할 수 있음을 확인하였다.
예인형 무인수중정 경로계획 기반 무인수상정 경로 추종 제어를 확인하기 앞서, 예인형 무인수중정의 경로계획은 Table 3과 같이 설정하였다. 무인수중정 경로계획에 따른 무인수상정의 경로계획(속도, 자세, 위치)은 Figs. 22부터 24와 같다.
No | T [sec] | ψ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 |
예인형 무인수중정 경로계획 기반 무인수상정 경로 추종 제어를 바탕으로 예인형 무인수중정 운동 결과를 확인하였다. Figs. 25와 26은 초록색은 예인형 무인수중정 경로계획을, 파란색은 예인형 무인수중정 경로계획에 따른 무인수상정의 경로 계획을 나타낸다. 핑크색 점선은 무인수상정의 경로 추종 제어 결과이며, 빨간색 점선은 무인수상정 경로 추종 제어에 따른 예인형 무인수중정 경로 결과이다. Figs. 25는 기존의 LOS 방법을 적용한 결과이며, 26은 기존의 LOS 방법과 경로선과 수선 방향인 지향자세(
본 논문은 무인수상정 동력을 도움을 받아 무인수중정의 탐색 범위를 넓힐 수 있도록 기본적이고, 실질적인 무인수상정의 경로추종제어 설계를 제안하였다. 무인수상정의 1차 시스템의 동적 모델 식별 방법을 제안하였으며, 속도에 따라 가변적으로 동적 모델이 적응될 수 있게 설계하였다. 또한 기존의 PID 제어 방법을 활용하고, LOS 유도 명령 보완을 통하여 무인수상정의 경로 추종제어를 설계하였다. 마지막으로 예인형 무인수중정과 무인수상정의 운동 모델 관계를 역이용하여 예인형 무인수중정 경로계획을 기반한 무인수상정의 경로 추종 제어를 설계하였다. 제안된 설계 기법을 통해 무인수상정 및 예인형 무인수중정의 경로 계획대로 추종 및 효율성을 확인하였다.
USV Position in the Inertia Frame W.R.T North, East Direction | |
USV Velocity in the Inertia Frame W.R.T North, East Direction | |
UUV Position in the Inertia Frame W.R.T North, East Direction | |
UUV Velocity in the Inertia Frame W.R.T North, East Direction | |
USV Velocity in the Body Frame W.R.T Surge, Sway Direction | |
UUV Velocity in the Body Frame W.R.T Surge, Sway Direction | |
ψUSV [rad] : | USV Heading |
ψUUV [rad] : | UUV Heading |
USV Angular Velocity | |
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 |
1. | Manley, J. E., “Unmanned Surface Vehicles, 15 Years of Development,” Oceans, pp. 1-4, 2008. |
2. | Bertram, V., “Unmanned Surface Vehicles-A Survey,” Skibsteknisk Selskab, Copenhagen, Denmark, Vol. 1, pp. 1-14, 2008. |
3. | 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. |
4. | 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. |
5. | 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) |
6. | 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) |
7. | 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) |
8. | Fossen, T. I., “Handbook of Marine Craft Hydrodynamics and Motion Control,” John Wiley & Sons, 2011. |
9. | Abkowitz, M. A., “Lectures on Ship Hydrodynamics-Steering and Manoeuvrability,” Proc. of the Transportation Research Board 101st Annual Meeting, Paper No. HY-5, 1964. |
10. | 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. |
11. | 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. |
12. | 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. |
13. | 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. |
14. | 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. |
15. | 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. |
16. | Al-Awad, N. A., “Model Reference Adaptive Control-Based Genetic Algorithm Design for Heading Ship Motion,” Acta Polytechnica, Vol. 60, No. 3, 2020. |
17. | 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 |
18. | Temiz, I., “An Investigation on the Ship Rudder with Different Control System,” Elektronika ir Elektrotechnika, Vol. 105, No. 9, pp. 28-32, 2010. |
19. | 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. |
Research Engineer in LIGNex1. His research interest is GNC M&S of unmanned systems.
E-mail: pyungmo.ku@lignex1.com
Chief Research Engineer in LIGNex1. His research interest is Unmanned systems (USV, UGV).
E-mail: jaekwan.ryu@lignex1.com
Chief Research Engineer in LIGNex1. His research interest is Unmanned systems (USV, UGV).
E-mail: wonhee.lee@lignex1.com
์ฌ๋จ๋ฒ์ธ ํ๊ตญ์ ๋ฐ๊ณตํํ
(04508) ์์ธ์ ์ค๊ตฌ ์ค๋ฆผ๋ก 50-1, 12์ธต(๋ง๋ฆฌ๋ SKY1004๋น๋ฉ)
SKY 1004 Bldg. 12F, 50-1, Jungnim-ro, Jung-gu, Seoul, Republic of Korea
TEL +82-2-518-2928 l Fax +82-2-518-2937 l E-mail paper@kspe.or.kr
โ Copyright 2001 by KSPE. All Rights Reserved