I nte rna t io na l J o urna l o f   Ro bo t ics a nd   Aut o m a t io n ( I J R A)   Vo l. 9 ,   No . 2 J u n e   2 0 2 0 ,   p p .   1 23 ~ 1 34   I SS N:  2089 - 4 8 5 6 ,   DOI : 1 0 . 1 1 5 9 1 / i j r a . v9 i 2 . pp 1 23 - 1 34     123       J o ur na l ho m ep a g e h ttp : //ij r a . ia esco r e. co m   Co ntrol sy ste m  d esig n of duc clea ning  robo ca pa bl e of  o v erco m ing  L an d T - sha ped  ducts       M y eo ng   I n Seo Wo o   J in   J a n g J un hw a n H a K y o ng t a P a rk Do ng   H w a n K i m   De p a rtme n o f   M e c h a n ica d e sig n   a n d   r o b o e n g in e e ri n g ,   S e o u Na t io n a U n iv .   o f   S c ien c e   a n d   T e c h n o lo g y ,   Ko re a       Art icle  I nfo     AB ST RAC T     A r ticle  his to r y:   R ec eiv ed   Dec   17 ,   2 0 1 9   R ev i s ed   F eb   13 ,   2 0 2 0   A cc ep ted   Mar   4 ,   2 0 20       T h is  stu d y   in tro d u c e th e   c o n tro l   m e th o d   o f   d u c c lea n in g   ro b o t h a e n a b les   re a l - ti m e   p o siti o n   trac k in g   a n d   se lf - d riv in g   o v e L - sh a p e d   a n d   T - sh a p e d   d u c t   se c ti o n s.  T h e   d e v e lo p e d   ro b o h a th re e   leg a n d   is  d e si g n e d   to   f lex ib l y   re sp o n d   to   d u c siz e s.  T h e   p o sit i o n   o f   th e   ro b o t   in si d e   t h e   d u c is   id e n ti f ied   u sin g   th e   UW c o m m u n ica ti o n   m o d u le  a n d   t h e   lo c a ti o n   e sti m a ti o n   a lg o rit h m .   A lt h o u g h   UW c o m m u n ica ti o n   h a re lativ e l y   larg e   d ist a n c e   e rro w it h in   th e   m e tal,   th e   p o siti o n a e rro w a s   re d u c e d   b y   in tro d u c i n g   a p p r o p riate   f il ters   to   e sti m a te  th e   ro b o p o siti o n   a c c u ra tely .   T CP /I P   c o m m u n ica ti o n   a ll o w c o m m a n d to   b e   se n b e tw e e n   th e   P C   a n d   t h e   ro b o t   a n d   t o   r e c e iv e   li v e   im a g e o f   th e   c a m e ra   a tt a c h e d   to   th e   r o b o t.   Us i n g   Ha a r - li k e   a n d   c las si f iers ,   th e   ro b o c a n   re c o g n ize   th e   t y p e   o f   d u c th a is  d if f icu lt   to   o v e rc o m e ,   su c h   a s   L - sh a p e d   a n d   T - sh a p e d   d u c t,   a n d   it   m o v e su c c e ss f u ll y   in sid e   th e   d u c t   a c c o r d in g   to   th e   c o rre sp o n d in g   m o v in g   a lg o rit h m s.   K ey w o r d s :   Au to n o m o u s   Dr iv i n g   Du ct  C lean i n g   R o b o t   I m ag P r o ce s s i n g   L o ca tio n   I d en ti f icat io n   T h is  is  a n   o p e n   a c c e ss   a rticle   u n d e r th e   CC B Y - SA   l ice n se .     C o r r e s p o nd ing   A uth o r :   Do n g   H w a n   Ki m ,   Dep ar t m en t o f   Me ch a n ical  s y s te m   d esi g n   e n g in ee r i n g ,   Seo u l N atio n a l U n i v er s i t y   o f   Scien ce   a n d   T ec h n o lo g y ,   2 3 2   Go n g n eu n g - r o ,   No w o n - g u ,   Seo u l 0 1 8 1 1 ,   Ko r ea .   E m ail: d h k i m @ s eo u ltech . ac . k r       1.   I NT RO D UCT I O N   I n   b u ild in g s   an d   k i tch e n s ,   air   is   s u p p lied   o r   cir cu lated   th r o u g h   d u ct s   w it h   v ar io u s   f ac ilit ie s .   S m o k e   an d   d u s co n tai n ed   in   t h air   p ass i n g   t h r o u g h   t h d u ct  i n   th en clo s ed   s p ac ac cu m u la te  in   th d u cts  a n d   b u ild   u p   m o r in   t h f le x io n s .   T h ese  ca u s in d o o r   air   p o llu tio n   an d   s h o u ld   b clea n ed   r eg u lar l y .   E s p ec iall y ,   in   ca s e   o f   k itc h e n   d u cts,  d u s t a n d   o il st ain   d ep o s its   p r ev e n t c ir cu la ti o n   o r   ca u s f ir ac cid en ts   d u to   h ig h   te m p er at u r e   air .   T h er m al  e f f icie n c y   o f   h e atin g   an d   co o lin g   d u cts  f o r   air   co n d itio n i n g   a n d   h ea tin g   d ec r ea s es  w h e n   d u s t   b u ild s   u p .   D u ct  clea n in g   ar l ar g el y   cla s s i f ied   as  d r y   a n d   wet  [ 1 ]   m et h o d s .   Sin ce   it  is   v ir t u all y   i m p o s s ib le  f o r   h u m a n s   to   clea n   d u cts   t h e m s elv e s ,   t h i n tr o d u ctio n   o f   a   d u ct - clea n in g   r o b o is   r eq u i r ed .   T h s h ap o f     th r o b o t c an   b d eter m i n ed   ac co r d in g   to   th m eth o d   o f   clea n in g   t h d u ct.   Du to   t h n atu r o f   d u ct s ,   es p ec iall y   i n   t h clo s ed   s p ac e,   w ir e - t w i s ti n g   p r o b lem s   o cc u r   w h e n   u s i n g   w ir d r iv en   r o b o t.  T h u s ,   it  i s   n ec es s ar y   to   b u ild   w ir eles s - d r iv e n   r o b o an d   d ev elo p   a   r o b o th at   ca n   m o v e   au to n o m o u s l y   alo n g   t h d u ct s .   A t h s a m ti m e,   th lo c atio n   o f   th r o b o n ee d s   to   b id en tif ied   w h ile   m o v i n g   alo n g   co m p le x   d u ct  s tr u ctu r i n   o r d er   to   m o n i to r   th o p er atio n .   Me an w h ile,   e x i s tin g   d u ct  clea n in g   r o b o ts   [ 2 - 4 ]   a r d if f icu l t to   co p w it h   w h e n   t h d u ct  d ia m e te r s   v ar y   b y   lo ca tio n .   I n   g e n er al,   air   co n d itio n in g   d u cts  ar co n ce aled   an d   in s t alled   in s id th ce i lin g .   A s   th s h ap   an d   d i m e n s io n s   o f   t h air   c o n d itio n er   f r o m   t h f ac ilit y   t o   th i n let  a n d   o u tle o f   ea c h   c h a m b er   c h an g e ,     th f le x io n s   ar f o r m ed ,   an d   th s u cc ess f u p ass i n g   th ese  f lex io n s   f o r   th r o b o s h o u ld   b ca r r ied   o u ev en   w it h   f le x io n s .   T y p ical  f le x io n   is   eith er   L   o r   T - s h ap ed   an d   th r o b o s h o u ld   b ab le  t o   p ass   th r o u g h   t h is     n o n - u n i f o r m   s h ap ed   d u cts.   Evaluation Warning : The document was created with Spire.PDF for Python.
              I SS N : 2 0 8 9 - 4856   I n J   R o b   &   A u to m Vo l.  9 ,   No .   2 J u n 2 0 2 0   :   1 23     1 34   124   T h d u ct - clea n i n g   r o b o in tr o d u ce d   in   th is   w o r k   i s   s i m ilar   t o   th e x i s ti n g   d u ct - clea n in g   r o b o [ 5 - 6 ] ,   b u it  i s   d esi g n ed   w i th   t h r ee - le g g ed   ( it  lo o k s   li k t h r ee   tr a ck s   i n   ap p ea r an ce )   r o b o th at  i s   m o r s u itab le  f o r   cir cu lar   d u ct s ,   th er eb y   allo win g   s tab le  m o v e m e n o n   th e   w al ls   i n s i d th c u r v ed   d u cts.  I ca n   a ls o   b w ir ele s s l y   o p er ated   to   p r ev e n t   w ir t w i s ti n g ,   w h ic h   o cc u r s   f r eq u en tl y   i n s id lo n g   a n d   w i n d in g   d u ct s .   U n li k e   co n v e n tio n al   d u ct - clea n in g   r o b o ts ,   it  is   d esi g n ed   to   p r o ce ed   au to n o m o u s l y   u s i n g   P SD  ( P o s itio n   Sen s iti v Dev ice)   s e n s o r s   an d   ca m er as  w it h o u b ein g   m a n ip u lated   b y   u s er s .   T h P SD  s en s o r   m ea s u r es  th d i s tan ce   to   ed g es  o f   L   o r   T - s h ap ed   d u ct   an d   th ca m er is   u s ed   to   d is ti n g u is h   b et w ee n   t h L   a n d   T - s h ap ed   d u ct  f o r     s elf - d r iv i n g .   T h u s er   j u s t c o n tr o ls   th s tar t b u tto n   an d   t h s t o p   b u tto n   an d   v ie w s   th i m a g e s   in s id t h d u ct  to   ch ec k   t h r o b o t' s   c u r r en lo ca tio n   an d   clea n in g   s tat u s .   I m ag es  o f   th d u c in s id th e n cl o s ed   s p ac ar s en w ir ele s s l y   to   th u s er 's  P C   v i W if th r o u g h   t h e m b ed d ed   P C ,   R asp b er r y   P i.  I n   th is   s t u d y ,   UW B   m o d u les   w er in s talled   o n   th o u ts id o f   th d u ct  to   esti m ate  th cu r r en p o s itio n   o f   th r o b o in   th d u ct  an d     th co r r ec id en tif icat io n   o f   T - s h ap ed   d u ct  u s i n g   th cla s s if ier   al g o r ith m   b ased   o n   th e   ac q u ir ed   im a g es  to   en ab le  au to n o m o u s   d r iv i n g   i s   p er f o r m ed .       2.   SYST E M   CO NF I G URA T I O AND  I NT E RF AC E   W h en   t h p u lle y   r ad iu s   is       an d   th a n g u lar   v e lo cit y   o f   ea ch   m o to r   f o r   d r iv in g   t h leg   is                         ,   th r o b o ce n ter   tr av el  v elo cit y         ca n   b o b tain ed   as  th p r o d u ct  o f   th p u lle y   r ad iu s   an d     th an g u lar   v elo cit y .   U s in g   th ese  v ar iab les,  th r o b o ce n ter   v elo cit y   ca n   b d eter m i n ed   ac co r d in g   to   th ea ch   ca s s u c h   as  th r ee   w h ee ls   ar at  th s a m s p ee d ,   o n w h ee s to p s   an d   th o th er   t w o   w h e els  d r iv e,   o n l y   o n e   w h ee i s   d r iv e n ,   a n d   th r ee   w h ee s p ee d s   ar d if f er en t.   On ce   t h t h r ee   w h ee ls   ar at  th s a m s p ee d ,     th v elo c it y   o f   th r o b o is                         .   I n   ca s o f   d if f er en t   v elo cit y   o n   th r ee   leg s ,   t h v elo cit y   o f     th ce n tr al  b o d y   is   e x p r ess ed   a s   v elo cit y   g r ad ien t see n   f r o m   t h p ip elin s id as  s h o w n   in   F ig u r 1 .   T h u s ,   th r o b o b o d y   v elo cit y   is   d eter m in ed   b y   t h av er a g o f   an g u lar   v elo cities  f r o m   t h r ee   m o to r s .   Fig u r 2   s h o w s   t h ap p ea r an c o f   t h m a n u f ac tu r ed   d u c cl ea n in g   r o b o t.  T h f r o n o f   t h e   r o b o is   eq u ip p ed   w it h   ca m er w h ile   t h r ea r   is   eq u ip p ed   w i th   b r u s h   f o r   d u s ti n g .   T h r o b o is   d r iv e n   b y   t h u s er 's  s tar ti n g   s ig n al   f r o m   t h P C ,   w h ich   is   s e n to   th e   m icr o   co n tr o ller   A r d u i n o   f r o m   t h R asp b er r y   P th r o u g h   T C P /I co m m u n icatio n .   T h P SD  s e n s o r   co n n ec ted   to   th e   A r d u i n o   m ea s u r es  t h e   d ia m eter   o f   th e   d u ct,   w h ich   is   i m p o r tan t i n f o r m atio n   f o r   au to n o m o u s   d r iv i n g   i n   th d u ct.   I n   ad d itio n ,   th ca m er co n n ec te d   to   th R asp b er r y   P co n tin u o u s l y   ca p tu r es  i m a g es  i n s id t h d u ct  a n d   s en d s   th r es u lt s   to   th P C .   A t h is   ti m e,   t h L   an d     T - s h ap ed   s tr u ct u r es  in s id d u ct  th at  ar d if f icu l to   d etec o n l y   b y   P SD  s e n s o r s   ar d is t in g u i s h ed   t h r o u g h     th ca m er a ' s   i m a g p r o ce s s in g   tec h n o lo g ies,  a n d   t h co r r esp o n d in g   m o v e m e n ts   o f   t h r o b o ac co r d in g   t o     th r ec o g n ized   d u ct   s tr u ctu r ar in tr o d u ce d   to   h elp   a u to n o m o u s   d r iv i n g   o f   th e   r o b o t.  User s   ca n   co n ti n u to   o b s er v th in s id o f   t h d u ct  b y   p r es s in g   t h s tar t b u tto n   o f   th P C .   I n   o r d er   to   k n o w   th ex ac lo ca tio n   o f   th r o b o in s id t h d u ct,   UW B   an ch o r s   in s tal led   o n   th e   o u ts id o f   t h d u ct  an d   UW B   tag   o n   th r o b o b o d y   ar u s ed .   T h d is tan ce   v alu e s   b et wee n   an c h o r s   an d   tag   ar tr an s m it ted   b y   B lu eto o t h   co m m u n ica tio n   to   th P C   an d   th lo ca tio n   o f   th r o b o is   esti m ated   b y   th e   tr ilater atio n   alg o r it h m   o n   th P C .     T h er ar th r ee   m ain   ca teg o r ies  o f   co n tr o l   s y s te m   d ev elo p ed   in   th i s   w o r k .   A   UW B   m o d u le  f o r   esti m ati n g   th r o b o t's   r ea l - ti m p o s itio n ,   an   A r d u i n o   Me g ab o ar d   f o r   co n tr o llin g   th r o b o t,  an d   R a s p b er r y   P i   Z er o   f o r   tr an s m itti n g   i m ag e s   v ia  P C   a n d   T C P /I P   co m m u n i ca tio n   to   co n tr o t h r o b o r e m o tel y .   Fi g u r 3   i s     th o v er all  co n tr o s y s te m   co n f ig u r atio n   o f   th e   r o b o u s ed   in   t h r o b o s y s te m .   A r d u i n o   c o n tr o ls   t h m o to r   an d   L E D   li g h t s   f o r   r o b o d r iv in g   a n d   r ec eiv e s   t h v alu e s   f r o m   t h P SD  s e n s o r s .   T h UW B   m o d u le  tr an s m its   th d is tan ce   v alu e s   to   th P C   v ia  B lu eto o th   co m m u n icat io n .   R asp b er r y   P tr an s m it s   im ag e s   ca p tu r ed   b y     th ca m er m o u n ted   o n   th r o b o to   th P C   v ia  T C P /I co m m u n icat io n   an d   also   s en d s   co m m an d   s i g n a ls   f r o m   th P C   to   A r d u in o .                                                              ( 1 )               Fig u r 1 .   Velo cit y   p r o le  at  t h s id v ie w   o f   t h p ip elin e.   Evaluation Warning : The document was created with Spire.PDF for Python.
