¹ãÎ÷´óѧѧʿѧλÂÛÎÄ
Á¦µÄÊä³ö£¬³ÝÂÖ×éµÄ±äËÙ±ÈÔ½´ó£¬ËÅ·þÂí´ïµÄÊä³öŤÁ¦Ò²Ô½´ó£¬Ò²¾ÍÊÇ˵ԽÄܳÐÊܸü´óµÄÖØÁ¿£¬µ«×ª¶¯µÄËÙ¶ÈÒ²ÓúµÍ¡£ÆäÔÀíÈçͼ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