Posted in

By

第 11 / 24 篇更新於 2026-11-17約 80 分鐘English

早期使用一般馬達來作定位控制,由於速度不快、或者精度要求不高,所以足以應付所需;當機械運轉為了求取效率而將速度加快時,當製成品品質、精度要求愈高時,馬達停止位置之控制就不是一般馬達所能勝任了!解決此問題之最佳方案是採用NC定位控制器搭配步進或伺服馬達作定位控制。但在過去,因其價位極高,而限制了其使用之普遍性,近年來拜技術之精進及成本之降低,其價位己堪稱低廉,使用之數量己有愈來愈多之趨勢。為因應此趨勢,FBs-PLC將目前市售專用之NC定位控制器功能整合在FBs-PLC內部SoC晶片內,除免卻PLC與專用NC定位控制器間繁雜之資料交換與連結程序外,更大幅降低整體成本,為使用者提供一價廉質優、簡易方便之PLC整合NC定位控制之答案。

11.1 NC定位控制之方式

PLC與步進或伺服驅動器之控制界面大致有下列方式:

z透過數位I/O方式下達命令:使用簡單但應用靈活度較差

z透過類比輸出方式下達命令:控制反應較靈敏但成本較高且較易受雜訊干擾

z透過通訊方式下達命令:通訊協定無標準且受限於通訊反應,因此應用有瓶頸

z透過高速脈波方式下達命令:成本低廉容易準確控制

以高速脈波方式控制步進或伺服驅動器是較常被使用之方式;PLC之CPU模組如有內含多軸高速脈波輸出以及高速硬體計數器,且能提供簡易使用、設計之定位程式編輯,則對於此方面之應用,更是如虎添翼、如魚得水、得心應手極了!

常用的PLC結合伺服驅動器所構成之NC伺服系統有如下二種:

z半閉迴路控制

PLC衹負責送出高速脈波命令給伺服驅動器,裝在伺服馬達之位移偵測信號直接迴授至伺服驅動器,閉迴路僅及伺服驅動器與伺服馬達;優點是控制簡單精度已足(已適合大部份之應用),缺點是不能真正反應實際經過傳動元件之真正位移量,況且如元件磨耗、老化或不良,無法加以補償或檢知。

z閉迴路控制

PLC負責送出高速脈波命令給伺服驅動器,除了裝在伺服馬達之位移偵測信號直接迴授至伺服驅動器外,外加位移偵測器裝在傳動元件之後,真正反應實際位移量,並將此信號迴授至PLC內含之高速硬體計數器,如此可作更精緻之控制,且可避免上述半閉迴路之缺點。

11.2 絕對座標與相對座標

移動距離之指定,可以絕對位置來指定(絕對座標定位),或以相對距離來指定(相對座標定位);而DRV指令用來驅動馬達。

當以絕對座標來標示移動距離時,
如目前位於100mm,欲行走至300mm時,則定位指令為:DRV ABS, ,300,Ut 如目前位於300mm,欲行走至 0mm時,則定位指令為:DRV ABS, , 0,Ut

當以相對座標來標示移動距離時,
如目前位於100mm,欲行走至300mm時,則定位指令為:DRV ADR,+,200,Ut 如目前位於300mm,欲行走至 0mm時,則定位指令為:DRV ADR,−,300,Ut

h絕對座標標示

欲由位置300mm,移至0mm時,程式寫法:

...

DRV

ABS,

, 0,Ut

...

-100

0

100

200

300

欲由位置100mm,移至300mm時,程式寫法:

DRV

ABS,

,300,Ut

h相對座標標示

欲由位置300mm,移至0mm時,程式寫法:

DRV ADR,-,300,Ut

...

...

-100

0

100

200

300

欲由位置100mm,移至300mm時,程式寫法: DRV ADR,+,200,Ut

11.3 使用FBs-PLC定位控制之步驟

開始

在WinProladder或FP-08C之建構功能下建構
高速脈波輸出(HSPSO)功能,將FBs-PLC之
Y 0~Y 7輸出切換到SoC內部之HSPSO電路, ——h配線請參閱13.4.2小節。

並決定輸出脈波之工作模式(U / D P S / D I R A/B),並完成PLC與定位驅動器之硬體配線。

每軸馬達以一個FUN140控制(亦可一個以上,但同時間只能一個啟動),再利用FUN140之衍

生定位指令(DRV,SPD… 等),撰寫所需之定位控制程式,將之填入FUN140 SR參數指定之暫存器區內,啟動FUN140之輸入控制即可進

行定位運動控制。

若需作閉迴路控制,可利用FBs-PLC之硬體高

速計數器,計數傳動元件後之回授脈波(如Encoder等)來達成。

完成

——h請參閱 FUN140及其衍生定位指

令之功能與用法說明。

11.4 FBs-PLC之定位控制硬體說明

11.4.1

HSPSO之輸出電路結構

FBs-PLC依機型之不同,在輸出脈波頻率方面則分為可達200KHz(高速)/20KHz(中速)之單端電晶體輸出機型(FB s-××MCT ),20KHz (中速)之單端電晶體輸出機型(FBs-xxMAT)及可高達920KHz之超高速差動輸出之機型(FB s-××MNT)三種系列型別。

高速脈波輸出電路共用FBs-PLC之Y 0~Y 7外界輸出點。在未使用到HSPSO功能(未於建構功能下建構PSO功能)時,FBs-PLC之Y 0~Y 7外界輸出點是對應到PLC內部之輸出繼電器Y 0~Y 7之狀態。但當有建構HSPSO時,則Y 0~Y 7外界輸出點將直接切換到SoC內部之HSPSO輸出電路,和PLC內部之Y 0~Y 7繼電器無關。

下表為FBs-PLC主機各軸輸出點之信號明細與可選擇之輸出模式:

軸號

外 界

輸出點

輸

出

模

式

U/D輸出

P/R輸出

A/B輸出

僅單點K輸出

PSO0

Y0 , Y 1

Y 0=U , Y 1=D

Y 0=P , Y 1=R

Y 0=A , Y1=B

Y 0=P

PSO1

Y2 , Y 3

Y 2=U , Y 3=D

Y 2=P , Y 3=R

Y 2=A , Y3=B

Y 2=P

PSO2

Y4 , Y 5

Y 4=U , Y 5=D

Y 4=P , Y 5=R

Y 4=A , Y5=B

Y 4=P

PSO3

Y6 , Y 7

Y 6=U , Y 7=D

Y 6=P , Y 7=R

Y 6=A , Y7=B

Y 6=P

※輸出脈波最高可達920KHz(單相:U/D,P/R)或460KHz(雙相:A/B)。

11.4.2 FBs-PLC定位控制之硬體配線

以FB s -xxMCT、FB s -xxMAT及FB s -xxMNR(T)主機之第0軸(PSO0)為例,圖示於下,其餘亦同。

A、F

B S -xxMCT、FB S -xxMAT單端輸出之配線

驅動器 (光藕合輸入)

A相

+

5~24V

DC

(或U或PLS)

外加電源

B相

(或D或DIR)

* R(假負載……提升速度用)之使用請參閱硬體篇手冊H7-5頁之說明

FBs主機

驅動器 (OP輸入例)

FB 主機

Y0

R

R

Va

A相

+

A

5~24V DC

(或U或PLS)

Y1

B

B相

外加電源

(或D或DIR)

C0 C

B、FB S -XXMNR(T)主機差動輸出之配線

FBS-XXMN PLC

Y0+ A+

Y0

Y0-

雙絞線

A-

A相(或U或PLS)

Y1

SG

FG

B相(或D或DIR)

Y1+

B+

Y1-

B-

FBS-XXMN PLC

Y0+ A+

Y0

Y0-

雙絞線

A-

A相(或U或PLS)

Y1

SG

FG

B相(或D或DIR)

Y1+

B+

Y1-

B-

(Line Receiver輸入需使PLC與驅動器之FG相連,除去共模電位)

利用WinProladder規劃HSPSO

系

統

組

統

I/O組態Æ選擇”輸出設定”。

於專案視窗中點選I/O組態: 專案名稱

出現輸出設定畫面後,便可以決定欲輸出之型態:

11.5 FBs-PLC之定位控制功能說明

FBs-PLC之定位功能將市售專用NC定位控制器整合於PLC內,使PLC與NC控制器能共用相同之資料區,而無需作兩系統間之資料交換與同步控制等繁複工作,但仍可用一般習用之NC定位控制指令(例如DRV、SPD… 等)。

一台FBs-PLC最多可控制4軸之定位運動,並可作多軸同動控制,除了僅提供點對點之定位速度控制,並提供各軸間直線補間功能。當系統應用超過4軸時尚可利用FBs-PLC之CPU LINK功能達到更多之定位運動控制。

FB s-XXMCT、FBs -XXMN主機所使用之NC定位控制指令完全相同。其差異如前節所述,僅在於輸出電路之不同而己。我們假設FB s-XXMCT主機主要用於較低速之步進或伺服馬達控制,而FBs -XXMN主機則應用於高速之伺服馬達控制。因此以下我們僅以FB s-XXMCT主機驅動步進馬達之連線示意圖及 FBs -XXMN主機驅動伺服馬達之連線示意圖說明,當然用FB s-XXMCT主機去驅動伺服馬達或以FBs -XXMN主機去驅動步進馬達,只要其電路結構(單端或差動)及頻率能搭配仍然可以完美工作。

11.5.1 FBs-PLC之步進馬達界面

h步進馬達是專門接受輸入脈波來達成角度或距離之控制;因此,馬達之回轉角度與外部輸

入之脈波數成正比,而馬達之轉速與脈波頻率成正比。

N:馬達轉速(RPM)

N(RPM)= 60 × f / n f :脈波頻率(Ps/Sec)

n:馬達轉一圈所需之脈波數(Ps/ Rev)

n = 360 / θs θs:角度(Deg)

相數

基 本

脈波角度

FULL

HALF

脈波角度

轉一圈所需脈波

脈波角度

轉一圈所需脈波

5相

0.36°

0.36°

1000

0.18°

2000

0.72°

0.72°

500

0.36°

1000

4相

0.90°

0.90°

400

0.45°

800

2相

1.80°

1.80°

200

0.90°

400

11.5.2 FBs-PLC之伺服馬達界面

※ 上圖Y0~Y7為特定使用外,Y8~Y11及各輸入點可根據需要自行調配使用。

※ 安全保護之左限、右限極限開關信號亦需接入PLC以確保能安全作動。

11.5.3 伺服馬達工作示意圖

伺服驅動器

正轉脈波
偏差值
上/下

FBs-XXMN

清除偏差計數器(CLR)

反轉脈波

計數器

D/A轉換

主

機

偏差計數器
位置到達(Finish)

回饋脈波

F V轉換

放大器伺服馬達

h伺服馬達之譯碼器(Encoder)將位移偵測信號回饋至伺服驅動器,驅動器將輸入信號之脈波頻率和脈波數與回饋信號之頻率和脈波數,經內部之偏差計數器與頻率轉電壓電路處理後,得到脈波偏差值與轉速誤差值,藉以控制伺服馬達達成高速、精密之速度與位置閉迴路處理系統。

