★中國(guó)電子科技集團(tuán)第十八研究所張昊辰
當(dāng)前,大多數(shù)國(guó)內(nèi)生產(chǎn)企業(yè)仍使用傳統(tǒng)的人工生產(chǎn)方式,往往會(huì)造成質(zhì)量不良、材料浪費(fèi)、效率低下、工藝穩(wěn)定性差等問(wèn)題,因此傳統(tǒng)制造業(yè)勢(shì)必會(huì)向自動(dòng)化、現(xiàn)代化和高效化的方向發(fā)展。越來(lái)越多的工業(yè)機(jī)器人研究投入到生產(chǎn)制造領(lǐng)域,對(duì)機(jī)器人系統(tǒng)也提出了更高要求。為提高質(zhì)量、保證精度,開(kāi)發(fā)高性能、低成本、人性化的直角坐標(biāo)機(jī)器人系統(tǒng)很有必要。直角坐標(biāo)機(jī)器人因相對(duì)簡(jiǎn)單的整體設(shè)計(jì)和操作使其在制造業(yè)中大受歡迎,原因是其每個(gè)軸都可以輕松更換,從而減少停機(jī)時(shí)間和維護(hù)成本。此外,其整個(gè)系統(tǒng)可以分解為多個(gè)新組件,用于單軸應(yīng)用。最重要的是,這些系統(tǒng)比其他更復(fù)雜的機(jī)器人更便宜。
目前,伺服驅(qū)動(dòng)器已經(jīng)開(kāi)發(fā)了變頻技術(shù),驅(qū)動(dòng)器內(nèi)部配有電流環(huán)和速度環(huán),還有變頻器中沒(méi)有的位置環(huán)。其獨(dú)特的多回路結(jié)構(gòu),電流回路嵌套在速度回路中,速度回路嵌套在位置回路中,使執(zhí)行的控制技術(shù)和算法操作比常規(guī)頻率轉(zhuǎn)換更為精確。伺服驅(qū)動(dòng)器的最主要優(yōu)點(diǎn)是其精準(zhǔn)度位置控制功能,一切在位置、速度和轉(zhuǎn)矩控制精度較高的地方,均可使用交流伺服電機(jī),它是一個(gè)精準(zhǔn)的閉環(huán)控制系統(tǒng)。由于伺服系統(tǒng)主要用于速度和定位控制,因此它也被稱(chēng)為運(yùn)動(dòng)控制系統(tǒng)。為了精確控制直角坐標(biāo)機(jī)器人運(yùn)作,該設(shè)計(jì)采用三菱QD75P2N運(yùn)動(dòng)控制模塊[1],通過(guò)觸摸屏與PLC之間的通信對(duì)運(yùn)動(dòng)控制器進(jìn)行參數(shù)設(shè)置。該設(shè)備可以根據(jù)坐標(biāo)進(jìn)行示教并規(guī)劃插補(bǔ)路徑、線性運(yùn)動(dòng)[2]、自動(dòng)檢測(cè)并報(bào)警,最終通過(guò)觸摸屏對(duì)設(shè)備進(jìn)行操控,將運(yùn)動(dòng)軌跡實(shí)時(shí)反饋回觸摸屏。
1 系統(tǒng)設(shè)計(jì)方案
為了降低勞動(dòng)成本、提升生產(chǎn)效率及產(chǎn)品質(zhì)量,我們提出基于三菱PLC的直角坐標(biāo)機(jī)器人設(shè)計(jì)[3]。該系統(tǒng)由X、Y軸兩臺(tái)伺服電機(jī)驅(qū)動(dòng),采用滑塊導(dǎo)軌式結(jié)構(gòu),X-Y軸在水平面內(nèi)垂直布置,利用三菱Q系列PLC及QD75P2N定位模塊,控制兩伺服電機(jī)進(jìn)行兩軸圓弧插補(bǔ),能夠根據(jù)規(guī)定坐標(biāo)及程序自動(dòng)生成插補(bǔ)路徑,并做到速度恒定可調(diào)。該系統(tǒng)配備的三菱HMI可對(duì)設(shè)備參數(shù)進(jìn)行調(diào)試,可實(shí)時(shí)監(jiān)控伺服電機(jī)運(yùn)行路徑及速度等運(yùn)動(dòng)參數(shù),并設(shè)定管理員頁(yè)面,可對(duì)單軸進(jìn)行手動(dòng)/自動(dòng)操控,方便操作人員對(duì)設(shè)備進(jìn)行調(diào)試[4]。該系統(tǒng)出于安全起見(jiàn)設(shè)置防護(hù)欄,防護(hù)門(mén)配備接觸開(kāi)關(guān),并在護(hù)欄頂端安裝帶有蜂鳴器的燈塔,顯示設(shè)備運(yùn)行狀態(tài)。該伺服系統(tǒng)對(duì)任意曲線插補(bǔ)精度高、速度快,可以很好地完成生產(chǎn)任務(wù)。系統(tǒng)流程如圖1所示。
圖1 系統(tǒng)流程圖
2 系統(tǒng)原理分析
2.1 伺服控制
該系統(tǒng)通過(guò)QD75P2N定位模塊與MR-J4-20A伺服驅(qū)動(dòng)器連接,控制伺服電機(jī)[5]進(jìn)行圓弧插補(bǔ)與直線插補(bǔ),并將插補(bǔ)軌跡在觸摸屏上通過(guò)散點(diǎn)圖的方式實(shí)時(shí)顯示。
將給定路徑分解成若干直線與圓弧,將模擬好的圓弧數(shù)據(jù)寫(xiě)入QD75P2N軸定位數(shù)據(jù)中,再按已編寫(xiě)完成的順序控制將程序?qū)懭隤LC的存儲(chǔ)空間,CPU按照內(nèi)部存儲(chǔ)的順序控制程序向QD75P2N定位模塊發(fā)出啟動(dòng)或停止信號(hào),與此同時(shí)監(jiān)測(cè)定位模塊的故障。QD75P2N定位模塊依據(jù)CPU發(fā)出的指令保存參數(shù)和定位數(shù)據(jù),并將定位數(shù)據(jù)傳送給伺服驅(qū)動(dòng)器。伺服驅(qū)動(dòng)器接收來(lái)自QD75P2N的定位數(shù)據(jù)驅(qū)動(dòng)伺服系統(tǒng),并輸出驅(qū)動(dòng)單元的就緒狀態(tài)信號(hào)及零位信號(hào)至定位模塊。最終,電動(dòng)機(jī)根據(jù)伺服電機(jī)指令完成運(yùn)動(dòng),實(shí)現(xiàn)曲線插補(bǔ)。
最后,該系統(tǒng)根據(jù)X-Y軸上兩霍爾傳感器實(shí)現(xiàn)原點(diǎn)回歸近點(diǎn)DOG功能,運(yùn)動(dòng)結(jié)束后使氣缸回到X-Y軸原點(diǎn),以便下次使用。
2.2 路徑監(jiān)視系統(tǒng)
散點(diǎn)圖是GS2110觸摸屏的功能之一,該功能可以由PLC實(shí)時(shí)讀取兩伺服電機(jī)當(dāng)前進(jìn)給值,并以坐標(biāo)形式顯示在散點(diǎn)圖的X/Y軸上,經(jīng)過(guò)坐標(biāo)轉(zhuǎn)換,將各點(diǎn)坐標(biāo)相連接便形成了直角坐標(biāo)機(jī)器人的實(shí)時(shí)插補(bǔ)路徑。當(dāng)讀取頻率足夠高時(shí),其所顯示曲線的誤差可以忽略。
3 硬件系統(tǒng)設(shè)計(jì)
3.1 PLC系統(tǒng)配置
在Q38B基板上安裝Q03UDE模塊作為PLC系統(tǒng)CPU,為了精準(zhǔn)控制兩臺(tái)三菱HJ-KR23J伺服電機(jī),該系統(tǒng)添加QD75P2N定位模塊,由兩臺(tái)MR-J4-20A型伺服驅(qū)動(dòng)器作為橋梁,驅(qū)動(dòng)直角坐標(biāo)機(jī)器人精準(zhǔn)定位。由于該系統(tǒng)中添加了若干傳感器及執(zhí)行器等外部元件,故加入QX40和QY10輸入輸出模塊。同時(shí)為了對(duì)系統(tǒng)運(yùn)行過(guò)程進(jìn)行控制與監(jiān)視,配備GS2110觸摸屏。PLC系統(tǒng)配置如圖2所示。
圖2 PLC系統(tǒng)配置圖
3.2 系統(tǒng)硬件連接
從現(xiàn)場(chǎng)引出三相四線制交流電源至設(shè)備接線端子排,通過(guò)斷路器啟動(dòng)按鈕啟動(dòng)設(shè)備,分別為PLC電源、伺服驅(qū)動(dòng)器以及觸摸屏電源供電;分別引火線與零線進(jìn)入開(kāi)關(guān)電源,轉(zhuǎn)換成24V直流電源并接至端子排,提供控制信號(hào)用電;同時(shí)安裝停止按鈕和急停按鈕來(lái)控制系統(tǒng)的停止和緊急情況的關(guān)斷。QD75P2N定位模塊與伺服驅(qū)動(dòng)器之間的控制信號(hào)線通過(guò)IO信號(hào)接頭焊接排線連接;根據(jù)功能將操作臺(tái)上的機(jī)械信號(hào)與QD75P2N定位模塊之間的通訊用排線焊接。觸摸屏與PLC之間通過(guò)網(wǎng)線通信,用于信號(hào)輸入及圖樣的顯示。
4 電路系統(tǒng)設(shè)計(jì)
4.1 主電路設(shè)計(jì)
本設(shè)計(jì)采用380V三相四線制電源。電源先經(jīng)過(guò)主斷路器,取L1和N接入PLC電源模塊Q61P為其供220V交流電,再將PG和LG共地。取L1和N通過(guò)副斷路器,從副斷路器出兩組線,一組進(jìn)24V開(kāi)關(guān)電源,另一組進(jìn)驅(qū)動(dòng)器X和驅(qū)動(dòng)器Y為其供電。火線接L1和L11,零線接L2/L3和L21,將驅(qū)動(dòng)器上U、V、W、PE連接X(jué)-Y軸伺服電機(jī),最后用專(zhuān)用電纜從驅(qū)動(dòng)器CN2連接至伺服電機(jī),整體動(dòng)力系統(tǒng)便搭建完成。主電路圖如圖3所示。
圖3 主電路圖
4.2 控制電路設(shè)計(jì)
該伺服控制回路主要由QD75P2N定位模塊及兩臺(tái)伺服驅(qū)動(dòng)器構(gòu)成。由于對(duì)位置及速度有嚴(yán)格的控制,且配合脈沖加方向的輸出方式,因此我們選用位置控制模式,該模式是伺服三大控制方式中最常見(jiàn)的一種,是通過(guò)外部輸入脈沖確定轉(zhuǎn)動(dòng)速度的大小及轉(zhuǎn)動(dòng)的角度。在三菱伺服電機(jī)中,要使用專(zhuān)用的伺服CN1接口SCSI,并且按位置控制模式所需要的功能進(jìn)行接線。QD75P2N與伺服驅(qū)動(dòng)器MR-J4-A的連接如圖4所示,伺服驅(qū)動(dòng)器參數(shù)設(shè)置如表1所示。
圖4 QD75P2N接線圖
表1 伺服驅(qū)動(dòng)器參數(shù)
5 軟件系統(tǒng)設(shè)計(jì)
5.1 定位模塊參數(shù)
首先要在GX-WORKS2中新建工程,插入QD75P2N模塊,系統(tǒng)會(huì)自動(dòng)在功能塊中生成參數(shù)設(shè)置,該參數(shù)主要用于設(shè)置機(jī)械設(shè)備和相應(yīng)電機(jī)參數(shù)與控制系統(tǒng)相匹配。為了匹配該設(shè)計(jì),需對(duì)初始設(shè)置進(jìn)行修改。在基本參數(shù)中設(shè)定以mm為單位進(jìn)行插補(bǔ),每轉(zhuǎn)的移動(dòng)量由機(jī)械結(jié)構(gòu)決定,定義電機(jī)旋轉(zhuǎn)一轉(zhuǎn)工件的移動(dòng)量,這里的脈沖輸出方式選為CW/CCW模式,兩線均輸出脈沖信號(hào),CW為正轉(zhuǎn)脈沖信號(hào),CCW為反轉(zhuǎn)脈沖信號(hào),通常都是差分方式輸出,兩信號(hào)相位差90度。加減速時(shí)間設(shè)為10ms。原點(diǎn)回歸方式選擇近點(diǎn)DOG型,并通過(guò)限位開(kāi)關(guān)設(shè)定原點(diǎn)回歸重試,同時(shí)可設(shè)置詳細(xì)回歸速度,系統(tǒng)調(diào)試時(shí)根據(jù)回歸實(shí)際情況設(shè)定原點(diǎn)偏移量。
5.2 軸定位參數(shù)
軸定位數(shù)據(jù)由軸1定位數(shù)據(jù)及軸2定位數(shù)據(jù)兩表組成,在兩表中分別根據(jù)實(shí)際插補(bǔ)路徑,設(shè)定坐標(biāo)及路徑類(lèi)型。運(yùn)行模式指設(shè)置僅限該數(shù)據(jù)結(jié)束對(duì)應(yīng)的定位,或者繼續(xù)執(zhí)行下一數(shù)據(jù)的定位。再選擇合適的控制方式,設(shè)置進(jìn)行定位控制時(shí)的控制方式,常用直線、圓弧插補(bǔ)、圓弧左/右、LOOP、LEND等。通過(guò)定位地址與圓弧地址分別設(shè)定目標(biāo)坐標(biāo)與輔助點(diǎn)坐標(biāo),按照規(guī)定的指令速度運(yùn)行。
5.3 順序控制程序
順序控制程序主要包括主程序、JOG手動(dòng)程序、實(shí)時(shí)轉(zhuǎn)速程序、指示燈及報(bào)警程序和原點(diǎn)回歸程序,將其進(jìn)行整合連接,最終完成插補(bǔ)動(dòng)作[6]。
程序開(kāi)始后先將U4/G800與U4/G900中的軸位置數(shù)據(jù)、軸速度數(shù)據(jù)報(bào)警代碼讀取到D寄存器,并通過(guò)觸摸屏顯示,以便后續(xù)調(diào)試。U4/G1518與U4/G1618為兩軸的手動(dòng)速度。
原點(diǎn)回歸時(shí)將編號(hào)9001寫(xiě)入到U4/G1500和U4/G1600是為了讓定位模塊根據(jù)霍爾傳感器和限位開(kāi)關(guān)的信號(hào)自動(dòng)進(jìn)行機(jī)械原點(diǎn)回歸。
伺服定位程序的核心就是將K6寫(xiě)入到U4/G1500特殊寄存器當(dāng)中,目的是調(diào)用定位表,將已設(shè)定的軸1、軸2定位數(shù)據(jù)引用至控制程序中。定位表調(diào)用程序如圖5所示。
圖5 定位表調(diào)用程序
6 總結(jié)
本文介紹了一種以三菱Q系列PLC為核心控制器,結(jié)合QD75P2N定位模塊,通過(guò)伺服運(yùn)動(dòng)控制系統(tǒng)驅(qū)動(dòng)和編程,以直線和曲線運(yùn)動(dòng)軌跡的生成擬合為多點(diǎn)插補(bǔ)方式,以操作和編程方式為引導(dǎo)示教編程或坐標(biāo)定位的直角坐標(biāo)機(jī)器人設(shè)計(jì)。該直角坐標(biāo)機(jī)器人同時(shí)具備實(shí)用性、精準(zhǔn)度、性?xún)r(jià)比等優(yōu)勢(shì)[7]。在生產(chǎn)制造行業(yè)中,生產(chǎn)線正在向著自動(dòng)化、智能化和集成化的方向發(fā)展,使用高精度的直角坐標(biāo)機(jī)器人,可以有效消除人工操作的弊端,做到提高效率、節(jié)省人力,并達(dá)到增長(zhǎng)經(jīng)濟(jì)效益的目的。
作者簡(jiǎn)介:
張昊辰(1996-),男,天津人,助理工程師,學(xué)士,現(xiàn)就職于中國(guó)電子科技集團(tuán)第十八研究所,研究方向?yàn)楣I(yè)控制自動(dòng)化。
參考文獻(xiàn):
[1] 付鴻澤, 許子杰, 曲培健, 李子豪, 魏仁哲. 基于十字滑臺(tái)的PLC的運(yùn)動(dòng)控制系統(tǒng)[J]. 工業(yè)控制計(jì)算機(jī), 2022, 35 (06) : 130 - 132.
[2] 田龍陽(yáng), 楊紅軍, 魯力, 戢紹庭, 陳家林. 基于PLC小型雕刻機(jī)的X/Y軸控制系統(tǒng)設(shè)計(jì)[J]. 武漢輕工大學(xué)學(xué)報(bào), 2022, 41 (02) : 102 - 106.
[3] 李永梅, 張錦濤, 馬鎰明. 直角坐標(biāo)機(jī)器人軌跡規(guī)劃[J]. 機(jī)械工程與自動(dòng)化, 2022 (01) : 14 - 15 + 18.
[4] 劉振昌, 焦愛(ài)勝. 基于FX2N-20 GM控制的三軸空氣等離子自動(dòng)切割機(jī)械手系統(tǒng)設(shè)計(jì)[J]. 蘭州工業(yè)學(xué)院學(xué)報(bào), 2021, 28 (02) : 69 - 72.
[5] 鄭傳琴. 基于三菱電機(jī)定位模塊在伺服自動(dòng)跟蹤系統(tǒng)中的應(yīng)用[J]. 制造業(yè)自動(dòng)化, 2020, 42 (10) : 137 - 140 + 145.
[6] 林宗德, 陳文, 林新英. 基于三菱QD75的兩軸運(yùn)動(dòng)控制系統(tǒng)設(shè)計(jì)[J]. 沈陽(yáng)工程學(xué)院學(xué)報(bào)(自然科學(xué)版), 2020, 16 (04) : 71 - 74.
[7] 廖謙, 廖育武. 基于PT/PLC的組合機(jī)床生產(chǎn)線定位系統(tǒng)設(shè)計(jì)[J]. 機(jī)電技術(shù), 2020 (04) : 44 - 46.
摘自《自動(dòng)化博覽》2023年4月刊