1¡¢¶æ»úÇý¶¯
¶æ»úµÄ¿ØÖÆÖ÷ÒªÊÇÖ¸¶ÔÆäת½ÇµÄ¿ØÖÆ£¬ÒªÊµÏÖÕâÒ»¹¦ÄÜ£¬Ö»ÐèҪͨ¹ý¸Ä±ä¿ØÖƶæ»ú¶Ë×ÓµÄPWM²¨Õ¼¿Õ±È±ã¿ÉʵÏÖ£¬²»ÐèÒª¸Ä±äÊ©¼ÓÔÚ¶æ»úÁ½¶ËµÄµçѹ´óС¡£½«µçÔ´7.2µçѹ¾×ª»»ÎÈѹºóÖ±½Ó½Óµ½¶æ»úµçѹÊäÈë¶Ë¼´¿ÉʵÏÖ¶Ô¶æ»úµÄÇý¶¯¡£Òò´Ë£¬¶æ»úµÄ¿ØÖÆ¿ÉÖ±½Óͨ¹ýÈí¼þ¸Ä±äPWM²¨Õ¼¿Õ±È£¬´Ë·½°¸¿ØÖƼòµ¥¶øÓÖ¾«È·£¬²¢ÇÒÒ×ÓÚʵÏÖ¡£ 2¡¢Ö±Á÷µç»úÇý¶¯
µ¥Æ¬»ú¹Ü½ÅµÄÊä³öµçÁ÷½ÏС£¬Ô¶Ô¶Ð¡ÓÚµç»ú¹¤×÷ʱÁ÷¹ýµç»úµÄµçÁ÷£¬ËùÒÔÒªÉè¼ÆÒ»¸öµç»úÇý¶¯µç·À´ÊµÏÖÍ϶¯µç»ú¡£±¾Éè¼Æ²ÉÓÃMotorola¹«Ë¾Éú²úµÄרÃŵç»úоƬMC33886£¬ËüÄÚ²¿¼¯³ÉÁËÒ»¸öHÇŵç·£¬Äܹ»Í¨¹ý5AµÄµçÁ÷£¬²¢ÇÒÍⲿÊäÈë¿ØÖÆÐÅºÅµÄÆµÂÊ¿ÉÒԸߴï10kHZ£¬´ó´óÌá¸ßÁ˵ç»ú¿ØÖÆµÄÆµÂÊ£¬¿ÉÒԺܺõĿØÖƵç»úµÄתËÙºÍת¶¯·½Ïò£¬Ò×ÓÚʵÏÖÕýת¡¢·´×ª¡£ 3.3.2µç»úÇý¶¯µç·Éè¼Æ 1¡¢¶æ»úÇý¶¯µç·
Ϊʹ¶æ»ú·´Ó³ÁéÃô£¬±¾Éè¼Æ¶Ô¶æ»úµÄ¹©µçµçѹÌá¸ßµ½6.4V¡£Ó¦¸Ã×¢ÒâµÄÊÇÊäÈë¶æ»úµÄPWM²¨£¬ÆäÖÜÆÚºÍÕ¼¿Õ±È¾ùÓÐÒ»¶¨µÄÏÞÖÆ£¬ÖÜÆÚÒ»°ãΪ20ms£¬Õ¼¿Õ±ÈΪ5% ~ 10%£¨Èç±í3.1£©¡£
±í3.1ÕýÂö³å¿í¶ÈÓë΢ÐÍËÅ·þÂí´ïµÄÊä³ö±ÛλÖùØÏµ
11
ͼ3.5 ¶æ»úÇý¶¯µç·
2¡¢Ö±Á÷µç»úÇý¶¯µç·
Ö±Á÷µç»úÇý¶¯Ö÷ÒªÊÇMC33886ÍâΧµç·Éè¼Æ£¬µç·ÔÀíͼÈçͼ3.6Ëùʾ£¬±¾Éè¼ÆÎªÊ¹Ö±Á÷µç»úÄܹ»¸ü¿ìµÄʵÏÖ¼ÓËÙ¡¢¼õËÙºÍÖÆ¶¯£¬²ÉÓÃÁ½Æ¬MC33886²¢Áª£¬Ê¹ÆäÇý¶¯µçÁ÷Ôö´óÒ»±¶£¬ÔÙÓɵ¥Æ¬»úÊä³öPWM²¨£¬´Ó¸Ä±äPWMÕ¼¿Õ±ÈÀ´ÊµÏÖ¶Ôµç»úµÄ¿ØÖÆ¡£
ͼ3.6 Ö±Á÷µç»ú»úÇý¶¯µç·
3.4 ²âËÙ·´À¡
²âËÙ·½°¸ÓкܶàÖÖ£¬±ÈÈ磺²âËÙµç»ú¡¢¹âµç±àÂëµÈ¡£
¿¼Âǵ½Ê¹ÓòâËÙµç»ú»á¸øÖÇÄܳµ³µºóÂÖ¸½¼ÓÁ¦¾Ø¶øÓ°Ïì³µËÙµÄÌáÉý£¬¹Ê±¾Éè¼ÆÑ¡Óùâµç±àÂëµÄ·½Ê½¡£
12
¹âµç±àÂëÆ÷ÊÇÓɹâµçºìÍâ¹âñîºÍÂëÅÌÄ£¿é¹¹³É£¬¹âµçÂëÅ̹²ÓÐ48µÈ·ÝÂֳݣ¬¹Ì¶¨ÔÚÖáÉÏ¡£µ±ÖáÐýתʱ£¬ÂëÅÌËæÖáÒ»ÆðÐýת£¬½«Êä³öһϵÁеÄÂö³åÐźţ¬ÓÃ12λ¼ÆÊýÆ÷CD4040¼ÆÊý£¬ÔÚÒ»¶¨µÄʱ¼äÄÚµ¥Æ¬»ú¶ÁÈ¡Âö³åÊý£¬ÊµÏÖËٶȵķ´À¡£¬´Ó¶ø½øÐÐËٶȵıջ·¿ØÖÆ¡£
²âËÙ·´À¡µÄµç·ͼÈçͼ3.7Ëùʾ¡£
ͼ3.7 ²âËÙ·´À¡µç·
3.5 µçÔ´Éè¼Æ
ÓÉÓÚÕû¸öϵͳµÄ¹©µçµçѹΪ7.2V¶ø¿ØÖÆÆ÷µÄËùÐèµçѹΪ5V£¬ÁíÍ⣬ÔÚʵ¼ÊС³µÔËÐйý³ÌÖпÉÄÜÆµ·±µÄ¼ÓËÙ¡¢¼õËÙʹµÃµçÔ´Á½¶ËµÄµçѹÓнϴóµÄ²¨¶¯£¬Òò´ËΪÁËÈ·±£ÏµÍ³Äܹ»ÅÜÍêÈ«³Ì±ÜÃâÒâÍâÖØÆô£¬µçÔ´Îȶ¨ÐÔÔÚϵͳÖÐÊÇÖÁ¹ØÖØÒªµÄ¡£±¾Éè¼Æ²ÉÓÃLM2940×÷ΪµçѹµÄÎÈѹоƬ£¬ÒòΪLM2940ÓнϴóµÄÊäÈëת»»Çø¼ä£¬½Ï¸ßµÄÊä³öµçѹ¾«¶È¡£Í¼3.8ΪµçÔ´µÄ¹©µçʾÒâͼ¡£
µçÔ´6-SC 7.2V 2000mALM 2940(5.0V)LM 2940(6.4V)΢¿ØÖÆÆ÷´«¸ÐÆ÷²âËÙÄ£¿é¶¯Á¦µç»úתÏò¶æ»ú
ͼ3.8 µçÔ´¹©µçʾÒâͼ
13
4 Èí¼þÉè¼Æ
4.1Èí¼þµÄ×ÜÌå·½°¸Éè¼Æ
ÖÇÄܳµ¿ØÖÆÏµÍ³Èí¼þÉè¼ÆÖ»Òª¹¦ÄÜΪͨ¹ý²É¼¯ÐÅÏ¢²¢×Ô¶¯Ê¶±ðÂö³å£¬±¾Éè¼Æ¿ØÖÆÆ÷µÄÊäÈëÁ¿Îª´«¸ÐÆ÷²É¼¯µÄÄ£ÄâÊý¾ÝÁ¿¡¢Ë²Ê±ËÙ¶ÈÖµ£¨Âö³åÊý£©£¬Êä³öÁ¿Îª¿ØÖƶ¯Á¦µç»úµÄÂö³åÐźźͿØÖƶæ»úµÄÂö³åÐźš£ÎªÊ¹ÖÇÄܳµÐÔÄÜÎȶ¨£¬ËٶȺÍתÏò½ÇÁ½¿ØÖÆÁ¿·Ö±ð²ÉÓÃPIDµ÷½ÚºÍPDµ÷½Ú¡£
³ÌÐòÈë¿Ú³õʼ»¯ÊÇ·ñ½øÐвÎÊýÐ޸ģ¿Êǹؼü²ÎÊýʵʱÐ޸ijÌÐò·ñ¿ªÖж϶ÁÈ¡¹âµç´«¸ÐÆ÷×éµÄ״̬λÖÃËÙ¶È¿ØÖƳÌÐòͼ4.1ϵͳ×ÜÌå·½°¸
±¾Éè¼ÆÏµÍ³Èí¼þÉè¼Æ×ñÑÒÔϹæÔò£º
£¨1£©²ÉÓÃÄ£¿é³ÌÐòÉè¼Æ¡£Ä£¿é³ÌÐòÉè¼ÆÊǰÑÒ»¸ö½Ï³¤µÄÍêÕûµÄ³ÌÐò£¬·Ö³ÉÈô¸ÉСµÄ¹¦ÄܳÌÐòÄ£¿é£¬ÔÙ·Ö±ð½øÐÐÉè¼Æ£¬×îÖÕ×°ÅäÔÚÒ»Æð£¬Á´½Ó³ÉÒ»¸öÍêÕûµÄ³ÌÐò¡£Ä£¿é»¯³ÌÐòÉè¼Æ±ãÓÚ³ÌÐòÒÆÖ²ºÍÐ޸ġ£
£¨2£©ÍⲿÉ豸ºÍÍⲿʼþ²ÉÓÃÖжϷ½Ê½ÓëCPUÁªÂ磬ÕâÑù£¬¼´±ãÓÚϵͳģ¿é»¯£¬Ò²¿ÉÌá¸ß³ÌÐòЧÂÊ¡£
£¨3£©¾¹ýµ÷ÊÔÐ޸ĺóµÄ³ÌÐò½øÐй淶»¯¡£¹æ·¶»¯µÄ³ÌÐò±ãÓÚ½»Á÷¡¢½è¼ø£¬Ò²
14
Ϊ½ñºóϵͳ¹¦ÄܵĽøÒ»²½À©³ä´òÏ»ù´¡¡£
£¨4£©ÏµÍ³Èí¼þÉè¼Æ³ä·Ö¿¼Âǵ½Èí¼þ¿¹¸ÉÈÅ´ëÊ©¡£ÈçÊý×ÖÂ˲¨£¬³ÌÐòÅܷɵÄÈí¼þÏÝÚ壬Èí¼þÈÝ´íÉè¼ÆµÈ¡£
4.2 ¿ØÖÆËã·¨
PID¿ØÖÆËã·¨µÄÔÀí£ºPID¿ØÖÆÆ÷±¾ÉíÊÇÒ»ÖÖ»ùÓÚ¶Ô¡°¹ýÈ¥¡±¡°ÏÖÔÚ¡±¡¢ºÍ¡°Î´À´¡±ÐÅÏ¢½øÐйÀ¼ÆµÄ¼òµ¥¿ØÖÆËã·¨¡£PID¿ØÖÆÆ÷ÊÇÒ»ÖÖÏßÐÔ¿ØÖÆÆ÷£¬Ëü¸ù¾Ý¸ø¶¨Öµr(t)Óëʵ¼ÊÊä³öÖµy(t)¹¹³É¿ØÖÆÆ«²î£¬½«Æ«²î°´±ÈÀý¡¢»ý·Ö¡¢Î¢·Öͨ¹ýÏßÐÔ×éºÏ¹¹³É¿ØÖÆÁ¿£¬¶Ô±»¿ØÖƶÔÏó½øÐпØÖÆ£¬ÊµÏÖ¡°ÎÈ¡±¡¢¡°¿ì¡±¡¢¡°×¼¡±¡£
PIDËã·¨µÄ¿ØÖƹæÂɹ«Ê½£º
1U(t)?Kp[e(t)?Ti³£Êý¡£
Tdde(t)?0e(t)dt?dt]
t¹«Ê½ÖÐe(t) = r(t) - y(t)£¬KpΪ±ÈÀýϵÊý£¬TiΪ»ý·Öʱ¼ä³£Êý£¬TdΪ΢·Öʱ¼ä
±ÈÀýµ÷½Ú£¨P£©µÄ×÷ÓãºÊǰ´±ÈÀý·´Ó¦ÏµÍ³µÄÆ«²î£¬ÏµÍ³Ò»µ©³öÏÖÆ«²î£¬±ÈÀýµ÷½ÚÁ¢¼´²úÉú×÷ÓÃÓÃÒÔ¼õÉÙÆ«²î¡£±ÈÀý×÷Óô󣬿ÉÒÔ¼Ó¿ìµ÷½Ú£¬¼õÉÙÎó²î£¬µ«Êǹý´óµÄ±ÈÀý£¬»áʹϵͳµÄÎȶ¨ÐÔϽµ¡£
»ý·Öµ÷½Ú£¨I£©µÄ×÷ÓãºÊÇʹϵͳÏû³ýÎÈ̬Îó²î£¬Ìá¸ßÎÞ²î¶È¡£ÓÐÎó²î£¬»ý·Öµ÷½Ú¾Í½øÐУ¬Ö±ÖÁÎÞÎó²î£¬Ò»µ©Î޲¾ÍÊä³öÒ»³£Êý¡£»ý·Ö×÷ÓõÄÇ¿ÈõÈ¡¾öÓÚ»ý·Öʱ¼ä³£ÊýTi£¬TiԽС£¬»ý·Ö×÷ÓþÍԽǿ¡£·´Ö®Ti´óÔò»ý·Ö×÷ÓÃÈõ£¬¼ÓÈë»ý·Ö»·½Ú£¬¿ÉʹϵͳÎȶ¨ÐÔϽµ£¬¶¯Ì¬ÏìÓ¦Âý¡£
΢·Öµ÷½Ú(D)µÄ×÷ÓãºÎ¢·Ö×÷Ó÷´Ó³ÏµÍ³Æ«²îÐźŵı仯ÂÊ£¬¾ßÓÐÔ¤¼ûÐÔ£¬ÄÜÔ¤¼ûÆ«²î±ä»¯µÄÇ÷ÊÆ£¬Òò´ËÄܲúÉú³¬Ç°µÄ¿ØÖÆ×÷Óã¬ÔÚÆ«²î»¹Ã»ÓÐÐγÉ֮ǰ£¬Òѱ»Î¢·Ö×÷ÓÃÏû³ý¡£Òò´Ë¿ÉÒÔ¸ÄÉÆÏµÍ³µÄ¶¯Ì¬ÐÔÄÜ¡£ÔÚ΢·Öʱ¼äÑ¡ÔñºÏÊÊÇé¿öÏ£¬¿ÉÒÔ¼õÉÙ³¬µ÷Á¿£¬¼õÉÙµ÷½Úʱ¼ä¡£Î¢·Ö×÷ÓöÔÔëÉù¸ÉÈÅÓзŴó×÷Óã¬Òò´Ë¹ýÇ¿µÄ¼Ó΢·Öµ÷½Ú£¬¶Ôϵͳ¿¹¸ÉÈŲ»Àû¡£´ËÍâ΢·Ö»·½Ú·´Ó³µÄÊDZ仯ÂÊ£¬µ±ÊäÈëûÓб仯ʱ£¬Î¢·Ö×÷ÓÃΪÁ㡣΢·Ö×÷Óò»Äܵ¥¶ÀʹÓÃÐèÒªÓëÆäËûÁ½¸ö»·½ÚÏà½áºÏ£¬×é³É
15