閱讀 | 訂閱
閱讀 | 訂閱
控制系統(tǒng)

基于通信方式的三菱伺服絕對(duì)值位置控制系統(tǒng)(二)

星之球激光 來源:中電網(wǎng)2012-10-16 我要評(píng)論(0 )   

4 控制軟件編制 在本控制系統(tǒng)的軟件中,主要是通訊程序的編制。其他一些如定位控制、位置速度控制方式的切換、模擬量速度控制等程序比較普通,在此不予介紹,我們著重介...

4  控制軟件編制
            
  在本控制系統(tǒng)的軟件中,主要是通訊程序的編制。其他一些如定位控制、位置速度控制方式的切換、模擬量速度控制等程序比較普通,在此不予介紹,我們著重介紹plc主機(jī)如何通過485通訊卡來讀取伺服驅(qū)動(dòng)器中伺服電機(jī)的當(dāng)前絕對(duì)位置的控制軟件。
            
  4.1 三菱mr-j2s-a伺服系統(tǒng)通訊協(xié)議
            
  該伺服系統(tǒng)具有rs422串行通訊功能,伺服系統(tǒng)作為從站,控制器作為主站。主控制器通過該通訊功能可實(shí)現(xiàn)對(duì)伺服驅(qū)動(dòng)器的運(yùn)行控制、參數(shù)的修改讀取、伺服驅(qū)動(dòng)器當(dāng)前運(yùn)動(dòng)狀態(tài)的讀取等。我們?cè)谶@里只需要讀取伺服電機(jī)的當(dāng)前絕對(duì)位置值。
            
 ?。?)通訊格式:

 ?。?)通訊協(xié)議:三菱j2s系列伺服系統(tǒng)的通訊協(xié)議大致分為四種格式:從控制器向伺服驅(qū)動(dòng)器發(fā)送數(shù)據(jù)、控制器從伺服驅(qū)動(dòng)器接送數(shù)據(jù)、通訊超時(shí)處理、通訊重試。在這里我們主要使用第二種格式的通訊協(xié)議,即控制器從伺服驅(qū)動(dòng)器接送數(shù)據(jù)的通訊協(xié)議。該種格式的通訊協(xié)議:

  在上述協(xié)議中,所有報(bào)文均以ascii碼表示。在主站控制器發(fā)出的報(bào)文中,soh(通訊開始)、stx(報(bào)文開始)和etx(報(bào)文結(jié)束)的ascii碼分別為01h、02h和03h。讀絕對(duì)位置的指令為02,則對(duì)應(yīng)的ascii碼為30h、31h,絕對(duì)位置值(指令脈沖單位)對(duì)應(yīng)的數(shù)據(jù)號(hào)為91,對(duì)應(yīng)的ascii碼為39h、31h。站號(hào)是在伺服驅(qū)動(dòng)器中設(shè)置的站號(hào),假如設(shè)置為0時(shí),則對(duì)應(yīng)的ascii碼為30h。其校驗(yàn)和的計(jì)算范圍為站號(hào)到etx,將其每一位數(shù)據(jù)的ascii碼進(jìn)行求和,得到結(jié)果的低二位即為校驗(yàn)和數(shù)據(jù)。在主站控制器收到的報(bào)文中,stx、站號(hào)、etx與前面一樣,不再重復(fù)了。當(dāng)通訊正常時(shí),錯(cuò)誤代碼為a(伺服不報(bào)警時(shí))或a(伺服報(bào)警時(shí)),當(dāng)通訊不正常時(shí),則錯(cuò)誤代碼不等于a或a,而是其他字符。數(shù)據(jù)即為絕對(duì)位置數(shù)據(jù),長(zhǎng)度為8幀。其校驗(yàn)和的計(jì)算范圍也是為站號(hào)到etx,也是取每位ascii碼計(jì)算和的低二位。
            
  (3)相關(guān)的驅(qū)動(dòng)器參數(shù):p#16參數(shù)用于設(shè)置波特率、rs232/rs422通訊選擇、通訊等待時(shí)間。我們選用波特率為19200pbs,rs422通訊口,通訊等待時(shí)間有效,則p#16=1101。
            
  p#15參數(shù)用于設(shè)置站號(hào),在本案中設(shè)為0。
            
  4.2 fx2n系列plc無協(xié)議通訊指令(rs指令)
            
  fx2n系列plc內(nèi)置串行數(shù)據(jù)傳送指令,可以通過rs-232或rs-422通訊口與其它設(shè)備進(jìn)行串行通訊。其通訊協(xié)議可根據(jù)所要與其進(jìn)行通訊的設(shè)備的通訊協(xié)議進(jìn)行編制。
            
 ?。?)通訊格式:串行數(shù)據(jù)傳送rs指令的通訊格式通過plc的特殊數(shù)據(jù)寄存器d8120來設(shè)置。在最新的fx3u系列plc中可通過設(shè)置plc參數(shù)來設(shè)置,而在fx2n中只能通過plc程序來設(shè)置。本案中d8120的b15-b8只能設(shè)置為00001100,在此不作介紹。b7-b0用于設(shè)置傳輸?shù)牟ㄌ芈?、?shù)據(jù)長(zhǎng)度等,這些參數(shù)必須與j2s伺服驅(qū)動(dòng)器的通訊參數(shù)相一致。當(dāng)b7-b4=1001時(shí),對(duì)應(yīng)的傳輸波特率為19200 
            
  bps;當(dāng)b3=0時(shí),對(duì)應(yīng)停止位為1位;當(dāng)b2b1=11時(shí),對(duì)應(yīng)奇偶校驗(yàn)為偶校驗(yàn);當(dāng)b0=1時(shí),對(duì)應(yīng)的數(shù)據(jù)長(zhǎng)度為8位。所以d8120=0000110010000111,即h0c97。
            
 ?。?)串行數(shù)據(jù)傳送rs指令:rs指令的指令格式為 rs  d10 k10 d20 k14;其中d10為發(fā)送數(shù)據(jù)首地址,k10為    
           #p#分頁標(biāo)題#e# 
  發(fā)送數(shù)據(jù)的個(gè)數(shù)(在本案中為10),d20為接收數(shù)據(jù)存放的首地址,k14為接收數(shù)據(jù)的個(gè)數(shù)(在本案中為14)。
            
  4.3 plc和伺服驅(qū)動(dòng)器的通訊程序
            
  在了解了伺服驅(qū)動(dòng)器的通訊協(xié)議和plc的通訊指令后,編制相應(yīng)的通訊程序,目標(biāo)是實(shí)時(shí)讀取伺服驅(qū)動(dòng)器的絕對(duì)位置。該通訊程序大致可分為通訊實(shí)現(xiàn)和通訊錯(cuò)誤判斷兩個(gè)部分。
            
  (1)報(bào)文構(gòu)成:據(jù)前述的通訊協(xié)議,我們知道,讀電機(jī)絕對(duì)位置時(shí)的協(xié)議格式為:
            
  轉(zhuǎn)換成ascii碼,則為:

  校驗(yàn)和的計(jì)算范圍為站號(hào)到etx的7個(gè)幀,計(jì)算方法是將其轉(zhuǎn)化成ascii碼的數(shù)加起來取其低二位。具體計(jì)算如下:

  30h+30h+32h+02h+39h+31h+03h=101h,取其低二位,則位01。再取其對(duì)應(yīng)的ascii碼,得30h、31h。該值即位發(fā)送報(bào)文中的校驗(yàn)和值。所以,讀絕對(duì)位置要發(fā)送的報(bào)文即為01h 30h 30h 32h 02h 39h 31h 03h 30h 31h

       (2)主通訊程序:圖4是通訊主程序,通過這段程序可得到儲(chǔ)存在d50中伺服電機(jī)絕對(duì)位置值。程序段a是在plc開始運(yùn)行時(shí),將根據(jù)伺服系統(tǒng)的通訊協(xié)議編制的報(bào)文寫入發(fā)送數(shù)據(jù)塊。程序段b選擇8位數(shù)據(jù)模式。程序段c激活通訊指令。程序段d每100毫秒對(duì)發(fā)送標(biāo)志m8122置位,發(fā)送完成后自動(dòng)復(fù)位。在程序段e,當(dāng)接收完成時(shí),接收完成標(biāo)志m8123置1,將接收到的數(shù)據(jù)送到d30—d43中,并同時(shí)將m8123復(fù)位。程序段f,將14幀接收數(shù)據(jù)中的位置數(shù)據(jù)(從第4幀到第11幀)通過轉(zhuǎn)換指令hex轉(zhuǎn)換成16進(jìn)制數(shù)據(jù),最后將位置數(shù)據(jù)送入d50。

            圖4  通訊程序
   

         
 ?。?)通訊出錯(cuò)檢測(cè)程序:為了保證讀入的位置數(shù)據(jù)的正確性,必須對(duì)整個(gè)通訊過程進(jìn)行出錯(cuò)檢測(cè)。在這里我們主要核對(duì)讀入數(shù)據(jù)的校驗(yàn)和的方法來進(jìn)行通訊錯(cuò)誤校驗(yàn)。前面我們介紹過,計(jì)算接收?qǐng)?bào)文數(shù)據(jù)校驗(yàn)和的計(jì)算范圍為stx之后的11幀數(shù)據(jù)。所以具體做法是,根據(jù)讀入的數(shù)據(jù)計(jì)算stx之后的11幀的校驗(yàn)和,再與接收到報(bào)文中校驗(yàn)和(最后兩幀)進(jìn)行比較。在圖5的通訊出錯(cuò)檢測(cè)程序段中,指令h用于計(jì)算從伺服驅(qū)動(dòng)器接收到數(shù)據(jù)的校驗(yàn)和。指令i用于取計(jì)算得到的校驗(yàn)的低二位,指令j用于將接收到的校驗(yàn)和轉(zhuǎn)換成16進(jìn)制。指令k用于比較實(shí)際計(jì)算得到的校驗(yàn)和與接收到的校驗(yàn)和進(jìn)行比較,若不相等,則通訊出錯(cuò)。通訊出錯(cuò)后處理,限于篇幅,在此不作介紹。#p#分頁標(biāo)題#e#

            圖5   檢測(cè)程序 
        

    
