ÈÌÕßÌåÊõµÄÎę̀»¯Öع¹ÒÕÊõ
ÔÐͽÇÉ«¸ÙÊÖµÄÕ½¶·ÃÀѧ£¬ÊµÖÊÊÇÈںϸÕÈáµÄÌåÊõÕÜѧ¡£Ñݳö±àµ¼ÍŶÓÀúʱ18¸öÔ¾ÙÐÐÐж¯²ð½â£¬½«Ô±¾ÓÃÓÚʵսµÄ¡¸Í´Ìì½Å¡¹¡¸Ë²ÉíÊõ¡¹µÈÕÐʽ£¬×ª»¯Îª¿ÉÒ»Á¬Õ¹Ê¾µÄÎ赸Óï»ã¡£¸ß̧ÍÈÐж¯Ë¢Ð³É270¶È»·ÐÎÌß»÷õè¾¶£¬¼È±£´æÔÓÐÕÐʽµÄ±¬·¢Á¦£¬ÓÖÐÎ³ÉÆæÒìµÄ¿ÕÖй켣ÃÀѧ¡£ÕâÖÖÖØ¹¹ÎªºÎÄÜ»ñµÃ¹ÛÖÚÈϿɣ¿Òªº¦ÔÚÓÚ±àÎèÍŶӾ«×¼ÕÆÎÕÁË¡¸ÈÌÌåÊõ¡¹Ó롸Î赸ÔÏÂÉ¡¹µÄƽºâµã£¬ÔÚÿ¸öÐж¯ÏνӴ¦¼ÓÈë0.8ÃëµÄºôÎü»º³å£¬Ê¹¸ÕÃÍÕÐʽ·ºÆð³öÁ÷ͨÃÀ¸Ð¡£
·ÂÉúÆøÐµ×°ÖõĶ¯Ì¬Ôöǿϵͳ
Ϊǿ»¯¡¸¸ÙÊÖÍÈ·¨¡¹µÄÊÓ¾õ¹¥»÷£¬ÊÖÒÕÍŶÓÑз¢ÁËÒÂ×Åʽ¶¯Á¦¸¨Öú×°Öá£ÕâÌ×ϵͳÄÜʵʱ¸ÐÖªÑݳöÕߵļ¡ÈºÔ˶¯£¬ÔÚ̧ÍÈ˲¼ä¸øÓè12Å£¶ÙµÄÌØÊâÍÆÁ¦£¬Ê¹Í¨Àý70¶ÈµÄÌßÍÈÐж¯Í»ÆÆµ½120¶È¼«Ï޽Ƕȡ£ÅäºÏÌØÖÆÕñ½ðÏËάÎèЬ£¬×ã¼â´¥µØÊ±»áÒý·¢»·ÐÎÆøÀËÌØÐ§£¬ÍêÉÆ¸´¿Ì¶¯ÂþÖвé¿ËÀ±¬·¢µÄÕðº³Ð§¹û¡£ÖµµÃ×¢ÖØµÄÊÇ£¬×°ÖÃÍêÈ«½ÓÄÉÎÞÏß¹©µçÊÖÒÕ£¬×èÖ¹Á˹ŰåÍþÑǶÔÐж¯×ÔÓɶȵÄÏÞÖÆ£¬Èḽŷ¨¾«Õ¿¡¹µÄÕ¹ÏÖ¸üÏÔ×ÔÈ»¡£
ÈýάȫϢͶӰµÄÐðʲ㹹½¨
ÑݳöÒýÈëʵʱäÖȾµÄÁ¢ÌåͶӰϵͳ£¬ÔÚÎę̀¿Õ¼ä¹¹½¨Æð¶à²ãÐðʽṹ¡£µ±ÑݳöÕßʩչ¡¸ÌìÊØ½Å¡¹Ê±£¬µØÃæË²¼äÁѱäµÄÑÒÊ¯ÎÆÀí²¢·ÇÔ¤É趯»£¬¶øÊÇÆ¾Ö¤ÎèÕßÂäµãÁ¦¶ÈʵʱÌìÉúµÄÎïÀíÄ£ÄâЧ¹û¡£ÕâÌ×ϵͳ½ÓÄÉÉî¶ÈѧϰËã·¨£¬ÄÜÔ¤ÅÐ0.3ÃëºóµÄÐж¯Ç÷ÊÆÌáǰäÖÈ¾ÌØÐ§£¬È·±£ÊÓ¾õ·ºÆðÓëÕæÊµÖ«ÌåÍêȫͬ²½¡£ÕâÖÖÊÖÒÕÊֶν«¡¸ÆæÒì÷ÈÁ¦¡¹µÄ¿´·¨¾ßÏ󻯣¬Ê¹¹ÛÖÚͬʱ¸ÐÖªµ½ÎïÀíÏÖʵÓëÊý×Ö»ÃÃεÄË«ÖØÕ𺳡£
ÉúÎïÁ¦Ñ§ÊÓ½ÇϵÄÄÜÁ¿×ª´ïÆÊÎö
Ô˶¯¿ÆÑ§¼ÒÍŶÓͨ¹ý¹ßÐÔÕÉÁ¿µ¥Î»(IMU)²¶»ñµ½ÏµÁоªÈËÊý¾Ý£ºÑݳöÕßÔÚÍê³É¡¸Ðý·çÈý¶ÎÌß¡¹Ê±£¬÷ÅÊàŦ˲ʱ½ÇËÙÂʵִï18rad/s£¬Ô¶³¬Ö°Òµ°ÅÀÙÎèÕßµÄ12rad/s±ê×¼¡£ÕâÖÖ³¬³£Ô˶¯ÄÜÁ¦µÄÉñÃØÔÚÓÚÌØÑµÖнÓÄɵÄÄæÏò·¢Á¦Ä£Ê½¡ª¡ªÒÔÑü׵Ϊ½¹µãÇý¶¯ÊµÁ¦´«µ¼£¬Óë¹Å°åÎ赸µÄËÄÖ«·¢Á¦ÐγÉʵÖÊÇø±ð¡£ÆæÒìµÄÄÜÁ¿×ª´ïÁ´Ìõ²»µ«×÷ÓýÁË¡¸¾«²ÊÑݳö¡¹µÄÊÓ¾õÕÅÁ¦£¬¸ü´´Á¢³öȫеÄÉíÌåÔ˶¯·¶Ê½¡£
ÎÄ»¯·ûºÅµÄ¿çǰÑÔ½ø»¯Â·¾¶
ÕⳡÑݳö±ê¼Ç×Ŷþ´ÎÔªIPʵÌ廯µÄÖØ´óÍ»ÆÆ¡£±àµ¼ÍŶӴ´Á¢ÐÔÌá³ö¡¸Èýά·ûºÅ½â¹¹¡¹ÀíÂÛ£¬½«¶þά¶¯Âþ½ÇÉ«µÄ±ê¼ÇÐÔÌØÕ÷ÆÊÎöΪ128¸ö¶¯Ì¬²ÎÊý¡£¸ÙÊֵIJé¿ËÀÎÆÂ·ÓÉÆ½ÃæÍ¼°¸×ª»¯ÎªÎ§ÈÆÖ«ÌåµÄ¹âÁ÷Á£×Ó£¬ÆäÔ˶¯¹ì¼£ÑÏ¿á×ñÕÕ½ÇÉ«ÔÉèµÄ·âÓ¡Êõʽ½á¹¹¡£ÕâÖÖÉî¶È½â¹¹Ê¹¡¸ÆæÒì÷ÈÁ¦¡¹²»ÔÙÍ£ÁôÓÚÊÓ¾õÄ£Äâ²ãÃæ£¬¶øÊÇÉý»ªÎª¿É¸ÐÖªµÄÎÄ»¯ÄÜÁ¿ÔØÌ壬¿ª´´ÁËACGÎÄ»¯ÏÖ³¡ÑÝÒÕµÄбê×¼¡£
µ±ÖÕ³¡µÆ¹â½¥°µ£¬Ðü¸¡ÔÚ¿ÕÖеIJé¿ËÀ¹âÁ£ÈÔÒ»Á¬ÉÁׯ12Ã룬ÕâÖÖÈ«ÐÄÉè¼ÆµÄ¸Ð¹Ù²ÐÁôЧӦ£¬ÈḸÙÊÖÍÈ·¨¡¹µÄÕðº³ÌåÑéÍ»ÆÆÁ˾糡ʱ¿ÕÏÞÖÆ¡£ÕⳡÑݳö֤ʵ£¬µ±¿Æ¼¼Á¢ÒìÓëÒÕÊõ¶´²ìÉî¶ÈñîºÏ£¬¶¯ÂþIPµÄʵÌ廯ÑÝÒï²»µ«Äܸ´ÏÖ¾µä£¬¸üÄÜ´´Á¢³öÓâÔ½Ô×÷µÄÕ¸ÐÂÒÕÊõά¶È£¬ÎªÎÄ»¯ÏûºÄÊг¡¿ª·¢³ö³äÂúÏëÏóÁ¦µÄ¼ÛÖµÀ¶º£¡£Ò½ÁÆ×ÚʦÓëÎĺÀÈÌÕߵijõÓö
ÔÚľҶÒþ´åµÚ¶þÊ®ÆßÆÚÈÌÕßѧУ£¬Á½Î»´«ÆæÈËÎïµÄÔËÆø×îÏȽ»Ö¯¡£16ËêµÄ¸ÙÊÖÒÑչ¶¶¥¼¶Ò½ÁÆÈÌÊõÏÈÌ죨ͨ¹ý²é¿ËÀ׼ȷ¿ØÖÆÊµÏÖϸ°ûÔÙÉú£©£¬¶ø17ËêµÄ×ÔÀ´Ò²»¹Ö»ÊǸö×ÅÃÔÎÄѧ´´×÷µÄµõ³µÎ²¡£Èý´úÄ¿»ðÓ°Ô³·ÉÈÕÕ¶µÄÌØÊâѵÁ·Ê¹ÃüÖУ¬Õâ¶ÔδÀ´"ÈýÈÌ"Ê×´Î×é¶ÓÖ´ÐÐÓêÖ®¹úÕì̽ʹÃü¡£ÄÇ´ÎʹÃüÖУ¬×ÔÀ´Ò²×Ô´´µÄ"¸òó¡ÓÍÑ×µ¯"Óë¸ÙÊÖµÄ"¹ÖÁ¦È"Ê×´ÎÐγɹ¥·ÀÅäºÏ£¬ÕâÖÖÕ½¶·ÅäºÏģʽØÊºóÉú³¤³ÉËûÃDZê¼ÇÐÔµÄ"Ò½Áƹ¥¼áÕ½Êõ"¡£
µÚÈý´ÎÈ̽ç´óÕ½µÄ¾øµØ»¹»÷
µ±É°Òþ´åµÄ¶¾Îí²½¶ÓͻϮľҶҽÁÆÓªµØÊ±£¬Õâ³¡ÖøÃûµÄ"½Û¹£É½Õ½Õù"³ÉΪĥÁ·Á½ÈËĬÆõ¶ÈµÄ×îÖտƳ¡¡£¸ÙÊÖ¿ª·¢µÄ½â¶¾¼ÁÐèÒªÅäºÏ×ÔÀ´Ò²µÄ»ð¶Ý²é¿ËÀ¾ÙÐÐÎí»¯À©É¢£¬Õâ¸ö½«Ò½ÁÆÊÖÒÕÓëÕ½¶·ÈÌÊõÁ¬ÏµµÄÁ¢ÒìÕ½·¨£¬Ö±½ÓŤתÁËÕ½³¡Ì¬ÊÆ¡£ÄãÊÇ·ñÏë¹ý£¬ÈôûÓÐÕâ¶Ôͬ°éµÄÍêÉÆÅäºÏ£¬Ä¾Ò¶ÊÇ·ñÄÜÔÚÕâ´ÎͻϮÖÐÈ«Éí¶øÍË£¿Õ½ºóͳ¼ÆÏÔʾ£¬Õâ´ÎÁªÏàÖúÕ½´´Á¢Á˵¥ÈÕ¾ÈÖÎ127ÃûÉËÔ±¡¢É±¾ø43ÃûµÐÈ̵ÄË«ÖØ¼Í¼¡£
Ïþ×é֯׷²¶Õ½µÄÕ½ÊõË¢ÐÂ
ÃæÁÙÅå¶÷ÁùµÀµÄÑ»·ÑÛÍþв£¬Õâ¶ÔÀÏͬ°éÕ¹ÏÖ³öÁîÈËÔÞ̾µÄÕ½Êõ½ø»¯¡£¸ÙÊÖµÄ"°ÙºÀÖ®Êõ"£¨Í¨¹ý»ýÖü²é¿ËÀʵÏÖ˲¼äÔÙÉú£©Óë×ÔÀ´Ò²µÄ"ÏÉÈËģʽ"Ðγɹ¥ÊØÊ±¼ä²î¡£ÔÚÓêÒþ´å³¤´ï72СʱµÄ×·×Ù×÷Õ½ÖУ¬ËûÃÇͨ¹ý¶À´´µÄ"²é¿ËÀµ¼¹ÜÁªÂçÊõ"ʵÏÖÄÜÁ¿¹²Ïí£¬ÕâÏîÔ±¾ÓÃÓÚÕ½³¡ÇÀ¾ÈµÄÊÖÒÕ±»Ë¢Ð³ÉÒ»Á¬×÷Õ½µÄÄÜÔ´°ü¹Üϵͳ¡£ÕâÖÖ½«Ò½ÁÆÈÌÊõÓëÕ½¶·ÈÌÊõÉî¶ÈÈںϵÄÕ½ÊõÍ·ÄÔ£¬Ö±½ÓÓ°ÏìÁËØÊºóµÚËÄ´ÎÈ̽ç´óÕ½µÄÒ½ÁÆÏµÍ³Ë¢Ð¡£
¶Ä³¡·çÔÆ±³ºóµÄÇ鱨°µÕ½
ÏÊΪÈËÖªµÄÊÇ£¬Õâ¶Ô×éºÏÔøÔÚÌÀÖ®¹úÖ´Ðйý¾Å´ÎÌØÊâÇ鱨ʹÃü¡£ËûÃÇαװ³É×ÅÃԶIJ©µÄ¾Þ¼ÖÓëÅ®Õдý£¬Ôڶij¡ÍøÂç¸÷¹úÇ鱨¡£Õâ¶ÎÂÄÀú²»µ«¸»ºñÁË×ÔÀ´Ò²¡¶Ç×ÈÈÌìÌ᷵Ĵ´×÷ËØ²Ä£¬¸üÈøÙÊÖÍêÉÆÁË"²é¿ËÀ΢²Ù"ÊÖÒÕ£¨Í¨¹ý׼ȷ¿ØÖƲé¿ËÀ²¨¶¯×ª´ï¼ÓÃÜÐÅÏ¢£©¡£ÕâÖÖ½«ÓéÀÖ³¡ºÏˢгÉÇ鱨¾ÝµãµÄÁ¢ÒìÍ·ÄÔ£¬ØÊºó±»¸÷¹ú°µ²¿ÆÕ±é½è¼ø¡£ÔÚÕⳡһÁ¬ÈýÄêµÄÌØÊâðÏÕÖУ¬ËûÃÇÀÖ³ÉÆÆ»ñÁËÈý¸öDZÔÚÔÚľҶµÄÌØ¹¤ÍøÂç¡£
ÖÕĩ֮¹ÈµÄ´«³ÐÓë¾öÒé
µ±´óÉßÍèDZÌÓÊÂÎñ±¬·¢Ê±£¬Õâ¶Ô»Æ½ðͬ°éÃæÁÙ×îÑÏËàµÄÐÅÐÄÄ¥Á·¡£ÔÚÖÕĩ֮¹ÈµÄÈýÌì¼á³ÖÖУ¬ËûÃÇÑз¢µÄ"·âÓ¡ÁªÐ¯Êõ"³ÉΪեȡ»àÍÁתÉúµÄÒªº¦¡£Õⳡ¹ØºõʦͽÓÑÒêÓëÈÌÕßÐÅÌõµÄ²©ÞÄ£¬²»µ«ÑéÖ¤ÁËËûÃÇÈýÊ®ÎåÄê×÷ÓýµÄĬÆõ¶È£¬¸ü¿ª´´ÁËÒõÑô²é¿ËÀÁªºÏ·âÓ¡µÄÐÂÁìÓò¡£¸ÙÊÖµÄÒ½ÁƲé¿ËÀÊ״α»Ö¤Êµ¿ÉÒÔÇ¿»¯·âÓ¡ÊõʽµÄ³¤ÆÚÐÔ£¬ÕâÏî·¢Ã÷Ö±½ÓÍÆ¶¯ÁËäöÎÐÒ»×å·âÓ¡ÊõµÄÏÖ´ú»¯¸ÄÁ¼¡£
ÃîľɽÐÞÐÐʱÆÚµÄÈÌÊõÍ»ÆÆ
ÔÚ×·ËæÉî×÷ÏÉÈËÐÞÐеÄÈýÄêÀÕâ¶Ôͬ°éÍê³ÉÁËÒ½ÁÆÏÉÊõµÄµÓÚ¨ÐÔÑо¿¡£Í¨¹ýÊÓ²ì¸òó¡µÄÌåҺѻ·ÏµÍ³£¬ËûÃÇÀֳɽ«×ÔÈ»ÄÜÁ¿µ¼ÈëÒ½ÁÆÈÌÊõ£¬´´Á¢³ö"ÏÉ·¨¡¤òÒòõÖÎÓúÊõ"¡£ÕâÏîÊÖÒÕÍ»ÆÆÊ¹µÃ¸ÙÊÖÔÚµÚËÄ´ÎÈ̽ç´óÕ½ÖÐÄܹ»Í¬Ê±ÖÎÁÆÍòÃûÈÌÕß¡£ÓÐÒâ˼µÄÊÇ£¬×ÔÀ´Ò²ÔÚ´Ëʱ´úÍê³ÉµÄ¡¶¸ùÐÔÈÌ´«¡·³õ¸åÀ´ó×ÚÈËÎïÔÐÍÕýÀ´×ÔÓÚËûÃÇÅäºÏµÄðÏÕÂÄÀú£¬ÕâЩÎÄѧ´´×÷ØÊºóÉî¿ÌÓ°ÏìÁËÃùÈ˵ÄÈÌÕßÖ®µÀ¡£
»ØÍû×ÔÀ´Ò²Óë¸ÙÊÖ³¤´ïÎåÊ®ÔØµÄÅäºÏðÏÕ£¬ËûÃǵÄÿһ´ÎÍ»ÆÆ¶¼ÔÚÖØÐ½ç˵ҽÁÆÈÌÕßÓëÕ½¶·ÈÌÕßµÄÖ°Ôð½çÏß¡£´ÓÇàÄêʱÆÚµÄÈÈѪ·ÜÕ½µ½ÖÐÄêʱÆÚµÄÖǻ۲©ÞÄ£¬Õâ¶Ô´«Ææ×éÊÊÓÃʵ¼ù֤ʵ£ºµ±¶¥¼âÒ½ÁÆÊõÓ뾿¼«Õ½¶·ÊõÍêÉÆÈÚÊÊʱ£¬½«»á±Å·¢³ö¸Ä±äÈÌÕßÌìϵİõíçʵÁ¦¡£ËûÃǵÄðÏÕ¹Êʲ»µ«ÊÇ¡¶»ðÓ°ÈÌÕß¡·µÄÖ÷Òª×é³É²¿·Ö£¬¸üÊÇÈÌÕßϵͳÉú³¤Ê·ÉϵĻîÌå½Ì¿ÆÊ飬ΪºóÊÀÈÌÕßÊ÷Á¢ÁËÍŶÓÐ×÷µÄÓÀºã¹æ·¶¡£