NOVA electronics Inc. MCX514 -
121
-
121
-
3.3.9 Examples of Helical Interpolation
■
Example 1 Helical Interpolation under 1 rotation (X, Y, Z axes)
It performs CCW circular interpolation that has the center at the relative
position (X:0, Y:10000) from the start point (current point), and terminates it
at the finish point (X:-3490, Y:19397).
At this time, it moves Z axis from the current position to +3000 in
synchronization with circular interpolation. The speed of circular
interpolation is 1000PPS at constant speed.
WR6
←
01C7h Write
;
XY axes Circular arc + Z axis, 2-axis high accuracy constant vector speed mode
WR0
←
002Ah Write
;
Short axis pulse equalization
:
Enable
WR6
←
03E8h Write
;
1000 PPS
WR7
←
0000h Write
WR0
←
0104h Write
;
Set initial speed to main axis X
WR6
←
03E8h Write
;
1000 PPS
WR7
←
0000h Write
WR0
←
0105h Write
;
Set drive speed to main axis X
WR6
←
0000h Write
;
Helical rotation number
:
0
WR0
←
001Ah Write
WR6
←
0000h Write
;
Circle center X
:
0
WR7
←
0000h Write
WR0
←
0108h Write
WR6
←
2710h Write
;
Circle center Y
:
10000
WR7
←
0000h Write
WR0
←
0208h Write
WR6
←
F25Eh Write
;
Circle finish point X
:
-3490
WR7
←
FFFFh Write
WR0
←
0106h Write
WR0
←
006Ch Write
;
CCW helical calculation (calculation time
:
About 56ms)
RR0
→
Read
;
Waits for termination of calculation (D0 bit = 0 waiting)
WR6
←
0000h Write
;
Circle center X
:
0
WR7
←
0000h Write
WR0
←
0108h Write
WR6
←
2710h Write
;
Circle center Y
:
10000
WR7
←
0000h Write
WR0
←
0208h Write
WR6
←
F25Eh Write
;
Circle finish point X
:
-3490
WR7
←
FFFFh Write
WR0
←
0106h Write
WR6
←
4BC5h Write
;
Circle finish point Y
:
19397
WR7
←
0000h Write
WR0
←
0206h Write
WR6
←
0BB8h Write
;
Feed amount of Z
:
3000
WR7
←
0000h Write
WR0
←
0406h Write
WR0
←
006Ah Write
;
Starts CCW helical interpolation driving
RR0
→
Read
;
Waits for termination of interpolation (D0 bit = 0 waiting)
X
Y
Z
Start point (current position)
Finish point
Center point
(0,10000)
Finish point of arc (- 3490,19397)
Feed amount of Z axis
:
3000