Unscented Kalman Filter

> RESEARCH > OPTIMAL ESTIMATION > Unscented Kalman Filter

Áö»ó ¹«±â ü°è¿Í °°ÀÌ Ãʱ⠻óÅ¿¡¼­ ÀÛÀü °³½Ã¿Í ÇÔ²² ±âµ¿À» ¼öÇàÇØ¾ß ÇÏ´Â °æ¿ì³ª ÀÛÀü Áß ±Þ°ÝÇÑ ±âµ¿À» ÇÏ´Â °æ¿ì¿¡´Â Ç×¹ý ¿ÀÂ÷ ¸ðµ¨ÀÇ ¼±Çü¼ºÀ» º¸Àå ÇÒ ¼ö ¾ø°Ô µÇ¸ç ÀÌ·Î ÀÎÇÏ¿© Ç×¹ý½Ã½ºÅÛÀº ºñ¼±Çü Ư¼ºÀ» °¡Áö´Â ºñ¼±Çü ½Ã½ºÅÛÀÌ µÈ´Ù.

¶ÇÇÑ ¿©·¯ ½ÇÁ¦ ȯ°æÀº ºñ¼±ÇüÀ¸·Î ¸ðµ¨¸µ µÇ±â ¶§¹®¿¡ ºñ¼±Çü¼ºÀ» °í·ÁÇÑ ÇÊÅ͸µ ¾Ë°í¸®ÁòÀÌ ÇÊ¿äÇÏ°Ô µÈ´Ù.

ºñ¼±Çü ½Ã½ºÅÛ¿¡ ÃÖ±Ù 20¿©³â°£ °¡Àå ³Î¸® »ç¿ëµÇ¾î ¿Â °ÍÀÌ È®Àå Ä®¸¸ÇÊÅÍ(Extended KF-EKF)ÀÌ´Ù. ±×·¯³ª, EKF´Â ºñ¼±Çü ¸ðµ¨À» 1Â÷·Î ¼±ÇüÈ­ ½ÃÄÑ »ç¿ëÇÔÀ¸·Î½á ¿ÀÂ÷°¡ ¸Å¿ì Ŭ °æ¿ì¿¡´Â ÃßÁ¤ ¼º´ÉÀÌ ÀúÇϵǴ ´ÜÁ¡À» °¡Áö°Ô µÈ´Ù.

ÀÌ·¯ÇÑ ¹®Á¦¸¦ ÇØ°áÇϱâ À§ÇÏ¿© 1995³â Julier¿Í Uhlmann¿¡ ÀÇÇÏ¿© UKF(Unscented Kalman Filter)°¡ ¿¬±¸µÇ¾î ±× ¼º´ÉÀÌ ´Ù¾çÇÑ ºñ¼±Çü ½Ã½ºÅÛ¿¡¼­ ¿ì¼öÇÑ ¼º´ÉÀ» °¡Áö´Â °ÍÀ¸·Î ¾Ë·ÁÁ³´Ù.

UKF´Â ½Ã±×¸¶ Á¡(Sigma Point-SP)

UKF´Â ½Ã±×¸¶ Á¡(Sigma Point-SP)À̶ó ºÎ¸£´Â È®Á¤ÀûÀÎ ¼±Åà Á¡(deterministically chosen points)ÀÇ ÁýÇÕÀ» ºñ¼±Çü ¸ðµ¨À» »ç¿ëÇÏ¿© º¯È¯ÇÏ´Â Unscented º¯È¯(Unscented Transform-UT)¿¡ ±âÃʸ¦ µÎ°í ÀÖ´Ù.

½Ã±×¸¶ Á¡Àº ºñ¼±Çü ¸ðµ¨ÀÇ ·£´ý »óź¯¼ö¸¦ Åë°èÀûÀ¸·Î °¡Àå Àß ³ªÅ¸³¾ ¼ö ÀÖµµ·Ï ¼±Åà µÈ´Ù.

Áö±Ý±îÁö ¿¬±¸µÈ SPÀÇ ¼±Åà ¹æ¹ýÀ¸·Î´Â ½Ã½ºÅÛ Â÷¼ö NÀÇ 2¹è¸¸Å­ SP¸¦ ¼±ÅÃÇÏ´Â ±â¹ý, 2N°³ÀÇ SP¿¡ Æò±Õ°ªÀ» Ãß°¡ÇÏ¿© 2N+1°³ÀÇ SP¸¦ ¼±ÅÃÇÏ´Â ±â¹ý, SPÀÇ °³¼ö¸¦ 2N°³º¸´Ù Ãà¼ÒÇÏ¿© ¼±ÅÃÇÏ´Â ±â¹ý, SPÀÇ °³¼ö¸¦ 2N°³ º¸´Ù ´Ã¿©¼­ ¼±ÅÃÇÏ´Â ±â¹ý µîÀÌ ÀÖ´Ù.

UKFÀÇ ±âº»ÀÌ µÇ´Â UT¿¡ ´ëÇؼ­ °£·«È÷ »ìÆ캸¸é ´ÙÀ½°ú °°´Ù.

