NOVA electronics Inc. MCX514 -
138
-
138
-
3.7.5 Example of Continuous Interpolation
Fig. 3.7-2 shows an example of continuous interpolation started at the point (0, 0) from segment S1 to S21, which is configured
with 2-axis linear interpolation and circular interpolation. Circular interpolation is a quarter of a circle with the radius 500 and
1000, interpolation speed: 1000PPS at constant speed in 2-axis high accuracy constant vector speed mode. It supposes that the
segment S1 starts at the point (X0, Y6000). The following table shows the interpolation command of each segment and setting
data.
Fig. 3.7-2 Example of Continuous Interpolation
//--- Set interpolation axis / mode -----
WR6
←
00C3h Write
;
Set X, Y axes,
2-axis high accuracy constant
vector speed mode
WR0
←
002Ah Write
//---
Set interpolation drive speed -------
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
//--- Drive start holding -------
WR0
←
0177h Write
;
Drive start holding to main axis
//--- Set Segment1 2-axis linear -----
WR6
←
0BB8h Write
;
Finish point X
:
3000
WR7
←
0000h Write
WR0
←
0106h Write
;
Finish point setting command
WR6
←
0000h Write
;
Finish point Y
:
0
WR7
←
0000h Write
WR0
←
0206h Write
WR0
←
0061h Write
;
2-axis linear interpolation command
//--- Set Segment2 CCW circular -----
WR6
←
01F4h Write
;
Finish point X
:
500
WR7
←
0000h Write
WR0
←
0106h Write
WR6
←
01F4h Write
;
Finish point Y
:
500
WR7
←
0000h Write
WR0
←
0206h Write
WR6
←
0000h Write
;
Center point X
:
0
WR7
←
0000h Write
WR0
←
0108h Write
WR6
←
01F4h Write
;
Center point Y
:
500
WR7
←
0000h Write
WR0
←
0208h Write
WR0
←
0065h Write
;
CCW circular interpolation command
Segment
Number
Command
Finish
point X
Finish
point Y
Center
point X
Center
point Y
S1
2-axis linear
3000
0
S2
CCW circular
500
500
0
500
S3
CW circular
500
500
500
0
S4
2-axis linear
2000
0
S5
CW circular
500
-500
0
-500
S6
CCW circular
500
-500
500
0
S7
2-axis linear
1000
0
S8
CW circular
1000
-1000
0
-1000
S9
2-axis linear
0
-2000
S10
CW circular
-1000
-1000
-1000
0
S11
2-axis linear
-3000
0
S12
CCW circular
-500
-500
0
-500
S13
CW circular
-500
-500
-500
0
S14
2-axis linear
-4000
0
S15
CW circular
-500
500
0
500
S16
CCW circular
-500
500
-500
0
S17
2-axis linear
-1000
0
S18
CW circular
-1000
1000
0
1000
S19
2-axis linear
0
2000
S20
CW circular
1000
1000
1000
0
S21
2-axis linear
2000
0
S1
S2
S3
S4
S5
S6
S7
S8
S9
S10
S11
S12
S13
S14
S15
S16
S17
S18
S19
S20
S21
Y
X
9000
-3000
7000
(0,0)
Start point / Finish point