I n J   R o b   &   A u to m   I SS N:  2089 - 4856       C o n tr o l sys tem  d esig n   o f d u ct  clea n in g   r o b o t c a p a b le  o o ve r co min g   L a n d   T - sh a p ed   d u cts   ( Myeo n g   I n   S e o )   125     ( a)       ( b )       ( c)       ( d )     Fig u r 2 ( a)   Ov er all  v ie w   o f   d u ct   clea n in g   r o b o t,  ( b )   ass e m b led   r o b o t ,   ( c)   an d   p ictu r e   o f   r o b o t r u n n i n g   in   d u ct,   ( d )   d r a w i n g s   o f   d u ct  clea n in g   r o b o t           Fig u r 3 .   C o n tr o l s y s te m   s tr u c tu r e       2 . 1 .   UWB   m o d ule c o nfig ura t io n   As  m e n tio n ed   ea r lier ,   UW B   co m m u n ica tio n   i s   u s ed   f o r   in d o o r   lo ca tio n   m ea s u r e m en t,  an d     th DW M1 0 0 0   [ 7 ]   u s ed   f o r   co m m u n icatio n   is   C MO S c h ip   f o r   m ea s u r i n g   p r ec is d is ta n ce s   w ith   a n   ac c u r ac y   o f   1 0 cm .   T h A r d u i n o   P r o   Min i s   ad o p ted   to   o p er ate  t h UW B   m o d u le.   On ta g   o n   th r o b o an d   f o u r   an ch o r s   o u t s id th d u ct  ar p lace d ,   as  s h o w n   i n   Fig u r 4 ,   an d   th P C B   ( P r in ted   C ir cu it  B o ar d )   is   u s ed   to   r ed u ce   th s ize  o f   a n ch o r   an d   tag   m o d u le  s o   t h at  t h e y   ca n   b p lace d   in s id th r o b o t.  B lu eto o th   m o d u le s   ar also   attac h ed   to   th P C   to   r ec eiv d is ta n ce   v al u es  f r o m   UW B   m o d u le s   w ir eles s l y .             Fig u r 4 .   UW B   m o d u les p lace m en t f o r   p o s itio n i n g   in   d u c t e n v ir o n m e n t   Evaluation Warning : The document was created with Spire.PDF for Python.
              I SS N : 2 0 8 9 - 4856   I n J   R o b   &   A u to m Vo l.  9 ,   No .   2 J u n 2 0 2 0   :   1 23     1 34   126   2 . 2 .   Co ntr o ller  co nfig ura t io n   I n   th i s   w o r k ,   th A T m e g a2 5 6 0   b ased   A r d u in o   Me g w a s   u s ed   to   ac q u ir th v alu e s   o f   t h e   n in P SD  s en s o r s   w h ic h   ar u s ed   to   id en ti f y   t h i n ter n al  s h ap o f   t h e   d u ct.   T o   s i m p lify   t h cir cu it,   P C B   co m p atib le  w it h   t h A r d u in o   Me g w as  cr ea ted .   On DC   m o to r   f o r   ea ch   w h ee an d   t w o   s m a ller   DC   m o to r s   f o r   w ir e   co n tr o w er co n n ec ted   to   th DC   m o to r   d r iv er s .       2 . 3 .   I nfr a re d sen s o r   As  s ta ted   ea r lier ,   P SD  s e n s o r s   ar u s ed   to   id en ti f y   t h s tr u ct u r in s id th e   d u ct  w h ic h   i s   c r u cial  f o r   an   a u to n o m o u s   d r iv i n g   o f   t h r o b o t.  T h in f r ar ed   s e n s o r s   w i th   r a n g e   o f   2 c m   to   1 5 c m   ca n   b u s ed   to   d etec t   s tr u ct u r al  ch a n g es  in s id th e   d u ct  w h ile  t h r o b o i s   d r iv in g .   T h Kal m a n   f ilter   ca n   b u s ed   to   m o r e   ef f ec tiv e l y   h a n d le  th a n alo g   v alu e s   r ec ei v ed   th r o u g h   th i n f r ar ed   s e n s o r ,   s i n ce   t h s e n s o r ' s   s ig n al  it s el f   is   p ar tly   ab s o r b ed   in to   t h d u ct  i n ter n al  m etal  p ar ts ,   p o ten tiall y   d is to r tin g   t h s e n s o r   v a lu e s .   T h Kal m an   f ilter   eq u atio n s   u s ed   h er ar as f o ll o w s .                                                     ( 2 )       ̂                                                 ( 3 )                                                     ( 4 )     w h er           is   th Kal m an   g ai n ,         is   th er r o r   co v ar ian ce ,         is   th p r o ce s s   n o i s v ar ia n ce ,   an d         is     th m ea s u r e m e n n o is v ar ian ce .         is   th m ea s u r ed   s tate  v ar iab le  an d         is   th esti m ated   s t ate  v ar iab le  at    k - th   s tep ,   r esp ec tiv el y .     B ased   o n   th ab o v eq u atio n s   ( 2 - 4 ) ,   w ap p lied   th p r o p o s ed   Kal m an   f ilter   to   th m icr o   co n tr o ller .   I n   Fi g u r 4 ,   th e   o u t p u d ata  b ef o r an d   a f ter   t h f il ter   p ass es  f o r   th in f r ar ed   s e n s o r   s i g n al  w er co m p ar ed .   T h b lu lin s h o w s   t h v alu e   o f   th d ata  b ef o r g o i n g   th r o u g h   t h f ilter ,   an d   t h r ed   lin e   s h o w s   t h v al u o f   th d ata  co m i n g   t h r o u g h   th f ilter .   I n   th is   ca s e,       =0 . 2 5 ,       =0 . 0 1 ,       =0 . 0 9   w er u s ed   an d       =1 . 0   w a s   u s ed   as  in i tial  v a lu e.   T h ex p er i m e n tal  r es u lt s   co n f ir m ed   t h at  t h v alu th at  ca m f r o m   t h Kal m an   f i lter   w as  m o r e   s tab le  th a n   o r ig i n al  s i g n al   ( Fig u r 5 ) .           Fig u r 5 .   Dis tan ce   d ata  co m p a r is o n   u s in g   Kal m a n   f ilter   (x - a x is   : ti m [ m s ] ,   y - a x is   : D i s ta n ce   [ cm ] )       3.   DIS T ANC E   M E ASURE M E NT   US I N G   UWB   CO M M U NICA T I O N   3 . 1 .   UWB   co m m u nica t io n   UW B   ( Ultr W id B an d )   c o m m u n icatio n   i s   w ir eles s   co m m u n icatio n   tec h n o lo g y   th at  ca n   g u ar a n tee  tr a n s m is s io n   d i s tan ce   o f   1 0 m   to   1 k m   o v er   w id e   f r eq u e n c y   r a n g f r o m   3 . 1   GH to   1 0 . 6   GHz ,   an d   h as  b ee n   d e v elo p ed   an d   ap p lied   f o r   s p ec ial  p u r p o s es  b y   th m ilit ar y ,   b u h as  r ec en tl y   g ain ed   atten tio n   as  it   o p en ed   to   th p r iv ate  s ec to r .   UW B ,   w h ic h   tr an s m it s   lar g a m o u n ts   o f   in f o r m atio n   at  lo w   p o w er ,   is   n e tech n o lo g y   w it h   a   v er y   w id ap p licatio n   r a n g e,   in cl u d i n g   i n d o o r   o b s er v atio n ,   s p o r ts   tr ac k i n g ,   i n tr u d er   d etec tio n   s y s te m ,   a n d   p r ev en tio n   o f   h ea v y   eq u ip m e n t   v eh icle  ac cid en t s .   I n   th i s   s tu d y ,   th UW B   co m m u n icatio n   a n d   R ea l - T im L o ca tin g   S y s te m s   ( R T L S )   w er ap p lied   to   im p le m en s y s te m   t h at  co u ld   Evaluation Warning : The document was created with Spire.PDF for Python.