UTº¯È¯Àº ºñ¼±Çü ÇÔ¼ö·Î ÁÖ¾îÁö´Â »óÅ º¯¼öÀÇ Æò±Õ ¹× °øºÐ»ê Á¤º¸ µîÀÇ Åë°èÄ¡¸¦ °í·ÁÇÑ ½Ã±×¸¶ Á¡ÀÇ °áÁ¤°ú °áÁ¤µÈ ½Ã±×¸¶ Á¡ÀÇ ºñ¼±Çü º¯È¯ ÀÌÈÄÀÇ Æò±Õ°ú °øºÐ»ê Á¤º¸¸¦ °è»êÇÏ´Â ÀÏ·ÃÀÇ °úÁ¤À¸·Î ÀÌ·ç¾îÁø´Ù.

UT¿¡¼­ »ç¿ëµÇ´Â ±âº»ÀûÀÎ °³³äÀº EKF¿Í °°ÀÌ ºñ¼±Çü ÇÔ¼ö¸¦ ±Ù»çÈ­ ÇÏ´Â °Íº¸´Ù È®·ü ºÐÆ÷¸¦ ±Ù»çÈ­ÇÏ´Â °ÍÀÌ ´õ ¿ëÀÌÇÏ´Ù´Â °ÍÀÌ´Ù.

ÀÌ·¯ÇÑ UTº¯È¯Àº ÀÔÀÚ ÇÊÅÍ(particle filter)¿¡¼­ ÀÔÀÚ¸¦ °áÁ¤ÇÏ´Â °Í°ú À¯»çÇÑ °³³äÀ̳ª ±âº»ÀûÀÎ Â÷ÀÌÁ¡Àº ÀÔÀÚ ÇÊÅÍ´Â ·£´ý(random)ÇÏ°Ô ÀÔÀÚ¸¦ ¼±ÅÃÇÏÁö¸¸ UKF¿¡¼­ »ç¿ëÇÏ´Â SP´Â °áÁ¤ÀûÀÎ(deterministic) ¹æ¹ýÀ¸·Î ¼±ÅÃÇÑ´Ù´Â °ÍÀÌ´Ù.

ÀÌ¿Í ÇÔ²², UT¿¡¼­´Â °¡ÁßÄ¡¸¦ »ç¿ëÇÏ¿© SPÀÇ Á¸Àç ±¸°£À» º¯È­ ½Ãų ¼ö ÀÖ´Ù´Â °ÍÀÌ Â÷ÀÌÁ¡ÀÌ´Ù. UKF´Â ¾Õ¿¡¼­ ¼³¸íÇÑ UT±â¹ýÀ» Àû¿ëÇÑ Ä®¸¸ÇÊÅÍÀÌ´Ù.

UKF ¾Ë°í¸®Áò

±×¸²1Àº UKF ¾Ë°í¸®ÁòÀ» °£·«È÷ ¼³¸íÇÏ´Â ±×¸²ÀÌ´Ù.

UKF´Â ¿ì¼± ÃʱâÈ­ °úÁ¤À» °ÅÄ£ ÈÄ ½Ã°£ ¾÷µ¥ÀÌÆ® °úÁ¤À» °ÅÄ¡´Âµ¥ ¿©±â¼­ SP¸¦ ¼±ÅÃÇÏ°í º¯È¯ÇÏ¿© °øºÐ»êÀ» ±¸ÇÑ ÈÄ ÃøÁ¤Ä¡ ¾÷µ¥ÀÌÆ® °úÁ¤À» °ÅÃÄ ¿ì¸®°¡ ¿øÇÏ´Â »óź¯¼ö¸¦ ÃßÁ¤ÇÏ´Â ÇÊÅÍÀÌ´Ù.

ºñ¼±Çü¼ºÀÌ ³ôÀº ½Ã½ºÅÛ¿¡ ´ëÇؼ­ ±×°Ç »ç¿ëµÇ¾î¿Â EKFº¸´Ù ¼º´ÉÀÌ ¿ì¼öÇÏ¿© ÃÖ±Ù ¸¹Àº ºñ¼±Çü ÇÊÅ͸µ ºÐ¾ß¿¡¼­ È°¿ëµÇ°í ÀÖ´Ù.

¼­¿ï´ëÇб³ Ç×¹ýÀüÀڽýºÅÛ¿¬±¸½Ç | ÁÖ¼Ò : ¼­¿ïƯº°½Ã °ü¾Ç±¸ °ü¾Ç·Î 1 ¼­¿ï´ëÇб³ | ±³¼ö ¿¬±¸½Ç : 133µ¿ 603È£ (Tel. 02-880-7308)
´ëÇпø»ý ¿¬±¸½Ç : 133µ¿ 607È£ (Tel. 02-880-1732) | ½ÇÇè½Ç : 302µ¿ 418-1È£ | Copyright by NESL All Rights Reserved.