Change Flight Tube to use REQx/RSPx instead of FTUBE/APDONE variables. Now workks for RSD Sample raise dual motor as well.
r1998 | dcl | 2007-06-01 16:53:25 +1000 (Fri, 01 Jun 2007) | 2 lines
This commit is contained in:
@@ -1,9 +1,9 @@
|
|||||||
NO TE: KOWARI - CONTROLLER 2
|
NO TE: KOWARI - CONTROLLER 2
|
||||||
NO TE:
|
NO TE:
|
||||||
NO TE: $Revision: 1.5 $
|
NO TE: $Revision: 1.6 $
|
||||||
NO TE: $Date: 2007-05-31 06:32:46 $
|
NO TE: $Date: 2007-06-01 06:53:25 $
|
||||||
NO TE: Author: Dan Bartlett
|
NO TE: Author: Dan Bartlett
|
||||||
NO TE: Last revision by: $Author: dbx $
|
NO TE: Last revision by: $Author: dcl $
|
||||||
NO TE:
|
NO TE:
|
||||||
NO TE: A-SAMPLE RAISE FIRST SECTION
|
NO TE: A-SAMPLE RAISE FIRST SECTION
|
||||||
NO TE: B-SAMPLE RAISE SECOND SECTION
|
NO TE: B-SAMPLE RAISE SECOND SECTION
|
||||||
@@ -33,7 +33,15 @@ SIE=1,25,13,0<-2>2;'HEIDENHAIN ROQ425
|
|||||||
SIF=1,25,13,0<-2>2;'HEIDENHAIN ROQ425
|
SIF=1,25,13,0<-2>2;'HEIDENHAIN ROQ425
|
||||||
SIG=0,25,13,0<-2>2;'NOT USED
|
SIG=0,25,13,0<-2>2;'NOT USED
|
||||||
SIH=0,25,13,0<-2>2;'NOT USED
|
SIH=0,25,13,0<-2>2;'NOT USED
|
||||||
APDONE=0;' FIRST TIME THROUGH AIRPAD CONTROL NOT DONE
|
NO TE: FIRST TIME THROUGH MOTOR LINK NOT DONE
|
||||||
|
REQA=0
|
||||||
|
RSPA=0
|
||||||
|
GAB=CA;'SET B FOLLOWS A IN COMMAND MODE
|
||||||
|
GRB=1;' SET 1:1 GEARING FOR NOW
|
||||||
|
GMB=1;' SET GANTRY MODE
|
||||||
|
NO TE: FIRST TIME THROUGH AIRPAD CONTROL NOT DONE
|
||||||
|
REQF=0
|
||||||
|
RSPA=0
|
||||||
JS #THREAD0
|
JS #THREAD0
|
||||||
EN
|
EN
|
||||||
NO ----------------------------------------
|
NO ----------------------------------------
|
||||||
@@ -64,18 +72,39 @@ ENDIF
|
|||||||
IF (_SPH>50000)
|
IF (_SPH>50000)
|
||||||
SPH=50000
|
SPH=50000
|
||||||
ENDIF
|
ENDIF
|
||||||
|
NO TE: CONTROLS LINKED MOTORS
|
||||||
|
IF (_MOA=0)&(RSPA=0);'DETECTOR ROTATE MOTOR IS ON
|
||||||
|
REQA=1
|
||||||
|
ENDIF
|
||||||
|
IF (_MOA=1)&(RSPA=1);'DETECTOR ROTATE MOTOR IS OFF
|
||||||
|
REQA=0
|
||||||
|
ENDIF
|
||||||
|
IF (REQA=1)&(RSPA=0);' SAMPLE RAISE MOTOR IS REQUIRED
|
||||||
|
SH AB
|
||||||
|
RSPA=1
|
||||||
|
ENDIF
|
||||||
|
IF (REQA=0)&(RSPA=1);' SAMPLE RAISE MOTOR IS NOT REQUIRED
|
||||||
|
MO AB
|
||||||
|
RSPA=0
|
||||||
|
ENDIF
|
||||||
NO TE: CONTROLS THE AIRPAD SOLENOID VALVES
|
NO TE: CONTROLS THE AIRPAD SOLENOID VALVES
|
||||||
IF (_MOF=0);'DETECTOR ROTATE MOTOR IS ON
|
IF (_MOF=0)&(RSPF=0);'DETECTOR ROTATE MOTOR IS ON
|
||||||
|
REQF=1
|
||||||
|
ENDIF
|
||||||
|
IF (_MOF=1)&(RSPF=1);'DETECTOR ROTATE MOTOR IS OFF
|
||||||
|
REQF=0
|
||||||
|
ENDIF
|
||||||
|
IF (REQF=1)&(RSPF=0);' DETECTOR ROTATE MOTOR IS REQUIRED
|
||||||
SB 10;'DETECTOR AIR PAD OFF-SOLENOID OFF
|
SB 10;'DETECTOR AIR PAD OFF-SOLENOID OFF
|
||||||
CB 9;'DETECTOR AIR PAD ON-SOLENOID ON
|
CB 9;'DETECTOR AIR PAD ON-SOLENOID ON
|
||||||
APDONE=0
|
RSPF=1
|
||||||
ENDIF
|
ENDIF
|
||||||
IF (_MOF=1)&(APDONE=0);'DETECTOR ROTATE MOTOR IS OFF
|
IF (REQF=0)&(RSPF=1);' DETECTOR ROTATE MOTOR IS NOT REQUIRED
|
||||||
SB 9;'DETECTOR AIR PAD ON-SOLENOID OFF
|
SB 9;'DETECTOR AIR PAD ON-SOLENOID OFF
|
||||||
CB 10;'DETECTOR AIR PAD OFF-SOLENOID ON
|
CB 10;'DETECTOR AIR PAD OFF-SOLENOID ON
|
||||||
WT500;'WAIT 1/2 SEC
|
WT500;'WAIT 1/2 SEC
|
||||||
SB 10;'DETECTOR AIR PAD OFF-SOLENOID OFF
|
SB 10;'DETECTOR AIR PAD OFF-SOLENOID OFF
|
||||||
APDONE=1
|
RSPF=0
|
||||||
ENDIF
|
ENDIF
|
||||||
JP #THREAD0
|
JP #THREAD0
|
||||||
EN
|
EN
|
||||||
|
|||||||
Reference in New Issue
Block a user