רÀûÃû³Æ£ºÓÃÓÚ¼ì²âºÍÅųýgnssϵͳÖжà¸öÎÀÐǹÊÕϵķ½·¨ºÍ×°ÖõÄÖÆ×÷·½·¨
¼¼ÊõÁìÓò£º
±¾·¢Ã÷µÄÁìÓòΪÀûÓÃÀ´×ÔÈô¸ÉÎÀÐÇÐÇ×ùµÄ²âÁ¿µÄÎÀÐǵ¼º½ÏµÍ³ËùÌṩµÄÐÅÏ¢µÄÔËÔØÆ÷¡£±¾·¢Ã÷¸ü¾ßÌ嵨ɿ¼°ÎÀÐǶ¨Î»×°ÖúÍÓÃÓÚ¼ì²éÓÉÕâÑùµÄÉ豸´«µÝµÄλÖÃÐÅÏ¢µÄÍêÕûÐԵķ½·¨£¬Äܹ»¼ì²âºÍÅųýÁ½¸öͬʱ·¢ÉúµÄÎÀÐǹÊÕÏ¡£
±³¾°¼¼Êõ£º
ÀýÈç·ÉÐÐÆ÷»ò´¬²°µÄÔËÔØÆ÷¾ßÓÐÐí¶àµ¼º½ÏµÍ³¡£ÔÚÕâЩϵͳÖУ¬Ìرð°üÀ¨INS/GNSS (¹ßÐÔµ¼º½ÏµÍ³/È«ÇòÎÀÐǵ¼º½ÏµÍ³)É豸µÄ»ìºÏ²¿¼þ¡£ÖÐÑë¹ßÐÔµ¥ÔªÌṩÔëÉù²»´ó²¢ÇÒ¶Ìʱ׼ȷµÄÐÅÏ¢¡£È»¶ø£¬ÔÚ³¤Ê±¼äÄÚ£¬ÖÐÑë¹ßÐÔµ¥ÔªµÄ¶¨Î»ÐÔÄܽµµÍ(ÀýÈ磬»ò¶à»òÉÙѸËÙµØÈ¡¾öÓÚ´«¸ÐÆ÷¡¢¼ÓËٶȼƻòÍÓÂÝÒǵÄÖÊÁ¿£¬ÒÔ¼°È¡¾öÓÚÖÐÑëµ¥ÔªËùʹÓõĴ¦Àí²Ù×÷)¡£Èç¹û´ÓÎÀÐǵ¼º½ÏµÍ³»ñµÃµÄÐÅϢƬ¶Î(¶ÔÓÚËüÃÇÀ´Ëµ)²»Ì«¿ÉÄÜÔÚ³¤Ê±¼äÄÚÆ¯ÒÆ£¬µ«ÊÇ£¬ÕâЩÐÅϢƬ¶Î³£³£ÓÐÔëÉùµÄ²¢ÇÒ¾ßÓпɱ侫¶È¡£´ËÍ⣬¹ßÐÔ²âÁ¿×ÜÊÇ¿ÉÓõ쬶øGNSSÐÅÏ¢²¢²»×ÜÊÇ¿ÉÓõĻò¿ÉÄܱ»ÓÕÆ«»òÈÅÂÒ¡£»ìºÏ°üº¬ÓÉÖÐÑë¹ßÐÔµ¥ÔªÌṩµÄÐÅϢƬ¶ÎºÍÓÉÎÀÐǵ¼º½ÏµÍ³ÌṩµÄ²âÁ¿µÄ½áºÏ£¬ÒÔÀûÓÃÁ½¸öϵͳµÄÓŵãÀ´»ñµÃλÖúÍËÙ¶ÈÐÅÏ¢¡£Òò´Ë£¬ÓÉGNSS½ÓÊÕÆ÷ÌṩµÄ²âÁ¿¾«¶ÈʹµÃ¹ßÐÔÆ¯Òƿɿأ¬²¢ÇÒÔëÉù²»´óµÄ¹ßÐÔ²âÁ¿Ê¹µÃ¿ÉÒÔ¶ÔGNSS½ÓÊÕÆ÷µÄ²âÁ¿ÉϵÄÔëÉù½øÐÐÂ˲¨¡£ÒÑÖªµÄGNSS²âÁ¿µÄÄ£ÐͲ»¿¼ÂÇÓ°ÏìʱÖÓ»ò´«ÊäµÄÐÇÀú±íµÄ¿ÉÄܵÄÎÀÐǹÊÕÏ£¬ÕâЩ¹ÊÕÏͨ³£µÄ±íÏÖÐÎʽΪÔÚGNSS²âÁ¿ÉÏµÄÆ«²î»òÆ¯ÒÆ¡£ÔÚ´Ë·¶Î§ÄÚ£¬ÍêÕûÐÔ¼ì²éϵͳµÄÄ¿µÄÊǼì²âÕâЩ¹ÊÕϵķ¢ÉúºÍÅųý¸ºÔðµÄÎÀÐÇ£¬ÒÔÔٴλñµÃ²»ÔÙ°üº¬ÈκηǼì²âÎó²îµÄµ¼º½½â¡£ÔÚINS/GNSS»ìºÏµ¼º½ÏµÍ³ÖУ¬ÔÚÏàͬÐÇ×ùÖеÄÁ½¸öÎÀÐǹÊÕϸÅÂÊСÓÚÍêÕûÐԵķçÏÕ¡£Òò´Ë¸Ãʼþ¹éÒòÓÚÍêÕûÐԵķçÏÕ£¬²¢ÇÒϵͳ½öÐèÒª¼ì²âµ¥¸öÎÀÐǹÊÕϵÄÄÜÁ¦¡£ÓÚÊÇ¿ÉÅųý±»È·¶¨Îª·¢Éú¹ÊÕϵÄÎÀÐÇÒÔÒÖÖÆÎÀÐǹÊÕÏÒýÆðµÄµ¼º½×´Ì¬ÎÛȾ¡£×¨ÓÃÓÚµ¼º½(ÀýÈ磬GPS¡¢Galile, Glonass)µÄÎÀÐÇÐÇ×ùµÄÔö¶àÔö¼ÓÁË¿ÉÓÃÓÚINS/GNSS»ìºÏµ¼º½ÏµÍ³µÄÎÀÐǵÄÊýÁ¿¡£µ«ÊÇ£¬Óöµ½Á½¸öͬʱ·¢ÉúµÄÎÀÐǹÊÕϵĸÅÂʶÔÓÚÍêÕûÐԵķçÏÕ½«²»ÔÙ¿ÉÒÔºöÂÔ²»¼Æ¡£Òò´Ë£¬½«ÐèÒª¸ü¸ßµÄÍêÕûÐÔÌõ¼þµÄδÀ´µ¼º½ÏµÍ³½«±ØÐë¾ßÓмì²âºÍÅųýÒ»¸öÒÔÉÏÎÀÐǹÊÕϵÄÄÜÁ¦¡£Ä¿Ç°£¬ÏÖÓеÄÍêÕûÐÔ¼ì²é¼¼Êõ½öÔÊÐí¼ì²âµ¥¸öÎÀÐǹÊÕÏ£¬²¢ÇÒÕâЩ¼¼Êõ²»ÄÜÀ©Õ¹ÖÁÁ½¸ö¹ÊÕϵÄÇé¿ö¶ø²»ÐèÒª¸ßµÄ¼ÆË㸺ºÉ¡£A.Gerimus ºÍ A.C.Escher µÄÎÄÕ¡°A GLR Algorithm to Detect and Exclude upto Two Simultaneous Range Failures in a GPS/Galileo/IRS Case¡±(ION GNSS2007)ÌÖÂÛÁËʹÓÃÓÃÓÚ»ùÓÚGLR (¹ãÒåËÆÈ»±È)Ëã·¨¼ì²âºÍÅųý¶à¸öÎÀÐǹÊÕϵķ½·¨À´¼ì²âÁ½¸öÎÀÐǹÊÕÏ¡£ÕâÖÖ·½·¨µÄÖ÷ҪȱµãÔÚÓڸ÷½·¨½öʹÓõ¥¸öµ¼º½Â˲¨Æ÷£¬²¢ÇҸ÷½·¨ÔÚÄܹ»¼ì²âµÚ¶þ¹ÊÕÏÎÀÐÇ֮ǰÊ×Ïȼì²â¾ßÓÐ×îÖØ´ó¹ÊÕϵÄÎÀÐÇ£¬Òò´Ë£¬½«¹Û²âµ½µ¼º½½âÉϵÄÖØ´óÎó²î¡£¶øÇÒ£¬¸Ã·½·¨²»Äܹ»ÒÖÖÆÓɵÚÒ»ÎÀÐǹÊÕÏÒýÆðµÄµ¼º½×´Ì¬ÎÛȾ£¬Æä±ØÈ»Ó°Ïì¼ì²âµÚ¶þÎÀÐǹÊÕϵÄϵͳµÄÄÜÁ¦¡£
·¢Ã÷ÄÚÈÝ
Òò´Ë£¬ÐèÒªÒ»ÖÖ¼¼Êõ£¬¿ÉÒÔ¾ßÓнµµÍµÄ¼ÆË㸺ºÉ£¬¿ÉÒÔ¼ì²âºÍÓÐЧÅųý¶à¸öÎÀÐǹÊÕÏ£¬²¢ÇÒ¿ÉÒÔÐÞÕý¹ÊÕ϶Ե¼º½½âµÄÓ°Ï졣ΪÁËÕâ¸öÄ¿µÄ£¬¸ù¾ÝµÚÒ»·½Ã棬±¾·¢Ã÷Ìá³öÒ»ÖÖÓÃÓÚ¼ì²éͨ¹ýÎÀÐǶ¨Î»É豸´«µÝµÄλÖÃÐÅÏ¢µÄÍêÕûÐԵķ½·¨£¬¸ÃÎÀÐǶ¨Î»É豸°üÀ¨KalmanÂ˲¨Æ÷×飬ÿ¸öKalmanÂ˲¨Æ÷¸ù¾Ýͨ¹ýÎÀÐÇ´«ÊäµÄÐźŵÄÔʼ²âÁ¿À´²úÉúµ¼º½½â£¬ÆäÌØÕ÷ÔÚÓÚ¶ÔÓÚÂ˲¨Æ÷×éÖеÄÿ¸öÂ˲¨Æ÷°üÀ¨ÒÔϲ½Öè:- (i)¿ÉÒÔ¸ù¾ÝÎÀÐǹÊÕ϶Ե¼º½½âµÄÓ°ÏìµÄ¹À¼Æ£¬ÐÞÕýͨ¹ýÂ˲¨Æ÷²úÉúµÄµ¼º½½â£»Ò»(ii)¼ÆËã½»²æÐ½á¹û(innovation crois6e),ËùÊö½»²æÐ½á¹û·´Ó³¶ÔÓ¦ÓÚÀ´×Ô²»±»Â˲¨Æ÷ʹÓõÄÎÀÐǵÄÔʼ²âÁ¿µÄ¹Û²âÓëÀ´×Ôͨ¹ýÂ˲¨Æ÷²úÉú²¢ÇÒ¸ù¾Ý²½Öè(i )ÐÞÕýµÄµ¼º½½âµÄËùÊö¹Û²âµÄºóÑé¹À¼ÆÖ®¼äµÄÆ«²î£»- (iii)¶Ô½»²æÐ½á¹û½øÐÐͳ¼Æ²âÊÔ£¬ÒÔÉùÃ÷ÆäÔʼ²âÁ¿²»±»Â˲¨Æ÷ʹÓõÄÎÀÐÇÊÇ·ñ¹ÊÕÏ¡£ÒÔÏÂΪ¸Ã·½·¨µÄijЩÓÅÑ¡µÄµ«·ÇÏÞÖÆµÄ·½Ãæ:Ò»²½Öè¢Å°üÀ¨:©–¶ÔÓÚÿ¸öÎÀÐÇ£¬È·¶¨ÖÁÉÙÒ» ¸öÔÚÎÀÐÇ´æÔÚ¸ø¶¨ÐÔÖʵĹÊÕϵļÙÉèÓëÎÀÐDz»´æÔÚ¹ÊÕϵļÙÉèÖ®¼äµÄËÆÈ»±È£»©–½«Óë¸ø¶¨ÐÔÖʵĹÊÕÏÏà¹ØÁªµÄËÆÈ»±ÈÓëãÐÖµ±È½Ï£¬²¢ÇÒÈç¹ûÐèÒªÔòÉùÃ÷¸ø¶¨ÐÔÖʵĹÊÕÏ£»©–¹À¼ÆËùÉùÃ÷¹ÊÕ϶Ôͨ¹ýÂ˲¨Æ÷²úÉúµÄµ¼º½½âµÄÓ°Ï죻©–¸ù¾Ý¶ÔËùÉùÃ÷¹ÊÕϵÄÓ°ÏìµÄ¹À¼ÆÀ´ÐÞÕýͨ¹ýÂ˲¨Æ÷²úÉúµÄµ¼º½½â¡£Ò»¸Ã·½·¨°üÀ¨:¶Ôÿ¸öÎÀÐǼÆËã½»²æÐ½á¹ûºÍ½»²æÐ½á¹ûз½²î£¬½»²æÐ½á¹ûºÍ½»²æÐ½á¹ûз½²î·´Ó³¶ÔÓ¦ÓÚÀ´×ÔÎÀÐǵÄÔʼ²âÁ¿µÄ¹Û²âÓëͨ¹ý²»Ê¹ÓÃÀ´×ÔÎÀÐǵÄÔʼ²âÁ¿µÄKalmanÂ˲¨Æ÷²úÉúµÄËùÊö¹Û²âµÄºóÑé¹À¼ÆÖ®¼äµÄÆ«²î£¬¸ù¾Ý²»Ê¹ÓÃÀ´×ÔÎÀÐǵÄÔʼ²âÁ¿µÄËùÊöKalmanÂ˲¨Æ÷ËùÌṩµÄ½»²æÐ½á¹ûºÍ½»²æÐ½á¹ûз½²î²¢¸ù¾Ý¸ø¶¨ÐÔÖʵĹÊÕ϶ÔËùÊö½»²æÐ½á¹ûµÄÓ°ÏìµÄ¹À¼ÆÀ´È·¶¨ËÆÈ»±È¡£Ò»Í¨¹ý¸ù¾ÝÓɲ»Ê¹ÓÃÀ´×ÔÎÀÐǵÄÔʼ²âÁ¿µÄËùÊöKalmanÂ˲¨Æ÷ÌṩµÄÊý¾ÝÈ·¶¨¶¯Ì¬Ð½á¹û¾ØÕóºÍͨ¹ý¹À¼Æ¶ÔÓ¦ÓÚ²»Ê¹ÓÃÀ´×ÔÎÀÐǵÄÔʼ²âÁ¿µÄËùÊöKalmanÂ˲¨Æ÷µÄ¸ø¶¨ÊýÁ¿µÄÔöÁ¿µÄ»¬¶¯¹À¼Æ´°¿ÚÉϸø¶¨ÐÔÖʵĹÊÕϵķù¶ÈÀ´¹À¼Æ¸ø¶¨ÐÔÖʵĹÊÕ϶ÔËùÊö½»²æÐ½á¹ûµÄÓ°Ï죬ËùÊö¶¯Ì¬Ð½á¹û¾ØÕó±íʾ¹ÊÕϵķù¶ÈÓëÓɽ»²æÐ½á¹ûÉϵĹÊÕÏÒýÆðµÄÆ«²îÖ®¼äµÄÁªÏµ£»Ò»Í¨¹ý¸ù¾ÝÓɲúÉúµ¼º½½âµÄKalmanÂ˲¨Æ÷ÌṩµÄÊý¾ÝÈ·¶¨¶¯Ì¬µ¼º½¾ØÕóºÍͨ¹ý¹À¼Æ¶ÔÓ¦ÓÚ²úÉúµ¼º½½âµÄËùÊöKalmanÂ˲¨Æ÷µÄ¸ø¶¨ÊýÁ¿µÄÔöÁ¿µÄ»¬¶¯¹À¼Æ´°¿ÚÉϵĹÊÕϵķù¶ÈºÍз½²îÀ´¹À¼Æ¹ÊÕ϶Ե¼º½½âµÄÓ°Ï죬ËùÊö¶¯Ì¬µ¼º½¾ØÕó±íʾ¹ÊÕϵķù¶ÈÓëÓÉËùÊöµ¼º½½âÉϵĹÊÕÏÒýÆðµÄÆ«²îÖ®¼äµÄÁªÏµ£»Ò»µ±½»²æÐ½á¹û³¬¹ý¶ÔÓ¦ÓÚ(H.P1.HT+Ri) * ¦ÁµÄãÐֵʱ£¬ÔÚ²½Öè(iii)ÖнøÐеÄͳ¼Æ²âÊÔÉùÃ÷ÎÀÐÇΪ¹ÊÕÏ£¬ÆäÖУ¬H±íʾKalmanÂ˲¨Æ÷µÄ¹Û²â¾ØÕó£¬Pi±íʾÎó²îµÄз½²îµÄºóÑé¹À¼Æ¾ØÕó£¬Ri¹Û²â±íʾ²âÁ¿ÔëÉùµÄз½²î¾ØÕó£¬ÒÔ¼°¦Á±íʾ¸ù¾Ý´íÎó¼ì²â¸ÅÂÊÉèÖÃÆäÖµµÄϵÊý£»Ò»½»²æÐ½á¹û¶ÔÓ¦ÓÚͨ¹ýÎÀÐǶ¨Î»ÏµÍ³´«µÝµÄµ½ÎÀÐǵÄα¾àÀëÓëÓɲ»Ê¹ÓÃͨ¹ýÎÀÐÇ´«µÝµÄα¾àÀëµÄKalmanÂ˲¨Æ÷ÌṩµÄ¸Ãα¾àÀëµÄºóÑé¹À¼ÆÖ®¼äµÄÆ«²î£»Ò»¸Ã·½·¨½øÒ»²½°üÀ¨ÒÔϲ½Öè:©–ʹÉùÃ÷Ϊ¹ÊÕϵÄÎÀÐÇÎÞЧ£¬ÒÔʹËùÊö¹ÊÕÏÎÀÐǵÄÔʼ²âÁ¿²»ÔÙ±»Â˲¨Æ÷×éÖеÄÂ˲¨Æ÷ʹÓ㬠©–Èç¹ûÔÚÎÞЧºóµÄÔ¤ÏÈÈ·¶¨µÄÑÓʱÆÚÂúʱ£¬½»²æÐ½á¹ûµÄͳ¼Æ²âÊÔ×ÜÊDzúÉúËùÊöÎÀÐǹÊÕϵĽáÂÛ£¬²¢ÇÒûÓÐÆäËû½»²æÐ½á¹û²âÊÔÒѾÉùÃ÷ÁíÒ»ÎÀÐǹÊÕÏ£¬ÔòÅųýÎÞЧµÄÎÀÐÇ¡£Ò»¸Ã·½·¨»¹¶ÔÓÚÂ˲¨Æ÷×éÖеÄÿһ¸öÂ˲¨Æ÷ÔÚ±»Â˲¨Æ÷ʹÓõÄÿһ¸öÎÀÐÇÉϽøÐÐÏÈÑéнá¹ûͳ¼Æ²âÊÔ£¬²¢ÇÒÔÚÈô¸ÉÎÀÐÇÔÚËüÃǵĽ»²æÐ½á¹ûµÄͳ¼Æ²âÊÔÖ®ºó±»ÉùÃ÷Ϊ¹ÊÕϵÄÇé¿öÏ£¬Ê¹²»±»¾ßÓÐ×î´óÊýÁ¿µÄÏÈÑéнá¹û(¶ÔÓÚ¸ÃÏÈÑéнá¹ûͳ¼Æ²âÊÔСÓÚãÐÖµ)µÄÂ˲¨Æ÷ʹÓõÄÎÀÐÇÎÞЧ£¬Ê¹µÃÀ´×ÔËùÊöÎÞЧµÄÎÀÐǵÄÔʼ²âÁ¿²»ÔÙ±»Â˲¨Æ÷×éÖеÄÂ˲¨Æ÷ʹÓã»Ò»Â˲¨Æ÷×éÖеÄÿ¸öÂ˲¨Æ÷ͨ¹ý½«¹ßÐÔ²âÁ¿Óëͨ¹ýÎÀÐÇ´«ÊäµÄÐźŵÄÔʼ²âÁ¿»ìºÏÀ´²úÉúµ¼º½½â¡£¸ù¾ÝµÚ¶þ·½Ã棬±¾·¢Ã÷Ìá³öÒ»ÖÖ°üÀ¨KalmanÂ˲¨Æ÷×éÖеÄÎÀÐǶ¨Î»É豸£¬Ã¿¸öKalmanÂ˲¨Æ÷¸ù¾Ýͨ¹ýÎÀÐÇ´«ÊäµÄÐźŵÄÔʼ²âÁ¿²úÉúµ¼º½½â£¬ÆäÌØÕ÷ÔÚÓÚËùÊöÎÀÐǶ¨Î»É豸°üÀ¨:Ò»µ÷½ÚÄ£¿é£¬°²×°ËùÊöµ÷½ÚÄ£¿éÓÃÓÚÕë¶ÔÂ˲¨Æ÷×éÖеÄÿ¸öÂ˲¨Æ÷¹À¼ÆÎÀÐǹÊÕ϶Ôͨ¹ýÂ˲¨Æ÷²úÉúµÄµ¼º½½âµÄÓ°Ï죬ÒÔ¼°ÔÚÉùÃ÷¹ÊÕϵÄÇé¿öÏ£¬¸ù¾Ý¶Ô¹ÊÕϵÄÓ°ÏìµÄ¹À¼ÆÐÞÕýµ¼º½½â£»Ò»ÓÃÓÚ¼ì²âÎÀÐǹÊÕϵÄÄ£¿é£¬ÅäÖøÃÄ£¿éÊÇΪÁË:©–¶ÔÓÚÂ˲¨Æ÷×éÖеÄÿ¸öÂ˲¨Æ÷¼ÆËã½»²æÐ½á¹û£¬¸Ã½»²æÐ½á¹û·´Ó³¶ÔÓ¦ÓÚÀ´×Ô²»±»Â˲¨Æ÷ʹÓõÄÎÀÐǵÄÔʼ²âÁ¿µÄ¹Û²âÓëÀ´×Ôͨ¹ýKalmanÂ˲¨Æ÷²úÉú²¢Óɵ÷½ÚÄ£¿éÐÞÕýµÄµ¼º½½âµÄËùÊö¹Û²âµÄºóÑé¹À¼ÆÖ®¼äµÄÆ«²î£¬ÒÔ¼°©–½øÐн»²æÐ½á¹ûµÄͳ¼Æ²âÊÔ£¬ÒÔÉùÃ÷ÎÀÐÇÊÇ·ñ¹ÊÕÏ¡£
ͨ¹ýÔĶÁÒÔÏÂÒÔ·ÇÏÞÖÆÊ¾Àý¸ø³ö²¢²ÎÕÕ¸½Í¼µÄ±¾·¢Ã÷µÄÓÅѡʵʩÀýµÄÏêϸÃèÊö£¬±¾·¢Ã÷µÄÆäËû·½Ã桢ĿµÄºÍÓŵ㽫±äµÃ¸ü¼ÓÃ÷ÏÔ£¬ÆäÖÐ:ͼ1ΪÏÔʾÔÚËĸöÎÀÐÇÖеÄÁ½¸öÎÀÐÇͬʱ¹ÊÕϵÄÇé¿öϱ¾·¢Ã÷µÄ¹¤×÷ÔÀíµÄʾÒâͼ£»Í¼2Ϊ±íʾ¸ù¾Ý±¾·¢Ã÷µÄµÚ¶þ·½ÃæµÄÉ豸µÄ¿ÉÄÜʵʩÀýµÄʾÒâͼ¡£
¾ßÌåʵʩÀý·½Ê½ÔÚ±¾·¢Ã÷µÄ·¶Î§ÄÚ£¬¹ÊÕÏÎÀÐDZ»¶¨ÒåΪ·¢ËÍÔÚÆäÏûÏ¢ÖеĴíÎóÐÅÏ¢£¬´Ó¶øµ¼ÖÂÆäʵ¼ÊλÖúÍÔÚÆäÏûÏ¢Öиø³öµÄλÖÃÖ®¼ä´æÔÚ(¹Ì¶¨µÄ»ò¿É±äµÄ)Æ«²îµÄÎÀÐÇ¡£¸ù¾ÝÏÖÓм¼Êõˮƽ£¬KalmanÂ˲¨Æ÷×éͨ³£ÓÃÓÚ·À·¶¿ÉÄܵÄÎÀÐǹÊÕÏ¡£ÔÚINS/GNSS»·¾³ÖУ¬ÕâЩÂ˲¨Æ÷²úÉúÀ´×ÔÎÀÐǵ¼º½ÏµÍ³ºÍÀ´×ÔÖÐÑë¹ßÐÔµ¥ÔªµÄÐÅÏ¢Ö®¼äµÄ»ìºÏ¡£ÓÉÊõÓïÖ÷Â˲¨Æ÷Ö¸¶¨µÄÂ˲¨Æ÷×éÖеÄÒ»¸öÂ˲¨Æ÷ʹÓðüÀ¨Î±²âÁ¿ºÍÓйØÎ±²âÁ¿ÖÊÁ¿µÄÐÅÏ¢ÔÚÄÚµÄËùÓÐGNSS²âÁ¿¡£Â˲¨Æ÷×éÖÐÆäËûËùνµÄ´Î¼¶Â˲¨Æ÷½öÀûÓÿÉÓÃGNSS²âÁ¿µÄÒ»²¿·Ö(ͨ³£Îª³ýÁËÄÇЩÀ´×ÔÒ»¸öÎÀÐÇÖ®ÍâµÄËùÓÐGNSS²âÁ¿£»±»ÅųýµÄÎÀÐDz»Í¬ÓÚÒ»¸ö´Î¼¶Â˲¨Æ÷¼°ÆäËûµÄÂ˲¨Æ÷)¡£ÔÚ±¾·¢Ã÷µÄ·¶Î§ÖУ¬ÕâÑùµÄÒÔÂ˲¨Æ÷×éÐÎʽµÄ¼Ü¹¹¾ßÓÐÒÔÏÂÓŵ㡣Èç¹û·¢ÉúÎÀÐǹÊÕÏ£¬²»½ÓÊոòâÁ¿µÄ´Î¼¶Â˲¨Æ÷¿´²»µ½¸Ã¹ÊÕÏ:Òò´Ë¸Ã´Î¼¶Â˲¨Æ÷²»ÊܹÊÕϵÄÓ°Ïì²¢´Ó¶ø±£³ÖδÊÜÎÛȾ¡£´ËÍ⣬Èç¹û²úÉúÁ½¸öͬʱ·¢ÉúµÄÎÀÐǹÊÕÏ£¬ÔòÂ˲¨Æ÷×éÖеÄÁ½¸ö´Î¼¶Â˲¨Æ÷(ÄÇЩÅųýÀ´×Ô¹ÊÕÏÎÀÐÇÖÐÈÎÒâÒ»¸öµÄ²âÁ¿µÄÂ˲¨Æ÷)Êܵ¥¸öÎÀÐǹÊÕÏÓ°Ïì¡£ÔÚͼ1ÖУ¬ÏÔʾKalmanÂ˲¨Æ÷×飬¸ÃKalmanÂ˲¨Æ÷×é°üÀ¨Ê¹ÓÃÀ´×ÔËĸöÎÀÐǵIJâÁ¿µÄÖ÷Â˲¨Æ÷Â˲¨Æ÷0£¬ÒÔ¼°Ëĸö´Î¼¶Â˲¨Æ÷Â˲¨Æ÷1¡¢Â˲¨Æ÷2¡¢Â˲¨Æ÷3ºÍÂ˲¨Æ÷4£¬¸ÃËĸö´Î¼¶Â˲¨Æ÷ÖеÄÿһ¸öÅųýÀ´×ÔÆäÖÐÒ»¸öÎÀÐǵIJâÁ¿¡£¼Ù¶¨ÎÀÐÇIºÍÎÀÐÇ4ͬʱ¹ÊÕÏ£¬¿ÉÒÔÀí½âΪ´Î¼¶Â˲¨Æ÷Â˲¨Æ÷IºÍÂ˲¨Æ÷4½öÊܵ¥¸öÎÀÐǹÊÕÏÓ°Ïì(·Ö±ðÊÇ£¬Ò»¸öÔ´ÓÚÎÀÐÇ4ÒÔ¼°Ò»¸öÔ´ÓÚÎÀÐÇI)¡£²ÎÕÕͼ2£¬ÏÔʾ¸ù¾Ý±¾·¢Ã÷µÄµÚ¶þ·½ÃæµÄ¿ÉÄÜʵʩ·½°¸µÄÎÀÐǶ¨Î»É豸1£¬¸ÃÎÀÐǶ¨Î»É豸½«±»×°ÔØÔÚÀýÈç·ÉÐÐÆ÷µÄÔËÔØÆ÷ÉÏ¡£É豸IʹÓÃÓÉÖÐÑë¹ßÐÔµ¥ÔªUMIºÍÈô¸Éµ¼º½ÏµÍ³Í¨¹ýÎÀÐÇGNSS1£¬GNNS j, GNSS pÌṩµÄÐÅÏ¢£¬²¢ÇÒ°üÀ¨µ¥¸öÐéÄâÆ½Ì¨2ºÍKalmanÂ˲¨Æ÷×é3¡£È»¶ø£¬±¾·¢Ã÷²»ÏÞÓÚINS/GNSSµ¼º½ÏµÍ³£¬¶øÇÒÀ©Õ¹ÖÁµ¥¶ÀµÄGNSS»·¾³¡£ÐéÄâÆ½Ì¨2½ÓÊÕÀ´×ÔÖÐÑë¹ßÐÔµ¥ÔªUMIµÄ´«¸ÐÆ÷(ÍÓÂÝÒÇ¡¢¼ÓËٶȼÆ)µÄ¹ßÐÔÔöÁ¿¡£¸Ã¹ßÐÔÔöÁ¿ÌرðÓë½ÇÔöÁ¿ºÍËÙ¶ÈÔöÁ¿Ïà¶ÔÓ¦¡£Í¨¹ýÐéÄâÆ½Ì¨2¼ÆËãÀ´×ÔÓÚÕâЩÔöÁ¿µÄ¹ßÐÔµ¼º½ÐÅϢƬ¶Î(ÀýÈçÔËÔØÆ÷µÄ¸ß¶È¡¢º½Ïß¡¢ËÙ¶È»òλÖÃ)¡£ÕâЩ¹ßÐÔµ¼º½ÐÅϢƬ¶ÎËæºó±»Ö¸¶¨Îª¹ßÐÔPPVI²âÁ¿¡£ÕâЩ¹ßÐÔPPVI²âÁ¿±»´«ÊäÖÁÓÃÓÚ¼ÆËãÏÈÑé¹À¼ÆµÄα¾àÀëµÄÉ豸(ͼ1ÖÐδÏÔʾ)£¬¸ÃÉ豸»¹½ÓÊÕÓйØÎÀÐÇλÖõÄÊý¾Ý¡£Ò»·½Ãæ¸ù¾Ý¹ßÐÔ²âÁ¿£¬ÒÔ¼°ÁíÒ»·½Ãæ¸ù¾ÝÓйØÎÀÐÇλÖõÄÊý¾Ý£¬ÓÃÓÚ¼ÆËãÏÈÑé¹À¼ÆµÄα¾àÀëµÄÉ豸¼ÆËãÔËÔØÆ÷Óë´ÓÔËÔØÆ÷¿É¼ûµÄ²»Í¬ÎÀÐÇÖ®¼äµÄÏÈÑéα¾àÀë¡£É豸I»¹½ÓÊÕÔËÔØÆ÷Óë´ÓÈô¸ÉÐÇ×ùGNSSl¡¢GNSS j¡¢GNSS P¿É¼ûµÄ²»Í¬ÎÀÐÇÖ®¼äµÄα²âÁ¿¡£È»ºó£¬Í¨³£¼ÆËãÏÈÑé¹À¼ÆµÄα²âÁ¿Óëͨ¹ýÿ¸öGNSSÐÇ×ù´«µÝµÄα²âÁ¿Ö®¼äµÄÆ«²î(³ÆÎª¹Û²â)¡£KalmanÂ˲¨Æ÷×é3ʵÏÖÀ´×ÔÖÐÑë¹ßÐÔµ¥Ôª2µÄ¹ßÐÔÐÅϢƬ¶ÎÓëÀ´×ÔÎÀÐǵ¼º½ÏµÍ³µÄÐÅϢƬ¶ÎÖ®¼äµÄ»ìºÏ¡£³ýÁËÔÚÊä³ö´¦ÌṩÓйزâÁ¿µÄͳ¼ÆÐÅÏ¢Ö®Í⣬Â˲¨Æ÷µÄ×÷ÓÃÊǽ«ÐéÄâÆ½Ì¨2±£³ÖÔÚÏßÐÔ²Ù×÷Óò£¬¸ÃÏßÐÔ²Ù×÷ÓòÊÇÔÚKalmanÂ˲¨Æ÷ÖÐͨ¹ý·Ö±ð¹À¼Æ×´Ì¬ÏòÁ¿dXO-dXn (Ò»°ãÀ´Ëµ£¬°üÀ¨Ô¼30¸ö·ÖÁ¿)µÄÒ»¸ö½¨Ä£µÄͼÏñ¡£ÔÚÒÑÖªµÄ´«Í³·½·¨ÖУ¬ÔÚ±¾ÖÊÉÏ£¬Â˲¨Æ÷×é3°üÀ¨Èô¸É²¢ÁªµÄKalmanÂ˲¨Æ÷¡£Â˲¨Æ÷ÖеÄÒ»¸ö±»³ÆÎªÖ÷KalmanÂ˲¨Æ÷8:Ëü¿¼ÂÇËùÓеĹ۲â(²¢ÇÒ£¬ÎªÁË×öµ½ÕâÒ»µã£¬´ÓGNSSϵͳ½ÓÊÕËùÓеIJâÁ¿)²¢ÇÒ²úÉúÖ÷»ìºÏµ¼º½½â¡£ÆäËûÂ˲¨Æ÷91¡¢9n±»³ÆÎª´Î¼¶Â˲¨Æ÷:ËüÃǽö¿¼ÂDz¿·ÖµÄ¹Û²â£¬ÀýÈç´ÓÓë¦Ç¸ö¿É¼ûÎÀÐÇÓйصĦǸö¹Û²âÖ®ÖеÄ(¦Ç-1)¸ö¹Û²â£¬Ê¹µÃµÚi¸ö´Î¼¶KalmanÂ˲¨Æ÷9i´ÓGNSSϵͳ½ÓÊÕ³ýµÚi¸öÎÀÐÇÖ®ÍâµÄËùÓÐÎÀÐǵIJâÁ¿£¬²¢ÇÒÿ¸ö´Î¼¶Â˲¨Æ÷²úÉú´Î¼¶»ìºÏµ¼º½½â¡£ÖµµÃ×¢ÒâµÄÊÇ£¬ÓÃÓÚ²úÉúÉÏÊö¹Û²âµÄ¹ý³Ì¶ÔÂ˲¨Æ÷×é3ÖеÄËùÓÐÂ˲¨Æ÷²»Êǹ²Óõ쬶øÊÇÕë¶ÔÂ˲¨Æ÷ÖеÄÿһ¸öÍê³ÉµÄ¡£Òò´Ë£¬ÉÏÃæÌáµ½µÄÏÈÑéα¾àÀëµÄ¼ÆËãºÍ¹Û²âµÄ¼ÆËã¶ÔÂ˲¨Æ÷×éÖеÄËùÓÐÂ˲¨Æ÷²»Êǹ²Óõ쬶øÊǸù¾Ý±¾·¢Ã÷µÄ»ìºÏÉ豸I¶ÔÓÚÂ˲¨Æ÷×éÖеÄÿ¸öÂ˲¨Æ÷Ö´ÐÐÕâЩ¼ÆËã¡£É豸I²úÉú»ìºÏÊä³öXref (²Î¿¼µ¼º½)£¬¸Ã»ìºÏÊä³öXref¶ÔÓ¦ÓÚͨ¹ýÐéÄâÆ½Ì¨2¼ÆËãµÄ²¢ÇÒͨ¹ýÎȶ¨ÏòÁ¿dc¾Óɼõ·¨Æ÷11ÐÞÕýµÄ¹ßÐÔPPVI²âÁ¿£¬Îȶ¨ÏòÁ¿dC¾ßÓÐÓëͨ¹ýKalmanÂ˲¨Æ÷¹À¼ÆµÄ״̬ÏòÁ¿Ò»Ñù¶àµÄ·ÖÁ¿¡£ÖµµÃ×¢ÒâµÄÊÇ£¬ÔÚ±Õ»·»ìºÏÉ豸µÄ·¶Î§ÄÚ£¬»ìºÏÊä³öXref»ØË͵½ÐéÄâÆ½Ì¨2µÄÊäÈë¡£´ËÍ⣬Èçͼ1Ëùʾ£¬Îȶ¨ÏòÁ¿dC¿ÉÓ¦ÓÃÓÚÂ˲¨Æ÷×éÖеÄÈ«²¿Â˲¨Æ÷µÄÊäÈë¡£ÒÔÕâÖÖ·½Ê½£¬KalmanÂ˲¨Æ÷ͨ¹ý¼õÈ¥ËüÃǵĹÀ¼Æ(״̬ÏòÁ¿dX)¡¢dCµÄÐÞÕýÀ´½øÐе÷½Ú£¬²¢Òò´Ë±£³ÖÓëÐéÄâÆ½Ì¨µÄÒ»Ö¡£É豸I½øÒ»²½°üÀ¨ÓÃÓÚ²úÉúÎȶ¨ÏòÁ¿dCµÄÄ£¿é4£¬ÒÔÏÂÃèÊö×÷Ϊ·ÇÏÞÖÆÐÔʾÀýµÄÄ£¿é4µÄÁ½¸öʵʩÀý¡£¸ù¾ÝµÚÒ»¿ÉÄܵÄʵʩÀý£¬Ó¦ÓÃÓÚ¹ßÐÔ²âÁ¿µÄÐÞÕýÀ´×Ôµ¥¸öÂ˲¨Æ÷¡£Òò´Ë£¬Îȶ¨Â˲¨Æ÷dC (ÔÚÆäËùÓзÖÁ¿ÖÐ)µÈÓÚͨ¹ý´ÓÂ˲¨Æ÷×é3µÄÂ˲¨Æ÷ÖÐÑ¡ÔñµÄKalmanÂ˲¨Æ÷¹À¼ÆµÄ״̬ÏòÁ¿¡£ÀýÈ磬ÔÚÄ£¿é4Öиù¾ÝÎĵµEP1801539Aͨ¹ý¼ì²â¿ÉÄܵÄÎÀÐǹÊÕÏ×ö³öÑ¡Ôñ¡£¸ù¾ÝµÚ¶þ¿ÉÄܵÄʵʩÀý£¬Í¨¹ý¶Ôÿ¸ö·ÖÁ¿Ê¹ÓÃÈ«²¿KalmanÂ˲¨Æ÷Öð¸ö·ÖÁ¿µØ²úÉúÎȶ¨ÏòÁ¿dC¡£È»ºó£¬ÅäÖÃÓÃÓÚ²úÉúdCµÄÐÞÕýdCµÄÄ£¿é4£¬ÒÔ¸ù¾ÝÐÞÕýÏòÁ¿dXO-dXnµÄÈ«²¿¶ÔÓ¦·ÖÁ¿dXO[״̬]-dXn[״̬]À´²úÉúÎȶ¨ÏòÁ¿dCµÄÿһ¸ö·ÖÁ¿dC[״̬]¡£ÀýÈ磬¸ù¾ÝÒÔÉêÇëÈËÃûÒåµÄרÀûÉêÇëW02010070012À´ÊµÏÖÿ¸ö·ÖÁ¿µÄ²úÉú¡£É豸I»¹°üÀ¨ÓÃÓÚÐÞÕýµ¼º½×´Ì¬µÄÄ£¿é5£¬¸ÃÄ£¿é5°üÀ¨¼ì²âÄ£¿é52£¬ÅäÖøüì²âÄ£¿é52ÒÔÓ¦ÓÃÒÔϲ½Öè:Ò»¶ÔÓÚÿ¸öÎÀÐÇ£¬È·¶¨ÖÁÉÙÒ»¸öÔÚÎÀÐÇ´æÔÚ¸ø¶¨ÐÔÖʵĹÊÕϵļÙÉèÓëÎÀÐDz»´æÔÚ¹ÊÕϵļÙÉèÖ®¼äµÄËÆÈ»±ÈIr£¬Ir¡¯¡£Ò»¸ù¾ÝÓëÆä¹ÊÕÏÏà¹ØÁªµÄËÆÈ»±ÈIr£¬Ir¡¯ÒÔ¼°¸ù¾ÝãÐÖµ£¬ÉùÃ÷ÎÀÐÇÉϸø¶¨ÐÔÖʵĹÊÕÏ¡£ÓÐÀûµØ£¬¶ÔÓÚÿ¸öÎÀÐÇ£¬È·¶¨ÖÁÉÙÒ»¸öÔÚ»¬¶¯´æ´¢´°¿ÚÉϵÄKalmanÂ˲¨Æ÷µÄÿ¸öÔöÁ¿ÉϵÄËÆÈ»±ÈIr£¬Ir¡¯£¬²¢ÇÒÈç¹ûÔÚ»¬¶¯´æ´¢´°¿ÚÉÏÓë¸Ã¹ÊÕÏÏà¹ØÁªµÄËÆÈ»±ÈIr£¬Ir¡¯Ö®ºÍ´óÓÚÏà¹ØÁªµÄãÐÖµ£¬ÔòÉùÃ÷Ò»°ãÐÔÖʵĹÊÕÏ¡£ËÆÈ»±È±íʾÓëÆäÏà¹ØÁªµÄ¸ø¶¨ÐÔÖʵĹÊÕÏÓ°Ïì¶ÔÓ¦µÄÎÀÐǵĸÅÂÊ¡£ÀýÈ磬Èç¹ûÓë¸ø¶¨ÐÔÖʵĹÊÕÏÏà¹ØÁªµÄËÆÈ»±ÈΪÕý£¬Ôò¸üÓпÉÄÜÊÇËùÊö¹ÊÕÏÓ°Ïì¶ÔÓ¦µÄÎÀÐÇ¡£ËÆÈ»±ÈÔ½¸ß£¬Æä¶ÔÓ¦µÄÎÀÐDZ»ÓëÆäÏà¹ØÁªµÄ¹ÊÕÏË𻵵ĸÅÂÊÔòÔ½´ó¡£¶ÔÓÚÈô¸ÉÎÀÐǺÍ/»ò¶ÔÓÚÈô¸É¹ÊÕϵÄÐÔÖÊ£¬ãÐÖµ¿ÉÒÔÊÇÏàͬµÄ£¬»òÕß¶ÔÓÚÿ¸öÎÀÐǺͶÔÓÚÿ¸ö¹ÊÕϵÄÐÔÖÊ£¬ãÐÖµ¿ÉÒÔÊDz»Í¬µÄ£¬ÔÚÕâЩÇé¿öÏ£¬½«Ã¿¸öËÆÈ»±È»òÓÐÀûµØ½«Ã¿¸öËÆÈ»±ÈÖ®ºÍÓë¶ÔÓÚËüµÄãÐÖµÏà±È½Ï¡£»¬¶¯´æ´¢´°¿ÚµÄ³ß´ç¿É¸ù¾Ý¹ÊÕϵÄÐÔÖʶø¸Ä±ä£¬»òÕß¿ÉÌṩµ¥¸ö»¬¶¯´°¿Ú³ß´ç¡£¶Ô´Ë½«Ëæºó½øÐÐÏêϸÃèÊö£¬ÓÃÓÚ¼ì²âºÍÅųýÎÀÐǹÊÕϵÄÄ£¿é5»¹Ó¦ÓÃÓÃÓÚ¹ÜÀíºÍÅųýGNSS²âÁ¿¹¦ÄÜÀ´¼à²âËüÃÇ¡£Òò´Ë£¬ÔÚͼ1ËùʾµÄʵʩÀýÖУ¬¼ì²âºÍÅųýÄ£¿é5°üÀ¨ÓÃÓÚ¹ÜÀíÎÀÐÇÐźŵÄÄ£¿é53£¬Ä£¿é53½ÓÊÕGNSS²âÁ¿²¢¸ù¾ÝÇé¿ö(ûÓÐÎÀÐDZ»¼ì²âΪ¹ÊÕÏ£»Åųý±»¼ì²âΪ¹ÊÕϵÄÎÀÐÇ)½«¸ÃÐÅÏ¢·¢ËÍÖÁÂ˲¨Æ÷×é3ÖеIJ»Í¬µÄÂ˲¨Æ÷¡£¶Ô´Ë½«Ëæºó×ö³ö˵Ã÷£¬ÎªÁË×öµ½ÕâÒ»µã£¬¼ì²âºÍÅųýÄ£¿é5»¹¿ÉÀûÓÃÓÉÓÃÓÚ¼ì²âÎÀÐǹÊÕϵÄÄ£¿é7²úÉúµÄ½»²æÐ½á¹ûµÄ²âÊÔ½á¹ûºÍÓɼì²âÄ£¿é52²úÉúµÄ²âÊÔ½á¹û¡£ÓÃÓÚ¹ÜÀíÎÀÐÇÐźŵÄÄ£¿é53ÓÐÀûµØÓ¦ÓôýʹÓõÄGNSS²âÁ¿µÄԤѡ£¬Äܹ»ÓÅ»¯ÏµÍ³µÄÐÔÄܺÍÏÞÖÆ²âÁ¿µÄ´ÎÊý¡£Êµ¼ÊÉÏ£¬¾¡¹ÜʹÓÃËùÓвâÁ¿¿ÉÒÔ»ñµÃ×îÓÅÐÔÄÜ£¬µ«GPS¡¢Galileo¡¢Glonass¡¢ÐÇ×ùµÈÖеĦǸö²âÁ¿(ÆäÖЦǶÔÓ¦Óëÿ¸öʹÓæÇ_1¸öGNSS²âÁ¿µÄ´Î¼¶Â˲¨Æ÷µÄÊýÁ¿)µÄÑ¡Ôñ£¬Æä×îС»¯Á˲»Í¬µÄ¾«¶È±ê×¼(ÀýÈ磬DOP ¡ª¾«¶ÈÒò×Ó¡¢EHE ¡ªÔ¤ÆÚˮƽÎó²î»òEVE ¡ªÔ¤ÆÚ´¹Ö±Îó²î)£¬¿ÉÒÔ»ñµÃ±ÈʹÓõ¥¸öÐÇ×ù¸üºÃµÄÊä³öÐÔÄܲ¢ÇÒ×ãÒÔ±£ÕÏËùÑ¡ÔñµÄÈÎÎñ¡£É豸I»¹°üÀ¨µ÷½ÚÄ£¿é6£¬¶ÔÓÚÂ˲¨Æ÷×éÖеÄÿ¸öÂ˲¨Æ÷£¬ÅäÖõ÷½ÚÄ£¿é6ÒÔÓ¦Óò½ÖèÀ´ÊµÏÖ:¡ª¹À¼ÆÎÀÐǹÊÕ϶Ôͨ¹ýÂ˲¨Æ÷²úÉúµÄ»ìºÏµ¼º½½âµÄÓ°Ï죬ÒÔ¼°¡ªÈç¹ûÉùÃ÷¹ÊÕÏ£¬Ôò¸ù¾Ý¶Ô¹ÊÕϵÄÓ°ÏìµÄ¹À¼ÆÀ´ÐÞÕýµ¼º½½â¡£Òò´Ë£¬µ÷½ÚÄ£¿é6¾ßÓÐÆÀ¹ÀÓÉͨ¹ýKalmanÂ˲¨Æ÷8£¬9i¡9n²úÉúµÄ»ìºÏµ¼º½½âÉϵĹÊÕÏÒýÆðµÄÆ«²î¦«¦¶£¬AXi, AXnµÄ¹¦ÄÜ£¬ÒÔ¼°ÐÞÕý»ìºÏµ¼º½½âµÄ¹¦ÄÜ(ÀýÈçͨ¹ý¼õ·¨Æ÷×é10)¡£È»¶ø±¾·¢Ã÷²»ÏÞÓÚͼ1ËùʾµÄ¼Ü¹¹£¬Ìæ´úµØ£¬Í¨¹ýKalmanÂ˲¨Æ÷¡¢Í¨¹ý¼ì²âÄ£¿é52»ò½øÒ»²½Í¨¹ý±¾ÁìÓò¼¼ÊõÈËÔ±ÒÑÖªµÄÈÎºÎÆäËû·½·¨¿É×ö³ö¹ÊÕ϶ԻìºÏµ¼º½½âµÄÓ°ÏìµÄ¹À¼Æ¡£ÖµµÃ×¢ÒâµÄÊÇ£¬Ä£¿é5ºÍ6·ûºÏÓëÒÔÉêÇëÈËÃûÒåÔÚ2009Äê7ÔÂ10ÈÕÌá½»µÄ·¨¹úרÀûÉêÇëN0.0954849ÖÐËùÃèÊöµÄÄÇЩģ¿é¡£ÒÔÏÂÃèÊöÉêÇëÈË¿ª·¢µÄºÍÒѾÔÚרÀûÉêÇëFR0954849ÖÐÌÖÂ۵ļÆËã·½·¨£¬ÒÔÈ·¶¨ËÆÈ»±ÈºÍ¹ÊÕ϶ԻìºÏµ¼º½½âµÄÓ°Ïì¡£×÷ΪʾÀý¸ø³öµÄÕâЩ¹«Ê½²¢ÇÒÎÞÒâÏÞÖÆ±¾·¢Ã÷¡£ÓÐÀûµØ,ËÆÈ»±È¸ù¾ÝÓÉKalmanÂ˲¨Æ÷ÌṩµÄÌØ±ð°üÀ¨Ð½á¹û(innovations)ºÍз½²îнá¹û(covariances d¡¯ innovation)µÄÊý¾ÝÒÔ¼°¸ù¾Ý¸ø¶¨ÐÔÖʵĹÊÕ϶Ôнá¹ûµÄÓ°ÏìµÄ¹À¼ÆÀ´È·¶¨¡£Ð½á¹û±íʾÔÚͨ¹ýKalmanÂ˲¨Æ÷µÃµ½µÄÏÈÑé¹Û²âÓëͨ¹ýÂ˲¨Æ÷²úÉúµÄ¸Ã¹Û²âµÄºóÑé¹À¼ÆÖ®¼äµÄÆ«²î¡£Òò´Ëÿ¸öÂ˲¨Æ÷´«µÝÓëÐÇ×ùÖеÄÎÀÐÇÒ»Ñù¶àµÄ¦Ç¸öнá¹û¡£¾ßÌå¶øÑÔ£¬Í¨¹ýÿ¸ö´Î¼¶KalmanÂ˲¨Æ÷SiÌṩµÄнá¹û±»³ÆÎª¡°½»²æÐ½á¹û¡±£¬Ð½á¹û±íʾԴÓÚÆä´Î¼¶Â˲¨Æ÷Si²»½ÓÊÕÊý¾ÝµÄÎÀÐǵÄÏÈÑé¹Û²âºÍ¸Ã¹Û²âµÄºóÑé¹À¼ÆÖ®¼äµÄÆ«²î¡£Òò´Ë£¬KalmanÂ˲¨Æ÷×é´«µÝ¦Ç* (¦Ç+1)¸öнá¹û£¬ÆäÖеĦǸöΪ½»²æÐ½á¹û¡£
ÓÐÀûµØ£¬ÓÃÓÚ¼ì²âºÍÅųýÎÀÐǹÊÕϵÄÄ£¿é5°üÀ¨ÓÃÓÚÑ¡Ôñнá¹ûµÄÄ£¿é51£¬ÅäÖÃÄ£¿é51ÒÔÑ¡Ôñнá¹û(»òÕßÊǽ»²æÐ½á¹û»òÕß²»ÊÇ)ºÍнá¹ûз½²î²¢ÇÒ½«ËüÃÇÏò¼ÆËãËÆÈ»±ÈµÄÄ£¿é52·¢ËÍ¡£ÓÐÀûµØ£¬ÅäÖÃÄ£¿é51ÒÔ½«½»²æÐ½á¹û»òÒ»°ãнá¹û´«ÊäÖÁÓÃÓÚ¼ÆËãËÆÈ»±ÈµÄÄ£¿é52¡£ÓëÒ»°ãнá¹ûµÄ²âÊÔÏà±È£¬Ê¹Óý»²æÐ½á¹ûµÄÓŵãÔÚÓÚ£¬ÔÊÐí²âÊÔ¹ÊÕÏÎÀÐǵÄÂ˲¨Æ÷²»ÊܹÊÕϵĸÉÈÅ¡£¾ßÌå¶øÑÔ£¬µÚi¸ö´Î¼¶KalmanÂ˲¨Æ÷9i´ÓGNSSϵͳ½ÓÊÕ³ýµÚi¸öÎÀÐÇÖ®ÍâµÄËùÓÐÎÀÐǵIJâÁ¿£¬²¢Óɴ˲úÉúÓëÎÀÐÇiÎ޹صÄ״̬ÏòÁ¿dXi£¬Ê¹µÃ¸ÃÂ˲¨Æ÷Si²»ÊÜÓ°ÏìÎÀÐÇiµÄ¿ÉÄܵĹÊÕϸÉÈÅ¡£ÀýÈ磬ÎÀÐǵĽ»²æÐ½á¹û¶ÔÓ¦ÓÚͨ¹ýÎÀÐǶ¨Î»ÏµÍ³´«µÝµÄµ½ËùÊöÎÀÐǵÄα¾àÀëºÍÓɲ»Ê¹ÓÃͨ¹ý¸ÃÎÀÐÇ´«µÝµÄα¾àÀëµÄKalmanÂ˲¨Æ÷ÌṩµÄ¸Ãα¾àÀëµÄºóÑé¹À¼ÆÖ®¼äµÄÆ«²î£¬Ê¹µÃ¸Ã¹À¼ÆÓë¸ÃÎÀÐÇÎ޹ء£Òò´ËËÆÈ»±ÈµÄ¼ÆË㽫²»ÊÜÎÀÐǹÊÕÏ£¬ÌرðÊÇÎÀÐǵÄÂýÐÔ¹ÊÕÏËù¸ÉÈÅ¡£ÕâÀïÖ¸¶¨½»²æÐ½á¹ûÒ»°ã¿ÉÓ¦ÓÃÓÚÈκÎÔʼ²âÁ¿£¬ÀýÈçαËٶȲâÁ¿(»¹¿É±»³ÆÎª¶àÆÕÀÕ²âÁ¿)¡£ÓÅÑ¡µØ£¬Í¨¹ýÒÔϹ«Ê½¶Ôÿ¸öÎÀÐÇÈ·¶¨ÔÚ¸ø¶¨Ê±¿ÌtÓë¸ø¶¨ÐÔÖʵĹÊÕÏÏà¹ØÁªµÄËÆÈ»±ÈIr:
ȨÀûÒªÇó
1.Ò»ÖÖÓÃÓÚ¼ì²éͨ¹ýÎÀÐǶ¨Î»É豸(1) (GNSS)´«µÝµÄλÖÃÐÅϢƬ¶ÎµÄÍêÕûÐԵķ½·¨£¬ËùÊöÎÀÐǶ¨Î»É豸(1)°üÀ¨KalmanÂ˲¨Æ÷×é(3)£¬Ã¿¸öKalmanÂ˲¨Æ÷¸ù¾Ýͨ¹ýÎÀÐÇ´«ÊäµÄÐźŵÄÔʼ²âÁ¿À´²úÉúµ¼º½½â(dXO£¬dXi, dXn)£¬ÆäÌØÕ÷ÔÚÓÚ¶ÔÓÚKalmanÂ˲¨Æ÷×éÖеÄÿ¸öÂ˲¨Æ÷£¬°üÀ¨ÒÔϲ½Öè: Ò»(i)¸ù¾ÝÎÀÐǹÊÕ϶Ե¼º½½âµÄÓ°ÏìµÄ¹À¼Æ£¬ÐÞÕýͨ¹ýËùÊöÂ˲¨Æ÷²úÉúµÄËùÊöµ¼º½½â£» -( )¼ÆËã½»²æÐ½á¹û£¬ËùÊö½»²æÐ½á¹û·´Ó³¶ÔÓ¦ÓÚÀ´×Ô²»±»ËùÊöÂ˲¨Æ÷ʹÓõÄÎÀÐǵÄÔʼ²âÁ¿µÄ¹Û²âÓëÀ´×Ôͨ¹ýËùÊöÂ˲¨Æ÷²úÉú²¢ÇÒ¸ù¾Ý²½Öè(i)ÐÞÕýµÄËùÊöµ¼º½½âµÄËùÊö¹Û²âµÄºóÑé¹À¼ÆÖ®¼äµÄÆ«²î£» Ò»(iii)¶ÔËùÊö½»²æÐ½á¹û½øÐÐͳ¼Æ²âÊÔ£¬ÒÔÉùÃ÷ËùÊöÔʼ²âÁ¿²»±»ËùÊöÂ˲¨Æ÷ʹÓõÄËùÊöÎÀÐÇÊÇ·ñ¹ÊÕÏ¡£
2.¸ù¾ÝȨÀûÒªÇó1ËùÊöµÄ·½·¨£¬ÆäÖв½Öè(i)°üÀ¨: Ò»¶ÔÓÚÿ¸öÎÀÐÇ£¬È·¶¨ÖÁÉÙÒ»¸öÔÚÎÀÐÇ´æÔÚ¸ø¶¨ÐÔÖʵĹÊÕϵļÙÉèÓëÎÀÐDz»´æÔÚ¹ÊÕϵļÙÉèÖ®¼äµÄËÆÈ»±È(1r£¬1r¡¯)£» Ò»½«Óë¸ø¶¨ÐÔÖʵĹÊÕÏÏà¹ØÁªµÄËÆÈ»±È(1r£¬1r¡¯ )ÓëãÐÖµ±È½Ï£¬²¢ÇÒÈç¹ûÐèÒª£¬ÔòÉùÃ÷¸ø¶¨ÐÔÖʵĹÊÕÏ£» Ò»¹À¼ÆËùÉùÃ÷¹ÊÕ϶Ôͨ¹ýËùÊöÂ˲¨Æ÷²úÉúµÄËùÊöµ¼º½½âµÄÓ°Ï죻 Ò»¸ù¾Ý¶ÔËùÉùÃ÷¹ÊÕϵÄÓ°ÏìµÄ¹À¼ÆÀ´ÐÞÕýͨ¹ýËùÊöÂ˲¨Æ÷²úÉúµÄËùÊöµ¼º½½â¡£
3.¸ù¾ÝȨÀûÒªÇó2ËùÊöµÄ·½·¨£¬°üÀ¨¶Ôÿ¸öÎÀÐǼÆËã½»²æÐ½á¹ûºÍ½»²æÐ½á¹ûз½²î£¬ËùÊö½»²æÐ½á¹ûºÍËùÊö½»²æÐ½á¹ûз½²î·´Ó³¶ÔÓ¦ÓÚÀ´×ÔËùÊöÎÀÐǵÄÔʼ²âÁ¿µÄ¹Û²âÓëͨ¹ý²»Ê¹ÓÃÀ´×ÔËùÊöÎÀÐǵÄÔʼ²âÁ¿µÄKalmanÂ˲¨Æ÷²úÉúµÄËùÊö¹Û²âµÄºóÑé¹À¼ÆÖ®¼äµÄÆ«²î£¬¸ù¾Ý²»Ê¹ÓÃÀ´×ÔËùÊöÎÀÐǵÄÔʼ²âÁ¿µÄËùÊöKalmanÂ˲¨Æ÷ËùÌṩµÄËùÊö½»²æÐ½á¹ûºÍËùÊö½»²æÐ½á¹ûз½²î²¢¸ù¾Ý¸ø¶¨ÐÔÖʵĹÊÕ϶ÔËùÊö½»²æÐ½á¹ûµÄÓ°ÏìµÄ¹À¼ÆÀ´È·¶¨ËùÊöËÆÈ»±È(1r, 1r¡¯ )¡£
4.¸ù¾ÝȨÀûÒªÇó3ËùÊöµÄ·½·¨£¬ÆäÖÐͨ¹ý¸ù¾ÝÓɲ»Ê¹ÓÃÀ´×ÔËùÊöÎÀÐǵÄÔʼ²âÁ¿µÄËùÊöKalmanÂ˲¨Æ÷ÌṩµÄÊý¾ÝÈ·¶¨¶¯Ì¬Ð½á¹û¾ØÕóºÍͨ¹ý¹À¼Æ¶ÔÓ¦ÓÚ²»Ê¹ÓÃÀ´×ÔËùÊöÎÀÐǵÄÔʼ²âÁ¿µÄËùÊöKalmanÂ˲¨Æ÷µÄ¸ø¶¨ÊýÁ¿(N)µÄÔöÁ¿µÄ»¬¶¯¹À¼Æ´°¿ÚÉϸø¶¨ÐÔÖʵÄËùÊö¹ÊÕϵķù¶ÈÀ´¹À¼Æ¸ø¶¨ÐÔÖʵÄËùÊö¹ÊÕ϶ÔËùÊö½»²æÐ½á¹ûµÄÓ°Ï죬ËùÊö¶¯Ì¬Ð½á¹û¾ØÕó±íʾËùÊö¹ÊÕϵķù¶ÈÓëÓÉËùÊö½»²æÐ½á¹ûÉϵÄËùÊö¹ÊÕÏÒýÆðµÄÆ«²îÖ®¼äµÄÁªÏµ¡£
5.¸ù¾ÝȨÀûÒªÇó1ÖÁ4ÖеÄÒ»ÏîËùÊöµÄ·½·¨£¬ÆäÖÐͨ¹ý¸ù¾ÝÓɲúÉúµ¼º½½âµÄËùÊöKalmanÂ˲¨Æ÷ÌṩµÄÊý¾ÝÈ·¶¨¶¯Ì¬µ¼º½¾ØÕóºÍͨ¹ý¹À¼Æ¶ÔÓ¦ÓÚ²úÉúËùÊöµ¼º½½âµÄËùÊöKalmanÂ˲¨Æ÷µÄ¸ø¶¨ÊýÁ¿µÄÔöÁ¿µÄ»¬¶¯¹À¼Æ´°¿ÚÉϵĹÊÕϵķù¶ÈºÍз½²îÀ´¹À¼ÆËùÊö¹ÊÕ϶ÔËùÊöµ¼º½½âµÄÓ°Ï죬ËùÊö¶¯Ì¬µ¼º½¾ØÕó±íʾËùÊö¹ÊÕϵķù¶ÈÓëÓÉËùÊöµ¼º½½âÉϵĹÊÕÏÒýÆðµÄÆ«²îÖ®¼äµÄÁªÏµ¡£
6.¸ù¾ÝȨÀûÒªÇó1ÖÁ5ÖеÄÒ»ÏîËùÊöµÄ·½·¨£¬ÆäÖе±ËùÊö½»²æÐ½á¹û³¬¹ý¶ÔÓ¦ÓÚ(H-P1.HT+R^aµÄãÐֵʱ£¬ÔÚ²½Öè(iii)ÖнøÐеÄËùÊöͳ¼Æ²âÊÔÉùÃ÷ÎÀÐÇΪ¹ÊÕÏ£¬ÆäÖУ¬H±íʾËùÊöKalmanÂ˲¨Æ÷µÄ¹Û²â¾ØÕó£¬Pi±íʾÎó²îµÄз½²îµÄºóÑé¹À¼Æ¾ØÕó£¬Ri±íʾ²âÁ¿ÔëÉùµÄз½²î¾ØÕó£¬ÒÔ¼°¦Á±íʾ¸ù¾Ý´íÎó¼ì²â¸ÅÂÊÉèÖõÄϵÊý¡£
7.¸ù¾ÝȨÀûÒªÇó1ÖÁ6ÖеÄÒ»ÏîËùÊöµÄ·½·¨£¬ÆäÖÐËùÊö½»²æÐ½á¹û¶ÔÓ¦ÓÚͨ¹ýËùÊöÎÀÐǶ¨Î»ÏµÍ³´«µÝµÄµ½ÎÀÐǵÄα¾àÀëÓëÓɲ»Ê¹ÓÃͨ¹ýËùÊöÎÀÐÇ´«µÝµÄËùÊöα¾àÀëµÄKalmanÂ˲¨Æ÷ÌṩµÄËùÊöα¾àÀëµÄºóÑé¹À¼ÆÖ®¼äµÄÆ«²î¡£
8.¸ù¾ÝȨÀûÒªÇó1ÖÁ7ÖеÄÒ»ÏîËùÊöµÄ·½·¨£¬½øÒ»²½°üÀ¨ÒÔϲ½Öè: һʹÉùÃ÷Ϊ¹ÊÕϵÄÎÀÐÇÎÞЧ£¬ÒÔʹËùÊö¹ÊÕÏÎÀÐǵÄÔʼ²âÁ¿²»ÔÙ±»ËùÊöÂ˲¨Æ÷×éÖеÄËùÊöÂ˲¨Æ÷ʹÓ㬠һÈç¹ûÔÚÎÞЧºóµÄÔ¤ÏÈÈ·¶¨µÄÑÓʱÆÚÂúʱ£¬ËùÊö½»²æÐ½á¹ûµÄËùÊöͳ¼Æ²âÊÔ×ÜÊDzúÉúËùÊöÎÀÐǹÊÕϵĽáÂÛ£¬²¢ÇÒûÓÐÆäËû½»²æÐ½á¹û²âÊÔÒѾÉùÃ÷ÁíÒ»ÎÀÐǹÊÕÏ£¬ÔòÅųýËùÊöÎÞЧµÄÎÀÐÇ¡£
9.¸ù¾ÝȨÀûÒªÇó1ÖÁ8ÖеÄÒ»ÏîËùÊöµÄ·½·¨£¬»¹Õë¶ÔÂ˲¨Æ÷×éÖеÄÿһ¸öÂ˲¨Æ÷ÔÚ±»ËùÊöÂ˲¨Æ÷ʹÓõÄÿһ¸öÎÀÐÇÉϽøÐÐÏÈÑéнá¹ûµÄͳ¼Æ²âÊÔ£¬²¢ÇÒÆäÖÐÔÚÈô¸ÉÎÀÐÇÔÚËüÃǵĽ»²æÐ½á¹ûµÄͳ¼Æ²âÊÔÖ®ºó±»Éù Ã÷Ϊ¹ÊÕϵÄÇé¿öÏ£¬Ê¹²»±»¾ßÓÐ×î´óÊýÁ¿µÄÏÈÑéнá¹û¼°¶ÔÓÚËùÊöÏÈÑéнá¹ûËùÊöͳ¼Æ²âÊÔµÍÓÚãÐÖµµÄÂ˲¨Æ÷ʹÓõÄÎÀÐÇÎÞЧ£¬Ê¹µÃËùÊöÎÞЧÎÀÐǵÄÔʼ²âÁ¿²»ÔÙ±»ËùÊöÂ˲¨Æ÷×éÖеÄËùÊöÂ˲¨Æ÷ʹÓá£
10.¸ù¾ÝǰÊöȨÀûÒªÇóÖеÄÒ»ÏîËùÊöµÄ·½·¨£¬ÆäÖÐËùÊöÂ˲¨Æ÷×éÖеÄÿ¸öÂ˲¨Æ÷ͨ¹ý½«¹ßÐÔ²âÁ¿Óëͨ¹ýËùÊöÎÀÐÇ´«ÊäµÄÐźŵÄÔʼ²âÁ¿»ìºÏÀ´²úÉúµ¼º½½â¡£
11.Ò»ÖÖÎÀÐǶ¨Î»É豸£¬°üÀ¨KalmanÂ˲¨Æ÷×é(3)£¬Ã¿¸öKalmanÂ˲¨Æ÷¸ù¾Ýͨ¹ýÎÀÐÇ´«ÊäµÄÐźŵÄÔʼ²âÁ¿À´²úÉúµ¼º½½â£¬ÆäÌØÕ÷ÔÚÓÚËùÊöÎÀÐǶ¨Î»É豸°üÀ¨: Ò»µ÷½ÚÄ£¿é(6)£¬ËùÊöµ÷½ÚÄ£¿é(6)ÓÃÓÚÕë¶ÔËùÊöÂ˲¨Æ÷×éÖеÄÿ¸öÂ˲¨Æ÷¹À¼ÆÎÀÐǹÊÕ϶Ôͨ¹ýËùÊöÂ˲¨Æ÷²úÉúµÄËùÊöµ¼º½½âµÄÓ°Ï죬ÒÔ¼°ÔÚÉùÃ÷¹ÊÕϵÄÇé¿öÏ£¬¸ù¾Ý¶ÔËùÊö¹ÊÕϵÄÓ°ÏìµÄ¹À¼ÆÐÞÕýËùÊöµ¼º½½â£»Ä£¿é(7)ÓÃÓÚ¼ì²âÎÀÐǹÊÕÏ£¬ÅäÖÃËùÊöÄ£¿é(7)ÊÇΪÁË: ©–¶ÔÓÚËùÊöÂ˲¨Æ÷×éÖеÄÿ¸öÂ˲¨Æ÷¼ÆËã½»²æÐ½á¹û£¬ËùÊö½»²æÐ½á¹û·´Ó³¶ÔÓ¦ÓÚÀ´×Ô²»±»ËùÊöÂ˲¨Æ÷ʹÓõÄÎÀÐǵÄÔʼ²âÁ¿µÄ¹Û²âºÍÀ´×Ôͨ¹ýËùÊöKalmanÂ˲¨Æ÷²úÉú²¢ÓÉËùÊöµ÷½ÚÄ£¿éÐÞÕýµÄËùÊöµ¼º½½âµÄËùÊö¹Û²âµÄºóÑé¹À¼ÆÖ®¼äµÄÆ«²î£¬ÒÔ¼° ©–½øÐÐËùÊö½»²æÐ½á¹ûµÄͳ¼Æ²âÊÔ£¬ÒÔÉùÃ÷ËùÊöÎÀÐÇÊÇ·ñ¹ÊÕÏ¡£
È«ÎÄÕªÒª
¸ù¾ÝµÚÒ»·½Ã棬±¾·¢Ã÷Éæ¼°Ò»ÖÖÓÃÓÚ¼ì²éͨ¹ýÎÀÐÇ(GNSS)¶¨Î»É豸(1)Êä³öµÄλÖÃÐÅÏ¢µÄÍêÕûÐԵķ½·¨£¬ËùÊöÎÀÐǶ¨Î»É豸(1)°üÀ¨KalmanÂ˲¨Æ÷×é(3)£¬Ã¿¸öKalmanÂ˲¨Æ÷¸ù¾Ýͨ¹ýÎÀÐÇ´«ÊäµÄÐźŵÄÔʼ²âÁ¿²úÉúµ¼º½½â(dX0,dXi,dXn)£¬ÆäÌØÕ÷ÔÚÓÚ¶ÔÓÚÂ˲¨Æ÷×éÖеÄÿ¸öÂ˲¨Æ÷£¬¸Ã·½·¨°üÀ¨ÒÔϲ½Öè(i)¸ù¾ÝÎÀÐǹÊÕ϶Ե¼º½½âµÄÓ°ÏìµÄ¹À¼Æ£¬ÐÞÕýͨ¹ýËùÊöÂ˲¨Æ÷²úÉúµÄµ¼º½½â£»(ii)¼ÆËã½»²æÐ½á¹û£¬ËùÊö½»²æÐ½á¹û·´Ó³¶ÔÓ¦ÓÚÀ´×Ô²»±»Â˲¨Æ÷ʹÓõÄÎÀÐǵÄÔʼ²âÁ¿µÄ¹Û²âÓëÀ´×Ôͨ¹ýÂ˲¨Æ÷²úÉú²¢ÇÒ¸ù¾Ý²½Öè(i)ÐÞÕýµÄµ¼º½½âµÄËùÊö¹Û²âµÄºóÑé¹À¼ÆÖ®¼äµÄÆ«²î£»ÒÔ¼°(iii)¶Ô½»²æÐ½á¹û½øÐÐͳ¼Æ²âÊÔ£¬ÒÔÉùÃ÷ÆäÔʼ²âÁ¿²»±»Â˲¨Æ÷ʹÓõÄÎÀÐÇÊÇ·ñ¹ÊÕÏ¡£
Îĵµ±àºÅG01S19/20GK103097911SQ201180042977
¹«¿ªÈÕ2013Äê5ÔÂ8ÈÕ ÉêÇëÈÕÆÚ2011Äê8ÔÂ30ÈÕ ÓÅÏÈȨÈÕ2010Äê9ÔÂ8ÈÕ
·¢Ã÷ÕßS¡¤Îä¶û¿Ë ÉêÇëÈË:ÈøÈÈÄ··ÀÎñ°²È«¹«Ë¾