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

조인트 구속조건 결합형 관성센서기반 수직변위 추정

Estimation of Vertical Displacement based on Inertial Sensor Signals Combined with Joint Constraint

Journal of the Korean Society for Precision Engineering 2019;36(3):233-238.
Published online: March 1, 2019

1 국립한경대학교 기계공학과

1 Department of Mechanical Engineering, Hankyong National University 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

#E-mail: jklee@hknu.ac.kr, TEL: +82-31-670-5112
• Received: August 27, 2018   • Revised: October 17, 2018   • Accepted: October 22, 2018

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.

  • 56 Views
  • 0 Download
prev next
  • Displacement estimation based on inertial sensor signals is usually performed in aid of global positioning systems or barometers. However, due to low accuracy estimation capabilities of such aiding sensors, inertial sensor-based displacement estimation is difficult to achieve high accuracy. This paper will show that it is possible to determine the vertical displacement of a link connected by a joint with higher accuracy while only using the inertial sensor. The proposed method utilizes a predetermined position vector from the joint center to the sensor and link orientation. By combining the joint constraint, accuracy of the orientation estimation is ensured even in highly dynamic conditions, and thus, the vertical displacement estimation with high accuracy can be achieved. Experimental results show that the proposed method outperformed the method by fusing inertial sensor and barometer signals as well as the method using inertial sensor signals only without constraint combination.
