רÀûÃû³Æ£º³µÔصÀ·ÆÂ¶È¼ì²â·½·¨¼°×°ÖõÄÖÆ×÷·½·¨
¼¼ÊõÁìÓò£º
±¾·¢Ã÷ÊôÓÚÆû³µµç×Ó¼¼ÊõÁìÓò£¬ÓÈÆäÉæ¼°Ò»ÖÖ³µÔصÀ·ÆÂ¶ÈµÄ¼ì²â·½·¨¼°×°Öá£
±³¾°¼¼Êõ£º
´«Í³µÄ³µÔصÀ·ÆÂ¶È¼ì²â¼¼Êõ£¬Ò»ÖÖÊÇÒÔÕû³µ×ÝÏò¶¯Á¦Ñ§Ä£ÐÍΪ»ù´¡£¬ÀûÓô«¸ÐÆ÷²É¼¯³µÁ¾ÔËÐеĸ÷Ïî²ÎÊý£¬Èç³µËÙ¡¢³µÁ¾¼ÓËÙ¶È¡¢·¢¶¯»úתËÙ¡¢×ª¾Ø¡¢Õû³µÖÊÁ¿µÈ£¬×îºóͨ¹ý¶¯Á¦Ñ§µÄ·½³Ì¼ÆËãµÃµ½³µÁ¾ËùÐÐÊ»µÄÆÂ¶ÈÖµ£¬ÕâÖÖ¼¼ÊõÖ÷ÒªÓÃÓÚ×Ô¶¯»¯³Ì¶ÈºÜ¸ßµÄ¸ßµµ³µÁ¾£¬ÆäȱÏÝÊDzɼ¯µÄ²ÎÊý½Ï¶à£¬³É±¾½Ï¸ß£¬²»ÊÊÓÃÓÚ´óÅúÁ¿µÍ³É±¾µÄ³µÁ¾£»»¹ÓÐÒ»ÖÖÊÇÖðµã¾²Ì¬¼ì²â£¬¼´ÔÚ³µÁ¾ÉÏÿ¼ä¸ôÒ»¶Î¾àÀëʹÓûúе»òµç×Ó¼ì²âÉ豸£¬Èç»ùÓÚÇã½Ç´«¸ÐÆ÷µÄ ÆÂ¶È³ß¡¢ÖØ´¸Ê½ÆÂ¶È¼Ü¡¢UÐ͹ÜʽÆÂ¶ÈÒǵȻñµÃµÀ·ÆÂ¶ÈÖµ£¬ÕâÖÖ¼¼ÊõµÄȱÏÝÊDz¼Öüà²âµã½ÏΪÀ§ÄÑ£¬¼à²âµã¹ýÊèÔò²»Äܾ«È·µÄ·´Ó³ÆÂ¶È±ä»¯£¬¹ýÃÜÔòÔì³É¼ì²âºÍά»¤¹¤×÷Á¿´ó¡¢Ð§Âʵ͡£ÉêÇëºÅΪ200910080694. 3µÄÖйú·¢Ã÷רÀûÉêÇ빫²¼Îı¾Öй«¿ªÁËÒ»ÖÖ³µÔصĵÀ·ÆÂ¶Èʶ±ð¼¼Êõ£¬¸Ã¼¼Êõ²ÉÓÃÈ«ÇòÎÀÐǶ¨Î»ÏµÍ³(GPS)ʵʱ»ñÈ¡³µËÙÐÅÏ¢Vt£¬Í¨¹ý¼ÆËã×°ÖÃ΢·ÖÇóµÃ³µÁ¾¼ÓËÙ¶Èa=dVt/dt ;ͬʱ²ÉÓüÓËÙ¶È´«¸ÐÆ÷»ñÈ¡¼ÓËÙ¶ÈÐÅÏ¢asmsOT (³µÁ¾¼ÓËٶȺÍÖØÁ¦¼ÓËٶȵÄʸÁ¿ºÍ)£¬ÔÙͨ¹ý¼ÆËãµÃµ½ÖØÁ¦¼ÓËÙ¶È·ÖÁ¿£¬×îÖÕ¼ÆËã³öµÀ·ÆÂ¶È£¬¹«Ê½Îªa =arcsin{ (a-asensor) /g},ÆäÖÐgÎªÖØÁ¦¼ÓËٶȳ£Êý¡£ÉÏÊö¼¼ÊõµÄȱÏÝÊÇ£¬³µËÙÐÅÏ¢VtÊÇͨ¹ýGPSϵͳ»ñµÃµÄ£¬Òò´Ë¸Ã·½·¨ÑÏÖØÒÀÀµÓÚGPSµÄ¾«¶ÈºÍʵʱÐÔ£¬²¢Çҳɱ¾½Ï¸ß£¬ÏµÍ³¸´ÔÓ£¬ÊµÊ±ÐԽϲºÜÄÑÓ¦ÓÃÓÚ¶ÔÓ¦µÀ·ÆÂ¶È¼ì²âʵʱÐÔÒªÇó½Ï¸ßµÄ³¡ºÏ¡£×¨ÀûºÅΪ200920208943. 8µÄÖйúʵÓÃÐÂÐÍרÀû¹«¿ªÁËÒ»ÖÖ³µÔصÀ·ÆÂ¶Èʶ±ð¼¼Êõ£¬ÓëÉÏÊö¼¼Êõ²»Í¬µÄÊÇ£¬Æä³µËÙÐÅÏ¢ÊÇͨ¹ý³µÔصÄËÙ¶È´«¸ÐÆ÷»ñµÃµÄ¡£ÕâÖÖ¼¼ÊõµÄȱÏÝÊÇ£¬ÔÚʵʱ¼ì²âµÀ·ÆÂ¶Èʱ£¬ÓÉÓÚ³µËÙÒ×Êܵ½»»µ²³å»÷£¬Â·Ã治ƽ¶ÈµÈËæ»úÒòËØµÄ¸ÉÈÅ£¬ËùÒÔÖ±½Ó¶Ô³µËÙ΢·ÖµÃµ½µÄ³µÁ¾¼ÓËÙÐÅÏ¢Öк¬ÓнϴóµÄÔëÉù£¬¸ÃÔëÉùÖ±½ÓÓ°ÏìµÀ·ÆÂ¶ÈµÄ¼ì²â½á¹û£¬ÓÉÓÚ»á»ýÀÛÎó²î£¬Òò´ËÔËÐÐÒ»¶Îʱ¼äÖ®ºó£¬Æ«²î»á±È½ÏÑÏÖØ£¬ÓÉÓÚÆÂ¶ÈÐÅÏ¢ÓÃÓÚ³µÁ¾×Ô¶¯¿ØÖÆ(È綨ËÙѲº½¡¢¸¨ÖúÆÂµÀÆð²½¡¢×Ô¶¯±äËÙµÈ)£¬Òò´Ë»áÖð½¥Ôì³É³µÁ¾µÄ¿ØÖÆÐÔÄÜϽµ¡£
·¢Ã÷ÄÚÈÝ
Ϊ½â¾öÉÏÊöÎÊÌ⣬±¾·¢Ã÷ÌṩÁËÒ»ÖÖÄܹ»³¤ÆÚÎȶ¨µÄ»ñµÃ¾«È·µÄ³µËÙÐÅÏ¢ÓÃÓÚ³µÁ¾ÆÂ¶È¼ì²âµÄ·½·¨£¬ÒÔ¼°²ÉÓø÷½·¨µÄ³µÔصÀ·ÆÂ¶È¼ì²â×°Öá£ÎªÊµÏÖÉÏÊöÄ¿µÄ£¬±¾·¢Ã÷µÄ³µÔصÀ·ÆÂ¶È¼ì²â·½·¨°üÀ¨
(I)³µÔسµËÙ´«¸ÐÆ÷ʵʱ¼ì²â³µËÙÐÅÏ¢£¬½«³µËÙ¼ì²âÖµV3mͨ¹ýCAN×ÜÏ߽ӿڵ練«µÝ¸øMCUÔËËãµ¥Ôª£»(2)ͨ¹ý¿¨¶ûÂüÂ˲¨Æ÷¹À¼Æ³µËÙVk£»
(3)ͨ¹ýÊý×Ö΢·Ö¼ÆËã³µÁ¾¼ÓËÙ¶Èa=dVk/dt£»
(4)³µÔؼÓËÙ¶È´«¸ÐÆ÷ʵʱ¼ì²â³µÁ¾¼ÓËÙ¶ÈasmsOT£»
(5)MCUÔËËãµ¥Ôª¼ÆËãµÀ·ÆÂ¶È0=arcsin{ (a-asensor) /g}
(6)MCUµ¥ÔªÍ¨¹ýCAN×ÜÏßÊä³öµÀ·ÆÂµÀÖµ¡£MCUÔËËãµ¥Ôª½øÐп¨¶ûÂüÂ˲¨¼ÆËãµÄ·½·¨ÈçÏÂ
Jk=Jk-i+ki X ¦Ä
ak=ak-i+jk-i+k2X ¦Ä
Vk=Vk_i +TXak^k3X ¦Ä
ÆäÖÐJk:±¾´Îµü´úµÃµ½µÄ³å»÷¶È£»
Jk-!ǰ´Îµü´úµÃµ½µÄ³å»÷¶È£»
¦Ä =V²â-Y1ʵ²â³µËÙV²âÓëÂ˲¨³µËÙ&µÄËٶȲ
kl¡¢k2¡¢k3 :¿¨¶ûÂüÔöÒæ³£Êý£»
T :¼ì²âÖÜÆÚ¡£±¾·¢Ã÷»¹ÌṩÁËÒ»ÖÖʹÓÃÉÏÊö·½·¨µÄ³µÔصÀ¡¤Â·ÆÂ¶È¼ì²â×°Öã¬Ëü°üÀ¨MCUÔËËãµ¥Ôª£¬¼°ÓëÆäÏàÁ¬½ÓµÄ¼ÓËÙ¶È´«¸ÐÆ÷¡£ËùÊöMCUÔËË㵥Ԫͨ¹ýCAN×ÜÏßÓë³µËÙ´«¸ÐÆ÷ÏàÁ¬½Ó¡£±¾·¢Ã÷ÀûÓÿ¨¶ûÂüÂ˲¨Æ÷À´¹À¼Æ³µÁ¾ËÙ¶È£¬Í¨¹ýµ÷Õû¿¨¶ûÂüÂ˲¨ÏµÊý£¬¿ÉÒÔ½µµÍ³µËÙÐÅÏ¢ÖеÄÔëÉù£¬´Ó¶øÌá¸ßÁ˵À·ÆÂ¶ÈµÄ¼ì²â¾«¶È£¬½µµÍÁËϵͳÑÓʱ¡£¿Ë·þÁËÏÖÓм¼ÊõÔÚʵ¼ÊʹÓùý³Ì³öÏֵļì²âÉ豸Ôì¼Û¹ý¸ß¡¢¼ì²âÉ豸°²×°À§ÄÑ¡¢ÆÂ¶È¼ÆË㸴ÔÓ¡¢²»ÄÜʵʱ¼ì²â³µÁ¾ÐÐÊ»µÀ·ÆÂ¶È±ä»¯µÈ·½ÃæµÄȱµã¡£Îª³µÁ¾ÌṩÁËÒ»ÖÖÔì¼ÛµÍÁ®¡¢°²×°·½±ã¡¢ÆÂ¶È¼ÆËã¼òµ¥¿ì½Ý¡¢¿ÉÒÔʵʱ¼ì²â³µÁ¾ÐÐÊ»ÆÂ¶ÈµÄ¼ì²âϵͳ¡£
ͼI³µÁ¾µÀ·ÆÂ¶È¼ì²âÔÀíʾÒâ ͼ2³µÁ¾µÀ·ÆÂ¶È¼ì²â·½·¨Á÷³Ì ͼ3Ϊ³µÁ¾µÀ·ÆÂ¶È¼ì²â×°ÖÃʵʩÀýI½á¹¹Ê¾Òâ ͼ4Ϊ³µÁ¾µÀ·ÆÂ¶È¼ì²â×°ÖÃʵʩÀý2½á¹¹Ê¾Òâͼ¡£
¾ßÌåʵʩÀý·½Ê½ÏÂÃæ²ÎÕÕ¸½Í¼£¬½áºÏʵʩÀý£¬¶Ô±¾·¢Ã÷ÌṩµÄ³µÔØÆÂ¶È¼ì²âϵͳ·½·¨½øÐÐÏêϸ˵Ã÷¡£ÊµÊ©ÀýI:
²ÎÕÕͼI¡¢Í¼2ºÍͼ3¶Ô±¾·¢Ã÷ʵʩÀý½øÐÐ˵Ã÷¡£±¾ÊµÊ©ÀýËùÊöµÄ³µÔØÆÂ¶È¼ì²âϵͳÖ÷Òª°üÀ¨¼ÓËÙ¶È´«¸ÐÆ÷(ÓÃÓÚʵʱµÄ¼ì²âµÀ·ÆÂ¶ÈÓë³µÁ¾¼ÓËÙ¶ÈÔÚ³µÁ¾×ÝÏò·½ÏòµÄʸÁ¿ºÍ)¡¢MCUÔËËãµ¥Ôª(ÓÃÓÚ¼ÆË㵱ǰ³µÁ¾µÄ¼ÓËÙ¶È¡¢µÀ·ÆÂ¶È)ºÍCAN×ÜÏß½Ó¿Úµç·(ÓÃÓÚ½«¼ÆËãµÄµÀ·ÆÂ¶ÈÐÅÏ¢·¢ËͳöÈ¥£¬Í¬Ê±»ñÈ¡³µÁ¾ÐÐÊ»ËÙ¶ÈÐÅÏ¢)¡£MCUÔËËãµ¥ÔªÖ±½ÓÓë¼ÓËÙ¶È´«¸ÐÆ÷ÏàÁ¬½Ó£¬Í¨¹ý¼ÓËÙ¶È´«¸ÐÆ÷»ñµÃ³µÁ¾×ÝÏò¼ÓËÙ¶È£»MCUÔËË㵥Ԫͨ¹ýCAN×ÜÏ߽ӿڵ緻ñµÃµ½³µÁ¾ËÙ¶ÈÐÅÏ¢£¬Í¨¹ýÔËËãºóµÃµ½µÀ·ÆÂ¶È¡£½«³µÔØÆÂµÀ¼ì²â×°Öð²×°ÔÚÕû³µÉÏ£¬Ê¹µÃ¼ÓËÙ¶È´«¸ÐÆ÷µÄ¸ÐÓ¦ÖáºÍ³µÁ¾×ÝÏò·½ÏòƽÐС£ÔÚ´Ë·½ÏòÉÏ£¬¼ÓËÙ¶È´«¸ÐÆ÷Äܹ»¸ÐÓ¦µÄ¼ÓËÙ¶ÈÎªÖØÁ¦¼ÓËÙ¶ÈgÔÚ´Ë·½ÏòÉϵķÖÁ¿
Óë³µÁ¾ÐÐÊ»¼ÓËÙ¶Èa , ¶þÕßÔÚ³µÁ¾ÐÐÊ»·½ÏòÉÏͶӰΪasensOT=a_ƶ,½«¼ÓËÙ¶È´«¸ÐÆ÷µÄÊä³öÖµasmsOT¼õÈ¥³µÁ¾ÐÐÊ»¼ÓËÙ¶Èa¾ÍÊÇÖØÁ¦¼ÓËÙ·ÖÁ¿,´Ëʱͨ¹ý·´
ÕýÏÒÔËËã¾Í¿ÉÒÔ½«µÀ·ÆÂ¶È¡¶±å½âµÃµ½¡£¾ßÌåÄ£ÐÍÈçÏÂ
ȨÀûÒªÇó
1.Ò»ÖÖ³µÔصÀ·ÆÂ¶È¼ì²â·½·¨£¬ÆäÌØÕ÷ÔÚÓÚËü°üÀ¨ÏÂÊö²½Öè (1)³µÔسµËÙ´«¸ÐÆ÷ʵʱ¼ì²â³µËÙÐÅÏ¢£¬½«³µËÙ¼ì²âÖµV3mͨ¹ýCAN×ÜÏß½Ó¥íµç·´«µÝ¸øMCUÔËËãµ¥Ôª£» (2)ͨ¹ý¿¨¶ûÂüÂ˲¨Æ÷¹À¼Æ³µËÙVk; (3)ͨ¹ýÊý×Ö΢·Ö¼ÆËã³µÁ¾¼ÓËÙ¶Èa= dVk/dt £» (4)³µÔؼÓËÙ¶È´«¸ÐÆ÷ʵʱ¼ì²â³µÁ¾¼ÓËÙ¶ÈasmsOT£» (5)MCUÔËËãµ¥Ôª¼ÆËãµÀ·ÆÂ¶È¦¨ = arcsin {(a-asensor) /g} (6)MCUµ¥ÔªÍ¨¹ýCAN×ÜÏßÊä³öµÀ·ÆÂµÀÖµ¡£
2.¸ù¾ÝȨÀûÒªÇóIËùÊöµÄ³µÔصÀ·ÆÂ¶È¼ì²â·½·¨£¬ÆäÌØÕ÷ÔÚÓÚËùÊöMCU½øÐп¨¶ûÂüÂ˲¨¼ÆËãµÄ·½·¨ÈçÏ Jk = Jk-i+ki X ¦Ä ak =¦ÄVk = Vk_1+TXak_1+k3X ¦ÄÆäÖÐ=Jk :±¾´Îµü´úµÃµ½µÄ³å»÷¶È£» JV1ǰ´Îµü´úµÃµ½µÄ³å»÷¶È£» ^ = Vm -Fifcʵ²â³µËÙV3mÓë¹À¼Æ³µËÙhµÄËٶȲ kl¡¢k2¡¢k3 :¿¨¶ûÂüÔöÒæ³£Êý T :¼ì²âÖÜÆÚ
3.©`ÖÖʹÓÃȨÀûÒªÇóI»ò2ËùÊöµÄ³µÔØÆÂ¶È¼ì²â·½·¨µÄ³µÔصÀ·ÆÂ¶È¼ì²â×°Öã¬ÆäÌØÕ÷ÔÚÓÚËü°üÀ¨MCUÔËËãµ¥Ôª£¬¼°ÓëÆäÏàÁ¬½ÓµÄ¼ÓËÙ¶È´«¸ÐÆ÷¡£
4.¸ù¾ÝȨÀûÒªÇó3ËùÊöµÄ³µÔصÀ·ÆÂ¶È¼ì²â×°Öã¬ÆäÌØÕ÷ÔÚÓÚËùÊöMCUÔËË㵥Ԫͨ¹ýCAN×ÜÏßÓë³µËÙ´«¸ÐÆ÷ÏàÁ¬½Ó¡£
È«ÎÄÕªÒª
±¾·¢Ã÷Éæ¼°Ò»ÖÖ³µÔصÀ·ÆÂ¶ÈµÄ¼ì²â·½·¨¼°×°Ö᣸÷½·¨°üÀ¨ÏÂÊö²½Öè³µÔØ³µËÙ´«¸ÐÆ÷ʵʱ¼ì²â³µËÙÐÅÏ¢£¬½«³µËÙ¼ì²âÖµV²âͨ¹ýCAN×ÜÏ߽ӿڵ練«µÝ¸øMCUÔËËãµ¥Ôª£»Í¨¹ý¿¨¶ûÂüÂ˲¨Æ÷¹À¼Æ³µËÙVk£»Í¨¹ýÊý×Ö΢·Ö¼ÆËã³µÁ¾¼ÓËÙ¶Èa=dVk/dt£»³µÔؼÓËÙ¶È´«¸ÐÆ÷ʵʱ¼ì²â³µÁ¾¼ÓËÙ¶Èasenser£»MCUÔËËãµ¥Ôª¼ÆËãµÀ·ÆÂ¶È¦È=arcsin{(a-asenser)/g}£»MCUµ¥ÔªÍ¨¹ýCAN×ÜÏßÊä³öµÀ·ÆÂµÀÖµ¡£±¾·¢Ã÷ÀûÓÿ¨¶ûÂüÂ˲¨Æ÷À´¹À¼Æ³µÁ¾ËÙ¶È£¬´ó´ó½µµÍ³µËٺͼÓËÙ¶ÈÐÅÏ¢ÖеÄÔëÉù£¬´Ó¶øÌá¸ßÁ˵À·ÆÂ¶ÈµÄ¼ì²â¾«¶È£¬½µµÍÁËϵͳÑÓʱ¡£
Îĵµ±àºÅG01C9/00GK102818556SQ20121007190
¹«¿ªÈÕ2012Äê12ÔÂ12ÈÕ ÉêÇëÈÕÆÚ2012Äê3ÔÂ19ÈÕ ÓÅÏÈȨÈÕ2012Äê3ÔÂ19ÈÕ
·¢Ã÷ÕßÖ£Ðñ¹â, ÍõÐÁÁ¢, ÍõËÉ, ÕÅÅôÀ×, ÍõÓñº£ ÉêÇëÈË:Ò»Æû½â·ÅÇൺÆû³µÓÐÏÞ¹«Ë¾