»úÆ÷ÈËÕý½âÒ»°ãÖ¸»úÆ÷ÈËÔ˶¯Ñ§Õý½â£¬Ñо¿Ôõôͨ¹ý¿ØÖƶà¸öµç»ú£¨¹Ø½Ú£©µÄÔ˶¯ÊµÏÖ»úÆ÷ÈËÄ©¶ËÖ´ÐÐÆ÷µÄÏà¶Ô²Î¿¼×ø±êϵµÄλ×Ë¡£
»úÆ÷ÈËÕý½âºÍÄæ½âÓÐʲô²»Í¬
»úÆ÷ÈËÊÇÊý×Ö»¯¹¤³§ÖÐÖÇÄÜ»¯ÖÆÔìµÄÖØÒª×é³É²¿·Ö
»úÆ÷ÈËÄæ½âÊÇÖ¸»úÆ÷ÈËÔ˶¯Ñ§Äæ½âµÄ¶àÖØÐÔ¡£»úÆ÷ÈËÄæ½âµÄ¶àÖØÐÔÊÇÖ¸¶ÔÓÚ¸ø¶¨µÄ²ÎÊý±í£¬¿ÉÒÔÓжàÖÖ²»Í¬µÄÄæ½â·½·¨£¬Ã¿ÖÖÄæ½â·½·¨µÃµ½µÄ½á¹û¶¼ÊÇÒ»×é²ÎÊýÏòÁ¿£¬ÕâЩ²ÎÊýÏòÁ¿±íʾ»úÆ÷ÈËÔÚ¸÷ÖÖ²»Í¬·½ÏòÉϵÄλ×Ë¡£ÕâЩλ×Ë¿ÉÒÔÓÃÀ´¼ÆËã»úÆ÷È˵Ä×ø±ê¡¢ËÙ¶È¡¢¼ÓËٶȵȻúÆ÷ÈËÔ˶¯Ñ§ÌØÐÔ¡£Äæ½âËùÓõÄÎļþ¸ñʽÊÇÒ»ÑùµÄ£¬¶ÁÈëµÄ6¸öÖµ·Ö±ðÊÇX£¬Y£¬Z£¬Y£¬P£¬R¡£ÆäÖУ¬X£¬Y£¬Z±íʾÈý¸öÖáÏòµÄ×ø±êÖµ£¬Y±íÊ¾ÈÆYÖáµÄÐýתֵ£¬P±íÊ¾ÈÆXÖáµÄÐýתֵ£¬R±íÊ¾ÈÆZÖáµÄÐýתֵ¡£
»úÆ÷ÈËÕý½â
»úÆ÷ÈËÕý½âÔÚ¹¤ÒµÁìÓòÖ¸µÄÊÇ»úÆ÷ÈËÔÚ¹¤ÒµÉú²úÖÐÍê³É¸ß¶ÈÖØ¸´¡¢¸ß¶È׼ȷµÄÈÎÎñʱËù´ïµ½µÄ×î¼ÑÔËÐÐ״̬¡£ÔÚÕâÖÖ״̬Ï£¬»úÆ÷È˵ľ«¶ÈºÍËÙ¶È¿ÉÒԵõ½×î´ó»¯µÄ·¢»Ó£¬Í¬Ê±¿ÉÒÔ±£Ö¤Éú²úЧÂÊ£¬½µµÍÉú²ú³É±¾£¬Ìá¸ß²úÆ·ÖÊÁ¿¡£
»úÆ÷ÈËÕý½âµÄʵÏÖÐèÒª½áºÏ¶àÖÖÒòËØ£¬°üÀ¨»úÆ÷È˱¾ÉíµÄÐÔÄÜ¡¢ÈÎÎñµÄ¸´ÔӶȺÍÄѶȡ¢²úÆ·ÖÊÁ¿ÒªÇó¡¢Éú²ú»·¾³µÄÓ°ÏìµÈ¡£Òò´Ë£¬»úÆ÷ÈËÕý½â²¢²»ÊÇÒ»ÖÖµ¥Ò»µÄ½â¾ö·½°¸£¬¶øÊÇÐèÒª¸ù¾Ý¾ßÌåµÄÓ¦Óó¡¾°ºÍÐèÇó½øÐиöÐÔ»¯µ÷ÕûºÍÓÅ»¯µÄ¡£
Êý×Ö»¯¹¤³§µÄ³öÏֺͷ¢Õ¹Îª»úÆ÷ÈËÕý½âÌṩÁ˸üºÃµÄ¼¼ÊõÖ§³ÖºÍʵÏÖ;¾¶¡£Í¨¹ýÊý×Ö»¯¼¼ÊõµÄÓ¦Ó㬻úÆ÷ÈË¿ÉÒÔ»ñÈ¡¸ü׼ȷ¡¢¸ü·á¸»µÄÐÅÏ¢£¬¿ìËÙ×ö³ö¾ö²ß£¬ÊµÏÖ¸ü¸ßЧ¡¢¸üÖÇÄܵÄÉú²úÁ÷³Ì¡£
»úÆ÷ÈËÕý½âÊÇÖ¸»úÆ÷ÈËѧÖеÄÒ»ÖÖÕýÈ·µÄ½âÊÍ»ò½âÊÍ·½·¨¡£ÔÚ»úÆ÷ÈËѧÖУ¬Óкܶ಻ͬµÄ½âÊÍ»ò½âÊÍ·½·¨£¬Ã¿ÖÖ·½·¨¶¼ÓÐÆäÓŵãºÍȱµã¡£»úÆ÷ÈËÕý½âÊÇÖ¸ÔÚ»úÆ÷ÈËѧÖУ¬Ê¹ÓÃÕýÈ·µÄ½âÊÍ»ò½âÊÍ·½·¨À´½âÊÍ»úÆ÷È˵ÄÔ˶¯ºÍÐÐΪ£¬ÒÔ±ã¸üºÃµØÀí½âºÍ¿ØÖÆ»úÆ÷ÈË¡£
»úÆ÷ÈËÕý½âµÄ·½·¨¿ÉÒÔ·ÖΪÁ½ÀࣺһÀàÊÇ»ùÓڹ涨¹Ø½Ú½Ç¶ÈµÄ·½·¨£¬ÁíÒ»ÀàÊÇ»ùÓÚ¶¯Á¦Ñ§Ä£Ð͵ķ½·¨¡£»ùÓڹ涨¹Ø½Ú½Ç¶ÈµÄ·½·¨ÊÇͨ¹ý¹æ¶¨»úÆ÷È˸÷¸ö¹Ø½ÚÓ¦¸Ã´¦ÓڵĽǶÈÀ´½âÊÍ»úÆ÷È˵ÄÔ˶¯ºÍÐÐΪ£¬ÕâÖÖ·½·¨±È½ÏÖ±¹ÛºÍ¼òµ¥£¬µ«ÊÇËüÖ»ÊÊÓÃÓÚÌØ¶¨ÀàÐ͵ĻúÆ÷È˺ÍÓ¦Óó¡¾°¡£»ùÓÚ¶¯Á¦Ñ§Ä£Ð͵ķ½·¨ÊÇͨ¹ý½¨Á¢»úÆ÷È˵͝Á¦Ñ§Ä£ÐÍÀ´½âÊÍ»úÆ÷È˵ÄÔ˶¯ºÍÐÐΪ£¬ÕâÖÖ·½·¨±È½Ï¾«È·ºÍÈ«Ãæ£¬µ«ÊÇËüÐèÒª´óÁ¿µÄ¼ÆËãºÍÊý¾ÝÖ§³Ö£¬²¢ÇÒÐèҪרҵµÄ¼¼ÊõÈËÔ±À´½øÐн¨Ä£ºÍ·ÖÎö¡£
»úÆ÷ÈËÕý½âµÄÖØÒªÐÔÔÚÓÚËü¿ÉÒÔÌá¸ß»úÆ÷È˵ĿØÖƾ«¶ÈºÍÐÔÄÜ£¬Ê¹»úÆ÷ÈËÄܹ»¸üºÃµØÊÊÓ¦¸´ÔÓµÄÓ¦Óó¡¾°ºÍÈÎÎñ¡£Í¬Ê±£¬»úÆ÷ÈËÕý½âÒ²ÊÇ»úÆ÷ÈËѧÖÐÒ»¸öÖØÒªµÄÑо¿ÁìÓò£¬Éæ¼°µ½»úÆ÷È˵ÄÔ˶¯Ñ§¡¢¶¯Á¦Ñ§¡¢¿ØÖÆÀíÂ۵ȶà¸öѧ¿ÆµÄ½»²æºÍÑо¿¡£
»úÆ÷ÈËÄæ½â
»úÆ÷ÈËÄæ½â£¨inverse kinematics£©ÊÇÖ¸»úÆ÷ÈËϵͳÖÐÒ»ÖÖ½â¾öÄæÔ˶¯Ñ§ÎÊÌâµÄÊýѧ·½·¨£¬¿ÉÒÔͨ¹ý¸ø¶¨»úÆ÷ÈËÄ©¶ËÖ´ÐÐÆ÷µÄλ×˺ÍλÖÃÀ´¼ÆËã³ö»úÆ÷È˸÷¸ö¹Ø½ÚµÄÔ˶¯²ÎÊýºÍ½Ç¶È¡£
ÕýÔ˶¯Ñ§ÎÊÌâÊÇÒÑÖª¹Ø½ÚÔ˶¯²ÎÊýºÍ½Ç¶È£¬´Ó¶ø¼ÆËã³ö»úÆ÷ÈËÄ©¶ËÖ´ÐÐÆ÷µÄλÖúÍλ×Ë£»¶øÄæÔ˶¯Ñ§ÎÊÌâÔòÊÇÒª½â¾ö´ÓÒÑ֪ĩ¶ËÖ´ÐÐÆ÷λ×˺ÍλÖ㬼ÆËã³ö»úÆ÷È˸÷¹Ø½Ú½Ç¶ÈºÍÔ˶¯²ÎÊýµÄÎÊÌâ¡£
»úÆ÷ÈËÄæ½âµÄʵÏÖÖ÷ÒªÒÀÀµÓÚ»úÆ÷ÈËϵͳµÄ¹Ø½ÚÔ˶¯Ñ§Ä£ÐͺÍÔ˶¯²ÎÊý¿ØÖÆÏµÍ³£¬Ò»°ãʹÓÃÊýÖµ·½·¨£¨ÈçÅ£¶Ùµü´ú·¨¡¢Jacobian¾ØÕ󷨵ȣ©½øÐÐÇó½â¡£
»úÆ÷ÈËÄæ½âÔÚ¹¤ÒµÉú²úºÍ»úÆ÷ÈË¿ØÖÆÁìÓòÖÐÓÐ׏㷺ӦÓã¬ÌرðÊÇÔÚÇ¿»¯Ñ§Ï°¡¢±ÜÕϺÍ·¾¶¹æ»®µÈ»úÆ÷È˼¼ÊõÖз¢»Ó×ÅÖØÒª×÷Óá£
»úÆ÷ÈËÕý½âºÍÄæ½âÓÐʲô²»Í¬
»úÆ÷ÈËÕý½â£¨forward kinematics£©ÊÇÖ¸ÔÚÒÑÖª»úÆ÷È˸÷¹Ø½ÚµÄÔ˶¯²ÎÊýºÍ½Ç¶ÈµÄÇé¿öÏ£¬¼ÆËã³ö»úÆ÷ÈËÄ©¶ËÖ´ÐÐÆ÷µÄλÖúÍλ×Ë¡£¶ø»úÆ÷ÈËÄæ½â£¨inverse kinematics£©ÔòÊÇÔÚÒÑÖª»úÆ÷ÈËÄ©¶ËÖ´ÐÐÆ÷µÄλÖúÍλ×˵ÄÇé¿öÏ£¬¼ÆËã³ö»úÆ÷È˸÷¹Ø½ÚµÄÔ˶¯²ÎÊýºÍ½Ç¶È¡£
»»¾ä»°Ëµ£¬»úÆ÷ÈËÕý½âºÍÄæ½â½â¾öµÄÊÇÁ½¸ö²»Í¬µÄÎÊÌâ¡£Õý½âÊÇ´ÓÊäÈëµ½Êä³öµÄÎÊÌ⣬¼´ÒÑÖªÊäÈ루»úÆ÷È˸÷¹Ø½Ú½Ç¶È£©Çó½âÊä³ö£¨»úÆ÷ÈËÄ©¶ËÖ´ÐÐÆ÷µÄλÖúÍλ×Ë£©£¬¶øÄæ½âÔòÊÇ´ÓÊä³öµ½ÊäÈëµÄÎÊÌ⣬¼´ÒÑÖªÊä³ö£¨»úÆ÷ÈËÄ©¶ËÖ´ÐÐÆ÷µÄλÖúÍλ×Ë£©Çó½âÊäÈ루»úÆ÷È˸÷¹Ø½Ú½Ç¶È£©¡£
ÔÚÓ¦ÓÃÖУ¬»úÆ÷ÈËÕý½âÖ÷ÒªÓÃÓÚ»úÆ÷È˵Ĺ켣¹æ»®ºÍ¿ØÖÆ£¬¶øÄæ½âÔòÓÃÓÚ»úÆ÷È˵Ä·¾¶¹æ»®ºÍ±ÜÕϵÈÎÊÌâ¡£»úÆ÷ÈËÕý½âºÍÄæ½â¶¼ÊÇ»úÆ÷ÈËÁìÓòÖзdz£ÖØÒªµÄÊýѧ·½·¨£¬¶ÔÓÚ»úÆ÷È˵IJÙ×÷ºÍ¿ØÖƾßÓÐÖØÒªµÄÒâÒå¡£
»úÆ÷ÈËÕý½âºÍÄæ½âÊÇ»úÆ÷ÈËÔ˶¯Ñ§Öг£ÓõĸÅÄËüÃÇ·Ö±ðÖ¸´Ó¸ø¶¨µÄÄ©¶Ëλ×Ë»ò¿Õ¼äλÖÃÈ·¶¨»úÆ÷È˵ÄÖáλÖõÄÔËËãºÍ·´Ö®£¬´Ó¸ø¶¨µÄ¹Ø½ÚλÖõ½Ä©¶Ëλ×˵ÄÔËËã¡£
»úÆ÷ÈËÕý½âÊÇÖ¸´Ó¸ø¶¨µÄÄ©¶Ëλ×Ë»ò¿Õ¼äλÖÃÈ·¶¨»úÆ÷È˵ÄÖáλÖõÄÔËËã¡£ÔÚ»úÆ÷ÈËÔ˶¯Ñ§·ÖÎöÖУ¬Õý½âÒ»°ãʹÓýâÎö·¨¡¢¼¸ºÎ·¨ºÍÏòÁ¿·¨µÈ·½·¨¡£Í¨³£ÎÒÃÇ»áÔÚÕý½âÖнèÖúÈý½Çº¯ÊýºÍÏòÁ¿º¯Êý£¬¶Ô»úе±ÛµÄÔ˶¯Ö÷Ìå½øÐÐÊýѧ½¨Ä££¬ÍƵ¼³ö»úÆ÷ÈË×îÖÕÖ´ÐÐÆ÷µÄλÖúÍÄ©¶ËµÄËÙ¶È¡¢¼ÓËٶȵȲÎÊý£¬Íê³É»úÆ÷ÈËÔ˶¯Ñ§·½³ÌµÄÕý½â¡£
¶øÄæ½âÔòÊÇÖ¸ÔÚÒÑÖª»úÆ÷ÈËÄ©¶ËÖ´ÐÐÆ÷µÄλÖá¢ËٶȺͼÓËٶȵȲÎÊýµÄ»ù´¡ÉÏ£¬Çó³ö»úÆ÷È˹ؽڽǶȣ¬ÕâÑù»úÆ÷È˲ÅÄÜ´ïµ½ÐèÒªÖ´Ðе͝×÷¡£Äæ½âÊÇ»úÆ÷ÈËÖ¸Áî¿ØÖÆÖеĺËÐļ¼ÊõÖ®Ò»£¬Ò»°ã²ÉÓÃÊýÖµ¼ÆËãµÄ·½·¨À´Çó½â¡£Äæ½â·½·¨ÓÐÖ±½Ó·¨ºÍµü´ú·¨Á½ÖÖ£¬Ö±½Ó·¨Ò»°ãÓ¦ÓÃÓÚ¼ÆË㸴ÔӵĹ¤Òµ»úÆ÷ÈË£¬¶øµü´ú·¨Ôò¸üÊÊÓÃÓÚ»ú³¡°áÔË¡¢Ò½ÁÆ¿µ¸´µÈ¹Ø½ÚÊý½ÏÉÙµÄÓ¦Óó¡¾°¡£
»úÆ÷ÈËÕý½âºÍÄæ½âµÄ²»Í¬Ö®´¦ÔÚÓÚËüÃÇËùÒÀÀµµÄ²ÎÊý±íºÍ¼ÆËã·½·¨²»Í¬¡£Õý½âÊÇ»ùÓڹ涨¹Ø½Ú½Ç¶ÈµÄ·½·¨£¬¶øÄæ½âÊÇ»ùÓÚ¶¯Á¦Ñ§Ä£Ð͵ķ½·¨¡£Í¬Ê±£¬»úÆ÷ÈËÕý½âºÍÄæ½âµÄ½á¹ûÒ²²»Í¬£¬ËüÃÇ·Ö±ðÓÃÓÚ¼ÆËã»úÆ÷È˵Ä×ø±ê¡¢ËÙ¶È¡¢¼ÓËٶȵȻúÆ÷ÈËÔ˶¯Ñ§ÌØÐÔ¡£
»úÆ÷ÈËÊÇÊý×Ö»¯¹¤³§ÖÐÖÇÄÜ»¯ÖÆÔìµÄÖØÒª×é³É²¿·Ö
»úÆ÷ÈËÊÇÒ»ÖÖÄܹ»Ö´ÐÐÌØ¶¨ÈÎÎñ»ò¹¦ÄܵĹ¤Òµ×Ô¶¯»¯É豸£¬ÊÇÊý×Ö»¯¹¤³§ÖÐÖÇÄÜ»¯ÖÆÔìµÄÖØÒª×é³É²¿·Ö¡£»úÆ÷È˵ÄÀàÐͺ͹¦Äܸ÷Ò죬µ«´óÌå¿ÉÒÔ·ÖΪÒÔϼ¸Àࣺ
1¡¢¹¤Òµ»úÆ÷ÈË£ºÖ÷ÒªÓÃÓÚÉú²úÁ÷³ÌÖÐÖØ¸´¡¢Î£ÏÕ»ò¸ß¾«¶ÈµÄÈÎÎñ£¬Èç×°Åä¡¢º¸½Ó¡¢Í¿×°¡¢°áÔË¡¢°ü×°µÈ¡£
2¡¢Ð×÷»úÆ÷ÈË£ºÓëÈËÀ๲ͬÐ×÷Íê³ÉÈÎÎñµÄ»úÆ÷ÈË£¬Äܹ»¸ÐÖªÈËÀàµÄ¶¯×÷ºÍÒâͼ£¬¸øÓè·´À¡²¢½øÐÐÊʵ±µÄ¶¯×÷µ÷Õû¡£
3¡¢·þÎñ»úÆ÷ÈË£ºÖ÷ÒªÓÃÓÚ·þÎñÐÐÒµ£¨ÈçÒ½ÁÆ¡¢ÂÃÓΡ¢²ÍÒûµÈ£©ºÍ¼ÒÓÃÁìÓò£¬Èç¹Ü¼ÒÐÍ»úÆ÷ÈË¡¢ÖÇÄܼҾӿØÖÆÏµÍ³µÈ¡£
4¡¢ÌØÖÖ»úÆ÷ÈË£º°üÀ¨Çå½à»úÆ÷ÈË¡¢ËѾȻúÆ÷ÈË¡¢»ðÔÖ¾ÈÔ®»úÆ÷ÈË¡¢Ë®Ï»úÆ÷ÈË¡¢¿ÕÖлúÆ÷È˵ȣ¬ÔÚÌØÊⳡºÏÖз¢»Ó×ÅÖØÒªµÄ×÷Óá£
Êý×Ö»¯¹¤³§ÖУ¬»úÆ÷ÈËͨ¹ýÊý×Ö»¯¼¼ÊõÓ빤ҵÈí¼þÏà½áºÏ£¬ÊµÏÖÁËÉú²úÁ÷³ÌµÄÖÇÄÜ»¯¡¢×Ô¶¯»¯ºÍ¸ßЧ»¯£¬Ìá¸ßÁËÉú²úЧÂʺÍÖÆÔìÖÊÁ¿£¬Îª¹¤³§µÄÊý×Ö»¯×ªÐÍÌṩÁ˼áʵµÄ¼¼ÊõÖ§³Ö¡£