摘 è¦ï¼šé‡å°æ•¸æŽ§æŠ€è¡“ä¸çš„åŒæ¥æŽ§åˆ¶è¦æ±‚,è¨è¨ˆäº†ä¸€ç¨®åŸºäºŽPC工控機的ä½ç½®ä¼ºæœåŒæ¥æŽ§åˆ¶ç³»çµ±ï¼Œå¹¶æè¿°äº†å…¶æŽ§åˆ¶è»Ÿä»¶çš„è¨è¨ˆæ–¹æ³•åŠé—œéµæŠ€è¡“。
é—œéµè©žï¼šå·¥æŽ§æ©Ÿï¼›ä½ç½®æŽ§åˆ¶ï¼›é•·é§å…§å˜;é›»æµæ¼‚移
ç•¶å‰ï¼Œç²¾å¯†åŒ–ã€è‡ªå‹•åŒ–ã€æ™ºèƒ½åŒ–和柔性化是數控技術的發展方å‘ã€‚å…¶é—œéµæŠ€è¡“ä¹‹ä¸€çš„å¤šè»¸è¯å‹•數控技術,日益引起國內外有關å¸è€…的普éé‡è¦–å’Œå»£æ³›ç ”ç©¶ã€‚ä½†æ˜¯å¦‚ä½•æ›´æ–¹ä¾¿åœ°å¯¦ç¾é«˜ç²¾åº¦ã€é«˜æ•ˆçއã€é«˜æŸ”性的多軸è¯å‹•還是一個有待繼續探索的課題。目å‰ï¼Œå¤šè»¸è¯å‹•系統大多采用主從å¼çµæ§‹ï¼Œä¸»æ©Ÿå®Œæˆç³»çµ±çš„管ç†å’Œç”¢ç”ŸæŒ‡ä»¤ï¼Œè€Œå„軸控制則由å„å–®ç¨å¾žæ©ŸæŽ§åˆ¶å–®å…ƒå®Œæˆ[1,2]。以PCå·¥æŽ§æ©Ÿç‚ºæ ¸å¿ƒçš„æŽ§åˆ¶ç³»çµ±ï¼Œé›†ç®¡ç†èˆ‡æŽ§åˆ¶ç‚ºä¸€é«”,é‹ç”¨PCL833ã€PCL728兩塊功能æ¿ï¼Œå¯åŒæ™‚實ç¾2臺伺æœé›»æ©Ÿé–“åŒæ¥å‚³å‹•的柔性化控制 ,使之滿足數控機床的多軸è¯å‹•è¦æ±‚。
1ç³»çµ±æ•´é«”çµæ§‹
ç³»çµ±æ•´é«”çµæ§‹ç°¡åœ–,如圖1所示。本系統的控制回路分數å—和模擬部分2部分,數å—部分由1臺PCå·¥æŽ§æ©Ÿå’Œå…©å¡Šç¡¬ä»¶åŠŸèƒ½æŽ¥å£æ¿çµ„æˆã€‚PC工控機主è¦å®Œæˆ2臺電機的ä½ç½®æŽ§åˆ¶èª¿ç¯€é‹ç®—;硬件功能æ¿1為計數器,實ç¾å°å…©ä¼ºæœé›»æ©Ÿå饋脈沖的檢測ã€å€é »è¾¯ç›¸å’Œè¨ˆæ•¸åŠŸèƒ½ï¼›ç¡¬ä»¶åŠŸèƒ½æ¿2為D/Aæ¿ï¼Œå¯¦ç¾å°2臺伺æœé›»æ©Ÿçš„æŽ§åˆ¶ã€‚
2 硬件接å£é›»è·¯
PCL833æ˜¯ç”±ç ”è¯å…¬å¸ç”Ÿç”¢çš„24ä½å¯é€†è¨ˆæ•¸å™¨[3],是專為ä½ç½®å’Œé€Ÿåº¦æŽ§åˆ¶è¨è¨ˆçš„è¨ˆæ•¸å™¨æŽ¥å£æ¿ï¼Œèƒ½å¤ å°æ£äº¤è¼¸å…¥å’Œæ•¸å—輸入進行計數,具有如下特點:
(1) 3個24ä½å¯é€†è¨ˆæ•¸å™¨ï¼›
(2) æœ€å¤§è„ˆæ²–è¼¸å…¥é »çŽ‡2.4MHzï¼›
(3) 計數方å¼ç‚ºè„ˆæ²–/æ–¹å‘計數和æ£åå‘計數;
(4) *1ã€ï¼Š2ã€ï¼Š4 3種å€é »æ–¹å¼ï¼›
(5) 具有å°9個ä¸åŒä¸æ–·æºä¸æ–·æŽ§åˆ¶ï¼›
(6) 光電隔離最大能é”到2500Vï¼›
(7) 4ç´šæ•¸å—æ¿¾æ³¢ï¼›
(8) å¯ç·¨ç¨‹ä¸æ–·æ™‚é–“ï¼›
(9) é©åˆIBM PC/AT 和兼容機(ISA總線)。
3個24ä½å¯é€†è¨ˆæ•¸å™¨æ—¢å¯å–®ç¨ä½¿ç”¨ï¼Œä¹Ÿå¯ç´šè¯ä½¿ç”¨ã€‚最大å¯å¯¦ç¾48ä½è¨ˆæ•¸å™¨æ–¹å¼ã€‚并坿 ¹æ“šè¦æ±‚è¨ç½®ç‚ºå¢žé‡å¼å’Œçµ•å°å¼ã€‚å…·æœ‰æº¢å‡ºä¸æ–·å’Œæº¢å‡ºè¨ˆæ•¸ç‰åŠŸèƒ½ã€‚åœ¨æœ¬ç³»çµ±ä¸ï¼Œç‚ºä¿è‰è¨ˆæ•¸å™¨è®€æ•¸æº–確ã€ä¸ä¸Ÿæ¥ï¼Œé‡‡ç”¨äº†24ä½è¨ˆæ•¸æ–¹å¼ï¼ŒåŒæ™‚è¦æ±‚計數器進行絕å°å¼å¾ªç’°è¨ˆæ•¸ã€‚æŽ¥å£æ¿1å æœ‰è¨ˆç®—機連續16å€‹æ˜ å°„åœ°å€ï¼Œæ ¹æ“šPCè¨ˆç®—æ©Ÿæ˜ å°„åœ°å€çš„åˆ†é…æƒ…æ³ï¼Œè¨ç½®0X200~0X215連續16å€‹æ˜ å°„åœ°å€çµ¦è¨ˆæ•¸å™¨ã€‚
PCL728æ˜¯ç”±ç ”è¯å…¬å¸ç”Ÿç”¢çš„12ä½D/A轉æ›å™¨[4],該轉æ›å™¨é‡å°æƒ¡åŠ£çš„å·¥æ³è¨è¨ˆçš„12ä½é›™é€šé“D/A輸出å¡ã€‚æ¯ä¸€é€šé“完全光電隔離,并且ç¨ç«‹äºŽç³»çµ±åœ°ï¼Œå¯è¨ç½®ç‚ºä»¥ä¸‹èŒƒåœè¼¸å‡ºï¼š0~5Vã€0~10Vã€Â±5Vã€Â±10Vã€4~20mAã€0~20mAã€‚æ ¹æ“šä¼ºæœé›»æ©Ÿçš„æŽ§åˆ¶è¦æ±‚,è¨ç½®ç‚ºé›™æ¥µæ€§Â±10V輸出。D/Aè¼¸å‡ºå æœ‰4å€‹æ˜ å°„åœ°å€ï¼Œåˆ†åˆ¥ç‚º0x2c0ã€0x2c1ã€0x2c2å’Œ0x2c3 4個連續地å€ã€‚
伺æœé›»æ©ŸåŠå…¶é©…動系統采用日本安å·å…¬å¸çš„產å“,電機型號為BMH0955N11A1L,光電編碼器為伺æœé›»æ©Ÿéš¨æ©Ÿæ”œå¸¶ï¼Œ3072脈沖/轉。
3 PC機實時控制算法軟件è¨è¨ˆèˆ‡å¯¦ç¾
在本系統ä¸å¯¦ç¾2伺æœé›»æ©ŸåŒæ¥è·Ÿè¹¤çš„æŽ§åˆ¶ã€‚2é›»æ©Ÿåˆ†åˆ¥å®šç¾©ç‚ºä¸»é›»æ©Ÿå’Œå¾žé›»æ©Ÿï¼Œç”±è©²å·¥æŽ§æ©ŸåŒæ™‚完æˆå°2臺伺æœé›»æ©Ÿçš„æŽ§åˆ¶ã€‚
采用工控機ä¸çš„8253零計數器來實ç¾å®šæ™‚䏿–·ï¼Œå¹¶é€šéŽå…¶æŽ§åˆ¶çš„0x1cH䏿–·ç›¸é‡ä¸å®‰è£ä¸æ–·æœå‹™ç¨‹åºã€‚8253零計數器的默èªè¨ç½®ç‚ºæ¯ç§’產生18.2æ¬¡ä¸æ–·ï¼Œå³æ¯ç™¼ç”Ÿä¸€æ¬¡ä¸æ–·é–“隔周期為55msã€‚é€™æ¨£ï¼Œå¯æ ¹æ“šå…¬å¼interrupt——hige=sample——time×1193180%256000å’Œinterrupt——low=sample——time×1193180/256000ç²å¾—計數器é 置數,通éŽä¿®æ”¹è©²è¨ˆæ•¸å™¨é 置值,å¯ç²å¾—ä¸åŒçš„䏿–·æ™‚間。
整個系統軟件由2個模塊組æˆï¼šä½ç½®éŽ–å®šæ¨¡å¡Šå’ŒæŽ§åˆ¶æ¨¡å¡Šã€‚ç•¶ç³»çµ±é‡‡ç”¨äº†æ•¸æ¨¡æ··åˆçµæ§‹æ™‚,å³ä½¿æ²’æœ‰è¼¸å…¥ï¼Œä¹Ÿæœƒå› å„種干擾的å˜åœ¨ï¼Œå¼•起模擬電路ä¸ç”¢ç”Ÿé›»æµâ€œé›¶æ¼‚â€ï¼Œå¾žè€Œå°‡å½±éŸ¿åˆ°æŽ§åˆ¶æ•ˆæžœã€‚ä½ç½®éŽ–å®šæ¨¡å¡Šå³ç‚ºè§£æ±ºä¸Šè¿°å•題而è¨è¨ˆï¼Œè©²æ¨¡å¡Šçš„䏿–·æœå‹™ç¨‹åºèˆ‡æŽ§åˆ¶æ¨¡å¡Šçš„䏿–·æœå‹™ç¨‹åºå 有åŒä¸€ä¸æ–·ç›¸é‡ï¼Œé‹ç”¨TSR(Terminate and Resident ),å³é•·é§å…§å˜æŠ€è¡“[5],將其長é§äºŽå…§å˜ä¸ã€‚當主控制模塊未é‹è¡Œæ™‚,該鎖定模塊通éŽå®šæ™‚䏿–·è‡ªå‹•æ¿€æ´»ï¼Œé‡‡ç”¨é›¶è¼¸å…¥è² å饋控制ç–略,實ç¾å°ä¼ºæœé›»æ©Ÿé›¶ä½ç½®çš„鎖定。當有任務時,é‹è¡Œä¸»æŽ§åˆ¶æ¨¡å¡Šï¼Œæ¤æ™‚è©²æ¨¡å¡Šçš„ä¸æ–·æœå‹™ç¨‹åºçš„å…¥å£åœ°å€å°‡å–ä»£éŽ–å®šæ¨¡å¡Šä¸æ–·æœå‹™ç¨‹åºçš„å…¥å£åœ°å€ï¼Œç²å¾—å°ä¼ºæœé›»æ©Ÿçš„æŽ§åˆ¶æ¬Šã€‚ä»»å‹™çµæŸåŽï¼Œé€€å‡ºä¸»æŽ§åˆ¶æ¨¡å¡Šï¼Œä½ç½®éŽ–å®šæ¨¡å¡Šå°‡é‡æ–°æ”¶å›žå…¶æŽ§åˆ¶æ¬Šï¼Œå¾žè€Œä½¿ä¼ºæœé›»æ©Ÿå§‹çµ‚處于閉環,有效地ä¿è‰äº†ç³»çµ±çš„工作性能。
實際è¨è¨ˆä¸ï¼ŒéŽ–å®šæ¨¡å¡Šé‡‡ç”¨äº†C語言和匯編語言混åˆç·¨ç¨‹ï¼ŒæŽ§åˆ¶æ–¹æ¡ˆé‡‡ç”¨ç°¡å–®çš„零輸入比例控制。該模塊æµç¨‹åœ–,如圖2所示。比例系數Kp=0.4ï¼Œä¸æ–·é‡‡æ¨£æ™‚é–“èˆ‡ä¸»æŽ§åˆ¶æ¨¡å¡Šé‡‡ç”¨ç›¸åŒæ™‚間,å‡ç‚º4ms。整個程åºåƒ…å 560bit,å°ä¸»æŽ§åˆ¶æ¨¡å¡Šæˆ–其他模塊的é‹è¡Œå¹¾ä¹Žæ²’有影響,但å°ä¼ºæœé›»æ©Ÿçš„ä½ç½®æ¼‚ç§»å»ç²å¾—了明顯的改善,ä½ç½®åå·®å§‹çµ‚ä¿æŒåœ¨Â±1脈沖內。

