»ÆÊÀÁáµÄ±ÏÒµÉè¼ÆÂÛÎÄ - ͼÎÄ ÏÂÔØ±¾ÎÄ

¹ãÎ÷´óѧѧʿѧλÂÛÎÄ

Á¦µÄÊä³ö£¬³ÝÂÖ×éµÄ±äËÙ±ÈÔ½´ó£¬ËÅ·þÂí´ïµÄÊä³öŤÁ¦Ò²Ô½´ó£¬Ò²¾ÍÊÇ˵ԽÄܳÐÊܸü´óµÄÖØÁ¿£¬µ«×ª¶¯µÄËÙ¶ÈÒ²ÓúµÍ¡£ÆäÔ­ÀíÈçͼ2.12Ëùʾ¡£

PWM¿ØÖƵç·ËÅ·þÂí´ï³ÝÂÖ×éµçλÆ÷·´À¡µçѹͼ2.12 ¶æ»úÔ­Àíͼ

¶æ»ú¹¤×÷Ô­Àí£º¿ØÖƵç·½ÓÊÜÀ´×ÔÐźÅÏߵĿØÖÆÐźÅ(¾ßÌåÐźŴý»áÔÙ½²)£¬¿ØÖƵç»úת¶¯£¬µç»ú´ø¶¯Ò»ÏµÁгÝÂÖ×飬¼õËÙºó´«¶¯ÖÁÊä³ö¶æÅÌ¡£¶æ»úµÄÊä³öÖáºÍλÖ÷´À¡µçλ¼ÆÊÇÏàÁ¬µÄ£¬¶æÅÌת¶¯µÄͬʱ£¬´ø¶¯Î»Ö÷´À¡µçλ¼Æ£¬µçλ¼Æ½«Êä³öÒ»¸öµçѹÐźŸø¿ØÖƵç·£¬½øÐз´À¡£¬È»ºó¿ØÖƵç·¸ù¾ÝËùÔÚλÖþö¶¨µç»úµÄת¶¯·½ÏòºÍËÙ¶È£¬´Ó¶ø´ïµ½Ä¿±êÍ£Ö¹¡£

2.7.2¶æ»úµÄ¿ØÖÆ

¶æ»úµÄÊäÈëÏß¹²ÓÐÈýÌõ£¬µçÔ´¡¢µØ¼°¿ØÖÆ¡£ºìÉ«ÔÚÖмäÊǵçÔ´Ïߣ¬Ò»±ßºÚÉ«µÄÊǵØÏߣ¬ÕâÁ½¸ùÏ߸ø¶æ»úÌṩµÄµçÔ´±£Ö¤£¬Ö÷ÒªÊǵç»úµÄת¶¯ÏûºÄ¡£µçÔ´µçѹͨ³£½éÓÚ4V-6VÖ®¼ä¡£¶æ»úµÄ¿ØÖÆÐźÅΪÖÜÆÚ20msµÄÂö¿íµ÷ÖÆ(PWM)Ðźţ¬ÆäÖÐÂö³å¿í¶È´Ó0.5ms-2.5ms£¬Ïà¶ÔÓ¦¶æÅ̵ÄλÖÃΪ0¡ã-180¡ã£¬³ÊÏßÐԱ仯¡£Ò²¾ÍÊÇ˵£¬¸øËüÌṩһ¶¨µÄÂö¿í£¬ËüµÄÊä³öÖá¾Í»á±£³ÖÔÚÒ»¸öÏà¶ÔÓ¦µÄ½Ç¶ÈÉÏ£¬ÎÞÂÛÍâ½çת¾ØÔõÑù¸Ä±ä£¬Ö±µ½¸øËüÌṩһ¸öÁíÍâ¿í¶ÈµÄÂö³åÐźţ¬Ëü²Å»á¸Ä±äÊä³ö½Ç¶Èµ½ÐµĶÔÓ¦µÄλÖÃÉÏ¡£¶æ»úÄÚ²¿ÓÐÒ»¸ö»ù×¼µç·£¬²úÉúÖÜÆÚ20ms£¬¿í¶È1.5msµÄ»ù×¼Ðźţ¬ÓÐÒ»¸ö±È½ÏÆ÷£¬½«Íâ¼ÓÐźÅÓë»ù×¼ÐźÅÏà±È½Ï£¬Åжϳö·½ÏòºÍ´óС£¬´Ó¶ø²úÉúµç»úµÄת¶¯Ðźš£Óɴ˿ɼû£¬¶æ»úÊÇÒ»ÖÖλÖÃËÅ·þµÄÇý¶¯Æ÷£¬×ª¶¯·¶Î§²»Äܳ¬¹ý+90¡ã¡£±í2.2ÁгöÒ»¸öµäÐ͵Ä20msÖÜÆÚÐÔÂö³åµÄÕýÂö³å¿í¶ÈÓë΢ÐÍËÅ·þÂí´ïµÄÊä³ö±ÛλÖõĹØÏµ¡£

