Posted in

By

第 10 / 18 篇更新於 2026-11-17約 85 分鐘English

9-1 NC定位控制之方式

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

以高速脈波方式控制步進或伺服驅動器是常被使用之方式,M系列主機因內含多軸高速脈波輸出以及高速硬體計數器,且能提供簡易使用、設計之定位程式編輯。

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

半閉迴路控制

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

閉迴路控制

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

9-3 絕對座標與相對座標

移動距離之指定,可以絕對位置來指定(絕對座標定位),或以相對距離來指定(相對座標定位);而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

  • 絕對座標標示

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

DRV ABS, , 0,Ut

...

...

-100

0

100

200

300

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

DRV ABS, ,300,Ut

  • 相對座標標示

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

DRV ADR,-,300,Ut

...

...

-100

0

100

200

300

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

DRV ADR,+,200,Ut

9-5 定位控制流程

表 17 NC定位控制設定步驟表格

9-5-1 定位軸設定

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

圖 49 規劃高速脈波輸出

9-5-2 定位軸輸出點

M系列主機於輸出脈波頻率最高可達200KHz(最高上限依機型不同而有差異) 。高速脈波輸出電路共用外界輸出點Y0~Y15(輸出點數依機型不同而有差異)。在未使用到HSPSO功能(未於建構功能下建構PSO功能)時, 外界輸出點Y0~Y15是對應到PLC內部之輸出繼電器Y之狀態。但當有建構HSPSO時,則外界輸出點將切換為HSPSO輸出電路,不作為原輸出繼電器所用。

下表為主機最大規格時,各軸輸出點之信號明細、輸出模式及支援頻率:

軸號

外界

輸出點

輸出模式

U/D輸出

P/R輸出

A/B輸出

僅單點K輸出

PSO0

MQ/MA/MS/ME

Y0 , Y1

Y0=U , Y1=D

Y0=P , Y1=R

Y0=A , Y1=B

Y0=P

PSO1

Y2 , Y3

Y2=U , Y3=D

Y2=P , Y3=R

Y2=A , Y3=B

Y2=P

PSO2

Y4 , Y5

Y4=U , Y5=D

Y4=P , Y5=R

Y4=A , Y5=B

Y4=P

PSO3

Y6 , Y7

Y6=U , Y7=D

Y6=P , Y7=R

Y6=A , Y7=B

Y6=P

PSO4

MA/MS/ME

Y8, Y9

Y8=U, Y9=D

Y16=U, Y17=D

Y8=P, Y9=R

Y16=P, Y17=R

Y8=A, Y9=B

Y16=A, Y17=B

Y8=P

Y16=P

MQ

Y16, Y17

PSO5

MA/MS/ME

Y10, Y11

Y10=U, Y11=D

Y10=P, Y11=R

Y10=A, Y11=B

Y10=P

MQ

Y18, Y19

Y18=U, Y19=D

Y18=P, Y19=R

Y18=A, Y19=B

Y18=P

PSO6

MA/MS/ME

Y12, Y13

Y12=U, Y13=D

Y12=P, Y13=R

Y12=A, Y13=B

Y12=P

MQ

Y20, Y21

Y20=U, Y21=D

Y20=P, Y21=R

Y20=A, Y21=B

Y20=P

PSO7

MA/MS/ME

Y14, Y15

Y14=U, Y15=D

Y14=P, Y15=R

Y14=A, Y15=B

Y14=P

MQ

Y22, Y23

Y22=U, Y23=D

Y22=P, Y23=R

Y22=A, Y23=B

Y22=P

表 18各軸輸出點之信號明細、輸出模式及支援頻率

9-7 定位控制功能

M 系列主機內建最多可控制8軸(最高上限依機型不同而有差異)之定位運動。其所使用之NC定位控制指令是以上一代PLC FBs/B1系列為基礎,在其上提供相容性並新增其他應用型之指令,如中斷定長(ICF)以及中斷定角(ICA)等。欲以M系列主機透過脈波去驅動伺服或步進馬達,只要其電路結構及頻率能搭配即可正常工作。

9-7-1 步進馬達介面

圖 50 步進馬達與PLC之訊號傳輸示意圖

步進馬達是專門接受輸入脈波來達成角度或距離之控制;因此,馬達之回轉角度與外部輸入之脈波數成正比,而馬達之轉速與脈波頻率成正比。

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

表 19 各相數的馬達與脈波角度和轉一圈所需的脈波對照表

9-7-2 伺服馬達介面

圖 51 伺服馬達與PLC之訊號傳輸示意圖

  • 上圖Y0~Y7為特定使用外,Y8~Y11及各輸入點可根據需要自行調配使用。
  • 安全保護之左限、右限極限開關信號亦需接入PLC以確保能安全作動。

9-7-3 伺服馬達工作示意圖

圖 52伺服馬達工作示意圖

  • 伺服馬達之譯碼器(Encoder)將位移偵測信號回饋至伺服驅動器,驅動器將輸入信號之脈波頻率和脈波數與回饋信號之頻率和脈波數,經內部之偏差計數器與頻率轉電壓電路處理後,得到脈波偏差值與轉速誤差值,藉以控制伺服馬達達成高速、精密之速度與位置閉迴路處理系統。
  • 伺服馬達之轉速與輸入信號之脈波頻率成正比,而馬達之移動量則由脈波數決定。
  • 一般而言,伺服馬達之控制誤差為±1個脈波。

9-9 NC定位控制指令

中斷定角( ICA )

編號為FUN137,以原點為角度0度,偵測到外界中斷時能夠定位於固定角度。

中斷定長( ICF )

編號為FUN138 ,偵測到外界中斷後輸出指定移動量。

高速脈波寬度調變( HSPWM )

編號為FUN139,輸出指定脈寬及頻率之PWM波形,唯輸出波形受限於內部公式,因相容於上一代PLC FBs/B1系列而保留。另有FUN144能提供更直接的控制。

單軸高速脈波輸出(HSPSO)

編號為FUN140,透過定位表格執行NC控制。

包含如下之9個衍生定位指令:

1. SPD 4. DRVZ 7. EXT

2. DRV 5. WAIT 8. GOTO

3. DRVC 6. ACT 9. MEND

※FUN140 不支援 脈波模式(U),如需使用,請以FUN139及FUN144。

定位參數設定(MPARA)

編號為FUN141,設定移動單位、加減速、回原點等參數,生效於指定定位軸。

強制停止脈波輸出(PSOFF)

編號為FUN142,停止指定軸之脈波輸出。

目前脈波值轉換為顯示值(PSCNV)

編號為FUN143,對移動量單位進行轉換。

高速脈波寬度調變2( HSPWM2 )

編號為FUN144,輸出指定脈寬及頻率之PWM波形。

多軸直線捕間定位輸出指令(MHSPO)

編號為FUN147,於被規劃的軸群組上,執行線性補間。

手搖輪定位( MPG )

編號為FUN148,針對一定位軸進行手搖輪動作。

多軸圓弧捕間定位輸出指令(AHSPO )

編號為FUN149,於被規劃的軸群組上,執行圓弧補間。

9-9-1 FUN137 中斷定角 ( ICA )

FUN137

ICA

中斷定角

(INTERRUPT CONSTANT ANGLE)

FUN137

ICA

指令說明

Ps:第幾組Pulse 輸出 (0~7)

0:Y0 & Y1

1:Y2 & Y3

2:Y4 & Y5

3:Y6 & Y7

4:MQ Y16 & Y17, ME/MS/MA:Y8 & Y9

5:MQ Y18 & Y19, ME/MS/MA: Y10 & Y11

6:MQ Y20 & Y21, ME/MS/MA: Y12 & Y13

7:MQ Y22 & Y23, ME/MS/MA: Y14 & Y15

Ls:外界輸入X點索引號碼(0~15)

Fo:目標工作速度(1~100000 or 1~200000)

Ag:中斷時固定角度(0~36000)

X

WX

WY

WM

WS

TMR

CTR

HR

IR

OR

SR

ROR

DR

K

主機上

之Xn

WX0

∣

WX1008

WY0

∣

WY1008

WM0

∣

WM19578

WS0

∣

WS3088

T0

∣

T1023

C0

∣

C1279

R0

∣

R34767

R34768

∣

R34895

R35024

∣

R35151

R35280

∣

R43223

R43224

∣

R47319

D0

∣

D7999

Pw

0~7

Ls

○

Fo

○

○

○

