Implement Echidna Airpad Control
r3295 | dcl | 2011-11-29 18:52:18 +1100 (Tue, 29 Nov 2011) | 1 line
This commit is contained in:
@@ -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
|
||||
'
|
||||
'
|
||||
|
||||
|
||||
|
||||
Reference in New Issue
Block a user