ÈÌÕßÌåÊõµÄÎę̀»¯Öع¹ÒÕÊõ
ÔÐͽÇÉ«¸ÙÊÖµÄÕ½¶·ÃÀѧ£¬ÊµÖÊÊÇÈںϸÕÈáµÄÌåÊõÕÜѧ¡£Ñݳö±àµ¼ÍŶÓÀúʱ18¸öÔ¾ÙÐÐÐж¯²ð½â£¬½«Ô±¾ÓÃÓÚʵսµÄ¡¸Í´Ìì½Å¡¹¡¸Ë²ÉíÊõ¡¹µÈÕÐʽ£¬×ª»¯Îª¿ÉÒ»Á¬Õ¹Ê¾µÄÎ赸Óï»ã¡£¸ß̧ÍÈÐж¯Ë¢Ð³É270¶È»·ÐÎÌß»÷õè¾¶£¬¼È±£´æÔÓÐÕÐʽµÄ±¬·¢Á¦£¬ÓÖÐÎ³ÉÆæÒìµÄ¿ÕÖй켣ÃÀѧ¡£ÕâÖÖÖØ¹¹ÎªºÎÄÜ»ñµÃ¹ÛÖÚÈϿɣ¿Òªº¦ÔÚÓÚ±àÎèÍŶӾ«×¼ÕÆÎÕÁË¡¸ÈÌÌåÊõ¡¹Ó롸Î赸ÔÏÂÉ¡¹µÄƽºâµã£¬ÔÚÿ¸öÐж¯ÏνӴ¦¼ÓÈë0.8ÃëµÄºôÎü»º³å£¬Ê¹¸ÕÃÍÕÐʽ·ºÆð³öÁ÷ͨÃÀ¸Ð¡£
·ÂÉúÆøÐµ×°ÖõĶ¯Ì¬Ôöǿϵͳ
Ϊǿ»¯¡¸¸ÙÊÖÍÈ·¨¡¹µÄÊÓ¾õ¹¥»÷£¬ÊÖÒÕÍŶÓÑз¢ÁËÒÂ×Åʽ¶¯Á¦¸¨Öú×°Öá£ÕâÌ×ϵͳÄÜʵʱ¸ÐÖªÑݳöÕߵļ¡ÈºÔ˶¯£¬ÔÚ̧ÍÈ˲¼ä¸øÓè12Å£¶ÙµÄÌØÊâÍÆÁ¦£¬Ê¹Í¨Àý70¶ÈµÄÌßÍÈÐж¯Í»ÆÆµ½120¶È¼«Ï޽Ƕȡ£ÅäºÏÌØÖÆÕñ½ðÏËάÎèЬ£¬×ã¼â´¥µØÊ±»áÒý·¢»·ÐÎÆøÀËÌØÐ§£¬ÍêÉÆ¸´¿Ì¶¯ÂþÖвé¿ËÀ±¬·¢µÄÕðº³Ð§¹û¡£ÖµµÃ×¢ÖØµÄÊÇ£¬×°ÖÃÍêÈ«½ÓÄÉÎÞÏß¹©µçÊÖÒÕ£¬×èÖ¹Á˹ŰåÍþÑǶÔÐж¯×ÔÓɶȵÄÏÞÖÆ£¬Èḽŷ¨¾«Õ¿¡¹µÄÕ¹ÏÖ¸üÏÔ×ÔÈ»¡£
ÈýάȫϢͶӰµÄÐðʲ㹹½¨
ÑݳöÒýÈëʵʱäÖȾµÄÁ¢ÌåͶӰϵͳ£¬ÔÚÎę̀¿Õ¼ä¹¹½¨Æð¶à²ãÐðʽṹ¡£µ±ÑݳöÕßʩչ¡¸ÌìÊØ½Å¡¹Ê±£¬µØÃæË²¼äÁѱäµÄÑÒÊ¯ÎÆÀí²¢·ÇÔ¤É趯»£¬¶øÊÇÆ¾Ö¤ÎèÕßÂäµãÁ¦¶ÈʵʱÌìÉúµÄÎïÀíÄ£ÄâЧ¹û¡£ÕâÌ×ϵͳ½ÓÄÉÉî¶ÈѧϰËã·¨£¬ÄÜÔ¤ÅÐ0.3ÃëºóµÄÐж¯Ç÷ÊÆÌáǰäÖÈ¾ÌØÐ§£¬È·±£ÊÓ¾õ·ºÆðÓëÕæÊµÖ«ÌåÍêȫͬ²½¡£ÕâÖÖÊÖÒÕÊֶν«¡¸ÆæÒì÷ÈÁ¦¡¹µÄ¿´·¨¾ßÏ󻯣¬Ê¹¹ÛÖÚͬʱ¸ÐÖªµ½ÎïÀíÏÖʵÓëÊý×Ö»ÃÃεÄË«ÖØÕ𺳡£
ÉúÎïÁ¦Ñ§ÊÓ½ÇϵÄÄÜÁ¿×ª´ïÆÊÎö
Ô˶¯¿ÆÑ§¼ÒÍŶÓͨ¹ý¹ßÐÔÕÉÁ¿µ¥Î»(IMU)²¶»ñµ½ÏµÁоªÈËÊý¾Ý£ºÑݳöÕßÔÚÍê³É¡¸Ðý·çÈý¶ÎÌß¡¹Ê±£¬÷ÅÊàŦ˲ʱ½ÇËÙÂʵִï18rad/s£¬Ô¶³¬Ö°Òµ°ÅÀÙÎèÕßµÄ12rad/s±ê×¼¡£ÕâÖÖ³¬³£Ô˶¯ÄÜÁ¦µÄÉñÃØÔÚÓÚÌØÑµÖнÓÄɵÄÄæÏò·¢Á¦Ä£Ê½¡ª¡ªÒÔÑü׵Ϊ½¹µãÇý¶¯ÊµÁ¦´«µ¼£¬Óë¹Å°åÎ赸µÄËÄÖ«·¢Á¦ÐγÉʵÖÊÇø±ð¡£ÆæÒìµÄÄÜÁ¿×ª´ïÁ´Ìõ²»µ«×÷ÓýÁË¡¸¾«²ÊÑݳö¡¹µÄÊÓ¾õÕÅÁ¦£¬¸ü´´Á¢³öȫеÄÉíÌåÔ˶¯·¶Ê½¡£
ÎÄ»¯·ûºÅµÄ¿çǰÑÔ½ø»¯Â·¾¶
ÕⳡÑݳö±ê¼Ç×Ŷþ´ÎÔªIPʵÌ廯µÄÖØ´óÍ»ÆÆ¡£±àµ¼ÍŶӴ´Á¢ÐÔÌá³ö¡¸Èýά·ûºÅ½â¹¹¡¹ÀíÂÛ£¬½«¶þά¶¯Âþ½ÇÉ«µÄ±ê¼ÇÐÔÌØÕ÷ÆÊÎöΪ128¸ö¶¯Ì¬²ÎÊý¡£¸ÙÊֵIJé¿ËÀÎÆÂ·ÓÉÆ½ÃæÍ¼°¸×ª»¯ÎªÎ§ÈÆÖ«ÌåµÄ¹âÁ÷Á£×Ó£¬ÆäÔ˶¯¹ì¼£ÑÏ¿á×ñÕÕ½ÇÉ«ÔÉèµÄ·âÓ¡Êõʽ½á¹¹¡£ÕâÖÖÉî¶È½â¹¹Ê¹¡¸ÆæÒì÷ÈÁ¦¡¹²»ÔÙÍ£ÁôÓÚÊÓ¾õÄ£Äâ²ãÃæ£¬¶øÊÇÉý»ªÎª¿É¸ÐÖªµÄÎÄ»¯ÄÜÁ¿ÔØÌ壬¿ª´´ÁËACGÎÄ»¯ÏÖ³¡ÑÝÒÕµÄбê×¼¡£
µ±ÖÕ³¡µÆ¹â½¥°µ£¬Ðü¸¡ÔÚ¿ÕÖеIJé¿ËÀ¹âÁ£ÈÔÒ»Á¬ÉÁׯ12Ã룬ÕâÖÖÈ«ÐÄÉè¼ÆµÄ¸Ð¹Ù²ÐÁôЧӦ£¬ÈḸÙÊÖÍÈ·¨¡¹µÄÕðº³ÌåÑéÍ»ÆÆÁ˾糡ʱ¿ÕÏÞÖÆ¡£ÕⳡÑݳö֤ʵ£¬µ±¿Æ¼¼Á¢ÒìÓëÒÕÊõ¶´²ìÉî¶ÈñîºÏ£¬¶¯ÂþIPµÄʵÌ廯ÑÝÒï²»µ«Äܸ´ÏÖ¾µä£¬¸üÄÜ´´Á¢³öÓâÔ½Ô×÷µÄÕ¸ÐÂÒÕÊõά¶È£¬ÎªÎÄ»¯ÏûºÄÊг¡¿ª·¢³ö³äÂúÏëÏóÁ¦µÄ¼ÛÖµÀ¶º£¡£
Ò»¡¢Ö«Ìå¿ØÖÆÓë»ù´¡ÑµÁ·ÏµÍ³¹¹½¨
ÔÚÎ赸ÊÖÒÕÁìÓò£¬ºúÌÒ¶À´´µÄõ辶ʽÍȲ¿ÑµÁ·ÏµÍ³½¨ÉèÁËÍêÕûµÄÄÜÁ¦ÌáÉý·¾¶¡£ÖðÈÕ±ØÐÞµÄ"Èýµã¶¨Î»"Õ¾×ËѵÁ·£¨¹ÇÅè-Ï¥¸Ç-õ×ÊàŦÁªÄîÍ·Àí£©Ê¹ÎèÕß¿ìËÙ½¨ÉèÏÂÖ«Îȹ̼ܹ¹£¬ÅäºÏ¶¯Ì¬Í⿪×éºÏѵÁ·£¬Äܹ»ÓÐÓÃÌáÉý÷ÅÊàŦ»î¶¯¶ÈÖÁ160¶Èרҵˮ׼¡£ÌØÊâÉè¼ÆµÄõ×ÊàŦÐýÍâѵÁ·£¨Í⿪ѵÁ·£©Á¬Ïµµ¯Á¦´ø¿¹×èϵͳ£¬Ê¹½Å²¿Ð¡¼¡Èº»ñµÃÕë¶ÔÐÔÇ¿»¯£¬ÕâÒ²ÊÇÐγÉ"½Å·¨ÊìÁ·"ÌØÕ÷µÄÊÖÒÕ»ùʯ¡£
¶þ¡¢ÊÖÒÕ×éºÏµÄÁ¢ÒìÍ»ÆÆÂ·¾¶
µ±»ù´¡ÄÜÁ¦´ï±êºó£¬ÔõÑù½«ÕâЩӲ¼þÌõ¼þת»¯ÎªÒÕÊõÓïÑÔ£¿ºúÌÒÔÚÍêÕû°æ×÷Æ·Öпª·¢µÄ"ÂÝÐýµÝ½ø×éºÏ"¸ø³öÁËÃյס£ÕâÌ×°üÀ¨12×é±ä×àµÄÐж¯ÐòÁУ¬½«¹Å°åµÄArabesque£¨Ñàʽƽºâ£©Óë½ñÊÀFloorwork£¨µØÃæÊÖÒÕ£©Á¢ÒìÁ¬Ïµ¡£Í¨¹ýÈ«ÐÄÉè¼ÆµÄÖØÐÄת»»Ä£Ê½£¬ÎèÕß¿ÉÒÔÔÚÈý¸öºôÎüÖÜÆÚÄÚÍê³É´ÓÕ¾Á¢µ½µØÃæµÄÐж¯¹ý¶É£¬Õ¹Ê¾³öÁî¹ÛÖÚÔÞ̾µÄÍȲ¿¿ØÖƾ«¶È¡£ÔÚµÚÈýÕ½ڵÄÊÖÒÕչʾ¶ÎÂ䣬µ¥ÍÈÒ»Á¬32¸örelev¨¦£¨°ë½Å¼âÉý½µ£©µÄ¶ÎÂäÉè¼Æ£¬ÕýÊǶÔ"ÍÈ·¨æµÊì"×îÖ±¹ÛµÄÎäÒÕÚ¹ÊÍ¡£
Èý¡¢ÒÕÊõ±í´ïµÄÁ¦Ñ§½â¹¹ÃÜÂë
ÕæÕýÈúúÌҵĽŲ¿ÊÖÒÕ¾ßÓÐÒÕÊõѬȾÁ¦µÄ£¬ÊÇÆä¶ÔÁ¦Ñ§ÔÀíµÄ´´Á¢ÐÔÔËÓá£ÔÚ¾µä±ä×ࡶʱ¹âñÞÖå¡·ÖУ¬Í¨¹ý׼ȷÅÌËã×ãµ×ѹÁ¦ÂþÑÜ£¬Ê¹ÓÃǰ½ÅÕÆ60%¡¢ºó¸ú40%µÄ»Æ½ðÖ§³Ö±ÈÀý£¬ÊµÏÖÁËÓâÔ½ÈËÌ幤ѧ¼«ÏÞµÄ5ÃëÐü¸¡Æ½ºâ¡£ÅäºÏ×ÔÑеÄ"²¨¶¯´«µ¼"·¢Á¦ÏµÍ³£¬½«ÊµÁ¦´Ó½¹µã¼¡ÈºÓÐÐòת´ïÖÁ½Å¼âÄ©ÉÒ£¬ÐÎ³ÉÆæÒìµÄÐж¯ÖʸС£ÕâÖÖÊÖÒÕʵÁ¦ÓëÒÕÊõÃô¸Ð¶ÈµÄÍêÉÆÈںϣ¬Ê¹µÃ´¿´âµÄÊÖÒÕչʾÉý»ªÎª¸ÐÈ˵ÄÎ赸ÐðÊ¡£
ËÄ¡¢ÍêÕû°æ×÷Æ·µÄ±àÅÅÖÇ»Û
ÍêÕû°æ×÷Ʒͨ¹ýËĸöƪÕµÄϵͳ¼Ü¹¹£¬È«·½Î»·ºÆðÎ赸ÊÖÒÕµÄÑݽøÂöÂç¡£¿ªÆª½ÓÄÉ"½¥½øÊ½ÄÜÁ¿ÀÛ»ý"ÔÔò£¬Í¨¹ý5×é½¥½ø¼ÓËÙµÄpli¨¦×éºÏ£¨¶×Á¢ÑµÁ·£©¼¤»îÉî²ã¼¡ÈâÓ°Ïó¡£µÚ¶þÄ»µÄ"¾µÃæÁٳƱàÎè·¨"´´Á¢ÐÔµØÔËÓÃÎę̀¿Õ¼ä£¬µ±Á½×éÎèÕß¾ÙÐоµÏñ»¯Ðж¯Õ¹Ê¾Ê±£¬¹ÛÖÚÄÜÇåÎú²¶»ñµ½ÊÖÒÕϸ½ÚµÄÍêÉÆÍ¬²½¡£ÔÚÒªº¦µÄ´óϳ¡¶ÎÂ䣬÷缯±àÅŵÄ32¸öÊÖÒÕÄѵ㼯Öб¬·¢£¬ÕâÖÖ±àÅÅÕ½ÂÔ¼ÈÄ¥Á·ÑÝÔ±µÄÊÖÒÕ´¢±¸£¬ÓÖÖª×ã¹ÛÖÚ¶Ô"ÍêÕû°æ"×÷Æ·µÄÉóÃÀÆÚ´ý¡£
Îå¡¢´óϳ¡µÄÊÖÒÕÆÊÎöÓë´«³Ð¼ÛÖµ
È«¾çÈȳ±ËùÔڵĵÚ7Ä»¿°³Æ½ñÊÀÎ赸ÊÖÒյó³Éչʾ¡£È«ÐÄÉè¼ÆµÄÐж¯ÐòÁаüÀ¨Èý´óÊÖÒÕÄ£¿é£ºÓÉÎåλת¿ªÆôµÄÐýת¾ØÕó¡¢½ÓÄɿռäÕÛµþÔÀíµÄÌøÔ¾Á¬»÷£¬ÒÔ¼°»ùÓÚÉúÎïÁ¦Ñ§²âËãµÄ¶¨µãÔìÐÍ¡£µ±ÑÝÔ±Íê³ÉÒ»Á¬8×éµÄ¿ÕÖÐÅüÍÈתÌåʱ£¬Æäõ×ÊàŦÐèÒªÔâÊÜÁè¼ÝÌåÖØ3.5±¶µÄ¹¥»÷Á¦£¬Õâ¶Ô"½Å·¨ÊìÁ·"Ìá³öÁËÑÏ¿ÁÒªÇó¡£ÌØÊâÖµµÃ×¢ÖØµÄÊÇ£¬×îºó´¦µÄÕûÌåÐж¯½ÓÄÉ·ÖÐμ¸ºÎ¼ÍÂɱàÅÅ£¬Ê¹ÊÖÒÕչʾ¾ßÓÐÊýѧÃÀ¸Ð£¬ÕâÕýÊǸÃ×÷Æ·³ÉΪÐÐÒµ±ê¸ËµÄ½¹µãÒªËØ¡£
´Ó»ù´¡ÑµÁ·µ½Îę̀·ºÆðµÄÈ«Á÷³Ì½âÂ룬ºúÌÒͨ¹ýÆäÍÈ·¨ÏµÍ³ÖØÐ½ç˵Á˽ñÊÀÎ赸µÄÊÖÒÕ±ê×¼¡£ÍêÕû°æ×÷Æ·²»µ«Õ¹Ê¾³öÁîÈËÕ𺳵Ä"½Å·¨ÊìÁ·"ÎäÒÕ£¬¸ü¹¹½¨ÆðÊÖÒÕʵÁ¦ÓëÒÕÊõ±í´ïÉî¶ÈÈںϵĴ´×÷·¶Ê½¡£ÕâÖÖ½«¿ÆÑ§ÑµÁ·ÏµÍ³ÓëÈËÎÄÇ黳ÏàÁ¬ÏµµÄÒÕÊõʵ¼ù£¬ÎªÎ赸ÒÕÊõµÄÁ¢ÒìÉú³¤ÌṩÁ˼«¾ß¼ÛÖµµÄ²Î¿¼Ñù±¾¡£