----------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
基于PLC研制的直流伺服系統，利用PLC擴展能力強的特點，添裝手動輸放裝置，實現工業機器人關節直流伺服系統的可視操作。其優點是：（1）無需改變電路結構，即可通過程序實現電機正反轉的控制;（2）能夠使電機不等待停止轉動即可立刻反方向轉動;（3）可令電機急停，避免電機慣性轉動;（4）編程、維護方便。
1 引言
隨著現代科學技術的發展，PLC己廣泛地應用于工業控制微型計算機中。
目前，工業機器人關節主要是采用交流伺服系統進行控制，本研究將技術成熟、編程方便、可靠性高、體積小的SIEMENS S-200可編程控制器，應用于可控環流可逆調系統，研制出機器人關節直流伺服系統，用以對工業機器人關節進行伺服控制。
2 工業機器人關節直流伺服系統
工業機器人關節是由直流伺服電機驅動，通過環流可逆調速系統控制電機的正反轉來達到對工業機器人關節的伺服控制的目的。
2.1 控制系統結構
系統采用SIEMEN S7-200型PLC，外加D/A數模轉換模塊，將PLC數字信號變成模擬信號，通過BT—I變流調速系統（主要由轉速調節器ASR、電流調節器ACR、環流調節器ARR，正組觸發器GTD、反組觸發器GTS、電流反饋器TCV組成）驅動直流電機運轉，驅動機器人關節按控制要求進行動作。系統結構如圖1所示。
圖1 機器人關節直流伺服系統結構示意圖
2.2 系統工作原理
系統原理如圖2所示，可控環流可逆調速系統的主電路采用交叉聯接方式，整流變壓器的一個副邊繞組接成Y型，另一個接成△型，2個交流電源的相位錯開30°，其環流電壓的頻率為l2倍工頻。為了抑交流環流，在2組可控整流橋之間接放了2只均衡電抗器，電樞回路中仍保留一只平波電抗器。
控制電路主要由轉速調節器ASR、電流調節器ACR、環流調節器ARR，正組觸發器GTD、反組觸發器GTS、電流反饋器TCV組成（見圖2），其中2組觸發器的同步信號分別取自與整流變壓器相對應的同步變壓器。
圖2 工業機器人關節直流伺服系統原理圖
系統給定為零時，轉速調節器ASR、電流調節器ACR被零速封鎖信號鎖零。此時，系統主要由環流調節器ARR組成交叉反饋的恒流系統。由于環流給定的影響，2組可控硅均處于整流狀態，輸出的電壓大小相等、極性相反，直流電機電樞電壓為零，電機停轉，輸出的電流流經2組可控硅形成環流。環流不宜過大，一般限制在電機額定電流的5%左右。正向啟動時，隨著轉速信號Ugn的增大，封鎖信號解除，轉速調節器ASR輸正，電機正向運行。此時，正組電流反饋電壓+Ufi2反映電機電樞電流與環流電流之和;反組電流反饋電壓-Uril反映了電樞電流，因此可以對主電流進行調節。而正組環流調節器輸入端所加的環流給定信號-Ugih和交叉電流反饋信號-Ufil對這個調節過程影響極小。反組環流調節器的輸入電壓為（+Uk）+（-Ugih）+（Ufi2），隨著電樞電流的不斷增大，當達到一定程度時，環流自動消失，反組可控硅進入待逆變狀態。反向啟動時情況相反。另外，可控環流可逆調速系統制動時仍然具有本橋逆變，反接制動和反饋制動等過程。由于啟動過程也是環流逐漸減小的過程，因此，電機停轉時，系統的環流達zui大值。環流有助于系統越過切換死區，改善過渡特性。
3 系統程序設計
程序設計方案為手動輸入一個角度值，讓電機轉動，通過與電動機相聯的光電碼盤來檢測電動機轉的角度，將轉動角度變成脈沖信號。由于電動機的轉速非常快，所以只能把脈沖信號送往PLC的高速計數器。然后將計數器的脈沖記錄與手輸入的進行比較，如果兩者相等說明電動機已經到達角度位置，否則繼續進行修正。值得注意的是，由于電動機從轉動突變到停止會有一定的慣性，因此在進行信號比較時應允許有一定的誤差，不然電動機就會始終處在修正位置狀態。系統程序框圖如圖3所示。
圖3 系統程序框圖
Multiline 6000 Dosiergerät von EcoLab
Phillips 32 Input/Output Module 4022 226 3531 4022226
SEW eurodrive -Movitrac Umrichter 3022-403-4-00
Sick BARCODSCANNER CLV490-1010 CLV4901010
Siemens Simatic S5 Rack 6ES5 955-3LC12 6Es5135-3KB13
Siemens 6AR1313-0FA03-0?AA0 E-Stand KS3 Top
Siemens SLM-SIMOLINK Monitor 6SX7005-0AF00
Siemens C79458L 1052A1 C79040-A322-C13?-03-87
Siemens PMC CPU 200/64MB 6AR1001-1AC30-0?AA0 Neu New
Siemens Verteilerplatte RCM 3 70929761 G33928-T2755-C0?0
Siemens Simatic S7-400 6ES7416-2XK02-0?AB0 6ES7 416-2XK0
Siemens Simatic S5 Moby Anschaltung 6AW5463-0AB 6AW5 46
Siemens Simatic S5 WF470 6FM1470-3CA21 Anzeigebaugrupp?e
Siemens Simatic S5-110S Netzgerät E220, G5/10 WRG
Siemens Simatic Steuerungskarte PC612-B1200-C96?0
Siemens Simatic WF785 6FM1785-3AA00
Siemens Simodrive Regelungseinsch?ub 6SN1118-0NJ01-0?AA1
Siemens Simodrive FBG C98043-A1240-L2 Neu
Siemens Simodrive 610 FBG 6SC6100-0SA01 + 6SC6100-0SA01
Siemens Simodrive 611 6SN1118-0NJ01-0?AA1 New
Siemens Simodrive 6RB2025-0FA01 Neu und Versiegelt
Siemens Simodrive Leistungsteil 6RB2030-0FA00
Siemens Simodrive Regelungseinsch?ub 6SN1118-1NH01-0?AA0
Siemens Simodrive Leistungsteil 6SC6108-0SE02
Siemens Simovert 6ES4215-1DA10 Ausgangs Modul
Siemens Simodrive Regelungseinsch?ub 6SN1118-0NH00-0?AA2
Siemens Sinamics 6SL3130-1TE22-0?AA0 neu
Siemens Sinumerik MS320 6FX1113-5AA00 Top
Siemens Sinumerik 6FC5110-0DB01-0?AA1 6FC51100DB010AA?1
Siemens Sinumerik 6FM2805-1WL00 + Netzteil+ 3x Karten
Siemens Sinumerik 6FX1121-4BG01 Version D
Siemens Sinumerik 6FX1121-4BG01 Version D
Siemens Sinumerik Einausgabemodul 6FX1124-6AD02
Siemens Sinumerik 6FX1138-4BA01
Siemens Sinumerik 6FX1138-4BA01
Siemens Sinumerik 6FX1144-2BA00
Siemens Sinumerik FBG. Servo Interf 6FX1121-4BG01
Siemens SINUMERIK FM-NC 6FC5210-0DA00-1?AA1
SIEMENS Sinumerik I/O Modul 6FC3 984-3RA 6FC3984-3RA
Siemens Sinumerik Interface Karte 6GK1147-5MA00 V.C
Siemens Sinumerik Fanuc Steuerpult CRT TR-9DK1 A61L-000
Siemens SIWAREX 7MH4405-1AA00 Express Versand möglich..
Siemens Simodrive Stromversorgung 6EW1890-0AB 6 EW 1890
Siemens ekommunikati?on S30861-Q429-X1-?05/01 M:TDPCV6
Indramat DDS02.1-W100-DL?04-01-FW DDS02.1-W100
Indramat DDS02.1-W200-DL?01-01-FW DDS02.1-W200-D
Siemens Simodrive 611 HF-Drossel 36 KW 6SN1111-0AA00-0?C
Siemens Sinumerik Messkreis-Baugr?. 6FC5111-0BA02-0?AA0 6
Errepi Solar Wechselrichter Auni 4000 Series Aunisol
Siemens Simodrive 611 Regelungseinsch?ub 6SN1118-1NH01-0?
Fanuc CPU A16B-3200-0090 A16B32000090
Siemens Sinumerik Messkreisbaugru?ppe 6FC5111-0BA00-0?AA0
Bosch Rexroth Servodyn SM17/35-TA SM 17/35-TA 17A
FANUC A16B-2203-0370/?13E USPP A16B22030370/13?E
Fanuc CPU A16B-3200-0071 /05A A16B32000071 /05A
Siemens Sinumerik 810D/840D PCU20 6FC5210-0DF00-0?AA1 Ve
SEW Movitrac 203 CD Antriebsumricht?er 3,62 kVA
SEW Movitrac 204 CD Antriebsumricht?er 4,80 kVA
FANUC A16B-2203-0033 /02B600289
Siemens Simodrive Regelungseinsch?ub 6SN1118-0DM21-0?AA0
Siemens Simodrive Regelungseinsch?ub 6SN1118-0DM11-0?AA1
Siemens Simadyn D EB11 Koppelspeicherm?odul 6DD1611-0AD0
Siemens Sinumerik Operator Panel 6FC5203-0AF02-0?AA0 6FC
Siemens 3~Brushless Servomotor 1FT6084-1AF71-3?AG1
Siemens Simodrive 611-D Regelungseinsch?ub 6SN1118-0DG23
Siemens Simatic S5 Mona C Display Module 6ES5255-3AC11
Osram HBO 2000W/NIL Entladungslampe 1750W neu
Siemens Sinamics 6SL3120-2TE13-0?AA3 neu
Indramat TVM 2.1-50W1-220V TVM 2.1-50-W1-220V TVM 2-1
Indramat A.C. Servo Netzteil TVM 2.2-050-220/300?-W1/220
Osram HBO 2001 W/NIEL Entladungslampe 1750W neu
Siemens Simodrive 650 Regelung 6SC6500-0NA44
Siemens Sinumerik System 8 MS140 6FX1113-2AA01
Siemens Sinumerik 6FX1122-8BC04 unbenutzt TOP
Siemens Sinumerik CPU 6FC5012-0CA02-0?AA0
Siemens Simodrive Universal Regelungseinsch?ub 6SN1118-0
Siemens Simatic S5 6ES5240-1AA12 6ES5 240-1AA12 Stand 2
Indramat A.C Serco Power Supply TVM-2.1-50-W1-2?20V
Siemens Simodrive Universal Regelungseinsch?ub 6SN1118-0
Siemens Simodrive Universal Regelungseinsch?ub 6SN1118-0
Fanuc Board 44A294584-G01 BD44A296323-001 CNC
Fanuc Board 44B294252-002/2 44A294505-G01 CNC
Siemens Sinamics G120 Power Module 6SL3224-0BE25-5?AA0
Siemens Simodrive Regelungseinsch?ub 6SN1118-0DM11-0?AA1
