¼·Ð : ·Îº¿ÀÇ ½Ã´ë°¡ ´Ù°¡¿À°í ÀÖ´Ù. ¿©±â Àú±â¼ ÀÌ·± Àú·± ·Îº¿À» °³¹ßÇÏ¿´´Ù´Â ¼Ò½ÄµéÀÌ ¹Ù»Ú°Ô µé·Á¿À°í ÀÖ´Ù. ÀÎÇÏ´ëÇб³´Â ÀÎÇÏ´ë/ÇѾç´ë/ºÎ»ê´ë ÄܼҽþöÀ» ÅëÇØ Áö½Ä°æÁ¦ºÎ°¡ Áö¿øÇÏ´Â ·Îº¿ Ư¼ºÈ ´ëÇпø »ç¾÷¿¡ ¼±Á¤µÇ¾úÀ¸¸ç 2010³âµµ 1ÇбâºÎÅÍ Á¤½ÄÀ¸·Î ´ëÇпø»ýÀ» ¸ðÁýÇÏ°Ô µÈ´Ù. ÀÌ¿¡ ¹ß¸ÂÃç Embedded Control Lab.¿¡¼µµ ´Ù¾çÇÑ ·Îº¿ ½ÇÇèÀ» ¼öÇàÇÒ ¼ö ÀÖµµ·Ï ·Îº¿ Ç÷§ÆûÀÌ ÀÖ¾î¾ß°Ú´Ù´Â »ý°¢ÀÌ µé¾î °£´ÜÇÑ ÇüÅÂÀÇ Mobile RobotÀ» Á¦ÀÛÇÏ°Ô µÇ¾ú´Ù. Á¦ÀÛµÈ ·Îº¿Àº ºñ·Ï ±¸Á¶´Â °£´ÜÇÏÁö¸¸ ´Ù¾çÇÑ ½ÇÇèÀ» ¼öÇàÇØ º¼ ¼ö ÀÖÀ» °ÍÀ¸·Î ¿¹»óµÈ´Ù.
¼³°è : 3Â÷¿ø ¼³°è ÇÁ·Î±×·¥À» ÀÌ¿ëÇÏ¿© ´ë·«ÀûÀ¸·Î ¼³°è¸¦ ¼öÇàÇÏ¿´´Ù. ±×¸² 1Àº ¼³°èµÈ mobile robotÀÇ Á¤¸é, Ãø¸é, ¹Ø¸é, ±×¸®°í µî°¢µµÀÌ´Ù. 2°³ÀÇ ¹ÙÄû¸¦ ÀÌ¿ëÇÏ¿© À̵¿À» ÇÏ°í ÀÛÀº º¸Á¶¹ÙÄû 2°³¸¦ ÀÌ¿ëÇÏ¿© ¾ÕµÚ·Î ³Ñ¾îÁüÀ» ¹æÁöÇÏ´Â ±¸Á¶ÀÌ´Ù. ±âº»ÀûÀÎ ÁÖÇà ½ÃÇè°ú °¢Á¾ ½ÇÇèÀÌ ³¡³ª¸é º¸Á¶ ¹ÙÄû¸¦ ¶¼¾î³½ ÈÄ ¹«ÀÎ Segway¸¦ ¸¸µé ¿¹Á¤ÀÌ´Ù.
- ¹ÙÄû´Â À̵¿½Ã ¹Ù´Ú°úÀÇ ¹Ì²ô·¯ÁüÀ» ¹æÁöÇϱâ À§ÇØ ¿¡¾î ¹ÙÄû¸¦ »ç¿ëÇÏ¿´´Ù. ·Îº¿À» À§ÇØ µü ¸Â°Ô ³ª¿À´Â ¹ÙÄû´Â ´«À» ¾Ä°í ã¾ÆºÁ¾ß ¾ø´Ù. ¾î¿ ¼ö ¾øÀÌ »ê¾÷¿ëÇ° À¯Åë ¼¾Å͸¦ µÚÁö´Ù °ª½Ñ Áß±¹»ê ¹ÙÄû¸¦ ¹ß°ßÇÏ°Ô µÇ¾î ÀÌ°ÍÀ» ÀÌ¿ëÇÏ¿© ¼³°è¸¦ ÇÏ¿´´Ù.
- DC ¸ðÅ͸¦ »ç¿ëÇÏ¿´À¸¸ç 49:1ÀÇ °¨¼Óºñ¸¦ °®´Â °¨¼Ó±â¸¦ »ç¿ëÇÏ¿´´Ù. ¹ÙÄû¿Í ¸ðÅÍ°£ÀÇ µ¿·ÂÀü´ÞÀº ¸ðµâ 1.0ÀÇ Spur Gear¸¦ »ç¿ëÇÏ¿´´Ù.
- ·Îº¿ÀÇ ¸öü´Â ¸ðµÎ ¾Ë·ç¹Ì´½À¸·Î ¼³°èÇÏ¿´´Ù. ·Îº¿Àº ÇÏÆÇ°ú »óÆÇÀ¸·Î ±¸¼ºÇؼ °¢°¢ ÇÊ¿äÇÑ °÷¿¡ ÇÊ¿äÇÑ Á¦¾î ÀåÄ¡¸¦ ÀåÂøÇÒ ¼ö ÀÖµµ·Ï ÇÒ ¿¹Á¤ÀÌ´Ù.
±×¸² 1. ¼³°èµÈ Mobile RobotÀÇ Á¤¸éµµ, Ãø¸éµµ, ¹Ø¸éµµ, µî°¢µµ
±â±¸ºÎ °¡°ø : ±â±¸ºÎ °¡°øÀº ¾ðÁ¦³ª ±×·¸Áö¸¸ °íµÈ ÀÛ¾÷ÀÌ´Ù. CAM ÀÛ¾÷À» ÇØ¾ß ÇÏ°í CNC¸¦ ÀÌ¿ëÇÏ¿© °¡°øÇÏ´Â ½Ã°£µµ ¸¹ÀÌ °É¸®±â ¶§¹®ÀÌ´Ù. °Ô´Ù°¡ ´Ù ³¡³ ´ÙÀ½¿¡ CNC û¼ÒÇÏ´Â ÀÛ¾÷µµ Á¤¸» ±ÍÂú±â ¦À̾ø´Ù. ±×·¯³ª ¿Ï¼ºµÈ ±â±¸¹°À» Á¶¸³ÇÏ´Â ½Ã°£Àº °¡°øÇÏ´Â ½Ã°£¿¡ ºñÇØ ÈξÀ Áñ°Å¿î ½Ã°£ÀÌ´Ù. À̹ø Mobile robotÀÇ ±â±¸ºÎ °¡°ø¿¡´Â ECLCNC2°¡ »ç¿ëµÇ¾ú´Ù. Bed°¡ ³ÐÁ÷Çϱ⠶§¹®¿¡ Å« ±â±¸¹°µµ °¡°øÇÒ ¼ö ÀÖ°í °¼ºÀÌ ÁÁ¾ÆÁö°í ½ºÇɵé Èûµµ ¼¼¾îÁ®¼ ECLCNC1¿¡ ºñÇØ ÈξÀ ¼ö¿ùÇÏ°Ô ÀÛ¾÷À» ÁøÇàÇÒ ¼ö ÀÖ¾ú´Ù. ±×¸² 2´Â Mobile robotÀÇ Á¦ÀÛ¿¡ »ç¿ëµÇ´Â ºÎÇ°µéÀ» ÆîÃijõÀº ±×¸²ÀÌ´Ù. ±â±¸¹°Àº ¸ðµÎ ¾Ë·ç¹Ì´½ 6061·Î °¡°øµÇ¾ú´Ù. µÎ²²´Â ÁÖ·Î 6mm¸¦ »ç¿ëÇÏ¿´À¸¸ç °¡°ø¿¡´Â Á÷°æ 5mmÀÇ Æò¿£µå¹ÐÀ» ÀÌ¿ëÇÏ¿© »çÁ¤¾øÀÌ °¡°øÇØ ÁÖ¾ú´Ù. CNC¸¦ ÀÌ¿ëÇØ ¸ðµÎ °¡°øÀÌ µÇ¾î ÁÖ¸é °í¸¿°ÚÁö¸¸ ÅÇÀ» ³»¾ß ÇÏ´Â ÀÛ¾÷Àº ¾î¿ ¼ö ¾øÀÌ ¿¬±¸½Ç¿¡ ÀÖ´Â ¹Ð¸µÀ» »ç¿ëÇÏ¿´´Ù. ÀÌ·± °Íµµ ¸ðµÎ ÀÚµ¿À¸·Î µÇ¸é ¾ó¸¶³ª ÁÁÀ»±î...
±×¸² 2 : Mobile robotÀÇ ºÎÇ°µé.
Á¶¸³ : °¡°ø¿¡ ºñÇϸé Á¶¸³Àº Á¤¸» ÇູÇÑ ½Ã°£ÀÌ´Ù. ±×·¯³ª ÀÌ Mobile robotÀº Á¶¸³µµ ±×¸® °£´ÜÇÏÁö´Â ¾Ê¾Ò´Ù. ¿©·¯°¡Áö ½ÃÇàÂø¿À³¡¿¡ ¾à ¼³Ê ½Ã°£Àº °É¸° °Í °°´Ù. ±×¸² 3Àº ¸ðÅÍ¿Í ±â¾îºÎÀÇ Á¶¸³µÈ ¸ð½ÀÀÌ´Ù. Âü°í·Î °¨¼Ó±â´Â 49:1ÀÌ°í ¸ðÅÍ´Â 1ȸÀü´ç 38ÆÞ½º¸¦ ¹ß»ýÇÏ´Â rotary encoder°¡ ºÎÂøµÇ¾î ÀÖ´Ù. ±×¸² 4´Â ·Îº¿ÀÇ Base ºÎºÐÀÌ Á¶¸³µÈ ¸ð½ÀÀ» º¸¿©ÁØ´Ù. ±×¸² 3¿¡¼ Á¶¸³ÇÑ ¸ðÅͺΰ¡ ÀåÂøµÇ¾î ÀÖ´Â °ÍÀ» º¼ ¼ö ÀÖ´Ù. ±×¸² 5´Â ÇÏÆÇ°ú ¹ÙÄû±îÁö ¸¶Àú Á¶¸³ÇÑ ¸ð½ÀÀÌ´Ù. ÀÌÁ¦ ¼³°èµµÀÇ ¸ð½À°ú À¯»çÇÑ ¸ð¾çÀÌ ³ª¿À´Â °ÍÀ» º¼ ¼ö ÀÖ´Ù. ±×¸² 6Àº ·Îº¿ÀÇ Base ºÎºÐÀ» À§¿¡¼ ÂïÀº »çÁøÀÌ´Ù. À½, ±ò²ûÇÏ´Ù. ¹«¾ð°¡ Çغ¸°í ½ÍÀº »ý°¢ÀÌ ¸¶±¸ ¿ë¼ÚÀ½ Ä£´Ù. ¹» Çغ¼±î? Á¦¾î? ÀÚÀ²ÁÖÇà? SLAM? ÇÒ ¼ö ÀÖ´Â °ÍÀº ¹«±Ã¹«ÁøÇÏ´Ù. ±×¸² 7Àº »óÆDZîÁö Á¶¸³ÀÌ ³¡³ Mobile robotÀÇ ±â±¸ºÎÀÌ´Ù. ¾î¶²°¡? ¼³°èµµ¿Í ºñ½ÁÇÑ°¡?
±×¸² 3. ¸ðÅÍ¿Í ±â¾îºÎÀÇ Á¶¸³µÈ ¸ð½À
±×¸² 4 : ·Îº¿ÀÇ Base ºÎºÐÀÇ Á¶¸³µÈ ¸ð½À
±×¸² 5: ¹ÙÄû¿Í ÇÏÆDZîÁö Á¶¸³µÈ ·Îº¿ÀÇ Base ºÎºÐ (¹Ø¸é ¸ð½À)
±×¸² 6 : ·Îº¿ÀÇ Base ºÎºÐ (À¸é ¸ð½À)
±×¸² 7 : ¿Ï¼ºµÈ Mobile robotÀÇ ±â±¸ºÎ
Á¦¾î : Mobile robotÀÇ Á¦¾î´Â 2°¡Áö ¹æ½ÄÀ» »ý°¢ÇØ º¼ ¼ö ÀÖ´Ù. ù¹ø°´Â º¸Á¶¹ÙÄû¸¦ ÀåÂøÇÑ »óÅ·ΠÁÖÇàÁ¦¾î, ±ËÀû »ý¼º, Ã浹ȸÇÇ¿Í °°Àº ÁÖÁ¦µéÀ» ´Ù·ç¾îº¼ ¼ö ÀÖ´Â Á¦¾î ¹æ½ÄÀÌ°í µÎ¹ø°´Â º¸Á¶¹ÙÄû¸¦ ¶¼¾î³»¾î ¾Õ/µÚ·Î ³Ñ¾îÁú ¼ö ÀÖ´Â robotÀ» Á¦¾î¸¦ ÀÌ¿ëÇÏ¿© ÀÚ¼¼ ¾ÈÁ¤È¸¦ ¾ÈÁ¤È½ÃÅ´°ú µ¿½Ã¿¡ ÁÖÇàÁ¦¾î¸¦ ÇÏ´Â Çü½ÄÀÇ Á¦¾îÀÌ´Ù. µÎ°¡Áö ÁÖÁ¦ ¸ðµÎ ´Ù¾çÇÑ Áö½ÄÀ» °¡Áö°í ÀÖ¾î¾ß ±¸Çö °¡´ÉÇϱ⠶§¹®¿¡ ¼®/¹Ú»ç ÇÐÀ§ °úÁ¤ÀÇ ÇлýµéÀÇ Çо÷À̳ª ¿¬±¸¸¦ À§ÇØ ÁÁÀº ÁÖÁ¦¶ó°í »ý°¢µÈ´Ù. ù¹ø° ÁÖÁ¦ÀÇ robotÀº ±×³É Mobile robot À̶ó°í ÇÏ°í µÎ ¹ø° ÁÖÁ¦ÀÇ robotÀº Mobile inverted pendulum robot À̶ó°í ºÎ¸£±â·Î ÇÏÀÚ. ECL¿¡¼´Â TMS320F2812 Base board¸¦ ÀÌ¿ëÇÏ¿© µÎ°¡Áö robot¿¡ ´ëÇÑ Á¦¾î¸¦ ¼öÇàÇÏ¿´´Ù.
1. Mobile robot ÀÇ Á¦¾î
±¸ÇöÀº µÇ¾î ÀÖÁö¸¸ ¼Ò°³ÀÇ ±ÛÀº ÃßÈÄ¿¡ ÀÛ¼ºÇϱâ·Î ÇÑ´Ù.
2. Mobile inverted pendulum robot ÀÇ Á¦¾î
inverted pendulum ÇüÅÂÀÇ robotÀ» ÀÚ¼¼Á¦¾î Çϱâ À§Çؼ´Â ÀÚ¼¼ Á¤º¸¸¦ ÃøÁ¤Çϱâ À§ÇÑ ¼¾¼°¡ ÇÊ¿äÇÏ´Ù. ECL¿¡¼´Â 1Ãà gyro ¼¾¼¿Í 2Ãà °¡¼Óµµ ¼¾¼¸¦ Kalman filter¸¦ ÀÌ¿ëÇÏ¿© À¶ÇÕÇÔÀ¸·Î½á robot ÀÇ ÀÚ¼¼Á¤º¸¸¦ ¹æ½ÄÀ» ÃëÇÏ¿´´Ù. ÀÌ ¹æ½ÄÀÇ ¼¾¼´Â ±â¿ï±â Á¤º¸¸¦ ÃøÁ¤Çϱâ À§ÇØ Ã¤ÅÃÇÏ´Â °¡Àå ÀϹÝÀûÀÎ ¹æ½ÄÁßÀÇ ÇϳªÀÌ´Ù. Á¦¾î ¾Ë°í¸®Áò¿¡ ´ëÇÑ °³°ýÀûÀÎ ³»¿ë¿¡ ´ëÇÑ ¾ð±ÞÀº ÃßÈÄ ½Ã°£ÀÌ Çã¶ôÇÒ ¶§ Á»´õ ÀÚ¼¼È÷ ¼Ò°³Çϱâ·Î ÇÑ´Ù. À§¿¡¼ ¾ð±ÞÇÑ Çϵå¿þ¾î¸¦ ÀÌ¿ëÇÏ¿© Á¦¾î¸¦ ¼öÇàÇÏ¿´À¸³ª ¿©·¯ °¡Áö ÀÌÀ¯·Î °á±¹ Çϵå¿þ¾î¸¦ ¼öÁ¤ÇÏ¿´´Ù. ù ¹ø° ¼öÁ¤Àº motorÀÇ ±³Ã¼ÀÌ´Ù. ºñ½Î´Ù´Â Maxon motor¸¦ »ç¿ëÇÏ¿´´Ù. ÀÌÀü¿¡´Â ±¹»ê ¸ðÅÍ¿Í ±â¾î¹Ú½º¸¦ ½è´Âµ¥ °á±¹ Çغ¸´Ù°¡ µÎ¼Õ µé°í ¸»¾Ò´Ù. ±â¾î¹Ú½ºÀÇ backlash°¡ ³Ê¹« Ä¿¼ Á¦¾î¼º´ÉÀÌ ³Ê¹« ¶³¾îÁ³´Ù. µÎ ¹ø° ¼öÁ¤Àº motor¿¡ Á÷°áµÈ encoder ´ë½Å ¹ÙÄûÀÇ Ãà¿¡ Á÷Á¢ encoder¸¦ Á÷°áÇϵµ·Ï ÇÑ °ÍÀÌ´Ù. ¾Æ·¡ÀÇ ±×¸²Àº Çϵå¿þ¾î°¡ ¼öÁ¤µÈ robotÀÇ Çϴܺθ¦ º¸¿©ÁÖ°í ÀÖ´Ù.
±×¸² 8. ¼öÁ¤µÈ Çϵå¿þ¾î (·Îº¿ÀÇ ¹Ù´Ú ºÎºÐ) [È®´ë»çÁø]
robotÀÇ Á¦¾î °¡´É¿©ºÎ¸¦ ±Ã±ÝÈ÷ ¿©±â´Â ºÐµéÀ» À§ÇØ robot ¿¡ Á¦¾î½Ã½ºÅÛÀ» ÀåÂøÇÑ »çÁø°ú ÀÎÇÏ´ëÇб³ ±³Á¤¿¡¼ ÀÌ·ç¾îÁø robotÀÇ Á¦¾î½ÇÇè µ¿¿µ»óÀ» Link ÇÏ¿´´Ù.
±×¸² 9. Á¦¾îºÎ¸¦ ÀåÂøÇÑ Mobile inverted pendulum robot