Revise AIRPAD CONTROL to be more like Echidna et al

r3293 | dcl | 2011-11-28 14:31:06 +1100 (Mon, 28 Nov 2011) | 1 line
This commit is contained in:
Douglas Clowes
2011-11-28 14:31:06 +11:00
parent baf2206efe
commit 66a87d9d01

View File

@@ -50,8 +50,12 @@ LSEHIT=0
LSFHIT=0
LSGHIT=0
LSHHIT=0
APFDONE=0;'INITIALISE THE BIT FOR AXIS F AIRPAD CONTROL
APHDONE=0;'INITIALISE THE BIT FOR AXIS H AIRPAD CONTROL
'INITIALISE THE BIT FOR AXIS F AIRPAD CONTROL
REQF=0
RSPF=0
'INITIALISE THE BIT FOR AXIS H AIRPAD CONTROL
REQH=0
RSPH=0
HMTAPEDN=0;'TAPE HOME ROUTINE NOT RUN
HMWEDGDN=0;'WEDGE HOME ROUTINE NOT RUN
ANGLE=((_TPF-190161)*-0.006696)+25.77375473;'SET ANGLE TO CURRENT POSITION
@@ -386,33 +390,73 @@ EN
'-----------------------------------------------------------------------------
#AIRPAD
'ROUTINE TO CONTROL AIRPADS
'ADAPTED FROM ECHIDNA AIRPAD CONTROL BY DOUGLAS CLOWES
'
'CONTROLS THE AIRPAD SOLENOID VALVES FOR SAMPLE STAGE
IF (_MOF=0);'FLIGHT TUBE MOTOR IS ON
' FOLLOW SHF/MOF COMMANDS ENTERED MANUALLY
IF (_MOF=0)&(RSPF=0);'MOTOR IS ON BUT AIR IS OFF
REQF=1
ENDIF
IF (_MOF=1)&(RSPF=1);'MOTOR IS OFF BUT AIR IS ON
SHF;' FOLLOWING STEPS MUST BE RUN BEFORE MOTOR CAN BE TURNED OFF
REQF=0
ENDIF
'
IF (REQF=1)&(RSPF=0);'REQUESTING SAMPLE STAGE MOTOR BE MOVABLE
SHF;' TURN SAMPLE STAGE MOTOR ON
WT500;' WAIT FOR MOTOR TO STABILISE
SB 10;'SAMPLE STAGE AIR PAD OFF-SOLENOID OFF
CB 9;'SAMPLE STAGE AIR PAD ON-SOLENOID ON
APFDONE=0
SB 12;'DETECTOR AIR PAD OFF-SOLENOID OFF
CB 11;'DETECTOR AIR PAD ON-SOLENOID ON
WT1000;
RSPF=1
ENDIF
IF ((_MOF=1)&(APFDONE=0));'FLIGHT TUBE MOTOR IS OFF AND 1ST TIME THROUGH
IF (REQF=0)&(RSPF=1)&(_BGF=0);'MOTION FINISHED
WT1000;' WAIT FOR MOTOR TO SETTLE
SB 9;'SAMPLE STAGE AIR PAD ON-SOLENOID OFF
CB 10;'SAMPLE STAGE AIR PAD OFF-SOLENOID ON
IF (REQH=0)&(RSPH=0);'DETECTOR IS NOT ON
SB 11;' DETECTOR AIR PAD ON-SOLENOID OFF
CB 12;' DETECTOR AIR PAD OFF-SOLENOID ON
ENDIF
WT500;'WAIT 1/2 SEC
SB 10;'SAMPLE STAGE AIR PAD OFF-SOLENOID OFF
APFDONE=1
IF (REQH=0)&(RSPH=0);'DETECTOR IS NOT ON
SB 12;' DETECTOR AIR PAD OFF-SOLENOID OFF
ENDIF
MOF;' TURN SAMPLE STAGE MOTOR OFF
RSPF=0
ENDIF
'
'CONTROLS THE AIRPAD SOLENOID VALVES FOR DETECTOR STAGE
IF ((_MOH=0)|(_MOF=0));'DETECTOR OR FLIGHT TUBE MOTOR IS ON
' FOLLOW SHF/MOF COMMANDS ENTERED MANUALLY
IF (_MOH=0)&(RSPH=0);'MOTOR IS ON BUT AIR IS OFF
REQF=1
ENDIF
IF (_MOH=1)&(RSPH=1);'MOTOR IS OFF BUT AIR IS ON
SHF;' FOLLOWING STEPS MUST BE RUN BEFORE MOTOR CAN BE TURNED OFF
REQF=0
ENDIF
'
IF (REQH=1)&(RSPH=0);'REQUESTING DETECTOR MOTOR BE MOVABLE
SHH;' TURN MOTOR ON
WT500;' WAIT FOR MOTOR TO STABILISE
SB 12;'DETECTOR AIR PAD OFF-SOLENOID OFF
CB 11;'DETECTOR AIR PAD ON-SOLENOID ON
APHDONE=0
WT1000;
RSPH=1
ENDIF
IF ((_MOH=1)&(_MOF=1)&(APHDONE=0));'DETECTOR & FT MOTORS OFF & 1ST TIME THROUGH
SB 11;'DETECTOR AIR PAD OFF-SOLENOID OFF
IF (REQH=0)&(RSPH=1)&(_BGH=0);'MOTION FINISHED
WT1000;' WAIT FOR MOTOR TO SETTLE
IF (REQF=0)&(RSPF=0);'SAMPLE STAGE IS NOT ON
SB 11;'DETECTOR AIR PAD ON-SOLENOID OFF
CB 12;'DETECTOR AIR PAD OFF-SOLENOID ON
WT500;'WAIT 1/2 SEC
SB 12;'DETECTOR AIR PAD OFF-SOLENOID OFF
APHDONE=1
ENDIF
MOH;' TURN MOTOR OFF
RSPH=0
ENDIF
EN
'