NOVA electronics Inc. MCX514 -
123
-
123
-
■
Example 3 Helical Interpolation with both Z and U axes (X, Y, Z axes)
It performs the radius 10000 of circular interpolation with one rotation in the CCW direction. During one rotation of circular
interpolation, move Z axis 3000 pulses and rotate U axis once (400 pulses). The speed of circular interpolation is 1000PPS at
constant speed.
WR6
←
00CFh Write
;
XY axes Circular arc + Z, U axes, 2-axis high accuracy constant vector speed mode
WR0
←
002Ah Write
;
Short axis pulse equalization
:
Disable
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
←
00007h Write
;
Helical rotation number
:
1
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
:
0
WR7
←
FFFFh Write
WR0
←
0106h Write
WR6
←
4BC5h Write
;
Circle finish point Y
:
0
WR7
←
0000h Write
WR0
←
0206h 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
:
0
WR7
←
FFFFh Write
WR0
←
0106h Write
WR6
←
4BC5h Write
;
Circle finish point Y
:
0
WR7
←
0000h Write
WR0
←
0206h Write
WR6
←
0BB8h Write
;
Feed amount of Z
:
3000
WR7
←
0000h Write
WR0
←
0406h Write
WR6
←
0190h Write
;
Feed amount of U
:
400
WR7
←
0000h Write
WR0
←
0806h Write
WR0
←
006Ah Write
;
Starts CCW helical interpolation driving
RR0
→
Read
;
Waits for termination of interpolation (D0 bit = 0 waiting)