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 LSFHIT=0
LSGHIT=0 LSGHIT=0
LSHHIT=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 JS #THREAD0
EN EN
' '
@@ -121,20 +123,33 @@ EN
'ROUTINE TO CONTROL AIRPADS 'ROUTINE TO CONTROL AIRPADS
' '
'CONTROLS THE AIRPAD SOLENOID VALVES FOR ANALYSER STAGE '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 SB 10;'ANALYSER AIR PAD OFF-SOLENOID OFF
CB 9;'ANALYSER AIR PAD ON-SOLENOID ON CB 9;'ANALYSER AIR PAD ON-SOLENOID ON
APFDONE=0 WT1000;
RSPF=1
ENDIF 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 SB 9;'ANALYSER AIR PAD ON-SOLENOID OFF
CB 10;'ANALYSER AIR PAD OFF-SOLENOID ON CB 10;'ANALYSER AIR PAD OFF-SOLENOID ON
WT500;'WAIT 1/2 SEC WT500;'WAIT 1/2 SEC
SB 10;'ANALYSER AIR PAD OFF-SOLENOID OFF SB 10;'ANALYSER AIR PAD OFF-SOLENOID OFF
APFDONE=1 MOF;' TURN ANALYSER MOTOR OFF
RSPF=0
ENDIF ENDIF
' '
'
'-------------------------------------------------------------------------- '--------------------------------------------------------------------------
#CHKSPD #CHKSPD
'ROUTINE TO CHECK THE SPEED OF THE AXES IS NOT GREATER THAN MAX ALLOWED 'ROUTINE TO CHECK THE SPEED OF THE AXES IS NOT GREATER THAN MAX ALLOWED
@@ -349,3 +364,5 @@ ENDIF
RE RE
' '
' '