h伺服馬達之轉速與輸入信號之脈波頻率成正比,而馬達之移動量則由脈波數決定。h一般而言,伺服馬達之控制誤差為±1個脈波。

11.6 NC定位控制指令之功能說明

FBs-PLC之NC定位控制相關之指令,如下五個指令。

hFUN140(HSPSO)單軸高速脈波輸出指令,包含如下之9個衍生定位指令:

1. SPD 4. DRVZ

7. EXT

用來撰寫定位程式,存

2. DRV 5. WAIT

8. GOTO

入FUN140之SR表格

3. DRVC 6. ACT

9. MEND

hFUN141(MPARA)定位參數設定指令
hFUN142(PSOFF)強制停止脈波輸出指令
hFUN143(PSCNV)目前脈波值轉換為顯示值指令
hFUN147(MHSPO)多軸直線補間高速脈波輸出指令,包含如下之7個衍生定位指令:

1. SPD 4. WAIT

7. MEND

用來撰寫定位程式,存

2. LIN 5. EXT

入FUN147之SR表格

3. LINE 6. GOTO

茲分別就上述五指令詳細功能說明於後:

NC定位控制指令

FUN140 HSPSO

單軸高速脈波輸出
(含衍生定位指令)

FUN140 HSPSO

執行控制

EN

階梯圖符號

ACT

Ps:第幾組Pulse Output (0~3)

140.HSPSO

Ps :
SR :
WR :

0:Y0 & Y1

脈波輸出中

1:Y2 & Y3
2:Y4 & Y5

暫停輸出

PAU

ERR

3:Y6 & Y7

指令執行

SR:定位程式起始暫存器

放棄輸出

ABT

DN

錯誤

WR:指令運作起始暫存器,共佔用7個暫存

定位點完成

器,其它程式不可重覆使用

HR

DR

ROR

K

R0

D0

R5000

∣

∣

∣

R3839

D3999

R8071

Ps

0~3

SR

○

○

○

WR

○

○

○*

指令說明

1. FUN140(HSPSO)指令之NC定位程式是以文字之程式書寫方式來編輯;每一定位點我們稱一步(含輸出頻率、動作行程、轉移條件),一個FUN140最多可編250步定位點,每一步定位點需佔用9個暫存器。

2. 將定位程式存在暫存器最大好處是,如果結合人機作機台操控設定,則可將定位程式存入人機,更換模具時,可直接由人機操作存取該副模具之定位程式。

3. 當執行控制輸入〝EN〞=1時,如Ps0~Ps3沒有被其它FUN140指令佔用(Ps0=M1992、Ps1=M1993、Ps2=M1994、Ps3=M1995之狀態為ON),則由下一步定位點開始執行(如已至最後一步,則重新由第1步開始執行);如Ps0~3被其它FUN140指令佔用(Ps0=M1992、Ps1=M1993、Ps2=M1994、Ps3=M1995之狀態為OFF),則等佔用之FUN140釋出控制權,本指令取得定位控制之脈波(Pulse)輸出權。

4. 當執行控制〝EN〞=0時,馬上停止脈波輸出。

5. 當暫停輸出〝PAU〞=1,且執行控制〝EN〞先前為1時,則暫停脈波輸出;當暫停輸出〝PAU〞=0,而執行控制〝EN〞仍為1時,繼續輸出未完成之脈波數。

6. 當放棄輸出〝ABT〞=1時,馬上停止脈波輸出。

(下一次當執行控制輸入〝EN〞=1時,重新由第一步定位點開始執行)

7. 當脈波輸出中,輸出指示〝ACT〞ON。

8. 當指令執行錯誤時,輸出指示〝ERR〞ON。
(錯誤代碼存放於錯誤碼暫存器)

9. 當每一步定位點完成時,輸出指示〝DN〞ON。

NC定位控制指令

FUN140 HSPSO

單軸高速脈波輸出
(含衍生定位指令)

FUN140 HSPSO

*** 務必設定Pulse Output之工作模式(不設定時,Y0~Y7當作一般輸出)為U/D,P/R或A/B等三種模式之一,Pulse Output才能正常輸出。

U/D 模式:Y0(Y2,Y4,Y6)送出上數脈波。

Y1(Y3,Y5,Y7)送出下數脈波。

P/R 模式:Y0(Y2,Y4,Y6)送出脈波。

Y1(Y3,Y5,Y7)送出方向信號;ON=上數,OFF=下數。A/B 模式:Y0(Y2,Y4,Y6)送出A相脈波。

Y1(Y3,Y5,Y7)送出B相脈波。

● Pulse Output輸出極性可選擇Normal ON或Normal OFF。

【介面處理信號】

M1991

ON :停止或暫停FUN 140,減速後停止脈波輸出。

OFF :停止或暫停FUN 140,立即停止脈波輸出。

M1992

ON :代表Ps0 Ready。

OFF :代表Ps0 作動中。

M1993

ON :代表Ps1 Ready。

OFF :代表Ps1 作動中。

M1994

ON :代表Ps2 Ready。

OFF :代表Ps2 作動中。

M1995

ON :代表Ps3 Ready。

OFF :代表Ps3 作動中。

M1996

ON : Ps0 完成最後一步。

M1997

ON : Ps1 完成最後一步。

M1998

ON : Ps2 完成最後一步。

M1999

ON : Ps3 完成最後一步。

M2000:ON,多軸同動(控制Ladder程式在同一掃描時間,Ps0~3之FUN140同時啟動,

則其脈波會同時輸出而不會有任何時差)。

:OFF,Ps0~3之FUN140啟動時,該軸脈波立即輸出;由於Ladder程式是先後執行,所以就算Ps0~3之FUN140在同一掃描時間啟動,其脈波輸出一定會有時差。

Ps No.

目前輸出頻率

目前PS位置

剩餘待輸出PS數

錯誤碼

Ps0

DR4080

DR4088

DR4072

R4060

Ps1

DR4082

DR4090

DR4074

R4061

Ps2

DR4084

DR4092

DR4076

R4062

Ps3

DR4086

DR4094

DR4078

R4063

※

R4056

:低位元組之值=5AH時,高速脈波輸出中,可隨時動態更改輸出頻率。

低位元組之值不為5AH時,高速脈波輸出中,不能動態更改輸出頻率。

NC定位控制指令

FUN140

單軸高速脈波輸出

FUN140

HSPSO

(含衍生定位指令)

HSPSO

R4056:內定值為0。

R4064:Ps0每步結束時之步號。 R4065:Ps1每步結束時之步號。 R4066:Ps2每步結束時之步號。 R4067:Ps3每步結束時之步號。

● 定位程式格式:

SR:定位程式起始暫存器,說明如下:

SR

A55AH

;有效定位程式,起始暫存器旗標必為A55AH

SR+1

總步數

;1~250

SR+2
SR+3
SR+4
SR+5
SR+6 第一步定位點程式(每步佔用9個暫存器)SR+7
SR+8
SR+9
SR+10

第N步定位點程式

SR+N×9+2

NC定位控制指令

FUN140 HSPSO

單軸高速脈波輸出
(含衍生定位指令)

FUN140 HSPSO

● 指令運作工作暫存器說明:

WR為起始暫存器

WR+0 WR+1 WR+2 WR+3 WR+4 WR+5 WR+6

目前工作或停留步數

工作旗標

系統使用

系統使用

系統使用

系統使用

系統使用

WR+0:如果本指令正執行中,則該暫存器之內容值即為正執行之步數(1~N);

如果本指令未執行中,則該暫存器之內容值代表目前所停留之步數。

當執行控制〝EN〞=1時,會將目前步數加一再執行,亦即執行下一步(如果目前步

數已指到最後一步,則會重新由第一步開始執行)。

啟動執行控制〝EN〞=1前,使用者可先更新WR+0之內容值以決定由那一步開始執行(WR+0之內容=0時,執行控制〝EN〞= 1時,代表由第一步開始執行)。

WR+1:B0~B7,總步數。

B8 =ON,暫停輸出。

B9 =ON,等待轉移條件。

B10=ON,連續運轉(輸出總行程設定為0)。

B12=ON,脈波輸出中(輸出指示〝ACT〞)。
B13=ON,指令執行錯誤(輸出指示〝ERR〞)。
B14=ON,一步定位點完成(輸出指示〝DN〞)。

*** 每一步定位點完成後,輸出指示〝DN〞會一直維持ON;如果不想讓輸出指示一直維持ON,則在每步定位點完成後,利用輸出指示線圈所控制之上緣接點指令將WR+1暫存器內容清除為0,即可達成。

NC定位控制指令

FUN140 HSPSO

單軸高速脈波輸出
(含衍生定位指令)

FUN140 HSPSO

錯誤指示

錯誤碼

執行FUN141時

註:錯誤指示暫存器

R4060(Ps0)

0

:無錯誤

內容會保持最近一

R4061(Ps1)

1

:參數0錯誤

次之錯誤碼,如需確

R4062(Ps2)

2

:參數1錯誤

認不再有錯誤發

生,可將錯誤指示暫

R4063(Ps3)

3

:參數2錯誤

存器內容清除為0,

4

:參數3錯誤

祇要其內容一直維

5

:參數4錯誤

持0不變,即代表無

6

:參數5錯誤

錯誤發生。

7

:參數6錯誤

可能之錯誤碼

8

:參數7錯誤

9

:參數8錯誤

10 :參數9錯誤

13 :參數12錯誤

14 :參數13錯誤

15 :參數14錯誤

30 :速度設定變數號碼錯誤

執行FUN140與

31 :速度設定值錯誤

32 :行程設定變數號碼錯誤

33 :行程設定值錯誤

34 :不合法定位程式

35 :步數長度錯誤

36 :超過最大步數

37 :最高頻率錯誤

38 :起始/停止頻率錯誤

39 :移動量補正值太大

執行FUN147時

40 :移動量超出範圍

可能之錯誤碼

41 :DRVC內不允許ABS定址

42 :DRVC不可銜接DRVZ命令

43 :驅動命令碼錯誤

50 :DRVZ工作模式錯誤

51 :近點DOG輸入點錯誤

52 :零點信號PG0輸入點錯誤

53 :歸零清除CLR輸出點錯誤

60 :不合法補間驅動命令

使用WinProladder編輯伺服命令表格
於專案視窗中點選伺服命令表格: 專案名稱

表格編輯

伺服命令表格Æ按右鍵後,點選”新
增伺服命令表格”。

NC定位控制指令

FUN140 HSPSO

單軸高速脈波輸出
(含衍生定位指令)

FUN140 HSPSO

●表格類別:固定為”伺服命令表格”。

●表格名稱:可爲伺服命令表格輸入一容易辨識之名稱,方便日後修改或除錯用。

●表格起始位置 :伺服命令指令(FUN140)所用之資料表格起始暫存器SR之起始位置。

※有關伺服命令表格之詳細說明,請參考WinProladder使用者手冊第五章(表格輸入及編輯)。