1 ~ 100000 or 1~ 200000

Ag

○

○

○

0~36000

FUN137

ICA

中斷定角

(INTERRUPT CONSTANT ANGLE)

FUN137

ICA

功能敘述

  1. 定位軸最多可以控制到PSO7,唯實際能夠控制的最大軸號依主機機型而有差異。
  2. 目標工作速度最大頻率依照主機機型而有100K與200K兩種差異。
  3. 在通用與進階運動型主機中,外界輸入X點8~15將保留給運動功能使用而不支援於此指令。
  4. 外界輸入點不需額外於I/O組態中之中斷設定特別配置。指令執行時會自動進行相關設定。

9-9-2 FUN138 中斷定長 ( ICF )

FUN138

ICF

中斷定長

(INTERRUPT CONSTANT FEED)

FUN138

ICF

指令說明

Ps:第幾組Pulse 輸出 (0~7)

0:Y0 & Y1

1:Y2 & Y3

2:Y4 & Y5

3:Y6 & Y7

4:MQ Y16 & Y17, ME/MS/MA:Y8 & Y9

5:MQ Y18 & Y19, ME/MS/MA: Y10 & Y11

6:MQ Y20 & Y21, ME/MS/MA: Y12 & Y13

7:MQ Y22 & Y23, ME/MS/MA: Y14 & Y15

Ls:外界輸入X點索引號碼(0~15)

Fo:目標工作速度(1~100000 or 1~200000)

Fd:中斷捕捉後輸出之脈波移動量

X

WX

WY

WM

WS

TMR

CTR

HR

IR

OR

SR

ROR

DR

K

主機上

之Xn

WX0

∣

WX1008

WY0

∣

WY1008

WM0

∣

WM19578

WS0

∣

WS3088

T0

∣

T1023

C0

∣

C1279

R0

∣

R34767

R34768

∣

R34895

R35024

∣

R35151

R35280

∣

R43223

R43224

∣

R47319

D0

∣

D7999

Pw

0~7

Ls

○

Fo

○

○

○

1 ~ 100000 or 1~ 200000

Fd

○

○

○

○

FUN138

ICF

中斷定長

(INTERRUPT CONSTANT FEED)

FUN138

ICF

功能敘述

  1. 定位軸最多可以控制到PSO7,唯實際能夠控制的最大軸號依主機機型而有差異。
  2. 目標工作速度最大頻率依照主機機型而有100K與200K兩種差異。
  3. 在通用與進階運動型主機中,外界輸入X點8~15將保留給運動功能使用而不支援於此指令。
  4. 外界輸入點不需額外於I/O組態中之中斷設定特別配置。指令執行時會自動進行相關設定。

9-9-3 FUN139 高速脈波寬度調變 ( HSPWM )

FUN139

HSPWM

高速脈波寬度調變

(HIGH SPEED PULSE WIDTH MODULATION)

FUN139

HSPWM

指令說明

Pw : 高速脈波寬度調變輸出點
0:Y0

1:Y2

2:Y4

3:Y6

4:MQ Y16, ME/MS/MA:Y8

5:MQ Y18 , ME/MS/MA: Y10

6:MQ Y20 , ME/MS/MA: Y12

7:MQ Y22 , ME/MS/MA: Y14

Op : 輸出極性;

0=輸出不倒相

1=輸出倒相

Rs : 解析度;

0=1/100 (1%)

1=1/1000 (0.1%)

Pn : 輸出頻率參數設定(0~255)

OR : PWM輸出寬度設定暫存器0~100或0~1000

WR : 指令運作工作暫存器,其他程式不可重複使用

Y

WX

WY

WM

WS

TMR

CTR

HR

IR

OR

SR

ROR

DR

K

主機上

之Yn

WX0

∣

WX1008

WY0

∣

WY1008

WM0

∣

WM19578

WS0

∣

WS3088

T0

∣

T1023

C0

∣

C1279

R0

∣

R34767

R34768

∣

R34895

R35024

∣

R35151

R35280

∣

R43223

R43224

∣

R47319

D0

∣

D7999

Pw

○

0~3

Op

○

0~1

Rs

○

0~1

Pn

○

○

○

○

○

○

○

○

○

○

○

○

0~255

OR

○

○

○

0~1000

WR

○

○

○

○

○

○

○

○

○

○

FUN139

HSPWM

高速脈波寬度調變

(HIGH SPEED PULSE WIDTH MODULATION)

FUN139

HSPWM

功能敘述

  • 第0點(Y0)與第1點(Y2)PWM輸出, 其解析度必須相同, 同為1/100或1/1000; 而輸出頻率參數設定也必須相同,只有輸出寬度(PLUSE WIDTH)可以不一樣; 同理第2點(Y4)與第3點(Y6)PWM輸出亦如上述規定。
  • 當執行控制〝EN〞=1時,本指令所指定之輸出點將依下列公式所決定之頻率以指定之脈波寬度輸出。

1. 當Rs(解析度)設定為1/100時

2. 當Rs(解析度)設定為1/1000時

程式範例一

假設Pn(輸出頻率參數)設為50,Rs(解析度)=0則

= 3614.117……≒3.6KHz

T(週期)= ≒277uS

因為解析度為1/100,所以OR(輸出寬度)若為1則To≒2.7uS,OR(輸出寬度)若為50則To≒140uS。圖形如下:

(1).Pn(輸出頻率參數)=50,Rs=0(解析度=1/100),OR(輸出寬度)=1之輸出波形:

(2). Pn(輸出頻率參數)=50,Rs=0(解析度=1/100),OR(輸出寬度)=50之輸出波形:

FUN139

HSPWM

高速脈波寬度調變

(HIGH SPEED PULSE WIDTH MODULATION)

FUN139

HSPWM

程式範例二

假設Pn(輸出頻率參數)設為200,Rs(解析度)=1則。

≒ 91.7Hz ; T(週期) = ≒10.9mS

因為Rs(解析度)為1/1000,所以OR(輸出寬度)若為10則To≒109uS,OR(輸出寬度)若為800則To≒8.72mS。圖形如下:

(1).Pn(輸出頻率參數)=200,Rs=1(解析度=1/1000) ,OR(輸出寬度)=10之輸出波形:

(2).Pn(輸出頻率參數)=200,Rs=1(解析度=1/1000) ,OR(輸出寬度)=800之輸出波形:

9-9-4 FUN140 高速脈波輸出(HSPSO)

FUN140

HSPSO

高速脈波輸出

(含衍生定位指令)

FUN140

HSPSO

指令說明

Ps :第幾組Pulse 輸出 (0~7)

0:Y0 & Y1

1:Y2 & Y3

2:Y4 & Y5

3:Y6 & Y7

4:MQ Y16 & Y17, ME/MS/MA:Y8 & Y9

5:MQ Y18 & Y19, ME/MS/MA: Y10 & Y11

6:MQ Y20 & Y21, ME/MS/MA: Y12 & Y13

7:MQ Y22 & Y23, ME/MS/MA: Y14 & Y15

SR :定位程式起始暫存器

WR:指令運作起始暫存器,共佔用7個暫存器,其它程式不可重覆使用

HR

DR

ROR

K

R0

∣

R34767

D0

∣

D7999

R43224

∣

R47319

Ps

0~7

SR

○

○

○

WR

○

○

○*

功能敘述

  1. 定位軸最多可以控制到PSO7,唯實際能夠控制的最大軸號依主機機型而有差異。
  2. FUN140(HSPSO)指令之NC定位程式是以文字之程式書寫方式來編輯;每一定位點我們稱一步(含輸出頻率、動作行程、轉移條件),一個FUN140最多可編250步定位點,每一步定位點需佔用9個暫存器。
  3. 將定位程式存在暫存器最大好處是,如果結合人機作機台操控設定,則可將定位程式存入人機,更換模具時,可直接由人機操作存取該副模具之定位程式。
  4. 當執行控制輸入〝EN〞=1時,如Ps0~Ps7沒有被其它FUN140指令佔用(Ps0=M9183、Ps1=M9184、Ps2=M9185、Ps3=M9186、Ps4=M9191、Ps5=M9192、Ps6=M9193、Ps7=M9194之狀態為ON,反之則為OFF),則由下一步定位點開始執行(如已至最後一步,則重新由第1步開始執行);如Ps0~7被其它FUN140指令佔用,則待佔用之FUN140釋出控制權,本指令取得定位控制之脈波輸出權。
  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。

