技術(shù)頻道

娓娓工業(yè)
您現(xiàn)在的位置: 中國傳動網(wǎng) > 技術(shù)頻道 > 技術(shù)百科 > 基于工控機的位置伺服同步系統(tǒng)的開發(fā)

基于工控機的位置伺服同步系統(tǒng)的開發(fā)

時間:2008-02-28 11:14:00來源:mahaiyan

導語:?針對數(shù)控技術(shù)中的同步控制要求,設(shè)計了一種基于PC工控機的位置伺服同步控制系統(tǒng),并描述了其控制軟件的設(shè)計方法及關(guān)鍵技術(shù)。
摘 要:針對數(shù)控技術(shù)中的同步控制要求,設(shè)計了一種基于PC工控機的位置伺服同步控制系統(tǒng),并描述了其控制軟件的設(shè)計方法及關(guān)鍵技術(shù)。 關(guān)鍵詞:工控機;位置控制;長駐內(nèi)存;電流漂移 當前,精密化、自動化、智能化和柔性化是數(shù)控技術(shù)的發(fā)展方向。其關(guān)鍵技術(shù)之一的多軸聯(lián)動數(shù)控技術(shù),日益引起國內(nèi)外有關(guān)學者的普遍重視和廣泛研究。但是如何更方便地實現(xiàn)高精度、高效率、高柔性的多軸聯(lián)動還是一個有待繼續(xù)探索的課題。目前,多軸聯(lián)動系統(tǒng)大多采用主從式結(jié)構(gòu),主機完成系統(tǒng)的管理和產(chǎn)生指令,而各軸控制則由各單獨從機控制單元完成[1,2]。以PC工控機為核心的控制系統(tǒng),集管理與控制為一體,運用PCL833、PCL728兩塊功能板,可同時實現(xiàn)2臺伺服電機間同步傳動的柔性化控制 ,使之滿足數(shù)控機床的多軸聯(lián)動要求。 1系統(tǒng)整體結(jié)構(gòu) 系統(tǒng)整體結(jié)構(gòu)簡圖,如圖1所示。本系統(tǒng)的控制回路分數(shù)字和模擬部分2部分,數(shù)字部分由1臺PC工控機和兩塊硬件功能接口板組成。PC工控機主要完成2臺電機的位置控制調(diào)節(jié)運算;硬件功能板1為計數(shù)器,實現(xiàn)對兩伺服電機反饋脈沖的檢測、倍頻辯相和計數(shù)功能;硬件功能板2為D/A板,實現(xiàn)對2臺伺服電機的控制。
2 硬件接口電路
PCL833是由研華公司生產(chǎn)的24位可逆計數(shù)器[3],是專為位置和速度控制設(shè)計的計數(shù)器接口板,能夠?qū)φ惠斎牒蛿?shù)字輸入進行計數(shù),具有如下特點: (1) 3個24位可逆計數(shù)器; (2) 最大脈沖輸入頻率2.4MHz; (3) 計數(shù)方式為脈沖/方向計數(shù)和正反向計數(shù); (4) *1、*2、*4 3種倍頻方式; (5) 具有對9個不同中斷源中斷控制; (6) 光電隔離最大能達到2500V; (7) 4級數(shù)字濾波; (8) 可編程中斷時間; (9) 適合IBM PC/AT 和兼容機(ISA總線)。 3個24位可逆計數(shù)器既可單獨使用,也可級聯(lián)使用。最大可實現(xiàn)48位計數(shù)器方式。并可根據(jù)要求設(shè)置為增量式和絕對式。具有溢出中斷和溢出計數(shù)等功能。在本系統(tǒng)中,為保證計數(shù)器讀數(shù)準確、不丟步,采用了24位計數(shù)方式,同時要求計數(shù)器進行絕對式循環(huán)計數(shù)。接口板1占有計算機連續(xù)16個映射地址,根據(jù)PC計算機映射地址的分配情況,設(shè)置0X200~0X215連續(xù)16個映射地址給計數(shù)器。 PCL728是由研華公司生產(chǎn)的12位D/A轉(zhuǎn)換器[4],該轉(zhuǎn)換器針對惡劣的工況設(shè)計的12位雙通道D/A輸出卡。每一通道完全光電隔離,并且獨立于系統(tǒng)地,可設(shè)置為以下范圍輸出:0~5V、0~10V、±5V、±10V、4~20mA、0~20mA。根據(jù)伺服電機的控制要求,設(shè)置為雙極性±10V輸出。D/A輸出占有4個映射地址,分別為0x2c0、0x2c1、0x2c2和0x2c3 4個連續(xù)地址。 伺服電機及其驅(qū)動系統(tǒng)采用日本安川公司的產(chǎn)品,電機型號為BMH0955N11A1L,光電編碼器為伺服電機隨機攜帶,3072脈沖/轉(zhuǎn)。 3 PC機實時控制算法軟件設(shè)計與實現(xiàn) 在本系統(tǒng)中實現(xiàn)2伺服電機同步跟蹤的控制。2電機分別定義為主電機和從電機,由該工控機同時完成對2臺伺服電機的控制。 采用工控機中的8253零計數(shù)器來實現(xiàn)定時中斷,并通過其控制的0x1cH中斷相量中安裝中斷服務(wù)程序。8253零計數(shù)器的默認設(shè)置為每秒產(chǎn)生18.2次中斷,即每發(fā)生一次中斷間隔周期為55ms。這樣,可根據(jù)公式interrupt——hige=sample——time×1193180%256000和interrupt——low=sample——time×1193180/256000獲得計數(shù)器預置數(shù),通過修改該計數(shù)器預置值,可獲得不同的中斷時間。 整個系統(tǒng)軟件由2個模塊組成:位置鎖定模塊和控制模塊。當系統(tǒng)采用了數(shù)?;旌辖Y(jié)構(gòu)時,即使沒有輸入,也會因各種干擾的存在,引起模擬電路中產(chǎn)生電流“零漂”,從而將影響到控制效果。位置鎖定模塊即為解決上述問題而設(shè)計,該模塊的中斷服務(wù)程序與控制模塊的中斷服務(wù)程序占有同一中斷相量,運用TSR(Terminate and Resident ),即長駐內(nèi)存技術(shù)[5],將其長駐于內(nèi)存中。當主控制模塊未運行時,該鎖定模塊通過定時中斷自動激活,采用零輸入負反饋控制策略,實現(xiàn)對伺服電機零位置的鎖定。當有任務(wù)時,運行主控制模塊,此時該模塊的中斷服務(wù)程序的入口地址將取代鎖定模塊中斷服務(wù)程序的入口地址,獲得對伺服電機的控制權(quán)。任務(wù)結(jié)束后,退出主控制模塊,位置鎖定模塊將重新收回其控制權(quán),從而使伺服電機始終處于閉環(huán),有效地保證了系統(tǒng)的工作性能。 實際設(shè)計中,鎖定模塊采用了C語言和匯編語言混合編程,控制方案采用簡單的零輸入比例控制。該模塊流程圖,如圖2所示。比例系數(shù)Kp=0.4,中斷采樣時間與主控制模塊采用相同時間,均為4ms。整個程序僅占560bit,對主控制模塊或其他模塊的運行幾乎沒有影響,但對伺服電機的位置漂移卻獲得了明顯的改善,位置偏差始終保持在±1脈沖內(nèi)。
控制模塊的主程序流程圖,如圖3(a)所示。中斷服務(wù)子程序流程圖,如圖3(b)所示。主程序完成寄存器、定時器初始化,定義控制變量,顯示輸入輸出,數(shù)據(jù)的存貯,打印等功能;中斷服務(wù)子程序則主要完成對2臺伺服電機的控制。在控制策略上對主電機采用簡單的PI控制,而從動電機采用了模糊-PID和前饋微分控制構(gòu)成的復合控制,運用C語言和匯編語言混合編程。復合控制充分運用模糊控制和傳統(tǒng)PID控制各自的優(yōu)點,采用模糊控制和PID控制相結(jié)合的控制模式。通過查詢模糊控制表,根據(jù)系統(tǒng)處于不同狀態(tài)和對控制過程不同時刻的不同要求,得到比例\Kp、積分Kd、微分K\3系數(shù)及前饋微分系數(shù)K1,兼顧控制系統(tǒng)的動、靜態(tài)等多項性能指標,達到預期目的。
軟件設(shè)計要點如下: (1) 駐留函數(shù)。長駐內(nèi)存函數(shù)keep(),將程序駐留在內(nèi)存中,并通過熱鍵或其它方式進行激活。函數(shù)括號內(nèi)為該程序所需字節(jié)數(shù),如本軟件中的位置鎖定模塊,需560bit,這樣可寫為keep(560)。 (2) 在計數(shù)器采樣子程序和D/A輸出子程序的設(shè)計中,為了縮短運行讀取計數(shù)器和輸出D/A數(shù)據(jù)時間,提高運算效率,運用了結(jié)構(gòu)體和公用體,如下所示: (3) 溢出判斷子程序。為保證計數(shù)器的計數(shù)準確,要求計數(shù)器進行絕對式循環(huán)計數(shù),這樣必然會產(chǎn)生溢出現(xiàn)象。因此,在每次采樣后都要對計數(shù)器是否溢出進行判斷。計數(shù)器由于采用24位計數(shù)方式,分3次進行讀取,若將24位全讀出后再進行判斷,則勢必增加中斷程序運行時間。實際應(yīng)用中,采用了高八位判斷方式。由于采用的編碼器為4096脈沖/轉(zhuǎn),伺服電機的最高速度為600r/min,采樣時間為4ms。因此,最高位的2次采樣之差絕對值不可能大于255,否則,為溢出。若本次采樣高位值與前次采樣值之差為255,則說明計數(shù)器下溢;若本次采樣高位值與前次采樣值之差為-255,則說明計數(shù)器下溢。 主電機采用恒速控制,從動電機進行位置跟蹤時,采用常規(guī)PID控制及復合控制跟蹤特性曲線的比較圖,如圖4所示。從圖中可以看出,與常規(guī)PID控制比較,復合控制具有響應(yīng)速度快等優(yōu)點。說明該控制策略是不僅可用于伺服電機的位置同步控制,而且具有以上諸多優(yōu)點。
4結(jié)束語 基于工控機實現(xiàn)的位置同步控制系統(tǒng),具有系統(tǒng)可靠性高、結(jié)構(gòu)簡單、編程靈活等優(yōu)點,既可運用高級軟件,又可運用匯編語言,提高編程調(diào)試速度和程序的可讀性。在實現(xiàn)伺服電機控制的同時,可直接對控制進度、輸入、輸出等進行觀察、分析、打印等處理。 參考文獻 [1] 許春全,胡洪國,楊汝清.多伺服電機的串聯(lián)同步控制[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].北京:中科院希望電腦技術(shù)公司,1987.

