Êý×ÖPID¿ØÖÆÆ÷µÄFPGAʵÏÖÓë·ÂÕæ ÏÂÔØ±¾ÎÄ

ÁúÔ´ÆÚ¿¯Íø http://www.qikan.com.cn

Êý×ÖPID¿ØÖÆÆ÷µÄFPGAʵÏÖÓë·ÂÕæ

×÷ÕߣºÐí¹úºê ËÎÕ÷ ÍõÒ«ÀÚ

À´Ô´£º¡¶µçÄÔ֪ʶÓë¼¼Êõ¡·2015ÄêµÚ11ÆÚ

ÕªÒª£º¸ù¾ÝÔöÁ¿Ê½PID¿ØÖÆÆ÷µÄ¹¤×÷Ô­Àí£¬Éè¼ÆÁËÒ»ÖÖ»ùÓÚFPGAµÄÊý×ÖPID¿ØÖÆÆ÷£¬²ÉÓÃFPGA²¢Ðнṹ£¬Ê¹ÓÃ×Ô¶¥ÏòϵÄÉè¼Æ·½·¨Íê³ÉÁË¿ØÖÆÆ÷µÄVHDL·Ö²ãÉè¼Æ£¬×îÖÕʵÏÖÁ˶ԿØÖÆÁ¿µÄ¾«È·¿ØÖÆ¡£¾­¹ý·ÂÕæ²âÊÔ±íÃ÷£¬¸ÃÉè¼Æ·½°¸ÓÐЧ¿ÉÐУ¬²¢ÇÒ¾ßÓнṹ¼òµ¥¡¢ÐÔÄܿɿ¿¡¢¿ØÖÆÐ§¹ûÁ¼ºÃ¼°ÊµÓÃÐÔÇ¿µÈÓŵ㡣

¹Ø¼ü´Ê£ºPID¿ØÖÆÆ÷£»FPGA£»Êý×ÖËøÏà»·£»

ÖÐͼ·ÖÀàºÅ£ºTN911.23 ÎÄÏ×±êʶÂ룺A ÎÄÕ±àºÅ£º1009-3044£¨2015£©11-0229-02 FPGA Implementation and Simulation of Digital PID Controller XU Guo-Hong£¬ SONG Zheng£¬ WANG Yao-Lei

£¨China Research Institude of Radio Wave Propagation£¬ QingDao 266107£¬ China£© Abstract£º According to the working principle of incremental PID controller£¬a kind of Digital PID Controller based on FPGA is designed£¬and using the FPGA parallel structure£¬The top-down design methodology is used to complete the controller VHDL layered design£¬Finally realized the precise control of control quantity¡£Through simulation tests show that the design scheme is effective and feasible£¬and has the advantages of simple structure¡¢reliable performance¡¢good control effect and strong practicability etc.

Key words£º PID controller£» FPGA£» DPLL

PID¿ØÖÆËã·¨ÊÇÒ»ÖÖ¼òµ¥ÓÐЧµÄ¿ØÖÆËã·¨£¬ÒòÆäÓÐÔ­Àí¼òµ¥¡¢²ÎÊý¿Éµ÷¡¢Â³°ôÐԺᢿɿ¿ÐԸߡ¢ÊÊÓ¦ÐÔÇ¿µÈÓŵ㣬¶øÔÚ¹¤Òµ¿ØÖÆÁìÓòµÃµ½Á˹㷺µÄÓ¦Óã¬ÊÇĿǰ×Ô¶¯»¯¿ØÖƼ¼ÊõÖÐ×îÎȶ¨µÄ¿ØÖÆ·½·¨Ö®Ò»[[1]]¡£ÊµÏÖPID¿ØÖÆËã·¨ÓкܶàÖÖ·½·¨£¬±¾ÎIJÉÓÃFPGA²¢ÐнṹÀ´ÊµÏÖPID¿ØÖÆËã·¨£¬FPGA×îÃ÷ÏÔµÄÓÅÊÆÔÚÓÚ¼¯³É¶È¸ß£¬Ìå»ýС£¬¹¦ºÄµÍ£¬¿É¿¿ÐԸߺ͵ç·Éè¼Æ±È½ÏÁé»î¡£ 1 PIDËã·¨ 1.1 PIDËã·¨±í´ïʽ

ÁúÔ´ÆÚ¿¯Íø http://www.qikan.com.cn

