Flight tube air pad control modified

r1499 | dbx | 2007-02-17 08:38:39 +1100 (Sat, 17 Feb 2007) | 2 lines
This commit is contained in:
Dan Bartlett
2007-02-17 08:38:39 +11:00
committed by Douglas Clowes
parent d5cde7c4f6
commit c5e5630a60

View File

@@ -1,7 +1,7 @@
NO TE: WOMBAT - CONTROLLER 1 NO TE: WOMBAT - CONTROLLER 1
NO TE: NO TE:
NO TE: $Revision: 1.2 $ NO TE: $Revision: 1.3 $
NO TE: $Date: 2007-01-31 03:39:19 $ NO TE: $Date: 2007-02-16 21:38:39 $
NO TE: Author: Dan Bartlett NO TE: Author: Dan Bartlett
NO TE: Last revision by: $Author: dbx $ NO TE: Last revision by: $Author: dbx $
NO TE: NO TE:
@@ -34,6 +34,7 @@ SIF=1,25,25,0<-2>2;'HEIDENHAIN RCN226
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 APDONE=0;' FIRST TIME THROUGH AIRPAD CONTROL NOT DONE
FTUBE=0;' FLIGHT TUBE OFF
JS #THREAD0 JS #THREAD0
EN EN
NO ---------------------------------------- NO ----------------------------------------
@@ -65,22 +66,33 @@ NO IF (_SPH>50000)
NO SPH=50000 NO SPH=50000
NO ENDIF NO ENDIF
NO TE: CONTROLS THE AIRPAD SOLENOID VALVES NO TE: CONTROLS THE AIRPAD SOLENOID VALVES
IF (_MOF=0);'FLIGHT TUBE MOTOR IS ON NO TE; SET FTUBE=1 TO MAKE FLIGHT TUBE AVAILABLE FOR MOVE
SB 10;'SAMPLE STAGE AIR PAD OFF-SOLENOID OFF NO TE: THE APDONE BIT IS USED SO THAT THE CODE ONLY RUNS WHEN THE
NO TE: STATE OF FTUBE CHANGES - THE DELAYS ARENT RUNNING EVERY CYCLE
NO TE: IN THE 2ND IF, THE OFF-SOLENOIDS ARENT HELD ENERGISED IN CASE THE
NO TE: VALVE MANUAL OVER RIDE IS NEEDED.
IF (FTUBE=1)&(APDONE=0);'REQUESTING FLIGHT TUBE BE MOVABLE
SHF;' TURN MOTOR ON
WT500;' WAIT FOR MOTOR TO STABILISE
SB 12;'DRIVE WHEEL UP-SOLENOID OFF SB 12;'DRIVE WHEEL UP-SOLENOID OFF
CB 9;'SAMPLE STAGE AIR PAD ON-SOLENOID ON
CB 11;'DRIVE WHEEL DOWN-SOLENOID ON CB 11;'DRIVE WHEEL DOWN-SOLENOID ON
APDONE=0 WT1000;' WAIT FOR DRIVE WHEEL TO LOWER
SB 10;'SAMPLE STAGE AIR PAD OFF-SOLENOID OFF
CB 9;'SAMPLE STAGE AIR PAD ON-SOLENOID ON
APDONE=1
ENDIF ENDIF
IF (_MOF=1)&(APDONE=0);'FLIGHT TUBE MOTOR IS OFF IF (FTUBE=0)&(APDONE=1);'FLIGHT TUBE MOTION FINISHED
WT1000; WAIT FOR FLIGHT TUBE TO SETTLE
SB 9;'SAMPLE STAGE AIR PAD ON-SOLENOID OFF SB 9;'SAMPLE STAGE AIR PAD ON-SOLENOID OFF
SB 11;'DRIVE WHEEL DOWN-SOLENOID OFF
CB 10;'SAMPLE STAGE AIR PAD OFF-SOLENOID ON CB 10;'SAMPLE STAGE AIR PAD OFF-SOLENOID ON
WT500;
SB 10;'SAMPLE STAGE AIR PAD OFF-SOLENOID OFF
SB 11;'DRIVE WHEEL DOWN-SOLENOID OFF
CB 12;'DRIVE WHEEL UP-SOLENOID ON CB 12;'DRIVE WHEEL UP-SOLENOID ON
WT500;'WAIT 1/2 SEC WT500;'WAIT 1/2 SEC
SB 10;'SAMPLE STAGE AIR PAD OFF-SOLENOID OFF
SB 12;'DRIVE WHEEL UP-SOLENOID OFF SB 12;'DRIVE WHEEL UP-SOLENOID OFF
APDONE=1 MOF;' TURN MOTOR OFF
APDONE=0
ENDIF ENDIF
JP #THREAD0 JP #THREAD0
EN EN