Õý³£×´Ì¬Ï¶æ»úµÄ¹¤×÷µçѹ·¶Î§ÊÇ4.8V-6V£¬¶øÎÒÃÇʹÓÃµÄµç³ØÊÇ7.4VµÄ£¬Êµ¼ÊÉÏÎÒÃÇ·¢ÏÖ¿ÉÒÔ°Ñµç³ØÖ±½Ó½Óµ½¶æ»úµÄµçÔ´½Ó¿ÚÉÏ£¬¼´Èöæ»ú¹¤×÷ÔÚ7.4VµÄµçѹÏ£¬ÕâÑùµÄ»°¿ÉÒÔ¼Ó¿ì¶æ»úµÄÏìӦʱ¼ä£¬¶ø¶æ»úµÄÏìӦʱ¼ä¶ÔÓÚС³µµÄ¿ØÖÆÊÇÖÁ¹ØÖØÒªµÄ¡£µ«Ôڴ˹¤×÷·½Ê½Ï·¢ÏÖ£¬µçÔ´µÄµçѹϽµ¶Ô¶æ»úµÄÕý³£¹¤×÷µÄÓ°Ïì±È½Ï´ó£¬µ«µç³ØµÄµçѹϽµµÄ±È½ÏÀ÷º¦Ö®ºó£¬¶æ»ú¾Í

21

¹ãÎ÷´óѧѧʿѧλÂÛÎÄ

²»ÄÜÕý³£¹¤×÷ÁË£¬³öÏÖµÄÏÖÏóÊǶæ»úתÏò²»×ã¡£ÕâÖÖÇé¿öÔÚµ÷ÊÔ¹ý³ÌÖÐÔø¾­¶à´Î³öÏÖ£¬Ã¿´Î¸ü»»ÐÂµç³ØºóС³µ¾ÍÄÜÕý³£¹¤×÷ÁË¡£Í¨³£¸ø¶æ»úµÄµ÷ÖÆÐźÅÊÇ50HzµÄ£¬¼´ÖÜÆÚΪ20ms£¬Êµ¼ÊÉÏΪÁË¼Ó¿ì¶æ»úµÄÏìӦʱ¼ä£¬ÎÒÃÇ¿ÉÒ԰Ѷæ»úµ÷ÖÆÐÅºÅµÄÆµÂÊÌá¸ßµ½100Hz£¬¼´ÖÜÆÚΪ10ms¡£²éÔĶæ»úµÄ×ÊÁÏÎÒÃÇÖªµÀ£¬µ±¸øµÄµ÷ÖÆÐÅºÅµÄ¸ßµçÆ½Ê±¼äÊÇ1.5msʱ£¬¶æ»úÊä³ö0¡ã¡£ÌرðҪעÒâµÄÊÇ£¬ÔÚ³ÌÐòÖаѶæ»úµÄƵÂÊÌá¸ßÒԺ󣬶æ»úµÄÊä³ö½Ç¶È½öÓë¸ßµçƽµÄ±í2.2¶æ»úת½Ç¿ØÖÆ

ÊäÈëÕýÂö³å¿í¶È(ÖÜÆÚΪ20ms)

0.5ms

1.0ms

1.5ms

2.0ms

2.5ms

90¡ã 45¡ã 0¡ã £­45¡ã

ËÅ·þÂí´ïÊä³ö±ÛλÖÃ

£­90¡ã

³ÖÐøÊ±¼äÓйأ¬¶øÓëÕ¼¿Õ±ÈÎ޹ء£¼´µ±²ÉÓÃ100Hz£¬µÄµ÷ÖÆÐźÅʱ£¬Ö»Òª°Ñ´ËʱµÄ¸ßµçƽ³ÖÐøÊ±¼äÏìÓ¦µÄÉ趨Ϊ1.5ms£¬Ôò¶æ»ú¾Í¿ÉÒÔÕýÈ·µÄÊä³ö0¡ã¡£

22

¹ãÎ÷´óѧѧʿѧλÂÛÎÄ

2.8±¾ÕÂС½á

±¾ÕÂÖÆ¶¨ÁËÖÇÄܳµ¿ª·¢µÄ×ÜÌå·½°¸£¬²¢·Ö±ðÉè¼ÆÁ˵çÔ´Ä£¿é¡¢´«¸ÐÆ÷Ä£¿é¡¢¶æ»úºÍÖ±Á÷µç»úÇý¶¯ÒÔ¼°ÆäËûÁ㲿¼þºÍÄ£ÐͳµÆ½Ì¨¡£Ö÷Òª°üÀ¨ÒÔÏÂÄÚÈÝ£º

