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:
Douglas Clowes
2007-06-01 16:53:25 +10:00
parent d75f423f43
commit fe63096315

View File

@@ -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