Skip to main navigation Skip to main content
  • E-Submission

JKSPE : Journal of the Korean Society for Precision Engineering

OPEN ACCESS
ABOUT
BROWSE ARTICLES
EDITORIAL POLICIES
FOR CONTRIBUTORS
REGULAR

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

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

Journal of the Korean Society for Precision Engineering 2022;39(1):35-44.
Published online: January 1, 2022

1 LIG넥스원 무인체계연구소

1 Unmanned Systems Research Institute, LIGNex1 Co., Ltd. JFIFddDuckydqhttp://ns.adobe.com/xap/1.0/ Adobed     ! 1AQa"q 2#w8B36v7XRr$9bCt%u&Ws'(xy4T5fH  !1AQaq"2B Rbr#u67Ѳ3sTt5v8Sc$4ĂCÔ%UӅFV ?_Aנj- H>>,m*>fzp"TrKkr^r.|_&]|*vPuܶvoQ1mwVJUhu-I"=LniAƕ8"۲ k*ҿ[yu:.vUQ+)%F DHyVBk>Hy8jݹ q~9D4KRmzQ)^ʔ.J%k_tVi5NTjg!'ky|5asOȻ)R۸ߩFMԿ3L4j6dڜ#NIwUF]JqB/(FafJRzq3\G՛ ?~\ 6)6W4m[O^L0E&rRMض*C .]Unl-1 1r#Rj/&QɈ׉˩s6Rj=5Tg.y.·Pӡ:JJS:C8-2u]d&vUz;7p9 5VnL֢"y)">iי(IDDd| Yj0; LRfS:ktYK%*N2^m|&dğth":ey)uPQZW)gcC3Pv&MMWd&Ŵ۲mvTRoժM03*F3Yd6\8,\hݻ kߔi<k NTwSԪmljj[>->ptU%'LR>&EBH$MQAUx[$Z6vi&_a.KIQ{hyƒ j"JOC9eFҝfj;˚Ω<[3_m% lQ@4g=5$(J]Yc-OMq<Ǎ wSzڗ)k$7VIP붾ͯnV+卵*t]iЎD31~SA1éC2u)ʼnQn-Uoi3:grI8ؓWm*G zܕ)ZקJ}Y YlGeJ6cB2I NS3Q>k=KTBT]W6+SOXQgGR? telˊ%-Re\hѯ2TF"C/OJΩ6r[N.0{SpljjX1“jOsӥ;ҭhe}xu`Ք&.)yO̒ Fߑ.$Qw;9Iw2o+RVJMSOj[SoҌZ%;`d$blQ{Ro{Imڌ>3egf\O֝Uzx"䢸g+mv%Gʆ:|V[N'&ס-ޝ'kfE|K,G&˳98Juin/\\Qݿ̋v~Ǩ!rtWU d|E߫R4d}.qPw*Ӭv5YEcn~f5c%MTMkb-F>5JT,})QHg%{("ӔȸWMsYyWNRrkkJr0XドnͫT}r-jj,Ŕʍ\Q2Ri>v$5!]"JB2WɅ)]VԜUc8i|.jeRO6^V.¸ Q&#|ܶ-*uOG%JAtRZRr]FFG\۩w+?'zչSѧt jz>KW&ot{7P&2D;&\\>Q2JzܗAKSfeNn[jRrԕf6,q,F1tRfԗ>vֶևj-&R'Zi2=xv~Elbsvm8=ӛ"ū񕜈BȩlWau[]ٷBߨF~J!|Ipr3R̴#Yp)={7:G{+:\W}n|Q#%)7^-h"Ƒq:M*%J&$T軨I333׎g_- ucBwwjp[6i25$̏bU’ٱRv?G\~#Iͪb7<<}Ezt" q_Inw,7-d,G÷%T* Wg1"䥱kq/A.,_KhqŒxwvo u2ۥۧ.bQ}XκA$֣ +K״ZUNmڸII{.v{5z5ѮRme[moyƾd~cRݾK'j.\i&/S6f|b=5: p!6i_ 4j6=.si˧eƾtS^c.Y^RJVS-Vi3,esi08?H$GvZgg?gi䤟2adw릿:"۪lkSN>q-4kI܋ێe̊qۅgDoѨ9; #T.Q;7#~_Ufstb_'w~Xw1Xk,vcOt._}v}8"(4Z\ۘgk?J?bm_c!g{HZV]Fkk%~gEt)b秴vΰB|꽸}mp~E6ݹv;7P٤v+ri*3Ԣ|'O14_~7nP{7ZU\Vű[ +7󖱅o#:ǥŬ\|3r%TJX]V7ez¨Y]lc|O3V! R zbJ'PnGqVJ"19WVeOF埜EaEJωqCN5Z g-9[S<$sUK5b|7sn\7x qmv##FF\ w[=-43$^ooVSiXօv7iB۴yg>]Vf"r$J3""32!Zh[K%7GvNLs+4nB/B{vlsobJaҺJR:0g%&zR\ S3T[&ִor*ⷳc3ʊO[iozW٨%$gn:ܶWwFBԹjHP&z u&F2\f;ipW73 [; '_̽b;vib!oec dC-tS__$Xs]l9&z$2/N>%'[}b{h/{`{Ji׉׏ YJB/X%}.|+{(S:qz]4_Kѵo`^tY_4S#* ^zvݾMr+TrkQ g.8Ͽ^i>ӈǙvix>$o( ^qt*&t1oJVu-ql5U6jCЉmĻ*"?JT=K'O/|=Vo}l0b}}f?X[?/\JSBe,kP8ETJ==?.p5ފgbU9}ǶdNKk—_$8̸͓ۍ8Di\BԿ-1v{FF]|.^ۅ{vl12׏z7-R7wE?\nh\jN/Kձr_oBw"N QMBZqe-m:ӨSn6j4%!hQ;sv'm4kcM=!8\m[M4{SMliۇ%eֽR&N:{2A8)THLK3Zj[jPBx#BگMf:G1\`edcʮ?|w(-̮vXt,bW2;.ιNHRR#YwTM"<;mk\.foIDjmlJ;vxy7o7i\,KQŊ9d^Mmgc L*.T6tLeIuOH3SJQ3=F/ʿ<9\JM6mN6=<{xkP!F1QR[I$6ُimXu2An2yԒMU q f[IB-'䤯jYm52&JG\zд\~vdg QtHGXw&1Lw+nDEdC1w|YJmvP)HZ>i0BPβә?R:QO["]I_Jʏۍ>QKyu^bycBq4lXF~l [\*N>-J6,Gq(Zr5h]CwYӤU~ʶߑ u*SIv%ZfJ7)! FS*s_\|IŸZ)J ]ܜi4"z[+Z,MOZ))}|Ʀ(RUNIII.S'ˍO~˨rn}M)xxӕ0 eyҵ7YMAB]ӣU:/ѭ*6bcwP͵ "+qēVjŹO|GtY4V j[mLV M -m>",B$ GD1~j6O4|LxnNmqATNR3ε|DŽa[fmn-ڭ+FiK7Pcm;r5 l8r{#-]'nrFh2ruycb;pW=njRqRJ(d mnpckNnʹ+6]tz~E=ʕ l ZZ5jSi3#47.Lcfe`9؏v囜.F\-UZ:*0_<Νu9Lӵm&)_3\^ҹ3"1n1v_|uRʞͫr'iȧN_kH׺8xXrj=\МH)V\ˬ.Xʸ oVRC}ySU9/OBY먌5 ٿwޞ)rw8Ӫi5*5ZΗcGƱ !ZۄlmpjJ -l <R̵/JAպZuq\IdUS 48wXJJtcg4cI~aqߓwŷrm-v)G7yS^7H^-\mŌAq|"m9IBnF㏉9[N+mmy/!KKۉ%n +BdddfFF6FQRN-U5;Sv'm4kcM=Mn)\qιqUd9F%",6MGdT%-+~ f%+y֛^3SrF>6lc(֪vۊN;g._0Sѧ]ETWرkQKzGe9ʨsKA"yC y2\[5 rԭ7Gk5Mzw_4sM3hxЊ'oÍ5jsub )ͪ~tR2H]R͍>̋m6=%(˿(Wrr-܅y5(ܔJ޺YunW̹븹NsqK ]/QR#"ZMDfD|43Qw|._ԡSqTZBg??O Ϥ)/E_U|i}2 9Z?¹0:x'3,whǣ?C y-A~=daJј&M?D1_PS+Oi&;a @;Dž7[ zZC"bv:jjMQk$M RԸ3uA\=wI.AwC"^.{?-\NSiˏ"b}T/}q/ o.1M}R%:-ZniʒL$SgrBW*,Mw'N\ɇ{s\j]VryG'8f`}'N<*/`U숻z CwHq18J+vԕKss4R53/&XTt1bZƟo\=%nO)h$rBi-nKĪ^ ջڜlwkYm[̑+/QrZo%TQ;TLs($2C:s.%+eoNttq۰kK7O0m_t_pZ1SsSM7"mevFZ[w -FJ*T*jФQRg BSu|]g:ɵzjqwmltL.e3sRMچkSmjkmWœިm++¦'tILk*բQ D,PB\lI[9{%Gb R6öۍmX-MaʉA931cs..G4CujQտ[9 }G-xwl)IQz j Ó"rqe&=]꾧֎c)<kӳ+0JrRR3'TnXi^xMF Bު*tIL.[h"2"nKzZe'ZV/RrNYz]8죝n]Ķܩ>^Ժ]u-7^\mZjܣ9+Rmn ߑv?oꋘ?&ƪy^N4o=3-ؔ̿*`}V݁ ƒPu8%$ ݗ]wt;\y\>='OjPIp/nJU8{϶FNMsf"ίNqƹ(+ ݮF2Km |jܴZs%zf*eȫ?]4)I۵nR&FX + [jDh(#哑9q9Eծj8noǕZf\J-l&Z˫}`ӎhyrΉn\űn]9pʌӣ"׮Wt?N4_I_~54#/my1Xr*척aS#DT >q ssΛW;3oUaJSRMDgQnt:Ql,/ ܷfRqiM Ȼ>Cob;A>ڦWقM9X~/!'MW.}Vrߔꔵ!5|iB(0-zF=}okڢE$^wW~nokY߮\6՜̌{i-AF*9)\t9IV6۸5ZUF6R$ŨQIq砳YUZ]eyv >hI櫥N )&l JulwE1GDOuFN2| }馥uC1rޫV+^gdb&W[4<^e4YW,d|htͮsUM)۸8:{3d{AѢ)~ \#J=NdƮꮓ90 |1K$v*?мS ]i$J,C,SG?/_՜pMSƯM|mG1V1$~K>CSvkuj=&) -,yLjuFHK{c駗.SOua;BrSqj-ۍZ#'Jys7[g2z/.u4+XV2VQ.ޕ)$"(%)#Z7suZ%j }BǬݕe)Jvz8zJf:hIN|svO1O#IEcۍjݽ:SdὮvu^@:o^5cs>i/VqmVm]ؔܢn6'vޑ̗J4Wn@OlKbX ;n:hgJ9ŻyǑz8f܌q&Y fN0N;[69 rbׅC2/#kE l&2~èMR.*%g=Ft.%؝e8<.e=Uv{~㻏"EˑnvDѭ͜Lu3u0:U֝$[M5<:oi+V4V9 6nXvx&_ q Qqw3W:uϔ2yb/(ɳ|5zQiJ#r|Hw#.W?4aDŲ\ugWG;Cw鐢K|xg)##=O.dF˟jMUvWĻsr.z]kPc9"]R)mkfOd*uYf١RsB Aîh=k]ʳUrrZsq`d#r$/Ը3o^&lRWȍyuW̦Y4QDUMJ65ƒ[+ygk XK_±k#y:8(TJOSQhJt2.DR}"5[) r)6V6u5k:eXZmv𭤔!푊Q[qQ}ҹLE- 8qIZG|UM4j}Mܕ[Vwm{} Naqµ"ԈM zOpKѰ?IAD3Ir0'/q1itoB5{%wkOBn-ۜduqIzYK60{+DʕܞqIt";r1mG/\/ym[6JƫR \L=S=OT@Ix[TMm{>ݾտ֒ݸӉLYIx>+"JVNzx||5rI?C{oz8۹e\R-^\A2F R+N9 vlT]"ۭ d)t֞i #E2jB@׵=#/N+!ĕhx}I!cM`ąZ*ŻɄҒ߮Y.Z}='/oۙ3IpW̮hT7cTSuz9>B}΄&h!>lӵn~j˅IvU.'v'CSZw8QK3G> ,J59ٷ+HSg䧎hJdzvwv-cvxS5[̊n~ؿ%ַX?O0\6ne 6kn9.ϯ} *h 8_QhLݣ7q +=XBҲ5?[[)+F`=4 }B,sNg==u*Nj9k_GJ)+R~GSPBȒZ:(K]heL=vKPӢwq(NrG^ثϣ?#tC?.ͼ[ۅo؞y#%ǛjVyLSw%T*s92JTM%"YkQО.q)gCͲn8cgi6j1MѾ[{9h^vƘǚםidfi.^RHmg&rׇz:}݃}xT$ضk'5s-狶,\vpbPD،=Okf.c#cdz2FK5T!&)|ntD<+OŹU i-G[EE*FDfeaf2QƤM\UG_{ǹm%\yrGy:.\4wjPGUJޕUV7Do\7Vy_13w;[?c]H\$IJ,*L]3b%L{y.JRKG2sq,B6T}(#nW|km+q5] r㪍bJ@y{byz,b踊3ϻJ,'^xd،)JVw#.Vټc''ÝպWtbRؒJz۠8!o9IۄS95E9ؔ-e9JR{dmnッ<[~n${~Њ$W?&ՐY_? #a.ߑv?oꋘ?&ơ|y^N4o=3t=~7!/M3>n8W홎2M`Qx+ z qy8%]7_~540ۦ彷]Wq CѡwkďyF5Dum_}~P(5.(X,K9vᯐ?leB9;Jhm#3{CxGE-S{;@Fz˙]=O'!ɿ]' r`:7'2bЖ>Iy,/eTy/V<.H?UYY{\^#ѣr9^7?xoRȆ7EoS_&??zϾM?(~Q-K&>"~aߨ t7Emsϛ+?;fCr)fY+>z$tIkjn_>vnrֳki-˹l= t;'EyC¥|/BLwBJdgjۛ$s S1|ɍV%JI6KvəhzIlBYɒ|0"Sy0F>eo5W)O+X˻u';v)2vVq۳kۮws?UʑBǴYO漪e2MIjPAک\b1)DDؚKm6ZWΨgȕ۶yjڳ 2ضN[C[|r@9Jfo<_eI7q.|cÊV߷:i.:$ȋ)1%%)ADZCEBxJ0MJۥy(bNsKM9k43IwNt.\%N簤I'.j|ƃ2$grBEٌ\}9:v*!n7M(ɽ]7c@XxƱԨ37īf62cTTfFK]9wntQHͮvٱI/f|j=7}\_V5U^+:uljSȃY(XI.ȱmo1甅jڎIZ2>#\*:gY|4k\8ZwSqtyA!+];бޞKծË¥e)#5ap.QK^8VdU{*ѽL\=qmjnB5>{ Ӟ`v±5 ^k&O~Oshɷ,;6nOW>u6{RqS`)S%jp\ipdEBLfTWy$GIYw~䲭J.1vSY5z.V>^+Ǎvc.I[R{QsNR3ӎfhd>y?UJ*}~[e\i5U^͛E]G_FS(Iɿ]i8:4zj~շsW,ˆsy:%O}iur]iF5~3M:Ӟ#N06)4ߧgdawIotiz:1r5YDZLHBSi;NQc44la=Y kQIT*ըl:tq2(է9VO4뒳܂~2rq'nrVZŦ[t7\oլfb/mlpc.I8콚q^1iE~䰳mi[dۧw֤ICfdFeCsg:i| 6擣׋* 96lust^{%99UNRvaMܽo ammi$em4D6DD\nA%$$#}۷/ݕr99JMն[oT޲E"KTaP+HGkŴj5TM5xƱOS-k`ۛkٝWz;{kS}F;~q|~^_|euwnE'pSupUP)V]vE+t =ZRaVdG6= *.ϼnj9:UɷbېmF_tޫgHjVS'śǕًdkkѻ_]Kv?nT>)^e=Ar1'3ԔILyD?:-^in):{7.؂\.:V }#뺾.3r̸*xbFM aȵz 6SQ:ײj[ 8nn iFMw rR"5M5I旘35f^j='j:nNW.ʭocZvZKV^ɚJ.cM1ZI7E'6rg탸5oZ=[m Z`\hbMUR١Ȗĉ):Jin!_7Dй+f̷eKҷvͨBPR(V`y6tw*MRΝcB.ڭTnc;P$8nFvm4(D(R#R-L -2:FP lxZKQc6I("Km%$E, 78uXIFA$RQI$JbInG]c[ֹ:ZM+n^')JmJMJRu{e)7jQDw~%yQl}BZujSSf۩QZ+Dzhd5o%BIc'GZ?}΍:>Ɵivז-%݌J5MqGWTVʦh݇ܟ~Օ_6 n'{3~mϬj'J11OȻn߃r Qr\3y٘+WӍ'WxEs^O3 o~[|7>]]H9݇ZomT@]?5B:Z߂'`V_+/MSKX߆ޠk3?o7y:4R/7þ] iG߬aBRU&?r&/} cQߥGj2?C5Yśe7hU=?+ x龳f-܈czW^7p%-(\D4h{UK&ӡn^m]Fݢ:`δvj俜F+) y[{{ 7 tu>gvrěOj'5 iRg[ͶFjGe n~qT$ci ۚ0oԹc*jL[sVWqj\ݻ&6"WoK:cnWmrv)o>66(F>=W^bf#c zzʞtپy%mՉPël e}J.\Zk4ttt>oEM=q)hJjI=ͥ(%]脼_88ф;͛gWG;Cw~˘$4=uWdĜTثNDkiQL9U*O"4XP`02,Ge-k5$h>ܼ]3vr6!9RQPIVSnM(ۓ{>;/Qͱv{3&-[rc)ܚI$n{Sv3[j00)-D3z}MRzVQпj,T[uVs0\}Sid;r(ݝJ>æʺL&c[jPK0~d(FKÝW\m]GTcF|Iׁ)I3~#oX%vҦEݑؼ5Żv2qAZTE^..M{ʐfȏ2##.R}*KʛZz^ӞN*lPťLf\G6[WVQquV]XAi)5J!,$iJ6o$tPZc;Kjx_n3`qIelV~vLy{fn匋Ѿn%;zV.n'-ұdd2߽1bZksPe3TI9)$ԩIN9Vơ\=2885N\ p)/a柛w9g_lױo8ݷ iixJV& ғRi{N^_oAŮE6Y7I$Nk$|Q)-*4Z)^¸%4Qm [I%.c-OV+C֧R#%ѨCe3i;w$G+_dy| Fzj$DI(=OA gj%v/]8qԯNIS*֩',Q%\44ZZ%D|Ǧʴ6&vֵI$%8(ԬƾS&#Z. }6z?b/|Jl{ץv&mpx4Z$”ڝ4-H%dGKfM:sKSRWeJAn]>s6应-W9'H]'uȫYvgK^\czp|My\鏩w/ËQ.)]\QiS`8uL뚛̸=J"ܻi\å'-)54Ue]:K\퓡vK xwBqrH\*֕TnzC.mT=t-H]SČ~Nu╏NÅ3f|͡G~B+Xm[Q7U{9"~jgK Zoʰ7"qJ,ekSeNGgϳ] ^.6:s}_,%eRg<5⿨z{ZPun#jRІ.6g T.!]xa c#jN$Zpl̋H WZu8WmMRýsĮ?Mco~sx TU҆Q :KDG4n42.<3/'^?6/ܠڒ^yrrÿr2\D}}B]^E~^T cɛ7϶Y[<֞[7d}2%QPqOLEQR\CIsj1?\}%tJ0e~ *sk"*)&ۓEi#{1J8Hrt|'ܝRr8)=ƔN'RVz:cf]F7bZyZUȘ4x8,#JG̒?.W9XnO]KO]%]ƻ O5Γ/3qÓj؍/r̺rƵ 5\&m6h.xoeX[=<3%< lZ"2h\Z[&jW3ejm?k&[]ųj+{N{66leu_+lj]q* 7g*knأYv= q ەdxЬZ|%GUrQ3jLŒqET]1% qkXYūYc[7Ś]QY\jko\</Lc7+'hMSUc6qXyؙ~6#ѯv.0$BQi5YyIhɍiy=KD!n3Vm[V%W-B%swa97ajۗ m+9~]fKq|Ddaˑ0A]_v޺mM5* F-BYHJ5}q>ʉ.6hyDmpD׬'-_v5;5[8K[viJ.3dR:oYHHh9I7:۽fi+wm^ [)odPѱ52CZUJicSw\&_s0uBȍh32džzQflcd^m|7GѹE!fO5]]H9݇ZomT@]?5B:Z߂'`V_+/MSKX߆ޠk3?o7y:4R/7þ] iG߬aBRU&?r&/} cQߥGj2?C5Yśe7hU=?+ x龳f-܈czW^7p%5|Y:SJE\U-(a_cƣUǽXXKiȞNlmۊڭڄR!**ܤMeȽ$|X5(Ź\rJ~ܮ]>'HB0cp XFr_c?f?7<ukSgov¥iG>>䙗i.+t+bOjIܶ . i^:nm}s}(3>NZ$2Qg([".>i.ƾ)B̋M8+"- >eE6DݥJnJˣt׻ 5.˅nJGwZD~!i۶a,Db3ZQ3O#KO5/֍ozuK'GbRi᝘NV_ҝcvם ZoX}F6z 7e5_e:ۓj=AB+iܔERadMBq*ԯ DwI/Gy*mĥiRKg6skY/#SN4e$-yXM YL?^ĸNNӪ{$r1JJRSLO]Aqm>V/s[~i/j+m>z}eI"Qvp]{ZԼ:{vPAG2=T͡@ڐ#u"E*>C;o$~C#_d/HBq^YRٽzIKbOm\~żjFFGdiQ(*/i*#.FF]©m=BmpQQQSP&Ҫ!T&^>:y)$ˑÐFčI Bӡ-t!bM WҦŶ'UZ=}zvn~oT/\ǒ'nr8 AJIӆz<^uߖ4eFC1i+v!3qNyߕni?4JZlmYFXFۼO0B\m[ tʄU3s"Sr(NJ;SKW72L4̏BVdf^Ҹj\]ȱ۪(ӷm?J-KEmWڽ^4<8qu%9pŹW~877ܾeVгS(յe^C]yX͹! םm4FGȋ\y'Z FX7e)|Gjt߹#gb\ŧq_([R8[qU$Z (ʻezV2V!iQ,i$JE˂٩ a(GK'O{vnBvryRd-RK4=qxZJMl_CuuIz @Rt㮽޳!|68\-l[џ84-2Pu" RJ_^OL>G1~XnBŬw6J0*Uvlږ1N G1q9IUm*'oWu][&UyYZbBZRZNfEJf"+2nF~Eû7n1xv.RUM$6 lAxSQJ&n5ܞwlEói"#>4׿Q.nEq7Oko[1wg8ZQwZYiqtm&~">Bo?w͡ni2峋NCEy Ҕ+%ZJ ʩq*fpˤl,~^Mχk1+:ݕ z&Y`KLӪУDr3[*Z :(SL&ݻ۬Vqsyԭs x|iI߽zZrg.:mp%6ԜvgmpIUt;QbS.Է) ǨKSV,*lڌ|5Jt3#NP.=+OZ~/G سIgbꥹJnl_DUM\iM!֔wVZuԺ,yV.Q>f v:݇WiaŸN5Ҕ[M7SsrvǣrMW= \8ZW-jsnڕ.ZnF2qt ً[ٻޘY۷Zm"Jxr&NAfA-݌to9s359݆mZ+N1-qS$D=17 x׵+%_ ve4ir6Z$FDڗnFtOr'7'{9C˨ꤡaYoace{Refnft RR"4%ʌm:Sj3)OdInTO>X'vxV#jܮw9Fog;5.~Y5\~18YQܹvj4+~t7S ﬕs %^۵ڴDZV69R^Y+rj$ԇoJKR5wB9C>Y:l+EǎS{ʲ{T6Wi* ^^9k/y/Cs\g*qڵgn4T8mERr|Ti+iPe;;.i\EBEJ 丬i9ɧM-ԼsGDrZ>r#R>~X9y4b棇9JwV۔%m(b[Tjvl}۩~nDԺ{Zo-YuK1vx.nWuO+jN [ٮ0%"΢CdTJK-RަH"$I(*ve &҉FzB,_Vpqp9m8werv')E;o&QE׵^d9˦j\_,ڵugZȻ̧8k+jK{wmr@3ӭ2 wFkzFVqs1؛.v'I%$[iT]D5Dl2 nk7qUxԫLS+sا3/ΖeZYK<["%-g/kRs:f3;*E ت wJ%)5&+&rw*霣i|sMҴ|;R+fm䡩.!**dӶ-6s6,]zAXMWjmnz%SJߴm2UXw7MQ%<!tKys#P,W>s;3IYwx<+i_\\\U6 u7P|xbn_k&ӓVOe䦒 VUr,-㘘"-LZeOSҠթrEvq8Kf%5%&K"#%vD/.ZYYŏ+p$nZkvއuW9㓱Z G wYIFyf)?ƎUm5ԉ/'k84{KO:rQI}XRuԪ|*lu)3qZ[mSm5R3".Xcَ5c®ࢫI*۳~wRϿQWޝ(EJrri&ۥ^ʶ齲Im|[yb;mnm֩uiܘq>E+Ikx߄3r33-5𹻖09ϖ9[Tz~mr5NsWl$oPusޛ^{Z;);sڹf\3oٹZmԉ/'k84{NO:rQIBø8Bݱ3n֤DiK4u& ofSȒܩx<˘|N0Fչ]qsp"}! QWw@t4ӭ+cO5%]'*{eM߲DRO1y*q8w++e!c߶ܪlZWّM欼 CQ̼빶lX{vib/V/ ai;x6~]+z]MWB>re-:lgk}պ!#9?%܋V-c[z!W?c7YNm/jRr[HOzԻefճ0q15Zp#rkQQ0tU-AmڵP/cȕ?0cZYj;:0ZM=D6g ?'UN+ձ[K ܖB2'xq9{|۫N0ku 7xaj;n\ 2[VznMlWiKbSk))f..)Km)&bGZ=>OR܍W:j'rM'wYz&/鶧{Sʵb"vջq[I-ՌZH._x*BagC'T(Q:$ͳQcMCKy?3g'ߝqnT);qs #ؤZ}OOI:cfnc8W~qy.;^pVl]Hԓ>^H^@7-AA܃nmL(uWܻS߿ Td95Bdh4t6*dDh!EhI[iŨ\L.&Nc ܮf^;$R)\rip9I|ٺ?#R.ZDZ;/]nݻqs\QE9M&Bd ]N mN*D>tgbK>+ˏ.!23]BȔR1ɝ^j'k2ƮqBQq[$di]icV/e`޵B.FIIJqbi>Ӥ|p; 6${)RU>_e}^dzdfzi %ekRVUS?6'hׂ)5.\+qUgzE2C˷ecŏ^֔ibk shesFWJ#~> Wk~ݨ}ڶ>ơǚ)׽ZƉo~B-ڼrvoE:Ʃ3ۣK7+Y`WirS):{>ڛ}:wԨ(J_";6R%[u&ƫdZ_\'np| RJwNeTW,=rrbnkڄ[M3ܴz)3- R.?:okۼ0TU'w{6&w7j1z3ON'fGoO?)S_bQ_¿R(^ԴԴG.EtMڇ&RUiW uQjU> Kiu1d<ѥIQ'RQ1:O/lŗᏩiʂv&Jc{D5 Tt)1.n[n۶X}RjqnOʽ(~[Ns{ސ⛌uO,kgo֢dRNQȄ .'6W!׌P朼tdZjFGE"]K@'i۪N;sI[{SOzk>`rRR+!σj8&TjlvA̷Q?HyjyLHNտJMjܶT۽lG?SnKN%<‘ nq[N0Sq[Ta(&t(|HGO~gvkݻTR4&Z$#ViOY1r$6YF?e4U/Mvxų:zbU^gQQ+NW_'4jfz^c'#`rvrڡ(IJ/J ݦ6 ]-CW |_{v*_q3^DZ}Ic6Uڌ8p7{crZq5ki`)mU6|-Z5^iEz3P=:Cu7DF'k%}<C-޹ֲ̱#\,(f88%X-N(ck0VLR~} G"-8ӏ/ϰKq?(#nrVTmZ;zióM4 m |UT'C^_1X.gXM{%ʤd 4\ovN":"y-,T)fLQgۢr=/CƹǨJVr[a+!rT|%Y\ٱzsS>jͱ.oOc6f$q% ǒGo;n[];ߎjrk{~\VۓNIGn:iqxo |~t5)Rxעri{Vi&NUOl_ѮMfsޕkЄay.0P{7N((BaIP$ K"U6Gl ݙqJRu+qN$ m#*p<|{:>-Ev=86N*MM긭U*uѾ?/^o7;'u,h4݌xښRM:5.(/ \իU.{F^rmF-Jɷ.>Q"[4xT^OZ~mK}T0ݛ^SAo9u?lX(' qj%=X}"^e4wˠ|rܫ 6I\Ķ;Ӻw!'ڍWg{ i U_9Avhۣƾ+:vs/MK[ɭīe{`Zgb}r[i'GE2J7Nez579wRq+Un ]J.cJ4M:h箽Wxxm^ pc\wcN%'My $$| :$Fqɏ¾^қP9J6Wxvu}ݵP>Z'FFdg"-; [¢cmWkÎT8nG%ݣ7*\խCLRYZͤiD&J#'ehbSyXK|y*ӞpS̍R`[pTr/Eg)K+92{_ n3zwz'oŸۤ+sOj J:`T>Cf*lwd\fYOP"R E֢̔L4ɥ :;.b(B02rJ蠟9>V'9M%)IqnhP<%,r'P/vNSwr#w"ݨaqc(|{kd=^0jTMR2ULNz|.<|^PfY22##!,K~E BEJۜ&jRNsHަޛg\r,v؜.jK3)[EJ2ii{KEiHP^&]Gn8x=K}Wx/KI9-ϵwQ%spܾ[^R}S3$qvq8M[ ozKxcqmJ/ӿ{_}7&ݨ\f6ZSyQz& 7ۉ[8~UNn|nkiTB+4RI8'Nc%tn{!]Ȋo.nEmʱn𵵥J A+wy#+ikǒڂ;՛s85'KmE:Ђu""Iģ5p=БbTY-ͽڔ詻ngL2Q}$de# fs^o{DUUsfwӶ;s1T,ǤtޒQ\෼J=.tKU,7čJ5 N$y3kdSMQU~mO[03 $zAڟsF5^뜞"Կ QHmrR"ӳηer+ҔZ]hE-6Jmt'ޒ=O[sQj)6K}?e4v_KfZheޓ=BV[bY}lݒTTЬ{ȫvO_qpRApVŗ 6ju=*BR)g "O1yhb=tqJ gtm\b3RY+JQ^Ō֍\յ\>+uSi{=x ^w;uӘ#ĸzLn*$anok߷CBӷ}5Yqvdž<( "_OWit5:EZj2 B ρ1̊fi[n!HQF82q1牙nqnEpT(2RMoM4ϳOu ':֧_Xjsg jP^(ڙ{2%E͖j^}ZU[Q$'U) <܂%!s"m R'G5M0<+zM6qYm$ڕ$3ǧH]?o2N<8F1̻r_my[Rf59NjpzBnl7*{.QP 3N&^BLJPjAHCK2Q}$#~YMq8 k(MFMU)8MEqTy+Tʞ-ar5yܕOXw!e;q-Jqܶ䓊Y:LC UE{/t>r"lI9)3KJjϤA 6SEE$d߇3KG*En|P\ԭTn6I-ƍKTj<1H_zwGr19wF N8ݝ+a9ɫM6mhePi%mmD! """"""*1bRKrD"vnrM۫mmĽm]ӡiG~e"˩ lhRTMk^MX["Jݱk7_ޕ*DqĒ&flՒ}`W}~SմZ{ĕ~wm*/{{ѹ_-0ط#P]xlڱ~Tn5wi*lڪ (JxioϏbqKYR|!|KN53 OS222$jzww%i}>N)E+rۥ7c$Ofl/LNث\6H9: FY󡈾I)fB֔JI_ ֣^: 9mY{66㒢7Uj]:.-os[R&gMF3˸#໹kmjq^8W"PΦURjʄWa˧T!͋ lW48JB2ko+ /Nw QwQzQ ے%$ޓ7^YL|r7!v%Trܥ &|M8~ybrn[RV gSn{{*#2#ԽᢏӴHak" ӌcwҜw&RJ07ױ>Ļ =^ BɆ)v32.M1=#6%̠tҤnzqMwԣ~s*%-j|_m*.Yx9Sz=)qE4 3pk+,`=kNRڥ=B=nŔNAx)Q$ԩȧ4z3t#Z2lҮYn$S%y- JzGpu|LBV7ZW#;Wwipܷ%(6jFG5#{$D"uۭ~]֫SrD܃fҎӾ+Tu>-ZTQ& N|$沸ii>eRWݳu'[O̻j8JۻEѩ[]vni= ڒ,[_%kC7I3Nv$4ɎЈeٸoUu:[}Do5|zNq=Tre%ɧ6&~DȍF]ƞG5q m]/w/ \ʲr8=oʔe9U(W"|S]uZd#?Se[W"ֿh][-7Nu:T=)R}.;ml*5Dlf $fF(̏T hiIUU4Szɕ t(%_|2 ~6eM;TƗK[f&]LK^CE2[ȏBOd;Mi|cx,^6;sیGpQ\NuJIFTJ~đArh* B"$H쉩eXPRj?sl"ԥ)su]xpԴY%VESH"ЋJǰ K&5^Ukzׄ8kEgS2h&Se\ Yl]WҶp-ZUvi7QS:4byqOo+[̺腋[6-_Fo.6[7$p&^ _GZԸߍkc.qqoI[9m߸YxOZЦ1uoiSH)P9Uʄjcq= S>֙NeR><;+ڌk%_qT].srNO?s[=vH[]RZHRMtᩗVؾ:/~u)ԍdg%=edVrISb{6vSu=(ܥ)mTv/J}̇8 S3ad:^hBSf؉OɔLhI_1d8,L><_A0y3rXq"'(۱;mFNII.v5_(^q~X>y{3צ I*Vܛv/jW' T'NR'j%ꔩ:mJ3SB}΋!-H-RJBТQoedi9tjENenPpke.%4]#{:>mkEɱdYWl\\\'nRM4&U>?Ќˉk÷!𴪛]]5}UqG~ݏI"O~s6(Ļ)qO~h}uԕd}Q~G,oE!&G&/]_H-O=o{k\̭bkv.Ô܈+;arZx)m?M\3lU$mk-CFXjTv6u' g:Vn_*qk:VC A%'4JV%EY)#BғO4<e׿jQQ]yUr4=wm[K1r׵%Iũ-O}|kC;/VcݩWZ)EHdžTru]8hgĵ-;=>U_ InvTm_jBM+QiF"9*{DI/iuo(=TzϖmPQl_v4z>T*ȴ>YF;ε\t]EH4ꌇ[VrLzef 2T^V>g2~kg5~Nק;{~Z~W}&ŒBӿS2$J?~(Yœ"˲ߩ\O]: J׉ښT{mmIѩn3˧)4LdFZ/zUG>U> n 5& ϴ-KJi2o]uKljvK3$bԔҚV旧iY5.ίfi96v7!v))FJM4{jG~Jt/lUE%pTAFe4qQk\ve۽/u/Im+W')v{\-E|Pms7߮DZRr۞/mu*1ՙaB܆ -xg3#6ۥtRogʌU)׎]ZҞNnŞr}F1Nnޞ;cZ{N}ۿMiuxʉ*3qi'9KHQ$WJxXyرŔe~[v5~/jN9Q4o6rJv FrdxM*iRjMzUinHdн7ᾞS=S'7 } ̽zt7K|_g J=Lq+/Bw_\ۧx\HJUPzQ<hqF[V0x==CsU7q|^ {)Iq38$_A(VgcKu06Ƅ"%i~_ˉk QCܣB8Ku/񋇵u([w}$F|8TՠI.E !;RJ^}MɒD_q2];Ɖ{5}*n7nEInO{Mwv}&q+v [V}Ĝ@%>#dXQ$f;iep.GquixVt x6bj͵mlKقQ[T]zs/&yەnM'W}!Fp_d^Tu N{ɻ'l{խ2.sTu{W^H&;1s)Pӛ6>$mě;Łnj= fLT)>׸+qReɴ[UR\L*P/!$Ӊ3Q 'K=m~6XqW3^W+ųO_[F$rR*u"T%@O +%# ]˽!aܽz{ͷvQh쩎]hGތ5ɇ*DzJDRNLi 4:{~2FmXY-zzĽ^f=]uū{/+&c:Ma{ĝDp2m܍kHș/(--m_vݮK(V{R}.k&yƴ7i^4@3f sK3^Ř˸B=]?gt5KbZB<e;kQLpxuWC}n 5ҴepB##~q= `x]KWF {GfŲ}?G.I9pjWkU]>={7q{kO/^I3==f1ɏ%nnʫ/Zu_yXN<57ۍ'vy/"8넭M2eԷ&Y,в33%IkjMr7xf nmQkX4踼>a-GcIeތw&U=-:qnW)z¥j :WqSZvԒ#j"KrIU)%qrmRoDGQ~SYRsu*V)  ,/x)MFD6O#]z 96[Ui(JRfw'y$GeUީkdMF-ݻ98F2d[o{Rn0n-xsV6Dh|Eb2E:KCOӪv4SJCr"J!!m,hRLD| ZYFm/X~ΧfrN&4Ƒ=Z9Mh.Mܵw/BdrܥniŪ8ɧ|y%œ[M=_tj?F!z5\evM:\ ~F-sg钬OWq“iiȍ<Gi%%n2rqͻllƑ)okw7}\Uk-:&fj솘XerV9yZuʼşdFC=rmo%~ZN78X(N)_7.Εn1MpJ}62jjJdI";R5&iLԸc:jmqiQj$ujp\{;v5B񥍪Xn Ą4qOERjzN(Ga٠䌡)p*v(J7#ZۻZ8O W uONb+^Qipv9GvֽƼϯrYƖKGJQDNPhRJjᡧC"21"9ѓS1;R_O7/WGz)8fE%F2ukmvSov/iZ&/]~KmI[:^~ͤ\kMi稜\ywJt3W7 8Ʒ~ݥeFgѼw"8VVSج\뻆}ݭ/J6Q)d|)zU3>k\L=;ow֯gN3pKѫ|wmkZ$z^2R:E)f>ς нd|#׆?\ǔpV{;\$ƵE%-ͪm0S6[n< kE[}mvE4DDZ^$OZ0*$~XUv҅B@^?]so#%ojw;Y#SxxueBگy v^i-)s)zV jC{7Gt.w3v,ygg8s]aE_,*E tY5k٨h=o"m泏:\6w噓aiL׎n^c\75AGkЯ0Lf46َ`egZ˓p/k;̛]kq!ݸzpԭG"}R9Ve>ˏHUjJ-&7nrnwG*Xv\˱/vN}O)ʼn&CV͍f̵]r\PMB-6Du-#RͰtRN^)mT _}nSȕC*_xBuTkJW[`ɩ`ejvsngP ڻ.-WUtܑqԹQj)t;vN&RNũT+8%IXӃ5fK՛-d9 ]CƑm|nZ-6=Hz,*aEm W3VzRšdY~Xf׀Xx"]s;)5u*ُHB BRGS6bݶؿ 9j[1*jױga7oX CUI%0v#~\-O-Ꙛuɷ쏪&5mY٦M`LJ2qK~HZbr =N'YobI. (^ ׾{_ ?OJ`S`3BN[}5w6:ǵ/iSlt=4F*d&T4y/#. ɵim5Uֲf 眕6Y7 fơ=3dϕq뚩$qTM-%r!$@A? ޾V0c~{[{;򥧅a~ڵ»&ڄv1ek=wb MLkNAԬw-x>~/r=e73VeVN)K%Sښe"+3uXuچrn ֺVzscJ峻m}vb㶓n\YbIUBT%*,0nov=;z꣓S/nSXSpl##k9mXGrZv^Gde!ŷRԠzQyjC]`gToPov{j~KRBMY}i[߶9KL2ԉO0K#m>wB[ٍ+n[[b٦DX ݲpo] [\m5qdT()mo4Oy9Ie b][wղmM~vmi۱~t \}$яimRk(L c Cvk7r9_r1 ;zv|F@KyZ[&jEji/"6$69ml#e]9s\{ScL}Ȣؿ0q/nZ*t,CLoD߉Njǚy=Pgmu6^]l-["çUʖMlʍp-"qmU>۷uFOJ%Ǔkx 'g=睋k[3u,{³WɘݪF]ՍeFX"Oy\,cچ=w/gn Ļ]#2? vqy-gXnR.^}ݺFs{ŝG]}e|#0mjx"ƬWكm?rgU^xVB":Dt>@LRbun~ݭ,w+v⪕;\U(RYa61>#Jm˞Μ9g9XKaG='u8gf}'qy#ɉw J]We.ʲ-<+&q%s?2dњztҼn`cΤmmqMdz O[-ߩӲ&;[tmܝVnr">{x<8U+p:Ig]zjGkt,uzf}dؠoJaکqEq -(:d<պ=eKy[˗^%ZXkX[C2߱\ITTLGzANM￵i]K>UsOGDDD.ZF6* ҃V Zhz{'xp^`wo8r0h ZmJ5"jb[l=yUu7-;7IT%:jFjߖm0tzU'K)څNۧYJ)4IQ}^KWm7kSP>q;ނ#)'n7&׊r?óM{IwR\j2Qn[v pe#/tAF\ϵ225q֒om6z})6҅*oqDsMf CNIN=T S2t,_ѧ}kveMF0J\Rnnݙܹy[rUc-j{yGtkQ%s]5qB.Nw.JN1LvR Ui5J ZESQԙr):MJ+g}χ!2;q([jAud][ljVK3$ײSJI=/|&tl'*n۽f.frܥ jQO8>&Z];.|7T/C}$ڋUmP2Reҭ8hFF\L 3~e v\۫]ݝNmrnB%*]Z«hKc=BTLG :V74$=Ǘy+EX'4tn(I:Ѝ;Df8c,k1%dJ6.j6ź{N~l6&*fœI7 WAlGOu-ҢH,,(ǔe뿋쩨kM܍ZſgRvQ' 9)?n|er˭|I|-fGK.rΛp8XV1%K6mvG+tc+qE&ǸC_Nm:l=_/m5^[dߌڇ.c<%:)tQ$Ow~-aY;UJ>=F)2[nk؆?훐M=l6[4(O.]2#-H^n#->&mp5~Fӛ+|| S,xag%qkEUzUgæBhߕP(7]kFnq?֖CpruZ6*rEڊtS|*tI*E}7R<,nUU֫^I7Q*mSly%rdȓd8hE<9oHhMfNSRj[i7D[Rj݊+kდq{"$$H?p\̅S?㭻;t~R߁)^/>Qj`yt[w ԛ;²~+ߔ_ YW~|o]?x^ᯛ `ʼn;g)T@vWn]>&4lp+$D̢1l|ȨF%-}.9[}w~ ԠLM9hСablfe&QoW!s?wjLK?s7yO>(=C~_nyǜu?v3vyo oI@qV-jeES^[9WoSܝh"l2C1a͔CiJ@3:Pճw=/7ovuk+\V;lDgն<[A+rX~d;m!_s8ݖ׷;;.0llUC+?i#_crʙ1~C.\–q ul8Hܶ2m`ܻM3Tov|Bs rɵ"oLS- DКw=Tv@f'6|YlD͓Y%׵-#Ѯo%:&!3o%\J<02;K87>^vgƓ# ;ݝmz^Y6=PS39U%~ &f# }o!muH;ʲŇ˷yvP+&.7e[3'vR4Yj̗IZ`e˽3o[WU{ m[sUbۋZǾۆl6~9'V*.\S2<Sd*zY[aŶ`]C$n.v^Ʌ dng>ەZ,Mmϑ :n6nϦezWqUJ4! ۇ4R! =>>Fn|Q[{pRO17ƕ~._I''00k=b՛o}Osðc2'o\3}ݭQ^2 . R1yKȣtAݿ-uܾw!`?1Whn|gzUo[ECWwjUIן)^h#1ɭ!/Z np;o;ΗŻkXs."6E`Z1 עӐ9Kl8qd q} 2Stt;#j>;խabONŗ=fwP1j)l6J̶|gV2`y/0E˛6+ԫ1? 6}KW c\KoKͨ2ۅFw–s*TԞLיuDx .kCzWXhy۶gLu|%TnupǺl-S* PRaLnT+c+*xl.v!.U=|; !_L̎뱚U=4hm:ٯ"y)$:>%(n}X'p[ȴ ^˒4kƓmzDx \ 'NqamP7nyN݅=j7%McSڵj%STy qXymvCg{w/w=wSW5r̹u erծˊsOm=DhEҚRb#n)QOxtվQwe]I}wCa'"[ۂ-z}2UuKP$㜉ԧ:mc<Ý>RoL?wu|%ҷ&K y_!y9 ??:tq3(UU-lkS'ɸ@jdzQˬR] EVPW1DJq2n:,c|ǻ̑;y{X,ۂ.u.b˕u.tKBjQ"[S園S`ٮdNبeJ&9Ơ ~0a(Vm٘L+Jr*vڑE( x0+tp˕ n';wm-ޜMOxX>{#2%jgb2M[`K*\5@8l'e=0u+w ֘鳾{y܀:R*Ya]"Ӧ%ktynlۣ65,3gU}{GYrb;ge'TKwǘ.,rpܚV]Tr,!dp /ԺU,xՉ>s׽~W5oTh yx?xrrx?)?ilbT׬,z$Ԏ.UH٠\U1pU:]JwSrGZq8àd驐,N67QYBӢD㏙W!Q25ϸo9ms-7-%3CihO.J鯽-;MZM8ku-7k9S$8]q2E(}bۏI[DKOK}3KUB^u %Y,u.-&f#]'܆o$x`Yu,dzwM;#oKxn;\[d7}Rb+*Y䛂ZuBӱl{j0O̓}LhK;[aֶaGL{Cb#S.T[>߃F]NK"u^LUʐ_ykW?!GRj29͖qa'0[npcDvV)qz9R)PۨM^aJx W] r>];eN3vxdmĘ(5W2K1䪖weF{mE/QP6\u54x5[hۮ-Nk”i[lUgL]J}5 S:EhiUrgHl!ŒJ$pe=q^b͵Q' ?6|R\,JA ڵ"TDꈭ:ymg`B5t%M] <N_zv2_Ortٵ/i/ReӮ*7[qүqEG* m"[I:6e^p"I$jԴęh!m)]GZkcjS!{e^z}+Cѥ9;R|/ֱeiUԏCNu2Zhcٗg$ݭwvr P8*7/Lk~I'Km1+MW%Bk|oOm>-#qj*|Dbѱkn|n{v#jĮqNpMIUm(7Liz;{ҜݞڝVƚVϬ+sO!OstGvxӉ']uӎ4g_ 1^-8ۦ k!)Ύ5O;YSB#2Zzχ;<.ֵOtge~.(RC#wFZeGZٸ6FFJ4e2ˇpJT$[wgV)q6muDGJ56q\I!̗ y/I~RtJ9kJ]Iy*'FN0s.[l!fw'y(7$œ WƫgyΙdMEU JQJv̋vmrۖ.jWR_M֨djYgSj0^\y'EoECjm$ IƩK>Z28J2TiJ2N#}.s cArl嫶nB.FIJ.)۔\ZiM>/hLĸ=C1s[?YMqp|94- 鮝𦔽/k^#NT(Y LS$6˩}{;5 )B۷W$qpN)qqoot}ZDVә;7TiK|6f3h$dԄ}fqݡ>Nb򗉉+ͶO]>ߡ_VtYf79ڰիF sq~prս|QM)g%l0ocJȨHz V;Bb/kLAcfPJ,ԭ{ƍgpjNR6VSI*$!yV足jᇑ.](EܣqM\qJ2eZT).<9UB/(B0j)mtKEj#׿fDI-=rZړj|'Nڤ]k*i$5qt"ݙPM6E4ke^Z8ۏhz$Q(R Ay2zfRñnpnkbkI:=j &ΝșW?׵d{+ύM'??XqeeĽ.[o=UxFS=ӷdZwenՄ]_X=ĭVa* pKs0ބۍfJ3 gz̚i|wnxtjc¼5${(1fXQ65ȼb̶Zkn>%FQMJXӡ{TZEVNᖣimT/37cNJUPnP҂ZOE~"-Rc4^b- FEͧtf5[)S!OZIښݲ͑;tvܡ+N)AR=hCNn;wL16-:特7M$=Tҕ-.R[HٷnXk sn[ҞD-0WS9p9:-Ϸ-jѬNu{ҹfv)[Ľvwfg(ٷfe+0mYj8Q1\ݧg]Eǎvڿc!4#j5̋C2"}BRriFp7=ô\TZ:\BLfj#I22װ<;صZl j 6:l"6]۸ K'6RTѯ^ئOԓV\?$x7s#r:Oh{ց=MmuHԷd{pN /܅:UE#Yy+(SgQ(Щ)RHzw>^Ѿݻ>mK&^ '$Jۻ&w%F|xfz%˳ L~3N?Cy9 v w/{ƿ kz3x> sXv}vP"@WyC z`'톽Dw%-tt yVY\wmuPYQA0iG-2JP,6/gˢ]u.-n!Zw.N7Q]Df}Q0({a\@=i_X7gFǘ8^⻲}G MZ1)WEfO12G+=-B@z\`||w6ċj߬m}UwRox֢I &c~XGP6Qndpvܻul'V7^FJt^{b^B(L~sѣ6@߿^xqU!ڙ5|Vpvef-uӥ^3  FSDɯKD%0r}FF穛r7 +o"V8tv̖NQU!5uFd"bCr^bJ=֤fM#ʳԷP0O-9xRBm\=`r-:;~3Tl(nXtXi%2Vٛ#vwqƴ`L@"H‹qW.j,JM5B[)WܺUeZFqc'V˷1W7V̾-MHФwn8N;HPSdݷC7&2j.W\τGŎ'Vb]c.x+Rx1%C2T{myg[qU|+m:M:շ8҉yWd)ՋWS%%:iqlʹmGwݹ WnNŤѩ5(9hTٵDdGUi-)vSs2 2{OnT$Xck n:¶(lASLeȔBjμPpTb2~N2~%^k[ܗ[Jzs0ӓHBKq[}JَA-$dFQgjxxFv4r/x*Rm% `4J(&iv7SkԲmSH1YWmx 8n.k']:Z˭_W >ڃXЩ. jTq%Aā[E}amc]D:rmHRiu:uӚӢ\p(5-q%e)(۬ҖȽIf<߽pr&ݫVfY91q2ĭEQgYbTGQ&,yL+N$[q*RVۉQ=FuTܻ>f>f㋳8N6$܌n)9&»iˤsX,݅܍ȩv+sRTpO}d?Wn/Inpȸ%O]StQO|v5\}7Zwb.AIVK^:wb{[uݯcytO߶S<{8KSRׁH̏N7ۚ[xkwYy_'ZӵF+>쌛ZUĦreE9F[24De{}@:ExWs-\ǻ7K-\JNvEk%:s˙#κ].oͳ;լ7wB6nwu:$L; DkI#Wz.:Xp(˅v$Sq,wn\qIN-e<5Oe+vuYTpcojUI_ާP8 O 7&VL8z$_B-H-[uh]T{|8=qVRN-:Ij:7PUtXϷmy鉿:RIM~33ӸS2#׳GdŲ5+/Bx{(WzȨ5Y㞎#|˖+ ط.|e<o/rߔX>7s}VE.OVti׽ .5nNJO"95{#q}Ay9do]R"M6z\tnNS-D!@3N_jicWsy*5uٮRcWv/.,j}=S)j5C^> Ie =gu9ӛqjtz]۪TMoߧI!Ǧ¶m:,"[L!{qAv-o 3{"KʼnrIkfٶj2ƙ؄S`7` k6jzޞ?e5G&6uʷ2%ԒRKE*G\Npom F/V |C0.q_eenƣ<5Oh'67ɪn[SĽ{ڔjǘzs;~׌(ۂ`ܢ1ƣ` _l9Va6%UQWh~P~\F^ZHR@:ۧCJ{ôGeBh;~ۧnU J\O+n2 RҠ)ng}Kh{5+S×ܛ.1ZjG)iRȤIN 4%{oΜ/eO[Nffd ĹK?nnԼMqX'܌nZvq<ķbFnͪaQ`5 s,M_լ?-@_{w{ӺձJ}GF[%v\5[ŒGkOw/ΜM9rjË%2+rd~+󲕛C9U۳r[aJǭm|˒LAʨSCq[XMۺoubfp:t+ΤĻo ][ zt-*67kvS7D·MMCQXm;)܎n_h%]4ܙnRk!]ڵsDUF"`R, &#R_*[z*ZqFXɻ]7|۵w+'pFDەs=r./ᐚm3Hשy yD"jHCr':sA65نѮ^o1V/ f;nFr3VM)e*- s D'H݅fӧ\*޷[k<7u<-]֍Q8R h|p=WlW3s%Q %3l}@U-K6f-NϿu|ڴmWN׮[׸F*mW\%r! C78:޳vBG7ŵ.JթԚ2x)ST!řn~9 W:Wpܢ件{xf8ٳwKE ҰWxVB\qBZ 2wMb[lGSnyԚ~z9ZmያvoN2Afnݽjf>)j3 !;gOYʹK" Wftڎ+׭b*2ϻK>ۢӱeyԪXISUm[z+ugX%0lϏnvg!;t{BqPj>PyvR7Cj]O%+ݲ :qiMj6W}3vC/R=4Som]ŗ=ю, TF6U_-\6MyskwMr&Q\wjKܩyMϣUj0*}RZܷSdY3>Zjqj6TgzpA/M`/Cmл,޻feE[/+uk^Vs1W$G(JsW2ٰu*߻q*Y޵.Wi:ur5T),=0uRmho.twܖiYwrWHntvEj8qhf`Ͻpf(R&>Ki%I7$QӖm-2 ~yߗQ-앑/ x[k8nw.c㩵k}]FkbJl:{.(˩n0Hqvαp7 귎.Gupx[N`Yq'+ruU7[ү+>!xrȫoSo]OC# d^Q]\>!ƛGw^Mx"-+%vdX-:M2UR%d>%l ioSu6lsj7D P>XxHz Ukà(n^Q V>5cVtWj SEiJdznyej[lE' 3kuٌNn4JW)gB {4 j6&]' m-(ZMEz8cz>WZ6#7+[,MR-Z!4ܓtCyE|umj1ƽvƷV\;%>Q :#Le(iVz5 4ũۤUWxX ^(ҔsլB2w-V ^R+; ˂M\z+Uwr+RWY⺧~ Q*JcYSNSλUd8in=v K낫k\IRרSUaCFmϿ5̗P|u ZTԕ}>oYѲ1sfP+sQkX8Gb~6r,s>^\,mGL+7[n-E\.Fqḕcl*Jmjb5 ,m]c}NXfeVlǸJ5eˡ$4%g~N p4Y*WwW٧<8v#;qԩTut,m"#Y D\5V`\\Lȋ];LȇiS6ϝZ l>LruR\v=ǘϔDg=ԈdFZ+M{=|,[;0>RiSi4,S5}yxw&(E7&fݙ4UՕ! ~'Id)]ǽu2K-fޭ \08Vڅ쓬=Vy^^ IhyKR-B#Ըr=]mܻӾ'*Umkoy rTqT_i,/8Q^<ݤ|4ԻO(܄"'5N~#m.(Ҿ2i6Uev&I*<}҄$eNtÛzyWJubW^iBW.܅Wڮg]irO6Ve90sgv.+sV޿aޔ[p?3q*FutUo*eL\KM'EG*ZcAFfG5J 5jj=MJ3OK:k˝'NMB7m3uFҕ\-Ywg%PRqMIyZGY9|μvn߻5cWݷa^+X֥vnݘ\v7m>Fgzv"-;Ew֝}1|RjN𿊀7g#֟*GQQ|#/bo]p$>_Un9гUbn9׃ErQBU-^vDmVh'<R[fdHT]*~}3j;nvjc7s-rӳ Y8[n[1pJx kX[Jk9Mn!_Nю6x:iZ˦U |߉^Ԛ݃hYxk &U^bwKk.[jE+P(˞=9j@snCv7%c_7=xǁ<l {t'酚+1F‹l׭:ݻILruǶkL-L(K0L1&>wXB(pm;1fpnlp֓%Skidkt(U +xulo'/ڕeN r=^pZZ:Pnj8Hf"48ijY[ N[yZٻ+=  ø:3 ?^ܷ^Sr#YK[UF?CuhC b]GM')mڏsNrܗI]ljq6VB. W,UK"YX5{c >Iqā> T:n!,5l2VzCl|+I[*SrjnS6٨y+x,@>П.g+!rn9>N|W>OZT_ut Y""v7|sfި;Pclm EùN,{'fNT%U&LfH8~1v>Il}统u6P˗c(WV~H^bMU.o*oOF0N:_:6Smr_.b+|ݶYY غF,mwjv>f*>QM뭱Sd:`N{l/⎱;n-z~"Gze퇎J5S KG9!Gn;N1 ݎ h6m|S?ɂ5'WOÞ 7|7^ao @mxGmi^jϽ>01Mf0լD3-2T. VXR"ɥV Kl J O7|u?bvа;6.eߓ|[1bmRr,eRz`z 6܎-ͨku͹Fː dPhYgZUj}nvX;z=gVեTv_J }\1n7w2J?ޘγc\E 1Aޑzq;\r]]\Y&[nsNei\uURje*Qk2CSl*xJz-xٶlm+|UjUؓ`Ladqiĩ!Gd\W~fz;Tn*PdRM&T4`չSWq5k훶(N"Ӎ% V]֦wb.nUO!u*J&Oӕ2e|Z=eV쫚΅g#+/RW:طnbi*Wyo)p{:ETKؚR(RY+r웓r(IF) VmȵNB:h Q1ғ|u8E]{,'$-TR[j49l*3"I鯴zhd>Q+\BkNF=.$ZR4Nwհ(IpNi.(Gi33#33e$FXK*NdWrud[r{xnk$v2ıh+J1TQ[#JQl[tRO]LHKٮ NӍnF񨔤֞Em'MILB"ԋ%dBŋ+p̿_17jzT~4pc Vo\ƹb9Rq-'1j;8ܗ)hE%DZKS<璸Bu*%*Yw5ڻ9ۣ^z4U; Ñk\U(o~G?VUĎ:?P?_F_Kߤ~ᓾI |pr.Ok\SklRhҪz{­P .}SktZ7UQ4ڌIM8̈eaӊJZ%FFZu,KZvln廐SNFIVtuNi?CM5]+Ph,{jN JSR$IS^tSUVrORYu.9WyP6 [Kiu m!X|]Y79ӄ)\ģ)pbڳr%*&ꑶ_-H*dzk)1 V3')UAϹٶWRxe'պn۫h7AR9 EAJeGLms!%D| A 5]/Q3eb̄vnVn%za\m kZnv([emqrIҕij|""><hjJשvvǕ|Pޟs}V~2&Z?+2N&Z4w@)4iSڪ_>/JN9Hiۏuf8'It[ȲR.hZ$ȋ_Y ~U<UUO*6b)Ovzڜj\R̋.$FsQuҊj^נ䈈y<zZIuP[}Qm=C?zN(Exqu/kn S-FzKZzOסӽjJ\)F3b!r5ٝ|;6 o=-3*λ]αb\abqRi-w޵⦪~b8Kpo)Z=>)ғ"5/GTZLE-輵f7ݘ۹~+&+w/7GFI:l33fg.N~۲\2|*cnermnnM+Fq"ѪIz%j =YW8@~gc/~?N'?)«qȸs➟n=k" X“m֮VreMh2[uݖ] *FܖN)MȐ`f0 g,C9̑o;ddudJ=In13:ݒvvdMUEJLp^,6t-@͐9'{7m{-3,>hnF;ѰM)->>+Ěz!R* :`e--m7nB\u{b U>[8֪]6^ߤLʦ\DFNo$$dͶlgno8OrsQ\l̯hRo8tuNo+ CTxu!2[>ctFpeޓƻֶR"3QrQuOѳgwQr;S~)6HhZw/GgVTmUf_yt7%$];zLWF̰xy2Ʉu!MCmš_0[W6jf#a-KLi+3Q7c^qg%s<1aYIQeZf+}>;S6L0]Yu_h9߻<ƅpmiM$AVvŚ,*#t2.8Y)-Zhshü97/#Oro"u^/uFgWɺ,p:6a,^x%$Yve^3PƗMnTP&yS}OJ '덫MH^:rXԴJۋ/rI;S*,+yz1hv)Qw^ڍJ2oL׊q(\fDj:^T%vOadɂnS}ZO)N*λdaȜkG_PIEO}нa(^iQX᯦-7^)%g'SJx(.S9zVɴZ{E ))ۅi/s7 VIV-|sj0*UBTHIqRf>FP$KqN0 R̻8j\GcC}IUz\i 6F)Q{Gҧ3qSzKj-Az VЛS-zy:8*mNk|D鿓ND2u+0Yŝ7kqm·?8Ib]u>˗^_>(]vӋzv+ݩ){vZrJ2RQ몋C$z [,pp,8mڊbR]Il .f~d/ݓs㓓mͶ{mgjQwn=Oic9ܚm4Q/6ݨ[TƧ?nԶoytf{@AzT{e{[O'ZRZt~AGD?s3􌿂ՉIw'|~U\ w~di:Kޱ)U/sU%njѩ&GSP^ǝd)..!^U` 1wX[aԇSxoFV6_扐)T 2Mfd=ۖͭiZ7KK Bi9%7@<3<ճԻU,},a}FRqɛr i@ONJvK KLN M, ʖv0n-]DwlI-X6ܶ$Jʴh5O+mOI+Ra瞠\ MG7BفjYo1#͖0V`Ѱ2M?c8>-Crt*JkIGS:e#hPKx[鱼>{5m;wcն&>j-M֥^َ) 6yȜl_w{-ō̱r> U=]iw3)r*]:K]6BdCTZ|>gf}LW}[$'Y5 &c -j.z6R 67MԷFMnÌwI7w5E}o޽+K ֵy4܌ȥW"COyR[q5Ӱ͙f[v"_#q{MV6܍3"u9BK(41ӯqˇc${ߝCi6I(OmθzҜ5k^:>Jzw.>qV8{vU[ڶEm|DžBz].KHjI]x;Mɗ{m,qZXr忇2u^RO2Z}ZێS[2Jen!*NDcrBUً4<ǼMҲs1Zw57c3&ĖڻzmP*FuJG1-dN:|OU}ҵgi2t~F^^Z.VxjvŧnNNh<:]^~NN+ge^g.SԔGFe߯'[vn'(ScJ]kܗ7eJOlRrfziݮq̋S"\*U<*W]k$FջV}? 7g#֟*GQQ|#/bo]p$>_Un9;l S VvQU%OLU{οmU6bZ1MTx%!֙Q7, J=!3 ;Q,ڌ;6ͱ݅q^&ߔ·n #WbwӖX.HtG)N&d̵zpI,n cu ޖUj+VXUp[w]N o.J6Z8Ts&utxln;~HPHS/xw`G\ʡ¿rj Z^vt"[L:SD\h0sUwR,}[x^X,R2Vn< ]2YDr[SRKs8tXb̷G?Ps Tv 3be,zVz D[/I.KOEQrm'$7|[J>r S`5յwT#\w1FTz\Ԛ &"ׅhSHrD\'r]~/>p;:Piuu:"9ő=tTaS7V2rӷk7mb[^WmPp*[y.Þ6f]cizJCgRR@UVl큝.WJP1N{/\whZ ػϧӱE7|E֫Sί.x-Y&pi%v''-x6r'Ws*6=DwwUu]=C?MK [yrtܒG$!WGqJ*%SAz ED[^)/tė/g=#Omd.|^n/sl׉g DZqemqowݮRzUܜ=ڽ-o/Iۖ;qVʘgPp|mm;6zGl9.8pwWgsJ2qPbe}}UpNjٯ}7TMQKrؽtEx%v w߾8%|j;~|}pK]ơ/ w߾8%|j;~|}pK]ơ/ w&~e_H 8PL7:%ʭ5Kw&U2vwR_+rm'}C7#rWoO&HoG?M$UR7{FU]u ;# !Wk`|W>׹潇9Vn)6)*ҹ{%qV4q>W1vi#T"Qk&GwxcJBJ- Ϸ^ˁxkU}ԣ/3.;]J=<*)cS)ROK9H=,r zX @)cS)Da^ԽQ gxJI=w֣gf*TRj

