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