PID¿ØÖÆÆ÷µÄºËÐÄ˼ÏëÊÇÕë¶Ô¿ØÖƶÔÏóµÄ¿ØÖÆÐèÇ󣬽¨Á¢ÃèÊö¶ÔÏó¶¯Ì¬ÌØÐÔµÄÊýѧģÐÍ£¬Í¨¹ýPID²ÎÊýÕû¶¨ÊµÏÖÔÚ±ÈÀý¡¢Î¢·Ö¡¢»ý·ÖÈý¸ö·½Ãæ²ÎÊýµ÷ÕûµÄ¿ØÖƲßÂÔÀ´´ïµ½×î¼ÑϵͳÏìÓ¦ºÍ¿ØÖÆÐ§¹û¡£ÍêÕûµÄPID¿ØÖƱí´ïʽÈçÏ£º [u£¨t£©=kp[e£¨t£©+1Ti0teTdde£¨t£©dt]]

ÆäÖУ¬[kp]Ϊ±ÈÀýÔöÒæ£¬[Ti]Ϊ»ý·Öʱ¼ä³£Êý£¬[Td]Ϊ΢·Öʱ¼ä³£Êý£¬[u£¨t£©]Ϊ¿ØÖÆÁ¿£¬[e£¨t£©]Ϊƫ²î¡£×ܵÄÀ´Ëµ£¬±ÈÀý¿ØÖÆÄÜÒýÆðϵͳѸËÙ·´Ó¦£¬´Ó¶ø¼õСÎÈ̬Îó²î£¬µ«ÊDZÈÀý·Å´óϵÊýµÄ¼Ó´ó£¬»áÒýÆðϵͳµÄ²»Îȶ¨£»»ý·Ö¿ØÖƵÄ×÷ÓÃÊÇ£¬Ö»ÒªÏµÍ³ÓÐÎó²î´æÔÚ£¬»ý·Ö¿ØÖÆÆ÷¾Í²»¶ÏµØ»ýÀÛ£¬Êä³ö¿ØÖÆÁ¿£¬ÒÔÏû³ýÎó²î£¬µ«»ý·Ö×÷ÓÃ̫ǿ»áʹϵͳ³¬µ÷¼Ó´ó£¬ÉõÖÁʹϵͳ³öÏÖÕñµ´£¬ÕâÖ÷Ҫȡ¾öÓë»ý·ÖϵÊýµÄ´óС£»Î¢·Ö¿ØÖÆ¿ÉÒÔ¼õС³¬µ÷Á¿£¬¿Ë·þÕñµ´£¬Ê¹ÏµÍ³µÄÎȶ¨ÐÔÌá¸ß£¬Í¬Ê±¼Ó¿ìϵͳµÄ¶¯Ì¬ÏìÓ¦ËÙ¶È£¬¼õСµ÷Õûʱ¼ä£¬¸ÄÉÆÏµÍ³µÄ¶¯Ì¬ÐÔÄÜ[[2]]¡£ ÔÚÊý×Ö¿ØÖÆÏµÍ³ÖбØÐë¶ÔPIDÂ˲¨Ëã·¨½øÐÐÀëÉ¢»¯¡£µ±²ÉÑùÖÜÆÚ×ã¹»¶Ìʱ£¬¿ÉÒÔÓÃÇóºÍ´úÌæ»ý·Ö¡¢ÓúóÏò²î·Ö´úÌæÎ¢·Ö£¬´Ó¶øµÃµ½Êý×ÖPIDËã·¨µÄʵÏÖÄ£ÐÍ[[3]]¡£Êý×ÖÔöÁ¿Ê½PID±í´ïʽÈçÏ£º

[u£¨k£©=u£¨k-1£©+£¨kp+ki+kd£©e£¨k£©-£¨kd+2kd£©e£¨k-1£©+kde£¨k-2£©]£» ¿ØÖÆÁ¿ÔöÁ¿Îª£º

[¦¤u=u£¨k£©-u£¨k-1£©=Kae£¨k£©+Kbe£¨k-1£©+Kce£¨k-2£©]

