基于多軸運動控制卡的伺服控制系統(tǒng)研究
發(fā)布時間:2008/6/3 0:00:00 訪問次數(shù):786
以工控機為核心,結(jié)合現(xiàn)有使用的控制系統(tǒng)及交流變頻器和伺服電機的種類,針對焊接機器人用數(shù)控焊接變位機的控制問題,應(yīng)用研華三軸運動控制卡pcl-832作為控制核心,建立了機器人用數(shù)控焊接變位機的高精度控制系統(tǒng)。 研究分析了焊接變位機的位置控制精度、速度和運動軌跡的控制過程,給出了負(fù)載變化和速度變化的位置控制結(jié)果,其結(jié)果滿足與弧焊機器人配合使用的精度要求。
2.系統(tǒng)配置:
基于多軸運動控制卡的伺服控制系統(tǒng)硬件組成如圖1所示:
系統(tǒng)包括:
1)pc總線工控機。選用基于pc總線的工控機ipc-610,該機擁有標(biāo)準(zhǔn)16位數(shù)據(jù)總線及組態(tài)靈活的板塊化系統(tǒng)結(jié)構(gòu),可根據(jù)需要配置板卡。
2)三軸交流伺服運動控制卡。三軸交流伺服運動控制卡pcl-832集成了碼盤計數(shù)器和12位的d/a輸出,使用數(shù)字微分分析技術(shù)dda(digital differential analysis),實現(xiàn)了高精度位置控制。特殊設(shè)計的同步信號保證三軸的同步控制,可以完成三軸線性插補或兩軸圓弧插補計算,1ms伺服控制更新,12位模擬量輸出,滿刻度為±10v。能夠?qū)崿F(xiàn)精確位置控制,而且每軸都有其獨立的位置控制芯片,可以實現(xiàn)三臺交流伺服電機的完全獨立控制。本文的數(shù)控焊接變位機系統(tǒng)僅使用了其中的兩個通道。
3)開關(guān)量輸入/輸出板。開關(guān)量輸入/輸出板包括pcl-724和pcld-885。本系統(tǒng)選用的pcl- 724是數(shù)字i/o卡,24通道,實現(xiàn)內(nèi)置plc功能。通過它與機器人通訊,驅(qū)動pcld-885繼電器輸出板實現(xiàn)繼電輸出功能,主要用于與外部焊接控制器、傳感器的通訊、控制器面板指示燈開滅以及錯誤報警等。
4)伺服驅(qū)動裝置、位置檢測裝置、執(zhí)行機構(gòu)和氣缸定位裝置。
3.控制系統(tǒng)設(shè)計
3.1 位置控制過程
1)數(shù)字微分分析(dda)
dda插補控制過程是pcl-832卡工作的核心,見圖2。為了協(xié)調(diào)控制多軸伺服系統(tǒng),各軸同時從t1時刻開始發(fā)送位置控制給定信號,同時在t2時刻結(jié)束給定信號的發(fā)送。t1與t2之間的時間區(qū)間定義為一個dda循環(huán)。循環(huán)時間由軟件設(shè)定。
dda循環(huán)中的每一個脈沖代表伺服電機轉(zhuǎn)動n度,即代表一個位置給定?梢栽谲浖袆討B(tài)地設(shè)定每個dda循環(huán)中的脈沖數(shù),每個dda循環(huán)中的脈沖總數(shù)就反映了在該循環(huán)中位置改變的總量。對交流變頻器連續(xù)的脈沖輸出,在宏觀上表現(xiàn)為平穩(wěn)的位置改變。將脈沖發(fā)往cmd+或cmd-通道決定了電機的轉(zhuǎn)向,以上的所有工作均由卡上內(nèi)置的運動dsp芯片完成,僅需在一個dda循環(huán)開始前將位置信息寫入運動控制芯片的緩沖區(qū)而已。
dda循環(huán)時間代表了控制脈沖序列的開始與結(jié)束時間段,為了保證多軸的協(xié)調(diào)控制,所有的軸使用了同一個dda循環(huán)時間。軟件設(shè)定dda循環(huán)時間可由以下公式(1)計算:
dda循環(huán)時間=0.512ms×寄存器中預(yù)設(shè)置
(1)寄存器中的預(yù)設(shè)置可以通過向dda寄存器的地址中寫入值的方法實現(xiàn),由于dda寄存器是12位寄存器,因此寫入的最大值為4095,而最小值規(guī)定為2。根據(jù)式(1),可知dda循環(huán)時間的設(shè)置范圍為1~2000ms。dda循環(huán)時間越短,則控制軟件的實時性越好,但如果dda循環(huán)時間取得太小,其cpu占用率太高,則其它實時控制模塊無法正常運行,故各實時任務(wù)的執(zhí)行頻率應(yīng)依據(jù)其優(yōu)先級和最壞情況下的運行時間來選取。
2)位置閉環(huán)控制過程 pcl-832卡使用比例閉環(huán)控制獲得可靠的控制效果。卡中內(nèi)建了速度反饋環(huán)和偏移量機制來消除在輸入很小時而產(chǎn)生的靜態(tài)誤差。圖3為pcl- 832運動控制卡的功能模塊示意圖。
dda發(fā)生器通過cmd+和cmd-通道產(chǎn)生連續(xù)的給定脈沖。此控制脈沖與編碼盤產(chǎn)生的反饋脈沖在比較器中進行比較,其結(jié)果送入比例控制器后,由比例控制器輸出控制脈沖,控制脈沖送入誤差計數(shù)器,誤差計數(shù)器實時驅(qū)動d/a轉(zhuǎn)換單元,完成閉環(huán)位置控制。當(dāng)dda循環(huán)發(fā)生器被軟件激活后,在下一個dda循環(huán)開始的上升沿,pcl-832將產(chǎn)生一個中斷,在中斷程序中,將dda脈沖緩沖區(qū)中的預(yù)設(shè)值n送入dda發(fā)生器。數(shù)目為n個脈沖的脈沖序列將在下一個dda循環(huán)中產(chǎn)生。在控制軟件中,必須在當(dāng)前dda循環(huán)完成前,將預(yù)設(shè)值送入dda脈沖緩沖區(qū),否則在下一個dda循環(huán)中將沒有脈沖輸出。
dda發(fā)生器產(chǎn)生的脈沖與反饋的碼盤脈沖經(jīng)比較器比較后送入誤差計數(shù)器。根據(jù)轉(zhuǎn)動方向的不同,誤差計數(shù)器的輸出上升或下降,由于誤差計數(shù)器直接驅(qū)動d/a輸出,因此d/a的輸出隨誤差計數(shù)器的輸出變化而變化,使變頻器驅(qū)動電機做出相應(yīng)的響應(yīng)。當(dāng)整個控制過程完成后,誤差計數(shù)器的值應(yīng)該為零。在非正
以工控機為核心,結(jié)合現(xiàn)有使用的控制系統(tǒng)及交流變頻器和伺服電機的種類,針對焊接機器人用數(shù)控焊接變位機的控制問題,應(yīng)用研華三軸運動控制卡pcl-832作為控制核心,建立了機器人用數(shù)控焊接變位機的高精度控制系統(tǒng)。 研究分析了焊接變位機的位置控制精度、速度和運動軌跡的控制過程,給出了負(fù)載變化和速度變化的位置控制結(jié)果,其結(jié)果滿足與弧焊機器人配合使用的精度要求。
2.系統(tǒng)配置:
基于多軸運動控制卡的伺服控制系統(tǒng)硬件組成如圖1所示:
系統(tǒng)包括:
1)pc總線工控機。選用基于pc總線的工控機ipc-610,該機擁有標(biāo)準(zhǔn)16位數(shù)據(jù)總線及組態(tài)靈活的板塊化系統(tǒng)結(jié)構(gòu),可根據(jù)需要配置板卡。
2)三軸交流伺服運動控制卡。三軸交流伺服運動控制卡pcl-832集成了碼盤計數(shù)器和12位的d/a輸出,使用數(shù)字微分分析技術(shù)dda(digital differential analysis),實現(xiàn)了高精度位置控制。特殊設(shè)計的同步信號保證三軸的同步控制,可以完成三軸線性插補或兩軸圓弧插補計算,1ms伺服控制更新,12位模擬量輸出,滿刻度為±10v。能夠?qū)崿F(xiàn)精確位置控制,而且每軸都有其獨立的位置控制芯片,可以實現(xiàn)三臺交流伺服電機的完全獨立控制。本文的數(shù)控焊接變位機系統(tǒng)僅使用了其中的兩個通道。
3)開關(guān)量輸入/輸出板。開關(guān)量輸入/輸出板包括pcl-724和pcld-885。本系統(tǒng)選用的pcl- 724是數(shù)字i/o卡,24通道,實現(xiàn)內(nèi)置plc功能。通過它與機器人通訊,驅(qū)動pcld-885繼電器輸出板實現(xiàn)繼電輸出功能,主要用于與外部焊接控制器、傳感器的通訊、控制器面板指示燈開滅以及錯誤報警等。
4)伺服驅(qū)動裝置、位置檢測裝置、執(zhí)行機構(gòu)和氣缸定位裝置。
3.控制系統(tǒng)設(shè)計
3.1 位置控制過程
1)數(shù)字微分分析(dda)
dda插補控制過程是pcl-832卡工作的核心,見圖2。為了協(xié)調(diào)控制多軸伺服系統(tǒng),各軸同時從t1時刻開始發(fā)送位置控制給定信號,同時在t2時刻結(jié)束給定信號的發(fā)送。t1與t2之間的時間區(qū)間定義為一個dda循環(huán)。循環(huán)時間由軟件設(shè)定。
dda循環(huán)中的每一個脈沖代表伺服電機轉(zhuǎn)動n度,即代表一個位置給定?梢栽谲浖袆討B(tài)地設(shè)定每個dda循環(huán)中的脈沖數(shù),每個dda循環(huán)中的脈沖總數(shù)就反映了在該循環(huán)中位置改變的總量。對交流變頻器連續(xù)的脈沖輸出,在宏觀上表現(xiàn)為平穩(wěn)的位置改變。將脈沖發(fā)往cmd+或cmd-通道決定了電機的轉(zhuǎn)向,以上的所有工作均由卡上內(nèi)置的運動dsp芯片完成,僅需在一個dda循環(huán)開始前將位置信息寫入運動控制芯片的緩沖區(qū)而已。
dda循環(huán)時間代表了控制脈沖序列的開始與結(jié)束時間段,為了保證多軸的協(xié)調(diào)控制,所有的軸使用了同一個dda循環(huán)時間。軟件設(shè)定dda循環(huán)時間可由以下公式(1)計算:
dda循環(huán)時間=0.512ms×寄存器中預(yù)設(shè)置
(1)寄存器中的預(yù)設(shè)置可以通過向dda寄存器的地址中寫入值的方法實現(xiàn),由于dda寄存器是12位寄存器,因此寫入的最大值為4095,而最小值規(guī)定為2。根據(jù)式(1),可知dda循環(huán)時間的設(shè)置范圍為1~2000ms。dda循環(huán)時間越短,則控制軟件的實時性越好,但如果dda循環(huán)時間取得太小,其cpu占用率太高,則其它實時控制模塊無法正常運行,故各實時任務(wù)的執(zhí)行頻率應(yīng)依據(jù)其優(yōu)先級和最壞情況下的運行時間來選取。
2)位置閉環(huán)控制過程 pcl-832卡使用比例閉環(huán)控制獲得可靠的控制效果。卡中內(nèi)建了速度反饋環(huán)和偏移量機制來消除在輸入很小時而產(chǎn)生的靜態(tài)誤差。圖3為pcl- 832運動控制卡的功能模塊示意圖。
dda發(fā)生器通過cmd+和cmd-通道產(chǎn)生連續(xù)的給定脈沖。此控制脈沖與編碼盤產(chǎn)生的反饋脈沖在比較器中進行比較,其結(jié)果送入比例控制器后,由比例控制器輸出控制脈沖,控制脈沖送入誤差計數(shù)器,誤差計數(shù)器實時驅(qū)動d/a轉(zhuǎn)換單元,完成閉環(huán)位置控制。當(dāng)dda循環(huán)發(fā)生器被軟件激活后,在下一個dda循環(huán)開始的上升沿,pcl-832將產(chǎn)生一個中斷,在中斷程序中,將dda脈沖緩沖區(qū)中的預(yù)設(shè)值n送入dda發(fā)生器。數(shù)目為n個脈沖的脈沖序列將在下一個dda循環(huán)中產(chǎn)生。在控制軟件中,必須在當(dāng)前dda循環(huán)完成前,將預(yù)設(shè)值送入dda脈沖緩沖區(qū),否則在下一個dda循環(huán)中將沒有脈沖輸出。
dda發(fā)生器產(chǎn)生的脈沖與反饋的碼盤脈沖經(jīng)比較器比較后送入誤差計數(shù)器。根據(jù)轉(zhuǎn)動方向的不同,誤差計數(shù)器的輸出上升或下降,由于誤差計數(shù)器直接驅(qū)動d/a輸出,因此d/a的輸出隨誤差計數(shù)器的輸出變化而變化,使變頻器驅(qū)動電機做出相應(yīng)的響應(yīng)。當(dāng)整個控制過程完成后,誤差計數(shù)器的值應(yīng)該為零。在非正
熱門點擊
- PWM至線性信號轉(zhuǎn)換電路適于風(fēng)扇速度控制
- 國內(nèi)外電站DCS系統(tǒng)的現(xiàn)狀和發(fā)展
- 人機界面的技術(shù)發(fā)展史
- 由NE555光控及抗干擾電路及CD4541定
- 富士觸摸屏與西門子PLC通訊中的問題及解決方
- 基于uC/OS-Ⅱ的光盤伺服控制系統(tǒng)的設(shè)計
- 為微控制器提供4到20mA回路的電路
- 水位自動控制器 二
- 可編程溫濕度控制器
- 單相電動機調(diào)速方法及其實現(xiàn)
推薦技術(shù)資料
- 自制經(jīng)典的1875功放
- 平時我也經(jīng)常逛一些音響DIY論壇,發(fā)現(xiàn)有很多人喜歡LM... [詳細(xì)]
- 完整模擬前端 (AFE) 監(jiān)控
- 2 通道至 4 通道數(shù)字隔離
- 集成雙通道柵極驅(qū)動器̴
- 隔離式半橋 (HB) 柵極驅(qū)動器解決方案
- 高效率降壓 DC/DC 變換器 IC
- 2.3V 至 5.5V 輸入、0.6A、PS
- 多媒體協(xié)處理器SM501在嵌入式系統(tǒng)中的應(yīng)用
- 基于IEEE802.11b的EPA溫度變送器
- QUICCEngine新引擎推動IP網(wǎng)絡(luò)革新
- SoC面世八年后的產(chǎn)業(yè)機遇
- MPC8xx系列處理器的嵌入式系統(tǒng)電源設(shè)計
- dsPIC及其在交流變頻調(diào)速中的應(yīng)用研究