Rmtcpu Programming Manual Positioning Control
Rmtcpu Programming Manual Positioning Control
-R16MTCPU
-R32MTCPU
-R64MTCPU
SAFETY PRECAUTIONS
(Read these precautions before using this product.)
Before using this product, please read this manual and the relevant manuals carefully and pay full attention to safety to handle
the product correctly.
The precautions given in this manual are concerned with this product only. Refer to MELSEC iQ-R Module Configuration
Manual for a description of the PLC system safety precautions.
In this manual, the safety precautions are classified into two levels: " WARNING" and " CAUTION".
Under some circumstances, failure to observe the precautions given under " CAUTION" may lead to serious
consequences.
Observe the precautions of both levels because they are important for personal and system safety.
Make sure that the end users read this manual and then keep the manual in a safe place for future reference.
[Design Precautions]
WARNING
● Configure safety circuits external to the programmable controller to ensure that the entire system
operates safely even when a fault occurs in the external power supply or the programmable controller.
Failure to do so may result in an accident due to an incorrect output or malfunction.
(1) Emergency stop circuits, protection circuits, and protective interlock circuits for conflicting
operations (such as forward/reverse rotations or upper/lower limit positioning) must be configured
external to the programmable controller.
(2) When the programmable controller detects an abnormal condition, it stops the operation and all
outputs are:
• Turned off if the overcurrent or overvoltage protection of the power supply module is activated.
• Held or turned off according to the parameter setting if the self-diagnostic function of the CPU
module detects an error such as a watchdog timer error.
(3) All outputs may be turned on if an error occurs in a part, such as an I/O control part, where the
CPU module cannot detect any error. To ensure safety operation in such a case, provide a safety
mechanism or a fail-safe circuit external to the programmable controller. For a fail-safe circuit
example, refer to "General Safety Requirements" in the MELSEC iQ-R Module Configuration
Manual.
(4) Outputs may remain on or off due to a failure of a component such as a relay and transistor in an
output circuit. Configure an external circuit for monitoring output signals that could cause a
serious accident.
● In an output circuit, when a load current exceeding the rated current or an overcurrent caused by a
load short-circuit flows for a long time, it may cause smoke and fire. To prevent this, configure an
external safety circuit, such as a fuse.
● Configure a circuit so that the programmable controller is turned on first and then the external power
supply. If the external power supply is turned on first, an accident may occur due to an incorrect output
or malfunction.
1
[Design Precautions]
WARNING
● For the operating status of each station after a communication failure, refer to manuals relevant to the
network. Incorrect output or malfunction due to a communication failure may result in an accident.
● When connecting an external device with a CPU module or intelligent function module to modify data
of a running programmable controller, configure an interlock circuit in the program to ensure that the
entire system will always operate safely. For other forms of control (such as program modification,
parameter change, forced output, or operating status change) of a running programmable controller,
read the relevant manuals carefully and ensure that the operation is safe before proceeding. Improper
operation may damage machines or cause accidents.
● Especially, when a remote programmable controller is controlled by an external device, immediate
action cannot be taken if a problem occurs in the programmable controller due to a communication
failure. To prevent this, configure an interlock circuit in the program, and determine corrective actions
to be taken between the external device and CPU module in case of a communication failure.
● Do not write any data to the "system area" and "write-protect area" of the buffer memory in the
module. Also, do not use any "use prohibited" signals as an output signal from the CPU module to
each module. Doing so may cause malfunction of the programmable controller system. For the
"system area", "write-protect area", and the "use prohibited" signals, refer to the user's manual for the
module used.
● If a communication cable is disconnected, the network may be unstable, resulting in a communication
failure of multiple stations. Configure an interlock circuit in the program to ensure that the entire
system will always operate safely even if communications fail. Failure to do so may result in an
accident due to an incorrect output or malfunction.
● To maintain the safety of the programmable controller system against unauthorized access from
external devices via the network, take appropriate measures. To maintain the safety against
unauthorized access via the Internet, take measures such as installing a firewall.
● Configure safety circuits external to the programmable controller to ensure that the entire system
operates safely even when a fault occurs in the external power supply or the programmable controller.
Failure to do so may result in an accident due to an incorrect output or malfunction.
● If safety standards (ex., robot safety rules, etc.,) apply to the system using the module, servo amplifier
and servo motor, make sure that the safety standards are satisfied.
● Construct a safety circuit externally of the module or servo amplifier if the abnormal operation of the
module or servo amplifier differs from the safety directive operation in the system.
● Do not remove the SSCNET cable while turning on the control circuit power supply of modules and
servo amplifier. Do not see directly the light generated from SSCNET connector of the module or
servo amplifier and the end of SSCNET cable. When the light gets into eyes, you may feel
something wrong with eyes. (The light source of SSCNET complies with class 1 defined in
JISC6802 or IEC60825-1.)
2
[Design Precautions]
CAUTION
● Do not install the control lines or communication cables together with the main circuit lines or power
cables. Keep a distance of 100mm or more between them. Failure to do so may result in malfunction
due to noise.
● During control of an inductive load such as a lamp, heater, or solenoid valve, a large current
(approximately ten times greater than normal) may flow when the output is turned from off to on.
Therefore, use a module that has a sufficient current rating.
● After the CPU module is powered on or is reset, the time taken to enter the RUN status varies
depending on the system configuration, parameter settings, and/or program size. Design circuits so
that the entire system will always operate safely, regardless of the time.
● Do not power off the programmable controller or reset the CPU module while the settings are being
written. Doing so will make the data in the flash ROM and SD memory card undefined. The values
need to be set in the buffer memory and written to the flash ROM and SD memory card again. Doing
so also may cause malfunction or failure of the module.
● When changing the operating status of the CPU module from external devices (such as the remote
RUN/STOP functions), select "Do Not Open by Program" for "Opening Method" of "Module
Parameter". If "Open by Program" is selected, an execution of the remote STOP function causes the
communication line to close. Consequently, the CPU module cannot reopen the line, and external
devices cannot execute the remote RUN function.
[Installation Precautions]
WARNING
● Shut off the external power supply (all phases) used in the system before mounting or removing the
module. Failure to do so may result in electric shock or cause the module to fail or malfunction.
3
[Installation Precautions]
CAUTION
● Use the programmable controller in an environment that meets the general specifications in the Safety
Guidelines included with the base unit. Failure to do so may result in electric shock, fire, malfunction,
or damage to or deterioration of the product.
● To mount a module, place the concave part(s) located at the bottom onto the guide(s) of the base unit,
and push in the module until the hook(s) located at the top snaps into place. Incorrect interconnection
may cause malfunction, failure, or drop of the module.
● To mount a module with no module fixing hook, place the concave part(s) located at the bottom onto
the guide(s) of the base unit, push in the module, and fix it with screw(s). Incorrect interconnection
may cause malfunction, failure, or drop of the module.
● When using the programmable controller in an environment of frequent vibrations, fix the module with
a screw.
● Tighten the screws within the specified torque range. Undertightening can cause drop of the screw,
short circuit, or malfunction. Overtightening can damage the screw and/or module, resulting in drop,
short circuit, or malfunction.
● When using an extension cable, connect it to the extension cable connector of the base unit securely.
Check the connection for looseness. Poor contact may cause malfunction.
● When using an SD memory card, fully insert it into the SD memory card slot. Check that it is inserted
completely. Poor contact may cause malfunction.
● Securely insert an extended SRAM cassette or a battery-less option cassette into the cassette
connector of the CPU module. After insertion, close the cassette cover and check that the cassette is
inserted completely. Poor contact may cause malfunction.
● Do not directly touch any conductive parts and electronic components of the module, SD memory
card, extended SRAM cassette, battery-less option cassette, or connector. Doing so can cause
malfunction or failure of the module.
[Wiring Precautions]
WARNING
● Shut off the external power supply (all phases) used in the system before installation and wiring.
Failure to do so may result in electric shock or cause the module to fail or malfunction.
● After installation and wiring, attach a blank cover module (RG60) to each empty slot and an included
extension connector protective cover to the unused extension cable connector before powering on the
system for operation. Failure to do so may result in electric shock.
4
[Wiring Precautions]
CAUTION
● Individually ground the FG and LG terminals of the programmable controller with a ground resistance
of 100 ohms or less. Failure to do so may result in electric shock or malfunction.
● Use applicable solderless terminals and tighten them within the specified torque range. If any spade
solderless terminal is used, it may be disconnected when the terminal screw comes loose, resulting in
failure.
● Check the rated voltage and signal layout before wiring to the module, and connect the cables
correctly. Connecting a power supply with a different voltage rating or incorrect wiring may cause fire
or failure.
● Connectors for external devices must be crimped or pressed with the tool specified by the
manufacturer, or must be correctly soldered. Incomplete connections may cause short circuit, fire, or
malfunction.
● Securely connect the connector to the module. Poor contact may cause malfunction.
● Do not install the control lines or communication cables together with the main circuit lines or power
cables. Keep a distance of 100mm or more between them. Failure to do so may result in malfunction
due to noise.
● Place the cables in a duct or clamp them. If not, dangling cable may swing or inadvertently be pulled,
resulting in damage to the module or cables or malfunction due to poor contact. Do not clamp the
extension cables with the jacket stripped. Doing so may change the characteristics of the cables,
resulting in malfunction.
● Check the interface type and correctly connect the cable. Incorrect wiring (connecting the cable to an
incorrect interface) may cause failure of the module and external device.
● Tighten the terminal screws or connector screws within the specified torque range. Undertightening
can cause drop of the screw, short circuit, fire, or malfunction. Overtightening can damage the screw
and/or module, resulting in drop, short circuit, fire, or malfunction.
● When disconnecting the cable from the module, do not pull the cable by the cable part. For the cable
with connector, hold the connector part of the cable. For the cable connected to the terminal block,
loosen the terminal screw. Pulling the cable connected to the module may result in malfunction or
damage to the module or cable.
● Prevent foreign matter such as dust or wire chips from entering the module. Such foreign matter can
cause a fire, failure, or malfunction.
● A protective film is attached to the top of the module to prevent foreign matter, such as wire chips,
from entering the module during wiring. Do not remove the film during wiring. Remove it for heat
dissipation before system operation.
● Programmable controllers must be installed in control panels. Connect the main power supply to the
power supply module in the control panel through a relay terminal block. Wiring and replacement of a
power supply module must be performed by qualified maintenance personnel with knowledge of
protection against electric shock. For wiring, refer to the MELSEC iQ-R Module Configuration Manual.
● For Ethernet cables to be used in the system, select the ones that meet the specifications in the user's
manual for the module used. If not, normal data transmission is not guaranteed.
5
[Startup and Maintenance Precautions]
WARNING
● Do not touch any terminal while power is on. Doing so will cause electric shock or malfunction.
● Correctly connect the battery connector. Do not charge, disassemble, heat, short-circuit, solder, or
throw the battery into the fire. Also, do not expose it to liquid or strong shock. Doing so will cause the
battery to produce heat, explode, ignite, or leak, resulting in injury and fire.
● Shut off the external power supply (all phases) used in the system before cleaning the module or
retightening the terminal screws, connector screws, or module fixing screws. Failure to do so may
result in electric shock.
6
[Startup and Maintenance Precautions]
CAUTION
● Do not drop or apply shock to the battery to be installed in the module. Doing so may damage the
battery, causing the battery fluid to leak inside the battery. If the battery is dropped or any shock is
applied to it, dispose of it without using.
● Startup and maintenance of a control panel must be performed by qualified maintenance personnel
with knowledge of protection against electric shock. Lock the control panel so that only qualified
maintenance personnel can operate it.
● Before handling the module, touch a conducting object such as a grounded metal to discharge the
static electricity from the human body. Failure to do so may cause the module to fail or malfunction.
● Before testing the operation, set a low speed value for the speed limit parameter so that the operation
can be stopped immediately upon occurrence of a hazardous condition.
● Confirm and adjust the program and each parameter before operation. Unpredictable movements
may occur depending on the machine.
● When using the absolute position system function, on starting up, and when the module or absolute
position motor has been replaced, always perform a home position return.
● Before starting the operation, confirm the brake function.
● Do not perform a megger test (insulation resistance measurement) during inspection.
● After maintenance and inspections are completed, confirm that the position detection of the absolute
position detection function is correct.
● Lock the control panel and prevent access to those who are not certified to handle or install electric
equipment.
[Operating Precautions]
CAUTION
● When changing data and operating status, and modifying program of the running programmable
controller from an external device such as a personal computer connected to an intelligent function
module, read relevant manuals carefully and ensure the safety before operation. Incorrect change or
modification may cause system malfunction, damage to the machines, or accidents.
● Do not power off the programmable controller or reset the CPU module while the setting values in the
buffer memory are being written to the flash ROM in the module. Doing so will make the data in the
flash ROM and SD memory card undefined. The values need to be set in the buffer memory and
written to the flash ROM and SD memory card again. Doing so also may cause malfunction or failure
of the module.
● Note that when the reference axis speed is specified for interpolation operation, the speed of the
partner axis (2nd, 3rd, or 4th axis) may exceed the speed limit value.
● Do not go near the machine during test operations or during operations such as teaching. Doing so
may lead to injuries.
7
[Disposal Precautions]
CAUTION
● When disposing of this product, treat it as industrial waste.
● When disposing of batteries, separate them from other wastes according to the local regulations. For
details on battery regulations in EU member states, refer to the MELSEC iQ-R Module Configuration
Manual.
[Transportation Precautions]
CAUTION
● When transporting lithium batteries, follow the transportation regulations. For details on the regulated
models, refer to the MELSEC iQ-R Module Configuration Manual.
● The halogens (such as fluorine, chlorine, bromine, and iodine), which are contained in a fumigant
used for disinfection and pest control of wood packaging materials, may cause failure of the product.
Prevent the entry of fumigant residues into the product or consider other methods (such as heat
treatment) instead of fumigation. The disinfection and pest control measures must be applied to
unprocessed raw wood.
8
CONDITIONS OF USE FOR THE PRODUCT
(1) Mitsubishi programmable controller ("the PRODUCT") shall be used in conditions;
i) where any problem, fault or failure occurring in the PRODUCT, if any, shall not lead to any major or serious accident;
and
ii) where the backup and fail-safe function are systematically or automatically provided outside of the PRODUCT for the
case of any problem, fault or failure occurring in the PRODUCT.
(2) The PRODUCT has been designed and manufactured for the purpose of being used in general industries.
MITSUBISHI SHALL HAVE NO RESPONSIBILITY OR LIABILITY (INCLUDING, BUT NOT LIMITED TO ANY AND ALL
RESPONSIBILITY OR LIABILITY BASED ON CONTRACT, WARRANTY, TORT, PRODUCT LIABILITY) FOR ANY
INJURY OR DEATH TO PERSONS OR LOSS OR DAMAGE TO PROPERTY CAUSED BY the PRODUCT THAT ARE
OPERATED OR USED IN APPLICATION NOT INTENDED OR EXCLUDED BY INSTRUCTIONS, PRECAUTIONS, OR
WARNING CONTAINED IN MITSUBISHI'S USER, INSTRUCTION AND/OR SAFETY MANUALS, TECHNICAL
BULLETINS AND GUIDELINES FOR the PRODUCT.
("Prohibited Application")
Prohibited Applications include, but not limited to, the use of the PRODUCT in;
• Nuclear Power Plants and any other power plants operated by Power companies, and/or any other cases in which the
public could be affected if any problem or fault occurs in the PRODUCT.
• Railway companies or Public service purposes, and/or any other cases in which establishment of a special quality
assurance system is required by the Purchaser or End User.
• Aircraft or Aerospace, Medical applications, Train equipment, transport equipment such as Elevator and Escalator,
Incineration and Fuel devices, Vehicles, Manned transportation, Equipment for Recreation and Amusement, and
Safety devices, handling of Nuclear or Hazardous Materials or Chemicals, Mining and Drilling, and/or other
applications where there is a significant risk of injury to the public or property.
Notwithstanding the above restrictions, Mitsubishi may in its sole discretion, authorize use of the PRODUCT in one or
more of the Prohibited Applications, provided that the usage of the PRODUCT is limited only for the specific
applications agreed to by Mitsubishi and provided further that no special quality assurance or fail-safe, redundant or
other safety features which exceed the general specifications of the PRODUCTs are required. For details, please
contact the Mitsubishi representative in your region.
INTRODUCTION
Thank you for purchasing the Mitsubishi Electric MELSEC iQ-R series programmable controllers.
This manual describes the dedicated signals, parameters, servo programs, and functions required for performing positioning
control of the relevant products listed below.
Before using this product, please read this manual and the relevant manuals carefully and develop familiarity with the
functions and performance of the MELSEC iQ-R series programmable controller to handle the product correctly.
When applying the program examples provided in this manual to an actual system, ensure the applicability and confirm that it
will not cause system control problems.
Please make sure that the end users read this manual.
Relevant products
R16MTCPU, R32MTCPU, R64MTCPU
9
CONTENTS
SAFETY PRECAUTIONS . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .1
CONDITIONS OF USE FOR THE PRODUCT . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .9
INTRODUCTION . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .9
RELEVANT MANUALS . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .15
TERMS . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .16
MANUAL PAGE ORGANIZATION. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .17
10
G-code control common status . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 136
G-code control common monitor device . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 137
G-code control line command signal . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 138
G-code control line control device . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 139
G-code control line status . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 140
G-code control line monitor device . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 142
G-code control line monitor device (expansion) . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 146
G-code control axis status . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 151
G-code control axis monitor device . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 153
CONTENTS
Common devices. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 155
2.3 Motion Registers (#) . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 161
Monitor devices 2 of each axis . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 162
2.4 Special Relays (SM). . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 164
2.5 Special Registers (SD) . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 164
11
Speed command device . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 203
Command speed acceleration time, Command speed deceleration time . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 203
Torque command device . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 204
Command torque time constant (positive direction), Command torque time constant (negative direction) . . . 205
Speed initial value selection at control mode switching. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 205
Torque initial value selection at control mode switching . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 205
Invalid selection during zero speed at control mode switching . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 206
3.9 Pressure control data . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 207
Pressure control selection . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 208
Feed/dwell startup device . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 208
Dwell forced switching device . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 208
Pressure release startup device . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 208
Pressure command reference . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 208
Speed limit reference. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 208
Abnormal pressure switching mode . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 208
Abnormal pressure setting. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 208
Abnormal pressure setting time. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 209
Mode reset selection after passing dwell time. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 209
Pressure profile start device . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 209
Pressure control status device . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 209
Feed execution point device . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 209
Dwell execution point device . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 209
Pressure release execution point device. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 209
3.10 Override Data . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 210
Override ratio setting device . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 210
3.11 Vibration Suppression Command Filter Data . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 211
Vibration suppression command filter 1 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 212
Vibration suppression command filter 2 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 213
Feed current value monitor device after filter . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 213
Command output complete signal after filter . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 213
3.12 Servo Parameters . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 214
3.13 Parameter Block . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 215
Interpolation control unit . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 217
Speed limit value, acceleration time, deceleration time and rapid stop deceleration time . . . . . . . . . . . . . . . . 218
S-curve ratio . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 220
Advanced S-curve acceleration/deceleration . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 222
Torque limit value. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 234
Deceleration processing on STOP input . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 234
Allowable error range for circular interpolation . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 235
Bias speed at start. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 235
12
CHAPTER 5 POSITIONING CONTROL 251
5.1 Basics of Positioning Control . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 251
Positioning speed . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 251
Positioning speed at the interpolation control . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 252
Control units for 1 axis positioning control. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 256
Control units for interpolation control. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 256
Control in the control unit "degree" . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 258
Stop processing and restarting after stop . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 260
Acceleration/deceleration processing . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 265
CONTENTS
5.2 1 Axis Linear Positioning Control . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 268
5.3 2 Axes Linear Interpolation Control. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 271
5.4 3 Axes Linear Interpolation Control. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 274
5.5 4 Axes Linear Interpolation Control. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 278
5.6 Auxiliary Point-Specified Circular Interpolation Control . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 281
5.7 Radius-Specified Circular Interpolation Control . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 285
5.8 Central Point-Specified Circular Interpolation Control . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 289
5.9 Helical Interpolation Control . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 293
Circular interpolation specified method by helical interpolation. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 294
5.10 Axis Fixed-Pitch Feed Control . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 307
5.11 Fixed-Pitch Feed Control Using 2 Axes Linear Interpolation . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 310
5.12 Fixed-Pitch Feed Control Using 3 Axes Linear Interpolation . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 313
5.13 Speed Control (I) . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 316
5.14 Speed Control (II). . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 319
5.15 Speed/Position Switching Control. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 322
Speed/position switching control start . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 322
Re-starting after stop during control . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 328
5.16 Speed Control with Fixed Position Stop . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 332
5.17 Continuous Trajectory Control. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 336
Specification of pass points by repetition instructions . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 339
Speed-switching by instruction execution . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 343
1 axis continuous trajectory control . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 346
2 to 4 axes continuous trajectory control . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 349
Continuous trajectory control for helical interpolation . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 353
Pass point skip function. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 358
FIN signal wait function . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 360
5.18 Position Follow-Up Control . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 367
5.19 High-Speed Oscillation . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 371
5.20 Simultaneous Start . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 373
5.21 Home Position Return. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 375
Servo program for home position return . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 376
Home position return by the proximity dog method 1 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 378
Home position return by the proximity dog method 2 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 380
Home position return by the count method 1. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 382
Home position return by the count method 2. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 383
Home position return by the count method 3. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 384
Home position return by the data set method 1. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 386
Home position return by the data set method 2. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 387
Home position return by the data set method 3. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 388
Home position return by the dog cradle method . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 389
Home position return by the stopper method 1 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 392
13
Home position return by the stopper method 2 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 393
Home position return by the limit switch combined method . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 394
Home position return by the scale home position signal detection method. . . . . . . . . . . . . . . . . . . . . . . . . . . . 396
Home position return by the dogless home position signal reference method . . . . . . . . . . . . . . . . . . . . . . . . . 398
Home position return by the driver home position return method . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 403
Home position return retry function . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 404
Home position shift function . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 407
Home position set condition selection . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 410
5.22 Current Value Change . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 411
APPENDICES 471
Appendix 1 Processing Times of the Motion CPU . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 471
REVISIONS. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .474
WARRANTY . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .475
TRADEMARKS . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .476
14
RELEVANT MANUALS
Manual Name [Manual Number] Description Available form
MELSEC iQ-R Motion Controller Programming Manual This manual explains the servo parameters, positioning Print book
(Positioning Control) instructions, device lists, etc.
e-Manual
[IB-0300241] (This manual)
PDF
MELSEC iQ-R Motion Controller User's Manual This manual explains specifications of the Motion CPU modules, Print book
[IB-0300235] SSCNET cables, synchronous encoder, troubleshooting, etc.
e-Manual
PDF
MELSEC iQ-R Motion Controller Programming Manual This manual explains the Multiple CPU system configuration, Print book
(Common) performance specifications, common parameters, auxiliary/applied
e-Manual
[IB-0300237] functions, error lists, etc.
PDF
MELSEC iQ-R Motion Controller Programming Manual This manual explains the functions, programming, debugging for Print book
(Program Design) Motion SFC, etc.
e-Manual
[IB-0300239]
PDF
MELSEC iQ-R Motion Controller Programming Manual This manual explains the dedicated instructions to use Print book
(Advanced Synchronous Control) synchronous control by synchronous control parameters, device
e-Manual
[IB-0300243] lists, etc.
PDF
MELSEC iQ-R Motion Controller Programming Manual This manual explains the dedicated instructions to use machine Print book
(Machine Control) control by machine control parameters, machine positioning data,
e-Manual
[IB-0300309] device lists, etc.
PDF
MELSEC iQ-R Motion Controller Programming Manual This manual explains the dedicated instructions to use G-code Print book
(G-Code Control) control by G-code control parameters and G-code programs. e-Manual
[IB-0300371]
PDF
e-Manual refers to the Mitsubishi FA electronic book manuals that can be browsed using a dedicated tool.
e-Manual has the following features:
• Required information can be cross-searched in multiple manuals.
• Other manuals can be accessed from the links in the manual.
• The hardware specifications of each part can be found from the product figures.
• Pages that users often browse can be bookmarked.
15
TERMS
Unless otherwise specified, this manual uses the following terms.
Term Description
R64MTCPU/R32MTCPU/R16MTCPU or Abbreviation for MELSEC iQ-R series Motion controller
Motion CPU (module)
MR-J4(W)-B Servo amplifier model MR-J4-B/MR-J4W-B
MR-J3(W)-B Servo amplifier model MR-J3-B/MR-J3W-B
AMP or Servo amplifier General name for "Servo amplifier model MR-J4-B/MR-J4W-B/MR-J3-B/MR-J3W-B"
RnCPU, PLC CPU or PLC CPU module Abbreviation for MELSEC iQ-R series CPU module
Multiple CPU system or Motion system Abbreviation for "Multiple PLC system of the R series"
CPUn Abbreviation for "CPU No.n (n = 1 to 4) of the CPU module for the Multiple CPU system"
Operating system software General name for "SW10DNC-RMTFW"
Engineering software package General name for MT Developer2/GX Works3
MELSOFT MT Works2 General product name for the Motion controller engineering software "SW1DND-MTW2"
MT Developer2 Abbreviation for the programming software included in the "MELSOFT MT Works2" Motion controller
engineering software
GX Works3 General product name for the MELSEC PLC software package "SW1DND-GXW3"
Serial absolute synchronous encoder or Abbreviation for "Serial absolute synchronous encoder (Q171ENC-W8)"
Q171ENC-W8
SSCNET/H*1 High speed synchronous network between Motion controller and servo amplifier
SSCNET*1
SSCNET(/H) General name for SSCNET/H, SSCNET
Absolute position system General name for "system using the servo motor and servo amplifier for absolute position"
Intelligent function module General name for module that has a function other than input or output such as A/D converter module and D/A
converter module.
SSCNET/H head module*1 Abbreviation for "MELSEC-L series SSCNET/H head module (LJ72MS15)"
Optical hub unit or MR-MV200 Abbreviation for SSCNET/H Compatible Optical Hub Unit (MR-MV200)
Sensing module General name for SSCNET/H compatible sensing module MR-MT2000 series
Sensing SSCNET/H head module*1 or Abbreviation for SSCNET/H head module (MR-MT2010)
MR-MT2010
Sensing extension module General name for I/O module (MR-MT2100), pulse I/O module (MR-MT2200), analog I/O module (MR-
MT2300), encoder I/F module (MR-MT2400)
Sensing I/O module or MR-MT2100 Abbreviation for I/O module (MR-MT2100)
Sensing pulse I/O module or MR-MT2200 Abbreviation for pulse I/O module (MR-MT2200)
Sensing analog I/O module or MR-MT2300 Abbreviation for analog I/O module (MR-MT2300)
Sensing encoder I/F module or MR-MT2400 Abbreviation for encoder I/F module (MR-MT2400)
16
MANUAL PAGE ORGANIZATION
Representation of numerical values used in this manual
■ Axis No. representation
In the positioning dedicated signals, "n" in "M3200+20n", etc. indicates a value corresponding to axis No. as shown in the
following table.
Axis No. n Axis No. n Axis No. n Axis No. n Axis No. n Axis No. n Axis No. n Axis No. n
1 0 9 8 17 16 25 24 33 32 41 40 49 48 57 56
2 1 10 9 18 17 26 25 34 33 42 41 50 49 58 57
3 2 11 10 19 18 27 26 35 34 43 42 51 50 59 58
4 3 12 11 20 19 28 27 36 35 44 43 52 51 60 59
5 4 13 12 21 20 29 28 37 36 45 44 53 52 61 60
6 5 14 13 22 21 30 29 38 37 46 45 54 53 62 61
7 6 15 14 23 22 31 30 39 38 47 46 55 54 63 62
8 7 16 15 24 23 32 31 40 39 48 47 56 55 64 63
• The range of axis No.1 to 16 (n=0 to 15) is valid in the R16MTCPU. The range of axis No.1 to 32 (n=0 to 31) is valid in the
R32MTCPU.
• Calculate as follows for the device No. corresponding to each axis.
Ex.
For axis No. 32 in Q series Motion compatible device assignment
M3200+20n ([Rq.1140] Stop command)=M3200+2031=M3820
M3215+20n ([Rq.1155] Servo OFF command)=M3215+2031=M3835
In the positioning dedicated signals, "n" in "M10440+10n", etc. of the "Synchronous encoder axis status", "Synchronous
encoder axis command signal", "Synchronous encoder axis monitor device" and "Synchronous encoder axis control device"
indicates a value corresponding to synchronous encoder axis No. as shown in the following table.
Synchronous encoder axis No. n Synchronous encoder axis No. n Synchronous encoder axis No. n
1 0 5 4 9 8
2 1 6 5 10 9
3 2 7 6 11 10
4 3 8 7 12 11
• Calculate as follows for the device No. corresponding to each synchronous encoder.
Ex.
For synchronous encoder axis No.12 in Q series Motion compatible device assignment
M10440+10n ([St.320] Synchronous encoder axis setting valid flag)=M10440+1011=M10550
D13240+20n ([Md.320] Synchronous encoder axis current value)=D13240+2011=D13460
17
■ Machine No. representation
In the positioning dedicated signals, "m" in "M43904+32m", etc. indicates a value corresponding to machine No. as shown in
the following table.
Machine No. m Machine No. m
1 0 5 4
2 1 6 5
3 2 7 6
4 3 8 7
Ex.
For machine No.8 in MELSEC iQ-R Motion device assignment
M43904+32m ([St.2120] Machine error detection) M43904+327=M44128
D53168+128m ([Md.2020] Machine type)=M53168+287=D54064
Ex.
For line No.2 in MELSEC iQ-R Motion device assignment
D54440.0+4s ([St.3208] During G-code control)=D54440.0+41=D54444.0
D54496+128s ([Md.3016] Number of axes on line)=D54496+1281=D54624
Ex.
For line No.2, axis No. 8 in MELSEC iQ-R Motion device assignment
D54448.0+2sn ([St.3076] Smoothing zero)=D54448.0+215=D54478.0
D54754+32sn ([Md.3146] Rotating axis setting status)=D54754+3215=D55234
18
Representation of device No. used in this manual
The "R" and "Q" beside the device No. of positioning dedicated signals such as "[Rq.1140] Stop command (R: M34480+32n/
Q: M3200+20n)" indicate the device No. for the device assignment methods shown below. When "R" and "Q" are not beside
the device No., the device No. is the same for both device assignment methods.
Symbol Device assignment method
R MELSEC iQ-R Motion device assignment
Q Q series Motion compatible device assignment
19
1 POSITIONING CONTROL BY THE MOTION CPU
There are the following six functions as controls toward the servo amplifier/servo motor.
• Servo operation by the servo program positioning instructions.
• Servo operation by the Motion dedicated PLC instruction (Direct positioning start request: M(P).SVSTD/D(P).SVSTD)
• JOG operation by each axis command signal of Motion CPU.
• Manual pulse generator operation by the positioning dedicated device of Motion CPU.
• Speed change, torque limit value change, and target position change during positioning control by the Motion dedicated
PLC instruction and Motion dedicated function of operation control step "F".
• Current value change by the Motion dedicated PLC instruction or servo instructions.
Servo program
The servo program is used for the positioning control. It comprises a program No., servo instructions and positioning data.
Refer to the servo programs for positioning control for details of servo program. (Page 237 SERVO PROGRAMS FOR
POSITIONING CONTROL)
Sequence program
The Motion CPU control can be performed using the Motion dedicated PLC instruction in the sequence program of PLC CPU.
Refer to the following for details of the Motion dedicated PLC instruction.
MELSEC iQ-R Motion controller Programming Manual (Program Design)
JOG operation
JOG operation can be performed by controlling the JOG dedicated device of the Motion CPU.
Refer to the JOG operation for details of JOG operation. (Page 413 JOG Operation)
Internal signals
The following five devices of the Motion CPU are used as the internal signals of the Motion CPU.
MELSEC iQ-R Motion device assignment and Q series Motion compatible device assignment are available. The ranges used
for devices differs depending on the device assignment method used.
Device name Device range
MELSEC iQ-R Motion device assignment Q series Motion compatible device assignment
Internal relay (M) M16000 to M49151 (33152 points) M2000 to M3839 (1840 points)
M8192 to M12287 (4096 points)
Special relay (SM) SM0 to SM4095 (4096 points)
Data register (D) D32000 to D57343 (25344 points) D0 to D799 (800 points)
D10240 to D19823 (9584 points)
Motion register (#) #8000 to #8639 (640 points)
Special register (SD) SD0 to SD4095 (4096 points)
External signals
The external input signals to the Motion CPU are shown below.
External input signals Description
Upper/lower limit switch input The upper/lower limit of the positioning range is controlled.
Stop signal This signal makes the starting axis stop.
Proximity dog signal ON/OFF signal from the proximity dog.
Speed/position switching signal Signal for switching from speed to position.
Manual pulse generator input Signal from the manual pulse generator.
Forced stop signal Signal for forced stop of the servo amplifier.
Servo
amplifier
Operation cycle 2
Main cycle
■ Operation cycle
The processing required for every operation cycle is executed. This processing includes data communication with the servo
amplifier, execution of fixed-cycle tasks of the Motion SFC, and generation of servo command values for every operation
cycle.
The processing time changes according to the number of servo axes, the servo program being executed, etc.
When the operation cycle exceeds the setting in [Motion CPU Common Parameter] [Basic Setting] "Operation Cycle",
"[St.1046] Operation cycle over flag (R: M30054/Q: M2054)" turns ON.
■ Main cycle
Using the free time after the processing in operation cycle, the automatic refresh and normal tasks of the Motion SFC, as well
as communication with MT Developer2 are executed.
The processing time in the main cycle changes according to the free time after the processing in operation cycle, the number
of automatic refresh transmissions, and the number of executed normal tasks of the Motion SFC, etc.
When the main cycle becomes longer, it can be shortened by increasing the operation cycle setting time in [Motion CPU
Common Parameter] [Basic Setting] "Operation Cycle " which increases free time.
Refer to the following for the monitoring of processing times of operation cycle and main cycle.
MELSEC iQ-R Motion controller Programming Manual (Common)
Cautions
For positioning dedicated signals labelled as "operation cycle" in refresh cycles and fetch cycles, when axes are operating at
the low speed operation cycle with the mixed operation cycle function, the refresh cycle and fetch cycle for these axes is the
"low speed operation cycle".
• The following range is valid. R16MTCPU: Axis No.1 to 16, R32MTCPU: Axis No.1 to 32.
• The following device area can be used as a user device. R16MTCPU: 17 axes or more, R32MTCPU: 33
axes or more. However, when the project of R16MTCPU is replaced with R32MTCPU/R64MTCPU, or the
project of R32MTCPU is replaced with R64MTCPU, this area cannot be used as a user device.
• The positioning complete signal turns ON by the execution of servo program even if the travel value of the axis specified
with the servo program is set to "0".
CAUTION
• The deviation counter value is not considered, so that The "[St.1061] Positioning complete (R: M32401+32n/Q:M2401+20n)" turns on with the completion of
the command output to positioning address. Use the "[St.1061] Positioning complete (R: M32401+32n/Q:M2401+20n)" together with the "[St.1062] In-
position (R: M32402+32n/Q: M2402+20n)" to confirm the positioning completion of servo axis in the final instruction under program.
ON
[St.1062] In-position
(R: M32402+32n/Q: M2402+20n) OFF
• While the control circuit power supply of the servo amplifier is ON, the status of the in-position signal of the servo amplifier
("[Md.108] Servo status1 (R: D32032+48n/Q: #8010+20n)": b12) is reflected. However, the state of the signal is always
OFF for the following.
• Servo error
• From positioning start until deceleration start*1
• Current value change
• Home position return*2
• Speed-torque control
• Pressure control
*1 Except during position follow-up control, high-speed oscillation control, manual pulse generator operation, synchronous control,
machine program operation, and G-code control. (The in-position signal is constantly updated during such controls.)
*2 The in-position signal may be updated after the proximity dog turns ON during home position return.
ON
[St.1063] Command in-position
(R: M32403+32n/Q: M2403+20n) OFF
ON
[St.1064] Speed controlling
(R: M32404+32n/Q: M2404+20n) OFF
Speed Position
control control
CHANGE Start
Speed/position
switching control start
ON
[St.1065] Speed/position switching latch
(R: M32405+32n/Q: M2405+20n) OFF
ON
CHANGE signal from external source OFF
• This signal turns off by the completion of the home position return.
CAUTION
• When using the absolute position system function, on starting up, and when the Motion controller or absolute position motor has been replaced, always
perform a home position return. In the case of the absolute position system, use the sequence program to check the home position return request before
performing the positioning control. Failure to observe this could lead to an accident such as a collision.
When the part of multiple servo amplifiers connected to the SSCNET(/H) becomes a servo error, only an
applicable axis becomes the servo OFF state.
M-code M1 M2 M3
ON
[St.1079] M-code outputting
(R: M32419+32n/Q: M2419+20n) OFF
ON
[Rq.1159] FIN signal
(R: M34499+32n/Q: M3219+20n) OFF
• The "[Rq.1159] FIN signal (R: M34499+32n/Q: M3219+20n)" and "[St.1079] M-code outputting (R:
M32419+32n/Q: M2419+20n)" are both for the FIN signal wait function.
• The "[Rq.1159] FIN signal (R: M34499+32n/Q: M3219+20n)" and "[St.1079] M-code outputting (R:
M32419+32n/Q: M2419+20n)" are effective only when FIN acceleration/deceleration is designated in the
servo program. Otherwise, the FIN signal wait function is disabled, and "[St.1079] M-code outputting (R:
M32419+32n/Q: M2419+20n)" does not turn on.
• The following range is valid. R16MTCPU: Axis No.1 to 16, R32MTCPU: Axis No.1 to 32.
• The following device area can be used as a user device. R16MTCPU: 17 axes or more, R32MTCPU: 33
axes or more. However, when the project of R16MTCPU is replaced with R32MTCPU/R64MTCPU, or the
project of R32MTCPU is replaced with R64MTCPU, this area cannot be used as a user device.
• The details of stop processing when the stop command turns on are shown below. (Refer to Speed control () (Page
316 Speed Control (I)), or speed control () (Page 319 Speed Control (II)) for details of speed control.)
Control details during Processing at the turning stop command on
execution During control During deceleration stop processing
Positioning control The axis decelerates to a stop in the deceleration time set in The deceleration stop processing is continued.
the parameter block or servo program.
Speed control ()
Speed control ()
JOG operation
Speed control with fixed
position stop
Manual pulse generator An immediate stop is executed without deceleration
operation processing.
Home position return • The axis decelerates to a stop in the deceleration time set in the parameter block.
• A stop error during home position return occurs and the minor error (error code:1908H) is stored in the "[Md.1004] Error
code (R: D32007+48n/Q: D7+20n)" for each axis.
Speed-torque control The speed commanded to servo amplifier is "0". The mode is
switched to position control mode when "Zero speed" turns
Pressure control
ON, and the operation stops.
Machine program operation This decelerates to a stop in the deceleration time set in the The deceleration stop processing is continued.
Machine JOG operation parameter block or machine positioning data.
• The stop command in a dwell time is invalid. (After a dwell time, the "[St.1040] Start accept flag (R: M30080+n/Q:
M2001+n)" turns OFF, and the "[St.1061] Positioning complete (R: M32401+32n/Q: M2401+20n)" turns ON.)
If it is made to stop by turning on the "[Rq.1140] Stop command (R: M34480+32n/Q: M3200+20n)" during a
home position return, execute the home position return again.
If the stop command is turned on after the proximity dog ON in the proximity dog method, execute the home
position return after move to before the proximity dog ON by the JOG operation or positioning.
• The details of stop processing when the rapid stop command turns on are shown below.
Control details during Processing at the turning rapid stop command on
execution During control During deceleration stop processing
Position control The axis decelerates to a rapid stop deceleration time set in Deceleration processing is stopped and rapid stop processing
the parameter block or servo program. is executed.
Speed control ()
Speed control ()
JOG operation
Speed control with fixed
position stop
Manual pulse generator An immediate stop is executed without deceleration
operation processing.
Home position return • The axis decelerates to a stop in the rapid stop deceleration time set in the parameter block.
• A "stop error during home position return" occurs and the minor error (error code:192DH) is stored in the "[Md.1004] Error
code (R: D32007+48n/Q: D7+20n" for each axis.
Speed-torque control The speed commanded to servo amplifier is "0". The mode is
switched to position control mode when "Zero speed" turns
Pressure control
ON, and the operation stops.
Machine program operation This decelerates to a stop in the deceleration time set in the Deceleration processing is stopped and rapid stop processing
Machine JOG operation parameter block or machine positioning data. is executed.
• The rapid stop command in a dwell time is invalid. (After a dwell time, the "[St.1040] Start accept flag (R: M30080+n/Q:
M2001+n)" turns OFF, and the "[St.1061] Positioning complete (R: M32401+32n/Q: M2401+20n)" turns ON.)
If it is made to stop rapidly by turning on the "[Rq.1141] Rapid stop command (R: M34481+32n/Q:
M3201+20n)" during a home position return, execute the home position return again.
If the rapid stop command turned on after the proximity dog ON in the proximity dog method, execute the
home position return after move to before the proximity dog ON by the JOG operation or positioning.
Take an interlock so that the "[Rq.1142] Forward rotation JOG start command (R: M34482+32n/Q:
M3202+20n)" and "[Rq.1143] Reverse rotation JOG start command (R: M34483+32n/Q: M3203+20n)" may
not turn on simultaneously.
Take an interlock so that the "[Rq.1142] Forward rotation JOG start command (R: M34482+32n/Q:
M3202+20n)" and "[Rq.1143] Reverse rotation JOG start command (R: M34483+32n/Q: M3203+20n)" may
not turn on simultaneously.
t
[St.1060] Positioning start ON
complete OFF
(R: M32400+32n/Q: M2400+20n) ON
[St.1061] Positioning complete
OFF
(R: M32401+32n/Q: M2401+20n)
[Rq.1144] Complete signal OFF ON
command OFF
(R: M34484+32n/Q: M3204+20n)
Be sure to turn OFF the "[Rq.1144] Complete signal OFF (R: M34484+32n/Q: M3204+20n)", after confirming
the "[St.1060] Positioning start complete (R: M32400+32n/Q: M2400+20n)" and "[St.1061] Positioning
complete (R: M32401+32n/Q: M2401+20n)" are OFF.
Control does not switch from speed Control switches from speed
control to position control because CHANGE CHANGE control to position control because
"[Rq.1145] Speed/position switching "[Rq.1145] Speed/position switching
enable command enable command
(R: M34485+32n/Q: M3205+20n) (R: M34485+32n/Q: M3205+20n)
turns off turns on
t
[Rq.1145] Speed/position switching ON
enable command OFF
(R: M34485+32n/Q: M3205+20n)
ON
CHANGE signal from external source OFF
Refer to the following for details on the warning code and error code storage registers.
MELSEC iQ-R Motion controller Programming Manual (Common)
Refer to the following for details on the servo error code storage registers.
MELSEC iQ-R Motion controller Programming Manual (Common)
[Rq.1149] External stop input disable at start command (R: M34489+32n/Q: M3209+20n)
This signal is used to set the external stop signal input valid or invalid.
Setting value Description
ON External stop input is set as invalid, and even axes which stop input is turning on can be started.
OFF External stop input is set as valid, and axes which stop input is turning on cannot be started.
This is ignored during G-code control. When "[Rq.1149] External stop input disable at start command (R: M34489+32n/Q:
M3209+20n)" is turned ON, axes with STOP input turned ON cannot be started.
When it stops an axis with the external stop input after it starts by turning on the "[Rq.1149] External stop input
disable at start command (R: M34489+32n/Q: M3209+20n)", switch the external stop input from OFF ON (if
the external stop input is turning on at the starting, switch it from ON OFF ON).
When it starts by turning on the "[Rq.1152] Feed current value update request command (R: M34492+32n/Q:
M3212+20n)", keep "[Rq.1152] Feed current value update request command (R: M34492+32n/Q:
M3212+20n)" on until completion of the positioning control. If "[Rq.1152] Feed current value update request
command (R: M34492+32n/Q: M3212+20n)" is turned off on the way, the feed current value may not be
reliable.
Execute this command after positioning completion because it becomes invalid during positioning.
CAUTION
• Turn the power supply of the servo amplifier side off before touching a servo motor, such as machine adjustment.
• When the servo amplifier is not started (LED: "AA", "Ab", "AC", "Ad" or "AE"), if the control loop changing
command is turned ON/OFF, the command becomes invalid.
• When the following are operated during the fully closed loop, it returns to the semi closed loop control.
(1) Power supply OFF or reset of the Multiple CPU system
(2) Wire breakage of the SSCNET cable between the servo amplifier and Motion controller
(3) Control circuit power supply OFF of the servo amplifier
• The "[Rq.1159] FIN signal (R: M34499+32n/Q: M3219+20n)" and "[St.1079] M-code outputting (R:
M32419+32n/Q: M2419+20n)" are both signal for the FIN signal wait function.
• The "[Rq.1159] FIN signal (R: M34499+32n/Q: M3219+20n)" and "[St.1079] M-code outputting (R:
M32419+32n/Q: M2419+20n)" are valid only when FIN acceleration/deceleration is designated in the servo
program. Otherwise, the FIN signal wait function is disabled, and the "[St.1079] M-code outputting (R:
M32419+32n/Q: M2419+20n)" does not turn on.
M36581+32n
M36582+32n
M36583+32n
M36584+32n
M36585+32n
M36586+32n
M36587+32n
M36588+32n
M36589+32n
M36590+32n
M36591+32n
• The following range is valid. R16MTCPU: Axis No.1 to 16, R32MTCPU: Axis No.1 to 32.
• The following device area can be used as a user device. R16MTCPU: 17 axes or more, R32MTCPU: 33
axes or more. However, when the project of R16MTCPU is replaced with R32MTCPU/R64MTCPU, or the
project of R32MTCPU is replaced with R64MTCPU, this area cannot be used as a user device.
• Refer to the following for details of command generation axis status.
MELSEC iQ-R Motion Controller Programming Manual (Advanced Synchronous Control)
• The following range is valid. R16MTCPU: Axis No.1 to 16, R32MTCPU: Axis No.1 to 32.
• The following device area can be used as a user device. R16MTCPU: 17 axes or more, R32MTCPU: 33
axes or more. However, when the project of R16MTCPU is replaced with R32MTCPU/R64MTCPU, or the
project of R32MTCPU is replaced with R64MTCPU, this area cannot be used as a user device.
• Refer to the following for details of command generation axis command signal.
MELSEC iQ-R Motion Controller Programming Manual (Advanced Synchronous Control)
Refer to the following for details of synchronous encoder axis command signal.
MELSEC iQ-R Motion Controller Programming Manual (Advanced Synchronous Control)
• The following range is valid. R16MTCPU: Axis No.1 to 16, R32MTCPU: Axis No.1 to 32.
• The following device area can be used as a user device. R16MTCPU: 17 axes or more, R32MTCPU: 33
axes or more. However, when the project of R16MTCPU is replaced with R32MTCPU/R64MTCPU, or the
project of R32MTCPU is replaced with R64MTCPU, this area cannot be used as a user device.
• Refer to the following for details of output axis status.
MELSEC iQ-R Motion Controller Programming Manual (Advanced Synchronous Control)
• The following range is valid. R16MTCPU: Axis No.1 to 16, R32MTCPU: Axis No.1 to 32.
• The following device area can be used as a user device. R16MTCPU: 17 axes or more, R32MTCPU: 33
axes or more. However, when the project of R16MTCPU is replaced with R32MTCPU/R64MTCPU, or the
project of R32MTCPU is replaced with R64MTCPU, this area cannot be used as a user device.
• Refer to the following for details of output axis command signal.
MELSEC iQ-R Motion Controller Programming Manual (Advanced Synchronous Control)
• The following range is valid. R16MTCPU: Axis No.1 to 16, R32MTCPU: Axis No.1 to 32.
• The following device area can be used as a user device. R16MTCPU: 17 axes or more, R32MTCPU: 33
axes or more. However, when the project of R16MTCPU is replaced with R32MTCPU/R64MTCPU, or the
project of R32MTCPU is replaced with R64MTCPU, this area cannot be used as a user device.
• Refer to the following for details of synchronous control signal.
MELSEC iQ-R Motion Controller Programming Manual (Advanced Synchronous Control)
• The following range is valid. R16MTCPU: Axis No.1 to 16, R32MTCPU: Axis No.1 to 32.
• The following device area can be used as a user device. R16MTCPU: 17 axes or more, R32MTCPU: 33
axes or more. However, when the project of R16MTCPU is replaced with R32MTCPU/R64MTCPU, or the
project of R32MTCPU is replaced with R64MTCPU, this area cannot be used as a user device.
• Refer to the following for details of synchronous analysis complete signal.
MELSEC iQ-R Motion Controller Programming Manual (Advanced Synchronous Control)
• The following range is valid. R16MTCPU: Axis No.1 to 16, R32MTCPU: Axis No.1 to 32.
• The following device area can be used as a user device. R16MTCPU: 17 axes or more, R32MTCPU: 33
axes or more. However, when the project of R16MTCPU is replaced with R32MTCPU/R64MTCPU, or the
project of R32MTCPU is replaced with R64MTCPU, this area cannot be used as a user device.
• Refer to the following for details of synchronous control start signal.
MELSEC iQ-R Motion Controller Programming Manual (Advanced Synchronous Control)
• The following range is valid. R16MTCPU: Axis No.1 to 16, R32MTCPU: Axis No.1 to 32.
• The following device area can be used as a user device. R16MTCPU: 17 axes or more, R32MTCPU: 33
axes or more. However, when the project of R16MTCPU is replaced with R32MTCPU/R64MTCPU, or the
project of R32MTCPU is replaced with R64MTCPU, this area cannot be used as a user device.
• Refer to the following for details of synchronous analysis request signal.
MELSEC iQ-R Motion Controller Programming Manual (Advanced Synchronous Control)
M2037
M2055 Unusable
(6 points)
:
M2060
M2093 Unusable
(35 points)
:
M2127
M2160 Unusable
(80 points)
:
M2239
M2304 Unusable
(16 points)
:
M2319
*1 The following range is valid. R16MTCPU: Axis No.1 to 16, R32MTCPU: Axis No.1 to 32.
*2 The following device area can be used as a user device. R16MTCPU: 17 axes or more, R32MTCPU: 33 axes or more.
• Internal relays for positioning control are not latched even within the latch range.
• The range devices allocated as internal relays for positioning control cannot be used by the user even if
their applications have not been set.
• Writing of parameters or files in the program from MT Developer2 is available while "[Rq.1120] PLC ready flag (R: M30000/
Q: M2000)" is OFF.
• When turning "[Rq.1120] PLC ready flag (R: M30000/Q: M2000)" from OFF to ON enables the program control of the
Motion CPU, "PCPU READY complete flag (SM500)" turns ON. Refer to the following for details of the processing when
"[Rq.1120] PLC ready flag (R: M30000/Q: M2000)" turns from OFF to ON, or from ON to OFF.
MELSEC iQ-R Motion controller Programming Manual (Common)
V Deceleration stop
Positioning start
ON
[Rq.1120] PLC ready flag
(R: M30000/Q: M2000) OFF
ON
PCPU READY complete flag
(SM500) OFF
"[Rq.1122] Speed switching point specified flag (R: M30040/Q: M2040)" OFF "[Rq.1122] Speed switching point specified flag (R: M30040/Q: M2040)" ON
V V
t t
Pass points of the continuous Pass points of the continuous
trajectory control (When the speed trajectory control (When the speed
P1 P2 P3 P4 P1 P2 P3 P4
change is specified with P3.) change is specified with P3.)
[Rq.1122] Speed switching point [Rq.1122] Speed switching point ON
specified flag OFF specified flag OFF
(R: M30040/Q: M2040) (R: M30040/Q: M2040)
• When using advanced S-curve acceleration/deceleration and starting continuous trajectory control with "[Rq.1122] Speed
switching point specified flag (R: M30040/Q: M2040)" turned ON, the override function is disabled.
Execute "[Rq.1123] All axes servo ON command (R: M30042/Q: M2042)": OFF after positioning completion because it
becomes invalid during positioning.
ON
[Rq.1123] All axes servo ON command
OFF
(R: M30042/Q: M2042)
ON
[St.1045] All axes servo ON accept flag
OFF
(R: M30049/Q: M2049)
ON
Each axis servo ready state*1 OFF
*1 Refer to the "[St.1075] Servo ready (R: M32415+32n/Q: M2415+20n)" for details. (Page 35 [St.1075] Servo ready (R: M32415+32n/
Q: M2415+20n))
When "[Rq.1123] All axes servo ON command (R: M30042/Q: M2042)" turns ON, it is not turned off even if the
Motion CPU is set in the STOP state.
"[Rq.1123] All axes servo ON command (R: M30042/Q: M2042)" turns OFF by the forced stop of Motion CPU.
*1 Refer to the "[St.1075] Servo ready (R: M32415+32n/Q: M2415+20n)" for details. (Page 35 [St.1075] Servo ready (R: M32415+32n/
Q: M2415+20n))
• The state of the start accept flag during positioning control by servo program is shown below.
• The state of the start accept flag of a current value change by the CHGA instruction of servo program or by the Motion
dedicated PLC instruction (M(P).CHGA/D(P).CHGA) is shown below.
CHGA instruction
ON Turns off at the completion of
[St.1040] Start accept flag
current value change.
(R: M30080+n/Q: M2001+n) OFF Current value changing
processing
CHGV instruction
ON
[St.1047] Speed change accepting flag
(R: M30144/Q: M2061+n) OFF
0 to 4 ms
Speed change
Setting speed
Speed after speed change
t
Speed change completion
P2
t
P3
ON
[St.1048] Automatic decelerating flag
(R: M30208+n/Q: M2128+n) OFF
Set a travel value in which automatic deceleration processing can be started at the final positioning point,
therefore the automatic decelerating flag turns on at the start point of automatic deceleration processing after
this final point.
ON
[St.1048] Automatic decelerating flag
(R: M30208+n/Q: M2128+n) OFF
ON
[St.1040] Start accept flag
(R: M30080+n/Q: M2001+n) OFF
ON
[St.1049] Speed change "0" accepting
flag (R: M30272+n/Q: M2240+n) OFF
ON
[St.1061] Positioning complete
(R: M32401+32n/Q: M2401+20n) OFF
• Even if it has stopped, when the "[St.1040] Start accept flag (R: M30080+n/Q: M2001+n)" is ON state, the
state where the request of speed change "0" is accepted is indicated. Confirm by this "[St.1049] Speed
change "0" accepting flag (R: M30272+n/Q: M2240+n)".
• During interpolation, the flags corresponding to the interpolation axes are set.
• In any of the following cases, the speed change "0" request is invalid.
(1) After deceleration by the JOG signal off
(2) During manual pulse generator operation
(3) After positioning automatic deceleration start
(4) After deceleration due to stop cause
ON
[St.1040] Start accept flag
(R: M30080+n/Q: M2001+n) OFF
ON
[St.1049] Speed change "0" accepting
flag (R: M30272+n/Q: M2240+n) OFF
• The flag turns off if a stop cause occurs after speed change "0" accept.
Stop cause
ON
[St.1040] Start accept flag
(R: M30080+n/Q: M2001+n) OFF
ON
[St.1049] Speed change "0" accepting
flag (R: M30272+n/Q: M2240+n) OFF
• The "[St.1049] speed change "0" accepting flag (R: M30272+n/Q: M2240+n)" does not turn on if a speed change "0" occurs
after an automatic deceleration start.
Automatic deceleration start
V
ON
[St.1040] Start accept flag
(R: M30080+n/Q: M2001+n) OFF
• Even if it is speed change "0" after the automatic deceleration start to the "command address", "[St.1049] Speed change "0"
accepting flag (R: M30272+n/Q: M2240+n)" turns on.
Automatic deceleration start
Command address P1 Speed change "0"
V V1
Speed change V2
V2
Command
address P2
P1 P2
t
ON
[St.1040] Start accept flag
(R: M30080+n/Q: M2001+n) OFF
ON
[St.1049] Speed change "0" accepting
flag (R: M30272+n/Q: M2240+n) OFF
It does not start, even if the "command address" is changed during speed change "0" accepting.
It can be changed the fully closed loop control/semi closed loop control of servo amplifier in the Motion controller by the
"[Rq.1158] Control loop changing command (R: M34498+32n/Q: M3218+20n)" ON/OFF.
Fully closed loop Semi closed loop
control change control change
ON
[Rq.1158] Control loop changing command
(R: M34498+32n/Q: M3218+20n) OFF
ON
[St.1050] Control loop monitor status
(R: M30336+n/Q: M2272+n) OFF
*1 It can be used as the travel value change register. The travel value change register can be set to the device optionally in the servo
program. (Page 322 Speed/Position Switching Control)
*2 Operation cycle 1.777[ms] or less: Operation cycle, operation cycle 3.555[ms] or more: 3.555[ms]
• The following range is valid. R16MTCPU: Axis No.1 to 16, R32MTCPU: Axis No.1 to 32.
• The following device area can be used as a user device. R16MTCPU: 17 axes or more, R32MTCPU: 33
axes or more. However, when the project of R16MTCPU is replaced with R32MTCPU/R64MTCPU, or the
project of R32MTCPU is replaced with R64MTCPU, this area cannot be used as a user device.
• The stroke range check is performed on this feed current value data.
• Servo error codes can be cleared by "[Rq.1148] Servo error reset command (R: M34488+32n/Q: M3208+20n)" or "Error
reset (SM50)".
*1 Confirm the actual value in "[Md.100] Home position return re-travel value (R: D32026+48n, D32027+48n/Q: #8006+20n, #8007+20n)".
(Page 100 [Md.100] Home position return re-travel value (R: D32026+48n, D32027+48n/Q: #8006+20n, #8007+20n))
[Md.34] Travel value after proximity dog ON (R: D32010+48n, D32011+48n/Q: D10+20n,
D11+20n)
• This register stores the travel value (unsigned) from the proximity dog ON to home position return completion after the
home position return start.
• The travel value (unsigned) of the position control is stored at the time of speed/position switching control.
• When the following control is being executed using MT Developer2 in the test mode, the following value is stored in this
register.
Item Monitor value
Home position return FFFDh
During G-code control, "[Md.1008] Execute program No. (R: D32012+48n/Q: D12+20n)" is not updated.
The input situation of positioning data to the Motion CPU is shown the next page by executing the 2-axes continuous
trajectory control using above the servo program and updating the positioning data in indirect devices D3000 to D3006.
16 (9) 1 0 8 7 6 5 4 3 2
4
18 (10) (A) (17) (15) (13) (11) (9) (7) (5)
32 (17) 3 2 1 0 8 7 6 5 4
8
34 (18) (5) (C) (A) (17) (15) (13) (11) (9)
4 3 2 1 0 8 7 6 5
5 4 3 2 1 0 8 7 6
6 5 4 3 2 1 0 8 7
7 6 5 4 3 2 1 0 8
8 7 6 5 4 3 2 1 0
Second Point 0 8 7 6 5 4 3 2 1
positioning (17) (15) (13) (11) (9) (7) (5) (C)
[Md.1012] Real current value at STOP input (R: D32018+48n, D32019+48n/Q: D18+20n,
D19+20n)
The actual current value at the detection of a stop/rapid stop cause is stored in this area.
The value is not stored during advanced synchronous control, or G-code control.
[Md.1019] Servo amplifier display servo error code (R: D32028+48n/Q: #8008+20n)
• This register stores the servo error code read from the servo amplifier. The hexadecimal display is the same as the LED of
servo amplifier.
Servo amplifier model Servo amplifier LED display
MR-J3-B The two digits of the LED display are shown.
MR-J3W-B The upper two digits of the LED display are shown.
MR-J4(W)-B The three digits of the LED display are shown.
H
Parameter No.
Parameter group No.
0: PA group 5: PF group
1: PB group 9: Po group
2: PC group A: PS group
3: PD group B: PL group
4: PE group C: PT group
READY ON
Servo ON
Control mode
Gain changing
Fully closed control changing
Servo alarm
In-position
Torque limit
Absolute position lost
Servo warning
*: The 0/1 is stored in the servo status 1.
0: OFF
1: ON
Item Description
READY ON (b0) Indicates the ready ON/OFF.
Servo ON (b1) Indicates the servo ON/OFF.
Control mode (b2, b3)*1 Indicates the control mode of servo amplifier.
Gain changing (b4) Turns ON when the servo amplifier is gain changing.
Fully closed control changing (b5) Turns ON when the servo amplifier is using fully closed control.
Servo alarm (b7) Turn ON during the servo alarm.
In-position (b12) The dwell pulse turns ON within the servo parameter "in-position".
Torque limit (b13) Turns ON when the servo amplifier is having the torque restricted.
Absolute position lost (b14) Turns ON when the servo amplifier is lost the absolute position.
Servo warning (b15) Turn ON during the servo warning.
Servo warning (b15) turns ON during Motion controller forced stop or servo forced stop.
Item Description
Zero point pass (b0) Turns ON if the zero point of the encoder has been passed even once.
Zero speed (b3) Turns ON when the motor speed is lower than the servo parameter "zero speed."
Speed limit (b4) Turn ON during the speed limit in torque control mode.
PID control (b8) Turn ON when the servo amplifier is PID control.
Continuous operation to
torque control mode
Pressure control mode
*: The 0/1 is stored in the servo status 3.
0: OFF
1: ON
Item Description
Continuous operation to torque control mode (b14) Turn ON when in continuous operation to torque control mode.
Pressure control mode (b15) Turn ON when in pressure control mode
Item Description
Driver operation alarm (b9) Turn ON when driver operation alarm occurs.
• The following range is valid. R16MTCPU: Axis No.1 to 16, R32MTCPU: Axis No.1 to 32.
• The following device area can be used as a user device. R16MTCPU: 17 axes or more, R32MTCPU: 33
axes or more. However, when the project of R16MTCPU is replaced with R32MTCPU/R64MTCPU, or the
project of R32MTCPU is replaced with R64MTCPU, this area cannot be used as a user device.
*1 When the "speed control 10 multiplier setting for degree axis" is set to "valid" in the fixed parameter, the unit is 1 to 2147483647 (10-
2
[degree/min]).
• The JOG speed is the value stored in the "[Cd.1110] JOG speed setting (R: D35120+2n, D35121+2n/Q: D640+2n,
D641+2n)" at leading edge of JOG start signal. Even if data is changed during JOG operation, JOG speed cannot be
changed.
• Refer to the JOG operation for details of the JOG operation. (Page 413 JOG Operation)
• The following range is valid. R16MTCPU: Axis No.1 to 16, R32MTCPU: Axis No.1 to 32.
• The following device area can be used as a user device. R16MTCPU: 17 axes or more, R32MTCPU: 33
axes or more. However, when the project of R16MTCPU is replaced with R32MTCPU/R64MTCPU, or the
project of R32MTCPU is replaced with R64MTCPU, this area cannot be used as a user device.
• Refer to the following for details of servo input axis monitor device.
MELSEC iQ-R Motion Controller Programming Manual (Advanced Synchronous Control)
• The following range is valid. R16MTCPU: Axis No.1 to 16, R32MTCPU: Axis No.1 to 32.
• The following device area can be used as a user device. R16MTCPU: 17 axes or more, R32MTCPU: 33
axes or more. However, when the project of R16MTCPU is replaced with R32MTCPU/R64MTCPU, or the
project of R32MTCPU is replaced with R64MTCPU, this area cannot be used as a user device.
• Refer to the following for details of servo input axis control device.
MELSEC iQ-R Motion Controller Programming Manual (Advanced Synchronous Control)
• The following range is valid. R16MTCPU: Axis No.1 to 16, R32MTCPU: Axis No.1 to 32.
• The following device area can be used as a user device. R16MTCPU: 17 axes or more, R32MTCPU: 33
axes or more. However, when the project of R16MTCPU is replaced with R32MTCPU/R64MTCPU, or the
project of R32MTCPU is replaced with R64MTCPU, this area cannot be used as a user device.
• Refer to the following for details of command generation axis monitor device.
MELSEC iQ-R Motion Controller Programming Manual (Advanced Synchronous Control)
• The following range is valid. R16MTCPU: Axis No.1 to 16, R32MTCPU: Axis No.1 to 32.
• The following device area can be used as a user device. R16MTCPU: 17 axes or more, R32MTCPU: 33
axes or more. However, when the project of R16MTCPU is replaced with R32MTCPU/R64MTCPU, or the
project of R32MTCPU is replaced with R64MTCPU, this area cannot be used as a user device.
• Refer to the following for details of command generation axis control device.
MELSEC iQ-R Motion Controller Programming Manual (Advanced Synchronous Control)
Refer to the following for details of synchronous encoder axis monitor device.
MELSEC iQ-R Motion Controller Programming Manual (Advanced Synchronous Control)
Refer to the following for details of synchronous encoder axis control device.
MELSEC iQ-R Motion Controller Programming Manual (Advanced Synchronous Control)
• The following range is valid. R16MTCPU: Axis No.1 to 16, R32MTCPU: Axis No.1 to 32.
• The following device area can be used as a user device. R16MTCPU: 17 axes or more, R32MTCPU: 33
axes or more. However, when the project of R16MTCPU is replaced with R32MTCPU/R64MTCPU, or the
project of R32MTCPU is replaced with R64MTCPU, this area cannot be used as a user device.
• Refer to the following for details of output axis monitor device.
MELSEC iQ-R Motion Controller Programming Manual (Advanced Synchronous Control)
Refer to the following for details of G-code control common command signal.
MELSEC iQ-R Motion Controller Programming Manual (G-Code Control)
Refer to the following for details of G-code control common control device.
MELSEC iQ-R Motion Controller Programming Manual (G-Code Control)
Refer to the following for details of G-code control common monitor device.
MELSEC iQ-R Motion Controller Programming Manual (G-Code Control)
D54227.2+2s Unusable
D54227.3+2s
D54227.4+2s Rq.3385 G65 argument initialization At G-code Command signal
program start
D54227.5+2s Unusable
D54227.6+2s
D54227.7+2s
D54227.8+2s
D54227.9+2s
D54227.A+2s
D54227.B+2s
D54227.C+2s
D54227.D+2s
D54227.E+2s
D54227.F+2s
Refer to the following for details of G-code control line command signal.
MELSEC iQ-R Motion Controller Programming Manual (G-Code Control)
Refer to the following for details of G-code control line control device.
MELSEC iQ-R Motion Controller Programming Manual (G-Code Control)
Refer to the following for details of G-code control line monitor device.
MELSEC iQ-R Motion Controller Programming Manual (G-Code Control)
Refer to the following for details of G-code control axis monitor device.
MELSEC iQ-R Motion Controller Programming Manual (G-Code Control)
D35304
D35305
D35306 D720 Cd.1101 Axis 1 Manual pulse generators 1
D35307 D721 Axis 2 pulse input magnification
setting register*1*2
D35308 D722 Axis 3
D35309 D723 Axis 4
D35310 D724 Axis 5
D35311 D725 Axis 6
D35312 D726 Axis 7
D35313 D727 Axis 8
D35314 D728 Axis 9
D35315 D729 Axis 10
D35316 D730 Axis 11
D35317 D731 Axis 12
D35318 D732 Axis 13
D35319 D733 Axis 14
D35320 D734 Axis 15
D35321 D735 Axis 16
D35322 D736 Axis 17
D35323 D737 Axis 18
D35324 D738 Axis 19
D35325 D739 Axis 20
D35326 D740 Axis 21
*1 The following range is valid. R16MTCPU: Axis No.1 to 16, R32MTCPU: Axis No.1 to 32.
*2 The following device area can be used as a user device. R16MTCPU: 17 axes or more, R32MTCPU: 33 axes or more.
[Cd.1096] JOG operation simultaneous start axis setting registers (Forward rotation
JOG) (R: D35286 to D35289/Q: D710, D711)
• This register sets the axis No. and direction which start the forward rotation JOG operation simultaneously.
b15 b14 b13 b12 b11 b10 b9 b8 b7 b6 b5 b4 b3 b2 b1 b0
R: D35286/ Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis
Q: D710 16 15 14 13 12 11 10 9 8 7 6 5 4 3 2 1
[Cd.1096] JOG operation R: D35287/ Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis
simultaneous start axis Q: D711 32 31 30 29 28 27 26 25 24 23 22 21 20 19 18 17
setting registers Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis
(Forward rotation JOG) R: D35288 48 47 46 45 44 43 42 41 40 39 38 37 36 35 34 33
Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis
R: D35289 64 63 62 61 60 59 58 57 56 55 54 53 52 51 50 49
*1: Make JOG operation simultaneous start axis setting with 1/0.
1: Simultaneous start execution
0: Simultaneous start not execution
*2: The following range is valid.
R16MTCPU: Axis No.1 to 16, R32MTCPU: Axis No.1 to 32.
• Refer to the JOG operation simultaneous start for details of the JOG operation simultaneous start. (Page 416
Simultaneous start)
[Cd.1097] JOG operation simultaneous start axis setting registers (Reverse rotation
JOG) (R: D35290 to D35293/Q: D712, D713)
• This register sets the axis No. and direction which start the reverse rotation JOG operation simultaneously.
b15 b14 b13 b12 b11 b10 b9 b8 b7 b6 b5 b4 b3 b2 b1 b0
R: D35290/ Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis
Q: D712 16 15 14 13 12 11 10 9 8 7 6 5 4 3 2 1
[Cd.1097] JOG operation R: D35291/ Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis
simultaneous start axis Q: D713 32 31 30 29 28 27 26 25 24 23 22 21 20 19 18 17
setting registers Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis
(Reverse rotation JOG) R: D35292 48 47 46 45 44 43 42 41 40 39 38 37 36 35 34 33
Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis
R: D35293 64 63 62 61 60 59 58 57 56 55 54 53 52 51 50 49
*1: Make JOG operation simultaneous start axis setting with 1/0.
1: Simultaneous start execution
0: Simultaneous start not execution
*2: The following range is valid.
R16MTCPU: Axis No.1 to 16, R32MTCPU: Axis No.1 to 32.
• Refer to the JOG operation simultaneous start for details of the JOG operation simultaneous start. (Page 416
Simultaneous start)
R: D35295/ Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis
[Cd.1098] Manual pulse Q: D715 32 31 30 29 28 27 26 25 24 23 22 21 20 19 18 17
generator 1 axis No.
setting registers (P1) Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis
R: D35296 48 47 46 45 44 43 42 41 40 39 38 37 36 35 34 33
Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis
R: D35297 64 63 62 61 60 59 58 57 56 55 54 53 52 51 50 49
*1: Make the axis No. controlled with the manual pulse generator setting with 1/0.
1: Specified axis
0: Unspecified axis
*2: The following range is valid.
R16MTCPU: Axis No.1 to 16, R32MTCPU: Axis No.1 to 32.
• Refer to the manual pulse generator operation for details of the manual pulse generator operation. (Page 418 Manual
Pulse Generator Operation)
[Cd.1099] Manual pulse generator 2 axis No. setting registers (R: D35298 to D35301/Q:
D716, D717)
• This register stores the axis No. controlled with the manual pulse generator 2.
b15 b14 b13 b12 b11 b10 b9 b8 b7 b6 b5 b4 b3 b2 b1 b0
R: D35298/ Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis
Q: D716 16 15 14 13 12 11 10 9 8 7 6 5 4 3 2 1
R: D35299/ Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis
[Cd.1099] Manual pulse Q: D717 32 31 30 29 28 27 26 25 24 23 22 21 20 19 18 17
generator 2 axis No.
setting registers (P2) Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis
R: D35300 48 47 46 45 44 43 42 41 40 39 38 37 36 35 34 33
Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis
R: D35301 64 63 62 61 60 59 58 57 56 55 54 53 52 51 50 49
*1: Make the axis No. controlled with the manual pulse generator setting with 1/0.
1: Specified axis
0: Unspecified axis
*2: The following range is valid.
R16MTCPU: Axis No.1 to 16, R32MTCPU: Axis No.1 to 32.
• Refer to the manual pulse generator operation for details of the manual pulse generator operation. (Page 418 Manual
Pulse Generator Operation)
[Cd.1100] Manual pulse generator 3 axis No. setting registers (R: D35302 to D35305/Q:
D718, D719)
• This register stores the axis No. controlled with the manual pulse generator 3.
b15 b14 b13 b12 b11 b10 b9 b8 b7 b6 b5 b4 b3 b2 b1 b0
R: D35302/ Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis
Q: D718 16 15 14 13 12 11 10 9 8 7 6 5 4 3 2 1
R: D35303/ Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis
[Cd.1100] Manual pulse Q: D719 32 31 30 29 28 27 26 25 24 23 22 21 20 19 18 17
generator 3 axis No.
setting registers (P3) Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis
R: D35304 48 47 46 45 44 43 42 41 40 39 38 37 36 35 34 33
Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis
R: D35305 64 63 62 61 60 59 58 57 56 55 54 53 52 51 50 49
*1: Make the axis No. controlled with the manual pulse generator setting with 1/0.
1: Specified axis
0: Unspecified axis
*2: The following range is valid.
R16MTCPU: Axis No.1 to 16, R32MTCPU: Axis No.1 to 32.
• Refer to the manual pulse generator operation for details of the manual pulse generator operation. (Page 418 Manual
Pulse Generator Operation)
• Refer to the manual pulse generator operation for details of the manual pulse generator operation. (Page 418 Manual
Pulse Generator Operation)
• When the smoothing magnification is set, the smoothing time constant is as indicated by the following expression.
Smoothing time constant (t) = (smoothing magnification + 1) 56.8 [ms]
• Operation
t t t t
Output speed (V1) [pulse/s] = (Number of input pulses/s) (Manual pulse generator 1-pulse input magnification setting)
Travel value (L) = (Travel value per pulse) (Number of input pulses) (Manual pulse generator 1-pulse input magnification
setting)
• The travel value per pulse of the manual pulse generator is shown below.
inch 0.00001[inch]
degree 0.00001[degree]
pulse 1[pulse]
The operation details are the same as "[Cd.1102] Manual pulse generator 1 smoothing magnification setting registers (R:
M35370/Q: D752)". (Page 159 [Cd.1102] Manual pulse generator 1 smoothing magnification setting registers (R:
D35370/Q: D752))
The operation details are the same as "[Cd.1102] Manual pulse generator 1 smoothing magnification setting registers (R:
M35370/Q: D752)". (Page 159 [Cd.1102] Manual pulse generator 1 smoothing magnification setting registers (R:
D35370/Q: D752))
The list of the parameters used by the Motion CPU is shown below.
: Input : Not input
Parameter item Parameter input timing Details Reference
At ON/reset of At STOP to
Multiple CPU RUN/ test
system power mode request
supply
*1
R series System parameter Set the R series CPU common parameters for
common CPU parameter the base, slot, and module settings and the
parameter Multiple CPU system settings.
Module parameter The system parameters for each CPU in the
Multiple CPU system must be matched.
Motion Basic setting Set the basic parameters of the Motion system,
CPU such as operation cycle and the external forced
common stop input.
parameter
Servo network setting Set the servo network type, and the connected
servo amplifiers, SSCNET/H head modules,
and sensing modules.
Limit output data Set the output device and watch data for limit
switch output.
High-speed input request signal Set the high precision input request signal used
for synchronous control or mark detection.
Mark detection Set the data for mark detection.
Manual pulse generator Set the data required for connecting the manual
connection setting pulse generator to the module.
Vision system parameter Set the parameters used for connecting the
vision system.
Head module Set the parameters used for connecting the
SSCNET/H head module and sensing module.
Refresh (END/I45 executing) Set the multiple CPU refresh (main cycle/
setting operation cycle).
Motion Axis setting Fixed parameter Set the fixed data based on the mechanical Page
control parameter system, etc. of the controlled axis. 167 Fixed
parameter Parameters
Home position Set the data required for the home position Page
return data return. 177 Home
Position
Return Data
JOG operation Set the data to perform the JOG operation. Page
data 187 JOG
Operation
Data
External signal Set the external signals (upper stroke limit (FLS), Page
parameter lower stroke limit (RLS), stop (STOP), and 189 External
proximity dog or speed/position switching (DOG/ Signal
CHANGE)) used for each axis. Parameter
*1 For direct setting using MT Developer2, use the decimal format instead of the exponential format.
Ex.
Different units (mm, inch, degree, and pulse) are applicable to different systems:
Unit System
mm, inch X-Y table, conveyor (Select mm or inch depending on the machine specifications.)
degree Rotating body (360 degrees/rotation)
pulse X-Y table, conveyor
When you change the unit, note that the values of other parameters and data will not be changed automatically. After
changing the unit, check if the parameter and data values are within the allowable range.
• The mechanical system error of the command travel value and real travel value is rectified by adjusting the
"electronic gear".
• The value of less than 1 pulse that cannot be execute an output when the machine travels is incremented in
the Motion CPU, and a total incremented output is performed when the total incremented value becomes
more than 1 pulse.
• The total incremented value of less than 1 pulse that cannot be execute an output is cleared and it is
referred to as "0" at the home position return completion, current value change completion, and fixed-pitch
feed control start. (When the total incremented value is cleared, the error occurs to the feed machine value
only a part to have been cleared.)
Motion CPU
Reduction gear Machine
Command Control AP Servo pulse
units pulse amplifier M
value AL
ENC
pulse
Feedback pulse
Electronic gear =
AP . . . . . (1) 3
AL
(There is a range which can be set in the numerical value set as AP/AL, so it is necessary to make the setting range of AP/AL
the value calculated from the above expression (reduced) of relations.)
Example of the real setting is shown below. Refer to the Number of pulses/travel value at linear servo use for the setting at
linear servo. (Page 170 Number of pulses/travel value at linear servo use)
pulse
Feedback pulse
Linear encoder
Calculate the number of pulses (AP) and travel value (AL) for the linear encoder in the following conditions.
Number of pulses (AP)
Linear encoder resolution =
Travel value (AL)
Linear encoder resolution: 0.05 [m]
Number of pulses (AP) [pulse] 1 20
= =
Travel value (AL) [μm] 0.05 1.0
Set the number of pulses in "Number of pulses per rotation", and the movement amount in "Travel value per rotation" in the
actual setting.
Set the same value as the value set in the fixed parameter to the servo parameter "PS02 (Linear encoder resolution setting
Numerator)" and "PS03 (Linear encoder resolution setting Denominator)".
Refer to the following for details.
Servo amplifier Instruction Manual
Servo amplifier type Instruction manual name
MR-J4-B SSCNET/H interface MR-J4-_B(-RJ)/ MR-J4-_B4(-RJ)/ MR-J4-_B1(-RJ) Servo amplifier Instruction Manual (SH-030106)
MR-J4W-B SSCNET/H interface Multi-axis AC Servo MR-J4W2-_B/MR-J4W3-_B Servo amplifier Instruction Manual (SH-030105)
MR-J3-B-RJ004 SSCNET Compatible Linear Servo MR-J3-B-RJ004U Instruction Manual (SH-030054)
RLS
(Travel range of the machine)
FLS
External limit signal
3
Stroke limit Stroke limit
(lower) (upper)
*1 When "[Rq.1152] Feed current value update command (R: M34492+32n/Q: M3212+20n)" is ON
*2 When "[Rq.1152] Feed current value update command (R: M34492+32n/Q: M3212+20n)" is OFF
• Besides setting the upper/lower stroke limit value in the fixed parameters, the range of mechanical system
can also be controlled by using the external limit signals (FLS, RLS).
• When the external limit signal turns off, a deceleration stop is executed. "Deceleration time" and "Rapid stop
deceleration time" can be used in the parameter block for deceleration stop time.
End point
-2147483648
• If the current feed value and real current value exceeds 2147483647 [pulse/0.1 m/10-5inch], it is controlled
with -2147483648 [pulse/0.1m/10-5 inch]. If those values are less than -2147483648 [pulse/0.1m/10-
5inch], it is controlled with 2147483647 [pulse/0.1m/10-5inch].
• The circular interpolation and helical interpolation (other than linear axis) including axis that the stroke limit
is set to invalid cannot be executed. A minor error (error code: 19E8H) will occur, and operation does not
start.
• The high-speed oscillation function cannot be used in the axis that set the stroke limit invalid.
• When executing a speed change to negative speed for the axis with stroke limit set to invalid, the operations
below occur based on the control mode being executed.
ON
[St.1063]Command in-position
(R: M32403+32n/Q: M2403+20n) OFF
<K 10>
INC-1
Axis 1, 360.00000 degree
Speed 180.00 degree/min
V
[degree/min]
Axis 1
speed
Servo program No.10
18.000
t
V
[degree/min]
180.00 Servo program No.20
Axis 2
speed
<K 30>
[degree/min]
V
[degree/min]
V
3
180.00 Servo program No.30
127.28
Vector speed
Axis 1
speed
t t
V
[degree/min]
127.28
Axis 2
Axis 2 speed
speed
t
<K 50>
V
[degree/min]
Axis 1
speed
Servo program No.50
3.24
t
V
[degree/min]
180.00 Servo program No.50
Axis 2
speed
<K 60>
V
[degree/min]
Axis 1
speed
Servo program No.60
3.24
t
V
[degree/min]
180.00 Servo program No.60
Axis 2
speed
When a speed change is executed by the Motion dedicated PLC instruction (M(P).CHGV/D(P).CHGV) or
Motion SFC program (CHGV instruction) after setting the "speed control 10 multiplier setting for degree
axis" to "valid", positioning control is executed at 10 the speed of the set command speed.
return request 1: Home position return request not ON during servo OFF
setting in pulse
conversion
unit*4
15 Standby time 1 to 1000 [ms] (1 word) At the
after clear signal home
output in pulse position
conversion return
unit*4 start
*1 For direct setting using MT Developer2, use the decimal format instead of the exponential format.
*2 Refer to the indirect setting method by devices for Parameters for the range of devices used for indirect setting. (Page 167 Indirect
Setting Method by Devices for Parameters)
*3 When the "speed control 10 multiplier setting for degree axis" is set to "valid" in the fixed parameter, the unit is 1 to 2147483647
(10-2 [degree/min]).
*4 Pulse conversion use only.
*5 MELSEC iQ-R Motion Controller Programming Manual (Common)
As the home position is normally set near the lower or upper limit, the "home position return direction" is set as shown below.
When the home position is set at the lower limit side, the home
position return direction is in the direction of arrow (1).
Set “0” for home position return direction.
When the home position is set at the upper limit side, the home
position return direction is in the direction of arrow (2).
Set “1” for home position return direction.
Creep speed
Set the creep speed after proximity dog ON (the low speed just before stopping after decelerating from the home position
return speed).
The creep speed is set within the following range.
Home position return speed Creep speed Bias speed at start
Ex.
The deceleration distance is calculated from the speed limit value, home position return speed, creep speed and deceleration
time as shown below.
[Home position return operation]
Speed limit value: VP = 200kpps
VZ t
Real deceleration time : t = TB
VP
TB
Deceleration time: TB = 300ms
A home position return must be made after the servo motor has been rotated more than one revolution to pass
the axis through the Z-phase (motor reference position signal).
For a proximity dog method or count method home position return, the distance between the point where the
home position return program is started and the deceleration stop point before re-travel must be such that the
servo motor is rotated more than one revolution to pass the axis through the Z-phase.
When a data set method home position return is made in an ABS (absolute position) system, the servo motor
must also have been rotated more than one revolution by JOG operation or the like to pass the axis through
the Z-phase.
When "1: No servo motor Z-phase pass after power ON" is selected in the "function selection C-4 (PC17)" of
servo parameter (expansion setting parameter), even if it does not pass zero point, the home position return
can be executed and restrictions are lost.
The temporary stop is made during time set in the (1) It travels to preset direction of home
Home position "dwell time at the home position return retry". position return.
return direction (2) If the external upper/lower limit switch
turns OFF before the detection of
proximity dog, a deceleration stop is
(5) (1) made.
(6) (2) (3) After a deceleration stop, the temporary
stop is made during time set in the
"dwell time at the home position return
retry" and it travels to reverse direction
of home position return with the home
Home Home position position return speed.
(4) position return start (4) A deceleration stop is made by the
proximity dog OFF.
(3) (5) After a deceleration stop, the temporary
stop is made during time set in the
External limit switch "dwell time at the home position return
Proximity dog retry" and it travels to direction of home
position return.
(6) Home position return ends.
Zero point
Valid/invalid of home position return retry function by the home position return method is shown below.
: Valid : Invalid
Home position return methods Valid/invalid of the parameter block setting
Proximity dog method
Count method
Data set method
Dog cradle method
Stopper method
Limit switch combined method
Scale home position signal detection method
Dogless home position signal Operation A
reference method
Operation B
Operation C
Driver home position return method
Home position
Home position
return start Home position shift amount
Home position return (Positive value)
re-travel value
Travel value after proximity dog ON
Proximity dog
Zero point
Home position
Set the operation speed at the
home position shift with speed
Travel value after set at the home position shift.
Creep speed
proximity dog ON Select one of "home position
return speed" or "creep speed".
Home position
return speed Home position shift amount
Proximity dog (Negative value)
Zero point
Valid/invalid of the setting value for home position shift amount by the home position return method is shown below.
: Valid : Invalid
Home position return methods Valid/invalid of home position shift amount
Proximity dog method
Count method
Data set method
Dog cradle method
Stopper method
Limit switch combined method
Scale home position signal detection method
Dogless home position signal reference method
Driver home position return method
CAUTION
• Do not execute the positioning control in "[St.1069] Home position return request (R: M32409+32n/Q: M2409+20n)" is ON for the axis which uses in the
positioning control. Failure to observe this could lead to an accident such as a collision.
Stopper method 1
Stopper method 2
Count method 1
Count method 2
Count method 3
Operation B
Operation C
Operation A
Home Home position return direction
position
Home position address
return data
Home position return speed
Creep speed
Travel value after proximity dog ON
Parameter block setting
Home position return retry function
Dwell time at the home position return retry
Home position shift amount
Speed set at the home position shift
Torque limit value at the creep speed
Operation setting for incompletion of home
position return
Parameter Interpolation control unit
blocks Speed limit value
Acceleration time
Deceleration time
Rapid stop deceleration time
S-curve ratio
Advanced S-curve Acceleration/
acceleration / deceleration system
deceleration
Acceleration section
1 ratio
Acceleration section
2 ratio
Deceleration
section 1 ratio
Deceleration
section 2 ratio
Torque limit value
Deceleration processing at the stop time
Allowable error range for circular
interpolation
Bias speed at start
*1 For direct setting using MT Developer2, use the decimal format instead of the exponential format.
*2 When the "speed control 10 multiplier setting for degree axis" is valid in the fixed parameter, the setting range is 1 to 2147483647
(10-2 [degree/min]).
Start to outside the range of stroke limit of fixed parameter cannot be executed.
However, JOG operation is possible in the direction from outside the stroke limit range to back inside the
stroke limit range.
Stroke limit lower Stroke limit upper
For a degree axis, depending on the stroke limit setting, the direction that can return the axis into the stroke
range is different.
• When upper stroke limit value > lower stroke limit value
When "Feed current value > upper stroke limit value", movement in the negative direction is possible.
When "Feed current value < lower stroke limit value", movement in the positive direction is possible.
• When upper stroke limit value < lower stroke limit value
Movement in both the positive and negative direction is possible.
Signal type
Set the signal type to use as the external signal.
■ Invalid
The external signal is invalid.
■ Amplifier input
The input signal of servo amplifier is used as the following external signals.
Input signal External signal
DI1 Upper stroke limit (FLS)
DI2 Lower stroke limit (RLS)
DI3 Proximity dog (DOG)
■ Bit device
The optional bit device is used as the servo external signal.
Device
Set the bit device used when the signal type is set to the bit device.
Refer to the indirect setting method by devices for parameters for the range of usable devices. (Page 167 Indirect Setting
Method by Devices for Parameters)
■ Normal open
External signal Details
FLS signal ON The upper stroke limit is detected, and "operation of direction that the feed current value increase" cannot be
executed.
RLS signal ON The lower stroke limit is detected, and "operation of direction that the feed current value decrease" cannot be
executed.
STOP signal ON The stop signal is detected, and an operation stops.
DOG signal ON The proximity dog/speed-position switching signal is detected, and the home position return operation and speed-
position control switching is executed.
■ Normal close
External signal Details
FLS signal OFF The upper stroke limit is detected, and "operation of direction that the feed current value increase" cannot be
executed.
RLS signal OFF The lower stroke limit is detected, and "operation of direction that the feed current value decrease" cannot be
executed.
STOP signal OFF The stop signal is detected, and an operation stops.
DOG signal OFF The proximity dog/speed-position switching signal is detected, and the home position return operation and speed-
position control switching is executed.
CAUTION
• For the stroke limit wiring, always use negative logic (normally closed contact). Using the positive logic (normally open contact) may cause serious accidents.
• The input signal of the servo amplifier is always turned OFF when the communication with the servo amplifier is disconnected. If using the state of the
external signal of the disconnected axis ([St.1071] External signals FLS (R: M32411+32n/Q: M2411+20n) / [St.1072] External signals RLS (R: M32412+32n/
Q: M2412+20n) / [St.1074] External signals DOG/CHANGE (R: M32414+32n/Q: M2414+20n)) as the external signal of another axis that is not disconnected,
design the system so that the machine will not go into a dangerous state due to the connection state of the servo amplifier.
Precision
Set the precision when the DOG signal is used for the count method home position return or the speed-position switching
control.
Precision Signal type Setting required on the module side Detection precision [μs]
General Bit device None 222*1
Amplifier input (DI3) None • Operation cycle 1.777 [ms] or less: Operation cycle
• Operation cycle 3.555 [ms] or more: 3555
High precision Bit device • Enable the inter-module synchronization function.*2 *3
*1 When an actual device with the inter-module synchronization setting is used, the inter-module synchronization cycle is used.
*2 When the function is not enabled, a moderate error (error code: 30D2H) occurs.
*3 Detection precision of the high precision setting of the bit device
■ High precision
When the input module setting is "Inter-module synchronization valid", the stopping precision of the count method home
position return or the speed-position switching control can be high by setting the DOG signal precision setting to "high
precision".
Refer to the following for the input module setting method. 3
MELSEC iQ-R Motion controller Programming Manual (Common)
When this setting is applied to a signal that does not support high precision input a moderate error (error code: 30D2H)
occurs.
*1 For direct setting using MT Developer2, use the decimal format instead of the exponential format.
*2 Refer to the indirect setting method by devices for parameters for the range of devices used for indirect setting. (Page 167 Indirect
Setting Method by Devices for Parameters)
*3 This setting can be omitted.
*4 When 0 is set, a deceleration stop is executed according to the stop deceleration time set in the parameter block.
*5 Can be set when the unit setting of the fixed parameter is "degree".
*6 During position follow-up control, the values of devices that were indirectly set at the change of the positioning address are input again.
*7 For continuous trajectory control, operation is by the settings at the start, even if the settings were changed during operation.
The positive torque limit value is stored in the "[Md.35] Torque limit value (R: D32014+48n/Q: D14+20n)" in
0.1 [%] unit. (The negative torque limit value is not stored.)
• When the setting of acceleration/deceleration time change enable device is omitted, change of acceleration/
deceleration time at a speed change request is not executed. When changing acceleration/deceleration
time at a speed change, set this parameter.
• When the setting of new acceleration time value device and new deceleration time value device is omitted,
change of acceleration/deceleration time of the omitted devices is not executed.
The servo motor maximum speed check parameter checks that the command value to the servo amplifier is within the servo
motor maximum speed settings during machine program operation and machine JOG operation. When the servo motor 3
maximum speed setting value is exceeded a minor error (error code: 1FE2H (details code: 0007H) occurs, and a deceleration
stop is executed according to the stop deceleration time set in the parameter block, or a separate deceleration time.
(Page 260 Stop processing and restarting after stop)
When the servo motor maximum speed value is set to "0", the maximum speed check is disabled.
When the servo motor maximum speed is set by indirect setting, the settings are imported at the start of machine operation
(machine program operation, machine JOG operation). When the servo motor maximum speed is outside of the setting range,
a warning (error code: 0EE0H (details code: 00F0H)) occurs, and the servo motor maximum speed check becomes the
maximum value for the servo motor maximum speed.
When used in conjunction with coordinate transformation, because operation stops temporarily use the smoothing filter of the
vibration suppression command filter function. When smoothing filter is not set during machine program operation, a warning
(error code: 0EE0H (details code: 00F1H)) occurs. Refer to vibration suppression command filter for vibration suppression
command filter function. (Page 465 Vibration Suppression Command Filter)
When deceleration time constant is set to "0", a deceleration stop is executed according to the stop deceleration time set in
the parameter block.
ABS-2
ABS-3
ABS-4
Continuous trajectory control passing point helical absolute specification*1
ABH
ABH
ABH
ABH
ABH
ABH
ABH
Position follow-up control Position follow-up control start
PFSTART
When the value of the ABS direction in degrees device is outside of range at the start of positioning control, a minor error
(error code: 19A4H) occurs, and positioning control does not start. When setting is changed during operation, the operation
continues with the setting at the start of operation.
However, during position follow-up control, the value of the ABS direction in degrees device is input again at the time of when
the positioning address is changed.When the value of the ABS direction in degrees device that is input again is out of range,
a minor error (error code: 19A4H) occurs, and a deceleration stop is made.
Operation 1
Operation 1 for when ABS direction in degrees device is set is shown below.
■ Positioning conditions
Item Setting
Servo program No. 10
Control axis 1
Positioning address 0.00000 [degree]
Positioning speed 18.000 [degree/min]
ABS direction in degrees device 1 (forward direction) / 2 (reverse direction)
Current value 45.00000 [degree]
■ Servo program
<K 10>
ABS-1
Axis 1, 0.00000degree
Speed 18.000degree/min
■ Operation when positioning direction is set to "1: Forward direction", "2: Reverse direction"
in ABS direction in degrees device
When "1: Forward direction" is set When "2: Reverse direction" is set
0 0
45 45
180 180
Operation 2
Operation 2 for when ABS direction in degrees device is set is shown below.
■ Positioning conditions
Item Setting
Servo program No. 11
Control axis 1
Positioning address D6000 [degree]
Positioning speed 18.000 [degree/min]
ABS direction in degrees device 1 (forward direction)
■ Servo program
<K 11>
PFSTART
Axis 1, D6000degree
Speed 18.000degree/min
■ When "Movement amount from current value < deceleration stop distance" at positioning
address change
Speed
t
Because a deceleration stop cannot be made
Feed current value Positioning address at the position, after making a deceleration
360 stop, positioning continues to the positioning
Positioning address change
address one revolution ahead.
t
0
t
0
size)
Torque control
Speed control
Conti-nuous operat-ion
invalid invalid cycle
(Required
to torque control
size)
Torque control
Speed control
*1 For direct setting using MT Developer2, use the decimal format instead of the exponential format.
*2 Refer to the indirect setting method by devices for parameters for the range of devices used for indirect setting. (Page 167 Indirect
Setting Method by Devices for Parameters)
*3 This setting can be omitted.
*4 When the "speed control 10 multiplier setting for degree axis" is set to "valid", the setting range is 1 to 2147483647(10-2 [degree/min].
If the value of control mode setting device is outside the range at control mode switching request, a warning (error code:
09E8H) will occur, and the control mode is not switched.
*1 When the "speed control 10 multiplier setting for degree axis" is valid, the setting range is -2147483648 to 2147483647(10-2 [degree/
min]).
The actual motor speed may not reach the speed limit value depending on the machine load situation during
torque control or continuous operation to torque control.
0 t
-10000
-20000
When the rotation direction is changed due to the command speed change during speed control, the operation is as follows.
• A deceleration is made to 0 [r/min] according to the setting value of command speed deceleration time. After that, an
acceleration is made to the command speed according to the setting value of command speed acceleration time.
Torque control
The relation between setting of command torque and torque generation direction of servo motor differs from the setting of
servo parameter "Rotation direction selection (PA14)" and "Function selection C-B (PC29) (POL reflection selection at torque
control)".
Function selection C-B Rotation direction Torque command device Torque generation direction of servo
(PC29) (POL reflection selection (PA14) motor
selection at torque control)"
0: Valid 0: Forward rotation (CCW) Positive value (Forward direction) CCW direction
with the increase of the
Negative value (Reverse direction) CW direction
positioning address
1: Reverse rotation (CW) Positive value (Forward direction) CW direction
with the increase of the CCW
Negative value (Reverse direction) CCW direction
positioning address direction CW
direction
1: Invalid 0: Forward rotation (CCW) Positive value (Forward direction) CCW direction
with the increase of the Negative value (Reverse direction) CW direction
positioning address
1: Reverse rotation (CW) Positive value (Forward direction) CCW direction
with the increase of the
Negative value (Reverse direction) CW direction
positioning address
20.0
0 t
-10.0
-20.0
When the torque generation direction of servo motor is changed due to the command torque change during torque control or
continuous operation to torque control, the operation is as follows.
• The torque output value is 0 [%] according to the setting value of command torque time constant (negative direction). After
that, the value becomes command torque according to the setting value of command torque time constant (positive
direction).
When the mode is switched to continuous operation to torque control mode in cases where command speed
and actual speed are different such as during acceleration/deceleration or when the speed does not reach
command speed due to torque limit, set "1: Feedback speed".
Set normally "0". Set "1" to switch to the control mode without waiting for stop of servo motor immediately after
completion of the command to servo motor.
At switching to continuous operation to torque control, switching of control mode is possible without stop
regardless of the setting value.
*1 Refer to the indirect setting method by devices for parameters for the range of devices used for indirect setting. (Page 167 Indirect
Setting Method by Devices for Parameters)
*2 Cannot be set when the unit setting of fixed parameter is "degree".
*3 This setting can be omitted.
Feed/dwell
Dwell
Abnormal pressure switching
Pressure release
Dwell time passed
*: 0 or 1 is stored in the pressure control status device.
• 0: OFF
• 1: ON
*1 Refer to the indirect setting method by devices for parameters for the range of devices used for indirect setting. (Page 167 Indirect
Setting Method by Devices for Parameters)
*2 This setting can be omitted.
*1 Refer to the indirect setting method by devices for parameters for the range of devices used for indirect setting. (Page 167 Indirect
Setting Method by Devices for Parameters)
*2 This setting can be omitted.
When the mode selection device is a value outside of range, a warning (error code: 0A3AH) occurs, and the mode setting is
not reflected even if changed.
Frequency
Set the frequency for suppressing vibration of the vibration suppression command filter 1.
The valid frequency range is shown below according to operation cycle and filter method set by the mode selection device.
The vibration suppression command filter is invalid when operation cycle is set to 7.111[ms].
Operation cycle[ms] Valid range[Hz]
Smoothing filter FIR filter
0.222 0.20 to 250.00 0.20 to 250.00
0.444 0.20 to 250.00 0.20 to 250.00
0.888 0.20 to 250.00 0.20 to 250.00
1.777 0.20 to 140.00 0.20 to 140.00
3.555 0.20 to 70.00 0.20 to 70.00
When the frequency is a value outside of range, a warning (error code: 0A3BH) occurs, and the value is changed to the lower
limit value if the input value is lower than the range, and changed to the upper limit value if the input value is higher than the
range.
Depth
Set the attenuation depth of the frequency that suppressing the vibration of vibration suppression command filter 1.
Setting a deeper value increases the effect of vibration suppression.
This setting is invalid for smoothing filter. (Depth is fixed at -40dB.)
For the FIR filter setting, when the depth is a value outside of range, a warning (error code: 0A3CH) occurs, and the value is
changed to the lower limit value if the input value is lower than the range, and changed to the upper limit value if the input
value is higher than the range.
When the mode selection device is a value outside of range, a warning (error code: 0A3AH) occurs, and the mode setting is
not reflected even if changed.
Frequency
Set the frequency for suppressing vibration of the vibration suppression command filter 1.
The valid frequency range is shown below according to operation cycle and filter method set by the mode selection device.
The vibration suppression command filter is invalid when operation cycle is set to 7.111[ms].
Operation cycle[ms] Valid range[Hz]
IIR filter
0.222 1.00 to 250.00
0.444 1.00 to 200.00
0.888 1.00 to 100.00
1.777 1.00 to 50.00
3.555 1.00 to 25.00
When the frequency is a value outside of range, a warning (error code: 0A3BH) occurs, and the value is changed to the lower
limit value if the input value is lower than the range, and changed to the upper limit value if the input value is higher than the
range.
Servo amplifier and sensing module instruction manual lists are shown below.
• Servo amplifier
Type Instruction manual name
MR-J4-B SSCNET/H interface MR-J4-_B(-RJ)/ MR-J4-_B4(-RJ)/ MR-J4-_B1(-RJ) Servo amplifier Instruction Manual (SH-030106)
MR-J4W-B SSCNET/H interface Multi-axis AC Servo MR-J4W2-_B/MR-J4W3-_B Servo amplifier Instruction Manual (SH-030105)
MR-J3-B SSCNET interface MR-J3-B Servo amplifier Instruction Manual (SH-030051)
MR-J3W-B SSCNET interface 2-axis AC Servo Amplifier MR-J3W-B/MR-J3W-0303BN6 Servo amplifier Instruction Manual (SH-030073)
MR-J3-B-RJ004 SSCNET Compatible Linear Servo MR-J3-B-RJ004U Instruction Manual (SH-030054)
MR-J3-B-RJ006 SSCNET Fully Closed Loop Control MR-J3-B-RJ006 Servo amplifier Instruction Manual (SH-030056)
MR-J3-B-RJ080W SSCNET interface Direct Drive Servo MR-J3-B-RJ080W/TM-RFM Instruction Manual (SH-030079)
MR-J3-BS SSCNET interface Drive Safety integrated MR-J3-B Safety Servo amplifier Instruction Manual (SH-030084)
• Sensing module
Type Instruction manual name
MR-MT2010 MR-MT Sensing Module Instruction Manual (SH-030251ENG)
MR-MT2100
MR-MT2200
MR-MT2300
MR-MT2400
Refer to the following for how to control servo parameters by the Motion CPU.
MELSEC iQ-R Motion Controller Programming Manual (Common)
*1 For direct setting using MT Developer2, use the decimal format instead of the exponential format.
*2 When the "speed control 10 multiplier setting for degree axis" is set to "valid", the setting range is 1 to 214748367 (10-2 [degree/min]).
*3 When the "speed control 10 multiplier setting for degree axis" is set to "valid", the setting range is 0 to 214748367 (10-2 [degree/min]).
• The processing method of acceleration/deceleration is set by the acceleration/deceleration method and S-curve ratio set in
the parameter block.
• Set "Trapezoid/S-curve" as acceleration/deceleration method to execute the trapezoidal acceleration/deceleration or S-curve acceleration/deceleration.
Set 0[%] as S-curve ratio to execute the trapezoidal acceleration/deceleration, and set 1 to 100[%] to execute the S-curve acceleration/deceleration.
• Set "Advanced S-curve" to execute the Advanced S-curve acceleration/deceleration. At this time, the S-curve ratio is invalid.
• When the FIN acceleration/deceleration (Fixed acceleration/deceleration time method) is set in the continuous trajectory control, the setting for advanced
S-curve acceleration/deceleration is invalid.
Refer to the advanced S-curve acceleration/deceleration for acceleration time, deceleration time and rapid stop deceleration
time of the advanced S-curve acceleration/deceleration processing. (Page 222 Advanced S-curve acceleration/
deceleration)
Stop
• The large value than deceleration time can be set as rapid stop deceleration time by turning ON the "Rapid stop
deceleration time setting error invalid flag (SM805)".
• Turn ON the "Rapid stop deceleration time setting error invalid flag (SM805)" before operation to use the rapid stop deceleration time setting error invalid.
(The setting value is input at start.)
• For the advanced S-curve acceleration/deceleration, operation is controlled with either small value of setting value for rapid stop deceleration time and
deceleration time even if the "Rapid stop deceleration time setting error invalid flag (SM805)" turns ON.
t
Real
deceleration
ON
time 3
[Rq.1141] Rapid stop command
(R: M34481+32n/Q: M3201+20n) OFF
• If a large value than deceleration time is set as the rapid stop deceleration time for the parameter block and
positioning data of servo program, a warning will occur. However, writing to the Motion CPU is possible.
Stop
Sine curve
t
0 Time
Acceleration Deceleration
time time
As shown below, the S-curve ratio setting serves to select the part of the sine curve to be used as the acceleration/
deceleration curve.
V
A A
Positioning speed B
B
B/2 B/2
B/A = 1.0
t
S-curve ratio is 100[%]
V
Positioning speed
Sine curve
B
B/A = 0.7
A
S-curve ratio = B/A × 100[%]
t
S-curve ratio is 70[%]
(Note 1): The processing described above is also performed at STOP signal input when "Deceleration stop based on the
deceleration time" is set in "Deceleration processing on STOP input" for the parameter block or servo program.
(Note 2): The same processing is also performed when the rapid stop command is set (including when "Deceleration stop
based on the rapid stop deceleration time" is set in Deceleration processing on STOP input). However, it is possible
to prevent the end point from overrunning by adjusting the setting for the rapid stop deceleration time.
• When the skip signal is turned ON during end point processing for the continuous trajectory control
instruction.
End point n
(Small travel value)
V n-1 point
Positioning speed When the skip signal is turned ON
at the end point, the S-curve pattern
is recalculated due to deceleration stop
processing. As a result, the target
position is exceeded.
t
Deceleration time Time
ON
Skip signal OFF
• When the rapid stop command is turned ON during S-curve deceleration processing.
V
Positioning speed
The S-curve pattern is recreated based
on the rapid stop deceleration time if the
rapid stop command turns ON.
t
Deceleration time Time
ON
[Rq.1141]Rapid stop command
(R: M34481+32n/Q: M3201+20n) OFF
Acceleration section 1
Deceleration section 2
ratio (A1R)
ratio (D2R)
Time
Section Section Section Section Section Section Section
A B C D E F G
Acceleration
Trapezoidal acceleration
/deceleration
Advanced S-curve Sine curve
acceleration/
deceleration
Time
Sine
curve
*1 For direct setting using MT Developer2, use the decimal format instead of the exponential format.
*2 When the "speed control 10 multiplier setting for degree axis" is set to "valid", the setting range is 1 to 2147483647 (10-2 [degree/
min]).
The acceleration time to reach the command speed and the travel value during acceleration changes by
setting the Acceleration section 1 ratio and acceleration section 2 ratio. The deceleration time to stop from the
commanded speed and the travel value during deceleration changes by setting the deceleration section 1
ratio and deceleration section 2 ratio.
(3)
A1R
Time
(4)
Acceleration
(1)
AmaxA
(2)
(3) *: The graph of deceleration is opposite to
(4) acceleration because the deceleration
Time pattern is negative acceleration.
The actual acceleration/deceleration time for each pattern (pattern (1) to (4)) based on positioning speed is shown below.
When the positioning speed is slower than the speed limit value, adjust the acceleration in the following procedure.
• Shorten time of maximum acceleration section. (Pattern (2), (3))
• Reduce maximum acceleration and acceleration increase/decrease time of acceleration section 1 and 2. (Pattern (4))
D2R
A1R
Time Time
Maximum
Maximum negative
acceleration acceleration
Acceleration section Acceleration section
AmaxA Time
Trapezoidal acceleration
/deceleration
Trapezoidal acceleration
Time DmaxA /deceleration
AT DT
AAT ADT
A1T A2T D1T D2T
*1 The actual acceleration time, actual deceleration time and actual rapid stop deceleration time are shortened when the positioning speed
is less than the speed limit value.
*2 The deceleration time for advanced S-curve acceleration/deceleration is rectified so that the deceleration inclination (deceleration
speed) is gradual. When the deceleration stop distance is short, the set advanced S-curve deceleration time (ADT) may be lengthened
due to rectification.
Error
In the following cases, warning (error code :0A4EH to 0A53H) will occur, and controls will be executed as trapezoidal
acceleration/deceleration (A1R = A2R = D1R = D2R = 0.0).
• Acceleration section 1 ratio is outside the range of 0.0 to 100.0[%].
• Acceleration section 2 ratio is outside the range of 0.0 to 100.0[%].
• Deceleration section 1 ratio is outside the range of 0.0 to 100.0[%].
• Deceleration section 2 ratio is outside the range of 0.0 to 100.0[%].
• "Acceleration section 1 ratio + Acceleration section 2 ratio" > 100.0[%]
• "Deceleration section 1 ratio + Deceleration section 2 ratio" > 100.0[%]
S.R.
Section D1R = 20.0%
A2R = 35.0%
X
ABS-1
Axis 4, 1200000pulse D2R = 35.0%
3
A1R = 20.0%
Speed 500000pulse/s
S.R. 500000pulse/s
ASC System 1 Acceleration
ASC Accel.1 20.0%
ASC Accel.2 35.0%
ASC Decel.1 20.0%
ASC Decel.2 35.0%
Acceleration section 1 ratio (A1R): 20.0% Deceleration section 1 ratio (D1R): 20.0%
Acceleration section 2 ratio (A2R): 35.0% Deceleration section 2 ratio (D2R): 35.0%
When the advanced S-curve acceleration/deceleration is set, the travel value (section X above) at the
commanded speed is different than when using trapezoidal acceleration/deceleration (A1R = A2R = D1R =
D2R = 0.0).
Operation
■ Stop processing
When the stop command turns ON during acceleration, the acceleration is decreased until it reaches zero according to
acceleration section 2 ratio setting. Therefore, the speed will continue to increase for a while before deceleration stop
processing is executed. (Deceleration is smooth.)
Speed
Setting speed
Control during stop
command OFF
Time
0 Deceleration
processing after
stop command
Acceleration
ON Deceleration stop processing
AmaxA
Time
0
DmaxA
ON
[Rq.1140] Stop command
(R: M34480+32n/Q: M3200+20n) OFF
Time
0
Rapid stop
Acceleration processing
AmaxA
Control during rapid
stop command OFF
Time
0
EmaxA
ON
[Rq.1141] Rapid stop command
(R: M34481+32n/Q: M3201+20n) OFF
Time
0
Rapid stop
Acceleration
processing
Time
0
EmaxA
ON
[Rq.1141] Rapid stop command
(R: M34481+32n/Q: M3201+20n) OFF
Time
0
Acceleration
AmaxA (3)
Time
0
• Acceleration processing from zero speed and deceleration processing to zero speed (fixed time method)
Operation for positioning to fixed position stop command position at servo program start is shown below.
Speed
Command speed V0
Time
0
Acceleration
Time
0
(-V0) ÷ b
a
(1) ON
Servo program start OFF
Deceleration from
speed V1 to V2
V1
Command speed V2
(After speed change) 0
Time 3
Before speed
Acceleration change
Same slope as
acceleration decrease
V0 a
Deceleration from
speed V1 to V2
Time
0
(V2 - V1) b
t1
ON
Servo program start OFF
Fixed position stop acceleration
/deceleration time a b
(Indirect setting device)
When a speed change is executed during decreasing acceleration of advanced S-curve acceleration/
deceleration, in order to maintain smoothness of acceleration, the speed will continue to increase until
acceleration reaches zero. Therefore, the time for speed change is lengthened.
Speed
Command speed V1
V0
Time
0
Acceleration Deceleration stop processing
Time
0
DmaxA
ON
[St.1048] Automatic decelerating flag
(R: M30208+n/Q: M2128+n) OFF
When the automatic deceleration processing is started during acceleration processing of advanced S-curve
acceleration/deceleration, in order to maintain smoothness of acceleration, the speed will continue to increase
until acceleration reaches zero.
Command speed
t
Actual Actual
acceleration time deceleration time
Command speed
t
Actual Actual
acceleration time deceleration time
For the 2-axes or more interpolation control, the bias speed at start is applied to the composite command
speed.
• Set the bias speed at start to a value not more than the speed limit value. If the bias speed at start is set to a value larger
than the speed limit value, a warning (error code: 0A4CH) occurs, and the bias speed at start is "0"
• The setting range for the command speed is "bias speed at start to speed limit value". When the command speed is out of
range by starting a servo program or executing a speed change instruction (M(P).CHGV/D(P).CHGV,CHGV), a warning
(error code: 0A4CH), or warning (error code: 0A5DH) occurs and speed change is not performed. When bias speed at start
is other than "0", a warning (error code: 0A5DH) occurs when a speed change to "0" is performed.
• When FIN acceleration/deceleration and advanced S-curve acceleration/deceleration methods are used with bias speed at
start, a warning (error code: 0A4DH) occurs, and the bias speed at start is "0".
• For servo programs where speed specification at a pass point is possible (CPSTART), if the speed at the pass point is set
to less than the bias speed at start, a warning (error code: 0A5AH) occurs, and the bias speed at start is "0" for the points
afterwards.
• Program No.
This No. is specified using the Motion SFC program. Any No. in the range of 0 to 8191 (for operating system software
version "09" or earlier, 0 to 4095) can be set.
• Servo instruction
Type of positioning control is indicated. (Page 239 Servo Instructions)
ABS-2
Page 349 2 to 4 axes 4
continuous trajectory
control
ABS-3
ABS-4
ABS
ABS
ABS
ABS
ABS
ABS
ABS
Continuous trajectory control passing point helical Page 353
ABH
absolute specification Continuous trajectory
control for helical
ABH
interpolation
ABH
ABH
ABH
ABH
ABH
Continuous trajectory control passing point incremental Page 346 1 axis
INC-1
specification continuous trajectory
control
Page 349 2 to 4 axes
INC-2
continuous trajectory
control
INC-3
INC-4
INC
INC
INC
INC
INC
INC
INC
*1 For direct setting using MT Developer2, use the decimal format instead of the exponential format.
*2 When the "speed control 10 multiplier setting for degree axis" is valid, the setting range is 1 to 2147483647 (10-2 [degree/min]).
*3 Only when the reference axis speed is specified
*4 Only bit0 is valid. If the value outside the range is set, the state except bit0 is ignored.
*5 When the "speed control 10 multiplier setting for degree axis" is valid, the setting range is 0 to 2147483647 (10-2 [degree/min]).
*6 For operating system software version "09" or earlier, 0 to 4095.
Common
Data that is common through all servo instructions.
■ Axis
Set the starting axis.
It becomes the interpolation starting axis No. at the interpolation.
■ Address/Travel value
• Address (Absolute data method)
Set the positioning address as an absolute method with an absolute address.
• Travel value (Incremental data method)
Set the positioning address as an incremental data method with a travel value. Travel direction is indicated by the sign.
Only positive settings can be made at the speed/position switching control.
Travel direction Description
Positive Forward rotation (address increase direction)
Negative Reverse rotation (address decrease direction)
■ Command speed
Sets the positioning speed.
Units for speed are the "control units" set in the parameter block.
It becomes the vector speed/long-axis reference speed/reference axis speed at the interpolation starting. (PTP control only)
■ M-code
Set the M-code.
Set for every point at the continuous trajectory control.
Updated at the start or specified point.
■ Number of pitches
Set at the helical interpolation.
OSC
Data that is set in high-speed oscillation. Refer to the high-speed oscillation for details. (Page 371 High-Speed
Oscillation)
• Starting angle
• Amplitude
• Frequency
Others
■ Repeat condition
• Number of repetitions
Set the repeat conditions between FOR-TIMES instruction and NEXT instruction.
• ON/OFF
Set the repeat conditions between FOR-ON/OFF instruction and NEXT instruction.
■ Program No.
Set the program No. for simultaneous start.
■ Skip
Set to cancel positioning to pass point and execute the positioning to the next point by turning on the specified bit device
during positioning at each pass point for continuous trajectory control instruction.
■ FIN acceleration/deceleration
Set to execute positioning to each pass point for continuous trajectory control instruction by turning on the FIN signal.
■ WAIT-ON/OFF
Set to make state of the waiting for execution by continuous trajectory control and execute the positioning immediately by
turning on/off the command bit device.
If the servo program area has insufficient capacity, perform multiple positioning control operations with one
program by the indirect setting of positioning data used in the servo program. (Page 249 Indirect setting
method by devices) 4
Setting method for direct setting by numerical values
In the setting by numerical values, each positioning data is set by a numerical value, and it becomes fixed data.
Data can be set and corrected using MT Developer2 only.
Ex.
Direct setting example of positioning data by numerical value
Direct setting by numerical
<K 11>
value for positioning data
ABS-3 Fixed data for one servo
Axis 1, 3000000.0 program.
Axis 2, 5500000.0
Axis 3, -2500000.0
Positioning
Vector speed 40000.00
data
Dwell 2500
M-code 12
P.B. 3
Ex.
Indirect setting example of positioning data by device
Axis No. can be set word device.
<K 11>
PVF
Axis W10, U3E0\G10000
Speed U3E0\G10002 Indirect setting by word device
Positioning
data Acc/DecTime 100ms Numerical value setting
FixedPosStop D3000.1 Indirect setting by bit device
• Take an interlock condition by using a "[St.1040] Start accept flag (R: M30080+n/Q: M2001+n)" not to
change the device data for indirect setting until the specified axis has accepted the start command. If the
data is changed before the start command is accepted, positioning may not be controlled in a normal value.
• For data that uses 2 words, always set a device with an even number.
■ Program
Program that starts the servo program (positioning) by the MP.SVST instruction after the data is written to the CPU buffer
memory (U3E0\G10000 to U3E0\G10003) from the PLC CPU (CPU No.1).
Sequence program (PLC CPU side)
M0
DMOVP K10000 U3E0\G10000
Instruction Servo program
execution K10 position
command command
DMOVP K100000 U3E0\G10002
Servo program
U3E1 K10 speed
\G516.0 command
MP.SVST H3E1 "J1" K10 M100 D100
Start accept
flag of CPU
No.2 (Axis 1)
RST M0
Instruction
execution
command
[K10: Real]
1 INC-1
Axis 1, U3E0\G10000 m
Speed U3E0\G10002 mm/min
Positioning speed
The positioning speed is set using the servo program.
Refer to servo programs for positioning control for details of the servo programs. (Page 237 SERVO PROGRAMS FOR
POSITIONING CONTROL)
The real positioning speed is set in the positioning speed and speed limit value using the servo program is shown below: 5
• If the positioning speed setting is less than speed limit value, the positioning is executed with the set positioning speed.
• If the positioning speed setting is greater than speed limit value, the positioning is executed with the speed limit value.
Ex.
(Example 1) If the speed limit value is 120000 [mm/min] and the positioning speed setting is 100000 [mm/min]
V Speed limit value
120000 Positioning speed
100000
t
Parameter block Parameter block
acceleration time deceleration time
(Example 2) If the speed limit value is 100000 [mm/min] and the positioning speed setting is 120000 [mm/min]
V Positioning speed
120000 Speed limit value (Real positioning speed)
100000
t
Parameter block Parameter block
acceleration time deceleration time
5 POSITIONING CONTROL
5.1 Basics of Positioning Control 251
Positioning speed at the interpolation control
The positioning speed of the Motion CPU sets the travel speed of the control system.
Ex.
2 axes linear interpolation control
[Program example]
Axis 2
<K 50>
ABS-2
(10000, 15000) Axis 1, 10000 [pulse]
Axis 2, 15000 [pulse]
Vector speed 7000 [pulse/s]
V
V2
V1
Axis 1
0
The Motion CPU calculates the positioning speed of each axis using the following calculation formulas in the above condition:
Axis Calculation expression
Axis 1 positioning speed
V1=VD1/ D12+D22
5 POSITIONING CONTROL
252 5.1 Basics of Positioning Control
■ Long-axis speed specification
It is controlled based on the positioning speed (Long-axis speed: V) of the largest travel value axis among address set as
each axis.
The Motion CPU calculates the positioning speed of other axes (V1 to V3) using each axis travel value (D1 to D4).
Set the long-axis speed and the travel value of each axis using the servo program.
Ex.
4 axes linear interpolation control
[Program example]
<K 51>
ABS-4
Axis 1, 10000 [pulse]
Axis 2, 15000 [pulse]
Axis 3, 5000 [pulse]
Axis 4, 20000 [pulse]
Long-axis speed 7000 [pulse/s]
In this example, since the reference axis is axis 4 of the largest travel value, it is controlled with the positioning speed
specified with axis 4.
The Motion CPU calculates the positioning speed of other axes using the following calculation formulas:
Axis Calculation expression
Axis 1 positioning speed V 1 = D1 / D 4 V
Axis 2 positioning speed V 2 = D2 / D 4 V
Axis 3 positioning speed V 3 = D3 / D 4 V
The following conversions are performed if the control units of each axis differ.
• Combination of axes set in [mm] and [inch]
Interpolation Item Description
control unit
mm Travel value Convert the travel value of axis set in [inch] into [mm] using the formula: inch setting value 25.4.
Speed The largest travel value axis is controlled with the long-axis speed and the other axes are controlled with the speed
based on the long-axis speed, as the result of conversion.
inch Travel value Convert the travel value of axis set in [mm] into [inch] using the formula: mm setting value 25.4.
Speed The largest travel value axis is controlled with the long-axis speed and the other axes are controlled with the speed
based on the long-axis speed, as the result of conversion.
5 POSITIONING CONTROL
5.1 Basics of Positioning Control 253
Speed limit value and positioning speed
• The setting speed limit value applies to the long-axis speed.
• Be careful that the vector speed may exceed the speed limit value at the long-axis speed specification.
(Example)
The following settings at the 2 axes linear interpolation, the vector speed exceeds the speed limit value.
<K 2>
INC-2
Axis 1, 100 [pulse]
Axis 2, 200 [pulse]
Long-axis speed 50 [pulse/s]
In this example, since the reference-axis is axis 2 of the largest travel value, it is controlled with the speed limit
value specified with axis 2.
The positioning speed and vector speed for each axis are as follows:
The vector speed exceeds the speed limit value setting of 55.
Relationship between speed limit value, acceleration time, deceleration time and rapid stop deceleration time.
• The real acceleration time, deceleration time and rapid stop deceleration time are set by the setting long-
axis speed.
Speed limit value
Positioning speed (long-axis speed)
Speed
Rapid stop cause occurrence
(6)
(2) (4)
5 POSITIONING CONTROL
254 5.1 Basics of Positioning Control
■ Reference-axis speed specification
The Motion CPU calculates the positioning speed of other axes (V1 to V3) based on the positioning speed (reference-axis
speed: V) of the setting reference-axis using each axis travel value (D1 to D4).
Set the reference-axis No., reference-axis speed and each axis travel value using the servo program.
Ex.
4 axes linear interpolation control
[Program example]
[Program example]
<K 52>
ABS-4
Axis 1, 10000 [pulse]
Axis 2, 15000 [pulse]
Axis 3, 5000 [pulse]
Axis 4, 20000 [pulse]
Reference-axis speed 7000 [pulse/s]
Reference-axis 4
5
In this example, since the reference-axis is axis 4, it is controlled with the positioning speed specified with axis 4.
The Motion CPU calculates the positioning speed of other axes using the following calculation formulas:
Axis Calculation expression
Axis 1 positioning speed V 1 = D1 / D 4 V
Axis 2 positioning speed V2 = D2 / D4 V
Axis 3 positioning speed V 3 = D3 / D 4 V
(6)
(2) (4)
5 POSITIONING CONTROL
5.1 Basics of Positioning Control 255
Circular interpolation control
The angular speed is controlled with the setting speed at the circular interpolation control.
Control with the setting speed
5 POSITIONING CONTROL
256 5.1 Basics of Positioning Control
Same units: (1)
The position command is calculated with the setting address (travel value), positioning speed or electronic gear, the
positioning is executed.
If control units for one axis are "degree" at the circular interpolation control, use "degree" also for the other
axis.
• If the interpolation control units match for two or more axes at the 3-axes or more linear interpolation, the positioning speed
is calculated with the electronic gear for the axis with the lowest No.
Although electric gear is not set for the command generation axis, the electric gear is set to "1" when
calculating the position command value or the positioning speed.
5 POSITIONING CONTROL
5.1 Basics of Positioning Control 257
Control in the control unit "degree"
If the control units are "degree", the following items differ from other control units.
0 0 0
315.00000 Clockwise
Area A
90.00000
Area B
• If the travel range in area A or area B is set, the limit values are as follows:
Area Lower stroke limit value Upper stroke limit value Remarks
Area A 315.00000 90.00000 When the feed current value is outside of the stroke limit range, movement
in both the positive and negative direction is possible with JOG operation, or
manual pulse generator operation.
Area B 90.00000 315.00000 When the feed current value is outside of the stroke limit range, movement
in the negative direction is possible when "feed current value > upper limit
stroke limit", and movement in the positive direction is possible when "feed
current value < lower stroke limit" with JOG operation, or manual pulse
generator operation.
• Circular interpolation including the axis which set the stroke limit as invalid cannot be executed.
• When the upper/lower limit value of the axis which set the stroke limit as valid are changed, perform the
home position return after that.
• When the stroke limit is set as valid in the incremental data system, perform the home position return after
power supply on.
• Do not use the high-speed oscillation in the axis that invalidates a stroke limit of control unit "degree".
• The unlimited length feed is possible by setting the stroke limit to invalid even the control unit is "other than
degree axis" (mm, inch, pulse). (Page 172 Stroke limit invalid setting)
5 POSITIONING CONTROL
258 5.1 Basics of Positioning Control
Positioning control
Positioning control method in the control unit "degree" is shown below.
Ex.
Positioning is executed in a clockwise direction to travel from the current value of 315.00000 to 0.
Positioning is executed in a counter clockwise direction to travel from the current value of 0 to 315.00000.
0 0
315.00000 315.00000
• The positioning direction of absolute data method is set a clockwise/counter clockwise direction by the
setting method of stroke limit range, positioning in the shortest direction may not be possible.
(Example)
Travel from the current value 0 to 315.00000 must be clockwise positioning if the lower stroke limit value is
set to 0 and the upper limit value is set to 345.00000.
0
345.00000
315.00000
Clockwise positioning
• Set the positioning address within the range of 0 to 360. Use the incremental data method for positioning
of one revolution or more.
5 POSITIONING CONTROL
5.1 Basics of Positioning Control 259
Stop processing and restarting after stop
This section describes the stop processing after a stop cause is input during positioning and restarting after stop.
Stop processing
■ Stop processing methods
Stop processing during positioning by stop cause are as follows.
• Deceleration stop
Deceleration stop by "stop deceleration time" of parameter block.
Speed limit value
Stop cause
Operation speed
Stop
• Rapid stop
Deceleration stop by "rapid stop deceleration time" of parameter block.
Stop cause
Stop
• Immediate stop
Stop without deceleration processing.
Stop cause
Stop
5 POSITIONING CONTROL
260 5.1 Basics of Positioning Control
■ Priority for stop processing
Priority for stops when a stop cause is input is as follows:
Ex.
A rapid stop is started if a rapid stop cause is input during one of the following types of deceleration stop processing:
• After automatic deceleration start during positioning control;
• During deceleration after JOG start signal turns off;
• During deceleration stop processing by stop cause.
5
Stop
5 POSITIONING CONTROL
5.1 Basics of Positioning Control 261
Stop cause Axis Stop processing
classification Servo Advanced Torque Manual Machine G-code
program/ synchronous control*2/ pulse program control*5
JOG control*1 Continuous generator operation/
operation operation to operation/ Machine
torque Speed JOG
control control*2 operation*4
mode*2/
Pressure
control*3
Multiple CPU system reset*7 All axes Immediate stop
Motion CPU WDT error*7
Multiple CPU system power
off*7
Forced stop
Servo amplifier control Individual axes
circuit power off*7
Speed change to speed "0" Individual axes*9 Deceleration
stop
Servo motor maximum Individual axes Stop
speed over
Override ratio set to "0" Deceleration Deceleration
stop stop
Software stroke limit error Deceleration stop Immediate stop Deceleration Immediate
stop stop
(individual)
XYZ stroke limit error Individual
machines
Operation outside of range
error/Indefinite solutions
error
"[Rq.2245] Machine stop Deceleration
command (M43621+32m)" stop
ON
"[Rq.2246] Machine rapid Rapid stop
stop command
(M43622+32m)" ON
"[Rq.3376] G-code control G-code control Deceleration
request (D54226.0+2s)" lines stop
OFF
"[Rq.3380] Reset command
(D54226.4+2s)" ON
"[Rq.3378] Automatic
operation hold (feed hold)
(D54226.2+2s)" ON
G-code control error
detection
Fast forward rate override/
cutting feed rate override is
set to "0"
5 POSITIONING CONTROL
262 5.1 Basics of Positioning Control
Re-starting after stop
• If it stopped by the stop command or stop cause (except change speed to speed "0"), re-starting is not possible. However,
it stopped by the STOP input of the external signal ON, the "[Rq.1140] Stop command (R: M34480+32n/Q: M3200+20n)"
ON or the "[Rq.1141] Rapid stop command (R: M34481+32n/Q: M3201+20n)" ON during speed/position switching control,
re-starting is possible using VPSTART instruction.
• If it stopped by the speed change to speed "0" using CHGV instruction, re-starting is possible by executing the speed
change to speed other than "0".
V Speed before speed change
Speed after re-starting
(2)
t
Stop by the speed Re-starting
CHGV instruction
(1) The "[St.1040] Start accept flag (R: M30080+n/Q: M2001+n)" remains on after stop by the speed change to "0".
(2) Re-starting by changing the speed again.
(3) However, if the "[Rq.1040] Stop command (R: M30080+n/Q: M2001+n)" turns off by turning on the "[Rq.1140] Stop command
(R: M34480+32n/Q: M3200+20n)", re-starting is not possible even if make a speed change again.
Start address 1
Axis 1
• For INCPositioning control of the travel value from the stop address.
Axis 2
Stop position by stop command
When the address 2 is moved to the same address (address which calculates with start address + specified travel value)
using the INC, the following processing using the servo program and Motion SFC program is required.
5 POSITIONING CONTROL
5.1 Basics of Positioning Control 263
Servo Program
The travel value of servo program which executes the positioning from address is set indirectly by the word devices, as
follows.
<K 10>
Travel value
INC-2
Axis 1, D3000
Axis 2, D3002
Vector speed 5000
2. Calculate the target address by applying the travel value to the address before starting.
3. Calculate the residual travel value by subtracting the stop address from the target address.
4. Store the residual travel value in the servo program for travel value register.
Travel value
from address 2*1
Address 1 Travel value
(start address) from address 1
Axis 1
Travel value from
address 2*1
5 POSITIONING CONTROL
264 5.1 Basics of Positioning Control
Acceleration/deceleration processing
Acceleration/deceleration are processed by the following three methods.
0
t
Time
5
Acceleration time Deceleration time
t
0 Time
Acceleration time Deceleration time
S-curve ratio set the part of the sine curve used to produce the acceleration and deceleration curve as shown in the diagram
below.
(Example) V
A
Positioning speed
B
B/2 B/2
t
S-curve ratio 100[%]
V
Positioning speed
b
sine curve a b/a=0.7
S-curve ratio=B/A×100[%] t
S-curve ratio 70[%]
5 POSITIONING CONTROL
5.1 Basics of Positioning Control 265
S-curve ratio can be set by the servo program is following two methods.
<K 10>
<K 10>
Acceleration section 1
Deceleration section 2
ratio (ASC Accel.1)
ratio (ASC Decel.2)
Time
Acceleration
Trapezoidal acceleration/
deceleration Sine curve
Advanced S-curve
acceleration/ Time
deceleration
Sine
curve
5 POSITIONING CONTROL
266 5.1 Basics of Positioning Control
Advanced S-curve acceleration/deceleration can be set by the servo program is following two methods.
*1 ASC Accel.1 + ASC Accel.2 100.0%, ASC Decel.1 + ASC Decel.2 100.0%
<K 10>
■ Specification by devices
Advanced S-curve acceleration/deceleration system and advanced S-curve acceleration/deceleration ratio is set by devices.
Refer to the following for the setting range of usable devices.
MELSEC iQ-R Motion controller Programming Manual (Common)
<K 10>
5 POSITIONING CONTROL
5.1 Basics of Positioning Control 267
5.2 1 Axis Linear Positioning Control
Positioning control from the current stop position to the fixed position for specified axis is executed. Positioning is controlled
using ABS-1 (Absolute data method) or INC-1 (Incremental data method) servo instructions.
: Must be set, : Set if required
FIN acceleration/deceleration
Rapid Stop deceleration time
Interpolation control unit
Address/travel value
Repeat condition
Command speed
Auxiliary point
Starting angle
WAIT-ON/OFF
Central point
S-curve ratio
Program No.
Frequency
Dwell time
Amplitude
M-code
Radius
Axis
Skip
ABS-1 Absolute
1 © ¨ ¨ ¨ © © © © © © © © © © ©
INC-1 Incremental
Processing details
■ Control using ABS-1 (Absolute data method)
• Positioning control from the current stop address (pre-positioning address) based on the home position to the specified
address is executed.
• The travel direction is set by the current stop address and the specified address.
Ex.
When the current stop address is 1000, and the specified address is 8000.
Current stop address Specified address
0 1000 8000
5 POSITIONING CONTROL
268 5.2 1 Axis Linear Positioning Control
■ Control using INC-1 (Incremental data method)
• Positioning control of the specified travel value from the current stop position address is executed.
• The travel direction is set by the sign (+/ -) of the travel value, as follows:
Travel direction Description
Positive Positioning control to forward direction (Address Increase direction)
Negative Positioning control to reverse direction (Address decrease direction)
Ex.
When the current stop address is -3000, and the travel value is -5000.
Current stop address
-8000 -3000 -2000 -1000 0 5
Travel value = -5000 Home
position
Program example
The servo program No.0 for performing the 1 axis linear positioning control of Axis 4 is explained as an example.
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
■ Operation timing
Operation timing for the servo program No.0 is shown below.
V
10000
Servo Program No.0
t
[Rq.1120] PLC ready flag
(M2000)
[Rq.1123] All axes servo ON
command (M2042)
[St.1045] All axes servo ON
accept flag (M2049)
Axis 4 [St.1075] Servo ready
(M2475)
5 POSITIONING CONTROL
5.2 1 Axis Linear Positioning Control 269
■ Motion SFC program
The Motion SFC program for executing the servo program (No. 0) for 1 axis linear positioning control is shown below.
[F10]
SET M2042 Turn on all axes servo ON command.
[G10]
X0*M2475 Wait until X0 and Axis 4 servo ready turn on.
[K0]
ABS-1 1 axis linear positioning control
Axis 4, 80000pulse Axis used ........................... Axis 4
Speed 10000pulse/s Positioning address ........... 80000[pulse]
Command speed ................. 10000[pulse/s]
[G20]
!X0 Wait until X0 turn OFF after linear positioning completion.
END
*1 Example of the above Motion SFC program is started using the automatic start or sequence program.
5 POSITIONING CONTROL
270 5.2 1 Axis Linear Positioning Control
5.3 2 Axes Linear Interpolation Control
Linear interpolation control from the current stop position with the specified 2 axes is executed.
ABS-2 (Absolute data method) and INC-2 (Incremental data method) servo instructions are used in the 2 axes linear
interpolation control.
: Must be set, : Set if required
FIN acceleration/deceleration
Rapid Stop deceleration time
Interpolation control unit
Address/travel value
Repeat condition
Command speed
Auxiliary point
Starting angle
WAIT-ON/OFF
Central point
S-curve ratio
Program No.
Frequency
Dwell time
Amplitude
M-code
Radius
Axis
Skip
ABS-2 Absolute
2 © ¨ ¨ ¨ © © © © © © © © © © © ©
INC-2 Incremental
Processing details
■ Control using ABS-2 (Absolute data method)
• 2 axes linear interpolation from the current stop address (X1 or Y1) based on the home position to the specified address (X2
or Y2) is executed.
• The travel direction is set by the stop address (starting address) and positioning address of each axis.
Forward direction
Current stop address (X1, Y1)
Y1
Ex.
When the current stop address is (1000, 4000), and the positioning address is (10000, 2000).
5 POSITIONING CONTROL
5.3 2 Axes Linear Interpolation Control 271
■ Control using INC-2 (Incremental data method)
• Positioning control from the current stop address to the position which combined travel direction and travel value specified
with each axis is executed.
• The travel direction for each axis is set by the sign (+/ -) of the travel value for each axis, as follows:
Travel direction Description
Positive Positioning control to forward direction (Address increase direction)
Negative Positioning control to reverse direction (Address decrease direction)
Forward direction
*: Forward: Travel direction for positive travel value
Y1
Reverse: Travel direction for negative travel value
: Indicates setting data
Y-axis travel value
X1
Current stop address
Reverse direction Forward direction
0 X2
Ex.
When the X-axis travel value is 6000 and Y-axis travel value is -2000.
X-axis travel value *: Current stop address
Home position (-1000, -1000)
* 0 5000
Program example
The program for performing 2 axes linear interpolation control of Axis 3 and Axis 4 is explained as an example.
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
Axis 4 positioning
Home position (0, 0) direction
■ Positioning conditions
• Positioning conditions are shown below.
Item Servo Program No.
No.11
Positioning speed 30000
5 POSITIONING CONTROL
272 5.3 2 Axes Linear Interpolation Control
■ Operation timing
Operation timing for 2 axes linear interpolation control is shown below.
V
t
[Rq.1120] PLC ready flag
(M2000)
[Rq.1123] All axes servo ON
command (M2042)
[St.1045] All axes servo ON
accept flag (M2049)
Axis 3 [St.1075] Servo ready
(M2455)
Axis 4 [St.1075] Servo ready
(M2475)
[F10]
SET M2042 Turn on all axes servo ON command.
[G10]
X0*M2455*M2475 Wait until X0, Axis 3 servo ready and Axis 4 servo ready turn on.
[K11]
ABS-2 2 axes linear interpolation control
Axis 3, 50000pulse Axis used ...................... Axis 3, Axis 4
Axis 4, 40000pulse Positioning address .... Axis 3.........50000[pulse]
Speed 30000pulse/s Axis 4.........40000[pulse]
Command positioning speed
Vector speed ................................... 30000[pulse/s]
[G20]
!X0 Wait until X0 turns off after linear interpolation completion.
END
*1 Example of the above Motion SFC program is started using the automatic start or sequence program.
5 POSITIONING CONTROL
5.3 2 Axes Linear Interpolation Control 273
5.4 3 Axes Linear Interpolation Control
Linear interpolation control from the current stop position with the specified 3 axes is executed.
: Must be set, : Set if required
FIN acceleration/deceleration
Rapid Stop deceleration time
Interpolation control unit
Address/travel value
Repeat condition
Command speed
Auxiliary point
Starting angle
WAIT-ON/OFF
Central point
S-curve ratio
Program No.
Frequency
Dwell time
Amplitude
M-code
Radius
Axis
Skip
ABS-3 Absolute
3 © ¨ ¨ ¨ © © © © © © © © © © © ©
INC-3 Incremental
Processing details
■ Control using ABS-3 (Absolute data method)
• 3 axes linear interpolation from the current stop address (X1, Y1 or Z1) based on the home position to the specified
positioning address (X2, Y2, Z2) is executed.
• The travel direction is set by the stop address and specified address of each axis.
5 POSITIONING CONTROL
274 5.4 3 Axes Linear Interpolation Control
Ex.
When the current stop address is (1000, 2000, 1000), and the specified address is (4000, 8000, 4000).
Positioning address
Forward direction (4000, 8000, 4000)
8000
X-axis, Y-axis and Z-axis linear
interpolation operation
Forward direction
Forward direction
*: Indicates setting data.
Y1
Y-axis travel
Forward direction Z1 value
Z-axis
travel value
X1
Current stop position
Reverse direction Forward direction
0 X-axis travel
value
Reverse direction
Reverse direction
Ex.
X-axis travel value is 10000, Y-axis travel value is 5000 and Z-axis value is 6000.
Stop position after positioning
(12300, 6300, 8000)
Forward direction
Positioning operation
Forward direction
0 5000 10000
Home position X-axis travel value (10000)
5 POSITIONING CONTROL
5.4 3 Axes Linear Interpolation Control 275
Program example
The program for performing 3 axes linear interpolation control of Axis 1, Axis 2, and Axis 3 is explained as an example
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
■ Positioning conditions
• Positioning conditions are shown below.
Item Servo Program No.
No.21
Positioning method Absolute data method
Positioning speed 1000
■ Operation timing
Operation timing for 3 axes linear interpolation control is shown below.
V
t
[Rq.1120] PLC ready flag
(M2000)
[Rq.1123] All axes servo ON
command (M2042)
[St.1045] All axes servo ON
accept flag (M2049)
Axis 1 [St.1075] Servo ready
(M2415)
Axis 2 [St.1075] Servo ready
(M2435)
Axis 3 [St.1075] Servo ready
(M2455)
5 POSITIONING CONTROL
276 5.4 3 Axes Linear Interpolation Control
■ Motion SFC program
The Motion SFC program for executing the servo program (No. 21) for 3 axes linear interpolation control is shown below.
[F10]
SET M2042 Turn on all axes servo ON command.
[G10] Wait until X0, Axis 1 servo ready, Axis 2 servo ready and
X0*M2415*M2435*M2455
Axis 3 servo ready turn on.
[K21]
ABS-3 3 axes linear interpolation control
Axis 1, 50000pulse Axis used ...................... Axis 1, Axis 2, Axis 3
Axis 2, 40000pulse Axis 1.........50000[pulse]
Axis 3, 30000pulse Positioning address .... Axis 2.........40000[pulse]
Speed 1000pulse/s Axis 3.........30000[pulse]
Command positioning speed
Vector speed ................................... 1000[pulse/s]
[G20]
!X0 Wait until X0 turn OFF after linear interpolation completion.
5
END
*1 Example of the above Motion SFC program is started using the automatic start or sequence program.
5 POSITIONING CONTROL
5.4 3 Axes Linear Interpolation Control 277
5.5 4 Axes Linear Interpolation Control
Linear interpolation control from the current stop position with 4 axes specified with the positioning command of the sequence
program is executed.
: Must be set, : Set if required
FIN acceleration/deceleration
Rapid Stop deceleration time
Interpolation control unit
Address/travel value
Repeat condition
Command speed
Auxiliary point
Starting angle
WAIT-ON/OFF
Central point
S-curve ratio
Program No.
Frequency
Dwell time
Amplitude
M-code
Radius
Axis
Skip
ABS-4 Absolute
4 © ¨ ¨ ¨ © © © © © © © © © © © ©
INC-4 Incremental
Processing details
Positioning control which starts and completes the 4 axes simultaneously is executed.
Ex.
4 axes linear interpolation
V
Travel value
Axis 1
t
V
Axis 2
t
V
Axis 3
t
V
Axis 4
t
Equal time
5 POSITIONING CONTROL
278 5.5 4 Axes Linear Interpolation Control
Program example
The program for performing 4 axes linear interpolation control of Axis 1, Axis 2, Axis 3, and Axis 4 is explained as an example.
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
5000
5000
Positioning using the servo program No.22
(Forward direction)
5
■ Positioning conditions
• Positioning conditions are shown below.
Item Servo Program No.
No.22
Positioning method Incremental data method
Positioning speed 10000
5 POSITIONING CONTROL
5.5 4 Axes Linear Interpolation Control 279
■ Operation timing
Operation timing for 4 axes linear interpolation control is shown below.
V
t
[Rq.1120] PLC ready flag
(M2000)
[Rq.1123] All axes servo ON
command (M2042)
[St.1045] All axes servo ON
accept flag (M2049)
Axis 1 [St.1075] Servo ready
(M2415)
Axis 2 [St.1075] Servo ready
(M2435)
Axis 3 [St.1075] Servo ready
(M2455)
Axis 4 [St.1075] Servo ready
(M2475)
[F10]
SET M2042 Turn on all axes servo ON command.
[G10]
X0*M2415*M2435*M2455*M2475 Wait until X0, Axis 1 servo ready, Axis 2 servo ready,
Axis 3 servo ready and Axis 4 servo ready turn on.
[K22]
INC-4 4 axes linear interpolation control
Axis 1, 5000pulse Axis used ...................... Axis 1, Axis 2, Axis 3, Axis 4
Axis 2, 3000pulse Axis 1.........5000[pulse]
Axis 3, 5000pulse Positioning address .... Axis 2.........3000[pulse]
Axis 4, 4000pulse Axis 3.........5000[pulse]
Speed 10000pulse/s Axis 4.........4000[pulse]
Command positioning speed
Vector speed ................................... 10000[pulse/s]
[G20]
!X0 Wait until X0 turn OFF after linear interpolation completion.
END
*1 Example of the above Motion SFC program is started using the automatic start or sequence program.
5 POSITIONING CONTROL
280 5.5 4 Axes Linear Interpolation Control
5.6 Auxiliary Point-Specified Circular Interpolation
Control
Circular interpolation control by specification of the end point address and auxiliary point address (a point on the arc) for
circular interpolation is executed.
Auxiliary point-specified circular uses ABS (Absolute data method) and INC (Incremental data method) servo
instructions.
: Must be set, : Set if required
FIN acceleration/deceleration
Rapid Stop deceleration time
Interpolation control unit
Address/travel value
Repeat condition
Command speed
Auxiliary point
Starting angle
WAIT-ON/OFF
Central point
S-curve ratio
Program No.
Frequency
Dwell time
Amplitude
M-code
Radius
Axis
Skip
ABS Absolute
2 © ¨ ¨ ¨ © © ¨ © © © © © © © © © © ©
INC Incremental
Processing details
■ Control using ABS (Absolute data method)
• Circular interpolation from the current stop address (address before positioning) based on the home position through the
specified auxiliary point address to the end point address is executed.
• The center of the arc is the point of intersection of the perpendicular bisectors of the start point address (current stop
address) to the auxiliary point address, and the auxiliary point address to the end point address.
Forward direction Operation by circular interpolation
End point address (X1, Y1)
5 POSITIONING CONTROL
5.6 Auxiliary Point-Specified Circular Interpolation Control 281
• The maximum arc radius is 232-1.
231-1
Maximum arc
-231 231-1
Radius R
Arc central point
Travel Y2
Travel
value to value to Auxiliary point X1
end point auxiliary
Arc central point
point X2
Reverse direction Travel value to
auxiliary point
Start point
Travel value to end point
Forward direction
Home position
• The setting range for the travel value to the end point address and auxiliary point address is 0 to (231-1).
• The maximum arc radius is 231-1. If the end point and auxiliary point are set more than a radius of 231-1, an error occurs at
the start and minor error (error code: 1A2AH) is stored in the data register.
231-1
Maximum arc
Arc central point
0
-231 231-1
Radius R
5 POSITIONING CONTROL
282 5.6 Auxiliary Point-Specified Circular Interpolation Control
Program example
The program for performing auxiliary point-specified circular interpolation control of Axis 1 and Axis 2 is explained as an
example.
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
■ Positioning details
The positioning uses the Axis 1 and Axis 2 servo motors.
The positioning by the Axis 1 and Axis 2 servo motors is shown in the diagram below.
Axis 2 positioning direction
(Forward direction)
Auxiliary point (40000, 50000)
■ Positioning conditions
• Positioning conditions are shown below.
Item Servo program No.
No.31
Positioning method Absolute data method
Positioning speed 1000
■ Operation timing
Operation timing for auxiliary point-specified circular interpolation control is shown below.
V
t
[Rq.1120] PLC ready flag
(M2000)
[Rq.1123] All axes servo ON
command (M2042)
[St.1045] All axes servo ON
accept flag (M2049)
Axis 1 [St.1075] Servo ready
(M2415)
Axis 2 [St.1075] Servo ready
(M2435)
Start command (X0)
5 POSITIONING CONTROL
5.6 Auxiliary Point-Specified Circular Interpolation Control 283
■ Motion SFC program
The Motion SFC program for executing the servo program (No. 31) for auxiliary point-specified circular interpolation control is
shown below.
[F10]
SET M2042 Turn on all axes servo ON command.
[G10]
X0*M2415*M2435 Waits until X0, Axis 1 servo ready and Axis 2 servo ready turn on.
[K31]
ABS Auxiliary point-specified circular interpolation control
Axis 1, 80000pulse Axis used .........................Axis 1, Axis 2
Axis 2, 30000pulse End point address......... Axis 1.........80000[pulse]
Speed 1000pulse/s Axis 2.........30000[pulse]
Auxiliary 1, 40000pulse Positioning speed ................................. 1000[pulse/s]
point Auxiliary point address ... Axis 1.........40000[pulse]
Auxiliary 2, 50000pulse Axis 2.........50000[pulse]
point
[G20]
!X0 Wait until X0 turn OFF after circular interpolation completion.
END
*1 Example of the above Motion SFC program is started using the automatic start or sequence program.
5 POSITIONING CONTROL
284 5.6 Auxiliary Point-Specified Circular Interpolation Control
5.7 Radius-Specified Circular Interpolation Control
Circular interpolation control by specification of the end point address and radius for circular interpolation is executed.
Radius-specified circular interpolation control uses ABS , ABS , ABS and ABS (Absolute data method) and INC
, INC , INC and INC (Incremental data method) servo instructions.
: Must be set, : Set if required
FIN acceleration/deceleration
Rapid Stop deceleration time
Interpolation control unit
Address/travel value
Repeat condition
Command speed
Auxiliary point
Starting angle
WAIT-ON/OFF
Central point
S-curve ratio
Program No.
Frequency
Dwell time
Amplitude
M-code
Radius
Axis
Skip
ABS
ABS
Absolute
ABS
ABS
2 © ¨ ¨ ¨ © © ¨ © © © © © © © © © © ©
INC
INC
Incremental
INC
INC
5 POSITIONING CONTROL
5.7 Radius-Specified Circular Interpolation Control 285
Processing details
Details for the servo instructions are shown in the table below.
Instruction Rotation direction of the servo Maximum controllable angle of arc Positioning path
motors
ABS Clockwise 0 < < 180
Positioning path
Start point End point
< 180
INC
Radius R
Central point
ABS Counter clockwise
Central point
Radius R
INC Start point < 180 End point
Positioning path
ABS Clockwise 180 < 360
Positioning path
Radius
Start point R End point
Positioning path
Start Radius R
point address Arc central point
(X0, Y0)
Reverse direction Forward direction
0
231-1
Maximum arc
-231 231-1
Radius R
Arc central point
5 POSITIONING CONTROL
286 5.7 Radius-Specified Circular Interpolation Control
■ Control using INC , INC , INC , INC (Incremental data method)
• Circular interpolation from the current stop address (0, 0) to the specified end point with specified radius.
• The center of the arc is the point of intersection of the perpendicular bisectors of the start point address (current stop
address) to the end address.
Forward direction
Circular interpolation path
Positioning speed
End point
Start Radius R
point Arc central point
231-1
Maximum arc
Arc central point
0
-231 231-1
Radius R
Program example
The program for performing radius-specified circular interpolation control of Axis 1 and Axis 2 is explained as an example.
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
5 POSITIONING CONTROL
5.7 Radius-Specified Circular Interpolation Control 287
■ Positioning conditions
• Positioning conditions are shown below.
Item Servo Program No.
No.41
Positioning method Absolute data method
Positioning speed 1000
■ Operation timing
Operation timing for radius-specified circular interpolation control is shown below.
V
t
[Rq.1120] PLC ready flag
(M2000)
[Rq.1123] All axes servo ON
command (M2042)
[St.1045] All axes servo ON
accept flag (M2049)
Axis 1 [St.1075] Servo ready
(M2415)
Axis 2 [St.1075] Servo ready
(M2435)
[F10]
SET M2042 Turn on all axes servo ON command.
[G10]
X0*M2415*M2435 Wait until X0, Axis 1 servo ready and Axis 2 servo ready turn on.
[K41]
ABS Radius specified-circular interpolation control
Axis 1, 100000pulse Axis used ...................... Axis 1, Axis 2
Axis 2, 50000pulse End point address....... Axis 1......... 100000[pulse]
Speed 1000pulse/s Axis 2......... 50000[pulse]
Radius 80000pulse Positioning speed .............................. 1000[pulse/s]
Radius ............................................... 80000[pulse]
[G20]
!X0 Wait until X0 turn OFF after circular interpolation completion.
END
*1 Example of the above Motion SFC program is started using the automatic start or sequence program.
5 POSITIONING CONTROL
288 5.7 Radius-Specified Circular Interpolation Control
5.8 Central Point-Specified Circular Interpolation
Control
Circular interpolation control by specification of the end point for circular interpolation and arc central point is executed.
Central point-specified circular interpolation control uses ABS and ABS (Absolute data method) and INC and INC
(Incremental data method) servo instructions.
: Must be set, : Set if required
FIN acceleration/deceleration
Rapid Stop deceleration time
Interpolation control unit
Address/travel value
Repeat condition
Command speed
Auxiliary point
Starting angle
WAIT-ON/OFF
Central point
S-curve ratio
Program No.
Frequency
Dwell time
Amplitude
M-code
Radius
Axis
Skip
ABS
Absolute
ABS
2 © ¨ ¨ ¨ © © ¨ © © © © © © © © © © ©
INC
Incremental
INC
Processing details
Details for the servo instructions are shown in the table below.
Instruction Rotation direction of the servo Maximum controllable angle of arc Positioning path
motors
ABS Clockwise 0 < < 360
Positioning path
Central point
INC
Start point 0 < < 360 End point
Positioning path
5 POSITIONING CONTROL
5.8 Central Point-Specified Circular Interpolation Control 289
■ Control using ABS , ABS (Absolute data method)
• Circular interpolation of an arc with a radius equivalent to the distance between the start point and central point, between
the current stop address (address before positioning) based on the home position and the specified end point address.
Operation by circular interpolation
Forward direction
End address (X1, Y1)
Positioning speed
Start Radius R
point address
(X0, Y0)
Reverse direction Forward direction
Arc central point
Reverse direction
*: Indicates setting data.
• Positioning control of a complete round is possible in the central point-specified circular interpolation control.
Forward direction
Circular interpolation control
Reverse direction
• Setting range of end point address and arc central point is (-231) to (231-1).
• The maximum arc radius is (232-1).
231-1
Maximum arc
-231 231-1
Radius R
Arc central point
End point
Positioning speed
Start
point
Reverse direction Forward direction
Home point Arc central point
Reverse direction
*: Indicates setting data.
5 POSITIONING CONTROL
290 5.8 Central Point-Specified Circular Interpolation Control
• Positioning control of a complete round is possible in the central point-specified circular interpolation control.
Forward direction
Circular interpolation control
Reverse direction
• Setting range of travel value to end point address and arc central point is 0 to (231-1).
• The maximum arc radius is (231-1). If the end point and central point are set more than a radius of (231-1), an error occurs
at the start and minor error (error code: 1A2FH) is stored in the data register.
231-1
5
Maximum arc
Arc central point
0
-231 231-1
Radius R
Program example
The program for performing central point-specified circular interpolation control of Axis 1 and Axis 2 is explained as an
example.
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
■ Positioning conditions
• Positioning conditions are shown below.
Item Servo Program No.
No.51
Positioning method Absolute data method
Positioning speed 1000
5 POSITIONING CONTROL
5.8 Central Point-Specified Circular Interpolation Control 291
■ Operation timing
Operation timing for central point-specified circular interpolation is shown below.
V
t
[Rq.1120] PLC ready flag
(M2000)
[Rq.1123] All axes servo ON
command (M2042)
[St.1045] All axes servo ON
accept flag (M2049)
Axis 1 [St.1075] Servo ready
(M2415)
Axis 2 [St.1075] Servo ready
(M2435)
[F10]
SET M2042 Turn on all axes servo ON command.
[G10]
X0*M2415*M2435 Wait until X0, Axis 1 servo ready and Axis 2 servo ready turn on.
[K51]
ABS Central point specified-circular interpolation control
Axis 1, 78541pulse Axis used .........................Axis 1, Axis 2
Axis 2, 30000pulse End point address......... Axis 1.........78541[pulse]
Speed 1000pulse/s Axis 2.........30000[pulse]
Central point 1, 45000pulse Positioning speed ................................. 1000[pulse/s]
Central point 2, 20000pulse Central point address ..... Axis 1.........45000[pulse]
Axis 2.........20000[pulse]
[G20]
!X0 Wait until X0 turn OFF after circular interpolation completion.
END
*1 Example of the above Motion SFC program is started using the automatic start or sequence program.
5 POSITIONING CONTROL
292 5.8 Central Point-Specified Circular Interpolation Control
5.9 Helical Interpolation Control
The linear interpolation control with linear axis is executed simultaneously while the circular interpolation specified with any 2
axes is executed, the specified number of pitches rotates spirally and performs the locus control to command position.
: Must be set, : Set if required
FIN acceleration/deceleration
Rapid Stop deceleration time
Interpolation control unit
Address/travel value
Repeat condition
Command speed
Auxiliary point
Starting angle
WAIT-ON/OFF
Central point
S-curve ratio
Program No.
Frequency
Dwell time
Amplitude
M-code
Radius
Axis
Skip
ABH
ABH
Absolute
ABH
ABH
© ¨ ¨ ¨ © © ¨ ¨ © © © © © © © © © ©
INH
INH
Incremental
INH
3
INH
ABH
Absolute
ABH
© ¨ ¨ ¨ © © ¨ ¨ © © © © © © © © © ©
INH
Incremental
INH
ABH Absolute
© ¨ ¨ ¨ © © ¨ ¨ © © © © © © © © © ©
INH Incremental
5 POSITIONING CONTROL
5.9 Helical Interpolation Control 293
Circular interpolation specified method by helical interpolation
The following method of circular interpolation is possible for the helical interpolation.
The specified method of circular interpolation connected start point and end point at the seeing on the plane for which
performs circular interpolation are as follows.
Servo instruction Positioning method Circular interpolation specified method
ABH Absolute Radius-specified method less than CW180
INH Incremental
ABH Absolute Radius-specified method less than CCW180
INH Incremental
ABH Absolute Radius-specified method CW180 or more.
INH Incremental
ABH Absolute Radius-specified method CCW180 or more.
INH Incremental
ABH Absolute Central point-specified method CW
INH Incremental
ABH Absolute Central point- specified method CCW
INH Incremental
ABH Absolute Auxiliary point-specified method
INH Incremental
Precautions
• When the travel value of linear axis is "0" is set, it can be controlled.
Condition Operation
Number of pitches is 0 Same control as normal circular interpolation control. (Allowable error range for circular interpolation can be set.)
Number of pitches is not 0 Linear interpolation to linear axis does not executed, circle for the number of pitches is drawn on the circle plane.
(Allowable error range for circular interpolation can be set.)
• Specified the speed which executes speed change by CHGV instruction during helical interpolation operation with the
vector speed of circular interpolation axis 2. If speed change is requested by specifying negative speed by CHGV
instruction during helical interpolation operation, deceleration starts from the time and it is possible to return to reverse
direction at the deceleration completion.
• If start point = end point, number of pitches = 1 and travel value of linear axis = 0, at the only central point-specified circular
interpolation, full circle can be drawn. When the address of "start point = end point" is set at the radius-specified helical
interpolation or auxiliary point-specified helical interpolation, a minor error (error code: 1A2BH) occurs at the start and
cannot be start.
• When the control unit is [degree] and the stroke limit is invalid, if the helical interpolation control is executed using absolute
data method, positioning in near direction to specified address based on the current value.
• Allowable error range for circular interpolation can be set.
5 POSITIONING CONTROL
294 5.9 Helical Interpolation Control
ABH , ABH , ABH , ABH Absolute radius-specified helical interpolation control
Processing details
The linear interpolation to other linear axis is executed performing 2 axes circular interpolation from current stop position (X0,
Y0, Z0) to specified circular end address (X1, Y1) or linear axis end point address (Z1), and the absolute helical interpolation is
executed so that it may become a spiral course.
It goes around on the specified circle for the specified number of pitches, the circular interpolation which had remainder
specified is executed, and positioning to end address is executed. The radius-specified circle specifies circular interpolation
method connected start point and end point at the seeing on the plane for which performs circular interpolation.
Operation details for absolute radius-specified helical interpolation are shown below.
Linear interpolation
travel value = Z1-Z0 Helical interpolation path
Positioning speed V1 5
Central
Number of pitches a angle
Radius R
Circular interpolation
plane
Start point (X0, Y0, Z0) Start point (X0, Y0)
Radius
Start point R End point
180 360
Positioning path
5 POSITIONING CONTROL
5.9 Helical Interpolation Control 295
• The setting range of end point address for the both of circular interpolation axis and linear interpolation axis is (-231) to (231-
1).
• The maximum arc radius on the circular interpolation plane is (231-1). For example, the maximum arc radius for electronic
gear 1:1 of unit [mm] is 214748364.7 [m].
231-1
Maximum arc
Arc central point
0
-231 231-1
Radius R
• Set the command speed with the vector speed for 2 axes circular interpolation axis.
• The command speed unit is specified in the parameter block.
• Set the number of pitches within the range of 0 to 999. If it is set outside the setting range, the minor error (error code:
1A36H) occurs, and cannot be started.
• All of the circular interpolation axis, linear axis and point address, command speed, radius (2 word data above) and number
of pitches (1 word data) are set indirectly by the word devices.
Program example
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
Absolute radius-specified
helical interpolation control
[F10]
SET M2042 Turn on all axes servo ON command.
[G10] Wait until X0, Axis 1 servo ready, Axis 2 servo ready, and
X0*M2415*M2435*M2455
Axis 3 servo ready turn on.
Absolute radius specified-circular helical interpolation
[K52]
ABH Axis for the circular interpolation ......... Axis 1, Axis 2
Axis 1, 100000pulse End point address of the Axis 1.........100000[pulse]
Axis 2, 50000pulse circular interpolation axis ................... Axis 2.........50000[pulse]
Linear axis 3, 25000pulse Linear axis for the circular
Speed 1000pulse/s interpolation and linear interpolation.... Axis 3
Number of pitches 100 End point address of the linear axis ....................... 25000[pulse]
Radius 60000pulse Positioning speed ..................................................... 1000[pulse/s]
Number of pitches .................................................... 100
Radius on a circular interpolation plane ................... 60000[pulse]
[G20]
!X0 Wait until X0 turn OFF after circular interpolation completion.
END
*1 Example of the above Motion SFC program is started using the automatic start or sequence program.
5 POSITIONING CONTROL
296 5.9 Helical Interpolation Control
INH , INH , INH , INH Incremental radius-specified helical interpolation control
Processing details
The linear interpolation to other linear axis is executed performing circular interpolation from current stop position (start point)
to specified circular relative end address (X1, Y1) or linear axis end point relative address (Z1), and the incremental helical
interpolation control is executed so that it may become a spiral course.
It goes around on the specified circle for the specified number of pitches, the circular interpolation which had remainder
specified is executed, and positioning to end address is executed. The radius-specified circle specifies circular interpolation
method connected start point and end point at the seeing on the plane for which performs circular interpolation.
Operation details for incremental radius-specified helical interpolation are shown below.
End point relative address (X1, Y1, Z1) Circular interpolation plane
End point relative address (X1, Y1)
Linear interpolation
travel value = Z1 Helical interpolation path
Positioning speed V1 5
Central
Number of pitches a angle
Radius R
Circular interpolation
plane
Start point Start point
Radius
Start point R End point
180 360
Positioning path
• The setting range of end point relative address for the both of circular interpolation axis and linear interpolation axis is 0 to
(231-1). The travel direction is set by the sign (+/ -) of the travel value, as follows:
Travel direction Description
Positive Positioning control to forward direction (Address increase direction)
Negative Positioning control to reverse direction (Address decrease direction)
5 POSITIONING CONTROL
5.9 Helical Interpolation Control 297
• The maximum arc radius on the circular interpolation plane is 231-1. For example, the maximum arc radius for electronic
gear 1:1 of unit [mm] is 214748364.7 [m].
231-1
Maximum arc
Arc central point
0
-231 231-1
Radius R
• Set the command speed with the vector speed for 2 axes circular interpolation axis.
• The command speed unit is specified in the parameter block.
• Set the number of pitches within the range of 0 to 999. If it is set outside the setting range, the minor error (error code:
1A36H) occurs and operation does not start.
• All of the circular interpolation axis, linear axis end point relative address, command speed, radius (2 word data above) and
number of pitches (1 word data) are set indirectly by the word devices.
Program example
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
Incremental radius-specified
helical interpolation control
[F10]
SET M2042 Turn on all axes servo ON command.
[G10] Wait until X0, Axis 1 servo ready, Axis 2 servo ready and
X0*M2415*M2435*M2455
Axis 3 servo ready turn on.
Incremental radius specified-circular helical interpolation
[K53]
INH Axis for the circular interpolation ......... Axis 1, Axis 2
Axis 1, 100000pulse End point relative address of Axis 1.........100000[pulse]
Axis 2, 50000pulse the circular interpolation axis ............. Axis 2.........50000[pulse]
Linear axis 3, 25000pulse Linear axis for the circular
Speed 1000pulse/s interpolation and linear interpolation.... Axis 3
Number of pitches 100 End point relative address of the linear axis........... 25000[pulse]
Radius 60000pulse Positioning speed ..................................................... 1000[pulse/s]
Number of pitches .................................................... 100
Radius on a circular interpolation plane ................... 60000[pulse]
[G20]
!X0 Wait until X0 turn OFF after circular interpolation completion
END
*1 Example of the above Motion SFC program is started using the automatic start or sequence program.
5 POSITIONING CONTROL
298 5.9 Helical Interpolation Control
ABH , ABH Absolute central point-specified helical interpolation control
Processing details
The linear interpolation to other linear axis is executed performing 2 axes circular interpolation from current stop position (X0,
Y0, Z0) to specified circular end address (X1, Y1) or linear axis end point address (Z1), and the absolute helical interpolation is
executed so that it may become a spiral course.
It goes around on the specified circle for the specified number of pitches, the circular interpolation which had remainder
specified is executed, and positioning to end address is executed. The central point-specified circle specifies circular
interpolation method connected start point and end point at the seeing on the plane for which performs circular interpolation.
Operation details for absolute central point-specified helical interpolation are shown below.
Linear interpolation
travel value = Z1-Z0 Helical interpolation path
Positioning speed V1 5
Number of pitches a Radius R
Circular interpolation Arc central point
plane address (X2, Y2)
Start point (X0, Y0, Z0) Start point (X0, Y0)
Central point
ABH Counter clockwise (CCW)
Central point
Central point- specified
helical interpolation CCW
Start point 0 < 360 End point
Positioning path
• The setting range of end point address for the both of circular interpolation axis and linear interpolation axis is (-231) to (231-
1).
• The setting range of central point address is (-231) to (231-1).
• The maximum arc radius on the circular interpolation plane is 231-1. For example, the maximum arc radius for electronic
gear 1:1 of unit [mm] is 214748364.7 [m].
231-1
Maximum arc
Arc central point
0
-231 231-1
Radius R
• Set the command speed with the vector speed for 2 axes circular interpolation axis.
• The command speed unit is specified in the parameter block.
• Set the number of pitches within the range of 0 to 999. If it is set outside the setting range, the minor error (error code:
1A36H) occurs and operation does not start.
5 POSITIONING CONTROL
5.9 Helical Interpolation Control 299
• All of the circular interpolation axis, linear axis end point address, command speed, radius (2 word data above) and number
of pitches (1 word data) are set indirectly by the word devices.
• If start point = end point, number of pitches = 1 and travel value of linear axis = 0, at the only central point-specified circular
interpolation, full circle can be drawn.
Program example
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
[F10]
SET M2042 Turn on all axes servo ON command.
[G10] Wait until X0, Axis 1 servo ready, Axis 2 servo ready and
X0*M2415*M2435*M2455
Axis 3 servo ready turn on.
Absolute central point-specified circular helical interpolation
[K55]
ABH Axis for the circular interpolation ......... Axis 1, Axis 2
Axis 1, 88541pulse End point address of the Axis 1.........88541[pulse]
Axis 2, 30000pulse circular interpolation axis ................... Axis 2.........30000[pulse]
Linear axis 3, 20000pulse Linear axis for the circular
Speed 1000pulse/s interpolation and linear interpolation.... Axis 3
Number of pitches 500 End point address of the linear axis ....................... 20000[pulse]
Ctr.P. 1, 45000pulse Positioning speed ..................................................... 1000[pulse/s]
Ctr.P. 2, 20000pulse Number of pitches .................................................... 500
Central point address of the arc .......... Axis 1.........45000[pulse]
Axis 2.........20000[pulse]
[G20]
!X0 Wait until X0 turn OFF after circular interpolation completion.
END
*1 Example of the above Motion SFC program is started using the automatic start or sequence program.
5 POSITIONING CONTROL
300 5.9 Helical Interpolation Control
INH , INH Incremental central point-specified helical interpolation control
Processing details
The linear interpolation to other linear axis is executed performing circular interpolation from current stop position (start point)
to specified circular relative end address (X1, Y1) or linear axis end point relative address (Z1), and the incremental helical
interpolation control is executed so that it may become a spiral course.
It goes around on the specified circle for the specified number of pitches, the circular interpolation which had remainder
specified is executed, and positioning to end address is executed. The central point-specified circle specifies circular
interpolation method connected start point and end point at the seeing on the plane for which performs circular interpolation.
Operation details for incremental central point-specified helical interpolation are shown below.
End point relative address (X1, Y1, Z1) Circular interpolation plane
End point relative address (X1, Y1)
Linear interpolation
travel value = Z1 Helical interpolation path
Positioning speed V1 5
Number of pitches a Radius R
Circular interpolation Arc central point
plane relative address (X2, Y2)
Start point Start point
Central point
Positioning path
• The setting range of end point relative address for the both of circular interpolation axis and linear interpolation axis is 0 to
(231-1).
• The setting range of central point relative is 0 to (231-1).
• The maximum arc radius on the circular interpolation plane is (231-1). For example, the maximum arc radius for electronic
gear 1:1 of unit [mm] is 214748364.7 [m].
231-1
Maximum arc
Arc central point
0
-231 231-1
Radius R
• Set the command speed with the vector speed for 2 axes circular interpolation axis.
• The command speed unit is specified in the parameter block.
• Set the number of pitches within the range of 0 to 999. If it is set outside the setting range, the minor error (error code:
1A36H) occurs and operation does not start.
5 POSITIONING CONTROL
5.9 Helical Interpolation Control 301
• All of the circular interpolation axis, linear axis end relative address, command speed, radius (2 word data above) and
number of pitches (1 word data) are set indirectly by the word devices.
• If start point = end point, number of pitches = 1 and travel value of linear axis = 0, at the only central point-specified circular
interpolation, full circle can be drawn.
Program example
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
[F10]
SET M2042 Turn on all axes servo ON command.
[G10] Wait until X0, Axis 1 servo ready, Axis 2 servo ready and
X0*M2415*M2435*M2455
Axis 3 servo ready turn on.
Incremental central point-specified helical interpolation control
[K56]
INH Axis for the circular interpolation ......... Axis 1, Axis 2
Axis 1, 88541pulse End point relative address of Axis 1.........88541[pulse]
Axis 2, 30000pulse the circular interpolation axis ............. Axis 2.........30000[pulse]
Linear axis 3, 20000pulse Linear axis for the circular
Speed 1000pulse/s interpolation and linear interpolation.... Axis 3
Number of pitches 500 End point relative address of the linear axis........... 20000[pulse]
Ctr.P. 1, 45000pulse Positioning speed ..................................................... 1000[pulse/s]
Ctr.P. 2, 20000pulse Number of pitches .................................................... 500
Central point relative address Axis 1.........45000[pulse]
of the arc ............................................. Axis 2.........20000[pulse]
[G20]
!X0 Wait until X0 turn OFF after circular interpolation completion.
END
*1 Example of the above Motion SFC program is started using the automatic start or sequence program.
5 POSITIONING CONTROL
302 5.9 Helical Interpolation Control
ABH Absolute auxiliary point-specified helical interpolation control
Processing details
The linear interpolation to other linear axis is executed performing 2 axes circular interpolation from current stop position (X0,
Y0, Z0) to specified circular end address (X1, Y1) or linear axis end point address (Z1), and the absolute helical interpolation is
executed so that it may become a spiral course.
It goes around on the specified circle for the specified number of pitches, the circular interpolation which had remainder
specified is executed, and positioning to end address is executed. The auxiliary point-specified circle specifies circular
interpolation method connected start point and end point at the seeing on the plane for which performs circular interpolation.
Operation details for absolute auxiliary point-specified helical interpolation are shown below.
Linear interpolation
travel value = Z1-Z0 Helical interpolation path
Positioning speed V1 5
Number of pitches a Radius R
Circular interpolation Arc auxiliary point
plane address (X2, Y2)
Start point (X0, Y0, Z0) Start point (X0, Y0)
• The setting range of end point address for the both of circular interpolation axis and linear interpolation axis is (-231) to (231-
1).
• The setting range of auxiliary point address is (-231) to (231-1).
• The maximum arc radius on the circular interpolation plane is 231-1. For example, the maximum arc radius for electronic
gear 1:1 of unit [mm] is 214748364.7 [m].
231-1
Maximum arc
Arc central point
0
-231 231-1
Radius R
• Set the command speed with the vector speed for 2 axes circular interpolation axis.
• The command speed unit is specified in the parameter block.
• Set the number of pitches within the range of 0 to 999. If it is set outside the setting range, the minor error (error code:
1A36H) occurs and operation does not start.
• All of the circular interpolation axis, linear axis end relative address, command speed, radius (2 word data above) and
number of pitches (1 word data) are set indirectly by the word devices.
5 POSITIONING CONTROL
5.9 Helical Interpolation Control 303
Program example
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
[F10]
SET M2042 Turn on all axes servo ON command.
[G10] Wait until X0, Axis 1 servo ready, Axis 2 servo ready and
X0*M2415*M2435*M2455
Axis 3 servo ready turn on.
Absolute auxiliary point-specified circular helical interpolation
[K60]
ABH Axis for the circular interpolation ......... Axis 1, Axis 2
Axis 1, 88541pulse End point address of the Axis 1.........88541[pulse]
Axis 2, 30000pulse circular interpolation axis ................... Axis 2.........30000[pulse]
Str.Ax. 3, 20000pulse Linear axis for the circular interpolation
Speed 1000pulse/s and linear interpolation ........................ Axis 3
Number of pitches 500 End point address of the linear axis ....................... 20000[pulse]
Aux.P. 1, 45000pulse Positioning speed ..................................................... 1000[pulse/s]
Aux.P. 2, 20000pulse Number of pitches .................................................... 500
Auxiliary point address of the arc ........ Axis 1.........45000[pulse]
Axis 2.........20000[pulse]
[G20]
!X0 Wait until X0 turn OFF after circular interpolation completion
END
*1 Example of the above Motion SFC program is started using the automatic start or sequence program.
5 POSITIONING CONTROL
304 5.9 Helical Interpolation Control
INH Incremental auxiliary point-specified helical interpolation control
Processing details
The linear interpolation to other linear axis is executed performing circular interpolation from current stop position (start point)
to specified circular relative end address (X1, Y1) or linear axis end point relative address (Z1), and the incremental helical
interpolation control is executed so that it may become a spiral course.
It goes around on the specified circle for the specified number of pitches, the circular interpolation which had remainder
specified is executed, and positioning to end address is executed. The auxiliary point-specified circle specifies circular
interpolation method connected start point and end point at the seeing on the plane for which performs circular interpolation.
Operation details for incremental auxiliary point-specified helical interpolation are shown below.
End point relative address (X1, Y1, Z1) Circular interpolation plane
End point relative address (X1, Y1)
Linear interpolation
travel value = Z1 Helical interpolation path
Positioning speed V1 5
Number of pitches a Radius R
Circular interpolation Arc auxiliary point
plane address (X2, Y2)
Start point Start point
• The setting range of end point relative address for the both of circular interpolation axis and linear interpolation axis is 0 to
(231-1).
• The setting range of auxiliary point relative is 0 to (231-1).
• The maximum arc radius on the circular interpolation plane is (231-1). For example, the maximum arc radius for electronic
gear 1:1 of unit [mm] is 214748364.7 [m].
231-1
Maximum arc
Arc central point
0
-231 231-1
Radius R
• Set the command speed with the vector speed for 2 axes circular interpolation axis.
• The command speed unit is specified in the parameter block.
• Set the number of pitches within the range of 0 to 999. If it is set outside the setting range, the minor error (error code:
1A36H) occurs and operation does not start.
• All of the circular interpolation axis, linear axis end point address, command speed, radius (2 word data above), and
number of pitches (1 word data) are set indirectly by the word devices.
5 POSITIONING CONTROL
5.9 Helical Interpolation Control 305
Program example
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
[F10]
SET M2042 Turn on all axes servo ON command.
[G10] Wait until X0, Axis 1 servo ready, Axis 2 servo ready and
X0*M2415*M2435*M2455
Axis 3 servo ready turn on.
Incremental auxiliary point-specified circular helical interpolation
[K61]
INH Axis for the circular interpolation ......... Axis 1, Axis 2
Axis 1, 88541pulse End point relative address of the Axis 1.........88541[pulse]
Axis 2, 30000pulse circular interpolation axis ................... Axis 2.........30000[pulse]
Str.Ax. 3, 20000pulse Linear axis for the circular
Speed 1000pulse/s interpolation and linear interpolation.... Axis 3
Number of pitches 500 End point relative address of the linear axis........... 20000[pulse]
Aux.P. 1, 45000pulse Positioning speed ..................................................... 1000[pulse/s]
Aux.P. 2, 20000pulse Number of pitches .................................................... 500
Auxiliary point relative address Axis 1.........45000[pulse]
of the arc ............................................. Axis 2.........20000[pulse]
[G20]
!X0 Wait until X0 turn OFF after circular interpolation completion.
END
*1 Example of the above Motion SFC program is started using the automatic start or sequence program.
5 POSITIONING CONTROL
306 5.9 Helical Interpolation Control
5.10 Axis Fixed-Pitch Feed Control
Positioning control for specified axis of specified travel value from the current stop point.
Fixed-pitch feed control uses the FEED-1servo instruction.
: Must be set, : Set if required
FIN acceleration/deceleration
Rapid Stop deceleration time
Interpolation control unit
Address/travel value
Repeat condition
Command speed
Auxiliary point
Starting angle
WAIT-ON/OFF
Central point
S-curve ratio
Program No.
Frequency
Dwell time
Amplitude
M-code
Radius
Axis
Skip
FEED-1 Incremental 1
Processing details
• Positioning control for the specified travel value from the current stop position "0" is executed.
• The travel direction is set by the sign (+/ -) of the travel value, as follows:
Travel direction Description
Positive Positioning control to forward direction (Address increase direction)
Negative Positioning control to reverse direction (Address decrease direction)
V
Fixed-pitch feed by FEED-1 instruction
Current stop position Command
speed
Reverse Forward
direction direction
Travel direction Travel direction
for negative sign for positive sign t
Travel value
Servo program
start
*: Indicates setting data.
Do not set the travel value to "0" for fixed-pitch feed control.
If the travel value is set to "0", fixed-pitch feed completion without fixed-pitch feed.
5 POSITIONING CONTROL
5.10 Axis Fixed-Pitch Feed Control 307
Precautions
The feed current value is changed to "0" at the start.
When fixed-pitch feed control is executed in the absolute position system, the feed current value that is restored when the
control circuit power supply of the servo amplifier or the Multiple CPU system power supply is turned ON again, may be
different from the feed current value before the power supply was turned ON again.
Program example
The program for repeating 1 axis fixed-pitch feed control of Axis 4 is explained as an example.
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
■ Operation timing
Operation timing for fixed-pitch feed control is shown below.
Servo program No.300
V
10000
t
Dwell 1 second Dwell 1 second Dwell 1 second
[Rq.1120] PLC ready flag
(M2000)
[Rq.1123] All axes servo ON
command (M2042)
[St.1045] All axes servo ON
accept flag (M2049)
Axis 4 [St.1075] Servo ready
(M2475)
5 POSITIONING CONTROL
308 5.10 Axis Fixed-Pitch Feed Control
■ Motion SFC program
The Motion SFC program for executing servo program (No. 300) for 1 axis fixed-pitch feed control is shown below.
[F10]
SET M2042 Turn on all axes servo ON command.
[G10]
X0*M2475 Wait until X0 and Axis 4 servo ready turn on.
P0
[K300]
FEED-1 1 axis fixed-pitch feed control
Axis 4, 80000pulse Axis used ....................Axis 4
Speed 10000pulse/s Travel value ................80000 [pulse]
Dwell 1000ms Command speed...........10000 [pulse/s]
Dwell.............................1000 [ms]
[G20]
X1 P0
After fixed-pitch feed completion, 5
PX001 is OFF: Fixed-pitch feed starts.
PX001 is ON : Motion SFC program ends.
[G30]
!X0*!X1 Wait until X0 and X1 turn OFF after fixed-pitch feed completion.
END
*1 Example of the above Motion SFC program is started using the automatic start or sequence program.
5 POSITIONING CONTROL
5.10 Axis Fixed-Pitch Feed Control 309
5.11 Fixed-Pitch Feed Control Using 2 Axes Linear
Interpolation
Fixed-pitch feed control using 2 axes linear interpolation from the current stop position with the specified 2 axes.
Fixed-pitch feed control using 2 axes linear interpolation uses the FEED-2 servo instruction.
: Must be set, : Set if required
FIN acceleration/deceleration
Rapid Stop deceleration time
Interpolation control unit
Address/travel value
Repeat condition
Command speed
Auxiliary point
Starting angle
WAIT-ON/OFF
Central point
S-curve ratio
Program No.
Frequency
Dwell time
Amplitude
M-code
Radius
Axis
Skip
FEED-2 Incremental 2
Processing details
• Positioning control from the current stop position "0" to the position which combined travel direction and travel value
specified with each axis is executed.
• The travel direction for each axis is set by the sign (+/ -) of the travel value for each axis, as follows:
Travel direction Description
Positive Positioning control to forward direction (Address increase direction)
Negative Positioning control to reverse direction (Address decrease direction)
V
Forward direction
Fixed-pitch feed by FEED-2 instruction
Command
speed
Y-axis t
travel value
Reverse Forward
Servo program
direction direction
start
Current stop
X-axis travel value
position *: Indicates setting data.
Reverse direction
Do not set the travel value to "0" for fixed-pitch feed control.
The following results if the travel value is set to "0":
• If the travel value of both is set to "0", fixed-pitch feed completion without fixed-pitch feed.
5 POSITIONING CONTROL
310 5.11 Fixed-Pitch Feed Control Using 2 Axes Linear Interpolation
Precautions
The feed current value is changed to "0" at the start.
When fixed-pitch feed control is executed in the absolute position system, the feed current value that is restored when the
control circuit power supply of the servo amplifier or the Multiple CPU system power supply is turned ON again, may be
different from the feed current value before the power supply was turned ON again.
Program example
The program for performing fixed-pitch feed control using 2 axes linear interpolation with Axis 2 and Axis 3 is explained as an
example.
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
■ Operation timing
Operation timing for fixed-pitch feed control using 2 axes linear interpolation is shown below.
Servo program No.310
V
10000
5 POSITIONING CONTROL
5.11 Fixed-Pitch Feed Control Using 2 Axes Linear Interpolation 311
■ Motion SFC program
The Motion SFC program for executing the servo program (No. 310) for fixed-pitch feed control using 2 axes linear
interpolation is shown below.
[F10]
SET M2042 Turn on all axes servo ON command.
[G10]
X0*M2435*M2455 Wait until X0, Axis 2 servo ready and Axis 3 servo ready turn on.
P0
[K310]
FEED-2 Fixed-pitch feed using 2 axes linear interpolation
Axis 2, 500000pulse Axis used ....................Axis 2, Axis 3
Axis 3, 300000pulse Travel value ............. Axis 2.........500000[pulse]
Speed 10000pulse/s Axis 3.........300000[pulse]
Positioning speed .........10000[pulse/s]
[G20] After fixed-pitch feed completion,
X0 P0
X0 is ON : Fixed-pitch feed start again.
X0 is OFF : Motion SFC program end.
END
*1 Example of the above Motion SFC program is started using the automatic start or sequence program.
5 POSITIONING CONTROL
312 5.11 Fixed-Pitch Feed Control Using 2 Axes Linear Interpolation
5.12 Fixed-Pitch Feed Control Using 3 Axes Linear
Interpolation
Fixed-pitch feed control using 3 axes linear interpolation from the current stop position with the specified 3 axes.
Fixed-pitch feed control using 3 axes linear interpolation uses the FEED-3 servo instruction.
: Must be set, : Set if required
FIN acceleration/deceleration
Rapid Stop deceleration time
Interpolation control unit
Address/travel value
Repeat condition
Command speed
Auxiliary point
Starting angle
WAIT-ON/OFF
Central point
S-curve ratio
Program No.
Frequency
Dwell time
Amplitude
M-code
Radius
Axis
Skip
FEED-3 Incremental 3 © ¨ ¨ ¨ © © © © © © © © © © © ©
Processing details
• Positioning control from the current stop position "0" to the position which combined travel direction and travel value
specified with each axis is executed.
• The travel direction for each axis is set by the sign (+/ -) of the travel value for each axis, as follows:
Travel direction Description
Positive travel value Positioning control to forward direction (Address increase direction)
Negative travel value Positioning control to reverse direction (Address decrease direction)
V
Forward direction
Fixed-pitch feed by FEED-3 instruction
Command
speed
Forward
direction
t
Y-axis
Z-axis travel value
travel value
Forward
Reverse Servo program
direction
direction start
X-axis travel value *: Indicates setting data.
Reverse Reverse direction
direction
Do not set the travel value to "0" for fixed-pitch feed control.
The following results if the travel value is set to "0":
• If the travel value of all axes are set to "0", fixed-pitch feed completion without fixed-pitch feed.
5 POSITIONING CONTROL
5.12 Fixed-Pitch Feed Control Using 3 Axes Linear Interpolation 313
Precautions
The feed current value is changed to "0" at the start. When fixed-pitch feed control is executed in the absolute position
system, the feed current value that is restored when the control circuit power supply of the servo amplifier or the Multiple CPU
system power supply is turned ON again, may be different from the feed current value before the power supply was turned
ON again.
Program example
The program for performing fixed-pitch feed control using 3 axes linear interpolation with Axis 1, Axis 2, and Axis 3 is
explained as an example.
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
■ Operation timing
Operation timing for fixed-pitch feed control using 3 axes linear interpolation is shown below.
Servo program No.320
V
1000
5 POSITIONING CONTROL
314 5.12 Fixed-Pitch Feed Control Using 3 Axes Linear Interpolation
■ Motion SFC program
The Motion SFC program for executing the servo program (No. 320) for fixed-pitch feed control using 3 axes linear
interpolation is shown below.
[F10]
SET M2042 Turn on all axes servo ON command.
[G10]
X0*M2415*M2435*M2455 Wait until X0, Axis 1 servo ready, Axis 2 servo ready and
Axis 3 servo ready turn on.
P0
[K320]
FEED-3 Fixed-pitch feed using 3 axes linear interpolation
Axis 1, 50000pulse Axis used ....................Axis 1, Axis 2, Axis 3
Axis 2, 40000pulse Axis 1.........50000[pulse]
Travel value ............. Axis 2.........40000[pulse]
Axis
Speed
3, 30000pulse
1000pulse/s Axis 3.........30000[pulse] 5
Positioning speed .........1000[pulse/s]
*1 Example of the above Motion SFC program is started using the automatic start or sequence program.
5 POSITIONING CONTROL
5.12 Fixed-Pitch Feed Control Using 3 Axes Linear Interpolation 315
5.13 Speed Control (I)
• Speed control for the specified axis is executed.
• Control includes positioning loops for control of servo amplifiers.
Refer to the speed-torque control for performing speed control that does not include positioning loops without
using the servo program. (Page 429 Speed-Torque Control)
• Speed control () uses the VF (Forward) and VR (Reverse) servo instructions.
: Must be set, : Set if required
FIN acceleration/deceleration
Rapid Stop deceleration time
Interpolation control unit
Address/travel value
Repeat condition
Command speed
Auxiliary point
Starting angle
WAIT-ON/OFF
Central point
S-curve ratio
Program No.
Frequency
Dwell time
Amplitude
M-code
Radius
Axis
Skip
VF
« 1 © ¨ ¨ © © © © © © © © © ©
VR
Processing details
• Controls the axis at the specified speed until the input of the stop command after starting of the servo motors.
Servo instruction Description
VF Forward direction start
VR Reverse direction start
• The operation of the feed current value during speed control is as follows depending on the status of the "[Rq.1152] Feed
current value update command (R: M34492+32n/Q: M3212+20n)".
Setting value Description
ON The feed current value is updated. The software stroke limit is valid.
OFF "0" is stored in the feed current value.
V
Stop command accept
Setting speed
Speed
control Operation speed
start
Stop
t
• Refer to the stop processing and restarting after stop for stop commands and stop processing during speed control.
(Page 260 Stop processing and restarting after stop)
5 POSITIONING CONTROL
316 5.13 Speed Control (I)
Precautions
• When "[Rq.1152] Feed current value update command (R: M34492+32n/Q: M3212+20n)" is OFF, the feed current value is
changed to "0". When speed control () is executed in the absolute position system, the feed current value that is restored
when the control circuit power supply of the servo amplifier or the Multiple CPU system power supply is turned ON again,
may be different from the feed current value before the power supply was turned ON again.
• The dwell time cannot be set.
Program example
The program for performing speed control () of Axis 1 is explained as an example.
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
■ Operation timing
Operation timing for speed control () is shown below.
Speed control by
servo program No.91
V Stop command accept
3000
5 POSITIONING CONTROL
5.13 Speed Control (I) 317
■ Motion SFC program
The Motion SFC program for executing the servo program (No. 91) for speed control () is shown below.
[F10]
SET M2042 Turn on all axes servo ON command.
[G10]
X0*M2415 Wait until X0 and Axis 1 servo ready turn on.
[K91]
VF Speed control (³) (Forward rotation)
Axis 1 Axis used ......................Axis 1
Speed 3000pulse/s Positioning speed .........3000 [pulse/s]
[G20]
!X0 Wait until X0 turns OFF after speed control (³) start.
[F20]
SET M3200 Turn on Axis 1 stop command.
[G30]
!M2001 Wait until Axis 1 start accept flag turn OFF.
[F30]
RST M3200 Turn OFF Axis 1 stop command.
END
*1 Example of the above Motion SFC program is started using the automatic start or sequence program.
5 POSITIONING CONTROL
318 5.13 Speed Control (I)
5.14 Speed Control (II)
• Speed control for the specified axis is executed.
• Speed control not includes positioning loops for control of servo amplifiers. It can be used for control, etc. so that it may not
become error excessive.
Refer to the speed-torque control for executing speed control that does not include positioning loops without
using the servo program. (Page 429 Speed-Torque Control)
• Speed control () uses the VVF (Forward) and VVR (Reverse) servo instructions.
: Must be set, : Set if required
FIN acceleration/deceleration
Rapid Stop deceleration time
Interpolation control unit
Address/travel value
Repeat condition
Command speed
Auxiliary point
Starting angle
WAIT-ON/OFF
Central point
S-curve ratio
Program No.
Frequency
Dwell time
Amplitude
M-code
Radius
Axis
Skip
VVF
« 1 © ¨ ¨ © © © © © © © © © © ©
VVR
Processing details
• Controls the axis at the specified speed until the input of the stop command after starting of the servo motors.
Servo instruction Description
VVF Forward direction start
VVR Reverse direction start
Precautions
• The feed current value is changed to "0" at the start. When speed control () is executed in the absolute position system,
the feed current value that is restored when the control circuit power supply of the servo amplifier or the Multiple CPU
system power supply is turned ON again, may be different from the feed current value before the power supply was turned
ON again.
• The dwell time cannot be set.
5 POSITIONING CONTROL
5.14 Speed Control (II) 319
Program example
The program for performing speed control () of Axis 3 is explained as an example.
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
■ Operation timing
Operation timing for speed control () is shown below.
Speed control by
servo program No.55
V Stop command accept
4000
5 POSITIONING CONTROL
320 5.14 Speed Control (II)
■ Motion SFC program
The Motion SFC program for executing the servo program (No. 55) for speed control () is shown below.
[F10]
SET M2042 Turn on all axes servo ON command.
[G10]
X0*M2455 Wait until X0 and Axis 3 servo ready turn on.
[K55]
VVF Speed control (´) (Forward rotation)
Axis 3 Axis used ......................Axis 3
Speed 4000pulse/s Positioning speed .........4000 [pulse/s]
[G20]
!X0 Wait until X0 turn OFF after speed control (´) start.
[F20]
SET M3240 Turn on Axis 3 stop command. 5
[G30]
!M2003 Wait until Axis 3 start accept flag turn OFF.
[F30]
RST M3240 Turn OFF Axis 3 stop command.
END
*1 Example of the above Motion SFC program is started using the automatic start or sequence program.
5 POSITIONING CONTROL
5.14 Speed Control (II) 321
5.15 Speed/Position Switching Control
Speed/position switching control start
Speed/position switching control for specified axis is executed.
Speed/position switching control uses the VPF (Forward rotation), VPR (Reverse rotation) and VPSTART (Re-start) servo
instructions.
: Must be set, : Set if required
FIN acceleration/deceleration
Rapid Stop deceleration time
Interpolation control unit
Address/travel value
Repeat condition
Command speed
Auxiliary point
Starting angle
WAIT-ON/OFF
Central point
S-curve ratio
Program No.
Frequency
Dwell time
Amplitude
M-code
Radius
Axis
Skip
VPF
« 1 © ¨ ¨ ¨ © © © © © © © © © © © ©
VPR
Processing details
• The speed control (including positioning loops) is executed after the start of the servo motor, and changes from speed
control to position control with the CHANGE (Speed/position switching) signal from external source, and then the specified
positioning travel value is executed.
Servo instruction Description
VPF Forward rotation direction (Address increase direction) start
VPR Reverse rotation direction (Address decrease direction) start
5 POSITIONING CONTROL
322 5.15 Speed/Position Switching Control
• The CHANGE signal from external source is effective during "[Rq.1145] Speed/position switching enable signal (R:
M34485+32n/Q: M3205+20n)" is on only. If "[Rq.1145] Speed/position switching enable signal (R: M34485+32n/Q:
M3205+20n)" turns on after the CHANGE signal turned on, it does not change from speed control to position control and
speed control is continued.
V Setting travel value
t
Speed Position
controlling controlling
"[Rq.1152] Feed current value update command (R: M34492+32n/Q: M3212+20n)" OFF
CHANGE input
Speed Position
controlling controlling
Speed Position
controlling controlling
5 POSITIONING CONTROL
5.15 Speed/Position Switching Control 323
If it is started with "[Rq.1152] Feed current value update command (R: M34492+32n/Q: M3212+20n)" on,
leave "[Rq.1152] Feed current value update command (R: M34492+32n/Q: M3212+20n)" on until positioning
control is completed.
If it is turns off during control, the feed current value cannot be guaranteed.
Ex.
Servo program which performs the speed control for axis 4 to the forward direction at speed 50000, and the position control of
the travel value set in D3000, D3001 after the CHANGE signal from external source turns on.
<K 11>
VPF
Axis 4, D3000 Indicates indirect specification of travel value
Speed 50000
• The travel value is stored in the data register for travel value change during speed control in the Motion SFC program.
When the CHANGE signal turns on, the contents of the data register for travel value change are set as the travel value.
Speed Position
V controlling controlling
t
Travel value
change possible ON
CHANGE signal input from external
OFF
source
Precautions
■ Item check at the CHANGE signal ON from external source
When the external CHANGE signal turns on, speed control switches to position control if the following conditions are met:
• "[St.1040] Start accept flag (R: M30080+n/Q: M2001+n)" is turning on.
• Speed control is executing after starting of the speed/position switching control.
• "[Rq.1145] Speed/position switching enable command (R: M34485+32n/Q: M3205+20n)" is turning on.
5 POSITIONING CONTROL
324 5.15 Speed/Position Switching Control
■ No speed control
Position control only is executed if "[Rq.1145] Speed/position switching enable command (R: M34485+32n/Q: M3205+20n)"
and CHANGE signal are turning on at the start. The "[Rq.1064] Speed controlling (R: M32404+32n/Q: M2404+20n)" does not
turn on.
Position control only is executed if "[Rq.1145] Speed/position
switching enable command (R: M34485+32n/Q: M3205+20n)"
and CHANGE signal are turning on at the start.
V
t
ON
[Rq.1145] Speed/position switching enable
OFF
command (R: M34485+32n/Q: M3205+20n)
ON
Speed switching signal input (CHANGE) OFF
ON
Servo program start OFF
t
ON
[Rq.1145] Speed/position switching enable
OFF
command (R: M34485+32n/Q: M3205+20n)
ON
Position switching signal input (CHANGE) OFF
ON
[St.1067] Error detection
OFF
(R: M32407+32n/Q: M2407+20n)
[St.1061] Positioning complete
OFF
(R: M32401+32n/Q: M2401+20n)
■ When "[Rq.1152] Feed current value update command (R: M34492+32n/Q: M3212+20n)" is
OFF
When "[Rq.1152] Feed current value update command (R: M34492+32n/Q: M3212+20n)" is OFF, the feed current value is
changed to "0" at the start. When speed-position switching control is executed in the absolute position system, the feed
current value that is restored when the control circuit power supply of the servo amplifier or the Multiple CPU system power
supply is turned ON again, may be different from the feed current value before the power supply was turned ON again.
5 POSITIONING CONTROL
5.15 Speed/Position Switching Control 325
Program example
The program for performing speed/position switching control of Axis 4 is explained as an example.
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
■ Positioning conditions
• Positioning conditions are shown below.
Item Positioning conditions
Servo program No. 101
Control axis Axis 4
Travel value for positioning control 40000
Command speed 1000
■ Operation timing
Operation timing for speed/position switching control is shown below.
: Speed control
V Servo program No.101 : Position control
t
1 second 1 second
[Rq.1120] PLC ready flag (M2000)
5 POSITIONING CONTROL
326 5.15 Speed/Position Switching Control
■ Motion SFC program
The Motion SFC program for executing the servo program (No. 101) for speed-position switching control is shown below.
[F10]
SET M2042 Turn on all axes servo ON command.
[G10]
X0*M2475 Wait until X0 and Axis 4 servo ready turn on.
[F20]
SET M3265 Axis 4 speed/position switching enable command ON.
[K101]
VPF Speed/position switching control
Axis 4, 40000pulse Axis used ....................Axis 4
Speed 1000pulse/s Travel value ................40000[pulse]
Dwell 1000ms Command speed ..........1000[pulse/s]
Dwell.............................1000ms
[G20]
M2465 Axis 4 speed/position switching latch
5
[F30]
RST M3265 Axis 4 speed/position switching enable command OFF
[G30]
!X0*M2461 Wait until positioning completion and X0 turn OFF.
END
*: Shift transition is used to transit into the next processing during the positioning.
*1 Example of the above Motion SFC program is started using the automatic start or sequence program.
5 POSITIONING CONTROL
5.15 Speed/Position Switching Control 327
Re-starting after stop during control
Re-starting (continuing) after stop with stop command during speed/position switching control is executed.
Re-starting uses VPSTART servo instruction.
: Must be set, : Set if required
FIN acceleration/deceleration
Rapid Stop deceleration time
Interpolation control unit
Address/travel value
Repeat condition
Command speed
Auxiliary point
Starting angle
WAIT-ON/OFF
Central point
S-curve ratio
Program No.
Frequency
Dwell time
Amplitude
M-code
Radius
Axis
Skip
VPSTART Incremental 1 ¨
Processing details
• The continuous control after stop during speed control is executed, after speed/position switching control start.
• Re-starting using the VPSTART is effective by stop during speed control or position control.
• Re-starts with the speed control at the stop during speed control, then switches to position control by turning on the CHANGE signal. The control contents
after re-starting are same as the speed/position switching control. (Page 322 Speed/position switching control start)
t
Speed Position
controlling controlling
[Rq.1145] Speed/position switching enable
CHANGE signal valid
signal (R: M34485+32n/Q: M3205+20n)
ON
[Rq.1145] Speed/position switching enable
OFF
command (R: M34485+32n/Q: M3205+20n)
5 POSITIONING CONTROL
328 5.15 Speed/Position Switching Control
• If the stop occurred during position control, re-start with position, and the positioning control of setting travel value. The travel value after the re-start is
calculated as follows:
Travel value after re-start (P2) = Setting travel value (P) - Travel value before stop (P1)
Speed/position Restart
switching P1 Stop P2
control start
t
Speed Position control Position
Servo program start control control
VPF/VPR instruction
VPSTART instruction
• It controls at the speed stored at the VPF/VPR instruction execution in the re-starting. Therefore, even if the speed change
before stop during control, it becomes the speed at the VPF/VPR instruction execution.
V
Speed change Operation speed CHANGE signal ON
Setting speed
Stop command
Restart
t
Speed control Speed Position
control control
Program example
The program for performing restarting after stop during control with the speed/position switching control of Axis 4 is explained
as an example.
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
■ Positioning conditions
• Positioning conditions are shown below.
Item Positioning conditions
Speed/position switching control Restart
Servo program No. 101 102
Control axis Axis 4 Axis 4
Travel value for positioning control 40000
Command speed 1000
5 POSITIONING CONTROL
5.15 Speed/Position Switching Control 329
■ Operation timing
Operation timing for speed/position switching control and re-starting are shown below.
5 POSITIONING CONTROL
330 5.15 Speed/Position Switching Control
■ Motion SFC program
The Motion SFC program for executing the servo programs (No. 101 and No. 102) for re-starting after stop during control is
shown below.
[F10]
SET M2042 Turn on all axes servo ON command.
[G10]
X0*M2475 Wait until X0 and Axis 4 servo ready turn on.
[F20]
SET M3265 Axis 4 speed/position switching enable command ON
[K101]
VPF Speed/position switching control for Axis 4
Axis 4, 40000pulse Axis used ....................Axis 4
Speed 1000pulse/s Travel value ................40000[pulse]
[G20]
Command speed ..........1000[pulse/s]
Axis 4 stop command ON with X2 ON.
5
SET M3260=X2
Speed/position switching enable command OFF with axis 4
RST M3265=M2465
speed/position switching latch ON.
!M2004
Axis 4 start accept flag OFF.
[G30]
M3260 End with stop
due to error.
[G40]
X1 Wait until X1 turn on. END
[F30]
RST M3260 Axis 4 stop command OFF
[K102]
VPSTART Re-start
Axis 4 Axis used ......................Axis4
[G60] Wait until X0, X1 and X2 turn off with re-starting after stop
!X0*!X1*!X2
during speed-position switching control.
END
*1 Example of the above Motion SFC program is started using the automatic start or sequence program.
5 POSITIONING CONTROL
5.15 Speed/Position Switching Control 331
5.16 Speed Control with Fixed Position Stop
Speed control with fixed position stop of the specified axis is executed.
Speed control with fixed position stop is started using the PVF (forward rotation) or PVR (reverse rotation) of servo program
instruction.
: Must be set, : Set if required
FIN acceleration/deceleration
Rapid Stop deceleration time
Interpolation control unit
Address/travel value
Repeat condition
Command speed
Auxiliary point
Starting angle
WAIT-ON/OFF
Central point
S-curve ratio
Program No.
Frequency
Dwell time
Amplitude
M-code
Radius
Axis
Skip
PVF
Absolute 1 © ¨ ¨ ¨ © © © © © © © © © © ¨ ¨
PVR
Processing details
• After starting of servo motor, control at the specified speed is executed until the fixed position stop command turns on.
Servo instruction Description
PVF Forward rotation direction (Address increase direction) start
PVR Reverse rotation direction (Address decrease direction) start
• When the fixed position stop command turns on, a positioning control to the specified address is executed.
[Positioning address: 180.00000 [degree]]
359.99999[degree]
ON
Servo program start OFF
ON
Fixed position stopcommand
OFF
device
• It can be controlled in the axis which "control unit is [degree] and stroke limit is invalid ("upper stroke limit value" equal to
"lower stroke limit value")". If it is started for axis which "control unit is except [degree] or stroke limit is not invalid", a minor
error (error code: 19EAH) occurs and it does not start.
• Address setting range is 0 to 35999999 (0 to 359.99999 [degree]) in the indirect setting of positioning address. If it is set
outside the setting range, a minor error (error code: 1A31H) occurs and it does not start. Positioning address is input at the
program start.
5 POSITIONING CONTROL
332 5.16 Speed Control with Fixed Position Stop
• It is controlled in the fixed position stop acceleration/deceleration time set in the servo program at positioning start, speed
change request (CHGV) and fixed position stop command ON. The fixed acceleration/deceleration time method is used as
an acceleration/deceleration processing in this case.
• The setting range of fixed position stop acceleration/deceleration time is 1 to 8388608 [ms].
• In the case of indirect setting, the fixed position stop acceleration/deceleration time is input in the following timing.
• Positioning start
• Speed change request (CHGV)
• Fixed position stop command ON
• When the positioning to specified address completes, the "[St.1061] Positioning complete (R: M32401+32n/Q:
M2401+20n)" turns on. It does not turn on at the time of stop by the "[Rq.1140] Stop command (R: M34480+32n/Q:
M3200+20n)" / "[Rq.1141] Rapid stop command (R: M34481+32n/Q: M3201+20n)". The "[St.1061] Positioning complete
(R: M32401+32n/Q: M2401+20n)" turns off at leading edge of "[Rq.1144] Complete signal OFF command (R: M34484+32n/
Q: M3204+20n)" or positioning start.
• Prior to turning ON the fixed position stop command device, speed change can be executed any number of times by the
speed change request (CHGV) instruction during operation. The speed change request (CHGV) instruction is disabled after
the fixed position stop command device turns ON. If the fixed position stop device turns ON while changing the speed by
5
the speed change request (CHGV) instruction, the acceleration/deceleration is stopped and positioning is performed for the
specified address using the speed at that time.
Change value by speed
V change request (CHGV).
t
a b c d
5 POSITIONING CONTROL
5.16 Speed Control with Fixed Position Stop 333
• When speed control with fixed position stop is started with the fixed position stop command turned ON, or when the fixed
position stop command is turned ON after a speed change to "0", positioning is executed at the speed that was specified by
the speed limit value.
Program example
The program for performing speed control with fixed position stop of Axis 1 is explained as an example.
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
■ Positioning conditions
• Speed control with fixed position stop conditions are shown below.
Item Setting
Servo program No. 55
Start direction Forward
Control axis Axis 1
Positioning address 120.00000 [degree]
Control speed 30000 [degree/min]
Acceleration/deceleration time 20 ms
Fixed position stop command device M100
• Speed control with fixed position stop start command: X0 Leading edge (OFF ON)
• Speed control with fixed position stop command: X0 Trailing edge (ON OFF)
■ Operation timing
Operation timing for speed control with fixed position stop is shown below.
Stop command of speed control
with fixed position stop
(X0 Leading edge)
359.99999[degree]
20[ms]
ON
[Rq.1120] PLC ready flag (M2000) OFF
ON
[Rq.1123] All axes servo ON
command (M2042) OFF
ON
[St.1045] All axes servo ON accept
flag (M2049) OFF
ON
Axis 1 [St.1075] Servo ready
(M2415) OFF
ON
Start command (X0) OFF
ON
Servo program start OFF
ON
Axis 1 [St.1040] Start accept flag
(M2001) OFF
ON
Fixed position stop command
device (M100) OFF
ON
Axis 1 [St.1061] Positioning
complete (M2401) OFF
ON
Axis 1 [Rq.1144] Complete signal
OFF command (M3204) OFF
ON
Axis 1 [St.1063] Command
in-position (M2403) OFF
5 POSITIONING CONTROL
334 5.16 Speed Control with Fixed Position Stop
■ Motion SFC program
The Motion SFC program for executing the servo program (No. 55) for speed control with fixed position stop is shown below.
[F10]
SET M2042 Turn on all axes servo ON command.
[G10]
X0*M2415 Wait until X0, Axis 1 servo ready turn on.
[K55]
PVF Fixed position stop with speed control start
Axis 1, 120.00000degree Axis used.................................. Axis 1
Speed 30000.000degree/min Stop position............................. 120.00000[degree]
Accel./decel. time 20ms Speed ......................................... 30000.000[degree/min]
Fixed position stop M100 Accel./decel. time ....................... 20[ms]
Fixed position stop command..... M100
[G20]
!X0 Wait until X0 turn OFF after speed control with fixed position stop start.
[F20]
5
SET M100 Turn on fixed position stop command.
[G30]
!M2001 Wait until Axis 1 start accept flag turn OFF.
[F30]
RST M100 Turn OFF fixed position stop command.
END
*1 Example of the above Motion SFC program is started using the automatic start or sequence program.
5 POSITIONING CONTROL
5.16 Speed Control with Fixed Position Stop 335
5.17 Continuous Trajectory Control
• Positioning to the pass point beforehand set by one starting is executed with the specified positioning method and
positioning speed.
• The positioning method and positioning speed can be changed for each pass point.
• The following parameters is set in the servo program.
• Pass point
• Positioning method from any pass point to the next pass point.
• Positioning speed from any pass point to the next pass point.
• Repetition control between any pass points can be performed by using repetition instructions.
• M-codes and torque limit values can be changed at each speed-switching point.
• 1 to 4 axes can be controlled.
<K 1>
Point
Set the continuous trajectory 4 CPSTART2
control axis and speed Axis 2
Axis 3
Speed 10000 [pulse/s]
1 ABS-2
Set each pass point
Axis 2, 40000 [pulse]
Set the positioning method Axis 3, 60000 [pulse]
2 ABS-2
Set the positioning address Axis 2, 60000 [pulse]
(travel value) Axis 3, 60000 [pulse]
Speed 15000 [pulse/s]
Set the speed-switching 3 ABS-2
Axis 2, 100000 [pulse]
Axis 3, 80000 [pulse]
4 CPEND
NO
All pass points are set?
YES
End
5 POSITIONING CONTROL
336 5.17 Continuous Trajectory Control
Operation timing
Operation timing for continuous trajectory control is shown below.
80000 P3
P1
60000 P2
Set
speed
10000
t
0
5 POSITIONING CONTROL
5.17 Continuous Trajectory Control 337
Caution
• The number of control axes cannot be changed during control.
• The pass point can be specified the absolute data method (ABS) and incremental method (INC) by mixed use.
• The pass point can also be specified an address which change in travel direction. The acceleration processing at a pass
point is executed for 1 axis continuous trajectory control. However, the acceleration/deceleration processing at a pass point
is not executed for 2 to 4 axes continuous trajectory control, so be careful of the servo error occurrence, etc.
• When the FIN acceleration/deceleration is not set in the program with only one pass point, this operation is the same as
PTP control.
• Speed change is possible after the start. Note the following points at the speed change.
• The central point-specified circular interpolation is included the continuous trajectory control.
When the arc path calculated from the start address and central-point address is differ (within the allowable error range for circular interpolation) from the
setting end address, if the speed is changed, error compensation (Page 235 Allowable error range for circular interpolation) may not function normally.
When the central point-specified circular interpolation as positioning method is used at the continuous trajectory control, set the start address, central point
address and end address becomes arc correctly.
• The speed switching and change speed by CHGV instruction are executed toward the same program in the servo program.
The lower of the speed change by CHGV instructions and the command speed in the servo program is selected.
The speed change by CHGV instructions are executed if the speed is lower than the speed set in the servo program; otherwise the CHGV instructions are
not executed.
(1) Change speed by CHGV instruction > command speed in the servo program
The command speed in the servo program is selected.
V
Command speed in the servo program
Speed change by CHGV instruction
Speed change to command speed in the servo program
(2) Change speed by CHGV instruction < command speed in the servo program
The change speed by CHGV instructions is effective.
V Speed change by command speed in the servo program
(Speed set by the CHGV instructions is valid)
t
Speed change by CHGV instructions
(Speed does not change due to more than command speed in the servo program.)
• An overrun occurs if the distance remaining to the final positioning point when the final positioning point is detected is less
than the deceleration distance at the positioning speed after the start (command speed). The minor error (error code:
1A58H) is stored in the "[Md.1004] Error code (R: D32007+48n/Q: D7+20n)" for each axis.
• If positioning to outside the stroke limit range is executed after the start, the minor error (error code: 1A18H, 1A1AH) is
stored in the "[Md.1004] Error code (R: D32007+48n/Q: D7+20n)" for each axis and a deceleration stop is executed.
• The minimum travel value between continuous trajectory control pass points is shown below:
Positioning speed drops if the distance between pass points is short the minimum travel value.
Command speed per second (control unit/s) Main cycle [s] < Travel distance [control unit]
Ex.
Main cycle: 20 [ms], Command speed: 600 [mm/min]
If the command speed (600 [mm/min]) is divided by 60, the command speed per second is 10 [mm/s], and the main cycle is
0.02 [s].
Therefore, the travel distance is as follow.
10 [mm/s] 0.02 [s] = 0.2 [mm]
Set the travel distance to more than 0.2 [mm].
5 POSITIONING CONTROL
338 5.17 Continuous Trajectory Control
Specification of pass points by repetition instructions
This section describes the method of the pass points for which executes between any pass points repeatedly.
: Must be set, : Set if required
FIN acceleration/deceleration
Rapid Stop deceleration time
Interpolation control unit
5
Address/travel value
Repeat condition
Command speed
Auxiliary point
Starting angle
WAIT-ON/OFF
Central point
S-curve ratio
Program No.
Frequency
Dwell time
Amplitude
M-code
Radius
Axis
Skip
FOR-TIMES
FOR-ON
FOR-OFF
NEXT
Processing details
The first of repetition range is set by the following instructions.
5 POSITIONING CONTROL
5.17 Continuous Trajectory Control 339
■ Repetition control operation
The repetition control operation using FOR-TIMES, FOR-ON and FOR-OFF is shown below.
[Servo program]
<K 701>
CPSTART2
Axis 1
Axis 2
Speed 1000
ABS-2
Axis 1, 40000
Axis 2, 20000
(1)
(2)
INC-2
Axis 1, 30000
Axis 2, 0
INC-2 (3)
Axis 1, 20000
Axis 2, 20000
NEXT
CPEND
(1) (2)
Condition 1 Condition 2 Condition 3
FOR-TIMES K1 K2 K3
FOR-ON X010 ON during first positioning (3) X010 ON during second positioning (3) X010 ON during third positioning (3)
FOR-OFF X011 OFF during first positioning (3) X011 OFF during second positioning (3) X011 OFF during third positioning (3)
Operation in condition 2
Axis 1
0 100000 200000
Precautions
• During a FOR-ON loop, or a FOR-OFF loop, if the travel value of the specified pass point is smaller than the travel value of
one operation cycle shown below, it will not loop-out even when trigger conditions are satisfied. To perform a loop-out,
make the travel value of the pass point larger than the travel value of one operation cycle, or set a smaller speed command.
The travel value for which positioning is completed in one operation cycle is shown below.
Travel value of one operation cycle [control unit] = Command speed per second [control unit/s] Operation cycle [s]
Ex.
Command speed: 100.00 [mm/min], Operation cycle: 0.444 [ms]
100
[mm/s] × 0.444 [ms] = 0.74 [μm]
60
If the travel value of the pass point exceeds 0.74 [m], it will loop-out normally.
5 POSITIONING CONTROL
340 5.17 Continuous Trajectory Control
• During a FOR-ON loop, or a FOR-OFF loop, if the time from satisfaction of trigger conditions until reaching end point of the
loop is shorter than the indicated time below, positioning operations are not normal. Set the trigger conditions so that the
time from satisfaction of trigger conditions until reaching end point of the loop is longer than the indicated time below.
Time required from satisfaction of trigger conditions until reaching end point of the loop = Main cycle + Time required for
deceleration stop
• At the end positioning address detection, an overrun occurs if the deceleration distance is insufficient for the output speed,
and a minor error (error code: 1A58H) occurs. If the end point has a movement amount 0, a minor error does not occur.
Program example
The program for repeating continuous trajectory control of Axis 2 and Axis 3 is explained as an example.
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
■ Positioning conditions
• Continuous trajectory control conditions are shown below. 5
Item Setting
Servo program No. 510
Control axis Axis 2, Axis 3
Positioning speed 10000
■ Operation timing
Operation timing for continuous trajectory control is shown below.
Axis 3 positioning direction
100000
80000
60000
40000
Radius
20000 20000
Axis 2
0 50000 100000 150000 200000 positioning
V direction
1000
Vector speed
5 POSITIONING CONTROL
5.17 Continuous Trajectory Control 341
■ Motion SFC program
The Motion SFC program for executing the servo program (No.510) for continuous trajectory control is shown below.
[F10]
SET M2042 Turn on all axes servo ON command.
[G10]
X0*M2435*M2455 Wait until X0, Axis 2 servo ready and Axis 3 servo ready turn on.
[K510]
CPSTART2 Start continuous trajectory control
Axis 2 Axis used ......................Axis 2, Axis 3
Axis 3
Speed 10000pulse/s Positioning speed .........10000 [pulse/s]
ABS-2 2 axes linear interpolation control (Absolute data method)
Axis 2, 40000pulse Axis used ....................Axis 2, Axis 3
Axis 3, 20000pulse End address ............... Axis 2.........40000 [pulse]
FOR-TIMES Axis 3.........20000 [pulse]
K 4 Number of repetitions 4
INC-2 Pass point setting
Axis 2, 30000pulse Positioning 2 axes linear Radius-specified
Axis 3, 0pulse method interpolation circular interpolation
INC Travel Axis 2 30000[pulse] 20000[pulse]
Axis 2, 20000pulse value Axis 3 0[pulse] 20000[pulse]
Axis 3, 20000pulse
Radius 20000pulse
NEXT End repetition region
CPEND End continuous trajectory control
[G20]
!X0 Wait until X0 turns OFF after continuous trajectory control completion.
END
*1 Example of the above Motion SFC program is started using the automatic start or sequence program.
5 POSITIONING CONTROL
342 5.17 Continuous Trajectory Control
Speed-switching by instruction execution
The speed can be specified for each pass point during the continuous trajectory control instruction.
The speed change from a point can be specified directly or indirectly in the servo program.
Precautions
• The speed switching during servo instruction is possible at the continuous trajectory control for 1 to 4 axes.
• The speed command can be set for point.
• By turning on the "[Rq.1122] Speed-switching point specified flag (R: M30040/Q: M2040)" before the start, the point which
completes speed change can be specified. The speed change timing at the flag ON/OFF.
[Rq.1122] Speed-switching point specified flag Details
(R: M30040/Q: M2040)
OFF The speed change starts with the specified speed-switching point.
V
Speed change complete point
5
Speed change
start point
t
Speed-switching specified point (position)
Speed change
start point
t
Speed-switching specified point (position)
5 POSITIONING CONTROL
5.17 Continuous Trajectory Control 343
Program example
The program for switching speed of Axis 1 and Axis 2 by turning ON "[Rq.1122] Speed-switching point specified flag (M2040)"
during the continuous trajectory control instruction is explained as an example.
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
■ Positioning conditions
• Speed switching conditions are shown below.
Item Setting
Servo program No. 310
Positioning speed 10000 15000
Positioning method 2 axes linear interpolation Central point-specified 2 axes linear interpolation 2 axes linear interpolation
circular interpolation
Pass point Axis 1 20000 30000 40000 50000
Axis 2 10000 20000 25000 40000
• The continuous trajectory control start command for speed switching: X0 Leading edge (OFF ON)
P3
P2
20000
P1
Central
point
Axis 1 positioning
0 20000 40000 direction
V Axis 1 positioning
15000 direction
10000
5 POSITIONING CONTROL
344 5.17 Continuous Trajectory Control
■ Motion SFC program
The Motion SFC program for executing the servo program (No. 310) for speed switching during instruction is shown below.
Speed-switching during
instruction execution
[F10]
SET M2042 Turn on all axes servo ON command.
[G10]
X0*M2415*M2435 Wait until X0, Axis 1 servo ready and Axis 2 servo ready turn ON.
[F20]
SET M2040=X10 Speed-switching point specified flag turn ON when X10 turn ON.
RST M2040=!X10 Speed-switching point specified flag turn OFF when X10 turn OFF.
[K310]
CPSTART2
Axis 1
Axis 2
Speed 10000pulse/s
ABS-2 Set P1 5
Axis 1, 20000pulse
Axis 2, 10000pulse
ABS Set P2
Axis 1, 30000pulse
Axis 2, 20000pulse
Center 1, 30000pulse
Center 2, 10000pulse
ABS-2 Set P3
Axis 1, 40000pulse
Axis 2, 25000pulse
Speed 15000pulse/s Speed change
ABS-2 Set P4
Axis 1, 50000pulse
Axis 2, 40000pulse
CPEND
[G20]
!X0 Wait until X0 turn OFF after continuous trajectory control completion.
END
*1 Example of the above Motion SFC program is started using the automatic start or sequence program.
5 POSITIONING CONTROL
5.17 Continuous Trajectory Control 345
1 axis continuous trajectory control
Continuous trajectory control for 1 axis.
: Must be set, : Set if required
FIN acceleration/deceleration
Rapid Stop deceleration time
Interpolation control unit
Address/travel value
Repeat condition
Command speed
Auxiliary point
Starting angle
WAIT-ON/OFF
Central point
S-curve ratio
Program No.
Frequency
Dwell time
Amplitude
M-code
Radius
Axis
Skip
End Start
CPSTART1 1
CPEND
Pass point
ABS-1 Absolute 1
INC-1 Incremental 1
Processing details
■ Start and end for 1 axis continuous trajectory control
1 axis continuous trajectory control is started and ended by the following instructions:
Instruction Description
CPSTART1 Starts the 1 axis continuous trajectory control.
Sets the axis No. and command speed.
CPEND Ends the 1 axis continuous trajectory control for CPSTART1.
5 POSITIONING CONTROL
346 5.17 Continuous Trajectory Control
Program example
The program for repeating 1 axis continuous trajectory control of Axis 4 is explained as an example.
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
■ Positioning conditions
• Continuous trajectory control conditions are shown below.
Item Setting
Servo program No. 500
Control axis Axis 4
Positioning speed 10000
Number of repetitions 100
Pass point travel value P1 -1000
P2 2000
P3 -2000
P4 1000 5
• Continuous trajectory control start command: X0 Leading edge (OFF ON)
Return
100
Out
Return
3
Out
Return
2
Out
Return
1
Out
Address
-1000 0 1000
■ Operation timing
Operation timing for servo program No.500 is shown below.
V P1 P2 P3 P2 P3 P4
10000
-10000
5 POSITIONING CONTROL
5.17 Continuous Trajectory Control 347
■ Motion SFC program
The Motion SFC program for executing the servo program (No. 500) for 1 axis continuous trajectory control is shown below.
[F10]
SET M2042 Turn on all axes servo ON command.
[G10]
X0*M2475 Wait until X0 and Axis 4 servo ready turn ON.
[K500]
CPSTART1 Start continuous trajectory control
Axis 4 Axis used ...................................Axis 4
Speed 10000pulse/s Positioning speed ......................10000 [pulse/s]
INC-1 1 axis linear positioning control
Axis 4, -1000pulse Axis used .................................Axis 4
FOR-TIMES Travel value to pass point........-1000 [pulse]
K 100 Number of repetitions 100
INC-1 1 axis linear positioning control
Axis 4, 2000pulse Axis used .................................Axis 4
INC-1 Travel value to pass point........2000 [pulse]
Axis 4, -2000pulse 1 axis linear positioning control
NEXT Axis used .................................Axis 4
INC-1 Travel value to pass point........-2000 [pulse]
Axis 4, 1000pulse End repetition region
CPEND 1 axis linear positioning control
Axis used .................................Axis 4
Travel value to pass point........1000 [pulse]
End continuous trajectory control
[G20]
!X0 Wait until X0 turn OFF after continuous trajectory control completion.
END
*1 Example of the above Motion SFC program is started using the automatic start or sequence program.
5 POSITIONING CONTROL
348 5.17 Continuous Trajectory Control
2 to 4 axes continuous trajectory control
Continuous trajectory control for 2 to 4 axes.
: Must be set, : Set if required
FIN acceleration/deceleration
Rapid Stop deceleration time
Interpolation control unit
5
Address/travel value
Repeat condition
Command speed
Auxiliary point
Starting angle
WAIT-ON/OFF
Central point
S-curve ratio
Program No.
Frequency
Dwell time
Amplitude
M-code
Radius
Axis
Skip
CPSTART2 « 2 © ¨ ¨ © © © © © © © © © © © ©
Start
CPSTART3 « 3 © ¨ ¨ © © © © © © © © © © © ©
CPSTART4 « 4 © ¨ ¨ © © © © © © © © © © © ©
End
CPEND « « ©
ABS-2 2 ¨ ¨ © © © © ©
ABS-3 3 ¨ ¨ © © © © ©
ABS-4 4 ¨ ¨ © © © © ©
ABS ¨ ¨ © © ¨ © © ©
ABS
Absolute
ABS
¨ ¨ © © ¨ © © ©
ABS 2
ABS
ABS
¨ ¨ © © ¨ © © ©
Pass point
ABS
INC-2 2 ¨ ¨ © © © © ©
INC-3 3 ¨ ¨ © © © © ©
INC-4 4 ¨ ¨ © © © © ©
INC ¨ ¨ © © ¨ © © ©
INC
Incremental
INC
¨ ¨ © © ¨ © © ©
INC 2
INC
INC
¨ ¨ © © ¨ © © ©
INC
5 POSITIONING CONTROL
5.17 Continuous Trajectory Control 349
Processing details
■ Start and end for 2 to 4 axes continuous trajectory control
2 to 4 axes continuous trajectory control is started and ended using the following instructions:
Instruction Description
CPSTART2 Starts the 2 axes continuous trajectory control. Sets the axis No. and command speed.
CPSTART3 Starts the 3 axes continuous trajectory control. Sets the axis No. and command speed.
CPSTART4 Starts the 4 axes continuous trajectory control. Sets the axis No. and command speed.
CPEND Ends the 2, 3, or 4 axes continuous trajectory control for CPSTART2, CPSTART3, or CPSTART4.
Precautions
For circular interpolation control at the pass points for continuous trajectory control of 2 to 4 axes, specify any 2 axes among
the controlled axes. When axes other than the axes specified for circular interpolation control are detected, an error occurs,
resulting in a deceleration stop.
Program example
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
■ Program example 1
The program for repeating 2 axis continuous trajectory control of Axis 2 and Axis 3 is explained as an example.
• Positioning conditions
• Continuous trajectory control conditions are shown below.
Item Setting
Servo program No. 505
Positioning speed 10000
Positioning method 2 axes linear interpolation Radius-specified circular interpolation 2 axes linear interpolation
Pass point Axis 2 30000 50000 90000
Axis 3 30000 50000 100000
5 POSITIONING CONTROL
350 5.17 Continuous Trajectory Control
• Positioning operation details
Axis 2 and axis 3 servo motors is used for positioning operation. Positioning details for Axis 2 and Axis 3 servo motors are
shown below.
Axis 3 positioning direction
P3
100000
P2
50000
P1
30000
5
Axis 2 positioning direction
0 30000 50000 90000
[F10]
SET M2042 Turn on all axes servo ON command.
[G10]
X0*M2435*M2455 Wait until X0, Axis 2 servo ready and Axis 3 servo ready turn on.
[K505]
CPSTART2 Start continuous trajectory control
Axis 2 Axis used ......................Axis 2, Axis 3
Axis 3
Speed 10000pulse/s Positioning speed .........10000 [pulse/s]
ABS-2 2 axes linear interpolation control
Axis 2, 30000pulse Axis 2.........30000 [pulse]
Positioning address ......
Axis 3, 30000pulse Axis 3.........30000 [pulse]
ABS Circular interpolation control
Axis 2, 50000pulse Axis 2.........50000 [pulse]
Positioning address ......
Axis 3, 50000pulse Axis 3.........50000 [pulse]
Radius 20000pulse Radius ..........................20000 [puls
ABS-2 2 axes linear interpolation control
Axis 2, 90000pulse Axis 2.........90000 [pulse]
Positioning address ......
Axis 3, 100000pulse Axis 3.........100000 [pulse]
CPEND End continuous trajectory control
[G20]
!X0 Wait until X0 turn OFF after continuous trajectory control completion.
END
*1 Example of the above Motion SFC program is started using the automatic start or sequence program.
5 POSITIONING CONTROL
5.17 Continuous Trajectory Control 351
■ Program example 2
The program for performing 4 axes continuous trajectory control of Axis 1, Axis 2, Axis 3, and Axis 4 is explained as an
example.
• Positioning conditions
• Continuous trajectory control conditions are shown below.
Item Setting
Servo program No. 506
Positioning speed 10000
Positioning method 4 axes linear interpolation 4 axes linear interpolation 4 axes linear interpolation
Pass point Axis 1 3000 5000 5000
Axis 2 4000 3500 3500
Axis 3 4000 -4000 3000
Axis 4 4000 -6000 6000
[F10]
SET M2042 Turn on all axes servo ON command.
[G10] Wait until X0, Axis 1 servo ready, Axis 2 servo ready,
X0*M2415*M2435*M2455*M2475
Axis 3 servo ready and Axis 4 servo ready turn on.
[K506]
CPSTART4 Start continuous trajectory control
Axis 1 Axis used ...................................4Axis 1, Axis 2, Axis 3, Axis 4
Axis 2
Axis 3
Axis 4
Speed 10000pulse/s Positioning speed ......................10000 [pulse/s]
INC-4 4 axes linear interpolation control (P1)
Axis 1, 3000pulse Axis 1.........3000[pulse]
Axis 2, 4000pulse Axis 2.........4000[pulse]
Travel value to pass point .........
Axis 3, 4000pulse Axis 3.........4000[pulse]
Axis 4, 4000pulse Axis 4.........4000[pulse]
INC-4 4 axes linear interpolation control (P2)
Axis 1, 5000pulse Axis 1.........5000[pulse]
Axis 2, 3500pulse Axis 2.........3500[pulse]
Travel value to pass point .........
Axis 3, -4000pulse Axis 3.........-4000[pulse]
Axis 4, -6000pulse Axis 4.........-6000[pulse]
INC-4 4 axes linear interpolation control (P3)
Axis 1, 5000pulse Axis 1.........5000[pulse]
Axis 2, 3500pulse Axis 2.........3500[pulse]
Travel value to pass point .........
Axis 3, 3000pulse Axis 3.........3000[pulse]
Axis 4, 6000pulse Axis 4.........6000[pulse]
CPEND End continuous trajectory control
[G20]
!X0 Wait until X0 turn OFF after continuous trajectory control completion.
END
*1 Example of the above Motion SFC program is started using the automatic start or sequence program.
5 POSITIONING CONTROL
352 5.17 Continuous Trajectory Control
Continuous trajectory control for helical interpolation
The helical interpolation can be specified as the positioning control method to pass point for 3 or 4 axes continuous trajectory
control.
Starting or ending instruction for continuous trajectory control uses the same CPSTART3, CPSTART4 or CPEND as 3 or 4
axes continuous trajectory control instruction.
: Must be set, : Set if required
FIN acceleration/deceleration
Rapid Stop deceleration time
Interpolation control unit
Address/travel value
Repeat condition
Command speed
Auxiliary point
Starting angle
WAIT-ON/OFF
Central point
S-curve ratio
Program No.
Frequency
Dwell time
Amplitude
M-code
Radius
Axis
Skip
ABH ¨ ¨ © © ¨ ¨ © © ©
ABH
ABH
¨ ¨ © © ¨ ¨ © © ©
ABH Absolute
ABH
ABH
¨ ¨ © © ¨ ¨ © © ©
ABH
2
INH ¨ ¨ © © ¨ ¨ © © ©
INH
INH
¨ ¨ © © ¨ ¨ © © ©
INH Incremental
INH
INH
¨ ¨ © © ¨ ¨ © © ©
INH
5 POSITIONING CONTROL
5.17 Continuous Trajectory Control 353
Processing details
Helical interpolation specified methods for continuous trajectory control are shown below.
Servo instruction Positioning method Circular interpolation specified method
ABH Absolute Radius-specified method less than CW180
INH Incremental
ABH Absolute Radius-specified method less than CCW180
INH Incremental
ABH Absolute Radius-specified method CW180 or more.
INH Incremental
ABH Absolute Radius-specified method CCW180 or more.
INH Incremental
ABH Absolute Central point-specified method CW
INH Incremental
ABH Absolute Central point-specified method CCW
INH Incremental
ABH Absolute Auxiliary point-specified method
INH Incremental
Precautions
• Specify any 3 axes among 4 controlled axes in the helical interpolation control at the pass point for 4 axes continuous
trajectory control (CPSTART4). When axes other than the axes specified for helical interpolation control are detected, an
error occurs, resulting in a deceleration stop.
• Command speed at the helical interpolation specified point is controlled with the speed of circumference. Control is the
same as before at the point except for the helical interpolation specification. (Both of the linear interpolation-specified point
and circular interpolation-specified point are the vector speed for number of interpolation axes.)
• Skip function toward the helical interpolation-specified each point for continuous trajectory control is possible. If the
absolute-specified helical interpolation is specified to point since the skip signal specified point, set the absolute linear
interpolation between them. If it does not set, it may occur an error and stop.
• FIN signal wait function toward the helical interpolation specified each pass point for continuous trajectory control is
possible. M-code outputting signal is outputted to all circular interpolation axes and linear axes. Fin signal can be operated
with the both of circular interpolation axes and linear axes.
• If negative speed change toward the helical interpolation-specified each pass point for continuous trajectory control is
executed, it can be returned before 1 point during positioning control.
• Speed-switching point-specified flag is effective toward the helical interpolation-specified each pass point for continuous
trajectory control.
5 POSITIONING CONTROL
354 5.17 Continuous Trajectory Control
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.
Helical interpolation
[F10]
SET M2042 Turn ON all axes servo ON command.
[G10]
X0*M2415*M2435*M2455 Wait until X0, Axis 1 servo ready, Axis 2 servo ready and
Axis 3 servo ready turn ON
[K510]
CPSTART3
Axis 1
Continuous trajectory control
Axis used ......................Axis 1, Axis 2, Axis 3 5
Axis 2
Axis 3
Speed 10000 Positioning speed ...... 10000
ABS-3 3 axes linear interpolation control (P1)
Axis 1, 3000 Axis 1......................... 3000
Axis 2, 4000 Positioning address ...... Axis 2......................... 4000
Axis 3, 4000 Axis 3......................... 4000
ABH 3 axes helical interpolation control (P2)
Axis 1, 5000 Axis 1......................... 5000
Axis 2, 3500 Axis 2......................... 3500
Linear axis 3, -4000 Positioning address ...... Axis 3......................... -4000
Number of pitches 6 Number of pitches ..... 6
Radius 1000 Radius ....................... 1000
ABS-3 3 axes linear interpolation control (P3)
Axis 1, 5000 Axis 1......................... 5000
Axis 2, 3500 Positioning address ...... Axis 2......................... 3500
Axis 3, 3000 Axis 3......................... 3000
CPEND End continuous trajectory control
[G12]
!M2001*!M2002*!M2003 Wait until Axis 1, Axis 2 and Axis 3 start accept flag turn OFF
5 POSITIONING CONTROL
5.17 Continuous Trajectory Control 355
■ Program 2
The program that controls the nozzle direction so that the nozzle stays perpendicular to the circular arc curve by 3 axes
continuous trajectory control of Axis 1, Axis 2, and Axis 3 is explained as an example.
• Positioning operation details
The operation to start as the following figure from start point and witch keeps a nozzle at right angles toward the contour of
line and that it goes around the contour and witch is returned to start point. It is the following program when a helical
interpolation function is used.
Y (Axis 2) Start point
150000.0 Nozzle
180°
-100000.0 0°
[Unit: m]
Z-axis (Rotation angle)
-150000.0
X,Y-axis plane
• Positioning conditions
• Helical interpolation conditions for continuous trajectory control are shown below.
Item Setting
Servo program No. 61, 62
Positioning speed 1000.00 [mm/min]
Control axis Positioning address Central point
Axis 1 [m] Axis 2 [m] Axis 3 [degree] Axis 1 [m] Axis 2 [m]
Pass point Start point 0.0 150000.0 0.00000
P1 50000.0 150000.0 0.00000
P2 150000.0 50000.0 90.00000 50000.0 50000.0
P3 150000.0 -50000.0 90.00000
P4 50000.0 -150000.0 180.00000 50000.0 -50000.0
P5 -50000.0 -150000.0 180.00000
P6 -150000.0 -50000.0 270.00000 -50000.0 -50000.0
P7 -150000.0 50000.0 270.00000
P8 -50000.0 150000.0 0.00000 -50000.0 50000.0
Vibration may cause the machine at the pass point depend on the speed change.
In this case, reduce the speed change (acceleration) in the FIN acceleration/deceleration.
However, a locus will change depend on the setting time of the FIN acceleration/deceleration.
• Continuous trajectory control start command: X0 Leading edge (OFF ON)
5 POSITIONING CONTROL
356 5.17 Continuous Trajectory Control
• Motion SFC program
Motion SFC program for is shown below.
Helical interpolation
[F10]
SET M2042 Turn ON all axes servo ON command.
[G10] Wait until X0, Axis 1 servo ready, Axis 2 servo ready and
X0*M2415*M2435*M2455
Axis 3 servo ready turn ON
3 axes linear interpolation control (Travel to start point)
[K61] ABS-3 Axis used .................. Axis 1, Axis 2, Axis 3
Axis 1, 0.0μm Axis 1........... 0.0 [m]
Axis 2, 150000.0μm Positioning address ......... Axis 2........... 150000.0 [m]
Axis 3, 0.00000degree Axis 3........... 0.00000 [degree]
Vectro speed 30000.00mm/min Command positioning speed
Vector speed ....................................30000.00 [mm/min]
[G11]
!M2001*!M2002*!M2003 Wait until Axis 1, Axis 2 and Axis 3 start accept flag turn OFF
[G12]
!M2001*!M2002*!M2003 Wait until Axis 1, Axis 2 and Axis 3 start accept flag turn OFF
END
5 POSITIONING CONTROL
5.17 Continuous Trajectory Control 357
Pass point skip function
This function stops positioning to executing point and executes positioning to next point, by setting a skip signal toward each
pass point for continuous trajectory control.
Setting data
■ Skip signal devices
A bit device (or a specified bit in a word device) can be used.
Refer to the following for the setting range of usable devices.
MELSEC iQ-R Motion controller Programming Manual (Common)
Precautions
• When an absolute circular interpolation or absolute helical interpolation is specified to since point since the skip signal
specified point, set the absolute linear interpolation between them. If it does not set, it may occur an error and stop.
• If a skip signal is inputted at the end point, a deceleration stop occurs at that point and the program is ended.
• If setting the S-curve ratio, the S-curve pattern is recalculated by the skip signal input. Refer to S-curve ratio for details of
the operation. (Page 220 S-curve ratio)
Program example
<K 0>
Point 1
CPSTART2
positioning Skip
Axis 1 V No skip
processing
Axis 2
Speed 10000
ABS-2
Axis 1, 100000
Axis 2, 200000 t
Speed 10000 Skip signal
Skip M200 Servo program
ABS-2 start
Axis 1, 200000 Start accept
Axis 2, 200000
Speed 15000
Skip signal
CPEND
(M200)
5 POSITIONING CONTROL
358 5.17 Continuous Trajectory Control
CAUTION
When a skip is specified during continuous trajectory control and the axis which has no stroke range [degree] is included, the operation at the execution of skip
is described.
• If there is an ABS instruction after the skip in these conditions, the end positioning point and the travel distance in the program as a whole will be the same
regardless of whether the skip is executed or not.
(1) All instructions after the skip are INC instructions:
Program example
When skip is not executed
CPSTART1
Axis 1 0 180 0 270[degree]
Speed 10.000
INC-1
Axis 1, 180.00000
Skip M100 When skip is executed
INC-1
Axis 1, 180.00000 0 100 280 190[degree]
INC-1
Axis 1, 270.00000
CPEND When the skip occurs at 100 [degree]
5
(2) Instruction immediately after the skip is ABS instruction:
Program example
When skip is not executed
CPSTART1
Axis 1 0 180 350 260[degree]
Speed 10.000
INC-1
Axis 1, 180.00000
Skip M100 When skip is executed
ABS-1 (The end positioning point is same regardless of whether the skip is executed or not.)
Axis 1, 350.00000
INC-1 0 100 350 260[degree]
Axis 1, 270.00000
CPEND
When the skip occurs at 100 [degree]
(3) Instruction immediately after the skip is INC instruction and there is ABS instruction after that:
Program example
When skip is not executed
CPSTART1
Axis 1 0 0 180 0 90[degree]
Speed 10.000
INC-1
Axis 1, 360.00000
Skip M100 When skip is executed
INC-1 (The end positioning point is same regardless of whether the skip is executed or not.)
Axis 1, 180.00000
INC-1 0 80 260 80 90[degree]
Axis 1, 180.00000
ABS-1
Axis 1, 90.00000 When the skip occurs This point moves at 370 [degree],
CPEND at 80 [degree] not 10 [degree].
5 POSITIONING CONTROL
5.17 Continuous Trajectory Control 359
FIN signal wait function
By selecting the FIN signal wait function and setting a M-code at each executing point, a process end of each executing point
is synchronized with the FIN signal, the FIN signal turns ON to OFF and then the next positioning is executed.
Turn the FIN signal on/off using the Motion SFC program or sequence program.
Setting data
When the FIN signal wait function is selected, the fixed acceleration/deceleration time method is used. Set the acceleration/
deceleration time within the range of 1 to 5000 [ms] by "FIN acceleration/deceleration" (selecting item) in the servo program.
Indirect setting is also possible by the word devices (1 word).
Precautions
• If the acceleration/deceleration time is specified outside the setting range, the warning (error code: 0A44H) will occur at the
start and it is controlled with the acceleration/deceleration time of 1000 [ms].
• M-code outputting signal is output to all interpolation axes at the interpolation control. In this case, turn on the FIN signal for
one of the interpolation axes.
• When M-code is set at the end point, positioning ends after the FIN signal has turn OFF to ON to OFF.
• When the FIN acceleration/deceleration (Fixed acceleration/deceleration time method) is set in the continuous trajectory,
the setting for advanced S-curve acceleration/deceleration is invalid.
Processing details
Servo program K0 for FIN signal wait function is shown below.
<K 0>
CPSTART2
Vector speed
Axis 1 100[ms]
Axis 2
Speed 10000 Point 1 WAIT 1
FIN 100 [ms]
ABS-2 M-code 10 11
Axis 1, 200000
Axis 2, 200000
M-code outputting
M code 10
ABS-2
Axis 1, 300000 FIN signal
Axis 2, 250000
M code 11 Explanatory
ABS-2
Axis 1, 350000 1. When the positioning of point 1 starts, M-code 10 is output and
Axis 2, 300000 M-code outputting signal turns ON.
M code 12 2. FIN signal turns ON after performing required processing in the
ABS-2 Motion SFC program.
Axis 1, 400000 Transition to the next point does not execute until the FIN signal
Axis 2, 400000 turns ON.
CPEND 3. When the FIN signal turns ON, M-code outputting signal turns OFF.
4.When the FIN signal turns OFF after the M-code outputting signal
turns OFF, the positioning to the next point 2 starts.
5 POSITIONING CONTROL
360 5.17 Continuous Trajectory Control
Program example
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
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
5
M-code 10 11 12
• Continuous trajectory control start command: X0 Leading edge (OFF ON) (PLC CPU device)
[F10]
SET M2042 Turn on all axes servo ON command.
[G10]
M2415*M2435 Wait until Axis 1 servo ready and Axis 2 servo ready turn on.
[K0]
CPSTART2 Start continuous trajectory control
Axis 1 Axis used ................................... Axis 1, Axis 2
Axis 2
Speed 10000 Positioning speed ......................10000 [pulse/s]
FIN 100 FIN acceleration/deceleration....100 [ms]
ABS-2 2 axes linear interpolation control
Axis 1, 200000 Axis used .................................Axis 1, Axis 2
Axis 1, 200000 Address of stop position ................ Axis 1.........200000[pulse]
M code 10 Axis 2.........200000[pulse]
M-code output ...........................10
ABS-2
2 axes linear interpolation control
Axis 1, 300000
Axis used .................................Axis 1, Axis 2
Axis 2, 250000
Address of stop position ................ Axis 1.........300000[pulse]
M code 11
Axis 2.........250000[pulse]
ABS-2 M-code output ...........................11
Axis 1, 350000 2 axes linear interpolation control
Axis 2, 300000 Axis used .................................Axis 1, Axis 2
M code 12 Address of stop position ................ Axis 1.........350000[pulse]
ABS-2 Axis 2.........300000[pulse]
M-code output ..........................12
Axis 1, 400000
2 axes linear interpolation control
Axis 2, 400000
Axis used ................................. Axis 1, Axis 2
CPEND
Address of stop position ................ Axis 1.........400000[pulse]
Axis 2.........400000[pulse]
End continuous trajectory control
END
5 POSITIONING CONTROL
5.17 Continuous Trajectory Control 361
• Sequence program
Sequence program for FIN signal wait function is shown below.
X0
0 DP.SFCS H3E1 K110 M0 D0 Motion SFC program start request
M0
11 MOVP K1 D51 Substitutes 1 for D51 after program start.
M2419 Reads data of D13 for Multiple CPU system
14 DP.DDRD H3E1 D50 "D13" D1 M2 No.2 by turning M2419 on, and stores in the
data area D1 of self
SET M3219 M3219 is set
M2419
26 RST M3219 Resets M3219 by turning M2419 OFF.
28 END
*1 The automatic refresh setting example for FIN signal wait function is shown below.
5 POSITIONING CONTROL
362 5.17 Continuous Trajectory Control
• Parameter setting
The refresh (END) setting example for FIN signal wait function is shown below.
[Example of allocating the devices allocated as Motion dedicated devices to the PLC CPU]
■CPU No. 1 (PLC CPU) (GX Works3) ■CPU No. 2 (Motion CPU) (MT Developer2)
• Set the device transmitted to CPU No.2 (M3200 to M3295) • Set the device received from CPU No.1 (M3200 to M3295)
5
• Set the device received from CPU No.2 (M2400 to M2495)
5 POSITIONING CONTROL
5.17 Continuous Trajectory Control 363
■ FIN signal wait function using the Motion SFC 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
• 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
[F10]
SET M2042 Turn on all axes servo ON command.
[G10]
X0*M2415*M2435 Wait until X0, Axis 1 servo ready and Axis 2 servo ready turn on.
[K0]
CPSTART2 Start continuous trajectory control
Axis 1 Axis used ...................................Axis 1, Axis 2
Axis 2
Speed 10000 Positioning speed ......................10000 [pulse/s]
FIN 100 FIN acceleration/deceleration . . . . . 100 [ms]
ABS-2 2 axes linear interpolation control
Axis 1, 200000 Axis used ................................. Axis 1, Axis 2
Axis 1, 200000 Address of stop position ............. Axis 1.........200000[pulse]
M code 10 Axis 2.........200000[pulse]
M-code output ...........................10
ABS-2
2 axes linear interpolation control
Axis 1, 300000
Axis used .................................Axis 1, Axis 2
Axis 2, 250000
Address of stop position ............. Axis 1.........300000[pulse]
M code 11
Axis 2.........250000[pulse]
ABS-2 M-code output ...........................11
Axis 1, 350000 2 axes linear interpolation control
Axis 2, 300000 Axis used .................................Axis 1, Axis 2
M code 12 Address of stop position ............. Axis 1.........350000[pulse]
ABS-2 Axis 2.........300000[pulse]
M-code output ...........................12
Axis 1, 400000
2 axes linear interpolation control
Axis 2, 400000
Axis used .................................Axis 1, Axis 2
CPEND
Address of stop position ............. Axis 1.........400000[pulse]
Axis 2.........400000[pulse]
Stand by FIN signal End continuous trajectory control
END
5 POSITIONING CONTROL
364 5.17 Continuous Trajectory Control
• The Motion SFC program which outputs M-code of each point for continuous trajectory control to Y20 to Y2F by BCD code is shown below.
P0
[G50]
M2419*M2439 Turn ON Axis 1, Axis 2 M-code outputting signal.
[F20]
#0=BCD(D13) Output Axis 1 M-code.
DOUT Y20,#0 Turn ON FIN signal.
SET M3219
[F30]
RST M3219 Turn OFF FIN signal.
5
[G70]
D13==K12 P0 Repeat until M-code value become 12.
END
5 POSITIONING CONTROL
5.17 Continuous Trajectory Control 365
• The fixed acceleration/deceleration time method is acceleration/deceleration processing that the time which
acceleration/deceleration takes is fixed, even if the command speed differs.
V
t
Acceleration/deceleration time is fixed
(1) Rapid stop deceleration time in parameter block, completion point specification method for speed change
point, and S-curve acceleration/deceleration processing and parameters are invalid in the fixed acceleration/
deceleration time method.
(2) The speed processing for each axis is as shown below in positioning operation (continuous trajectory) as
shown in the following figure.
Y V
Ay
Axis 1
Axis 2
Address Ax
X t
Axis 1 Ax Ax
Positioning operation V
Axis 2
Address Ay
t
Ay
Continuous-trajectory control processing of each axis
• When the rapid stop command is executed by the setting "deceleration time < rapid stop deceleration time"
during continuous trajectory control, the point data currently executed in the middle of deceleration, and the
positioning may be completed suddenly as a speed "0".
In the case of, "deceleration time rapid stop deceleration time", the above operation is not executed. For
the following condition, note that the speed may become 0 in the middle of deceleration.
Travel value by the point data currently executed at the rapid stop command (Up to 9 points) < speed at rapid
stop command input rapid stop deceleration time / 2
[Operation pattern]
ON
Start accept flag OFF
ON
Positioning complete
OFF
signal
ON
Rapid stop command OFF
Vector speed
Deceleration speed at
the normal stop
5 POSITIONING CONTROL
366 5.17 Continuous Trajectory Control
5.18 Position Follow-Up Control
Positioning to the address set in the word device of the Motion CPU specified with the servo program at one start is executed.
Position follow-up control is started using the PFSTART servo program instruction.
: Must be set, : Set if required
FIN acceleration/deceleration
Rapid Stop deceleration time
Interpolation control unit
Address/travel value
Repeat condition
Command speed
Auxiliary point
Starting angle
WAIT-ON/OFF
Central point
S-curve ratio
Program No.
Frequency
Dwell time
Amplitude
M-code
Radius
Axis
Skip
PFSTART Absolute 1 © ¨ ¨ ¨ © © © © © © © © © ©
Processing details
■ Control using PFSTART instruction
• Positioning to the address set in the word device of the Motion CPU specified with the servo program is executed.
• Position follow-up control is executed until the stop instruction is input. If the word device value changes during operation,
positioning is executed to the changed address.
t
Before reaching A, positioning address
changed to B (return direction)
Positioning address A B
Precautions
• Number of control axes is 1 axis.
• Only the absolute data method (ABS) is used for positioning control to the pass points.
• The speed can be changed during the start. The changed speed is effective until the stop command is input.
• Set the positioning address in the servo program using indirect setting with the word devices.
• Use only even-numbered devices for indirect setting of positioning address in the servo program.
• Positioning speeds can be set in the servo program using indirect setting with the word devices. However, this data is
effective only at the position follow-up control start (servo program start) and the speed does not change if the indirect
setting are changed during the start.
5 POSITIONING CONTROL
5.18 Position Follow-Up Control 367
Program example
The program for performing Axis 3 position follow-up control for PLC CPU (CPU No.1) to Motion CPU (CPU No.2) is
explained as an example.
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
■ Positioning conditions
• Position follow-up conditions are shown below.
Item Setting
Servo program No. 100
Control axis Axis 3
Positioning address D4000
Positioning speed 20000
• Position follow-up control start command: X0 Leading edge (OFF ON) (PLC CPU device)
■ Operation timing
Operation timing for position follow-up control is shown below.
V
5 POSITIONING CONTROL
368 5.18 Position Follow-Up Control
■ Motion SFC program
The Motion SFC program for executing the servo program (No. 100) for position follow-up control is shown below.
This program is started using D(P).SFCS instruction from PLC CPU (CPU No. 1).
[F10]
SET M2042 Turn on all axes servo ON command.
[K100]
PFSTART Position follow-up control
Axis 3, D4000 Axis used .......................... Axis 3
Speed 20000pulse/s Positioning address .......... D4000
Positioning speed ............... 2000 [pulse/s]
[G20] Wait until Axis 3 start accept flag turn OFF after
!M2003
position follow-up control completion.
5
END
■ Sequence program
Sequence program example for position follow-up control is shown below.
SM400
0 MOVP K2 D1 Substitute 2 for D1 after program start.
X0
3 PLS M10 Starts by turning X0 on.
RST M20
RST M30
M10 M0 Reads data of D1000 of self CPU for
16 DP.DDWR H3E1 D0 D1000 "D4000" M0 Multiple CPU system by turning M10 on,
and writes to D4000 of CPU No.2.
DP.SFCS H3E1 K150 M2 D1100 Starts the Motion SFC program No.150.
M1 M2 M3
38 SET M20
M20
42 DMOV D40 D1200 Substitutes the value of D40 for D1200
M2441 M2442
D= D1200 D1000 RST M20 Resets M20 and sets M30 at the axis 3
positioning completion and
SET M30 D1200 = D1000.
M30 M4 Reads data of D1300 of self CPU for
52 DP.DDWR H3E1 D0 D1300 "D4000" M4 Multiple CPU system by turning M30 on,
and writes to D4000 of CPU No.2.
RST M30
67 END
*1 The automatic refresh setting example for position follow-up control is shown below.
5 POSITIONING CONTROL
5.18 Position Follow-Up Control 369
■ Parameter setting
The refresh (END) setting example for position follow-up control is shown below.
[Allocation example of devices allocated in the Motion dedicated device to the PLC CPU]
■CPU No. 1 (PLC CPU) (GX Works3) ■CPU No. 2 (Motion CPU) (MT Developer2)
• Set the device transmitted to CPU No.2 (M3200 to M3295) • Set the device received from CPU No.1 (M3200 to M3295)
• Set the device received from CPU No.2 (M2400 to M2495, D40 to D59)
• Set the device transmitted to CPU No.1 (M2400 to M2495, D40 to D59)
5 POSITIONING CONTROL
370 5.18 Position Follow-Up Control
5.19 High-Speed Oscillation
Positioning of a specified axis is caused to oscillate on a sine wave.
: Must be set, : Set if required
FIN acceleration/deceleration
Rapid Stop deceleration time
5
Repeat condition
Command speed
Auxiliary point
Starting angle
WAIT-ON/OFF
Central point
S-curve ratio
Program No.
Frequency
Dwell time
Amplitude
M-code
Radius
Axis
Skip
OSC « 1 © ¨ © ¨ ¨ ¨ ©
Processing details
The designated axis caused to oscillate on a specified sine wave.
Acceleration/deceleration processing is not performed.
360 [degree]
Amplitude
Starting angle
■ Amplitude
Set the amplitude of the oscillation in the setting units.
The amplitude can be set within the range of 1 to 2147483647.
■ Starting angle
Set the angle on the sine curve at which oscillation is to start.
The setting range is 0 to 359.9 [degree]
■ Frequency
Set how many sine curve cycles occur in one minute.
The setting range is 1 to 5000 [CPM].
Since acceleration/deceleration processing is not performed, you should set the starting angle to 90 or 270
[degree] in order to avoid an abrupt start.
5 POSITIONING CONTROL
5.19 High-Speed Oscillation 371
Precautions
• If the amplitude setting is outside the range, the minor error (error code: 1A52H) occurs and operation does not start.
• If the starting angle setting is outside the range, the minor error (error code: 1A53H) occurs and operation does not start.
• If the frequency setting is outside the range, the minor error (error code: 1A54H) occurs and operation does not start.
• Operation is continually repeated until a stop signal is input after the start.
• Speed changes during operation are not possible. Attempted speed changes will cause warning (error code: 09EEH).
• Do not use the high-speed oscillation in the axis that invalidates a stroke limit of control unit "degree".
Program example
An example of a program for high-speed oscillation is shown below.
<K 6>
OSC
Axis 1
Starting angle 90.0 [degree]
Amplitude 1000 [pulse]
Frequency 100 [CPM]
5 POSITIONING CONTROL
372 5.19 High-Speed Oscillation
5.20 Simultaneous Start
Simultaneous start of the specified servo program at one start is executed.
Simultaneous start is started using the START servo program instruction.
: Must be set, : Set if required
FIN acceleration/deceleration
Rapid Stop deceleration time
Interpolation control unit
Address/travel value
Repeat condition
Command speed
Auxiliary point
Starting angle
WAIT-ON/OFF
Central point
S-curve ratio
Program No.
Frequency
Dwell time
Amplitude
M-code
Radius
Axis
Skip
START *2 *2 ¨
Processing details
■ Control using START instruction
• Simultaneous start of the specified servo programs is executed.
• The servo program except for the simultaneous start (START instruction) can be specified.
• Up to 3 servo programs can be specified.
• A word device can be used as the servo program number. Refer to the following for the setting range of usable devices.
MELSEC iQ-R Motion controller Programming Manual (Common)
• When the servo program number is specified using a word device, the device value can be set to start the program or not
start the program.
Setting value Description
-1 Servo program number not specified
0 to 8191*1 Program number to start
• Each axis is controlled using the specified servo program after the simultaneous start.
5 POSITIONING CONTROL
5.20 Simultaneous Start 373
Precautions
A check is made at the start. An error occurs and operation does not start in the following cases.
• Specified servo program does not exist.
• START instruction is set as the specified servo program.
• The specified servo program start axis is already used.
• A servo program cannot start by an error.
• The specified program number for simultaneous start is already used.
• The program number for simultaneous start is set as the self program number.
• The real axis program and command generation axis program are mixed.
• The program to start does not exist.
• All of the specified program numbers are "-1".
Program example
The program for performing simultaneous start of Axis 1, Axis 2, Axis 3, and Axis 4 is explained as an example.
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
■ Start conditions
• Simultaneous start servo program No.: No.121
• Simultaneous start execute command: X0 Leading edge (OFF ON)
[F10]
SET M2042 Turn on all axes servo ON command.
[G10] Wait until X0, Axis 1 servo ready, Axis 2 servo ready,
X0*M2415*M2435*M2455*M2475
Axis 3 servo ready and Axis 4 servo ready turn ON.
[K121]
START Simultaneous start control
Program No. K 1 No.1 servo program
Program No. K 14 No.14 servo program
Program No. K 45 No.45 servo program
[G20]
!X0 Wait until X0 turn OFF after simultaneous start completion.
END
*1 Example of the above Motion SFC program is started using the automatic start or sequence program
5 POSITIONING CONTROL
374 5.20 Simultaneous Start
5.21 Home Position Return
• Use the home position return at the power supply ON and other times where decision of axis is at the machine home
position is required.
• The home position return data must be set for each axis to execute the home position return. Refer to the following details
of the home position return data. (Page 177 Home Position Return Data)
• The home position return methods that are available are proximity dog method, count method, data set method, dog cradle
method, stopper method, limit switch combined method, scale home position signal detection method, dogless home
position signal reference method, and driver home position return method. Select the optimal home position return method
for the system configuration and applications with reference to the following.
Home position return methods Reference position External signal*1 Applications
Proximity dog Proximity dog Motor zero point DOG • It is used in the system which can surely pass a zero point from
method method 1 (FLS/RLS) the home position return start to proximity dog ON OFF.
• When the proximity dog is ON, it cannot be started.
Proximity dog • This method is valid when the stroke range is short and 5
method 2 "proximity dog method 1" cannot be used.
• When the proximity dog is ON, it can be started.
Count method Count method 1 It is used in the system which can surely pass a zero point from the
home position return start to point of travel distance set as "travel
value after proximity dog ON".
Count method 2 Command position This method is used when the proximity dog is near the stroke end
and the stroke range is narrow.
Count method 3 Motor zero point This method is valid when the stroke range is short and "count
method 1" cannot be used.
Data set Data set method 1 Command position • It is used in a system where external input signals such as dog
method signal are not set in the absolute position system.
• This method is valid for the data set independent of a deviation
counter value.
Data set method 2 Motor actual position It is used in a system where external input signals such as dog
signal are not set in the absolute position system.
Data set method 3 It is used to perform home position return during servo OFF.
Dog cradle method Motor zero point DOG • Home position is zero point of servo motor immediately after the
(FLS/RLS) proximity dog signal ON.
• It is easy to set the position of proximity dog, because the
proximity dog is set near the position made to the home
position.
Stopper Stopper method 1 Motor actual position DOG This method is valid to improve home position accuracy in order to
method make the home position for the position which stopped the
Stopper method 2
machine by the stopper.
Limit switch combined method Motor zero point FLS (for forward It is used in a system where the proximity dog signal cannot be
home position return used and only external limit switch can be used.
direction)/RLS (for
reverse home position
return direction)
Scale home position signal detection DOG • The travel direction is reversed at the proximity dog ON, and
method home position is encoder zero point after reversal.
• This method is valid to make the home position for the load side
at the linear motors or direct drive motors use.
Dogless home position signal (FLS/RLS) • It is used in a system where proximity dog signal cannot be used
reference method and stops at the zero point of servo motor.
• Home position return operation differs by servo amplifier.
Driver home position return method Position in driver The driver performs home position return operation autonomously
settings according to the settings on the driver-side.
*1 The signal in parentheses is required when the home position return retry function is used.
5 POSITIONING CONTROL
5.21 Home Position Return 375
Servo program for home position return
The home position return executed using the ZERO servo instruction.
: Must be set, : Set if required
FIN acceleration/deceleration
Rapid Stop deceleration time
Interpolation control unit
Address/travel value
Repeat condition
Command speed
Auxiliary point
Starting angle
WAIT-ON/OFF
Central point
S-curve ratio
Program No.
Frequency
Dwell time
Amplitude
M-code
Radius
Axis
Skip
ZERO « 1 ¨
Processing details
Home position return is executed by the home position return method specified with the home position return data (Page
177 Home Position Return Data).
Refer to the following for details of the home position return methods.
Home position return methods Reference
Proximity dog method 1 Page 378 Home position return by the proximity dog method 1
Proximity dog method 2 Page 380 Home position return by the proximity dog method 2
Count method 1 Page 382 Home position return by the count method 1
Count method 2 Page 383 Home position return by the count method 2
Count method 3 Page 384 Home position return by the count method 3
Data set method 1 Page 386 Home position return by the data set method 1
Data set method 2 Page 387 Home position return by the data set method 2
Data set method 3 Page 388 Home position return by the data set method 3
Dog cradle method Page 389 Home position return by the dog cradle method
Stopper method 1 Page 392 Home position return by the stopper method 1
Stopper method 2 Page 393 Home position return by the stopper method 2
Limit switch combined method Page 394 Home position return by the limit switch combined method
Scale home position signal detection method Page 396 Home position return by the scale home position signal detection method
Dogless home position signal reference method Page 398 Home position return by the dogless home position signal reference method
Driver home position return method Page 403 Home position return by the driver home position return method
5 POSITIONING CONTROL
376 5.21 Home Position Return
Program example
The servo program No. 0 for performing home position return of Axis 4 is explained as an example.
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
[F10]
SET M2042 Turn on all axes servo ON command.
[G10]
X0*M2475*M2462 Wait until X0, Axis 4 servo ready and in-position signal turn ON.
*1
[K0]
ZERO Home position return
Axis 4 Axis used ............... Axis 4
5
[G20]
!X0 Wait until X0 turn OFF after home position return completion.
END
*1 It is necessary to turn on the zero pass signal before execution of the home position return instruction for data set method home position
return.
*2 Example of the above Motion SFC program is started using the automatic start or sequence program.
Precautions
If the home position is not within the in-position range of servo parameter, it does not mean having reached the home position
and the home position return does not end in the proximity dog method, count method, data set method 1, dog cradle method,
limit switch combined method, scale home position signal detection method, dogless home position signal reference method,
or driver home position return method home position return. In this case, adjusts the in-position range of servo parameter or
position control gain.
5 POSITIONING CONTROL
5.21 Home Position Return 377
Home position return by the proximity dog method 1
Cautions
• Keep the proximity dog ON during deceleration from the home position return speed to the creep speed. If the proximity
dog turns OFF before deceleration to the creep speed, a deceleration stop is made and the next zero point is set as the
home position.
Home position return speed
The zero point is passed during deceleration stop by the
proximity dog OFF.
Proximity dog
ON OFF
Zero point
Zero point of this range does not become the home position.
The next zero point becomes the home position.
5 POSITIONING CONTROL
378 5.21 Home Position Return
• The position executed deceleration stop by the proximity dog OFF is near zero point, a home position discrepancy
equivalent to one revolution of the servo motor may occur. Adjust the position of proximity dog OFF, such that the home
position return re-travel value becomes half the travel value for one revolution of the servo motor.
If the position executed deceleration stop by the proximity dog
OFF is near zero point, the creep speed and deceleration
settings may result in a home position discrepancy equivalent
to one revolution of the servo motor.
Proximity dog
ON OFF
Zero point
When the home position return retry function is not set in the following cases, execute the home position
return, after return the axis once to position before the proximity dog ON by the JOG operation, etc.
Home position return cannot be executed without returning to position before the proximity dog ON.
• Home position return with a position after the proximity dog ON to OFF. 5
• When the power supply turned OFF to ON after home position return end.
• When it does not pass ("[St.1066] Zero pass (R: M32406+32n/Q: M2406+20n)" ON) the zero point from home position
return start to deceleration stop by proximity dog ON to OFF, a minor error (error code: 197AH) will occur, a deceleration
stop is made and home position return does not end normally. When a distance between home position return start position
and home position is near and a zero point is not passed, select the proximity dog method 2.
• If home position return is executed in the proximity dog ON, a minor error (error code: 197DH) will occur, the home position
return is not executed. Use the proximity dog method 2 in this case.
• When home position return retry function is not set, if home position return is executed again after home position return
end, a minor error (error code: 197BH) will occur, the home position return is not executed.
• If "[St.1062] In-position (R: M32402+32n/Q: M2402+20n)" does not turn ON, home position return is not ended.
5 POSITIONING CONTROL
5.21 Home Position Return 379
Home position return by the proximity dog method 2
5 POSITIONING CONTROL
380 5.21 Home Position Return
Cautions
• A system which the servo motor can rotate one time or more is required.
• When a servo motor stops with specified condition enables and rotates to reverse direction one time after proximity dog
ON, make a system for which does not turn OFF the external upper/lower stroke limit.
• Keep the proximity dog ON during deceleration from the home position return speed to the creep speed. If the proximity
dog turns OFF before deceleration to the creep speed, a deceleration stop is made and the next zero point is set as the
home position.
• If home position return is executed in the proximity dog ON, it starts with the creep speed.
• When home position return retry function is not set, if home position return is executed again after home position return
completion, a minor error (error code: 197BH) will occur, the home position return is not executed.
• When "1: Not need to pass motor Z phase after the power supply is switched on" is selected in the "function selection C-4
(PC17)" of servo parameter (expansion setting parameter), even if it does not pass zero point at the servo amplifier power
ON, the "[St.1066] Zero pass (R: M32406+32n/Q: M2406+20n)" turns ON. This operation is the same as proximity dog
method 1.
• If "[St.1062] In-position (R: M32402+32n/Q: M2402+20n)" does not turn ON, home position return is not ended.
5
5 POSITIONING CONTROL
5.21 Home Position Return 381
Home position return by the count method 1
Count method 1
After the proximity dog ON, the zero point after the specified distance (travel value after proximity dog ON) is home position in
this method. When the zero point is not passed ("[St.1066] Zero pass "(R: M32406+32n/Q: M2406+20n)" OFF) until it travels
the distance set in the "travel value after proximity dog ON" from home position return start, an error will occur and home
position return is not executed. However, when "1: Not need to pass motor Z phase after the power supply is switched on" is
selected in the "function selection C-4 (PC17)" of servo parameter (expansion setting parameter), if the zero point is not
passed until it travels the distance set in the "travel value after proximity dog ON" from home position return start, the home
position return can be executed.
The travel value after proximity dog ON is set in the home position return data (Page 177 Home Position Return Data).
Cautions
• Home position return and continuously start of home position return are also possible in the proximity dog ON in the count
method 1. When the home position return or continuously start of home position return are executed in the proximity dog
ON, the home position return is executed after return the axis once to position of the proximity dog OFF.
• When the zero point is not passed ("[St.1066] Zero pass (R: M32406+32n/Q: M2406+20n)" ON) until it travels the distance
set in the "travel value after proximity dog ON" from home position return start, a minor error (error code: 197AH) will occur,
a deceleration stop is made and home position return does not end normally. When a distance between home position
return start position and home position is near and a zero point is not passed, select the count method 3.
• When the "travel value after proximity dog ON" is less than the deceleration distance from "home position return speed" to
"creep speed", a minor error (error code: 1A57H) will occur and deceleration stop is made.
• If "[St.1062] In-position (R: M32402+32n/Q: M2402+20n)" does not turn ON, home position return is not ended.
5 POSITIONING CONTROL
382 5.21 Home Position Return
Home position return by the count method 2
Count method 2
After the proximity dog ON, the position which traveled the specified distance (travel value after proximity dog ON) is home
position in this method.
It is not related for zero point pass or not pass.
A count method 2 is effective method when a zero point signal cannot be taken. (However, dispersions will occur to the stop
position at the home position return compared with the count method 1.)
The travel value after proximity dog ON is set in the home position return data (Page 177 Home Position Return Data).
Cautions
• Home position return and continuously start of home position return are also possible in the proximity dog ON in the count
method 2. When the home position return and continuously start of home position return are executed in the proximity dog
ON, the home position return is executed after return the axis once to position of the proximity dog OFF.
• When the "travel value after proximity dog ON" is less than the deceleration distance from "home position return speed" to
"creep speed", a minor error (error code: 1A57H) will occur and deceleration stop is made.
• Command position is the home position.
• If "[St.1062] In-position (R: M32402+32n/Q: M2402+20n)" does not turn ON, home position return is not ended.
5 POSITIONING CONTROL
5.21 Home Position Return 383
Home position return by the count method 3
Count method 3
After the proximity dog ON, the zero point after the specified distance (travel value after proximity dog ON) is home position in
this method.
When the zero point is passed ("[St.1066] Zero pass (R: M32406+32n/Q: M2406+20n)" ON) during travel of specified distance
set in the "travel value after proximity dog ON" from the home position return start, home position return operation is the same
as "count method 1". (Page 382 Home position return by the count method 1)
When a zero point is not passed ("[St.1066] Zero pass (R: M32406+32n/Q: M2406+20n)" OFF) during travel of specified
distance set in the "travel value after proximity dog ON" from the home position return start, it rotates one time to reverse
direction and passes the zero point, re-travels to home position return direction, and then the first zero point after the specified
distance (travel value after proximity dog ON) after proximity dog ON is set as home position.
The travel value after proximity dog ON is set in the home position return data (Page 177 Home Position Return Data).
5 POSITIONING CONTROL
384 5.21 Home Position Return
Cautions
• A system which the servo motor can rotate one time or more is required.
• After the proximity dog ON, when a servo motor rotates one time to reverse direction after stop with travel value set in the
"travel value after proximity dog ON", make a system which does not turn OFF the external upper/lower stroke limit.
• Home position return and continuously start of home position return are also possible in the proximity dog ON in the count
method 3. When the home position return and continuously start of home position return are executed in the proximity dog
ON, the home position return is executed after return the axis once to position of the proximity dog OFF.
• When the "travel value after proximity dog ON" is less than the deceleration distance from "home position return speed" to
"creep speed", a minor error (error code: 1A57H) will occur and deceleration stop is made.
• When "1: Not need to pass motor Z phase after the power supply is switched on" is selected in the "function selection C-4
(PC17)" of servo parameter (expansion setting parameter), even if it does not pass zero point at the servo amplifier power
ON, the "[St.1066] Zero pass (R: M32406+32n/Q: M2406+20n)" turns ON. This operation is the same as count method 1.
• If "[St.1062] In-position (R: M32402+32n/Q: M2402+20n)" does not turn ON, home position return is not ended.
5 POSITIONING CONTROL
5.21 Home Position Return 385
Home position return by the data set method 1
Cautions
• A zero point must be passed ("[St.1066] Zero pass (R: M32406+32n/Q: M2406+20n)" ON) between turning ON the power
supply and executing home position return. If home position return is executed without passing a zero point once, minor
error (error code: 197AH) occurs. If minor error (error code: 197AH) occurred, perform the home position return again, after
reset the error and turn the servo motor at least one revolution by the JOG operation. The zero point passing can be
confirmed with the "[St.1066] Zero pass (R: M32406+32n/Q: M2406+20n)". However, when "1: Not need to pass motor Z
phase after the power supply is switched on" is selected in the "function selection C-4 (PC17)" of servo parameter
(expansion setting parameter), even if it does not pass zero point at the servo amplifier power ON, the home position return
is possible because the "[St.1066] Zero pass (R: M32406+32n/Q: M2406+20n)" turns ON.
• Home position return is started by the data set method 1 when the absolute position system does not support, it becomes
same function as the current value change command.
• The home position return data required for the data set method 1 are the home position return direction and home position
address.
• If "[St.1062] In-position (R: M32402+32n/Q: M2402+20n)" does not turn ON, home position return is not ended.
5 POSITIONING CONTROL
386 5.21 Home Position Return
Home position return by the data set method 2
Cautions
• A zero point must be passed ("[St.1066] Zero pass (R: M32406+32n/Q: M2406+20n)" ON) between turning on the power
supply and executing home position return. If home position return is executed without passing a zero point once, minor
error (error code: 197AH) occurs. If minor error (error code: 197AH) occurred, perform the home position return again, after
reset the error and turn the servo motor at least one revolution by the JOG operation. The zero point passing can be
confirmed with the "[St.1066] Zero pass (R: M32406+32n/Q: M2406+20n)". However, when "1: Not need to pass motor Z
phase after the power supply is switched on" is selected in the "function selection C-4 (PC17)" of servo parameter
(expansion setting parameter), even if it does not pass zero point at the servo amplifier power ON, the home position return
is possible because the "[St.1066] Zero pass (R: M32406+32n/Q: M2406+20n)" turns ON.
• The home position return data required for the data set method 2 are the home position return direction and home position
address.
5 POSITIONING CONTROL
5.21 Home Position Return 387
Home position return by the data set method 3
Cautions
• A zero point must be passed ("[St.1066] Zero pass (R: M32406+32n/Q: M2406+20n)" ON) between turning on the power
supply and executing home position return. If home position return is executed without passing a zero point once, minor
error (error code: 197AH) occurs. If minor error (error code: 197AH) occurred, perform the home position return again, after
reset the error and turn the servo motor at least one revolution by the JOG operation. The zero point passing can be
confirmed with the "[St.1066] Zero pass (R: M32406+32n/Q: M2406+20n)". However, when "1: Not need to pass motor Z
phase after the power supply is switched on" is selected in the "function selection C-4 (PC17)" of servo parameter
(expansion setting parameter), even if it does not pass zero point at the servo amplifier power ON, the home position return
is possible because the "[St.1066] Zero pass (R: M32406+32n/Q: M2406+20n)" turns ON.
• When executing home position return during servo OFF, fix the home position return target axis. (For servo motor speed of
20[r/min] or less, the home position return is completed.)
• Home position return is not performed at a servo error or forced stop. Perform a home position return after removing the
error cause and resetting the error.
• When performing data set method 3 home position return, do not change the servo ON/OFF status of the home position
return target axis while the home position return is being executed.
• The home position return data required for the data set method 3 are the home position return direction and home position
address.
5 POSITIONING CONTROL
388 5.21 Home Position Return
Home position return by the dog cradle method
Acceleration time º Deceleration time (1) It travels to preset direction of home position return with
the home position return speed, and a deceleration stop
5
V
Home position Home position is made by the proximity dog ON.
return direction return speed (2) After a deceleration stop, it travels to reverse direction of
home position return with the home position return speed.
(3) A deceleration stop is made when proximity dog turns
OFF and zero point is passed.
(1)
Creep speed (4) After a deceleration stop, it travels to direction of home
position return with the creep speed, the home position
(4) return ends with first zero point after the proximity dog ON.
Home position
Home position return start
(3)
(2)
5 POSITIONING CONTROL
5.21 Home Position Return 389
Cautions
• When home position return retry function is not set, if home position return is executed again after home position return
end, a minor error (error code: 197BH) will occur, the home position return is not executed.
• If the home position return is executed in the proximity dog, it travels to reverse direction of home position return. If
proximity dog turns OFF, a deceleration stop is made, it travels to direction of home position return again with the creep
speed and the first zero point after proximity dog ON is home position.
Acceleration time º Deceleration time (1) It travels to preset reverse direction of home position
return with the home position return speed.
V (2) A deceleration stop is made when proximity dog turns
Home position
return direction OFF and zero point is passed.
Creep speed (3) After a deceleration stop, it travels to direction of home
position return with the creep speed, and the home
(3)
position return ends with first zero point after the
proximity dog ON.
Home position
Home position return start
(2) (1)
Proximity dog
ON
Zero point
• When the proximity dog is set in the home position return direction, the proximity dog is turned OFF during travel to reverse
direction of home position return, and the zero point is not passed ("[St.1066] Zero pass (R: M32406+32n/Q: M2406+20n)"
OFF). It continues to travel in the reverse direction of home position return with home position return speed until the zero
point is passed. The zero point is passed again during deceleration by zero point pass, the home position becomes this
side compared with the case to pass zero point at the time of the proximity dog OFF.
Acceleration time º Deceleration time (1) It travels to preset direction of home position return with
the return speed.
V (2) A deceleration stop is made by the proximity dog ON.
Home position Home positio
return direction return speed (3) After a deceleration stop, it travels to reverse direction of
home position return with the home position return speed.
(4) It continues to travel after proximity dog turns OFF, and a
deceleration stop is made when zero point is passed.
(2) (5) After a deceleration stop, it travels to direction of home
(1) Creep speed position return with the creep speed, and the home position
return ends with first zero point after the proximity dog ON.
(5)
Home position
Home position return start
(4)
(3)
Home position return speed
Proximity dog
Zero point
5 POSITIONING CONTROL
390 5.21 Home Position Return
• When it starts in the proximity dog, the zero point is not passed ("[St.1066] Zero pass (R: M32406+32n/Q: M2406+20n)"
OFF) at the time of the proximity dog is turned OFF during travel to reverse direction of home position return. It continues to
travel with home position return speed until the zero point is passed. The zero point is passed again during deceleration by
zero point pass, the home position becomes this side compared with the case to pass zero point at the time of the proximity
dog OFF.
Acceleration time º Deceleration time (1) It travels to preset reverse direction of home position return
with the home position return speed.
V (2) It continues to travel after proximity dog turns OFF, and a
Home position
deceleration stop is made when zero point is passed.
return direction
(3) After a deceleration stop, it travels to direction of home
Creep speed
position return with the creep speed, and the home position
(3) return ends with first zero point after the proximity dog ON.
Home position
(1)
(2)
Home position return start
Home position return speed
5
Proximity dog
Zero point
• If the zero point is passed during deceleration, the nearest zero point from deceleration stop position to home position
return direction is set as the home position.
Acceleration time º Deceleration time (1) It travels to preset direction of home position return with the
home position return speed, and a deceleration stop is made
V by the proximity dog ON.
Home position Home position
return direction return speed (2) After a deceleration stop, it travels to reverse direction of
home position return with the home position return speed.
(3) If the zero point is passed by the proximity dog OFF, a
deceleration stop is made. (The zero point is passed during
(1)
Creep speed deceleration.)
(4) After a deceleration stop, it travels to the nearest zero point
(4) of home position return direction with the creep speed, and
the home position return ends.
Home
position
Home position return start
(3)
(2)
5 POSITIONING CONTROL
5.21 Home Position Return 391
Home position return by the stopper method 1
Stopper method 1
Position of stopper is home position in this method.
It travels to the direction set in the "home position return direction" with the "home position return speed", after a deceleration
starts by proximity dog OFF to ON and it presses against the stopper and makes to stop with the torque limit value set in the
"torque limit value at the creep speed" and "creep speed" of home position return data. Real position of servo motor at the
time of detection for turning the torque limiting signal OFF to ON is home position.
Torque limit value after reaching creep speed is set in the "torque limit value at the creep speed" of home position return data.
Stopper
Creep speed
Proximity dog
ON
[St.1076] Torque limiting
OFF
(R: M32416+32n/Q: M2416+20n)
*: "Travel value after proximity dog ON" storage register becomes "0" at the home position return start.
Cautions
• A zero point does not must be passed ("[St.1066] Zero pass (R: M32406+32n/Q: M2406+20n)" ON) between turning on the
power supply and executing home position return.
• Home position return retry function cannot be used in the stopper method 1.
• Set the torque limit value after reaching the creep speed for system. When the torque limit value is too large, servo motors
or machines may be damaged after pressing the stopper. Also, when the torque limit value is too small, it becomes the
torque limiting before pressing the stopper and ends the home position return.
• If the home position return is executed again after home position return completion, a minor error (error code: 197BH) will
occur, the home position return is not executed.
• Home position return is started during the proximity dog ON, it is started from the "creep speed".
5 POSITIONING CONTROL
392 5.21 Home Position Return
Home position return by the stopper method 2
Stopper method 2
Position of stopper is home position in this method.
It travels the direction set in the "home position return direction" with the "creep speed", and it presses against the stopper and
makes to stop with the "creep speed". (The torque limit value is valid set in the "torque limit value at the creep speed" of the
home position return data from the home position return start.) Real position of servo motor at the time of detection for turning
the torque limiting signal OFF to ON is home position. Torque limit value after reaching creep speed is set in the "torque limit
value at the creep speed" of home position return data.
Torque limit value Home position return data "torque limit value at the creep speed"
ON
[St.1076] Torque limiting
OFF
(R: M32416+32n/Q: M2416+20n)
*: "Travel value after proximity dog ON" storage register becomes "0" at the home position return start.
Cautions
• A zero point does not must be passed ("[St.1066] Zero pass (R: M32406+32n/Q: M2406+20n)" ON) between turning on the
power supply and executing home position return.
• Home position return retry function cannot be used in the stopper method 2.
• Set the torque limit value at the reaching creep speed for system. When the torque limit value is too large, servo motors or
machines may be damaged after pressing the stopper. Also, when the torque limit value is too small, it becomes the torque
limiting before pressing the stopper and ends the home position return.
• If the home position return is executed again after home position return completion, a minor error (error code: 197BH) will
occur, the home position return is not executed.
5 POSITIONING CONTROL
5.21 Home Position Return 393
Home position return by the limit switch combined method
Zero point
5 POSITIONING CONTROL
394 5.21 Home Position Return
Cautions
• For the axis which executes the home position return by the limit switch combined method, if the external input signal has
not been set in [Motion Control Parameter] [Axis Setting Parameter] "External Signal Parameter", a minor error (error
code: 19ECH) will occur and home position return is not executed.
• When the limit switch reverse to home position return direction is turned ON to OFF, deceleration stop is made, home
position return is not completed and a minor error (error code: 1905H, 1907H) will occur.
• Home position return retry function cannot be used in the limit switch combined method.
• If the home position return is executed with the limit switch OFF, it is started to reverse direction of home position return with
creep speed.
• When it does not pass ("[St.1066] Zero pass (R: M32406+32n/Q: M2406+20n)" ON) the zero point from home position
return start to deceleration stop by limit switch OFF, a minor error (error code: 197AH) will occur, a deceleration stop is
made and home position return does not end normally. However, when "1: Not need to pass motor Z phase after the power
supply is switched on" is selected in the "function selection C-4 (PC17)" of servo parameter (expansion setting parameter),
if the zero point is not passed until from home position return start to deceleration stop by limit switch OFF, the home
position return can be executed.
5
• Deceleration stop is executed after the limit switch OFF. Set the limit switch in expectation of deceleration distance.
• If the "[St.1062] In-position (R: M32402+32n/Q: M2402+20n)" is turned ON, home position return is not ended.
• When the width is in a zero point, the home position differs from the home position return by the proximity dog method 1,
proximity dog method 2, count method 1, count method 3, dog cradle method and scale home position signal detection
method.
5 POSITIONING CONTROL
5.21 Home Position Return 395
Home position return by the scale home position signal detection
method
Home position return by the scale home position signal detection method
Operation of home position return by the scale home position signal detection method for setting the proximity dog in the
home position return direction is shown below.
V (1) It travels to preset direction of home position return with the
Home position Home position home position return speed, and a deceleration stop is made
return direction return speed by the proximity dog ON.
(2) After a deceleration stop, it travels to reverse direction of home
position return with the home position return speed.
(1) (3) Home position signal (zero point) is detected, and a deceleration
Creep speed stop is made.
(4) After a deceleration stop, it travels to preset direction of home
position return with the creep speed, the home position return
(4) ends with the position of home position signal (zero point).
Home
Home position position
return start (3)
(2)
Zero point
Cautions
• When home position is in the proximity dog, if home position return is executed again after home position return end, a
minor error (error code: 1940H) will occur, the home position return is not executed.
• Set "0: Need to pass motor Z phase after the power supply is switched on" in the "function selection C-4 (PC17)" of servo
parameter (expansion setting parameter). When "1: Not need to pass motor Z phase after the power supply is switched on"
is set, a minor error (error code: 1978H) will occur at home position return by the scale home position signal detection
method starting, the home position return is not executed.
• When "[St.1066] Zero pass (R: M32406+32n/Q: M2406+20n)" turns on by passing zero point at home position return start,
this signal turns off once at the reverse direction of home position return start and turns on again at the next zero point
passage.
5 POSITIONING CONTROL
396 5.21 Home Position Return
• Home position return is executed in the proximity dog, it travels to reverse direction of home position return. If home
position signal (zero point) is detected, a deceleration stop is made, it travels to direction of home position return again with
the creep speed and the detecting position of home position signal (zero point) is home position.
V Home position (1) It travels to preset reverse direction of home position return
return direction with the home position return speed.
(2) Home position signal (zero point) is detected, and a
Creep speed deceleration stop is made.
Home position (3) After a deceleration stop, it travels to preset direction of home
(3) return start position return with the creep speed, and the home position
return ends with the position of home position signal (zero point).
Home
position
(2)
(1)
Proximity dog
External limit switch
Zero point 5
• If the zero point is passed during deceleration, the nearest position of home position signal (zero point) of home position
return direction from deceleration stop position is set as the home position.
V (1) It travels to preset direction of home position return with
Home position Home position the home position return speed, and a deceleration stop
return direction return speed is made by the proximity dog ON.
(2) After a deceleration stop, it travels to reverse direction of
home position return with the home position return speed.
(1) (3) Home position signal (zero point) is detected, and a
Creep speed deceleration stop is made. (The home position signal
(zero point) is passed during deceleration.)
(4) After a deceleration stop, it travels to preset direction of
(4) home position return with the creep speed, the home
position return ends with the nearest position of home
position signal (zero point).
Home
Home position position
return start
(3) (2)
Proximity dog
External limit switch
Zero point
• Home position return retry function cannot be used in the scale home position signal detection method.
• An error always occurs without the proximity dog in home position return direction from home position return starting
position. Make the proximity dog overlap in limit switch as shown in the figure above so that the proximity dog is set before
limit switch of home position return direction. And, when home position return is executed in the proximity dog, an error will
occur if zero point is not in reverse direction of home position return from home position return starting position.
• When there is only one zero point in the motor like linear motor, home position return may not be ended if zero point is in
the proximity dog. Set zero point before the proximity dog.
• If the "[St.1062] In-position (R: M32402+32n/Q: M2402+20n)" is not turned ON, home position return is not ended.
5 POSITIONING CONTROL
5.21 Home Position Return 397
Home position return by the dogless home position signal
reference method
*1 For the home position return operations, refer to home position return by the dogless home position signal reference method.
• Operation A (Page 399 Operation A)
• Operation B (Page 400 Operation B)
• Operation C (Page 400 Operation C)
*2 During semi closed loop control is equivalent to MR-J3-B and MR-J4-B (standard).
5 POSITIONING CONTROL
398 5.21 Home Position Return
Home position return by the dogless home position signal reference method
■ Operation A
"Operation A" of a home position return by the dogless home position signal reference method is shown below.
• When the zero point is in the home position return direction
V (1) It travels to preset direction of home position return with
Home position Home position the home position return speed..
return direction return speed (2) Home position signal (zero point) is detected, and a
(1) deceleration stop is made.
(3) After a deceleration stop, it travels to reverse direction
(2) of home position return with the creep speed, the home
position return ends with the position of home position
signal (zero point).
Zero point
5
• If an external limit switch is detected during a deceleration stop after zero point detection, an error occurs
and stops. Ensure there is enough distance between the zero point signal and external limit switch, or set
the deceleration time so the decelerating distance is shortened.
• If multiple home position signals (zero points) are passed during deceleration after zero point detection, by
the connected servo amplifier, the following operation occurs.
MR-J3-B-RJ004
MR-J3-B-RJ006
MR-J3-B-RJ080W Home position return ends at the position of the last home position
signal (zero point) passed.
• When the zero point is not in the home position return direction
V Home position (1) It travels to preset direction of home position return with
return speed Home position Home position the home position return speed.
return direction return speed (2) External limit switch is detected, and a deceleration stop
(1) is made.
(3) After a deceleration stop, it travels to reverse direction of
(6) (2) home position return with the home position return speed.
(4) Home position signal (zero point) is detected, and a
deceleration stop is made.
(5) Home (5) After a deceleration stop, it travels to home position return
position with the home position return speed.
(6) Home position signal (zero point) is detected, and a
(7) deceleration stop is made.
Home position (7) After a deceleration stop, it travels to reverse direction of
return start home position return with the creep speed, the home
(4) Creep speed
Home position position return ends with the position of home position
return speed signal (zero point).
Zero point
5 POSITIONING CONTROL
5.21 Home Position Return 399
■ Operation B
"Operation B" of a home position return by the dogless home position signal reference method is shown below.
V Home position
return direction (1) It travels to preset direction of home position return with
the creep speed.
Creep speed (2) The home position return ends with first zero point.
(1)
(2)
Home position
Home position
return start
Zero point
• If an external limit switch is detected during home position return operation, an error occurs and stops.
• Home position return retry function cannot be used.
■ Operation C
"Operation C" of a home position return by the dogless home position signal reference method is shown below.
• When the position where address of absolute linear encoder becomes 0 is in the home position return direction
V Home position
return direction (1) It travels to preset direction of home position return with
the creep speed.
Creep speed (2) The home position return ends the position where address
(1) of absolute linear encoder becomes 0.
(2)
Home position
Home position
return start
Linear encoder
address
• If an external limit switch is detected during home position return operation, an error occurs and stops.
• Home position return retry function cannot be used.
• When the position where address of absolute linear encoder becomes 0 is not in the home position return direction
V Home position
return direction (1) It travels to reverse of preset direction of home position return
with the home position return speed.
Creep speed (2) The position where address of absolute linear encoder becomes
(3) Home position 0 is detected, and a deceleration stop is made.
return start (3) After a deceleration stop, it travels to direction of home position
return with the creep speed, and the home position return ends
with the position where address of absolute linear encoder
Home position becomes 0.
(2) (1)
5 POSITIONING CONTROL
400 5.21 Home Position Return
• If an external limit switch is detected during home position return operation, an error occurs and stops.
• Home position return retry function cannot be used.
Cautions
• If a home position return is started for an axis connected with servo amplifiers other than MR-J3(W)-B, MR-J4(W)-B, a
minor error (error code: 1979H) will occur and the home position return is not executed.
• If home position return is executed again after home position return end, a minor error (error code: 197BH) will occur, the
home position return is not executed.
• If connecting a rotational motor on the load side with a fully closed loop control servo amplifier (MR-J3-B-RJ006, MR-J4-
B), execute home position return in a semi closed loop control state. (The home position return operation becomes that of
5
"Operation B".)
If a home position return is performed in a fully closed loop control state, the home position return is at the
position of encoder current value of multiple revolution position=0, and single revolution position=0 (The home
position return operation becomes that of "Operation C"), and the motor might revolve more than necessary.
When connecting a rotational motor on the load side, execute home position return in a semi closed loop
control state.
• If executing home position return with a fully closed loop control servo amplifier (MR-J3-B-RJ006, MR-J4-B), do not
change fully closed loop control/semi closed loop control during home position return operation. When fully closed loop
control/semi closed loop control is changed during home position return operation, the home position return might not be
completed normally
• If performing home position return from zero point, depending on the actual motor position at the start, and it's relative
position to zero point, the home position return might be completed at the next zero point. It is recommended to move the
start of the home position return from the zero point to a position in the reverse direction of home position return direction.
• The operation for when home position return is executed during the operation of amplifier-less operation function is shown
below.
Servo amplifier Operation
MR-J3(W)-B Regardless of the servo amplifier model, home position return is executed by the home position return operation of
"Operation B".
MR-J4(W)-B Home position return is performed by the home position return operation that complies with the amplifier operation
mode that is set in [Motion CPU Common Parameter] [Servo Network Setting] "Amplifier Setting".
5 POSITIONING CONTROL
5.21 Home Position Return 401
• The following describes precautions for the home position return operations for the home position return by dogless home
position signal reference method.
Home position return operation Cautions
Operation A • Set the servo parameter (expansion parameter) "Function selection C-4 (PC17)" to "0: Need to pass motor Z phase
after the power supply is switched on". If set to "1: Not need to pass motor Z phase after the power supply is
switched on", when home position return by dogless home position signal reference method (operation A) is
started, a minor error (error code: 1978H) will occur and the home position return is not executed.
• If the "[St.1066] Zero pass (R: M32406+32n/Q: M2046+20n)" was on at home position return start, this signal turns
off once at the home position return start and turns on again at the next zero point passage.
• If an external limit switch is detected during a deceleration stop after zero point detection, an error occurs and
stops. Ensure there is enough distance between the zero point signal and external limit switch, or set the
deceleration time so the decelerating distance is shortened.
• With home position return retry function valid, if zero point is detected during a deceleration stop after external limit
switch is detected, an error occurs and stops. Set the external limit switch in a position that puts the zero signal
inside the external limit switch.
Operation B • Set the servo parameter (expansion parameter) "Function selection C-4 (PC17)" to "1: Not need to pass motor Z
phase after the power supply is switched on". If set to "0: Need to pass motor Z phase after the power supply is
switched on", when home position return by dogless home position signal reference method (operation B) is
started, a minor error (error code: 1978H) will occur and the home position return is not executed.
• Home position return retry function cannot be used.
Operation C • If an external limit switch is detected during home position return operation, an error occurs and stops.
• Home position return retry function cannot be used.
5 POSITIONING CONTROL
402 5.21 Home Position Return
Home position return by the driver home position return method
Cautions
• If a home position return is started for an axis that is not connected to a stepping driver, a minor error (error code: 1979H)
will occur and the home position return is not executed.
• When a stop cause is detected during driver home position return, home position return operation is stopped. The stopping
operation for when a stop cause is detected depends on the stepping driver. Refer to the manual of the stepping driver
being used for details.
• During driver home position return, the home position return is performed based on the home position return direction of the
parameters on the stepping driver side. Make sure the home position return direction is the same as home position return
direction of the parameters on the stepping driver side.
5 POSITIONING CONTROL
5.21 Home Position Return 403
Home position return retry function
When a current value has been exceeded home position during positioning control, etc., even if it executes the home position
return, depending on the position of current value, a current value may not travel to home position direction. In this case, a
current value is normally travelled before the proximity dog by the JOG operation etc., and the home position return is started
again. However, by using the home position return retry function, the home position return can be executed regardless of
current value position.
Refer to the following for home position return method by using the home position return retry function. (Page 186 Setting
items for home position return data)
Setting data
When the "home position return retry function" is used, set the following "home position return data" using MT Developer2.
Set the "dwell time at the home position return retry" as required.
Set the parameters for every axis.
Processing details
Operation for the home position return retry function is shown below.
■ Home position return retry operation setting a current value within the range of external limit
switch
Acceleration time º Deceleration time
Zero point
5 POSITIONING CONTROL
404 5.21 Home Position Return
■ Home position return retry operation setting a current value outside the range of external limit
switch
• When the direction of "current value home position" and home position return is same, normal home position return is
operated.
Direction of "current value home position" and home position return is same
Home position
return direction
Home position
return start
Home position
RLS FLS
Proximity dog
Zero point
Travel range 5
• When the direction of "current value home position" and home position return is reverse, deceleration stop is made with
the proximity dog OFF and home position return is operated to preset direction of home position return.
Direction of "current value home position" and home position return is reverse (1) It travels to preset reverse direction of home position
return with the home position return speed.
Home position
(2) A deceleration stop is made by the proximity dog OFF.
return direction
(3) After a deceleration stop, it travels to direction of home
position return, the home position return ends.
(3)
Home position return start
Home position
(2)
(1)
RLS FLS
Proximity dog
Zero point
Travel range
5 POSITIONING CONTROL
5.21 Home Position Return 405
■ Dwell time setting at the home position return retry
Reverse operation by detection of the external upper/lower limit switch and dwell time function at the home position return
start after stop by proximity dog OFF are possible with the dwell time at the home position return retry in the home position
return retry function.
Dwell time at the home position return retry becomes valid at the time of deceleration stop of the following 2) and 4). (Dwell
time operates with the same value.)
(5) (1)
(2)
(6)
(3)
External limit switch
Proximity dog
Zero point
The temporary stop is made during time set in the (1) It travels to preset direction of home position return.
"dwell time at the home position return retry". (2) If the external upper/lower limit switch turns OFF before the detection of proximity
dog, a deceleration is made and the temporary stop is made during time set in the
"dwell time at the home position return retry".
(3) After a stop, it travels to reverse direction of home position return with the home
position return speed.
(4) A deceleration is made by the proximity dog OFF and the temporary stop is made
during time set in the "dwell time at the home position return retry".
(5) After a stop, it travels to direction of home position return.
(6) Home position return ends. At this time, the "dwell time at the home position return
retry" is invalid.
Precautions
• Possible/not possible of home position return retry function by the home position return method is shown below.
: Possible, : Not possible
Home position return methods Possible/not possible of home position return retry function
Proximity dog method
Count method
Data set method
Dog cradle method
Stopper method
Limit switch combined method
Scale home position signal detection method
Dogless home position signal Operation A
reference method Operation B
Operation C
Driver home position return method
• Make a system for which does not execute the servo amplifier power off or servo OFF by the external upper/lower limit
switch. Home position return retry cannot be executed only in the state of servo ON.
• Deceleration is made by detection of the external limit switch and travel to reverse direction of home position return is
started. In this case, a minor error (error codes: 1904H to 1907H) will not occur.
CAUTION
• Be sure to set the external limit switch (FLS, RLS) in the upper/lower position of machines. If the home position return retry function is used without external
limit switch, servo motors continue rotating.
5 POSITIONING CONTROL
406 5.21 Home Position Return
Home position shift function
Normally, when the machine home position return is executed, a position of home position is set by using the proximity dog or
zero point signal. However, by using the home position shift function, the position to which only the specified travel value was
travelled from the position which detected the zero point signal can be regarded as home position.
Setting data
Set the following "home position return data" using MT Developer2 to use the home position shift function.
Refer to the following for home position return method by using the home position shift function. (Page 186 Setting items
for home position return data)
Set the parameters for every axis.
Processing details
■ Home position shift operation
Operation for the home position shift function is shown below.
Proximity dog
Zero point
Proximity dog
Zero point
5 POSITIONING CONTROL
5.21 Home Position Return 407
■ Setting range of home position shift amount
Set the home position shift amount within the range of from the detected zero signal to external upper/lower limit switch (FLS/
RLS). If the range of external upper/lower limit switch is exceeded, a minor error (error codes: 1905H, 1907H) will occur at
that time and the home position return is not ended.
Zero point
Proximity dog
Zero point
Proximity dog
Zero point
5 POSITIONING CONTROL
408 5.21 Home Position Return
Precautions
• Valid/invalid of home position shift amount setting value by the home position return method.
: Valid, : Invalid
Home position return methods Possible/not possible of home position return retry function
Proximity dog method
Count method
Data set method
Dog cradle method
Stopper method
Limit switch combined method
Scale home position signal detection method
Dogless home position signal reference method
Driver home position return method
• Axis monitor devices and axis statuses are set after completion of home position shift. 5
• When the home position return by proximity dog method set the travel value after proximity dog ON and home position shift
amount within the range of "-2147483648 to 2147483647" [10-1m, 10-5inch, 10-5degree, pulse].
5 POSITIONING CONTROL
5.21 Home Position Return 409
Home position set condition selection
A home position return must be made after the servo motor has been rotated more than one revolution to pass the axis
through the Z-phase (motor reference position signal) and "[St.1066] Zero pass (R: M32406+32n/Q: M2406+20n)" has been
turned ON. When "1: Not need to pass motor Z phase after the power supply is switched on" is selected in "Function selection
C-4 (PC17), Selection of home position setting condition" in the servo parameter (expansion setting parameter), "[St.1066]
Zero pass (R: M32406+32n/Q: M2406+20n)" can be turned ON even if the servo motor does not pass zero point with the
motor rotation after turning the servo amplifier power ON.
Setting data
Set the following "Servo parameter" using MT Developer2 to select "Function selection C-4 (PC17)".
Set the servo parameters for every axis.
Precautions
• When "1: Not need to pass motor Z phase after the power supply is switched on" is set as the above servo parameter, a
restrictions such as "make the home position return after the servo motor is rotated more than one revolution to pass the
axis through the Z-phase (motor reference position signal)" is lost.
• When "1: Not need to pass motor Z phase after the power supply is switched on" is selected in the "function selection C-4
(PC17)" of servo parameter (expansion setting parameter), if it does not pass zero point at the servo amplifier power ON,
the "[St.1066] Zero pass (R: M32406+32n/Q: M2406+20n)" turns ON.
• When the above parameter is changed, control circuit power supply of the servo amplifier is turned OFF to ON after
resetting or turning power OFF to ON of Multiple CPU system.
• Set "0: Need to pass motor Z phase after the power supply is switched on" in the "function selection C-4
(PC17)" of servo parameter (expansion setting parameter) for the home position return by the scale home
position signal detection method. If "1: Not need to pass motor Z phase after the power supply is switched
on" is set, a minor error (error code: 1978H) will occur at the home position return start and the home
position return is not executed.
• When executing home position return by dogless home position signal reference method, set the servo
parameter (expansion parameter) "Function selection C-4 (PC17)" by the servo amplifier connected.
(Page 398 Home position return by the dogless home position signal reference method)
5 POSITIONING CONTROL
410 5.21 Home Position Return
5.22 Current Value Change
The current value of the specified servo motor/command generation axis is changed.
: Must be set, : Set if required
FIN acceleration/deceleration
Rapid Stop deceleration time
5
Repeat condition
Command speed
Auxiliary point
Starting angle
WAIT-ON/OFF
Central point
S-curve ratio
Program No.
Frequency
Dwell time
Amplitude
M-code
Radius
Axis
Skip
CHGA Absolute 1 ¨ ¨
Processing details
• Executing the CHGA instruction changes the current value in the following procedure.
1. The "[St.1040] Start accept flag (R: M30080+n/Q: M2001+n)" corresponding to the specified axis is turned on. For the
command generation axis, "[St.345] Command generation axis start accept flag (R: M36570+32n/Q: M9810+20n)"
corresponding to the specified axis is turned on.
2. The feed current value of the specified axis is changed to the specified address. In this case, the servo motor (output
axis) does not move.
3. Start accept flag is turned off at completion of the feed current value change.
• When the servo program is not assigned to the command generation axis program, the operation is as follows.
• The current value of the specified servo motor axis is changed.
• The address which made the current value change by CHGA instruction is valid on the power supply turning on
• The feed current value that is restored after the Multiple CPU system power supply or the control circuit power supply of the servo amplifier is turned ON
again, is returned to the state before the performing of the current value change by the CHGA instruction.
• When the servo program is assigned to the command generation axis program, a current value change is performed for the
specified command generation axis.
Program example
A program for performing the current value change control of Axis 2 is explained as an example.
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
• Start command of current value change control: Leading edge of X0 (OFF ON)
5 POSITIONING CONTROL
5.22 Current Value Change 411
■ Operation timing
The operation timing for current value change is shown below.
CHGA instruction
[F10]
SET M2042 Turn on all axes servo ON command.
[G10]
X0*M2435 Wait until X0 and Axis 2 servo ready turn ON.
[K10]
CHGA Current value change control
Axis 2, 50 Axis used ....................................... Axis 2
Current value change address ...... 50
[G20]
!X0 Wait until X0 turn OFF after current value change completion.
END
5 POSITIONING CONTROL
412 5.22 Current Value Change
6 MANUAL CONTROL
This section describes the manual control methods.
Individual start
JOG operation for the specified axes is started.
JOG operation is executed by the following JOG start commands:
• [Rq.1142] Forward JOG start command (R: M34482+32n/Q: M3202+20n) 6
• [Rq.1143] Reverse JOG start command (R: M34483+32n/Q: M3203+20n)
Processing details
• JOG operation continues at the "[Cd.1110] JOG speed setting (R: D35120+2n, D35121+2n/Q: D640+2n, D641+2n)" value
while the JOG start command turns on, and a deceleration stop is made by the JOG start command OFF. Control of
acceleration/deceleration is based on the data set in JOG operation data. JOG operation for axis for which JOG start
command is turning on is executed.
V JOG operation speed
Acceleration based on
JOG operation data Deceleration stop based
on JOG operation data
t
ON
JOG start command OFF
[Rq.1142] Forward JOG start command
(R: M34482+32n/Q: M3202+20n)
[Rq.1143] Reverse JOG start command
(R: M34483+32n/Q: M3203+20n)
• The setting range for "[Cd.1110] JOG speed setting (R: D35120+2n, D35121+2n/Q: D640+2n, D641+2n)" are shown below.
Device name Setting range
mm inch degree pulse
[Cd.1110] JOG speed setting 1 to 600000000 1 to 600000000 1 to 2147483647 1 to 2147483647
(R: D35120+2n, D35121+2n/ (10-2 [mm/min]) (10-3 [inch/min]) (10-3 [degree/min])*1 [pulse/s]
Q: D640+2n, D641+2n)
*1 When the "speed control 10 multiplier setting for degree axis" is set to "valid" in the fixed parameter, the unit is "10-2 [degree/min]"
6 MANUAL CONTROL
6.1 JOG Operation 413
Precautions
• If the "[Rq.1142] Forward JOG start command (R: M34482+32n/Q: M3202+20n)" and "[Rq.1143] Reverse JOG start
command (R: M34483+32n/Q: M3203+20n)" turn on simultaneously for a single axis, the forward JOG operation is
executed. When a deceleration stop is made by the "[Rq.1142] Forward JOG start command (R: M34482+32n/Q:
M3202+20n)" OFF the reverse JOG operation is not executed even if the "[Rq.1143] Reverse JOG start command (R:
M34483+32n/Q: M3203+20n)" is ON. After that, when the reverse JOG start command turns off to on, the reverse JOG
operation is executed.
V Forward JOG operation
ON
[Rq.1142] Forward JOG start command Reverse JOG
(R: M34482+32n/Q: M3202+20n) OFF operation
ON
[Rq.1143] Reverse JOG start command
(R: M34483+32n/Q: M3203+20n) OFF
• If the JOG start command ("[Rq.1142] Forward JOG start command (R: M34482+32n/Q: M3202+20n)" / "[Rq.1143]
Reverse JOG start command (R: M34483+32n/Q: M3203+20n)") turns on during deceleration by the JOG start command
OFF, after deceleration stop, JOG operation is not executed. After that, the JOG operation is executed by the JOG start
command OFF to ON.
V
JOG operation
ON
JOG start command OFF
• JOG operation by the JOG start command ("[Rq.1142] Forward JOG start command (R: M34482+32n/Q: M3202+20n)" /
"[Rq.1143] Reverse JOG start command (R: M34483+32n/Q: M3203+20n)") is not executed during the test mode using MT
Developer2. After release of test mode, the JOG operation is executed by turning the JOG start command off to on.
V JOG operation is impossible JOG operation
because not leading edge of
JOG start command
JOG operation is impossible
during test mode (start error)
ON
During test mode (SM501) OFF
ON
JOG start command OFF
6 MANUAL CONTROL
414 6.1 JOG Operation
Program example
The program for performing JOG operation of Axis 1 and Axis 2 is explained as an example.
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
[F10]
SET M2042 Turn on all axes servo ON command. 6
[G10]
M2415*M2435 Wait until Axis 1 servo ready and Axis 2 servo ready turn on.
P1
[F20]
D640L=K100000 Transfer the JOG operation speed to D640L and D642L.
D642L=K100000
[F30]
SET M3202=X3*!M3203 Axis 1, Axis 2 forward/reverse JOG operation
RST M3202=!X3 Axis 1 forward JOG start command SET/RST
SET M3203=X4*!M3202
RST M3203=!X4 Axis 1 reverse JOG start command SET/RST
SET M3222=X5*!M3223
RST M3222=!X5 Axis 2 forward JOG start command SET/RST
SET M3223=X6*!M3222
RST M3223=!X6 Axis 2 reverse JOG start command SET/RST
P1
*1 Example of the above Motion SFC program is started using the automatic start or sequence program.
6 MANUAL CONTROL
6.1 JOG Operation 415
Simultaneous start
Simultaneous start JOG operation for specified multiple axes.
Processing details
• JOG operation continues at the JOG speed setting register value for each axis while the "[Rq.1124] JOG operation
simultaneous start command (R: M30048/Q: M2048)" turns on, and a deceleration stop is made by the "[Rq.1124] JOG
operation simultaneous start command (R: M30048/Q: M2048)" OFF. Control of acceleration/deceleration is based on the
data set in the JOG operation data.
JOG operation speed
V
Acceleration based on
JOG operation data Deceleration stop based
on JOG operation data
t
JOG operation by data on JOG operation
[Cd.1096] JOG operation simultaneous start axis setting register simultaneous start axis setting register
(forward JOG) (R: D35286 to D35289/Q: D710, D711)/
[Cd.1097] JOG operation simultaneous start axis setting register
(reverse JOG) (R: D35290 to D35293/Q: D712, D713)
ON
[Rq.1124] JOG operation simultaneous start command
(R: M30048/Q: M2048) OFF
• JOG operation axis is set in the "[Cd.1096] JOG operation simultaneous start axis setting register (forward JOG) (R:
D35286 to D35289/Q: D710, D711)" / "[Cd.1097] JOG operation simultaneous start axis setting register (reverse JOG) (R:
D35290 to D35293/Q: D712, D713)".
b15 b14 b13 b12 b11 b10 b9 b8 b7 b6 b5 b4 b3 b2 b1 b0
R: D35286/ Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis
Q: D710 16 15 14 13 12 11 10 9 8 7 6 5 4 3 2 1
[Cd.1096] JOG operation R: D35287/ Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis
simultaneous start axis Q: D711 32 31 30 29 28 27 26 25 24 23 22 21 20 19 18 17
setting registers Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis
(Forward rotation JOG) R: D35288 48 47 46 45 44 43 42 41 40 39 38 37 36 35 34 33
Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis
R: D35289 64 63 62 61 60 59 58 57 56 55 54 53 52 51 50 49
R: D35290/ Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis
Q: D712 16 15 14 13 12 11 10 9 8 7 6 5 4 3 2 1
[Cd.1097] JOG operation R: D35291/ Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis
simultaneous start axis Q: D713 32 31 30 29 28 27 26 25 24 23 22 21 20 19 18 17
setting registers Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis
(Reverse rotation JOG) R: D35292 48 47 46 45 44 43 42 41 40 39 38 37 36 35 34 33
Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis Axis
R: D35293 64 63 62 61 60 59 58 57 56 55 54 53 52 51 50 49
*1: Make JOG operation simultaneous start axis setting with 1/0.
1: Simultaneous start execution
0: Simultaneous start not execution
*2: The following range is valid.
R16MTCPU: Axis No.1 to 16, R32MTCPU: Axis No.1 to 32.
• The setting range for "[Cd.1110] JOG speed setting (R: D35120+2n, D35121+2n/Q: D640+2n, D641+2n)" are shown below.
Device name Setting range
mm inch degree pulse
[Cd.1110]JOG speed setting 1 to 600000000 1 to 600000000 1 to 2147483647 1 to 2147483647
(R: D35120+2n, D35121+2n/ (10-2 [mm/min]) (10-3 [inch/min]) (10-3 [degree/min])*1 [pulse/s]
Q: D640+2n, D641+2n)
*1 When the "speed control 10 multiplier setting for degree axis" is set to "valid" in the fixed parameter, the unit is " 10-2 [degree/min]".
6 MANUAL CONTROL
416 6.1 JOG Operation
Program example
The program for performing simultaneous start of JOG operations of Axis 1 and Axis 2 is explained as an example.
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
P1
[G20]
X0
P1
*1 Example of the above Motion SFC program is started using the automatic start or sequence program.
6 MANUAL CONTROL
6.1 JOG Operation 417
6.2 Manual Pulse Generator Operation
Positioning control based on the number of pulses inputted from the manual pulse generator is executed.
Simultaneous operation for 1 to 3 axes is possible with one manual pulse generator, the number of connectable modules are
shown below.
Number of connectable to the manual pulse generator
3
Setting data
■ Usable modules
The manual pulse generator is connected to a high-speed counter module controlled by the self CPU. The following high-
speed counter modules can be used.
Module Model
High-speed counter modules RD62P2
RD62D2
If a fault is detected when the above setting is checked during initialization of a Motion CPU, a moderate error (error code:
30D4H) is output and the Motion CPU does not run.
The count enable command (Y signal) is set to "Always ON" for the relevant channel of the high-speed
counter module for which the manual pulse generator is set to connect to.
6 MANUAL CONTROL
418 6.2 Manual Pulse Generator Operation
Processing details
■ Manual pulse generator enable flag
• Positioning of the axis set in the manual pulse generator axis setting register based on the pulse input from the manual
pulse generator. Manual pulse generator operation is only valid while the manual pulse generator enable flag turn ON.
Manual pulse generator Manual pulse generator axis No. setting register Manual pulse generator enable flag
connecting position
P1 [Cd.1098] Manual pulse generator 1 axis No. setting register [Rq.1125] Manual pulse generator 1 enable flag
(R: D35294 to D35297/Q: D714, D715) (R: M30051/Q: M2051)
P2 [Cd.1099] Manual pulse generator 2 axis No. setting register [Rq.1126] Manual pulse generator 2 enable flag
(R: D35298 to D35301/Q: D716, D717) (R: M30052/Q: M2052)
P3 [Cd.1100] Manual pulse generator 3 axis No. setting register [Rq.1127] Manual pulse generator 3 enable flag
(R: D35302 to D35305/Q: D718, D719) (R: M30053/Q: M2053)
The travel value per pulse for manual pulse generator operation is shown below.
Unit Travel value
mm 0.1 [m]
inch 0.00001 [inch]
degree 0.00001 [degree]
pulse 1 [pulse]
If units is [mm], the command travel value for input of one pulse is: (0.1 [m]) (1 [pulse]) (Manual pulse generator 1-pulse
input magnification setting)
• Output speed
The output speed is the positioning speed corresponding to the number of pulses input from a manual pulse generator in
unit time.
[Output speed] = [Number of input pulses per 1 [ms]] [Manual pulse generator 1-pulse input magnification setting]
*1 The manual pulse generator does not have a speed limit value, so set the magnification setting within the rated speed of the servo
motor.
6 MANUAL CONTROL
6.2 Manual Pulse Generator Operation 419
■ Check of the manual pulse generator 1-pulse input magnification
The setting manual pulse generator 1-pulse input magnification checks the "1-pulse input magnification setting registers of the
manual pulse generator" of the applicable axis at leading edge of manual pulse generator enable flag. If the value is outside of
range, a warning (error code: 0988H) occurs and a value of "1" is used for the magnification.
• Operation
V V1
t t t t
Output speed (V1) = [Number of input pulses/ms] [Manual pulse generator 1-pulse input magnification setting]
Travel value (L) = [Travel value per pulse] [Number of input pulses] [Manual pulse generator 1-pulse input magnification
setting]
• When the smoothing magnification is set, the smoothing time constant is as following formula.
The smoothing time constant is within the range of 56.8 to 3408 [ms].
6 MANUAL CONTROL
420 6.2 Manual Pulse Generator Operation
Precautions
• The start accept flag turns on for axis during manual pulse generator operation. Positioning control or home position return
cannot be started using the Motion CPU or MT Developer2. Turn off the manual pulse generator enable flag after the
manual pulse generator operation end.
• When the torque limit value is not specified with M(P).CHGT/D(P).CHGT (torque limit value change request instruction form
the PLC CPU to the Motion CPU), or CHGT (torque limit value change request), the torque limit value is fixed at 300.0 [%]
during manual pulse generator operation.
• If the manual pulse generator enable flag turns on for the axis for which the start accept flag is ON, a minor error (error
code: 192AH) occurs, and manual pulse generator input is not enabled. When enabling the manual pulse generator input,
turn the manual pulse generator flag ON again while the start accept flag is OFF.
V Positioning control
Manual pulse generator operation
t
ON
[Rq.1125]Manual pulse generator 1
enable flag (R: M30051/Q: M2051) OFF
Enable
6
Manual pulse generator enable status Disable
ON
Start accept flag OFF
• If another axis is set and the same manual pulse generator enable flag turns on again during smoothing deceleration after
manual pulse generator enable flag turns off, a minor error (error code: 198EH) occurs, and the manual pulse generator
input is not enabled. At this time, include the start accept flag OFF for specified axis as an interlock condition for turning ON
the manual pulse generator enable flag.
Operating procedure
Procedure for manual pulse generator operation is shown below.
Start
End
6 MANUAL CONTROL
6.2 Manual Pulse Generator Operation 421
Program example
The program for performing manual pulse generator operation of Axis 1 and Axis 2 is explained as an example.
This program example is explained in the "Q series Motion compatible device assignment" device assignment method.
■ System configuration
Motion CPU control module
[F10]
SET M2042
[G10]
X0*M2415*M2435 Wait until X0, Axis 1 servo ready and Axis 2 servo ready turn ON.
[F20]
D720=100 Manual pulse generator 1-pulse input magnification for Axis 1, Axis 2.
D721=100
D714L=H00000001 Control Axis 1 by P1.
D716L=H00000002 Control Axis 2 by P2.
SET M2051 Manual pulse generator 1 enable flag ON for P1
SET M2052 Manual pulse generator 2 enable flag ON for P2
[G20]
!X0 Wait until X0 turn OFF after manual pulse generator operation end.
[F30]
RST M2051 Manual pulse generator 1 enable flag OFF for P1
RST M2052 Manual pulse generator 2 enable flag OFF for P2
*: Turn the manual pulse generator enable flag OFF for P1, P2,
so that the operation may not continue for safety.
END
*1 Example of the above Motion SFC program is started using the automatic start or sequence program.
6 MANUAL CONTROL
422 6.2 Manual Pulse Generator Operation
7 AUXILIARY AND APPLIED FUNCTIONS
This section describes the auxiliary and applied functions for positioning control in the Multiple CPU system.
Setting of M-codes
M-code can be set using MT Developer2 at the creation and correction of the servo program.
t
ON
[Rq.1120] PLC ready flag
(R: M30000/Q: M2000) OFF
M-code
Storage of setting M-code No.
Resetting of M-codes
M-codes can be reset by setting of the M-code output devices to zero.
Use this method during positioning control to perform operations unrelated to the servo program, such as when it has been
difficult to output the M-code during the previous positioning control. However, M-code is set during the speed switching
control or continuous trajectory control, the M-code output of the servo program takes priority.
• Motion SFC program with the above conditions are shown below.
System Configuration
Reading of M-codes
[F10] #0=0
#1=0
#2=0
[F20]
SET M2042 All axes servo ON command turns on
[G10]
X0*M2455 Stand by until X0 and Axis 3 servo ready turns on
[K100]
CPSTART1 1 axis continuous trajectory control
Axis 3 Axis used . . . Axis 3
Speed 1000pulse/s Speed . . . . . . 1000 pulse/s
INC-1 1 axis linear positioning control
Axis 3, 200000pulse Axis used . . . . . . . . . . Axis 3
M-code 3 Positioning address. . . 200000 pulse
INC-1 M-code output . . . . . . . 3
Axis 3, 300000pulse 1 axis linear positioning control
M-code 5 Axis used . . . . . . . . . . Axis 3
INC-1 Positioning address. . . 300000 pulse
Axis 3, 400000pulse M-code output . . . . . . . 5
M-code 4 1 axis linear positioning control
CPEND Axis used . . . . . . . . . . Axis 3
Positioning address. . . 400000 pulse
P0 M-code output . . . . . . . 4
[G20]
D53==3 M-code (3) for axis 3 ?
[F30]
#0=BCD(D53)
After M-code storage area for axis 3 is changed into
DOUT Y10,#0
BCD code, it is output to Y10 and Y20 turns on.M
SET Y20
[G30]
D53==5 M-code (5) for axis 3 ?
[F40]
1=BCD(D53)
After M-code storage area for axis 3 is changed into BCD
DOUT Y10,#1
code, it is output to Y10 and Y21 turns on.
SET Y21
[G40]
(D53==3)+(D53==5) M-code (except 3 or 5) for axis 3 ?
[G50]
!M2003 P0
END
Feed screw
Workpiece
• When backlash compensation amount has been set, feed pulses of the backlash compensation amount are
added to the position command value but are not added to feed current value.
• When the backlash compensation amount is changed, the home position return is required. When the home
position return is not executed, the original backlash compensation amount is not changed.
Even while the Multiple CPU system power supply is ON, the torque limit value is returned to the default value
of 300.0[%] when the control circuit power supply of the servo amplifier is turned ON again, or when the
SSCNET communication is disconnected or connected again. Set the torque control value again as required
using the Motion SFC program or the Motion dedicated PLC instruction.
When the torque limit value is set individually for positive direction and negative direction in the Motion SFC
program or Motion dedicated PLC instruction, only either one of the positive direction or negative direction
may become valid depending on the setting value of servo program.
Operation description
Torque limit value [%] : Positive direction torque limit value (Forward rotation (CCW) driving torque and
reverse rotation (CW) regenerative torque)
60.0
: Negative direction torque limit value (Reverse rotation (CW) regenerative torque
and forward rotation (CCW) driving torque)
40.0
20.0
t
0
*1 The torque limit value specified with servo program is clamped with the negative direction torque limit value changed by CHGT.
*2 The torque limit value is not changed so that "-1" is set as the positive direction torque limit value of CHGT.
Start
Positioning start using the servo . . . . . Positioning does not start if the STOP signal,
program "[Rq.1140] Stop command (R: M34480+32n/Q: M3200+20n)" or
"[Rq.1141] Rapid stop command (R: M34481+32n/Q: M3201+20n)" turns on.
Turn on the "[Rq.1149] External . . . . . Turn "[Rq.1149] External stop input disable at start command
stop input disable at start (R: M34489+32n/Q: M3209+20n)" on to use the skip function.
command (R: M34489+32n/ (The external STOP signal becomes invalid at the next positioning start.)
Q: M3209+20n)" If "[Rq.1149] External stop input disable at start command
(R: M34489+32n/Q: M3209+20n)" turns off, the external STOP signal
becomes valid, and if the STOP signal is input, the positioning does not start.
Start the positioning using the . . . . . Confirm the operation stop with the "[St.1040] start accept flag
next servo program after (R: M30080+n/Q: M2001+n)" turns off.
deceleration stop
End
Operation timing
The operation timing for the skip function is shown below.
V Positioning to point A
Positioning Deceleration stop by STOP input
start to
point A
(The "[Rq.1149] External STOP input disable at start
(R: M34489+32n/Q: M3209+20n)" is on.)
t
A
Positioning start of the next servo
ON program by skip function
[Rq.1120] PLC ready flag
(R: M30000/Q: M2000) OFF
[Rq.1123] All axes servo ON ON
command OFF
(R: M30042/Q: M2042) ON
Servo program start OFF
ON
External STOP signal OFF Turn on before the next positioning start.
[Rq.1149] External stop input ON
disable at start OFF
(R: M34489+32n/Q: M3209+20n)
Use the servo amplifiers whose software versions are compatible with each control mode to execute the "Speed-torque
7
control".
Servo amplifier software versions that are compatible with each control mode are shown below.
: There is no restriction by the version.
Servo amplifier model Software version
Speed control Torque control*1 Continuous operation to torque
control
MR-J4-B
MR-J4W-B
MR-J3-B B3 or later C7 or later
MR-J3W-B Not compatible
MR-J3-B Safety C7 or later
*1 In the servo amplifier that supports continuous operation to torque control, the torque generation direction of servo motor can be
switched by setting "Function selection C-B (PC29) (POL reflection selection at torque control)". (Page 204 Torque command
device)
In the servo amplifier that does not support continuous operation to torque control, the operation is the same as when "0: Valid" is set in
"Function selection C-B (PC29) (POL reflection selection at torque control)".
CAUTION
• If operation that generates torque more than 100% of the rating is performed with an abnormally high frequency in a servo motor stop status (servo lock
status) or in a 30 r/min or less low-speed operation status, the servo amplifier may malfunction regardless of the electronic thermal relay protection.
Confirm the control mode with "control mode (b2, b3)" of "[Md. 108] Servo status 1 (R: D32032+48n/Q: #8010+20n)".
• Control mode (b2, b3) of "[Md.108] Servo status 1 (R: D32032+48n/Q: #8010+20n)"
b3 b2 Control mode
0 0 Position control mode
0 1 Speed control mode
1 0 Torque control mode
When the mode is switched from speed control mode to position control mode, the command position immediately after
switching is the current feed value at switching.
The following chart shows the operation timing.
V
Position control mode Speed control mode Position control mode
30000
20000
0 t
6 to 11ms 6 to 11ms
ON
Control mode switching OFF
request device
Control mode setting device 0 10: Speed control mode 0: Position control mode
7
Speed command device 0 20000 30000 0
ON
[St.1040] Start accept flag
(R: M30080+n/Q: M2001+n) OFF
When the servo parameter "POL reflection selection at torque control (PC29)" is set to "0: Valid" and "Torque
initial value selection at control mode switching" is set to "1: Feedback torque", a warning (error code: 0A55H)
will occur at control mode switching, and the command value immediately after switching is the same as the
case of selecting "0: Command torque". If the feedback torque is selected, set "1: Invalid" in the servo
parameter "POL reflection selection at torque control (PC29)".
When the mode is switched from torque control mode to position control mode, the command position immediately after
switching is the current feed value at switching.
The following chart shows the operation timing.
Torque
Position control mode Torque control mode Position control mode
30.0%
20.0%
0 t
6 to 11ms 6 to 11ms
ON
Control mode switching OFF
request device
Control mode setting device 0 20: Torque control mode 0: Position control mode
When the servo parameter "POL reflection selection at torque control (PC29)" is set to "0: Valid" and "Torque
initial value selection at control mode switching" is set to "1: Feedback torque", a warning (error code: 0A55H)
will occur at control mode switching, and the command value immediately after switching is the same as the
case of selecting "0: Command torque". If the feedback torque is selected, set "1: Invalid" in the servo
parameter "POL reflection selection at torque control (PC29)".
When the mode is switched from torque control mode to speed control mode, the command speed immediately after
switching is the motor speed at switching.
The following chart shows the operation timing.
V
7
Speed control mode Torque control mode Speed control mode
30000
20000
0 t
Torque
20.0%
0 t
ON
Control mode switching OFF
request device
Control mode setting device 10 20: Torque control mode 10: Speed control mode
Speed command device
(During torque control: 20000 0 10000 0 30000
Speed limit command value)
Confirm the status of continuous operation to torque control mode with "Continuous operation to torque control (b14)" of
"[Md.125] Servo status3 (R: D32034+48n/Q: #8012+20n)". When the mode is switched to continuous operation to torque
control mode, the value in "control mode (b2, b3)" of "[Md.108] Servo status1 (R: D32032+48n/Q: #8010+20n)" will stay the
same before control mode switching.
• Continuous operation to torque control mode (b14) of "[Md.125] Servo status3 (R: D32034+48n/Q: #8012+20n)"
b14 Continuous operation to torque control mode
0 Not continuous operation to torque control mode
1 Continuous operation to torque control mode
■ Operation for "Position control mode Continuous operation to torque control mode
switching 7
When the mode is switched from position control mode to continuous operation to torque control mode, the command torque
and command speed immediately after switching are the values set in "Torque initial value selection at control mode
switching" and "Speed initial value selection at control mode switching".
• Command torque
Torque initial value selection at Command torque to servo amplifier immediately after switching from position control mode
control mode switching to continuous operation to torque control mode
0: Command torque Immediately after switching the control mode, the value of torque command device is the torque to servo
amplifier regardless of the command torque time constant.
1: Feedback torque Motor current value received from servo amplifier at switching is the torque to servo amplifier.
• Command speed
Speed initial value selection at Command speed to servo amplifier immediately after switching from position control mode
control mode switching to continuous operation to torque control mode
0: Command speed The speed to servo amplifier immediately after switching is the speed during command.
1: Feedback speed Motor speed received from servo amplifier at switching.
2: Automatic selection The speed commanded to servo amplifier immediately after switching is the lower speed between "0: Command
speed" and "1: Feedback speed".
When the mode is switched to continuous operation to torque control mode in cases where command speed
and actual speed are different such as during acceleration/deceleration or when the speed does not reach
command speed due to torque limit, set "1: Feedback speed" in "Speed initial value selection at control mode
switching".
Torque
30.0%
0 t
ON
Control mode switching request device OFF
Control mode setting device 0 30: Continuous operation to torque control mode 0: Position control mode
■ Operation for "Speed control mode Continuous operation to torque control mode
switching"
When the mode is switched from speed control mode to continuous operation to torque control mode, the command torque
and command speed immediately after switching are the values set in "Torque initial value selection at control mode
switching" and "Speed initial value selection at control mode switching".
• Command torque
Torque initial value selection at Command torque to servo amplifier immediately after switching from speed control mode
control mode switching to continuous operation to torque control mode
0: Command torque Immediately after switching the control mode, the value of torque command device is the torque to servo
amplifier regardless of the command torque time constant.
1: Feedback torque Motor current value received from servo amplifier at switching is the torque to servo amplifier.
• Command speed
Speed initial value selection at Command speed to servo amplifier immediately after switching from speed control mode to
control mode switching continuous operation to torque control mode
0: Command speed The speed to servo amplifier immediately after switching is the speed during command.
1: Feedback speed Motor speed received from servo amplifier at switching.
2: Automatic selection The speed to servo amplifier immediately after switching is the lower speed between "0: Command speed" and
"1: Feedback speed".
10000
Contact with target
1000
0 t
-10000
Torque
30.0%
0 t
ON
Control mode switching request device OFF
Control mode setting device 10 30: Continuous operation to torque control mode 10: Speed control mode
When the mode is switched from continuous operation to torque control mode to speed control mode, the
torque command during continuous operation to torque control is invalid. As shown in the figure above, when
the target is pressed in continuous operation to torque control direction, if the mode is switched to speed
control, torque is output to the torque limit value.
Execute the following either if such operation will be a problem.
• Set the speed command which is in opposite direction of continuous operation to torque control direction in
the speed command device before switching to the speed control mode.
• Change the torque limit value to the lower value by torque limit value change request (CHGT) before
switching to the speed control mode.
The actual motor speed may not reach the speed limit command value depending on the machine load
situation during torque control.
Ex.
When the torque command is changed from 0.0% to 100% with the torque command device.
Operation for continuous operation to torque control mode Operation for torque control mode
Command speed
Speed limit Speed limit
acceleration time
command value command value
Speed limit value in
speed-torque control
Speed command device value Speed command device value
Controlled by speed limit
command value after
acceleration/deceleration
processing
0 t 0 t
During continuous operation to torque control mode, the torque control is executed at command torque set in "Torque
command device". Command torque can be changed any time during continuous operation to torque control mode.
Speed change request (CHGV, M(P).CHGV/D(P).CHGV) is invalid (no operation).
Torque limit value to servo amplifier can be changed within the range of "Torque limit value at speed-torque control" by torque
limit value change request (CHGT, M(P).CHGT/D(P).CHGT) but the value is valid when the mode is switched to position
control mode. Command torque time constant is calculated based on the "Torque limit value at speed-torque control" at torque
control mode switching after the torque limit value is changed. If the change outside the range of "Torque limit value at speed-
torque control" is requested by torque limit value change request a warning (error code: 0A5EH) will occur, and the torque
limit value is not changed.
0 t
• The actual motor speed may not reach the speed limit command value depending on the machine load
situation during continuous operation to torque control mode.
• It is recommended to match the direction of torque command and speed command. When the direction of
torque command and speed command is different, the speed may decelerate to 0.
"Acceleration/deceleration time after change" is the acceleration/deceleration time of positioning control being
executed. "Acceleration/deceleration time after change" is valid until the switching of the next positioning
point. (Automatic decelerating processing at positioning completion is also controlled by "Acceleration/
deceleration time after change".)
Control details
After setting the acceleration/deceleration time change parameter, if speed change command is executed, the acceleration/
deceleration time changes. The acceleration/deceleration time change parameter is set for every axis in [Motion Control
Parameter] [Axis Setting Parameter] "Expansion Parameter" of MT Developer2. Refer to the Expansion Parameter for
details of acceleration/deceleration time change parameter. (Page 192 Expansion Parameters)
Refer to the following for details of command generation axis parameter.
MELSEC iQ-R Motion Controller Programming Manual (Advanced Synchronous Control)
• Set the change value of acceleration/deceleration time in the device set by acceleration time change value device/
deceleration time change value device.
Name Setting range
New acceleration time value device 1 to 8388608 [ms]
Other than above: Time change invalid
New deceleration time value device
• Device set by the acceleration/deceleration time change enable device turns ON (valid).
t
1000 ms 250 ms 1000 ms
Acceleration/deceleration
time change enable device OFF
150000
100000
t
1000 ms 500 ms 500 ms
ON
Acceleration/deceleration
time change enable device OFF
V Change of acceleration
time is not executed
Decelerate at
deceleration time
after change
t
ON
Acceleration/deceleration time
change enable device OFF
• During interpolation control, change of acceleration/deceleration time is executed by the acceleration/deceleration time
change parameter of the axis No. specified with the speed change command.
• Acceleration/deceleration time change function becomes invalid for axes executing the following servo instructions:
7
• Circular interpolation control (including point during CPSTART)
• Helical interpolation control (including point during CPSTART)
• Speed control with fixed position stop
• Acceleration/deceleration time change function becomes invalid for axes executing the following acceleration/deceleration
methods:
• FIN acceleration/deceleration
• Advanced S-curve acceleration/deceleration control
• If a negative speed change request is executed acceleration/deceleration time change function is only valid for axes
executing speed control (), or speed control (). If a negative speed change request is executed for axes executing other
instructions, acceleration/deceleration time change function becomes invalid. Also, if an acceleration/deceleration time
change is performed for axes operating at a negative speed, acceleration/deceleration time change function becomes
invalid.
Acceleration/deceleration time change is not executed
V at negative speed change request.
[pulse/s] (Except speed control(³) and speed control(´).)
200000
Acceleration/deceleration
time change is executed
100000 Acceleration/deceleration time
change is not executed for during
0 operation at negative speed.
V
-100000
-200000
ON
Acceleration/deceleration time
change enable device OFF
If changing deceleration time by the acceleration/deceleration time change function, regardless of whether the "Rapid stop
deceleration time setting error invalid flag (SM805)" is ON or OFF, deceleration time can be changed. Therefore, if the setting
values of the rapid stop deceleration time are larger than the deceleration time change value after change, an overrun may
occur.
Refer to the Speed limit value, acceleration time, deceleration time and rapid stop deceleration time for details of operation.
(Page 218 Speed limit value, acceleration time, deceleration time and rapid stop deceleration time)
• When the current value is to execute a deceleration stop from current command speed, if the current value exceeds the
stroke limit range, a minor error (error code: 1993H, 1995H) occurs, and deceleration stop is made before a stroke limit.
However, if the deceleration distance after the deceleration time change is longer than the distance until the stroke limit,
deceleration stop exceeds the stroke limit. Execute a speed change at a position where enough movement amount until the
stroke limit is ensured.
• During a positioning operation where acceleration/deceleration time is changed, and the deceleration distance to the final
positioning address for the output speed is not enough, a minor error (error code: 1A58H) occurs and the operation
immediately stops at the final positioning address. Execute a speed change at a position where enough movement amount
until the stop position is ensured.
• If acceleration/deceleration time is changed during speed control in speed-position switching (VPF/VPR), control continues
at the acceleration/deceleration times changed during speed control even after switching from speed to position control. To
control with the acceleration/deceleration time of the start after switching to position control, execute speed change again.
• If acceleration/deceleration time is changed during continuous trajectory control (CPSTART), control at the "acceleration/
deceleration time after change" occurs only between the points where change was executed. From the next point onward,
control at the "acceleration/deceleration time at start" set beforehand occurs. If the "[Rq.1122] Speed switching point
specified flag (R: M30040/Q: M2040)" is ON in continuous trajectory control (CPSTART), speed change is executed up to
the speed switching point at the "acceleration/deceleration time after change". (If the acceleration/deceleration time is
changed to a large value, speed change may not be completed up to the speed switching point).
V
[K101] [pulse/s]
CPSTART-1
Axis 1 200000
Control at deceleration time after change
Speed 1500000 pulse/s 150000
S.R. 2000000 pulse/s Control at deceleration
1000 ms 100000 time at start
1000 ms 75000
INC-1 50000
Axis 1 t
Travel 800000 pulse
Speed 100000 pulse/s
M-code 10 ON
INC-1 [Rq.1122] Speed switching point
Axis 1 specified flag (R: M30040/Q: M2040)
Travel 1000000 pulse
Speed 150000 pulse/s [Md.25] M-code
10 20 30
M-code 20 (R: D32013+48n/Q: D13+20n)
INC-1 ON
Acceleration/deceleration time
Axis 1 change enable device OFF
Travel 600000 pulse
Speed 50000 pulse/s
New acceleration time value device 0 2000
M-code 30
CPEND
New deceleration time value device 0 500
ON
Speed change request (CHGV) OFF
Control at acceleration/
deceleration time after change
t
ON
Acceleration/deceleration time
change enable device OFF
• When position follow-up control (PFSTART) is performed in an axis where trapezoidal acceleration/deceleration is set, and
deceleration time is changed to a value smaller than the operation cycle by the acceleration/deceleration time change
function during automatic deceleration, positioning to the set address is completed instantly. This can cause vibrations or
collisions, and depending on the remaining movement amount, servo errors (such as AL.35) can occur. Add "[St.1048]
Automatic decelerating flag (R: M30208+n/Q: M2128+n)" to an interlock condition to so that acceleration/deceleration time
change is not performed during automatic deceleration, or change the acceleration/deceleration time at a deceleration time
where deceleration stop can be performed without fail. 7
For performing "pressure control", use a pressure control compatible servo amplifier and software version.
The software versions for pressure control compatible servo amplifiers are shown in the table below.
Servo amplifier model Software version
Basic operation Pressure increasing direction selection for positioning address
(Servo parameter "Pressure control function selection 1 (PT12)")
MR-J4(W)-B Not supported Not supported
MR-J4-B-LL B0 or later B7 or later
MR-J3(W)-B Not supported Not supported
• Pressure control is not supported when control unit is [degree]. If the control unit is set to [degree] and the
pressure control parameters are enabled, a moderate error (error code: 30F7H) occurs.
• Up to 8 axes can be controlled with pressure control. When the number of axes set for pressure control
exceeds 8 axes, a moderate error (error code: 30F7H) occurs.
• Set the "Stop function at forward/reverse side" of the servo parameter "Pressure control function selection 1
(PT12)" to "1 (Stop at forward side: Valid, stop at reverse side: Invalid)". When stop at reverse side is set to
"Valid", a minor error (error code: 19DFH) occurs.
7
SSCNET/H (CN2)
Pressure control
Pressure control for feed/dwell is available.
The load cell pressure can be monitored with the optional data monitor function. (The load cell pressure is used for feedback
for pressure control in the servo amplifier)
V2
V1 V3
V0 V4
S1 S2 S3 S4 S5
Current value
Ex.
When "V4=0", a deceleration stop from S4 is made.
Speed
V2
V1
V0 V3
V4
S1 S2 S3 S4 S5 S6
The profile data set in the pressure profile test is not saved to the project. In order to enable profile data when
starting up the Motion CPU, perform the following.
• Set the device area of devices set by the pressure profile data to the latch range.
• Create a Motion SFC program to set pressure profile data.
• The M-code output function is not supported. Determine the current point with the execution point device.
• The unit of the pressure command value differs to that of the pressure unit. The analog input value from the
load cell is processed as A/D conversion data within the range of 0 to 32767. (The A/D converted data unit
is the analog input conversion value of the 10 V parameter in the servo amplifier)
• If the applicable axis is already starting at startup of pressure control, pressure control does not startup.
• The speed change processing by CHGV instruction to an axis that is running pressure control is invalid.
• If the difference between the end address and real current value exceeds 2-31 [pulse] in motor encoder
pulse units, a minor error (error code: 19E0H) may occur. Operate within a stroke range that does not
exceed 2-31 [pulse] in motor encoder pulse units.
Feed Dwell
V3 V1
Speed/ PR1 PR2 V2
Pressure PR0 V2 PR1 PR2
V1 V4
V0 PR3 PR4 7
1H 2 4 8 10 1H 2
SS S1 S2 S3 S4 T1
Execution point output No. Feed to dwell switching Mode reset
When the servo parameter "Pressure control function selection 1 (PT12)" is changed, turn the power supply of
the Multiple CPU system OFF to ON again, or reset the Multiple CPU system.
If operated without the new settings being reflected in the system, an unintended operation such as the
movement to the end address without referring to load cell pressure may occur.
Mode selection
By setting the mode selection, "0: The time constant is valid for the second step and after", or "1: The time constant is invalid
and pressure command points for the second step and after are connected with a straight line" can be selected for the
pressure command of the second step of dwell operation and after.
Pressure
: Mode selection "0"
32767 : Mode selection "1"
Change by the pressure command
time constant at switching
6000
Change by the pressure
5000
command time constant
4000 Connect two points
with a straight line
3000
2000
1000
0
Time[ms]
0 1000 2000 3000 4000 5000 6000
Feed Dwell Dwell Dwell Dwell Dwell
operation step 1 step 2 step 3 step 4 step 5
PR0
SE2
Pressure release
operation startup
Processing details
• Pressure release operation starts by turning ON the pressure release startup device from the sequence program or Motion
SFC program. If the load cell pressure drops below the set pressure, the mode resets.
• When the deceleration start point of the speed limit value stop time constant to the end address is reached, deceleration
starts automatically. If the pressure release startup device is turned OFF at this time, a deceleration stop that uses the
7
speed limit value time constant is made.
• Pressure can be changed during pressure release operation. Speed and address cannot be changed during pressure
release operation.
• Feed/dwell operation cannot be executed during pressure release operation.
• When the required setting values at the startup of pressure release operation are outside the range, the pressure control
status device (pressure release (b3)) does not turn ON, and a minor error (error code: 19E1H) occurs.
• When the required setting values are changed to values outside the range during pressure release control, the setting
values are ignored, operation continues with the present setting values, and a warning (error code: 09E3H) occurs.
• "1" is stored in the execution point device of pressure release operation.
Motor speed
Pressure command
value
Feed Dwell
Switching point
*: is change by the time constant setting.
• The time constant of the switching point is set in "Feed to dwell switching speed limit value time constant" and "Feed to
dwell switching pressure command time constant". Set the switching point slightly before the position where load cell
pressure increases dramatically. When setting the mode switching point, and switching by position only, specify "0:
Address" to the feed/dwell switching mode. When also making the load cell pressure as a switching condition, specify "1:
Address & load cell pressure" to the feed/dwell switching mode, and set the switching pressure.
• For points that start deceleration at low speeds, set the point so that the motor is at a low speed until pressure increases
even slightly.
• Set pressure settings so that feed step 1 = dwell step 1. During feed, the pressure command is clamped by the speed limit
value, therefore it is not true pressure control.
• When the load cell pressure overshoots at the switching point, make the feed to dwell switching speed limit value time
constant longer.
• To make operation smooth, make the speed limit value time constant and pressure command time constant longer.
• When the motor speed at the start of operation does not reach the set speed, make the first step of pressure command
during feed larger. (Changing the value of the first step of dwell is not required.)
• When a load cell fails and becomes a high pressure, the motor continues reversing in order to lower pressure and may
collide with machinery. Set a stroke limit to prevent a collision.
• The servo parameter "Pressure control F/B input offset (PT21)" is normally set to "0". When adjusting offset with the user
program, change the servo parameter with the servo parameter read/change function. Refer to the following for details on
the servo parameter read/change function.
MELSEC iQ-R Motion Controller Programming Manual (Common)
Precautions
The feed/dwell startup device is not turned OFF automatically.
Check if the control mode has been changed to position control mode by viewing the status of pressure control status devices
(feed/dwell (B0), dwell (B1)).
When starting pressure control again, turn OFF the feed/dwell startup device, and turn it back ON again to execute pressure
control.
Simultaneous start
START
JOG operation
Manual pulse generator operation
*1
High-speed oscillation
OSC
Home position return
ZERO
Speed-torque control
Pressure control
Machine control
Direct positioning control by Motion dedicated PLC instruction (M(P).SVSTD/D(P).SVSTD)
G-code control*2
• When the data set to the override ratio is outside of range, a warning (error code: 09E2H) occurs, and speed is not
changed. (At startup, operation is at 100.0[%] of the program command speed, when running, operation is at the speed
before the change.)
For machine control, a warning (error code: 0EE0H(details code: 00F2H)) occurs.
• At startup, if "[Rq.1122] Speed switching point specified flag (R: M30040/Q: M2040)" is ON and advanced S-curve
acceleration/deceleration is being used, the override function is disabled.
• When the override ratio is changed after performing a speed change request (CHGV) for speed "0", the speed is "0" even
after applying the override to speed "0". Change the override ratio after changing the speed change request (CHGV) to a
speed other than "0". 7
• For a speed change by override function, "[St.1047] Speed change accepting flag (R: M30144+n/Q: M2061+n)" and
"[St.346] Command generation axis speed change accepting flag (R: M36571+32n/Q: M9811+20n)" do not turn ON.
• When override ratio is set to "0", "[St.1049] Speed change "0" accepting flag (R: M30272+n/Q: M2240+n)" and "[St.347]
Command generation axis speed change "0" accepting flag (R: M36572+32n/Q: M9812+20n)" turn ON. In this case, an
event history is recorded.
• When the speed after "program command speed override ratio" exceeds the speed limit value, the feed speed is clamped
at the speed limit value and a warning (error code: 0991H) occurs.
For machine control, a warning (error code: 0EE0H(details code: 00F3H)) occurs.
• When the speed after "program command speed override ratio" is less than bias speed at start, a warning (error code:
0A5DH) occurs and speed is not changed. (At startup, operation is at 100.0[%] of the program command speed, when
running, operation is at the speed before the change.)
• In high-speed oscillation the override is applied to the frequency. There is a possibility of operating at a frequency that
exceeds the frequency set by the program due to the override ratio. When the range for frequency (1 to 5000[CPM) is
exceeded due to the override ratio, a warning (error code: 09E1H) occurs, and frequency is clamped at 5000[CPM].
• Speed is not changed by override ratio after the fixed position stop command is turned ON during speed control with fixed
position stop.
• Speed is not changed by override ratio when override ratio is changed during automatic deceleration, or during stop/rapid
stop.
• The values of "[Md.28] Command speed (R: D32024+48n, D32025+48n/Q: #8004+20n, #8005+20n)" and "[Md.348]
Command generation axis command speed (R: D36492+48n, D36493+48n/Q: D12612+20n, D12613+20n)" are updated
with the value including the override ratio when override is being used.
In machine program operation,"[Md.2083] Machine program operation target speed (D53276+128m, D53277+128m)" is
also updated with the value including the override ratio when override is being used.
• Override is disabled in the output axes of advanced synchronous control.
• Override is disabled in positioning control in test mode.
P3 command speed
(1)
When the override ratio is changed during deceleration of the speed change to P3 (section (1)), the speed is not changed.
Speed is changed to the speed of “P3 command speed override ratio” from the beginning of P3.
• In machine control, the override ratio setting of the machine configuration axis with the lowest axis No. is valid.
Ex.
For the following machine configuration axes
The override ratio setting of axis 1 is valid.
Item Machine configuration axis
Joint axis JNT1 Axis 3
Joint axis JNT2 Axis 1
Joint axis JNT3 Axis 2
[K 1] [K 2] [K 3]
INC-1 INC-1 INC-1
Axis 1 Axis 1 Axis 1
Travel value 50000 pulse Travel value 10000 pulse Travel value 100000 pulse
Speed 10000 pulse/s Speed 10000 pulse/s Speed 10000 pulse/s
[Operation timing]
V
Command speed [pulse/s]
30000
20000
10000
(4)
t
(1) When running, speed change starts from the position where override ratio was changed.
(2) When override ratio is set to "0", just as when speed is changed to "0", a deceleration stop is performed and
"[St.1049] Speed change "0" accepting flag (R: M30272+n/Q: M2240+n)" turns ON.
(3) Operation is restarted by changing the override ratio from "0".
(4) Even when the override ratio has been changed at the start, acceleration/deceleration is performed with the
speed including the override ratio.
[K1]
CPSTART1
Axis 1
Speed 20000 pulse/s
INC-1
Axis 1
Travel value 50000 pulse
INC-1
Axis 1
Travel value 80000 pulse
Speed 40000 pulse/s
CPEND
[Operation timing]
V
Command speed [pulse/s]
40000
30000
20000
(2)
10000
(1)
t
The control modes that support vibration suppression command filter are shown in the chart below.
The vibration suppression command filter is only valid in positioning control mode, however if the filter is set during home
position return, it stays invalid.
: Valid : Invalid
Control mode Vibration suppression command filter valid/invalid
Positioning control mode (Invalid during speed control() and during home position return)
Speed control mode
Torque control mode
Continuous operation to torque control mode
Pressure control mode
7
■ Application examples
Application example Filter method
Minimizing torque change of the motor Smoothing filter
Suppressing a frequency below 1Hz Smoothing filter
FIR filter
Minimizing the command delay caused by the filter FIR filter
Changing frequency during positioning operation IIR filter
Suppressing more than one frequency Use filter methods together
• Low frequency: Smoothing filter or FIR filter
• High frequency: IIR filter
t
Time
Acceleration time Deceleration time
Smoothing Smoothing
time constant time constant
• FIR filter
The FIR filter removes only the specified frequencies by superimposing the waveforms that delay phases for only half of the
vibration cycle for position control. The filter time constant is "1/(frequency2)[s]", and the acceleration/deceleration times
are extended by the filter time constant only. Filter depth can be set. When the effect of the filter is too small, make the
depth larger.
V
: Before filter
Positioning speed
: After filter
t
Time
Acceleration speed Deceleration time
Filter Filter
time constant time constant
• IIR filter
The IIR filter removes only the specified frequencies for position control. Although the delay time changes depending on the
pattern, acceleration/deceleration times are extended 1/frequency[s] to approximately 1/1.5frequency. For the IIR filter, the
frequency value can also be changed during positioning operation. However, if the frequency value is changed drastically in
a short period of time, a sudden operation can occur, and an alarm or warning can occur. When changing frequency during
operation, while checking operation, gradually change the value by units such as 0.01[Hz].
V
: Before filter
Positioning speed
: After filter
t
Time
Acceleration time Deceleration time
Stop
t
Deceleration time Delay time
ON
[Rq.1140] Stop command
(R: M34480+32n/Q: M3200+20n) OFF
t
Deceleration Delay time
time
ON
[Rq.1140] Stop command
(R: M34480+32n/Q: M3200+20n) OFF
Measuring vibration
With the filter invalid, measure the vibration cycle with the vibration of the deviation counter occurring after command stop
(after command speed 0), or the value of the external acceleration sensor signal with a graph function (MR Configurator2)
etc., and set that frequency.
The frequency can be analyzed by using the FFT analyzer function of MR Configurator2. Refer to the following for details.
Help of MR Configurator2
dB
FFT analyzer function
Droop pulse value (MR Configurator2), example Vibration cycle [Hz] of the
external acceleration sensor signal etc. shake or vibration
Command
speed
[pulse/s]
t t
Vibration
cycle [Hz]
Filter change
processing starts
Command in-position
Servo program start set value
ON
[St.1040] Start accept flag
(R: M30080+n/Q: M2001+n) OFF
ON
[St.1061] Positioning complete
(R: M32401+32n/Q: M2401+20n) OFF
ON
[St.1063] Command in-position
(R: M32403+32n/Q: M2403+20n) OFF
Vibration suppression
command filter frequency 0 20.0Hz
Vibration suppression
command filter 0: Invalid 1: Smoothing filter 0: Invalid
mode selection device
ON
Command output complete
7
signal after filter OFF
• When a servo program is started up consecutively before the command output complete signal after filter turns ON, filter
processing continues and does not become invalid even by changing the mode selection device to "0: Invalid".
[Md.20] Feed current value
V Filter continues
(R: D32000+48n, D32001+48n/Q: D0+20n, D1+20n)
Feed current value as enabled
after filter
t
Command in-position
Servo program start set value
ON
[St.1040] Start accept flag
(R: M30080+n/Q: M2001+n) OFF
ON
[St.1061] Positioning complete
(R: M32401+32n/Q: M2401+20n) OFF
ON
[St.1063] Command in-position
(R: M32403+32n/Q: M2403+20n) OFF
Vibration suppression
command filter frequency 0 20.0Hz
Vibration suppression
command filter 0: Invalid 1: Smoothing filter 0: Invalid
mode selection device
ON
Command output complete Filter is invalid before positioning complete
signal after filter OFF
20000
Feed current value after filter
10000
Execution
point 1 2
M-code 10 20
• In advanced synchronous control, filter is applied to feed current values of output axis modules.
• Each monitor value for advanced synchronous control is the value before filter.
• The vibration suppression filter is not supported for command generation axis.
• When input axis modules for advanced synchronous control are servo input axes, filter valid/invalid is as follows.
: Valid, : Invalid
Specified value for "[Pr.300] Servo input axis type" Filter valid/invalid
1: Feed current value
2: Real current value
3: Servo command value
4: Feedback value
• For operation patterns that repeat forward rotation and reverse rotation in vibration suppression command filter 1, the
command output complete signal after filter may turn ON during operation as illustrated below. If the vibration suppression
command filter 1 values (mode selection device/frequency/depth) are changed with the filter operation not settled, the
values are discontinued in the middle of operation which causes the feed current value and feed current value after filter to
misalign. When changing the setting values for vibration suppression command filter 1, after checking that the operation
pattern before filter is complete with "[St.1061] Positioning complete (R: M32401+32n/Q: M2401+20n)" or "[St.1040] Start
accept flag (R: M30080+n/Q: M2001+n)", wait for a filter time constant before changing the values.
V : Speed before filter
Feed current value stop
: Speed after filter
Positioning speed
t
ON
[St.1061] Positioning complete
(R: M32401+32n/Q: M2410+20n) OFF Filter time constant
ON
Command output complete
signal after filter OFF
Setting values for vibration Setting values
suppression command filter 1 may be changed
(mode selection device/
frequency/depth)
APPENDICES
Appendix 1 Processing Times of the Motion CPU 471
CPU processing time [ms]
The instruction processing time means the time until the content is reflected to servo amplifier side after each instruction is
executed.
(Including the transmission time between Motion controller and servo amplifier.)
R64MTCPU/R32MTCPU/R16MTCPU
Operation cycle [ms] 0.222 0.444 0.888 1.777 3.555 7.111
Servo program "WAIT ON/OFF" + Motion control 0.444 0.888 1.777 3.554 7.110 14.222
start processing step
time*1
Only Motion control step 0.666 to 0.888 1.110 to 1.554 1.998 to 2.886 3.776 to 5.553 7.332 to 14.444 to
10.887 21.555
Dedicated instruction (D(P).SVST) 1.332 to 1.554 1.776 to 2.220 2.664 to 3.552 3.554 to 5.331 7.110 to 14.222 to
from the PLC CPU 10.665 21.333
Dedicated instruction (M(P).SVST) 0.888 to 1.110 1.332 to 1.776 2.220 to 3.108 2.666 to 4.443 5.333 to 8.888 10.667 to
from the PLC CPU 14.222
Direct positioning Dedicated instruction 1.332 to 1.554 1.776 to 2.220 2.664 to 3.552 3.554 to 5.331 7.110 to 14.222 to
start request (D(P).SVSTD) from the PLC CPU 10.665 21.333
processing time
Dedicated instruction 0.888 to 1.110 1.332 to 1.776 2.220 to 3.108 2.666 to 4.443 5.333 to 8.888 10.667 to
(M(P).SVSTD) from the PLC CPU 14.222
Speed change Instruction (CHGV) from the 0.444 to 0.888 0.888 to 1.332 1.776 to 2.664 2.665 to 4.442 4.443 to 7.998 7.999 to
processing time Motion SFC 15.110
Dedicated instruction (D(P).CHGV) 0.888 to 1.110 1.332 to 1.776 2.220 to 3.108 3.109 to 4.886 4.887 to 8.442 11.998 to
from the PLC CPU 19.109
Dedicated instruction 0.666 to 0.888 1.110 to 1.554 1.998 to 2.886 2.887 to 4.664 4.665 to 8.220 11.776 to
(M(P).CHGV) from the PLC CPU 18.887
Command Instruction (CHGVS) from the 0.444 to 0.888 0.888 to 1.332 1.776 to 2.664 2.665 to 4.442 4.443 to 7.998 7.999 to
generation axis Motion SFC 15.110
speed change
Dedicated instruction 0.888 to 1.110 1.332 to 1.776 2.220 to 3.108 3.109 to 4.886 4.887 to 8.442 11.998 to
processing time
(D(P).CHGVS) from the PLC CPU 19.109
Dedicated instruction 0.666 to 0.888 1.110 to 1.554 1.998 to 2.886 2.887 to 4.664 4.665 to 8.220 11.776 to
(M(P).CHGVS) from the PLC CPU 18.887
Torque limit value Instruction (CHGT) from the 0.444 to 0.888 0.888 to 1.332 1.776 to 2.664 2.665 to 4.442 4.443 to 7.998 7.999 to
change Motion SFC 15.110
processing time
Dedicated instruction (D(P).CHGT) 0.888 to 1.110 1.332 to 1.776 2.220 to 3.108 3.109 to 4.886 4.887 to 8.442 8.443 to
from the PLC CPU 15.554
Dedicated instruction 0.666 to 0.888 1.110 to 1.554 1.998 to 2.886 2.887 to 4.664 4.665 to 8.220 8.221 to
(M(P).CHGT) from the PLC CPU 15.332
Target position Instruction (CHGP) from the 0.444 to 0.888 0.888 to 1.332 1.776 to 2.664 2.665 to 4.442 4.443 to 7.998 7.999 to
change Motion SFC 15.110
processing time
Machine program Instruction (MCNST) from the 1.332 to 1.776 1.776 to 2.664 2.665 to 4.442 4.443 to 7.998
operation start Motion SFC
processing time*3 Dedicated instruction 1.776 to 2.220 2.664 to 3.552 3.554 to 5.331 7.110 to
(D(P).MCNST) from the PLC CPU 10.665
Dedicated instruction 1.332 to 1.776 2.220 to 3.108 2.666 to 4.443 5.333 to 8.888
(M(P).MCNST) from the PLC CPU
G-code control Automatic operation start (cycle 15.111 to 30.222 to 60.444 to 120.889 to
program start start) ON 19.556 39.111 78.222 156.444
processing time
Time from "[Rq.1120] PLC ready flag (R: M30000/Q: 22 to 165*2
M2000)" ON to "PCPU READY complete flag (SM500)"
ON
*1 FEED instruction varies greatly depending on the condition (whether other axes are operating).
*2 The processing time gets larger depending on the number of axes set.
*3 CPU processing time when "Number of positioning points = 1".
APPENDICES
472 Appendix 1 Processing Times of the Motion CPU
MEMO
APPENDICES
Appendix 1 Processing Times of the Motion CPU 473
REVISIONS
* The manual number is given on the bottom left of the back cover
Revision date *Manual number Description
July 2014 IB(NA)-0300241-A First edition
March 2015 IB(NA)-0300241-B ■Added functions
ABS direction in degrees setting, Pressure control, Servo amplifier (MR-J4-B-LL) compatible
■Added or modified parts
SAFETY PRECAUTIONS, RELEVANT MANUALS, TERMS, Section 2.1, 2.2, 2.3, 3.1, 3.3, 3.7, 3.9, 3.10,
3.11, 5.1, 6.2, 7.5, 7.6, 7.7, Appendix 1
June 2015 IB(NA)-0300241-C ■Added functions
Override function, vibration suppression command filter
■Added or modified parts
TERMS, Section 2.1, 3.1, 3.10, 3.11, 3.12, 3.13, 5.21, 7.2, 7.7, 7.8, 7.9
February 2016 IB(NA)-0300241-D ■Added models
R64MTCPU
■Added functions
Servo motor maximum speed check parameter, Home position return by driver home position return method
■Added or modified parts
SAFETY PRECAUTIONS, INTRODUCTION, RELEVANT MANUALS, TERMS, MANUAL PAGE
ORGANIZATION, Section 1.1, 2, 2.1, 2.2, 2.3, 3.1, 3.3, 3.4, 3.6, 3.7, 3.11, 3.13, 4.3, 4.4, 5.1, 5.15, 5.16,
5.17, 5.21, 5.22, 6.1, 6.2, 7.1, 7.3, 7.4, 7.5, 7.6, 7.7, 7.8, 7.9, Appendix 1, WARRANTY
June 2016 IB(NA)-0300241-E ■Added functions
Home position return by data set method 3
■Added or modified parts
SAFETY PRECAUTIONS, INTRODUCTION, Section 2.1, 2.2, 3.4, 5.1, 5.21, 7.8
September 2016 IB(NA)-0300241-F ■Added or modified parts
TERMS, Section 2.1, 2.2, 3.1, 3.12, 5.17, Appendix 1
December 2016 IB(NA)-0300241-G ■Added or modified parts
SAFETY PRECAUTIONS, Chapter 2, Section 2.2, 4.1, 4.3, 5.20, 7.5
December 2017 IB(NA)-0300241-H ■Added or modified parts
SAFETY PRECAUTIONS, RELEVANT MANUALS, MANUAL PAGE ORGANIZATION, Section 2.1, 2.2, 3.1,
3.3, 3.4, 3.5, 5.1, 5.17, 5.21, 7.8, Appendix 1
June 2018 IB(NA)-0300241-J ■Added or modified parts
SAFETY PRECAUTIONS, Section 2.1, 2.2, 2.3, 3.9
December 2018 IB(NA)-0300241-K ■Added or modified parts
SAFETY PRECAUTIONS, Section 2.2, 3.13, 6.2
February 2020 IB(NA)-0300241-L ■Added or modified parts
Section 2.1, 2.2, 3.13, 5.16, 5.17, 5.21, 7.2
474
WARRANTY
Please confirm the following product warranty details before using this product.
1. Gratis Warranty Term and Gratis Warranty Range
If any faults or defects (hereinafter "Failure") found to be the responsibility of Mitsubishi occurs during use of the product
within the gratis warranty term, the product shall be repaired at no cost via the sales representative or Mitsubishi Service
Company.
However, if repairs are required onsite at domestic or overseas location, expenses to send an engineer will be solely at
the customer's discretion. Mitsubishi shall not be held responsible for any re-commissioning, maintenance, or testing
on-site that involves replacement of the failed module.
[Gratis Warranty Term]
The gratis warranty term of the product shall be for one year after the date of purchase or delivery to a designated place.
Note that after manufacture and shipment from Mitsubishi, the maximum distribution period shall be six (6) months, and
the longest gratis warranty term after manufacturing shall be eighteen (18) months. The gratis warranty term of repair
parts shall not exceed the gratis warranty term before repairs.
[Gratis Warranty Range]
(1) The range shall be limited to normal use within the usage state, usage methods and usage environment, etc., which
follow the conditions and precautions, etc., given in the instruction manual, user's manual and caution labels on the
product.
(2) Even within the gratis warranty term, repairs shall be charged for in the following cases.
1. Failure occurring from inappropriate storage or handling, carelessness or negligence by the user. Failure caused
by the user's hardware or software design.
2. Failure caused by unapproved modifications, etc., to the product by the user.
3. When the Mitsubishi product is assembled into a user's device, Failure that could have been avoided if functions
or structures, judged as necessary in the legal safety measures the user's device is subject to or as necessary by
industry standards, had been provided.
4. Failure that could have been avoided if consumable parts (battery, backlight, fuse, etc.) designated in the
instruction manual had been correctly serviced or replaced.
5. Failure caused by external irresistible forces such as fires or abnormal voltages, and Failure caused by force
majeure such as earthquakes, lightning, wind and water damage.
6. Failure caused by reasons unpredictable by scientific technology standards at time of shipment from Mitsubishi.
7. Any other failure found not to be the responsibility of Mitsubishi or that admitted not to be so by the user.
2. Onerous repair term after discontinuation of production
(1) Mitsubishi shall accept onerous product repairs for seven (7) years after production of the product is discontinued.
Discontinuation of production shall be notified with Mitsubishi Technical Bulletins, etc.
(2) Product supply (including repair parts) is not available after production is discontinued.
3. Overseas service
Overseas, repairs shall be accepted by Mitsubishi's local overseas FA Center. Note that the repair conditions at each FA
Center may differ.
4. Exclusion of loss in opportunity and secondary loss from warranty liability
Regardless of the gratis warranty term, Mitsubishi shall not be liable for compensation to:
(1) Damages caused by any cause found not to be the responsibility of Mitsubishi.
(2) Loss in opportunity, lost profits incurred to the user by Failures of Mitsubishi products.
(3) Special damages and secondary damages whether foreseeable or not, compensation for accidents, and
compensation for damages to products other than Mitsubishi products.
(4) Replacement by the user, maintenance of on-site equipment, start-up test run and other tasks.
5. Changes in product specifications
The specifications given in the catalogs, manuals or technical documents are subject to change without prior notice.
475
TRADEMARKS
Microsoft, Microsoft Access, Excel, SQL Server, Visual Basic, Visual C++, Visual Studio, Windows, Windows NT, Windows
Server, Windows Vista, and Windows XP are either registered trademarks or trademarks of Microsoft Corporation in the
United States and/or other countries.
The company names, system names and product names mentioned in this manual are either registered trademarks or
trademarks of their respective companies.
In some cases, trademark symbols such as '' or '' are not specified in this manual.
476 IB(NA)-0300241-L
IB(NA)-0300241-L(2002)MEE
MODEL: RMT-P-POS-E
MODEL CODE: 1XB008
HEAD OFFICE : TOKYO BUILDING, 2-7-3 MARUNOUCHI, CHIYODA-KU, TOKYO 100-8310, JAPAN
NAGOYA WORKS : 1-14 , YADA-MINAMI 5-CHOME , HIGASHI-KU, NAGOYA , JAPAN
When exported from Japan, this manual does not require application to the
Ministry of Economy, Trade and Industry for service transaction permission.