NC定位控制指令

FUN140 HSPSO

單軸高速脈波輸出
(含衍生定位指令)

FUN140 HSPSO

z為了讓定位程式易編、易讀、易維護,在FUN140指令下我們衍生出下列幾個相關指令,使用者在WinProladder下即可直接編輯、修改定位程式。

z定位衍生指令列表如下:

指令

運

算

元

說明

SPD

XXXXXX或
Rxxxx 或
Dxxxx

y脈波輸出之頻率或速度(FUN141參數0=0時為速度;參數0=1或2時為頻率,系統內定為頻率);運算元可直接輸入常數或變數(Rxxxx,Dxxxx);當運算元為變數時共需使用二個暫存器,例如D10,即代表D10(Low Word)與D11(High Word)為頻率或速度設定值。

y當選擇使用速度設定時,系統會自動將速度設定值轉 換為頻率輸出。

y頻率輸出範圍:1≦頻率輸出≦921600Hz
*** 當頻率設定值=0時,本指令等待設定值不等於0時,才會執行定位脈波輸出。

DRV

ADR,+,XXXXXXXX,Ut ADR,+,XXXXXXXX,Ps ADR,−,XXXXXXXX,Ut ADR,−,XXXXXXXX,Ps ADR,, XXXXXXXX,Ut ADR,,−XXXXXXXX,Ut ADR,, XXXXXXXX,Ps ADR,,−XXXXXXXX,Ps ADR,+,Rxxxx,Ut
ADR,+,Rxxxx,Ps
ADR,−,Rxxxx,Ut
ADR,−,Rxxxx,Ps
ADR,,Rxxxx,Ut
ADR,,Rxxxx,Ps
ADR,+,Dxxxx,Ut
ADR,+,Dxxxx,Ps
ADR,−,Dxxxx,Ut
ADR,−,Dxxxx,Ps
ADR,,Dxxxx,Ut
ADR,,Dxxxx,Ps
ABS,, XXXXXXXX,Ut ABS,,−XXXXXXXX,Ut ABS,, XXXXXXXX,Ps ABS,,−XXXXXXXX,Ps ABS,,Rxxxx,Ut
ABS,,Rxxxx,Ps
ABS,,Dxxxx,Ut
ABS,,Dxxxx,Ps

y脈波輸出量
(FUN141參數0=1時,單位為Ps;參數0=0或2時, 單位為mm,Deg,Inch;系統內定為Ps)

y當脈波輸出單位不為Ps時,系統會根據FUN141之參數1,2,3設定轉換為Ps數輸出。

y DRV指令運算元共有四項,說明如下:

第一項運算元:定位座標選擇
ADR或ABS: ADR,相對值座標定位。 ABS ,絕對值座標定位。

第二項運算元:運轉方向選擇(相對值座標有效)’ + ‘ 或 ‘ − ‘: ‘ + ‘,正轉或上數。
‘ − ‘,反轉或下數。

或’

‘ : ‘

‘,運轉方向由行程設定值決定

(正值:正轉;負值:反轉)

第三項運算元:行程設定值(脈波輸出量)。

XXXXXXXX 可直接輸入常數或變數(Rxxxx ,或 Dxxxx);當使用變數時共需使用二個−XXXXXXXX 暫存器,例如R0,即代表R0(Low 或Rxxxx Word)與R1(High Word)為行程或Dxxxx 設定值。

*** 當行程設定值=0,不管座標為ADR或ABS,代表連續運轉不停。

行程設定範圍:−99999999 ≤行程設定值≤ 99999999

第四項運算元:行程設定值解析度

Ut或Ps:Ut時,解析度為一個單位;(由FUN141之參數0,3決定)Ps時,強制解析度為一個Ps。

NC定位控制指令

FUN140 HSPSO

單軸高速脈波輸出
(含衍生定位指令)

FUN140 HSPSO

指

令運

算

元

說

明

DRVC ADR,+,XXXXXXXX,Ut 或或或或
ABS,−, Rxxxx ,Ps
或

Dxxxx

DRVC之使用及運算元說明與DRV指令相同。

***DRVC用來做連續多段速度變換控制(最多8段)***DRVC所構成之連續多段速度變換控制,祇有第一個DRVC指令能夠使用絕對值座標定位。

***DRVC之運轉方向決定祇能由’ + ‘ 或 ‘ − ‘決定

***連續多段速度控制之方向(正、反轉)祇能由第一段

之方向決定,後面指令之方向運算元無效;亦即多段

速度變換控制祗能同方向。

例:連續三段速度控制

001 SPD 10000 ;脈波頻率=10 KHz

DRVC ADR,+,20000,Ut ;正轉20000個單位

GOTO NEXT

002 SPD 50000 ;脈波頻率=50 KHz

DRVC ADR,+,60000,Ut ;正轉60000個單位

GOTO NEXT

003 SPD 3000 ;脈波頻率=3 KHz

DRV ADR,+,5000,Ut ;正轉5000個單位

WAIT X0 ;等待X0 ON,重新

GOTO 1 由第一步執行

***注意:DRVC指令之個數必須比連續之段數少一,亦

即最後一段必須使用DRV指令。

y上例為連續三段速度控制,DRVC指令使用二個,第

三段必須使用DRV指令。

y上例圖示:

f

DRVZ

MD0

50000

f2

10000

f1

f3

3000

20000

60000

5000

Ut

DRVZ為原點復歸便利指令,總共提供MD0~MD2三

或

種不同的原點復歸方式;使用者可依據不同的機台機

MD1

構,選擇最適當之原點復歸模式。

或

MD2

***DRVZ指令須主機OS版本V4.32(含)以上方可使用。

***DRVZ指令須搭配WinProladder V2.34(含)以上版本。

***有關DRVZ之MD0~MD2之詳細說明,請參閱11.7

節(機械原點復歸)。

NC定位控制指令

FUN140

單軸高速脈波輸出

FUN140

HSPSO

(含衍生定位指令)

HSPSO

註:相對值座標定位(ADR)與絕對值座標定位(ABS)比較說明 欲由位置30000移至−10000時,程式寫法: DRV ADR,−,40000,Ut或DRV ABS, ,−10000,Ut

...

-10000

0

10000

20000

30000

...

Ut

欲由位置−10000移至10000時,
程式寫法:DRV ADR,+,20000,Ut 或DRV ABS,,10000,Ut

指令

運

算

元

說

明

WAIT

TIME,XXXXX

y當脈波輸出完成時,欲執行下一步之等待指令;

或Rxxxx

運算元共有五種,說明如下:

或Dxxxx

Time:等待時間(單位為0.01秒),可直接輸入常數或變數

(Rxxxx或Dxxxx);當計時到,則執行GOTO所指

之步數。

ACT

或X0~X255

X0~X255:等待輸入接點信號ON,執行GOTO所指之步數。

或Y0~Y255

Y0~Y255:等待輸出接點信號ON,執行GOTO所指之步數。

或M0~M1911

M0~M1911:等待內部繼電器ON,執行GOTO所指之步數。

或 S0~S999

S0~S999:等待步進繼電器ON,執行GOTO所指之步數。

TIME,XXXXX

y脈波輸出ACT所描述之作動時間後,立即執行GOTO所指之步

或Rxxxx

數;亦即脈波輸出一段時間後,立即執行下一步。作動時間(單

或Dxxxx

位為0.01秒),可直接輸入常數或變數(Rxxxx或Dxxxx);當

作動時間到,則執行GOTO所指之步數。

EXT

X0~X255

y外部觸發指令,當脈波輸出中(脈波個數尚未送完),如果外部觸發信號作動(ON),則立即執行GOTO所指之步數;如果脈波輸出已完成,外部觸發信號尚未作動,則與WAIT指令相同,信號(ON)時,才會執行GOTO所指之步數。

y當WAIT,ACT,EXT等指令條件滿足時,利用GOTO指令描述將要執行之步數。

NEXT :代表執行下一步

1~N :執行第幾步

或 Y0~Y255
或 M0~M1911 或 S0~S999

GOTO NEXT
或1~N 或Rxxxx 或Dxxxx

Rxxxx:欲執行之步數存放於暫存器Rxxxx Dxxxx:欲執行之步數存放於暫存器Dxxxx MEND 定位程式結束

NC定位控制指令

FUN140 HSPSO

單軸高速脈波輸出
(含衍生定位指令)

FUN140 HSPSO

z定位程式之書寫:

定位程式在編輯之前,必須要先完成FUN140指令,並在FUN140指令指定欲存放定位

程式之起始暫存器號碼;編輯定位程式時,會將新編之定位程式存入所指定之暫存器區塊,

每編1個定位點(稱為1步)會佔用9個暫存器,如有N個定位點(N步),共佔用N × 9 +

2個暫存器。

*** 注意:儲存定位程式之暫存器不可被重複使用!

z程式格式與範例:

001 SPD 5000 ;脈波頻率=5KHz

DRV ADR,+,10000,Ut ;正轉10000個單位

WAIT TIME,100 ;等待1秒

GOTO NEXT ;執行下一步

002 SPD R1000 ;脈波頻率存放在DR1000(R1001與R1000)

DRV ADR,+,D100,Ut ;正轉行程存放在DD100(D101與D100)

WAIT TIME,R500 ;等待時間存放在R500

GOTO NEXT ;執行下一步

003 SPD R1002 ;脈波頻率存放在DR1002(R1003與R1002)

DRV ADR,−,D102,Ut ;反轉行程存放在DD102(D103與D102)

EXT X0 ;外部觸發X0(減速點)ON時,馬上執行下一步

GOTO NEXT

004 SPD 2000 ;脈波頻率=2K HZ

DRV ADR,−,R4072,Ps ;繼續執行第3步未完成之PS數(存放於DR4072)

WAIT X1 ;等待X1 ON時

GOTO 1 ;執行第一步

NC定位控制指令

FUN140

單軸高速脈波輸出

FUN140

HSPSO

(含衍生定位指令)

HSPSO

程式範例:寸動進(Jog Forward)

當寸進按鈕被按時間小於0.5秒(可變)時,祇輸出一個(可變)脈波;
當寸進按鈕被按時間大於0.5秒(可變)時,連續輸出脈波(頻率為10KHz,可變),直到放開寸進按鈕才停止輸出;或可設計成最多祇能輸出N個脈波數。

寸進按鈕

SERVO

手動

作動

M1

EN

RST

M1

M0

•清除結束訊號

寸進

EN

RST

R 2000

•每次由第一步開始執行

按鈕

READY

條件

M0

M0

EN

140.HSPSO

ACT

M1000

Ps

: 0

定位程式:

PAU

SR: : R 5000

ERR

M1001

001 SPD 1000

WR

: R 2000

DRV ADR,+,1,Ps

M1002

WAIT TIME,50

ABT

DN

GOTO NEXT

002 SPD 10000
DRV ADR,+,999999,Ut
MEND

M0

M1996

EN

SET

M1

•最後一步執行完,設定

結束信號

程式範例:寸動退(Jog Backward)

