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:
@@ -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
|
||||
'
|
||||
|
||||
Reference in New Issue
Block a user