#pyungmo.ku@lignex1.com, TEL: +82-31-8026-7671
• Received: August 29, 2021   • Revised: October 18, 2021   • Accepted: October 20, 2021

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.

  • 15 Views
  • 0 Download
prev next
  • 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.

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
무인수상정 및 무인수중정과 같은 해양무인체계는 다양한 범위로 관심이 커지고 있다. 민수 분야에서는 해저 자원 탐사, 해저 지형 조사, 구조 및 재난 방제 등에 활용 가능하고, 국방 분야에서는 작전해역 및 주요 항만의 감시정찰, 대기뢰전, 대잠전, 대수상함전, 특수전 등에 활용 가능하다.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

KSPE_2022_v39n1_35_f001.jpg
이러한 무인수상정과 예인형 무인수중정 결합시스템은 무인수중정 운용의 단점을 보완해준다. 운용 시나리오에 따라 무인수상정의 빠른 기동성과 경로점 자율 운항을 이용하여 무인수중정의 광역 탐색이 가능하고, 강조류 하에서도 무인수상정의 예인을 도움 받아 무인수중정의 정밀 탐색이 가능하다. 또한 예인케이블을 통해 무인수상정의 위치 정보를 받아 무인수중정의 위치 추정이 가능하여, 무인수상정은 무인수중정으로부터 상태 정보를 실시간으로 받을 수 있어 무인수상정의 대응 속도가 빠르다. 무인수상정 및 예인형 무인수중정의 임무수행을 효과적으로 적용하려면, 우선적으로 무인수상정 및 무인수중정의 경로 추종 제어 설계가 선행되야 한다. 하지만 무인수상정 및 무인수중정이 결합된 형태의 경로 추종 제어에 대한 연구는 많이 부족한 상태이다.
본 논문에서는 예인형 무인수중정이 무인수상정의 동력 도움을 받아 무인수중정의 탐색 범위를 넓힐 수 있도록 기본적이고 실질적인 무인수상정의 경로 추종제어 설계를 제안한다. 경로추종 제어 설계를 하기 위해서는 선제적으로 무인수상정 동적 모델 및 식별이 필요하다. 일반적으로 무인수상정 동적 모델은 유체력, 풍력, 파고 등 외란의 외력이 존재하기에 상당히 비선형적이다.8 비선형적인 무인수상정 동적 모델로 제어기 설계하는 것은 단순한 작업이 아니므로, 선형적으로 단순화된 무인수상정 동적 모델들이 연구됐다.9-14 단순화된 무인수상정 동적 모델 중 1차 시스템의 속도 모델11,12과 각속도 모델13,14을 선정하여, 직진 및 선회 실선시험을 통해 가속도 및 등속도 데이터와 각가속도 및 등각속도 데이터를 이용한 동적 모델 식별 방법을 제안하였고, 속도별 직진 및 선회 실선 시험을 확보하여 동적 모델을 속도에 따라 가변적으로 적응될 수 있게 설계하였다. 무인수상정 속도 및 자세 제어기는 계산량도 적고 효과적인 PID 제어로 선정하였으며, 무인수상정의 경로계획상의 수선거리별로 회전 반경을 다르게 하여 무인수상정 경로선을 동적으로 추정할 수 있도록 기존의 LOS 방법을 보완하였다. 최종적으로 예인형 무인수중정이 경로계획을 추종될 수 있도록 무인수상정 운동에 따른 예인형 무인수중정 운동 모델 관계를 역이용하여 예인형 무인수중정 경로계획을 기반한 무인수상정의 경로계획을 제안하였다.
논문의 구성은 다음과 같다. 2장에서는 무인수상정 및 예인형 무인수중정 운동 모델을 설명하고, 무인수상정 동적 모델 식별 방법을 제안한다. 3장에서는 무인수상정 제어와 예인형 무인수중정 경로계획 기반 무인수상정 경로계획을 제안한다. 4장에서는 성능 검증을 위해 시뮬레이션을 통해 분석한다. 마지막으로 5장에서 결론을 맺는다.
2.1 무인수상정 및 예인형 무인수중정 운동 모델
본 운동 모델은 Fig. 2와 같이 2차원 평면상 운동을 가정하여 무인수상정 및 예인형 무인수중정에 대한 운동모델은 식(1)과 같다.
Fig. 2

