רÀûÃû³Æ£º¹ÜµÀ¿Õ¼äÖо«È·²âÁ¿ÎïÌåÒÆ¶¯µÄ×°ÖõÄÖÆ×÷·½·¨
¼¼ÊõÁìÓò£º
±¾ÊµÓÃÐÂÐÍÉæ¼°Ò»ÖÖ²âÁ¿ÎïÌåÒÆ¶¯µÄ×°Öã¬ÌرðÊÇÉæ¼°Ò»ÖֹܵÀ¿Õ¼äÖвâÁ¿ÎïÌåÒÆ¶¯µÄ×°ÖÃ
±³¾°¼¼Êõ£º
ÔڹܵÀ¿Õ¼ä»òÕßÀàËÆÓڹܵÀµÄ¿Õ¼äÖУ¬¼´Òƶ¯Â·¾¶µÄÉÏÃæ£¬ÏÂÃæºÍÁ½²à¿Õ¼ä¶¼ÊÇ·â±ÕµÄ£¬Ö»ÓÐǰºóÁ½Ãæ¿ÉÒÔͨÐеĿռäÖУ¬ÎïÌåÒÆ¶¯ÊýÖµµÄ¼ÆËãÒ»°ã²ÉÓòâ¾à·¨(Odometry)£¬µ«ÊÇÒòΪ²â¾à·¨(Odometry)Îó²îºÜ´ó(ÿÃׯ½¾ùÎó²î2. 5%×óÓÒ)£¬ËùÒÔ»¹»áÀûÓü¤¹â·¶Î§´«¸ÐÆ÷¹Û²â¿Õ¼ä½øÐÐÒÆ¶¯ÊýֵУÕý¡£ÔÚÀûÓü¤¹â·¶Î§´«¸ÐÆ÷¶ÔÎïÌåÒÆ¶¯ÊýÖµ½øÐмÆËãʱºò£¬ÒòΪ¼¤¹â´«¸ÐÆ÷¶Ô¿Õ¼äµÄɨÃè½á¹ûÀàËÆÈô¸ÉÌõƽÐÐÐéÏßµÄɨÃèµã¼¯£¬ËùÒÔÔÚ½øÐеü´ú×î½üµã·¨(Iterative Closest Point)¶ÔÎïÌåÒÆ¶¯Ç°ºÍÒÆ¶¯ºóµÄɨÃèµã¼¯½øÐÐÄâºÏµÄʱºò£¬¼ÆËã³öÀ´µÄÒÆ¶¯ÊýÖµÒòΪɨÃèµã¼¯ÐÎ×´µÄÎÊÌ⣬¾ßÓйÌÓеÄÎó²îȱÏÝÐÔ¡£
·¢Ã÷ÄÚÈݱ¾ÊµÓÃÐÂÐÍËùÒª½â¾öµÄ¼¼ÊõÎÊÌâÊÇÌṩһÖÖÄܹ»¾«È·²âÁ¿¹ÜµÀ¿Õ¼äÖÐÎïÌåÒÆ¶¯µÄ×°Öᣱ¾ÊµÓÃÐÂÐͽâ¾öÉÏÊö¼¼ÊõÎÊÌâËù²ÉÓõļ¼Êõ·½°¸ÎªÒ»ÖֹܵÀ¿Õ¼äÖо«È·²âÁ¿ÎïÌåÒÆ¶¯µÄ×°Öã¬ÆäÌØÕ÷ÔÚÓÚ°üÀ¨Ò»¼Ó¹Ì±Ê¼Ç±¾µçÄÔ£¬Ò»¼¤¹â·¶Î§´«¸ÐÆ÷£¬Ò»Êܶæ»úÇý¶¯µÄÐýתƽ̨£¬ÒÔ¼°Ò»ÊÜ¿ØÒƶ¯ÎïÌ壬ËùÊöÊÜ¿ØÒƶ¯µÄÎïÌåÖÃÓÚ´ý²âÎïÌåµÄǰ·½»òÕߺ󷽣¬ËùÊö¶æ»úÒÔ¼°Ðýתƽ̨װÓÚ´ý²âµÄÎïÌåÉÏ£¬²¢ÇÒ¼¤¹â·¶Î§´«¸ÐÆ÷ÉèÖÃÓÚÐýתƽ̨ÉÏËæ×ÅÐýתƽ̨µÄת¶¯¶ÔËÄÖܽøÐÐɨÃ裬¸ÃÊÜ¿ØÒƶ¯ÎïÌåͨ¹ýÎÞÏßͨÐÅÄ£¿éÓë¼Ó¹Ì±Ê¼Ç±¾µçÄÔÖ®¼ä½øÐÐͨÐŽø¶ø¸Ã¼Ó¹Ì±Ê¼Ç±¾µçÄÔ¿ØÖƸÃÊÜ¿ØÒƶ¯ÎïÌåµÄÔ˶¯£¬¸Ã¼Ó¹Ì±Ê¼Ç±¾µçÄÔ»¹Á¬½ÓÖÁ¸Ã¶æ»ú½ø¶ø¿ØÖÆÐýתƽ̨µÄÐýת£¬²¢ÇҼӹ̱ʼDZ¾Á¬½Ó¼¤¹â·¶Î§´«¸ÐÆ÷£¬ÓÃÓڼǼ¼¤¹â·¶Î§´«¸ÐÆ÷ɨÃèµÄÊý¾Ý½øÐÐÔËËã²¢ÇÒ¿ØÖƼ¤¹â·¶Î§´«¸ÐÆ÷µÄɨÃ衣ΪÁËʹÊÜ¿ØÒƶ¯ÎïÌå¸üÈÝÒ×±»¼¤¹â·¶Î§´«¸ÐÆ÷ɨÃèµ½£¬ËùÊöÊÜ¿ØÒƶ¯ÎïÌåÉÏÉèÓÐÒ»ÔöÇ¿·´Éä°å¡£ÓëÏÖÓм¼ÊõÏà±È£¬±¾ÊµÓÃÐÂÐ͵ÄÓŵãÔÚÓÚÀûÓôøÓÐÔöÇ¿·´Éä°åµÄÊÜ¿ØÒƶ¯ÎïÌå³äµ±Â·±ê£¬´Ó¶ø¸Ä±äÁËɨÃèµã¼¯µÄÐÎ×´£¬Ê¹µÃÀûÓõü´ú×î½üµã·¨(Iterative Closest Point)¶ÔÎïÌåÒÆ¶¯ÊýÖµµÄ¼ÆËã¸üΪ¾«È·¡£
ͼIΪ±¾ÊµÓÃÐÂÐÍ×°ÖõĽṹ¿ò¼Üͼ¡£Í¼2Ϊ±¾ÊµÓÃÐÂÐÍ×°ÖõIJâÁ¿¹ý³Ìͼ¡£
¾ßÌåʵʩ·½Ê½
ÒÔϽáºÏ¸½Í¼ÊµÊ©Àý¶Ô±¾ÊµÓÃÐÂÐÍ×÷½øÒ»²½ÏêϸÃèÊö¡£[0010]±¾ÊµÓÃÐÂÐ͵ĹܵÀÖо«È·²âÁ¿ÎïÌåÒÆ¶¯µÄ×°Öã¬ÈçͼIËùʾ£¬°üÀ¨Ò»¼Ó¹Ì±Ê¼Ç±¾µçÄÔ£¬Ò»¼¤¹â·¶Î§´«¸ÐÆ÷£¬Ò»Êܶæ»úÇý¶¯µÄÐýתƽ̨£¬ÒÔ¼°Ò»ÊÜ¿ØÒƶ¯ÎïÌ壬Èçͼ2Ëùʾ£¬ÆäÖг¤·½ÐεıíʾÊÜ¿ØÒƶ¯ÎïÌ壬·ÅÖÃÓÚ´ý²âÎïÌåµÄǰ·½»òÕߺ󷽣¬·½ÐδøÈý½ÇÐεÄÎïÌå±íʾ´ý²âÎïÌ壬ÐéÏß±íʾ¼¤¹â·¶Î§´«¸ÐÆ÷µÄÄ£ÄâɨÃ輤¹â¡£ÓÅÑ¡µØ£¬ÓÉÓÚÊÜ¿ØÒƶ¯ÎïÌå¿ÉÄÜ»áÊDz»¹æÔòÐÎ×´²¢ÇÒ²»ÈÝÒ×±»¼¤¹â·¶Î§´«¸ÐÆ÷ɨÃèµ½£¬Òò´Ë¸ÃÊÜ¿ØÒƶ¯ÎïÌåÉÏ»¹´øÓÐÔöÇ¿·´Éä°å£¬¸ÃÔöÇ¿·´Éä°åΪ±íÃæÆ½ÕûÓÐÀûÓÚÂþ·´ÉäµÄƽ°å£¬ÔÚ±¾ÊµÓÃÖвÉÓõÄÊÇÆ½ÕûµÄ°×É«PVC°å²Ä¡£¸Ã´ý²âÎïÌåÉϰ²×°Ðýתƽ̨£¬¸ÃÐýתƽ̨ÉÏÉèÖÃÓм¤¹â·¶Î§´«¸ÐÆ÷¶ÔÖÜΧ»·¾³½øÐÐɨÃ裬ÊÜ¿ØÒƶ¯ÎïÌåͨ¹ýÎÞÏßͨÐÅÄ£¿éÓë¼Ó¹Ì±Ê¼Ç±¾µçÄÔÖ®¼ä½øÐÐͨÐŽø¶ø¿ØÖƸÃÊÜ¿ØÎïÌåµÄÒÆ¶¯¡£¸Ã¶æ»úÒ²Óë¸Ã¼Ó¹Ì±Ê¼Ç±¾µçÄÔ½øÐÐÁ¬½Ó½ø¶øÇý¶¯Ðýתƽ̨µÄÐýתʹ¼¤¹â·¶Î§´«¸ÐÆ÷¶ÔÖÜΧ»·¾³½øÐÐɨÃ裬¸Ã¼Ó¹Ì±Ê¼Ç±¾µçÄÔÓÚ¼¤¹â·¶Î§´«¸ÐÆ÷½øÐÐÁ¬½Ó£¬ÓÃÓڼǼ¼¤¹â·¶Î§´«¸ÐÆ÷ɨÃèµÄÊý¾Ý½øÐÐÔËËã²¢ÇÒ¿ØÖƼ¤¹â·¶Î§´«¸ÐÆ÷µÄɨÃè¡£ÓÅÑ¡µØ£¬ÆäÖм¤¹â·¶Î§´«¸ÐÆ÷²ÉÓñ±Ñóµç»úÖêʽ»áÉçÉú²úµÄURG-04LX£¬¶æ»ú²ÉÓÃR0BITISÉçÉú²úµÄDynamixelϵÁÐµÄ DX-117¡£²âÁ¿¹ý³ÌÈçÏÂËùʾ£¬Èçͼ2aËùʾ£¬ÊÜ¿ØÒƶ¯ÎïÌåÏȱ»¿ØÖÆÒƶ¯µ½±»²âÎïÌåµÄǰ·½£¬»òÕߺ󷽣¬È¡¾öÓÚ¼¤¹â·¶Î§´«¸ÐÆ÷µÄɨÃè·½Ïò£¬È»ºó±£³Ö¾²Ö¹£»Èçͼ2bËùʾ£¬±»²âÎïÌåÒÆ¶¯Ç°£¬ÏÈÀûÓü¤¹â·¶Î§´«¸ÐÆ÷È¡µÃÒÆ¶¯Ç°µÄ¿Õ¼äɨÃèÊýÖµ¡£È»ºó±»²âÎïÌåÒÆ¶¯Ò»¶Î¾àÀëºÍ½Ç¶Èºó¾²Ö¹£¬Èçͼ2cËùʾ£¬ÆäÖÐÐéÏß±íʾ´ý²âÎïÌåÔ˶¯Ç°µÄλÖã¬ÊµÏß±íʾÔ˶¯ºóµÄλÖã¬ÔÙÀûÓü¤¹â·¶Î§´«¸ÐÆ÷È¡µÃÒÆ¶¯ºóµÄ¿Õ¼äɨÃèÊýÖµ£¬È»ºóÀûÓõü´ú×î½üµã·¨(Iterative Closest Point)¶ÔÒÆ¶¯Ç°ºóµÄ¿Õ¼äɨÃèÊýÖµ½øÐÐÄâºÏ,¼ÆËã³ö±»²âÎïÌåµÄÒÆ¶¯ÊýÖµ¡£È»ºóÊÜ¿ØÒƶ¯ÎïÌå¼ÌÐøÒÆ¶¯£¬È»ºó¿É¼ÌÐø½øÐб»²âÎïÌåµÄ²âÁ¿£¬Èçͼ2dËùʾ£¬ÆäÖÐÐéÏß±íʾÔ˶¯Ç°µÄλÖã¬ÊµÏß±íʾÔ˶¯ºóµÄλÖá£Í¨¹ý¼Ç¼ÏÂÀ´µÄ¶æ»úÐýת½Ç¶ÈºÍÿ¸ö½Ç¶ÈÉϼ¤¹â·¶Î§´«¸ÐÆ÷¶Ô¿Õ¼äµÄɨÃèÊý¾Ý£¬¿ÉÒÔÈ¡µÃ¶Ô¿Õ¼äµÄÈýάɨÃèÊý¾Ý£¬ÔÙÀûÓõü´ú×î½üµã·¨(Iterative Closest Point)¶Ôÿһ´ÎÒÆ¶¯Ç°ºÍÒÆ¶¯ºóµÄÈýά¿Õ¼äɨÃèÊý¾Ý½øÐÐÄâºÏ£¬´Ó¶ø¾«È·µØ¼ÆËã³öÎïÌåÿһ´ÎÒÆ¶¯ÊýÖµ£¬°üÀ¨Òƶ¯¾àÀëºÍ½Ç¶È¡£±¾ÁìÓò¼¼ÊõÈËÔ±¿ÉÒÔÁ˽⵽£¬µü´ú×î½üµã·¨ËäÊdz£ÓõÄÒ»ÖÖÊýÖµÄâºÏ·½·¨£¬Èç¹ûÔÚ´ý²âÎïÌåµÄǰ·½»òÕߺó·½Ã»ÓÐÉèÖÃÊÜ¿ØÒƶ¯µÄÎïÌ壬ÔòÓü¤¹â·¶Î§´«¸ÐÆ÷ɨÃè³öÀ´µÄ¿Õ¼äɨÃè½á¹ûΪÈô¸ÉÌõƽÐÐÐéÏßµÄɨÃèµã¼¯£¬ËùÒÔÔÚ½øÐеü´ú×î½üµã·¨(Iterative ClosestPoint)¶ÔÎïÌåÒÆ¶¯Ç°ºÍÒÆ¶¯ºóµÄɨÃèµã¼¯½øÐÐÄâºÏµÄʱºò£¬¼ÆËã³öÀ´µÄÒÆ¶¯ÊýÖµÒòΪɨÃèµã¼¯ÐÎ×´µÄÎÊÌ⣬¾ßÓйÌÓеÄÎó²îȱÏÝÐÔ¡£µ«ÊÇÔÚ´ý²âÎïÌåµÄǰ·½»òÕߺó·½ÉèÖÃÊÜ¿ØÒƶ¯µÄÎïÌåºó£¬¸ÃÊÜ¿ØÒƶ¯µÄÎïÌåÏ൱ÓÚ·±ê£¬Ê¹µÃ¼¤¹â·¶Î§´«¸ÐÆ÷ɨÃè³öÀ´µÄɨÃèµã¼¯ÎªÀàËÆÈô¸ÉÌõÐéÏߵġ°¦°¡±ÐÎ×´µÄɨÃèµã¼¯£¬Òò´ËÔÚ¶ÔÕâÑùµÄɨÃèµã¼¯Óõü´ú×î½üµã·¨½øÐÐÊý¾ÝÄâºÏºó£¬¼ÆËã³öµÄÎïÌåÿ´ÎÒÆ¶¯µÄÊýÖµ½«¸üΪ¾«È·£¬Ã¿Ãׯ½¾ùÎó²î¿ÉСÓÚI. 25%£¬¶øÍ¬ÑùµÄ¾àÀ룬ÈçÓòâ¾à·¨À´¼ÆË㣬ÿÃׯ½¾ùÎó²î¿É´ï2. 5%×óÓÒ¡£¸Ã¹ÜµÀ¿Õ¼äÖо«È·²âÁ¿ÎïÌåÒÆ¶¯µÄ×°ÖÃÀûÓôøÓÐÔöÇ¿·´Éä°åµÄÊÜ¿ØÒƶ¯ÎïÌå³äµ±Â·±ê£¬´Ó¶ø¸Ä±äÁËɨÃèµã¼¯µÄÐÎ×´£¬Ê¹µÃÀûÓõü´ú×î½üµã·¨(Iterative Closest Point)¶ÔÎïÌåÒÆ¶¯ÊýÖµµÄ¼ÆËã¸üΪ¾«È·£¬Ã¿Ãׯ½¾ùÎó²îСÓÚI. 25%¡£³ýÉÏÊöʵʩÀýÍ⣬±¾ÊµÓÃÐÂÐÍ»¹°üÀ¨ÓÐÆäËûʵʩ·½Ê½£¬·²²ÉÓõÈͬ±ä»»»òÕßµÈÐ§Ìæ»»·½Ê½Ðγɵļ¼Êõ·½°¸£¬¾ùÓ¦ÂäÈ뱾ʵÓÃÐÂÐÍȨÀûÒªÇóµÄ±£»¤·¶Î§Ö®ÄÚ¡£
ȨÀûÒªÇó1.Ò»ÖֹܵÀ¿Õ¼äÖо«È·²âÁ¿ÎïÌåÒÆ¶¯µÄ×°Öã¬ÆäÌØÕ÷ÔÚÓÚ°üÀ¨Ò»¼Ó¹Ì±Ê¼Ç±¾µçÄÔ£¬Ò»¼¤¹â·¶Î§´«¸ÐÆ÷£¬Ò»Êܶæ»úÇý¶¯µÄÐýתƽ̨£¬ÒÔ¼°Ò»ÊÜ¿ØÒƶ¯ÎïÌ壬ËùÊöÊÜ¿ØÒƶ¯µÄÎïÌåÖÃÓÚ´ý²âÎïÌåµÄǰ·½»òÕߺ󷽣¬ËùÊö¶æ»úÒÔ¼°Ðýתƽ̨װÓÚ´ý²âµÄÎïÌåÉÏ£¬²¢ÇÒ¼¤¹â·¶Î§´«¸ÐÆ÷ÉèÖÃÓÚÐýתƽ̨ÉÏËæ×ÅÐýתƽ̨µÄת¶¯¶ÔËÄÖܽøÐÐɨÃ裬¸ÃÊÜ¿ØÒƶ¯ÎïÌåͨ¹ýÎÞÏßͨÐÅÄ£¿éÓë¼Ó¹Ì±Ê¼Ç±¾µçÄÔÖ®¼ä½øÐÐͨÐŽø¶ø¸Ã¼Ó¹Ì±Ê¼Ç±¾µçÄÔ¿ØÖƸÃÊÜ¿ØÒƶ¯ÎïÌåµÄÔ˶¯£¬¸Ã¼Ó¹Ì±Ê¼Ç±¾µçÄÔ»¹Á¬½ÓÖÁ¸Ã¶æ»ú½ø¶ø¿ØÖÆÐýתƽ̨µÄÐýת£¬²¢ÇҼӹ̱ʼDZ¾Á¬½Ó¼¤¹â·¶Î§´«¸ÐÆ÷£¬ÓÃÓڼǼ¼¤¹â·¶Î§´«¸ÐÆ÷ɨÃèµÄÊý¾Ý½øÐÐÔËËã²¢ÇÒ¿ØÖƼ¤¹â·¶Î§´«¸ÐÆ÷µÄɨÃè¡£
2.ÈçȨÀûÒªÇóIËùÊöµÄ¾«È·²âÁ¿ÎïÌåÒÆ¶¯µÄ×°Öã¬ÆäÌØÕ÷ÔÚÓÚËùÊöÊÜ¿ØÒƶ¯ÎïÌåÉÏÉèÓÐÒ»ÔöÇ¿·´Éä°å¡£
רÀûÕªÒªÒ»ÖֹܵÀ¿Õ¼äÖо«È·²âÁ¿ÎïÌåÒÆ¶¯µÄ×°Öã¬ÆäÌØÕ÷ÔÚÓÚ°üÀ¨Ò»¼Ó¹Ì±Ê¼Ç±¾µçÄÔ£¬Ò»¼¤¹â·¶Î§´«¸ÐÆ÷£¬Ò»Êܶæ»úÇý¶¯µÄÐýתƽ̨£¬ÒÔ¼°Ò»ÊÜ¿ØÒƶ¯ÎïÌ壬ËùÊöÊÜ¿ØÒƶ¯µÄÎïÌåÖÃÓÚ´ý²âÎïÌåµÄǰ·½»òÕߺ󷽣¬ËùÊö¶æ»úÒÔ¼°Ðýתƽ̨װÓÚ´ý²âµÄÎïÌåÉÏ£¬²¢ÇÒ¼¤¹â·¶Î§´«¸ÐÆ÷ÉèÖÃÓÚÐýתƽ̨ÉÏËæ×ÅÐýתƽ̨µÄת¶¯¶ÔËÄÖܽøÐÐɨÃ裬¸Ã¼Ó¹Ì±Ê¼Ç±¾µçÄÔÓÃÓڼǼ¼¤¹â·¶Î§´«¸ÐÆ÷ɨÃèµÄÊý¾Ý½øÐÐÔËËã²¢ÇÒ¿ØÖƼ¤¹â·¶Î§´«¸ÐÆ÷µÄɨÃè¡£¸Ã¹ÜµÀ¿Õ¼äÖо«È·²âÁ¿ÎïÌåÒÆ¶¯µÄ×°ÖÃÀûÓôøÓÐÔöÇ¿·´Éä°åµÄÊÜ¿ØÒƶ¯ÎïÌå³äµ±Â·±ê£¬´Ó¶ø¸Ä±äÁËɨÃèµã¼¯µÄÐÎ×´£¬Ê¹µÃÀûÓõü´ú×î½üµã·¨(Iterative Closest Point)¶ÔÎïÌåÒÆ¶¯ÊýÖµµÄ¼ÆËã¸üΪ¾«È·£¬Ã¿Ãׯ½¾ùÎó²îСÓÚ1.25£¥¡£
Îĵµ±àºÅG01C3/00GK202382727SQ20112053653
¹«¿ªÈÕ2012Äê8ÔÂ15ÈÕ ÉêÇëÈÕÆÚ2011Äê12ÔÂ20ÈÕ ÓÅÏÈȨÈÕ2011Äê12ÔÂ20ÈÕ
·¢Ã÷ÕßÁõÓñÁ¼, ÀîÔÏÀÚ ÉêÇëÈË:Õ㽺£ÑóѧԺ