æŽ§åˆ¶æ¨¡å¡Šçš„ä¸»ç¨‹åºæµç¨‹åœ–,如圖3(aï¼‰æ‰€ç¤ºã€‚ä¸æ–·æœå‹™åç¨‹åºæµç¨‹åœ–,如圖3(b)所示。主程åºå®Œæˆå¯„å˜å™¨ã€å®šæ™‚器åˆå§‹åŒ–,定義控制變é‡ï¼Œé¡¯ç¤ºè¼¸å…¥è¼¸å‡ºï¼Œæ•¸æ“šçš„å˜è²¯ï¼Œæ‰“å°ç‰åŠŸèƒ½ï¼›ä¸æ–·æœå‹™å程åºå‰‡ä¸»è¦å®Œæˆå°2臺伺æœé›»æ©Ÿçš„æŽ§åˆ¶ã€‚在控制ç–略上å°ä¸»é›»æ©Ÿé‡‡ç”¨ç°¡å–®çš„PI控制,而從動電機采用了模糊-PIDå’Œå‰é¥‹å¾®åˆ†æŽ§åˆ¶æ§‹æˆçš„å¾©åˆæŽ§åˆ¶ï¼Œé‹ç”¨C語言和匯編語言混åˆç·¨ç¨‹ã€‚å¾©åˆæŽ§åˆ¶å……åˆ†é‹ç”¨æ¨¡ç³ŠæŽ§åˆ¶å’Œå‚³çµ±PID控制å„自的優點,采用模糊控制和PID控制相çµåˆçš„æŽ§åˆ¶æ¨¡å¼ã€‚é€šéŽæŸ¥è©¢æ¨¡ç³ŠæŽ§åˆ¶è¡¨ï¼Œæ ¹æ“šç³»çµ±è™•于ä¸åŒç‹€æ…‹å’Œå°æŽ§åˆ¶éŽç¨‹ä¸åŒæ™‚刻的ä¸åŒè¦æ±‚,得到比例\Kpã€ç©åˆ†Kdã€å¾®åˆ†K\3系數åŠå‰é¥‹å¾®åˆ†ç³»æ•¸K1,兼顧控制系統的動ã€éœæ…‹ç‰å¤šé …性能指標,é”åˆ°é æœŸç›®çš„。
軟件è¨è¨ˆè¦é»žå¦‚下:
(1) é§ç•™å‡½æ•¸ã€‚é•·é§å…§å˜å‡½æ•¸keep(),將程åºé§ç•™åœ¨å…§å˜ä¸ï¼Œå¹¶é€šéŽç†±éµæˆ–其它方å¼é€²è¡Œæ¿€æ´»ã€‚å‡½æ•¸æ‹¬è™Ÿå…§ç‚ºè©²ç¨‹åºæ‰€éœ€å—節數,如本軟件ä¸çš„ä½ç½®éŽ–å®šæ¨¡å¡Šï¼Œéœ€560bit,這樣å¯å¯«ç‚ºkeep(560)。
(2) 在計數器采樣å程åºå’ŒD/A輸出å程åºçš„è¨è¨ˆä¸ï¼Œç‚ºäº†ç¸®çŸé‹è¡Œè®€å–計數器和輸出D/A數據時間,æé«˜é‹ç®—效率,é‹ç”¨äº†çµæ§‹é«”和公用體,如下所示:

(3) 溢出判斷å程åºã€‚為ä¿è‰è¨ˆæ•¸å™¨çš„è¨ˆæ•¸æº–ç¢ºï¼Œè¦æ±‚計數器進行絕å°å¼å¾ªç’°è¨ˆæ•¸ï¼Œé€™æ¨£å¿…然會產生溢出ç¾è±¡ã€‚å› æ¤ï¼Œåœ¨æ¯æ¬¡é‡‡æ¨£åŽéƒ½è¦å°è¨ˆæ•¸å™¨æ˜¯å¦æº¢å‡ºé€²è¡Œåˆ¤æ–·ã€‚計數器由于采用24ä½è¨ˆæ•¸æ–¹å¼ï¼Œåˆ†3次進行讀å–,若將24ä½å…¨è®€å‡ºåŽå†é€²è¡Œåˆ¤æ–·ï¼Œå‰‡å‹¢å¿…å¢žåŠ ä¸æ–·ç¨‹åºé‹è¡Œæ™‚間。實際應用ä¸ï¼Œé‡‡ç”¨äº†é«˜å…«ä½åˆ¤æ–·æ–¹å¼ã€‚由于采用的編碼器為4096脈沖/轉,伺æœé›»æ©Ÿçš„æœ€é«˜é€Ÿåº¦ç‚º600r/min,采樣時間為4msã€‚å› æ¤ï¼Œæœ€é«˜ä½çš„2次采樣之差絕å°å€¼ä¸å¯èƒ½å¤§äºŽ255,å¦å‰‡ï¼Œç‚ºæº¢å‡ºã€‚若本次采樣高ä½å€¼èˆ‡å‰æ¬¡é‡‡æ¨£å€¼ä¹‹å·®ç‚º255,則說明計數器下溢;若本次采樣高ä½å€¼èˆ‡å‰æ¬¡é‡‡æ¨£å€¼ä¹‹å·®ç‚º-255,則說明計數器下溢。
主電機采用æ’速控制,從動電機進行ä½ç½®è·Ÿè¹¤æ™‚,采用常è¦PID控制åŠå¾©åˆæŽ§åˆ¶è·Ÿè¹¤ç‰¹æ€§æ›²ç·šçš„æ¯”較圖,如圖4所示。從圖ä¸å¯ä»¥çœ‹å‡ºï¼Œèˆ‡å¸¸è¦PIDæŽ§åˆ¶æ¯”è¼ƒï¼Œå¾©åˆæŽ§åˆ¶å…·æœ‰éŸ¿æ‡‰é€Ÿåº¦å¿«ç‰å„ªé»žã€‚說明該控制ç–略是ä¸åƒ…å¯ç”¨äºŽä¼ºæœé›»æ©Ÿçš„ä½ç½®åŒæ¥æŽ§åˆ¶ï¼Œè€Œä¸”具有以上諸多優點。

4çµæŸèªž
基于工控機實ç¾çš„ä½ç½®åŒæ¥æŽ§åˆ¶ç³»çµ±ï¼Œå…·æœ‰ç³»çµ±å¯é 性高ã€çµæ§‹ç°¡å–®ã€ç·¨ç¨‹éˆæ´»ç‰å„ªé»žï¼Œæ—¢å¯é‹ç”¨é«˜ç´šè»Ÿä»¶ï¼Œåˆå¯é‹ç”¨åŒ¯ç·¨èªžè¨€ï¼Œæé«˜ç·¨ç¨‹èª¿è©¦é€Ÿåº¦å’Œç¨‹åºçš„å¯è®€æ€§ã€‚在實ç¾ä¼ºæœé›»æ©ŸæŽ§åˆ¶çš„åŒæ™‚,å¯ç›´æŽ¥å°æŽ§åˆ¶é€²åº¦ã€è¼¸å…¥ã€è¼¸å‡ºç‰é€²è¡Œè§€å¯Ÿã€åˆ†æžã€æ‰“å°ç‰è™•ç†ã€‚
åƒè€ƒæ–‡ç»
[1] 許春全,胡洪國,æ¥Šæ±æ¸….多伺æœé›»æ©Ÿçš„串è¯åŒæ¥æŽ§åˆ¶[J].電氣自動化,2001,(4).
[2] 潘曉彬,æŽåœ‹å¹³,俞岳平.伺æœé›»æ©Ÿé–“åŒæ¥å‚³å‹•的柔性化控制[J].機電工程,1999,(5).
[3] PCL833 3-axis Quadrature Encoder and Counter Card User‘s Manual[Z]. Advance Co. Ltd.,1998.
[4] PCL728 D/A Conveter Card User‘s Manual[Z].Advance Co. Ltd.,1998.
[5] IBM PC XT/AT 系列微機高級程åºå“¡ç·¨ç¨‹æŒ‡å—[M].北京:ä¸ç§‘院希望電腦技術公å¸,1987.