Kinematics of USV and towed UUV

KSPE_2022_v39n1_35_f002.jpg
(1)
η˙=Rψv
여기서 위치벡터(η)는 pxi, pvi, ψT, 속도벡터(v)는 vxb, vvb, rT이며, 회전행렬은 식(2)와 같다.
(2)
Rψ=cos(ψ)-sin(ψ)0-sin(ψ)cos(ψ)0001
무인수상정과 예인형 무인수중정은 예인케이블 장력이 존재하고 케이블의 방향과 예인형 무인수중정의 자세가 같다는 가정하에 트렉터-트레일러 관계15로 정의하였다. 무인수중정의 진행방향 속도(vxb,UUV)는 식(3)과 같으며, 각속도(rzb,UUV)는 식(4)와 같다. 여기서, φ식(5)와 같이 무인수상정의 자세와 예인형 무인수중정 자세와의 차분값이다. φ의 업데이트는 식(6)과 같으므로 식(4)식(6)에 대입하여 식(7)φ의 업데이트를 표현한다.
(3)
vxb,UUV=vxb,USVcosϕ
(4)
rzb,UUV=-vxb,USVsinϕL
(5)
ϕ=ψUUV-ψUSV
(6)
ϕ˙=rzb,UUZ-rzb,USV
(7)
ϕ˙=vxb,USVsinϕL-rzb,USV
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

