一種光電碼盤輸出線斷路檢測和保護電路
富歷新(哈爾濱工業大學)
1概述
在以光電碼盤作為角位置測量元件的伺服系統中,碼盤輸出線或電源線斷路會使伺服系統丟失反饋信號而發生電機“飛轉”的故障,這常會造成設備損壞或人身傷害事故,尤其是在機器人的系統中,控制系統能夠檢測出這類故障,從而及時關斷電機并釋放制動器。目前,很多控制系統采用計算機處理這一故障。當碼盤斷線時,位置誤差增大,當增大到超過程序中設定的門限值時,使電機停轉。由于程序執行需要時間,這種方法對故障的處理不是很及時的,而且計算機分辨不出什么原因引起的位置誤差超限,給系統維護帶來困難。最壞的情況是計算機本身出現故障,就根本無法處理。
筆者在某一機器人控制系統設計中采用了一種簡單、可靠的方法,不通過計算機就能直接檢測碼盤輸出線或電源線斷路故障,并顯示出哪個碼盤發生了故障,然后自動切除伺服驅動器使能信號,使電機停轉,并使制動器釋放。
2故障檢測電路
圖1是碼盤斷線檢測與顯示電路。圖2是一類碼盤中任一信號的輸出電路,F說明其工作原理。
a、b、z為碼盤信號輸出,若這3根線中任一根斷路時,檢測電路輸入端懸空,檢測電路的12v電圓電壓通過電阻r1、r2、二極管d及穩壓管d1形成電流回路,這個電流在r2上產生一個足以使q1導通的電壓,q1的集電極由高電平變為低電平,一方面通過二極管或門送給故障信號處理電路,另一方面點亮發光二極管d3,顯示出這個碼盤出了故障。當碼盤工作正常時,其輸出無論是高電平5v或低電平0v,均由于穩壓二極管d1的阻斷作用,而不能使q1導通,檢測電路輸出維持在高電乎。12v與5v(或0v)的電壓差降在電阻r1上。碼盤信號通過rc濾波網絡送到計算機接口電路中。在機器人控制系統中,有多個碼盤同時工作,這時可用一個二極管或門將多個檢測電路或起來,這樣任一個碼盤發生信號斷路故障時都會輸出一故障信號。
3故障信號處理電路
圖3是故障信號處理電路原理圖,其輸入端為碼盤斷路故障信號。當系統工作正常時,反相器輸出為一高電平,晶體管q2導通,輸出一低電平使伺服單元使能端打開。電機可運轉。同時晶體管q3導通,輸出一高電平,使電機制動器不在制動狀態。當故障發生時,反相器輸出為低電平,使制動器釋放,伺服單元使能端閉鎖,電機停轉。
在所設計的系統中,碼盤型號為lbt-001-2000,電路參數如下:r1=2kω,r2,r3=1 kω,d1的穩壓值為7v,其它二極管均為in4148。
上述電路已成功地應用在機器人控制系統中,工作穩定,可靠,效果好。
歡迎訂閱《機械與電子》
《機械與電子》系國家科委批準、由機械部科技司與貴州省機械工業廳合辦的宣傳報道機電一體化技術的全國性專業技術雜志。它的宗旨:貫徹黨和國家關于機械應用電子技術的方針政策,介紹推廣應用微電子技術、計算機技術的新產品、新技術、新工藝,傳遞機電一體化技術經濟信息。推動機械電子產品更新換代,為振興機械電子工業服務。設有機電一體化技術推廣應用、研究與設計、工場經驗、新技術應用講座、技術動態和信息之窗等10多個欄目。是一種機械與電子結合、適用性較強的刊物,向國內外公開發行,適合機械電子行業技術人員、管理人員、大專院校師生和其他行業機電一體化技術愛好者閱讀。它的質量和水平不斷提高,多次獲得部、省優秀科技期刊獎,1 992年獲機電部優秀科技期刊一等獎、國家優秀科技期刊三等獎,熱忱歡迎訂閱和向本刊投稿。如郵局收訂期過,請直接向本刊雜志社訂閱。
本刊為雙月刊,單月24日出版。內頁48頁,彩色封面,激光照排,膠版印刷,封美內優,每期(冊)訂價2元,全年12元。郵政代號66-32,國外發行代號jtc-58,刊號1ssn1001-2257、cn52-1052/th,國內總發行:貴州省貴陽市郵政局,全國各地郵局均可訂閱。國外總發行:文成公司(香港),中國圖書進出口總公司。
本刊雜志社地址:貴州省貴陽市延安西路67號
|