當寸退按鈕被按時間小於0.5秒(可變)時,祇輸出一個(可變)脈波;
當寸退按鈕被按時間大於0.5秒(可變)時,連續輸出脈波(頻率為10KHz,可變),直到放開寸退按鈕才停止輸出;或可設計成最多祇能輸出N個脈波數。

NC定位控制指令

FUN140

手動

作動

M3

單軸高速脈波輸出

M2

FUN140

HSPSO

(含衍生定位指令)

HSPSO

寸退按鈕

EN

RST

M3

•清除結束訊號

↑

寸退

SERVO

EN

RST

R 2007

•每次由第一步開始執行

按鈕

READY

條件

M2

M2

EN

140.HSPSO

ACT

M1003

Ps

: 0

定位程式:

SR

: R 5020

M1004

PAU

ERR

001 SPD 1000

WR

: R 2007

DRV ADR,−,1,Ps

WAIT TIME,50

ABT

DN

M1005

GOTO NEXT

002 SPD 10000
DRV ADR,−,999999,Ut
MEND

M2

M1996

EN

SET

M3

•最後一步執行完,設定

結束信號

NC定位指令

FUN141

階梯圖符號

ERR

定位程式參數設定指令

FUN141
MPARA

MPARA

執行控制

EN

Ps :第幾組Pulse Output(0~3)

141.MPARA

錯誤訊息

SR :參數表起始暫存器,共18個參數,佔用24個暫存器

Ps :

SR :

Ps

HR

DR

ROR

K

R0

D0

R5000

2

∣

∣

∣

∣

R3839

D3999

R8071

256

○

○

○

0~3

SR

指令說明

1.本指令並不一定要使用;如果系統內定之參數值已符合使用者需求,則可不必用到此指令;

如果需開放參數值作動態修改,則需有此指令。

2.本指令配合FUN140作定位控制使用,每一軸只可使用一個本指令

3.無論控制輸入〝EN〞=0或1時,本指令皆會被執行。

4.當參數值有錯誤時,輸出指示〝ERR〞ON,且錯誤代碼會出現在錯誤碼暫存器。

SR=參數表起始暫存器,假設為R2000

R2000

0~2

參數0

系統內定值=1

R2001

1~65535 Ps/Rev

參數1

系統內定值=2000

1~999999μM/Rev

DR2002

1~999999 mDeg/Rev

參數2

系統內定值=2000

1~999999×0.1 mInch/Rev

R2004

0~3

參數3

系統內定值=2

DR2005

1~921600 Ps/sec

參數4

系統內定值=460000

1~153000

DR2007

0~921600 Ps/sec

參數5

系統內定值=141

1~153000

R2009

1~65535 Ps/sec

參數6

系統內定值=1000

R2010

0~32767

參數7

系統內定值=0

R2011

0~30000

參數8

系統內定值=5000

R2012

0~1

0~1

參數9

系統內定值=0100H

R2013

−32768~32767

參數10

系統內定值=0

R2014

−32768~32767

參數11

系統內定值=0

R2015

0~30000

參數12

系統內定值=0

R2016

0~30000

參數13

系統內定值=500

DR2017

0~1999999

參數14

系統內定值=0

DR2019

00H~FFH

00H~FFH

參數15

系統內定值=FFFFFFFFH

00H~FFH

00H~FFH

DR2021

-999999~999999

參數16

系統內定值=0

R2023

0~255

參數17

系統內定值=1

NC定位指令

FUN141 MPARA

定位程式參數設定指令

FUN141 MPARA

使用WinProladder編輯伺服參數表格

格

編

伺服參數表格Æ按右鍵後,點

於專案視窗中點選伺服參數表格: 專案名稱

選” 新增伺服

參數表格”。

●表格類別:固定為”伺服參數表格”。

●表格名稱:可爲伺服參數表格輸入一容易辨識之名稱,方便日後修改或除錯用。

●表格起始位置 :伺服參數指令(FUN141)所用之資料表格起始暫存器SR之起始位置。

NC定位指令

FUN141 MPARA

定位程式參數設定指令

FUN141 MPARA

參數說明

●

參數0:單位設定,內定值為1

y設定值為0時,程式內所使用之行程與速度設定值均被指定以mm,Deg,Inch

為單位,稱為機械單位。

y設定值為1時,程式內所使用之行程與速度設定值均被指定以Pulse為單位,稱

為馬達單位。

y設定值為2時,程式內所使用之行程設定值均被指定以mm,Deg,Inch為單位,而速度設定均被指定以Pulse為單位,稱為複合單位。

參數0,單位

〝0〞機械單位

〝1〞馬達單位

〝2〞複合單位

參數1,2

必須設定

不必設定

必須設定

參數3,7,10,11

mm,Deg,Inch

Ps

mm,Deg,Inch

參數4,5,6,15,16

Cm/Min,Deg/Min,Inch/Min

Ps/Sec

Ps/Sec

●

參數1:脈波數/1轉,內定值為2000,亦即2000 Ps/Rev

y馬達轉一圈所需之脈波數 (A)
A=1~65535(32767以上時,以十進位正數設定)Ps/Rev y當參數14 = 0時,以參數1為脈波數/1轉。

y當參數14 ≠ 0時,以參數14為脈波數/1轉。

● 參數2:移動量/1轉,內定值為2000,亦即2000 Ps/Rev y馬達轉一圈所帶動之距離 (B)
B=1~999999 μM/Rev
1~999999 mDeg/Rev
1~999999×0.1 mInch/Rev

NC定位指令

FUN141 MPARA

定位程式參數設定指令

FUN141 MPARA

●

參數3:最小設定單位,內定值為2,相當於小數點二位

設定值=1

參數0

設定值=0,機械單位;設定值=2,複合單位;

●

參數3

mm

Deg

Inch

馬達單位Ps

設定值=0

×1

×1

×0.1

×1000

設定值=1

×0.1

×0.1

×0.01

×100

設定值=2

×0.01

×0.01

×0.001

×10

設定值=3

×0.001

×0.001

×0.0001

×1

參數4:最高速度設定,內定值為460000,亦即460000 Ps/Sec

y馬達及複合單位:1~921600 Ps/Sec
y機械單位:1~153000(cm/Min,x10 Deg/Min,Inch/Min)
但最高頻率不能大於921600 Ps/Sec
f_max =(V_max x 1000 x A)/(6 x B)≤ 921600 Ps/Sec f_min ≥ 1 Ps/Sec

註:A=參數1,B=參數2

● 參數5:起始/結束速度,內定值=141
y馬達及複合單位:1~921600 Ps/Sec。

y機械單位:1~15300(cm/Min,×10 Deg/Min,Inch/Min)但最高頻率不能大於921600 Ps/Sec。

● 參數6:原點復歸減速速度,內定值為1000
馬達及複合單位 : 1~65535 Ps/Sec
機械單位: 1~15300 (Cm/Min, x10 Deg/Min, Inch/Min)

● 參數7:齒輪間隙補正值,內定值=0 註:多軸直線補間命令無效 y設定範圍:0~32767 Ps。

y反相行走時,行走距離會自動加上此值。

● 參數8:加減速時間設定,內定值=5000,單位為mS 註:多軸直線補間命令無效 y設定範圍:0~30000 mS。

y此時間代表由靜止加速至最高速度(參數4),或由最高速度減至靜止所需時間。y本系統之加減速乃為等斜率控制。

y當參數12=0時,以本參數為減速時間。

y本系統之加減速控制,依實際動作行程會自動以三角波型或梯形波型運動。

● 參數9:原點復歸方向與運轉方向設定,內定值為0100H 註:多軸直線補間命令無效

b15 b8 b7 b0

SR+12

參數9-1

參數9-0

y參數9-0:運轉方向設定,內定值為0
設定值=0時,正轉脈波輸出、目前Ps值往上加 反轉脈波輸出、目前Ps值往下減設定值=1時,正轉脈波輸出、目前Ps值往下減 反轉脈波輸出、目前Ps值往上加

NC定位指令

FUN141 MPARA

定位程式參數設定指令

FUN141 MPARA

y參數9-1:原點復歸方向設定,內定值為1

設定值=0時,原點復歸方向為目前Ps值往上加方向

(原點在右)

設定值=1時,原點復歸方向為目前Ps值往下減方向

(原點在左)

● 參數10:正轉移動量補正值,內定值=0 註:多軸直線補間命令無效 y設定範圍:−32768~32767 Ps。

y正轉脈波輸出時,會自動加上此值作為移動距離。

● 參數11:反轉移動量補正值,內定值=0 註:多軸直線補間命令無效 y設定範圍:−32768~32767 Ps。

y反轉脈波輸出時,會自動加上此值作為移動距離。

● 參數12:減速時間設定,內定值=0,單位為mS 註:多軸直線補間命令無效 y設定範圍:0~30000 mS。

y當參數12 = 0時,以參數8為減速時間。
y當參數12 ≠ 0時,以參數12為減速時間。

● 參數13:補間加減速時間(定數)設定,內定值為500 註:多軸直線補間命令專用 y設定範圍 : 0~30000 mS
y用來設定直線補間運動時,由靜止(速度=0)加速至工作頻率所需時間;

本時間亦用來作減速停止控制

● 參數14:脈波數/1轉,內定值為0
y設定範圍:0~1999999。

y當參數14 = 0時,以參數1為脈波數/1轉。
y當參數14 ≠ 0時,以參數14為脈波數/1轉。

● 參數15:控制介面I/O設定,內定值為FFFFFFFFH

b15 b8 b7 b0

SR+19 SR+20

參數15-1

參數15-0

參數15-3

參數15-2

y參數15-0:近點DOG輸入接點設定;必須為主機之輸入點(SR+19) b6~b0 :近點DOG輸入接點號碼(0~15,亦即X0~X15) b7 = 0 :近點DOG輸入為常開接點 (A或NO接點) = 1 : 近點DOG輸入為常閉接點 (B或NC接點) b7~b0=FFH, 無近點DOG輸入

y參數15-1:行程極限輸入接點設定 (SR+19)
b14~b8 :行程極限輸入接點號碼(0~125,亦即X0~X125) b15 = 0 :行程極限輸入為常開接點 (A或NO接點)
= 1 :行程極限輸入為常閉接點 (B或NC接點)
b15~b8=FFH :無行程極限輸入

NC定位指令

FUN141 MPARA

定位程式參數設定指令

FUN141 MPARA

y參數15-2:零點信號PG0輸入接點設定;必須為主機之輸入點(SR+20) b6~b0 :零點信號PG0輸入接點號碼(0~15,亦即X0~X15) b7 = 0 :近點DOG前緣開始計數零點信號
= 1 :近點DOG後緣開始計數零點信號
b7~b0 = FFH :無零點信號PG0輸入

y參數15-3:歸零清除信號CLR輸出接點設定;必須為主機之輸出點(SR+20) b15~b8 :歸零清除信號CLR輸出接點號碼(0~23,亦即
Y0~Y23)
b15~b8=FFH :無歸零清除信號CLR輸出

● 參數16:機械原點位置值,內定值為0
-999999~999999 Ps

