ÄÚÈÝ·¢²¼¸üÐÂʱ¼ä : 2026/9/29 22:22:38ÐÇÆÚÒ» ÏÂÃæÊÇÎÄÕµÄÈ«²¿ÄÚÈÝÇëÈÏÕæÔĶÁ¡£
¶«±±´óÑ§ÇØ»Êµº·ÖУ±ÏÒµÉè¼Æ£¨ÂÛÎÄ£© µÚ12Ò³
ͼ2.6µÚÎåÖÖÖ±µÀÇé¿ö
ÔÚÓÒת´óÍäºó£¬³öÍäʱ×î¿ÉÄܳöÏÖµÄǰºóÅÅ´«¸ÐÆ÷¼ì²âµ½ºÚÏßʱµÄ×éºÏÇé¿ö¡£ÊÊÓÃÓÚÓÒתת 90¡ãÍä¡¢180¡ãÍä¡£ÌáǰµÃµ½³öÍäÐÅÏ¢£¬¶æ»úÏòÓÒת¶¯½ÏС½Ç¶È£¬²¢ÔÚ´Ëʱ²ÉÈ¡¼ÓËÙ¶¯×÷£¬Æðµ½ÃÖ²¹Ç°Õ°²»×ãµÄ×÷Óá£ÔÚÈüµÀµÄsÍä³öÏÖʱ£¬²»Âú×ãÖ±µÀµÄµÚ¶þÖÖʶ±ð·½Ê½£¬¹Ê²»»á¼ÓËÙ¡£
(2)Ö±µÀʶ±ð£¬³ÌÐò¸¨ÖúÈ·ÈÏ
½øÈëÍäµÀºó£¬Ëæ×ÅС³µµÄÐнø£¬»á·¢ÉúÕñµ´£¬ÖÂʹ³öÍäʱ²»Ò»¶¨Âú×ãÉÏÊö5ÖÖÇé¿ö¡£ÎªÁËÌá¸ßÖ±µÀµÄʶ±ð³É¹¦ÂÊ£¬Ôö¼ÓµÚ¶þÖÖÖ±µÀÅб𷽷¨¡£Á½ÕßͬʱÆð×÷Óã¬Âú×ãµÚÒ»ÖÖºó¾¹ý×î¶à15msÈ·ÈÏÊÇÖ±µÀ¡£
³ÌÐòÊÇÑ»·Ö´ÐУ¬ÎÒÃǵijÌÐòÖ´ÐÐÆµÂÊÊÇ2KHz¡£²ÉÓö¨Ê±ÖжÏ(15ms)µÄ·½Ê½£¬¶ÔǰÅÅÖмä3¸ö´«¸ÐÆ÷(±àºÅΪ3¡¢4¡¢5)ʹÓÃ3¸ö¼ÆÊýÆ÷·Ö±ð¼ÆÊý£¬Ã¿´ÎÖ´ÐгÌÐòÈôÊÇÆäÖÐÒ»¸ö¼ì²âµ½ºÚÏߣ¬Ïà¶ÔÓ¦µÄ¼ÆÊýÆ÷¼Ó1¡£¾¹ý¼ÆË㣬15msÄÚËùÄܼÆÊýµÄ×î´óֵΪ31¡£ÎÒÃÇÉ趨¼ÆÊýµÄ×î´óÖµ£¬ÈôÔÚ15msÄÚ´ïµ½ËùÒªÇóµÄ¼ÆÊýÖµ£¬¾ÍÈÏΪÊÇÖ±µÀ£¬Çл»Ö±µÀ³ÌÐò²¢½«¼ÆÊýÆ÷ÇåÁ㣻Èô15msÄÚûÓдﵽËùÒªÇóµÄ¼ÆÊýÖµ£¬¼ÆÊýÆ÷ÇåÁã£¬ÖØÐ¼ÆÊý¡£ÀýÈçС³µÎª2m/sµÄËÙ¶È£¬Ð¡³µÐнø3cm¡£ÎÒÃÇÖ»ÒªÅжÏ2~2.5cmÄÚΪֱµÀ¼´¿É¡£ËùÒÔÉè×î´ó¼ÆÊýֵΪ20~25¼´ÈÏΪÊÇÖ±µÀ£¬Ìø³öÍäµÀ³ÌÐò¡£
µ±È»Ò²¿ÉÒÔ²ÉÓøüÑϸñµÄ·½·¨À´Åжϣ¬Ö»Ðèµ÷Õû¶¨Ê±ÖжϵÄʱ¼äºÍ¼ÆÊýÖµ¼´¿É¡£´ËÌõ¼þÔÚ½øÈëÖ±µÀºó×ÜÄÜÂú×㣬ËùÒÔ×÷ΪµÚÒ»ÖÖÖ±µÀÅбð·½Ê½µÄ²¹³ä£¬±£Ö¤Ö±µÀµÄÎȶ¨¿É¿¿Ê¶±ð[7]¡£
¶«±±´óÑ§ÇØ»Êµº·ÖУ±ÏÒµÉè¼Æ£¨ÂÛÎÄ£© µÚ13Ò³
2.2.4 Ö±ÏßÎȶ¨¿ØÖƲßÂÔ
С³µ³öÍäºó£¬ÓÉÓÚ¶æ»úµÄ·´Ó¦²»ÁéÃô£¬ÖÇÄܳµ»á·¢ÉúÕñµ´£¬Ëæºó²ÅÄÜ´ïµ½Îȶ¨£¬ÎªÁ˾¡Ôç¼õСÕñµ´£¬²ÉÓÃÈçÏ·½Ê½¿ØÖÆÐ¡³µ³öÍäºóµÄ¶¯×÷£º
ÔÚÍäµÀ²ßÂÔÖÐÉèÖñê־룬½øÈëÖ±Ïß³ÌÐòºó£¬Ê¶±ð±ê־룬¶Ô¿ØÖƶæ»úתÏòµÄ¹«Ê½²ÉÈ¡ÐÞÕýÉèÖ᣹«Ê½Îª£ºq=K1q1+K2q2£»ÆäÖÐqΪ×îÖÕË͸ø¶æ»úµÄ¿ØÖÆÁ¿£¬q1ΪǰÅŹâµç´«¸ÐÆ÷µÄ·µ»Ø×ª½ÇÖµ£¬q2ΪºóÅźìÍâ·µ»Ø×ª½ÇÖµ¡£K1¡¢K2·Ö±ðΪǰºóÅÅ´«¸ÐÆ÷µÄ¼ÓȨ±ÈÀýÖµ¡£Í¨³£Çé¿öÏÂK1¡¢K2Ϊ¶¨Öµ1£¬ÐèҪʱÔò¸Ä±ä¸³Öµ¡£
µ±Ð¡³µ´ÓÍäµÀ½øÈëÖ±µÀ²¢³É¹¦Ê¶±ð³öÖ±µÀºó£¬¼õСK1µÄÖµ£¬ÓÉÓÚºóÅÅ´«¸ÐÆ÷¾àÀëС³µµÄǰÂÖ(תÏòÂÖ)ºÜ½ü£¬Ð¡³µÖÐÐÄÆ«ÀëºÚÏßʱ£¬²»»áÔÚºóÅÅ´«¸ÐÆ÷ºáÏòλÖòúÉúºÜ´óÎ»ÒÆ(Ïà¶ÔÓÚǰÅÅ´«¸ÐÆ÷)£¬¹ÊС³µÔÚÖ±ÏßÉ϶æ»úµ÷ÕûµÄ´ÎÊý¾Í»áÃ÷ÏÔ¼õÉÙ£¬Ö±ÏßµÄÎȶ¨ÐÔ»áºÃ¡£Í¬Ê±£¬¸ù¾ÝǰºóÅŲ»Í¬´«¸ÐÆ÷µÄ×éºÏ£¬¸ø³ö²»Í¬µÄת½Ç²ßÂÔ(ÔÚ³ÌÐòÖÐÒÔÁбíµÄ·½Ê½ÌåÏÖ)£¬½üÒ»²½Ìá¸ßÖ±ÏßµÄÎȶ¨¿ØÖÆÄÜÁ¦¡£ 2.2.5 ÍäµÀ¿ØÖƲßÂÔ
PIDËã·¨ÔÚÉÏÊöÖ±µÀ¿ØÖÆÖÐЧ¹ûºÜºÃ£¬¿ØÖƼòµ¥£¬ÔÚÆðÅܼÓËÙʱ¿ÉÉèÖÃǰÀ¡¿ØÖÆÆ÷£¬ÏÈÈ«Á¦¼ÓËÙµ½Ò»¸öËÙ¶ÈÖµ£¬ÔÚ¼ÓÉÏPIDµ÷½Ú£¬ÐγÉÒ»¸öÀàËÆÓڷֶεĿØÖÆ£¬¼´¿É½Ï¿ìµØ´ïµ½¹æ¶¨µÄËÙ¶È¡£
µ«ÊµÑéÖ¤Ã÷£¬Ë«ÅŹâµç¿ØÖÆÊ±µ¥´¿ÓÃPIDËã·¨£¬ÖÇÄܳµÔÚ´óSÍäÉÏ»á³öÏÖ¶¶¶¯£¬½µµÍ³µËÙ£¬Ôì³ÉÖÇÄܳµÔÚͨ¹ý´ËÀàÍäµÀʱ¼äµÄ´ó´óÑÓ³¤¡£Îª´Ë£¬Ïë³öÁË5ÖÖ½â¾ö·½·¨£º
£¨1£©ÑÓ³¤¿ØÖÆÖÜÆÚ£ºÕâÑù£¬ÖÇÄܳµ¶æ»úµÄ·´Ó³ÁéÃô¶È½µµÍ£¬¼õÉÙÁËÔÚ´óSÍäÉÏ»á³öÏÖ¶¶¶¯µÄ´ÎÊý£¬È±µãÊÇÑÓ³¤¿ØÖÆÖÜÆÚ£¬Ôì³ÉÈí¼þ¶Ô³µÌå¿ØÖÆÑÓʱµÄ¼Ó³¤£¬×îÃ÷ÏÔµÄÁÓÊÆÔÚÓÚ³¤Ö±µÀ¼ÓËÙºóת´óÍä·´Ó¦²»¼°Ê±£¬³å³öÈüµÀ£¬ÎªÁ˲»³å³öÈüµÀ£¬Ö»ÓнµµÍÖ±µÀ×î´óËÙ¶È£¬¼ä½ÓÓ°ÏìÁËÖÇÄܳµµÄËÙ¶ÈÐÔ¡£
£¨2£©¸Ä±äPID²ÎÊý£º¸Ä±äPID²ÎÊý¿ÉÒÔ¼õС¶æ»úÔÚתÍäʱ¿ØÖƵÄPWMÐźţ¬¼´ÈóµÌåתÏò±äС£¬ËõСÁËÔÚ´óSÍäÉϳöÏÖ¶¶¶¯µÄ·ù¶È£¬È±µãÊǸıäPID²ÎÊýÔÚËõСÁËÔÚ´óSÍäÉϳöÏÖ¶¶¶¯µÄ·ù¶ÈµÄͬʱ£¬Ò²ËõСÁËÖÇÄܳµÔÚÓÚ³¤Ö±µÀ¼ÓËÙºóת´óÍäʱµÄתÏò·ù¶È£¬Ê¹³µÌåÔÚÏàͬËÙ¶ÈÏ£¬²»ÄÜת¹ýÒÔÍù¿Éת¹ýµÄ´óÍ䣬×îºóµ¼Ö»¬³öÈüµÀ»òÖ±½Ó³å³öÈüµÀ£¬
¶«±±´óÑ§ÇØ»Êµº·ÖУ±ÏÒµÉè¼Æ£¨ÂÛÎÄ£© µÚ14Ò³
Ò²Ó°ÏìÁËÖÇÄܳµµÄ±ÈÈüÐÔÄÜ¡£
£¨3£©×öÈüµÀ±ê־룬¶ÔСSÍ䣬´óSÍ䣬90¡ãÍ䣬180¡ãÍ䣬»·Íä½øÐÐÊý¾Ý²É¼¯£¬·ÖÀàÉè³É±ê־룬´ËºóÖÇÄܳµÔËÐÐʱ²»¶Ï¼Ç¼×î½ü²É¼¯µÄ5×éÊý¾Ý£¬·ÖÎöÆä·ûºÏÄÇÖÖÍäµÀ£¬½ø¶ø¼ÓÒÔ¿ØÖÆ¡£ÊµÑéºóÖªÆäȱµãΪ±ê־λʶ±ðÒ׳ö´íÎ󣬿ÉÐÐÐÔ²»¸ß£¬ÕâÖ÷ÒªÊÇÒòΪ˫ÅŹâµç´«¸ÐÆ÷µÄǰհ²»×㣨½ö28cm£©£¬²É¼¯µ½µÄÈüµÀÐÅÏ¢Ò²²»ÏñÉãÏñÍ·ÄÇÑù¶à£¬¿ÉÒÔ×÷³ö׼ȷµÄʶ±ð¡£
£¨4£©ÀûÓÃËÙ¶È´«¸ÐÆ÷·µ»ØµÄʵ¼ÊËÙ¶ÈÖµ£¬×ö±ê־룬±ä¶æ»úPID²ÎÊý¶ÔÍäµÀ½øÐзֶοØÖÆ£ºÔÚÈí¼þÖÐÉèһϵÁÐËÙ¶ÈÖµ£¬°´ÖÇÄܳµÔËÐÐËÙ¶ÈÓèÒԷֶΣ¬ÔÚµÍËÙÇø£¨´óSÍäµÄÇé¿ö¶àΪµÍËÙ£©£¬¿ØÖÆÁ¿¸øÖеÈÖµ£¬Òò³µËÙ²»¸ß£¬½ÏСµÄ¿ØÖÆÁ¿ÔÚ¿ØÖÆÖÜÆÚÏà¶Ô¶àʱ¿ÉºÜºÃµÄµ÷½Ú³µÌ壬Îȶ¨¹ýÍ䣻ÔÚÖÐËÙÇø£¨Ö÷ÒªÕë¶ÔСSÍ䣩¡£¿ØÖÆÁ¿¸øÐ¡£¬¿ÉÔÚÒ»¶¨³Ì¶ÈÉÏʵÏÖSÍäÖ±ÏßÅÜ£¬½Úʡʱ¼ä£¬ÔÚ´óSÍäÖ®ËùÒÔ²»ÕâÑùÅÜ£¬ÊÇÓÉÓÚË«ÅŹâµçµÄǰհСºÍ²É¼¯ÐÅÏ¢²»×ãµÄÔµ¹Ê£»ÔÚ¸ßËÙÇø£¨Í¨³£Ö»ÔÚ³¤Ö±µÀ³µÌå¼ÓËÙºó·½ËÙ¶ÈÖµ¿É´ïµ½´ËÇøÓò£©£¬¿ØÖÆÁ¿¸ø´ó£¬·ÀÖ¹¸ßËÙʱ£¬×ª90¡ãÍ䣬180¡ãÍä²»¼°Ê±¶ø³å³öÅܵÀ¡£ÊµÑéÖУ¬Ð§¹ûºÜºÃ£¬µ«ºó·¢ÏÖµ±ÈüµÀ½á¹¹£¨Ö±µÀ£¬¸÷ÀàÍäµÀµÄ²»Í¬×éºÏ£©Î´¿¼ÂÇÖÜȫʱ£¬ÔÚÁ½ËÙ¶ÈÇøÏνӴ¦»á³öÏÖʧ¿Ø£¬ÀýÈçÖ±µÀÖ±½Ó½Ó´óSÍäµÄÈüµÀ´¦£¬³µÌå½øÈë´óSÍ䣬¶øÆäËÙ¶ÈÉÐδ¼õÏÂÀ´£¬¼´ÔÚ¸ßËÙÇø£¬¿ØÖÆÁ¿¸ø´ó£¬²»ÄÜÍê³ÉÔÚ´óSÍäÉϵÄÕýÈ·¿ØÖÆ£¬³µÌå°Ú¶¯2-3´Îºó·½¿ÉÕý³£Ðнø£¨´ËʱÊÇÓÉÓÚ³µËÙËæ°Ú¶¯½µµÍ£¬·ûºÏµÍËÙÇø±ê×¼£¬¿ØÖÆÁ¿¸øµÄÕýÈ·£©¡£
£¨5£©ÔÚ£¨4£©µÄ»ù´¡ÉÏ×öÀàËÆ£¨3£©µÄ±ê־λ´¦ÀíºóÒÔʵÑ鷨ȷ¶¨¸ø¶¨²ÎÊýÖµ£¨Ö÷ÒªÊDz»Í¬Çé¿öÏÂ¸Ä±ä¶æ»úµÄ¿ØÖÆÁ¿q´óСÓëKpÖµ´óС£©£ºÔÚÉè¼ÆÆÚ¼ä£¬ÔøÊÔ×ÅÔÚÈí¼þ¶ÔËÙ¶ÈÇø¼ä×öϸ·Ö£¬ÓÉÔÏȵĵ͡¢ÖС¢¸ßÈý¶Î¸Ä½øÎª5¶Î¡¢7¶Î¡¢9¶Î£¬½øÐпØÖÆ£¬¸ù¾ÝʵÑé½á¹û£¬Ëæ×Åϸ·Ö¶ÎÊýµÄÔö¼Ó£¬¿ÉÒÔ¼õÉÙ¼õÈõÇø¼äÏνӴ¦µÄ³µÌå°Ú¶¯£¬µ«²»ÄÜÍêÈ«½â¾öÎÊÌ⣬¶øÇÒËã·¨Ö´ÐÐʱ¼äÊܵ½Ò»¶¨Ó°Ïì¡£¼Ì¶ø×ö±ê־룬²¢ÒÔʵÑ鷨ȷ¶¨¸ø¶¨²ÎÊýÖµºó£¬ÖÇÄܳµ¿É³ä·Ö·¢»ÓÆäË«ÅÅ¿Éʶ±ðǰ·½ÈüµÀµÄÓÅÊÆ£¬Ê¶±ðºóÔÙ½øÐÐËٶȷֶοØÖÆ£¬Ê¹³µÌåÔÚÍäµÀÉϵĿØÖƵõ½Á˱£Ö¤£¬¿ØÖÆÐ§¹û±È½ÏÂúÒâ¡£ 2.2.6 ʵ²â½á¹ûºÍÏÖÏó·ÖÎö
ÏÂͼΪÎÒÃÇʹÓÃÉÏÊöË㷨ǰºóС³µÐнøµÄʵ¼Ê¹ì¼£¡£
¶«±±´óÑ§ÇØ»Êµº·ÖУ±ÏÒµÉè¼Æ£¨ÂÛÎÄ£© µÚ15Ò³
ͼ2.7 Á½ÖÖË㷨С³µÐнøµÄʵ¼Ê¹ì¼£¶Ô±È
ͼ2.7 ÊÇʹÓÃʵÑ鷨ȷ¶¨¸ø¶¨²ÎÊýֵǰºóС³µÔÚÈüµÀÉϵÄʵ¼Ê¹ì¼£,ÆäÖеĺìÏßÊÇÈü³µÐÐÊ»¹ì¼£
×¢£ºÕâÕÅͼµÄ»æÖÆ·½·¨ÊÇÕâÑùµÄ£¬ÏÈͨ¹ý´®¿Ú°ÑÎó²îÖµºÍËÙ¶Èͨ¹ýÎÞÏß´®¿Ú·¢µ½ÉÏλ»ú£¬È»ºóͨ¹ýÔÚ¼ÆËã»úÉÏÃèµã»³öС³µÊµ¼ÊµÄ¹ì¼££¬ÓÐÆ«²îµ«ÊÇÓëʵ¼ÊÇé¿ö·Ç³£½üËÆ¡£
¿ÉÒԷdz£Ã÷ÏԵĿ´µ½Ê¹ÓÃʵÑ鷨ȷ¶¨¸ø¶¨²ÎÊýÖµÖ®ºó£¬Ð¡³µËäȻҲÓÐÆ«³öÈüµÀµÄÇé¿ö´æÔÚ£¬µ«ÊDZÈÓà Kp ²ÎÊýºã¶¨µÄËã·¨Çé¿ö¾ÍºÃ¶àÁË¡£ÕâÖ÷ÒªÊÇÒòΪÔÚÍäµÀÉÏ Kp ²ÎÊý±ä´óµÄÔµ¹Ê¡£Kp ±ä´óʱ£¬Ò»µ©¼ì²âµ½Æ«²î£¬ÏµÍ³¾ÍÄܸü¿ìµÄ»Ö¸´µ½Æ½ºâλÖᣴӱíÖпÉÒÔ¿´µ½Ð¡³µÆ«²îµÄ·½²îʵ¼Ê¼õСÁË£¬Òò¶øÐ¡³µ×ßµÄʵ¼Ê¾àÀëÒ²¼õСÁË£¬×ÔÈ»ÅÜÍêÈüµÀµÄʱ¼äÒ²¼õСÁË¡£ 2.3 ³µÄ£²ÎÊý
´Ë´Î±ÈÈüÑ¡ÓõÄÈü³µ³µÄ£²ÉÓÃ1/10 µÄ·ÂÕæ³µÄ£¡£Èü³µ»úе½á¹¹Ö»Ê¹ÓþºÈüÌṩ³µÄ£µÄµ×Å̲¿·Ö¼°×ªÏòºÍÇý¶¯²¿·Ö¡£¿ØÖƲÉÓÃǰÂÖתÏò£¬ºóÂÖÇý¶¯·½°¸¡£¾ßÌ峵ģÊý¾ÝÈçÏ£º