FUN140

HSPSO

單軸高速脈波輸出

(含衍生定位指令)

FUN140

HSPSO

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

U/D 模式:從相應點送出上數脈波。

從相應點送出下數脈波。

P/R 模式:從相應點送出脈波。

從相應點送出方向信號;ON=上數,OFF=下數。

A/B 模式:從相應點送出A相脈波。

從相應點送出B相脈波。

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

【介面處理信號】

M9183

ON : 代表Ps0 Ready。

OFF : 代表Ps0 作動中。

M9184

ON : 代表Ps1 Ready。

OFF : 代表Ps1 作動中。

M9185

ON : 代表Ps2 Ready。

OFF : 代表Ps2 作動中。

M9186

ON : 代表Ps3 Ready。

OFF : 代表Ps3 作動中。

M9187

ON : Ps0 完成最後一步。

M9188

ON : Ps1 完成最後一步。

M9189

ON : Ps2 完成最後一步。

M9190

ON : Ps3 完成最後一步。

FUN140

HSPSO

單軸高速脈波輸出

(含衍生定位指令)

FUN140

HSPSO

M9191

ON : 代表Ps4 Ready。

OFF : 代表Ps4 作動中。

M9192

ON : 代表Ps5 Ready。

OFF : 代表Ps5 作動中。

M9193

ON : 代表Ps6 Ready。

OFF : 代表Ps6 作動中。

M9194

ON : 代表Ps7 Ready。

OFF : 代表Ps7 作動中。

M9195

ON : Ps4 完成最後一步。

M9196

ON : Ps5 完成最後一步。

M9197

ON : Ps6 完成最後一步。

M9198

ON : Ps7 完成最後一步。

Ps No.

目前輸出頻率

目前PS位置

剩餘待輸出PS數

錯誤碼

背隙當前剩餘步數

Ps0

DR35328

DR35336

DR35344

R35320

R35782

Ps1

DR35330

DR35338

DR35346

R35321

R35783

Ps2

DR35332

DR35340

DR35348

R35322

R35784

Ps3

DR35334

DR35342

DR35350

R35323

R35785

Ps4

DR35655

DR35663

DR35671

R35647

R35786

Ps5

DR35657

DR35665

DR35673

R35648

R35787

Ps6

DR35659

DR35667

DR35675

R35649

R35788

Ps7

DR35661

DR35669

DR35677

R35650

R35789

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

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

R35761:內定值為0。

R35324:Ps0每步結束時之步號。 R35325:Ps1每步結束時之步號。

R35326:Ps2每步結束時之步號。 R35327:Ps3每步結束時之步號。

R35651:Ps4每步結束時之步號。 R35652:Ps5每步結束時之步號。

R35653:Ps6每步結束時之步號。 R35654:Ps7每步結束時之步號。

FUN140

HSPSO

單軸高速脈波輸出

(含衍生定位指令)

FUN140

HSPSO

  • 定位程式格式:

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

SR

A55AH

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

SR+1

總步數

;1~250

SR+2

SR+3

SR+4

SR+5

SR+6

SR+7

SR+8

SR+9

SR+10

SR+N´9+2

FUN140

HSPSO

單軸高速脈波輸出

(含衍生定位指令)

FUN140

HSPSO

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

WR為起始暫存器

WR+0

目前工作或停留步數

WR+1

工作旗標

WR+2

系統使用

WR+3

系統使用

WR+4

系統使用

WR+5

系統使用

WR+6

系統使用

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

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

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

B8 =保留。

B9 =保留。

B10=保留。

B11=保留。

B12=ON,脈波輸出中(輸出指示〝ACT〞)。

B13=ON,指令執行錯誤(輸出指示〝ERR〞)。

B14=ON,一步定位點完成(輸出指示〝DN〞)。

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

FUN140

HSPSO

單軸高速脈波輸出

(含衍生定位指令)

FUN140

HSPSO

錯誤碼

0

:無錯誤

1

:參數0錯誤

2

:參數1錯誤

3

:參數2錯誤

4

:參數3錯誤

5

:參數4錯誤

6

:參數5錯誤

7

:參數6錯誤

8

:參數7錯誤

9

:參數8錯誤

10

:參數9錯誤

13

:參數12錯誤

14

:參數13錯誤

15

:參數14錯誤

30

:速度設定變數號碼錯誤

31

:速度設定值錯誤

32

:行程設定變數號碼錯誤

33

:行程設定值錯誤

34

:不合法定位程式

35

:步數長度錯誤

36

:超過最大步數

37

:最高頻率錯誤

時

38

:起始/停止頻率錯誤

39

:移動量補正值太大

40

:移動量超出範圍

41

:DRVC內不允許ABS定址

42

:DRVC不可銜接DRVZ命令

43

:驅動命令碼錯誤

50

:DRVZ工作模式錯誤

51

:近點DOG輸入點錯誤

52

:零點信號PG0輸入點錯誤

53

:歸零清除CLR輸出點錯誤

54

:I/O組態錯誤

(Ex :以不支援的模式使用,

如FUN140配脈波模式;

應改為FUN139配脈波模式)

60

:不合法補間驅動命令

註:錯誤指示暫存器內容會保持最近一次之錯誤碼,如需確認不再有錯誤發生,可將錯誤指示暫存器內容清除為0,祇要其內容一直維持0不變,即代表無錯誤發生。

FUN140

HSPSO

單軸高速脈波輸出

(含衍生定位指令)

FUN140

HSPSO

使用UperLogic編輯伺服命令表格

FUN140

HSPSO

單軸高速脈波輸出

(含衍生定位指令)

FUN140

HSPSO

  • 表格類別 : 固定為”伺服命令表格”。
  • 表格名稱 : 可爲伺服命令表格輸入一容易辨識之名稱,方便日後修改或除錯用。
  • 表格起始位置 : 伺服命令指令(FUN140)所用之資料表格起始暫存器SR之起始位置。

※ 有關伺服命令表格之建立,請參考UperLogic介面手冊第7章(表格輸入及編輯),或按一下指令,在按下Z(快捷鍵)進行建立。

FUN140

HSPSO

單軸高速脈波輸出

(含衍生定位指令)

FUN140

HSPSO

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

指令

運算元

說明

SPD

XXXXXX或

Rxxxxx 或

Dxxxxx

  • 脈波輸出之頻率或速度(FUN141參數0=0時為速度;參數0=1或2時為頻率,系統內定為頻率);運算元可直接輸入常數或變數(Rxxxx,Dxxxx);當運算元為變數時共需使用二個暫存器,例如D10,即代表D10(Low Word)與D11(High Word)為頻率或速度設定值。
  • 當選擇使用速度設定時,系統會自動將速度設定值轉換為頻率輸出。
  • 頻率輸出範圍:1≦頻率輸出≦100000 or 200000Hz

*** 當頻率設定值=0時,本指令等待設定值不等於0時,才會執行定位脈波輸出。

FUN140

HSPSO

單軸高速脈波輸出

(含衍生定位指令)

FUN140

HSPSO

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

脈波輸出量

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

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

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

第一項運算元:定位座標選擇

ADR或ABS: ADR,相對值座標定位。
ABS ,絕對值座標定位。

第二項運算元:運轉方向選擇(相對值座標有效)

‘ + ‘ 或 ‘ – ‘: ‘ + ‘,正轉或上數。

‘ – ‘,反轉或下數。
或’ ’ : ‘ ’,運轉方向由行程設定值決定
(正值:正轉;負值:反轉)

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

XXXXXXXX

或

-XXXXXXXX

或Rxxxx

或Dxxxx

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

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

行程設定範圍:-99999999 £ 行程設定值 £ 99999999

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

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

FUN140

HSPSO

單軸高速脈波輸出

(含衍生定位指令)

FUN140

HSPSO

指令

運算元

說明

DRVC

ADR,

或

ABS,

+,

或

-,

xxxxx,

或

Rxxxx,

或

Dxxxx,

Ut

或

Ps

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

***DRVC用來做連續多段速度變換控制(最多8段)

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

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

***連續多段速度控制之方向(正、反轉)祇能由第一段之方向決定,後面指令之方向運算元無效;亦即多段速度變換控制祗能同方向。

例:連續三段速度控制

001

T-CURVE

SPD 10000

DRVC ADR,+,20000,Ut

GOTO NEXT

002

S-CURVE,100%

SPD 50000

DRVC ADR,+,60000,Ut

GOTO NEXT