I n J   R o b   &   A u to m   I SS N:  2089 - 4856       C o n tr o l sys tem  d esig n   o f d u ct  clea n in g   r o b o t c a p a b le  o o ve r co min g   L a n d   T - sh a p ed   d u cts   ( Myeo n g   I n   S e o )   127   au to m at icall y   id en ti f y   an d   tr ac k   t h p o s it io n   o f   o b j ec ts .   T h co m m u n icat io n   m o d u l es  u s ed   f o r   UW B   co m m u n icatio n   ar DW M1 0 0 0   f r o m   DE C A W A VE   a n d   T im o f   Fli g h ( T OF)   m e th o d   f o r   d is ta n ce   m ea s u r e m e n t   i s   m ai n   p r in cip le  o f   th s e n s o r .   Fig u r 6   is   r ep r esen tatio n   o f   t h T OF - t y p d i s ta n ce   m ea s u r e m e n p r o ce d u r e,   w h ic h   i s   ch ar ac ter ized   b y   DS - T W R   ( Do u b le - s id ed   T w o   W a y   R an g in g )   [ 8 ]   ex te n d in g   th m ea s u r e m en r a n g o f     SS - T W R   ( Sin g le  Sid ed   T w o   W ay   R an g i n g ) ,   i n   w h ic h   t w o   r o u n d - tr ip   ti m m ea s u r e m e n ts   ar u s ed   to   o b tain   th T OF  r es u lt s .   E r r o r s   ar r ed u ce d   d esp ite  s ig n i f ica n tl y   l o n g   r e s p o n s e   d ela y s   a n d   t h e   T OF  is   3 3 3   n s   in     th r elati v el y   lar g UW B   o p er atin g   r an g o f   1 0 0   m .           Fig u r 6 .   Seq u en ce   o f   T W R   u s in g   T O F       3 . 2 .   E s t i m a t ing   t he  lo ca t io n o f   t h ro bo t   by   t rila t er a t io n m ea s ure m ent   T o   id en tify   t h p o s itio n   o f   t h r o b o in s id th d u ct,   tr ila ter atio n   m e th o d   w as   ap p lied   to   esti m a te   th ce n ter   p o s itio n   o f   th r o b o w h ile  it  m o v e s   ar o u n d   u s in g   an ch o r s   t h at  ar p lace d   o u ts id th d u ct  an d   tag   o n   th r o b o b o d y .   Her e,   th g r ad ien d ec en m et h o d   is   ap p lied   to   r ed u ce   th er r o r   b etw ee n   t h ac tu al  a n d     th e s ti m ated   v alu e s   f o r   t h e   r o b o lo ca tio n .   Fi g u r 7   s h o w s   th e   b asic  e n v ir o n m en t   f o r   ap p l y i n g   t h e   tr ilater atio n   m e t h o d   to   o b tain   th r o b o t' s   ce n tr al  p o s itio n   ( x,   y ) ,   u s in g   t h d is ta n ce   v al u es  f r o m   f o u r   an c h o r s   an d   o n tag .   T h tr u v al u o f   th ce n ter   p o s itio n   o f   t h r o b o t is co n s tr u cted   b y   th f o llo w i n g   f o r m u la.                                                                 ( 5 )     w h er     is   th n u m b er   o f   an c h o r s ,   an d         is   m ea s u r ed   d is ta n ce   b et w ee n   t h an c h o r       an d   tag .   Nex t,        w h ic h   is   th es ti m ated   d is tan ce   to   t h e   r o b o t f r o m   an c h o r       is   ex p r ess ed   as f o llo w .                                             ( 6 )     E r r o r   b et w ee n   t h ac t u al  v al u e   an d   th esti m ated   v alu b et wee n   an c h o r       an d   tag   is                   ,   an d   th co s t f u n ctio n       th at  m i n i m iz es th er r o r   at  ea ch   s tep   ca n   b d ef in ed   as ;                                     (7 )     B y   u s i n g   th g r ad ien d esce n m et h o d ,   th r o b o t' s   ce n tr al  p o s itio n   is   u p d ated   in   ea ch   s tep   as   f o llo w s .                                      [         ]                 (8 )     T h f in al  u p d ate  la w   f o r   th es ti m ated   2 lo ca tio n   is   d eter m i n ed   in   ( 9 ) .     [                 ]   [         ]     [                                                                                         ]   ( 9 )   Evaluation Warning : The document was created with Spire.PDF for Python.
              I SS N : 2 0 8 9 - 4856   I n J   R o b   &   A u to m Vo l.  9 ,   No .   2 J u n 2 0 2 0   :   1 23     1 34   128   As  s h o w n   i n   ( 9 )   is   an   eq u ati o n   d eter m i n ed   b y   th g r ad ien d escen m et h o d   th at  ca lc u la tes  s p atial   co o r d in ates  t h at  m i n i m ize  th e   d is tan ce   er r o r   b etw ee n   th a n ch o r s   an d   th ta g .               th n ex p o in to   m o v e   f r o m   th c u r r en co o r d in ate  v alu       is   ca lcu lated ,   an d       is   p ar a m eter   th at  co n tr o ls   t h u p d ate  s p ee d .   W h en   UW B   m o d u le s   ar u s ed   in   d u ct  m ad o f   m e tal  in   p ar t,  lo ca tio n   er r o r s   o cc u r   d u to   th f ac th at  t h w av e s   d o   n o t p en etr ate  th e   m e tal  p ar t s   w ell   b u t   r ef lect   t h e m   [ 9 ] .   T o   o v er co m t h is ,   th e   f o llo w in g   m et h o d s   h a v e   b ee n   tr ied .   W ap p lied   g en er al  s ig n a f ilter s   to   i n co m in g   d a ta  v al u es,   ad d ed   th n u m b e r   o f   a n ch o r s ,   a n d   s u p p le m e n ted   t h s h o r tco m in g s   o f   t h g r ad ien t d esce n t   m et h o d .   T h d is ad v an ta g o f   g r ad ien t d esce n m et h o d   is   th at  it  d o es  n o escap th ze r o   s lo p w ell  an d   co n v er g e n ce   is   s lo w .   T o   s o lv th is   p r o b l e m ,   th co m m o n l y   u s ed   m eth o d   is   to   ap p l y   t h e   s to ch ast ic  g r ad ie n d ec en w it h   m o m e n t u m   m eth o d   [ 1 0 ] .   I n   o th er   w o r d s ,     th s p ee d   co n s ta n is   co r r ec ted   to   r ea ch   th m i n i m u m   v alu f aster   an d   t h in f lect io n   p o in ca n   b s m o o th l y   p ass ed   o v er   d u to   th m o m en tu m .                               ( 1 0 )                           ( 1 1 )     I n   ( 1 0 ) ,         r ep r esen ts   v elo cit y   at   k - th   s tep ,   an d   η   r ep r esen ts   d ec ay i n g   r ate.   I n   th is   ca s e,   η =0 . 9 ,   an d       =0 . 9 5   is   u s ed   r esp ec tiv el y ,   w h ic h   s h o w ed   th at  co n v er g e n ce   w as  ab o u t   1 0   ti m es   f a s t er   th an   b e f o r e.   I n   ad d itio n ,   th v al u o f         is   v a r iab le  to   w h ic h   t h g r ad ien d escen m et h o d   is   ap p lied ,   th at  is ,   co o r d in ate   v alu u p d ated   b y   s u b s titu tin g   th x   co o r d in ate  o r   th y   c o o r d in ate  o b tain ed   th r o u g h   th g r ad ien d ec en w i th   m o m e n t u m   m et h o d   ca n   b o b tain ed .   Fig u r 8   s h o w s   t h r es u lt s   o f   ex p er i m e n ts   ca r r ied   o u in   m e ta d u cts.  T h r ed   cir cles  i n   F i g u r e   7   ar e   th r esu l ts   o f   th co n v e n tio n a g r ad ien d escen m eth o d   an d   th b lu cir cles  ar th r es u lts   o f   t h g r ad ien t   d escen m e th o d   co n s id er in g   t h ac ce ler atio n .   I ca n   b s ee n   t h at  t h er r o r   is   r ed u ce d   an d   clo s er   to   th ac tu al   p o s itio n s   b y   e m p lo y i n g   th g r ad ien d ec en w i th   m o m en tu m   m et h o d   th a n   t h g r ad ie n d ec en m et h o d .     T h ac tu al   er r o r s   ar u p   to   a b o u 3 0   c m   f o r   b o th   m et h o d s ,   w h ich   ar r eliab le   to   b a d o p ted   to   lo ca tio n   esti m atio n   i n s id d u ct s .           Fig u r 7 .   Dis tan ce s   b et w ee n   f o u r   an ch o r s   a n d   o n tag       Fig u r 8 .   E x p er i m en tal  r esu lts   o f   g r ad ien   d escen m eth o d   an d   co n s id er in g   ac ce ler atio n       4.   O P E RAT I O SO F T WAR E   DE S I G N   4 . 1 .   Aut o no m o u s   driv ing   T h r o b o t b asically   m o v es  f o r w ar d   t h r o u g h   t h r ee   m o to r s .   W h en   th e   P C   g iv e s   co m m a n d s   t o   th r o b o t   th r o u g h   T C P   I T   co m m u n ic atio n ,   t h r o b o m o v es   o r   s to p s .   W h en   th r o b o s tar t s   to   m o v e,   t h L E D   an d     th b r u s h   m o to r   s tar to   w o r k   to g eth er ,   an d   at  th s a m ti m e,   th in ter n a s h ap o f   t h d u ct   is   r ec o g n ized   b y   th d is ta n ce   i n f o r m atio n   o f   t h i n f r ar ed   s e n s o r s   attac h ed   to   th f r o n an d   b ac k   o f   t h r o b o as  s h o w n   i n     Fig u r e   9 .   I n f r ar ed   s en s o r   v alu es  u s u all y   co m o u w it h   co n s ta n v alu w h e n   th r o b o m o v es  alo n g   s tr ai g h t   d u ct.   W h en   th c u r v ed   s e ctio n   is   f o u n d ,   th v al u es  f r o m   t h in f r ar ed   s en s o r s   ch an g e.   T h r o u g h   t h ese  v alu e s ,     th r o b o t c an   b a u to m a ticall y   r o tated   ac co r d in g   to   t h le f t a n d   r ig h f le x io n   w h ich   is   ca lle d   L - s h ap ed   d u ct,   o r   t w o - w a y   p at h ,   ca lled   T - s h ap ed   d u ct  as  s h o w n   i n   Fi g u r 10 .   T h p r ec is s ch e m e s   f o r   p ass i n g   t h r o u g h   L   o r     T - s h ap ed   d u ct  w ill b ex p lai n ed   in   th later   s ec tio n .     Evaluation Warning : The document was created with Spire.PDF for Python.
