programa servo

IPOS-CODE ADDR 2 MDS60A0110-5A3 EMPACADORA ATUN 1/1

1 mm. = 1/1 inc

JMP UNCONDITIONED , M1
M15 :SET H1 = 1
SET H2 = 0
SET H4 = 0
SET H481 = 0
M3 :SET H400 = H483
AND H400 & 2 hex
JMP H400 == 0, M2
BSET H481.1 = 1
JMP H2 == 12 , M3
JMP H4 != 0, M4
SET H3 = 0
SET H4 = 1
M6 :SET H400 = H483
AND H400 & 4 hex
NOTL H400 = NOT(H400)
JMP H400 == 0, M5
JMP UNCONDITIONED , M6
M5 :BSET H481.2 = 1
SET H488 = 100
M8 :JMP H488 == 0, M7
JMP UNCONDITIONED , M8
M7 :BCLR H481.2 = 0
M4 :SET H488 = H9
M11 :JMP H488 == 0, M9
SET H400 = H483
AND H400 & 4 hex
JMP H400 == 0, M10
OR H3 | H1
BSET H481.2 = 1
JMP UNCONDITIONED , M11
M10 :BCLR H481.2 = 0
JMP UNCONDITIONED , M11
M9 :SET H488 = H10
M14 :JMP H488 == 0, M12
SET H400 = H483
AND H400 & 4 hex
JMP H400 == 0, M13
BSET H481.2 = 1
JMP UNCONDITIONED , M14
M13 :BCLR H481.2 = 0
JMP UNCONDITIONED , M14
M12 :SHL H1 << 1
ADD H2 + 1
JMP UNCONDITIONED , M3
M2 :BCLR H481.1 = 0
SET H400 = H3
MUL H400 * H5
DIV H400 / H6
SET H7 = H400
SET H474 = H33
RET
M1 :TASK2 START M15
M17 :SET H401 = H483
AND H401 & 1 hex
JMP H401 != 0, M16
WAIT 100 ms
JMP UNCONDITIONED , M17
M16 :GO0 C, W, ZP
SET H8 = 0
M20 :SET H401 = H131
MUL H401 * -1
MUL H401 * H11
SET H20 = H401
DIV H20 / H12
JMP H20 >= H23 , M18
SET H20 = H23
M18 :SET H22 = H20
SETSYS POS.SPEED C(C)W = H20
SET H401 = H483
AND H401 & 28 hex
ASHR H401 >> 3
JMP H401 != 0, M19
SET H8 = 1
M19 :JMP H8 != 1 , M20
SET H401 = H483
AND H401 & 28 hex
ASHR H401 >> 3
JMP H401 != 1 , M21
SET H33 = H7
GOR WAIT H33
SET H8 = 0
JMP UNCONDITIONED , M20
M21 :JMP H401 != 4 , M20
SET H401 = H7
MUL H401 * H30
DIV H401 / H31
SET H33 = H401
GOR WAIT H33
SET H8 = 0
JMP UNCONDITIONED , M20
END

MOVITOOLS 4.90