Ò»¡¢ÎªºÎ̸¹ßÐÔµ¼º½£¿ÔÚÒ»Ñùƽ³£µÄµ¼º½ÌåÑé±³ºó£¬Òþ²Ø×ÅÒ»Ì×¼«¾ß¡°×ÔÖú¡±ÄÜÁ¦µÄ¶¨Î»Âß¼¡£¹ßÐÔµ¼º½µÄ½¹µãÊÇ¡°¿¿×Ô¼º¸ÐÖªÔ˶¯¡±£¬Ëüͨ¹ý¸ÐÖª×ÔÉíµÄ¼ÓËÙÂʺͽÇËÙÂÊ£¬ÍÆËã³öÄ¿½ñλÖá¢ËÙÂÊÓë×Ë̬¡£×î³£ÓõĴ«¸ÐÆ÷ÊǹßÐÔÕÉÁ¿µ¥Î»£¨IMU£©£¬ÄÚÀO³ÉÁËÈýÖá¼ÓËÙÂʼƺÍÈýÖáÍÓÂÝÒÇ£¬ÓÐʱ»¹»áÅ䱸´ÅÁ¦¼ÆÓëÆøÑ¹¼Æ£¬ÓÃÓÚÔöÇ¿×Ë̬ºÍ¸ß¶ÈµÄÅжϡ£
ÀíÂÛÉÏ£¬Ö»Òª´«¸ÐÆ÷Êý¾Ý¿É¿¿£¬ÏµÍ³¾ÍÄܲ»ÒÀÀµÍⲿÐźÅÒ»Á¬ÊÂÇé¡£ÕâÖÖ×ÔÎÒ¸ÐÖªµÄÄÜÁ¦£¬Ê¹¹ßÐÔµ¼º½ÔÚÎÀÐÇÐźÅÊÜÏÞ¡¢ÊÒÄÚÇéÐΡ¢Ç±Ë®Ó뺽º£µÈ¼«¶Ë³¡¾°ÖУ¬³ÉΪһ¸ö¡°¿É¿¿µÄ»ùʯ¡±¡£
¶þ¡¢½¹µãÔª¼þÓëÊÂÇéÔÀí¡£IMUµÄÁ½´óÖ÷½ÇÊǼÓËÙÂʼƺÍÍÓÂÝÒÇ¡£¼ÓËÙÂʼƲâÈýÆ«ÏòµÄÏßÐÔ¼ÓËÙÂÊ£¬ÍÓÂÝÒDzâÈýÆ«ÏòµÄ½ÇËÙÂÊ¡£½«½ÇËÙÂÊ»ý·Ö»ñµÃ×Ë̬£¨º½Ïò¡¢¸©Ñö¡¢ºá¹ö£©£¬ÔÙÁ¬Ïµ¶ÔÖØÁ¦³¡µÄÃ÷È·£¬°ÑÊӲ쵽µÄ×ܼÓËÙÂÊÆÊÎö³öÖØÁ¦·ÖÁ¿ºÍÏÖʵÔ˶¯·ÖÁ¿£¬½ø¶ø¶ÔËÙÂʾÙÐлý·Ö»ñµÃÎ»ÒÆ¡£
ÀíÂÛÉÏÕâÒ»Á¬´®µÄ»ý·Ö¾ÍÏñ°Ñ¡°Ï¸Ð¡³ÌÐò¡±ÀÛ»ý³É¡°ÐнøµÄ¹ì¼£¡±¡£ÏÖʵ²»»áÕâôÎÂÈ᣺´«¸ÐÆ÷±£´æËæ»úÔëÉù¡¢Æ«Öá¢ÎÂ¶ÈÆ¯ÒÆÒÔ¼°±ê×¼Îó²î£¬ËùÓÐÕâЩ¶¼»áÈÃÆ¯ÒÆÇÄÇÄ»ýÀÛ£¬µ¼ÖÂʱ¼äÔ½³¤£¬¶¨Î»Ô½Æ«ÀëÕæÊµÖµ¡£ÕâÒ²Êǵ¥¶ÀʹÓùßÐÔµ¼º½µÄÒ»¸öÖ÷ÒªÌôÕ½¡£
Èý¡¢Îó²îÔ´ÓëÌôÕ½¡£¹ßÐÔµ¼º½µÄ½¹µãÄÑÌ⣬ÊÇÎó²î»ýÀÛ´øÀ´µÄÆ¯ÒÆ¡£Ëæ»úÔëÉù»áʹЧ¹û¿´ÆðÀ´ÔÚ²ü¶¶£¬Æ«ÖûáÏñºã¶¨µÄбÏߣ¬ËæÊ±¼äÏßÐÔ»ýÀ۳ɲ»¿ÉºöÊӵĹ켣Îó²î¡£Î¶Èת±ä¡¢»úеÕñ¶¯¡¢´Å³¡×ÌÈÅ¡¢´«¸ÐÆ÷ÀÏ»¯µÈ¶¼»á·Å´óÕâЩÎó²î¡£ÌØÊâÊÇÔÚÐèÒª³¤Ê±¼äÒ»Á¬¶¨Î»µÄ³¡¾°£¨ÈçÎÞÈË»úµÄ³¤º½Ïß¡¢»úеÈËÊÒÄÚµ¼º½¡¢Ç±Í§ÏÂDZµÈ£©£¬½ö¿¿IMUºÜÄÑά³Ö¸ß¾«¶È£¬ÐèÒªÍⲿÐÅÏ¢À´¡°Ð£ÕýÎó²î¡±¡£
ËÄ¡¢ÎªºÎÐèÒª×éºÏµ¼º½£¿ÈôÊÇ˵¹ßÐÔµ¼º½ÊÇ¡°×ÔÎÒ¸ÐÖª¡±µÄÒýÇæ£¬ÄÇô×éºÏµ¼º½¾ÍÊÇ¡°Íⲿ²ÎÕÕµÄУ׼ʦ¡±¡£°ÑIMU»ñµÃµÄÔ˶¯ÐÅÏ¢ÓëÍⲿ´«¸ÐÊӲ죨ÈçGNSS¡¢ÊÓ¾õ¡¢À×´ï¡¢µØ´ÅµÈ£©¾ÙÐÐÈںϣ¬¿ÉÒÔÔÚ²î±ðʱ¼ä¶Î¡¢²î±ðÇéÐÎÏÂÌî²¹Ï໥µÄ¶Ì°å¡£GNSSÔÚ¿ª·ÅÇøÓò¿ÉÒÔÌṩ¾ø¶Ô¶¨Î»£¬µ«ÔÚ÷缯¶¼»áÏ¿¹È¡¢ÊÒÄÚ»òÌìÆø²»¼ÑʱÐźÅÈÝÒ×ɥʧ£»ÊÓ¾õºÍÀ×´ïµÈ¸ÐÖªÔò¶ÔÇéÐÎת±äÃô¸Ðµ«ÈÝÒ×ÊÜÕÚµ²»òÎÆÀíÏ£º±Ó°Ïì¡£
ͨ¹ýºÏÊʵÄÈÚºÏÕ½ÂÔ£¬ÏµÍ³¼È±£´æ¹ßÐÔµ¼º½ÔÚ¸ßÆµÂÊÉϵÄÏìÓ¦ËÙÂÊ£¬ÓÖÄÜÔÚÊÓ²ìÐźÅÎȹÌʱʵÏÖºã¾ÃµÄ¸ß¾«¶È¶¨Î»¡£Äã¿ÉÒÔ°Ñ×éºÏµ¼º½ÏëÏó³ÉÒ»¸ö¡°¶àÔ´¹²Ê¶¡±µÄÀú³Ì£ºÈòî±ð´«¸ÐÆ÷µÄÓÅÊÆÏ໥µÖÏû£¬»ñµÃ¸üÎȽ¡µÄ¶¨Î»Ð§¹û¡£
Îå¡¢ÂäµØÇ°µÄÐÄ·¨¡£Òª°Ñ¹ßÐÔµ¼º½´ÓÀíÂÛÄð³É¿ÉÂ䵨µÄϵͳ£¬ÏÈÒªÇåÎúÁ½¼þÊ£ºÒ»ÊÇÄãÐèÒª½â¾öµÄÆ¯ÒÆÈªÔ´ÔÚÄÇÀ¶þÊÇÍⲿÊÓ²ìÊý¾ÝÄÜÔÚÄÄЩʱ¼ä¶ÎÌṩÓÐÓþÀÆ«¡£¼òÆÓµÄõè¾¶ÊÇÏȽ¨ÉèÒ»¸ö»ùÏßµÄIMU¨C×Ô´øµÄ״̬Ԥ¼ÆÄ£×Ó£¬ËæºóÖð²½ÒýÈëÍⲿÊÓ²ìÒÔʵÏÖÎó²îÐÞÕý¡£½ÓÏÂÀ´µÄÊÂÇ飬¾ÍÊÇÑ¡ÔñºÏÊʵÄÈںϼܹ¹¡¢½¨ÉèºÏÀíµÄ״̬ģ×Ó¡¢²¢¾ÙÐгä·ÖµÄ·ÂÕæÓëʵµØ²âÊÔ¡£
ÏÂÒ»²¿·ÖÎÒÃǰѡ°ÔÀíµ½ÊµÏÖ¡±µÄÇÅÁºÀÖ±£¬¸ø³öÏêϸµÄ°ì·¨ºÍ¿ÉÂ䵨µÄÕ½ÂÔ£¬×ÊÖúÄã°ÑÕâ·Ý¡°×ÔÎÒ¸ÐÖª¡±Äð³ÉÏÖʵ¿ÉÓõĵ¼º½ÄÜÁ¦¡£
Ò»¡¢×éºÏµ¼º½µÄ½¹µãÍ·ÄÔÓë³£Óÿò¼Ü¡£×éºÏµ¼º½²»Êǵ¥µãµÄÊÖÒÕ£¬¶øÊÇÒ»¸ö¶à´«¸ÐÆ÷ÐͬµÄËã·¨¿ò¼Ü¡£×î½¹µãµÄÀíÄÊǽ¨ÉèÒ»¸ö״̬ÏòÁ¿£¬°üÀ¨Î»Öá¢ËÙÂÊ¡¢×Ë̬¡¢´«¸ÐÆ÷Æ«ÖõȱäÁ¿¡£ÊӲ췽³Ì°ÑÍⲿ´«¸ÐÆ÷µÄÐźÅÓ³É䵽״̬¿Õ¼ä£¬Í¨³£Óõ½µÄÒ»À๤¾ßÊÇ¿¨¶ûÂüÂ˲¨¼°Æä±äÌ壨ÈçÀ©Õ¹¿¨¶ûÂüÂ˲¨¡¢ÎÞ¼£¿¨¶ûÂüÂ˲¨µÈ£©¡£
ÔÚ¸ßÆµ¹ßÐÔÊý¾ÝºÍµÍƵÊÓ²ìÊý¾ÝÖ®¼ä£¬Â˲¨Æ÷ÒÔȨºâµÄ·½·¨¸üÐÂ״̬Ԥ¼Æ£¬Ê¹Îó²î×îС»¯¡£ÕâÑù£¬ÏµÍ³¼ÈÄÜ¿ìËÙÏìÓ¦£¨¿¿IMU£©£¬ÓÖÄÜÔÚ°´ÆÚÊӲ쵽µÄÍⲿÐźÅÎȹÌʱ¾ÙÐС°½ÃÕý¡±£¨¿¿GNSS¡¢ÊÓ¾õ¡¢À×´ïµÈ£©¡£¼ò¶øÑÔÖ®£¬×éºÏµ¼º½Êǰѡ°×ÔÎÒ¸ÐÖª¡±ºÍ¡°Íⲿ֤¾Ý¡±ÎÕÔÚͳһ¿òÀïµÄÒ»ÖÖ×ÛºÏÅжϡ£
¶þ¡¢³£¼ûÈÚºÏÕ½ÂÔÓ볡¾°¡£ÈÚºÏÕ½ÂÔ´óÖ¿ɷÖΪËÉñîºÏ£¨Loosely-coupled£©¡¢½ôñîºÏ£¨Tightly-coupled£©Ó볬½ôñîºÏ£¨Ultra-tight£©¡£ËÉñîºÏ°ÑÍⲿÊÓ²ì×÷Ϊ×ÔÁ¦µÄÊÓ²ìÊäÈ룬ÊʺÏÍⲿÐźÅÎȹÌÇÒÊÓ²ìÐÅÏ¢Á¿´óʱµÄʵÏÖ£»½ôñîºÏ°ÑÍⲿÊÓ²ìÖ±½ÓÓëIMUÊý¾ÝÒ»Æð½¨Ä££¬¿ÉÒÔ¸üºÃµØ´¦Öóͷ£ÈõÐźźͶàÔ´´«¸ÐÆ÷µÄÐͬ£»³¬½ôñîºÏÔòÔÚ¼«¶Ë³¡¾°Ï£¨ÈçÎÞGPSʱµÄÊÓ¾õ/À״︨Öú£©°Ñ¸ü¶à´«¸ÐÐÅÏ¢ÈÚºÏÔÚͳһ״̬·½³ÌÖУ¬ÌáÉý³°ôÐÔ¡£
³£¼ûµÄÓ¦Óó¡¾°°üÀ¨£ºÎÞÈË»úµ¼º½£¨ÐèÒª¸ßƵÏìÓ¦ÓëÎȽ¡¶¨Î»£©¡¢ÖÇÄÜÊÖ»ú/¿ÉÒÂ×Å×°±¸µÄÊÒÄÚ¶¨Î»¡¢×Ô¶¯¼ÝÊ»Óë»úеÈ˵¼º½£¬ÒÔ¼°º£ÉÏ/µØÏÂÇéÐεÄDZº½¶¨Î»µÈ¡£²î±ð³¡¾°Ï£¬Ñ¡ÔñÄÄÖÖñîºÏ·½·¨£¬È¡¾öÓÚ¿ÉÓÃÊӲ졢ÅÌËã×ÊÔ´¡¢¶ÔʱÑÓµÄÈÝÈ̶ȺͶÔ³°ôÐÔµÄÒªÇó¡£
Èý¡¢´ÓÀíÂÛµ½Êµ¼ùµÄÂäÌïµØÖè¡£Òª°Ñ×éºÏµ¼º½ÕæÕýÂ䵨£¬¿ÉÒÔ×ñÕÕÒÔϰ취£º
Ä¿µÄÓë´«¸ÐÆ÷ÆÀ¹À£ºÃ÷È·ÐèÇóµÄ¶¨Î»¾«¶È¡¢¿ÉÓô«¸ÐÆ÷ÓëÔ¤ËãÏÞÖÆ¡£Í¬²½Óë±ê¶¨£ºÈ·±£IMUÓëÍⲿ´«¸ÐÆ÷µÄÊý¾Ýʱ¼äͬ²½£¬¾ÙÐо²Ì¬Ó붯̬±ê¶¨£¬Ô¤¼Æ¸÷´«¸ÐÆ÷µÄÆ«Öᢱ궨ϵÊýÓëÔëÉùÌØÕ÷¡£½¨Éè״̬ÓëÄ£×Ó£ºÃ÷ȷ״̬ÏòÁ¿£¨Î»Öá¢ËÙÂÊ¡¢×Ë̬¡¢IMUÆ«Öᢴ«¸ÐÆ÷±ê¶¨²ÎÊýµÈ£©£¬Éè¼ÆÀú³Ì·½³Ì£¨ÐÎòÔ˶¯Ñ§¡¢´«¸ÐÆ÷¶Ô״̬µÄÓ°Ï죩£¬ÓëÊӲ췽³Ì£¨Íⲿ´«¸ÐÆ÷ÊÓ²ìÓë״̬µÄÓ³É䣩¡£
Ñ¡ÔñÂ˲¨¿ò¼Ü£º»ùÓÚ³¡¾°Ñ¡ÓÃÀ©Õ¹¿¨¶ûÂüÂ˲¨¡¢ÎÞ¼£¿¨¶ûÂüÂ˲¨»òÁ£×ÓÂ˲¨µÈ£»ÉèÖÃÔëÉùз½²î¡¢³õʼÌõ¼þÓë³°ôÐÔÕ½ÂÔ¡£ÏµÍ³ÊµÏÖÓëÑéÖ¤£ºÔÚ·ÂÕæÇéÐÎÖе÷²Î¡¢ÔÙÔÚÕæÊµ³¡¾°ÖÐ×öÀëÏߺÍÔÚÏßÑéÖ¤£¬ÊӲ춨λÎó²î¡¢Æ¯ÒÆÓë³°ôÐÔ¡£ÐÔÄÜÆÀ¹ÀÓëµ÷ÓÅ£ºÍ¨¹ý·ÂÕæÊý¾Ý¡¢È«Á¿²âÊÔ¼¯Óëµä·¶¹¤¿ö£¬µ÷½âÊÓ²ì¸üÐÂÕ½ÂÔ¡¢´«¸ÐÆ÷È¨ÖØ¡¢Æ«ÖÃÔ¤¼ÆÆµÂʵȡ£
ËÄ¡¢ÏÖʵ°¸ÀýÓëÓ¦ÓÃÁé¸Ð¡£ÎÞÈË»úÔÚÖØ´óÇéÐÎÖжԵ¼º½µÄÎȹÌÐÔÒªÇ󼫸ߣ¬ÍùÍùͨ¹ýGNSS/IMU/ÊÓ¾õµÄ¶àÔ´ÈÚºÏÀ´ÊµÏÖÎȽ¡·É¿ØÓë·¾¶¸ú×Ù£»ÖÇÄÜÊÖ»úͨ¹ýÁ¬ÏµIMU¡¢GPS¡¢Í¨Óô«¸ÐÆ÷Êý¾Ý£¬Ìṩ½Ïƽ»¬µÄ²½Ì¬ÓëλÖÃÔ¤¼Æ£¬¸ÄÉÆµØÍ¼¶¨Î»ÓëARÌåÑ飻»úеÈËÇåɨ¡¢²Ö´¢»úеÈ˳£Óü¤¹âÀ×´ï/ÊÓ¾õÓëIMU×éºÏÀ´ÊµÏÖÊÒÄÚµ¼º½ºÍµØÍ¼¸üС£
ÕâЩ°¸Àý±³ºóµÄÅäºÏµã£¬ÊÇ¡°¸ßƵÏìÓ¦+Íⲿ¾ÀÆ«¡±µÄË«ÂÖÇý¶¯¡£Ã÷È·ÁËÕâÒ»µã£¬Äã¾ÍÄÜÔÚ×Ô¼ºµÄ×°±¸»òÏîÄ¿ÖУ¬ÌôÑ¡ºÏÊʵĴ«¸ÐÆ÷×éºÏÓëÈÚºÏÕ½ÂÔ£¬¶ø·Ç±»¼òµ¥´«¸ÐÆ÷µÄ¾ÖÏÞËùÀ§¡£
Îå¡¢Â䵨µÄÊÊÓÃСÌùÊ¿¡£ÏëÔÚ¼Ò×Ô²â×éºÏµ¼º½£¿¿ÉÒÔ´ÓÒ»¸ö¼ò»¯µÄϵͳÈëÊÖ£ºÓÃÒ»¿é´øIMUµÄ¿ª·¢°å£¬ÅäºÏÒ»¸ö¿ÉÓõÄÍⲿÊÓ²ìÔ´£¨ÈçÊÖ»úGPS»ò¼òÆÓµÄÊÓ¾õÀï³Ì¼Æ£©¡£ÏÈÏßÐԱ궨IMUµÄÆ«ÖúÍÔëÉù²ÎÊý£¬ÔÙʵÏÖÒ»¸ö¼òÆÓµÄ¿¨¶ûÂüÂ˲¨Æ÷£¬ÒÔIMUÊý¾ÝΪÖ÷¡¢ÊÓ²ìÊý¾ÝΪ¸¨¾ÙÐÐ״̬¸üС£
È»ºóÔÚ²î±ðÇéÐÎÖÐÅܶ¯»ò×ß¶¯£¬¼Í¼¶¨Î»Îó²îÓëÆ¯ÒÆÇúÏߣ¬½ÏÁ¿ÓÐÎÞÍⲿÊÓ²ìʱµÄ²î±ð¡£Í¨¹ýÕâ¸öѵÁ·£¬Äã»áÖ±¹Û¸ÐÊܵ½£ºÍⲿÊÓ²ìºÎʱÄÜ¡°½ÐÍ£¡±Æ¯ÒÆ£¬IMUÔÚ¸ßÆµÏµĿìËÙÏìÓ¦ÓÖÔõÑù¼á³ÖϵͳµÄÎȹ̡£±ðÍüÁ˶Ôϵͳ¾ÙÐа´ÆÚ±ê¶¨Óë²âÊÔ£¬ÓÉÓÚ´«¸ÐÆ÷µÄ״̬»áËæÊ±¼äºÍÇéÐζø×ª±ä¡£
Áù¡¢¶ÔδÀ´µÄÕ¹ÍûÓëÌðÃÛʵ¼ù¡£Ëæ×ÅËãÁ¦ÌáÉý¡¢´«¸ÐÆ÷±¾Ç®Ï½µ£¬ÒÔ¼°ÔƶËÓë±ßÑØÅÌËãµÄÈںϣ¬×éºÏµ¼º½½«ÔÚ¸ü¶àÒ»Ñùƽ³£³¡¾°ÖгÉΪ¡°¿É´¥´ïµÄ»ù±¾ÄÜÁ¦¡±¡£´ÓÊÒÄÚµ¼º½µ½»§Íâ̽ÏÕ£¬´ÓÎÞÈË»ú·É¿Øµ½Öǻ۶¼»áµÄ¶¨Î»Ð§ÀÍ£¬×éºÏµ¼º½½«ÒÔ¸ü¸ßµÄ³°ôÐÔ¡¢¸üµÍµÄʱÑÓÒÔ¼°¸üµÍµÄ¹¦ºÄ£¬´øÀ´¸üÌù½üÉúÑĵġ°ÌðÃÛ¡±ÌåÑé¡£
Äã¿ÉÒÔ°ÑËüÏëÏó³ÉÒ»ÕÅÒþÐεĵ¼º½Íø£ºÔÚÄãÐèÒªµÄʱ¼ä£¬Íø¸ñÖеĸ÷ÌõÏ߾ͻá×Ô¶¯¶ÔÆë£¬¸øÄãÒ»¸öÎȹ̡¢¿É¿¿µÄÆ«Ïò¸Ð¡£¼ÌÐøÌ½Ë÷¡¢Êµ¼ùÓëÓÅ»¯£¬Äã»á·¢Ã÷£¬µ¼º½ÊÖÒÕ²»ÔÙÊǸßÀäµÄѧÊõÃû´Ê£¬¶øÊÇÒ»Ñùƽ³£ÉúÑÄÖеÄÊÊÓÃͬ°é¡£
ÒÔÉÏÄÚÈÝÏ£ÍûÄÜ×ÊÖúÄãÃ÷È·¹ßÐÔµ¼º½Óë×éºÏµ¼º½µÄÔÀí¡¢ÊµÏÖ˼Ð÷ÓëÂ䵨սÂÔ£¬²¢ÔÚÏÖʵӦÓÃÖлñµÃ¸üÎȹ̡¢¸ü¡°ÌðÃÛ¡±µÄ¶¨Î»ÌåÑé¡£