본 논문은 로봇 및 인체 모델을 포함하여 조인트로 연결된 다링크(Multi-Link) 시스템에 있어, 관성센서를 이용하여 센서 부착 지점의 링크 수직변위를 추정하는 방법에 대한 것이다. 링크의 변위 추정은 다양한 목적을 위해 요구되어지는데, 예를 들어 머니퓰레이터의 변위는 역기구학 해석에 활용되며, 인체역학 모델에서는 이를 통해 전신 모션캡처가 이루어진다.1,2
최근 로봇공학, 운동역학, 재활공학과 같은 다양한 분야에서 관성센서를 이용한 변위 추정이 활발히 연구되고 있다.3-7 관성센서가 각광을 받는 근본적인 이유는 이 센서가 일반적인 변위 센서와 달리 송신과 수신의 관계가 없다는 점이다. 즉, 일반적인 변위 센서는 송신기 또는 수신기중 한 가지가 고정지점에 위치하여, 이 지점에 상대적인 운동체의 변위를 감지하는 방식으로 작동한다. 예를 들어, 광학식 카메라 시스템은 카메라가 고정지점에 위치하고, 추정 대상체에 부착된 마커를 카메라에 노출시키므로서, 카메라와 함께 고정된 좌표계에서 관측된 마커의 위치를 제공하는 방식이다. 따라서, 일반적인 변위 추정 센서에 있어 제한적인 작동범위는 불가피하다. 따라서 이동체를 대상으로 한 변위추정에 있어, 공간제약성이 없는 관성센서의 적용이 필요한 것이다.8,9
하지만, 관성센서는 가속도계를 통한 선형가속도 및 자이로스코프를 통한 각속도를 제공할 뿐 변위를 직접적으로 제공하지 않는다. 따라서, 관성센서 신호를 통한 변위 추정은 칼만필터 등을 통한 복잡한 신호처리 과정을 거쳐야 한다. 또한, 구속이 없는 단일 이동체의 변위 추정에 있어, 관성센서 단독으로는 적분에 따른 표류오차를 피할 수 없으므로 GPS (Global Positioning System)나10,11 바로미터(Barometer)12-14 등과 융합을 통해 변위를 추정하고 있다. 이때 GPS나 바로미터는 표류하지 않는 변위값을 제공하며, 관성센서는 고샘플링률을 제공하므로, 두 센서의 융합을 통해 고샘플링률과 고정확도의 변위추정을 도모하는 것이다. 하지만, GPS나 바로미터 신호는 표류오차를 방지하는 동시에 궁극적으로 추정값의 결정에 가장 크게 기여한다. 다시 말해, 표류오차 방지를 위해 GPS나 바로미터 신호에 의존하는 이상 이들 신호에 오차가 증가하면 추정값도 심각하게 영향을 받는 것은 불가피하다.14,15 이와 같이 관성센서 기반 변위추정은 관성센서 단독이 아닌 이종 센서와의 융합을 기반으로 하는 경우가 많으며, 이 경우에도 정확도를 확보하는 것이 매우 어렵다.
본 논문이 대상으로 하는 조인트로 연결된 링크의 변위 추정에 있어서는 조인트에 의해 변위의 자유도가 제약을 받으므로, 관성센서만을 이용하면서도 보다 높은 정확도로 변위 결정이 가능하다. 이는 기본적으로 ‘자세경유 변위추정(Displacement Estimation Via Orientation)’라고 할 수 있다. 이 접근법은 다음의 두 단계를 거친다. 첫째, 조인트중심에서 센서로의 위치벡터(Position Vector from Joint Center to Sensor, 이하 J2S 벡터)를 사전 캘리브레이션을 통해 결정한다. 이때 J2S 벡터는 센서좌표계에서 관찰되므로, 상수(Constant)이다. 둘째, 고정좌표계에 대한 센서의 자세를 추정한다. 그렇다면 앞서 구한 J2S벡터를 고정좌표계에서 관찰되는 벡터로 좌표계 변환을 하므로써 센서의 변위를 추정하는 것이다. 이때 자세는 고정좌표계에 대한 자세로서 일반적으로 조인트에 부착되는 엔코더를 통한 각도와는 다르다.
하지만 이러한 자세경유 변위추정 역시 추정정확도 개선에 많은 여지가 있다. 사전 캘리브레이션을 통한 J2S 벡터와 관성센서를 통한 자세를 이용하는 만큼, 이 둘의 정확도를 향상시키므로써 추정 성능 향상이 가능하다. 하지만, 자세경유 변위추정과 관련한 대부분의 문헌은 J2S 벡터를 구하는 방법에 대한 것이다.16-18 반면, 자세 추정 알고리즘에 대해서는 조인트로 구속된 링크라는 점을 이용하지 않고, 일반적인 비구속 강체에 대한 범용 자세 결정 알고리즘을 적용하고 있다. 그러나 동적조건에서는 가속도로 인해 자세 결정에 이용되는 가속도계신호 관련 참조벡터의 신뢰성이 훼손되고 결과적으로 자세 추정 성능이 크게 감소할 수 있다.9,19
이에 대한 대응으로 가속도 보상 메커니즘이 적용된 자세추정 칼만필터가 개발되고 있다. 그럼에도 불구하고, 동적조건이 지속되는 로봇시스템이나, 고속 가동조건이 빈번히 발생하는 기계시스템의 경우 기존의 가속도 보상 메커니즘으로는 추정 정확성 향상에 한계가 있다.19,20 조인트로 연결된 링크는 해당 조인트의 종류에 따라 허용된 형태의 상대운동을 하고 다른 움직임은 구속되어진다. 이러한 조인트 구속조건은 자세추정의 정확성을 향상시키기 위해 활용될 수 있으며, 앞서 설명하였듯이 이는 변위 추정정확도 향상으로 이어질 수 있다.
본 논문은 조인트 구속조건 결합형 관성센서기반 수직변위 추정 방법을 제안한다. 특히 3방향 회전조인트인 볼조인트의 구속 조건에 대하여, 제안 방법의 성능을 구속조건이 아닌 가속도 보상 메커니즘 적용을 통한 변위추정방법과 바로미터 융합형 변위 추정방법의 성능과 비교 분석하였다.
본 논문에서 제안하는 수직변위추정 구속 칼만필터는 참고문헌21에서 제안된 비구속 자세추정 칼만필터를 기반으로 전개된다.
고정된 항법좌표계(Navigation Frame, n)에 상대적인 이동하는 센서좌표계(Sensor Frame, s)의 3차원 자세를 의미하는 방향코사인행렬 Rns식(1)과 같이 표현가능하다.
(1)
Rns=XsYsZsT
여기서, Xs, Ys, Zs는 각각 n좌표계의 X, Y, Z축 단위벡터를 s좌표계에서 관찰한 것이다. 이처럼 우측 윗첨자를 통해 벡터의 관측 좌표계를 표기한다. 가장 일반적인 좌표축 설정이 그러하듯 n좌표계의 Z축이 상향중력방향으로 설정되는 경우, Zs는 수직축에 대한 센서의 기울기를 의미하는 틸트(Tilt)벡터이며, 이를 통해 롤, 피치와 같은 자세 정보를 얻을 수 있다.21 따라서, 이후 기술되는 칼만필터에서는 Zs를 추정한다.
6축 관성센서를 구성하는 자이로스코프와 가속도계의 신호는 각각 식(2)식(3)과 같이 모델링되었다.
(2)
sG=ωs+nG
(3)
sA=gs+as+nA
여기서, ωs는 각속도, nG는 자이로스코프 신호잡음, gs는 중력가속도, as는 센서가속도, nA는 가속도계 신호잡음이다. 또한, 식(3)의 센서가속도는 식(4)와 같은 마르코프 연쇄식 기반식이 적용되었다.
(4)
aks=caak-1s+εk
칼만필터의 진행모델은 스트랩다운 적분식으로부터 이산시간 k에 대하여 식(5)와 같이 모델링된다.
(5)
Zks=I-TssG,k-1×Zk-1s+Ts-Zk-1snG
여기서 I는 단위행렬, Ts는 샘플링 간격이며, ‘×’는 해당 벡터의 외적(Cross Product) 행렬을 의미한다. 또한, 칼만필터의 측정모델은 식(6)과 같다.
(6)
sA,k-caak-1k-1s=gZks-aε,kk-1s+nA
여기서, g는 중력가속도의 크기이며, 이산시간 k에 대하여, k|k−1는 예측값(a priori), k|k는 보정값(a posteriori)을 의미한다.21
식(5)식(6)을 통해 도출되는 비구속 자세추정 칼만필터식은 식(7)식(8)과 같다.
(7)
xk=Φk-1xk-1+wk-1
(8)
zk=Hkxk+vk
여기서 식(5)로부터 식(7)의 상태벡터 xk는 틸트벡터 Zks, 천이행렬 Φk-1ITs[sG,k−1×], 진행 잡음 wk-1Ts-Zk-1s×nG 이며 공분산 행렬 Qk-1=-TsΣGZk-1s×2을 갖는다. 식(6)으로부터 식(8)의 측정벡터 zksA,k-caak-1k-1s, 관측행렬 HkgI, 측정 잡음 vk-aε-1k-1s+nA 이며 공분산 행렬 Mk=3-1ca2ak-1k-1s2I+ΣA을 갖는다.21 이때 ΣG와 ΣA는 각각 nGnA에 대한 공분산 행렬로서 σG2IσA2I로 설정되었다(여기서, σGσA는 신호잡음에 대한 표준편차).
식(4)의 센서가속도 모델은, 생체역학적 응용관점에서 ‘관성센서가 많은 시간 정적조건을 유지한다’는 가정을 바탕으로 한다. 따라서, 기계시스템에서 동적조건이 장시간 지속되는 경우 가정이 위배되어 모델링의 불확실성이 증가하고 오류를 발생시킬 수 있다.19 다음은 조인트 구속조건을 통해 불확실성이 제거된 센서가속도 모델을 칼만필터에 결합하는 과정이다.
바닥에 소켓부분이 고정된 볼조인트에 연결된 링크에 있어, 조인트중심에서 센서로의 J2S (Joint to Sensor) 위치벡터를 S좌표계 관점에서 표현한 벡터를 ps라 하면, 센서가속도 as식(9)와 같다.
(9)
as=ω˙s×+ωs×ωs×ps
이때, J2S벡터는 ps는 캘리브레이션을 통해 결정된 값으로 가정한다 (본 논문에서는 참고문헌16 이용). 식(9)ωs = sGnG과 [nG×][nG×] = 0를 적용하여 정리하면, 식(10)과 같이 측정모델로 사용가능한 가속도단계의 조인트 구속조건식이 된다.19
(10)
as=s˙G×+sG×sG×ps+εa
여기서 구속조건 오차 εa식(11)과 같다.
(11)
εa=ps×n˙G-ps×sG×-2sG×ps×nG
식(11) 우변의 각항에 있어, n˙GnG를 오른쪽에 위치시키기 위하여 −이를 통해 에 대한 공분산행렬 도출이 가능하게 하기 위하여 [[a×]b×] = [a×][b×] - [b×][a×]와 [a×]b = -[b×]a 등의 행렬 규칙이 적용되었다.19
식(10)식(11)을 통해, 조인트 구속조건을 통한 2차 측정모델이 식(12)와 같이 정리된다.
(12)
sA-s˙G×+sG×sG×ds=gZs+εc+nA
따라서, 식(6)을 통한 비구속 칼만필터에서의 보정값은, 식(12)를 통한 구속조건 결합형 칼만필터에서 추가적인 보정과정을 거치게 된다. 즉, 비구속된 보정 상태벡터 xk|k와 오차 공분산 행렬 Pk|k은, 각각 구속된 보정 상태벡터 cxk|k와 구속된 오차 공분산행렬 cPk|k로 각각 식(13)식(14)와 같이 갱신된다.
(13)
xckk=xkk+Kckzck-gxkk
(14)
Pckk=I-gKckPkk
여기서, 구속 측정벡터 czksA-s˙G×+sG×sG×ds, 구속 칼만이득 cKkgPk|k (g2Pk|k + cBk)-1, cBkεc + nA의 공분산 행렬이다. 식(13)을 통해 구속된 상태벡터 xckk=Zckks가 구해지면, 본 논문의 추정대상인 수직변위 dzn식(15)와 같이 구해진다. 여기서 dzndn의 Z방향 성분, 즉, dn=dxn,dyn,dznT.
(15)
dzn=ZckksTds
여기서, Zckks는 구속조건 결합을 통해 불확실성이 제거된 자세정보이므로, 이를 통해 구한 dzn 역시 불확실성이 제거된 고정확도의 수직변위이다.
제안하는 수직변위 추정 기법의 성능을 검증하기 위하여 GY-87 모듈 시스템이 Arduino사 UNO보드에 연결되어 사용되었다. GY-87은(가속도계와 자이로스코프를 포함하는) 6축 InvenSense MPU-6050 관성센서와 3축 Honeywell HMC5883L 지자기센서, 그리고 Bosch BMP180 바로미터로 구성된다. 이 중 관성센서는 제안기법을 위해 사용되고, 바로미터는 비교기법을 위해 사용되며, 지자기센서는 사용되지 않았다. 또한, 성능비교를 위한 참조값을 얻기 위해 OptiTrack사의 Flex13 광학식 모션캡쳐 시스템을 사용하였다(마커위치 절대오차 < 0.1 mm). 샘플링 주기는 모든 시스템에서 100 Hz로 설정하였다.
관성센서가 부착된 삼각자에 세 개의 마커를 부착하므로써 마커 위치정보를 이용하여 Zs의 참조값을 구하고, 이를 통해 수직변위 참조값을 구한다. 하단에 볼조인트가 있는 링크에 관성센서 및 마커가 부착된 삼각자를 고정시키고, 볼조인트의 소켓부분을 바닥에 고정함으로써 식(9)가 성립하도록 하였다. 여기서 J2S벡터 ds는 [−9 −4 165]T cm였다(Fig. 1 참조).
Fig. 1

