早期使用一般馬達來作定位控制,由於速度不快、或者精度要求不高,所以足以應付所需;當機械運轉為了求取效率而將速度加快時,當製成品品質、精度要求愈高時,馬達停止位置之控制就不是一般馬達所能勝任了!解決此問題之最佳方案是採用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之定位控制硬體說明
|
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單端輸出之配線 驅動器 (光藕合輸入)
外加電源 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 |
||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||
|
||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||
|
指令說明 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。 【介面處理信號】
M2000:ON,多軸同動(控制Ladder程式在同一掃描時間,Ps0~3之FUN140同時啟動, 則其脈波會同時輸出而不會有任何時差)。 :OFF,Ps0~3之FUN140啟動時,該軸脈波立即輸出;由於Ladder程式是先後執行,所以就算Ps0~3之FUN140在同一掃描時間啟動,其脈波輸出一定會有時差。
低位元組之值不為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:如果本指令正執行中,則該暫存器之內容值即為正執行之步數(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〞)。 *** 每一步定位點完成後,輸出指示〝DN〞會一直維持ON;如果不想讓輸出指示一直維持ON,則在每步定位點完成後,利用輸出指示線圈所控制之上緣接點指令將WR+1暫存器內容清除為0,即可達成。 |
|||||||||||


NC定位控制指令
|
FUN140 HSPSO |
單軸高速脈波輸出 |
FUN140 HSPSO |
||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||
使用WinProladder編輯伺服命令表格 表格編輯 伺服命令表格Æ按右鍵後,點選”新 |
||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||
NC定位控制指令
|
FUN140 HSPSO |
單軸高速脈波輸出 |
FUN140 HSPSO |
|
●表格類別:固定為”伺服命令表格”。 ●表格名稱:可爲伺服命令表格輸入一容易辨識之名稱,方便日後修改或除錯用。 ●表格起始位置 :伺服命令指令(FUN140)所用之資料表格起始暫存器SR之起始位置。 ※有關伺服命令表格之詳細說明,請參考WinProladder使用者手冊第五章(表格輸入及編輯)。
|
||
NC定位控制指令
|
FUN140 HSPSO |
單軸高速脈波輸出 |
FUN140 HSPSO |
|||||||||||||||
|
z為了讓定位程式易編、易讀、易維護,在FUN140指令下我們衍生出下列幾個相關指令,使用者在WinProladder下即可直接編輯、修改定位程式。 z定位衍生指令列表如下:
|
|||||||||||||||||

NC定位控制指令
|
FUN140 HSPSO |
單軸高速脈波輸出 |
FUN140 HSPSO |
||||||||||||||||||||||||||||||||||||||||||||||||||||||
***連續多段速度控制之方向(正、反轉)祇能由第一段 之方向決定,後面指令之方向運算元無效;亦即多段 速度變換控制祗能同方向。 例:連續三段速度控制 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指令須搭配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 GOTO NEXT |
||
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 |
||||||
|
執行控制 |
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 |
||||||||||||||||||||
|
參數說明
y設定值為0時,程式內所使用之行程與速度設定值均被指定以mm,Deg,Inch 為單位,稱為機械單位。 y設定值為1時,程式內所使用之行程與速度設定值均被指定以Pulse為單位,稱 為馬達單位。 y設定值為2時,程式內所使用之行程設定值均被指定以mm,Deg,Inch為單位,而速度設定均被指定以Pulse為單位,稱為複合單位。
y馬達轉一圈所需之脈波數 (A) y當參數14 ≠ 0時,以參數14為脈波數/1轉。 ● 參數2:移動量/1轉,內定值為2000,亦即2000 Ps/Rev y馬達轉一圈所帶動之距離 (B) |
||||||||||||||||||||||


NC定位指令
|
FUN141 MPARA |
定位程式參數設定指令 |
FUN141 MPARA |
|||||||||||||||||||||||||||||||||||||||||||
y馬達及複合單位:1~921600 Ps/Sec 註:A=參數1,B=參數2 ● 參數5:起始/結束速度,內定值=141 y機械單位:1~15300(cm/Min,×10 Deg/Min,Inch/Min)但最高頻率不能大於921600 Ps/Sec。 ● 參數6:原點復歸減速速度,內定值為1000 ● 參數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
y參數9-0:運轉方向設定,內定值為0 |
|||||||||||||||||||||||||||||||||||||||||||||
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為減速時間。 ● 參數13:補間加減速時間(定數)設定,內定值為500 註:多軸直線補間命令專用 y設定範圍 : 0~30000 mS 本時間亦用來作減速停止控制 ● 參數14:脈波數/1轉,內定值為0 y當參數14 = 0時,以參數1為脈波數/1轉。 ● 參數15:控制介面I/O設定,內定值為FFFFFFFFH b15 b8 b7 b0
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) |
||||||||

