5 POSITIONING CONTROL
5.17 Continuous Trajectory Control
357
5
Program example
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
■
Program 1
• Motion SFC program
The Motion SFC program for executing the servo program (No. 510) for specifying helical interpolation at the pass points of
3 axes continuous trajectory control is shown below.
CPSTART3
Axis
1
Axis
2
Axis
3
Speed
10000
ABS-3
Axis
1,
3000
Axis
2,
4000
Axis
3,
4000
ABH
Axis
1,
5000
Axis
2,
3500
Linear axis 3,
-4000
Number of pitches
6
Radius
1000
ABS-3
Axis
1,
5000
Axis
2,
3500
Axis
3,
3000
CPEND
Helical interpolation
SET M2042
[F10]
X0*M2415*M2435*M2455
[G10]
[K510]
Wait until X0, Axis 1 servo ready, Axis 2 servo ready and
Axis 3 servo ready turn ON
Turn ON all axes servo ON command.
!M2001*!M2002*!M2003
[G12]
END
Wait until Axis 1, Axis 2 and Axis 3 start accept flag turn OFF
Continuous trajectory control
End continuous trajectory control
Positioning address . . .
Positioning address . . .
3 axes linear interpolation control (P3)
3 axes helical interpolation control (P2)
Positioning address . . .
3 axes linear interpolation control (P1)
Positioning speed . . . . . 10000
Axis used . . . Axis 1, Axis 2, Axis 3
Axis 1 . . . . . . . . . . . 5000
Axis 2 . . . . . . . . . . . 3500
Axis 3 . . . . . . . . . . . 3000
Axis 1 . . . . . . . . . . . 5000
Axis 2 . . . . . . . . . . . 3500
Axis 3 . . . . . . . . . . -4000
Number of pitches . . . . 6
Radius . . . . . . . . . . 1000
Axis 1 . . . . . . . . . . . 3000
Axis 2 . . . . . . . . . . . 4000
Axis 3 . . . . . . . . . . . 4000
Control with the following speed.
For linear/circular interpolation :
:
Vector speed for number of
interpolation axes.
For helical interpolation
2 axes vector speed for circular
interpolation.
Summary of Contents for MELSEC iQ-R16MTCPU
Page 2: ......
Page 477: ...APPENDICES Appendix 1 Processing Times of the Motion CPU 475 A MEMO ...
Page 481: ......