5 POSITIONING CONTROL
5.17 Continuous Trajectory Control
363
5
Program example
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
■
FIN signal wait function by the PLC program
The program for executing the FIN signal wait function for continuous trajectory control of Axis 1 and Axis 2 is explained as an
example.
• Positioning conditions
• Motion SFC program
The Motion SFC program for executing the servo program (No. 0) for continuous trajectory control is shown below.
• Continuous trajectory control conditions are shown below.
Item
Setting
Servo program No.
0
Positioning speed
10000
FIN acceleration/deceleration time
100 [ms]
Positioning method
2 axes linear interpolation control
Pass point
Axis 1
200000
300000
350000
400000
Axis 2
200000
250000
300000
400000
M-code
10
11
12
• Continuous trajectory control start command: X0 Leading edge (OFF
ON) (PLC CPU device)
END
Continuous trajectory control
SET M2042
[F10]
M2415*M2435
[G10]
CPSTART2
Axis
1
Axis
2
Speed 10000
FIN
100
ABS-2
Axis
1,
200000
Axis
1,
200000
M-code
10
ABS-2
Axis
1,
300000
Axis
2,
250000
M-code
11
ABS-2
Axis
1,
350000
Axis
2,
300000
M-code
12
ABS-2
Axis
1,
400000
Axis
2,
400000
CPEND
[K0]
Wait until Axis 1 servo ready and Axis 2 servo ready turn on.
Turn on all axes servo ON command.
Start continuous trajectory control
2 axes linear interpolation control
2 axes linear interpolation control
2 axes linear interpolation control
FIN acceleration/deceleration . . . . . 100 [ms]
Positioning speed . . . 10000 [pulse/s]
Axis used . . . . . . . . . Axis 1, Axis 2
Axis used . . . . . . . . . Axis 1, Axis 2
Address of stop position . . . . Axis 1 . . . 200000 [pulse]
Axis 2 . . . 200000 [pulse]
M-code output . . . . . 10
2 axes linear interpolation control
Axis used . . . . . . . . . Axis 1, Axis 2
Address of stop position . . . . Axis 1 . . . 300000 [pulse]
Axis 2 . . . 250000 [pulse]
M-code output . . . . . 11
M-code output . . . . . 12
Axis used . . . . . . . . . Axis 1, Axis 2
Address of stop position . . . . Axis 1 . . . 400000 [pulse]
Axis 2 . . . 400000 [pulse]
Axis used . . . . . . . . . Axis 1, Axis 2
Address of stop position. . . . Axis 1 . . . 350000 [pulse]
Axis 2 . . . 300000 [pulse]
End continuous trajectory control
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: ......