Test setup

KSPE_2019_v36n3_233_f001.jpg
링크를 손으로 붙잡고 임의로 움직여 가며 실험이 진행되었다. 본 논문의 주제는 수직변위 추정이므로 수직변위가 발생하도록(즉, n좌표계의 Z축방향) 움직였으나, 전후/좌우 방향으로도 임의의 움직임을 가하며 실험이 진행되었다. 조인트 구속조건 결합에 따른 추정 성능개선 효과를 확인하기 위하여 다음과 같이 일정크기 이상의 센서가속도가 존재하는 실험조건을 설정하였으며, 모두 65초간 진행되었다.

• Test 1: 참조값 ∥aS∥의 평균 6.8 m/s2

• Test 2: 참조값 ∥aS∥의 평균 10.7 m/s2

• Test 3: 참조값 ∥aS∥의 평균 12.5 m/s2

제안하는 수직변위 추정기법(Method A)과 아래의 비교기법들(Methods B - D)의 성능이, 참조값에 따른 RMSE (Root Mean Square Error)를 통해 비교 분석되었다.

• Method B: 참고문헌21의 자세칼만필터를 통해 추정한 경우. 즉, 조인트 구속조건 결합형이 아닌 비구속 자세칼만필터를 사용한 경우.

• Method C: 참고문헌14의 수직변위 추정 기법. 즉, 자세경유 변위추정기법이 아닌, 관성센서−바로미터 융합을 통해 추정한 경우.