003

T-CURVE

SPD 3000

DRV ADR,+,5000,Ut

WAIT X0

GOTO 1

;脈波頻率=10KHz

;正轉20000個單位

;脈波頻率=50 KHz

;正轉60000個單位

;脈波頻率=3 KHz

;正轉5000個單位

;等待X0 ON,重新由第一步執行

***注意:DRVC指令之個數必須比連續之段數少一,亦即最後一段必須使用DRV指令。

FUN140

HSPSO

單軸高速脈波輸出

(含衍生定位指令)

FUN140

HSPSO

指令

運算元

說明

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

上例圖示:

DRVZ

MD1

DRVZ為原點復歸便利指令,支援MD1原點復歸方式。

***有關DRVZ之MD1之詳細說明,請參閱9.6節(機械原點復歸)。

註: 相對值座標定位(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

FUN140

HSPSO

單軸高速脈波輸出

(含衍生定位指令)

FUN140

HSPSO

指令

運算元

說明

WAIT

TIME,XXXXX

或Rxxxxx

或Dxxxxx

或X0〜X1023

或Y0〜Y1023

或M0〜M29599

或 S0〜S3103

  • 當脈波輸出完成時,欲執行下一步之等待指令;
    運算元共有五種,說明如下:

Time:等待時間(單位為0.01秒),可直接輸入常數或變數
(Rxxxx或Dxxxx);當計時到,則執行GOTO所指
之步數。

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

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

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

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

ACT

TIME,XXXXX

或Rxxxxx

或Dxxxxx

  • 脈波輸出ACT所描述之作動時間後,立即執行GOTO所指之步數;亦即脈波輸出一段時間後,立即執行下一步。作動時間(單位為0.01秒),可直接輸入常數或變數(Rxxxxx或Dxxxxx);當作動時間到,則執行GOTO所指之步數。

FUN140

HSPSO

單軸高速脈波輸出

(含衍生定位指令)

FUN140

HSPSO

指令

運算元

說明

EXT

X0〜X1023

或 Y0〜Y1023

或 M0〜M29599

或 S0〜S999

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

GOTO

NEXT

或1〜N

或Rxxxxx

或Dxxxxx

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

NEXT :代表執行下一步

1〜N :執行第幾步

Rxxxxx:欲執行之步數存放於暫存器Rxxxxx

Dxxxxx:欲執行之步數存放於暫存器Dxxxxx

MEND

定位程式結束。

加速類型

說明

T-Curve

T曲線則相反,適合低慣量的場合,相當於S曲線的0%,反應速度快,

缺點為控制的剛性高。

S-Curve

0 ~ 100%

S曲線適合用在高慣量的控制場合,可以依照需求填入1~100%的比例,

缺點是會較慢到達最高速。

FUN140

HSPSO

單軸高速脈波輸出

(含衍生定位指令)

FUN140

HSPSO

  • 定位程式之書寫:

定位程式在編輯之前,必須要先完成FUN140指令,並在FUN140指令指定欲存放定位程式之起始暫存器號碼;編輯定位程式時,會將新編之定位程式存入所指定之暫存器區塊,每編1個定位點(稱為1步)會佔用9個暫存器,如有N個定位點(N步),共佔用N ´ 9 + 2個暫存器。

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

程式格式與範例:

001 SPD 5000 ;脈波頻率=5KHz

T-CURVE ;走T型曲線加減速

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

WAIT TIME,100 ;等待1秒

GOTO NEXT ;執行下一步

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

S-CURVE, 100%;走100% S型曲線加減速

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

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

GOTO NEXT ;執行下一步

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

T-CURVE ;走T型曲線加減速

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

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

GOTO NEXT

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

T-CURVE ;走T型曲線加減速

DRV ADR,-,R35344,Ps ;繼續執行第3步未完成之PS數(存放於DR35344)

WAIT X1 ;等待X1 ON時

GOTO 1 ;執行第一步

FUN140

HSPSO

單軸高速脈波輸出

(含衍生定位指令)

FUN140

HSPSO

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

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

定位程式:

T-CURVE

001 SPD 1000

DRV ADR,+,1,Ps

WAIT TIME,50

GOTO NEXT

002 SPD 10000

DRV ADR,+,999999,Ut

MEND

  • 清除結束訊號
  • 每次由第一步開始執行
  • 最後一步執行完,設定
    結束信號

FUN140

HSPSO

單軸高速脈波輸出

(含衍生定位指令)

FUN140

HSPSO

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

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

  • 清除結束訊號
  • 每次由第一步開始執行
  • 最後一步執行完,設定
    結束信號

定位程式:

T-CURVE;走T型曲線加減速

001 SPD 1000

DRV ADR,-,1,Ps

WAIT TIME,50

GOTO NEXT

002 SPD 10000

DRV ADR,+,999999,Ut

9-9-5 FUN141 定位參數設定(MPARA)

FUN141

MPARA

定位程式參數設定指令

FUN141

MPARA

指令說明

Ps :第幾組Pulse 輸出(0~7)

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

範圍

運算元

R

IR

OR

SR

ROR

DR

K

R0

∣

R34767

R34768

∣

R34895

R35024

∣

R35151

R35280

∣

R43223

R43224

∣

R47319

D0

∣

D7999

Ps

0~7

SR

○

○

○

○

○

○

0~32767

功能敘述

FUN141

MPARA

定位程式參數設定指令

FUN141

MPARA

  1. 定位軸最多可以控制到PSO7,唯實際能夠控制的最大軸號依主機機型而有差異。
  2. 本指令並不一定要使用;如果系統內定之參數值已符合使用者需求,則可不必用到此指令;如果需開放參數值作動態修改,則需有此指令。
  3. 本指令配合FUN140作定位控制使用,每一軸只可使用一個本指令
  4. 無論控制輸入〝EN〞=0或1時,本指令皆會被執行。
  5. 當參數值有錯誤時,輸出指示〝ERR〞ON,且錯誤代碼會出現在錯誤碼暫存器。SR=參數表起始暫存器,假設為R2000

R2000

0~2

參數0

系統內定值=1

R2001

1~65535 Ps/Rev

參數1

系統內定值=2000

DR2002

1~999999 mM/Rev

1~999999 mDeg/Rev

1~999999 x 0.1 mInch/Rev

參數2

系統內定值=2000

R2004

0~3

參數3

系統內定值=2

DR2005

1~200000 Ps/sec

1~153000

參數4

系統內定值=200000

DR2007

0~200000 Ps/sec

1~153000

參數5

系統內定值=141

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

FUN141

MPARA

定位程式參數設定指令

FUN141

MPARA

使用UperLogic編輯伺服參數表格

  • 表格類別 : 固定為”伺服參數表格”。
  • 表格名稱 : 可爲伺服參數表格輸入一容易辨識之名稱,方便日後修改或除錯用。
  • 表格起始位置 : 伺服參數指令(FUN141)所用之資料表格起始暫存器SR之起始位置。

FUN141

MPARA

定位程式參數設定指令

FUN141

MPARA

參數說明

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

□ 設定值為0時,程式內所使用之行程與速度設定值均被指定以mm,Deg,Inch為單位,稱為機械單位。

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

□ 設定值為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

FUN141

MPARA

定位程式參數設定指令

FUN141

MPARA

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

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

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

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

  • 參數2:移動量/1轉,內定值為2000,亦即2000 Ps/Rev

馬達轉一圈所帶動之距離 (B)

B=1~999999 mM/Rev

1~999999 mDeg/Rev

1~999999×0.1 mInch/Rev

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

參數0

參數3

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

設定值=1

馬達單位Ps

mm

Deg

Inch

設定值=0

x1

x1

x0.1

x1000

設定值=1

x0.1

x0.1

x0.01

x100

設定值=2

x0.01

x0.01

x0.001

x10

設定值=3

x0.001

x0.001

x0.0001

x1

FUN141

MPARA

定位程式參數設定指令

FUN141

MPARA

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

□ 馬達及複合單位:1~200000 Ps/Sec

□ 機械單位:1~153000(cm/Min,x10 Deg/Min,Inch/Min)

但最高頻率不能大於200000 Ps/Sec

f_max =(V_max x 1000 x A)/(6 x B)£ 200000 Ps/Sec

f_min ³ 1 Ps/Sec

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

  • 參數5:起始/結束速度,內定值=141

□ 馬達及複合單位:1~200000 Ps/Sec。

□ 機械單位:1~15300(cm/Min,´10 Deg/Min,Inch/Min)

但最高頻率不能大於200000 Ps/Sec。

  • 參數6:原點復歸減速速度,內定值為1000

馬達及複合單位 : 1~65535 Ps/Sec

機械單位 : 1~15300 (Cm/Min, x10 Deg/Min, Inch/Min)

  • 參數7:齒輪間隙補正值,內定值=0 註:多軸直線補間命令無效

設定範圍:0~32767 Ps。

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

FUN141

MPARA

定位程式參數設定指令

FUN141

MPARA

  • 參數8:加減速時間設定,內定值=5000,單位為mS 註:多軸直線補間命令無效

設定範圍:0~30000 mS。

此時間代表由靜止加速至最高速度(參數4),或由最高速度減至靜止所需時間。

本系統之加減速乃為等斜率控制。

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

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

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

SR+12

b15 b8 b7 b0

參數9-1

參數9-0

  • 參數9-0:運轉方向設定,內定值為0

設定值=0時,正轉脈波輸出、目前Ps值往上加

反轉脈波輸出、目前Ps值往下減

設定值=1時,正轉脈波輸出、目前Ps值往下減

反轉脈波輸出、目前Ps值往上加

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

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

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

  • 參數10:正轉移動量補正值,內定值=0 註:多軸直線補間命令無效
  • 設定範圍:-32768~32767 Ps。
  • 正轉脈波輸出時,會自動加上此值作為移動距離。
  • 參數11:反轉移動量補正值,內定值=0 註:多軸直線補間命令無效
  • 設定範圍:-32768~32767 Ps。
  • 反轉脈波輸出時,會自動加上此值作為移動距離。
  • 參數12:減速時間設定,內定值=0,單位為mS 註:多軸直線補間命令無效
  • 設定範圍:0~30000 mS。
  • 當參數12 = 0時,以參數8為減速時間。
  • 當參數12 ≠ 0時,以參數12為減速時間。
  • 參數13:補間加減速時間(定數)設定,內定值為500

註:多軸直線補間命令專用

  • 設定範圍 : 0~30000 mS
  • 用來設定直線補間運動時,由靜止(速度=0)加速至工作頻率所需時間;本時間亦用來作減速停止控制
  • 參數14:脈波數/1轉,內定值為0
  • 設定範圍:0~1999999。
  • 當參數14 = 0時,以參數1為脈波數/1轉。
  • 當參數14 ≠ 0時,以參數14為脈波數/1轉。
  • 參數15:控制介面I/O設定,內定值為FFFFFFFFH

b15 b8 b7 b0

SR+19

參數15-1

參數15-0

SR+20

參數15-3

參數15-2

  • 參數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輸入

  • 參數15-1:行程極限輸入接點設定 (SR+19)

b14~b8 : 行程極限輸入接點號碼(0~125,亦即X0~X125)

b15 = 0 : 行程極限輸入為常開接點 (A或NO接點)

= 1 : 行程極限輸入為常閉接點 (B或NC接點)

b15~b8=FFH : 無行程極限輸入

FUN141

MPARA

定位程式參數設定指令

FUN141

MPARA

  • 參數15-2:零點信號PG0輸入接點設定 ; 必須為主機之輸入點(SR+20)

b6~b0 : 零點信號PG0輸入接點號碼(0~15,亦即X0~X15)

b7 = 0 : 近點DOG前緣開始計數零點信號

= 1 : 近點DOG後緣開始計數零點信號

b7~b0 = FFH : 無零點信號PG0輸入

  • 參數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

9-9-6 FUN142 強制停止脈波輸出(PSOFF)

FUN142 P

PSOFF

強制停止HSPSO脈波輸出指令

FUN142 P

PSOFF

指令說明

N:0~7

強制第幾組Pulse 輸出停止輸出

功能敘述

  1. 定位軸最多可以控制到PSO7,唯實際能夠控制的最大軸號依主機機型而有差異。
  2. 當停止控制〝EN〞=1或〝EN〞由0→1(P 指令)時,本指令將強制所指定之第幾組Pulse 輸出停止輸出。
  3. 在執行機械原點復歸之應用時,當原點條件滿足時,利用本指令可快速停止脈波輸出,讓每次作機械原點復歸時,都停在同一個位置。

程式範例

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

9-9-7 FUN143 當前脈波值轉換為顯示值(PSCNV)

FUN143 P

PSCNV

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

FUN143 P

PSCNV

指令說明

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

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

HR

DR

ROR

K

R0

∣

R34767

D0

∣

D7999

R43224

∣

R47319

2

∣

256

Ps

0~7

D

○

○

○*

功能敘述

  1. 定位軸最多可以控制到PSO7,唯實際能夠控制的最大軸號依主機機型而有差異。
  2. 當執行控制〝EN〞=1或〝EN〞由0→1(P 指令)時,本指令將所指定之目前脈波位置(Ps)轉換為與設定值同單位之mm(或Deg或Inch或Ps),以作為目前位置顯示。
  3. FUN140或FUN147指令執行過後,執行本指令時,才會得到正確之轉換值。

FUN143 P

PSCNV

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

FUN143 P

PSCNV

程式範例

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

9-9-8 FUN144 高速脈波寬度調變2 ( HSPWM2 )

FUN144

HSPWM2

高速脈波寬度調變2

(HIGH SPEED PULSE WIDTH MODULATION 2)

FUN144

HSPWM2

指令說明

PW:脈波寬度調變輸出點

0:Y0 & Y1

1:Y2 & Y3

2:Y4 & Y5

3:Y6 & Y7

4:MQ Y16 & Y17, MA/MS/ME: Y8 & Y9

5:MQ Y18 & Y19, MA/MS/ME: Y10 & Y11

6:MQ Y20 & Y21, MA/MS/ME: Y12 & Y13

7:MQ Y22 & Y23, MA/MS/ME: Y14 & Y15

Op:輸出極性(0=正相, 1=倒相)

Hz:輸出頻率(1~100000000 or 1~200000000,單位0.001Hz)

OR:脈波輸出寬度(0~100,單位%)

範圍

運算元

Y

WX

WY

WM

WS

TMR

CTR

HR

IR

OR

SR

ROR

DR

K

主機上

之Yn

WX0

∣

WX1008

WY0

∣

WY1008

WM0

∣

WM19578

WS0

∣

WS3088

T0

∣

T1023

C0

∣

C1279

R0

∣

R34767

R34768

∣

R34895

R35024

∣

R35151

R35280

∣

R43223

R43224

∣

R47319

D0

∣

D7999

Pw

○

○

○

○

○

○

○

○

○

○

○

○

○

Op

0~1

Hz

○

○

○

○

○

○

○

○

○

○

○

○

○

OR

○

○

○

○

○

○

○

○

○

○

○

○

○

0~100

功能敘述

  1. 相較於FUN139,FUN144提供了更直接便利的高速PWM輸出控制,無須透過內建公式推算參數。
  2. 最大輸出頻率依照機型可能為100K或200K,如超過最大輸出頻率將無法執行。

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

FUN147

MHSPO

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

FUN147

MHSPO

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

SR :定位程式起始暫存器(範例解釋)。

WR:指令運作起始暫存器(範例解釋),共佔用9個暫存器,其它程式不可重覆使用。

範圍

運算元

HR

DR

ROR

K

R0

∣

R34767

D0

∣

D7999

R43224

∣

R47319

Gp

0~3

SR

○

○

○

WR

○

○

○*

指令說明

  1. FUN147(MHSPO)指令之直線補間定位程式是以文字之程式書寫方式來編輯;每一定位點我們稱一步(含輸出頻率、動作行程、轉移條件),每一步定位點需佔用15個暫存器。
  2. FUN147(MHSPO)直線補間定位指令最多可同時作四軸直線補間,或兩組獨立之二軸直線補間運動。
  3. 將定位程式存在暫存器最大好處是,如果結合人機作機台操控設定,則可將定位程式存入人機,更換模具時,可直接由人機操作存取該副模具之定位程式。
  4. 當執行控制輸入〝EN〞=1時,如Gp(群組)內的各軸(Ps0~Ps3)沒有被其它FUN140或FUN147指令佔用(Ps0=M9183、Ps1=M9184、Ps2=M9185、Ps3=M9186之狀態為ON),則由下一步定位點開始執行(如已至最後一步,則重新由第1步開始執行);如Gp(群組)內的各軸(Ps0~3)被其它FUN140或FUN147指令佔用(Ps0=M9183、Ps1=M9184、Ps2=M9185、Ps3=M9186之狀態為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。

FUN147

MHSPO

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

FUN147

MHSPO

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

U/D 模式:依照目標點所設定,送出上數脈波。

依照目標點所設定,送出下數脈波。

A/B 模式:依照目標點所設定,送出A相脈波。

依照目標點所設定,送出B相脈波。

P/R 模式:依照目標點所設定,送出一般脈波。

依照目標點所設定,送出方向訊號,ON為上數,OFF為下數。

Pulse 模式:依照目標點所設定,送出脈波。

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

【介面處理信號】

M9161

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

OFF: 停止或暫停FUN147,立即停止脈波輸出

M9183

ON : 代表Ps0 Ready

OFF: 代表Ps0作動中

M9184

ON : 代表Ps1 Ready

OFF: 代表Ps1作動中

M9185

ON : 代表Ps2 Ready

OFF: 代表Ps2作動中

M9186

ON : 代表Ps3 Ready

OFF: 代表Ps3作動中

M9191

ON : 代表Ps4 Ready

OFF: 代表Ps4作動中

M9192

ON : 代表Ps5 Ready

OFF: 代表Ps5作動中

M9193

ON : 代表Ps6 Ready

OFF: 代表Ps6作動中

M9194

ON : 代表Ps7 Ready

OFF: 代表Ps7作動中

M9187

ON : 代表Ps0 已完成最後一步的輸出。

M9188

ON : 代表Ps0 已完成最後一步的輸出。

M9189

ON : 代表Ps0 已完成最後一步的輸出。

M9190

ON : 代表Ps0 已完成最後一步的輸出。

M9195

ON : 代表Ps0 已完成最後一步的輸出。

M9196

ON : 代表Ps0 已完成最後一步的輸出。

M9197

ON : 代表Ps0 已完成最後一步的輸出。

M9198

ON : 代表Ps0 已完成最後一步的輸出。

DR35766

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

DR35768

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

DR35770

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

DR35772

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

R35773

Gp0錯誤碼暫存器

R35774

Gp1錯誤碼暫存器

R35775

Gp2錯誤碼暫存器

R35776

Gp3錯誤碼暫存器

R35777

Gp0定位完成時之步號

R35778

Gp1定位完成時之步號

R35779

Gp2定位完成時之步號

R35780

Gp3定位完成時之步號

Ps No.

目前輸出頻率

目前PS位置

剩餘待輸出PS數

Ps0

DR35328

DR35336

DR35344

Ps1

DR35330

DR35338

DR35346

Ps2

DR35332

DR35340

DR35348

Ps3

DR35334

DR35342

DR35350

Ps4

DR35655

DR35663

DR35671

Ps5

DR35657

DR35665

DR35673

Ps6

DR35659

DR35667

DR35675

Ps7

DR35661

DR35669

DR35677

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

FUN147

MHSPO

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

FUN147

MHSPO

  • 直線補間定位程式格式:

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

SR

A55CH

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

SR+1

總步數

SR+2

SR+3

●

●

●

●

●

●

●

●

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

SR+14

SR+15

SR+16

SR+N×15+2

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,即可達成。

FUN147

MHSPO

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

FUN147

MHSPO

註:錯誤指示暫存器內容會保持最近一次之錯誤碼,如需確認不再有錯誤發生,可將錯誤指示暫存器內容清除為0,祇要其內容一直維持0不變,即代表無錯誤發生。

錯誤指示

錯誤碼

R35320(Ps0)

0

:無錯誤

R35321(Ps1)

1

:參數0錯誤

R35322(Ps2)

2

:參數1錯誤

R35323(Ps3)

3

:參數2錯誤

R35647(Ps4)

4

:參數3錯誤

R35648(Ps5)

5

:參數4錯誤

R35649(Ps6)

6

:參數5錯誤

執行FUN141時

R35650(Ps7)

7

:參數6錯誤

可能之錯誤碼

R35773(Gp0)(Gp0)

8

:參數7錯誤

R35774(Gp1)(Gp1)

9

:參數8錯誤

R35775(Gp2)(Gp0)

10

:參數9錯誤

R35776(Gp3)(Gp1)

13

:參數12錯誤

14

:參數13錯誤

15

:參數14錯誤

30

:速度設定變數號碼錯誤

31

:速度設定值錯誤

32

:行程設定變數號碼錯誤

33

:行程設定值錯誤

34

:不合法定位程式

35

:步數長度錯誤

36

:超過最大步數

37

:最高頻率錯誤

時

38

:起始/停止頻率錯誤

執行FUN140與

39

:移動量補正值太大

執行FUN147時

40

:移動量超出範圍

可能之錯誤碼

41

:DRVC內不允許ABS定址

42

:DRVC不可銜接DRVZ命令

43

:驅動命令碼錯誤

50

:DRVZ工作模式錯誤

51

:近點DOG輸入點錯誤

52

:零點信號PG0輸入點錯誤

53

:歸零清除CLR輸出點錯誤

60

:不合法補間驅動命令

FUN147

MHSPO

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

FUN147

MHSPO

使用WinProladder編輯伺服命令表格

於專案視窗中點選伺服命令表格:

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

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

● 表格起始位置 : FUN147所用之資料表格起始暫存器SR之起始位置。

● 補間起始軸可於表格中指定。

● 支援S曲線或T曲線。

FUN147

MHSPO

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

FUN147

MHSPO

  • 為了讓定位程式易編、易讀、易維護,在FUN147指令下我們衍生出下列幾個相關指令,使用者在UperLogic下即可直接編輯、修改定位程式。
  • 補間運動定位衍生指令列表如下:

指令

運算元

說明

SPD

XXXXXX或

Rxxxx 或

Dxxxx

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

1≦設定值≦1840000

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

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

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

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

LIN

ADR,X,Y,Z,W,Ut

或 或

ABS Ps

X:Ps0之行程設定值

Y:Ps1之行程設定值

Z:Ps2之行程設定值

W:Ps3之行程設定值

• 各軸脈波輸出量設定

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

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

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

第一項運算元:定位座標選擇

ADR或ABS: ADR,相對值座標定位。
ABS,絕對值座標定位。

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

XXXXXXXX

或

−XXXXXXXX

或Rxxxx

或Dxxxx

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

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

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

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

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

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

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

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

FUN147

MHSPO

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

FUN147

MHSPO

指令

運算元

說明

LINE

ADR,X,Y,Z,W,Ut

或 或

ABS Ps

X:Ps0之行程設定值

Y:Ps1之行程設定值

Z:Ps2之行程設定值

W:Ps3之行程設定值

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

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

或Rxxxx

或Dxxxx

或X0〜X255

或Y0〜Y255

或M0〜M1911

或 S0〜S999

• 當補間運動脈波輸出完成時,欲執行下一步之等待指令;
運算元共有五種,說明如下:

Time:等待時間(單位為0.01秒),可直接輸入常數或變數
(Rxxxx或Dxxxx);當計時到,則執行GOTO所指
之步數。

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

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

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

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

FUN147

MHSPO

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

FUN147

MHSPO

EXT

X0〜X255

或 Y0〜Y255

或 M0〜M1911

或 S0〜S999

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

GOTO

NEXT

或1~N

或Rxxxx

或Dxxxx

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

NEXT :代表執行下一步

1~N : 執行第幾步

Rxxxx: 欲執行之步號存放於暫存器Rxxxx

Dxxxx: 欲執行之步號存放於暫存器Dxxxx

MEND

定位程式結束

加速類型

說明

T-Curve

T曲線與S曲線相反,適合低慣量的場合,相當於S曲線的0%,反應速度快,

控制的剛性高。

S-Curve

0 ~ 100%

S曲線適合用在高慣量的控制場合,可以依照需求填入1~100%的比例,

會較慢到達最高速。

  • 定位程式之書寫:

補間定位程式在編輯之前,必須要先完成FUN147指令,並在FUN147指令指定欲存放定位程式之起始暫存器號碼;編輯定位程式時,會將新編之定位程式存入所指定之暫存器區塊,每編1個定位點(稱為1步)會佔用15個暫存器,如有N個定位點(N步),共佔用N × 15 + 2個暫存器。

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

  • 程式格式與範例:

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 ;執行第一步

FUN147

MHSPO

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

FUN147

MHSPO

直線補間示意圖

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

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

動作示意圖如下:

9-9-10 FUN148 手搖輪定位控制 ( MPG )

FUN148

MPG

手搖輪定位控制指令

FUN148

MPG

指令說明

Sc :指定接手搖輪之來源高速計數器;0~7

Ps :指定反應手搖輪之脈波輸出軸;0~7

Fo :輸出頻率設定暫存器(2個暫存器)

Mr :倍率設定暫存器(2個暫存器)

Mr+0:倍率被乘數(Fa)

Mr+1:倍率被除數(Fb)

WR:工作暫存器起始位址,共佔用4個暫存器

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

HR

DR

ROR

K

R0

∣

R34767

D0

∣

D7999

R43224

∣

R47319

16位元

Sc

○

○

○

0~7

Ps

○

○

○

0~7

Fo

○

○

○

Mr

○

○

○

WR

○

○*

○

FUN148

MPG

手搖輪定位控制指令

FUN148

MPG

功能敘述

  • 定位軸最多可以控制到PSO7,唯實際能夠控制的最大軸號依主機機型而有差異。
  • 將此指令放在10mS單位時間定時中斷處理程式(LTM0),並利用特殊暫存器R35443、或利用0.1mS高速計時器產生50mS定時中斷來執行此指令,以便以較準確的時間間隔對手搖輪輸入脈波作取樣、並依倍率設定(Mr+0與Mr+1)計算輸出脈波數;同時在此間隔時間內以Fo所設定的頻率,將計算出來的輸出脈波數作輸出。

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

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

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

  • 如果指定輸出軸被其它定位指令使用中(FUN140/FUN147),則就算有取樣到有手搖輪脈波輸入,也不會有輸出。
  • 當脈波輸出中,輸出指示ACT=1;否則為0。
  • 本指令會佔用4個工作暫存器(WR),其它程式不可重複使用。

FUN148

MPG

手搖輪定位控制指令

FUN148

MPG

程式範例1

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

9-10-1 FUN149 多軸圓弧補間定位輸出指令

FUN149 AHSPO

多軸圓弧補間定位輸出指令

Arc High Speed Pulse Output

FUN149 AHSPO

階梯圖符號

運算元

SR: 定位程式起始暫存器

WR: 指令運作工作暫存器

繼電器和暫存器

範圍

運算元

WX

WY

WM

WS

TMR

CTR

HR

IR

OR

SR

ROR

DR

K

XR

WX0

∣

WX1008

WY0

∣

WY1008

WM0

∣

WM9104

WS0

∣

WS3088

T0

∣

T1023

C0

∣

C1279

R0

∣

R34767

R34768

∣

R35023

R35024

∣

R35279

R35280

∣

R43223

R43224

∣

R47319

D0

∣

D7999

V, Z

P0 ~ P9

ID

○

○

○

○

○

○

○

○

○

○

○

○

0~1

D

○

○

○

○

○

○

○

○

○

○

○

○

○

Gp

○

○

○

○

○

○

○

○

○

○

○

○

0~100

指令說明

  1. Function 149 (AHSPO)指令是以表格方式來編輯運動參數,可使用Ps0~Ps7中任二軸作為脈波輸出軸,當作為fun149的輸出軸時將無法給其它function使用,同理其它function占用的輸出軸func149也無法使用。
  2. 此指令透過表格來設定定位點並且分成三模式半徑、圓心以及通過點來實行圓弧補間運動。
  3. 補間運動中每一定位點稱步step(包含運動模式、行程、向量速度、轉換條件等參數),每一步皆需40個16 bit暫存器,最高可編輯250步。
  4. 參數設置完成後使用引腳啟動脈波輸出,過程中輸出引腳、WR暫存器以及相關的繼電器/暫存器即時地呈現脈波狀態。
  5. 脈波實行補間運動過程中,使用者也可使用轉換條件與更改條件來達成特定的目標。
  6. 當輸入"EN"=1時開始脈波輸出,每當一步完成時將依轉換條件來執行下一步。
  7. 當輸入"EN"=0時將停止脈波輸出,下一次"EN"ON時重新由第一步開始執行。
  8. 當"PAU"=1且"EN"先前為1時,暫時脈波輸出。
  9. 當"PAU"=0且"EN"仍為1時,繼續當前步之未完成脈波輸出。
  10. 當輸入"ABT"=1時將停止脈波輸出。
  11. 當輸入"ABT"=0且"EN"=1時將從第一步開始執行。
  12. 當脈波輸出時,輸出指示"ACT"ON。
  13. 當脈波執行發生錯誤時,輸出指示"ERR"ON,脈波將停止輸出。
  14. 每一步完成時,輸出指示"DN"ON。

SR內容說明

SR暫存器存放此定位程式所需的參數,需要由使用者透過指定命令表格來填寫:

SR0 , SR+1 : 起始暫存器的開頭,存放指令旗標與總步數。

SR+2 ~ SR+41 : 存放第一步表格內容。

SR+42 ~ SR+81 : 存放第二步表格內容。

……

SR+(N – 1) x 40 + 2 ~ SR+(N – 1) x 40 + 41 : 存放第N步表格內容。

以此類推,除了開頭外每一步皆需要40個16 bit暫存器,最高步數為250。

WR內容說明

WR指令運作工作暫存器 ,程式運行時韌體算法將當前指令的執行狀態存放在此:

暫存器

大小

功能

描述

WR+0

16 bit

執行步數或停留步數

指令執行時代表SR正執行的步數,為執行時則表示停留的步數

WR+1

16 bit

工作旗標

B0~B7: 總步數 1~250

B8 = ON: 暫停輸出

B9 = ON: 等待轉移條件

B10 = ON: 連續運轉

B12 = ON: 脈波輸出中(對應應用指令輸出〝ACT〞)

B13 = ON: 指令執行錯誤(對應應用指令輸出〝ERR〞)

B14 = ON: 一步定位點完成(對應應用指令輸出〝DN〞)

B15 = ON: 最後一步定位點完成

WR+2

16 bit

系統適用

保留

WR+3

16 bit

保留

保留

錯誤碼

錯誤碼

描述

相關指令

0

無錯誤

執行

指令141時可能發生之錯誤碼

1

參數0錯誤

2

參數1錯誤

3

參數2錯誤

4

參數3錯誤

5

參數4錯誤

6

參數5錯誤

7

參數6錯誤

8

參數7錯誤

9

參數8錯誤

10

參數9錯誤

13

參數12錯誤

14

參數13錯誤

15

參數14錯誤

30

速度設定變數號碼錯誤

執行

指令140

指令147

指令149時可能發生之錯誤碼

31

速度設定值錯誤

32

行程設定變數號碼錯誤

33

行程設定值錯誤

34

不合法定位程式

35

步數長度錯誤

36

超過最大步數

37

最高頻率錯誤

38

起始/停止頻率錯誤

39

移動量補正值太大

40

移動量超出範圍

41

DRVC內不允許ABS定址

42

DRVC不可銜接DRVZ命令

43

驅動命令錯誤

50

DRVZ工作模式錯誤

51

近點DOG輸入點錯誤

52

零點信號PG0輸入點錯誤

53

歸零清除CLR輸出點錯誤

54

脈波輸出配置錯誤

60

mhspo無效

61

不好的step calculation

62

軸占用

70

主頁設定錯誤

71

當前座標與目標座標之差大於兩倍半徑

執行

指令149時可能發生之錯誤碼

72

當前座標、目標座標與中心座標相等

73

當前座標、目標座標與通過點相等或是三點在直線上

74

三個圓弧模式,若半徑小於1500pulse時無法確保控制精度

繼電器與暫存器

描述

繼電器

描述

繼電器

高速脈波輸出指示 PSO0

M9183

高速脈波輸出完成 PSO0

M9187

高速脈波輸出指示 PSO1

M9184

高速脈波輸出完成 PSO1

M9188

高速脈波輸出指示 PSO2

M9185

高速脈波輸出完成 PSO2

M9189

高速脈波輸出指示 PSO3

M9186

高速脈波輸出完成 PSO3

M9190

高速脈波輸出指示 PSO4

M9191

高速脈波輸出完成 PSO4

M9195

高速脈波輸出指示 PSO5

M9192

高速脈波輸出完成 PSO5

M9196

高速脈波輸出指示 PSO6

M9193

高速脈波輸出完成 PSO6

M9197

高速脈波輸出指示 PSO7

M9194

高速脈波輸出完成 PSO7

M9198

目前輸出頻率

目前PS位置

剩餘PS數

PS0

DR35328

DR35336

DR35344

PS1

DR35330

DR35338

DR35346

PS2

DR35332

DR35340

DR35348

PS3

DR35334

DR35342

DR35350

PS4

DR35655

DR35663

DR35671

PS5

DR35657

DR35665

DR35673

PS6

DR35659

DR35667

DR35675

PS7

DR35661

DR35669

DR35677

伺服命令表格

伺服命令表格路徑:專案管理→資料表格→伺服命令表格。

表格類型選擇為進階伺服程式表格:

每一次的定位點參數可於下圖視窗中填寫:

若欲使用func149指令畫平面圓弧時可設定為Arc模式,其中半徑、圓心以及通過點三個方法使用時須注意以下:

模式

情境

半徑

1. 起點與終點距離差小於兩倍半徑值時,將找到一圓心不落在起點與終點連線上

2. 起點與終點距離差等於兩倍半徑值時,將找到一圓心落在起點與終點連線上

3. 起點與終點距離差大於兩倍半徑值時,指令將發生錯誤

圓心

1. 起點與終點相同時,將繞圓一圈

2. 起點與圓心相同或終點與圓心相同時,將從起點與終點的中間點視為新的圓心並以此點畫弧

3. 起點、終點與圓心座標皆不同且起點與圓心的距離相同於終點與圓心的距離時,將以使用者所設圓心畫弧

4. 起點、終點與圓心座標皆不同但起點與圓心的距離不同於終點與圓心的距離時,將修正圓心位置並以修正後的圓心畫弧

5. 起點、終點與圓心座標皆相同時,指令將發生錯誤

通過點

1. 三點相同時或是三點在直線上時,指令將發生錯誤

2. 若非上一情境時,將畫一圓弧經過使用者所設通過點

操作範例

半圓

此操作範例以半徑模式畫一半圓,表格設置一步即一次定位點操作,本操作將起點設在(0 , 0),表格參數設置如下表,將(100000 , 0)設為目標點並且以10000 Ps/s向量速度進行輸出,加速過程中以s型曲線來進行

半徑模式下需設置半徑值以及旋轉方向,兩參數可取決於使用者想要的圓心位置,轉換條件與更改條件不設置,最後此步設為結束即脈波完成此步操作後將自動停止。

Step

Item

setting

description

1

Mode

ARC , ADR

圓弧模式 , 相對座標

Axis

M:0 , I1:1

軸0為主軸 , 軸1為內差軸

Movement

(100000 , 0) Ps

以當下位置為原點,目標點為(100000 , 0),單位pulse

Speed

SPD 10000

向量速度10000 pulse/s

Acceleration

S-CURVE , 100%

S型速度曲線 , 曲率100%

Arc

RADIUS(CW): 50000

以半徑50000 Ps順時針畫圓弧

Change

無

Go to

無

Switch

MEND

結束

結果

下圖利用運動監視圖監控各軸的速度與位置,速度值由DR35328與DR35330取得而位置值則是DR35336與DR35338,從速度曲線圖中可以觀察到兩軸速度變化,其加速過程與func140 , func147相同也分成加速、勻速以及減速三個過程

,兩軸脈波依當下位置以及向量速度值決定輸出比例來達到適當的轉速,加速階段中轉速值增加,勻速時轉速維持不變而兩軸速度合成為使用者所設的向量速度,減速階段則減速至零。

速度時間圖

位置時間圖

圓形

Step

Item

setting

description

1

Mode

ARC , ADR

圓弧模式 , 相對座標

Axis

M:0 , I1:1

軸0為主軸 , 軸1為內差軸

Movement

(0, 0) Ps

目標點為(0, 0),若當下座標與目標點相同時畫一圈圓

Speed

SPD 10000

向量速度10000 pulse/s

Acceleration

S-CURVE , 100%

S型速度曲線 , 曲率100%

Arc

RADIUS(CW): 50000

以半徑50000 Ps順時針畫圓弧

Change

無

Go to

無

Switch

MEND

結束

結果

多步執行

以下呈現以圓心模式並且使用轉換條件畫兩相鄰的圓,兩步中間皆設定2秒等待時間。

結果

更改條件說明

以下呈現半徑模式畫半圓過程中插入更改條件,以M10暫存器作為觸發條件,當更改條件觸發後以新的目標點進行新的補間運動

Step

Item

setting

description

1

Mode

ARC , ADR

圓弧模式 , 相對座標

Axis

M:0 , I1:1

軸0為主軸 , 軸1為內差軸

Movement

(100000 , 0) Ps

以當下位置為原點,目標點為(100000 , 0),單位pulse

Speed

SPD 20000

向量速度20000 pulse/s

Acceleration

S-CURVE , 100%

S型速度曲線 , 曲率100%

Arc

RADIUS(CW): 50000

以半徑50000 Ps順時針畫圓弧

Change

COORD: WAIT M10 , (50000 , -25000)

若此步運行期間M10 on時,將更改目標點為(50000 , -25000)並立即執行更改後的圓弧運動,參考原點仍是運行前的起始點

Go to

無

Switch

MEND

結束

結果

9-11 機械原點

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

示意圖如下:

方法一:

圖 53 NC伺服機台之機械原點復歸簡圖

例:

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

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

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

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

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

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

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

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

M系列PLC於高速脈波輸出指令(FUN140)中,也具備原點復歸命令(DRVZ)。

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

DRVZ MD1

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

必須設定

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

必須設定

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

必須設定

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

可不設

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

不必設定

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

可不設

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

必須設定

參數17(零點信號數)

不必設定

表 20 與機械原點復歸相關之參數設定表

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

錯 誤 碼

說 明

R35320(PS0)

R35321(PS1)

R35322(PS2)

R35323(PS3)

R35647(PS4)

R35648(PS5)

R35649(PS6)

R35650(PS7)

42

DRVC不可銜接DRVZ命令

50

DRVZ工作模式錯誤

51

近點DOG輸入點錯誤

52

零點信號PG0輸入點錯誤

53

歸零清除CLR輸出點錯誤

表 21 錯誤碼問題對照表

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

圖 54 DRVZ之設定方式圖

原點復歸便利命令(DRVZ)為達到高度精確性及重現性,因而利用中斷技術來處理外界信號(如近點DOG輸入),所以對於機械開關或現場雜訊所產生的彈跳訊號,必須加以濾除以免產生誤動作。一般而言近點DOG sensor建議使用光電或感應式的近接開關,以避免產生類似機械式接觸開關(Limit switch)的彈跳信號。

模式之示意圖及動作說明入下所示,以下範例皆假設欲做原點復歸時機台位置在近點感應開關之右側(原點復歸方向為向左) :

模式1(MOD1)

圖 56 模式1之動作說明與示意圖

【動作說明】

  1. 歸零起始點在原點感知器(DOG sensor,參數15_0)後方
  2. 以原點復歸速度往零點方向移動
  3. 碰到原點感知信號時(中斷處理),由目前速度以加減速時間設定(參數8)之斜率減速停止
  4. 延遲0.5秒後,反方向以原點復歸減速速度(參數6)離開原點感知信號瞬間(中斷處理),該點即為零點位置
  5. 如沒有設定歸零清除信號輸出(參數15_3),找到零點位置時,即代表歸零動作完成
  6. 如有設定歸零清除信號輸出(參數15_3),找到零點位置時,會輸出一脈波寬度大於20mS之信號;完成信號輸出後,才代表整個歸零動作完成
  7. 歸零起始點在原點感知器(DOG sensor)處或前方、配合行程極限感知器(參數15_1)
  8. 以原點復歸速度往零點方向移動會碰到極限感知器而停止前進
  9. 反方向以原點復歸速度離開原點感知器後,以上述1之步驟完成歸零動作

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

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

動作說明

  1. 當原點復歸動作一啟動,先以原點復歸速度朝原點復歸方向前進(參數9_1),直到碰到行程極限輸入點(參數15_1)開關為止。
  2. 當碰到行程極限輸入點(參數15_1)時,立即反向朝原點復歸方向之反方向前進直到離開近點感應開關DOG sensor(近點感應信號由1→0)為止。
  3. 當完成上述步驟2之後,則可以確定起點已回到近點感應開關(DOG sensor)之右側,接下來就會以所設定之原點復歸模式(MD1)繼續完成原點復歸動作。
這篇文件對您有幫助嗎?

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