Implement Echidna Airpad Control

r3295 | dcl | 2011-11-29 18:52:18 +1100 (Tue, 29 Nov 2011) | 1 line
This commit is contained in:
Douglas Clowes
2011-11-29 18:52:18 +11:00
parent f3763033d8
commit bd2f7a6853

View File

@@ -53,7 +53,9 @@ LSEHIT=0
LSFHIT=0
LSGHIT=0
LSHHIT=0
APFDONE=0;' INITIALISE THE BIT FOR AXIS F AIRPAD CONTROL
' INITIALISE THE BIT FOR AXIS F AIRPAD CONTROL
REQF=0
RSPF=0
JS #THREAD0
EN
'
@@ -121,20 +123,33 @@ EN
'ROUTINE TO CONTROL AIRPADS
'
'CONTROLS THE AIRPAD SOLENOID VALVES FOR ANALYSER STAGE
IF (_MOF=0);'ANALYSER 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 ANALYSER MOTOR BE MOVABLE
SHF;' TURN ANALYSER MOTOR ON
WT500;' WAIT FOR MOTOR TO STABILISE
SB 10;'ANALYSER AIR PAD OFF-SOLENOID OFF
CB 9;'ANALYSER AIR PAD ON-SOLENOID ON
APFDONE=0
WT1000;
RSPF=1
ENDIF
IF (_MOF=1)&(APFDONE=0);'ANALYSER MOTOR IS OFF
IF (REQF=0)&(RSPF=1)&(_BGF=0);'MOTION FINISHED
WT1000;' WAIT FOR MOTOR TO SETTLE
SB 9;'ANALYSER AIR PAD ON-SOLENOID OFF
CB 10;'ANALYSER AIR PAD OFF-SOLENOID ON
WT500;'WAIT 1/2 SEC
SB 10;'ANALYSER AIR PAD OFF-SOLENOID OFF
APFDONE=1
MOF;' TURN ANALYSER MOTOR OFF
RSPF=0
ENDIF
'
'
'--------------------------------------------------------------------------
#CHKSPD
'ROUTINE TO CHECK THE SPEED OF THE AXES IS NOT GREATER THAN MAX ALLOWED
@@ -349,3 +364,5 @@ ENDIF
RE
'
'