• Method D: 바로미터만을 사용하여 수직변위를 추정한 경우.

Table 1은 각각의 경우에 대한 수직변위 추정 RMSE를, Fig. 2는 그에 해당하는 결과그래프를 보여준다. Fig. 2(c)는 Test 3 전구간(65초간)을 보여주고 있는 반면, Figs. 2(a)2(b)는 각각 Test 1과 Test 2 일부 구간 (5초간)만 보여주고 있는데, 이는 Test 1과 Test 2에서 Method A와 Method B의 차이를 보여주기 위함이다.
Table 1

RMSEs of vertical position estimation

(unit: cm)
Table 1
Method A Method B Method C Method D
Test 1 0.58 0.93 17.34 31.65
Test 2 1.86 2.80 31.05 49.86
Test 3 2.56 10.21 24.35 49.54
Fig. 2

Estimation results of (a) Test 1, (b) Test 2, and (c) Test 3, from Method A (green line with circle markers), Method B (blue with triangles), Method C (red with diamonds), and Method D (gray)

KSPE_2019_v36n3_233_f002.jpg
모든 경우에서 자세경유 변위 추정기법인 Method A와 Method B가 관성센서-바로미터융합 기법인 Method C에 비해 월등히 우수한 추정성능을 보였다. Method C는 바로미터 신호인 Method D에 비해 평균 19.4 cm의 성능향상을 보였으나, 큰 오차를 보이는 바로미터 신호를 추종하는 모습을 보였다.
Method A와 Method B의 비교에 있어서, 모든 실험에서 제안방법인 Method A가 우세하였다. 하지만, 우세폭은 Test 1에서 0.35 cm, Test 2에서 0.94 cm, Test 3에서 7.65 cm로 상이하였으며, 이는 각 테스트의 센서가속도 조건과 관련성이 있다. 즉, Method B에서는 센서가속도가 증가할수록 가속도계신호 관련 참조벡터의 신뢰성이 훼손되고 자세 추정 성능이 감소하였고, 결과적으로 수직변위 추정 성능 저하되는 모습을 보였다(Table 2참조). 즉, 상대적으로 센서가속도가 크지 않은 Test 1에서는 Method B에 적용된 참고문헌21의 자세 칼만필터가 지니고 있는 가속도 보상 메커니즘으로 인해 Method A와 큰 차이가 없이 정확한 추정을 하고 있는 반면(Fig. 2(a) 참조), Test 3에서는 Fig. 2(c)에서 보이듯 동적조건의 시간이 경과함에 따라 오차가 증가하여, 동작이 멈추기 전까지 오차를 회복하지 못하는 모습이 관찰되었다. 이 경우 Table 2에서 보이듯 자세추정 오차 역시 Method A와 큰 폭의 차이를 보였다.
Table 2

