רÀûÃû³Æ£ºÒ»ÖÖбÖÃÈßÓà½ÝÁª¹ßÐÔµ¼º½ÏµÍ³µÄ¿ìËٱ궨·½·¨
¼¼ÊõÁìÓò£º
±¾·¢Ã÷Éæ¼°Ò»ÖÖбÖÃÈßÓà½ÝÁª¹ßÐÔµ¼º½ÏµÍ³µÄ¿ìËٱ궨·½·¨£¬ÊôÓÚº½¿Õ¡¢º½Ììµ¼º½¼¼ÊõÁìÓò¡£
±³¾°¼¼Êõ£º
´«Í³µÄ½ÝÁª¹ßµ¼ÏµÍ³·½°¸Îª¡°3ÍÓÂÝ+3¼ÓËٶȼơ±Õý½»ÅäÖã¬ÀûÓÃÍÓÂÝÓë¼ÓËٶȼƵÄÃô¸ÐÖá¹¹½¨¹ßµ¼ÏµÍ³µÄ±¾Ìå×ø±êϵ¡£Ôڹߵ¼½âËã¹ý³ÌÖн«ÀûÓÃÍÓÂÝÓë¼ÓËٶȼƵÄÈ«²¿Êä³öÐÅÏ¢¡£´«Í³µÄ½ÝÁªÊ½¹ßµ¼ÏµÍ³²»ÔÊÐí¹ßÐÔÃô¸ÐÔª¼þ²úÉú¹ÊÕÏÊä³ö£¬µ±ÈÎÒâ¹ßÐÔÃô¸ÐÔª¼þ·¢Éú¹ÊÕÏÊä³öÒ쳣ֵʱ£¬ÏµÍ³Êä³öµÄµ¼º½½á¹û½«²»ÔÙÓÐЧ¡£Òò´Ë´«Í³µÄ½ÝÁª¹ßµ¼ÏµÍ³ÖÐÈÎÒâ¹ßÐÔÆ÷¼þµÄ¹ÊÕϵÈͬÓÚÕûÌ×ϵͳµÄ±¨·Ï£¬ÒýÆðµÄºó¹û½«²»¿°ÉèÏë¡£¹ßµ¼ÏµÍ³µÄ¾«¶ÈºÍ¿É¿¿ÐԺܴó³Ì¶ÈÉÏÈ¡¾öÓÚ¹ßÐÔÃô¸ÐÔª¼þµÄ¾«¶È¼°¿É¿¿ÐÔ¡£Ìá¸ß¹ßÐÔÃô¸ÐÔª¼þµÄ¾«¶ÈºÍ¿É¿¿ÐÔ¡¤ÐèÒªÕû¸ö¹¤Òµ¼°ÖÆÔìҵˮƽµÄÌá¸ß£¬ÕâÐèÒªºÜ³¤µÄÑз¢ÖÜÆÚ²¢ÇÒͶÈë¾Þ´óµÄ²ÆÁ¦¡£ÔÚÏÖÓй¤ÒµÉú²úˮƽÌõ¼þÏ£¬²ÉÓÃÈßÓàÉè¼ÆÊÇÌá¸ß¹ßµ¼ÏµÍ³¿É¿¿ÐÔµÄÓÐЧ;¾¶¡£ÈßÓ༼Êõ¿É·ÖΪϵͳ¼¶ÈßÓ༰Æ÷¼þ¼¶ÈßÓàÁ½ÖÖ¡£ÏµÍ³¼¶ÈßÓàÖ¸Ò»Ì×»ò¶àÌ×ϵͳ×÷Ϊ±¸·Ý£¬µ±Ö÷ϵͳʧЧʱ±¸·Ýϵͳ¿ªÊ¼¹¤×÷£»Æ÷¼þ¼¶ÈßÓàÖ¸ÀûÓöà¸ö¹ßÐÔÃô¸ÐÔª¼þµÄ×î¼ÑÅäÖÃÀ´¹¹³ÉÈßÓàϵͳ£¬µ±Ò»¸ö»ò¶à¸öÆ÷¼þʧЧʱÈßÓàÆ÷¼þÈÔ¿ÉÍê³Éµ¼º½ÈÎÎñ¡£Æ½Ì¨Ê½¹ßµ¼ÏµÍ³»úе½á¹¹½ÏΪ¸´ÔÓ£¬¾ù²Éȡϵͳ¼¶ÈßÓà²ßÂÔ¡£ÓëÆ½Ì¨Ê½ÏµÍ³Ïà±È£¬½ÝÁªÊ½¹ßµ¼ÏµÍ³Ìå»ý½ÏС£¬¹ßÐÔÃô¸ÐÔª¼þÁé»îµØÓëÔØÌå¹ÌÁª£¬ÎÞÐèʹÓø´ÔӵĻúе֧³Ð¼°Îȶ¨Æ½Ì¨£¬Òò´ËÆ÷¼þ¼¶ÈßÓ༼Êõ¸üÊÊÓÃÓÚ½ÝÁªÊ½¹ßµ¼ÏµÍ³¡£ÈßÓ༼ÊõÒѳÉΪÌá¸ß½ÝÁª¹ßµ¼ÏµÍ³(SINS)¿É¿¿ÐÔ¼°¾«¶ÈµÄÖØÒª·½·¨Ö®Ò»¡£Ïà±È½Ïϵͳ¼¶ÈßÓ࣬Æ÷¼þ¼¶Ð±ÖÃÈßÓ෽ʽÔÚÌå»ý¹¦ºÄ¼°³É±¾·½Ãæ¾ßÓнϴóÓÅÊÆ£¬³ÉΪÈßÓà½ÝÁª¹ßµ¼ÏµÍ³(RSINS)µÄÊ×Ñ¡¡£Ð±ÖÃRSINSÔÚʹÓÃǰ±ØÐë¶Ô´«¸ÐÆ÷½øÐÐ׼ȷ±ê¶¨£¬ÒÔÈ·¶¨¸÷¹ßÐÔ´«¸ÐÆ÷µÄÁãÆ«¡¢±ê¶ÈÒòÊý¼°°²×°Ê§×¼½ÇµÈ²ÎÊý¡£´«Í³Õý½»ÐÍSINSÖ÷ÒªÓзÖÁ¢Ê½ºÍϵͳ¼¶Á½Öֱ궨·½·¨·ÖÁ¢±ê¶¨·¨Ö±½ÓÀûÓÃÍÓÂÝÒǺͼÓËٶȼƵÄÊä³ö×÷Ϊ¹Û²âÁ¿£¬Ò»°ã²ÉÓÃ×îС¶þ³Ë·¨£»ÏµÍ³¼¶±ê¶¨ÔòÀûÓÃÍÓÂÝÒǺͼÓËٶȼƵÄÊä³ö½øÐе¼º½½âË㣬ÒÔµ¼º½Îó²î(λÖÃÎó²î¡¢ËÙ¶ÈÎó²î¼°×Ë̬Îó²î)×÷Ϊ¹Û²âÁ¿À´±ê¶¨ÏµÍ³µÄÎó²î²ÎÊý¡£ÓÉÓÚбÖÃRSINS´«¸ÐÆ÷²ÉÓ÷ÇÕý½»°²×°·½Ê½£¬Æä±ê¶¨·½·¨ÓбðÓÚ´«Í³Õý½»ÐÍSINS¡£ÏÖÓеÄÈßÓà½ÝÁª¹ßµ¼ÏµÍ³±ê¶¨Ê±ÓÐ×ÅÈçϲ»×ãÖ®´¦I¡¢ÏÖÓйúÄÚ·ÖÁ¢Ê½±ê¶¨·½·¨½öÊÊÓÃÓÚ¾«¶È½ÏµÍµÄMEMSÆ÷¼þ×é³ÉµÄÈßÓà½ÝÁª¹ßµ¼ÏµÍ³£¬Í¨ÓÃÐԽϲ2¡¢¶ÔĿǰ¹úÄÚ¹ßÐÔÆ÷¼þˮƽ¶øÑÔ£¬Éв»ÄÜÍêÈ«·¢»Óϵͳ¼¶±ê¶¨µÄÓÅÊÆ£¬ÈôKalmanÂ˲¨Æ÷Éè¼Æ²»Ç¡µ±£¬¸÷±ê¶¨²ÎÊý¹ÀÖµ½«·¢É¢£¬ÑÏÖØÓ°Ïì±ê¶¨ÐÔÄÜ¡£
·¢Ã÷ÄÚÈÝ
±¾·¢Ã÷µÄÄ¿µÄÊÇΪÁ˽â¾öÉÏÊöÎÊÌ⣬Ìá³öÒ»ÖÖбÖÃÈßÓà½ÝÁª¹ßÐÔµ¼º½ÏµÍ³µÄ¿ìËٱ궨·½·¨£¬·Ö±ðÀûÓÃËÄλÖ÷¨ºÍÈýλÖÃת¶¯·¨±ê¶¨ÈßÓà¼ÓËٶȼƼ°ÍÓÂÝÒǵÄÁãÆ«¡¢±ê¶ÈÒòÊý¼°°²×°Ê§×¼½ÇµÈ±ê¶¨²ÎÊý£¬²¢ÇÒÀûÓ÷ÂÕæÆ½Ì¨ÑéÖ¤±¾·¢Ã÷±ê¶¨·½·¨µÄ׼ȷÐÔ¡£±¾·¢Ã÷±ê¶¨¾«¶È¸ß£¬²Ù×÷¼ò±ã£¬¾ßÓнϺõŤ³ÌÓ¦ÓüÛÖµ£¬Ó¦ÓÃÓÚ¹ßÐÔ´«¸ÐÆ÷ÁãÆ«¡¢±ê¶ÈÒòÊý¼°°²×°Ê§×¼½ÇµÈ²ÎÊýµÄ±æÊ¶ÖУ¬¿ÉÒÔÓÐЧµØ±æÊ¶³ö²ÎÊý£¬¾ßÓкܸߵı궨¾«¶È¡£Ò»ÖÖбÖÃÈßÓà½ÝÁª¹ßÐÔµ¼º½ÏµÍ³µÄ¿ìËٱ궨·½·¨£¬°üÀ¨ÒÔϼ¸¸ö²½Öè²½ÖèÒ»ÃèÊöбÖÃRSINS°²×°Ê§×¼½Ç£¬¹¹½¨±ê¶¨Á¿²â·½³Ì£»(I)бÖÃRSINS°²×°Ê§×¼½ÇÃèÊö£»(2)¹¹½¨Ð±ÖÃRSINS±ê¶¨Á¿²â·½³Ì£»²½Öè¶þ È·¶¨Ð±ÖÃRSINS±ê¶¨·½°¸£¬°üÀ¨È·¶¨ÈýÖáת̨λÖ㬼ÓËٶȼÆËÄλÖñ궨·½·¨£¬È·¶¨ÍÓÂÝÒDZ궨·½·¨£¬²ÉÓÃÍÓÂÝÒÇËÄλÖñ궨·½·¨»òÍÓÂÝÒÇÈýλÖÃת¶¯±ê¶¨·½·¨£»
²½ÖèÈý´î½¨Ð±ÖÃRSINS±ê¶¨·ÂÕæÆ½Ì¨£¬²¢ÀûÓ÷ÂÕæÆ½Ì¨ÑéÖ¤ËùÊöµÄ±ê¶¨·½·¨µÄ׼ȷÐÔ¡£±¾·¢Ã÷µÄÓŵãÔÚÓÚ(I)±¾·¢Ã÷ËùÊö·½·¨ÊÊÓÃÓÚ¶àÖÖ¾«¶ÈµÄбÖÃRINSµÄ±ê¶¨£¬¾ßÓÐͨÓÃÐÔ£»(2)±¾·¢Ã÷ËùÊö·½·¨±ê¶¨¾«¶È½Ï¸ß£¬²Ù×÷¼òµ¥ÇÒºÄʱ¶Ì£¬¿ÉÒÔÂú×ãÖС¢µÍ¾«¶ÈбÖÃRSINSµÄ¿ìËٱ궨ÐèÇó£»(3)±¾·¢Ã÷ËùÊö·½·¨¶ÔÓÚÖе;«¶ÈÍÓÂÝÒÇ£¬ÈýλÖÃת¶¯±ê¶¨·½·¨ÓÐЧÔöÇ¿ÁËÍÓÂÝÒDZ궨²ÎÊý¿É¹Û²âÐÔ¡£
ͼIÊDZ¾·¢Ã÷ÀíÏë´«¸ÐÆ÷ÖáÏòÓëϵͳ±¾Ìå×ø±êϵµÄ°²×°¹ØÏµ£»Í¼2ÊDZ¾·¢Ã÷ʵ¼Ê´«¸ÐÆ÷ÖáÏòÓëϵͳ±¾Ìå×ø±êϵµÄ°²×°¹ØÏµ£»Í¼3ÊDZ¾·¢Ã÷±ê¶¨·ÂÕæÆ½Ì¨½á¹¹¿òͼ£»Í¼4ÊDZ¾·¢Ã÷ÁùÈßÓàRSINSµÄÕýÊ®¶þÃæÌå°²×°·½Ê½£»Í¼5ÊDZ¾·¢Ã÷µÄ·½·¨Á÷³Ìͼ¡£Í¼ÖÐIһбÖÃRSINSÅäÖ÷½Ê½Ñ¡ÔñÄ£¿é 2 ¡ª MUÊý¾Ý¹¹ÔìÄ£¿é 3¡ª±ê¶¨²ÎÊýÑ¡ÔñÄ£¿é4 һת̨λÖúÍËÙÂÊÑ¡ÔñÄ£¿é5¡ª±ê¶¨²ÎÊý½âËãÄ£¿é6¡ª±ê¶¨½á¹ûÑé֤ģ¿é
¾ßÌåʵʩÀý·½Ê½ÏÂÃæ½«½áºÏ¸½Í¼ºÍʵʩÀý¶Ô±¾·¢Ã÷×÷½øÒ»²½µÄÏêϸ˵Ã÷¡£±¾·¢Ã÷ÊÇÒ»ÖÖбÖÃÈßÓà½ÝÁª¹ßÐÔµ¼º½ÏµÍ³µÄ¿ìËٱ궨·½·¨£¬Ê×Ïȸø³öÁËбÖÃRSINS (бÖÃÈßÓà½ÝÁª¹ßÐÔµ¼º½ÏµÍ³)µÄ±ê¶¨Á¿²â·½³Ì²¢×ÅÖØÃèÊöÁËÆä°²×°Ê§×¼½Ç£»È»ºó¸ø³öÁ˼ÓËٶȼƺÍÍÓÂÝÒǵÄËÄλÖñ궨·½·¨£¬²¢Õë¶ÔµÍ¾«¶ÈÍÓÂÝÒÇÌá³öÁËÈýλÖÃת¶¯±ê¶¨·½·¨£»×îºó´î½¨Ð±ÖÃRSINS±ê¶¨·ÂÕæÆ½Ì¨£¬ÃèÊö¸÷¹¦ÄÜÄ£¿é×÷Ó㬲¢ÀûÓ÷ÂÕæÆ½Ì¨ÑéÖ¤ÒÔÉϱ궨·½·¨µÄ׼ȷÐÔ¡£Á÷³ÌÈçͼ5Ëùʾ£¬°üÀ¨ÒÔϼ¸¸ö²½Öè²½ÖèÒ»ÃèÊöбÖÃRSINS°²×°Ê§×¼½Ç£¬¹¹½¨±ê¶¨Á¿²â·½³Ì¡£
(I)бÖÃRSINS°²×°Ê§×¼½ÇÃèÊöÔÚбÖÃRSINSÖУ¬´«¸ÐÆ÷×ø±êϵ(sϵ)²¢·ÇÈýÖáÕý½»µÄµÑ¿¨¶û×ø±êϵ£¬Òò´Ë±ØÐ뽫´«¸ÐÆ÷Êä³öÓ³ÉäÖÁϵͳ±¾Ìå¹ÌÁ¬×ø±êϵ(bϵ)£¬ÒÔÍê³É³£¹æ¹ßµ¼½âËã¡£ÈçͼIËùʾOXbYbZbΪϵͳ±¾Ìå¹ÌÁ¬×ø±êϵѶ±íʾµÚi¸ö´«¸ÐÆ÷µÄÖáÏò£¬HiÓëbϵ¾ßÓÐÈçÏÂÓ³Éä¹ØÏµ
ȨÀûÒªÇó
1.Ò»ÖÖбÖÃÈßÓà½ÝÁª¹ßÐÔµ¼º½ÏµÍ³µÄ¿ìËٱ궨·½·¨£¬ÆäÌØÕ÷ÔÚÓÚ£¬°üÀ¨ÒÔϼ¸¸ö²½Öè ²½ÖèÒ»ÃèÊöбÖÃRSINS°²×°Ê§×¼½Ç£¬¹¹½¨±ê¶¨Á¿²â·½³Ì£» (1)бÖÃRSINS°²×°Ê§×¼½ÇÃèÊö RSINS±íʾÈßÓà½ÝÁª¹ßµ¼ÏµÍ³£¬ÔÚбÖÃRSINSÖУ¬´«¸ÐÆ÷×ø±êϵΪsϵ£¬ÏµÍ³±¾Ìå¹ÌÁ¬×ø±êϵΪbϵ,OXbYbZb±í²»ÏµÍ³±¾Ìå¹ÌÁ¬×ø±êϵ,Hi±í²»µÚi¸ö´«¸ÐÆ÷µÄÖáÏò£¬HiÓëbϵ¾ßÓÐÈçÏÂÓ³Éä¹ØÏµ
2.¸ù¾ÝȨÀûÒªÇóIËùÊöµÄÒ»ÖÖбÖÃÈßÓà½ÝÁª¹ßÐÔµ¼º½ÏµÍ³µÄ¿ìËٱ궨·½·¨£¬ÆäÌØÕ÷ÔÚÓÚ£¬ËùÊöµÄʵ¼ÊʹÓÃÁ¿Îª ʵ¼ÊʹÓÃÁ¿=°²×°Ê§×¼½Ç¾ØÕó*{(ÔʼÂö³åÁ¿-¹ÌÓÐÁãÆ«Öµ)/Æ÷¼þ±ê¶ÈÒòÊý} ¼ÓËٶȼơ¢ÍÓÂÝÒǵݲװʧ׼½Ç¡¢¹ÌÓÐÁãÆ«Öµ¡¢±ê¶ÈÒòÊý·Ö±ð´úÈëÉÏʽ£¬µÃµ½¼ÓËٶȼƵÄʵ¼ÊʹÓÃÁ¿¡¢ÍÓÂÝÒǵÄʵ¼ÊʹÓÃÁ¿¡£
È«ÎÄÕªÒª
±¾·¢Ã÷¹«¿ªÁËÒ»ÖÖбÖÃÈßÓà½ÝÁª¹ßµ¼ÏµÍ³¿ìËٱ궨·½·¨£¬°üÀ¨²½ÖèÒ»ÃèÊöбÖÃRSINS°²×°Ê§×¼½Ç£¬¸ø³ö±ê¶¨Á¿²â·½³Ì¡£²½Öè¶þÉè¼ÆÐ±ÖÃRSINS±ê¶¨·½°¸¡£²½ÖèÈý´î½¨Ð±ÖÃRSINS±ê¶¨·ÂÕæÆ½Ì¨£¬²¢ÀûÓ÷ÂÕæÆ½Ì¨ÑéÖ¤±ê¶¨·½·¨µÄ׼ȷÐÔ¡£±¾·¢Ã÷»ùÓÚÈýÖáλÖÃ/ËÙÂÊת̨¶ÔбÖÃRSINS½øÐпìËٱ궨£¬·Ö±ðÀûÓÃËÄλÖ÷¨ºÍÈýλÖÃת¶¯·¨±ê¶¨ÈßÓà¼ÓËٶȼƼ°ÍÓÂÝÒǵÄÁãÆ«¡¢±ê¶ÈÒòÊý¼°°²×°Ê§×¼½ÇµÈ±ê¶¨²ÎÊý£¬²¢ÀûÓ÷ÂÕæÆ½Ì¨ÑéÖ¤ÒÔÉϱ궨·½·¨µÄ׼ȷÐÔ¡£±¾·¢Ã÷±ê¶¨¾«¶È¸ß£¬²Ù×÷¼ò±ã£¬¿ÉÒÔÂú×ãÖС¢µÍ¾«¶ÈбÖÃRSINSµÄ¿ìËٱ궨ÐèÇ󣬾ßÓнϺõŤ³ÌÓ¦ÓüÛÖµ¡£
Îĵµ±àºÅG01C25/00GK102927994SQ20121040485
¹«¿ªÈÕ2013Äê2ÔÂ13ÈÕ ÉêÇëÈÕÆÚ2012Äê10ÔÂ23ÈÕ ÓÅÏÈȨÈÕ2012Äê10ÔÂ23ÈÕ
·¢Ã÷ÕßÕÅ´ºìä, ËÎÀ´ÁÁ, êË´úºê, ÖÜСºì ÉêÇëÈË:±±¾©º½¿Õº½Ìì´óѧ