Mitsubishi Electronics Q173HCPU, Q172HCPU User Manual
MOTION CONTROLLERS
SV43
Q173HCPU
Q172HCPU
Programming Manual
SAFETY PRECAUTIONS
(Read these precautions before using.)
When using this equipment, thoroughly read this manual and the associated manuals introduced in this
manual. Also pay careful attention to safety and handle the module properly.
These precautions apply only to this equipment. Refer to the Q173HCPU/Q172HCPU Users manual for a
description of the Motion controller safety precautions.
These SAFETY PRECAUTIONS classify the safety precautions into two categories: "DANGER" and
"CAUTION".
DANGER
!
CAUTION
!
Depending on circumstances, procedures indicated by ! CAUTION may also be linked to serious
results.
In any case, it is important to follow the directions for usage.
Store this manual in a safe place so that you can take it out and read it whenever necessary. Always
forward it to the end user.
Indicates that incorrect handling may cause hazardous conditions,
resulting in death or severe injury.
Indicates that incorrect handling may cause hazardous conditions,
resulting in medium or slight personal injury or physical damage.
A - 1
For Safe Operations
1. Prevention of electric shocks
!
DANGER
Never open the front case or terminal covers while the power is ON or the unit is running, as
this may lead to electric shocks.
Never run the unit with the front case or terminal cover removed. The high voltage terminal and
charged sections will be exposed and may lead to electric shocks.
Never open the front case or terminal cover at times other than wiring work or periodic
inspections even if the power is OFF. The insides of the Motion controller and servo amplifier
are charged and may lead to electric shocks.
When performing wiring work or inspections, turn the power OFF, wait at least ten minutes, and
then check the voltage with a tester, etc.. Failing to do so may lead to electric shocks.
Be sure to ground the Motion controller, servo amplifier and servomotor. (Ground resistance :
or less) Do not ground commonly with other devices.
100
The wiring work and inspections must be done by a qualified technician.
Wire the units after installing the Motion controller, servo amplifier and servomotor. Failing to do
so may lead to electric shocks or damage.
Never operate the switches with wet hands, as this may lead to electric shocks.
Do not damage, apply excessive stress, place heavy things on or sandwich the cables, as this
may lead to electric shocks.
Do not touch the Motion controller, servo amplifier or servomotor terminal blocks while the
power is ON, as this may lead to electric shocks.
Do not touch the built-in power supply, built-in grounding or signal wires of the Motion controller
and servo amplifier, as this may lead to electric shocks.
2. For fire prevention
!
CAUTION
Install the Motion controller, servo amplifier, servomotor and regenerative resistor on
inflammable material. Direct installation on flammable material or near flammable material may
lead to fire.
If a fault occurs in the Motion controller or servo amplifier, shut the power OFF at the servo
amplifier’s power source. If a large current continues to flow, fire may occur.
When using a regenerative resistor, shut the power OFF with an error signal. The regenerative
resistor may abnormally overheat due to a fault in the regenerative transistor, etc., and may
lead to fire.
Always take heat measures such as flame proofing for the inside of the control panel where
the servo amplifier or regenerative resistor is installed and for the wires used. Failing to do so
may lead to fire.
A - 2
3. For injury prevention
!
CAUTION
Do not apply a voltage other than that specified in the instruction manual on any terminal.
Doing so may lead to destruction or damage.
Do not mistake the terminal connections, as this may lead to destruction or damage.
Do not mistake the polarity ( + / - ), as this may lead to destruction or damage.
Do not touch the servo amplifier's heat radiating fins, regenerative resistor and servomotor, etc.,
while the power is ON and for a short time after the power is turned OFF. In this timing, these
parts become very hot and may lead to burns.
Always turn the power OFF before touching the servomotor shaft or coupled machines, as
these parts may lead to injuries.
Do not go near the machine during test operations or during operations such as teaching.
Doing so may lead to injuries.
4. Various precautions
Strictly observe the following precautions.
Mistaken handling of the unit may lead to faults, injuries or electric shocks.
(1) System structure
!
CAUTION
Always install a leakage breaker on the Motion controller and servo amplifier power source.
If installation of an electromagnetic contactor for power shut off during an error, etc., is specified
in the instruction manual for the servo amplifier, etc., always install the electromagnetic
contactor.
Install the emergency stop circuit externally so that the operation can be stopped immediately
and the power shut off.
Use the Motion controller, servo amplifier, servomotor and regenerative resistor with the combi-
nations listed in the instruction manual. Other combinations may lead to fire or faults.
If safety standards (ex., robot safety rules, etc.,) apply to the system using the Motion controller,
servo amplifier and servomotor, make sure that the safety standards are satisfied.
Construct a safety circuit externally of the Motion controller or servo amplifier if the abnormal
operation of the Motion controller or servo amplifier differ from the safety directive operation in
the system.
In systems where coasting of the servomotor will be a problem during the forced stop,
emergency stop, servo OFF or power supply OFF, use dynamic brakes.
Make sure that the system considers the coasting amount even when using dynamic brakes.
A - 3
!
CAUTION
In systems where perpendicular shaft dropping may be a problem during the forced stop,
emergency stop, servo OFF or power supply OFF, use both dynamic brakes and
electromagnetic brakes.
The dynamic brakes must be used only on errors that cause the forced stop, emergency stop,
or servo OFF. These brakes must not be used for normal braking.
The brakes (electromagnetic brakes) assembled into the servomotor are for holding
applications, and must not be used for normal braking.
The system must have a mechanical allowance so that the machine itself can stop even if the
stroke limits switch is passed through at the max. speed.
Use wires and cables that have a wire diameter, heat resistance and bending resistance
compatible with the system.
Use wires and cables within the length of the range described in the instruction manual.
The ratings and characteristics of the parts (other than Motion controller, servo amplifier and
servomotor) used in a system must be compatible with the Motion controller, servo amplifier
and servomotor.
Install a cover on the shaft so that the rotary parts of the servomotor are not touched during
operation.
There may be some cases where holding by the electromagnetic brakes is not possible due to
the life or mechanical structure (when the ball screw and servomotor are connected with a
timing belt, etc.). Install a stopping device to ensure safety on the machine side.
(2) Parameter settings and programming
!
CAUTION
Set the parameter values to those that are compatible with the Motion controller, servo amplifier,
servomotor and regenerative resistor model and the system application. The protective functions
may not function if the settings are incorrect.
The regenerative resistor model and capacity parameters must be set to values that conform to
the operation mode, servo amplifier and servo power supply module. The protective functions
may not function if the settings are incorrect.
Set the mechanical brake output and dynamic brake output validity parameters to values that
are compatible with the system application. The protective functions may not function if the
settings are incorrect.
Set the stroke limit input validity parameter to a value that is compatible with the system
application. The protective functions may not function if the setting is incorrect.
A - 4
!
CAUTION
Set the servomotor encoder type (increment, absolute position type, etc.) parameter to a value
that is compatible with the system application. The protective functions may not function if the
setting is incorrect.
Set the servomotor capacity and type (standard, low-inertia, flat, etc.) parameter to values that
are compatible with the system application. The protective functions may not function if the
settings are incorrect.
Set the servo amplifier capacity and type parameters to values that are compatible with the
system application. The protective functions may not function if the settings are incorrect.
Use the program commands for the program with the conditions specified in the instruction
manual.
Set the sequence function program capacity setting, device capacity, latch validity range, I/O
assignment setting, and validity of continuous operation during error detection to values that are
compatible with the system application. The protective functions may not function if the settings
are incorrect.
Some devices used in the program have fixed applications, so use these with the conditions
specified in the instruction manual.
The input devices and data registers assigned to the link will hold the data previous to when
communication is terminated by an error, etc. Thus, an error correspondence interlock program
specified in the instruction manual must be used.
Use the interlock program specified in the special function module's instruction manual for the
program corresponding to the special function module.
(3) Transportation and installation
!
CAUTION
Transport the product with the correct method according to the mass.
Use the servomotor suspension bolts only for the transportation of the servomotor. Do not
transport the servomotor with machine installed on it.
Do not stack products past the limit.
When transporting the Motion controller or servo amplifier, never hold the connected wires or
cables.
When transporting the servomotor, never hold the cables, shaft or detector.
When transporting the Motion controller or servo amplifier, never hold the front case as it may
fall off.
When transporting, installing or removing the Motion controller or servo amplifier, never hold
the edges.
Install the unit according to the instruction manual in a place where the mass can be withstood.
A - 5
!
CAUTION
Do not get on or place heavy objects on the product.
Always observe the installation direction.
Keep the designated clearance between the Motion controller or servo amplifier and control
panel inner surface or the Motion controller and servo amplifier, Motion controller or servo
amplifier and other devices.
Do not install or operate Motion controller, servo amplifiers or servomotors that are damaged or
that have missing parts.
Do not block the intake/outtake ports of the servomotor with cooling fan.
Do not allow conductive matter such as screw or cutting chips or combustible matter such as oil
enter the Motion controller, servo amplifier or servomotor.
The Motion controller, servo amplifier and servomotor are precision machines, so do not drop
or apply strong impacts on them.
Securely fix the Motion controller and servo amplifier to the machine according to the
instruction
manual. If the fixing is insufficient, these may come off during operation.
Always install the servomotor with reduction gears in the designated direction. Failing to do so
may lead to oil leaks.
Store and use the unit in the following environmental conditions.
Environment
Ambient
temperature
Ambient humidity
Storage
temperature
Atmosphere
Altitude
Vibration
Motion controller/Servo amplifier Servomotor
According to each instruction manual.
According to each instruction manual.
According to each instruction manual.
Indoors (where not subject to direct sunlight).
No corrosive gases, flammable gases, oil mist or dust must exist
1000m (3280.84ft.) or less above sea level
According to each instruction manual
Conditions
0°C to +40°C (With no freezing)
(32°F to +104°F)
80% RH or less
(With no dew condensation)
-20°C to +65°C
(-4°F to +149°F)
When coupling with the synchronization encoder or servomotor shaft end, do not apply impact
such as by hitting with a hammer. Doing so may lead to detector damage.
Do not apply a load larger than the tolerable load onto the servomotor shaft. Doing so may lead
to shaft breakage.
When not using the module for a long time, disconnect the power line from the Motion controller
or servo amplifier.
Place the Motion controller and servo amplifier in static electricity preventing vinyl bags and
store.
When storing for a long time, please contact with our sales representative.
A - 6
(4) Wiring
!
CAUTION
Correctly and securely wire the wires. Reconfirm the connections for mistakes and the terminal
screws for tightness after wiring. Failing to do so may lead to run away of the
servomotor.
After wiring, install the protective covers such as the terminal covers to the original positions.
Do not install a phase advancing capacitor, surge absorber or radio noise filter (option FR-BIF)
on the output side of the servo amplifier.
Correctly connect the output side (terminals U, V, W). Incorrect connections will lead the
servomotor to operate abnormally.
Do not connect a commercial power supply to the servomotor, as this may lead to trouble.
Do not mistake the direction of the surge absorbing diode
installed on the DC relay for the control signal output of
brake signals, etc. Incorrect installation may lead to signals
not being output when trouble occurs or the protective
functions not functioning.
Do not connect or disconnect the connection cables between
each unit, the encoder cable or PLC expansion cable while the
power is ON.
Servo amplifier
VIN
(24VDC)
Control output
signal
RA
Securely tighten the cable connector fixing screws and fixing mechanisms. Insufficient fixing
may lead to the cables combing off during operation.
Do not bundle the power line or cables.
(5) Trial operation and adjustment
!
CAUTION
Confirm and adjust the program and each parameter before operation. Unpredictable
movements may occur depending on the machine.
Extreme adjustments and changes may lead to unstable operation, so never make them.
When using the absolute position system function, on starting up, and when the Motion
controller or absolute value motor has been replaced, always perform a home position return.
A - 7
(6) Usge methods
!
CAUTION
Immediately turn OFF the power if smoke, abnormal sounds or odors are emitted from the
Motion controller, servo amplifier or servomotor.
Always execute a test operation before starting actual operations after the program or
parameters have been changed or after maintenance and inspection.
The units must be disassembled and repaired by a qualified technician.
Do not make any modifications to the unit.
Keep the effect or electromagnetic obstacles to a minimum by installing a noise filter or by using
wire shields, etc. Electromagnetic obstacles may affect the electronic devices used near the
Motion controller or servo amplifier.
When using the CE Mark-compliant equipment, refer to the "EMC Installation Guidelines"
(data number IB(NA)-67339) for the Motion controllers and refer to the corresponding EMC
guideline information for the servo amplifiers, inverters and other equipment.
Use the units with the following conditions.
Item
Input power
Input frequency 50/60Hz ±5%
Tolerable
momentary
power failure
Q61P-A1 Q61P-A2 Q62P Q63P Q64P
100 to 120VAC
(85 to 132VAC) (170 to 264VAC) (85 to 264VAC) (15.6 to 31.2VDC)
+10% +10% +10% +30% +10%
200 to 240VAC
-15%
200 to 240VAC
-15%
Conditions
100 to 240VAC
20ms or less
-15%
24VDC
-35%
100 to 120VAC
(7) Corrective actions for errors
!
CAUTION
If an error occurs in the self diagnosis of the Motion controller or servo amplifier, confirm the
check details according to the instruction manual, and restore the operation.
If a dangerous state is predicted in case of a power failure or product failure, use a servomotor
with electromagnetic brakes or install a brake mechanism externally.
Use a double circuit construction so that the electromagnetic brake operation circuit can be
operated by emergency stop signals set externally.
Shut off with servo ON signal OFF,
alarm, magnetic brake signal.
Servomotor
RA1
Shut off with the
emergency stop
signal(EMG).
EMG
-15%
+10%
-15%
(85 to 132VAC/
170 to 264VAC)
/
`
Electromagnetic
brakes
24VDC
A - 8
!
CAUTION
If an error occurs, remove the cause, secure the safety and then resume operation after alarm
release.
The unit may suddenly resume operation after a power failure is restored, so do not go near the
machine. (Design the machine so that personal safety can be ensured even if the machine
restarts suddenly.)
(8) Maintenance, inspection and part replacement
!
CAUTION
Perform the daily and periodic inspections according to the instruction manual.
Perform maintenance and inspection after backing up the program and parameters for the
Motion controller and servo amplifier.
Do not place fingers or hands in the clearance when opening or closing any opening.
Periodically replace consumable parts such as batteries according to the instruction manual.
Do not touch the lead sections such as ICs or the connector contacts.
Do not place the Motion controller or servo amplifier on metal that may cause a power leakage
or wood, plastic or vinyl that may cause static electricity buildup.
Do not perform a megger test (insulation resistance measurement) during inspection.
When replacing the Motion controller or servo amplifier, always set the new module settings
correctly.
When the Motion controller or absolute value motor has been replaced, carry out a home
position return operation using one of the following methods, otherwise position displacement
could occur.
1) After writing the servo data to the Motion controller using programming software, switch on
the power again, then perform a home position return operation.
2) Using the backup function of the programming software, load the data backed up before
replacement.
After maintenance and inspections are completed, confirm that the position detection of the
absolute position detector function is correct.
Do not short circuit, charge, overheat, incinerate or disassemble the batteries.
The electrolytic capacitor will generate gas during a fault, so do not place your face near the
Motion controller or servo amplifier.
The electrolytic capacitor and fan will deteriorate. Periodically replace these to prevent
secondary damage from faults. Replacements can be made by our sales representative.
A - 9
(9) About processing of waste
When you discard Motion controller, servo amplifier, a battery (primary battery) and other option articles,
please follow the law of each country (area).
!
CAUTION
This product is not designed or manufactured to be used in equipment or systems in situations
that can affect or endanger human life.
When considering this product for operation in special applications such as machinery or
systems used in passenger transportation, medical, aerospace, atomic power, electric power, or
submarine repeating applications, please contact your nearest Mitsubishi sales representative.
Although this product was manufactured under conditions of strict quality control, you are
strongly advised to install safety devices to forestall serious accidents when it is used in facilities
where a breakdown in the product is likely to cause a serious accident.
(10) General cautions
!
CAUTION
All drawings provided in the instruction manual show the state with the covers and safety
partitions removed to explain detailed sections. When operating the product, always return the
covers and partitions to the designated positions, and operate according to the instruction
manual.
A - 10
REVISIONS
The manual number is given on the bottom left of the back cover.
Print Date Manual Number Revision
Feb., 2006 IB(NA)-0300115-A First edition
Japanese Manual Number IB(NA)-0300095
This manual confers no industrial property rights or any rights of any other kind, nor does it confer any patent
licenses. Mitsubishi Electric Corporation cannot be held responsible for any problems involving industrial property
rights which may occur as a result of using the contents noted in this manual.
© 2006 MITSUBISHI ELECTRIC CORPORATION
A - 11
INTRODUCTION
Thank you for choosing the Q173HCPU/Q172HCPU Motion Controller.
Please read this manual carefully so that equipment is used to its optimum.
CONTENTS
Safety Precautions .........................................................................................................................................A- 1
Revisions ........................................................................................................................................................A-11
Contents .........................................................................................................................................................A-12
About Manuals ...............................................................................................................................................A-17
1. OVERVIEW 1- 1 to 1- 6
1.1 Overview................................................................................................................................................... 1- 1
1.2 Features ................................................................................................................................................... 1- 3
1.2.1 Performance specifications............................................................................................................... 1- 3
1.2.2 Differences between Q173HCPU/Q172HCPU and Q173CPU(N)/Q172CPU(N)......................... 1- 6
2. POSITIONING CONTROL BY THE MOTION CPU 2- 1 to 2-10
2.1 Positioning Control by the Motion CPU. .................................................................................................. 2- 1
3. MOTION DEDICATED PLC INSTRUCTION 3- 1 to 3-44
3.1 Motion Dedicated PLC Instruction ........................................................................................................... 3- 1
3.1.1 Restriction item of the Motion dedicated PLC instruction ................................................................ 3- 1
3.2 Motion program (Control program) Start Request from The PLC CPU to The Motion CPU:
S(P).SFCS (PLC instruction:
S(P).SFCS
)............................................................................................ 3- 8
3.3 Motion Program (Axis designation program) Start Request from The PLC CPU to The Motion CPU:
S(P).SVST (PLC instruction:
S(P).SVST
) ............................................................................................ 3-13
3.4 Home position return instruction from The PLC CPU to The Motion CPU:
S(P).CHGA (PLC instruction:
S(P).CHGA
)........................................................................................... 3-19
3.5 Speed Change Instruction from The PLC CPU to The Motion CPU:
S(P).CHGV (PLC instruction:
S(P).CHGV
)........................................................................................... 3-24
3.6 Torque Limit Value Change Request Instruction from The PLC CPU to The Motion CPU:
S(P) .CHGT
S(P).CHGT (PLC instruction:
3.7 Write from The PLC CPU to The Motion CPU: S(P).DDWR (PLC instruction:
3.8 Read from The Devices of The Motion CPU: S(P).DDRD (PLC instruction:
).......................................................................................... 3-32
S(P).DDWR
S(P).DDRD
) ..............3-36
) ................. 3-40
4. POSITIONING SIGNALS 4- 1 to 4-88
4.1 Internal Relays ......................................................................................................................................... 4- 2
4.1.1 Axis statuses ..................................................................................................................................... 4-13
4.1.2 Axis command signals ......................................................................................................................4-26
4.1.3 Axis statuses 2 .................................................................................................................................. 4-33
4.1.4 Axis command signals 2 ................................................................................................................... 4-36
4.1.5 Common devices .............................................................................................................................. 4-45
4.2 Data Registers.......................................................................................................................................... 4-56
A - 12
4.2.1 Axis monitor devices ......................................................................................................................... 4-64
4.2.2 Control change registers ................................................................................................................... 4-67
4.2.3 Axis monitor devices 2 ...................................................................................................................... 4-68
4.2.4 Control program monitor devices ..................................................................................................... 4-72
4.2.5 Control change registers 2................................................................................................................ 4-74
4.2.6 Tool length offset data setting registers............................................................................................ 4-75
4.2.7 Common devices .............................................................................................................................. 4-76
4.3 Motion Registers (#)................................................................................................................................. 4-79
4.4 Special Relays (SP.M) ............................................................................................................................. 4-80
4.5 Special Registers (SP.D) ......................................................................................................................... 4-83
5. PARAMETERS FOR POSITIONING CONTROL 5- 1 to 5-20
5.1 System Settings .......................................................................................................................................5- 1
5.2 Fixed Parameters..................................................................................................................................... 5- 2
5.2.1 Number of pulses/travel value per rotation....................................................................................... 5- 3
5.2.2 Backlash compensation amount....................................................................................................... 5- 5
5.2.3 Upper/lower stroke limit value........................................................................................................... 5- 5
5.2.4 Command in-position range.............................................................................................................. 5- 7
5.2.5 High-speed feed rate setting............................................................................................................. 5- 8
5.2.6 Speed control 10
5.3 Parameter Block....................................................................................................................................... 5-13
5.3.1 Relationships between the speed limit value, acceleration time, deceleration time and rapid
stop deceleration time ................................................................................................................... 5-16
5.3.2 S-curve ratio ......................................................................................................................................5-18
5.3.3 Allowable error range for circular interpolation................................................................................. 5-19
5.4 Work Coordinate Data ............................................................................................................................. 5-20
multiplier setting for degree axis ........................................................................ 5- 9
6. MOTION PROGRAMS FOR POSITIONING CONTROL 6- 1 to 6-186
6.1 Motion Program Composition .................................................................................................................. 6- 1
6.2 Type of The Motion Program ................................................................................................................... 6- 4
6.3 G-code List ............................................................................................................................................... 6- 5
6.4 M-code List ............................................................................................................................................... 6- 7
6.5 Control Instruction List ............................................................................................................................. 6- 8
6.6 Start/End Method .....................................................................................................................................6-10
6.7 Number of Maximum Nesting for Program Call and Multi Startable Program ....................................... 6-12
6.8 Motion parameter ..................................................................................................................................... 6-13
6.9 Caution at The Axis Designation Program Creation ............................................................................... 6-14
6.10 Instruction Symbols/Characters List...................................................................................................... 6-19
6.11 Setting Method for Command Data....................................................................................................... 6-23
6.11.1 Direct setting (numerical value) ...................................................................................................... 6-23
6.11.2 Indirect setting ................................................................................................................................. 6-24
6.11.3 Operational data.............................................................................................................................. 6-31
6.11.4 Setting range of instruction symbols list ......................................................................................... 6-41
6.11.5 Positioning control unit for 1 axis .................................................................................................... 6-43
6.11.6 Control units for interpolation control.............................................................................................. 6-44
6.11.7 Control in the control unit "degree"................................................................................................. 6-46
6.12 About Coordinate Systems .................................................................................................................... 6-48
A - 13
6.13 G-code .................................................................................................................................................... 6-49
6.13.1 G00 Point-to-point positioning at the high-speed feed rate .......................................................... 6-52
6.13.2 G01 Constant-speed positioning at the speed specified in F ....................................................... 6-54
6.13.3 G02 Circular interpolation CW (Central coordinates-specified) .................................................. 6-56
6.13.4 G03 Circular interpolation CCW (Central coordinates-specified)................................................. 6-59
6.13.5 G02 Circular interpolation CW (Radius-specified) ........................................................................ 6-62
6.13.6 G03 Circular interpolation CCW (Radius-specified) ..................................................................... 6-64
6.13.7 G04 Dwell....................................................................................................................................... 6-66
6.13.8 G09 Exact stop check .................................................................................................................... 6-68
6.13.9 G12 Helical interpolation CW (Helical central coordinates-specified) .......................................... 6-70
6.13.10 G13 Helical interpolation CCW (Helical central coordinates-specified) ..................................... 6-73
6.13.11 G12 Helical interpolation CW (Helical radius-specified) ............................................................. 6-75
6.13.12 G13 Helical interpolation CCW (Helical radius-specified) .......................................................... 6-77
6.13.13 G23 Cancel, cancel start invalid .................................................................................................. 6-79
6.13.14 G24 Cancel, cancel start.............................................................................................................. 6-80
6.13.15 G25 High-speed oscillation.......................................................................................................... 6-83
6.13.16 G26 High-speed oscillation stop.................................................................................................. 6-85
6.13.17 G28 Home position return............................................................................................................ 6-86
6.13.18 G30 Second home position return............................................................................................... 6-88
6.13.19 G32 Skip....................................................................................................................................... 6-90
6.13.20 G43 Tool length offset (+) ............................................................................................................ 6-94
6.13.21 G44 Tool length offset (-) ............................................................................................................. 6-96
6.13.22 G49 Tool length offset cancel ......................................................................................................6-98
6.13.23 G53 Mechanical coordinate system selection............................................................................. 6-99
6.13.24 G54 to G59 Work coordinate system selection ........................................................................ 6-101
6.13.25 G61 Exact stop check mode...................................................................................................... 6-104
6.13.26 G64 Cutting mode ......................................................................................................................6-106
6.13.27 G90 Absolute value command .................................................................................................. 6-108
6.13.28 G91 Incremental value command ............................................................................................. 6-110
6.13.29 G92 Coordinates system setting ...............................................................................................6-112
6.13.30 G98, G99 Preread disable/enable .............................................................................................6-114
6.13.31 G100, G101 Time-fixed acceleration/deceleration, acceleration-fixed acceleration/deceleration
switching command..................................................................................................................... 6-116
6.14 M-Code................................................................................................................................................. 6-120
6.15 Special M-Code.................................................................................................................................... 6-121
6.15.1 M00 Program stop ....................................................................................................................... 6-122
6.15.2 M01 Optional program stop ........................................................................................................6-123
6.15.3 M02 Program end ........................................................................................................
6.15.4 M30 Program end ........................................................................................................................6-125
6.15.5 M98, M99 Subprogram call, subprogram end ...........................................................................6-126
6.15.6 M100 Preread disable .................................................................................................................6-128
6.16 Miscellaneous....................................................................................................................................... 6-129
6.16.1 Program control function (IF, GOTO statement) ........................................................................ 6-130
6.16.2 Program control function (IF, THEN, ELSE, END statements) .................................................6-132
6.16.3 Program control function (WHILE, DO, END statements)......................................................... 6-134
6.16.4 Four fundamental operators, assignment operator (+, -, *, /, MOD, =)..................................... 6-136
6.16.5 Trigonometric functions (SIN, COS, TAN, ASIN, ACOS, ATAN) .............................................. 6-138
6.16.6 Real number to BIN value conversion (INT)............................................................................... 6-139
6.16.7 BIN value to real number conversion (FLT)................................................................................6-140
................ 6-124
A - 14
6.16.8 32-bit real number and 64-bit real number data conversion (DFLT, SFLT) ............................... 6-141
6.16.9 Functions (SQRT, ABS, BIN, BCD, LN, EXP, RND, FIX, FUP) ................................................ 6-142
6.16.10 Logical operators (AND, OR, XOR, NOT, <<, >>) ...................................................................6-143
6.16.11 Move block wait functions (W AITON, WAITOFF)..................................................................... 6-145
6.16.12 Block wait functions (EXEON, EXEOFF) .................................................................................. 6-147
6.16.13 Bit set and reset for word devices (BSET, BRST)..................................................................... 6-150
6.16.14 Parameter block change (PB) ................................................................................................... 6-151
6.16.15 Torque limit value change (TL) .................................................................................................. 6-153
6.16.16 Home position return (CHGA) .................................................................................................... 6-155
6.16.17 Speed change (CHGV) ...............................................................................................................6-156
6.16.18 Torque limit value change (CHGT)............................................................................................. 6-157
6.16.19 Bit device set, reset functions (SET, RST) ...............................................................................6-158
6.16.20 Bit device operation on condition (IF, THEN, SET/RST/OUT) ................................................. 6-159
6.16.21 Program start (CALL).................................................................................................................. 6-161
6.16.22 Program call 1 (GOSUB) ............................................................................................................ 6-163
6.16.23 Program call 2 (GOSUBE) .........................................................................................................6-164
6.16.24 Control program end (CLEAR) ................................................................................................... 6-167
6.16.25 Time to wait (TIME)..................................................................................................................... 6-169
6.16.26 Block transfers (BMOV : 16-bit unit) ..........................................................................................6-170
6.16.27 Block transfer (BDMOV : 32-bit unit)......................................................................................... 6-172
6.16.28 Identical data block transfers (FMOV)........................................................................................ 6-174
6.16.29 Write device data to shared CPU memory (MULTW) ...............................................................6-176
6.16.30 Read device data from shared CPU memory of the other CPU (MULTR)............................... 6-178
6.16.31 Write words data to intelligent function module/special function module (TO)......................... 6-180
6.16.32 Read words data from intelligent function module/special function module (FROM) .............. 6-182
6.16.33 Conditional branch using bit device (ON, OFF) ....................................................................... 6-184
7. AUXILIARY AND APPLIED FUNCTIONS 7- 1 to 7-80
7.1 Backlash Compensation Function........................................................................................................... 7- 1
7.2 Torque Limit Function .............................................................................................................................. 7- 3
7.3 Home Position Return .............................................................................................................................. 7- 5
7.3.1 Home position return data................................................................................................................. 7- 6
7.3.2 Home position return by the proximity dog type 1............................................................................ 7-16
7.3.3 Home position return by the proximity dog type 2............................................................................ 7-19
7.3.4 Home position return by the count type 1......................................................................................... 7-21
7.3.5 Home position return by the count type 2......................................................................................... 7-23
7.3.6 Home position return by the count type 3......................................................................................... 7-25
7.3.7 Home position return by the data set type 1 .................................................................................... 7-27
7.3.8 Home position return by the data set type 2 .................................................................................... 7-28
7.3.9 Home position return by the dog cradle type ................................................................................... 7-29
7.3.10 Home position return by the stopper type 1 ...................................................................................7-33
7.3.11 Home position return by the stopper type 2 ...................................................................................7-35
7.3.12 Home position return by the limit switch combined type................................................................ 7-37
7.3.13 Home position return retry function ................................................................................................ 7-39
7.3.14 Home position shift function............................................................................................................ 7-43
7.3.15 Condition selection of home position set........................................................................................ 7-47
7.3.16 Execution of home position return................................................................................................. 7-48
7.4 Speed Change (CHGV instruction) ......................................................................................................... 7-49
A - 15
7.5 JOG Operation ......................................................................................................................................... 7-53
7.5.1 JOG operation data ........................................................................................................................... 7-53
7.5.2 Individual start ................................................................................................................................... 7-54
7.5.3 Simultaneous start............................................................................................................................. 7-59
7.6 Manual Pulse Generator Operation......................................................................................................... 7-62
7.7 Override Ratio Setting Function .............................................................................................................. 7-68
7.8 FIN signal wait function ............................................................................................................................ 7-70
7.9 Single Block Operation ............................................................................................................................ 7-74
7.10 Control Program Stop Function from The PLC CPU............................................................................ 7-79
8. USER FILES 8- 1 to 8- 2
8.1 Projects..................................................................................................................................................... 8- 1
8.2 User File List............................................................................................................................................. 8- 2
APPENDICES APP- 1 to APP-67
APPENDIX 1 Error Codes Stored Using The Motion CPU ....................................................................APP- 1
APPENDIX 1.1 Motion program setting errors (Stored in D9190).......................................................APP- 3
APPENDIX 1.2 Minor errors .................................................................................................................APP- 4
APPENDIX 1.3 Major errors .................................................................................................................APP-20
APPENDIX 1.4 Servo errors.................................................................................................................APP-24
APPENDIX 1.5 PC link communication errors .....................................................................................APP-41
APPENDIX 2 Motion dedicated signal.....................................................................................................APP-42
APPENDIX 2.1 Internal relay (M) .........................................................................................................APP-42
APPENDIX 2.2 Data registers (D) ........................................................................................................APP-52
APPENDIX 2.3 Motion Registers (#) ....................................................................................................APP-59
APPENDIX 2.4 Special Relays .............................................................................................................APP-60
APPENDIX 2.5 Special Registers.........................................................................................................APP-63
APPENDIX 3 Processing Times of the Motion CPU ...............................................................................APP-67
A - 16
About Manuals
The following manuals are related to this product.
Referring to this list, please request the necessary manuals.
Related Manuals
(1) Motion controller
Q173HCPU/Q172HCPU Motion controller User's Manual
This manual explains specifications of the Motion CPU modules, Q172LX Servo external signal interface
module, Q172EX Serial absolute synchronous encoder interface module, Q173PX Manual pulse
generator interface module, Teaching units, Power supply modules, Servo amplifiers, SSCNET
synchronous encoder cables and others.
(Optional)
Q173HCPU/Q172HCPU Motion controller Programming Manual (COMMON)
This manual explains the Multiple CPU system configuration, performance specifications, common
parameters, auxiliary/applied functions and others.
(Optional)
Manual Name
cables,
Manual Number
(Model Code)
IB-0300110
(1XB910)
IB-0300111
(1XB911)
Q173HCPU/Q172HCPU Motion controller (SV13/SV22) Programming Manual (Motion SFC)
This manual explains the functions, programming, debugging, error codes and others of the Motion SFC.
(Optional)
Q173HCPU/Q172HCPU Motion controller (SV13/SV22) Programming Manual (REAL MODE)
This manual explains the servo parameters, positioning instructions, device list, error list and others.
(Optional)
Q173HCPU/Q172HCPU Motion controller (SV22) Programming Manual (VIRTUAL MODE)
This manual describes the dedicated instructions use to the synchronous control by virtual main shaft,
mechanical system program create mechanical module.
This manual explains the servo parameters, positioning instructions, device list, error list and others.
(Optional)
IB-0300112
(1XB912)
IB-0300113
(1XB913)
IB-0300114
(1XB914)
A - 17
(2) PLC
QCPU User's Manual (Hardware Design, Maintenance and Inspection)
This manual explains the specifications of the QCPU modules, power supply modules, base modules,
extension cables, memory card battery and others.
(Optional)
QCPU User's Manual (Function Explanation, Program Fundamentals)
This manual explains the functions, programming methods and devices and others to create programs
with the QCPU.
(Optional)
QCPU User's Manual (Multiple CPU System)
This manual explains the functions, programming methods and cautions and others to construct the
Multiple CPU system with the QCPU.
(Optional)
QCPU (Q Mode)/QnACPU Programming Manual (Common Instructions)
This manual explains how to use the sequence instructions, basic instructions, application instructions and
micro computer program.
(Optional)
QCPU (Q Mode)/QnACPU Programming Manual (PID Control Instructions)
This manual explains the dedicated instructions used to exercise PID control.
(Optional)
QCPU (Q Mode)/QnACPU Programming Manual (SFC)
This manual explains the system configuration, performance specifications, functions, programming,
debugging, error codes and others of MELSAP3.
(Optional)
I/O Module Type Building Block User's Manual
This manual explains the specifications of the I/O modules, connector, connector/terminal block
conversion modules and others.
(Optional)
Manual Name
(3) Servo amplifier
MR-J3-B Servo amplifier Instruction Manual
This manual explains the I/O signals, parts names, parameters, start-up procedure and others.
(Optional)
Manual Name
Manual Number
(Model Code)
SH-080483ENG
(13JR73)
SH-080484ENG
(13JR74)
SH-080485ENG
(13JR75)
SH-080039
(13JF58)
SH-080040
(13JF59)
SH-080041
(13JF60)
SH-080042
(13JL99)
Manual Number
(Model Code)
SH-030051
(1CW202)
A - 18
1 OVERVIEW
1. OVERVIEW
1.1 Overview
This programming manual describes the operating system software packages
Generic term/Abbreviation Description
Q173HCPU/Q172HCPU or
Motion CPU (module)
Q172LX/Q172EX/Q173PX or
Motion module
MR-J3- B Servo amplifier model MR-J3- B
AMP or Servo amplifier General name for "servo amplifier model MR-J3- B"
QCPU, PLC CPU or PLC CPU module Qn(H)CPU
Multiple CPU system or Motion system Abbreviation for "Multiple PLC system of the Q series"
CPUn
Programming software package General name for "MT Developer" and "GX Developer"
Operating system software General name for "SW RN-SV Q "
SV43 Operating system software for machine tool peripheral use: SW5RN-SV43Q
MT Developer
GX Developer
Manual pulse generator or MR-HDP01 Abbreviation for "Manual pulse generator (MR-HDP01)"
Serial absolute synchronous encoder
or Q170ENC
SSCNET
SSCNET
Absolute position system
Battery holder unit Battery holder unit (Q170HBATC)
External battery General name for "Q170HBATC" and "Q6BAT"
A 0BD-PCF A10BD-PCF/A30BD-PCF SSC I/F board
(Note-2)
(Note-2)
"SW5RN-SV43Q
In this manual, the following abbreviations are used.
" for Motion CPU module (Q173HCPU/Q172HCPU).
Q173HCPU/Q172HCPU Motion CPU module
Q172LX Servo external signals interface module/
Q172EX-S2/S3 Serial absolute synchronous encoder interface module
Q173PX(-S1) Manual pulse generator interface module
Abbreviation for "CPU No.n (n= 1 to 4) of the CPU module for the Multiple
CPU system"
Abbreviation for "MT Developer (Version 00M or later)"
(Integrated start-up support software package)
Abbreviation for "GX Developer (Version 6 or later)"
(GX Developer function software package)
Abbreviation for "Serial absolute synchronous encoder (Q170ENC)"
High speed synchronous network between Motion controller and servo
amplifier
High speed serial communication between Motion controller and servo
amplifier
General name for "system using the servomotor and servo amplifier for
absolute position"
(Note-1)
1
/
SSC I/F communication cable Abbreviation for "Cable for SSC I/F board/card"
Intelligent function module
Abbreviation for "MELSECNET/H module/Ethernet module/
CC-Link module/Serial communication module"
(Note-1) : Q172EX can be used in SV22.
(Note-2) : SSCNET: S
1 - 1
ervo System Controller NETwork
1 OVERVIEW
REMARK
For information about the each module, design method for program and parameter,
Motion CPU module/Motion unit Q173HCPU/Q172HCPU User’s Manual
PLC CPU, peripheral devices for PLC program design, I/O
modules and intelligent function module
Operation method for MT Developer Help of each software
• Multiple CPU system configuration
• Performance specification
• Design method for common parameter
• Auxiliary and applied functions (common)
SV43
refer to the following manuals relevant to each module.
Item Reference Manual
Manual relevant to each module
Q173HCPU/Q172HCPU Motion controller
Programming Manual (COMMON)
!
CAUTION
When designing the system, provide external protective and safety circuits to ensure safety in
the event of trouble with the Motion controller.
There are electronic components which are susceptible to the effects of static electricity
mounted on the printed circuit board. When handling printed circuit boards with bare hands you
must ground your body or the work bench.
Do not touch current-carrying or electric parts of the equipment with bare hands.
Make parameter settings within the ranges stated in this manual.
Use the program instructions that are used in programs in accordance with the conditions
stipulated in this manual.
Some devices for use in programs have fixed applications: they must be used in accordance
with the conditions stipulated in this manual.
1 - 2
1 OVERVIEW
1.2 Features
The Motion CPU has the following features.
1.2.1 Performance specifications
(1) Basic specifications of Q172HCPU/Q172HCPU
Item Q173HCPU Q172HCPU
Number of control axes Up to 32 axes Up to 8 axes
Operation cycle
(Default)
Interpolation functions Linear interpolation (Up to 4 axes), Circular interpolation (2 axes), Helical interpolation (3 axes)
Control modes PTP (Point to Point) control, Constant speed positioning, High-speed oscillation control
Method
Position
command
(a) Motion control specifications
0.88ms/ 1 to 5 axes
1.77ms/ 6 to 14 axes
3.55ms/15 to 28 axes
7.11ms/29 to 32 axes
PTP : Select of absolute or incremental data method.
Constant-speed control : Both absolute and incremental data method can be used together.
Selectable for each axis
Control
mm 10
inch 10
degree 10
unit
Command unit
-4
mm
-5
inch
-5
degree 0 to 35999999
Address setting
range
-2147483648 to
2147483647
0.88ms/ 1 to 5 axes
1.77ms/ 6 to 8 axes
Travel value setting range
0 to ±2147483647
Positioning
Control
Speed
command
(Command
unit)
Automatic
Acceleration/
deceleration
control
Compensation Backlash compensation, Electronic gear
Programming language Dedicated instruction (EIA language)
Motion program capacity 248k bytes
trapezoidal
S-curve S-curve ratio : 0 to 100[%]
mm 0.01 to 6000000.00 (mm/min)
inch 0.001 to 600000.000 (inch/min)
degree
unit
• Speed control 10 multiplier setting for degree axis is invalid
• Speed control 10
Acceleration-fixed
acceleration/deceleration method
Acceleration time : 1 to 65535 ms
Deceleration time : 1 to 65535 ms
Speed setting range
0.001 to 2147483.647 (degree/min)
multiplier setting for degree axis is valid
0.01 to 21474836.47 (degree/min)
Time-fixed acceleration/deceleration
method
Acceleration/deceleration time :
1 to 5000 ms
(Only constant speed control)
(Note-1)
1 - 3
1 OVERVIEW
Motion control specifications (continued)
Item Q173HCPU Q172HCPU
Number of programs 1024
Number of simultaneous
start programs
Number of positioning
points
Number of I/O (X/Y) points 8192 points
Number of real I/O (PX/PY)
points
Internal relays
Number of
Devices
(internal
motion
CPU only)
Programming tool IBM PC/AT
Peripheral I/F USB/SSCNET
Teaching operation
function
Home position return
function
JOG operation function Provided
Manual pulse generator
operation function
M-code function
Limit switch output function
Skip function Provided
Override ratio setting
function
Absolute position system
Number of SSCNET
systems
Number of Motion related
modules
(M)
Latch relays
(L)
Link relays (B) 8192 points
Annunciators
(F)
(Note-2)
Axis designation program : 32
Control program : 16
Approx. 10600 points
(Positioning data can be designated indirectly)
Total 256 points
Total (M+L) : 8192 points
2048 points
None
Proximity dog type (2 types), Count type (3 types), Data set type (2 types), Dog cradle type,
Stopper type (2 types), Limit switch combined type
(Home position return re-try function provided, home position shift function provided)
Possible to connect 3 modules.
M-code output function provided
M-code completion wait function provided
Number of output points 32 points
Watch data: Motion control data/Word device
Override ratio setting : 0 to 100[%]
Made compatible by setting battery to servo amplifier.
(Possible to select the absolute data method or incremental method for each axis)
2 systems 1 system
Q172LX : 4 modules
Q173PX : 1 module
Axis designation program : 8
Control program : 16
Q172LX : 1 module
Q173PX : 1 module
1 - 4
1 OVERVIEW
(Note-1) : Acceleration-fixed/time-fixed acceleration/deceleration method is switched as follows.
Acceleration-fixed acceleration/deceleration method Time-fixed acceleration/deceleration method
G00 (Without M-code setting.)
G28
G30
G53
in G100
All travel instructions in G101
(Note-2) : The servo amplifiers for SSCNET cannot be used.
Program capacity
Operation controls
G-codes Positioning command
M-codes Output command to data register M****
Special M-codes Program control command M00, M01, M02, M30, M98, M99, M100
Variable Device variable X, Y, B, F, D, W, #
Functions
Instructions
Number of controls
Total of program files 248k bytes
Number of programs Up to 1024 (No. 1 to 1024)
Arithmetic operation
Comparison operation Equal to, Not equal to
Logical operation
Trigonometric function SIN, COS, TAN, ASIN, ACOS, ATAN
Numerical function
Start/end CALL, CLEAR
Home position return CHGA
Speed/torque setting TL, CHGV, CHGT
Motion control WAITON, WAITOFF, EXEON, EXEOFF
Jump/repetition processing
Data operation
Number of program calls
(GOSUB/GOSUBE)
Number of program calls (M98) Up to 8
(b) Motion program performance specifications
Item Q173HCPU/Q172HCPU
G00 (With M-code setting.)
G01
G02
G03
G12
G13
G32
in G101
—
Unary operation, Additive operation, Multiplicative operation,
Remainder operation
Logical shift operation, Logical negation, Logical AND,
Logical OR, Exclusive OR
G00, G01, G02, G03, G04, G09, G12, G13, G23, G24, G25, G26,
G28, G30, G32, G43, G44, G49, G53, G54, G55, G56, G61, G64,
G90, G91, G92, G98, G99, G100, G101
ABS, SQR, BIN, LN, EXP, BCD, RND, FIX, FUP, INT, FLT,
DFLT, SFLT
CALL, GOSUB/GOSUBE, IF…GOTO, IF…THEN…ELSE…END,
WHILE…DO
BMOV, BDMOV, FMOV, BSET, BRST, SET, RST, MULTW,
MULTR, TO, FROM, ON, OFF, IF…THEN…SET/RST/OUT, PB
Up to 8
1 - 5
1 OVERVIEW
1.2.2 Differences between Q173HCPU/Q172HCPU and Q173CPU(N)/Q172CPU(N)
Item Q173HCPU Q172HCPU Q173CPU(N) Q172CPU(N)
Number of control axes 32 axes 8 axes 32 axes 8 axes
Operation cycle
(Default)
(It can be set up by parameters.)
Peripheral devices I/F USB/SSCNET USB/RS-232/SSCNET
Servo amplifier I/F
Indirect setting of home position
return data
Expansion of speed setting range in
the unit [degree]
Fetch of external signal input Q172LX/General input of servo amplifier
0.88ms/ 1 to 5 axes
1.77ms/ 6 to 14 axes
3.55ms/15 to 28 axes
7.11ms/29 to 32 axes
SSCNET
(Optical
communication)
Indirect setting with word devices (D, W, #) of
• When the speed control 10
for degree axis is valid ;
• When the speed control 10
for degree axis is invalid ;
Motion CPU.
0.01 to 21474836.47[degree/min]
0.001 to 2147483.647[degree/min]
0.88ms/1 to 5 axes
1.77ms/6 to 8 axes
Q173HCPU : 2 systems
Q172HCPU : 1 system
multiplier setting
multiplier setting
(Note-2)
0.88ms/ 1 to 4 axes
1.77ms/ 5 to 12 axes
3.55ms/13 to 24 axes
7.11ms/25 to 32 axes
SSCNET
Only direct setting by programming software.
0.001 to 2147483.647[degree/min] fixed
Q172LX
Q173CPU(N) : 4 systems
Q172CPU(N) : 1 system
0.88ms/1 to 4 axes
1.77ms/5 to 8 axes
(Note-1)
OFF.
more.)
—
(Note-4)
Optional data monitor function 3 points/axis (Specified device D, W, #)
When the speed change is executed after
positioning automatic decerelation start or during
Minor error [303], [304]
Processing with power supply OFF
of servo amplifier
Back-up battery for internal memory
(Note-1) : Use the dividing unit (Q173DV) or dividing cable (Q173J2B CBL M/Q173HB CBL M).
(Note-2) : When selecting the each servo amplifier general input, the home position return by the count type cannot be executed. And, the
external stop input cannot be used.
(Note-3) : When adding the external battery (Q6BAT), use the Q170HBATC.
(Note-4) : When adding the external battery (A6BAT/MR-BAT), use the Q173DV (Q173CPU(N) use) or Q170BAT (Q172CPU(N) use).
decerelation by the JOG start command signal
(M3202+20n, M3203+20n) OFF, since the
speed change request is ignored, a minor error
[303], [304] will not occur.
Servo OFF is executed for all servo amplifier
connected behind servo amplifier with which the
control power supply was turned OFF.
Internal rechargeable battery
(Set the external battery (Q6BAT) if continuous
power off time is longer for 1 month or more.)
(Note-3)
When the speed change is executed after
positioning automatic decerelation start or during
decerelation by the JOG start command signal
(M3202+20n, M3203+20n) OFF, a minor error
[303], [304] will occur.
Servo OFF is executed for only servo amplifier
with which the control power supply was turned
Internal rechargeable battery
(Set the external battery (A6BAT/MR-BAT) if
continuous power off time is longer for 1 month or
1 - 6
2 POSITIONING CONTROL BY THE MOTION CPU
2. POSITIONING CONTROL BY THE MOTION CPU
2.1 Positioning Control by the Motion CPU
The positioning control of up to 32 axes in Q173HCPU and up to 8 axes in Q172HCPU
is possible in the Motion CPU.
There are following four functions as controls toward the servo amplifier/servomotor.
(1) Servo operation by the positioning instructions.
The positioning instructions are programmed using the Motion program.
The starting method of Motion program is shown below.
(a) Motion program start request (S(P).SVST) using the PLC program of PLC
CPU or Motion program (control program) start request (S(P).SFCS)
(b) Automatic start setting of Motion program (control program)
(c) Start by CALL, GOSUB/GOSUBE instruction using other Motion program
(2) JOG operation by the axis command signal of Motion CPU.
(3) Manual pulse generator operation by the positioning dedicated device of Motion
CPU.
(4) Speed change and torque limit value change during positioning control by the
Motion dedicated PLC instruction (S(P).CHGV, S(P).CHGT instruction) or the
CHGV, CHGT, TL instruction in the Motion program.
2
2 - 1
2 POSITIONING CONTROL BY THE MOTION CPU
[Execution of the Motion program start (S(P).SVST instruction)]
Positioning control is executed by starting the Motion program (axis designation
program) specified with S(P).SVST instruction of the PLC CPU in the Motion CPU.
An overview of the starting method using the Motion program is shown below.
Multiple CPU control system
PLC CPU
PLC program . . . . . . . . .
Create using a peripheral device
(Note-1)
<Example> SP.SVST instruction
Positioning execute command
M0 D0
.
SP
SVST H3E3
"J1"
K15
Device which stores the
complete status
Complete device
Motion program No.15
Axis 1
(Start axis No.)
Target CPU
Start request of the
Motion program
1) The Motion program No. and start axis No. are set using the
S(P).SVST instruction in the PLC program.
2) When the S(P).SVST instruction is executed, the program of the
Motion program No. specified with the Motion CPU is executed.
Point
In the above, it is explained the start of axis designation program.
There are following 2 types as the Motion program.
Control program : Only control instruction can be used, the travel instruction by G-code
can not be used.
It is started by the S(P).SFCS of PLC CPU, automatic start with parameter,
or CALL, GOSUB/GOSUBE instruction of other control program.
Axis designation program : The travel instruction by G-code and control instruction can be used.
It is started by the S(P).SVST instruction of PLC CPU or CALL,
GOSUB/GOSUBE instruction of control program.
(1) Create the Motion programs and positioning control parameters using a peripheral
device.
(2) Perform the positioning start using the PLC program (S(P).SVST instruction) of
PLC CPU.
(a) Motion program No. is specified with the S(P).SVST instruction.
1) Motion program No. can be set either directly or indirectly.
2) Start axis No. can be set only directly.
(3) Perform the specified positioning control using the specified with the Motion
program.
Start request of the
Motion program
2 - 2
2 POSITIONING CONTROL BY THE MOTION CPU
Motion CPU
Motion program . . . . .
O0015;
SET #M2042
N10 G00 X100. Y100.;
X200.;
Y200.;
N20 G01 X25. F500.;
.
.
.
N70 G28 X0. Y0.;
N80 M02;
%
Create and correct using a peripheral
(Note-1)
device
Motion program No.15
(Program No. specified with the S(P).SVST instruction.)
All axes servo ON command turns on.
PTP positioning instruction by high-speed feed speed
Linear positioning of the specified axis is executed from
the current position to the specified coordinate position
by all axes fixed speed.
CP positioning instruction by the speed specified with F
Linear interpolation is executed from the current
position to the specified coordinate position by the feed
speed specified with F.
Home position return instruction
Home position return of the specified axis is executed
from the current position through the specified
coordinate position.
Program end instruction
Program ends.
Positioning control parameters . . . . .
System settings
Fixed parameters
Servo parameters
Parameters block
Home position return data
JOG operation data
Limit switch output data
System data such as axis allocations
Fixed data by the mechanical system, etc.
Data by the specifications of the connected
servo amplifier
Data required for the acceleration, deceleration
of the positioning control, etc.
Data required for the home position return
Data required for the JOG operation
ON/OFF pattern data required for the limit
switch output function
Set and correct using a
peripheral device
(Note-1)
Servo amplifier
Servomotor
REMARK
(Note-1) : The following peripheral devices started by the SW6RN-GSV43P can be
used.
• The personal computer by which WindowsNT
Windows
WindowsNT
R
2000/Windows
R
, WindowsRare either registered trademarks or trademarks of
R
XP works. (IBM PC/AT compatible)
Microsoft Corporation in the United States and/or other countries.
2 - 3
R
4.0/WindowsR98/
2 POSITIONING CONTROL BY THE MOTION CPU
[Execution of the JOG operation]
JOG operation of specified axis is executed using the Motion program in
the Motion CPU. JOG operation can also be executed by controlling the JOG
dedicated device of specified axis.
An overview of JOG operation is shown below.
Motion CPU control system
Motion program . . . . .
O100;
SET #M2042;
N10 IF[[ON #M2 415] AND [ON #M2435]] GOTO 20;
GOTO 10;
N20 #D640 = 100000;
#D642L = 100000;
IF [[O N #X003 ] AN D [OFF #M 32 03]] TH EN 1;
SET #M3202;
ELSE 1;
RST #M 3202;
END 1;
IF [[O N #X004 ] AN D [OFF #M 32 02]] TH EN 2;
SET #M3203;
ELSE 2;
RST #M 3203;
END 2;
.
.
.
N80 M02;
%
Create and correct using a peripheral device
(Note-1)
Motion program No.100
(Program No. specified with the
S(P).SFCS instruction.)
All axes servo ON command turns on.
Transfer the JOG operation speed to
D640L and D642L.
Program control function instruction
The flow of execute program is
controlled by conditions.
1 axis forward rotation command
SET/RST
Program control function instruction
The flow of execute program is
controlled by conditions.
1 axis reverse rotation command
SET/RST
Program end instruction
Program ends.
JOG operation by
the JOG dedicated
device control
(1) Set the positioning control parameters using a peripheral device.
(2) Set the JOG speed to the JOG speed setting register for each axis using the
Motion program.
(3) Perform the JOG operation while the JOG start command signal is ON in the
Motion program.
2 - 4
2 POSITIONING CONTROL BY THE MOTION CPU
Positioning control parameter . . . . .
System settings
Fixed parameters
Servo parameters
Parameter block
Home position return data
JOG operation data
Limit switch output data
System data such as axis allocations
Fixed data by the mechanical system, etc.
Data by the specifications of the connected
servo amplifier
Data required for the acceleration, deceleration
of the positioning control, etc.
Data required for the home position return
Data required for the JOG operation
ON/OFF pattern data required for the limit
switch output function
Set and correct using a
peripheral device
(Note-1)
Servo amplifier
Servomotor
REMARK
(Note-1) : The following peripheral devices started by the SW6RN-GSV43P can be
used.
• The personal computer by which WindowsNT
Windows
WindowsNT
R
2000/Windows
R
, WindowsRare either registered trademarks or trademarks of
R
XP works. (IBM PC/AT compatible)
Microsoft Corporation in the United States and/or other countries.
2 - 5
R
4.0/WindowsR98/
Loading...