(1)STM32ϵͳ°å¡¢¹âµç´«¸ÐÆ÷µç·¡¢³µËÙ²âÁ¿µç·²ÉÓÃLM2576Ìṩ3.3Vµçѹ£¬¶æ»úµçÔ´²ÉÓÃLM2576Ìṩ6Vµçѹ£¬¼õËÙµç»úÇý¶¯Ä£¿éÖ±½Óµç³ØÓëÁ¬½Ó»ñµÃ7.4Vµçѹ£»

(2)²ÉÓõ¥Åʲ7¸öºìÍâ´«¸ÐÆ÷µÈ¼ä¾àÅÅÁеķ½Ê½½øÐÐÑ­¼£ºÍ¼ì²âÄ£ÐͳµÏà¶ÔÓÚÒýµ¼Ïߵį«ÒÆÁ¿£»

(3)¾­¹ý¾«È·²âÁ¿ºÍ¼ÆË㣬×îÖÕÈ·¶¨Á˸÷Ó²¼þµÄ½á¹¹³ß´ç£¬È·¶¨ÁË¿ÉʹÓõÄѰÏß´«¸ÐÆ÷ºÍ²âËÙ´«¸ÐÆ÷¼°Æä¸½ÊôµÄµç·°å¿¨ºÍÏà¹ØµÄÁ¬½Ó²¿¼þ¡£

ÖÁ´Ë£¬ÖÇÄܳµµÄÓ²¼þƽ̨ÍêÈ«´î½¨Íê±Ï¡£

23

¹ãÎ÷´óѧѧʿѧλÂÛÎÄ

µÚÈýÕ PID¿ØÖÆËã·¨µÄÈí¼þÉè¼ÆÓëʵÏÖ

3.1 PID¿ØÖÆÔ­ÀíÓë³ÌÐò

PID¿ØÖÆÆ÷·ÖΪģÄâPID¿ØÖÆÆ÷ÓëÊý×ÖPID¿ØÖÆÆ÷£¬¶øÊý×ÖPID¿ØÖÆÆ÷ÓÖ·ÖΪλÖÃʽÓëÔöÁ¿Ê½£»PID(±ÈÀý¡¢»ý·Ö¡¢Î¢·Ö)¿ØÖÆÆ÷Êǽ¨Á¢ÔÚ¾­µäµÄ¿ØÖÆÀíÂÛ»ù´¡ÉϵÄÒ»ÖÖ¿ØÖƲßÂÔ¡£PID¿ØÖÆÆ÷×÷Ϊ×îÔçʵÓû¯µÄ¿ØÖÆÆ÷£¬ÒѾ­ÓÐ70¶àÄêµÄÀúÊ·£¬ËüÒÔÆä½á¹¹¼òµ¥¡¢Îȶ¨ÐԺᢹ¤×÷¿É¿¿¡¢µ÷Õû·½±ã¡¢²»ÐèÒª¾«È·µÄϵͳģÐ͵ÈÏȾöÌõ¶ø³ÉΪӦÓÃ×î¹ã·ºµÄ¿ØÖÆÆ÷[22]¡£

3.1.1 Ä£ÄâPIDµ÷½ÚÆ÷

Ä£ÄâPID¿ØÖÆÏµÍ³Ô­Àí¿òͼÈçͼ3.1Ëùʾ¡£

PID¿ØÖÆÆ÷±ÈÀýµ÷½ÚÆ÷r(t)+-΢·Öµ÷½ÚÆ÷

ͼ3.1Ä£ÄâPID¿ØÖÆÏµÍ³Ô­Àí¿òͼ

e(t)´ú±íÀíÏëÊäÈëÓëʵ¼ÊÊä³öµÄÎó²î£¬Õâ¸öÎó²îÐźű»Ë͵½PID¿ØÖÆÆ÷£¬¿ØÖÆÆ÷¶ÔÎó²îÐźÅe(t)·Ö±ð½øÐбÈÀý(P)¡¢»ý·Ö(I)¡¢Î¢·Ö(D)ÔËË㣬Æä½á¹ûµÄ¼ÓȨºÍ¹¹³ÉϵͳµÄ¿ØÖÆÐźÅu(t)¡£

PID¿ØÖÆÆ÷µÄÊýѧģÐÍΪ

e(t)»ý·Öµ÷½ÚÆ÷+u(t)+±»¿ØÖƶÔÏó+y(t) 24