PC »úһ̨£¬TD-ACC+ʵÑéϵͳһÌ×
ʵÑéÄÚÈÝ
ÓÃÁÙ½ç±ÈÀý´ø·¨Õû¶¨PID¿ØÖÆÆ÷²ÎÊý¼°»ý·Ö·ÖÀëÖµµÄÄ£ÄâʵÑéѡȡ¡£
ʵÑéÔÀí
1£®ÔÀí
Èçͼ5¡ª1£¬RΪÊäÈ룬CΪÊä³ö£¬¼ÆËã»ú²»¶Ï²ÉÈëÎó²îE£¬½øÐлý·ÖÅбðÓëPIDÔËË㣬ȻºóÅнá¹ûÊÇ·ñÒç³ö£¨ÈôÒç³öÔòÈ¡×î´ó»ò×îСֵ£©£¬×îºó½«¿ØÖÆÁ¿ÊäË͸øÏµÍ³¡£
P R + E + + I + ¨C D ?TSC 501?e (0.2S?1)(0.25S?1)S ͼ5¡ª1
de(t)]¡£
0dte£¨t£©Îª¿ØÖÆÆ÷ÊäÈ룻U£¨t£©Îª¿ØÖÆÆ÷Êä³ö¡£ÓþØÕó·¨Ëã»ý·Ö£¬ÓÃÏòºó²î·Ö´úÌæÎ¢·Ö£¬²ÉÑùÖÜÆÚΪT£¬Ë㷨Ϊ£º
PID¿ØÖƹæÂÉΪ£º
1U(t)?KP[e(t)?TI? te£¨t£©?TU(t)?KP{E(K)?TI?E(i)?i?1KKTD[E(K)?E(K?1)]}TK?T?KP?E(K)?PTIKKP?TDE(i)?[E(K)?E(K?1)]?Ti?1i
¼ò¼ÇΪ£ºUK?P?EK?I?Ei?1?D?(EK?EK?1)
P¡¢I¡¢D·¶Î§Îª£º-0.9999~+0.9999£¬¼ÆËã»ú·Ö±ðÓÃÏàÁÚÈý¸ö×Ö½Ú´æ´¢ÆäBCDÂë¡£
×îµÍ×Ö½Ú´æ·ûºÅ£¬00HΪÕý£¬01HΪ¸º¡£Öмä×Ö½Ú´æÇ°2λСÊý£¬×î¸ß×Ö½Ú´æÄ©2λСÊý¡£ÀýÓÐϵÊýPΪ0.1234£¬IΪ0.04Ã룬DΪ0¡£
¼ÆËã»ú´æÓгõʼ»¯³ÌÐò£¬°ÑÊ®½øÖÆÐ¡Êýת»»³É¶þ½øÖÆÐ¡Êý£¬Ã¿¸öСÊýÓÃÁ½¸ö×Ö½Ú±íʾ¡£ÔÚ¿ØÖƼÆËã³ÌÐòÖа´¶¨µãСÊý½øÐв¹ÂëÔËË㣬¶ÔÔËËã½á¹ûÓÐÒç³ö´¦Àí¡£µ±ÔËËã½á¹û³¬³ö00H»òFFHʱÔòÓü«Öµ00H»òFFH×÷Ϊ¼ÆËã»ú¿ØÖÆÊä³ö£¬ÔÚÏàÓ¦µÄÄÚ´æÖÐÒ²´æÈëÏàÓ¦µÄ¼«Öµ00H»òFFH¡£
»ý·ÖÔËËãÒ²ÉèÓÐÒç³ö´¦Àí£¬µ±»ý·ÖÔËËãÒç³öʱ¿ØÖÆÁ¿Êä³ö¼«Öµ£¬ÏàÓ¦ÄÚ´æÖÐÒ²´æÈ뼫ֵ¡£¼ÆËã»ú»¹ÓÃ2F00HÄÚ´æµ¥ÔªËù´æµÄÊýÖµ×÷Ϊ»ý·ÖÔËËãÅж¨ÖµEI£¬Îó²îEµÄ¾ø¶ÔֵСÓÚEIʱ»ý·Ö£¬´óʱ²»»ý·Ö¡£EIµÄȡֵ·¶Î§£º00H~7FH¡£
¿ØÖÆÁ¿UKÊä³öÖÁD/A£¬·¶Î§£º00H~FFH£¬¶ÔÓ¦¨C5V~+4.96V £¬Îó²îEÄ£È뷶ΧÓë´Ë
30
Ïàͬ¡£
2£®¶¨µ÷½Ú²ÎÊýÓëϵͳ¿ª»·ÔöÒæ
¿ÉÓÃÁÙ½ç±ÈÀý´ø·¨Õû¶¨²ÎÊý¡£Éè²ÉÑùÖÜÆÚΪ50ms£¬ÏÈÈ¥µô΢·ÖÓë»ý·Ö×÷Óã¬Ö»±£Áô±ÈÀý¿ØÖÆ£¬Ôö´óKP£¬Ö±ÖÁϵͳµÈ·ùÕñµ´£¬¼ÇÏÂÕñµ´ÖÜÆÚTUºÍÕñµ´Ê±ËùÓñÈÀýÖµKPU£¬°´ÒÔϹ«Ê½Õû¶¨²ÎÊý¡£
TÈ¡TU ±ÈÀýKP?0.27KPU£¨¼´P?0.27KPU£©
»ý·Öʱ¼äTI?0.4TU£¨¼´ I?16KP?T?0.11KPU£© TI΢·Öʱ¼äTD?0.22TU£¨¼´D?KP?TD?0.36KPU£© TPIDϵÊý²»¿É¹ýС£¬ÒòΪÕâ»áʹ¼ÆËã»ú¿ØÖÆÊä³öÒ²½ÏС£¬´Ó¶øÊ¹ÏµÍ³Á¿»¯Îó²î±ä´ó£¬ÉõÖÁÓÐʱ¿ØÖÆÆ÷¸ù±¾ÎÞÊä³ö¶øÐγÉËÀÇø¡£Õâʱ¿É½«Ä£Äâµç·¿ª»·ÔöÒæÊʵ±¼õС£¬¶øÊ¹PIDϵÊý±ä´ó¡£Àý£ºPIDÈý¸öϵÊý¶¼Ð¡ÓÚ0.2£¬Ä£Äâµç·¿ª»·ÔöÒæ¿É±äΪK/5£¬PIDϵÊýÔò¶¼ÏàÓ¦Ôö´ó5±¶¡£ÁíÒ»·½ÃæPIDϵÊý²»¿ÉµÈÓÚ1£¬ËùÒÔÕû¸öϵͳ¹¦ÂÊÔöÒæ²¹³¥ÊÇÓÉÄ£Äâµç·ʵÏÖ¡£ÀýÈçÈôÏëÈ¡P=5.3£¬¿ÉÈ¡0.5300ËÍÈ룬ģÄâµç·¿ª»·ÔöÒæÒàÏàÓ¦Ôö´ó10±¶¡£
3£®½ÓÏßÓëÏß·ÔÀí
ͼ5¡ª2
4£®²ÉÑùÖÜÆÚT
¼ÆËã»ú8253²úÉú¶¨Ê±Ðźţ¬¶¨Ê±10ms£¬²ÉÑùÖÜÆÚTΪ£ºT=TK¡Á10ms
TKÊÂÏÈËÍÈë2F60Hµ¥Ôª£¬·¶Î§ÊÇ01H~FFH£¬Ôò²ÉÑùÖÜÆÚTµÄ·¶Î§Îª10ms~2550ms¡£°´TU¼ÆËã³öµÄTÈç¹û²»ÊÇ10msµÄÕûÊý±¶£¬¿ÉÒÔÈ¡Ïà½üµÄTK¡£
ʵÑé²½Öè
1£®°´Í¼5¡ª2½ÓÏߣ¬Ä£Äâµç·²¿·ÖÓë¼ÆËã»ú²¿·Ö·Ö¿ªÁ¬½Ó£¬´ýÄ£Äⲿ·Ö²ÎÊýÕû¶¨ºÃºó
31
ÔÙÁ¬½Ó¡£ÏÈÕû¶¨µÚÒ»¸ö¹ßÐÔ»·½Ú£¬Ê¹µÃʱ¼ä³£Êý¡¢·Å´ó±¶Êý·ûºÏÊýѧģÐÍÒªÇ󣬵ڶþ¸ö¹ßÐÔ»·½Ú£¬Í¬ÑùʹµÃ²ÎÊý´ïµ½ÒªÇó¡£
2£®´ò¿ª×îСÅijÌÐòC:\\shiyan\\jffl.asm¡£ 3£®±àÒë¡¢Á´½Ó¡¢¼ÓÔØ³ÌÐò¡£
4£®ÐźÅÔ´Öý×Ô¾Ðźţ¬Ðźų¤¶ÈΪ5S¡¢·ùֵΪ2.5V¡£
5£®³ÌÐò¿ªÍ·µÄÊý¾Ý¸³ÖµÓï¾äÐÞ¸ÄKP£¬¿ªÊ¼Ê±¿ÉÈÎÈ¡£¬ÈçÈ¡KP=0.6¡£ 6£®ÔËÐгÌÐò£¬ÓÃÐéÄâʾ²¨Æ÷¹Û²ìÊä³ö¡£
7£®Ñ¡²»Í¬µÄKP£¬Öظ´5¡¢6£¬Ö±ÖÁµÈ·ùÕñµ´£¬¼ÇÏÂTUÓëKPU£¬TUÌîÈë±í5¡ª1Éϲ¿¡££¨ÈçKPÈ¡0.99ÈÔ²»Õñµ´ÔòÓ¦Ôö´ó²ÉÑùÖÜÆÚ»òÔö´óÄ£Äâµç·ÔöÒæ£¬Ôö´óÔöÒæ¿Éµ÷Õûͼ5¡ª2ÖÐ500Kµç×裩¡£
8£®¸ù¾ÝÁÙ½ç±ÈÀý´ø·¨¼ÆËãPIDÈý²ÎÊý£¬¶Ô³ÌÐò¿ªÍ·µÄÊý¾Ý¸³ÖµÓï¾ä½øÐÐÐ޸쬻ý·Ö·ÖÀëÖµEIÈ¡7FH£¬ÔÚÊäÈëRΪÁãʱÆô¶¯³ÌÐò£¬¶ÔÕÕÊäÈëR¹Û²ìÊä³öC£¬ÓÃʾ²¨Æ÷²â³öMP¡¢ts¡£
9£®¸Ä±ä»ý·Ö·ÖÀëÖµEI£¬¶Ô³ÌÐò¿ªÍ·µÄÊý¾Ý¸³ÖµÓï¾ä½øÐÐÐ޸ģ¬ÔÚÊäÈëΪÁãÊ±ÖØÐÂÆô¶¯³ÌÐò£¬¶ÔÕÕÊäÈëR¹Û²ìÊä³öC£¬¿´Mp¡¢tsÓÐÎÞ¸ÄÉÆ£¬²¢¼Ç¼Mp¡¢ts²ÎÊý¡£
10£®¸ù¾ÝPIDÈý¸öϵÊýµÄ²»Í¬¿ØÖÆ×÷Óã¬Êʵ±¼ÓÒÔµ÷Õû£¬Í¬Ê±¿ÉÅäºÏ¸Ä±äEIÖµ£¬ÔÚÊäÈëΪÁãʱÆô¶¯³ÌÐò£¬¶ÔÕÕÊäÈëR¹Û²ìÊä³öC¡£¼Ç¼Mp¡¢ts²ÎÊýÖµ¡£
11£®°´ÉÏÊö·½·¨Öظ´×ö¼¸´Î£¬Ö±µ½Ê¹M p < 20% £¬ts < 1S£¬ÔÚ±í5¡ª1¢óÀ¸ÖÐÌîÈë´ËʱËùÓø÷²ÎÊýÓë½á¹û¡£
12£®Óñí5¡ª1¢óÀ¸PID²ÎÊý£¬µ«»ý·Ö·ÖÀëÖµ¸ÄΪ7FH£¬ÔÚÊäÈëRΪÁãʱÆô¶¯³ÌÐò£¬½«²ÎÊýÓë½á¹ûÌîÈë±í5¡ª1¢ôÀ¸ÄÚ¡£
T= 05H K pu= T u=
±í5¡ª1
²Î Êý Ïî Ä¿ ¢ñÓÃÁÙ½ç±ÈÀý·¨Õû¶¨²ÎÊý ¢ó½Ï¼ÑµÄPID¿ØÖƲÎÊý EI 7F P I D Mp ts ¢òÓâñÀ¸PID²ÎÊý£¬µ«EIÐÞ¸Ä 30 ¢ôÓâóÀ¸PID²ÎÊý£¬EIΪ7FH 7F
Ԥϰ±¨¸æÒªÇó
1£®ÊìϤ»ý·Ö·ÖÀëPIDËã·¨¼°ÓÃÁÙ½ç±ÈÀý´ø·¨Õû¶¨²ÎÊýµÄÀíÂÛ·½·¨¡£ 2£®Ð´³öԤϰ±¨¸æ£¬²¢ÔÚԤϰ±¨¸æÖлشð˼¿¼Ìâ¡£
˼¿¼Ìâ
1. µ±»ý·ÖÅж¨ÖµÈ¡×î´óֵʱ£¬»¹ÊÇ»ý·Ö·ÖÀëʽ¿ØÖÆÂð£¿ÈôÈ¡×îÐ¡ÄØ£¿ 2. ÊÔ·ÖÎö±ÈÀý¿ØÖÆ¡¢Î¢·Ö¿ØÖÆ¡¢»ý·Ö¿ØÖÆÔÚϵͳÖеĿØÖÆ×÷Óá£
ʵÑ鱨¸æÒªÇó
1£®ÕûÀíʵÑéÊý¾Ý£¬×ܽá³ÌÐòµ÷ÊÔ¹ý³Ì¡£
2£®¶ÔʵÑé½á¹û½øÐзÖÎö£¬ÊÇ·ñÓëÀíÂÛ¼ÆËãÏàÒ»Ö¡£
32
3£®¶ÔʵÑéÌá³ö¸Ä½ø¡£
ʵÑéÁù ´óÁÖËã·¨¿ØÖÆ
ʵÑéÄ¿µÄ
1£®ÕÆÎÕ´óÁÖËã·¨µÄD£¨Z£©Éè¼Æ¡£
33
2£®Á˽âÕñÁåµÄ²úÉú²¢ÕÆÎÕ´óÁÖËã·¨Ïû³ýÕñÁåµÄ·½·¨¡£
ʵÑéÉ豸
PC »úһ̨£¬TD-ACC+ʵÑéϵͳһÌ×
ʵÑéÄÚÈÝ
1. ¶Ô¸ø³öµÄ´ø´¿ÖͺóµÄÄ£Äâ¶ÔÏó£¬Õë¶Ô½×Ô¾ÊäÈë½øÐдóÁÖËã·¨µÄD£¨Z£©Éè¼Æ£¬¹Û²âϵͳÊä³ö¼°¿ØÖÆÆ÷Êä³ö²¨ÐΡ£
2. ¹Û²ì¿ØÖÆÆ÷Êä³öÕñÁåÏÖÏó²¢ÐÞ¸ÄD£¨Z£©Ö±ÖÁÏû³ý¡£
ʵÑéÔÀí
¶ÔÓÚһЩ¹¤ÒµÖдóÁ¿´æÔÚÓд¿ÖͺóÌØÐÔµÄϵͳ£¬ÓÃPID¿ØÖÆÐ§¹û²»ºÃ£¬²ÉÓôóÁÖË㷨Ч¹û½ÏºÃ¡£ÊµÑéÄ£ÄâÁ˺¬Óд¿ÖͺóÒ»¸ö²ÉÑùÖÜÆÚTµÄϵͳ£¬D£¨Z£©Ëã·¨ÊÇͬÓÃÐÎʽ£¬¶ÔÓÚ¿ÉÄܳöÏֵĿØÖÆÊä³öÕñÁåÏÖÏ󣬿ÉÒÔÐÞ¸ÄD£¨Z£©È¥Ïû³ý¡£
1. ʵÑé¶ÔÏó
Èçͼ6¡ª1£¬ÖͺóÒ»ÅÄÓɲÉÑù±£³ÖÆ÷ÑÓʱһÅÄÊäÈëÄ£ÄâÁ¿ÊµÏÖ¡£
?TS R + 1?e?TSC 10eD(Z) SS?1 -
ͼ6¡ª1
²ÉÑùÖÜÆÚT=0.2S£¬´óÁÖËã·¨µÄÉè¼ÆÄ¿±êÊÇʹÕû¸ö±Õ»·ÏµÍ³ËùÆÚÍûµÄ´«µÝº¯Êý¦µ£¨s£© £¬
e?TSÏ൱ÓÚÒ»¸ö´¿Öͺ󻷽ںÍÒ»¸ö¹ßÐÔ»·½ÚÏà´®Áª£¬¼´£º?(S)?¡£Ê½ÖÐ?=0.1Ãë¡£
?S?12. D£¨Z£©Ëã·¨
E£¨Z£©Îª¼ÆËã»úÊäÈ룬U£¨Z£©ÎªÊä³ö£¬ÓУº
U(Z)K0?K1Z?1?K2Z?2?K3Z?3? D(Z)? £¨6-1£© E(Z)1?P1Z?1?P2Z?2?P3Z?3ʽÖÐKiÓëPiȡֵ·¶Î§£º¨C0.9999~+0.9999£¬¼ÆËã»ú·Ö±ðÓÃÏàÁÚÈý¸ö×Ö½Ú´æ´¢ÆäBCDÂë¡£
×îµÍ×Ö½Ú´æ·ûºÅ£¬00HΪÕý£¬01HΪ¸º¡£Öмä×Ö½Ú´æÇ°2λСÊý£¬×î¸ß×Ö½Ú´æÄ©2λСÊý¡£ÀýÓÐϵÊýK0??0.1234£¬Ôò³ÌÐòÖÐÊý¾Ý¶Î¶¨ÒåÓï¾äΪ£ºK0 DB 01H£¬12H£¬34H¡£
³ÌÐòÔËÐÐʱת»»Îª¶þ½øÖÆÄ£2¶¨µãСÊý¡£×¢Ò⣬D£¨Z£©ÖÐȱÏîÏ൱ÓÚϵÊýΪÁ㣬ӦÔÚÏàÓ¦ÄÚ´æÈý×Ö½ÚÈ«´æÈë00H¡£
½«D£¨Z£©Ê½Ð´³É²î·Ö·½³Ì£¬ÔòÓУº
UK?K0EK?K1EE?1?K2EK?2?K3EK?3?P1UK?1?P2UK?2?P3UK?3 ʽÖÐEK ~ EK-3£¬Îó²îÊäÈ룻UK ~ UK-3 £¬¼ÆËã»úÊä³ö¡£
¼ÆËã»úÔËË㻹ÉèÓÐÒç³ö´¦Àí£¬µ±¼ÆËã»ú¿ØÖÆÊä³ö³¬¹ý00H~FFHʱ£¨¶ÔÓ¦ÓÚÄ£ÄâÁ¿-5V~+5V£©£¬Ôò¼ÆËã»úÊä³öÏàÓ¦µÄ¼«Öµ00H»òFFH£¬Í¬Ê±ÔÚÏàÓ¦µÄÄÚ´æµ¥ÔªÒ²´æÈ뼫ֵ¡£
3. ²ÉÑùÖÜÆÚT
8088΢»úµÄ8253²úÉú¶¨Ê±Ðźţ¬¶¨Ê±10ms£¬²ÉÑùÖÜÆÚTΪ£º T=TK¡Á10ms
¶ÔÓ¦·¶Î§£º10ms~2550ms¡£ÊµÑéÈ¡T=0.2S=20¡Á10ms£¬TK=20=14H¡£ 4. ½ÓÏߣ¨Èçͼ6¡ª2Ëùʾ£©
34