● 參數17:零點信號數,內定值為1
0~255 Count

速度

參數4 : 最高速度

工作速度

參數5

起始/結束速度

參數8

參數8

時間

加減速時間

或參數12

NC定位指令

FUN142P

PSOFF

強制停止HSPSO脈波輸出指令

FUN142P

PSOFF

N:0~3

強制第幾組Pulse Output停止輸出

指令說明

1. 當停止控制〝EN〞=1或〝EN〞由0→1(P指令)時,本指令將強制所指定之第幾組

Pulse Output停止輸出。

2. 在執行機械原點復歸之應用時,當原點條件滿足時,利用本指令可快速停止脈波輸出,

讓每次作機械原點復歸時,都停在同一個位置。

程式範例

;當M0由0→1時,強制Ps0停止脈波之輸出。

NC定位指令

FUN143P

目前脈波值轉換為顯示值(mm,Deg,lnch,PS)指令

FUN143P

PSCNV

PSCNV

Ps: 0~3;將第幾組脈波位置轉換為與設定值同單位之mm(Deg , Inch , PS),以作為目前位置顯示。

D :儲存轉換後目前位置之暫存器,共需使用二個暫存器;例如D10,即代表D10(Low Word)與D11(High Word)二個暫存器。

Ps

HR

DR

ROR

K

R0

D0

R5000

2

∣

∣

∣

∣

R3839

D3071

R8071

256

0~3

○

○

○*

D

指令說明

1. 當執行控制〝EN〞=1或〝EN〞由0→1(P指令)時,本指令將所指定之目前脈波位置

(Ps)轉換為與設定值同單位之mm(或Deg或Inch或Ps),以作為目前位置顯示。

2. FUN140或FUN147指令執行過後,執行本指令時,才會得到正確之轉換值。

程式範例

;當M0由0→1時,將Ps0目前脈波位置
(DR4088),轉換為與設定值同單位之mm
(或Deg或Inch或PS),並存入DD10以
作為目前位置顯示。

NC定位指令

FUN147 MHSPO

多軸直線補間定位輸出指令

FUN147 MHSPO

執行控制

階梯圖符號

ACT

脈波輸出

Gp:第幾個群組(0~1)

147.MHSPO

SR:定位程式起始暫存器

Gp :

WR:指令運作起始暫存器,共佔用9個暫存

EN

暫停輸出

PAU

SR :

ERR

錯誤訊息

器,其它程式不可重覆使用

WR :

放棄輸出

定位完成

放棄輸出

ABT

DN

DR

ROR

K

HR

R0

D0

R5000

∣

∣

∣

R3839

D3999

R8071

Gp

0~1

SR

○

○

○

WR

○

○

○*

指令說明

1. FUN147(MHSPO)指令之直線補間定位程式是以文字之程式書寫方式來編輯;每一定位點我們稱一步(含輸出頻率、動作行程、轉移條件),每一步定位點需佔用15個暫存器。

2. FUN147(MHSPO)直線補間定位指令最多可同時作四軸直線補間,或兩組獨立之二軸直

線補間運動。

3. 將定位程式存在暫存器最大好處是,如果結合人機作機台操控設定,則可將定位程式存入

人機,更換模具時,可直接由人機操作存取該副模具之定位程式。

4. 當執行控制輸入〝EN〞=1時,如Gp(群組)內的各軸(Ps0~Ps3)沒有被其它FUN140或FUN147指令佔用(Ps0=M1992、Ps1=M1993、Ps2=M1994、Ps3=M1995之狀態為ON),則由下一步定位點開始執行(如已至最後一步,則重新由第1步開始執行);如Gp(群組)內的各軸(Ps0~3)被其它FUN140或FUN147指令佔用(Ps0=M1992、Ps1=M1993、Ps2=M1994、Ps3=M1995之狀態為OFF),則等佔用之FUN140或FUN147釋出控制權,本指令取得定位控制之脈波(Pulse)輸出權。

5. 當執行控制〝EN〞=0時,馬上停止脈波輸出。

6. 當暫停輸出〝PAU〞=1,且執行控制〝EN〞先前為1時,則暫停脈波輸出;當暫停輸出〝PAU〞=0,而執行控制〝EN〞仍為1時,繼續輸出未完成之脈波數。

7. 當放棄輸出〝ABT〞=1時,馬上停止脈波輸出。

(下一次當執行控制輸入〝EN〞=1時,重新由第一步定位點開始執行)

8. 當脈波輸出中,輸出指示〝ACT〞ON。

9. 當指令執行錯誤時,輸出指示〝ERR〞ON。

(錯誤代碼存放於錯誤碼暫存器)

10.當每一步定位點完成時,輸出指示〝DN〞ON。

NC定位指令

FUN147 MHSPO

多軸直線補間定位輸出指令

FUN147 MHSPO

*** 務必設定Pulse Output之工作模式(不設定時,Y0~Y7當作一般輸出) 為U/D或A/B等二種模式之一,Pulse Output才能正常輸出。

U/D 模式:Y0(Y2,Y4,Y6)送出上數脈波。 Y1(Y3,Y5,Y7)送出下數脈波。

A/B 模式:Y0(Y2,Y4,Y6)送出A相脈波。 Y1(Y3,Y5,Y7)送出B相脈波。

● Pulse Output輸出極性可選擇Normal ON或Normal OFF。

【介面處理信號】

M1991

ON : 停止或暫停FUN147,減速後停止脈波輸出OFF: 停止或暫停FUN147,立即停止脈波輸出

M1992

ON : 代表Ps0 Ready
OFF: 代表Ps0作動中

M1993

ON : 代表Ps1 Ready
OFF: 代表Ps1作動中

M1994

ON : 代表Ps2 Ready
OFF: 代表Ps2作動中

M1995

ON : 代表Ps3 Ready
OFF: 代表Ps3作動中

M1934

ON : Gp0完成最後一步定位

M1935

ON : Gp1完成最後一步定位

DR4068

Gp0線(向量)速度顯示暫存器

DR4070

Gp1線(向量)速度顯示暫存器

D4060

Gp0錯誤碼暫存器

D4061

Gp1錯誤碼暫存器

D4062

Gp0定位完成時之步號

D4063

Gp1定位完成時之步號

Ps No.

目前輸出頻率

目前PS位置

剩餘待輸出PS數

Ps0

DR4080

DR4088

DR4072

Ps1

DR4082

DR4090

DR4074

Ps2

DR4084

DR4092

DR4076

Ps3

DR4086

DR4094

DR4078

※

FUN14

7(MHSPO)多軸直線補間定位運動不支援動態更改輸出頻率功能。

NC定位指令

FUN147

多軸直線補間定位輸出指令

FUN147

MHSPO

MHSPO

●

直線補間定位程式格式:

SR:定位程式起始暫存器,說明如下:

SR

A55CH

;有效補間定位程式,起始暫存器旗標必為A55CH

SR+1

總步數

SR+2
SR+3

●

●

第一步定位點程式(每步佔用15個暫存器)

●

●

●

●

●

●

SR+14
SR+15
SR+16

第N步定位點程式

SR+N×15+2

NC定位指令

FUN147 MHSPO

多軸直線補間定位輸出指令

FUN147 MHSPO

● 指令運作工作暫存器說明:

WR為起始暫存器

WR+0 WR+1 WR+2 WR+3 WR+4 WR+5 WR+6 WR+7 WR+8

目前工作或停留步數

工作旗標

系統使用

系統使用

系統使用

系統使用

系統使用

系統使用

系統使用

WR+0:如果本指令正執行中,則該暫存器之內容值即為正執行之步數(1~N);

如果本指令未執行中,則該暫存器之內容值代表目前所停留之步數。

當執行控制〝EN〞=1時,會將目前步數加一再執行,亦即執行下一步(如果目前步

數已指到最後一步,則會重新由第一步開始執行)。

啟動執行控制〝EN〞=1前,使用者可先更新WR+0之內容值以決定由那一步開始執行(WR+0之內容=0時,執行控制〝EN〞= 1時,代表由第一步開始執行)。

WR+1:B0~B7,總步數。

B8 =ON,暫停輸出。

B9 =ON,等待轉移條件。

B10=ON,連續運轉。

B12=ON,脈波輸出中(輸出指示〝ACT〞)。
B13=ON,指令執行錯誤(輸出指示〝ERR〞)。
B14=ON,一步定位點完成(輸出指示〝DN〞)。

*** 每一步定位點完成後,輸出指示〝DN〞會一直維持ON;如果不想讓輸出指示一直維持ON,則在每步定位點完成後,利用輸出指示線圈所控制之上緣接點指令將WR+1暫存器內容清除為0,即可達成。

NC定位指令

FUN147 MHSPO

多軸直線補間定位輸出指令

FUN147 MHSPO

錯誤指示

錯誤碼

執行FUN141時

註:錯誤指示暫存器

R4060(Ps0)

0

:無錯誤

內容會保持最近一

R4061(Ps1)

1

:參數0錯誤

次之錯誤碼,如需確

R4062(Ps2)

2

:參數1錯誤

認不再有錯誤發

R4063(Ps3)

3

:參數2錯誤

生,可將錯誤指示暫

D4060(Gp0)

4

:參數3錯誤

存器內容清除為0,

D4061(Gp1)

5

:參數4錯誤

祇要其內容一直維

6

:參數5錯誤

持0不變,即代表無

7

:參數6錯誤

可能之錯誤碼

錯誤發生。

8

:參數7錯誤

9

:參數8錯誤

10 :參數9錯誤

13 :參數12錯誤

14 :參數13錯誤

15 :參數14錯誤

30 :速度設定變數號碼錯誤

執行FUN140與

31 :速度設定值錯誤

32 :行程設定變數號碼錯誤

33 :行程設定值錯誤

34 :不合法定位程式

35 :步數長度錯誤

36 :超過最大步數

37 :最高頻率錯誤

38 :起始/停止頻率錯誤

39 :移動量補正值太大

執行FUN147時

40 :移動量超出範圍

可能之錯誤碼

41 :DRVC內不允許ABS定址

42 :DRVC不可銜接DRVZ命令

43 :驅動命令碼錯誤

50 :DRVZ工作模式錯誤

51 :近點DOG輸入點錯誤

52 :零點信號PG0輸入點錯誤

53 :歸零清除CLR輸出點錯誤

60 :不合法補間驅動命令

NC定位指令

FUN147 MHSPO

多軸直線補間定位輸出指令

FUN147 MHSPO

使用WinProladder編輯伺服命令表格

格

編

伺服命令表格Æ按右鍵後,點選”新於專案視窗中點選伺服命令表格: 專案名稱

增伺服命令表格”。

●表格類別: FUN147(MHSPO)直線補間指令需選擇”多軸命令表格”。

●表格名稱:可爲多軸命令表格輸入一容易辨識之名稱,方便日後修改或除錯用。●表格起始位置 : FUN147所用之資料表格起始暫存器SR之起始位置。

NC定位指令

FUN147 MHSPO

多軸直線補間定位輸出指令

FUN147 MHSPO