KSPE_2022_v39n1_35_f003.jpg
Fig. 4

Angular velocity output of USV curve maneuvering

KSPE_2022_v39n1_35_f004.jpg
Fig. 5

Heading output of USV curve maneuvering

KSPE_2022_v39n1_35_f005.jpg
(8)
Trr˙+r=KrδS
(9)
Tr0tr˙dt+0trdt=Kr0tδSdt
(10)
Trr0t+ψ0t=Kr0tδSdt
(11)
Trr23+ψ23=Kr23δSdt
(12)
K^r=ψ3-ψ2/23δSdt
(13)
Trr12+ψ12=Kr12δSdt
(14)
Tr=K^r12δSdt-ψ2-ψ2/r2-r1
각속도 동적 식별 계수를 추정하는 방법대로, 입력 추력(δ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

KSPE_2022_v39n1_35_f006.jpg
Fig. 7

Velocity output of USV straight maneuvering

KSPE_2022_v39n1_35_f007.jpg
(15)
Tvv˙+v=KvδT
(16)
Tv0tv˙dt+0tvdt=Kv0tδTdt
(17)
Tvv0t+0tvdt=Kv0tδTdt
(18)
Tvv23+23vdt=Kv23δTdt
(19)
K^v=23vdt/23δSdt
(20)
Tvv12+12vdt=Kv12δTdt
(21)
T^v=K^v12δTdt-12vdt/v2-v1
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

KSPE_2022_v39n1_35_f008.jpg
(22)
δS=K1K2ψc-ψ-ψ˙
(23)
δS=1KrTrψ¨+ψ˙
(24)
ψ¨+1+KrK1Trψ˙+KrK1K2Trψ=KrK1K2Trψc
(25)
ψ¨+2ζωnψ˙+ωn2ψ=ωn2ψc
(26)
K1=2ζωnTr-1/Kr
(27)
K2=wn2Tr/2ζωnTr-1
속도 제어기는 Fig. 9와 같이 비례 제어기로 구성하였다. 구성한 속도 제어기 구조의 입력 추력(δT)은 식(28)과 같으며, 식(15)를 입력 추력(δT)에 대해 정리하면 식(29)와 같다. 식(28)식(29)는 같으므로 식(30)과 같이 정리될 수 있으며, 속도 제어 비례 게인(K1)는 식(25)의 자세 제어 미분 게인(K1)과 같은 상에 있으므로 식(31)로 표현할 수 있다.
Fig. 9

Velocity control of USV scheme

KSPE_2022_v39n1_35_f009.jpg
(28)
δT=K1vc-v
(29)
δT=1KvTvv˙+1
(30)
v˙+1+KvK1Tvv=KvK1Tvvc
(31)
K1=2ζωnTv-1/Kv
3.2 예인형 무인수중정 기반 무인수상정 경로 추종
예인형 무인수중정의 운동은 식(3)부터 식(7)에서 알 수 있듯이 무인수상정의 운동과 예인케이블 길이에 의해 종속된다. 종속된 관계를 역이용하여 무인수중정의 각속도, 자세, 속도와 같은 경로계획 프로파일이 정해진다면, 무인수상정의 경로계획을 세울 수 있다. 식(32)는 무인수중정의 각속도(rz,profileb,UUN) 프로파일을 충족하기 위한 지향되어야 할 무인수중정과 무인수상정과의 자세 차이(φdesird)를 말한다. 식(32)φdesird가 결정되면, 식(33)과 같이 지향되어야 할 무인수상정의 자세(ψdesiredUSV)값이 된다. 그리고 식(34)는 무인수중정의 속도(vx,profileb, UUV) 프로파일을 충족하기 위한 지향되어야 할 무인수상정의 속도(vx,desirdb, USV)를 나타낸다. 지향되어야 할 무인수상정의 속도 및 자세가 결정되면, 식(1)에 따라 무인수상정의 경로가 결정되며, 이는 무인수상정의 경로점으로 이용하여 유도명령을 내릴 수 있다.
(32)
ϕdesired=sin-1Lrz,profileb,UUV/vzb,USV
(33)
ψdesiredUSV=ψprofileUUV-ϕdesired
(34)
vx,desirdb, USV=vx,profileb, UUV/cosϕdesiredη˙=Rψv
Fig. 10은 무인수상정의 경로점에 대한 유도기법을 설명한다. 무인수상정의 현재 위치(xUSVlocal,yUSVlocal)와 첫 번째 경로점(x1wp,y1wp) 및 두 번째 경로점(x2wp,y2wp)이 있다면, 기존의 무인수상정 Line of Sight (LOS) 지향벡터(l) 및 LOS 지향자세(ψl)를 통해 유도명령을 내릴 수 있다.19 LOS 방법으로는 위치 및 자세가 점진적으로 경로계획과 수렴하여 경로계획 오차가 줄어들지만, 경로계획 오차가 존재한 상태로 경로 추종이 이루어지므로 효율적인 경로 추종 방법이 필요하다.
Fig. 10

Guidance of USV scheme

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

Heading desired of USV respect to perpendicular distance

Table 1
Condition ψdesired
d > 2R ψd
R< d < 2R ψR2
0.5R< d <R ψR1
d < 0.5R ψ1
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)

