6 - 147
6 POSITIONING CONTROL
(e) Motion SFC program
Motion SFC program for which executes the servo program is shown below.
SET M2042
CPSTART2
Axis 2
Axis 3
Speed 10000pulse/s
ABS-2
Axis 2, 30000pulse
Axis 3, 30000pulse
ABS
Axis 2, 50000pulse
Axis 3, 50000pulse
Radius
ABS-2
Axis 2, 90000pulse
Axis 3, 100000pulse
CPEND
PX000*M2435*M2455
END
!PX000
2 axes constant-speed control
2 axes constant-speed control
20000pulse
Turn on all axes servo ON command.
Wait until PX000, Axis 2 servo ready and Axis 3
servo ready turn on.
Start constant-speed control
Axis used . . . Axis 2, Axis 3
Positioning speed . . . . . . . . . .
10000[pulse/s]
2 axes linear interpolation control
Positioning address
Axis 2 . . . 30000[pulse]
Axis 3 . . . 30000[pulse]
Circular interpolation control
Radius . . . 20000[pulse]
2 axes linear interpolation control
End constant-speed control
Positioning address
Axis 2 . . . 50000[pulse]
Axis 3 . . . 50000[pulse]
Positioning address
Axis 2 . . . 90000[pulse]
Axis 3 . . 100000[pulse]
Wait until PX000 turn off after constant-speed control
completion.
[F10]
[G10]
[K505]
[G20]
(Note): Example of the above Motion SFC program is started using the automatic start or sequence program.
(2) Program for 4 axes constant-speed control is shown as the following conditions.
(a) System configuration
Constant-speed control for Axis 1, Axis 2, Axis 3, and Axis 4.
Start command (PX000)
Q172D
CPU
Q172D
LX
QX41 QY41PQ61P Q03UD
CPU
Motion CPU control module
AMP
M
Axis
1
AMP
M
Axis
2
AMP
M
Axis
4
AMP
M
Axis
3