Á£×ÓÂ˲¨ÔÚGPS ¶¯Ì¬Â˲¨ÖеÄÓ¦ÓÃÕªÒª_˶ʿÂÛÎÄ
·¢²¼Ê±¼ä£º
2015-03-20
À´Ô´£º
ÈË´ó¾¼ÃÂÛ̳
Á£×ÓÂ˲¨ÔÚGPS ¶¯Ì¬Â˲¨ÖеÄÓ¦ÓÃÕªÒª_˶ʿÂÛÎÄ
ÒýÑÔ
½üÄêÀ´ÈËÃǶÔGPS µ¼º½µÄÒªÇóÔ½À´Ô½¸ß£¬¶ÔÓÚGPS Â˲¨ÀíÂÛµÄÑо¿Ò²Ô½À´Ô½¶à¡£¾µä¿¨¶ûÂüÂ˲¨Æ÷Ò»Ö±Êǵ¼º½ÁìÓòÂ˲¨Ñо¿µÄÖ÷Ìâ¡£µ«ÊǾµä¿¨¶ûÂüÂ˲¨Æ÷Ö»ÊǶÔÏßÐÔϵͳºÍ¸ß˹°×ÔëÉùÊÊÓã¬ËùÒÔ¶ÔÓÚ·ÇÏßÐԷǸß˹ÔëÉùµÄ×éºÏµ¼º½ÏµÍ³µÄÂ˲¨ÀíÂÛµÄÑо¿Ò²Ô½À´Ô½¶à¡£
ÓÈÆäÊÇÊÊÓ¦ÄÜÁ¦¸üÇ¿£¬Â˲¨Ð§¹û¸üºÃµÄÂ˲¨Ëã·¨¡£ÆäÖУ¬ºÜ¶àÊÇ»ùÓÚ¾µä¿¨¶ûÂüÂ˲¨Ëã·¨[1,2,5]
µÄ¸Ä½øËã·¨¡£°üÀ¨£¬ÊÊÓ¦·ÇÏßÐÔϵͳµÄÀ©Õ¹¿¨¶ûÂüÂ˲¨¡¢×ÔÊÊÓ¦¿¨¶ûÂüÂ˲¨Ëã·¨¡¢ÎÞ¼£¿¨¶ûÂüÂ˲¨Ëã·¨µÈµÈ¡£Í¬Ê±£¬Ò²ÓÐһЩÆäËûÐÔÄÜÓÅÔ½µÄÂ˲¨Ëã·¨³öÏÖ¡£Á£×ÓÂ˲¨Ëã·¨¾ÍÊÇÆäÖÐÖ®Ò»¡£±¾ÎĽ«Ó¦ÓÃÁ£×ÓÂ˲¨Ëã·¨µ½GPS ¶¯Ì¬Â˲¨ÖС£²¢Í¨¹ý·ÂÕæ¶Ô±ÈÖ¤Ã÷¸ÃËã·¨±È¾µä¿¨¶ûÂüÂ˲¨Ëã·¨¾ßÓиüºÃµÄÂ˲¨Ð§¹û¡£±ÏÒµÂÛÎÄ´úд£¬¾ÍÀ´±ÏÒµÂÛÎÄÍø¡£
2 GPS ¶¯Ì¬Â˲¨µÄÊýѧģÐÍÈ«Çò¶¨Î»ÏµÍ³£¨GPS-Global Positioning System£©Í¨¹ý¶ÔµÃµ½µÄµ¼º½ÎÀÐǵĵ¼º½µçÎĽâÎöºÍ¼ÆË㣬¿ÉÒԵõ½Óû§µ±Ç°µÄλÖÃÐÅÏ¢£¬°üÀ¨¾Î³¶ÈºÍËٶȵÈÐÅÏ¢¡£¶ÔÓÚµØÃæÔØÌåµÄÔ˶¯¿ÉÒÔ½üËÆÈÏΪĿ±êÊǶþάƽÃæµÄÔ˶¯¡£¼ÙÉèϵͳÊÇÏßÐÔϵͳ£¬ÆäÖÐÔëÉùÊÇ°×ÔëÉù¡£¶ÔÓÚÀëÉ¢µÄÐźţ¬¼ÙÉè²ÉÑùÖÜÆÚΪT £¬µØÃæÔØÌåµÄÔ˶¯¿ÉÒÔ°´¶«¡¢±±¡¢ÌìÏò×ø±ê·Ö½âΪ¶«ÏòÔ˶¯ºÍ±±ÏòÔ˶¯¡£ÔØÌåµÄλÖã¬ËٶȺͼÓËٶȿÉÒÔÓɶ«ÏòºÍ±±ÏòµÄλÖã¬ËٶȺͼÓËٶȺϳɵõ½¡£ÍøÂçÓªÏú±ÏÒµÂÛÎÄ×îÈ«µÄÓªÏú±ÏÒµÂÛÎÄ¡£
2.1 GPS ¶¯Ì¬Â˲¨×´Ì¬·½³ÌÔØÌåµÄÔ˶¯×´Ì¬±äÁ¿¿ÉÒÔȡΪ¶«±±ÏòµÄλÖá¢ËٶȺͼÓËٶȡ£
2.2 GPS ¶¯Ì¬Â˲¨¹Û²â·½³Ì3 ¿¨¶ûÂüÂ˲¨Ëã·¨¿¨¶ûÂüÂ˲¨×´Ì¬¿Õ¼äÄ£ÐÍ¿ÉÒÔÓÉÒÔϵÄ״̬·½³ÌºÍ¹Û²â·½³ÌÃèÊö¡£
4 Á£×ÓÂ˲¨Ëã·¨Á£×ÓÂ˲¨(PF: Particle Filter)µÄ˼Ïë»ùÓÚÃÉÌØ¿¨Âå·½·¨(Monte Carlo methods)£¬ËüÊÇÀûÓÃÁ£×Ó¼¯À´±íʾ¸ÅÂÊ£¬¿ÉÒÔÓÃÔÚÈκÎÐÎʽµÄ״̬¿Õ¼äÄ£ÐÍÉÏ¡£ÆäºËÐÄ˼ÏëÊÇͨ¹ý´ÓºóÑé¸ÅÂÊÖгéÈ¡µÄËæ»ú״̬Á£×ÓÀ´±í´ïÆä·Ö²¼£¬ÊÇÒ»ÖÖ˳ÐòÖØÒªÐÔ²ÉÑù·¨(Sequential ImportanceSampling)¡£¼òµ¥À´Ëµ£¬Á£×ÓÂ˲¨·¨ÊÇָͨ¹ýÑ°ÕÒÒ»×éÔÚ״̬¿Õ¼ä´«²¥µÄËæ»úÑù±¾¶Ô¸ÅÂÊÃܶȺ¯Êý ½øÐнüËÆ£¬ÒÔÑù±¾¾ùÖµ´úÌæ»ý·ÖÔËË㣬´Ó¶ø»ñµÃ״̬×îС·½²î·Ö²¼µÄ¹ý³Ì¡£ÕâÀïµÄÑù±¾¼´Ö¸Á£×Ó,µ±Ñù±¾ÊýÁ¿N¡ú¡Øʱ¿ÉÒԱƽüÈκÎÐÎʽµÄ¸ÅÂÊÃܶȷֲ¼¡£
¾¡¹ÜËã·¨ÖеĸÅÂÊ·Ö²¼Ö»ÊÇÕæʵ·Ö²¼µÄÒ»ÖÖ½üËÆ£¬µ«ÓÉÓڷDzÎÊý»¯µÄÌص㣬Ëü°ÚÍÑÁ˽â¾ö·ÇÏßÐÔÂ˲¨ÎÊÌâʱËæ»úÁ¿±ØÐëÂú×ã¸ß˹·Ö²¼µÄÖÆÔ¼£¬Äܱí´ï±È¸ß˹ģÐ͸ü¹ã·ºµÄ·Ö²¼£¬Ò²¶Ô±äÁ¿²ÎÊýµÄ·ÇÏßÐÔÌØÐÔÓиüÇ¿µÄ½¨Ä£ÄÜÁ¦¡£Òò´Ë£¬Á£×ÓÂ˲¨Äܹ»±È½Ï¾«È·µØ±í´ï»ùÓÚ¹Û²âÁ¿ºÍ¿ØÖÆÁ¿µÄºóÑé¸ÅÂÊ·Ö²¼£¬¿ÉÒÔÓÃÓÚ½â¾öSLAM ÎÊÌâ¡£
SIS Ëã·¨µÄα´úÂëÃèÊö¡£SIS Ëã·¨ÊÇÁ£×ÓÂ˲¨µÄ»ù´¡×é³É²¿·Ö¡£
Á£×ÓÂ˲¨Ë㷨ͨ¹ýSIS Ëã·¨³éÑùµÃµ½Ëæ»úÑù±¾ikx £¬Ò²¾ÍÊÇËù˵µÄ¡°Á£×Ó¡±¡£ÀûÓÃÕâЩ³éÑùÁ£×Ó¸ù¾Ýϵͳ·½³ÌµÃµ½Ñù±¾µÄÔ¤²âºÍ¹éÒ»»¯È¨Öµ¡£È»ºó¸ù¾Ý¸ÅÂʸüк¯ÊýµÃµ½ºóÑé¹À¼Æ¡£
5 »ùÓÚ¿¨¶ûÂüÂ˲¨ºÍÁ£×ÓÂ˲¨µÄGPS ¶¯Ì¬Â˲¨¶Ô±È·ÂÕæ·ÖÎö·ÂÕæÌõ¼þ£ºÏÖ¼ÙÉèµØÃæGPS µ¼º½ÏµÍ³µÄµ¼º½ÐÅÏ¢µÄ²ÉÑùÖÜÆÚT =1s£¬ÔØÌå³õʼλÖÃλÓÚ¶«±±Ïò×ø±êϵϵÄԵ㡣ÔØÌåµÄÒÔ¶«Ïò3m/ sµÄËٶȺͱ±Ïò3m/ sµÄËÙ¶ÈÔÈËÙÐÐÊ»£¬¼ÙÉèGPS ¶¨Î»Îó²îΪ20m£¬¼´ÔÚ¶«±±ÏòµÄλÖÃÉϵþ¼ÓÉÏN(0,(20m)2 ) µÄ°×ÔëÉù¡£ÔËÐÐʱ¼äΪ100s ¡£
6 ½áÂÛ±¾Îĸø³öÁË»ùÓÚÁ£×ÓÂ˲¨µÄGPS ¶¯Ì¬Â˲¨·½·¨¡£²¢ÇÒÓÃʵÑéÖ¤Ã÷Á˱¾Ëã·¨µÄÓÐЧÐÔÒÔ¼°½Ï¾µä¿¨¶ûÂüÂ˲¨Ëã·¨µÄÓÅÔ½ÐÔ¡£¾Á£×ÓÂ˲¨µÄGPS ¶¯Ì¬Â˲¨µÄRMS Îó²î¸üµÍ£¬µ¼º½¾«¶ÈÏà¶Ô¾µä¿¨¶ûÂüÂ˲¨Ëã·¨ÒªºÃµÃ¶à¡£