MPM001 "GRP1"
"----- TAICANG TECO ELECTRIC MAIN PROGRAM-----;
;
FMX T22500K; "馬達最高速度設定
IAC T500; "馬達加速時間設定
IDC T500; "馬達減速時間設定
INP [S]100 [X]100 [Y]100 [Z]100; "各軸允許最大誤差設定
;
"TENTION 2.1kg;
"230S 316rpm;
;
ABS; "絕對值坐標
;
OB0016=0; "CORE CLAMP 1,2 HP "繞線夾具夾緊
TIM T030; "延時0.03秒
EOX; "中間暫停等待（單步時有效）
IOW IB17==1; "CORE CLAMP 1 HP "確認左邊夾具汽缸動作到位
IOW IB19==1; "CORE CLAMP 2 HP "繞線右邊夾具汽缸動作到位
EOX; "中間暫停等待（單步時有效）
;
TIM T030; "延時0.03秒
;
"===== CORE CLAMP CHEK =====
;
MSEE MPS190; "呼叫副程式（繞線夾具夾緊夾緊確認程式）
EOX; "中間暫停等待（單步時有效）
;
"============================
;
PFORK 001,002; "同時動作命令（001~002和002~003區(qū)間同步動作）
;
001: MVS [X]19.000 [Y]-3.000 [Z]-22.500 [S]-325.000 F10000K PFN; "移動命令
MVS [X]25.800 PFN; "移動命令
MVS [Y]7.000 PFN; "移動命令
MVS [X]24.500 [Z]-28.000 PFN; "移動命令
;
PLN [X] [Y]; "繞圓平面設定
KCC [X]24.400 [Y]1.400 P[Z]0.5 L2.090 F8000K PFN; "繞圓動作設定
EOX; "中間暫停等待
;
JOINTO 003; "同時動作命令
;
002: OB0019=1; "NIPPER FRONT SLIDE FE ON "線夾向前伸出
IOW IB001C==1; "NIPPER FRONT SLIDE FE ON "線夾伸出到位確認
IOW IB001D==0; "NIPPER FRONT SLIDE HP OFF "確認線夾不在退回位置
TIM T030; "延時0.03秒
EOX; "中間暫停等待
;
JOINTO 003; "同時動作命令
;
003: PJOINT; "同時動作命令
;
;
PFORK 004,005; "同時動作命令（004~005和005~006區(qū)間同步動作）
;
004: MVS [X]15.000 [S]350.000 F10000K PFN; "移動命令
MVS [Y]-15.000 [S]360.000 F10000K PFN; "移動命令
MVS [Y]-21.000 F10000K PFN; "移動命令
;
JOINTO 006; "同時動作命令
;
005: OB0018=0; "WIRE CLAMP HP "線夾張開（連鎖保護解鎖）
TIM T020; "延時0.02秒
EOX; "中間暫停等待
OB0012=1; "WIRE CLAMP FE "線夾張開（張開動作）
TIM T020; "延時0.02秒
EOX; "中間暫停等待
;
OB0019=0; "NIPPER FRONT SLIDE HP ON "線夾退回動作
IOW IB001D==1; "NIPPER FRONT SLIDE HP ON "線夾退回到位確認
IOW IB001C==0; "NIPPER FRONT SLIDE FE OFF "確認線夾不在伸出位置
TIM T030; "延時0.03秒
EOX; "中間暫停等待
;
JOINTO 006; "同時動作命令
;
006: PJOINT; "同時動作命令
;
;
MVS [X]26.000 [Y]-15.000 [Z]-26.000 [S]15.000 PFN; "移動命令
MVS [X]38.000 [Z]-20.000 PFN; "移動命令
;
OB001E=1; "CORE GUIDE FRONT FE ON "壓線塊（向前移動）
OB001F=0; "CORE GUIDE FRONT HP OFF "壓線塊向前（連鎖保護解鎖）
IOW IB026==1; "CORE GUIDE FRONT FE ON "壓線塊向前到位確認
IOW IB027==0; "CORE GUIDE FRONT HP OFF "確認壓線塊不在退回位置
EOX; "中間暫停等待
TIM T020; "延時0.02秒
;
OB001C=1; "CORE GUIDE U/D FE ON "壓線塊（下壓）
OB001D=0; "CORE GUIDE U/D HP OFF "壓線塊下壓（連鎖保護解鎖）
IOW IB024==1; "CORE GUIDE U/D FE ON "壓線塊下壓到位確認
IOW IB025==0; "CORE GUIDE U/D HP OFF "確認壓線塊不在上升位置
EOX; "中間暫停等待
TIM T020; "延時0.02秒
;
MSEE MPS200; "NOZZLE INVERSE ON "導針90度翻轉（水平）
EOX; "中間暫停等待
;
MVS [X]59.500 [Y]-15.000 [Z]-53.000 F8000K PFN; "WINDING START POSITION 繞線起繞X軸位置
MVS [Z]-86.700 PFN; "移動命令
TIM T020; "延時0.02秒
;
OB001D=1; "CORE GUIDE U/D HP ON "壓線塊（上升）
OB001C=0; "CORE GUIDE U/D FE OFF "壓線塊上升（連鎖保護解鎖）
IOW IB025==1; "CORE GUIDE U/D HP ON "壓線塊上升到位確認
IOW IB024==0; "CORE GUIDE U/D FE OFF "確認壓線塊不在下壓位置
EOX; "中間暫停等待
TIM T020; "延時0.02秒
;
OB001F=1; "CORE GUIDE FRONT HP ON "壓線塊（向后移動）
OB001E=0; "CORE GUIDE FRONT FE OFF "壓線塊向后（連鎖保護解鎖）
IOW IB027==1; "CORE GUIDE FRONT HP ON "壓線塊向后到位確認
IOW IB026==0; "CORE GUIDE FRONT FE OFF "確認壓線塊不在向前位置
EOX; "中間暫停等待
TIM T020; "延時0.02秒
;
"##### 1 姫慄 #####;
MSEE MPS191; "TENSION DURM ON "張力減衰（ON：松）
EOX; "中間暫停等待
;
MSEE MPS151; "繞線動作（繞線參數在MPS151里面設定）
;
MSEE MPS192; "TENSION DURM OFF "張力減衰（OFF：緊）
EOX; "中間暫停等待
"#################;
;
MSEE MPS120; "1次繞線完成后跨槽移動(共跨3次：第一次)
;
"##### 2 姫慄 #####;
MSEE MPS191; "TENSION DURM ON "張力減衰（ON：松）
EOX; "中間暫停等待
;
MSEE MPS151; "繞線動作（繞線參數在MPS151里面設定）
;
MSEE MPS192; "TENSION DURM OFF "張力減衰（OFF：緊）
EOX; "中間暫停等待
"#################;
;
MSEE MPS120; "1次繞線完成后跨槽移動(共跨3次：第二次)
;
"##### 3 姫慄 #####;
MSEE MPS191; "TENSION DURM ON "張力減衰（ON：松）
EOX; "中間暫停等待
;
MSEE MPS151; "繞線動作（繞線參數在MPS151里面設定）
;
MSEE MPS192; "TENSION DURM OFF "張力減衰（OFF：緊）
EOX; "中間暫停等待
"#################;
;
MSEE MPS120; "1次繞線完成后跨槽移動(共跨3次：第三次)
;
"##### 4 姫慄 #####;
MSEE MPS191; "TENSION DURM ON "張力減衰（ON：松）
EOX; "中間暫停等待
;
MSEE MPS151; "繞線動作（繞線參數在MPS151里面設定）
;
MSEE MPS192; "TENSION DURM OFF "張力減衰（OFF：緊）
EOX; "中間暫停等待
"#################;
;
;
"===== U乣V =====;
MSEE MPS130; "1次4組繞線完成后跨槽至2次繞線槽（U TO V）
"===============;
;
;
"##### 5 姫慄 #####;
MSEE MPS191; "TENSION DURM ON "張力減衰（ON：松）
EOX; "中間暫停等待
;
MSEE MPS151; "繞線動作（繞線參數在MPS151里面設定）
;
MSEE MPS192; "TENSION DURM OFF "張力減衰（OFF：緊）
EOX; "中間暫停等待
"#################;
;
MSEE MPS121; "2次繞線完成后跨槽移動(共跨3次：第一次)
;
"##### 6 姫慄 #####;
MSEE MPS191; "TENSION DURM ON "張力減衰（ON：松）
EOX; "中間暫停等待
;
MSEE MPS151; "繞線動作（繞線參數在MPS151里面設定）
;
MSEE MPS192; "TENSION DURM OFF "張力減衰（OFF：緊）
EOX; "中間暫停等待
"#################;
;
MSEE MPS121; "2次繞線完成后跨槽移動(共跨3次：第二次)
;
"##### 7 姫慄 #####;
MSEE MPS191; "TENSION DURM ON "張力減衰（ON：松）
EOX; "中間暫停等待
;
MSEE MPS151; "繞線動作（繞線參數在MPS151里面設定）
;
MSEE MPS192; "TENSION DURM OFF "張力減衰（OFF：緊）
EOX; "中間暫停等待
"#################;
;
MSEE MPS121; "2次繞線完成后跨槽移動(共跨3次：第三次)
;
"##### 8 姫慄 #####;
MSEE MPS191; "TENSION DURM ON "張力減衰（ON：松）
EOX; "中間暫停等待
;
MSEE MPS151; "繞線動作（繞線參數在MPS151里面設定）
;
MSEE MPS192; "TENSION DURM OFF "張力減衰（OFF：緊）
EOX; "中間暫停等待
"#################;
;
;
"===== V乣W =====;
MSEE MPS131; "2次4組繞線完成后跨槽至3次繞線槽（V TO W）
"===============;
;
;
"##### 9 姫慄 #####;
MSEE MPS191; "TENSION DURM ON "張力減衰（ON：松）
EOX; "中間暫停等待
;
MSEE MPS151; "繞線動作（繞線參數在MPS151里面設定）
;
MSEE MPS192; "TENSION DURM OFF "張力減衰（OFF：緊）
EOX; "中間暫停等待
"#################;
;
MSEE MPS122; "3次繞線完成后跨槽移動(共跨3次：第一次)
;
"##### 10 姫慄 #####;
MSEE MPS191; "TENSION DURM ON "張力減衰（ON：松）
EOX; "中間暫停等待
;
MSEE MPS151; "繞線動作（繞線參數在MPS151里面設定）
;
MSEE MPS192; "TENSION DURM OFF "張力減衰（OFF：緊）
EOX; "中間暫停等待
"#################;
;
MSEE MPS122; "3次繞線完成后跨槽移動(共跨3次：第二次)
;
"##### 11 姫慄 #####;
MSEE MPS191; "TENSION DURM ON "張力減衰（ON：松）
EOX; "中間暫停等待
;
MSEE MPS151; "繞線動作（繞線參數在MPS151里面設定）
;
MSEE MPS192; "TENSION DURM OFF "張力減衰（OFF：緊）
EOX; "中間暫停等待
"#################;
;
MSEE MPS122; "3次繞線完成后跨槽移動(共跨3次：第三次)
;
"##### 12 姫慄 #####;
MSEE MPS191; "TENSION DURM ON "張力減衰（ON：松）
EOX; "中間暫停等待
;
MSEE MPS151; "繞線動作（繞線參數在MPS151里面設定）
;
MSEE MPS192; "TENSION DURM OFF "張力減衰（OFF：緊）
EOX; "中間暫停等待
"#################;
;
MVS [Z]-41.300 F10000K PFN; "移動命令
;
MSEE MPS201; "NOZZLE INVERSE OFF "導針90度翻轉（垂直位置）
EOX; "中間暫停等待
;
OB0017=1; "TENTION "張力減衰（ON：松）
;
MVS [X]28.000 [Z]-28.000 F6000K; "移動命令
;
INC; "相對值坐標
MVS [S]25.000 F10000K PFN; "移動命令
ABS; "絕對值坐標
;
MVS [X]14.000; "移動命令
;
INC; "相對值坐標
MVS [S]-40.000 F10000K PFN;
ABS; "絕對值坐標
;
MVS [Y]5.500 [Z]-28.500 [S]-327.000 PFN; "移動命令
MVS [X]14.000 [Y]25.000 [Z]-34.000 PFN; "移動命令
;
OB0019=1; "NIPPER FRONT SLIDE FE ON "線夾向前伸出
IOW IB001C==1; "NIPPER FRONT SLIDE FE ON "線夾伸出到位確認
IOW IB001D==0; "NIPPER FRONT SLIDE HP OFF "確認線夾不在退回位置
TIM T030; "延時0.03秒
EOX; "中間暫停等待
;
OB0018=1; "WIRE CLAMP ON "剪刀剪線
OB0012=0; "剪刀剪線（連鎖保護解鎖）
TIM T030; "延時0.03秒
EOX; "中間暫停等待
;
MVS [Z]-20.000 PFN; "移動命令
;
OB0017=0; "TENTION "張力減衰（ON：松）
;
PFORK 007,008; "同時動作命令（007~008和008~009區(qū)間同步動作）
;
007: MVS [X]0.000 [Y]0.000 [Z]00.000 [S]360.000 PFN; "移動命令
JOINTO 009; "同時動作命令
;
008: OB0019=0; "NIPPER FRONT SLIDE HP ON "線夾退回動作
IOW IB001D==1; "NIPPER FRONT SLIDE HP ON "線夾退回到位確認
IOW IB001C==0; "NIPPER FRONT SLIDE FE OFF "確認線夾不在伸出位置
TIM T030; "延時0.03秒
EOX; "中間暫停等待
;
JOINTO 009; "同時動作命令
;
009: PJOINT; "同時動作命令
;
OB0016=1; "CORE CLAMP 1,2 FE "繞線夾具放松
TIM T030; "延時0.03秒
EOX; "中間暫停等待
IOW IB17==1; "CORE CLAMP 1 HP "確認左邊夾具汽缸動作到位
IOW IB19==1; "CORE CLAMP 2 HP "繞線右邊夾具汽缸動作到位
EOX; "中間暫停等待
;
END; "主程式結束命令
滬公網安備31010802001143號