I n J   R o b   &   A u to m   I SS N:  2089 - 4856       C o n tr o l sys tem  d esig n   o f d u ct  clea n in g   r o b o t c a p a b le  o o ve r co min g   L a n d   T - sh a p ed   d u cts   ( Myeo n g   I n   S e o )   129         Fig u r 9 .   I R   Sen s o r s   p lace m e n t in   r o b o t       F ig u r 10 .   R o b o t a u to n o m o u s   d r iv in g   alg o r it h m   u s in g   I R   s en s o r s   o n l y       4 . 2 .   L ef t   a nd   rig ht  driv ing   in t he  L - s ha ped  du ct     W h en   t h r o b o m ee ts   th c u r v ed   s ec tio n ,   it  o p er ates  in   th o r d er   as  s h o w n   i n   F ig u r 1 1 .   First,  ch ec k   th lef an d   r ig h s id es  t h r o u g h   th i n f r ar ed   s en s o r .   W h en   th r o b o en co u n ter s   cu r v ed   s e ctio n   w h ile  m o v i n g   f o r w ar d ,   o n o f   t h t w o   s en s o r s   h as  d is ta n ce   o f   m o r t h an   ce r tai n   d is ta n ce   ( h er e,   1 2 . 5 cm )   as  s h o w n   i n   Fig u r 10 ,   m ak in g   t h r o b o d etec e m p t y   s p ac e.   T h en ,   t h r o b o s to p s   th w h ee th a b ec o m es  t h p i v o ax i s   an d   m o v e s   th r est  o f   th w h ee s o   th at  it  ca n   t u r n   w i th o u t   h ea v y   r esis ta n ce   i n s id t h d u ct.   A f ter   th r o b o t   tu r n s ,   if   th v al u o f   o n in f r ar ed   s en s o r   is   less   th a n   ab o u t   th p r eset  d is tan ce   ( h er e,   f o r   in s ta n ce   1 2 . 5 cm ) ,     th r o b o w ill  s tar m o v i n g   f o r w ar d   ag ai n .   I n   t h is   w a y ,   th e   lef a n d   r i g h t   d r iv i n   t h L - s h ap ed   d u ct  ca n   b e   a u to m at icall y   ca r r ied   o u t.           Fig u r 1 1 .   Seq u en ce   o f   L - s h a p ed   d u ct  r u n n i n g       4 . 3 .   O v er co m ing   T - s ha ped d uct   w it h T i m er s   I n   t h T - s h ap ed   d u ct,   th e   r o b o ca n   m o v f o r w ar d ,   le f t   an d   r ig h t.  I n   o r d er   f o r   th e   r o b o to   t u r n   in     th T - s h ap ed   d u ct,   it  m u s b tu r n e d   i n   d if f er en w a y   th a n   th L - s h ap ed   d u ct  m o v e m en t   m en t io n ed   ea r lier .   W h en   t u r n i n g   o n   T - s h ap ed   d u ct,   th w h ee b o d y   w ill  u n f o ld   d u to   th r o b o t' s   s p r in g   s tr u ctu r i n   t h o p en   s p ac e.   I n   o th er   w o r d s ,   b ec au s o n s id is   o p en   an d   th w h ee ca n n o r ea ch   t h w all  a n d   th r o b o t' s   w h ee ls   ca n   g et  s tu c k .   T h er ef o r e,   f o r   th is   p u r p o s e,   th r o b o m u s b co n tr o lled   to   escap th s ec tio n   b y   g i v i n g   it    r ev er s t u r n .   I n   ca s o f   u s i n g   i n f r ar ed   s en s o r s   f o r   s el f - d r i v in g ,   as  s h o w n   in   Fi g u r 1 2 ,   wh en   th e   r o b o m ee ts   T - s h ap ed   d u ct  it  ca n   d etec t   s id e m p t y   s p ac e,   j u s li k e   th L - s h ap ed   d u ct,   b u n o f r o n e m p t y   s p ac e.   T h er ef o r e,   in f r ar ed   s en s o r s   alo n ca u s th r o b o to   m o v e   in   th s a m w a y   a s   L - s h ap e d   d u ct,   w h ic h   lets     th r o b o g et  s tu c k   i n   t h b o tto m   o f   t h T - s h ap e d   d u ct.   T o   s o lv t h i s   p r o b lem ,   th ac c u r ate  r ec o g n itio n   o f     th T - s h ap ed   d u ct  s h o u ld   b estab lis h ed .   I f   T - s h ap ed   d u ct  is   d etec ted   th r o u g h   i m a g p r o ce s s in g   w i th o u t     th u s o f   d is tan ce   s en s o r s ,   th r o b o r ec o g n izes  t h at  t h er i s   T - s h ap ed   d u ct  i n   f r o n t.  T h d etail  alg o r ith m   to   f i n d   th T - s h ap d u ct  b y   i m a g p r o ce s s in g   i s   ex p lai n ed   in   t h f o llo w in g   s ec tio n .     W h en   a n   in f r ar ed   s e n s o r   d et ec ts   e m p t y   s p ac e,   T 1   ti m er   in s id e   MCU   s tar t s .   An d   w h i le  d r iv i n g     th g ea r ed   m o to r ,   t h w ir e   is   w o u n d   to   clo s th e   f r o n o f   th e   th r ee   leg s .   T h r o b o m o v es  f o r w ar d   u n til     th ti m er   r ea ch e s   p r ed eter m in ed   ti m e.   A th i s   ti m e,   t h T 2   ti m er   ( Fi g u r 1 2 )   s tar ts ,   r o tatin g   t h w h ee o n     th ax i s   o f   tu r n   r ev er s el y ,   as  s h o w n   i n   ( 4 ) .   W h en   th T 2   tim er   r ea ch es  p r eset  ti m e,   th e   T 3   tim er   s t ar ts   an d   r o tates  th e   r o b o t' s   to p   w h ee l   i n   r ev er s o r d er   to   tu r n   t h r o b o t.  W h en   t h T 3   ti m er   r ea ch es  p r ed eter m i n ed   ti m e,   all  th w h ee ls   o f   t h r o b o m o v f o r w ar d   an d   s tar ts   s elf - d r iv in g   ag ai n   o n   s tr ai g h s ec tio n .   T h r o u g h     Evaluation Warning : The document was created with Spire.PDF for Python.
              I SS N : 2 0 8 9 - 4856   I n J   R o b   &   A u to m Vo l.  9 ,   No .   2 J u n 2 0 2 0   :   1 23     1 34   130   th e x p er i m e n ts ,   th ti m es  o f   ea ch   ti m er   w a s   f o u n d   to   b ab o u 4 . 8   s ec o n d s ,   6 . 4   s ec o n d s   a n d   8   s ec o n d s   r esp ec tiv el y ,   an d   it  w as  p r o v ed   th r o b o co u ld   au to m at ic all y   o v er co m t h T - s h ap ed   d u ct  s u cc es s f u ll y .   B ased   o n   th ex p er i m en ta r esu lts ,   t h s etti n g   ti m e s   o f   th ti m er s   ca n   b ad j u s ted   ac co r d in g   to   th co n d itio n s   o f   th d u ct.           Fig u r 1 2 .   Seq u en ce   o f   T - s h a p ed   d u ct  r u n n i n g   u s i n g   ti m er s       4 . 4 .   Self - driv ing   in T - s ha ped d uc t   us ing   i m a g pro ce s s ing   As  m e n tio n ed   ea r lier ,   th d u ct   t y p es  t h at  r o b o n ee d s   to   o v e r co m ar L - s h ap ed   d u cts  a n d   T - s h ap ed   d u cts,  w h ic h   ar d if f er en in   th d r iv in g   co n tr o m et h o d   to   o v er co m th t w o   t y p es.  T h er ef o r e,   th r o b o t's   u lti m ate  g o al  is   to   ac cu r atel y   r ec o g n ize  an d   p r o p er ly   o v er co m t h f le x io n s .   T h u s o f   d is ta n ce   s e n s o r s   alo n m a y   r es u lt  i n   s i g n i f ica n er r o r s   d u to   m i s p er ce p tio n   at  th f le x io n ,   r esu lt in g   i n   th w r o n g   ch o ice  o f   h o w   to   o v er co m t h s h ap e,   w h ic h   m a y   ca u s it  to   f all   i n t o   ce r tain   s ec tio n s   o r   b ec o m s tu c k   t h er e.   I f   i m a g e   in f o r m atio n   t h r o u g h   ca m er is   s u p p le m e n ted   w it h   id en tif icat io n   alg o r it h m s ,   it  is   ce r tain l y   h elp f u f o r     th r o b o to   ac cu r atel y   r ec o g n ize  th f le x io n   w h eth er   it  is   L   o r   T - s h ap ed   an d   to   ch o o s t h r ig h m et h o d   to   o v er co m th d u c t sh ap e.   I f   th i m a g i n f o r m atio n   i s   u s ed ,   th s h ap es  o f   t h t w o   d u cts  w i ll  b d is ti n g u i s h ed   as   s h o w n   i Fig u r 1 3 .   Dis tan ce   s en s o r   v a lu es  ca n   b s i m ilar   f o r   b o th   s h ap es,  an d   in   f ac t,  th r ee   w h ee ls   to u ch   t h w al i n   th L - d u ct,   b u i n   t h T - d u c t,  o n w h ee m u s b r u n   w it h o u to u c h in g   th w all.   D u to   th p r o b lem   o f   w h ee l   an d   n o t b ein g   ab le  to   o p er ate,   ad d it io n al  w ir m o to r   w a s   to   b u s ed   as s h o w n   i n   F i g u r 1 4 .         ( a)     ( b )     ( a)     ( b )     Fig u r 1 3 .   I m a g d if f er en ce   b et w ee n   ( a)   L - s h ap ed   an d   ( b )   T - s h ap ed   d u ct     Fig u r 1 4 .   R o b o t w ir e   attac h m en t d r a w i n g   an d   p ictu r e,   ( a)   w ir an d   w ir e - d r i v in g   m o to r ,   ( b )   s h ap o f   c lo s ed   f r o n t p ar t o f   r o b o t       T h er ar s ix   w ir e s ,   t w o   f o r   e ac h   le g .   T h ese  w ir e s   ar u s ed   to   f o ld   t h f r o n t   an d   r ea r   p ar ts   o f   le g   w h e n   m o v i n g   in   T   o r   L   s h ap ed   d u ct.   B ef o r th r o b o en ter s   t h d u ct,   t h g ea r ed   m o t o r s   ar ac tiv ated   to   f o ld   th le g s   b y   w i n d in g   t h e   w ir e s .   I n   o r d er   to   d is tin g u i s h   L - s h ap ed   d u ct  f r o m   T - s h a p ed   d u ct  b y   i m a g e,     th o u t lin e   o f   T - s h ap ed   d u ct  ed g w as  s elec ted   as  c h ar ac te r is tic  p o in t.  I w a s   d eter m i n ed   th at  t h t w o   t y p es   co u ld   b r ec o g n ized   d if f er e n tl y   d ep en d in g   o n   w h eth er   t h o u tl i n s h o w n   i n   Fi g u r 1 5   w as   d etec ted .   A f ir s t,  w tr ied   to   d etec t th o u tlin e,   b u t th er w er th f o ll o w i n g   p r o b le m s .   a.   T h er w er to o   m a n y   co n to u r s   d etec ted .   b.   I w as d i f f icu l t to   u s t h d esir ed   p ix el  co o r d in ates.   c.   T h er w a s   p o o r   r ea l - ti m p er f o r m a n ce   b ec au s e   i t to o k   lo n g   ti m to   ca lcu late.     T h er ef o r e,   w d ec id ed   to   u s t h ca m er i m a g it s el f   r ath er   t h an   th p i x el  co o r d in ates  o f   t h o u tli n e,   an d   w u s ed   te m p late  m atc h in g   [ 1 1 ] .   T em p late  m a tch i n g   h as   th e   ad v a n tag e   o f   o b tai n in g   co o r d in ates  o f   m atc h in g   i m ag f r o m   r ef er e n c i m ag e,   w h ich   ca n   b v er if ie d   in   r ea ti m d u to   s h o r ter   co m p u tatio n al  ti m e,   Evaluation Warning : The document was created with Spire.PDF for Python.