RMSEs of roll/pitch estimation

(unit:°)
Table 2
Method A Method B
Roll Pitch Roll Pitch
Test 1 0.53 0.49 0.71 0.55
Test 2 1.20 1.30 1.80 1.79
Test 3 1.72 1.76 5.73 5.83
반면, 제안방법인 Method A에서는 비록 센서가속도가 증가하면서 추정오차가 다소 증가하는 모습을 보였으나, 모든 테스트에서 3 cm 이내의 우수한 성능을 보였다. 제안방법의 경우 조인트 구속조건을 결합하므로서 센서가속도에 의한 자세추정의 불확실성이 제거되었으므로, 이론적으로 센서가속도에 무관한 추정성능을 보여야 한다. 하지만, Table 1에서 보여지는 약간의 관련성은, 가속조건에서 링크의 미세한 휨, 관성센서 계측값의 부정확성, 고정조인트의 미세 움직임 등에 기인한 것으로 판단된다.
본 논문은 링크의 수직변위 추정을 주제로 하고 있다. 만약 수직변위가 아닌, 전후좌우를 포함한 3차원 변위 추정을 대상으로 한다면, 제안 기법이 사용하는 관성센서(자이로스코프 + 가속도계)에 더하여 지자기 센서가 필요하다. 지자기 센서를 추가하므로써 식(1)에서 Zs가 아닌 Rns 전체를 추정할 수 있고, 이를 통해 식(15)의 대신 dzn=ZsTds 대신 dn = Rns ds가 가능하다. 하지만, 가속도계가 센서가속도라고 하는 불확실성 요소를 갖는 것처럼, 지자기센서는 자기교란이라고 하는 불확실성 요소를 갖고 있다. 본 논문에서의 조인트 구속조건은 센서가속도라는 불확실성을 제거할 수 있지만, 자기교란과는 물리적 연관성이 없다. 따라서, 자세경유 3차원 변위추정에 있어, 전후좌우 방향의 정확도 향상을 위해서는 별도의 고려가 필요할 수 있다.
본 논문은 조인트로 연결된 링크에 대하여, 조인트 구속조건 결합형 관성센서기반 수직변위 추정 방법을 제안하고 있다. 자세경유 변위추정 방식을 통해 관성센서만을 이용하여 매우 높은 정확도로 수직변위를 추정하는 방법을 제안하고 있다. 특히, 조인트 구속조건을 결합하여 자세추정에 있어서의 불확실성을 제거하고 이를 통해 수직변위 추정의 정확도를 향상시켰다. 조인트 구속조건을 결합하지 않은 기존의 비구속형 자세결정 기법을 경유한 경우에 비하여, 모든 경우에서 우세한 수직변위 추정성능을 보였다. 특히, 센서가속도가 크고 오랫동안 지속된 경우에도 비구속형과 달리 성능이 유지되는 것을 확인하였다.
제안 방법은 다관절 머니퓰레이터나 말단효과장치의 고정 관성좌표계 관점에서의 절대 위치 추적 등을 위하여 적용될 수 있다. 본 논문을 통해 응용분야가 다소 제한적일 수는 있으나, 관성센서만으로 수직변위를 추정할 수 있는 예시를 보여주고 있다. 특히 구속조건 결합을 통해 추정성능의 향상을 확보할 수 있다는 점을 보여주고 있다.
이 논문은 2018년도 정부(교육부)의 재원으로 한국연구재단기초연구사업(No. 2018R1D1A1B07042791)의 지원을 받아 수행됨.
  • 1.
    Giansanti, D., Maccioni, G., and Macellari, V., “The Development and Test of a Device for the Reconstruction of 3-D Position and Orientation by Means of a Kinematic Sensor Assembly with Rate Gyroscopes and Accelerometers,” IEEE Transactions on Biomedical Engineering, Vol. 52, No. 7, pp. 1271-1277, 2005.
    10.1109/TBME.2005.847404
  • 2.
    Lee, D.-H., Baek, S. Y., and Cho, N. G., “Six-Degree-of-Freedom Manipulator Displacement Measurement Using Stereo Vision,” Journal of the Korean Society for Precision Engineering, Vol. 32, No. 2, pp. 191-198, 2015.
    10.7736/KSPE.2015.32.2.191
  • 3.
    Meng, X., Zhang, Z.-Q., Wu, J.-K., and Wong, W.-C., “Hierarchical Information Fusion for Global Displacement Estimation in Microsensor Motion Capture,” IEEE Transactions on Biomedical Engineering, Vol. 60, No. 7, pp. 2052-2063, 2013.
    10.1109/TBME.2013.2248085
  • 4.
    Ruffaldi, E., Peppoloni, L., and Filippeschi, A., “Sensor Fusion for Complex Articulated Body Tracking Applied in Rowing,” Proc. of the Institution of Mechanical Engineers, Part P: Journal of Sports Engineering and Technology, Vol. 229, No. 2, pp. 92-102, 2015.
    10.1177/1754337115583199
  • 5.
    Zhou, H. and Hu, H., “Reducing Drifts in the Inertial Measurements of Wrist and Elbow Positions,” IEEE Transactions on Instrumentation and Measurement, Vol. 59, No. 3, pp. 575-585, 2010.
    10.1109/TIM.2009.2025065
  • 6.
    Schepers, H. M., Roetenberg, D., and Veltink, P. H., “Ambulatory Human Motion Tracking by Fusion of Inertial and Magnetic Sensing with Adaptive Actuation,” Medical & Biological Engineering & Computing, Vol. 48, No. 1, pp. 27-37, 2010.
    10.1007/s11517-009-0562-9
  • 7.
    Filippeschi, A., Schmitz, N., Miezal, M., Bleser, G., Ruffaldi, E., et al., “Survey of Motion Tracking Methods Based on Inertial Sensors: A Focus on Upper Limb Human Motion,” Sensors, Vol. 17, No. 6, p. 1257, 2017.
    10.3390/s17061257
  • 8.
    Lee, J. K. and Park, E. J., “Quasi Real-Time Gait Event Detection Using Shank-Attached Gyroscopes,” Medical & Biological Engineering & Computing, Vol. 49, No. 6, pp. 707-712, 2011.
    10.1007/s11517-011-0736-0
  • 9.
    Lee, J. K. and Park, E. J., “Minimum-Order Kalman Filter with Vector Selector for Accurate Estimation of Human Body Orientation,” IEEE Transactions on Robotics, Vol. 25, No. 5, pp. 1196-1201, 2009.
    10.1109/TRO.2009.2017146
  • 10.
    Waegli, A. and Skaloud, J., “Optimization of Two GPS/MEMS-IMU Integration Strategies with Application to Sports,” GPS Solutions, Vol. 13, No. 4, pp. 315-326, 2009.
    10.1007/s10291-009-0124-5
  • 11.
    Sadi, F. and Klukas, R., “New Jump Trajectory Determination Method Using Low-Cost MEMS Sensor Fusion and Augmented Observations for GPS/INS Integration,” GPS Solutions, Vol. 17, No. 2, pp. 139-152, 2013.
    10.1007/s10291-012-0267-7
  • 12.
    Sabatini, A. M. and Genovese, V., “A Sensor Fusion Method for Tracking Vertical Velocity and Height Based on Inertial and Barometric Altimeter Measurements,” Sensors, Vol. 14, No. 8, pp. 13324-13347, 2014.
    10.3390/s140813324
  • 13.
    Zihajehzadeh, S., Lee, T. J., Lee, J.-K., Hoskinson, R., and Park, E. J., “Integration of MEMS Inertial and Pressure Sensors for Vertical Trajectory Determination,” IEEE Transactions Instrumentation and Measurement, Vol. 64, No. 3, pp. 804-814, 2015.
    10.1109/TIM.2014.2359813
  • 14.
    Lee, J. K., “A Two-Step Kalman/Complementary Filter for Estimation of Vertical Position Using an IMU-Barometer System,” Journal of Sensor Science and Technology, Vol. 25, No. 3, pp. 202-207, 2016.
    10.5369/JSST.2016.25.3.202
  • 15.
    Lim, J. and Kang, S., “Non-Inertial Sensor-Based Outdoor Localization for Practical Application of Guide Robots,” Journal of the Korean Society for Precision Engineering, Vol. 34, No. 5, pp. 315-321, 2017.
    10.7736/KSPE.2017.34.5.315
  • 16.
    Seel, T., Schauer, T., and Raisch, J., “Joint Axis and Position Estimation from Inertial Measurement Data by Exploiting Kinematic Constraints,” Proc. of Control Applications International Conference, pp. 45-49, 2012.
    10.1109/CCA.2012.6402423
  • 17.
    Olsson, F. and Halvorsen, K., “Experimental Evaluation of Joint Position Estimation Using Inertial Sensors,” Proc. Information Fusion 20th International Conference, pp. 1-8, 2017.
    10.23919/ICIF.2017.8009669
  • 18.
    Vargas-Valencia, L. S., Elias, A., Rocon, E., Bastos-Filho, T., and Frizera, A., “An IMU-to-Body Alignment Method Applied to Human Gait Analysis,” Sensors, Vol. 16, No. 12, pp. 2090, 2016.
    10.3390/s16122090
  • 19.
    Choi, M. and Lee, J., “Inertial Sensor-Based Attitude Estimation Combining a Kinematic Constraint for Elimination of Acceleration-Induced Inaccuracy,” Transactions of the Korean Society of Mechanical Engineers. A, Vol. 42, No. 3, pp. 263-269, 2018.
    10.3795/KSME-A.2018.42.3.263
  • 20.
    Choi, M. J. and Lee, J. K., “IMU-Based Attitude Estimation Kalman Filter with Kinematic Constraint Projection,” Journal of Institute of Control, Robotics and Systems, Vol. 24, No. 2, pp. 175-181, 2018.
    10.5302/J.ICROS.2018.17.0204
  • 21.
    Lee, J. K., Park, E. J., and Robinovitch, S. N., “Estimation of Attitude and External Acceleration Using Inertial Sensor Measurement During Various Dynamic Conditions,” IEEE Transactions on Instrumentation and Measurement, Vol. 61, No. 8, pp. 2262-2273, 2012.
    10.1109/TIM.2012.2187245
