VI. Kết quả hạn chế:
Code chương trình con về vị trí đầu
Network 1
LD M0.5 TON T101, 3
Network 2 // Network Title
// Chờ 0,3s cho ĐC khâu đé quay ngược
LDW> T101, 3 = Q1.0 Network 3 // khâu đế hoạt động LDW> T101, 6 EU MOVW 100, SMW70 PLS 0 Network 4
// độ rộng xung cho tay kẹp
LD SM0.0
MOVW 8, SMW80
PLS 1
Network 5
// đảo chiều ĐC khâu 2
LDW> T101, 3 = Q1.1 Network 6 // ĐC khâu 2 hoạt động LDW> T101, 12 EU S Q0.5, 1 Network 7
//khâu tay kẹp hoạt động
LDW> T101, 18 EU
S Q0.3, 2
Network 8
// đừn các động cơ khi gặp công tắc hành trình LD I0.5 EU MOVW 0, SMW80 PLS 1 Network 9 LD I0.5 R Q0.3, 2 Network 10 LD I1.1 R Q0.5, 1 Network 11 LD I1.0 MOVW 0, SMW70 PLS 0 Network 12 // xóa các bit và HSC LD I1.0 A I1.1 A I0.5 EU HSC 0 HSC 1 HSC 2 HSC 4 R M0.0, 255 R Q0.5, 10 R T0, 255 HSC 0
Code chương trình con HSC1
LD SM0.0
MOVB 16#FC, SMB47 //Set control bits: count UP; rate 1X; enabled; MOVD +0, SMD48 //Load CV MOVD +0, SMD52 //Load PV HDEF 1, 9
ENI HSC 1
Code chương trình con HSC2
Network 1 // Instruction Wizard HSC
LD SM0.0
MOVB 16#FC, SMB57 //Set control bits: count UP; rate 1X; enabled; MOVD +0, SMD58 //Load CV MOVD +0, SMD62 //Load PV HDEF 2, 9
ENI HSC 2
Code chương trình con HSC4
Network 1 // Instruction Wizard HSC LD SM0.0
MOVB 16#FC, SMB147 //Set control bits: count UP; rate 1X; enabled; MOVD +0, SMD148 //Load CV MOVD +0, SMD152 //Load PV HDEF 4, 9
ENI HSC 4
Code chương trình con xung – goc 2 2
Network 1 // Network Title
// lay gia tri hien tai cua HSC2 ==> VW4
LD SM0.0 MOVD HC2, AC2 DTI AC2, AC2 MOVW AC2, VW4
Network 2
// Chuyen tu xung sang goc cua khau 3 ==> VW14 LD SM0.0 MOVD HC2, AC2 *D +360, AC2 /D 240, AC2 DTI AC2, VW14
Code chương trình con xung – goc 3
Network 1 // Network Title
// Lay gia tri hien tai cua HSC4 ==> VW6
LD SM0.0 MOVD HC4, AC3 DTI AC3, AC3 MOVW AC3, VW6
Network 2
// Chuyen tu xung sang goc cua khau 4 ==> VW16 LD SM0.0 MOVD HC4, AC3 *D +360, AC3 /D 240, AC3 DTI AC3, VW16
Code chương trình con goc - xung 2
Network 1 // Network Title
// Chuyen tu goc sang xung cua khau 2 ==> vw24 LD SM0.0 ITD VW54, AC2 *D 240, AC2 /D 360, AC2 DTI AC2, VW24 Network 2
// Xac dinh sai so can tren va can duoi cua khau 2 ==> vw34
LD SM0.0
MOVW VW24, VW34 -I VW4, VW34
Code chương trình con goc - xung 3
Network 1 // Network Title
// Chuyen tu goc sang xung cua khau 2 ==> vw24 LD SM0.0 ITD VW54, AC2 *D 240, AC2 /D 360, AC2 DTI AC2, VW24 Network 2
// Xac dinh sai so can tren va can duoi cua khau 2 ==> vw34
LD SM0.0
MOVW VW24, VW34 -I VW4, VW34
Code chương trình con PWM 1
Network 1 // cai dat thong so cho PWM1
LD SM0.0
MOVB 16#DB, SMB77 MOVW 100, SMW78 MOVW 0, SMW80
PLS 1
MOVB 16#DA, SMB77