Mitsubishi Electric MELSEC-Q Series - Page 320

6 - 133
6 POSITIONING CONTROL
(4) Servo program
Servo program No.510 for constant-speed control is shown below.
Axis 2
<K 510>
40000
ABS-2
Speed
Axis 3
CPSTART2
Axis 2,
Axis 3,
FOR-TIMES
10000
CPEND
NEXT
INC-2
Radius
INC
Axis 2,
Axis 3,
Axis 2,
Axis 3,
20000
0
K 4
30000
Positioning speed . . . 10000
20000
20000
20000
Start constant-speed control
Axis used . . . . . . . . . Axis 2, Axis 3
Positioning
method
Pass point setting
2 axes linear
interpolation
Number of repetitions 4
30000
Travel
value
Axis 3
Axis 2
Radius-specified
circular interpolation
0
20000
20000
Pass point setting
End constant-speed control
End repetition region
(5) Motion SFC program
Motion SFC program for which executes the servo program is shown below.
Positioning
method
2 axes linear
interpolation
30000[pulse]
Travel
value
Axis 3
Axis 2
0[pulse]
20000[pulse]
20000[pulse]
SET M2042
CPSTART2
Axis 2
Axis 3
Speed 10000pulse/s
ABS-2
Axis 2, 40000pulse
Axis 3, 20000pulse
FOR-TIMES
K 4
INC-2
Axis 2, 30000pulse
Axis 3, 0pulse
INC
Axis 2, 20000pulse
Axis 3, 20000pulse
Radius 20000pulse
NEXT
CPEND
PX000*M2435*M2455
END
Constant-speed control
!PX000
Constant-speed control
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
2 axes linear interpolation control (Absolute data method)
Axis used . . . . . . . . . . Axis 2, Axis 3
End address
Axis 2 . . . 40000[pulse]
Axis 3 . . . 20000[pulse]
Positioning speed . . .
10000[pulse/s]
Axis used . . . . . . . Axis 2, Axis 3
Number of repetitions 4
Pass point setting
End constant-speed control
End repetition region
Wait until PX000 turns off after constant-speed control
completion.
[F10]
[G10]
[K510]
[G20]
Radius-specified
circular interpolation
(Note): Example of the above Motion SFC program is started using the automatic start or sequence program.