齊海強,張晉塬,王 興
(1.晉西鐵路車輛有限公司;2.太原科技大學 計算機科學與技術(shù)學院,山西 太原 030000)
2015年,國務(wù)院印發(fā)《中國制造2025》,文件中提出我國要通過“三步走”實現(xiàn)制造強國的戰(zhàn)略目標。中國正由制造大國向制造強國轉(zhuǎn)型,以智能制造為主攻方向,提升我國制造業(yè)的智能化程度[1]。然而目前,在火車輪軸生產(chǎn)檢測領(lǐng)域,輪軸從一個檢測工位到另一個檢測工位的運輸仍需要通過行車吊裝,甚至有的檢測生產(chǎn)線需要通過人工輔助推送。因此,為了響應(yīng)國家完成重點企業(yè)智能化轉(zhuǎn)型的號召,在輪軸生產(chǎn)檢測領(lǐng)域進一步提高自動化、智能化程度,筆者設(shè)計了一臺可以自動運輸火車輪軸的智能機器人。通過該機器人能夠?qū)崿F(xiàn)輪軸在各個檢測工位間的自動運輸,完成檢測過程中自動上下貨的過程。從而實現(xiàn)火車輪對生產(chǎn)檢測過程中的高效、可靠、智能化。
火車車輛輪軸智能運輸機器人是基于物聯(lián)網(wǎng)[2]的三層基本架構(gòu)設(shè)計,由感知層(包括感知傳感器、限位傳感器、測距傳感器和力矩傳感器)、傳輸層(控制器和通信系統(tǒng))、工作系統(tǒng)(包括電動的推移擋桿單元、移動機構(gòu)和裝置本體)等部分組成,如圖1所示。
圖1 設(shè)備結(jié)構(gòu)
本設(shè)備是基于PLC的計算機控制系統(tǒng)[3],設(shè)備裝有電源開關(guān)以及設(shè)備的緊急停止控制按鈕。運行狀態(tài)指示燈、報警蜂鳴器用來顯示機器人的運行狀態(tài),推移擋桿機構(gòu)用來托運輪軸,每個運輸機器人均有安裝一臺嵌入式計算機系統(tǒng),以實現(xiàn)設(shè)備監(jiān)控,故障查詢,數(shù)據(jù)記錄,以及各個動作的控制,如推移擋桿的升降,舵輪的啟停轉(zhuǎn)向等。手持控制器與該計算機Wi-Fi連接以實現(xiàn)現(xiàn)場工作人員遠程控制,監(jiān)控系統(tǒng)裝于總控制室,與每個機器人的計算機控制系統(tǒng)無線通信,實現(xiàn)對廠房內(nèi)所有運輸機器人查看控制。
火車車輛輪軸智能運輸機器人通過PLC控制舵輪,采用導航磁鐵條[4]的行走方式。首先機器人通過限位傳感器定位導航磁鐵條來尋找輪軸位置,當機器人運行到輪軸正下方時,感知傳感器向控制器發(fā)送數(shù)字信號,控制器收到來自感知傳感器的信號后,向驅(qū)動器發(fā)送停止信號,機器人停止移動。此時推移擋桿機構(gòu)升起夾住輪對,動作完成后,控制器對移動機構(gòu)發(fā)出啟動信號,機器人托運輪軸走向下一個檢測工位。行走方式如圖2所示。
圖2 行走方式
火車車輛輪軸智能運輸機器人的控制器以PLC為控制核心,負責接收來自上位機的控制指令,將該指令轉(zhuǎn)換成控制信號發(fā)送給搬運機器人,進而控制搬運機器人動作??刂破髦饕蒔LC模塊、電源模塊、指示燈、手動開關(guān)、空氣開關(guān)、熔斷器、繼電器組成,按設(shè)計好的電路原理圖進行接線,然后將其封裝在定制的機箱當中。PLC模塊的選型是根據(jù)I/O點數(shù)量、存儲器容量、控制功能、輸出類型來確定的,根據(jù)控制系統(tǒng)的規(guī)模來選擇,PLC模塊選擇的是西門子CPU226。設(shè)備采用梯形圖的編程方式,將設(shè)備的控制邏輯工作全部放在計算機當中來完成,上位機將控制指令下發(fā)到PLC當中,PLC接收到指令后根據(jù)對應(yīng)的程序執(zhí)行相應(yīng)的動作。
由于串口通信接口[5]具有成本低、抗干擾能力強、通信距離遠、通信簡單的優(yōu)點,計算機與PLC之間采用串行通信。選擇串行通信方式后還需要進一步確定接口標準,目前適用于PLC的有RS-232、RS-422和RS-485,根據(jù)比較傳輸距離、傳輸帶寬、傳輸模式等可得RS-485的優(yōu)勢明顯,所以PLC上的串口通常默認為RS-485,而計算機端的串口默認為RS-232,通常需要專用的通信線纜實現(xiàn)RS-232轉(zhuǎn)RS-485??刂破鹘M成如圖3所示。
圖3 控制器組成
舵輪機構(gòu)采用ARIPS控制系統(tǒng)[6],該系統(tǒng)綜合內(nèi)外側(cè)車輪側(cè)向力非線性特性和垂直載荷轉(zhuǎn)移的影響,為提高機器人行走的穩(wěn)定性,最大程度利用導向輪側(cè)向力,需通過不同幅值的脈沖轉(zhuǎn)向信號。
脈沖轉(zhuǎn)角包括脈沖形式、頻率和幅值3個基本參數(shù)。脈沖信號選用標準正弦脈沖信號,其頻率和幅值可通過驅(qū)動電機的轉(zhuǎn)向和轉(zhuǎn)速來實現(xiàn),脈沖方程式如式1所示。
(1)
式中:f為脈沖頻率,N為脈沖幅值。
線性輪胎側(cè)向力與側(cè)偏角關(guān)系如式2所示。
(2)
式中:?f和?r分別為前后主動輪的側(cè)偏剛度。
由于脈沖頻率對于機器人的側(cè)傾角和質(zhì)心側(cè)傾角有很大影響,當脈沖頻率為1 Hz時,機器人的側(cè)傾穩(wěn)定性變差;4 Hz時,機器人在行走過程中可以發(fā)揮其穩(wěn)定性能。
為了使用戶能夠方便實時查控運輸機器人,設(shè)計了一個監(jiān)控系統(tǒng)。本系統(tǒng)通過Visual Basic程序語言設(shè)計,因考慮到用戶使用的便捷性,系統(tǒng)設(shè)置了文件、監(jiān)控主界面、參數(shù)設(shè)置、系統(tǒng)日志、故障報警、設(shè)備維護、用戶管理等多個模塊[7]。用戶可根據(jù)系統(tǒng)提示界面,實現(xiàn)對應(yīng)的功能。
主控制界面由菜單欄、監(jiān)控畫面、設(shè)備狀態(tài)窗口、系統(tǒng)控制窗口、功能按鈕組成。設(shè)備狀態(tài)窗口包括設(shè)備運行指示、通信狀態(tài)指示和傳感器狀態(tài)指示,其中報警指示紅燈亮表示“警報”,黃燈亮表示“警告”,綠燈亮表示“正常運行”,當指示燈變?yōu)辄S燈、紅燈時,蜂鳴器發(fā)出對應(yīng)的報警聲。通信設(shè)置窗口可以控制計算機與PLC的通信連接或斷開,系統(tǒng)狀態(tài)可以查看所有連接設(shè)備的通信狀態(tài)。圖像采集畫面主要顯示當前系統(tǒng)接收到的數(shù)據(jù)信息,實時監(jiān)控搬運設(shè)備的運行情況。系統(tǒng)控制窗口主要用于對行走電機、轉(zhuǎn)向電機、前行走輪電機、后行走輪電機、電動推桿進行手動控制。參數(shù)設(shè)置是對前后行走電機的空載啟動頻率、固有步距角、保持轉(zhuǎn)矩,舵機的速度、扭矩,壓力傳感器的最大載荷、靈敏度,電動推桿的推力、速度等進行設(shè)置。系統(tǒng)日志界面中,用戶可以按起止時間對工作量、報警和故障事件、當日工作人員進行查詢。故障報警模塊可以將搬運機器人遇到障礙物或線路發(fā)生故障等不能正常運行的信息反饋到系統(tǒng)界面。設(shè)備維護模塊是對運輸機器人各個部件工作時長進行一個計時,技術(shù)人員根據(jù)部件的運行時長對其進行定時維護更換。用戶管理模塊是對用戶進行添加、刪除、修改信息、修改密碼等操作。
首先用戶選擇要操控的設(shè)備,設(shè)置通信狀態(tài)建立計算機與PLC之間的通信,通信狀態(tài)顯示已連接之后選擇手動控制或系統(tǒng)自動控制搬運機器人運輸,點擊系統(tǒng)自檢,此時系統(tǒng)將對所有連接設(shè)備進行自診斷。若選擇手動控制,待系統(tǒng)自檢完成后,用戶可以自行對搬運機器人的啟停、前舵輪、后舵輪、電動推桿等進行控制。若選擇自動控制,則在系統(tǒng)完成自檢后開始自行搬運,此時用戶對設(shè)備的一系列控制將不能操作,在點擊停止按鈕之后默認轉(zhuǎn)為手動控制。主控制模塊如圖4所示。
圖4 主控制模塊
火車車輛輪軸智能運輸機器人采用路徑規(guī)劃導航算法[8],設(shè)備之間采用聯(lián)動控制技術(shù)。通過設(shè)備間端對端的通信方式,實現(xiàn)輪軸運輸設(shè)備間聯(lián)動控制。
3.2.1 智能導航算法。A*算法[9]是一種靈活性高和適應(yīng)性強的路徑搜索算法,經(jīng)常應(yīng)用于環(huán)境已知的全局路徑規(guī)劃中。在路徑搜索過程中,依據(jù)估價函數(shù)計算當前節(jié)點的每個可拓展相鄰節(jié)點的代價估值,將相鄰節(jié)點中代價估值最小的節(jié)點作為下一個計算的節(jié)點,然后再對新節(jié)點重復上面的步驟,直至搜索到目標節(jié)點時停止搜索,從而找到一條從起點到終點理論上的最優(yōu)路徑,路徑規(guī)劃流程圖如圖5所示。
圖5 路徑規(guī)劃流程
該方法在實行路徑規(guī)劃過程中,需通過OPEN表和CLOSE表完成最優(yōu)節(jié)點的選取。
設(shè)置p(t)、(xt,yt)以及(xn,yn)分別表示啟發(fā)式信息、當前節(jié)點以及目標節(jié)點,且(xt,yt)和(xn,yn)之間的直線距離可用p(t)表示,因此得出:
(3)
基于A*算法的運輸機器人路徑規(guī)劃步驟如下:①向OPEN表和CLOSE表中分別引入起點和障礙點。②向CLOSE表中引入具有最小f值的節(jié)點n,并且引入節(jié)點同屬于OPEN表中。③對引入節(jié)點n進行判斷,分析是否為目標節(jié)點,如果是,最優(yōu)路徑的生成以引入節(jié)點方向指針為依據(jù);反之,需生成后續(xù)節(jié)點m,通過實行擴展完成。④將后繼節(jié)點m返回至n的指針建立在OPEN表中,并對f(m)=g(m)+p(m)求解。⑤通過判斷語句,確定后繼節(jié)點m是否存在OPEN表中。若不存在,則將m添加至OPEN表中;若m位于OPEN表中,則對不同前向指針的f(m)進行比較,將最小f值保留。⑥更新g(m)、f(m)和m前指向針。⑦根據(jù)f(m)數(shù)值的大小進行排列,并在OPEN表中重新完成 f值排序,并返回步驟②。
3.2.2 聯(lián)動控制技術(shù)?;疖囕嗇S在檢測運輸過程中為提高檢測效率需由多臺機器人同時運行,設(shè)備間通過確立協(xié)同插補[10]的輸入輸出,進行主從同步速度規(guī)劃,以及進行協(xié)同軌跡過渡,協(xié)同插補的輸入由用戶協(xié)同運動指令經(jīng)過譯碼器解析然后由組控制模塊處理得到,協(xié)同插補的輸出直接作用于機器人伺服驅(qū)動器。當一臺運輸機器人將輪軸運輸至檢測工位,下一臺機器人將輪軸運輸至指定位置等候檢測,從而實現(xiàn)多個運輸機器人間的聯(lián)動控制,以此提高檢測效率。
同時運輸機器人與檢測設(shè)備之間實現(xiàn)聯(lián)動控制,檢測設(shè)備裝有感知傳感器和壓力傳感器,當感知傳感器和壓力傳感器檢測到輪軸時,對檢測設(shè)備發(fā)送開始檢測信號,檢測設(shè)備開始檢測,待檢測完成后,檢測設(shè)備通過無線通信對運輸機器人發(fā)送移動信號,運輸機器人將已完成檢測的輪軸運輸至指定位置。
火車車輛輪軸智能運輸機器人包括推移擋桿機構(gòu),設(shè)于所述裝置本體內(nèi)且具有一組對稱安裝的推移擋桿單元,每組推移擋桿單元中均包括有一對相向設(shè)置后能夠升降且保持運動同步的擋桿,當所述擋桿升起時,用以夾住被檢測輪對的中心軸,推移擋桿單元還包括減速器、連接軸和圓形檔輪,減速器安裝在所述裝置本體內(nèi)并接受所述控制器的控制,減速器的左右兩側(cè)的輸出端上分別與連接軸相連接,在每個連接軸上還設(shè)有擋桿,擋桿上自上而下還設(shè)有若干個均勻分布的、可自由滑動的圓形檔輪,相向設(shè)置的兩擋桿之間的距離略大于被檢測輪對的中心軸的直徑。
感知傳感器[11]為紅外傳感器,置于裝置本體的上表面且位于所述推移擋桿機構(gòu)的中心位置,中心位置是指在對稱安裝的兩個減速器的正中間。用以感知被檢測輪對是否處于感知傳感器的上方。在其裝置本體的左右兩側(cè)還分別設(shè)有測距傳感器,同時還在其擋桿上還配置有力矩傳感器,且所述紅外傳感器、測距傳感器以及力矩傳感器均分別與所述控制器進行通信。
限位傳感器,置于裝置本體的下表面并感應(yīng)地面鋪設(shè)的導航條或電子標簽,通過導航條或電子標簽引導所述裝置本體在地面上行走。
移動機構(gòu),安裝于所述裝置本體的四角上,驅(qū)動所述裝置本體沿規(guī)劃的路線移動。移動機構(gòu)包括對角線設(shè)置的一組舵輪和對角線設(shè)置的一組萬向腳輪,且舵輪和萬向腳輪均安裝在所述裝置本體內(nèi)并位于該裝置本體的四角上。舵輪還包括有控制舵輪行走方向的第一伺服驅(qū)動器和控制舵輪前進后退的第二伺服驅(qū)動器,第一伺服驅(qū)動器和第二伺服驅(qū)動器均分別與控制器保持通信并接收控制器發(fā)出的移動信號。舵輪通過舵輪連接座安裝在裝置本體內(nèi),萬向腳輪通過腳輪支座安裝在所述裝置本體內(nèi)。
控制器,設(shè)于所述裝置本體內(nèi),接收所述感知傳感器和限位傳感器的采集信號,并發(fā)出控制推移擋桿機構(gòu)內(nèi)擋桿的升降信號和控制移動機構(gòu)前進后退的移動信號,實現(xiàn)被檢測輪對的自動推移。
裝置本體內(nèi)還設(shè)置有供電電池,用以對裝置本體內(nèi)的用電設(shè)備進行供電。裝置本體的殼體上還設(shè)有與供電電池相連的充電端子,充電端子與配置在外部充電設(shè)備上的電動伸縮充電刷相接觸后為電池進行供電。模型設(shè)計圖如圖6所示。
1.推移擋桿機構(gòu);2.舵輪機構(gòu);3.裝置本體;4.控制器。
火車車輛輪軸智能運輸機器人通過控制器、移動機構(gòu)、推桿機構(gòu)、各個傳感器之間的相互通信,實現(xiàn)了將火車輪軸自動運輸至檢測工位的過程,同時智能運輸機器人監(jiān)控系統(tǒng)的設(shè)計具備的方便、直觀、實時控制等特點。該設(shè)備的成功應(yīng)用,在一定程度上解決了火車輪軸在檢測工位上頻繁轉(zhuǎn)換、生產(chǎn)效率低下的問題,從而為相關(guān)企業(yè)帶來較好的經(jīng)濟效益。