»ùÓÚSTM32µÄÖ±Á÷ÎÞË¢Î޸еç»úµÄ¿ØÖÆÏµÍ³Ñо¿ ÏÂÔØ±¾ÎÄ

Ö±Á÷ÎÞË¢µç»ú¿ØÖÆÏµÍ³Éè¼ÆÓëʵÏÖ

ͼ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