基于伺服電機和運動控制器的目標(biāo)仿真實時性設(shè)計
上位機軟件
上位機軟件的組成如圖4所示。
初始化模塊:實現(xiàn)零位標(biāo)定等功能。
軌跡和參數(shù)設(shè)定模塊:根據(jù)不同的運動功能和軌跡,提供了相應(yīng)的參數(shù)設(shè)定界面,其中包括參數(shù)合理性判別、缺省值提供等輔助功能。
運動信息實時顯示模塊:通過與DMC5400實時通訊,動態(tài)采集負載位置和速度等運動信息。然后,借助CB開發(fā)的帶有二維坐標(biāo)系的顯示界面,實現(xiàn)實時動態(tài)顯示負載運動軌跡,同時動態(tài)顯示左右兩個軟硬限位狀態(tài)。另外,在界面的右下角還實時動態(tài)顯示負載的位置和速度數(shù)據(jù)。
故障診斷模塊:內(nèi)嵌于各功能模塊中,如設(shè)定值合理性判別、鍵盤操作功能保護、界面功能按鈕的連鎖、電機限速保護、位置超速保護等。
通訊模塊:利用DMC5400提供的動態(tài)鏈接庫編制,實現(xiàn)上位PC機和下位DMC5400之間的通訊。它內(nèi)嵌于各功能模塊中,囊括了同DMC5400通訊的所有方式,而且將其主要的函數(shù)進行分類、封裝。所編制的通訊程序?qū)崿F(xiàn)了運動軌跡程序及設(shè)定參數(shù)的下載、上位PC機對DMC5400的指令傳輸及DMC5400對PC機的狀態(tài)反饋等通訊功能。
下位機軟件
控制下位機是運動控制系統(tǒng)的直接控制級,構(gòu)成可控擴束和可控衰減兩個獨立的伺服控制回路。其功能包括:實現(xiàn)目標(biāo)運動的實時控制;采用相應(yīng)的控制算法,對系統(tǒng)的運行位置、速度進行控制;將檢測到的系統(tǒng)狀態(tài)信號通過PCI總線傳給上位機。DMC5400的運動控制功能十分豐富,可以滿足絕大多數(shù)多軸運動控制系統(tǒng)的要求[3]。
DMC5400運動控制卡提供基于Windows 95 /98/Me/NT/2000/XP下32位DLL驅(qū)動編程。其具體的編程語言可為VB、VC、C++Builder中的任何一種。在運動函數(shù)庫中所使用到的函數(shù)主要有如下幾種:控制卡及軸設(shè)置函數(shù),獨立運動和插補運動函數(shù),制動函數(shù),位置和狀態(tài)的設(shè)置及查詢函數(shù),I/O口操作函數(shù),錯誤代碼函數(shù)。其函數(shù)返回值為0(函數(shù)執(zhí)行正確)或-1(函數(shù)執(zhí)行錯誤)。其控制系統(tǒng)的流程圖如圖5所示。
仿真結(jié)果分析
圖6~11為半實物仿真試驗與數(shù)學(xué)仿真試驗激光制導(dǎo)炸彈空間三維坐標(biāo)變化曲線,可見兩種仿真模式下試驗曲線吻合良好。由于在整個彈道曲線中差別表現(xiàn)不明顯,因此給出了各坐標(biāo)相應(yīng)的彈道末端局部顯示曲線。
試驗結(jié)果表明,數(shù)學(xué)仿真的仿真解算穩(wěn)定,結(jié)果精度良好;同時,在相同投彈條件下,半實物仿真與數(shù)學(xué)仿真試驗過程相關(guān)性比較好,仿真精度非常高,由此反映出目標(biāo)仿真系統(tǒng)帶入全系統(tǒng)的誤差極小(目標(biāo)系統(tǒng)誤差占全系統(tǒng)誤差的90%),所設(shè)計的控制系統(tǒng)實現(xiàn)了光斑大小和能量的實時控制。
伺服電機相關(guān)文章:伺服電機工作原理
評論