M O T I O N C O N T R O L P R O G R A M M I N G
CONTOURING &
Motion Control Programming
113
The contouring mode allows the user to bypass the DMC
motion profiler and prescribe any arbitrary position trajec-
tory. Position increments (CD) over a time interval (DT)
are specified for each axis. The contouring mode is useful
when complex and computer-generated trajectories must
be followed. An automatic data recording feature allows
the DMC to "learn" a path and then follow it in the con-
tour mode.
Teach (record and playback). Example:
Instruction
Interpretation
#RECORD
Begin program to record
DM XPOS[501]
Dimension array
RA XPOS[ ]
Specify automatic data record
RD_TPX
Specify X position for capture
MOX
Turn motor off for teach
RC2
Begin recording every 4 msec
#A;JP#A,_RC=1
Continue until done recording
#COMPUTE
Compute program
DM DX[500]
Define new array
C=0
Initialize array counter
#L
Loop label
D=C+1
DELTA=XPOS[D]-XPOS[C] Compute difference
DX[C]=DELTA
Store difference in array
C=C+1
Increment counter
JP #L,C<500
Loop until done
#PLAYBK
Playback program
SHX
Turn motor on
CMX
Contour mode on X
DT2
Specify time interval
I=0
Initialize array counter
#B
Loop label
CD DX[I];WC
Specify contour distance
I=I+1
Increment counter
JP #B,I<500
Loop until done
EN
End program
The dual-loop encoder feature enables the DMC to compen-
sate for backlash. There are two compensation methods: the
continuous dual loop, which performs the correction along
the move; and the sampled dual loop, which performs the
correction at the final point.
In both cases, two encoders are used for each axis, one
mounted on the motor and the other, on the load. The
continuous dual loop, which is activated with the instruc-
tion DV1, closes the position loop with the load encoder
and derives the damping terms from the motor encoder.
This method provides backlash compensation along the
motion path.
The sampled dual loop performs the correction at the
end of the move, as illustrated by the example.
Sampled dual loop. Example:
Consider a linear slide driven by a leadscrew. The slide is
equipped with a linear encoder having a resolution of 1
micron, and a rotary encoder which, along with the lead
screw, provides 4 counts per micron. The control method is
to close the loop with the rotary encoder and to monitor the
linear encoder by the auxiliary encoder input. To perform a
move of 10,000 microns, for example, the motor is driven
40,000 counts. Once the motion is complete, the linear
encoder is observed with the DE command and the position
error of the load is monitored. The motor is then required to
perform a correction move.
Instruction
Interpretation
#DUAL
Label
DE 0
Set load position load to zero
PR 40000
Distance
BGX
Start first move
AMX
Wait for completion
WT 20
Wait for settling if necessary
PR 4*(10000-_DEX)
Correction move
BGX
Start correction
EN
End program
Contouring
Dual Loop
DUAL LOOP
