dc695a75b2
#ININT routine Switches accept NC CONTACTS r1211 | ffr | 2006-11-01 12:43:46 +1100 (Wed, 01 Nov 2006) | 4 lines
116 lines
2.0 KiB
Plaintext
116 lines
2.0 KiB
Plaintext
#AUTO
|
|
NO TE: $Revision: 1.4 $
|
|
NO TE: $Date: 2006-11-01 01:43:46 $
|
|
NO TE: Author: Dan Bartlett
|
|
NO TE: Limit switch HOME routine added by Ferdi Franceschini
|
|
NO TE: Last revision by: $Author: ffr $
|
|
NO TE:
|
|
NO TE: A-SPARE
|
|
NO TE: B-SPARE
|
|
NO TE: C-SPARE
|
|
NO TE: D-SPARE
|
|
NO TE: E-SLIT 2 LEFT BLADE (ss2l)
|
|
NO TE: F-SLIT 2 RIGHT BLADE (ss2r)
|
|
NO TE: G-SLIT 2 TOP BLADE (ss2u)
|
|
NO TE: H-SLIT 2 BOTTOM BLADE (ss2d)
|
|
MT-2,-2,-2,-2,-2,-2,-2,-2;'CONFIGURES ALL AXES AS STEPPER
|
|
MO
|
|
II 8,,,0;' CONFIGURES THE 8TH INPUT TO ACTIVATE THE #ININT ROUTINE
|
|
IA 137,157,201,6;' CONFIGURES IP ADDRESS
|
|
CN 1;' CONFIGURES LIMIT SWITCHES TO ACCEPT NC CONTACTS
|
|
AC 25000,25000,25000,25000,10000,10000,10000,10000
|
|
DC 25000,25000,25000,25000,40000,40000,40000,40000
|
|
SP 25000,25000,25000,25000,30000,30000,30000,30000
|
|
HOMERUN=0
|
|
#LOOPER
|
|
JP#LOOPER
|
|
EN
|
|
#TCPERR
|
|
RE
|
|
#ININT
|
|
STA,B,C,D,F,G,H
|
|
AM
|
|
MO
|
|
RI
|
|
#LIMSWI
|
|
OLDDCA=_DCA
|
|
OLDDCB=_DCB
|
|
OLDDCC=_DCC
|
|
OLDDCD=_DCD
|
|
IF (_LFA = 0) | (_LRA = 0)
|
|
DCA=100000
|
|
STA
|
|
AMA
|
|
DCA=OLDDCA
|
|
ENDIF
|
|
IF (_LFB = 0) | (_LRB = 0)
|
|
DCB=100000
|
|
STB
|
|
AMB
|
|
DCB=OLDDCB
|
|
ENDIF
|
|
IF (_LFC = 0) | (_LRC = 0)
|
|
DCC=100000
|
|
STC
|
|
AMC
|
|
DCC=OLDDCC
|
|
ENDIF
|
|
IF (_LFD = 0) | (_LRD = 0)
|
|
DCD=100000
|
|
STD
|
|
AMD
|
|
DCD=OLDDCD
|
|
ENDIF
|
|
RE
|
|
#HOME
|
|
IF (HOMERUN = 1)
|
|
JP #ENDHOME
|
|
ENDIF
|
|
NOTE Move slit forward 10mm if it is against the reverse limit switch
|
|
IF ((_TSE & 4) = 0)
|
|
SHE
|
|
PRE=200000
|
|
BGE
|
|
ENDIF
|
|
NOTE Move slit forward 10mm if it is against the reverse limit switch
|
|
IF ((_TSF & 4) = 0)
|
|
SHF
|
|
PRF=200000
|
|
BGF
|
|
ENDIF
|
|
NOTE Move slit forward 10mm if it is against the reverse limit switch
|
|
IF ((_TSG & 4) = 0)
|
|
SHG
|
|
PRG=200000
|
|
BGG
|
|
ENDIF
|
|
NOTE Move slit forward 10mm if it is against the reverse limit switch
|
|
IF ((_TSH & 4) = 0)
|
|
SHH
|
|
PRH=200000
|
|
BGH
|
|
ENDIF
|
|
AMEFGH
|
|
NOTE Drive all slits into reverse limit switch
|
|
SHEFGH
|
|
JG ,,,,-25000,-25000,-25000,-25000
|
|
BGEFGH
|
|
AMEFGH
|
|
NOTE Move away from switches by 2mm and drive back slowly
|
|
PR ,,,,80000,80000,80000,80000
|
|
BGEFGH
|
|
AMEFGH
|
|
JG ,,,,-5000,-5000,-5000,-5000
|
|
BGEFGH
|
|
AMEFGH
|
|
NOTE Move forward from switch by 2mm and set zero
|
|
PR ,,,,40000,40000,40000,40000
|
|
BGEFGH
|
|
AMEFGH
|
|
DP ,,,,0,0,0,0
|
|
SP ,,,,30000,30000,30000,30000
|
|
HOMERUN=1
|
|
#ENDHOME
|
|
EN
|
|
|