רÀûÃû³Æ£ºÒ»ÖÖ¾²Ö¹¹ìµÀÎÀÐÇ×ÔÖ÷µ¼º½·½·¨
¼¼ÊõÁìÓò£º
±¾·¢Ã÷Éæ¼°Ò»ÖÖ¾²Ö¹¹ìµÀÎÀÐÇ×ÔÖ÷µ¼º½·½·¨£¬ÊôÓÚÎÀÐÇ×ÔÖ÷µ¼º½Ñо¿ÁìÓò£¬¿ÉÒÔÓ¦ÓÃÓÚ¾²Ö¹¹ìµÀÎÀÐÇ×ÔÖ÷µ¼º½ÈÎÎñ¡£
±³¾°¼¼Êõ£º
´«Í³ÎÀÐÇÔÚÊÙÃüÖÜÆÚÄÚÍêÈ«ÒÀÀµµØÃæ²â¿ØÏµÍ³µÄÖ§³Ö£¬ÓëÖ®Ïà±È£¬ÖÐÐÇ2AÎÀÐÇÊÇÎÒ¹úµÚÒ»¿Å¾ßÓÐ×ÔÖ÷Éú´æÄÜÁ¦µÄµØÇò¾²Ö¹¹ìµÀͨÐÅÎÀÐÇ£¬ÆäËù²ÉÓõÄ×ÔÖ÷µ¼º½·½·¨Îª¸Ã¼¼ÊõÊ״餳ÌÓ¦Óã¬ËùÓõķ½·¨ÊôÓÚÌìÎĵ¼º½·½·¨£¬ÕâÒ»´óÀà·½·¨´ÓËã·¨½Ç¶ÈÒѾ½ÏΪ³ÉÊ죬²¢Ò²²úÉúÁ˶àÖÖÐÂÐÍÃô¸ÐÆ÷£¬Èç¿Õ¼äÁù·ÖÒǵȣ¬ÈçÖÐÐÇ2AÉÏÓõ½µÄ»ùÓÚµØÇòÃô¸ÐÆ÷ºÍÐÇÃô¸ÐÆ÷µÄµ¼º½Â˲¨Ëã·¨ÊDZȽÏÊʺÏĿǰ·¢Õ¹Ç÷ÊÆµÄ·½·¨£¬Ê×ÏÈÊÇ·½·¨½ÏΪ¼òµ¥(ÒѾ»ñµÃÎÒ¹úרÀû±£»¤)£¬Æä´ÎÊÇ·½·¨ËùÓõ½µÄ²¿¼þÊôÓÚÐÇÉϳ£ÓÃ×Ë̬ȷ¶¨²¿¼þ£¬Äܹ»³¤ÆÚÔڹ첻¼ä¶Ï ¹¤×÷£¬¼´µ¼º½·½°¸²»¶ÔÐÇÉÏ×ÊÔ´²úÉúеÄÐèÇó£»ÔÚÔÓе¼º½Â˲¨·½·¨µÄ»ù´¡ÉÏ£¬ÖÐÐÇ2AÕë¶Ô¾²Ö¹¹ìµÀÎÀÐǵÄÔËÐÐÒªÇó£¬ÓÈÆäÊǹìµÀ¿ØÖÆÒªÇ󣬴´ÔìÐÔ½«ÐÇÉϹìµÀ½âÎöÍâÍÆËã·¨ºÍµ¼º½Â˲¨ºóµÄ´¦Àí½á¹ûÓлú½áºÏÆðÀ´£¬¼ÈʹµÃÎÀÐÇ×ÔÖ÷»ñÈ¡ÁËʵʱλÖã¬Í¬Ê±Ò²»ñµÃÁËÊʺÏÓÚ¹ìµÀ¿ØÖƵĹìµÀÐÅÏ¢¡£
·¢Ã÷ÄÚÈÝ
±¾·¢Ã÷µÄÄ¿µÄÊÇΪÁËÌá³öÒ»ÖÖ¾²Ö¹¹ìµÀÎÀÐÇ×ÔÖ÷µ¼º½·½·¨£¬¸Ã·½·¨Äܹ»¸ø³ö¾²Ö¹¹ìµÀÎÀÐÇʵʱµÄ¹ìµÀÐÅÏ¢¡£±¾·¢Ã÷µÄÄ¿µÄÊÇͨ¹ýÒÔϼ¼Êõ·½°¸ÊµÏֵġ£±¾·¢Ã÷µÄÒ»ÖÖ¾²Ö¹¹ìµÀÎÀÐÇ×ÔÖ÷µ¼º½·½·¨£¬¸Ã·½·¨µÄ²½ÖèΪI)»ùÓÚÐÇÃô¸ÐÆ÷ºÍµØÇòÃô¸ÐÆ÷µÄkalmanÂ˲¨Ëã·¨£¬ÊµÊ±µÃµ½ÎÀÐÇÏà¶ÔÓÚ¶¨µãµÄλÖÃÆ«²îÖµ£»2)¶Ô²½ÖèI)µÃµ½µÄλÖÃÆ«²îÖµÓÃ×îС¶þ³Ë·½·¨½øÐÐÊý¾Ý´¦Àí£¬»ñµÃÒ»ÌìÄڵĹìµÀÆ½ÃæÄ򵀮½¾ù¹ìµÀ¸ùÊý¼´°ë³¤ÖᡢƫÐÄÂÊ¡¢½üµØµã·ù½ÇºÍÕæ½üµã½Ç£»¶Ô²½ÖèI)µÃµ½µÄλÖÃÆ«²îÖµÓÃÆ½¾ùÂ˲¨·½·¨»ñµÃÒ»ÌìÄڵĹìµÀÆ½ÃæÍâµÄƽ¾ù¹ìµÀ¸ùÊý¼´¹ìµÀÇã½ÇºÍÉý½»µã³à¾£»3)ÒÔ²½Öè2)µÃµ½µÄƽ¾ù¹ìµÀ¸ùÊý×÷ΪÐÇÉϹìµÀ½âÎöÍâÍÆËã·¨µÄÊäÈëÖµ£¬ÍâÍÆ¼ÆËãÒ»ÌìÄÚÎÀÐǹìµÀλÖã¬ÌṩÁ¬Ðøµ¼º½¶¨Î»ÐÅÏ¢£¬ÊµÏÖÎÀÐÇ×ÔÖ÷µ¼º½¹¦ÄÜ¡£ÓÐÒæÐ§¹û±¾·¢Ã÷µÄ·½·¨ÒѾÔÚÖÐÐÇ2AÉϳɹ¦Ó¦Ó㬾¹ýÔÚ¹ì±ê¶¨ºó×ÔÖ÷¹ìµÀÈ·¶¨¾«¶ÈÓÅÓÚ10km£¬¸Ã·½·¨¿ÉÒÔÍÆ¹ãÓ¦ÓÃÓÚËùÓÐÒªÇó¾ß±¸×ÔÖ÷¹¦ÄܵĵØÇò¾²Ö¹¹ìµÀÎÀÐÇ¡£
ͼIΪÎÀÐÇ×ÔÖ÷µ¼º½²âÁ¿ÔÀíʾÒâͼ£»Í¼2Ϊ¹ìµÀÆ½Ãæ²ÎÊýÈ·¶¨Ê¾Òâͼ¡£
¾ßÌåʵʩÀý·½Ê½ÏÂÃæ½áºÏ¸½Í¼ºÍʵʩÀý¶Ô±¾·¢Ã÷×÷½øÒ»²½ËµÃ÷¡£ÊµÊ©ÀýI)ÎÀÐÇ×ÔÖ÷µ¼º½ËùÐèµÄÐÇÉϲâÁ¿²¿¼þΪÐÇÃô¸ÐÆ÷ºÍµØÇòÃô¸ÐÆ÷£¬»ùÓÚÐÇÃô¸ÐÆ÷ºÍµØÇòÃô¸ÐÆ÷µÄkalmanÂ˲¨Ëã·¨ÒÔ´Ë±ê³Æ¹ìµÀ¶¨µãλÖý¨Á¢Hill·½³Ì£¬¼´ÎÀÐÇÏà¶Ô±ê³Æ¹ìµÀ¶¨µãλÖõÄÏà¶ÔÔ˶¯·½³Ì£¬×÷ΪkalmanÂ˲¨Ëã·¨µÄ״̬·½³Ì£¬·½³ÌÐÎʽÈçÏÂ
ȨÀûÒªÇó
1.Ò»ÖÖ¾²Ö¹¹ìµÀÎÀÐÇ×ÔÖ÷µ¼º½·½·¨£¬ÆäÌØÕ÷ÔÚÓڸ÷½·¨µÄ²½ÖèΪ 1)»ùÓÚÐÇÃô¸ÐÆ÷ºÍµØÇòÃô¸ÐÆ÷µÄkalmanÂ˲¨Ëã·¨£¬ÊµÊ±µÃµ½ÎÀÐÇÏà¶ÔÓÚ¶¨µãµÄλÖÃÆ«²îÖµ£» 2)¶Ô²½ÖèI)µÃµ½µÄλÖÃÆ«²îÖµÓÃ×îС¶þ³Ë·½·¨½øÐÐÊý¾Ý´¦Àí£¬»ñµÃÒ»ÌìÄڵĹìµÀÆ½ÃæÄ򵀮½¾ù¹ìµÀ¸ùÊý¼´°ë³¤ÖᡢƫÐÄÂÊ¡¢½üµØµã·ù½ÇºÍÕæ½üµã½Ç£»¶Ô²½ÖèI)µÃµ½µÄλÖÃÆ«²îÖµÓÃÆ½¾ùÂ˲¨·½·¨»ñµÃÒ»ÌìÄڵĹìµÀÆ½ÃæÍâµÄƽ¾ù¹ìµÀ¸ùÊý¼´¹ìµÀÇã½ÇºÍÉý½»µã³à¾£» 3)ÒÔ²½Öè2)µÃµ½µÄƽ¾ù¹ìµÀ¸ùÊý×÷ΪÐÇÉϹìµÀ½âÎöÍâÍÆËã·¨µÄÊäÈëÖµ£¬ÍâÍÆ¼ÆËãÒ»ÌìÄÚÎÀÐǹìµÀλÖã¬ÌṩÁ¬Ðøµ¼º½¶¨Î»ÐÅÏ¢£¬ÊµÏÖÎÀÐÇ×ÔÖ÷µ¼º½¹¦ÄÜ¡£
2.¸ù¾ÝȨÀûÒªÇóIËùÊöµÄÒ»ÖÖ¾²Ö¹¹ìµÀÎÀÐÇ×ÔÖ÷µ¼º½·½·¨£¬ÆäÌØÕ÷ÔÚÓÚ²½ÖèI)µÄ¾ßÌå²½ÖèΪ ÒÔ´Ë±ê³Æ¹ìµÀ¶¨µãλÖý¨Á¢Hill·½³Ì£¬¼´ÎÀÐÇÏà¶Ô±ê³Æ¹ìµÀ¶¨µãλÖõÄÏà¶ÔÔ˶¯·½³Ì£¬×÷ΪkalmanÂ˲¨Ëã·¨µÄ״̬·½³Ì£¬·½³ÌÐÎʽÈçÏ - 2¦Ø0¦Ã =¡ª Y ¦Â+¦Ø1¦Â-¡ª r¦Ã + 2¦Ø0 - 3¦Ø^¦Ö -¡ªr ÆäÖÐ ¦ÁΪ¾¶ÈÆ«²î£¬µ¥Î»Îªrad £» ¦ÂΪγ¶ÈÆ«²î£¬µ¥Î»Îªrad £» YΪ¾¶ÏòÆ«²î£¬µ¥Î»Îªrad £» fΪ¾²Ö¹¹ìµÀÎÀÐÇÀíÂÛ°ë¾¶£¬µ¥Î»Îªkm £» OΪ±ê³Æ¾²Ö¹¹ìµÀ½ÇËÙ¶È£¬µ¥Î»Îªrad/s £» ax¡¢ay¡¢azÊÇÍâ½ç¼ÓËÙ¶ÈÔÚ±ê³Æ¹ìµÀ¶¨µãλÖÃΪԵãµÄ×ø±êϵµÄ·ÖÁ¿£» ±ê³Æ¹ìµÀ¶¨µãλÖö¨ÒåΪ²»¿¼ÂÇÎÀÐÇÆ¯ÒÆÇÒ¹ìµÀÇã½ÇΪÁãµÄÇé¿öϵÄÀíÂÛ¶¨µãλÖã¬ÓëµØÇò×ÔתÍêȫͬ²½£» ÎÀÐÇ×ÔÖ÷µ¼º½²âÁ¿ÒªÓõ½µØÇò¡¢ÎÀÐÇºÍ±ê³Æ¹ìµÀ¶¨µãλÖã»ÆäÖУ¬Î²±íʾÐÇÃô¸ÐÆ÷¸ø³öµÄµÚÒ»¸ö·½ÏòʸÁ¿£¬ÎÞ±í²»ÐÇÃô¸ÐÆ÷¸ø³öµÄµÚ¶þ¸ö·½ÏòʸÁ¿£¬ÃÏ´ú±íµØÇòÃô¸ÐÆ÷¸ø³öµÄµØÐÄ·½ÏòʸÁ¿; ·½ÏòʸÁ¿ÒÓ¡¢ôÞÔÚÎÀÐDZ¾ÌåϵϵÄ×ø±êλÖÃÓÉÐÇÃôµÄ°²×°¾ØÕó¾ö¶¨£»¸ù¾ÝÐÇÃô¸ÐÆ÷µÄ²âÁ¿ÔÀí£¬Æä²âÁ¿Êä³öΪ·½ÏòʸÁ¿S1¡¢ôÞÔÚ¹ßÐÔ×ø±êϵÖеķ½Î»×ø±ê£¬·Ö±ð¼ÇΪ(ÒÓ);ºÍ(¼°2)/£¬¾ßÌå±í´ïΪ(Si)/ = ^Uy 1^hz] = [^2 ^hy ^hz ]£» ºìÍâµØÇòÃô¸ÐÆ÷µÄ²âÁ¿Êä³öΪ¹ö¶¯½Ç(^ºÍ¸©Ñö½Çeh;¸ù¾Ý²âÁ¿µÃµ½µÄ¹ö¶¯½ÇºÍ¸©Ñö½Ç£¬¾¹ýÁ½´ÎÐýת±ä»»¼´¿ÉµÃµ½ÔÚ±¾Ìå×ø±êϵÏÂÎÀÐǹìµÀ×ø±êϵԵ㵽µØÐĵÄλÖÃʸÁ¿£¬¼ÇΪ
3.¸ù¾ÝȨÀûÒªÇóIËùÊöµÄÒ»ÖÖ¾²Ö¹¹ìµÀÎÀÐÇ×ÔÖ÷µ¼º½·½·¨£¬ÆäÌØÕ÷ÔÚÓÚ²½Öè2)µÄ¾ßÌå²½ÖèΪ¶Ô²½ÖèI)µÃµ½µÄλÖÃÆ«²îÖµÓÃ×îС¶þ³Ë·½·¨½øÐÐÊý¾Ý´¦Àí£¬»ñµÃÒ»ÌìÄڵĹìµÀÆ½ÃæÄ򵀮½¾ù¹ìµÀ¸ùÊý¼´°ë³¤ÖᡢƫÐÄÂÊ¡¢½üµØµã·ù½ÇºÍÕæ½üµã½Ç£»¶Ô²½ÖèI)µÃµ½µÄλÖÃÆ«²îÖµÓÃÆ½¾ùÂ˲¨·½·¨»ñµÃÒ»ÌìÄڵĹìµÀÆ½ÃæÍâµÄƽ¾ù¹ìµÀ¸ùÊý¼´¹ìµÀÇã½ÇºÍÉý½»µã³à¾£» ¸ù¾Ý²½ÖèI)ÖÐkalmanÂ˲¨ºó»ñµÃµÄÕæÊµÎÀÐÇÏà¶ÔÓÚ±ê³Æ¹ìµÀ¶¨µãλÖõÄÏà¶ÔλÖÃÆ«²îÖµ£¬ÎªÁË»ñµÃ±ãÓÚ¹ìµÀ¿ØÖƵĿØÖƱäÁ¿ÒÔ¼°Ìá¸ßµ¼º½¾«¶È£¬È¡Â˲¨½á¹ûÖеĶ«Î÷Æ«²î¦ÁºÍÄϱ±Æ«²î¦Â£¬»ùÓÚ¾²Ö¹¹ìµÀÎÀÐǵÄÊÜÉãÆ¯ÒÆÔÀí£¬Í¨¹ý×îС¶þ³Ë·¨ºÍƽ¾ùÂ˲¨·½·¨»ñµÃÎÀÐÇµÄÆ½¾ù¹ìµÀÁù¸ùÊý£¬°üÀ¨°ë³¤ÖᡢƫÐÄÂÊ¡¢¹ìµÀÇã½Ç¡¢Éý½»µã³à¾¡¢½üµØµã·ù½ÇºÍÕæ½üµã½Ç£¬ÆäÖÐÆ½¾ùµÄÒâÒåΪÀûÓÃÒ»ÌìµÄ¦ÁºÍ¦ÂÊý¾ÝÄâºÏ»ñµÃ£» ¸ù¾Ý¦ÁºÍ¦Â£¬¿ÉÒÔת»»³ÉÎÀÐǵijྺͳà㣬¼´³à¾Îª¦Á¦Ó+¦Á £¬³àγΪ¦Ä¦Ó_¦Â£¬¿ÉÒÔ»ñµÃµ±Ç°kʱ¿ÌµÄµØÐĵ¥Î»Ê¸Á¿ £¬Æä±í´ïʽΪ
4.¸ù¾ÝȨÀûÒªÇóIËùÊöµÄÒ»ÖÖ¾²Ö¹¹ìµÀÎÀÐÇ×ÔÖ÷µ¼º½·½·¨£¬ÆäÌØÕ÷ÔÚÓÚ²½Öè3)µÄ¾ßÌå²½ÖèΪÒÔ²½Öè2)µÃµ½µÄÁù¸öƽ¾ù¹ìµÀ¸ùÊý×÷ΪÐÇÉϹìµÀ½âÎöÍâÍÆËã·¨µÄÊäÈëÖµ£¬ÍâÍÆ¼ÆËãÒ»ÌìÄÚÎÀÐǹìµÀλÖã¬ÌṩÁ¬Ðøµ¼º½¶¨Î»ÐÅÏ¢£¬ÊµÏÖÎÀÐÇ×ÔÖ÷µ¼º½¹¦ÄÜ£» ÓÉÓÚµØÇòͬ²½¹ìµÀÎÀÐÇÆ«ÐÄÂÊeºÍ¹ìµÀÇã½ÇiÁ¿¼¶¶¼±È½ÏС£¬¹ÊÔÚ½øÐнâÎöÍâÍÆ¼ÆËãʱÐè²ÉÓÃÊÊÓÃÓÚO¡Üe<lºÍ0¡Üi< 180¡ãµÄµÚ¶þÀàÁù¸öÎÞÆæµã¸ùÊý ¦Ï = [a£¬h£¬k£¬¦Î£¬¦°£¬Èë]Æä±í´ïÊÇΪa Ϊ°ë³¤Öᣬ
È«ÎÄÕªÒª
±¾·¢Ã÷Éæ¼°Ò»ÖÖ¾²Ö¹¹ìµÀÎÀÐÇ×ÔÖ÷µ¼º½·½·¨£¬ÊôÓÚÎÀÐÇ×ÔÖ÷µ¼º½Ñо¿ÁìÓò¡£»ùÓÚÐÇÃô¸ÐÆ÷ºÍµØÇòÃô¸ÐÆ÷µÄkalmanÂ˲¨Ëã·¨£¬ÊµÊ±µÃµ½ÎÀÐÇÏà¶ÔÓÚ¶¨µãµÄλÖÃÆ«²îÖµ£»¶ÔλÖÃÆ«²îÖµÓÃ×îС¶þ³Ë·½·¨½øÐÐÊý¾Ý´¦Àí£¬»ñµÃÒ»ÌìÄڵĹìµÀÆ½ÃæÄ򵀮½¾ù¹ìµÀ¸ùÊý£¬ÔÙÓÃÆ½¾ùÂ˲¨·½·¨»ñµÃÒ»ÌìÄڵĹìµÀÆ½ÃæÍâµÄƽ¾ù¹ìµÀ¸ùÊý£»ÒÔÆ½¾ù¹ìµÀ¸ùÊý×÷ΪÐÇÉϹìµÀ½âÎöÍâÍÆËã·¨µÄÊäÈëÖµ£¬ÍâÍÆ¼ÆËãÒ»ÌìÄÚÎÀÐǹìµÀλÖã¬ÌṩÁ¬Ðøµ¼º½¶¨Î»ÐÅÏ¢£¬ÊµÏÖÎÀÐÇ×ÔÖ÷µ¼º½¹¦ÄÜ¡£±¾·¢Ã÷µÄ·½·¨ÒѾÔÚÖÐÐÇ2AÉϳɹ¦Ó¦Ó㬾¹ýÔÚ¹ì±ê¶¨ºó×ÔÖ÷¹ìµÀÈ·¶¨¾«¶ÈÓÅÓÚ10km£¬¸Ã·½·¨¿ÉÒÔÍÆ¹ãÓ¦ÓÃÓÚËùÓÐÒªÇó¾ß±¸×ÔÖ÷¹¦ÄܵĵØÇò¾²Ö¹¹ìµÀÎÀÐÇ¡£
Îĵµ±àºÅG01C21/02GK102878995SQ20121041399
¹«¿ªÈÕ2013Äê1ÔÂ16ÈÕ ÉêÇëÈÕÆÚ2012Äê10ÔÂ24ÈÕ ÓÅÏÈȨÈÕ2012Äê10ÔÂ24ÈÕ
·¢Ã÷Õß¹ù½¨ÐÂ, ³£½¨ËÉ, ÁõÐÂÑå, ÍõÓ±, ÍõÓñ·å, л¾ü ÉêÇëÈË:±±¾©¿ØÖƹ¤³ÌÑо¿Ëù