KSPE_2022_v39n1_35_f011.jpg
Fig. 12

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

KSPE_2022_v39n1_35_f012.jpg
Fig. 13

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

KSPE_2022_v39n1_35_f013.jpg
Fig. 14

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

KSPE_2022_v39n1_35_f014.jpg
Table 2

Dynamic model identification coefficients of USV respect to velocity

Table 2
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. 15

USV angular velocity dynamic model

KSPE_2022_v39n1_35_f015.jpg
Fig. 16

USV velocity dynamic model

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

USV heading control

KSPE_2022_v39n1_35_f017.jpg
Fig. 18

USV velocity control

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

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

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

USV velocity control for waypoints

KSPE_2022_v39n1_35_f019.jpg
Fig. 20

USV heading control for waypoints

KSPE_2022_v39n1_35_f020.jpg
Fig. 21

USV path-following control for waypoints

KSPE_2022_v39n1_35_f021.jpg

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

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

Profile of UUV path plan

Table 3
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
Fig. 22

USV velocity plan respect to UUV path plan

KSPE_2022_v39n1_35_f022.jpg
Fig. 23

USV attitude plan respect to UUV path plan

KSPE_2022_v39n1_35_f023.jpg
Fig. 24

USV path plan respect to UUV path plan

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

USV and UUV path following using conventional LOS vector method