5  結(jié)束語
            
  通過上述硬件和軟件兩方面的結(jié)合,整個(gè)控制系統(tǒng)就能滿足本文開始時(shí)所描述的控制任務(wù)要求。plc控制伺服系統(tǒng)進(jìn)行定位控制是一種典型的控制模式,而應(yīng)用通訊技術(shù)實(shí)現(xiàn)伺服系統(tǒng)的絕對(duì)位置檢測(cè)和控制更是一種實(shí)用的技術(shù)。本文所討論的三菱fx2n系列plc實(shí)時(shí)讀取三菱mr-j2s-a系列伺服系統(tǒng)當(dāng)前位置的實(shí)現(xiàn)方式,不僅對(duì)類似的控制場(chǎng)合具有借鑒意義,而且對(duì)plc與其他設(shè)備的通訊程序編制也有啟發(fā)意義。

 

轉(zhuǎn)載請(qǐng)注明出處。

暫無關(guān)鍵詞
免責(zé)聲明

① 凡本網(wǎng)未注明其他出處的作品,版權(quán)均屬于激光制造網(wǎng),未經(jīng)本網(wǎng)授權(quán)不得轉(zhuǎn)載、摘編或利用其它方式使用。獲本網(wǎng)授權(quán)使用作品的,應(yīng)在授權(quán)范圍內(nèi)使 用,并注明"來源:激光制造網(wǎng)”。違反上述聲明者,本網(wǎng)將追究其相關(guān)責(zé)任。
② 凡本網(wǎng)注明其他來源的作品及圖片,均轉(zhuǎn)載自其它媒體,轉(zhuǎn)載目的在于傳遞更多信息,并不代表本媒贊同其觀點(diǎn)和對(duì)其真實(shí)性負(fù)責(zé),版權(quán)歸原作者所有,如有侵權(quán)請(qǐng)聯(lián)系我們刪除。
③ 任何單位或個(gè)人認(rèn)為本網(wǎng)內(nèi)容可能涉嫌侵犯其合法權(quán)益,請(qǐng)及時(shí)向本網(wǎng)提出書面權(quán)利通知,并提供身份證明、權(quán)屬證明、具體鏈接(URL)及詳細(xì)侵權(quán)情況證明。本網(wǎng)在收到上述法律文件后,將會(huì)依法盡快移除相關(guān)涉嫌侵權(quán)的內(nèi)容。

網(wǎng)友點(diǎn)評(píng)
0相關(guān)評(píng)論
精彩導(dǎo)讀