標簽:

點贊

分享到:

上一篇:基于事件——目標驅(qū)動的人機...

下一篇:微能WIN-V63矢量控制變頻器在...

中國傳動網(wǎng)版權(quán)與免責聲明:凡本網(wǎng)注明[來源:中國傳動網(wǎng)]的所有文字、圖片、音視和視頻文件,版權(quán)均為中國傳動網(wǎng)(m.u63ivq3.com)獨家所有。如需轉(zhuǎn)載請與0755-82949061聯(lián)系。任何媒體、網(wǎng)站或個人轉(zhuǎn)載使用時須注明來源“中國傳動網(wǎng)”,違反者本網(wǎng)將追究其法律責任。

本網(wǎng)轉(zhuǎn)載并注明其他來源的稿件,均來自互聯(lián)網(wǎng)或業(yè)內(nèi)投稿人士,版權(quán)屬于原版權(quán)人。轉(zhuǎn)載請保留稿件來源及作者,禁止擅自篡改,違者自負版權(quán)法律責任。

網(wǎng)站簡介|會員服務(wù)|聯(lián)系方式|幫助信息|版權(quán)信息|網(wǎng)站地圖|友情鏈接|法律支持|意見反饋|sitemap

傳動網(wǎng)-工業(yè)自動化與智能制造的全媒體“互聯(lián)網(wǎng)+”創(chuàng)新服務(wù)平臺

網(wǎng)站客服服務(wù)咨詢采購咨詢媒體合作

Chuandong.com Copyright ?2005 - 2024 ,All Rights Reserved 深圳市奧美大唐廣告有限公司 版權(quán)所有
粵ICP備 14004826號 | 營業(yè)執(zhí)照證書 | 不良信息舉報中心 | 粵公網(wǎng)安備 44030402000946號