´ÓÉÏʽ¿ÉÒÔ¿´³öÔöÁ¿Ê½PIDËã·¨Ö»ÓëǰÈý´Î²ÉÑùÖµÓйأ¬²»ÐèÒª´óÁ¿µÄÊý¾Ý´æ´¢ºÍÀÛ¼Ó£¬Òò¶ø²»Ò×ÒýÆðÎó²îÀÛ»ý£¬¾ßÓмÆËãÁ¿Ð¡¡¢ÊµÊ±ÐԸߵÄÓŵ㡣 1.2 PIDËã·¨Ó¦ÓÃ

Êý×ÖËøÏ໷ϵͳ£¨DPLL£©ÓÉÊý×Ö¼øÏàÆ÷¡¢Êý×Ö»·Â·Â˲¨Æ÷ºÍDACµÈ²¿·Ö×é³É£¬ÆäÖÐÊý×Ö»·Â·Â˲¨Æ÷ÊÇDPLL×îºËÐĵIJ¿·Ö£¬Ö÷ҪʵÏÖ´ÓÏàλÎó²îµ½¿ØÖƵçѹÔöÁ¿±ÈÌØ×ÖµÄת»»[[4]]¡£ÎªÁËʹÊý×Ö»·Â·Â˲¨Æ÷¾ßÓм«¼ÑµÄϵͳÏìÓ¦ºÍ¿ØÖÆÐ§¹û£¬PID¿ØÖÆËã·¨ÊǽϺõÄÑ¡Ôñ£¬»ùÓÚPID¿ØÖÆÏµÍ³µÄËøÏà»·½á¹¹Èçͼ1Ëùʾ¡£

ͼ1 »ùÓÚPIDËã·¨µÄËøÏà»·½á¹¹

ËøÏ໷ϵͳÖУ¬Êý×Ö¼øÏàÆ÷±È½ÏÊäÈëÆµÂÊÓëÊä³öƵÂʵÄÏàλ²î[e£¨k£©]£¬×÷ΪPID¿ØÖÆÆ÷µÄÊäÈëÆ«²îÐźţ¬ÔÚÑ¡¶¨±ÈÀý-΢·Ö-»ý·ÖϵÊý[kp]¡¢[ki]¡¢[kd]ºó¾­PIDÔËË㣬²úÉúÆ«²î¿ØÖÆÐźÅ[u£¨k£©]£¬×îºó¾­¹ýD/Aת»»Æ÷°ÑÊý×ÖÏà²îת»»³ÉÄ£ÄâµçѹÐźţ¬Êä³ö¸ø±»¿Ø¶ÔÏóѹ¿ØºãÎÂÕñµ´Æ÷¡£

ÁúÔ´ÆÚ¿¯Íø http://www.qikan.com.cn

2 PIDµÄFPGAʵÏÖ 2.1 PIDµÄFPGAʵÏֽṹ

PIDËã·¨ÔÚFPGAÖпÉÒÔͨ¹ý´®Ðнṹ¡¢²¢ÐнṹµÈ·½·¨ÊµÏÖ¡£´®ÐÐʵÏÖ·¨½á¹¹¼òµ¥£¬Ö»Óõ½Ò»¸ö³Ë·¨Æ÷ºÍ¼Ó·¨Æ÷£¬ËùÐèÒªµÄ×ÊÔ´×îÉÙµ«ËÙ¶ÈÒ²×îÂý£»¶ø²¢ÐÐʵÏÖ·½·¨µÄ»ù±¾Ë¼ÏëÊÇÒÔÃæ»ý»»È¡ËÙ¶È£¬ÆäÌØµãÊÇÓµÓнϿìµÄÔËËãËÙ¶È£¬µ«ËùÐèÒªµÄ×ÊÔ´±È½Ï¶à¡£

±¾´ÎPID¿ØÖÆÆ÷ÒªÓ¦Óõ½Êý×ÖËøÏ໷ϵͳÖУ¬ËùÒÔ±ÊÕßÉè¼Æ²ÉÓÃÔËËãËÙ¶È¿ìµÄ²¢Ðнṹ£¬ÓÃÁËÈý¸ö¼Ó·¨Æ÷ºÍÈý¸ö³Ë·¨Æ÷À´ÊµÏÖ[[5]]¡£²¢ÐнṹÈçͼ2Ëùʾ£¬ÆäÖмĴæÆ÷ÓÃÓÚËø´æÆ«²îÐźŻòÊä³öÐźŵijõʼֵºÍÖмäÖµ¡£

