¸¨ÖúÒÆ¶¯Ôؾ߶¨Î»µÄϵͳÓë·½·¨
¡¾×¨ÀûÕªÒª¡¿±¾·¢Ã÷ΪһÖÖ¸¨ÖúÒÆ¶¯Ôؾ߶¨Î»µÄϵͳÓë·½·¨£¬ÆäÖ÷ÒªÓÉÒÆ¶¯Ôؾߡ¢Òƶ¯ÔؾßѶºÅ¶ÁÈ¡µ¥Ôª¡¢ÕûºÏÔËËãµ¥Ôª¼°¶¨Î»µ¥Ôª¡£±¾·¢Ã÷½áºÏÔØ¾ßµÄ·½ÏòÅ̽ǶȸÐÖªÓë¾àÀë/ËٶȸÐ֪ѶºÅ£¬¾¹ýÔËËãºóÌṩÔ(ÎÀÐÇ)¶¨Î»×°ÖÃÔÚÊÕѶºÅ²»Á¼»ò²úÉúÆ«ÒÆµÄÇé¿öÏ£¬¸ü¿É¿¿Óë׼ȷµÄ¶¨Î»ÐÅÏ¢¡£±¾·¢Ã÷¿ÉÓÐЧ¸ÄÉÆÎÀÐǶ¨Î»×°ÖõIJ»×㣬ʹÔ(ÎÀÐÇ)¶¨Î»×°ÖÃÎÞ·¨È¡µÃ×ã¹»µÄ¶¨Î»ÐÅÏ¢¡¢Ê§Ð§»òÒ쳣ʱÈÔÌṩһ¸ö¿É¿¿µÄ²Î¿¼Î»ÖÃÐÅÏ¢¡£
¡¾×¨Àû˵Ã÷¡¿¸¨ÖúÒÆ¶¯Ôؾ߶¨Î»µÄϵͳÓë·½·¨
¡¾¼¼ÊõÁìÓò¡¿
[0001]±¾·¢Ã÷Éæ¼°Ò»ÖÖ¶¨Î»µÄ·½·¨£¬ÌرðÊÇÉæ¼°Ò»ÖÖ¸¨ÖúÒÆ¶¯Ôؾ߶¨Î»µÄϵͳÓë·½·¨¡£
¡¾±³¾°¼¼Êõ¡¿
[0002]ÎÀÐǶ¨Î»ÏµÍ³ÔÚÓ¦ÓÃÉÏÎÞ·¨¿Ë·þÒòÕÚ±Î(¸ß¼ÜµÀ·¡¢ËíµÀ¡¢ÐеÀÊ÷¡¢´óÂ¥µÈ)Ëù´øÀ´¶¨Î»Ê§ÕæµÄÓ°Ï졣רÀû¡¶¶àÓÃ;¸¨ÖúÐÍGPSÖмÌϵͳ¡·(¹«¿ª(¸æ)ÈÕÆÚ:2006/12/1£¬¹«¿ª(¸æ)ºÅ:200641383),¹«¿ªÁ˶àÓÃ;¸¨ÖúÐÍ GPS (Global Posit1ning System,È«Çò¶¨Î»ÏµÍ³)ÖмÌϵͳ£¬Ê¹ÓÃÐÐͨѶϵͳ´«µÝ¸¨Öú¶¨Î»ÐÅÏ¢£¬½öÄܼÓÇ¿ÓëÔö¿ìÎÀÐǶ¨Î»ÄÜÁ¦¡£²¢ÎÞ·¨ÔÚ¶¨Î»Ê§Ð§¡¢Êܵ½¸ÉÈÅ¡¢Æ®ÒƵÈÇé¿ö·¢Éú¸¨Öú¶¨Î»µÄ×÷Óá£
[0003]רÀû¡¶ÀûÓÃÐж¯Í¨Ñ¶×÷ΪDGPS¾«Ãܶ¨Î»Ö®¼Ü¹¹Óë·½·¨¡·(¹«¿ª(¸æ)ÈÕÆÚ:2004/08/16£¬¹«¿ª(¸æ)ºÅ:200415369)£¬¹«¿ªÁËÀûÓÃÐж¯Í¨Ñ¶×÷Ϊ DGPS(DifferentialGlobal Posit1ning System,²î·ÖÈ«Çò¶¨Î»ÏµÍ³)¾«Ãܶ¨Î»Ö®¼Ü¹¹Óë·½·¨£¬ÒÔÕûºÏÐж¯Í¨Ñ¶ÓëDGPS×÷Ϊ¾«Ãܶ¨Î»µÄ·½·¨¡£½öÄܽâ¾ö¶¨Î»Æ®ÒƵÄÎÊÌ⣬ÎÞ·¨ÔÚGPS²»Á¼Ê±´ïµ½¸¨Öú¶¨Î»µÄЧ¹û¡£
[0004]רÀû¡¶ÔËÓÃÓÚ¶¨Î»·þÎñÖ®ÍøÂ縨ÖúÐж¯¶¨Î»ÏµÍ³·½·¨¡·(¹«¿ª(¸æ)ÈÕÆÚ:2006/01/1£¬¹«¿ª(¸æ)ºÅ:200601859)£¬¹«¿ªÁËʹÓÃÐж¯Í¨Ñ¶ÍøÂçÓë»ùµØÌ¨µÈÐÅÏ¢µÄ·½·¨¸¨Öú¶¨Î»£¬¾«È·¶È²»Èô¼ÆËãÒÆ¶¯ÔؾߵÄÎïÀíÁ¿µÄ½á¹ûÀ´µÄ¸ß¡£
[0005]רÀû¡¶ÔؾßÖ®ÕûºÏ¶¨Î»ÏµÍ³Óë·½·¨¡·(¹«¿ª(¸æ)ÈÕÆÚ:2005/10/16£¬¹«¿ª(¸æ)ºÅ:200533945)£¬¹«¿ªÁËʹÓùßÐÔÁ¿²â×é¼þ(¼ÓËÙ¼Æ)×÷ΪÕûºÏ¶¨Î»µÄ·½·¨£¬µ«¸Ã·½·¨Óв»Ò×ʵʩ¡¢³É±¾½Ï¸ßÇÒÒ×ÊÜÔØ¾ß·ÇÒÆ¶¯ÐÔÎïÀíÁ¿µÄ¸ÉÈŵÈȱµã¡£
¡¾·¢Ã÷ÄÚÈÝ¡¿
[0006]Óɴ˿ɼû£¬ÉÏÊö¡¾±³¾°¼¼Êõ¡¿ÖйßÓ÷½Ê½ÈÔÓÐÖî¶àȱʧ£¬Êµ·ÇÁ¼ÉƵÄÉè¼Æ£¬¶øØ½´ý¼ÓÒÔ¸ÄÁ¼¡£
[0007]±¾°¸·¢Ã÷È˼øÓÚÉÏÊö¹ßÓ÷½Ê½ËùÑÜÉúµÄ¸÷Ïîȱµã£¬ÄËØ½Ë¼¼ÓÒÔ¸ÄÁ¼´´Ð£¬²¢¾¶àÄê¿àÐĹÂÒèDZÐÄÑо¿ºó£¬ÖÕÓڳɹ¦Ñз¢Íê³É±¾¼þ·¢Ã÷¡£
[0008]±¾·¢Ã÷Ϊ³µÔØÖÕ¶ËÉ豸¼¼ÊõµÄ´´ÐÂÓ¦Óᣱ¾·¢Ã÷ÖÂÁ¦ÓÚ³µÔØÖÕ¶ËÉ豸Ñз¢ÒÑÓжàÄ꣬ÔÚͨѶÓ붨λ¼¼ÊõÉϲ»¶ÏÌáÉý¼¼Êõ²ã´Î£¬ÒÔÌṩ¿Í»§¸üºÃµÄ·þÎñÖÊÁ¿¡£ÔÚÎÀÐǶ¨Î»ÁìÓò£¬¸üÊÇÁìÏÈÒµ½ç²ÉÓÃSiRFµÚËÄ´úÎÀÐǶ¨Î»Ð¾Æ¬£¬´ó·ù¸ÄÉÆÊÕѶЧ¹û¡£
[0009]È»¶ø£¬ÎÀÐǶ¨Î»Ð¾Æ¬µÄ·¢Õ¹Ç÷ÊÆÊDz»¶ÏÌáÉýÁéÃô¶È£¬Ê¹ÊÕѶ΢ÈõµÄÌõ¼þ϶¨Î»Ð§¹û¿ÉµÃµ½¸ÄÉÆ£¬È´ÔÚÕڱεĻ·¾³ÏÂÊøÊÖÎ޲ߡ£»»ÑÔÖ®£¬´ËΪÎÀÐǶ¨Î»Î¨Ò»µÄȱº¶¡£±¾·¢Ã÷ÊǽáºÏÔØ¾ßµÄ·½ÏòÅ̸ÐÖªÓë¾àÀë/ËٶȸÐ֪ѶºÅ¾¹ýÔËËãºó£¬ÌṩÔ(ÎÀÐÇ)¶¨Î»Ê§Ð§Ï£¬¸ü¿É¿¿Óë׼ȷµÄ¶¨Î»ÐÅÏ¢£¬¿ÉÓÐЧÌáÉý±¾³µ¶Ó¹ÜÀí·þÎñ¿É¿¿¶È²¢¸ü¾ßÊг¡¾ºÕùÁ¦¡£
[0010]Ϊ´ï³ÉÉÏÊö·¢Ã÷Ä¿µÄ¸¨ÖúÒÆ¶¯Ôؾ߶¨Î»µÄ·½·¨£¬ÀûÓÃÒÆ¶¯Ôؾ߷½ÏòÅ̽ǶÈÓëÈ¡Ñùʱ¼äÄÚÒÆ¶¯µÄ¾àÀë¶ø¹ÀËãÒ»¸ö²Î¿¼¸¨Öú¶¨Î»×ø±ê£¬¹©Ô¶¨Î»ÏµÍ³Ê§Ð§Ê±È¡´ú¡£
[0011]Æä¹«Ê½ÈçÏÂ:
[0012]Xn+1 = ¦¶¦Ç+¦¤¦¶¡¡(I)
[0013]¦´¦Ç+1 = ¦´¦Ç+¦¤¦´¡¡¢Æ
[0014]¦¤¦¶ = S.sin ¦Ä¦Ç......(3)
[0015]AY = S* cos ¦Ä ¦Ç......(4)
[0016]ÆäÖУ¬5¡¡(5)
[0017]¶¨ÒåÈçÏÂ:
[0018]X1:ºá(¶«Î÷)Ïò×ø±êλÖà ¦« X:ºá(¶«Î÷)Î»ÒÆ¾àÀë
[0019]Y1:×Ý(Äϱ±)Ïò×ø±êλÖà ¦« Y:×Ý(Äϱ±)Î»ÒÆ¾àÀë
[0020]S:ÒÆ¶¯¾àÀë
[0021]¦Ä¦Ç:·½Î»½ÇQtl:¸¨Öú¶¨Î»ÔµãÖ®·½Î»½Ç¡£
[0022]ÁíÍ⣬¸Ã¸¨ÖúÖú¶¨Î»×ø±êϵͳÐëÒªÒ»¸ö½Ï¾«È·ÇÒÓвο¼ÒâÒåµÄ×÷ΪÆðʼ¼ÆËãµÄÔµã(Xtl, Ytl),´ËÔµãÀ´×ÔÓÚÔ¶¨Î»ÏµÍ³ÏµÍ³ÉÐδʧȥѶºÅ»òÆä¶¨Î»×´Ì¬ÈÔÓÐЧµÄÇé¿öÏ£¬ÔÙÅäºÏ·½ÏòÅ̽ǶÈÇ÷½ü0¡ã ÍÁÎó²î·¶Î§ÄÚÇÒά³ÖÐÐʻһ¶Î¾àÀë(Èç:2±¶Òƶ¯Ôؾ߳¤¶È)ºó£¬²ÅΪ¸¨Öú¶¨Î»ÏµÍ³×ø±êµÄÔµã(Xci, Ytl)¡£ÔؾßÒÆ¶¯µÄ¹ý³ÌÖУ¬ÔÚÉÏÊöÌõ¼þ·ûºÏµÄÇé¿öϲ»¶Ï¸üи¨Öú¶¨Î»µÄÔµã×ø±ê(H)¹©¸¨Öú¶¨Î»ÔËËãÿ¸öÈ¡Ñùʱ¼äºóµÄ×ø±êλÖÃ(¦¶¦Ç+1£¬¦´¦Ç+1)¡£Ò»µ©¶¨Î»ÏµÍ³Ê§Ð§»ò²»¿É¿¿Ê±£¬¼´²ÉÓø¨Öú¶¨Î»×ø±ê×÷Ϊʵ¼Ê×ø±ê£¬¶ø´ïµ½¸¨Öú¸ÃÒÆ¶¯Ôؾ߶¨Î»µÄÄ¿µÄ¡£
[0023]±¾·¢Ã÷ËùÌṩµÄ¸¨ÖúÒÆ¶¯Ôؾ߶¨Î»µÄϵͳÓë·½·¨£¬ÓëÆäËû¹ßÓü¼ÊõÏ໥±È½Ïʱ£¬¾ß±¸ÏÂÁÐÓŵã:
[0024]±¾·¢Ã÷ÀûÓÃÒÆ¶¯ÔؾßËùÌṩµÄ·½Î»½ÇÓëËÙ¶ÈÐÅÏ¢£¬¿É´ó·ù¼ò»¯°²×°ÓëʹÓõĸ´ÔÓ¶È£»
[0025]±¾·¢Ã÷Ö±½ÓÀûÓÃÒÆ¶¯Ôؾ߱¾ÉíµÄ·½Î»½ÇÓëËٶȲο¼Öµ£¬ÔëÉù¸ÉÈÅÓ°ÏñЧ½ÏµÍ¡¢Îȶ¨ÐԸߣ»
[0026]±¾·¢Ã÷ÎÞÐë°²×°¶îÍâµÄ´«¸ÐÆ÷Óë×°Öã¬ÓÐЧ½µµÍ¹ºÖóɱ¾¡£
¡¾×¨Àû¸½Í¼¡¿
¡¾¸½Í¼ËµÃ÷¡¿
[0027]ͼ1Ϊ±¾·¢Ã÷µÄ¸¨ÖúÒÆ¶¯Ôؾ߶¨Î»µÄϵͳµÄʾÒâͼ¡£
[0028]ͼ2Ϊ±¾·¢Ã÷µÄ¸¨ÖúÒÆ¶¯Ôؾ߶¨Î»µÄϵͳµÄʵʩÀýͼ¡£
[0029]ͼ3Ϊ±¾·¢Ã÷µÄ¸¨ÖúÒÆ¶¯Ôؾ߶¨Î»µÄ·½·¨µÄÁ÷³Ìͼ¡£
[0030]ͼ4Ϊ±¾·¢Ã÷µÄ¸¨ÖúÒÆ¶¯Ôؾ߶¨Î»µÄ·½·¨µÄÁ÷³ÌʵʩÀýͼ¡£
[0031]·ûºÅ˵Ã÷:
[0032]10ÒÆ¶¯Ôؾß
[0033]11·½ÏòÅ̽ǶȸÐÖª×é¼þ
[0034]12ÒÆ¶¯¾àÀë¸ÐÖª×é¼þ
[0035]20ÒÆ¶¯ÔؾßѶºÅ¶ÁÈ¡µ¥Ôª
[0036]21·½ÏòÅ̽ǶȽçÃæ
[0037]22ÒÆ¶¯¾àÀë½Ó¿Ú
[0038]30ÕûºÏÔËËãµ¥Ôª
[0039]40¶¨Î»µ¥Ôª
[0040]10ÒÆ¶¯Ôؾß
[0041]11·½ÏòÅ̽ǶȸÐÖª×é¼þ
[0042]12ÒÆ¶¯¾àÀë¸ÐÖª×é¼þ
[0043]20ÒÆ¶¯ÔؾßѶºÅ¶ÁÈ¡µ¥Ôª
[0044]21·½ÏòÅ̽ǶȽçÃæ
[0045]22ÒÆ¶¯¾àÀë½Ó¿Ú
[0046]30ÕûºÏÔËËãµ¥Ôª
[0047]40¶¨Î»µ¥Ôª
[0048]101Æû³µ
[0049]111·½ÏòÅ̽ǶȸÐÖª×é¼þ
[0050]121ÒÆ¶¯¾àÀë¸ÐÖª×é¼þ
[0051]201CAN Bus ½çÃæ
[0052]211·½ÏòÅ̽ǶÈѶºÅ
[0053]221ÒÆ¶¯¾àÀëѶºÅ
[0054]401GPSÎÀÐǶ¨Î»Ä£¿é
[0055]SlOO?S107:Á÷³Ì²½Öè
[0056]S200?S207:Á÷³Ì²½Öè
¡¾¾ßÌåʵʩ·½Ê½¡¿
[0057]ΪÁËʹ±¾·¢Ã÷µÄÄ¿µÄ¡¢¼¼Êõ·½°¸¼°Óŵã¸ü¼ÓÇå³þÃ÷°×£¬ÏÂÃæ½áºÏ¸½Í¼¼°ÊµÊ©Àý£¬¶Ô±¾·¢Ã÷½øÐнøÒ»²½Ïêϸ˵Ã÷¡£Ó¦µ±Àí½â£¬´Ë´¦ËùÃèÊöµÄ¾ßÌåʵʩÀý½öÓÃÒÔ½âÊͱ¾·¢Ã÷£¬µ«²¢²»ÓÃÓÚÏÞ¶¨±¾·¢Ã÷¡£
[0058]ÒÔÏ£¬½áºÏ¸½Í¼¶Ô±¾·¢Ã÷½øÒ»²½ËµÃ÷:
[0059]±¾·¢Ã÷½öÒÔÒÆ¶¯Ôؾߵķ½ÏòÅ̽ǶÈÓëÈ¡Ñùʱ¼äÄÚËùÒÆ¶¯µÄ¾àÀëµÈ2¸öÐÅÏ¢£¬¼´¿É´ïµ½¸¨Öú¶¨Î»µÄÄ¿µÄ¡£ÔÚÔ¶¨Î»ÏµÍ³²»¿É¿¿»òʧЧʱȡ´úÔ¶¨Î»ÏµÍ³ÒÔÃÖ²¹È±Ê§£¬²¢³ÖÐøÖÁÔ¶¨Î»ÏµÍ³»Ö¸´Õý³£¹¦ÄÜ¡£Èç´Ë£¬¸ÃÒÆ¶¯ÔؾßËùÊôµÄϵͳ»ò¶¨Î»Ïà¹ØµÄ¹¦ÄÜÓë·þÎñ£¬Èç:³ö×â³µÅÉDz¡¢³µÁ¾¼à¿Ø¡¢×·×Ù¡¢µ¼º½µÈ¡£½«Òò´Ë¸¨Öú¶¨Î»µÄÓ¦Ó㬶øÎÞ¼ä¶ÏµØÌṩ²Î¿¼¶¨Î»ÐÅÏ¢£¬Ê¹ÕûÌåÔË×÷´ïµ½¸ü¿É¿¿¡¢±ãÀûÓëʵÓõÄЧ¹û¡£
[0060]±¾·¢Ã÷ËùÌá³öµÄ¸¨ÖúÒÆ¶¯Ôؾ߶¨Î»µÄϵͳ°üÀ¨ËÄ´óµ¥Ôª:(Ò»)ÒÆ¶¯Ôؾߡ¢(¶þ)ÒÆ¶¯ÔؾßѶºÅ¶ÁÈ¡µ¥Ôª¡¢(Èý)ÕûºÏÔËËãµ¥Ôª¡¢(ËÄ)¶¨Î»µ¥Ôª¡£Ö´Ðд˷½·¨µÄÔËËãºËÐÄÊÇ(Èý)ÕûºÏÔËËãµ¥Ôª£»(Èý)ÕûºÏÔËËãµ¥ÔªÓÉ(¶þ)ÒÆ¶¯ÔؾßѶºÅ¶ÁÈ¡µ¥Ôª£¬½ÓÊÕÒÆ¶¯Ôؾߵķ½ÏòÅ̽ǶÈÓëÒÆ¶¯¾àÀë»òËÙ¶ÈÐÅÏ¢ºó£¬ÔÚ(ËÄ)¶¨Î»µ¥ÔªÑ¶ºÅ¿É¿¿µÄÇé¿öÏ£¬²»¶Ï¼ÆËã¸üÐÂÔµãλÖ㬲¢³ÖÐø¼ÆË㸨Öú¶¨Î»µÄλÖᣵ±¶¨Î»µ¥Ôª²»¿É¿¿Ê±£¬¼´¿ÉÓÉÕûºÏÔËËãµ¥ÔªµÄ¶¨Î»Êý¾Ý×÷È¡´ú£¬´ïµ½¸¨Öú¶¨Î»µÄ¹¦ÄÜÒÔÍê³ÉÒ»Ì×±ãÀû¡¢×¼È·¡¢ÍêÉÆµÄ¶¨Î»ÏµÍ³¡£
[0061]Çë²ÎÔÄͼ1£¬Í¼1Ϊ±¾·¢Ã÷µÄ¸¨ÖúÒÆ¶¯Ôؾ߶¨Î»µÄϵͳµÄʾÒâͼ¡£Èçͼ1Ëùʾ£¬±¾·¢Ã÷Ó¦ÓÃÓÚ½áºÏ³µÔØ×°ÖÃÓëÖÇÄÜÐÍÊÖ»úµÄ³ö×â³µ¼à¿ØÅÉDzϵͳµÄϵͳ¼Ü¹¹Í¼£¬°üÀ¨ËÄ´óµ¥Ôª:(Ò»)ÒÆ¶¯Ôؾß10¡¢(¶þ)ÒÆ¶¯ÔؾßѶºÅ¶ÁÈ¡µ¥Ôª20¡¢(Èý)ÕûºÏÔËËãµ¥Ôª30¡¢(ËÄ)¶¨Î»µ¥Ôª40¡£¡£
[0062]Çë²ÎÔÄͼ2£¬Í¼2Ϊ±¾·¢Ã÷µÄ¸¨ÖúÒÆ¶¯Ôؾ߶¨Î»µÄϵͳµÄʵʩÀýͼ¡£Èçͼ2Ëùʾ£¬ÒÔһʵʩÀý½øÐÐ˵Ã÷£¬ÒÔÆû³µ101˵Ã÷ÄÚ½¨·½ÏòÅ̽ǶȸÐÖª×é¼þ111¼°Òƶ¯¾àÀë¸ÐÖª×é¼þ121,¶ø¸ÃÕûºÏÔËËãµ¥Ôª30½åÓÉCAN BUS (Controller Area Network-BUS,¿ØÖÆÆ÷¾ÖÓòÍø×ÜÏß¼¼Êõ)½Ó¿Ú 201¶ÁÈ¡³µÁ¾µÄ·½ÏòÅ̽ǶÈѶºÅ211ÓëÒÆ¶¯¾àÀëѶºÅ221²¢¶ÁÈ¡GPSÎÀÐǶ¨Î»Ä£¿é401µÄλÖᢷ½Ïò½ÇÓ붨λ״̬¡£
[0063]ÆäÖÐÕûºÏÔËËãµ¥Ôª´¦ÀíCAN Bus½Ó¿ÚµÄÒÆ¶¯¾àÀëѶºÅÓë·½ÏòÅ̽ǶÈѶºÅµÄ¹«Ê½ÈçÏÂ:
[0064]Xn+j = Xn+ ¦¤ X......(I)
[0065]Yn+1 = Yn+ ¦¤ Y¡¡¢Æ
[0066]AX = S* sin ¦Ä ¦Ç......(3)
[0067]AY = S* cos ¦Ä n......(4)
[0068]ÆäÖУ¬¾Ã=ËË+¦²¦©/?¡(5)
[0069]¶¨ÒåÈçÏÂ:
[0070]X1:ºá(¶«Î÷)Ïò×ø±êλÖÃ
[0071]¦« X:ºá(¶«Î÷)Î»ÒÆ¾àÀë
[0072]Y1:×Ý(Äϱ±)Ïò×ø±êλÖÃ
[0073]¦« Y:×Ý(Äϱ±)Î»ÒÆ¾àÀë
[0074]S:ÒÆ¶¯¾àÀë
[0075]¦Ä¦Ç:·½Î»½Ç
[0076]¦¨¡£:¸¨Öú¶¨Î»ÔµãÖ®·½Î»½Ç¡£
[0077]Çë²ÎÔÄͼ3£¬Í¼3Ϊ±¾·¢Ã÷µÄ¸¨ÖúÒÆ¶¯Ôؾ߶¨Î»µÄ·½·¨µÄÁ÷³Ìͼ¡£Èçͼ1¼°Í¼3Ëùʾ£¬±¾·¢Ã÷µÄÔË×÷Á÷³ÌÆä²½ÖèÖÁÉٿɰüº¬:
[0078]SlOO¶¨Î»ÐÅÏ¢½ÓÊÕ£»
[0079]SlOlÊÇ·ñ¶¨Î»Ñ¶Ï¢ÕýÈ·£»
[0080]S102ÈôÊÇ£¬ÅжÏÊÇ·ñÂú×㸨Öú¶¨Î»ÔµãÌõ¼þ£»
[0081]S103ÈôÊÇ£¬¸üи¨Öú¶¨Î»Ôµã£»
[0082]S104¸üж¨Î»µã£¬ÇÒµ±S102Èô·ñ,¸üж¨Î»µã£»
[0083]S105µ±SlOlÈô·ñ£¬ÅжÏÊÇ·ñÒÑÈ¡µÃ¸¨Öú¶¨Î»Ôµã£¬Èô·ñ£¬ÖØ»ØSlOO¶¨Î»ÐÅÏ¢½ÓÊÕ£»
[0084]S106µ±S105ÈôÊÇ£¬¸¨Öú¶¨Î»¼ÆËã
[0085]S107¸üи¨Öú¶¨Î»µã£»
[0086]Çë²ÎÔÄͼ4£¬Í¼4Ϊ±¾·¢Ã÷µÄ¸¨ÖúÒÆ¶¯Ôؾ߶¨Î»µÄ·½·¨µÄÁ÷³ÌʵʩÀýͼ¡£Èçͼ2¼°Í¼4Ëùʾ£¬ÒÔÆû³µÎªÊµÊ©Àý½øÐÐ˵Ã÷±¾·¢Ã÷µÄ·½·¨Á÷³Ì£¬Æä²½ÖèÖÁÉٿɰüº¬:
[0087]S200¶¨Î»ÐÅÏ¢½ÓÊÕ£»
[0088]S201ÅжÏGPS״̬ΪÓÐЧÇÒÎ»ÒÆ¼ÆËã¾àÀë½éÓÚÓëÖ®¼ä£»
[0089]S202ÈôÊÇ£¬ÅжÏÊÇ·ñÂú×ã·½ÏòÅ̽ǶÈÇ÷½üÓÚO¶È¡¢Îó²î5¶ÈÄÚÇÒÐÐÊ»ÒÆ¶¯Ôؾ߳¤¶È£»
[0090]S203ÈôÊÇ£¬¸üи¨Öú¶¨Î»Ôµã£»
[0091]S204¸üж¨Î»µã£¬µ±S202Èô·ñ£¬¸üж¨Î»µã£»
[0092]S205µ±S201Èô·ñ£¬ÅжÏÊÇ·ñÒÑÈ¡µÃ¸¨Öú¶¨Î»Ôµã£¬Èô·ñ£¬ÖØ»ØS200¶¨Î»ÐÅÏ¢½ÓÊÕ£»
[0093]S206ÈôÊÇ£¬¸¨Öú¶¨Î»¼ÆË㣻
[0094]S207¸üи¨Öú¶¨Î»µã¡£
[0095]ÉÏÁÐÏêϸ˵Ã÷ÄËÕë¶Ô±¾·¢Ã÷µÄ¿ÉÐÐʵʩÀý½øÐоßÌå˵Ã÷£¬Î©¸ÃʵʩÀý²¢·ÇÓÃÒÔÏÞÖÆ±¾·¢Ã÷µÄרÀû·¶Î§£¬·²Î´ÍÑÀë±¾·¢Ã÷¼¼ÒÕ¾«ÉñËùΪµÄµÈЧʵʩ»ò±ä¸ü£¬¾ùÓ¦°üº¬ÓÚ±¾°¸µÄרÀû·¶Î§ÖС£
[0096]×ÛÉÏËùÊö£¬±¾°¸²»½öÓÚ¼¼Êõ˼ÏëÉÏÈ·Êô´´Ð£¬²¢¾ß±¸¹ßÓõĴ«Í³·½·¨Ëù²»¼°µÄÉÏÊö¶àÏЧ£¬Òѳä·Ö·ûºÏÐÂÓ±ÐÔ¼°½ø²½ÐԵ퍶¨·¢Ã÷רÀûÒª¼þ£¬ë¼ÒÀ·¨Ìá³öÉêÇ룬¿ÒÇë¹ó¾ÖºË×¼±¾¼þ·¢Ã÷רÀûÉêÇë°¸£¬ÒÔÀø·¢Ã÷£¬ÖÁ¸ÐµÂ±ã¡£
¡¾È¨ÀûÒªÇó¡¿
1.Ò»ÖÖ¸¨ÖúÒÆ¶¯Ôؾ߶¨Î»µÄϵͳ£¬ÆäÌØÕ÷ÔÚÓÚ£¬ÖÁÉÙ°üÀ¨: ÒÆ¶¯Ôؾߣ¬°üº¬·½ÏòÅ̽ǶȸÐÖª×é¼þ¼°Òƶ¯¾àÀë¸ÐÖª×é¼þ£¬ÇҸвⷽÏòÅ̽Ƕȱ仯µÄ¸Ð֪ѶºÅ¼°ËÙ¶È»ò¹Ì¶¨Òƶ¯¾àÀë²úÉúµÄ¸Ð֪ѶºÅ£¬²¢¼ÆËãÒÆ¶¯¾àÀ룻 ÒÆ¶¯ÔؾßѶºÅ¶ÁÈ¡µ¥Ôª£¬°üº¬Òƶ¯¾àÀë½Ó¿Ú¼°·½ÏòÅ̽ǶȽӿڣ¬¸Ã·½ÏòÅ̽ǶȽӿڶÁÈ¡»òÕì²âÐгµÀï³ÌÓëÐгµËÙ¶È£¬½ÓÊÕ¸ÃÒÆ¶¯ÔؾߵĸÐ֪ѶºÅ£¬²¢Ñ¡ÔñÖ±½Ó¶ÁÈ¡¸ÃЩ¸Ð֪ѶºÅ»òͨ¹ýÒÆ¶¯ÔؾߵļÆËã»úÕï¶Ï½Ó¿Ú¶ÁÈ¡¸ÃЩ¸Ð֪ѶºÅ£» ÕûºÏÔËËãµ¥Ôª£¬ÎªÖÐÑë´¦ÀíÆ÷£¬½ÓÊÕ¸ÃÒÆ¶¯ÔؾßѶºÅ¶ÁÈ¡µ¥ÔªÓ붨λµ¥ÔªËùÊäÈëµÄѶºÅ½øÐÐÔËËã´¦Àí£» ¶¨Î»µ¥Ôª£¬È¡µÃ¶¨Î»Î»ÖÃÓ뷽λ½Ç¶È£¬²¢¾ß¸Ãµ¥Ôª¶¨Î»Ñ¶ºÅ¿É¿¿¶ÈÖ¸ÕëµÄ¶¨Î»×°Ö㬽«È¡µÃµÄѶºÅ´«ËÍÖÁ¸ÃÕûºÏÔËËãµ¥Ôª¡£
2.¸ù¾ÝȨÀûÒªÇó1ËùÊöµÄ¸¨ÖúÒÆ¶¯Ôؾ߶¨Î»µÄϵͳ£¬ÆäÌØÕ÷ÔÚÓÚ£¬¸Ã¼ÆËã»úÕï¶Ï½Ó¿ÚΪOBDI1¡¢CAN BUS¡¢LIN BUSµÄͨѶ½Ó¿Ú±ê×¼¡£
3.¸ù¾ÝȨÀûÒªÇó1ËùÊöµÄ¸¨ÖúÒÆ¶¯Ôؾ߶¨Î»µÄϵͳ£¬ÆäÌØÕ÷ÔÚÓÚ£¬¸Ã¶¨Î»×°ÖÃΪȫÇòÎÀÐǶ¨Î»ÏµÍ³GPS¡£
4.Ò»ÖÖ¸¨ÖúÒÆ¶¯Ôؾ߶¨Î»µÄ·½·¨£¬ÆäÌØÕ÷ÔÚÓÚ£¬ÖÁÉÙ°üÀ¨²½Öè: A:½ÓÊÕ¶¨Î»ÐÅÏ¢²¢ÅжÏÊÇ·ñ¶¨Î»ÕýÈ·£» B:ÈôÊÇ£¬ÅжÏÊÇ·ñÂú×㸨Öú¶¨Î»ÔµãÌõ¼þ£¬Èô·ñ£¬ÅжÏÊÇ·ñÈ¡µÃ¸¨Öú¶¨Î»Ôµã£¬Èô·ñ£¬ÅжÏÊÇ·ñÒÑÈ¡µÃ¸¨Öú¶¨Î»Ôµã£» C:²½ÖèBÖУ¬ÈôÊÇÂú×㸨Öú¶¨Î»ÔµãÌõ¼þ£¬¸üи¨Öú¶¨Î»Ôµã²¢¸üж¨Î»µã£¬ÈôδÂú×㸨Öú¶¨Î»ÔµãÌõ¼þ£¬Ö±½Ó¸üж¨Î»µã£» D:²½ÖèBÖУ¬ÈôÒÑÈ¡µÃ¸¨Öú¶¨Î»Ôµãʱ£¬½øÐи¨Öú¶¨Î»¼ÆËã²¢¸üи¨Öú¶¨Î»µã£¬ÈôδȡµÃ¸¨Öú¶¨Î»ÔµãÖØ»Ø²½ÖèAÖØÐ¶¨Î»ÐÅÏ¢½ÓÊÕ¡£
5.¸ù¾ÝȨÀûÒªÇó4ËùÊöµÄ¸¨ÖúÒÆ¶¯Ôؾ߶¨Î»µÄ·½·¨£¬ÆäÌØÕ÷ÔÚÓÚ£¬Åжϸò½ÖèA¶¨Î»ÕýÈ·£¬°üÀ¨¸Ã¶¨Î»µ¥Ôª×´Ì¬Ö¸Ê¾ÎªÓÐЧÇÒÓëÉÏÒ»¸öÈ¡Ñù¶¨Î»µÄ¾àÀë·ûºÏ¸ÃÒÆ¶¯ÔؾßÖÐÒÆ¶¯¾àÀë¸ÐÖª×é¼þµÄÎ»ÒÆ¼ÆËã¡£
6.¸ù¾ÝȨÀûÒªÇó4ËùÊöµÄ¸¨ÖúÒÆ¶¯Ôؾ߶¨Î»µÄ·½·¨£¬ÆäÌØÕ÷ÔÚÓÚ£¬Åжϸò½ÖèBÊÇ·ñÂú×㸨Öú¶¨Î»ÔµãÌõ¼þ£¬°üÀ¨Ô¶¨Î»µãÉÐδʧȥѶºÅ»òÆä¶¨Î»×´Ì¬ÈÔÓÐЧµÄÇé¿öÏ£¬ÔÙÅäºÏ¸Ã·½ÏòÅ̽ǶÈÇ÷½ü0¡ã ÍÁÎó²î·¶Î§ÄÚÇÒά³ÖÐÐʻһ¶Î¾àÀëºó£¬²ÅΪ¸¨Öú¶¨Î»Ôµã(H)¡£
7.¸ù¾ÝȨÀûÒªÇó6ËùÊöµÄ¸¨ÖúÒÆ¶¯Ôؾ߶¨Î»µÄ·½·¨£¬ÆäÌØÕ÷ÔÚÓÚ£¬¸Ã¶Î¾àÀëΪ¸ÃÒÆ¶¯Ôؾߵij¤¶È¡£
8.¸ù¾ÝȨÀûÒªÇó6ËùÊöµÄ¸¨ÖúÒÆ¶¯Ôؾ߶¨Î»µÄ·½·¨£¬ÆäÌØÕ÷ÔÚÓÚ£¬¸Ã²½ÖèD¸¨Öú¶¨Î»¼ÆËãΪÏÂÁй«Ê½:
¦¶¦Ç+1 = ¦¶¦Ç+¦¤¦¶ ¡¡(1) ¦´¦Ç+¦É = ¦´¦Ç+¦¤¦´¡¡¢Æ
¦¤ X = S.sin ¦Ä ¦Ç......(3)
¦¤ ¦´ = S.cos ¦Ä ¦Ç......(4) ÆäÖУ¬Ã´¡¡(5) ¶¨ÒåÈçÏÂ:X1:ºá(¶«Î÷)Ïò×ø±êλÖæ«¦¶:ºá(¶«Î÷)Î»ÒÆ¾àÀëY1:×Ý(Äϱ±)Ïò×ø±êλÖæ¤¦´:×Ý(Äϱ±)Î»ÒÆ¾àÀëS:ÒÆ¶¯¾àÀësn:·½Î»½Ç¦È 0:¸¨Öú¶¨Î»ÔµãÖ®·½Î»½Ç¡£
¡¾Îĵµ±àºÅ¡¿G01S19/48GK104280757SQ201410525034
¡¾¹«¿ªÈÕ¡¿2015Äê1ÔÂ14ÈÕ ÉêÇëÈÕÆÚ:2014Äê10ÔÂ8ÈÕ ÓÅÏÈȨÈÕ:2014Äê2ÔÂ13ÈÕ
¡¾·¢Ã÷Õß¡¿Çñ¼ÑºÌ, Àî d¹â ÉêÇëÈË:ÖлªµçÐŹɷÝÓÐÏÞ¹«Ë¾