DMC-18x2
Chapter 6 Programming Motion • 99
YC4000;
'ENCODER RESOLUTION (COUNTS PER REVOLUTION)
SH
X
;
'ENABLE AXIS
WT
50;
'ALLOW SLIGHT SETTLE TIME
YS1;
'ENABLE SPM MODE
Example: Error Correction
The following code demonstrates what is necessary to set up SPM mode for the X axis, detect error,
stop the motor, correct the error, and return to the main code. The drive is a full step drive, with a 1.8
o
step motor and 4000 count/rev encoder.
#SETUP
OE
1;
'SET THE PROFILER TO STOP AXIS UPON ERROR
KS
16;
'SET STEP SMOOTHING
MT
-2,-2,-2,-2;
'MOTOR TYPE SET TO STEPPER
YA2;
'STEP RESOLUTION OF THE DRIVE
YB200;
'MOTOR RESOLUTION (FULL STEPS PER REVOLUTION)
YC4000;
'ENCODER RESOLUTION (COUNTS PER REVOLUTION)
SH
X
;
'ENABLE AXIS
WT
100;
'ALLOW SLIGHT SETTLE TIME
YS1;
'ENABLE SPM MODE
#MOTION
'PERFORM MOTION
SP
512;
'SET THE SPEED
PR1000;
'PREPARE MODE OF MOTION
BG
X
;
'BEGIN MOTION
#LOOP
;
JP
#LOOP
;
'KEEP THREAD ZERO ALIVE FOR #POSERR TO RUN IN
REM When error occurs, the axis will stop due to OE1. In
REM #POSERR, query the status YS and the error QS, correct,
REM and return to the main code.
#POSERR
;
'AUTOMATIC SUBROUTINE IS CALLED WHEN YS=2
WT
100;
'WAIT HELPS USER SEE THE CORRECTION
spsave=
_
SP
X
;
'SAVE CURRENT SPEED SETTING
JP
#RETURN
,_YSX<>2;
'RETURN TO THREAD ZERO IF INVALID ERROR
SP
64;
'SET SLOW SPEED SETTING FOR CORRECTION
MG
"ERROR= "
,_QSX
YRX=_QSX;
'ELSE, ERROR IS VALID, USE QS FOR CORRECTION
Artisan Technology Group - Quality Instrumentation ... Guaranteed | (888) 88-SOURCE | www.artisantg.com
Содержание DMC-18 2 Series
Страница 3: ...Artisan Technology Group Quality Instrumentation Guaranteed 888 88 SOURCE www artisantg com...
Страница 5: ...Artisan Technology Group Quality Instrumentation Guaranteed 888 88 SOURCE www artisantg com...
Страница 11: ...Artisan Technology Group Quality Instrumentation Guaranteed 888 88 SOURCE www artisantg com...