Ö±Á÷ÎÞË¢µç»ú¿ØÖÆÏµÍ³Éè¼ÆÓëʵÏÖ
ͼ21 Ä£ÄâPID¿ØÖÆÔÀíͼ
PID¿ØÖÆÏµÍ³ÖУ¬Èý¸ö¿ØÖÆÁ¿ËùÆðµÄ×÷Ó÷ֱðÊÇ£ºP¿ØÖƽ«Îó²î¹Ì¶¨±ÈÀýÐÞÕý¡£I¿ØÖƽ«Îó²îȡʱ¼äµÄ»ý·Ö¡£D¿ØÖƽ«Îó²î½øÐÐ΢·Ö·ÀÖ¹±»¿ØÁ¿µÄÑÏÖØ³¬µ÷¡£
´Ó¹«Ê½ÖÐÍÆ³öÔöÁ¿Ê½PID¿ØÖÆË㷨Ϊ£º
?u(k)?u(k)?u(k?1)
=Kp(e(k)?e(k?1))?Kie(k)?Kd(e(k)?2e(k?1)?e(k?2)) ÏÂÃæÊÇÔöÁ¿PIDËã·¨£¬³ÌÐòÉè¼ÆÖÐÓõÄ×î³£ÓõÄÔöÁ¿PIDËã·¨[8]£º u(k?1)?u(k)?q0*e(k?2)?q1*e(k?1)?q2*e(k); £¨2£©
TsTd?)TiTs
Tdq1?Kp*(1?2)Ts Tdq2?KpTs
q0?Kp*(1?4.7 matlab gui ´®ÐÐͨÐŽçÃæÉè¼Æ
ΪÁ˸üºÃµ÷½ÚPID,Éè¼Æmatlab gui½çÃæ£¬Äܹ»ºÜ·½±ãµÄµ÷½ÚPID¡£½çÃæÈçͼ22£º
ͼ22 PID²ÎÊýÕû¶¨½çÃæ
15
Ö±Á÷ÎÞË¢µç»ú¿ØÖÆÏµÍ³Éè¼ÆÓëʵÏÖ
5Ö±Á÷ÎÞË¢Î޸еç»ú²âÊÔ½á¹û¼°½á¹û·ÖÎö
5.1 H_PWM_L_PWMµÄ²¨ÐÎ
Ö±Á÷ÎÞË¢µç»úµÄÇý¶¯²¨ÐÎÓкܶàÖÖ·½Ê½¿ÉÒÔÑ¡Ôñ£¬±ÈÈ磺PWM_ONµ÷ÖÆ¡¢ON_PWMµ÷ÖÆ¡¢H_PWM_L_ONµ÷ÖÆ¡¢H_ON_L_PWMµ÷ÖÆ¡¢H_PWM_L_PWMµ÷ÖÆ¡£ÎÒÑ¡ÓõÄÊÇH_PWM_L_PWMµ÷ÖÆ·½Ê½[9]£¬Í¼23ÊÇÁù·PWMµÄÆäÖÐÁ½Â·£¬ÆäËûµÄ¼¸Â·»ù±¾¶¼Ò»Ñù£¬ÓÃÀ´¿ØÖÆÖ±Á÷ÎÞË¢µç»úµÄ˳ÀûÔËת¡£
ͼ23 H_PWM_L_PWM²¨ÐÎ
5.2¶Ëµçѹ¶ÔµØ²¨ÐÎ
ͼ24Êǵç»ú¶ÔµØµÄµçѹ²¨ÐΣ¬ºÍÔÀíµÄºÜ½Ó½ü£¬Ò²ËãÀíÏë¡£
ͼ24 ¶Ëµçѹ¶ÔµØ²¨ÐÎ
16
Ö±Á÷ÎÞË¢µç»ú¿ØÖÆÏµÍ³Éè¼ÆÓëʵÏÖ
5.3λÖüì²â²¨ÐÎ
µç»úµÄλÖüì²â²¨ÐÎͼÈçÏÂËùʾ£¬ËüÊÇͨ¹ýÄ£ÄâÖÐÐÔµã[10]µÃµ½µÄ£¬¾¹ý¹âñî¸ôÀëÊäÈëµ½µ¥Æ¬»úµÄ»ô¶û½Ó¿Ú£¬Í¨¹ýÅжϵ¥Æ¬»ú½Ó¿ÚµÄµçƽÀ´Çý¶¯µç»úµÄÐýת²½·¥£¬µ¥Æ¬»ú½Ó¿ÚµçƽÈç±í2Ëùʾ¡£Í¼25ΪλÖüì²âµÄ²¨ÐÎËäÈ»Óеãë´Ì£¬µ«¾¹ýµ¥Æ¬»úÄÚ²¿µÄÈí¼þÂ˲¨£¬ÈÔÈ»Äܹ»ºÃµÄʶ±ðµç»úת×ÓµÄλÖ㬲¢½øÐеç»úµÄ»»Ïà¡£
ͼ25 λÖüì²â²¨ÐÎ
±í 2 λÖüì²âµçƽ
PA6 0 0 0 1 1 1 PA7 0 1 1 1 0 0 PB0 1 1 0 0 0 1 Ê®Áù½øÖÆ 0x01 0x03 0x02 0x06 0x04 0x05 5.4µçÁ÷²¨ÐÎ
Ö±Á÷ÎÞË¢µç»ú¸ÕÆô¶¯Ê±µÄµçÁ÷·Ç³£´ó£¬´ËʱÈÝÒ×ÉÕ»µµç»ú£¬Òò´ËÒª¼Ó±£»¤µç·£¬Çý¶¯µç·ҲҪÓÐ×ã¹»µÄµçÁ÷Çý¶¯ÄÜÁ¦£¬·ñÔòµç»úת²»ÆðÀ´¡£Ê¾²¨Æ÷¹Û²ìµÄ²¨ÐÎÈçºÎÏÂͼ26Ëùʾ£¬·ûºÏµç»úÆô¶¯µÄÔÀíµçÁ÷²¨ÐÎ[11]¡£
17
Ö±Á÷ÎÞË¢µç»ú¿ØÖÆÏµÍ³Éè¼ÆÓëʵÏÖ
ͼ26 µçÁ÷²¨ÐÎͼ
5.5ʵÎïͼ
ͼ27ÊǶ¯ÊÖº¸µÄµç·°å£¬ÊÇÖ±Á÷ÎÞË¢µç»úµÄÇý¶¯µç·°å£¬Çý¶¯µç·ÓõÉÄ£¿éIPM¹¹³É¡£¸Ãµç·ºÜºÃµÄʵÏÖÁËÎÞË¢µç»úµÄÆô¶¯¡¢Í£Ö¹¼°×ªËÙ¿ØÖÆÄܹ¦ÄÜ¡£´ïµ½ÁËÔ¤ÆÚЧ¹û¡£
ͼ27 ʵÎïͼ
18