KSPE_2022_v39n1_35_f025.jpg
Fig. 26

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

KSPE_2022_v39n1_35_f026.jpg
본 논문은 무인수상정 동력을 도움을 받아 무인수중정의 탐색 범위를 넓힐 수 있도록 기본적이고, 실질적인 무인수상정의 경로추종제어 설계를 제안하였다. 무인수상정의 1차 시스템의 동적 모델 식별 방법을 제안하였으며, 속도에 따라 가변적으로 동적 모델이 적응될 수 있게 설계하였다. 또한 기존의 PID 제어 방법을 활용하고, LOS 유도 명령 보완을 통하여 무인수상정의 경로 추종제어를 설계하였다. 마지막으로 예인형 무인수중정과 무인수상정의 운동 모델 관계를 역이용하여 예인형 무인수중정 경로계획을 기반한 무인수상정의 경로 추종 제어를 설계하였다. 제안된 설계 기법을 통해 무인수상정 및 예인형 무인수중정의 경로 계획대로 추종 및 효율성을 확인하였다.
  • 1.
    Manley, J. E., “Unmanned Surface Vehicles, 15 Years of Development,” Oceans, pp. 1-4, 2008.
    10.1109/OCEANS.2008.5289429
  • 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.
    10.1002/9781119994138
  • 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.
    10.1002/rob.21452
  • 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.
    10.1109/TMECH.2017.2651057
  • 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.
    10.2534/jjasnaoe1952.1956.99_75
  • 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.
    10.14311/AP.2020.60.0197
  • 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
    10.1299/jsdd.2.389
  • 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.
    10.1016/S1474-6670(17)37809-6