Jung Keun Lee
KSPE_2019_v36n3_233_bf001.jpg
Professor in the Department of Mechanical Engineering, Hankyong National University. His research interests include inertial-sensing-based human motion tracking, biomechatronics, wearable sensor applications, and system dynamics and control.

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:

Estimation of Vertical Displacement based on Inertial Sensor Signals Combined with Joint Constraint
J. Korean Soc. Precis. Eng.. 2019;36(3):233-238.   Published online March 1, 2019
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:
Estimation of Vertical Displacement based on Inertial Sensor Signals Combined with Joint Constraint
J. Korean Soc. Precis. Eng.. 2019;36(3):233-238.   Published online March 1, 2019
Close

Figure

  • 0
  • 1
Estimation of Vertical Displacement based on Inertial Sensor Signals Combined with Joint Constraint
Image Image
Fig. 1 Test setup
Fig. 2 Estimation results of (a) Test 1, (b) Test 2, and (c) Test 3, from Method A (green line with circle markers), Method B (blue with triangles), Method C (red with diamonds), and Method D (gray)
Estimation of Vertical Displacement based on Inertial Sensor Signals Combined with Joint Constraint
Method A Method B Method C Method D
Test 1 0.58 0.93 17.34 31.65
Test 2 1.86 2.80 31.05 49.86
Test 3 2.56 10.21 24.35 49.54
Method A Method B
Roll Pitch Roll Pitch
Test 1 0.53 0.49 0.71 0.55
Test 2 1.20 1.30 1.80 1.79
Test 3 1.72 1.76 5.73 5.83
Table 1 RMSEs of vertical position estimation (unit: cm)
Table 2 RMSEs of roll/pitch estimation (unit:°)