'*********** just M06 *************
'NV3 Y_AXIS TC CHANGE POSITION
'NV4 Z_AXIS TC CHANGE POSITION
'NV5 W_AXIS TC CHANGE POSITION
IF BIT_GET(E17.01) AND BIT_GET(B70.00) AND BIT_GET(B8.00) THEN
BIT_CLR(E17.07)
BIT_CLR(E24.03)
'********** MOVE TO POSTION **********
FLTS(3)=WORD_GET(NV3)/1000 'Y axis tool change position
FLTS(4)=WORD_GET(NV4)/1000 'Z axis tool change position
FLTS(5)=WORD_GET(NV5)/1000 'w axis tool change position
while bit_get(I2.07)=1 OR BIT_GET(I2.05)=0
IF BIT_GET(E0.02)=0 OR BIT_GET(N7) THEN
BIT_SET(B21.01)
'ERR_N("HAND OUT WHEN MOVE SWITH NEED I2.05=1 AND I2.07=0",18)
GOTO 1100
ENDIF
RE_SCHED()
ENDWHILE
AXCMD(SETVEL,Z,6000)
AXCMD(SETVEL,Y,6000)
AXCMD(SETVEL,A,3000)
AXCMD(IMOVE,Z,FLTS(4)) 'MOVE Z TO POSITION
WHILE AXES(Z).STATE>3
RE_SCHED()
ENDWHILE
AXCMD(IMOVE,A,FLTS(5)) 'MOVE A TO POSITION
WHILE AXES(A).STATE>3
RE_SCHED()
ENDWHILE