z為了讓定位程式易編、易讀、易維護,在FUN147指令下我們衍生出下列幾個相關指令,使用者在WinProladder下即可直接編輯、修改定位程式。

z補間運動定位衍生指令列表如下:

指令

運

算

元

說明

SPD

XXXXXX或
Rxxxx 或
Dxxxx

y補間運動之線(向量)速度或頻率設定;

1≦設定值≦1840000

y FUN141 參數0=0 時為速度;參數0=1 或2 時為頻率(系統內定為頻率)。運算元可直接輸入常數或變數(Rxxxx,Dxxxx);當運算元為變數時共需使用二個暫存器,例如D10,即代表D10(Low Word)與D11(High Word)為頻率或速度設定值。

y當選擇使用速度設定時,系統會自動將速度設定值轉 換為頻率輸出。

y FUN147指令執行時,會根據線速度計算出各軸之分量 速度並轉換為頻率輸出

y各軸之頻率輸出範圍:1≦頻率輸出≦921600Hz

LIN

ADR,X,Y,Z,W,Ut 或或

ABS Ps

X:Ps0之行程設定值Y:Ps1之行程設定值Z:Ps2之行程設定值W:Ps3之行程設定值

y各軸脈波輸出量設定
(FUN141參數0=1時,單位為Ps;參數0=0或2時, 單位為mm,Deg,Inch;系統內定為Ps)

y當脈波輸出單位不為Ps時,系統會根據FUN141之參數1,2,3設定轉換為Ps數輸出。

y LIN指令運算元共有六項,說明如下:

第一項運算元:定位座標選擇
ADR或ABS: ADR,相對值座標定位。 ABS,絕對值座標定位。

第二~五項運算元:各軸行程設定值(脈波輸出量)。

XXXXXXXX 可直接輸入常數或變數(Rxxxx ,或 Dxxxx);當使用變數時共需使用二個−XXXXXXXX 暫存器,例如R0,即代表R0(Low 或Rxxxx Word)與R1(High Word)為行程或Dxxxx 設定值。

行程設定值為正值時,代表正轉

行程設定值為負值時,代表反轉

*** 當行程設定值=0或空白時(Space)且座標為ADR時, 代表該軸不輸出。

*** 當行程設定值為空白時(Space)且座標為ABS時,代

表該軸不輸出。

*** 行程設定範圍:每軸一次運動之最大移動量為±1999999Ps

第六項運算元:行程設定值解析度

Ut或Ps:Ut時,解析度為一個單位;(由FUN141之參數0,3決定)Ps時,強制解析度為一個Ps。

NC定位指令

FUN147
MHSPO

多軸直線補間定位輸出指令

FUN147 MHSPO

明

指

令運

算

元

說

LINE

ADR,X,Y,Z,W,Ut

LINE為多軸同動連續運轉模式。

或或

ABS Ps

X:Ps0之行程設定值Y:Ps1之行程設定值Z:Ps2之行程設定值W:Ps3之行程設定值

LINE之使用及運算元說明與LIN指令大致相同,唯一有差別的地方在於對第二~五項運算元(行程設定值)之解釋;在LINE運作模式下,四軸的行程設定值將被解釋為一比例關係(行程最長的軸為主,其餘軸為追蹤)。

舉例來說:若在LINE模式下運作,四軸的行程設定分別為1000、500、300、0(單位為Ps),即表示Ps0軸每輸出1000Ps,Ps1及Ps2軸會分別輸出500Ps跟300Ps(Ps3軸因行程為0,故不輸出) 。FUN147會根據此比例關係持續輸出不停,直到離開條件滿足或FUN147被停止。

註:相對值座標定位(ADR)與絕對值座標定位(ABS)比較說明 欲由位置30000移至−10000時,程式寫法:

DRV ADR,−,40000,Ut或DRV ABS, ,−10000,Ut

...

-10000

0

10000

20000

30000

...

Ut

欲由位置−10000移至10000時,
程式寫法:DRV ADR,+,20000,Ut 或DRV ABS,,10000,Ut

指令

運

算

元

說

明

WAIT

TIME,XXXXX

y當補間運動脈波輸出完成時,欲執行下一步之等待指令;

或Rxxxx

運算元共有五種,說明如下:

或Dxxxx

Time:等待時間(單位為0.01秒),可直接輸入常數或變數

(Rxxxx或Dxxxx);當計時到,則執行GOTO所指

之步數。

或X0~X255 X0~X255:等待輸入接點信號ON,執行GOTO所指之步數。或Y0~Y255 Y0~Y255:等待輸出接點信號ON,執行GOTO所指之步數。或M0~M1911 M0~M1911:等待內部繼電器ON,執行GOTO所指之步數。

或 S0~S999 S0~S999:等待步進繼電器ON,執行GOTO所指之步數。

NC定位指令

FUN147 MHSPO

多軸直線補間定位輸出指令

FUN147 MHSPO

EXT

X0~X255
或 Y0~Y255
或 M0~M1911 或 S0~S999

y外部觸發指令,當脈波輸出中(脈波個數尚未送完),如果外部觸發信號作動(ON),則立即執行GOTO所指之步數;如果脈波輸出已完成,外部觸發信號尚未作動,則與WAIT指令相同,信號(ON)時,才會執行GOTO所指之步數。

GOTO

NEXT
或1~N
或Rxxxx
或Dxxxx

y當WAIT,EXT等指令條件滿足時,利用GOTO指令描述將要執行之步數。

NEXT :代表執行下一步
1~N :執行第幾步
Rxxxx:欲執行之步號存放於暫存器Rxxxx Dxxxx:欲執行之步號存放於暫存器Dxxxx

MEND

定位程式結束

z定位程式之書寫:

補間定位程式在編輯之前,必須要先完成FUN147指令,並在FUN147指令指定欲存放

定位程式之起始暫存器號碼;編輯定位程式時,會將新編之定位程式存入所指定之暫存器區

塊,每編1個定位點(稱為1步)會佔用15個暫存器,如有N個定位點(N步),共佔用N

× 15 + 2個暫存器。

*** 注意:儲存定位程式之暫存器不可被重複使用!

z程式格式與範例:

001 SPD 5000 ;線速度為5KHz

LIN ADR,500,400,300,200,Ut ;輸出500(Ps0)/400(Ps1)/300(Ps2)/200(Ps3)個單位

WAIT TIME,100 ;等待1秒

GOTO NEXT ;執行下一步

002 SPD R1000 ;線速度存放在DR1000(R1001與R1000)

LIN ADR,D100,D200, , ,Ut ;Ps0行程存放在DD100,Ps1行程存放在DD200

WAIT TIME,R500 ;等待時間存放在R500

GOTO NEXT ;執行下一步

003 SPD R1002 ;線速度存放在DR1002(R1003與R1002)

LIN ADR,0,0,R300,R400,Ps ;Ps2行程存放在DR300,Ps3行程存放在DR400

WAIT X0 ;等待X0 ON時

GOTO 1 ;執行第一步

NC定位指令

FUN147

多軸直線補間定位輸出指令

FUN147

MHSPO

MHSPO

直線補間示意圖

假設多軸命令表格內容如下:

表示Ps0軸(X軸)的行程設定為1000個Ps,Ps1軸(Y軸)的行程設定為500個Ps,Ps2及Ps3軸不輸出(因行程設定為0)。

動作示意圖如下:

Y 軸

Y 軸之行程距離

500

1000

X 軸

X 軸之行程距離

NC定位指令

FUN148 MPG

手搖輪定位控制指令

FUN148 MPG

148. MPG

Ps :
Fo : Mr :

WR :

執行控制EN Sc : ACT

HR
R0
∣
R3839

Sc :指定接手搖輪之來源高速計數器;0~7 Ps :指定反應手搖輪之脈波輸出軸;0~3 Fo :輸出頻率設定暫存器(2個暫存器)
Mr :倍率設定暫存器(2個暫存器)
Mr+0:倍率被乘數(Fa)
Mr+1:倍率被除數(Fb)
WR:工作暫存器起始位址,共佔用4個暫存器 .輸出脈波數=(手搖輪輸入脈波數×Fa)/Fb
*PLC OS V4.60(含)以後支援此命令

ROR

DR

K

R5000

D0

∣

∣

16 位元

R8071

D3999

Sc

○

○

○

0~7

Ps

○

○

○

0~3

Fo

○

○

○

Mr

○

○

○

WR

○

○*

○

● 將此指令放在50mS定時中斷處理程式(50MSI)、或利用0.1mS高速計時器產生50mS定時中斷來執行此指令,以便以較準確的時間間隔對手搖輪輸入脈波作取樣、並依倍率設定(Mr+0與Mr+1)計算輸出脈波數;同時在此間隔時間內以Fo所設定的頻率,將計算出來的輸出脈波數作輸出。

輸出頻率(Fo)設定值必須夠高,加減速(由FUN141指令之參數4與參數8設定)也必須夠快才足夠在高放大倍率(100或200倍)的情況下,在間隔時間內將計算出來的輸出脈波數輸出完畢;否則會有失步現象。

● 當執行控制〝EN〞為1時,每個間隔時間會對手搖輪輸入脈波作取樣;如果沒有取樣到有脈波輸入,則本指令不會有輸出;如果有取樣到有脈波輸入,則會根據倍率設定(Mr+0與Mr+1)計算輸出脈波數,然後以Fo所設定的輸出頻率,將計算出來的輸出脈波數作輸出。

輸出脈波數=(間隔時間內手搖輪輸入脈波數×Fa)/Fb

● 本指令會配合高速脈波輸出之硬體資源管理旗標(Ps0為M1992,Ps1為M1993,Ps2為M1994,Ps3為M1995)作控制;如果該硬體被其它定位指令使用中(FUN140/FUN147),則就算有取樣到有手搖輪脈波輸入,也不會有輸出。

● 當脈波輸出中,輸出指示ACT=1;否則為0。

● 本指令會佔用4個工作暫存器(WR),其它程式不可重複使用。

間隔時間=50mS

…

間隔時間=50mS

.以Fo所設定的頻率,輸

出脈波

.取樣手搖輪脈波輸入

.以Fo所設定的頻率,輸

出脈波

.取樣手搖輪脈波輸入

NC定位指令

FUN148 MPG

手搖輪定位控制指令

FUN148 MPG

程式範例1:

NC定位指令

FUN148 MPG

手搖輪定位控制指令

FUN148 MPG

X32 :選擇第0軸 (Ps0)
X33 :選擇第1軸 (Ps1)
X34 :輸出倍率為1
X35 :輸出倍率為10
X36 :輸出倍率為100
M100:手搖輪作動選擇
DR2005:第0軸最高輸出頻率(FUN141指令之參數4);200K Hz R2011 :第0軸加減速時間(FUN141指令之參數8);30mS DD600:第0軸手搖輪作動輸出頻率;200K Hz
DR2105:第1軸最高輸出頻率(FUN141指令之參數4);200K Hz R2111 :第1軸加減速時間(FUN141指令之參數8);30mS DD602:第1軸手搖輪作動輸出頻率;200K Hz

