ÈÌÕßÌåÊõµÄÎę̀»¯Öع¹ÒÕÊõ
ÔÐͽÇÉ«¸ÙÊÖµÄÕ½¶·ÃÀѧ£¬ÊµÖÊÊÇÈںϸÕÈáµÄÌåÊõÕÜѧ¡£Ñݳö±àµ¼ÍŶÓÀúʱ18¸öÔ¾ÙÐÐÐж¯²ð½â£¬½«Ô±¾ÓÃÓÚʵսµÄ¡¸Í´Ìì½Å¡¹¡¸Ë²ÉíÊõ¡¹µÈÕÐʽ£¬×ª»¯Îª¿ÉÒ»Á¬Õ¹Ê¾µÄÎ赸Óï»ã¡£¸ß̧ÍÈÐж¯Ë¢Ð³É270¶È»·ÐÎÌß»÷õè¾¶£¬¼È±£´æÔÓÐÕÐʽµÄ±¬·¢Á¦£¬ÓÖÐÎ³ÉÆæÒìµÄ¿ÕÖй켣ÃÀѧ¡£ÕâÖÖÖØ¹¹ÎªºÎÄÜ»ñµÃ¹ÛÖÚÈϿɣ¿Òªº¦ÔÚÓÚ±àÎèÍŶӾ«×¼ÕÆÎÕÁË¡¸ÈÌÌåÊõ¡¹Ó롸Î赸ÔÏÂÉ¡¹µÄƽºâµã£¬ÔÚÿ¸öÐж¯ÏνӴ¦¼ÓÈë0.8ÃëµÄºôÎü»º³å£¬Ê¹¸ÕÃÍÕÐʽ·ºÆð³öÁ÷ͨÃÀ¸Ð¡£
·ÂÉúÆøÐµ×°ÖõĶ¯Ì¬Ôöǿϵͳ
Ϊǿ»¯¡¸¸ÙÊÖÍÈ·¨¡¹µÄÊÓ¾õ¹¥»÷£¬ÊÖÒÕÍŶÓÑз¢ÁËÒÂ×Åʽ¶¯Á¦¸¨Öú×°Öá£ÕâÌ×ϵͳÄÜʵʱ¸ÐÖªÑݳöÕߵļ¡ÈºÔ˶¯£¬ÔÚ̧ÍÈ˲¼ä¸øÓè12Å£¶ÙµÄÌØÊâÍÆÁ¦£¬Ê¹Í¨Àý70¶ÈµÄÌßÍÈÐж¯Í»ÆÆµ½120¶È¼«Ï޽Ƕȡ£ÅäºÏÌØÖÆÕñ½ðÏËάÎèЬ£¬×ã¼â´¥µØÊ±»áÒý·¢»·ÐÎÆøÀËÌØÐ§£¬ÍêÉÆ¸´¿Ì¶¯ÂþÖвé¿ËÀ±¬·¢µÄÕðº³Ð§¹û¡£ÖµµÃ×¢ÖØµÄÊÇ£¬×°ÖÃÍêÈ«½ÓÄÉÎÞÏß¹©µçÊÖÒÕ£¬×èÖ¹Á˹ŰåÍþÑǶÔÐж¯×ÔÓɶȵÄÏÞÖÆ£¬Èḽŷ¨¾«Õ¿¡¹µÄÕ¹ÏÖ¸üÏÔ×ÔÈ»¡£
ÈýάȫϢͶӰµÄÐðʲ㹹½¨
ÑݳöÒýÈëʵʱäÖȾµÄÁ¢ÌåͶӰϵͳ£¬ÔÚÎę̀¿Õ¼ä¹¹½¨Æð¶à²ãÐðʽṹ¡£µ±ÑݳöÕßʩչ¡¸ÌìÊØ½Å¡¹Ê±£¬µØÃæË²¼äÁѱäµÄÑÒÊ¯ÎÆÀí²¢·ÇÔ¤É趯»£¬¶øÊÇÆ¾Ö¤ÎèÕßÂäµãÁ¦¶ÈʵʱÌìÉúµÄÎïÀíÄ£ÄâЧ¹û¡£ÕâÌ×ϵͳ½ÓÄÉÉî¶ÈѧϰËã·¨£¬ÄÜÔ¤ÅÐ0.3ÃëºóµÄÐж¯Ç÷ÊÆÌáǰäÖÈ¾ÌØÐ§£¬È·±£ÊÓ¾õ·ºÆðÓëÕæÊµÖ«ÌåÍêȫͬ²½¡£ÕâÖÖÊÖÒÕÊֶν«¡¸ÆæÒì÷ÈÁ¦¡¹µÄ¿´·¨¾ßÏ󻯣¬Ê¹¹ÛÖÚͬʱ¸ÐÖªµ½ÎïÀíÏÖʵÓëÊý×Ö»ÃÃεÄË«ÖØÕ𺳡£
ÉúÎïÁ¦Ñ§ÊÓ½ÇϵÄÄÜÁ¿×ª´ïÆÊÎö
Ô˶¯¿ÆÑ§¼ÒÍŶÓͨ¹ý¹ßÐÔÕÉÁ¿µ¥Î»(IMU)²¶»ñµ½ÏµÁоªÈËÊý¾Ý£ºÑݳöÕßÔÚÍê³É¡¸Ðý·çÈý¶ÎÌß¡¹Ê±£¬÷ÅÊàŦ˲ʱ½ÇËÙÂʵִï18rad/s£¬Ô¶³¬Ö°Òµ°ÅÀÙÎèÕßµÄ12rad/s±ê×¼¡£ÕâÖÖ³¬³£Ô˶¯ÄÜÁ¦µÄÉñÃØÔÚÓÚÌØÑµÖнÓÄɵÄÄæÏò·¢Á¦Ä£Ê½¡ª¡ªÒÔÑü׵Ϊ½¹µãÇý¶¯ÊµÁ¦´«µ¼£¬Óë¹Å°åÎ赸µÄËÄÖ«·¢Á¦ÐγÉʵÖÊÇø±ð¡£ÆæÒìµÄÄÜÁ¿×ª´ïÁ´Ìõ²»µ«×÷ÓýÁË¡¸¾«²ÊÑݳö¡¹µÄÊÓ¾õÕÅÁ¦£¬¸ü´´Á¢³öȫеÄÉíÌåÔ˶¯·¶Ê½¡£
ÎÄ»¯·ûºÅµÄ¿çǰÑÔ½ø»¯Â·¾¶
ÕⳡÑݳö±ê¼Ç×Ŷþ´ÎÔªIPʵÌ廯µÄÖØ´óÍ»ÆÆ¡£±àµ¼ÍŶӴ´Á¢ÐÔÌá³ö¡¸Èýά·ûºÅ½â¹¹¡¹ÀíÂÛ£¬½«¶þά¶¯Âþ½ÇÉ«µÄ±ê¼ÇÐÔÌØÕ÷ÆÊÎöΪ128¸ö¶¯Ì¬²ÎÊý¡£¸ÙÊֵIJé¿ËÀÎÆÂ·ÓÉÆ½ÃæÍ¼°¸×ª»¯ÎªÎ§ÈÆÖ«ÌåµÄ¹âÁ÷Á£×Ó£¬ÆäÔ˶¯¹ì¼£ÑÏ¿á×ñÕÕ½ÇÉ«ÔÉèµÄ·âÓ¡Êõʽ½á¹¹¡£ÕâÖÖÉî¶È½â¹¹Ê¹¡¸ÆæÒì÷ÈÁ¦¡¹²»ÔÙÍ£ÁôÓÚÊÓ¾õÄ£Äâ²ãÃæ£¬¶øÊÇÉý»ªÎª¿É¸ÐÖªµÄÎÄ»¯ÄÜÁ¿ÔØÌ壬¿ª´´ÁËACGÎÄ»¯ÏÖ³¡ÑÝÒÕµÄбê×¼¡£
µ±ÖÕ³¡µÆ¹â½¥°µ£¬Ðü¸¡ÔÚ¿ÕÖеIJé¿ËÀ¹âÁ£ÈÔÒ»Á¬ÉÁׯ12Ã룬ÕâÖÖÈ«ÐÄÉè¼ÆµÄ¸Ð¹Ù²ÐÁôЧӦ£¬ÈḸÙÊÖÍÈ·¨¡¹µÄÕðº³ÌåÑéÍ»ÆÆÁ˾糡ʱ¿ÕÏÞÖÆ¡£ÕⳡÑݳö֤ʵ£¬µ±¿Æ¼¼Á¢ÒìÓëÒÕÊõ¶´²ìÉî¶ÈñîºÏ£¬¶¯ÂþIPµÄʵÌ廯ÑÝÒï²»µ«Äܸ´ÏÖ¾µä£¬¸üÄÜ´´Á¢³öÓâÔ½Ô×÷µÄÕ¸ÐÂÒÕÊõά¶È£¬ÎªÎÄ»¯ÏûºÄÊг¡¿ª·¢³ö³äÂúÏëÏóÁ¦µÄ¼ÛÖµÀ¶º£¡£ »î¶¯£º¡¾QQµ¯µ¯´óÅ·ÅÉÎ赸¶¯ÂþÊÓÆµ¿ìÀ´Ò»Æð¸ÐÊÜÕⳡÊÓ¾õÓëÌý¾õµÄ¡¿ ÔÚÐéÄâżÏñÎÄ»¯ÅÉú³¤È·µ±Ï£¬ÄþÈÙÈÙµÄÎ赸ӰÏñÒÀ¸½ÆäÆæÒìµÄÒÕÊõѬȾÁ¦Ò»Á¬Òý·¢ÈÈÒé¡£Õâ¶Î¹ãΪÈö²¥µÄÎ赸ÊÓÆµÖУ¬Ëýͨ¹ýÐÄÇéÓëÖ«ÌåµÄĬÆõÅäºÏ£¬Ïò¹ÛÖÚÍêÉÆÚ¹ÊÍÁËÓÅÑÅÓë×ÔÐŵĽç˵¡£±¾ÎĽ«ÉîÈëÆÊÎöÕⳡÊÓ¾õÊ¢Ñç±³ºóµÄ½¹µãÒªËØ£¬´Ó΢ÐÄÇéÖÎÀíµ½Ö«ÌåÓïÑÔ±í´ï£¬½âÂëÆäÒÕÊõ·ºÆðµÄÉî²ãÂß¼¡£ÐÄÇéÖÎÀíµÄÒÕÊõÔìÒè
ÔÚ³¤´ïÈý·Ö¶þÊ®ÆßÃëµÄÎ赸ÑݳöÖУ¬ÄþÈÙÈÙÃæ²¿µÄ΢ÐÄÇé£¨Ãæ²¿Ï¸Î¢ÐÄÇéת±ä£©·ºÆð³ö½Ì¿ÆÊé¼¶±ðµÄ°Ñ¿ØÁ¦¡£ÑÛ½Ç×ÔÈ»ÉÏÑïÐγɵÄÔÂÑÀ»¡¶È£¬ÅäºÏË«´½Î¢ÆôµÄºôÎüÔÏÂÉ£¬½«ÓäÔÃÏíÊܵÄÇéÐ÷ÍêÉÆ¿ÉÊÓ»¯¡£ÕâÖÖ¿´ËÆËæÐÔµÄÐÄÇéϵͳ£¬ÊµÖʾÓÉÁ˾«×¼µÄ¼¡Èâ¿ØÖÆÑµÁ·£¬¼È±£´æÁËÒÕÊõÌåÏÖµÄ×ÔÈ»¸Ð£¬ÓÖÓÐÓùæ±ÜÁË¿äÕÅŤÇúµÄΣº¦¡£µ±Î赸Ðж¯Çл»ÖÁ¸ßËÙÐýתʱ£¬ÆäÃæ²¿¼¡ÈâÈÔÄܼá³ÖÊæÕ¹×´Ì¬£¬³ä·ÖÓ¡Ö¤ÁËרҵÎèÕßµÄÐÄÇé¿ØÖÆ¹¦Á¦¡£
Ö«ÌåÓïÑÔµÄÐðÊÂÂß¼
ÄþÈÙÈÙÎè×˵ÄÓÅÑÅÌØÖÊÔ´ÓÚÆä¶Ô¹Å°åÎèÖÖÓëÏÖ´ú±àÎèµÄÈÚºÏÁ¢Òì¡£´Ó¹Åµä°ÅÀٵıÁ½ÅÑÓÉìµ½½ÖÎèµÄÂɶ¯Çз֣¬Ã¿¸öÊàŦµÄת¶¯¶¼°µº¬Á¦Ñ§ÔÀí¡£ÌØÊâÖµµÃ¹Ø×¢µÄÊÇÊÖ²¿Ðж¯Éè¼Æ£ºÎåÖ¸ÊæÕ¹Ê±ÈçÁ«»¨ÕÀ·Å£¬ÊÕÊÊʱÓÖËÆÇáÎÕÐdz½£¬ÕâÖÖÐÂÎŽ»ÌæµÄ´¦Öóͷ£ÊÖ·¨²»µ«ÔöÇ¿ÊÓ¾õÌõÀí¸Ð£¬¸üÐγÉÁËÆæÒìµÄÉíÌåÐðÊÂÓïÑÔ¡£ÎèÕßͨ¹ý÷Ų¿°Ú¶¯·ù¶ÈÓëÑü²¿Å¤×ª½Ç¶ÈµÄ׼ȷ¿ØÖÆ£¬½«ÊµÁ¦ÃÀѧÓëÈáÐÔÃÀ¸ÐµÄƽºâÄÃÄóµÃÇ¡µ½ÀûÒæ¡£
ÒÂÊεÀ¾ßµÄ¸³ÄÜ×÷ÓÃ
Æ®¶¯µÄË¿ÖÊȹñÕÔÚÎ赸Öоø·Ç¼òÆÓµÄ×°ÊÎÔªËØ£¬ÆäÆ®¶¯¹ì¼£ÓëÖ«ÌåÐж¯ÐγÉϸÃܵĿռä¶Ô»°¹ØÏµ¡£µ±Ë®Ðä»®³öÅ×ÎïÏßʱ£¬ÎèÕß»áÅäºÏÔöÇ¿¼ç²¿ÐýתÁ¦¶È£»¶øÔÚȹ°Ú×ÔÈ»´¹Âä˲¼ä£¬ÓÖ¿ÌÒâ·Å»º½Å²½ÐγÉÊÓ¾õÁô°×¡£ÕâÖÖÒÂÊζ¯Ì¬ÓëÎ赸½Ú×àµÄĬÆõºôÓ¦£¬³ä·ÖÕ¹ÏÖÁËÄþÈÙÈÙ¶Ô×ÛºÏÎę̀Ч¹ûµÄÕÆ¿ØÁ¦¡£Ñü¼äÒøÉ«ÑüÁ´µÄÉùÏì¿ØÖÆ¸ü¿°³Æ¾«ÃʼÖÕά³Ö×ÅÈôÒþÈôÏÖµÄÏìÁÁ½Ú×࣬¼È×èÖ¹ÁËÐú±ö¶áÖ÷£¬ÓÖÍêÉÆÔö²¹ÁËÒôÀÖÌõÀí¡£
¹âÓ°ÐðʵĽø½×±í´ï
Îę̀µÆ¹âÉè¼ÆÔÚ±¾´ÎÑݳöÖÐÊÎÑÝ×ÅÒþÐε¼ÑݵĽÇÉ«¡£Äæ¹âʱ¿Ì¹´ÀÕ³öµÄÉíÌåÂÖÀª£¬ÇÉÃîÈõ»¯ÁËÊÖÒÕÐж¯µÄ»úе¸Ð£»²à¹âÇÐÈëÊ±ÖØµãÇ¿»¯¾±²¿ÓëÊÖ±ÛÏßÌõ£¬½«Ô±¾¶þάµÄÎ赸»Ãæ×ª»¯ÎªÁ¢ÌåÒÕÊõ×°Öá£ÖµµÃ×¢ÖØµÄϸ½ÚÊÇ£¬ÄþÈÙÈÙÔÚÇ¿¹âÕÕÉäϵÄÍ«¿×µ÷ÀíÒì³£Îȹ̣¬ÕâÖÖÔÚ¼«Ö¹âÇéÐÎϵÄÐÄÀí¿ØÖÆÄÜÁ¦£¬ÕýÊÇÖ°ÒµÎèÕßÓëÒµÓàϲ»¶ÕßµÄÖ÷Òª·ÖÒ°¡£
ÇéÐ÷¹²Ê¶µÄת´ï»úÖÆ
ÕæÕýÈÃÕâ¶ÎÎ赸±¬·¢ÆÕ±éÈö²¥Ð§Á¦µÄ½¹µã£¬ÔÚÓÚÒÕÊõÐÎÏóÓë¹ÛÖÚÐÄÀíµÄ¸ß¶ÈÆõºÏ¡£µ±ÎèÕßÑïÆðÏÂò¢Õ¹ÏÖ×ÔÐÅ×Ë̬ʱ£¬60%µÄ¹ÛÖڻᱬ·¢¾µÏñÉñ¾Ôª£¨ÈËÄÔÄ£ÄâËûÈËÐÐΪµÄÌØÊâϸ°û£©¼¤»î·´Ó¦¡£ÑݳöÈȳ±²¿·ÖÉè¼ÆµÄÈý´ÎÒ»Á¬ÐÔÌøÔ¾Ðж¯£¬Í¨¹ýÖð²½Ç¿»¯µÄÖØÁ¦¶Ô¿¹¸Ð£¬ÀÖ³ÉËÜÔì³öÍ»ÆÆÔ¼ÊøµÄÊÓ¾õÒâÏó¡£ÕâÖÖ½«ÎïÀí¶¯ÄÜת»¯ÎªÇéÐ÷¶¯ÄܵÄÌåÏÖÊÖ·¨£¬ÕýÊǽñÊÀÎ赸ÒÕÊõµÄË¢ÐÂÆ«Ïò¡£
ͨ¹ý¶àά¶ÈÊÖÒս⹹¿ÉÒÔ·¢Ã÷£¬ÄþÈÙÈÙÕâ¶ÎÎ赸ÊÓÆµµÄÈö²¥ÊÂÒµ¾ø·ÇÎÞÒâ¡£´Ó0.3ÃëµÄÐÄÇéת»»¾«¶Èµ½´ò°çÆ®¶¯µÄÁ÷ÌåÁ¦Ñ§ÅÌË㣬ÿ¸öϸ½Ú¶¼Äý¾Û×ÅרҵÍŶӵÄÒÕÊõÖǻۡ£Õâ¶ÎÓ°Ïñ²»µ«Îª¹ÛÖÚ·ºÆðÁËÊÓÌýÏíÊÜ£¬¸ü´î½¨ÆðÎ赸ÒÕÊõÓ빫¹²ÉóÃÀµÄÏàͬÇÅÁº¡£ÆÚ´ýÕâÖÖ½«ÊÖÒÕÀíÐÔÓë¸ÐÐÔ±í´ïÍêÉÆÈںϵÄÑݳöÐÎʽ£¬ÄÜÒýÁì¸ü¶àÒÕÊõÊÂÇéÕß̽Ë÷Á¢Òì±í´ïµÄ¿ÉÄÜ¡£