NC定位指令
|
FUN141 MPARA |
定位程式參數設定指令 |
FUN141 MPARA |
||||||
|
y參數15-2:零點信號PG0輸入接點設定;必須為主機之輸入點(SR+20) b6~b0 :零點信號PG0輸入接點號碼(0~15,亦即X0~X15) b7 = 0 :近點DOG前緣開始計數零點信號 y參數15-3:歸零清除信號CLR輸出接點設定;必須為主機之輸出點(SR+20) b15~b8 :歸零清除信號CLR輸出接點號碼(0~23,亦即 ● 參數16:機械原點位置值,內定值為0 ● 參數17:零點信號數,內定值為1 速度 參數4 : 最高速度 工作速度 參數5
|
||||||||













NC定位指令
|
FUN142P PSOFF |
強制停止HSPSO脈波輸出指令 |
FUN142P PSOFF |
||||
|
N:0~3
|
||||||
|
指令說明 1. 當停止控制〝EN〞=1或〝EN〞由0→1(P指令)時,本指令將強制所指定之第幾組 Pulse Output停止輸出。 2. 在執行機械原點復歸之應用時,當原點條件滿足時,利用本指令可快速停止脈波輸出, 讓每次作機械原點復歸時,都停在同一個位置。 |
||||||
|
程式範例
|
||||||


















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 |
||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||
|
||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||
|
指令說明 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。 【介面處理信號】
|
|||||||||||||||||||||||||||||||||||||||||||||||||||

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:如果本指令正執行中,則該暫存器之內容值即為正執行之步數(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〞)。 *** 每一步定位點完成後,輸出指示〝DN〞會一直維持ON;如果不想讓輸出指示一直維持ON,則在每步定位點完成後,利用輸出指示線圈所控制之上緣接點指令將WR+1暫存器內容清除為0,即可達成。 |
|||||||||||||
NC定位指令
|
FUN147 MHSPO |
多軸直線補間定位輸出指令 |
FUN147 MHSPO |
||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||
|
||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||
NC定位指令
|
FUN147 MHSPO |
多軸直線補間定位輸出指令 |
FUN147 MHSPO |
||||||||||||||||||||||||||||||||||||||||
|
使用WinProladder編輯伺服命令表格
伺服命令表格Æ按右鍵後,點選”新於專案視窗中點選伺服命令表格: 專案名稱 增伺服命令表格”。
●表格類別: FUN147(MHSPO)直線補間指令需選擇”多軸命令表格”。 ●表格名稱:可爲多軸命令表格輸入一容易辨識之名稱,方便日後修改或除錯用。●表格起始位置 : FUN147所用之資料表格起始暫存器SR之起始位置。
|
||||||||||||||||||||||||||||||||||||||||||
NC定位指令
|
FUN147 MHSPO |
多軸直線補間定位輸出指令 |
FUN147 MHSPO |
||||||||||||
|
z為了讓定位程式易編、易讀、易維護,在FUN147指令下我們衍生出下列幾個相關指令,使用者在WinProladder下即可直接編輯、修改定位程式。 z補間運動定位衍生指令列表如下:
|
||||||||||||||

NC定位指令
|
FUN147 |
多軸直線補間定位輸出指令 |
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 |
|||||||||
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 |
||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||
● 將此指令放在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),其它程式不可重複使用。
|
||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||
NC定位指令
|
FUN148 MPG |
手搖輪定位控制指令 |
FUN148 MPG |
|
程式範例1:
|
||
NC定位指令
|
FUN148 MPG |
手搖輪定位控制指令 |
FUN148 MPG |
|
X32 :選擇第0軸 (Ps0) 範例說明:在50MSI定時中斷處理程式裏放入Ps0與Ps1之手搖輪定位處理指令。 輸出脈波數=(間隔時間內HSC0輸入脈波數×D700)/D701 |
||
NC定位指令
|
FUN148 MPG |
手搖輪定位控制指令 |
FUN148 MPG |
|
程式範例2:
|
||
NC定位指令
|
FUN148 MPG |
手搖輪定位控制指令 |
FUN148 MPG |
|
X32 :選擇第0軸 (Ps0) 範例說明:將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)左、右極限禁止運動功能 . 程式範例
|



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 |
||||||||
|
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 |
|||||||||
|
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 搜尋










階梯圖符號






















.以Fo所設定的頻率,輸
.以Fo所設定的頻率,輸





































































