I n J   R o b   &   A u to m   I SS N:  2089 - 4856       C o n tr o l sys tem  d esig n   o f d u ct  clea n in g   r o b o t c a p a b le  o o ve r co min g   L a n d   T - sh a p ed   d u cts   ( Myeo n g   I n   S e o )   131   an d   th d eg r ee   o f   m atc h in g   with   t h th r es h o ld   v al u ca n   b e   ad j u s ted .   Ho w e v er ,   th er w er d is ad v an ta g es  o f   r eq u ir in g   p r o p er   r ef er en ce   im ag e s   i n   ad v a n ce ,   ch a n g i n g   th t h r es h o ld   v al u ev er y   t i m d ep en d i n g   o n     th en v ir o n m e n t,  an d   b ein g   v e r y   s u s ce p tib le  to   b r ig h t n es s   ch an g e s   an d   g eo m etr ical  r o tatio n s .   T h er ef o r e,   th Har r - l ik e   f ea t u r es  [ 1 2 ]   m eth o d   t h at  d o es  n o r eq u ir r e f er en ce   i m a g b ef o r eh an d   w a s   u s ed   to   d etec th o u t l in o f   th i m a g e.   Usi n g   Har r - li k f ea t u r es  a s   s h o w n   i n   F ig u r 1 6 ,   an   o b j ec is   r ec o g n ized   b y   co m b i n in g   e le m en tar y   f ea t u r es  th at   ar co n s tr u cted   b ased   o n   p ix e b r ig h tn es s   d i f f er e n ce s   in     th i m a g e.   T h o u tli n to   b d etec ted   w as   f o u n d   to   b s u i t ab le  f o r   th k e y   p o in r ec o g n i tio n   o f   th e   T - s h ap e   d u ct  b ec au s it  b asicall y   r etai n s   t h g eo m etr ic  in f o r m at io n   as  s h o w n   i n   F ig u r 1 5 ,   an d   th ar ea   h as  d is tin c t   b r ig h t n es s   d if f er en ce .   I n   o r d er   to   ex tr ac t th f ea t u r to   clas s i f y   th i n p u t i m ag e,   t h d i f f er e n ce   i n   b r ig h tn e s s   o f   all  p ix els  m u s t b ca lcu la ted   an d   co m p ar ed   w it h   th t h r es h o l d s   o f   th ele m en tar y   f ea tu r e s .   I f   w ca lc u late  t h b r ig h t n es s   d if f er en ce s   f o r   all  p i x els,  t h co m p u tatio n a v o l u m b ec o m e s   v er y   lar g e,   s o   in te g r ated   i m a g es  [ 1 3 ]   ca n   b u s ed   to   q u ick l y   ca lcu late  th p i x el  b r ig h t n es s   d if f er en ce s   in     th d esire d   ar ea .   T h is   allo w s   th b r ig h t n es s   o f   all  ar ea s   to   b e   ca lcu lated   in   o n l y   f o u r   ca lcu latio n s ,   w h ic h   en ab les  r ap id   co m p u ta tio n .   I f   th f ea tu r o f   t h T - s h ap ed   d u ct  is   e x tr ac ted   d u to   t h d if f e r en ce   in   b r i g h tn e s s ,   class if ier   is   m ad an d   co m p ar ed   w it h   ea c h   i n p u i m a g to   d etec t h T - s h ap ed   d u ct.   Fo r   th i s   o p er atio n ,     th f u n ctio n s   p r o v id ed   b y   Op en C w er u s ed   w i th   t h ele m en tar y   f ea t u r es  an d   t h r es h o l d   v alu e s .   T o   cr ea te   th clas s i f ier ,   an   x m f ile  [ 1 4 ]   w a s   m ad u s in g   t h C a s ca d C las s i f ier   p r o v id ed   in s id t h Op en C V.   Fig u r 1 7   s h o w s   t h p r o ce s s   o f   cr ea ti n g   an   x m f ile  as  f lo w   ch ar a n d   r ep r esen ts   th i m ag d ata  u s ed .   Fo r   th P o s itiv s a m p les,  t h s a m p les  w er c o n s tr u cted   b ased   o n   t h s h ap es  th at  r eq u ir ed   r ec o g n i tio n   w it h i n   t h d u ct,   an d     th p o in ts   to   b u s ed   a s   a   f ea t u r w er m ar k ed .   Fo r   t h Ne g ativ s a m p les,  i m a g es   t h at  h ad   n o t h in g   to   d o   w it h   th d u ct  w er s elec ted ,   i.e .   b ac k g r o u n d s ,   a n i m als,  o r   ca r s .   I n   th ea r l y   s ta g es  o f   tr ai n in g ,   th n u m b er   o f   s a m p le s   w a s   te s ted   u s in g   5 0   P o s itiv an d   2 0 0   Neg ati v e   s a m p les  r esp ec ti v el y ,   an d   f o u n d   th a n o n - T - s h ap ed   d u cts  s u ch   as  L - s h ap ed   d u cts  o r   s tr aig h d u cts  w er e   s o m eti m es  j u d g ed   to   b T - s h ap ed   d u ct.   T o   s o lv th is   p r o b lem ,   t h n u m b er   o f   s a m p le s   f o r   P o s itiv an d   Neg a ti v w er in cr ea s ed   to   3 0 0   an d   9 0 0 ,   r esp ec tiv el y ,   a n d   th i m ag s ize  w as  m o d if ied   s o   th at  p i x el   b r ig h t n es s   co u ld   b e   clea r l y   d is tin g u is h ed .   L ater ,   a f ter   c h ec k in g   t h r ea l - ti m d etec tio n ,   it   w a s   co n f ir m ed   t h at   th T - b r an ch   s ec tio n   w as   r elativ el y   ac c u r atel y   d etec ted   an d   o v er co m e   th e   er r o r s   o f   t h e   T - s h ap ed   s tr u c tu r e   r ec o g n itio n   b y   ac c u r atel y   d etec tin g   t h T - s h ap ed   d u ct,   a n d   co n f ir m ed   th at  it  w as  r ec o g n ized   n o o n l y   i n     th e x is tin g   e n v ir o n m en b u t   also   i n   t h n e w   e n v ir o n m en t.  T ab le  1   s h o w s   t h r es u lt s   o f   t h e x p er i m e n t s   ac co r d in g   to   th n u m b er   o f   s a m p les.           Fig u r 1 5 .   Dete cted   T - b r an ch   s ec tio n       Fig u r 1 6 .   E x a m p le  o f   ele m en tar y   f ea t u r es           Fig u r 1 7 .   Seq u en ce   o f   m ak i n g   x m f ile  a n d   i m a g d ata   T ab le  1 .   Su cc ess   r ate  b ased   o n   n u m b er   o f   s a m p les   P o si t i v e   50   30 0   N e g a t i v e   2 0 0   9 0 0   R e su l t s       S u c c e ss  Rate   0%   9 5 %         Evaluation Warning : The document was created with Spire.PDF for Python.
              I SS N : 2 0 8 9 - 4856   I n J   R o b   &   A u to m Vo l.  9 ,   No .   2 J u n 2 0 2 0   :   1 23     1 34   132   5.   E XP E R I M E NT S AN RE S UL T S   Af ter   t h r o b o w as  m a n u f ac t u r ed ,   lo o f   test s   w er co n d u cted   f o r   ea ch   s ec tio n   to   en s u r n o r m al   d r iv in g   w as  p o s s ib le  o n   s tr ai g h d u ct,   L - s h ap ed   an d   T - s h ap ed   d u cts.  Fo r   s tr aig h an d   L - s h ap ed   d u cts,  r o b o t   d r iv in g   w as  s m o o t h   w it h   i m a g ca p tu r i n g ,   a n d   b r u s h in g   w i th   t h h elp   o f   d is tan ce   s en s o r s   an d   alg o r ith m s .   I n   ca s o f   T - s h ap ed   d u cts,  t h r o b o co u ld   m o v n o r m all y   w it h o u f all in g   i n to   th d u ct  w h e n   it  w a s   d r iv en   w i t h   th f r o n t   p ar ts   o f   t h w h ee l s   f o ld ed   b y   w ir es.   I n   s o m ca s es,  th m o v e m e n f ailed   in   t h T - s h ap ed   d u ct,   m ai n l y   i f   th w ir e s   w er n o s u f f ic ien t l y   ti g h o r   im a g p r o ce s s in g   w a s   n o s ec u r ed .   T ab le   2   r ep r esen ts     th s u cc es s   r ate  f o r   ea ch   d u ct  s eg m e n t.   Usi n g   t h UW B ,   m a n y   e x p er i m e n ts   h a v b ee n   co n d u cted   t o   id en tify   t h lo ca tio n   o f   m o v in g   r o b o in s id th e   d u ct   m ad e   o f   m etal   o r   an d   p last ic   d ep en d in g   o n   t h s ec tio n .   Fo r   t h p las tic  s ec ti o n ,   th e   tr ilater atio n   alg o r ith m   b ased   o n   g r ad ie n d escen m et h o d   g u ar an teed   g r ea ac cu r ac y   w i th   an   er r o r   o f   les s   t h an   5 c m .   Ho w e v er ,   w ith   t h ap p licatio n   o f   tr ilater atio n   al g o r ith m   f o r   m etal  s ec tio n ,   t h T OF  b et w e en   an c h o r s   an d   ta g s   v ar ied   g r ea tl y ,   p r ev en t in g   ac c u r ate  p o s itio n i n g .   W ith   t h i n tr o d u ctio n   o f   m o m e n t u m   ter m   s h o w n   in   ( 9 - 1 0 )   an d   in c r ea s th n u m b er   o f   an ch o r s   f r o m   t h r ee   to   f o u r ,   t h er r o r   co u ld   b r ed u ce d   to   3 0   cm .   T ab le  3   is     th UW B   p o s itio n   m ea s u r e m e n t e r r o r s   ac co r d in g   to   th m a te r ial  o f   th d u ct.   T ab le   4   s h o w s   th p er f o r m a n ce   to   tr an s m it  r ea ti m i m ag f r o m   th r o b o t’   ca m er to   P C .   Du to     th p er f o r m a n ce   li m itatio n s   o f   R asp b er r y   P Z er o ,   t h i m a g f r a m r ate   h ad   to   b lo w er ed .   I n   ad d itio n ,   th e   v id eo   co u ld   b in s ta n tl y   v ie wed   b y   s tr ea m i n g   it  l iv o n   i n te r n et.   Ho w e v er ,   d u to   th in te r n et  en v ir o n m en o r   p er f o r m a n ce   p r o b lem s   w ith   R asp b er r y   P i,  th er w er s lig h t   d elay   in   v ie w i n g   t h v id eo .   On   th o th er   h a n d ,     th ca m er u s ed   in   th r o b o w a s   s m all   s ize  m o d el  w it h   P C a m er a,   s o   it  h ad   lo w   r es o lu tio n .   W h e n   u s i n g   C #   p r o g r am   to   id en ti f y   T - s h a p ed   d u ct  b y   i m a g p r o ce s s in g   s tated   p r ev io u s l y ,   t h id en ti f i ca tio n   s u cc e s s   r ate   f o r   T - s h ap d u ct  w as a r o u n d   9 5 %.    So m o f   th e   r ea s o n s   f o r   t h f ail u r o f   th m i s r ec o g n iti o n   o f   T - s h ap ed   d u ct  w er t h at  w h e n   tr an s p ar en d u cts   w er u s ed ,   ex ter n al   li g h t   w as   tr an s m itted   in to   t h d u ct,   w h ich   r es u lted   in   f ail u r o f   i m ag e   p r o ce s s in g   d u to   d if f er en ce   in   illu m i n atio n   i n s id th d u ct,   an d   d elay   in   i m a g tr an s m i s s io n   d u to   p er f o r m a n ce   o f   w ir ele s s   co m m u n icat io n   m o d u les.   I n   Fig u r 1 8   th im a g e s   s h o th at  th r o b o o p er ates  in   th v er tical  d u ct  th at  is   m o r d if f ic u lt  th a n   th h o r izo n tal  d u ct.   T ests   s h o w ed   t h at  t h r o b o w a s   cli m b in g   u p   u s i n g   t h f r ictio n   f o r ce   b et w ee n   t h b elt   co n n ec ted   to   th d r iv es h a f a n d   in n er   w al ls   o f   t h d u ct.   Fi g u r 1 9   s h o w s   t h i m ag e s   th at  th r o b o m o v e s   th r o u g h   t h L - s h ap ed   d u ct  an d   th r o b o m o v e m en t s   i n   t h T - s h ap ed   d u ct  ar s h o w n   i n   Fi g u r 20 .   A ll  m o v i n g   p er f o r m a n ce   f o r   th r ee   t y p es o f   d u ct  ar co m p ar ed   in   T ab le  5 .   Fin all y ,   T ab le  5   is   m ea s u r e   o f   d r iv in g   s p ee d   m ea s u r ed   a cc o r d in g   to   s h ap o f   d u cts.  T h r o b o t's   d r iv in g   s p ee d   w as  m o d er a te  en o u g h   to   clea n   it  u p   w it h   b r u s h .   As  w g u e s s ,   th r o b o s p ee d   is   s lo w est  i n     th T - s h ap ed   d u ct  b ec au s it  tak es  lo n g er   to   r ec o g n ize  th e   T - s h ap d u ct  th r o u g h   i m a g e   p r o ce s s in g   an d   to   s af el y   o v er co m i t th r o u g h   s u b s eq u en t ti m er   o p er atio n s   an d   w ir o p er a tio n .       T ab le  2 .   Su cc ess   r ates f o r   m o v in g   i n   d u ct    in   ac co r d an ce   w ith   d u ct  s h ap es   D u c t   Ty p e s   S t r a i g h t   D u c t   L - sh a p e d   T - sh a p e d   S u c c e ss  R a t e   1 0 0 %   1 0 0 %   8 0 %     T ab le  3 .   L o ca tio n   er r o r s   o f   r o b o t in s id d u ct    in   ac co r d an ce   w ith   d i f f er en m ater ials     U W B   P o si t i o n i n g   Er r o r   Emp t y   S p a c e   5   ~   1 0   c m   P l a st i c   D u c t   5   ~   1 0   c m   M e t a l l i c   D u c t   3 0   ~   5 0   c m         T ab le  4 .   I m ag p r o ce s s i n g   a n d   p er f o r m a n ce   f ig u r es   V i d e o   F r a me   V i d e o   T r a n smiss i o n   D e l a y   R e so l u t i o n   ( P i x e l )   I mg a e   P r o c e ssi n g   S u c c e ss  R a t e   2 0   F P S   0   ~   1 . 5   se c   3 2 0   x   2 4 0   9 5 %     T ab le  5 .   R o b o t a v er ag s p ee d   in   s e v er al  cir cu m s ta n ce s   D u c t   T y p e   S t r a i g h t   L - sh a p e d   T - sh a p e d   S p e e d ( mm / s)   20   12   5             Fig u r 1 8 Mo v in g   s ce n e s   o f   a   r o b o   in   v er tical  d u ct       Fig u r 1 9 Mo v in g   s ce n e s   o f   a   r o b o   in   L - s h ap ed   d u ct   Evaluation Warning : The document was created with Spire.PDF for Python.