範例說明:在50MSI定時中斷處理程式裏放入Ps0與Ps1之手搖輪定位處理指令。
當X32=1且M100=1時,啟動Ps0手搖輪定位處理;每個間隔時間(50mS)會對手搖輪輸入脈波(來自HSC0)作取樣;如果沒有取樣到有脈波輸入,則FUN148指令不會有輸出;如果有取樣到有脈波輸入,則會根據倍率設定(D700與D701)計算輸出脈波數,然後以DD600所設定的輸出頻率,將計算出來的輸出脈波數作輸出。

輸出脈波數=(間隔時間內HSC0輸入脈波數×D700)/D701

NC定位指令

FUN148 MPG

手搖輪定位控制指令

FUN148 MPG

程式範例2:

NC定位指令

FUN148 MPG

手搖輪定位控制指令

FUN148 MPG

X32 :選擇第0軸 (Ps0)
X33 :選擇第1軸 (Ps1)
X34 :輸出倍率為1
X35 :輸出倍率為10
X36 :輸出倍率為100
M100:手搖輪作動選擇
DR2005:第0軸最高輸出頻率(FUN141指令之參數4);200K Hz R2011 :第0軸加減速時間(FUN141指令之參數8);30mS DD600:第0軸手搖輪作動輸出頻率;200K Hz
DR2105:第1軸最高輸出頻率(FUN141指令之參數4);200K Hz R2111 :第1軸加減速時間(FUN141指令之參數8);30mS DD602:第1軸手搖輪作動輸出頻率;200K Hz

範例說明:將0.1mS高速計時器(HSTA)設定為50mS定時中斷,並在HSTAI中斷處理程式裏 放入Ps0與Ps1之手搖輪定位處理指令。

當X33=1且M100=1時,啟動Ps1手搖輪定位處理;每個間隔時間(50mS)會對手搖輪輸入脈波(來自HSC0)作取樣;如果沒有取樣到有脈波輸入,則FUN148指令不會有輸出;如果有取樣到有脈波輸入,則會根據倍率設定(D700與D701)計算輸出脈波數,然後以DD602所設定的輸出頻率,將計算出來的輸出脈波數作輸出。

輸出脈波數=(間隔時間內HSC0輸入脈波數×D700)/D701

NC定位指令

☆☆☆【OS V4.63(含)以後版本支援】

手搖輪指令(FUN148,MPG)左、右極限禁止運動功能
. R4020高位元組之值 ≠55H時,無此功能;
R4020高位元組之值 = 55H時,低位元組之位元用來控制左、右極限禁止運動功能 R4020_ b15…b8=55H,
R4020_ b0=1,禁止Ps0正轉運動
R4020_ b1=1,禁止Ps0反轉運動
R4020_ b2=1,禁止Ps1正轉運動
R4020_ b3=1,禁止Ps1反轉運動
R4020_ b4=1,禁止Ps2正轉運動
R4020_ b5=1,禁止Ps2反轉運動
R4020_ b6=1,禁止Ps3正轉運動
R4020_ b7=1,禁止Ps3反轉運動

. 程式範例

11.7 機械原點復歸

採用相對式Encoder作為位移偵測器之機台,通常皆需要作歸零動作以作為定位座標之參考,此動作我們稱為機械原點復歸(尋找機械零點)。

NC伺服機台之機械原點復歸簡圖如下:

方法一:

原點復歸速度

原點減速速度

左限極限開關

近點感應

右限極限開關

碰到近點信號時,開始Z相計數

Z相計數到,停止脈波輸出,送出CLR信號清除伺服之偏差計數器

例:
X3:近點感應信號輸入,規劃為中斷輸入;如為機械原點復歸時,在X3+I中斷處理副程式裏啟動HSC4開始計數。

X2:Z相計數輸入,規劃為HSC4之UP輸入;平常將X2+I中斷禁止,當執行機械原點復歸且X3近點信號中斷發生時,啟動HSC4開始作Z相計數;當HSC4計數到,停止脈波輸出,禁止X2+I中斷,設定原點位置到信號,輸出CLR信號清除伺服驅動器之偏差計數器。請參考範例程式。

方法二:根據應用需求,亦可將碰到近點信號時減速慢行停止;然後以低速反向慢行,離開近 點信號之瞬間(近點感應信號由1→0)當作機械原點,程式較簡單!

(1)

(3)

(2)

原點復歸速度

原點減速慢行

停止

(4)

(5)

反向慢行

停止

近點信號由1→0,機械零點

左限極限開關

近點感應

右限極限開關

X3:近點感應輸入,並規劃為負緣中斷輸入。

.碰到近點感應信號時,啟動X3負緣中斷;減速慢行並停在近點感應範圍內。

.反向慢行,直到近點感應信號由1→0。

.當近點感應信號由1→0,立即執行X3−I中斷處理副程式。

.X3−I中斷處理副程式:停止脈波輸出,禁止X3−I中斷,設定原點位置到信號,輸出CLR信號清除伺服驅動器之偏差計數器。(請參考範例程式)

程式範例1:機械原點復歸(方法一)

X2:規劃為HSC4之UP輸入,接Z相計數輸入

X3:規劃為中斷輸入,接近點信號輸入

【主程式】

M1924

EN

146

X2+I

•禁止X2+I 中斷(HSC4 不計數)

DIS

141.MPARA

EN

Ps

: 0

ERR

•參數表 R2900→R2923

SR: R 2900

M92

EN

RST

M50

•清除原點復歸完成信號

EN

RST

M5

•清除原點復歸指令完成信號

EN

RST

M1007

•清除錯誤信號

RST

R 2014

•步數指標清為0,

EN

由第一步開始執行

EN

D

•清除HSC4目前值

RST

R 4112

EN

RST

R 4115

•清除HSC4設定值之

High Word

EN

08.MOV

•將Z相計數值搬為HSC4之

S

: R 2923

D

: R 4114

設定值

SERVO

M92

READY

手動

M5

M50M1007

M4

M4

M4

定位程式:

EN

140.HSPSO

ACT

M1006

•將R5000~R5199規劃為唯

Ps

: 0

M4

PAU

SR

: R 5040

ERR

M1007

讀暫存器(ROR),則儲存程

001 SPD R2919

WR

: R 2014

式時,Ladder程式會自動包

DRV ADR,−,999999,Ut

EXT X3

含定位程式。

ABT

DN

GOTO NEXT

002 SPD R2921
DRV ADR,−,9999,Ut

SET

M5

•原點復歸指令完成

MEND

EN

M1996

Y8

EN

.01S

TUP

•伺服偏差計數器清除信號Y8

T0

50

ON 0.5秒

T0

EN

RST

Y8

0

EN

RST

R 4088

•目前Ps值清為0

【副程式】

M4

65

X3+I

EN

145

X2+I

• X3+I正緣中斷處理副程式

LBL

•啟動HSC4計數

EN

69

RTI

65

M4

LBL

HSC4I

EN

142

0

Y8

•停止脈波輸出

PSOFF

146

X2+I

•禁止X2+I中斷

EN

DIS

•送出伺服偏差計數器清除信號

M50

•設定原點復歸完成信號74.IMDIO

EN

D

: Y8

•立即輸出

N

: 1

69

RTI

程式範例2:機械原點復歸(方法二)

X3:接近點感應輸入,並規劃為負緣中斷輸入

【主程式】

M1924

EN

67

INIT

CALL

65

原點

LBL

HOME

EN

RST

M50

M20

•清除原點復歸完成信號

SERVO

復歸

READY

手動

左限

M20

•清除原點復歸指令完成信號

RST

M5

•步數指標清為0,

EN

由第一步開始執行

EN

RST

R2014

SERVO

M20

READY

M5

M50

M4

M4

M4

X3

EN

145P

ACT

M1006

y啟動 X3-1中斷

EN

X3 – I

M4

EN

140.HSPSO

•將R5000~R5199 規劃為唯

Ps

: 0

讀暫存器(ROR),則儲存

定位程式:

SR

: R 5040

PAU

ERR

程式時,Ladder程式會自

001 SPD R2919

WR

: R 2014

動包含定位程式。

DRV ADR,−,999999,Ut

EXT X3

ABT

SET

M5

DN

M51

•原點復歸指令完成

GOTO NEXT

002 SPD 1000

DRV ADR,−,1000,Ps

WAIT TIME,10

GOTO NEXT

003 SPD R200

EN

DRV ADR,+,999999,Ut

MEND

M4

M1996

M50

M51

EN

D

TUP

•y原點恢復完成信號

y目前 PS值清除為0

RST

R4088

Y8

.01S

EN

•伺服偏差計數器清除信號

T0

30

Y8 ON 0.3秒

T0

EN

RST

Y8

【副程式】

65

LBL INIT

146

EN

DIS

X3 – I

•禁止X3−I中斷

141.MPARA

68

EN

Ps

: 0

ERR

•參數表R2900~R2923

SR: 2900

RTS

65

M4

LBL

X3 – I

EN

142

0

y原點恢復完成信號y X3-1負緣中段處理程式

PSOFF

停止脈波輸出

146

EN

DIS

X3 – I

•禁止x3-1中斷

Y8

M50

74.IMDIO

69

RTI

D :

Y8

•設定原點復歸完成信號

N :

1

上面兩個機械原點復歸範例,皆是利用階梯圖程式(Ladder)所實作而成的;雖然不難理解,但畢竟稍嫌繁瑣,使用及除錯上皆可能會較為不便。考慮到客戶之實用與方便性,FBs系列PLC於系統版本(OS)V4.32(含)版以後,於高速脈波輸出指令(FUN140)中,增加了原點復歸命令(DRVZ),並提供三種(MD0~MD2)不同之模式可供客戶選擇使用。

使用DRVZ命令作機械原點復歸時,需搭配FUN141運動參數指令,意即於程式中必須要有FUN141,且相關參數設定必須正確無誤,否則執行DRVZ命令之FUN140不會作動,且錯誤旗標(ERR)將設為”ON”。下面列表為整理出之與機械原點復歸有關之參數設定:

參數6 (原點復歸減速速度)

DRVZ MD0

DRVZ MD1

DRVZ MD2

必須設定

必須設定

必須設定

參數9-1 (原點復歸方向)

必須設定

必須設定

必須設定

參數15-0 (近點DOG輸入)

必須設定

必須設定

必須設定

參數15-1 (行程極限輸入)

可不設

可不設

可不設

參數15-2 (零點信號PG0輸入)

不必設定

不必設定

必須設定

參數15-3 (歸零清除CLR輸出)

可不設

可不設

可不設

參數16 (機械原點位置值)

必須設定

必須設定

必須設定

參數17 (零點信號數)

不必設定

不必設定

必須設定

當FUN140指令無法正確執行DRVZ命令時,可由錯誤指示暫存器之內容得知不能執行之原因如下:

R4060(PS0)

錯誤碼

說明

42

DRVC不可銜接DRVZ命令

50

DRVZ工作模式錯誤

R4061(PS1)

51

近點DOG輸入點錯誤

