»ùÓÚpmuÊý¾ÝµÄµ¥»ØÊäµçÏß·ÁãÐò²ÎÊý¿¹²î±æÊ¶·½·¨
¡¾×¨ÀûÕªÒª¡¿Ò»ÖÖ»ùÓÚPMUÊý¾ÝµÄÊäµçµ¥»ØÊäµçÏß·¿¹²îÁãÐò²ÎÊý±æÊ¶·½·¨£ºÊ×ÏÈ,¸ù¾Ýµ¥»ØÊäµçÏß·µÄÈýÏ಻¶Ô³ÆÔËÐÐ״̬£¬¾¶Ô³Æ·ÖÁ¿±ä»»£¬µÃµ½µ¥»ØÊäµçÏß·µÄÁãÐòµÈֵģÐÍ£¬½ø¶øÒÔµ¥»ØÊäµçÏß·Á½¶ËµÄÁãÐòµçѹ¼°µçÁ÷·ÖÁ¿½¨Á¢ÁãÐò²ÎÊý±æÊ¶µÄÊýѧ·½³Ì£»Æä´Î£¬ÔÚµçÍø²»¶Ô³ÆÔËÐÐ״̬Ï£¬¸ù¾Ýµ¥»ØÊäµçÏß·Á½¶Ë×°ÉèµÄPMUËù²âÁ¿µ½µÄÈýÏ಻¶Ô³ÆµçѹµçÁ÷ÏàÁ¿£¬¾¶Ô³Æ·ÖÁ¿±ä»»£¬µÃµ½µ¥»ØÊäµçÏß·Á½¶ËµÄÁãÐòµçѹ¼°µçÁ÷·ÖÁ¿£»µÚÈý£¬¸ù¾ÝHuber¿¹²î¹À¼ÆÀíÂÛ¼°Ëù½¨Á¢µÄÁãÐò²ÎÊý±æÊ¶µÄÊýѧ·½³Ì£¬½¨Á¢»ùÓÚHuber¹À¼ÆµÄ¿¹²îÄ¿±êº¯Êý£»×îºó£¬¸ù¾ÝËùµÃµ½µÄµ¥»ØÊäµçÏß·Á½¶ËµÄÁãÐòµçѹ¼°µçÁ÷·ÖÁ¿ºÍËù½¨Á¢µÄ¿¹²îÄ¿±êº¯Êý£¬ÓÃmatlabµÄfminconº¯Êý½øÐвÎÊý±æÊ¶£¬µÃµ½µ¥»ØÊäµçÏß·µÄÁãÐò²ÎÊý¡£
¡¾×¨Àû˵Ã÷¡¿»ùÓÚPMUÊý¾ÝµÄµ¥»ØÊäµçÏß·ÁãÐò²ÎÊý¿¹²î±æÊ¶·½·¨
¡¾¼¼ÊõÁìÓò¡¿
[0001]±¾·¢Ã÷Éæ¼°Ò»ÖÖ»ùÓÚPMUÊý¾ÝµÄµ¥»ØÊäµçÏß·ÁãÐò²ÎÊý¿¹²î±æÊ¶·½·¨¡£
¡¾±³¾°¼¼Êõ¡¿
[0002]ÊäµçÏß·µÄ²ÎÊýÊǵçÁ¦ÏµÍ³¼ÆËã¼°ÔËÐпØÖƵĻù´¡Êý¾Ý£¬Èç³±Á÷¼ÆË㡢״̬¹À¼Æ¡¢¹ÊÕÏ·ÖÎö¡¢±£»¤Õû¶¨µÈ£¬²»×¼È·µÄÏß·²ÎÊý»áÓ°Ïìµ½µçÁ¦ÏµÍ³°²È«¡¢Îȶ¨¼°¾¼ÃÔËÐС£
[0003]ÊäµçÏß·µÄÁãÐò²ÎÊýʹصçÁ¦ÏµÍ³¼Ìµç±£»¤µÄÕû¶¨¼ÆË㣬µ«Ïà½ÏÓÚÕýÐò²ÎÊý£¬ÁãÐò²ÎÊýÊÜÍâÔÚÒòËØµÄÓ°Ïì¸ü´ó£¬Èç½ÓµØµç×èÂÊ¡¢µÈÖµÉî¶È¡¢µ¼Ïß²¼¾ÖµÈ£¬¾«È·ÀíÂÛ¼ÆËãÁãÐò²ÎÊý¼¸ºõÊDz»¿ÉÄܵġ£Òò´Ë£¬ÎÒ¹ú¼Ìµç±£»¤¹æ³Ì¹æ¶¨ÁãÐò²ÎÊý±ØÐëʵ²â¡£È»¶ø£¬Ëæ×ÅÊäµçÍø¹æÄ£Ô½À´Ô½´ó£¬Æ½ÐÐÏß·µÄÔö¶à£¬²ÉÓÃÒÔÍùµÄÍ£µç²âÁ¿·½·¨ÖðÌõÍ£µç²âÁ¿Ïß·µÄÁãÐò²ÎÊý·Ñʱ·ÑÁ¦£¬Ò²»áÓ°Ïìµ½µçÍøµÄÕý³£ÔËÐк͹©µçµÄ¿É¿¿ÐÔ£»´ËÍ⣬ÊäµçÏß·²ÎÊýÊܸ÷ÖÖËæ»úÒòËØ¼°ÀÏ»¯µÄÓ°Ï죬ҲÔÚ»ºÂý±ä»¯£¬Ò²ÓбØÒª¶¨ÆÚʵ²âÊäµçÏß·²ÎÊý¡£¼øÓÚ´Ë£¬ÓбØÒªÀûÓÃеļ¼ÊõÊֶδúÌæ´«Í³·½·¨ÊµÏÖ¶ÔÊäµçÏß·ÁãÐò²ÎÊýµÄ²âÁ¿¡£
[0004]»ùÓÚÈ«Çò¶¨Î»ÏµÍ³(GPS)µÄÏàÁ¿²âÁ¿µ¥Ôª(PMU)µÄ³öÏÖ,Ϊµ¥»ØÊäµçÏß·ÁãÐò²ÎÊýµÄÔÚÏß±æÊ¶ÌṩÁËÒ»¸öеÄÊý¾ÝÀ´Ô´ºÍÓÐЧƽ̨¡£PMUÄÜÒÔ¸ü¸ß¾«¶È¡¢¸ü¸ß²ÉÑùƵÂÊ¡¢¸üºÃµÄͬ²½ÐÔʵʱ¼Ç¼µçÍø¸÷ÖÖ²»¶Ô³ÆÔËÐÐ״̬ÐÅÏ¢£»Èôµ¥»ØÊäµçÏß·Á½¶Ë¾ù×°ÉèÁË PMU£¬ÔòÔÚµçÍø²»¶Ô³ÆÔËÐÐ״̬Ï£¬¸ù¾ÝPMU²âÁ¿µ½µÄµ¥»ØÊäµçÏß·Á½¶ËµÄÈýÏ಻¶Ô³Æµçѹ¡¢µçÁ÷ÏàÁ¿£¬Í¨¹ý¶Ô³Æ·ÖÁ¿±ä»»ÌáÈ¡³öÏàÓ¦µÄÁãÐòµçѹ¡¢µçÁ÷·ÖÁ¿£¬½ø¶ø¿ÉʵÏÖÁãÐò²ÎÊýµÄÔÚÏß±æÊ¶¡£
[0005]È»¶ø£¬PMUÊý¾ÝÒ²²»¿É±ÜÃâµØ´æÔÚËæ»úÁ¿²âÎó²î£¬¸üÑÏÖØµÄÊÇÔÚÊý¾Ý²âÁ¿¡¢´«Êä¼°´æ´¢µÈ¹ý³ÌÖÐÓÉÓÚ¸÷ÖÖËæ»úÒòËØµÄÓ°Ï죬PMUÊý¾ÝÖлá³öÏÖ¸÷ÖÖ»µÊý¾Ý¡£ÈôPMUÊý¾Ý²»¼Ó´¦Àí¼´Ê¹Ó㬻µÊý¾Ý(´Ö²î)µÄ´æÔڱػá¶ÔÁãÐò²ÎÊýµÄ±æÊ¶²úÉú²»ÀûÓ°Ï죬ʹµÃ±æÊ¶Öµ²»¿ÉÐÅ£»µ«´Óº£Á¿µÄPMUÊý¾ÝÖÐÌÞ³ý¸÷ÖÖ»µÊý¾ÝÊǺÜÀ§Äѵģ¬×îÓÐЧµÄ·½·¨ÊÇʹÓþßÓп¹²îÄÜÁ¦µÄ²ÎÊý±æÊ¶·½·¨¡£
¡¾·¢Ã÷ÄÚÈÝ¡¿
[0006]±¾·¢Ã÷ËùÒª½â¾öµÄ¼¼ÊõÎÊÌ⣬¾ÍÊÇÌṩһÖÖ»ùÓÚPMUÊý¾ÝµÄµ¥»ØÊäµçÏß·ÁãÐò²ÎÊý¿¹²î±æÊ¶·½·¨£¬¸Ã·½·¨¿É²Ù×÷ÐÔÇ¿£¬Ò×ÓÚʵʩ£¬ÇÒ±æÊ¶µÃµ½µÄÁãÐò²ÎÊý¸ü½Ó½üʵ¼ÊÖµ£¬¸ü¼Ó¿ÉÐÅ£¬²¢¾ßÓкÜÇ¿µÄ¿¹²îÄÜÁ¦¡£
[0007]½â¾öÉÏÊö¼¼ÊõÎÊÌ⣬±¾·¢Ã÷²ÉÓõļ¼Êõ·½°¸ÊÇ:
[0008]Ò»ÖÖ»ùÓÚPMUÊý¾ÝµÄµ¥»ØÊäµçÏß·ÁãÐò²ÎÊý¿¹²î±æÊ¶·½·¨£¬ÆäÌØÕ÷ÊǰüÀ¨ÒÔϲ½Öè:
[0009]²½Öè1:ÔÚµ¥»ØÊäµçÏß·Á½¶Ë×°ÉèÏàÁ¿²âÁ¿µ¥ÔªPMU£¬²âÁ¿µ¥»ØÊäµçÏß·Á½¶ËµÄÈýÏ಻¶Ô³Æµçѹ¡¢µçÁ÷ÏàÁ¿£»
[0010]²½Öè2:ÔÚµçÍø²»¶Ô³ÆÔËÐÐ״̬Ï£¬¸ù¾ÝPMUËù²âÁ¿µ½µÄµ¥»ØÊäµçÏß·Á½¶ËµÄÈýÏ಻¶Ô³Æµçѹ¡¢µçÁ÷ÏàÁ¿£¬¾¶Ô³Æ·ÖÁ¿±ä»»£¬µÃµ½µ¥»ØÊäµçÏß·Á½¶ËµÄÁãÐòµçѹ¼°µçÁ÷·ÖÁ¿£»[0011]ÔÚºöÂÔ¶ÔµØÁãÐòµçÈÝÌõ¼þÏ£¬µ¥»ØÊäµçÏß·Ê×Ä©¶ËµÄÁãÐòµçѹ¡¢µçÁ÷Âú×ãÈçÏÂÁãÐòµçÁ÷·½³Ì:
¡¾È¨ÀûÒªÇó¡¿
1.Ò»ÖÖ»ùÓÚPMUÊý¾ÝµÄµ¥»ØÊäµçÏß·ÁãÐò²ÎÊý¿¹²î±æÊ¶·½·¨£¬ÆäÌØÕ÷ÊǰüÀ¨ÒÔϲ½Öè: ²½Öè1:ÔÚµ¥»ØÊäµçÏß·Á½¶Ë×°ÉèÏàÁ¿²âÁ¿µ¥ÔªPMU£¬²âÁ¿µ¥»ØÊäµçÏß·Á½¶ËµÄÈýÏ಻¶Ô³Æµçѹ¡¢µçÁ÷ÏàÁ¿£» ²½Öè2:ÔÚµçÍø²»¶Ô³ÆÔËÐÐ״̬Ï£¬¸ù¾ÝPMUËù²âÁ¿µ½µÄµ¥»ØÊäµçÏß·Á½¶ËµÄÈýÏ಻¶Ô³Æµçѹ¡¢µçÁ÷ÏàÁ¿£¬¾¶Ô³Æ·ÖÁ¿±ä»»£¬µÃµ½µ¥»ØÊäµçÏß·Á½¶ËµÄÁãÐòµçѹ¼°µçÁ÷·ÖÁ¿£» ÔÚºöÂÔ¶ÔµØÁãÐòµçÈÝÌõ¼þÏ£¬µ¥»ØÊäµçÏß·Ê×Ä©¶ËµÄÁãÐòµçѹ¡¢µçÁ÷Âú×ãÈçÏÂÁãÐòµçÁ÷·½³Ì:
j ,,?O ¡ª ¦É¦Ç¦¯ 6?0)/Z(>
(1)£» ÆäÖУ¬Zci=RfjXciΪÁãÐòµÈÖµ×迹£¬RtlΪÁãÐòµÈÖµµç×裬XtlΪÁãÐòµÈÖµµç¿¹£¬U·Ö±ð±íʾÏß·Á½¶ËÁãÐòµçÁ÷ÏàÁ¿£¬Um0, Lfn0·Ö±ð±íʾÏß·Á½¶ËÁãÐòµçѹÏàÁ¿£» ½«Ê×Ä©¶ËµÄÁãÐòµçÁ÷·½³Ì·Ö±ð°´Êµ²¿ºÍÐ鲿չ¿ª£¬µÃµ½µ¥»ØÊäµçÏß·µÄÁãÐòµÈֵģÐ͵ÄÊýѧ·½³Ì×é:
r Lm ] (Umn cos ¡ª Uan cos ¦È¦Ø¦¬ Uan sin ¦È¦Á¦«} ¡ª Umn sin ¦È_,¡¢) ,?O/ _ ^mO S*n ^hmO ¡ª ^nQ hi)C0SCOSif
Km Un() cosOun0 ¡ª Um0 cos0mM Um0 sin¦È¦É¦É¦É¦Ç0 ¡ª Vnl) sin0jmi) J
L ^bOI J I ^bO ^tfiO ~ `"'?O ^umQ ^nO C0SC0S ho )
(2)£» ÆäÖУ¬ImOE> ImOI·Ö±ð±í²»µ¥»ØÊäµçÏß·һ¶ËÁãÐòµçÁ÷ÏàÁ¿µÄʵ²¿ÓëÐ鲿£¬¦©¦Ç(?£¬InOI·Ö±ð±í²»µ¥»ØÊäµçÏß·ÁíÒ»¶ËÁãÐòµçÁ÷ÏàÁ¿µÄʵ²¿ÓëÐ鲿£»Umtl, Untl, Qumtl, ¦È ¡ª·Ö±ð±í²»µ¥»ØÊäµçÏß·Á½¶ËÁãÐòµçѹÏàÁ¿µÄ·ùÖµÓëÏà½Ç£»g(l£¬b0·Ö±ð±íʾ1/?µÄʵ²¿ÓëÐ鲿,ZtlΪµ¥»ØÊäµçÏß·µÄÁãÐòµÈÖµ×迹£» ½øÒ»²½½«Ê½(2)дΪ¾ØÕóÐÎʽΪ:
Ax= ¦Â
(3)£» ÆäÖУ¬¾ØÕóAΪʽ¢ÆÖеçѹÏàÁ¿×é³ÉµÄϵÊý¾ØÕó£¬ÏòÁ¿¦ÂΪʽ(2)ÖеçÁ÷ÏàÁ¿×é³ÉµÄ³£ÊýÏXΪ´ý±æÊ¶²ÎÊýÏòÁ¿£» ¿¼Âǵ½PMUÊý¾Ý»á´æÔÚËæ»úÁ¿²âÎó²î£¬¹«Ê½(3)½øÒ»²½±íʾΪ:
Ax= ¦Â + ¦Ô
(4)£» ÆäÖУ¬¦ÔΪ·½³Ì²Ð²îÏòÁ¿£» ¶ÔÓÚ¹«Ê½(4)Ëù½¨Á¢µÄÁãÐò²ÎÊý±æÊ¶µÄÊýѧ·½³Ì£¬»ùÓÚÓÅ»¯µÄ²ÎÊý±æÊ¶·½·¨Ñ°ÕÒÒ»¸ö×îÓŵIJÎÊýʸÁ¿Ê¹Îó²îÄ¿±êº¯ÊýE×îС: »ùÓÚ´«Í³×îС¶þ³Ë·½·¨µÄÄ¿±êº¯ÊýΪ:
2.¸ù¾ÝȨÀûÒªÇó1ËùÊöµÄ»ùÓÚPMUÊý¾ÝµÄµ¥»ØÊäµçÏß·ÁãÐò²ÎÊý¿¹²î±æÊ¶·½·¨£¬ÆäÌØÕ÷ÊÇ:ËùÊö²½Öè2µÄ¶Ô³Æ·ÖÁ¿±ä»»Îª:
3.¸ù¾ÝȨÀûÒªÇó1»ò2ËùÊöµÄ»ùÓÚPMUÊý¾ÝµÄµ¥»ØÊäµçÏß·ÁãÐò²ÎÊý¿¹²î±æÊ¶·½·¨£¬ÆäÌØÕ÷ÊÇ:ËùÊöµÄ²½Öè3ÖеÄCֵȡ1.5¡£
¡¾Îĵµ±àºÅ¡¿G01R31/00GK103869184SQ201410047806
¡¾¹«¿ªÈÕ¡¿2014Äê6ÔÂ18ÈÕ ÉêÇëÈÕÆÚ:2014Äê2ÔÂ11ÈÕ ÓÅÏÈȨÈÕ:2014Äê2ÔÂ11ÈÕ
¡¾·¢Ã÷Õß¡¿³ÂÏþ¿Æ, ÕÔÑÞ¾ü, Ñî·ÚÑÞ, ËïÎÅ, Ê¢³¬, ±ÏÌìæ, ÌÆ¾°ÐÇ, ÍõÁá, ¸¶´Ï, ÕÅÔ¾, Ôø½Ü, ÍõîÔ, Ѧ°²³É, »Æè÷»ª, ÕÅÕ×Ñô, °²È»È», ÂÞº½, ÕŽ¡, ÕÅÔ¶, ÍõÞÈ, ºúÓñá°, ÕÅ¿¡·å, ³ÂÈñ, ÂíÃ÷ ÉêÇëÈË:¹ã¶«µçÍø¹«Ë¾µçÁ¦¿ÆÑ§Ñо¿Ôº