Galil DMC-3425 Manual De Usuario

Descargar
Página de 210
92 • Chapter 6  Programming Motion 
 
DMC-3425 
 
ω = 50 [1 - cos 2π T/120] 
 
 
 
Figure 6.6 - Velocity Profile with Sinusoidal Acceleration 
 
The DMC-3425 can compute trigonometric functions.  However, the argument must be expressed in 
degrees.  Using our example, the equation for X is written as: 
 
X = 50T - 955 sin 3T 
 
A complete program to generate the contour movement in this example is given below.  To generate an 
array, we compute the position value at intervals of 8 ms.  This is stored at the array POS.  Then, the 
difference between the positions is computed and is stored in the array DIF.  Finally the motors are run 
in the contour mode. 
Contour Mode Example 
Instruction Interpretation 
#POINTS 
Program defines A points 
DM POS[16] 
Allocate memory 
DM DIF[15] 
 
C=0 
Set initial conditions, C is index 
T=0 
T is time in ms 
#A  
V1=50*T  
V2=3*T 
Argument in degrees 
V3=-955*@SIN[V2]+V1 Compute 
position 
V4=@INT[V3] 
Integer value of V3 
POS[C]=V4 
Store in array POS 
T=T+8  
C=C+1  
JP #A,C<16 
 
#B 
Program to find position differences