R4062(PS2)

零點信號PG0輸入點錯誤

52

R4063(PS3)

53

歸零清除CLR輸出點錯誤

DRVZ之使用方式如同FUN140之其他兩種模式(DRV及DRVC),在專案管理視窗中的伺服命令表格裡,將所欲運行之模式(MD0~MD2)勾選完成即可。(參考下圖)

原點復歸便利命令(DRVZ)為達到高度精確性及重現性,因而利用中斷技術來處理外界

信號(如近點DOG輸入),所以對於機械開關或現場雜訊所產生的彈跳訊號,必須加以濾除

以免產生誤動作。一般而言近點DOG sensor建議使用光電或感應式的近接開關,以避免

產生類似機械式接觸開關(Limit switch)的彈跳信號。

MOD0~MOD2三種模式之示意圖及動作說明入下所示,以下範例皆假設欲做原點復

歸時機台位置在近點感應開關之右側(原點復歸方向為向左) :

模式0(MOD0)

【動作說明】

1• 歸零起始點在原點感知器(DOG sensor,參數15_0)後方
a. 以原點復歸速度往零點方向移動
b. 碰到原點感知信號時(中斷處理),以原點復歸減速速度(參數6)繼續前進
c.離開原點感知信號瞬間(中斷處理),該點即為零點位置
d. 如沒有設定歸零清除信號輸出(參數15_3),找到零點位置時,即代表歸零動作完成 e. 如有設定歸零清除信號輸出(參數15_3),找到零點位置時,會輸出一脈波寬度大於 20mS之信號;完成信號輸出後,才代表整個歸零動作完成

2• 歸零起始點在原點感知器(DOG sensor)處或前方、配合行程極限感知器(參數15_1) a. 以原點復歸速度往零點方向移動會碰到極限感知器而停止前進
b. 反方向以原點復歸速度離開原點感知器後,以上述1之步驟完成歸零動作

模式1(MOD1)

【動作說明】

1• 歸零起始點在原點感知器(DOG sensor,參數15_0)後方

a. 以原點復歸速度往零點方向移動
b. 碰到原點感知信號時(中斷處理),由目前速度以加減速時間設定(參數8)之斜率減速停

止
c. 延遲0.5秒後,反方向以原點復歸減速速度(參數6)離開原點感知信號瞬間(中斷處理), 該點即為零點位置
d. 如沒有設定歸零清除信號輸出(參數15_3),找到零點位置時,即代表歸零動作完成e. 如有設定歸零清除信號輸出(參數15_3),找到零點位置時,會輸出一脈波寬度大於 20mS之信號;完成信號輸出後,才代表整個歸零動作完成

2• 歸零起始點在原點感知器(DOG sensor)處或前方、配合行程極限感知器(參數15_1)

a. 以原點復歸速度往零點方向移動會碰到極限感知器而停止前進

b. 反方向以原點復歸速度離開原點感知器後,以上述1之步驟完成歸零動作

模式2(MOD2) 前緣計數模式

【動作說明】

1• 歸零起始點在原點感知器(DOG sensor,參數15_0)後方

a. 以原點復歸速度往零點方向移動
b. 碰到原點感知信號時(中斷處理),以原點復歸減速速度(參數6)繼續前進,並開始計數 零點信號(PG0,參數15_2) (中斷處理)
c. 當零點信號之計數值等於零點信號設定值(參數17)時,該點即為零點位置
d. 如沒有設定歸零清除信號輸出(參數15_3),找到零點位置時,即代表歸零動作完成e. 如有設定歸零清除信號輸出(參數15_3),找到零點位置時,會輸出一脈波寬度大於 20mS之信號;完成信號輸出後,才代表整個歸零動作完成

2• 歸零起始點在原點感知器(DOG sensor)處或前方、配合行程極限感知器(參數15_1)

a. 以原點復歸速度往零點方向移動會碰到極限感知器而停止前進

b. 反方向以原點復歸速度離開原點感知器後,以上述1之步驟完成歸零動作

※ 選擇此歸零模式,需注意正確調整原點感知器之位置與零點信號(PG0)搭配,避免每次執行歸零動作時,零點位置可能會有1個零點信號計數之偏移誤差

模式2(MOD2) 後緣計數模式

【動作說明】

1• 歸零起始點在原點感知器(DOG sensor,參數15_0)後方

a. 以原點復歸速度往零點方向移動
b. 碰到原點感知信號時(中斷處理),以原點復歸減速速度(參數6)繼續前進;離開原點感 知信號瞬間(中斷處理),開始計數零點信號(PG0,參數15_2) (中斷處理)
c. 當零點信號之計數值等於零點信號設定值(參數17)時,該點即為零點位置
d. 如沒有設定歸零清除信號輸出(參數15_3),找到零點位置時,即代表歸零動作完成e. 如有設定歸零清除信號輸出(參數15_3),找到零點位置時,會輸出一脈波寬度大於 20mS之信號;完成信號輸出後,才代表整個歸零動作完成

2• 歸零起始點在原點感知器(DOG sensor)處或前方、配合行程極限感知器(參數15_1)

a. 以原點復歸速度往零點方向移動會碰到極限感知器而停止前進

b. 反方向以原點復歸速度離開原點感知器後,以上述1之步驟完成歸零動作

※ 選擇此歸零模式,需注意正確調整原點感知器之位置與零點信號(PG0)搭配,避免每次執行歸零動作時,零點位置可能會有1個零點信號計數之偏移誤差

上面三種原點復歸模式皆假設起點在近點感應開關(DOG sensor)之右側,但欲做原點復歸動作時,也有可能起點位置落於近點感應開關(DOG sensor)之後,或正好停在近點感應開關(DOG sensor)之上,下列示意圖及說明即是解釋當起點落於上述兩個位置時之原點復歸動作如何運行:

當起點落於近點感應開關(DOG sensor)之上或之前時之原點復歸示意圖

動作說明

歸動作一啟動,先以原點復歸速度朝原點復歸方向前進(參數9_1),直到碰到行程點(參數15_1)開關為止。

程極限輸入點(參數15_1)時,立即反向朝原點復歸方向之反方向前進直到離開近點 感應開關DOG sensor(近點感應信號由1→0)為止。

述步驟2之後,則可以確定起點已回到近點感應開關(DOG sensor)之右側,接下來就會以所設定之原點復歸模式(MD0~MD2)繼續完成原點復歸動作。

程式範例3:機械原點復歸(利用DRVZ指令之模式2)

• M1924起始脈波將伺服參數指令之 參數寫入系統。

•清除FUN140原點復歸完成信號。

•原點復歸動作啟動。

• FUN140執行原點復歸模式(DRVZ) 指令。

伺服參數表格(FUN141)設定

伺服命令表格(FUN140)設定

程式說明:

(1). 當程式一執行,起始脈波(M1924)將伺服參數之各項設定寫入PLC。

(2). 當M0由0→1 ( P指令) ,M1自保迴路起動,同時FUN140之回Home動作啟動。(3). 依FUN140之伺服命令表格之設定,會先以5000的速度,朝原點復歸方向(左邊)移動, 當遇到DOG點(X0)作動時,立即降為原點復歸速度(1000),並且開始進行零點(PG0)計 數(前緣計數之故)。

(4). 當零點信號計數(X4)到達其設定值(10)時,原點復歸動作即完成,將歸零清除信號(Y8)送出為”ON”約大於 20mS,並且將機械零點位置值(100)般至目前位置值之暫存器(本範例因使用第0軸,故為將100填入DR4088),原點復歸動作即告完成。

流程示意圖

DOG sensor (X0)

參數 6 :

參數 8 :

前緣

參數 15_2 :

零點信號PG0輸入接點&

前緣/後緣計數(X4/前緣計數)

DOG

後緣

加/減速時間

(5000mS)

原點復歸速度(5000)

原點復歸減速速度

(1000) 參數9_1 : 原點復歸方向(左)

參數 16 :
機械原點位置值

(100)

參數 17 :
零點信號數(10) PG0: 零點信號

零點信號開始計數

參數 15_3:
歸零清除信號CLR輸出(Y8)

≥20mS+1 次掃描時間

※ DOG點之設定需為主機上之Input點(X0~X15)。

※被設為DOG點之Input,不得與中斷或高速計數器相衝突,例如: 若X0已被設為DOG點,則不得再將X0設為中斷輸入或高速計數器。

程式範例4:寸動(JOG)進

寸進按鈕

EN

RST

M1

M0

•清除結束訊號

↑

寸進

SERVO

作動

EN

RST

R 2000

•每次由第一步開始執行

按鈕

READY

手動

條件

M1

M0

M0

EN

140.HSPSO

ACT

M1000

Ps

: 0

定位程式:

SR

: R 5000

M1001

001 SPD 1000

PAU

ERR

WR

: R 2000

DRV ADR,+,1,Ps

WAIT TIME,50

GOTO NEXT

ABT

DN

002 SPD R2907
DRV ADR,+,99999999,Ut
MEND

M0

M1996

EN

SET

M1

•最後一步執行完,設定結束

信號

程式範例5:寸動(JOG)退

寸進按鈕

手動

作動

M3

EN

RST

M3

M2

•清除結束訊號

↑

寸退

SERVO

EN

RST

R 2007

•每次由第一步開始執行

按鈕

READY

條件

M2

M2

EN

140.HSPSO

ACT

M1003

Ps

: 0

定位程式:

PAU

SR

: R 5020

ERR

M1004

001 SPD 1000

WR

: R 2007

DRV ADR,−,1,Ps

WAIT TIME,50

ABT

DN

GOTO NEXT

002 SPD R2907
DRV ADR,−,99999999,Ut
MEND

M2

M1996

EN

SET

M3

•最後一步執行完,設定結束

信號

程式範例6:步進、一次循環、連續運轉定位控制

M93 :啟動

M101 :步進

M102 :一次循環

M103 :連續運轉

M104 :正常停機

M105 :緊急停機

M93 •清除執行完畢信號

↑

M101

EN

RST

M7

•清除錯誤信號

RST

M1010

EN

EN

RST

M1011

•清除步數完成信號

EN

RST

R 2021

•非步進時,步進指標清為0,

由第一步開始執行

SERVO

M93

READY

M105

M1010

M6

↑

M6

M101

M1011

140.HSPSO

ACT

M1009

M101

M7

M6

定位程式:

EN

Ps

: 0

M1010

SR

: R 5100

001 SPD1000
PAU DRVADR,+,20000,Ut

WR

: R 2021

ERR

M1011

WAIT

TIME,100

ABT

DN

GOTONEXT

002 SPD20000
DRVADR,+,40000,Ut
WAITM200
GOTO NEXT
003 SPD 25000
DRVADR,−,50000,Ut
WAITTIME,500
GOTO NEXT
004 SPD 5000
DRVADR,−,10000,Ut
WAITX16
GOTO 1

M6

M102

M104

M1996

EN

SET

M7

y設定停機結束信號

M103

這篇文件對您有幫助嗎?

提示:按 ← → 切換章節,Ctrl+K 搜尋