Pyung Mo Ku
KSPE_2022_v39n1_35_bf001.jpg
Research Engineer in LIGNex1. His research interest is GNC M&S of unmanned systems.
Jae Kwan Ryu
KSPE_2022_v39n1_35_bf002.jpg
Chief Research Engineer in LIGNex1. His research interest is Unmanned systems (USV, UGV).
Won Hee Lee
KSPE_2022_v39n1_35_bf003.jpg
Chief Research Engineer in LIGNex1. His research interest is Unmanned systems (USV, UGV).

Download Citation

Download a citation file in RIS format that can be imported by all major citation management software, including EndNote, ProCite, RefWorks, and Reference Manager.

Format:

Include:

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
J. Korean Soc. Precis. Eng.. 2022;39(1):35-44.   Published online January 1, 2022
Download Citation

Download a citation file in RIS format that can be imported by all major citation management software, including EndNote, ProCite, RefWorks, and Reference Manager.

Format:
Include:
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
J. Korean Soc. Precis. Eng.. 2022;39(1):35-44.   Published online January 1, 2022
Close

Figure

  • 0
  • 1
  • 2
  • 3
  • 4
  • 5
  • 6
  • 7
  • 8
  • 9
  • 10
  • 11
  • 12
  • 13
  • 14
  • 15
  • 16
  • 17
  • 18
  • 19
  • 20
  • 21
  • 22
  • 23
  • 24
  • 25
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
Image Image Image Image Image Image Image Image Image Image Image Image Image Image Image Image Image Image Image Image Image Image Image Image Image Image
Fig. 1 Development case of unmanned maritime integrated system
Fig. 2 Kinematics of USV and towed UUV
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
Fig. 6 Thrust input of USV straight maneuvering
Fig. 7 Velocity output of USV straight maneuvering
Fig. 8 Attitude control of USV scheme
Fig. 9 Velocity control of USV scheme
Fig. 10 Guidance of USV scheme
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)
Fig. 15 USV angular velocity dynamic model
Fig. 16 USV velocity dynamic model
Fig. 17 USV heading control
Fig. 18 USV velocity control
Fig. 19 USV velocity control for waypoints
Fig. 20 USV heading control for waypoints
Fig. 21 USV path-following control for waypoints
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
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
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
Condition ψdesired
d > 2R ψ d
R< d < 2R ψ R 2
0.5R< d <R ψ R 1
d < 0.5R ψ 1
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
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
Table 1 Heading desired of USV respect to perpendicular distance
Table 2 Dynamic model identification coefficients of USV respect to velocity
Table 3 Profile of UUV path plan