רÀûÃû³Æ£ºÒ»ÖÖ¹ßÐÔµ¼º½ÏµÍ³ÖйßÐÔ´«¸ÐÆ÷¹Ì¶¨Îó²îʵʱ±ê¶¨·½·¨
¼¼ÊõÁìÓò£º
±¾·¢Ã÷¹«¿ªÁËÒ»ÖÖ¹ßÐÔµ¼º½ÏµÍ³ÖйßÐÔ´«¸ÐÆ÷¹Ì¶¨Îó²îʵʱ±ê¶¨·½·¨£¬ÊôÓÚ¹ßÐÔµ¼º½¹ßÐÔ´«¸ÐÆ÷Îó²î±ê¶¨¼¼ÊõÁìÓò¡£
±³¾°¼¼Êõ£º
½üÄêÀ´£¬Ëæ×ÅÐÂÐÍ·ÉÐÐÆ÷µÄÑÐÖÆ£¬¶Ôµ¼º½ÏµÍ³ÐÔÄܵÄÒªÇóÈÕÒæÌá¸ß¡£¹ßÐÔµ¼º½ÏµÍ³¾ßÓжÌʱ¾«¶È¸ß¡¢Êä³öÁ¬ÐøÒÔ¼°ÍêÈ«×ÔÖ÷µÈÍ»³öÓÅµã±ØÊÇδÀ´ÐÂÐÍ·ÉÐÐÆ÷µÄºËÐĵ¼º½ÐÅÏ¢µ¥Ôª¡£¹ßÐÔ´«¸ÐÆ÷GMU-ÍÓÂÝÒǺͼÓËٶȼÆ)µÄ²âÁ¿Îó²îÊÇÓ°Ïì¹ßÐÔµ¼º½ÏµÍ³¾«¶ÈµÄÖ÷ÒªÒòËØ¡£´«Í³IMUÎó²îÄ£ÐÍÖУ¬ÍùÍùÈÏΪÆä¹Ì¶¨ÐÔÎó²îÒ»°²×°Îó²îºÍ±ê¶ÈÒòÊýÎó²îÔÚ¾²Ì¬±ê¶¨ºóÍêÈ«²¹³¥£¬MUÎó²îÖнö°üº¬Ëæ»úÆ¯ÒÆÎó²î¡£¶øÔÚ·ÉÐÐÆ÷¶¯Ì¬·ÉÐйý³ÌÖУ¬ÓÉÕñ¶¯³å»÷¡¢ÆøÁ÷ÈŶ¯µÈÓ°Ïìµ¼ÖµĻúÌå±äÐν«ÒýÆðIMUµÄÖáÏß²»ÄÜÓë»úÌåÖáÏßÍêÈ«ÖØºÏ£¬½ø¶øµ¼Ö°²×°Îó²î¼°±ê¶ÈÒòÊýÎó²îÏÔÖøÔö´ó¡£ÕâЩÎó²îÈç¹ûÔÚ·ÉÐÐÆ÷¶¯Ì¬·ÉÐйý³ÌÖв»ÄܽøÐб궨²¹³¥½«Ôںܴó³Ì¶ÈÉÏÓ°Ïìµ¼º½¾«¶È¡£´«Í³µÄIMUÎó²î±ê¶¨·½·¨¶àÀûÓÃת̨ÔÚÊÒÄÚ½øÐÐλÖÃÊÔÑé¼°ËÙÂÊÊÔÑéʵÏÖ¶Ô°²×°Îó²îºÍ±ê¶ÈÒòÊýÎó²îµÄ±ê¶¨¡£µ«ÔÚ·ÉÐÐÆ÷¶¯Ì¬·ÉÐйý³ÌÖУ¬ÓÉÓÚ»·¾³Ó°Ï죬´«Í³ÀûÓÃת̨µÄ±ê¶¨·½·¨½«²»ÔÙÊÊÓ᣷ÉÐÐÆ÷¶¯Ì¬·ÉÐйý³ÌÖУ¬´«Í³¶Ô¹ßÐÔ´«¸ÐÆ÷µÄÎó²îÐÞÕý½öÕë¶ÔÆäËæ»úÐÔÎó²î£¬²»¿¼ÂÇÆä°²×°Îó²îºÍ±ê¶ÈÒòÊýÎó²îµÈ¹Ì¶¨ÐÔÎó²îµÄÓ°Ïì¡£¶øÓÉÓÚ·ÉÐÐÕñ¶¯µÈÓ°ÏìÒýÆðµÄ°²×°Îó²îºÍ±ê¶ÈÒòÊýÎó²î½«»áºÜ´ó³Ì¶ÈÉÏÓ°Ïì¹ßÐÔµ¼º½ÏµÍ³¾«¶È£¬±ØÐë¶ÔÆä½øÐб궨ºÍ²¹³¥ÐÞÕý¡£Òò´Ë£¬Ñо¿Ò»ÖÖÔÚ·ÉÐÐÆ÷¶¯Ì¬·ÉÐйý³ÌÖжԹßÐÔ´«¸ÐÆ÷¹Ì¶¨ÐÔÎó²îµÄ±ê¶¨·½·¨£¬Äܹ»ÓÐЧÌá¸ß·ÉÐÐÆ÷¶¯Ì¬·ÉÐйý³ÌÖеĹßÐÔµ¼º½ÏµÍ³¾«¶È£¬½«¾ßÓÐÍ»³öµÄÓ¦ÓüÛÖµ¡£
·¢Ã÷ÄÚÈÝ
±¾·¢Ã÷µÄÄ¿µÄÔÚÓÚÌá³öÒ»ÖÖ¹ßÐÔµ¼º½ÏµÍ³¹ßÐÔ´«¸ÐÆ÷µÄ¹Ì¶¨ÐÔÎó²î½¨Ä£¼°ÊµÊ±±ê¶¨·½·¨£¬ÒÔÂú×ã·ÉÐÐÆ÷¶¯Ì¬·ÉÐйý³ÌÖеĶԵ¼º½ÏµÍ³µÄ¸ß¾«¶ÈÒªÇó¡£±¾·¢Ã÷Ϊ½â¾öÉÏÊö¼¼ÊõÎÊÌâ²ÉÓÃÒÔϼ¼Êõ·½°¸£¬Ò»ÖÖ¹ßÐÔµ¼º½ÏµÍ³ÖйßÐÔ´«¸ÐÆ÷¹Ì¶¨Îó²îʵʱ±ê¶¨·½·¨£¬ËùÊö·½·¨¾ßÌå²½ÖèÈçÏÂ:²½Öè1¡¢½¨Á¢¹ßÐÔ´«¸ÐÆ÷µÄ¹Ì¶¨ÐÔÎó²îÄ£ÐÍ£¬°üÀ¨¼ÓËٶȼƱê¶ÈÒòÊýÎó²î¾ØÕóºÍÍÓÂÝÒǵıê¶ÈÒòÊýÎó²î¾ØÕó:¼ÓËٶȼƱê¶ÈÒòÊýÎó²î¾ØÕóΪSKa = diag[SKAx 6 KAy S KaJ£¬ÆäÖУ¬S KAx¡¢6 KAy¡¢6 Kaz·Ö±ðΪXÖá¡¢YÖá¼°ZÖá¼ÓËٶȼƵıê¶ÈÒòÊýÎó²î£»¼ÓËٶȼư²×°Îó²î¾ØÕóΪ
0SA.-SAy
SA= -SAz 0 SAx £¬ÆäÖУ¬6AX, 6Ay, S Az·Ö±ðΪXÖá¡¢YÖá¼°ZÖá¼ÓËٶȼƵݲSAv -SAx 0
×°Îó²î½Ç£»3&ºÍS A¾ùÈ¡ÎªËæ»ú³£Êý£¬X¡¢Y¡¢ZÈýÖáµÄ¼ÓËٶȼÆÎó²îÄ£ÐÍÏàͬ£¬ÈçÏÂËùʾ:
ȨÀûÒªÇó
1.Ò»ÖÖ¹ßÐÔµ¼º½ÏµÍ³ÖйßÐÔ´«¸ÐÆ÷¹Ì¶¨Îó²îʵʱ±ê¶¨·½·¨£¬ÆäÌØÕ÷ÔÚÓÚ£¬ËùÊö·½·¨¾ßÌå²½ÖèÈçÏÂ: ²½Öè1¡¢½¨Á¢¹ßÐÔ´«¸ÐÆ÷µÄ¹Ì¶¨ÐÔÎó²îÄ£ÐÍ£¬°üÀ¨¼ÓËٶȼƱê¶ÈÒòÊýÎó²î¾ØÕóºÍÍÓÂÝÒǵıê¶ÈÒòÊýÎó²î¾ØÕó: ¼ÓËٶȼƱê¶ÈÒòÊýÎó²î¾ØÕóΪSKa = diag[ S Kax 8KAy 6 1^]£¬ÆäÖУ¬61^¡¢61^¡¢¦ÄKaz·Ö±ðΪXÖá¡¢YÖá¼°ZÖá¼ÓËٶȼƵıê¶ÈÒòÊýÎó²î£»¼ÓËٶȼư²×°Îó²î¾ØÕóΪ
2.ÈçȨÀûÒªÇó1ËùÊöµÄÒ»ÖÖ¹ßÐÔµ¼º½ÏµÍ³ÖйßÐÔ´«¸ÐÆ÷¹Ì¶¨Îó²îʵʱ±ê¶¨·½·¨£¬ÆäÌØÕ÷ÔÚÓÚ£¬²½Öè3ÖÐËùÊö¶ÔIMU°²×°Îó²îºÍ±ê¶ÈÒòÊýÎó²îµÄ±ê¶¨Óë²¹³¥£¬Æä¾ßÌå²½ÖèΪ: (301)½«Â˲¨Æ÷״̬·½³ÌºÍÁ¿²â·½³ÌÀëÉ¢»¯´¦Àí:
È«ÎÄÕªÒª
±¾·¢Ã÷¹«¿ªÁËÒ»ÖÖ¹ßÐÔµ¼º½ÏµÍ³ÖйßÐÔ´«¸ÐÆ÷¹Ì¶¨Îó²îʵʱ±ê¶¨·½·¨£¬¸Ã·½·¨°üÀ¨ÒÔϲ½ÖèÊ×ÏȽ¨Á¢¹ßÐÔ´«¸ÐÆ÷ÔÚ·ÉÐÐÆ÷¶¯Ì¬·ÉÐйý³ÌÖеĹ̶¨ÐÔÎó²îÄ£ÐÍ£¬¹Ì¶¨Îó²î°üÀ¨°²×°Îó²îºÍ±ê¶ÈÒòÊýÎó²î£»ÔÚ´«Í³µÄIMUËæ»úÎó²îÄ£Ðͼ°Ëù½¨Á¢µÄ¹Ì¶¨ÐÔÎó²îÄ£Ð͵Ļù´¡ÉÏ£¬Ëæºó½¨Á¢°üº¬¹ßÐÔ´«¸ÐÆ÷¹Ì¶¨Îó²îÔÚÄÚµÄÂ˲¨×´Ì¬·½³Ì¼°Î»Öá¢ËٶȺÍ×Ë̬ÏßÐÔÁ¿²â·½³Ì£»×îºóÔÚ·ÉÐÐÆ÷¶¯Ì¬·ÉÐйý³ÌÖжԹßÐÔ´«¸ÐÆ÷¹Ì¶¨ÐÔÎó²î½øÐÐʵʱ¶¯Ì¬±ê¶¨ÓëУÕý£¬»ñµÃ¹ßÐÔ´«¸ÐÆ÷¹Ì¶¨ÐÔÎó²î²¹³¥Ð£ÕýºóµÄ¹ßÐÔµ¼º½ÏµÍ³µ¼º½½á¹û¡£±¾·½·¨Äܹ»ÔÚ·ÉÐÐÆ÷µÄ¶¯Ì¬·ÉÐйý³ÌÖÐʵÏÖ¶Ô¹ßÐÔµ¼º½ÏµÍ³ÖйßÐÔ´«¸ÐÆ÷°²×°Îó²îºÍ±ê¶ÈÒòÊýÎó²îµÄ±ê¶¨¼°Ð£Õý£¬ÓÐЧÌá¸ß¹ßÐÔµ¼º½ÏµÍ³ÐÔÄÜ£¬ÊʺÏÓÚ¹¤³ÌÓ¦Óá£
Îĵµ±àºÅG01C25/00GK103245359SQ20131014270
¹«¿ªÈÕ2013Äê8ÔÂ14ÈÕ ÉêÇëÈÕÆÚ2013Äê4ÔÂ23ÈÕ ÓÅÏÈȨÈÕ2013Äê4ÔÂ23ÈÕ
·¢Ã÷ÕßÅí»Ý, Íõ¶«Éý, ÕųÐ, Ðí½¨ÐÂ, ÍõÈÚ, ÐÜÖÇ, Áõ½¨Òµ, ÕÔ»Û, °ØÇàÇà, Íõ½à ÉêÇëÈË:ÄϾ©º½¿Õº½Ìì´óѧ