ͼ2 PIDËã·¨²¢ÐÐʵÏֽṹ 2.2 PID²ÎÊýÑ¡Ôñ

¶ÔÓÚPID¿ØÖÆÆ÷À´Ëµ£¬ÈçºÎÑ¡Ôñ±ÈÀý-΢·Ö-»ý·ÖϵÊý[kp]¡¢[ki]¡¢[kd]ÊÇÉè¼ÆµÄ¹Ø¼ü£¬ÕâÈý¸ö²ÎÊýµÄÑ¡Ôñ¶Ô»·Â·ÏµÍ³µÄ¶¯Ì¬ÐÔÄÜ¡¢ÎÈ̬ÐÔÄÜÒÔ¼°Îȶ¨ÐÔ¶¼ÆðÖÁ¹ØÖØÒªµÄ×÷Ó᣸ù¾Ý¿ØÖÆÏµÍ³¶Ô»·Â·´ø¿í¡¢×èÄáϵÊýµÈÖ¸±êµÄÒªÇó£¬ÒÔ¼°¿¼ÂÇ»·Â·ÏµÍ³Æ÷¼þ±¾ÉíÌØÐÔ£¬¿ÉÒÔ¼ÆËãÑ¡ÔñÊʵ±µÄPIDÂ˲¨Æ÷×÷Ϊ´Öµ÷²ÎÊý£¬ÔÙͨ¹ý·ÂÕæºÍʵ¼Êµ÷ÊԵõ½½øÒ»²½²ÎÊý£¬ÒÔ»ñµÃ±È½ÏÍêÉÆµÄ¿ØÖÆÇúÏß[[6]]¡£

Êý×ÖËøÏ໷ϵͳµÄÊäÈëÆµÂÊuiºÍÊä³öƵÂÊupfÔÚ¼øÏ๦ÄÜÄ£¿éjianxiangÖвúÉú³¬Ç°¨CÖͺóÐźÅupºÍdown£¬Èçͼ3Ëùʾ£¬µ±ui³¬Ç°upfʱ£¬upÊä³ö¿í¶ÈÕý±ÈÓÚÏàλÎó²îµÄÂö¿í¸ßµçѹ£»¶øµ±uiÖͺóupfʱ£¬downÊä³ö¿í¶ÈÕý±ÈÓÚÏàλÎó²îµÄÂö¿í¸ßµçѹ¡£ÔÚÁ¿»¯¹¦ÄÜÄ£¿élianghuaÖУ¬¼ÆÊýʱÖÓ¶ÔÏàλÎó²î½øÐÐÊý×ÖÁ¿»¯²¢²úÉúÆ«²îÐźÅ[e£¨k£©]£¬Æ«²î¼°²ÎÊý²úÉúÈçͼ4Ëùʾ¡£¸ù¾ÝËøÏ໷ϵͳ¶Ô»·Â·´ø¿í¡¢×èÄáϵÊýµÄÒªÇ󣬱ÊÕßÑ¡Ôñ±ÈÀý-»ý·Ö-΢·Ö´Öµ÷²ÎÊýÈçÏ£º[kp=29]¡¢[ki=0.97]¡¢[kd=1.07]£¬¾­¼ÆËãµÃ[Ka=31.04]¡¢[Kb=-31.14]¡¢[Kc=1.04]¡£

ͼ3 ³¬Ç°-ÖͺóÐźŲúÉúͼ

ͼ4 Æ«²î¼°²ÎÊý²úÉúͼ

ÓÉÓÚFPGAÖ»ÄܽøÐÐÕûÊýÔËË㣬ËùÒÔÔËËãʱÐèÒª½«ÊµÊýת»»³ÉÕûÊý£¬¼´½«ÏµÊýÀ©´óN±¶£¬×îºóÊä³öʱÔٰѽá¹ûËõСN±¶¡£±¾´ÎÉè¼ÆÑ¡Ôñ½«ÏµÊýÀ©´ó[27]±¶£¬×îºó¶ÔÓÚFPGAÀ´Ëµ£¬ÉáÆ÷Æú×îµÍ7λµÄÊý¾Ý¼´¿É×÷ΪÊä³öÐźš£Í¬Ê±£¬Òª¶ÔϵÊý½øÐÐÀ©Õ¹£¬ÔÚϵÊý×î¸ßλÔö¼ÓÒ»¸ö