DS5C2 Servo Manual
DS5C2 Servo Manual
User manual
Declaration of liability
Although the contents of the manual have been carefully checked, errors are inevitable, and we
cannot guarantee complete consistency.
We will often check the contents of the manual and make corrections in the subsequent
versions.We welcome your valuable comments.
If there is any change to the contents introduced in the manual, please understand without
further notice.
Contact information
Tel: 400-885-0136
Fax: 0510-85111290
Address: No.816, Jianzhu West Road, Binhu District, Wuxi City, Jiangsu Province, China
Postcode: 214072
Safety Precautions
The problems that may arise during the use of the product are basically listed in the safety precautions,
and all are indicated by the two levels of attention and danger. For other unmentioned matters, please
follow the basic electrical operation rules.
When used incorrectly, there may be danger, moderate injury or minor injury, and
Caution
property loss.
When used incorrectly, it may cause danger, personal casualties or serious injuries
Danger
as well as serious property losses.
Installation notes
1. It is strictly forbidden to place near flammable gas,otherwise it will cause fire.
2. Be sure to follow the installation direction requirements to prevent drive failure.
3. It is forbidden to expose the product to water, corrosive gases, flammable gases and other
substances,causing electric shock and fire hazards.
4. Before installing wiring, be sure to disconnect the power supply to prevent electric shock.
5. Do not touch the conductive part of the product directly, which may cause misoperation and
malfunction.
Wiring attention
1. Do not cross the power line and the control signal line from the same pipeline, nor tie them
together. The power line and the control signal line are separated by more than 30 centimeters.
2. For signal wire and encoder (PG) feedback wire, please use multi stranded wire and multi-core
stranded overall shielded wire.
3. The longest signal input line is 3m, and the longest PG feedback line is 30m.
4. Please conduct wiring correctly and reliably, otherwise the motor will be out of control or failure,
and serious injury will be caused.
5. It is strictly forbidden to use it when the power supply is in poor condition or exceeds the specified
voltage variation range, otherwise it will cause mechanical damage.
6. Please take appropriate shielding measures when there is static electricity, strong electromagnetic
field, radiation, and nearby power lines.
Catalog
►►CONFIRMATION ON PRODUCT ARRIVAL ................................................................................................................ 6
1 SELECTION OF SERVO SYSTEM ........................................................................................................................ 7
1.1 SELECTION OF SERVO DRIVER ............................................................................................................................................ 7
1.1.1 Model name ........................................................................................................................................................7
1.1.2 Description of each part ......................................................................................................................................7
1.1.3 Performance specifiation .................................................................................................................................... 9
1.1.4 Electrical specification ........................................................................................................................................ 9
1.2 SERVO MOTOR SELECTION .............................................................................................................................................. 10
1.2.1 Model name ......................................................................................................................................................10
1.2.2 Description of each part ....................................................................................................................................11
1.2.3 Axial force and radial force ...............................................................................................................................11
1.3 CABLE SELECTION ..........................................................................................................................................................12
1.3.1 Encoder cable ....................................................................................................................................................12
1.3.2 Power cable .......................................................................................................................................................12
1.3.3 EtherCAT communication cable ........................................................................................................................13
1.3.4 Connection cable of driver and motor .............................................................................................................. 13
1.4 SELECTION OF OTHER ACCESSORIES .................................................................................................................................. 18
2 INSTALLATION OF SERVO SYSTEM ................................................................................................................19
2.1 SERVO DRIVER INSTALLATION .......................................................................................................................................... 19
2.1.1 Installation site ................................................................................................................................................. 19
2.1.2 Environment condition ......................................................................................................................................19
2.1.3 Installation standard .........................................................................................................................................19
2.2 SERVO MOTOR INSTALLATION ..........................................................................................................................................20
2.2.1 Environment condition ......................................................................................................................................20
2.2.2 Installation cautions ......................................................................................................................................... 21
2.2.3 Installation environment ...................................................................................................................................22
2.3 SERVO CABLE INSTALLATION ............................................................................................................................................ 23
2.3.1 Cable selection .................................................................................................................................................. 23
2.3.2 Xinje cable specification ....................................................................................................................................24
2.4 SERVO DRIVER DIMENSION ............................................................................................................................................. 26
2.5 SERVO MOTOR DIMENSION .............................................................................................................................................29
3 SERVO SYSTEM WIRING ................................................................................................................................... 33
3.1 MAIN CIRCUIT TERMINAL ................................................................................................................................................34
3.1.1 Servo driver terminal layout ............................................................................................................................. 34
3.1.2 Main circuit terminals .......................................................................................................................................35
3.1.3 CN0, CN1, CN2, CN3 terminal description ........................................................................................................ 37
3.1.3.1 CN0 control terminal ..................................................................................................................................................... 37
3.1.3.2 CN1 communication terminal description .................................................................................................................... 37
3.1.3.3 CN2 encoder interface description ................................................................................................................................38
3.1.3.4 CN3 terminal (RS232) .................................................................................................................................................... 38
3.1.3.5 CN5 terminal ..................................................................................................................................................................39
3.2 SIGNAL TERMINAL ......................................................................................................................................................... 40
3.2.1 SI input signal ....................................................................................................................................................40
3.2.2 SO output signal ................................................................................................................................................41
4 PANEL OPERATION ............................................................................................................................................. 43
4.1 BASIC OPERATION ..........................................................................................................................................................43
4.1.1 Operating panel description ............................................................................................................................. 43
4.1.2 Button operation ...............................................................................................................................................43
4.2 OPERATION STATE DISPLAY .............................................................................................................................................. 44
4.3 GROUP U MONITOR PARAMETER ..................................................................................................................................... 46
4.4 GROUP F AUXILIARY PARAMETERS .................................................................................................................................... 49
4.4.1 F0-XX ................................................................................................................................................................. 49
4.4.2 F1-XX ................................................................................................................................................................. 49
4.5 FAULT ALARM OPERATION ............................................................................................................................................... 50
4.6 PARAMETER EXAMPLE .................................................................................................................................................... 50
4.7 CHECK THE MOTOR CODE ............................................................................................................................................... 51
5 BASIC FUNCTIONS .............................................................................................................................................. 52
5.1 ABSOLUTE VALUE SYSTEM ...............................................................................................................................................52
5.1.1 Absolute system setting ....................................................................................................................................52
5.1.2 Replace the battery ...........................................................................................................................................52
5.1.3 The upper limit of turns .................................................................................................................................... 53
5.1.4 Absolute encoder position calibration .............................................................................................................. 54
5.1.4.1 Reset multi-turn absolute position ................................................................................................................................54
5.1.4.2 Zero calibration of absolute encoder ............................................................................................................................ 55
5.2 POWER-OFF BRAKE ....................................................................................................................................................... 55
5.3 STOP MODE ................................................................................................................................................................. 58
5.3.1 Servo OFF and alarm shutdown ........................................................................................................................59
5.3.2 Stop mode when overtravel in normal mode ................................................................................................... 61
5.3.3 Stop mode when overtravel in bus mode ......................................................................................................... 62
5.4 POSITION CONTROL ....................................................................................................................................................... 65
5.4.1 General position control ................................................................................................................................... 65
5.4.1.1 Electronic gear ratio .......................................................................................................................................................65
5.4.1.2 Positioning completion signal (/COIN, /COIN_HD) ........................................................................................................68
5.4.1.3 Positioning near signal (/NEAR) .....................................................................................................................................70
5.4.1.4 Command pulse prohibition (/INHIBIT) .........................................................................................................................71
5.4.1.5 Offset clear(/CLR) .....................................................................................................................................................71
5.4.1.6 Position pulse deviation ................................................................................................................................................ 72
5.4.1.7 Position command filter ................................................................................................................................................ 72
5.4.1.8 Reference origin .............................................................................................................................................................73
5.4.1.9 Homing function ............................................................................................................................................................75
5.4.2 Position control (external pulse command) ...................................................................................................... 92
5.4.2.1 External pulse position mode ........................................................................................................................................92
5.4.2.2 Pulse input specification ................................................................................................................................................92
5.4.2.3 Pulse command form selection ..................................................................................................................................... 92
5.4.2.4 Pulse command logic form ............................................................................................................................................ 93
5.4.2.5 Pulse command forward direction selection .................................................................................................................93
5.4.3 Position control (Internal command) ................................................................................................................ 94
5.4.3.1 Internal position mode .................................................................................................................................................. 94
5.4.3.2 Internal position mode setting ...................................................................................................................................... 94
5.4.3.3 Position segment 1 to 35 parameter settings ............................................................................................................... 99
5.4.3.4 Change step signal (/CHGSTP) ..................................................................................................................................... 101
5.4.3.5 Skip present segment signal (/ZCLAMP) ......................................................................................................................101
5.4.3.6 Set segment through communication ......................................................................................................................... 101
5.4.3.7 Motion start signal (/MRUN) ....................................................................................................................................... 101
5.5 SPEED CONTROL ......................................................................................................................................................... 102
5.5.1 Speed mode general control ........................................................................................................................... 102
5.5.1.1 Soft start ...................................................................................................................................................................... 102
5.5.1.2 Zero clamp (/ZCLAMP) .................................................................................................................................................102
5.5.1.3 Speed reach signal (/V-RDY) ........................................................................................................................................ 103
5.5.1.4 Speed command filter ................................................................................................................................................. 103
5.5.2 Speed control (internal speed) ........................................................................................................................ 105
5.5.2.1 Internal speed mode ................................................................................................................................................... 105
5.5.3 Speed control (pulse frequency command) .................................................................................................... 107
5.5.3.1 External pulse speed mode ......................................................................................................................................... 107
5.5.3.2 Pulse frequency command .......................................................................................................................................... 107
5.5.3.3 Command pulse frequency at rated speed ................................................................................................................. 107
5.5.3.4 Speed command pulse filter time ............................................................................................................................... 107
5.5.3.5 Speed command pulse direction .................................................................................................................................107
5.6 TORQUE CONTROL .......................................................................................................................................................108
5.6.1 Torque control (internal setting) ..................................................................................................................... 108
5.6.1.1 Internal torque command ........................................................................................................................................... 108
5.6.1.2 Internal speed limit of torque control ......................................................................................................................... 108
5.6.1.3 Speed reach signal output (/VLT) ................................................................................................................................ 109
5.7 STO SAFE TORQUE OFF ................................................................................................................................................ 109
5.7.1 STO function overview .................................................................................................................................... 109
5.7.2 STO wiring diagram ........................................................................................................................................ 109
5.7.3 STO parameters .............................................................................................................................................. 110
5.7.4 STO working principle ..................................................................................................................................... 110
5.7.5 STO function precautions ................................................................................................................................110
5.8 WEAK MAGNETIC CONTROL .......................................................................................................................................... 111
5.8.1Weak magnetic function overview .................................................................................................................. 111
5.8.2 Weak magnetic related parameter settings ................................................................................................... 111
6 ETHERCAT BUS COMMUNICATION ..............................................................................................................112
6.1 ETHERCAT TECHNICAL OVERVIEW ..................................................................................................................................112
6.1.1 EtherCAT introduction .....................................................................................................................................112
6.1.2 System composition(master and slave station) ..............................................................................................112
6.2 ETHERCAT COMMUNICATION SPECIFICATION ...................................................................................................................112
6.2.1 Communication specification ......................................................................................................................... 112
6.2.2 EtherCAT frame structure ............................................................................................................................... 113
6.2.3 State machine ESM ......................................................................................................................................... 114
6.2.4 Slave station controller ESC ............................................................................................................................ 114
6.2.4.1 Principle overview ....................................................................................................................................................... 114
6.2.4.2 Address space ..............................................................................................................................................................115
6.2.5 SII area (0000h~003Fh) .................................................................................................................................116
6.2.6 SDO(Service Data Object) ............................................................................................................................... 116
6.2.6.1 Mailbox frame structure ..............................................................................................................................................117
6.2.6.2 Mailbox overtime ........................................................................................................................................................ 117
6.2.6.3 Alarm information ....................................................................................................................................................... 118
6.2.7 PDO(Process Data object) ...............................................................................................................................118
6.2.7.1 PDO mapping objects .................................................................................................................................................. 118
6.2.7.2 PDO distribution objects ............................................................................................................................................. 119
6.2.8 Communication synchronization mode .......................................................................................................... 119
6.2.8.1 DC(SYNC0 event synchronization) ............................................................................................................................... 120
6.2.8.2 SM2(SM2 event synchronization) ................................................................................................................................120
7 ETHERCAT BUS CONTROL MODE .................................................................................................................121
7.1 ETHERCAT OPERATION ................................................................................................................................................ 121
7.2 CSP MODE ................................................................................................................................................................ 122
7.2.1 Related parameters ........................................................................................................................................ 122
7.2.2 Common parameters ...................................................................................................................................... 126
7.3 CSV MODE ................................................................................................................................................................ 127
7.3.1 Related parameter ..........................................................................................................................................127
7.3.2 Common parameters ...................................................................................................................................... 130
7.4 CST MODE ................................................................................................................................................................ 131
7.4.1 Related parameter ..........................................................................................................................................131
7.4.2 Common parameters ...................................................................................................................................... 134
7.5 HM MODE ................................................................................................................................................................ 135
7.5.1 Related parameter ..........................................................................................................................................136
7.5.2 Related parameters ........................................................................................................................................ 143
7.5.3 Homing method .............................................................................................................................................. 143
7.6 PP MODE .................................................................................................................................................................. 151
7.6.1 Related parameters ........................................................................................................................................ 151
7.6.2 Common parameters ...................................................................................................................................... 158
7.7 PV MODE .................................................................................................................................................................. 160
7.7.1 Related parameters ........................................................................................................................................ 160
7.7.2 Common parameters ...................................................................................................................................... 165
7.8 TQ MODE ..................................................................................................................................................................166
7.8.1 Related parameters ........................................................................................................................................ 166
7.8.2 Common parameters ...................................................................................................................................... 169
7.9 MODE COMMON FUNCTION ......................................................................................................................................... 170
7.9.1 Mode mutual switching function ....................................................................................................................170
7.9.2 Stop mode ....................................................................................................................................................... 170
7.9.3 Touch Probe function(position clamp request/release) ................................................................................. 174
7.9.4 Digital input(60FDh) ....................................................................................................................................... 178
7.9.5 Digital output (60FEh) .....................................................................................................................................179
7.9.6 Position information ....................................................................................................................................... 180
7.9.7 Overtravel function in Ethercat mode ............................................................................................................ 184
7.9.8 Remote I/O function ........................................................................................................................................189
7.9.9 Cascade alarm function .................................................................................................................................. 191
8 OBJECT DICTIONARY ...................................................................................................................................... 192
8.1 OBJECT DICTIONARY AREA ASSIGNMENT ..........................................................................................................................192
8.2 COE COMMUNICATION AREA (0X1000-0X1FFF) ............................................................................................................ 192
8.2.1 Object list ........................................................................................................................................................ 192
8.2.2 Device information ..........................................................................................................................................195
8.2.3 Sync manager communication type(1C00h) ...................................................................................................195
8.2.4 PDO mapping ..................................................................................................................................................196
8.2.5 Sync manager 2/3 synchronization (1C32h, 1C33h) .......................................................................................198
8.3 SERVO PARAMETER AREA (0X2000~0X2FFF) ................................................................................................................. 202
8.3.1 Object list ........................................................................................................................................................ 202
8.3.2 Object overview .............................................................................................................................................. 203
8.4 DRIVER PROFILE AREA(0X6000~0X6FFF) ...................................................................................................................... 204
8.4.1 Object list ........................................................................................................................................................ 204
8.4.2 PDS(Power Drive Systems)specification ..........................................................................................................206
8.4.3 Controlword (6040h) .......................................................................................................................................207
8.4.4 Statusword (6041h) ........................................................................................................................................ 208
8.5 CONTROL MODE SETTING ............................................................................................................................................. 209
8.5.1 Supported drive modes (6502h) ..................................................................................................................... 209
8.5.2 Modes of operation(6060h) ............................................................................................................................209
8.5.3 Modes of operation display(6061h) ................................................................................................................210
9 SERVO GAIN ADJUSTMENT ............................................................................................................................ 211
9.1 OVERVIEW OF SERVO GAIN ADJUSTMENT ........................................................................................................................ 211
9.1.1 Overview and process ..................................................................................................................................... 211
9.1.2 Differences between these adjustment modes .............................................................................................. 212
9.2 ROTARY INERTIA PRESUMPTION ..................................................................................................................................... 213
9.2.1 Overview ......................................................................................................................................................... 213
9.2.2 Notes ...............................................................................................................................................................213
9.2.3 Operation tool .................................................................................................................................................213
9.2.4 Operation steps ...............................................................................................................................................213
9.3 FAST ADJUSTMENT ...................................................................................................................................................... 217
9.3.1 Overview ......................................................................................................................................................... 217
9.3.2 Fast adjustment steps .....................................................................................................................................217
9.3.3 Rigidity level corresponding gain parameters ................................................................................................ 217
9.3.4 Notes: ..............................................................................................................................................................220
9.4 AUTO-TUNING ............................................................................................................................................................221
9.4.1 Overview ......................................................................................................................................................... 221
9.4.2 Notes ...............................................................................................................................................................221
9.4.3 Operation tools ............................................................................................................................................... 221
9.4.4 Internal instruction auto-tuning steps ............................................................................................................222
9.4.5 External instruction auto-tuning steps ........................................................................................................... 226
9.4.6 Related parameters ........................................................................................................................................ 231
9.5 MANUAL ADJUSTMENT ................................................................................................................................................ 233
9.5.1 Overview ......................................................................................................................................................... 233
9.5.2 Adjustment steps ............................................................................................................................................ 233
9.5.3 Gain parameter for adjustment ......................................................................................................................234
9.6 ADAPTIVE .................................................................................................................................................................. 235
9.6.1 Overview ......................................................................................................................................................... 235
9.6.2 Notes ...............................................................................................................................................................235
9.6.3 Operation steps ...............................................................................................................................................235
9.6.4 Inertia mode and related parameters ............................................................................................................ 235
9.6.5 Recommended inertia ratio parameters ........................................................................................................ 236
9.6.6 Adaptive parameter effect ..............................................................................................................................236
9.6.7 Invalid parameters when adaptive effective .................................................................................................. 237
9.7 VIBRATION SUPPRESSION ..............................................................................................................................................238
9.7.1 Overview ......................................................................................................................................................... 238
9.7.2 Operation tools ............................................................................................................................................... 238
9.7.3 Vibration suppression (fast FFT) ..................................................................................................................... 238
9.7.4 Vibration suppression (PC software) .............................................................................................................. 239
9.7.5 Vibration suppression(manual setting) .......................................................................................................... 240
9.7.6 Notch filter ...................................................................................................................................................... 240
9.8 GAIN ADJUSTMENT APPLICATION ....................................................................................................................................242
9.8.1 Model loop control ..........................................................................................................................................242
9.8.2 Torque disturbance observation ..................................................................................................................... 244
9.8.3 Gain adjust parameters .................................................................................................................................. 244
9.8.4 Gain switch ..................................................................................................................................................... 245
9.8.5 Speed loop P-PI mode switching .....................................................................................................................249
9.9 GAIN ADJUSTMENT ......................................................................................................................................................250
9.9.1 Load shaking ................................................................................................................................................... 250
9.9.2 Vibration ......................................................................................................................................................... 250
9.9.3 Noise ............................................................................................................................................................... 250
10 ALARM ............................................................................................................................................................... 251
10.1 ETHERCAT RELATED COMMUNICATION ALARM CODE ......................................................................................................251
10.2 ETHERCAT COMMUNICATION UNRELATED ALARM .......................................................................................................... 255
10.3 ALARM READ ........................................................................................................................................................... 264
10.4 ALARM CLEAR .......................................................................................................................................................... 264
11 APPLICATIONS ................................................................................................................................................. 265
11.1 XINJE XG2/XDH AND DS5C2 ETHERCAT COMMUNICATION .......................................................................................... 265
11.1.1 System configuration .................................................................................................................................... 265
11.1.2 System topology ........................................................................................................................................... 265
11.1.3 Debugging steps ........................................................................................................................................... 265
11.2 BECKHOFF TWINCAT AND XINJE DS5C2 .................................................................................................................... 294
11.2.1 System configuration .................................................................................................................................... 294
11.2.2 System topology ........................................................................................................................................... 294
11.2.3 Commissioning steps: ................................................................................................................................... 294
11.3 CODESYS AND XINJE DS5C2 ETHERCAT COMMUNICATION EXAMPLE ............................................................................. 307
11.3.1 System topology ........................................................................................................................................... 307
11.3.2 System topology ........................................................................................................................................... 307
11.3.3 Debugging steps ........................................................................................................................................... 307
11.4 OMRON AND DS5C2 SERVO ETHERCAT COMMUNICATION EXAMPLE ............................................................................... 327
11.4.1 System configuration .................................................................................................................................... 327
11.4.2 System topology ........................................................................................................................................... 327
11.4.3 Debugging steps ........................................................................................................................................... 328
APPENDIX ...............................................................................................................................................................342
APPENDIX 1. DRIVER PARAMETERS ...................................................................................................................................... 342
Appendix 1.1 PX-XX ..................................................................................................................................................342
Appendix 1.2 FX-XX .................................................................................................................................................. 356
Appendix 1.3 U0-XX ................................................................................................................................................. 356
APPENDIX 2. OBJECT DICTIONARY ........................................................................................................................................360
Appendix 2.1 COE communication area (0x1000-0x1FFF) .......................................................................................360
Appendix 2.2 Servo parameter area ........................................................................................................................ 362
Appendix 2.3 Driver Profile area(0x6000~0x6FFF) .................................................................................................. 363
APPENDIX 3. GLOSSARY OF TERMS ...................................................................................................................................... 380
►►Confirmation on product arrival
After the product arrives, please confirm the integrity of the product in the following aspects.
Items Notes
Does the product on arrival match the Please confirm according to the nameplate of servo
specified model? motor and servo unit.
Does the servomotor shaft rotate smoothly? The servo motor shaft is normal if it can be turned
smoothly by hand. Servo motors with brakes, however,
cannot be turned manually.
Is there any damage? Check the overall appearance, and check for damage or
scratches that may have occurred during shipping.
Are there any loose screws? Check screws for looseness using a screwdrive.
Is the motor code the same with the code in Check the motor code marked on the nameplates of the
drive? servomotor and the parameter U3-70 on the servo
drive.
If any of the above is faulty or incorrect, contact Xinje or an authorized distributor.
1 Selection of servo system
1.1 Selection of servo driver
1.1.1 Model name
The names of each part of the 0.1kW~7.5kW servo drive are as follows:
No. Name Explanation
Refer to driver nameplate rated voltage level input main
circuit power supply:
L/N, L1/L2/L3, R/S/T
L/N: single-phase 220V main circuit power supply;
(1) Main circuit power input
L1/L2/L3: single-phase/three-phase main circuit power
terminal
supply;
R/S/T: three-phase 380V main circuit power supply.
When using the built-in braking resistor, short-circuit the
P+, D, C brake resistor
(2) P+ and D terminals, and disconnect the P+ and C;
connection terminal
When using an external braking resistor, remove the P+
and D short connection and connect the braking resistor
to the P+ and C terminals.
(3) P+, P- bus terminal Driver bus terminal.
(4) U, V, W servo motor power
Connect the servo motor phase U/V/W.
terminal
(5) Connect to the motor grounding terminal and perform
PE motor grounding terminal
grounding treatment.
(6) Connect to external ground stakes for grounding
treatment,
driver grounding terminal
Connect to the power grounding terminal and perform
grounding treatment.
(7) Used to indicate that the bus capacitor is in a charged
state. When the indicator light is on, even if the main
CHARGE Bus voltage circuit power is turned off, there may still be charges in
indicator light the internal capacitors of the servo unit. Therefore, do
not touch the power terminal when the light is on to
avoid electric shock.
(8) CN0: input output terminals Input/output control signal terminals.
(9) CN1: EtherCAT port EtherCAT communication ethernet cable port
(10) CN2: encoder port Connect to the motor encoder terminal.
(11) RS232 communication interface, connected to the servo
CN3: RS232 port
upper computer debugging software for communication.
(12) STO function safety terminal, used for application
CN5: STO Safety function
scenarios of safety functions, external safety function
terminal
signal access.
(13) 5-digit 8-segment LED digital tube, used to display the
Driver display panel
operating status and parameter settings of the servo.
(14) Used for installation and wiring assistance of needle
Wiring auxiliary buckle
terminals.
The names of each part of the 15kW servo drive are as follows:
No. Name Explanation
R/S/T main circuit power Refer to driver nameplate rated voltage level input main
(1) circuit power supply:
supply input terminal
R/S/T: three-phase 380V main circuit power supply.
U, V, W servo motor power
(2) Connect the servo motor phase U/V/W.
terminal
(3) Connect to the motor grounding terminal and perform
grounding treatment,
Connect to external ground stakes for grounding
PE grounding terminal
treatment,
Connect to the power grounding terminal and perform
grounding treatment.
(4) P+, P- bus terminal Driver bus terminals.
(5) When using an external braking resistor, connect the
PB terminal
braking resistor to the P+ and PB terminals.
(6) CN0: input output terminals Input/output control signal terminals.
(7) CN1: EtherCAT port EtherCAT communication ethernet cable port
(8) CN2: encoder port Connect to the motor encoder terminal.
(9) RS232 communication interface, connected to the servo
CN3: RS232 port
upper computer debugging software for communication.
(10) 5-digit 8-segment LED digital tube, used to display the
Driver display panel
operating status and parameter settings of the servo.
(11) Four panel operation buttons are used to view the
Panel buttons
operation status and set parameters of the servo.
(12) Used to indicate that the bus capacitor is in a charged
state. When the indicator light is on, even if the main
PWR Bus voltage indicator circuit power is turned off, there may still be charges in
light the internal capacitors of the servo unit. Therefore, do
not touch the power terminal when the light is on to
avoid electric shock.
Maximum Power
Driver Continuous
output input Cooling
Driver model power output Power supply
current current method
(kW) current (A)
(A) (A)
DS5C2-20P1-PTA 0.1 0.9 3.15 1.3 Single phase Self cooling
DS5C2-20P4-PTA 0.4 2.8 9.8 4 AC200~240V, Self cooling
DS5C2-20P7-PTA 0.75 4.8 16.8 5.5 50/60Hz Air cooling
Maximum Power
Driver Continuous
output input Cooling
Driver model power output Power supply
current current method
(kW) current (A)
(A) (A)
DS5C2-21P0-PTA 1.0 6 18 9 Single Air cooling
DS5C2-21P5-PTA 1.5 8 20 9 phase/three-phase Air cooling
DS5C2-22P3-PTA 2.3 9 18 8 AC200~240V, Air cooling
DS5C2-22P6-PTA 2.6 10.5 29.93 10 50/60Hz Air cooling
DS5C2-41P0-PTA 1.0 3.2 9.6 2.6 Air cooling
DS5C2-41P5-PTA 1.5 5.5 13.75 2.6 Air cooling
DS5C2-42P3-PTA 2.3 8.5 21.75 6.8 Three-phase Air cooling
DS5C2-43P0-PTA 3.0 11 29.7 8 AC380~440V, Air cooling
DS5C2-45P5-PTA 5.5 20 50 16 50/60Hz Air cooling
DS5C2-47P5-PTA 7.5 25 62.5 20 Air cooling
DS5C2-415P0-PTA 15 35 87.5 30 Air cooling
Base
40ST 60ST 80ST 100ST 110ST 130ST 180ST 220ST/265ST
no.
Axial
54N 74N 147N ≤200N 250N 300N 400N ≤500N
force
Radial
78N 245N 392N 500N 500N 600N 800N 1000N
force
1.3 Cable selection
1.3.1 Encoder cable
No. Name
1 /
2 5V
3 GND
4 485-A
5 485-B
MS6-130 base B2 motor
6 Battery +
7 Battery -
8 /
9 /
10 Shielding wire
No. Name
1 Shielding wire
2 /
3 485-B
4 485-A
MS6-180 base B2 motor 5 /
6 GND
7 Battery -
8 5V
9 Battery +
10-15 /
No. Name
1 Shielding wire
2 /
3 485-B
4 485-A
5 /
MS6-200 base B2 motor 6 GND
7 Battery -
8 5V
9 Battery +
10-13 /
14 Temperature -
15 Temperature +
No. Name
1 U
2 V
MS6-60, 80 base B3 motor 3 W
4 PE
Positive outlet reverse outlet A BK+
(user’s view) B BK-
No. Name
A W
MS6G-130 base non brake B V
motor C U
D PE
No. Name
A W
B V
MS6G-130 base brake motor C U
D PE
1 BK+
2 BK-
No. Name
A PE
MS6G-180 base non brake B W
motor C V
D U
No. Name
A PE
B W
MS6G-180 base brake motor C V
D U
1 BK+
2 BK-
No. Name
1 PE
MS6H-180 base non brake 2 U
motor 3 V
4 W
No. Name
A U
B V
MS6H-180 base brake motor C W
D PE
1 BK+
2 BK-
Color Name
Red U
Yellow V
MS6H-200 base brake motor
Blue W
Yellow
PE
green
Brake pins:
The cable including pin BK+, BK- is used for the brake motor. The cable of the non-brake motor has no BK pins.
At present, the length of power cables is 2 meters, 3 meters, 5 meters, 8 meters, 10 meters, 12 meters, 16 meters,
20 meters, 25 meters, 30 meters, 35 meters, 40 meters, 45 meters, and 50 meters.
1.4 Selection of other accessories
When the servo motor is driven by the generator mode, the power returns to the servo amplifier side, which is
called regenerative power. The regenerated power is absorbed by charging the smooth capacitor of the servo
amplifier. After exceeding the rechargeable energy, the regenerative resistance is used to consume the regenerative
power.
The deceleration stop period during acceleration and deceleration operation.
Running vertically and axially.
When the external load drives the motor to rotate.
Servo driver model Regenerative resistance connection terminals
(1) Using a built-in braking resistor, short circuit the P+ and D terminals,
and disconnect the P+ and C.
(2) When using an external braking resistor for drives with built-in braking
resistors of 7.5kW and below, connect the braking resistor to the P+ and C
DS5C2-P□-PTA terminals, remove the P+ and D short circuits, P0-25=power value, and
P0-26=resistance value.
(3) When using an external braking resistor for a 15kW driver, connect the
braking resistor to the P+ and PB terminals, P0-25=power value, and
P0-26=resistance value.
The following table is the recommended specifications of external regenerative resistance for each type of motor.
Minimum
External regenerative External regenerative
Bulit-in resistance(no
Servo driver model resistance(recommended resistance(recommended
brake unit less than this
resistance value) power value)
value)
DS5C2-20P1-PTA /
80Ω 80Ω-100Ω Above 200W
DS5C2-20P4-PTA /
DS5C2-20P7-PTA 80W50Ω 50Ω 50Ω-100Ω Above 600W
DS5C2-21P0-PTA 80W45Ω 35Ω 35Ω-75Ω Above 800W
DS5C2-21P5-PTA 80W50Ω
30Ω 30Ω-50Ω
DS5C2-22P3-PTA 80W50Ω Above 1000W
DS5C2-22P6-PTA 80W50Ω 25Ω 25Ω-50Ω
DS5C2-41P0-PTA 80W100Ω 120Ω 120Ω-150Ω Above 800W
DS5C2-41P5-PTA 80W100Ω 75Ω 75Ω-120Ω Above 1000W
DS5C2-42P3-PTA 80W60Ω 55Ω 55Ω-75Ω Above 1000W
DS5C2-43P0-PTA 80W60Ω 50Ω 50Ω-75Ω Above 1200W
DS5C2-45P5-PTA / 25Ω 25Ω-65Ω Above 2000W
DS5C2-47P5-PTA / 22Ω 22Ω-50Ω Above 2500W
DS5C2-415P0-PTA / 20Ω 20Ω-45Ω Above 3000W
Note:
1) When selecting external resistance, "resistance" - try to choose close to the "minimum resistance" in the
"recommended resistance". The smaller the resistance, the faster the discharge will be. The selection of "power"
should be based on the actual use on site, and the specific should depend on the calorific value. Generally, the
external regenerative resistor with higher power should be selected as far as possible.
2) The surface temperature of the regenerative resistance will be very high when it is frequently discharged. Please
use high-temperature resistant and flame-retardant wires when wiring, and note that the surface of the regenerative
resistance can not contact with the wire.
2 Installation of servo system
2.1 Servo driver installation
2.1.1 Installation site
Please install it in the installation cabinet without sunshine or rain.
Do not use this product near corrosive and flammable gas environments and combustibles such as hydrogen
sulfide, chlorine, ammonia, sulfur, chlorinated gas, acid, alkali, salt, etc.
Do not install in high temperature, humidity, dust, metal dust environment.
No vibration place.
Caution
1. The shaft end is coated with antirust. Please wipe the "antirust" with a cloth soaked in "thinner" before
installing the motor.
2. Avoid getting thinner on other parts of the servo motor.
Antirust
MS6 series servo motors are intended for indoor use. Please use them in an environment that meets the
following installation conditions.
Item Description
Using ambient temperature -10℃~40℃(no freeze)
Using ambient humidity 20%~90%RH(no condensation)
Storage temperature -20℃~60℃
Storage humidity 20%~90%RH(no condensation)
IP67 (MS6 series B3 motor, MS6G series B2 motor)
Protection level
IP65 (MS6H series B2 motor)
Encoder
cautions ◆ When installing a pulley on a servo motor shaft with a keyway, a screw hole is used
at the shaft end. To install the pulley, first insert the stud into the screw hole of the
shaft, use a washer on the surface of the coupling end, and gradually lock the pulley
with a nut.
◆ For the servo motor shaft with keyway, use the screw hole at the end of the shaft to
install. For shaft without keyway, friction coupling or similar methods are used.
◆ When disassembling the pulley, use the pulley extractor to prevent the shaft from
bearing the strong impact of the load.
◆ To ensure safety, install protective covers or similar devices in the rotating area,
such as pulleys installed on shafts
◆When installing the servo motor, ensure that it meets the centering accuracy
requirements shown in the following figure. If the centering is not sufficient, vibration
Centering may occur and sometimes damage bearings and encoders. When installing the
coupling, please do not directly impact the motor shaft, otherwise it will damage the
encoder installed on the opposite side of the load shaft end.
Item Description
Installation ◆ The servo motor can be installed in the horizontal or vertical direction.
direction
When using in places with water droplets, please confirm the protection level of the
servo motor before use. (Except for the shaft through part) When using in places where
oil droplets may drip onto the shaft through part, please specify a servo motor with oil
seal.
Oil and water
Service conditions for servo motors with oil seals:
countermeasures
◆ Please ensure that the oil level is below the lip of the oil seal when using.
◆ Please use the oil seal in a state where it can maintain good splashing of oil droplets.
◆ When installing the servo motor vertically upwards, please be careful not to
accumulate oil on the oil seal lip.
◆ Do not bend or apply tension to the wires, especially when the core wire of the
Stress condition
signal wire is 0.2mm or 0.3mm, which is very thin. Therefore, when wiring (using),
of cables
please do not tension it too tightly.
Regarding the connector section, please note the following:
◆When connecting the connector, please confirm that there is no garbage or foreign
objects such as metal sheets inside the connector.
◆When connecting the connector to the servo motor, be sure to first connect it from
one side of the main circuit cable of the servo motor, and the grounding wire of the
main cable must be reliably connected. If one side of the encoder cable is connected
first, the encoder may malfunction due to the potential difference between PE.
Handling of the
◆When wiring, please confirm that the pin arrangement is correct and error free.
connector
◆The connector is made of resin. Do not apply impact to avoid damaging the
section
connector.
◆When carrying out transportation operations while the cables are still connected, be
sure to hold the main body of the servo motor. If only the cable is grabbed for
handling, it may damage the connector or pull the cable.
◆If using bent cables, full attention should be paid during wiring operations to avoid
applying stress to the connector section. If stress is applied to the connector section, it
may cause damage to the connector.
Our regular cable materials include ordinary cable and high flexible cable. The adapter cable connector for motors
with 80 flange or less is divided into aviation plug and amp plug; the adapter cable connector for motors with 80
flange or more is aviation plug.
The cable selected by the customer needs to define the operating conditions on site.
If the cable is used in general occasions, please select the cable from other manufacturers (2.3.2 specifications of
Xinje cable) in strict accordance with the specifications given by Xinje. If the cable is used in unconventional
occasions, please select the cable according to the actual working conditions to be superior to the existing
specifications of Xinje.
(3) Interference, high current / high power occasions (such as welding equipment)
The motor is properly grounded.
High current equipment shall be grounded separately.
Reasonable wiring. Such as separation of strong and weak current cables.
Use metal shielding layer to shield, add magnetic ring to the encoder cable to resist interference.
The signal cables (485-A and 485-B) in encoder cables of 30m and above should have
thicker diameters to prevent long-distance signal attenuation and external interference from
affecting the encoder feedback signal.
4.5
169.25
168
DS5C2-20P7-PTA unit: mm
55 174 4.5 43.25
5.4
4.65
181.55
180
5.4
DS5C2-21P0/41P0/41P5-PTA unit: mm
2- 50 5
60 174.6 5
4.7
160
169.4
.5
R2
DS5C2-21P5/22P3/22P6/42P3/43P0-PTA unit: mm
2- 73 5
83 190.3 ∅
5
5
185
175
.5
R2
6
DS5C2-45P5/47P5-PTA unit: mm
2-
∅
5. 76 5.5
87 230 2
5
239.5
249
.6
R2
5.5
DS5C2-415P0-PTA unit: mm
120
150 209.7
15
9.5
417
402
.5
R3
2.5 Servo motor dimension
40 series motor installation dimensions Unit: mm
0.06 A 2-Ø4.6
0.02 A
Ø46
29.2
28.8
30h7
8h6
A
15
0.04 A 35
25 LA 40
8
深
M3
3N9
6.2
LA±1
Inertia
Motor model With
Normal level
brake
MS6H-40CN30B□3-20A5-S 60.8 93.4
High
MS6H-40□□30B□3-20P1 79.4 112
inertia
MS6H-40CN30B□3-20P1-S 77.4 110
0.06 A
Ø70
38.8
37.8
0.02 A
50h7
14h6
8
深
20
5N9
M5
3 4- 5.5
0.04 A A 6
30 LA □ 60
11
LA±1
Inertia
Motor model With
Normal level
brake
MS6H-60□□30B□3-20P2 76.4 99.15 High
MS6H-60CN30B□3-20P2-S 66.7 93.5 inertia
MS6S-60□□30B□3-20P4 98.4 121.15 Low
MS6S-60CN30B□3-20P4-S 88.7 115.5 inertia
MS6H-60□□30B□3-20P4 98.4 121.15 High
MS6H-60CN30B□3-20P4-S 80.2 106.95 inertia
80 series motor installation dimensions Unit: mm
4-Ø6.50
0.06 A
49.3
48.8
0.02 A
70h7
19h6
25
10
A
6N9
深 1
M5
Ø90
3
35 8
15.5 0.04 A
LA 80
LA±1 Inertia
Motor model With
Normal level
brake
MS6S-80□□30B□3-20P7 107.1 132.1 Low
MS6S-80CN30B□3-20P7-S 95 126.9 inertia
MS6H-80□□30B□3-20P7 107.1 132.1 High
MS6H-80CN30B□3-20P7-S 89.2 121.1 inertia
Low
MS6S-80□□30B□3-21P0 117.6 142.6
inertia
MS6H-80□□30B□3-21P0 134 159 High
MS6H-80CN30B□3-21P0-S 112.5 144.4 inertia
4-∅9
110.9 ∅145
A-A 1
1.5 : 1 A
M6 - 6H 12
Ø110h7
Ø22h6
5 15
8N9
A
40
5
0 12
18-0.1 55±0.5 LA □ 130
LA±1
Motor model With Inertia level
Normal
brake
MS6G-130CN25B□2-□1P0 119.5 148.5
MS6G-130CN20B□2-□1P5 133.5 162.5
MS6G-130CN15B□2-□1P5 151.5 180.5
MS6G-130CN15E□2-□2P3 181.5 210.5
Medium
MS6G-130TH15B□2-□0P8 150 179
inertia
MS6G-130TH25B□2-□1P0 136 165
MS6G-130TH20B□2-□1P5 150 179
MS6G-130TH15B□2-□1P5 168 197
MS6G-130TH15E□2-□2P3 198 227
0.1 A
4-∅9
110.9
A-A
2 : 1 15 ∅145
深 A1
56.5
0.025
M6
Ø110h7
Ø24h6
8N9
A A
40
5 12
20 0.06 A 55 LA 130
LA±1
Motor model Inertia level
Normal With brake
MS6G-130CN15B□2-□2P3 181.5 210.5 Medium
MS6G-130TH15B□2-□2P3 198 227 inertia
4-
∅1
0
3
20
.5
0.1 A
147.9
∅
0.08 A
90.15
Ø114.3h7
0.03 A
Ø35h6
M12深
10N9
16 A
65
3
79 20 LA
30 □180
LA±1
Motor model With Inertia level
Normal
brake
MS6H-180CN15B□2-43P0 215 255
High inertia
MS6H-180CN15B□2-44P4 247 287
4-
∅1
00
3
∅2
.5
0.1 A
147.9
0.08 A
90.15
M1
Ø114.3h7
6深
0.03 A
12N9
Ø42h6
32
A 96
3
37 19
113 LA □180
LA±1
Motor model With Inertia level
Normal
brake
MS6H-180CN15B□2-45P5 269 309
High inertia
MS6H-180CN15B□2-47P5 325 365
4-∅13.
0
0.1 A
20
5
∅
147.9
0.08 A
90.15
0.03 A
Ø114.3h7
16
Ø35h6
深
N9
2
M1
10
A
65
3
30 79 20 LA
□180
LA±1
Motor model With Inertia level
Normal
brake
MS6H-180CN15E□2-45P5 269 309
High inertia
MS6H-180CN15E□2-47P5 325 365
∅200
4-∅14
130.9
74.13
114.30h
35h6
M12深16
66
10N9
3
30 19
79 LA
o180
LA±1
Motor model With Inertia level
Normal
brake
MS6G-180CN15B□2-43P0 162 206.5
MS6G-180CN15B□2-44P4 185 229.5 Medium
MS6G-180TH15B□2-43P0 176.5 221 inertia
MS6G-180TH15B□2-44P4 199.5 244
0.1 A ∅200
4-∅14
130.9
74.13
0.03 A
Ø114.30h7
Ø42h6
A-A
1 : 1
M12深16
12N9
A 96
0.08 A
3 19
37 113 LA 180
A
LA±1
Motor model With Inertia level
Normal
brake
MS6G-180CN15B□2-45P5 208 252.5
MS6G-180CN15B□2-47P5 256 300.5 Medium
MS6G-180TH15B□2-45P5 222.5 267 inertia
MS6G-180TH15B□2-47P5 270.5 315
3 Servo system wiring
The recommended wiring for each interface of the servo drive is shown in the table below:
Power supply wire- UVW power Ground cable Encoder
Driver model
diameter mm² cable-diameter mm² -diameter mm² cable-dimeter mm²
100W 2.0 0.3 0.3 0.2 (6 cores)
200~ 750W 2.0 0.5 0.5 0.2 (6 cores)
1 ~ 2.6kW 2.0 1.5 1.5 0.2 (6 cores)
3kW 2.0 2.0 2.0 0.2 (6 cores)
5.5~7.5kW 6.0 6.0 2.5 0.2 (6 cores)
15kW 6.0 6.0 2.5 0.2 (8 cores)
Please do not pass the power cable and signal cable through the same pipeline, and do not
tie them together. When wiring, please keep the power cable and signal cable at least
30cm apart.
For signal cables and encoder (PG) feedback cables, please use multi stranded wires and
multi-core twisted overall shielded wires.
For the wiring length, the maximum length of the instruction input cable is 3m, and the
maximum length of the PG feedback cable is 20m.
Even if the power supply to the driver is disconnected and the panel displays OFF, the
internal capacitance of the servo unit will still be stuck with high voltage. Please do not
touch the power terminal temporarily (within 10 minutes).
Do not frequently turn on or off the power supply of the driver. When it is necessary to
repeatedly switch on and off the power supply continuously, it is necessary to ensure that
the power switch frequency is greater than 2 minutes per time. The servo drive has a large
capacitor inside, so when the power is turned on, the internal circuit of the drive will flow
a large charging current (charging time of 0.2 seconds). Therefore, if the power supply is
frequently switched on and off, it will cause a decrease in the performance of the main
circuit components inside the servo drive, affecting the service life of the drive.
3.1 Main circuit terminal
DS5C2-20P1/20P4-PTA
L
According to the order from top to bottom, the main circuit terminal functions are as follows:
N Terminal Function Explanation
· Main circuit power
L, N Single phase AC200~240V, 50/60Hz
P+ input terminal
C ● Empty terminal -
Connect the braking resistor to the P+ and C
U Use external braking
P+, C terminals;
V resistor
P0-25=power value, P0-26=resistance value
W
Motor connection
U, V, W, PE Connect to the motor
PE terminal
DS5C2-20P7-PTA
According to the order from top to bottom, the main circuit terminal functions are as follows:
L Terminal Function Explanation
N Main circuit power
L, N Single phase AC200~240V, 50/60Hz
· input terminal
P+ ● Empty terminal -
D Use built-in braking Short circuit P+ and D terminals,
C resistor disconnect P+ and C.
· Connect the braking resistor to the P+ and
U P+, D, C C terminals, and remove the P+ and D
Use external braking
V short circuits;
resistor
W P0-25=power value, P0-26=resistance
PE value
● Empty terminal -
Motor connection
U, V, W, PE Connect to the motor
terminal
DS5C2-21P0/21P5/22P3/22P6-PTA
According to the order from top to bottom, the main circuit terminal functions are as follows:
Terminal Function Explanation
Single phase/three-phase AC200~240V,
50/60Hz
Main circuit power input
L1, L2, L3 (If single-phase power supply, please
terminal
connect L1/L3, otherwise power failure will
affect parameter memory)
Use built-in braking Short circuit P+ and D terminals, disconnect
resistor P+ and C.
Connect the braking resistor to the P+ and C
P+, D, C
Use external braking terminals, and remove the P+ and D short
resistor circuits;
P0-25=power value, P0-26=resistance value
Real time voltage of the busbar can be
P+, P- Bus terminal
measured, please be aware of the danger
Motor connection
U, V, W, PE Connect to the motor
terminal
The ground wire is on the heat sink. Please
Grounding terminal confirm good grounding before powering
on
DS5C2-41P0/41P5/42P3/43P0-PTA
According to the order from top to bottom, the main circuit terminal functions are as follows:
Terminal Function Explanation
Main circuit power
R, S, T Three-phase AC380~440V, 50/60Hz
input terminal
Use built-in braking Short circuit P+ and D terminals, disconnect P+
resistor and C.
P+, D, C Connect the braking resistor to the P+ and C
Use external braking
terminals, and remove the P+ and D short circuits;
resistor
P0-25=power value, P0-26=resistance value
Real time voltage of the busbar can be measured,
P+, P- Bus terminal
please be aware of the danger
Motor connection
U, V, W, PE Connect to the motor
terminal
The ground wire is on the heat sink. Please confirm
Grounding terminal
good grounding before powering on
DS5C2-45P5/47P5-PTA
According to the order from top to bottom, the main circuit terminal functions are as follows:
Terminal Function Explanation
Main circuit power
R, S, T Three-phase AC380~440V, 50/60Hz
input terminal
Short circuit P+ and D terminals, disconnect P+
Use built-in braking
and C. (This model does not have built-in braking
resistor
resistor)
P+, D, C
Connect the braking resistor to the P+ and C
Use external braking
terminals, and remove the P+ and D short circuits;
resistor
P0-25=power value, P0-26=resistance value
Real time voltage of the busbar can be measured,
P+, P- Bus terminal
please be aware of the danger
Motor connection
U, V, W, PE Connect to the motor
terminal
The ground wire is on the heat sink. Please confirm
Grounding terminal
good grounding before powering on
DS5C2-415P0-PTA
According to the order from top to bottom, the main circuit terminal functions are as follows:
Terminal Function Explanation
Main circuit power
R, S, T Three-phase AC380~440V, 50/60Hz
input terminal
Use external braking When using an external braking resistor, connect
P+, PB
resistor the braking resistor to the P+ and PB terminals
Real time voltage of the busbar can be measured,
P+, P- Bus terminal
please be aware of the danger
Motor connection
U, V, W Connect to the motor
terminal
Perform grounding treatment, please confirm good
PE Grounding terminal
grounding before powering on
3.1.3 CN0, CN1, CN2, CN3 terminal description
15kW
RS232 communication is full duplex communication, and the TXD (pin number 1) of the driver 232
communication port needs to be connected to the RX pin of USB to serial convertor. The RXD (pin number 2) of
the port needs to be connected to the TX pin of USB to serial convertor.
RS232 port default communication parameters: baud rate 19200bps, data bit is 8-bit, stop bit is 1-bit, even parity.
Suggest to use 115200 communication speed, internal hardware supports up to 250kHz, supports hot swapping.
Modbus station No.
Parameter Function Default setting Range Modify Effective
P7-10 Modbus station no. 1 1~255 Servo OFF At once
3.1.3.5 CN5 terminal
The terminal arrangement of the CN5 port of the driver is as follows (facing the driver), with a safe torque
shutdown STO, only supported on models with the suffix - FS:
In order to make the debugging process more user-friendly, the power supply voltage (2: 24V) pin has been added.
If the STO function is not required, please connect the STO1 and STO2 terminals to the 24V terminal.
The maximum allowed cable length between the driver and the safety switch is 30m.
3.2 Signal terminal
Please use a relay or an open collector transistor circuit to connect. When using relay connection, please select the
relay for small current. If the relay is not small current, it will cause bad contact.
Type Input terminal Function
Digital input SI1~SI5 Multifunctional input signal terminal
COM2 COM2
COM2 COM2
+24VV
+24 +24V
+24V +24
+24 VV +24V
+24V
++ ++
0V
0V SI
SI 0V0V SI SI
R=3.3K Ω
R=3.3K R=3.3K
R=3.3K
ΩΩ
Y2
Y2 Y2Y2
COM2
COM2 COM2
COM2
SI1 and SI2 of 750W and below drivers are high-speed SI inputs, SI3 is low-speed, and
only supports NPN connection;
The SI1 and SI2 channels of the 1~7.5kW driver are high-speed SI inputs with a response
speed of less than or equal to 2μs, and only support NPN connection; SI3, SI4, and SI5
are low-speed SI inputs with a response time of less than or equal to 2ms. They support
both NPN and PNP connections (SI1 to SI5 can only be NPN or PNP at the same time);
Typical voltage DC24V, minimum not lower than DC18V, maximum allowable voltage
not higher than DC28V.
+24 VV
+24 +24V
+24V +24 VV
+24 +24V
+24V
++ ++
0V0V SISI 0V0V SISI
R=3.3K
R=3.3KΩΩ R=3.3K
R=3.3KΩΩ
Y2Y2 Y2Y2
COM2
COM2 COM2
COM2
+24VV
+24 +24V
+24V +24V +24V
++ +
00VV SI
SI 0V SI
R=3.3k
R=3.3k
ΩΩ R=3.3kΩ
Y2
Y2 Y2
COM2
COM2 COM2
A 15kW driver with three low-speed SI inputs of SI1, SI2, and SI3, with a response
time of less than or equal to 2ms, supporting NPN and PNP connections; SI4 and SI5
are high-speed SI inputs with a response speed of less than or equal to 2μs, and only
support NPN connection;
Typical voltage DC24V, minimum not lower than DC18V, maximum allowable
voltage not higher than DC28V.
Optocoupler type (7.5kw and below) Relay type (7.5kw and below)
Servo driver upper device Servo driver upper device
+24V +24V
SO X3 SO X3
0V 0V
0V 0V 0V 0V
SO1, SO2, and SO3 of 7.5kW and below driver only support NPN connection;
15kW drive SO1, SO2, SO3, SO4 with + and - markings, SO1-, SO2-, SO3-, SO4- can be
connected together when using a common COM;
Maximum load current:
400W and below:
SO1 DC 500mA (maximum), SO (other) DC 50mA (maximum), the current required by
the brake is relatively high. When directly controlling the brake motor through SO, please
use the SO1 terminal control and set the holding parameter P5-44=n.0001;
750W and above:
SO (all) DC 50mA (maximum), supporting 24VDC, with a maximum of 30VDC. The
required current for the brake is relatively high. When controlling the brake motor
through SO, please use an intermediate relay.
4 Panel operation
4.1 Basic operation
Button Operation
STA/ESC Short press: state switch, state return
By switching the basic state of the panel operator, it can display the running state, set parameters, run auxiliary
functions and alarm state. After pressing the STA/ESC key, the states are switched in the order shown in the
following figure.
State: BB indicates that the servo system is idle; run indicates that the servo system is running; RST indicates that
the servo system needs to be re-energized.
Parametric setting PX-XX: The first X represents the group number, and the last two X represents the
parameter serial number under the group.
Monitor status UX-XX: The first X represents the group number, and the last two X represents the
parameter number under the group.
Auxiliary function FX-XX: The first X represents the group number, and the last two X represents the
parameter number under the group.
Alarm state E-XX□: The first two X represents the alarm category, and the last □ represents the small
category under the category.
Function Function
code Explanation code Explanation
Panel external command auto
F0-00 Clear the alarm F0-08 tuning
Restore parameters to factory Panel internal command auto
F0-01 settings F0-09 tuning
F0-02 Clear position deviation F0-10 Panel vibration suppression 1
F0-04 Clear historical alarm records F0-11 Panel vibration suppression 2
Panel vibration suppression (fast
F0-07 Panel inertia identification F0-12 FFT)
4.4.2 F1-XX
Code Note
F1-00 Jog run
F1-01 Test run
F1-02 Current sampling zero-correction
F1-05 Software enable
F1-06 Reset turns of absolute encoder
1. Jog run(F1-00)
Before entering jog mode, please confirm that the motor shaft is not connected to the machine and the driver is in
bb idle status! The jog function is in speed mode, and P3-09 and P3-10 control the acceleration and deceleration
time!
Test run mainly checks the power cable and the encoder cable to determine whether the connection is
normal.According to the following operation,the motor can normally achieve forward and reverse rotation. If the
motor shaft shakes or driver alarms, please immediately disconnect the power supply, and re-check the wiring
situation.
3.Current sampling zero-correction(F1-02)
When the servo driver is updated or the motor runs unsteadily after a long time, it is recommended that the user
automatically adjust the current detection offset, and carry out the following operations when the driver is bb idle.
Note: When an alarm occurs, the cause of the alarm should be eliminated first, and then the alarm should be
released.
4.6Parameter example
Provide an example of the operation steps for changing the content of parameter P3-09 from 2000 to 3000.
Step Panel display Buttons Operation
When the set parameters exceed the range that can be set, the driver will not accept the set
value and will report E-021 (parameter setting exceeded). Parameter setting exceeding the
limit usually occurs when the upper computer writes parameters to the driver through
communication.
(3) Take out the old battery, install the new one.
(4) Close the cover of the battery unit
(5) After replacing the battery, in order to remove the "Encoder Battery Alarm (E-222)" display, please do clear
alarm twice (F0-00=1). (3770 version and above only need to be cleared once.)
(6) Connect the power supply of the servo unit again;
(7) Make sure the error display disappears and the servo unit can operate normally.
Because it can only rotate in one direction, after a certain period of time, the number of revolving cycles will
always exceed the upper limit of absolute value encoder.
Resolution Rotating Circle Serial
Servo motor
(single-turn Data Operation of overtime
series
data) Output range
When exceeding the upper limit value of forward
rotation direction (+32767 * 219):
Rotation serial data=32767 * 219
CN 19 -32768~32767
When below the lower limit of the reverse direction
(-32768 * 219):
Rotation serial data=-32768 * 219
Clear the absolute encoder turns through F1-06 on the servo panel.
Method 1: In the servo bb state, write 1 to # 0x4106 through EtherCAT bus communication to clear the number of
turns.
Calibrate the encoder current position as zero position through servo panel F1-06 parameter, U0-94~97 will show
the encoder position after calibration.
Note: The brake built in the servo motor is a fixed special brake without excitation. It can not be used for dynamic
braking. Please use it only when the servo motor is in a stop state.
Related parameter
Parameter Meaning Default Unit Setting range Modify Effective
setting
P5-44 Brake interlock /BK n.0000 - 0~ffff Servo bb At once
P5-07 Servo OFF delay time 500 1ms -500~9999 Servo bb At once
P5-08 Brake command output speed 30 rpm 20~10000 Servo bb At once
P5-09 Brake command waiting time 500 ms 0~65535 Servo bb At once
1. Hardware wiring
The ON/OFF circuit of the brake is composed of the sequential output signal of the servo unit "/BK" and "brake
power supply". A typical connection example is shown below.
Note:
① The excitation voltage of the power-off brake is 24V.
② If the holding brake current is more than 50mA, please transfer it through the relay to prevent terminal burnt
out due to excessive current.
Signal/BK terminal
Parameter setting Servo status Servo motor status
output logic
Servo bb Invalid Brake power off, motor in position locked state
P5-44=n.000□
Servo run Valid Brake power on, motor in rotatable state
Servo run Invalid Brake power off, motor in position locked state
P5-44=n.001□
Servo bb Valid Brake power on, motor in rotatable state
Note:
(1) When SO terminal is used to control holding brake, when servo enable is on, holding brake power is on and
motor is in rotatable state;
(2) If the motor fails to rotate during the debugging of the new machine, please confirm whether the holding brake
is open.
As the brake of the servo motor is designed for position retention, it must be activated at the appropriate time
when the motor stops. While observing the mechanical movements, adjust the user parameters.
4. Brake connection
When the drive power is 400W and below, it can be directly connected through SO terminal, as shown in the
figure below., and set P5-44=0001.
When controlling the holding brake motor through SO for 400W and below, please use the SO1 terminal control
and set the holding brake parameter P5-44=n.0001 to prevent the terminal from being burnt out due to excessive
current or the brake from being worn out due to inability to open.
When the power of the driver is 750W and above, it needs to be connected through the intermediate relay. The
connection method is as follows. Set parameter P5-44=0001.
For motors with a current of 750W or above, if the holding brake current is greater than 50mA, please use a relay
to prevent the terminal from being burned due to excessive current, or the holding brake from being worn out due
to inability to open.
Note: it is recommended that SO terminal and intermediate relay do not share the same switching power supply.
5. When the holding brake slightly drops after power failure, the following solutions can be adopted:
① Appropriately reduce p5-07
② Directly set p0-69.2 to 1
According to the different scenarios of servo shutdown, it can be divided into servo OFF shutdown, alarm
shutdown, and overtravel shutdown.
Currently, only the 0.1kW~7.5kW models of DS5C2 support dynamic braking (DB) function.
5.3.1 Servo OFF and alarm shutdown
Related parameters
Default
Parameter Meaning Unit Range Modify Effective
setting
P0-30 Stop timeout time 20000 1ms 0~65535 Servo bb At once
Servo turn off enable
P0-27 0 - 0~5 Servo bb At once
shutdown mode
P0-29 Alarm shutdown mode 2 - 0~5 Servo bb At once
Note:
1. servo turn off enable shutdown mode (P0-27)
① When P0-27=0, if the servo OFF occurs, the motor starts to rely on free stop without any alarm.
② When P0-27=1, if the servo OFF occurs, the motor starts to rely on free stop and maintains the DB state after
stopping.
③ When P0-27=2, if the servo OFF occurs, the motor starts to rely on deceleration to stop, until the speed is less
than 50rpm before turning to free stop. At the same time, the servo will time the deceleration stop stage. If the
timing time has exceeded P0-30 and the motor speed has not dropped below 50rpm during the deceleration
process, an alarm E-262 will show.
④ When P0-27=3, if the servo OFF occurs, the motor starts to rely on deceleration to stop, until the speed is less
than 50rpm before turning to free stop. At the same time, the servo will time the deceleration stop stage. If the
timing time has exceeded P0-30 and the motor speed has not dropped below 50rpm during the deceleration
process, an alarm E-262 will show. Maintain DB status after stopping.
⑤ When P0-27=4, if the servo OFF occurs, the motor DB stops and remains in a free running state after stopping.
⑥ When P0-27=5, if servo OFF occurs, the motor DB stops and maintains the DB state after stopping.
1. Servo alarm shutdown mode (P0-29)
(1) Turn off enable property alarm
When P0-29=0, if a servo alarm occurs, the motor starts to rely on free stop.
When P0-29=1, if a servo alarm occurs, the motor starts to rely on free stop and remains in DB state after
stopping.
When P0-29=2, if a servo alarm occurs, the motor DB stops and remains in a free running state after stopping.
When P0-29=3, if a servo alarm occurs, the motor DB stops and maintains the DB state after stopping.
When P0-29=4, the motor DB stops and remains in a free running state after stopping.
When P0-29=5, if a servo alarm occurs, the motor DB stops and maintains the DB state after stopping.
(2) Not turn off enable property alarm
When P0-29=0, if a servo alarm occurs, the motor starts to stop freely.
When P0-29=1, if a servo alarm occurs, the motor starts to stop freely and remains in DB state after stopping.
When P0-29=2, if a servo alarm occurs, the motor starts to rely on deceleration to stop, until the speed is less than
50rpm before turning to a free stop. At the same time, the servo will time the deceleration stop stage. If the timing
time exceeds P0-30 during the deceleration process, the servo will directly stop freely. At this time, due to the
servo being in an alarm state, regardless of the value of P0-29, there will be no alarm E-262. Maintain free
running status after stopping.
When P0-29=3, if a servo alarm occurs, the motor starts to rely on deceleration to stop, until the speed is less than
50rpm before turning to a free stop. At the same time, the servo will time the deceleration stop stage. If the timing
time exceeds P0-30 during the deceleration process, the servo will directly stop freely. At this time, due to the
servo being in an alarm state, regardless of the value of P0-29, there will be no alarm E-262. Maintain DB status
after stopping.
When P0-29=4, if a servo alarm occurs, the motor DB stops and remains in a free running state after stopping.
When P0-29=5, if a servo alarm occurs, the motor DB stops and maintains the DB state after stopping.
(3) The servo drive SO terminal has been assigned a holding brake function, and the values set in
P0-27/P0-29 are invalid. They all stop in a deceleration manner.
Dynamic braking (DB) timing diagram (dynamic braking low-level indicates effective).
Power on Enable
DB stop
5.3.2 Stop mode when overtravel in normal mode
The overtravel prevention function of servo unit refers to the safety function that the servo motor is forced to stop
by inputting the signal of limit switch when the movable part of the machine exceeds the designed safe moving
range.
Related parameter
Default Setting
parameter Meaning Unit Modify Effective
setting range
Servo override stop
P0-28 2 - 0~3 Servo bb At once
mode
P0-30 Stop timeout 20000 1ms 0~65535 Servo bb At once
Forward run Anytime
P5-22 n.0001 - 0~ff At once
prohibition /P-OT
Reverse run Anytime
P5-23 n.0002 - 0~ff At once
prohibition /N-OT
Be sure to connect the limit switch as shown in the figure below.
Rotary applications such as round tables and conveyors do not need the function of overrun prevention. At this
time, there is no need to connect the overrun prevention with input signals.
Signal /POT, terminal input Overtravel signal (/POT, /NOT) terminal
Parameter setting
status logic
No need to connect
P5-22/P5-23=n.0000
external input
SI□ terminal has no signal
P5-22/P5-23=n.000□ invalid
input
SI□ terminal has signal
P5-22/P5-23=n.001□
input
No need to connect
P5-22/P5-23=n.0010
external input
SI□ terminal has signal
P5-22/P5-23=n.000□ valid
input
SI□ terminal has no signal
P5-22/P5-23=n.001□
input
Parameter settings in forward limit signal /POT and reverse limit signal /NOT can not be set to the same terminal
input at the same time.
Direction Meet the limit Operation status
Forward positive limit is valid POT, set the servo overrun stop mode as P0-28
run negative limit is valid Alarm E-261
Reverse positive limit is valid Alarm E-261
run negative limit is valid NOT, set the servo overrun stop mode as P0-28
In the bus control modes PP, CSP, PV, CSV, TQ, and CST, according to the P0-28 setting value, when
encountering POT and NOT signals, the servo has different processing methods.
Default Setting
Parameter Meaning Unit Modify Effective
setting range
0: Direct alarm, using servo
deceleration shutdown method
1: Alarm triggered after deceleration 1|3|4|8|9|
P0-28.0 2 - 0~3 ○
and shutdown in 605Ah mode 10
2: Not using overtravel, controlled
by the master station
Scenario 2: When the servo is in an enabled or disabled state and touches the forward limit switch, the panel will
display POT, cancel the forward limit signal, and the panel will return to its previous state.
Scenario 3: When the servo is in an enabled or disabled state and simultaneously touches the forward and reverse
limit switches, the servo will report E-261. If two limit signals are cancelled, the panel will return to its previous
state; If any limit signal is cancelled, the panel will display another limit signal, which needs to be cancelled
before the panel can return to its previous state.
Scenario 2: In the case of offside, touch the forward limit switch before the axis deceleration stop is completed.
The initial direction of movement is left. When touching the rising edge of the reverse limit switch, the panel
display changes from RUN to NOT, triggering the reverse overtravel deceleration stop. However, the axis crosses
the reverse limit switch and triggers the falling edge of the reverse limit switch. Before the shaft stops, if the
forward limit switch is touched, the servo will report E-261. The forward limit switch must be cancelled in order
to clear the E-261 alarm. Otherwise, the alarm cannot be cleared. Then, the shaft moves forward and touches the
rising and falling edges of the reverse limit switch again. Only then can the panel display change from NOT to
RUN, and the reverse overtravel prohibition be released.
Scenario 3: In the case of offside, when the shaft stops, touch the forward limit switch.
The initial direction of movement is left. When touching the rising edge of the reverse limit switch, the panel
display changes from RUN to NOT, triggering the reverse overtravel deceleration stop. However, the axis crosses
the reverse limit switch and triggers the falling edge of the reverse limit switch. When the shaft stops, the servo
will report E-260. At this time, if the forward limit switch is touched, the servo will report E-261. The forward
limit switch must be cancelled before the E-261 alarm can be cleared. Otherwise, the alarm cannot be cleared.
Then, the shaft will move forward and touch the rising and falling edges of the reverse limit switch again. Only
then can the panel display change from NOT to RUN, and the reverse overtravel prohibition be released.
Scenario 4: In the case of offside, touching the forward limit switch during axial forward movement.
The initial direction of movement is left. When touching the rising edge of the reverse limit switch, the panel
display changes from RUN to NOT, triggering the reverse overtravel deceleration stop. However, the axis crosses
the reverse limit switch and triggers the falling edge of the reverse limit switch. When the shaft stops, the servo
will report E-260. After clearing the alarm to move the shaft forward, if the forward limit switch is touched, the
servo will report E-261. The forward limit switch must be cancelled before the E-261 alarm can be cleared.
Otherwise, the alarm cannot be cleared. Continue to move the shaft forward, touch the rising and falling edges of
the reverse limit switch again, and the panel display can change from NOT to RUN to release the reverse
overtravel prohibition.
1. Overview
The so-called "electronic gear" function has two main applications:
(1) Determine the number of command pulses needed to rotate the motor for one revolution to ensure that the
motor speed can reach the required speed.
As an example of 19-bit encoder motor, the pulse frequency sent by the upper computer PLC is 200kHz:
Pulses per revolution set to 10000 Set pulses per revolution to 5000
Electronic gear ratio set to 524288:10000 Electronic gear ratio set to 524288:5000
(2) In the precise positioning, the physical unit length corresponding to 1 command pulse is set for calculation.
For example: the object moves 1um per command pulse. The command pulses of load rotating one circle = 6mm /
1um = 6000. In the case of deceleration ratio is 1:1, set pulse per rotation P0-11=6000, P0-12=0. Then if the PLC
outputs 6000 pulses, the object will move 6mm.
Encoder: 524288 (19-bit) ball screw pitch: 6mm
Do not change the electronic gear ratio Change the electronic gear ratio
Without changing the ratio of the electronic By changing the electronic gear ratio, the
gear to the motor, the rotating cycle is motor needs 6000 pulses to rotate one circle.
524288 pulses (P 0-11=0, P 0-12=0). If the If the workpiece moves 6 mm in one turn, the
workpiece is moved 6 mm in one turn, the number of pulses needed is 6 000. If the
number of pulses needed is 524288. If the workpiece is moved 10 mm, it needs
workpiece is moved 10 mm, it will need 10/6*6000 = 10000 pulses. When the pulse is
10/6*524288=873813.333 pulses. When the sent, the decimal number will not be produced
decimal number is omitted, the error will and the error will not be produced.
occur.
Related parameters
Default Setting
Parameter Meaning Unit Modify Effective
setting range
P0-11 Pulse numbers per rotation *1 0 pul 0~9999 Servo At once
OFF
P0-12 Pulse numbers per rotation *10000 0 pul 0~9999 Servo At once
OFF
P0-13 Electronic gear ratio (numerator) 1 - 0~65535 √ At once
Note:
(1) P0-11~P0-14 is all about the parameters of electronic gear ratio, P0-11, P0-12 is group 1, P0-13, P0-14 is
group 2, but the priority of P0-11 and P0-12 is higher than that of P0-13 and P0-14. Only when P0-11 and P0-12
are set to 0, the ratio of electronic gear P0-13 and P0-14 will take effect.
(2) When P0-11, P0-12, P0-13 and P0-14 are all set to 0, P0-92, P0-93, P0-94 and P0-95 will take effect.
2. Calculation of Pulse Number per Rotation and Electronic Gear Ratio
Steps Content Description
Confirm the machine Confirm the deceleration ratio n:m(servo motor turns m
1 specification rotations while load turns n rotations), ball screw distance,
pulley diameter.
2 Confirm the encoder pulse Confirm the servo motor encoder accuracy
Set the command unit Determine the actual distance or angle corresponding to 1
3
pulse of the controller
Calculate the command pulses Based on the determined command unit, calculate the
4
the load shaft rotates 1 circle command quantity n of the load shaft rotating for 1 revolution.
Calculate the pulses per Command pulse number of motor shaft rotating for 1 turn
5
rotation M M=N/(m/n).
Set the pulses per rotation P0-11=M%10000 priority
(P0-11/P0-12) or P0-12=M/10000
6
Electronic gear ratio encoder encoder
P 0 13 resolution resolution m
(P0-13/P0-14)/(P0-92~95) P 0 14
M
N n
Note:
(1) In step 6, the effective priority of the number of pulses per revolution is higher than the electronic gear ratio,
that is, when P0-11 ~ P0-12 are all 0, P0-13 ~ P0-14 will take effect. In special cases, if the number of pulses per
revolution is calculated as a decimal, the electronic gear ratio should be considered.
(2) When P0-13 and P0-14 exceed the setting range, please divide the electronic gear ratio into numerator and
denominator. If the ratio still exceeds the parameter setting range, please use the second gear ratio P0-92~P0-95.
Only when P0-11~14 = 0, the second gear ratio takes effect.
(3) The resolution of DS5C2 series servo motor encoder is 524288 (19 bits).
(4) The command unit does not represent the machining accuracy. On the basis of the mechanical accuracy,
refining the instruction unit quantity can improve the positioning accuracy of the servo system. For example,
when using the lead screw, the mechanical accuracy can reach 0.01mm, so the unit equivalent of 0.01mm is more
accurate than the unit equivalent of 0.1mm.
3. Example of setting the electronic gear ratio
Ball screw Round table Belt + pulley
Load shaft
P Load shaft
If the absolute
deviation is below
0 P5-00, the COIN
signal will be
output.
After the
instruction is
finished, the
1
deviation is below
P5-00 and COIN
signal is output.
When the
instruction ends
and the motor
speed is under the
rotation detection
2 speed (P5-03) and
the absolute
deviation is less
than P5-00, the
COIN signal is
output.
At the end of
instruction, the
absolute deviation
value under P5-00,
3 it outputs COIN
signal. If COIN
maintains P5-02
time, COIN-HOLD
signal is output.
2. Description of positioning completion width
(1) The positioning completion width P5-00 changes proportionally due to the change of electronic gear ratio, and
the factory default is 11 command units.
The following table is an example:
Number of The positioning completion width P5-00 changes
command pulses positioning completion proportionally with the number of command pulses
required for one width P5-00 required for one revolution of the motor.
revolution of motor The output of the positioning completion signal
10000 (default) 11 (default) depends on the positioning completion width. The
20000 22 smaller the width is, the later the positioning
5000 6 completion signal output is, but the signal output
3000 4 does not affect the actual operation state of the
2000 3 motor.
(2) The positioning completion width can also be set separately, and its change will not affect the number of
command pulses required for one revolution of the motor.
The servo motor is located near the positioning completion signal, so that the equipment can prepare the next
action in advance.
Related parameters
Default
Parameter Meaning Unit Range Change Effective
setting
Near signal output Command
P5-06 50 0~65535 Anytime At once
width unit
(2) The approach signal output width can also be set independently, and its change will not affect the number of
command pulses required for one revolution of the motor.
(3) Please set this parameter larger than the positioning completion width.
Position command prohibition, including internal and external position commands. Stop the function of command
pulse input during position control. When the /INHIBIT signal is on, the pulse command is no longer counted.
Related parameters
Signal Default Suitable
Parameter Meaning Modify Effective
name setting mode
P5-32 /INHIBIT n.0000 5|6 Command pulse prohibition Anytime At once
Parameter range n.0000-001A, assigned to other input terminals by parameter P5-32.
If it is necessary to input from SI2, P5-32 can be set to n.0002/0012. Refer to section 3.2.2 for hardware
wiring details.
When the deviation pulse limit is 0, the deviation pulse will not be detected.
Signal setting
Parameter Signal Default Meaning Modify
Mode 3: internal speed Range: 0000-0014, distributes
selecting signal to input terminal through P5-28.
P5-28 /SPD-A n.0000 When it set to 0001, it means
Mode 5: find origin point at input signal from SI1.
forward direction
Mode 3: internal speed Range: 0000-0014, distributes
selecting signal to input terminal through P5-29.
P5-29 /SPD-B n.0000 When it set to 0001, it means
Mode 5: find origin point at
input signal from SI1.
reverse direction
Related parameter setting:
Default
Parameter Meaning Unit Range Change Effective
setting
P4-00 Z phase signal Servo
2 - 0~f At once
n.xxx□ numbers OFF
The speed hitting At once
Servo
P4-01 the proximity 600 rpm 0~65535
OFF
switch
The speed leaving At once
Servo
P4-02 the proximity 100 rpm 0~65535
OFF
switch
Note: The origin finding function is only applicable to single turn absolute value motors (multi-turn
absolute value motors P0-79=1 can also support the origin finding function)
/P-OT /N-OT
/Z
③
V
P4-01 P4-00
t
P4-02
Steps:
(1) Install limit switch at forward and reverse side. At the rising edge of /SPD-A, motor runs forward at the speed
of P4-01 to find the reference origin on forward side.
(2) After the working table hit the limit switch, the motor stop as the mode set by parameter P0-28
(3) Motor leaves the limit switch at the speed of P4-02. After the working table left the limit switch, the motor run
at the Z phase signal position of No.n optical encoder. This position is considered as the coordinates origin, n is
decided by parameter P4-00.
5.4.1.9 Homing function
1. Function overview
The return to origin function refers to that when the servo enable is on in the position control mode, after the
return to origin function is triggered, the servo motor will find the origin and complete the positioning function.
The found origin can be used as the position reference point for subsequent position control.
During the homing operation, other position commands (including the retriggered homing signal) are shielded.
After the homing is completed, the servo driver can respond to other position commands.
After the homing is completed, the servo driver outputs the homing completion signal, and the upper computer
can confirm that the homing has been completed after receiving the signal.
1. Parameter setting
Set
Parameter Name Range Meaning Effective Default
time
P9-11.0=0: not find Z phase
Z phase P9-11.0=1: find one Z phase Servo Servo
P9-11.0 0~F 0
numbers P9-11.0=2: find two Z phases OFF ON
And so on
P9-11.1=0: not trigger homing
Homing
P9-11.1=1: trigger homing through SI terminal Servo Servo
P9-11.1 trigger 0~2 0
(P5-28) OFF ON
mode
P9-11.1=2: trigger homing after enabling
P9-11.2=0: homing mode 0
Homing P9-11.2=1: homing mode 1 Servo Servo
P9-11.2 0~7 0
mode P9-11.2=2: homing mode 2 OFF ON
And so on
Deceleration
mode when
P9-11.3=0: decelerate as the setting of P9-14 Servo Servo
P9-11.3 meeting the 0, 1 0
P9-11.3=1: decelerate at once OFF ON
overlimit
signal
Note: P9-11.0 can set up to 15 Z phases. P9-11.1 = 0 means that the homing function cannot be used. This
parameter can be understood as the enabling bit of the homing function. Homing modes 1, 3, 5 and 7 are the
opposite situation of homing modes 0, 2, 4 and 6 respectively.
Set Default
Parameter Name Range Unit Meaning Effective
time value
Return to the origin at high
Homing speed, find the deceleration Servo
P9-12 0~3000 rpm Servo ON 200
high speed point and execute the OFF
mechanical offset
Homing with low speed.
This low speed should be
Homing Servo
P9-13 0~1000 rpm low enough not to cause Servo ON 20
low speed OFF
mechanical shock when
stopping
The acceleration and
Homing
deceleration time here refers Servo
P9-14 acc/dec 0~1000 ms Servo ON 1000
to the time required for 0 to OFF
time
1000 rpm
If the time spent in the whole
Maximum process of homing exceeds
time the time set by this
Servo
P9-15 allowed to 0~12000 10ms parameter, an alarm will be Servo ON 0
OFF
return to given. When P9-15 = 0, the
the origin timeout alarm will be
shielded
Touch stop
This parameter is only
mode Servo
P9-16 0~1000 rpm available for home mode 6 Servo ON 2
homing OFF
and 7
speed
Set Default
Parameter Name Range Unit Meaning Effective
time value
threshold
Touch stop This parameter is only
mode available for home mode 6
Servo
P9-17 homing 0~300% % and 7 Servo ON 100%
OFF
torque The base value of the
threshold percentage is the rated torque
Touch stop
mode This parameter is only
Servo
P9-18 homing 10~1500 ms available for home mode 6 Servo ON 500
OFF
time and 7
threshold
Quantitativ
Servo
P9-19 e pulses -9999~9999 - Quantitative pulses low bit Servo ON 0
OFF
low bit
Quantitativ
Servo
P9-20 e pulses -9999~9999 - Quantitative pulses high bit Servo ON 0
OFF
high bit
New/old P9-21=0: old homing
homing function Servo Power on
P9-21 0, 1 - 0
function P9-21=1: new homing OFF again
selection function
When the homing is about to
end, this filtering time is
required. Wait until the
New motor stops completely
Servo
P9-22 homing end 50~10000 ms before completely exiting the Servo ON 500
OFF
filter time homing mode. After this
filtering time, the return to
origin completion signal will
be output.
Note: Actual mechanical offset =P9-19 + P9-20×10000 , P9-19 and P9-20 need same symbol (all positive or
negative value). The mechanical offset here is the absolute position of the servo after homing.
Parameter
Name Meaning Set time Effective Default
n.xxxx
Forward overtravel Operation Take effect
P5-22 Forward limit signal in homing mode 0
signal POT setting at once
Reverse overtravel Operation Take effect
P5-23 Reverse limit signal in homing mode 0
signal NOT setting at once
When the homing action and status are Take effect
completed, the homing completion signal will at once
be output. Even if other modes are executed
Homing completion Operation
P5-54 after the homing is completed, the homing 0
signal setting
completion signal will not disappear. When
the homing is started again, the homing
completion signal will disappear.
The origin switch signal is required in the Operation Take effect
P5-64 Homing switch signal 0
process of returning to the origin. setting at once
When P9-11.1=1, P5-28 distributed the SI Take effect
SI terminal start Operation
P5-28 terminal, the homing can be triggered by SI at once 0
homing setting
terminal.
2. New homing mode selection
To use the new homing function, first set P9-21=1, then set the overtravel switch (POT/NOT) and the origin
switch. If the mechanical offset (P9-19 and P9-20 are set), please set the offset within the travel range to ensure
that the mechanical equipment will not be damaged during the homing process!
The number of Z phases (P9-11.0) and the mechanical offset (P9-19, P9-20) can be valid at the same time. If the
number of Z phases (P9-11.0) and the mechanical offset (P9-19, P9-20) are not set to 0, the servo will find the
number of Z phases (P9-11.0) first, and then execute the mechanical offset (P9-19, P9-20). If the number of Z
phases (P9-11.0) is 0 and the mechanical offset (P9-19, P9-20) is not 0, the servo does not find the Z phase, but
executes the mechanical offset (P9-19, P9-20). If the number of Z phases is not 0 but the mechanical offset is 0,
the servo will find the Z phase (P9-11.0) without performing the mechanical offset.
There are 8 homing modes in total, as follows:
(1) Positive homing, the deceleration point is the origin switch, and the origin is the origin switch or motor Z
signal (P9-11.2 = 0)
(2) Reverse homing, the deceleration point is the origin switch, and the origin is the origin switch or motor Z
signal (P9-11.2 = 1)
(3) Positive homing, the deceleration point and origin are motor Z signal (P9-11.2 = 2)
(4) Reverse homing, the deceleration point and origin are the motor Z signal (P9-11.2 = 3)
(5) Forward homing, the deceleration point is the forward overtravel switch, and the origin is the forward
overtravel switch or motor Z signal (P9-11.2 = 4)
(6) Reverse homing, the deceleration point is the reverse overtravel switch, and the origin is the reverse overtravel
switch or motor Z signal (P9-11.2 = 5)
(7) Positive homing, the deceleration point is the mechanical limit position, and the origin is the mechanical limit
position or motor Z signal (P9-11.2 = 6)
(8) Reverse homing, the deceleration point is the mechanical limit position, and the origin is the mechanical limit
position or motor Z signal (P9-11.2 = 7)
(b) Z phase number (P9-11.0) is 0 and mechanical offset (P9-19, P9-20) is not 0:
In the operation process of continuing to search the rising edge of deceleration point (origin) signal at low speed
with P9-13 (homing low speed), stop immediately when encountering the rising edge of deceleration point (origin)
signal. After the motor is completely stopped, the motor will move a quantitative pulse (P9-19, P9-20) with speed
P9-12 (homing high speed) according to the set number of mechanical offset pulses and direction (either positive
direction or negative direction), then the motor will stop.
(c) Z phase number (P9-11.0) is 1 and mechanical offset (P9-19, P9-20) is 0:
During the operation of continuing to search the rising edge of deceleration point (origin) signal at low speed
P9-13 (homing low speed), continue to run after encountering the rising edge of deceleration point (origin) signal,
and then find the first Z-phase signal and stop immediately.
(d) Z phase number (P9-11.0) is 1 and mechanical offset (P9-19, P9-20) is not 0:
During the operation of continuing to search the rising edge of the deceleration point (origin) signal at low speed
P9-13 (homing low speed), continue to run after encountering the rising edge of the deceleration point (origin)
signal, then find the first z-phase signal and stop immediately. After the motor is completely stopped, according to
the set number of mechanical offset pulses (P9-19, P9-20) and direction (it can be positive direction or negative
direction), the motor goes through a quantitative pulses (P9-19, P9-20) at the speed set by P9-12 (homing high
speed), and then the motor stops.
(2) When the motor starts to move, the origin switch (deceleration point) signal is valid (P5-64 = 0-invalid,
1-valid), and the forward overtravel switch (P5-22) is not triggered in the whole process:
The servo motor directly searches for the falling edge of the deceleration point (origin) signal at low speed -P9-13
(homing low speed). If it encounters the falling edge of the deceleration point (origin) signal, it will reverse (i.e.
forward), and continue to search for the rising edge of the deceleration point (origin) signal at low speed with
P9-13 (homing low speed). The next homing action can be divided into four cases:
(a) Z phase number (P9-11.0) is 0 and mechanical offset (P9-19, P9-20) is 0:
In the process of forward acceleration or forward constant speed operation, stop immediately when encountering
the rising edge of deceleration point (origin) signal.
(b) Z phase number (P9-11.0) is 0 and mechanical offset (P9-19, P9-20) is not 0:
In the process of positive acceleration or positive constant speed operation, stop immediately after encountering
the rising edge of the origin signal. After the motor is completely stopped, according to the set number of
mechanical offset pulses and direction (either positive or negative direction), the motor will move a quantitative
pulse (P9-19, P9-20) at the speed set by P9-12 (homing high speed), and then the motor will stop.
(c) Z phase number (P9-11.0) is 1 and mechanical offset (P9-19, P9-20) is 0:
In the process of forward acceleration or forward constant speed operation, continue to run after encountering the
rising edge of the origin signal, and then find the first Z-phase signal and stop immediately.
(d) Z phase number (P9-11.0) is 1 and mechanical offset (P9-19, P9-20) is not 0:
In the process of positive acceleration or positive constant speed operation, continue to run after encountering the
rising edge of the origin signal, and then find the first Z-phase signal and stop immediately. After the motor is
completely stopped, the motor will run a quantitative pulse (P9-19, P9-20) at the set speed P9-12 (homing high
speed) according to the set number of mechanical offset pulses (P9-19, P9-20) and direction (either positive or
negative direction), then the motor stops.
(3) When the motor starts to move, the signal of the origin switch (deceleration point) is invalid (P5-64 =
0-invalid, 1-valid), and the forward overtravel switch (P5-22) triggered in the process is valid.
Firstly, the servo motor forward searches for the deceleration point signal at high speed P9-12 (homing high
speed). After encountering the forward overtravel switch (POT) (P5-22), the driver immediately reverse searches
for the falling edge of the deceleration point (origin) signal at the speed -P9-12 (homing high speed) according to
the value set by P9-14 (homing acceleration and deceleration time). After encountering the falling edge of the
deceleration point (origin) signal, decelerate in the reverse direction (i.e. restore the forward direction) according
to the set value of P9-14 (homing acceleration and deceleration time). The servo motor forward searches the rising
edge of the deceleration point (origin) signal at low speed of P9-13 (homing low speed). The next action back to
the origin can be divided into four cases:
(a) Z phase number (P9-11.0) is 0 and mechanical offset (P9-19, P9-20) is 0:
In the process of forward acceleration or forward constant speed operation, stop immediately when encountering
the rising edge of the origin signal.
(b) Z phase number (P9-11.0) is 0 and mechanical offset (P9-19, P9-20) is not 0:
In the process of positive acceleration or positive constant speed operation, stop the machine immediately after
encountering the rising edge of the deceleration point (origin) signal. After the motor is completely stopped, the
motor will move a quantitative pulse (P9-19, P9-20) at the speed set by P9-12 (homing high speed) according to
the set number and direction of mechanical offset pulses (either positive direction or negative direction), then the
motor stops.
(c) Z phase number (P9-11.0) is 1 and mechanical offset (P9-19, P9-20) is 0:
In the process of forward acceleration or forward constant speed operation, continue to run after encountering the
rising edge of deceleration point (origin) signal, and then find the first Z-phase signal and stop immediately.
(d) Z phase number (P9-11.0) is 1 and mechanical offset (P9-19, P9-20) is not 0:
In the process of positive acceleration or positive constant speed operation, continue to run after encountering the
rising edge of the deceleration point (origin) signal, and then find the first Z-phase signal to stop immediately.
After the motor is completely stopped, the motor will run a quantitative pulse (P9-19, P9-20) at the set speed
P9-12 (homing high speed) according to the set number of mechanical offset pulses and direction (either positive
direction or negative direction), then the motor stops.
2. Homing mode 1——Reverse return to zero, the deceleration point is the origin switch, and the origin is
the origin switch or motor Z signal(P9-11.2=1)
It needs to connect POT, NOT, origin switch to use this mode.
(1) When the motor starts to move, the signal of origin switch (deceleration point) is invalid, and the reverse
overtravel switch (NOT)(P5-23) is not triggered in the whole process
Firstly, the servo motor searches for the deceleration point signal at high speed -P9-12 (homing high speed) in
reverse until it meets the rising edge of the deceleration point signal. After gradually accelerating to P9-13
(homing low speed) according to the setting of P9-14 (homing acceleration and deceleration time), the servo
motor forward searches for the falling edge of deceleration point (origin) signal at the low speed P9-13 (homing
low speed). When encountering the falling edge of deceleration point (origin) signal, it will reverse (resume
reverse), and continue to search the rising edge of the deceleration point (origin) signal at a low speed
-P9-13(homing low speed). The next back to origin action can be divided into four cases:
(a) Z phase number (P9-11.0) is 0 and mechanical offset (P9-19, P9-20) is 0:
During the operation of continuing to search for the rising edge of deceleration point (origin) signal at low speed
-P9-13 (homing low speed), stop immediately when encountering the rising edge of deceleration point (origin)
signal.
(b) Z phase number (P9-11.0) is 0 and mechanical offset (P9-19, P9-20) is not 0:
During the operation of continuing to search the rising edge of deceleration point (origin) signal at low speed
-P9-13 (homing low speed), stop the machine immediately after encountering the rising edge of deceleration point
(origin) signal. After the motor is completely stopped, the motor will run a quantitative pulse (P9-19, P9-20) at the
set speed P9-12 (homing high speed) according to the set number of mechanical offset pulses and direction (either
positive direction or negative direction), then the motor stops.
(c) Z phase number (P9-11.0) is 1 and mechanical offset (P9-19, P9-20) is 0:
During the operation of continue to search the rising edge of deceleration point (origin) signal at low speed -P9-13
(homing low speed), continue to run after encountering the rising edge of deceleration point (origin) signal, and
then find the first Z-phase signal and stop immediately.
(d) Z phase number (P9-11.0) is 1 and mechanical offset (P9-19, P9-20) is not 0:
During the operation of continue to search the rising edge of the deceleration point (origin) signal at low speed
-P9-13 (homing low speed), continue to operate after encountering the rising edge of the deceleration point (origin)
signal, then find the first Z-phase signal and stop immediately. After the motor stops completely, according to the
set number of mechanical offset pulses and direction (either positive direction or negative direction), the motor
goes through a quantitative pulse (P9-19, P9-20) at the speed P9-12 (homing high speed), and then the motor
stops.
(2) When the motor starts to move, the signal of origin switch (deceleration point) is valid (P5-64 = 0-invalid,
1-valid), and the reverse overtravel switch is not triggered in the whole process (NOT) (P5-23).
The servo motor directly forward searches for the falling edge of the deceleration point (origin) signal at low
speed P9-13 (homing low speed). If it encounters the falling edge of the deceleration point (origin) signal, it will
reverse (i.e. negative direction), and continue to search for the rising edge of the deceleration point (origin) signal
at low speed -P9-13 (homing low speed). The next action of returning to origin can be divided into four cases:
(a) Z phase number (P9-11.0) is 0 and mechanical offset (P9-19, P9-20) is 0:
In the process of negative acceleration or negative constant speed operation, stop immediately when encountering
the rising edge of the origin signal.
(b) Z phase number (P9-11.0) is 0 and mechanical offset (P9-19, P9-20) is not 0:
In the process of negative acceleration or negative constant speed operation, stop the machine immediately after
encountering the rising edge of the origin signal. After the motor is completely stopped, the motor will walk a
quantitative pulse (P9-19, P9-20) at the speed P9-12 (homing high speed) according to the set number and
direction of mechanical offset pulses (either positive direction or negative direction), and then stop the motor.
(3) When the motor starts to move, the signal of the origin switch (deceleration point) is invalid (P5-64 =
0-invalid, 1-valid), and the reverse overtravel switch triggered in the process is valid (NOT) (P5-23).
Firstly, the servo motor reverse searches for the deceleration point (origin) signal at high speed -P9-12 (homing
high speed). After encountering the reverse overtravel switch (NOT), the driver decelerates in reverse (i.e. forward)
according to the value set in P9-14 (homing acceleration and deceleration time), and immediately searches for the
falling edge of the deceleration point (origin) signal at high speed P9-12 (homing high speed) in the forward
direction. After encountering the falling edge of the deceleration point (origin) signal, decelerate in the reverse
direction (i.e. negative direction) according to the set value of P9-14 (homing acceleration and deceleration time),
and the servo motor searches the rising edge of the deceleration point (origin) signal in the reverse low speed
-P9-13 (homing low speed). The next homing action can be divided into four cases:
(a) Z phase number (P9-11.0) is 0 and mechanical offset (P9-19, P9-20) is 0:
In the process of reverse acceleration or reverse constant speed operation, stop immediately when encountering
the rising edge of the origin signal.
(b) Z phase number (P9-11.0) is 0 and mechanical offset (P9-19, P9-20) is not 0:
In the process of reverse acceleration or reverse constant speed operation, stop the machine immediately after
encountering the rising edge of the deceleration point (origin) signal. After the motor is completely stopped, the
motor will move a quantitative pulse (P9-19, P9-20) at the speed set by P9-12 (homing high speed) according to
the set number and direction of mechanical offset pulses (either positive direction or negative direction), then the
motor stops.
(c) Z phase number (P9-11.0) is 1 and mechanical offset (P9-19, P9-20) is 0:
In the process of reverse acceleration or reverse constant speed operation, continue the operation after
encountering the rising edge of the origin signal, and then stop immediately after finding the first Z-phase signal.
(d) Z phase number (P9-11.0) is 1 and mechanical offset (P9-19, P9-20) is not 0:
In the process of reverse acceleration or reverse constant speed operation, continue to operate after encountering
the rising edge of the deceleration point (origin) signal, and then find the first Z-phase signal to stop immediately.
After the motor is completely stopped, the motor will run a quantitative pulse (P9-19, P9-20) at the set speed
P9-12 (homing high speed) according to the set number of mechanical offset pulses and direction (either positive
direction or negative direction), then the motor stops.
3. Homing mode 2——forward homing, deceleration point and origin are motor Z signal (P9-11.2=2)
In this mode, the number of Z phases of the motor is not found. To use this mode, you need to connect POT and
NOT.
(1) When the motor starts to move, the Z signal is invalid or valid (P5-64 = 0-invalid, 1-valid), and the
forward overtravel switch (POT) is not triggered in the whole process.
Firstly, the servo motor forward searches the Z signal at the high-speed P9-12 (homing high speed). After
encountering the rising edge of the Z signal, it decelerates in the reverse direction according to the set value of
P9-14 (homing acceleration and deceleration time), accelerates to -P9-13 (homing low speed) and reverse
searches the Z signal at low speed. Next, the homing action is divided into two cases:
(a) Mechanical offset (P9-19, P9-20) is 0:
In the process of reverse acceleration or reverse constant speed operation, stop immediately when encountering
the rising edge of the other side of the motor Z signal.
(2) When the motor starts to move, the Z signal is invalid or valid (P5-64 = 0-invalid, 1-valid), and the
forward overtravel switch is triggered in the process (POT) (P5-22).
Firstly, the servo motor searches for the Z signal in forward direction with the high speed P9-12 (homing
high-speed speed). After encountering the forward overtravel switch, the driver decelerates in the reverse direction
according to P9-14 (homing acceleration and deceleration time), and searches for the Z signal in the reverse
direction with the high-speed -P9-12 (homing high-speed) until encountering the rising edge of the Z signal. The
machine gradually decelerates in the reverse direction (i.e. returns to the forward direction) according to P9-14
(homing acceleration and deceleration time). The servo motor searches the rising edge of the other side of the Z
signal in the forward direction and low speed P9-13 (homing low speed). The next homing action is divided into
two cases:
(a) Mechanical offset (P9-19, P9-20) is 0:
In the process of forward acceleration or forward constant speed operation, stop immediately when encountering
the rising edge of the other side of the Z signal.
4. Homing mode 3——reverse homing, the deceleration point and origin are motor Z signal
(P9-11.2=3)
In this mode, the number of Z phases of the motor is not found. To use this mode, you need to connect POT and
NOT.
(1) When the motor starts to move, the Z signal is invalid or valid (P5-64 = 0-invalid, 1-valid), and the
reverse overtravel switch is not triggered in the whole process (NOT).
Firstly, the servo motor searches for the Z signal in reverse direction with the high speed -P9-12 (homing high
speed). After encountering the rising edge of the Z signal, it decelerates and reverses according to the set value of
P9-14 (homing acceleration and deceleration time), accelerates to P9-13 (homing low speed) and searches for the
Z signal at low speed in forward direction. Next, the homing action is divided into two cases:
(a) Mechanical offset (P9-19, P9-20) is 0:
In the process of forward acceleration or forward constant speed operation, stop immediately when encountering
the rising edge of the other side of the motor Z signal.
(2) When the motor starts to move, the Z signal is invalid or valid (P5-64 = 0-invalid, 1-valid), and the
reverse overtravel switch is triggered in the process (NOT)
The servo motor searches for the Z signal at high speed -P9-12 (homing high speed) in reverse direction. After
encountering the reverse overtravel switch, the driver decelerates and reverses according to P9-14, and then
searches for the Z signal at high speed P9-12 (homing high speed) in forward direction until encountering the
rising edge of the Z signal, and gradually decelerates and reverses (i.e. restores the reverse direction) according to
the set value of P9-14 (homing acceleration and deceleration time). The servo motor searches the rising edge on
the other side of the Z signal at low speed -P9-13 (homing low speed) in reverse direction. Next, the homing
action is divided into two cases:
(a) Mechanical offset (P9-19, P9-20) is 0:
In the process of reverse acceleration or reverse constant speed operation, stop immediately when encountering
the rising edge of the other side of the Z signal.
5. Homing mode 4——forward homing, deceleration point and origin are forward overtravel switch
POT (P5-22) (P9-11.2=4)
To use this mode, it needs to connect NOT, POT.
(1) When the motor starts moving, the forward overtravel switch (POT) is invalid
Firstly, the servo motor searches the forward overtravel switch at high speed P9-12 (homing high speed). After
encountering the rising edge of the forward overtravel switch signal, it gradually decelerates in reverse according
to the setting of P9-14 (homing acceleration and deceleration time). The servo motor searches the falling edge of
the forward overtravel switch signal in reverse direction at low speed -P9-13 (homing low speed). After
encountering the falling edge of the forward overtravel switch signal, the next action of returning to the origin can
be divided into four cases:
(a) Z phase number (P9-11.0) is 0 and mechanical offset (P9-19, P9-20) is 0:
Decelerate in the reverse direction (i.e. restore the forward direction), and search for the rising edge of the forward
overtravel switch signal in the forward direction and low speed P9-13 (homing low speed). In the process of
forward acceleration or forward constant speed operation, stop immediately when encountering the rising edge of
the forward overtravel switch signal.
(b) Z phase number (P9-11.0) is 0 and mechanical offset (P9-19, P9-20) is not 0:
Decelerate in the reverse direction (i.e. restore the forward direction), and search the rising edge of the forward
overtravel switch signal in the forward with low speed P9-13 (homing low speed). In the process of forward
acceleration or forward uniform speed operation, stop immediately when encountering the rising edge of the
forward overtravel switch signal. After the motor is completely stopped, motor walks a quantitative pulse at the
speed set by P9-12 (homing high speed) according to the set number and direction of mechanical offset pulses (it
can only be in the negative direction, that is, it must move between the origin switch and NOT), and then the
motor will stop.
(d) Z phase number (P9-11.0) is 1 and mechanical offset (P9-19, P9-20) is not 0:
Continue to operate in the reverse direction at the low speed set by -P9-13 (homing low speed), and then stop
immediately after encountering the rising edge of the first Z-phase signal. After the motor stops completely, the
motor will move a quantitative pulse at the speed P9-12 (homing high speed) according to the set number of
mechanical offset pulses and direction (it can be negative or positive, but it must move between the origin switch
and NOT), and then the motor stops.
(2) Forward overtravel switch is valid when motor starts moving (POT) (P5-22)
The servo motor directly searches for the falling edge of the forward overtravel switch signal (POT) at a reverse
low speed -P9-13 (homing low speed). After encountering the falling edge of POT, the next homing action is
divided into four cases:
(a) Z phase number (P9-11.0) is 0 and mechanical offset (P9-19, P9-20) is 0:
Decelerate in the reverse direction (i.e. restore the forward direction), search for the rising edge of POT in the
forward low-speed P9-13 (homing low speed), and stop immediately when encountering the rising edge of POT
during forward acceleration or forward constant speed operation.
(b) Z phase number (P9-11.0) is 0 and mechanical offset (P9-19, P9-20) is not 0:
Decelerate in reverse direction (i.e. restore the positive direction), search the rising edge of POT at low speed and
positive direction with P9-13 (homing low speed). In the process of positive acceleration or positive constant
speed operation, stop immediately when encountering the rising edge of POT. After the motor stops completely,
the motor will move a quantitative pulse at the speed P9-12 (homing high speed) according to the set number of
mechanical offset pulses and direction (it only can be negative direction, but it must move between the origin
switch and NOT), and then the motor stops.
6. Homing mode 5——reverse homing, deceleration point and origin are reverse overtravel switch
NOT (P5-23) (P9-11.2=5)
To use this mode, please connect POT, NOT.
(1) When the motor starts moving, the reverse override switch (NOT) is invalid
Firstly, the servo motor searches for the reverse overtravel switch (NOT) at reverse high speed -P9-12 (homing
high speed). After encountering the rising edge of NOT, it gradually decelerates in reverse according to the setting
of P9-14 (homing acceleration and deceleration time). The servo motor searches for the falling edge of NOT at
forward low speed P9-13 (homing low speed). After encountering the falling edge of NOT, the next homing action
can be divided into four cases:
(b) Z phase number (P9-11.0) is 0 and mechanical offset (P9-19, P9-20) is not 0:
Decelerate in the reverse direction (i.e. restore the reverse direction), and search for the rising edge of the reverse
overtravel switch signal (NOT) at the reverse low speed -P9-13 (homing low speed). In the process of reverse
acceleration or reverse constant speed operation, stop immediately when encountering the rising edge of NOT.
After the motor stops completely, the motor will move a quantitative pulse at the speed P9-12 (homing high speed)
according to the set number of mechanical offset pulses and direction (it only can be positive, but it must move
between the origin switch and POT), and then the motor stops.
(2) When the motor starts to move, the reverse overtravel switch (NOT) (P5-23) is valid
The servo motor directly searches for the falling edge of the reverse overtravel switch signal (NOT) at the forward
low speed P9-13 (homing low speed). After encountering the falling edge of NOT, the next homing action is
divided into four cases:
(a) Z phase number (P9-11.0) is 0 and mechanical offset (P9-19, P9-20) is 0:
Decelerate in reverse direction (i.e. resume reverse direction), search for the rising edge of NOT in reverse
direction at low speed -P9-13(homing low speed). During reverse acceleration or reverse constant speed operation,
stop immediately when encountering the rising edge of NOT.
(b) Z phase number (P9-11.0) is 0 and mechanical offset (P9-19, P9-20) is not 0:
Decelerate in reverse direction (i.e. recover in reverse direction), search for the rising edge of NOT in reverse
direction at low speed -P9-13 (homing low speed). During reverse acceleration or reverse constant speed
operation, stop immediately when encountering the rising edge of NOT. After the motor stops completely, the
motor will move a quantitative pulse at the speed P9-12 (homing high speed) according to the set number of
mechanical offset pulses and direction (it only can be positive), but it must move between the origin switch and
POT), and then the motor stops.
7. Homing mode 6——forward homing, deceleration point and origin are forward mechanical limit
position (P9-11.2=6)
To use this mode, no need to connect POT, NOT and origin switch.
Firstly, the servo motor runs forward at low speed P9-13 (homing low speed). After hitting the mechanical limit
position, if the absolute value of torque reaches the upper torque limit of P9-17 (touch stop homing mode torque
threshold), and the absolute value of speed is lower than the set value of P9-16 (touch stop homing mode speed
threshold), this state remains P9-18 (touch stop homing mode time threshold) After the set time, it is judged that
the mechanical limit position is reached, and the next homing action can be divided into four cases:
(a) Z phase number (P9-11.0) is 0 and mechanical offset (P9-19, P9-20) is 0:
Shut down immediately.
(b) Z phase number (P9-11.0) is 0 and mechanical offset (P9-19, P9-20) is not 0:
The servo motor stops immediately. After it stops completely, according to the set number of mechanical offset
pulses, the motor reverse moves a quantitative pulse (P9-19, P9-20) at the speed set by -P9-12 (homing high
speed), and then the motor stops.
(c) Z phase number (P9-11.0) is 1 and mechanical offset (P9-19, P9-20) is 0:
Operate in reverse at the low speed set by -P9-13 (homing low speed), and then stop immediately after
encountering the rising edge of the first Z-phase signal.
(d) Z phase number (P9-11.0) is 1 and mechanical offset (P9-19, P9-20) is not 0:
Run in reverse at the low speed set by -P9-13 (homing low speed), then stop immediately after encountering the
rising edge of the first Z-phase signal, and then walk a quantitative pulse (it can run in positive direction or
negative direction, but it must be within the mechanical limit position) at the speed set by -P9-12 (homing high
speed) according to the set number of mechanical offset pulses after complete stop, and then the motor stops.
8. Homing mode 7——reverse homing, deceleration point and origin are reverse mechanical limit
position (P9-11.2=7)
To use this mode, no need to connect POT, NOT and origin switch.
Firstly, the servo motor runs in reverse direction with the low speed -P9-13 (homing low speed). After hitting the
mechanical limit position, if the absolute value of torque reaches the upper torque limit of P9-17 (touch stop
homing mode torque threshold), and the absolute value of speed is lower than the set value of P9-16 (touch stop
homing mode speed threshold), this state remains P9-18 (touch stop homing mode time threshold). After the set
time, it is judged that the mechanical limit position is reached, and the next action of returning to the origin can be
divided into four cases:
(a) Z phase number (P9-11.0) is 0 and mechanical offset (P9-19, P9-20) is 0:
Shut down immediately.
(b) Z phase number (P9-11.0) is 0 and mechanical offset (P9-19, P9-20) is not 0:
The servo motor stops immediately. After it stops completely, the motor moves forward a quantitative pulse
(P9-19, P9-20) at the speed set by P9-12 (high speed back to the origin) according to the set number of
mechanical offset pulses, and then the motor stops.
(d) Z phase number (P9-11.0) is 1 and mechanical offset (P9-19, P9-20) is not 0:
Operate in the forward direction with low-speed P9-13 (homing low-speed), and then stop immediately after
encountering the rising edge of the first Z-phase signal. After complete stop, the motor will walk a fixed pulse
(P9-19, P9-20) at the speed set by P9-12 (homing high-speed) according to the set number of mechanical offset
pulses (it can operate in positive direction or negative direction, but it must be within the mechanical limit
position), and then the motor stops.
Note: only for homing mode 6 and 7.
For homing modes 6 and 7, once these two homing modes are triggered, the maximum torque during homing is
1.1 times of the set value of P9-17 (touch stop homing torque threshold). If the internal forward and reverse torque
limits P3-28 and P3-29 are smaller than 1.1 times of the set value of P9-17 (touch stop homing torque threshold),
the torque limit is the set value of P3-28 and P3-29. Similarly, if the external forward and reverse torque limits
P3-30 and P3-31 are enabled, the actual torque limit is the minimum of the internal torque limit, the external
torque limit and 1.1 times of the P9-17 set value.
Only when these two homing modes are triggered, 1.1 times of the set value of torque limit P9-17 (touch stop
homing torque threshold) will take effect. If only the homing is enabled and (homing mode) P9-11.2 is 6 or 7, but
the homing is not triggered, 1.1 times of the set value of torque limit P9-17 (touch stop homing torque threshold)
will not take effect.
5.4.2 Position control (external pulse command)
DS5C2 series only 15kW model support this function.
Parameter Overview Reference
chapter
P0-01 control mode selection Set to 6: external pulse mode 5.4.2.1
P0-10 pulse instruction form Set the pulse form 5.4.2.3
0-CW/CCW
1-AB
2-P+D
P0-11 Motor pulse numbers per rotation*1 Setting of command pulse number required 5.4.1.1
P0-12 Motor pulse numbers per for one revolution of motor
rotation*10000 P0-11 and P0-12=0, P0-13/P0-14 are
P0-13 Electronic gear ratio (numerator) effective
P0-14 Electronic gear ratio (denominator) P0-11~P0-14 are 0, P0-92~P0-95 are
P0-92~P0-93 32-bit electronic gear ratio valid
(numerator) 32-bit electronic gear ratio (numerator):
P0-94~P0-95 32-bit electronic gear ratio P0-92*1 + P0-93 *10000
(denominator) 32-bit electronic gear ratio denominator:
P0-94*1 + P0-95 *10000
P0-09 Pulse command setting You can set the command direction and 5.4.2.5
filter time of low-speed pulse respectively
0:CW/CCW
1:AB
2:P+D
Default
Parameter Meaning Unit Range Change Effective
setting
P0-09.2 Pulse command filter Servo Re-power
2 4.167ns 0~4
n.x□xx time OFF on
Pulse filtering time can enhance the anti-interference ability of low-speed pulses (within 200K).
P0-09.2=0: Turn off the noise filter;
P0-09.2=1-4: Turn on the noise filter to filter out pulses with a pulse width less than 30*4^(n-1) ns.
5.4.3 Position control (Internal command)
After the drive output 1-segment position After the drive output 1-segment position
command, it will wait for the completion of command, it will wait for the completion of
motor positioning, and then start the next position motor positioning, and pass the adjust time, then
command at once. T1 is positioning time, which start the next position command. T1 is
means the time from pulse output complete to the positioning time, t2 is adjust time. Refer to
output of positioning completion signal. parameter P4-16.
Wait mode = 1, adjust time = 0ms Wait mode = 1, adjust time > 0ms
After the drive output 1-segment position After the drive output 1-segment position
command, it will not wait for the completion of command, it will not wait for the completion of
motor positioning, and start the next position motor positioning, but pass the adjust time, and
command at once. then start the next position command. T2 is adjust
time. Refer to parameter P4-16.
n.xx□x Description
Take setting two segments as an example,
t1 = p4-16 in the figure.
1. Note that as shown in the figure, in this
mode, the set adjustment time actually
does not work. As long as the previous
position command has been sent out, the
next command will be entered
1: Change immediately when a new step change
the step at signal arrives.
the rising 2. In this mode, the step change signal
edge of the /CHGSTP is triggered by rising edge.
signal, 3. After each operation completion,
single-step positioning completion and positioning
execution approach signal are all effective.
4. When the servo enable is off during a
certain section of operation, the motor
stops according to the servo off shutdown
mode. After the shutdown, the
positioning is invalid.
5. The adjustment time is not valid in this
mode.
Take setting two segments as an example,
t1 = p4-16 in the figure.
1. The /CHGSTP signal before the
2: Start at completion of a cycle will not be
the rising counted, as shown in the second
edge of the /CHGSTP signal in the figure.
signal, 2. In this mode, the step change signal
sequential /CHGSTP is triggered by rising edge.
run all, not 3. After each operation completion,
recycling positioning completion and positioning
approach signal are all effective.
4. When the servo enable is off during a
certain section of operation, the motor
stops according to the servo off shutdown
mode. After the shutdown, the
positioning is invalid.
5. The adjustment time is valid in this
mode.
3: set
segment no.
Servo is ON, set parameter P2-09=0, then set the running segment. The motor will run
through
the setting segment. Refer to chapter 5.4.3.6
communica
tion
t1 = p4-16 in the figure.
1. /CHGSTP rising edge triggers the first
segment and falling edge triggers the
second segment. Where, if the first
segment position is required to operate
completely, the /CHGSTP signal remains
on until the end of the first segment.
2. Only in this mode, the number of
p4-04 valid segments is invalid.
3. After each operation completion,
4:
positioning completion and positioning
/CHGSTP
approach signal are all effective.
double edge
4. When the servo enable is off during a
triggering
certain section of operation, the motor
stops according to the servo off shutdown
mode. After the shutdown, the
positioning is invalid.
5. The adjustment time is not valid in this
mode.
6. Before using this mode, p5-35
terminals need to be allocated first, but
not when using this mode.
3. Positioning mode
n.xxx□ Meaning
0 Relative positioning
1 Absolute positioning
1: absolute positioning
0: relative positioning (take the reference origin as the absolute
positioning origin)
5.4.3.3 Position segment 1 to 35 parameter settings
Default
Parameter Meaning Unit Range Change Effective
setting
Pulse number
P4-10+(n-1)*7 0 1 pulse -9999~9999 Anytime At once
(low bit)
Pulse number Anytime At once
P4-11+(n-1)*7 0 10000 pulses -32767~32767
(high bit)
P4-12+(n-1)*7 Speed 0 0.1rpm 0~65535 Anytime At once
Trapezoid Anytime At once
P4-13+(n-1)*7 acceleration 0 ms 0~65535
time
Trapezoid Anytime At once
P4-14+(n-1)*7 deceleration 0 ms 0~65535
time
P4-15+(n-1)*7 Reserved -
P4-16+(n-1)*7 Adjust time 0 ms 0~65535 Anytime At once
Notes:
1. Set pulse number = pulse number (high bit) ×10000 + pulse number (low bit).
2. In formula P4-10+(n-1)*7, n is the segment no. of internal position; the range is 1~35. Segment 1~12 can
be set through the operate panel, segment 13~35 needs to write in parameters through communication
(RS232 or RS485).
3. In the relative positioning mode, if the pulse high position is set to 9999, the pulse low position is set to
9999, or the pulse high position is set to - 9999, and the pulse low position is set to - 9999, and p4-03.3 = 1
(do not wait for the positioning to be completed), the infinite pulse mode will be entered. On the contrary, the
number of pulses is limited.
4. If one of the segment speed is zero, servo will skip this segment and run the next segment.
5. In relative positioning mode, if one segment speed is not zero but the pulse number is zero, the motor will
not run, but the wait mode is effective. The servo will run the next segment when the adjust time is out.
6. In absolute positioning mode, if one segment speed is not zero but the pulse number is zero, the
motor will return to the reference origin with the speed of this segment.
7. In absolute positioning mode, if two consecutive segments speed are not zero, but the pulse number is
the same, the servo motor will not run but the wait mode is effective.
8. In the absolute positioning mode, the number of rotations of the motor is limited and cannot be unlimited.
9. At present, there are only two kinds of velocity in the internal position mode: step speed and slope speed.
When the trapezoidal acceleration time and trapezoidal deceleration time are set to 0, it is in the form of step
speed. When the trapezoidal acceleration time and trapezoidal deceleration time are greater than 0, it is in the
form of slope speed.
10. Trapezoidal acceleration time and trapezoidal deceleration time refer to the time required to change from
0 to rated speed.
11. If the speed of a certain parameter set is 0, the position command of this section will be ignored in the
step change mode of 0 / 1 / 2. However, in the mode of 4 / 5 / 6, the motor does not rotate when the step
change is triggered at this section.
12. In the internal position section parameters, the position commands of pulse settings are still affected by
the electronic gear ratio. The actual number of turns of the motor should be determined by combining the set
pulse command and the electronic gear ratio.
13. In the absolute positioning mode, the starting position of each step change is based on the starting
position of the first triggering step change. In the relative positioning mode, the starting position of each step
change is based on the position at the end of the last step change.
14. In the relative positioning mode, the infinite pulse position segment can be set in the 35 segment
positions. The motor will run continuously in this segment, unless the trigger skips the current segment.
Default
Parameter Meaning Unit Range Modify Effective
setting
Internal position mode
P4-08 1 - 0~35 Servo bb At once
start segment number
P4-08 sets the starting operation section number after the first round, and it is valid when the change mode
P4-03.1 is set to 0 and 1. The settings are explained below, and valid values are set for No.1-No.8 sections.
Change
Setting Parameter Actions
step mode
P4-08=0 or P4-08=8
P4-08>P4-04 P4-04=4
P4-03.1=0
P4-08=2
1≤P4-08≤P4-04
P4-04=4
P4-08=0 or P4-08=8
P4-08>P4-04 P4-04=4
P4-03.1=1
P4-08=2
1≤P4-08≤P4-04
P4-04=4
When using skip current segment function, the SI terminal assigned by P5-31 needs rising edge trigger.
5.4.3.4 Change step signal (/CHGSTP)
Parameter Name Setting Meaning Range
Range: 0000-0014.
Change Defaulted is not distribute to input Distribute to input
P5-35 step signal n.0000 terminal. Refer to chapter 5.4.3.2. terminal through P5-35.
/CHGSTP When it set to 0001, it
means input from SI1.
In different Step-Changing modes, the function of skipping the current segment will have different effects, as
follows:
Change step
Skip the present
mode Actions
segment
P4-03 n.xx□x
0 Cancel current segment, execute the next segment at once
Cancel current segment, execute the next segment when the
1
change step signal is ON
2 Cancel current segment, execute the next segment at once
3 Cancel current segment, set the F2-09 again
/Z-CLAMP
The current segment is cancelled and the next segment is
4
executed on the falling edge of the /CHGSTP step change signal
If the current segment is cancelled, the corresponding segment
5
will be executed after selecting other segments
The current segment is cancelled, the selected position segment
6
is executed at the rising edge of /CHGSTP step signal
Firstly, set P3-09 and P3-10. Plan the speed command acceleration and deceleration time.
Among them, the acceleration time Tacc=(target speed/rated speed) * P3-09 [ms], and the deceleration time
Tdec=(target speed/rated speed) * P3-10 [ms].
Set an appropriate sliding average filtering time constant P3-11 (S-type acceleration and deceleration time
constant). Ts=P3-11*0.1 [ms].
Note: The setting of the sliding average filtering time constant must meet the requirements, Ts<0.5 * Tacc,
Ts<0.5*Tdec. Otherwise, excessive sliding average filtering time will result in an increase in deceleration time,
which does not comply with the settings of P3-09 and P3-10.
When P3-09 and P3-10 are set to 0, setting the sliding average filtering time will change the speed command into
a trapezoidal acceleration/deceleration speed command. Set P1-23 (speed command filtering time constant) and
P1-24 (first-order low-pass filtering time constant), and the effect is as follows:
Note: If acceleration and deceleration are set, the first-order low-pass filtering will increase the lag of the speed
command.
5.5.2 Speed control (internal speed)
Parameter Overview Chapter
P0-01 Control mode selection Set to 3: internal speed control mode 5.5.2.1
P3-05 Internal speed 1 Speed value setting of internal 3-segment speed 5.5.2.1
P3-06 Internal speed 2 in rpm
P3-07 Internal speed 3
P5-28 internal speed selection /SPD-A The combination of terminals determines the 5.5.2.1
P5-29 internal speed selection /SPD-B speed of corresponding section
P5-27 internal speed direction selection Direction changing, default is n.0000 5.5.2.1
/SPD-D If the direction changing is given through SI2
terminal, P5-27 can be set to n.0002
P3-09 soft start acceleration time Set acceleration and deceleration time in ms 5.5.1.1
P3-10 soft start deceleration time
Related parameter
Defaulted
Parameter Meaning Unit Range Modify Effective
setting
P3-05 Internal speed 1 0 rpm -9999~+9999 Anytime At once
P3-06 Internal speed 2 0 rpm -9999~+9999 Anytime At once
P3-07 Internal speed 3 0 rpm -9999~+9999 Anytime At once
3. Running example
Speed 3
+SPEED3 Speed up down is decided by
P3-09, P3-10
Speed 2
+SPEED2
Speed 1
+SPEED1
-SPEED1
Speed 1
-SPEED2
Speed 2
-SPEED3
Speed 3
STO (Safe Torque Off) function: refers to the safety function of cutting off motor current through hardware.
The STO safety function terminal (CN5) adopts a dual circuit design, with two safety signal input channels STO1
and STO2. If either terminal is triggered, it will enter the STO state. Through an independent circuit, it prevents
the power module that controls the motor current from outputting PWM control signals, thereby cutting off the
motor current and achieving a torque free state.
STO triggering
The driver can only operate normally when both the input signals of STO1 and STO2 terminals are at high level.
In addition, when an STO alarm occurs, the current STO status can be determined based on the EDM output
signal status, as shown in the table below:
STO1 input STO2 input EDM output status PWM control signal
H H No output Normal
H L No output Prohibited
L H No output Prohibited
L L With output Prohibited
When either STO1 or STO2 is at a low level, the servo enters the STO state. At this time:
(1) PWM control signal prohibition;
(2) The servo stops as the turn off enable mode in P0-29 alarm stop mode;
(3) The servo/S-RDY signal output is 0;
(4) The panel displays STO.
When both STO1 and STO2 are at low levels, the EDM output circuit becomes conductive;
When the status of STO1 and STO2 is inconsistent and the time exceeds the set time of P0-88, alarm E-340: STO
status is not synchronized.
Ensure that the STO1 and STO2 pins do not respond to pulses below 1ms, and ensure that it responds to the pulse
higher than the setting in P0-89.2-3.
An alarm occurs in the STO state, and the panel displays the alarm information. However, the servo is still in the
STO state at this time, and the dynamic braking and holding brake configurations are configured according to the
STO state.
STO release
When both STO1 and STO2 terminals are at high level and the enable signal is in a non enable state, the STO
state is released, the servo ready output signal/S-RDY is output according to P5-70 configuration, the dynamic
braking is output according to P0-27 or P0-29 configuration, and the holding brake is output according to the
effectiveness of the enable signal/S-ON.
After the STO function is activated, the motor safely enters a torque free state, and the servo drive will no longer
have control over the motor. Therefore, before using the STO function, please evaluate the hazards that still exist
after the STO function is enabled:
After the STO function is enabled, the servo cannot guarantee that the motor will move due to
external forces, such as the vertical axis;
The STO function cannot cut off the power supply of the servo unit. The strong electrical part of the
driver is still charged, so there is still a risk of electric shock or other electrical hazards. When
maintaining the servo unit, please be sure to cut off the power supply and other devices of the servo
unit;
Please use the single power supply provided by the safety function terminal CN5 to supply power to
the STO signal input, otherwise the STO function may malfunction due to leakage current, making it
impossible to enter the STO cut-off state.
If the STO function is used to stop a running servo, the motor will gradually stop. If it is not acceptable, the
system should use the correct stop mode instead of using the STO function to stop.
All cables suitable for STO function must have good protection, wiring, and fixation. During installation, it is
necessary to ensure that the cables are not pulled or squeezed. The requirements for the cables used are as follows:
Cable Explanation
requirements
Type Double shielded or single shielded twisted pair multiple pair cables
Max length The maximum allowable cable length between the driver and safety switch is
30m
Max size 0.8mm2 (18 AWG)
Min size 0.3mm2 (28 AWG)
The control method of servo driven permanent magnet synchronous motor, which operates above the rated speed
by reducing the motor magnetic field while meeting the maximum voltage and current limits of the inverter, is
called weak field control. Weak magnetic control can broaden the speed range of permanent magnet synchronous
motors.
When using the weak magnetic function, the motor speed must not exceed the maximum
motor speed to avoid motor failure or personal and property damage.
Servo weak magnetic control switch PE-01.3. 0 (default): indicates turning off the weak magnetic function, 1:
indicates turning on the weak magnetic function.
When activating the weak magnetic function of the servo, it is necessary to match the correct motor parameters,
such as back electromotive force coefficient, Ld, Lq, etc. For specific usage conditions and parameter settings,
please contact the technical support.
Parameter Name Unit Range Effective Default
PE-01.3 Weak magnetic control switch — 0-1 Anytime 0
PE-80 Weak magnetic control gain Kv Hz 10-1000 Anytime 30
PE-81 Weak magnetic control integration 10-1000 Anytime 16
%
time constant Ti
PE-82 Weak magnetic control integral limit % 0-200 Anytime 60
PE-83 Voltage command limit threshold % 50-150 Anytime 115
PE-84 IdRef limit % 50-150 Anytime 95
PE-85 Smooth filtering time of main cycle 0-1000 Anytime 20
0.1ms
voltage
6 EtherCAT bus communication
6.1 EtherCAT technical overview
This section mainly introduces the basic concept, system composition, communication specifications and
connection instructions of EtherCAT.
6.1.1 EtherCAT introduction
EtherCAT, the full name is Ethernet for Control Automation Technology, which is developed by Beckhoff
Atuomation GmbH. It is a kind of real-time Ethernet used for open network communication between master
station and slave station. As a mature industrial Ethernet technology, EtherCAT has the characteristics of high
performance, low cost and easy to use.
XG2, XDH or XLH series controller (master station) and DS5C2 servo driver (slave station) comply with the
standard EtherCAT protocol, supports the maximum 64-axis slave stations, 64-axis synchronization cycle is 4ms,
supports touch probe function, position, speed, torque and other control modes, is widely applicable to various
industries.
Communication action
Slave station SDO(mailbox) PDO PDO
Actions in various states
status receive and send Send Receive
messages messages messages
Communication initialization, SDO, PDO
Init - - -
unable to receive and send messages
Pre-Operational
Only SDO receives and sends messages Yes - -
(PreOP)
Safe-Operational Only SDO receives and sends messages,
Yes Yes -
(SafeOP) PDO sends messages
Operational SDO receives and sends messages, PDO
Yes Yes Yes
(OP) receives and sends messages
Note: the access from the master station to the ESC register is independent of the above table and is available at
any time.
PDO (Process Data Object) Used to transmit periodic communication data.
SDO (Service Data Object) Used to transmit aperiodic communication data.
Command or interface operation during ESM state switching may cause abnormal communication error
Bit Contents
0
1
Not support
2
3
4 AL status code defined alarm occured *1
5 Not support
6 Reserved
7 AL status code defined alarm occured*2
*1:“AL status code defined alarm” means EtherCAT communication related error E-800~
7, E-810~7, E-850~7.
*2:“AL status code not defined alarm” means EtherCAT communication related error
E-880~7 and except EtherCAT communication related error.
The following table shows the parameters that must be configured uniformly in CSP, CSV, CST, PP, PV and TQ
modes.
Register Explanation
RXPDO[0x6040] Controlword must be added to the PDO configuration. It is invalid to modify it through IO
mapping in CSP, CSV and CST modes. It is controlled by the NC module
RXPDO[0x6060] Modes of operation, must be added to the PDO configuration,and can be modified by IO
mapping in the task mode.
RXPDO[0x607A] Target position, the given location of the program, must be added to the PDO configuration
TXPDO[0x6041] Statusword, must be added to PDO configuration
TXPDO[0x6061] Modes of operation display, must be added to PDO configuration
TXPDO[0x6064] Position actual value, must be added to PDO configuration
TXPDO[0x606C] Velocity actual value,must be added to PDO configuration
7.2 CSP mode
CSP (periodic synchronous position mode), whose motion trajectory is calculated by the upper computer,
periodically sends the target position to the slave station.
15 14 13 12 11 10 9 8
R om h
7 6 5 4 3 2 1 0
fr oms eo qs ev so
r r r
r = reserved(not corresponding) fr = fault reset
oms = operation mode specific eo = enable operation
(control mode is based on bit) qs = quick stop
h = halt ev = enable voltage
so = switch on
CSP mode does not use oms bit.
2) realted CSP control mode (monitor)
Index Sub-index Name Unit Range Data type Access PDO
6041h 00h Statusword - 0~65535 U16 ro TxPDO
15 14 13 12 11 10 9 8
R om h
7 6 5 4 3 2 1 0
6040h 00h
fr oms eo qs ev so
r r r
r = reserved(not corresponding) fr = fault reset
oms = operation mode specific eo = enable operation
(control mode is based on bit) qs = quick stop
h = halt ev = enable voltage
so = switch on
Csv mode doesn’t use oms bit.
2)Objects associated with CSV control mode (monitoring)
Index Sub-index Name Unit Range Data type Access PDO
6041h 00h Statusword - 0~65535 U16 ro TxPDO
Other related objects common to speed control.
15 14 13 12 11 10 9 8
r om h
7 6 5 4 3 2 1 0
6040h 00h
fr oms eo qs ev so
r r r
r = reserved(not corresponding) fr = fault reset
oms = operation mode specific eo = enable operation
(control mode is based on bit) qs = quick stop
h = halt ev = enable voltage
so = switch on
Cst mode doesn’t use oms bit.
2)Objects associated with CST torque control (monitoring)
Index Sub-index Name Units Range Data type Access PDO
6041h 00h Statusword - 0~65535 U16 ro TxPDO
6073h 00h Max current 0.1% 0~65535 U16 ro NO
15 14 13 12 11 10 9 8
r oms h
7 6 5 4 3 2 1 0
Fr oms eo qs ev so
r r start homing
r = reserved(not corresponding) fr = fault reset
oms = operation mode specific eo = enable operation
(control mode is based on bit) qs = quick stop
h = halt ev = enable voltage
so = switch on
Through the opening of bit4 (start homing) of 6040h (control word), obtain the parameters (timing method, speed,
acceleration and deceleration, etc.) associated with the origin reset position control mode (HM), and start the
action.
In addition, in the origin reset action, even if a new origin reset action (bit4 of 6040h is started again), the new
origin reset action is ignored.
Homing method(6098h)
Index Sub-index Name Range Data type Access PDO Op-mode
Homing
-128~127 I8 rw RxPDO All
method
Set the zero point reset method
Value Definition
-2 Reverse hitting homing
-1 Forward hitting homing
0 No homing method assigned
1 -Ve LS & Index Pulse
2 +Ve LS & Index Pulse
3 +Ve HS & Index Pulse direction reversal
4 +Ve HS & Index Pulse no direction changed
5 -Ve HS & Index Pulse direction reversal
6 -Ve HS & Index Pulse no direction changed
7 On +Ve HS -Index Pulse
8 On +Ve HS +Index Pulse
9 After +Ve HS reverse +Index Pulse
10 After +Ve HS +Index Pulse
11 On -Ve HS -Index Pulse
12 On -Ve HS +Index Pulse
13 After -Ve HS reverse +Index Pulse
14 After -Ve HS +Index Pulse
15 Reserved
6098h 00h
16 Reserved
17 Same as 1 without Index pulse
18 Same as 2 without Index pulse
19 Same as 3 without Index pulse
20 Same as 4 without Index pulse
21 Same as 5 without Index pulse
22 Same as 6 without Index pulse
23 Same as 7 without Index pulse
24 Same as 8 without Index pulse
25 Same as 9 without Index pulse
26 Same as 10 without Index pulse
27 Same as 11 without Index pulse
28 Same as 12 without Index pulse
29 Same as 13 without Index pulse
30 Same as 14 without Index pulse
33 On Index Pulse +Ve direction
34 On Index Pulse –Ve direction
35 Current postion = home
37 Current postion = home
+Ve: positive LS: Limit switch
-Ve: negative HS: Home switch
Homing speeds(6099h)
Index Sub-index Name Range Data Access PDO Op-mode
type
6099h - Homing speeds - - - - -
Set the speed in the home reset position control mode (HM).
00h Number of entries 2 U8 ro NO HM
Sub-Index number of 6099h (Homing speeds)
01h Speed during search 0~4294967295 U32 rw RxPDO HM
Set the speed of the action to be detected by the switch signal.
The maximum value is limited by any smaller one of the internal processing of 6080h (max
motor speed) and 2147483647.
02h Speed during search for 0~4294967295 U32 rw RxPDO HM
zero
Set the action speed to zero point detection.
If the edge of the switch signal is used as the origin detection position, in order to reduce the
detection error, please set a value as small as possible.
The maximum value is limited by the smaller side of the internal processing of 6080h (max
motor speed) and 2147483647.
When using in incremental mode, in order to initialize the location information before starting the normal action,
please execute the homing action.
After the origin position is detected, this position is used as the reference to initialize the following
objects (preset).
6062h(Position demand value)= 6064h(Position actual value)= 607Ch(Home offset)
6063h(Position actual internal value)= 60FCh(Position demand internal value)= 0
If the origin point reset is performed, the position information is initialized (preset). Therefore, it is
necessary to obtain the data based on the old location information again (touch probe location, etc.).
Whether 607Ch (home offset) is changed or not in the homing action, it is not reflected in the executing
homing action. The next homing action will be reflected (initialization of position information upon
completion).
607C (me offset) is only valid in homing mode 35 and 37.
If the edge of the switch signal (T, NOT, HOME) is used as the detection position of the origin, please
assign each clamping compensation pin to SI1, SI2, SI3. If it is not allocated correctly, an error will be
reported in the origin reset. (Note: P5-22 of DS5C2 series servo is the setting address of positive limit,
the default value is 1, the corresponding servo terminal is SI1; P5-23 is the setting address of negative
limit NOT, the default value is 2, the corresponding servo terminal is SI2; P5-27 is the setting address of
origin, the default value is 3, the corresponding servo terminal is SI3.)
In the Method diagrams described later, the meaning of below terms:
Index pulse Z phase signal of encoder
Home switch Theoretical signal state of near origin input(ME)
Positive limit Theoretical signal state of forward drive inhibit input(POT)
Negative limit Theoretical signal state of negative drive inhibit input(NOT)
After the update (sending) of action command and the operation enabled command, please input after
about 100 ms.
The following shows the timing of the HM control mode.
Method -1:
The servo motor first runs at a forward low speed with the set value of 6099h:02 (low speed for homing). After
hitting the mechanical limit position, if the absolute value of the torque reaches the upper limit of P9-17 (touch
stop homing torque threshold), and the absolute value of the speed is lower than the set value of P9-16 (touch stop
homing speed threshold), this state is maintained for the set time of P9-18 (touch stop homing time threshold), and
it is judged to have reached the mechanical limit position. Then it can be divided into two situations:
1 P7-20=0, and the number of quantitative pulses is 0. At this point, immediately stop the machine and
calibrate it as zero (position reset);
2 P7-20>0, the number of quantitative pulses is 0, and it runs in reverse at the setting homing low speed.
When encountering the rising edge of P7-20 Z-phase signals, it immediately stops and calibrates the zero
point (position reset).
3 P7-20=0, and the number of quantitative pulses is not 0. First, run in the forward direction at low speed
(6099h: 02), and after touching the mechanical point, run in the reverse direction at homing high speed
(6099h: 01). After the quantitative pulse length is reached, stop the machine and calibrate it as the zero
point (Ecat position is reset to zero);
4 P7-20>0, the number of quantitative pulses is not 0. First, run in the forward direction at low speed
(6099h: 02), and then run in the reverse direction at the set homing low speed (6099h: 02) when
encountering the mechnical origin, stop machine when encountering the rising edge of P7-20 Z-phase
signals. After stopping, run the quantitative pulse length at the homing high speed (6099h: 01), and then
stop the machine. Calibrate the zero point (Ecat position is reset).
Default Effective Suitable
Parameter Function Unit Range
value time mode
Ethercat homing find the Z phase EtherCAT
P7-20 - 1 -9999~9999 ○
numbers mode
The positive and negative values of the P7-20 parameters represent the direction of homing,
with positive values indicating the forward direction of finding the origin, negative values
indicating the reverse direction of finding the origin, and absolute values indicating the
number of Z-phase points for homing.
Method -2:
Similar to the previous homing action, running in the opposite direction.
Method 1:
When using this homing method 1, if the reverse limit switch is in a non triggered state, the initial direction of
movement is left. The first Z-phase pulse to the right of the position where the negative limit switch becomes
invalid at the origin position.
Method 2:
When using method 2, if the forward limit switch is not triggered, the initial movement direction is to the right.
The origin position is at the first Z-phase pulse to the left of the position where the forward limit switch becomes
invalid.
Method 3, 4:
Using method 3 or 4, the initial direction of movement depends on the state of the origin switch. The origin
position is on the reverse side of the origin switch or at the initial detected Z-phase position in the forward rotation
direction.
Method 5, 6:
Using method 5 or 6, the initial direction of movement depends on the state of the origin switch. The origin
position is on the reverse side of the origin switch or at the initial detected Z-phase position in the forward rotation
direction.
Method 7~14:
7-14 all use origin switches and Z-phase signals;
The initial action direction of modes 7 and 8 is negative if the origin switch is already activated at the beginning
of the action;
The initialization direction of modes 9 and 10 is positive if the origin switch is already activated at the beginning
of the action;
The initialization direction of modes 11 and 12 is positive if the origin switch is already activated at the beginning
of the action;
The initialization direction of modes 13 and 14 is negative if the origin switch is already activated at the beginning
of the action;
The final position returned to the origin is the Z-phase signal near the rising or falling edge of the origin switch.
Method 17:
This method is similar to Method 1.
The difference is that the origin detection position is not the index pulse, but the position where the Limit switch
changes. (Please refer to the following figure)
When NOT is not assigned, Homing error=1.
Method 18:
This method is similar to Method 2.
The difference is home detection position is not Index pulse. It is becoming the position where limit switch
changed.
When POT is not allocated, Homing error = 1.
(Please refer to the figure below)
Method 19,20:
These methods is similar to Method 3 and 4.
The difference is home detection position is not Index pulse. It is becoming the position where Home switch
changed.
When HOME is not assigned, homing error = 1.
(Please refer to the figure below)
Method 21,22:
These methods is similar to Method 5 and 6.
The difference is home detection position is not Index pulse. It is becoming the position where Home switch
changed.
When HOME is not assigned, homing error = 1.
(Please refer to the figure below)
Method 23,24,25,26:
These methods is similar to Method 7, 8, 9, 10.
The difference is home detection position is not Index pulse. It is becoming the position where Home switch
changed.
When HOME,POT is not assigned, homing error = 1.
(Please refer to the figure below)
Method 27,28,29,30:
These methods is similar to Method 11,12,13,14。
The difference is home detection position is not Index pulse. It is becoming the position where Home switch
changed.
When HOME,NOT is not assigned, homing error = 1.(Please refer to the figure below)
Method 33, 34:
Using methods 33 or 34, homing direction with negative or positive values, respectively. The original position is
located near Z in the selected direction.
(2) In the following status, if set point is executed (bit4 (new set-point) is changed from 0 to 1), please note that its
positioning task is revoked.
--6081h (profile speed) = 0.
(3) if the driving prohibition in deceleration is detected according to halt = 1, all the positioning tasks are invalid.
(4) start the PP action, and keep it for more than 2ms until the next PP action is started (new set-point changes
from 0 to 1).
After changing the 607Ah (target position) and 6081h (profile velocity), update the 607Ah (target position) and
6081h (profile velocity) simultaneously according to the above steps (1) - (4).
7.6.2 Common parameters
PP Control mode associated object(Command setting)
Register Explanation Unit
RXPDO[0x6040] Controlword -
RXPDO[0x6060] Control mode is PP(Profile position control
-
mode), set to 1
RXPDO[0x607A] Target position Command unit
RXPDO[0x6072] Max torque 0.1%
RXPDO[0x607F] Max profile velocity Command unit /s
RXPDO[0x6080] Max motor speed r/min
RXPDO[0x6081] Profile velocity Command unit /s
RXPDO[0x6083] Profile acceleration Command unit /s²
RXPDO[0x6084] Profile deceleration Command unit /s²
RXPDO[0x60C5] Max acceleration Command unit /s²
RXPDO[0x60C6] Max deceleration Command unit /s²
RXPDO[0x6065] Following error window Command unit
RXPDO[0x6066] Following error time out ms
RXPDO[0x6067] Position window Command unit
RXPDO[0x6068] Position window time ms
Note:
(1) 6081h (Profile velocity) is limited by the smaller of 607Fh (Max profile velocity) and 6080h (Max motor
speed.
(2) The set values of 607Fh (Max profile velocity) or 6080h (Max motor speed) are changed during the operation
and are not reflected in the operation.
PP control mode associated object(Command monitoring)
Register Explanation Unit
TXPDO[0x6041] Statusword -
TXPDO[0x6063] Position actual internal value Command unit
TXPDO[0x6064] Position feedback Command unit
TXPDO[0x606C] Velocity feedback Command unit /s
TXPDO[0x6077] Torque actual value 0.1%
TXPDO[0x60F4] Following error actual value Command unit
7.7 PV mode
PV(Profile speed control mode), specify the target speed, acceleration and deceleration, etc., and generate the
speed control mode of position command action in the servo driver.
Please use this control mode in the communication cycle of more than 500μs.
4) PV operations
Profile velocity control mode generates a velocity command value according to the following
parameters
Target velocity(60FFh)
Velocity offset(60B1h)
Profile acceleration(6083h)
Profile deceleration(6084h)
Target speed is 60FFh(Target velocity)
Speed feedforward is 60B1h(Velocity offset) cannot support now
The update (sending) of action command is that after the servo enable is turned on, please input it after
about 100ms.
As test information, provide 606Ch (velocity actual value), etc.
The 60FFh (target velocity) is limited by 607Fh (max profile velocity) and 6080h (max motor speed).
Torque type
Index Sub-index Name Unit Range Data type access PDO OP-mode
6087h 00h Torque slope 0.1 % 0~4294967295 U32 rw RxPDO tq
cst
• Set a parameter value for giving slope to a torque command.
• In the cyclic synchronous torque mode (cst), torque slope is effective only during the
deceleration stop sequence.
• When 0 has been set, the setting is regarded as 1 internally.
6088h 00h Torque profile type - -32768~32767 I16 rw RxPDO tq
Set the torque profile type used for changing in the torque
0:linear slope
1:Not supported
2)TQ control mode related objects(monitoring)
Index Sub-index Name Unit Range Data type Access PDO
6041h 00h Statusword - 0~65535 U16 ro TxPDO
6073h 00h Max current 0.1% 0~65535 U16 ro NO
Other objects commonly associated with torque control (monitoring)
Index Sub-index Name Unit Range Data Access PDO
type
6063h 00h Actual internal position pulse -2147483648~ I32 ro TxPDO
feedback 2147483647
6064h 00h Position feedback Command -2147483648~ I32 ro TxPDO
unit 2147483647
606Ch 00h Velocity feedback Command -2147483648~ I32 ro TxPDO
unit/s 2147483647
6074h 00h Torque command 0.1% -32768~32767 I16 ro TxPDO
6075h 00h Motor rated current 1mA 0~4294967295 U32 ro TxPDO
6076h 00h Motor rated torque Mn·m 0~4294967295 U32 ro TxPDO
6077h 00h Torque actual value 0.1% -32768~32767 I16 ro TxPDO
6078h 00h Current actual value 0.1% -32768~32767 I16 ro TxPDO
Other associated objects that share the same mode
Index Sub-index Name Unit Range Data access PDO
type
603Fh 00h Error code - 0~65535 U16 ro TxPDO
60B9h 00h Touch probe status - 0~65535 U16 ro TxPDO
60BAh 00h The rising edge clamping position Command -2147483648~ I32 ro TxPDO
of Touch probe 1 unit 2147483647
60BBh 00h The falling edge clamping position Command -2147483648~ I32 ro TxPDO
of Touch probe 1 unit 2147483647
60BCh 00h The rising edge clamping position Command -2147483648~ I32 ro TxPDO
of Touch probe 2 unit 2147483647
60BDh 00h The falling edge clamping position Command -2147483648~ I32 ro TxPDO
of Touch probe 2 unit 2147483647
The 6071h (target torque) value is 6072h (max torque), 2312h (P3-28), 2313h (P3-29), which is limited
by the minimum value.
The speed is limited by 6080h (max motor speed).
hm
0: after motor stop through (Sequence at Servo-off), migrate to Switch on disabled.
605Ah 00h 1: after motor stop through 609Ah (Homing acceleration), migrate to Switch on disabled.
2: after motor stop through 6085h (Quick stop deceleration), migrate to Switch on disabled.
3: after motor stop through 60C6h (Max deceleration), migrate to Switch on disabled.
5: after motor stop through 609Ah (Homing acceleration), migrate to Quick stop active.
6: after motor stop through 6085h (Quick stop deceleration), migrate to Quick stop active.
7: after motor stop through 60C6h (Max deceleration), migrate to Quick stop active.
cst, tq
0: after motor stop through servo side (Sequence at Servo-off), migrate to Switch on
disabled.
1, 2: after motor stop through 6087h (Torque slope), migrate to Switch on disabled.
3: after motor stop through torque 0, migrate to Switch on disabled.
5, 6: after motor stop through 6087h (Torque slope), migrate to Quick stop active.
7: after motor stop through torque 0, migrate to Quick stop active.
Deceleration stop examples according to the Quick stop command:
A: if 6040h: bit2 (control word: quick stop) changes from 1 to 0, it starts to slow down and stop.
The PDS status in deceleration changes to quick stop active.
B: the motor stops when the actual speed is less than 10r / min.
The PDS status after stopping is switch on disabled, or it changes to quick stop active.
hm
0: after motor stop through servo side (Sequence at Servo-off), migrate to Ready to switch
on.
1: after motor stop through 609Ah (Homing acceleration), migrate to Ready to switch on.
cst, tq
0: after motor stop through servo side (Sequence at Servo-off), migrate to Ready to switch
on.
605Bh 00h
1: after motor stop through 6087h (Torque slope), migrate to Ready to switch on.
hm
0: after motor stop through servo side (Sequence at Servo-off), migrate to Switch on
disabled.
1: after motor stop through 609Ah (Homing acceleration), migrate to Switch on disabled.
cst, tq
0: after motor stop through servo side (Sequence at Servo-off), migrate to Switch on
disabled.
1: after motor stop through 6087h (Torque slope), migrate to Switch on disabled.
hm
0: after motor stop through servo side (Sequence at Servo-off), migrate to Switched on.
1: after motor stop through 609Ah (Homing acceleration), migrate to Switched on.
cst, tq
0: after motor stop through servo side (Sequence at Servo-off), migrate to Switched on.
1: after motor stop through 6087h (Torque slope), migrate to Switched on.
The slowing down stop examples according to Disable operation command:
A: if receiving PDS command "Disable operation" to deceleration stop.
PDS status in deceleration remains operation enabled.
B: the motor stops when the actual speed is less than 10r / min.
The PDS status after stop is Switched on.
hm
1: after motor stop through 609Ah (Homing acceleration), keep Operation enabled.
2: after motor stop through 6085h (Quick stop deceleration), keep Operation enabled.
3: after motor stop through 6072h (Max torque), 60C6h(Max deceleration), keep Operation
enabled.
cst, tq
1, 2: after motor stop through 6087h (Torque slope), keep Operation enabled.
3: after motor stop through torque 0, keep Operation enabled.
Note:
(1) Probe function is not supported in HM mode.
(2) Currently, only external signals are supported as trigger sources.
(1) The clamping trigger signal uses external inputs (EXT1/EXT2), and P5-62 and P5-63 are terminal assignment
parameters for Touch Probe1 and Touch Probe2 functions. The default parameters for the driver probe function are
shown in the table above.
60B8h (Touch probe function)
Bit10 LT2 Bit2 LT1
0 EXT2 0 EXT1
1 Z phase 1 Z phase
(2) if the touch probe is executed to an unassigned port, E-883 (abnormal action protection) will occur.
(3) when the clamping trigger signal is an external input (EXT1/EXT2), the acquisition error occurs. Make the
speed near the clamp signal input as low as possible.
(4) the width of input ON and OFF of clamping trigger signal shall be more than 2ms respectively.
(5) in the following cases, touch probe is invalid (cancelled). (the value of 60B9h is cleared).
① when ESM status is init
② switch to HM mode
(6) for the same touch probe, please do not set the rising edge and the falling edge at the same time. The action of
setting the situation at the same time is unknown.
(7) it should be noted that it takes a certain time from the generation of external trigger signal to the reception of
signal by driver and the execution of latch operation. Therefore, the value of probe latch must have error with the
actual value, and the difference is related to the motor speed, hardware performance and software processing.
Positive edge
Negtive edge
(2) < Continuous mode >(60B8h:bit1=1 / bit9=1)
After startup, this mode clamps position for every trigger signal. The obtained value will be kept for the next
Probe signal.
Positive edge
Negtive edge
The following is mainly about setting the electronic gear ratio according to COE (CiA402).
The relationship between user-defined units (instruction units) and internal units (pulse) is calculated according to
the following equation.
Calculation formula of electronic gear ratio:
Note:
(1) The ratio of electronic gear is valid in the range of 8000 to 1/1000 times.
If the out of range value is saturated within the range, E-883 (abnormal action abnormal protection) occurs.
(2)608FH-01h (encoder increments) is automatically set according to the resolution of the encoder. The factory
value of 6092h-01h (feed) is set according to the resolution of encoder.
(3) The setting of electronic gear ratio is reflected by the following time sequence.
・When the power is put into operation
・When communication is established (ESM status Init → OP migration)
・When the original point is reset
・Absolute multi-turn zero clearing
(4) Please note that it does not reflect whether the set value of the associated object changes or not.
The position information initialization when Init ⇒ OP in absolute mode, please set the value of absolute encoder
position [pulse / unit] / electronic gear ratio within the range of - 2 ^ 31 (- 2147483648) ~ + 2 ^ 31-1
(2147483647). Actions outside this range are not guaranteed.
Please confirm the action range of absolute encoder position and gear ratio.
(5) Try to use the electronic gear ratio setting in Cia402 protocol.
Related parameter
Position encoder resolution(608Fh)
Index Sub-index Name Units Range Data Access PDO OP-
type mode
608Fh - Position encoder - - - - - -
resolution
The resolution of encoder is set automatically.
00h Highest sub-index - 2 U8 ro NO ALL
supported
Represents the Sub-Indexes of 608FH.
01h Encoder increments Pulse 1~4294967295 U32 ro NO ALL
Indicates the amount of encoder movement. Value is set automatically by the encoder
resolution.
02h Motor revolutions r(motor) 1~4294967295 U32 ro NO ALL
Indicates the number of motor rotations. The value is fixed to 1.
This object defines the encoder resolution for each revolution of the motor.
Position encoder resolution = Encoder increments(608Fh-01h)/ Motor revolutions (608Fh-02h)
This object is automatically set according to the information read out from the motor connected to the servo
driver.
Example: connection of 17 bit/r encoder
608Fh-01h(Encoder increments)= 130172
608Fh-02h(Motor revolutions)= 1
Position encoder resolution = 131072 / 1 = 131072
Gear ratio (6091h)
Index Sub- Name Units Range Data Access PDO OP-
index type mode
6091h - Gear ratio - - - - - -
Set gear ratio
00h Highest sub-index - 2 U8 ro NO ALL
supported
Represents the Sub-Indexes of 6091H.
01h Motor revolutions Pulse 1~4294967295 U32 rw NO ALL
Motor rotation numbers.
02h Shaft revolutions r(motor) 1~4294967295 U32 rw NO ALL
Shaft rotation numbers.
This object defines the number of motor revolutions and the number of shaft revolutions after gearbox output.
Gear ratio = Motor shaft revolutions(6091h-01h)/ Driving shaft revolutions(6091h-02h).
Feed constant(6092h)
Index Sub- Name Units Range Data Access PDO OP-
index type mode
Feed constant - - - - - -
-
Set the feed constant.
Highest sub-index
- 2 U8 ro NO ALL
00h supported
Represents the Sub-Indexes of 6091H.
6092h
Command
Feed 1~4294967295 U32 rw NO ALL
01h unit
Set the feed quantity.
Shaft revolutions r (motor) 1~4294967295 U32 rw NO ALL
02h
Set the shaft rotation number.
This object represents the action amount of shaft each revolution after the gearbox outputs.
Feed constant =Feed(6092h-01h)/ Driving shaft revolutions(6092h-02h).
7) Homing offset(607Ch)
Set the offset quantity of the mechanical origin offset after returning to the mechanical origin, and use this
position as the mechanical zero point. If it is set to 0, the mechanical origin will coincide with the mechanical zero
point. The origin offset can be set as a positive or negative number to indicate the left or right deviation from the
mechanical origin.
This object can be updated at any time, but it needs to reflect the actual location information through the following
time sequence.
・When the power is put into operation
・When communication is established (when ESM status is Init → OP migration)
・When the original point is reset
The position under the above time sequence is used as the reference to initialize(preset) the following objects
・ When the origin position is detected
6063h(Position actual internal value)=60FCh(Position demand internal value)=0
6062h(Position demand value)=6064h(Position actual value)=607Ch(Home offset)
・Initialization (preset) in time sequence other than the origin position is detected
6063h(Position actual internal value)=60FCh(Position demand internal value)
6062h(Position demand value)=6064h(Position actual value)
=6063h(Position actual internal value)+607Ch(Home offset)
Note: the above is the case when the electronic gear ratio is 1:1 and there is no polarity reversal.
Default
Parameter Meaning Unit Range Modify Effective
value
0: Direct alarm, using servo
deceleration shutdown method
P0-28.0 1: Alarm after decelerating and 2 - 0~3 ○ 1|3|4|8|9|10
stopping as 605Ah mode
2: Do not use overtravel
Prohibited status
Scenario 1:
When the servo is in an enabled not motion or disabled state and touches the reverse limit switch, the panel will
display NOT, cancel the reverse limit signal, and the panel will return to its previous state.
Scenario 2:
When the servo is in an enabled not motion or disabled state and touches the forward limit switch, the panel will
display POT, cancel the forward limit signal, and the panel will return to its previous state.
Scenario 3:
When the servo is in an enabled not motion or disabled state and simultaneously touches the forward and reverse
limit switches, the servo will report E-261. If two limit signals are cancelled, the panel will return to its previous
state; If any limit signal is cancelled, the panel will display another limit signal, which needs to be cancelled
before the panel can return to its previous state.
Overtravel status
P0-28 set to 1 (Alarm deceleration stop)
(1) Initial movement direction to the left, triggering the overtravel signal without occurrence of offside
Scenario 1: Failure to touch the forward limit switch
The initial direction of movement is left. When touching the rising edge of the reverse limit switch, the panel
display changes from RUN to NOT, triggering the reverse overtravel deceleration stop. The shaft stops on the
reverse limit switch, and the servo will report E-260. The alarm must be cleared to move the axis in the
forward direction. When it touches the falling edge of the reverse limit switch, the panel display can change
from NOT to RUN, and the reverse overtravel prohibition can be released.
Scenario 2: Before the axis deceleration stops, touch the forward limit switch
The initial direction of movement is left. When touching the rising edge of the reverse limit switch, the panel
display changes from RUN to NOT, triggering the reverse overtravel deceleration stop. Before the shaft stops,
if the forward limit switch is touched, the servo will report E-261. The forward limit switch must be
cancelled in order to clear the E-261 alarm. Otherwise, the alarm cannot be cleared. Then, the shaft moves
forward and touches the falling edge of the reverse limit switch. Only then can the panel display change from
NOT to RUN, and the reverse overtravel prohibition be released.
Scenario 3: When the shaft stops at the negative limit switch and touches the positive limit switch
The initial direction of movement is left. When touching the rising edge of the reverse limit switch, the panel
display changes from RUN to NOT, triggering the reverse overtravel deceleration stop. When the shaft stops
on the reverse limit switch, the servo will report E-260. At this time, if the forward limit switch is touched,
the servo will report E-261. The forward limit switch must be cancelled before the E-261 alarm can be
cleared. Otherwise, the alarm cannot be cleared. Then, when the shaft moves forward and touches the falling
edge of the reverse limit switch, the panel display can change from NOT to RUN, and the reverse overtravel
prohibition can be released.
Scenario 4: When touching the forward limit switch during axis forward movement
The initial direction of movement is left. When touching the rising edge of the reverse limit switch, the panel
display changes from RUN to NOT, triggering the reverse overtravel deceleration stop. When the shaft stops
on the reverse limit switch, the servo will report E-260. After clearing the alarm to make the shaft move
forward, if the forward limit switch is touched, the servo will report E-261. The forward limit switch must be
cancelled before the E-261 alarm can be cleared. Otherwise, the alarm cannot be cleared. Continue to move
the shaft forward, touch the falling edge of the reverse limit switch, and the panel display can change from
NOT to RUN to release the reverse overtravel prohibition.
(2) The initial movement direction is to the left, triggering an overtravel signal and out of range occured
Scenario 1: Without touching the forward limit switch while offside
The initial direction of movement is to the left. When touching the rising edge of the reverse limit switch, the
panel display changes from RUN to NOT, triggering the reverse overtravel deceleration stop. However, the
axis crosses the reverse limit switch and triggers the falling edge of the reverse limit switch. The axis stops
outside the limit, and the servo will report E-260. The alarm must be cleared to make the axis move forward.
Touch the rising and falling edges of the reverse limit switch again before the panel display can change from
NOT to RUN, and the reverse overtravel prohibition can be released.
Scenario 2: In the case of offside, touch the forward limit switch before the axis deceleration stop is completed
The initial direction of movement is left. When touching the rising edge of the reverse limit switch, the panel
display changes from RUN to NOT, triggering the reverse overtravel deceleration stop. However, the axis crosses
the reverse limit switch and triggers the falling edge of the reverse limit switch. Before the shaft stops, if the
forward limit switch is touched, the servo will report E-261. The forward limit switch must be cancelled in order
to clear the E-261 alarm. Otherwise, the alarm cannot be cleared. Then, the shaft moves forward and touches the
rising and falling edges of the reverse limit switch again. Only then can the panel display change from NOT to
RUN, and the reverse overtravel prohibition be released.
Scenario 3: In the case of offside, when the shaft stops, touch the forward limit switch
The initial direction of movement is left. When touching the rising edge of the reverse limit switch, the panel
display changes from RUN to NOT, triggering the reverse overtravel deceleration stop. However, the axis
crosses the reverse limit switch and triggers the falling edge of the reverse limit switch. When the shaft stops,
the servo will report E-260. At this time, if the forward limit switch is touched, the servo will report E-261.
The forward limit switch must be cancelled before the E-261 alarm can be cleared. Otherwise, the alarm
cannot be cleared. Then, the shaft will move forward and touch the rising and falling edges of the reverse
limit switch again. Only then can the panel display change from NOT to RUN, and the reverse overtravel
prohibition be released.
Scenario 4: In the case of offside, touching the forward limit switch during axis forward movement
The initial direction of movement is left. When touching the rising edge of the reverse limit switch, the panel
display changes from RUN to NOT, triggering the reverse overtravel deceleration stop. However, the axis
crosses the reverse limit switch and triggers the falling edge of the reverse limit switch. When the shaft stops,
the servo will report E-260. After clearing the alarm to move the shaft forward, if the forward limit switch is
touched, the servo will report E-261. The forward limit switch must be cancelled before the E-261 alarm can
be cleared. Otherwise, the alarm cannot be cleared. Continue to move the shaft forward, touch the rising and
falling edges of the reverse limit switch again, and the panel display can change from NOT to RUN to release
the reverse overtravel prohibition.
For specific information on 60FDh, please refer to Chapter 7.9.4 Digital Input (60FDh)
For specific information on 60FEh, please refer to Chapter 7.9.5 Digital Output (60FEh)
3770 and later versions have added an external terminal emergency alarm function. When this function is
enabled, if the terminal signal is conductive, the driver will generate an alarm E-320. The driver can be used
in cascade, and by connecting the alarm output to this functional terminal of the next driver, a cascade alarm
can be triggered.
New function parameter P5-68, default setting of P5-68 to 0:
Default
Parameter Meaning Unit Range Modify Effective
value
Terminal emergency
P5-68 0 - 00~ff Anytime At once
alarm function
8 Object dictionary
This chapter mainly introduces the object dictionary area allocation, COE communication area, driver profile area
and so on.
Bit Contents
0 Not support
1
2
3
4 AL status code defined alarm occured*1
5 Not support
6 Reserved
7 AL status code undefined alarm occured*2
*1: “AL status code defined alarm” refers to abnormal communication association of
EtherCAT E-800~7, E-810~7, E-850~7.
*2: “AL status code undefined alarm” refers to abnormal communication association of
EtherCAT E-880~7 and abnormal except EtherCAT communication association.
1008h 00h Manufacturer Device name - - ro TxPDO All
Represents the device name.
1009h 00h Manufacturer Hardware - - ro TxPDO All
version
Indicates the hardware version.
Index Sub-index Name/Description Range DateType Access PDO Op-mode
1018h 00h Number of entries 0~255 U8 ro TxPDO All
Represents the object subindexes. The value is fixed to 04H.
01h vendor ID 0~4294967295 U32 ro TxPDO All
Indicates the manufacturer ID of EtherCAT. The value is fixed to 00000556h.
02h product code 0~4294967295 U32 ro TxPDO All
Represents the product code. The value is 10305070h.
03h Revision umber 0~4294967295 U32 ro TxPDO All
Indicates the product version number. The value is 02040608h.
04h Divece type 0~4294967295 U32 ro TxPDO All
Indicates the product serial number. The value is 00000000h.
Index Sub-index Name Unit Data range Data type Flag PDO
Encode Single turn Position -2147483648
5000h 00h - I32 ro TxPDO
~ 2147483647
Encode MultRevolutions -2147483648~
5001h 00h - I32 ro TxPDO
2147483647
Index Sub-index Name Unit Data range Data type Flag PDO
ModeSwitch Deceleration
5002h 00h - 0~65535 U16 rw RxPDO
time
After migrating to Operation enabled, please increase the time to more than 100ms and input the action command.
The following table shows the PDS state migration events (migration conditions) and actions during migration.
For the migration of PDS, the status migration is performed at the same time as the handshake is obtained
(through 6041h: Statusword, confirm the status has been converted, and then send the next migration instruction).
Bit11(internal limit active): the main reason for the internal limit is that the bit11 (internal limit active) of 6041h
(status word) changes to 1.
Bit15,14(reserved): This bit is not used (fixed 0).
Because 6060h (modes of operation) is default = (no mode change / no mode assigned), please set the control
mode value to be used after the power is put into operation. When the set value of 6060h is 0 and the set value of
6061h is 0, if the PDS state is migrated to Operation enabled, E-881 (control mode setting fault protection) occurs.
After the initial state of 6060h = 0 (no mode assigned) is transferred to the supported control mode (PP, PV, TQ,
HM, CSP, CSV, CST), set 6060h = 0 is seemed as "no mode changed", and the control mode can not be switched.
(keep the previous control mode).
9.2.2 Notes
or
At this point, start action, under the condition of P0-05 = 0 (initial positive direction), if press INC, then turn
forward and then reverse; if press DEC, turn reverse and then forward. If the inertia identification is successful,
the load inertia ratio is prompted and written to P0-07 automatically after several forward and reverse operations.
If the inertia identification error occurs, the error code will be displayed. Press STA/ESC key to exit the panel
inertia identification operation.
Note:
(1) If the auto-tuning interface is closed directly, the driver only configures inertia ratio parameters.
(2) The detailed steps of XinJeServo's presumptive inertia refer to XinJeServo's help document.
9.3 Fast adjustment
9.3.1 Overview
Fast adjustment needs to set the moment of inertia of load first, then turn off the adaptive function. If the inertia
does not match, it will cause oscillation alarm. Servo firmware version 3640 and later versions support this
function, and the version is viewed through U2-07. Fast adjustment of gain parameters belongs to auto-tuning
mode.
9.3.4 Notes:
In the fast adjustment mode, the gain parameters corresponding to the rigidity level can be
independently fine tuned.
The quick adjustment mode will be configured with a rigid level by default. If the gain does not meet
the mechanical requirements, please gradually increase or decrease the setting.
To ensure stability, the model loop gain is given relatively small at low rigidity levels. When there are
high response requirements, this parameter value can be increased separately.
When vibration occurs during rapid adjustment, the torque command filter P2-35 can be modified. If
there is no effect, mechanical characteristic analysis can be used to set relevant notch parameters (refer
to 9.7 Vibration Suppression).
9.4 Auto-tuning
9.4.1 Overview
Auto-tuning is divided into internal instruction auto-tuning and external instruction auto-tuning.
Auto-tuning (internal instruction) refers to the function of automatic operation (forward and reverse reciprocating
motion) of servo unit without instructions from the upper device and adjusting according to the mechanical
characteristics in operation.
Auto-tuning (external instruction) is the function of automatically optimizing the operation according to the
instructions from the upper device.
The automatic adjustments are as follows:
Load moment of inertia
Gain parameters (speed loop, position loop, model loop gain)
Filter (notch filter, torque instruction filter)
9.4.2 Notes
Untunable occasions
Mechanical systems can only operate in one direction.
3. Press ENTER, panel display iat--; servo is in enabled status right now;
4. Press INC or DEC, panel display is tune and flashing, enter auto-tuning status.
5. Driver will automatically send pulse instructions, if the auto-tuning is successful, the panel shows done and
flashing.
Note: In the process of auto-tuning, press STA/ESC will exit the auto-tuning operation and use the gain
parameters at the exit time. If auto-tuning fails, it is necessary to initialize the driver before auto-tuning again.
Auto-tuning Description
mode
Make a soft gain adjustment. Besides gain adjustment, notch filter is automatically
Soft adjusted.
Make special adjustment for positioning purpose. Besides gain adjustment, the
Fast positioning model loop gain and notch filter are automatically adjusted.
Fast positioning In the use of positioning, we should pay attention to adjusting without overshoot.
(control Besides gain adjustment, the model loop gain and notch filter are automatically
overshoot) adjusted.
Rigid It is suitable for the adjustment of rigid body system and other mechanisms with
connection higher rigidity.
6. Start auto-tuning
Press ENTER, if the enable is not open, the panel displays Son and flickers, waiting for the enabler to open, if the
enabler has been opened, skip this step;
Servo enable, the panel displays tune and flickers, enter auto-tuning status.
The upper device starts to send pulse, if the auto-tuning is successful, it displays done and flickers.
Auto-tuning Description
mode
Make a soft gain adjustment. Besides gain adjustment, notch filter is automatically
Soft adjusted.
Make special adjustment for positioning purpose. Besides gain adjustment, the model
Rapid
positioning loop gain and notch filter are automatically adjusted.
Rapid In the use of positioning, we should pay attention to adjusting without overshoot.
positioning Besides gain adjustment, the model loop gain and notch filter are automatically
(control adjusted.
overshoot)
Rigid It is suitable for the adjustment of rigid body system and other mechanisms with
connection higher rigidity.
6. Start auto-tuning automatically
Note: P2-60~P2-63 are automatically modified in auto-tuning process. Users are not allowed to modify them
manually. Manual modification may lead to the risk of system runaway.
9.5 Manual adjustment
9.5.1 Overview
Parame Default
Name Unit Range Modify Effective
ter setting
Speed loop integration
P1-01 3300 0.01ms 15~51200 Anytime At once
time constant
Position loop gain
When the model loop is invalid (P2-47.0=0), the responsiveness of the position loop of the servo unit is
determined by the gain of the position loop. The higher the position loop gain is, the higher the responsiveness is
and the shorter the positioning time is. Generally speaking, the gain of position loop cannot be increased beyond
the natural vibration number of mechanical system. Therefore, in order to set the position loop gain to a larger
value, it is necessary to improve the rigidity of the machine and increase the number of inherent vibration of the
machine.
Default
Parameter Meaning Unit Range Modify Effective
setting
P1-02 Position loop gain 200 0.1/s 10~20000 Anytime At once
Torque command filtering time constant
When machine vibration may be caused by servo drive, it is possible to eliminate vibration by adjusting the
filtering time parameters of the following torque instructions. The smaller the numerical value, the better the
response control can be, but it is restricted by the machine conditions. When vibration occurs, the parameter is
generally reduced, and the adjustment range is suggested to be 10-150.
9.6 Adaptive
9.6.1 Overview
Adaptive function means that no matter what kind of machine and load fluctuation, it can obtain stable response
through automatic adjustment. It starts to automatically adjust when servo is ON.
9.6.2 Notes
When the servo unit is installed on the machine, it may produce instantaneous sound when the servo is
ON. This is the sound when the automatic notch filter is set, not the fault. For the next time the servo is
ON, no sound will be emitted.
When the inertia of the motor exceeds the allowable load, the motor may produce vibration. At this time,
please modify the adaptive parameters to match the present load inertia.
In adaptive operation, in order to ensure safety, the adaptive function should be executed at any time
when the servo enablement can be stopped or turned off urgently.
Default
Parameter Meaning Modify Effective
setting
n.□□□0 Adaptive shutdown Re-power
P2-01 n.□□□1 Servo bb
n.□□□1 Adaptive open on
Default
Parameter Meaning Modify Effective
setting
n.0□□□ Adaptive small inertia mode
P2-03 n.0□□□ Servo bb Re-power on
n.1□□□ Adaptive large inertia mode
Default
Parameter Meaning Modify Effective
setting
P2-05 Adaptive speed loop gain 400Note 1 Servo bb Re-power on
P2-10 Adaptive speed loop integral 500 Servo bb Re-power on
P2-11 Adaptive position loop gain 100 Servo bb Re-power on
P2-07 Adaptive inertia ratio 0 Servo bb Re-power on
P2-08 Adaptive speed observer gain 60 Servo bb Re-power on
P2-12 Adaptive stable max inertia ratio 30 Servo bb Re-power on
P2-16 Adaptive motor rotor inertia coefficient 100 Servo bb Re-power on
P2-19 Adaptive bandwidth 50 Note 2
Anytime At once
P6-05 Adaptive large inertia mode speed loop gain 200 Servo bb Re-power on
P6-07 Adaptive large inertia mode inertia ratio 50 Servo bb Re-power on
Adaptive large inertia mode speed observer
P6-08 40 Servo bb Re-power on
gain
P6-12 Adaptive large inertia mode max inertia ratio 50 Servo bb Re-power on
Note 1:The default value of 750W and below DS5series servo is 400. The default value of other power is 200.
Note 2: The default value of 400W and below DS5 series servo drivers is 70; The default value of other power is
50.
Motor
Inertia Parameter
flange
Within 20 times inertia Adaptive small inertia mode(default parameters)
20~30 times inertia Set P2-08=50, P2-12=40
40~90 30~40 times inertia Set P2-08=50, P2-12=40, P2-07=10
flange 40~50 times inertia Set P2-08=50, P2-12=40, P2-07=30
Switch to adaptive large inertia mode or set
50~80 times inertia
P2-08=40,P2-12=50,P2-07=50
Within 10 times inertia Adaptive small inertia mode (default parameters)
110, 130 10~15 times inertia Set P2-08=50, P2-12=40
flange Switch to adaptive large inertia mode or set P2-08=40, P2-12=50,
15~20 times inertia
P2-07=50
Within 5 times inertia Adaptive small inertia mode (default parameters)
180 and
5~10 times inertia Set P2-08=50, P2-12=40
above
flange Switch to adaptive large inertia mode or set P2-08=40, P2-12=50,
10~20 times inertia
P2-07=50
Note: The large inertia parameters can still drive a smaller inertia load. For example, when the parameters of 50
times inertia are used in the mechanism of 20 times inertia, only the response will become worse.
Note:
(1) Servo responsiveness will change after vibration suppression operation.
(2) Please set the inertia ratio and gain parameters correctly before performing the vibration suppression operation,
otherwise it can not be controlled properly.
2. Press 【ENT】 to enter torque setting interface, it will show the current setting torque, which is the value of
P6-89. Press【▲】,【▼】to increase or decrease torque command. When increasing the torque command, it is
recommended to increase it a little bit to avoid severe vibration of the equipment.
3. After setting the torque command, long press【ENT】, enter “read to enable” status, it will show ‘F”.
5. Press【▲】【▼】 , to run forward or reverse and find the resonance frequency. “E_FFt” will shining on the panel
when operation. If the resonance frequency is found, it will show “Fxxxx”, “xxxx” is the resonance frequency. If
failed, it will show “F----”.
6. Whatever it shown “Fxxxx” or “F----”, press【 ▲】,【▼ 】 can find the resonance frequency again. If the
resonance frequency is found, long press【EN】to set the resonance frequency in the notch filter of servo driver.
Note: for above each step, press STA/ESC can return to the last step, press STA to exit.
2. Set the filter width (to see resonance frequencies clearly), find the resonance frequency;
3. Notch parameters need to be set manually. Refer to 9.7.6 notch filter for details.
As an example, through the analysis of mechanical characteristics, the resonance frequency is 328 Hz, and the
third notch filter can be used. The parameters are as follows:
P2-69 = n.1000 , P2-77 = 328
Note: In both adaptive and auto-tuning modes, if mechanical characteristic analysis is used, the notch can be set
manually. If there are multiple resonance points, the third to fifth notch can be configured in turn.
The servo driver has five sets of notch filters, each with three parameters, notch frequency, notch attenuation and
notch bandwidth. The first and second notches are set automatically, and the third, fourth and fifth are set
manually.
The torque instruction filter and notch filter are in series in the system. As shown in the figure below, the switch of
the notch filter is controlled by P2-69 and P2-70.
Default
Parameter Meaning Modify Effective
setting
n.□□□0 First notch off
n.□□□0 Anytime At once
n.□□□1 First notch on
n.□□0□ Second notch off
P2-69 n.□□0□ Anytime At once
n.□□1□ Second notch on
n.0□□□ Third notch off
n.0□□□ Anytime At once
n.1□□□ Third notch on
n.□□□0 Fourth notch off
n.□□□0 Anytime At once
n.□□□1 Fourth notch on
P2-70
n.□□0□ Fifth notch off
n.□□0□ Anytime At once
n.□□1□ Fifth notch on
Default
Parameter Meaning Unit Range Modify Effective
setting
P2-71 First notch frequency 5000 Hz 50~5000 Anytime At once
P2-72 First notch attenuation 70 0.1dB 50~1000 Anytime At once
P2-73 First notch bandwidth 0 Hz 0~1000 Anytime At once
P2-74 Second notch frequency 5000 Hz 50~5000 Anytime At once
P2-75 Second notch attenuation 70 0.1dB 50~1000 Anytime At once
P2-76 Second notch bandwidth 0 Hz 0~1000 Anytime At once
P2-77 Third notch frequency 5000 Hz 50~5000 Anytime At once
P2-78 Third notch attenuation 70 0.1dB 50~1000 Anytime At once
P2-79 Third notch bandwidth 0 Hz 0~1000 Anytime At once
P2-80 Fourth notch frequency 5000 Hz 50~5000 Anytime At once
P2-81 Fourth notch attenuation 70 0.1dB 50~1000 Anytime At once
P2-82 Fourth notch bandwidth 0 Hz 0~1000 Anytime At once
P2-83 Fifth notch frequency 5000 Hz 50~5000 Anytime At once
P2-84 Fifth notch attenuation 70 0.1dB 50~1000 Anytime At once
P2-85 Fifth notch bandwidth 0 Hz 0~1000 Anytime At once
Note:
1. In the adaptive mode, if the vibration is detected, the second notch filter will be automatically configured.
2. In the auto-tuning mode, the second and first notches will be automatically configured if the vibration is
detected (the second notches will be preferentially opened when there is only one vibration point).
3. Whether in self-adaptive or auto-tuning mode, if the mechanical characteristic analysis is sued, it belongs to
manual setting of notches, please configure the third to fifth notches.
When the self-tuning mode is soft, the model loop function will be automatically off. When the
self-tuning mode selects fast positioning or fast positioning (control overshoot), the model loop
function will be automatically turned on.
Self-tuning mode
Defult
Parameter Meaning Modify Effective
setting
n.□□□1 Soft
n.□□□2 Fast positioning
P2-02 n.□□□3 Anytime At once
Quick positioning (control
n.□□□3
overshoot)
Selection of self-tuning mode:
(1) Soft(P2-02.0=1)
This mode does not turn on the gain of the model loop, and the operation is soft. It is suitable for
occasions with insufficient mechanical rigidity and low response requirements.
(2) Quick positioning (P2-02.0 = 2)
This method has the fastest response to setting parameters, but has no special suppression on overshoot.
(3) Quick positioning (control overshoot) (P2-02.0 = 3):
In this way, the setting parameter response is fast, which will inhibit the overshoot.
Self-tuning Explanation
mode
Soft gain adjustment. In addition to gain adjustment, the notch filter is also adjusted
Soft
Automatically.
Fast Make special adjustment for positioning purpose. In addition to gain adjustment, the
positioning model loop gain and notch filter are also adjusted automatically
Fast Pay attention to the adjustment of no overshoot in the positioning purpose. In
positioning addition to gain adjustment, the model loop gain and notch filter are also adjusted
(control automatically.
overshoot)
Default
Parameter Meaning Modify Effective
setting
n.□□□1 Soft
P2-02 n.□□□2 Fast positioning n.□□□3 Anytime At once
n.□□□3 Fast positioning(control overshoot)
Taking DS5 series servo auto-tuning mode and using 750W servo 5 times load inertia as an example:
Model loop function turns off (soft mode)
Low rigidity and low response High rigidity and medium response
Default
Parameter Meaning Modify Effective
setting
n.□□□0 Turn off disturbance observer
P2-00 n.□□□0 Servo bb At once
n.□□□1 Turn on disturbance observer
Default Setting
Parameter Meaning Unit Modify Effective
setting range
Disturbance
P2-41 85 % 0~100 Anytime At once
observer gain
For power ranges of 22P6 and below, Asr P/PI mode switching is enabled by default, i.e. P1-26.0=1, and Asr P/PI
mode switching is performed based on P1-27 torque command exceeding 200%.
Note: P1-31=0, the speed loop is equivalent to PI control; P1-31=100, the speed loop is equivalent to IP control.
9.9 Gain adjustment
9.9.1 Load shaking
The following reasons cause load to shake
1. The instruction is not smooth enough when the load inertia is too large.
Solutions:
(1) Use position instruction smoothing filter P1-25;
(2) Optimizing the instructions of the upper device to reduce the acceleration of the instructions;
(3) Replace the motor with greater inertia.
9.9.2 Vibration
The following causes cause machine vibration:
(1) Vibration due to inappropriate servo gain
Solutions: Reduce gain
9.9.3 Noise
In adaptive mode:
(1) Inappropriate servo gain
Solutions: Reduce the adaptive control bandwidth (P2-19).
In auto-tuning mode:
(1) Inappropriate servo gain
Solutions: Under the mode of rapid adjustment, reduce the rigidity level.
E-851 RxPDO The data size of RxPDO map is set up RxPDO data size is set up within 32
assignment error exceeding 24 bytes. bytes.
Alarm
Reasons Solution
code
protection The servo alarm can be cleared by
ESM state after alarm: PreOP setting SM2013+20 * (N-1) or by
ESC register AL Status Code:0025h servo panel F0-00=1.
E-881 Control mode - The PDS state was changed to “Operation Check preset value of 6060h(Modes
setting error enabled” when the value set to 6060h (Modes of operation).
protection of operation) is 0 and the value set to 6061h The servo alarm can be cleared by
(Modes of operation display) is 0. setting SM2013+20 * (N-1) or by
servo panel F0-00=1.
Unsupported control mode is set to 6060h
(Modes of operation).
A control mode other than position control is
set to 6060h (Modes of operation) in
full-closed control.
FF**h
Alarm (main) No. (00h ~ FFH)
(Example) FF03h … 03h = 3d E-030 (overvoltage protection) occurs
FF55h … 55h = 85d E-850 (TxPDO configuration error protection), E-851 (RxPDO
configuration error protection)
any one of them occurs
As an exception, A000h is displayed in the case of E-817 (Syncmanager 2/3 setting error).
Alarm code can also be read through SDO instruction. U1-00 corresponding object dictionary is 0x3100. The
command is as follows:
Read the value in slave object dictionary 0x3100: 00 (current alarm code) with station number 0 to register D0.
(Refer to XDH/XLH motion control manual for the specific use of this instruction)
Method ②: carry out abnormal (alarm) clearing by servo driver (panel F0-00, upper computer software).
After the alarm is cleared, the PDS status is transferred from Fault to Switch on disabled.
Method ③: the external alarm clear input (A-CLR) of servo driver changes from OFF state to ON state.
After the alarm is cleared, the PDS status is migrated from Fault to Switch on disabled.
Method ④: Clear the alarm through SDO instruction. The object dictionary corresponding to F0-00 is 0x4000.
The command is as follows:
The DS5C2 driver's network interface plug-in follows the standard of bottom in and top out. For example, the
network cable from the master station is connected to the second network interface in front of the first driver, and
the network cable from the first network interface is connected to the second network interface in front of the
second driver, and so on.
② Click【Expert process data】→【PDO assign】, select 1600, 1A00. (The default configuration can meet the basic
use of CSP. If necessary, other PDO parameters can be added.)
③ Confirm 6060h value is 8 in【Lauch parameters】.
There are three default configurations in the startup parameters, among which 6060h is the slave operation mode,
with a default value of 8 (CSP mode); 60C2-1 and 60C2-2 are synchronization unit cycles, 60C2-1 is the value of
synchronization unit cycle, and 60C2-2 is the unit of synchronization unit cycle. For example, the default
synchronization unit cycle is 100 × 10-5s, which is 1000us. (This parameter will automatically change with the
synchronization cycle of the main station configuration and does not require manual modification).
⑥ After the activation is completed, the slave station state machine (SD8021) will change state from 1 → 2 → 4
→ 8, 8 means OP state. At this time, both SDO and PDO can receive and send messages.
⑦ Confirm that the instruction channel (SFD8001+300*N) in the axis configuration parameters is Ethercat
(register value is 0).
⑧ In CSP mode, the current given position can be monitored through HD10002 (mapping of 607Ah), the current
actual position of the motor can be monitored through HD10012 (mapping of 6064h), and the current actual speed
can be monitored through HD10014 (mapping of 606Ch).
When M20 goes from OFF to ON, perform periodic position control on the axis specified by HD300. After
successful execution, M21 is set to ON to indicate that the axis is in a periodic control state. By periodically
assigning values to HD300, control of the axis is achieved.
Before triggering the command, please ensure that the value of HD300 is the same as the current position,
otherwise the position will generate a step.
Periodic position control requires periodic writing of the target position value into the register, with no
significant changes in position, to avoid causing the axis to fly due to a large difference between the given
cycle position and the previous cycle position.
⑦ After enabling ON, HD10000 (mapping of 6040h) will indicate the slave enable status from 6 → 7 → 15,
which can be assigned a value to HD10004 (mapping of 60FFh) as the given speed in CSV mode (real-time speed
interpolation can be achieved by modifying HD1004 in I9900 interrupt).
⑧ In CSV mode, the current given speed can be monitored through HD10004 (mapping of 60FFh), the current
actual position of the motor can be monitored through HD10012 (mapping of 6064h), and the current actual speed
can be monitored through HD10014 (mapping of 606Ch).
3) CST mode operation example
Register Explanation Unit
RXPDO[0x6071] Target torque 0.1%
TXPDO[0x6064] Position actual value Command unit
TXPDO[0x606C] Velocity actual value Command unit/s
TXPDO[0x6077] Torque actual value 0.1%
RXPDO[0x6080] Max motor speed r/min
RXPDO[0x6060] Set to 10 -
② Click【Expert process data】→【PDO list】, select 1600, 1A00. The default configuration can meet the basic
use of CST. If necessary, other PDO parameters can be added. For example, add 6080h to modify max motor
speed and limit the torque.
③ Confirm 6060h value in【Launch parameters】is 10.
⑤ After setting all the parameters, click【write】→【activate】→【OK】. The parameters will take effect after
the activation is successful.
⑥ After the activation is completed, the slave station state machine (SD8021) will change state from 1 → 2 → 4
→ 8, 8 means OP state. At this time, both SDO and PDO can receive and send messages.
⑦ After enabling ON, HD10000 (mapping for 6040h) will indicate the slave enable state from 6 → 7 → 15,
which can be assigned a value to HD10006 (mapping for 6071h) as the given torque in CST mode.
⑧ In CST mode, the current given torque can be monitored through HD10006 (mapping of 6071h), the current
actual position can be monitored through HD10012 (mapping of 6064h), the current actual speed can be
monitored through HD10014 (mapping of 606Ch), the current actual torque can be monitored through HD10016
(mapping of 6077h), and the maximum motor speed can be limited through 6080h.
Note: After adding the speed limit parameter, ensure that the speed limit is within the appropriate range during
operation.
4) HM mode operation example
HM control mode related objects
Register Explanation Unit
RXPDO[0x6040] Control word, modify control word to enable homing -
RXPDO[0x6098] Homing mode -
RXPDO[0x609A] Homing acceleration speed Command
unit/s²
The control mode is HM mode (i.e. homing mode), and its value is
RXPDO[0x6060] -
set to 6 when the motor is not enabled
SDO[0x6099] Homing speed, modify online through COE-Online Command
unit/s
① Terminal assignment is performed. P5-22 is the positive limit setting address, and the default value is 1, related
to servo terminal SI1. P5-23 is the setting address of the reverse limit, and the default value is 2, related to servo
terminal SI2, P5-27 is the origin setting address, and the default value is 3, related to servo terminal SI3.
② Click【scan】or【add】in the EtherCAT interface,【general】interface please use default settings.
⑥ After setting all the parameters, click【write】→【activate】→【OK】. The parameters will take effect after
the activation is successful.
⑦ After the activation is completed, the slave station state machine (SD8021) will be from 1 → 2 → 4 → 8, 8
means OP status. At this time, both SDO and PDO can receive and send messages.
⑧ After the state is switched to OP, the homing speed and acceleration can be modified through COE-Online.
⑨ Set the homing mode (6098h).
This setting range is -2~37 (currently supports methods -2~14, 17~30, 33, 34, 35, 37).
⑩ After enabling ON, HD10000 (6040h mapping) will go from 6 → 7 → 15 to indicate the slave station's
enabled state, and then HD10000 (6040h mapping) will go from 15 → 31 to enable the homing. During the
homing process, if the origin signal is triggered, it will slow down and stop according to the corresponding way of
homing. To homing again, first change 6040h to 15, and then HD10000 (mapping of 6040h) 15 → 31.
① Click【scan】or【add】in the EtherCAT interface, function module please set to user define in【general】
interface.
② Click【Expert process data】→【PDO list】, select 1600, 1A00. PDO parameters associated with the mode can
be added (1600 and 1A00 can not add more than 32 bytes respectively).
③ Confirm 6060h value【launch parameters】is 1.
⑥ After the activation is completed, the slave station state machine (SD8021) will from 1 → 2 → 4 → 8, 8
means OP status. At this time, both SDO and PDO can receive and send messages.
⑦ Modify the control word 6040 (absolute mode: 6 → 15 → 31, relative mode: 6 → 79 → 95) to enable the
slave station to move the motor by setting the target position, target speed, acceleration and deceleration and other
parameters.
⑧ In PP mode, data can be monitored through I/O mapping address setting. For example, the control word of
axis 1 can be modified through HD10000 (mapping of 6040h), the motor can be enabled or disabled, and the
given position of current axis 1 can be monitored through HD10004 (mapping of 607Ah).
6) PV mode operation example
pv control mode related object (command・setting)
Register Explanation Unit
RXPDO[0x6040] Control word -
RXPDO[0x6060] Set to 3 -
RXPDO[0x60FF] Target velocity Command unit/s
RXPDO[0x6072] Max torque 0.1%
RXPDO[0x607F] Max Profile velocity Command unit /s
RXPDO[0x6080] Max motor speed r/min
RXPDO[0x6083] Profile acceleration Command unit /s²
RXPDO[0x6084] Profile deceleration Command unit /s²
RXPDO[0x60C5] Max acceleration Command unit /s²
RXPDO[0x60C6] Max deceleration Command unit /s²
RXPDO[0x606D] Velocity window Command unit /s
RXPDO[0x606E] Velocity window time ms
RXPDO[0x606F] Velocity threshold Command unit /s
RXPDO[0x6070] Velocity threshold time ms
② Click【Expert process data】→【PDO list】, select 1600, 1A00. PDO parameters associated with the mode can
be added (1600 and 1A00 can not add more than 32 bytes respectively)
③ Confirm the 6060h value in【Lanuch parameter】is 3.
④【IO mapping】The starting address can be customized and modified.
⑤ After configuring the parameters, click【write】→【activate】→【OK】, the parameters will take effect after
the activation is successful.
⑥ After the activation is completed, the slave station state machine (SD8021) will from 1 → 2 → 4 → 8, 8
means the OP status. At this time, SDO and PDO can receive and send messages
⑦ Modify the control word 6040 (6 → 15) to enable the slave station and move the motor by setting the target
speed, acceleration and deceleration and other parameters
⑧ In PV mode, data can be set and monitored through I/O mapping addresses. For example, the control word of
axis 1 can be modified through HD10000 (6040h mapping) to enable or disable the motor. The actual position of
the current motor on axis 1 can be monitored through HD10012 (6064h mapping), and the actual speed of axis 1
can be monitored through HD10014 (606Ch mapping).
7) TQ mode operation example
TQ control mode related objects (command・setting)
Register Note Unit
RXPDO[0x6040] Control word -
RXPDO[0x6060] Control mode is tq (Profile torque control mode), set its value to
-
4
RXPDO[0x6071] Target torque given 0.1%
RXPDO[0x6072] Max torque 0.1%
RXPDO[0x6080] Maximum motor speed r/min
RXPDO[0x6087] Set torque slope 0.1%/S
RXPDO[0x6088] Set the type of torque profile to use -
① Click 【 scan】or【add】 slave on EtherCATconfig interface, function module please set to user define in
【general】 interface.
② Select 1600, 1A00 in【expert process data】→【PDO list】, PDO parameters associated with the mode can be
added (1600 and 1A00 cannot add more than 32 bytes respectively).
③ When the level signal connected to the driver SI1 or SI2 jumps, the probe function is triggered, and the probe
value is locked in the corresponding COE object words 0x60BA to 0x60BD. When reading the probe value, you
need to add the corresponding probe value object (0x60BA-0x60BD) to TxPDO to facilitate data collection.
Select 1600, 1A00 in【Expert process data】→【PDO list】, add 60B8h in 1600, add 60BAh in 1A00, 60BCh (take
the rising edge of the two probe signals as an example. If the falling edge is collected, 60BBh and 60BDh can be
added).
④【IO mapping】The default starting address is HD10000, which can be changed if necessary
⑤ After configuring the parameters, click【write】→【activate】→【OK】, the parameters will take effect after
the activation is successful.
⑥ After activation, the slave station state machine (SD8021) will change from 1 → 2 → 4 → 8, 8 indicating the
OP state. At this time, both SDO and PDO can receive and send messages.
⑦ After enabling the slave station, the probe function can be activated by modifying HD10024 (60B8h
mapping).
⑧ After activating the probe function, the rising edge clamping value of probe 1 can be monitored through
HD10022 (60BAh mapping), the rising edge clamping value of probe 2 can be monitored through HD10024
(60BCh mapping), the current probe status can be monitored through HD10026 (60B9h mapping), the current
actual position of the motor can be monitored through HD10012 (6064h), and the current actual speed can be
monitored through HD10014 (606Ch mapping).
11.2 Beckhoff TWINCAT and Xinje DS5C2
Beckhoff TwinCAT control software is used as the master station and Xinje servo is used as the slave station to
realize EtherCAT motion control.
DS5C2 servo driver has two communication network ports, which follow the principle of "bottom in and top out"
shall be followed when connecting. The master station must be connected with the network port under the CN1
port of the first servo, and then the network port above the first servo is connected with the network port below the
second servo, and so on.
2) New project
Open the TwinCAT XAE(VS 2013) software and new a project.
(1)FILE—NEW—Project:
(2)Select TwinCAT Project, enter the project name and the project saving path, and click OK.
The following interface will appear:
3) Hardware scanning
If the controller is not in config mode,click to switch the controller to config mode first. Then right click
“Device” and click “Scan” to scan the slave station of EtherCAT.
Method 2: Manually right click Axis and click Append axis. Link the NC axis to the physical axis manually.
In this window, you can see the corresponding relationship between the NC axis and the physical axis
(2)Click Set, manually check Controller, Feed Fw, Feed Bw and set Override(%), then click OK.
Or directly click “All” to enable the axis, and automatically set the Override to 100%.
(3) If the Ready status is checked, it means that the motor is enabled. Then the axis can be inched through F1 ~ F4.
The inching speed is set in the “Manual Velocity” in the “Parameter”. The default speed is 100mm/s and 600mm/s,
respectively corresponding to slow inching and fast inching.
(4) After setting “Target position” and “Target Velocity”, press F5 to realize position control. The motor will move
to the target position with the set target. This positioning is absolute position positioning, and F6 can be used to
stop during positioning.
(5) When the NC reports an error, there will be an error code in the “Error”.
F8 is the reset button. Press F8 to reset the error.
F9 is the origin finding button. After pressing F9, the axis position will change to 99999... And move slowly.
However, the origin signal requires external hardware signal, which cannot be captured in the Online window.
Therefore, F9 is not used to return to the origin generally, but realized through programming in the program.
Note: Refer to "TC3 training material V1.1.0" for more single axis debugging functions.
Click POUs -MAIN(PRG) ,create an Axis_ref type at the main program. Axis_ Ref is a structure, mainly used for
data exchange between NC and PLC. It also contains some other structures. We call this Axis_ref variable the axis
variable.
After the program is written, compile it to see if it is wrong. The project of this instance is named Twincattest, so
find Twincattest project, right-click it, and then select “Build” and click it.
The corresponding variables can be seen in the Instance directory after compile successfully.
After successful compilation, you can bind two variables under PlcTask Inputs and PlcTask Outputs
respectively.
(2)Connect variable between NC and PLC
Click “Motion-Axes”,double click Axis 1, find “Settings-Link to PLC...” from the interface on the right.
Link Axis1 to the corresponding PLC, and then NC and PLC can interact with each other through this link.
Press F2 in the program writing window and select power and move_absolute in “Categories——Instance Calls”
to call the defined function block into the program.
Fill in all the parameters in the function block. Enable represents the enable position, Enabled_Positive represents
allowing forward rotation, Enabled_Negative represents allowing reverse rotation, Override represents the speed
ratio, Axis represents the corresponding axis, Position represents the positioning position, Velocity represents the
positioning speed, Acceleration represents acceleration, and Deceleration represents deceleration. Additionally,
declare two boolean type variables power_do and move_do as trigger bits for the enable and absolute position
motion function blocks, and declare an Lreal type variable as the position, velocity, and acceleration/deceleration
for absolute position motion.
Right click “PLC-VISUs”, click Add from the pop-up menu, and then select Visualization from the new menu to
create a visual interface.
Select the rectangle in the toolbar of the added VISU interface and drag a control.
Double click the rectangle box control to set.
Double click the control, and set parameters in Property as shown in the figure.
Set Texts——Text-axis_ pos: %.2f, %.2f represents the data type of floating-point number, display the value of
the associated variable (that is, the variable pointed to by “Text variables——Text variable”, and only two
decimal places are reserved.
Enter MAIN.axis.NcToPlc.ActPos in Text variable, indicating that the control points to the actual position in the
axis variable.
Make another control to represent the current speed of the shaft, enter MAIN.axis.NcToPlc.ActVelo in Text
variable.
Add a rectangular control to input the target position value of the absolute position movement.
The specific operations are as follows: create a rectangular control, and enter MAIN.move_position in Text
variable(lreal type variable added in the program), click “Inputconfiguration - OnMouseClick”, select “Write a
Variable” in the pop-up interface, click “>” to add the function, and select “Use another variable” on the right to
point to the variable MAIN.move_position.
In the same way, create the controls of speed, acceleration and deceleration pointing to the absolute position.
Create two button controls to control the enable and axis motion.
Create an indicator control to show whether the power function block is enabled successfully.
First, drag an LED icon from the Toolbox on the right, and then bind the “Position——Variable” to the
MAIN.axis.NcToPlc.StateDWord.20 variable, where StateDWord “.20” represents the enabled state of the axis
variable.
After the program is written, it needs to be activated, and then click Login to run the program. Click the run
button to see the value of the specified variable in the visual interface.
Click move_ Position and other input type controls can modify the value of the variable in real time.
11.3 CODESYS and XINJE DS5C2 Ethercat communication example
This example will explain how Codesys motion control software realizes EtherCAT motion control when it is used
as EtherCAT master station (Xinje XS3 series PLC is only used as a hardware platform) and Xinje DS5C2 series
servo is used as slave station.
11.3.1 System topology
Name Model Quantity Note
Software CODESYS 1 Software version: V3.5 SP13
Patch 1
Hardware XS3 series PLC 1
Servo DS5C2-41P0-PTA 3
Network cable JC-CA-3 Some Connect PC and servo
This is a Codesys control system based on traditional hard PLC. In this scheme, the PLC development system
generally runs on an ordinary PC, while the traditional hard PLC only serves as a hardware platform. The
real-time core of the soft PLC is installed in the traditional hard PLC, and the system program compiled by the
development system is downloaded into the hard PLC. The control system diagram is shown in the above figure.
XS3 series PLC has upper and lower network ports. The upper network port is Ethernet/IP, which is used to
connect the Codesys upper computer. The lower network port is an EtherCAT connection port, which is used to
connect Xinje DS5C2 series servo to realize EtherCAT communication. The two communication network ports of
Xinje DS5C2 series servo drivers should follow the principle of "bottom in and top out".
Double click to open Codesys. Click New Project, input project name and save path.
2)Add XML file
Open Tools/device repository, add XML file of master and slave station. First, add the XML file of the master
station device. Click Tools -- device repository in turn, click install in the pop-up dialog box, select the path where
the XML file is located, find the XML file, select it, and click open.
After opening, the installation is completed, as shown in the following figure. Similarly, install the slave XML file
(Xinje-DS5-C_rev1.1) in the same way.
3)Add master station device
Right click Untitled, click Add Device, select PLCs--SoftMotion PLCs--Xinje –Cortex-Linux-SM-CNC, click
Add Device to add the PLC.
After adding a PLC, the device manager will appear on the right side of the interface. Select Xinje – Cortex Linux
SM CNC, right-click, and click Add device.
Select "EtherCAT / master/ EtherCAT master" in the "add device" dialog box, and finally click Add device.
Add the device, as shown in the following figure:
4)Gateway communication settings
Double click Xinje_ Cortex_ Linux_ SM_ CNC, click Scan netwook in the communication settings tab, search for
PLCs in the same network segment, and click OK after finding them. As shown in the figure below, the equipment
name of the PLC is XINJE-XS3.
Note: Ethernet connection requires that the IP address of the connected device (PC) and the IP address of the PLC
are in the same network segment, so confirm whether the IP address setting of the PC meets the requirements
before connecting.
Similarly, add an axis for each slave station. After adding, it is shown in the following figure:
7)Master station device select source address
Double click “EtherCAT_Master”, click Browse… in general tab, select corresponding MAC address, click OK,
now the source address is selected.
Add input and link the function block to the first slave station axis. Select Input, drag it in the programming
interface, double click this object, click , select IoConfig_Globals-- SM_Drive_GenericDSP402 in the
Input Assistant, click OK.
Connect the added input function block and the enable function block with wires.
Similarly, continue to add the relative movement function block MC_ MoveRelative, Stop function block MC_
Stop, Reset function block MC_Reset. The procedure is shown in the figure below.
9) Add visualization
Right click application in the devices column and select Add object - visualization. After naming and selecting the
programming method, click Add.
Double click visualization in the devices column to add the required visualization. For example, you can search
for power in the toolbar and drag the visualization object into the screen.
When you drag the control object into the editing area, the dialog box Assign parameters < VISU_MC_Power>
will pop up automatically, link the control object to the corresponding declared variable. Double click the value
column.
Click , at this time, select the declared variable in the newly pop-up dialog box, and then click OK. The
linked variable name will appear in the value column. Finally, click OK, that is, the variable linking is completed.
Similarly, other control object follow suit.
Add an object that simulates the rotation of the motor and link it to the motor axis. Add it in the same way as
above.
Example: when the input-output relationship coefficient is 10, the distance in the MC_MoveRelative function
block is set to 100, then 100/10*524288 = 5242880, that is, the set operating distance is 5242880 pulses, and the
motor will rotate for 10 revolutions.
At this time, set the velocity value in the function block to 10, then 10/10* 524288 = 524288, that is, the motor
will run at the speed of 524288/s.
Set the acceleration value to 1000, then 1000/10*524288 = 52428800, that is, the acceleration of the motor is
52428800/s², the deceleration setting is the same.
After setting parameters, compile the program for syntax check, and log in and run the program after no error is
reported. Login enables the application to establish a connection with the target device and enter the online state.
The precondition for correct login is to correctly configure the communication settings of the device and the
application must be free of compilation errors.
Execute compile, login, run, the normal operation status is shown in the figure below:
At this time, the distance, speed and other parameters that the motor needs to move can be set in the visualization.
Click bDriveStart—bRegulatorOn—Enable in turn in the MC_Power function block to enable the motor normally.
Finally, click Execute in MC_MoveRelative function block to start relative position movement.
11.4 OMRON and DS5C2 servo Ethercat communication example
This example will explain how Omron PLC is used as EtherCAT master station and Xinje servo is used as slave
station to realize EtherCAT motion control.
The NJ501 CPU module has two network ports, the red marked is Ethernet/IP, which are used to connect the
Omron host computer SYSMAC studio to monitor and write data to the PLC. The yellow marked is EtherCAT,
and the other end is connected to Xinje DS5C2 series servo to realize EtherCAT communication.
Each network port is equipped with three indicators, RUN/ERROR/ACT. After the network cable is correctly
connected, RUN should be on and ACT should be on. When the communication is established and there is data
interaction at the network interface, ACT flashes. Error will not light up unless it is abnormal.
11.4.3 Debugging steps
1)New project
If "new project" is selected for the first time, select model: NJ501-1500, version 1.02 in the project attribute
interface, and click "create" to generate the programming interface.
Then we need to add the XML file of DS5C2 to the pop-up ESI library. Select "this folder" to display the path of
the storage folder, and put the "Xinje-DS5C2-rev1.1" XML type file in the path folder.
Finally, close SYSMAC studio and restart the software, browse the "ESI library" again, and the
Xinje-DS5C2 slave station description file already exists in the library.
3)Add device
Find “XINJE-DS5C2 CoE Drive Rev” on the right side of the interface, double click it to add to the node under
master device.
After adding a node, select the node with the cursor to display the PDO configuration of the current node. Select
Edit PDO mapping settings. The pop-up interface will display the current output PDO mapping on the left and the
PDO items on the right. You can add or delete PDO as required.
Select "add PDO item" to add PDO, and the pop-up window will show the PDO objects that can be added. After
selecting, click "OK", and then click "apply", and the addition is successful.
After adding, it is shown in the following figure:
Double click " MC_Axis000" to display the axis setting interface. The interface is divided into multiple sub
interfaces.
Select "axis type - servo axis" in the "axis basic settings" interface, and select "node 1: DS5C2" in the "input
device".
Click detailed settings, expand the configuration module. The function name needs to be mapped to the PDO
mapping item on the device. It needs to be added manually here. Missing or wrong addition will affect the
subsequent use of this parameter.
In "unit conversion setting", the number of motor encoder lines is correctly filled in the "number of command
pulses per motor revolution". If 19-bit encoder is used in this example, it is modified to 524288. "Working stroke
of motor for one revolution" is the equivalent stroke of motor for one revolution. The example here is modified to
524288, and the default gear ratio is 1:1.
5)Write "round trip" program
Description of programming interface: select "programming / POUs / program / program0/ section0" and
double-click "section0" to show the programming interface. By default, program0 is ladder programming. If ST
programming is selected, right click "program / add / ST". The "toolbox" allows you to add various ladder
elements.
Enter a function block name to call this function block parameter. If "MC_Power" is input, the calling
function block is declared as MC_ Power.
Function block "Axis" pin connected variable, input MC_ Axis000 indicates that the function block is
applied to the axis "MC_Axis000".
Add function block “MC_MoveAbsolute” in the same way, and define the variable name for the pins
“Position”“Velocity”“Acceleration”“Deceleration” to “Pos_1”“Vel_1”“Acc_1”“Dec_1”.
The defined variables can be written with initial values in the variable table, and the initial values take effect when
the PLC is running.
Select "Ethernet - direct connection" in the "communication setting" interface, and then click "OK" to close the
interface.
Note: Ethernet connection requires that the IP address of the connected device (PC) is automatically obtained or in
the PLC IP address network segment. Therefore, before connecting, confirm whether the IP address setting of the
PC meets the requirements.
7)Compile program and prepare connection
Find "compile controller" in the toolbar to compile the project. If there is any error, check the cause of the error.
After the compilation is passed, find "online" in the toolbar and click it. If the pop-up window "failed to connect
to the controller" appears, check whether the communication configuration is correct. After successful online, the
upper computer switches to online status.
Select "synchronize" in the toolbar, and the pop-up window compares the local project with the project in the
controller. The local project and the project in the controller display "out of sync". Click "transfer to controller" to
download the local project and overwrite the original project of the controller.
After synchronization, click "recompare" to view the synchronization items of each local project and the
controller project. When the subsequent modified project is synchronized again, the different items from the
controller project will be marked in detail.
8)Online control
On the "section0" interface, right-click the variable "X0", select "Edit variable value", switch BOOL to the state
"True", the function block "MC_Power" takes effect, and the servo enable is turned on. Change the state of the
variable "X1" to "True" in the same way to realize the round-trip movement of the program.
PDO object data can be monitored by "IO mapping".
Appendix
Appendix 1. Driver parameters
Appendix 1.1 PX-XX
Modification and effective:
“○” means modifying when servo OFF and take effect at once.
“√” means modifying anytime and take effect at once.
“●” means modifying when servo OFF and take effect when power on again.
“△” means modifying anytime and take effect when the motor doesn’t rotate.
For parameters set in hexadecimal system, the prefix "n." is added to the setting value to indicate that the current
setting value is hexadecimal number.
(1) P0-XX
Default Suitable
Parameter Function Unit Range Effective
value mode
Driver type
P0-00 0:General type - 1 0~1 ○ All
1:EtherCAT type
P0-00=0:General type
1-Internal Torque Mode
3-Internal speed Model
5-Internal Location Mode
P0-00=1:EtherCat type
1-Profile position control mode(PP)
3-Profile speed control mode(PV)
P0-01 4-Profile torque control mode(TQ) - 0 1~10 ○ All
6-Homing mode(HM)
8-Cyclic synchronous position
control mode(CSP)
9-Cyclic synchronous velocity
control mode(CSV)
10-Cyclic synchronous torque
control mode(CST)
Control mode 2 (ditto) -
When the/C-SEL signal is valid, the
P0-02 servo system will switch to the 0 1~10 ○ All
mode selected by P0-02 for
operation
Enabling mode -
0:not enabled
1:IO /SON enable
P0-03 3 0~3 ○ All
2:Software enable(Panel/Modbus)
Write 1 to panel F1-05;
3:Bus Enable
<=20P7: 13
P0-04 Rigidity grade - 0~41 △ All
>=21P0: 11
Definition of rotation direction
P0-05 - 0 0~1 ● All
0- positive mode
Default Suitable
Parameter Function Unit Range Effective
value mode
1- negative mode
P0-07 First inertia ratio 1% 200 0~50000 √ All
Input pulse command positive -
direction
P0-09.0 0 0~1 ● 6, 7
0: Positive pulse counting
1: Reverse pulse counting
P0-09.2 Input pulse command filtering time - F 0~F ● 6, 7
0: CW/CCW -
P0-10.0
1: AB 2 0~2 ○ 6, 7
xxx□
2: P+D
P0-11 Low bit of pulses per cycle ×1 - 0 0~9999 ○ 5, 6
High bit of pulses per cycle × -
P0-12 0 0~65535 ○ 5, 6
10000
P0-13 Electronic Gear Numerator - 1 1~65535 √ 5, 6
P0-14 Denominator of Electronic Gear - 1 1~65535 ○ 5, 6
Pulse frequency corresponding to 100Hz
P0-15 1000 0~10000 ○ 7
rated speed in speed mode
Speed command pulse filtering 0.01ms
P0-16 100 0~10000 ○ 7
time
0.01
P0-23 Pulse offset limit 2000 0~65535 √ 5, 6
turn
0 - cumulative discharge time -
P0-24 1 - average power mode 1 0 0~2 ○ All
2-average power mode 2
Power Value of Discharge W
P0-25 0~65535 ○ All
Resistance Set as model
P0-26 Discharge resistance value Ω 1~500 ○ All
Servo shutdown the enable stop -
mode
0: Free stop, maintain free running
state after stopping
1: Free stop, maintain DB state
after stopping
2: Slow down and stop, maintain
P0-27 0 0~5 ○ All
free running state after stopping
3: Slow down and stop, maintain
DB status after stopping
4: DB stops and maintains a free
running state after stopping
5: DB stops, maintains DB state
after stopping
Servo Overrun Stop Mode -
(P0-28.0)
0-Deceleration stop 1
1-Inertial Stop
2-Deceleration stop 2
2 0~3 ○ All
3-Alarm Stop
Overtravel alarm shield switch
(P0-28.1)
P0-28
0-Not shield the alarm
1-Shield the alarm
EC bus overtravel stop mode -
(P0-28.0)
0: Direct alarm, using servo 1|3|4|8|9
2 0~3 ○
deceleration shutdown method |10
1: Alarm after decelerating and
stopping as 605Ah mode
Default Suitable
Parameter Function Unit Range Effective
value mode
2: Do not use overtravel
Servo alarm stop mode -
0: Free stop, maintain free running
state after stopping
1: Free stop, maintain DB state
after stopping
2: DB/deceleration stop, maintain
P0-29 free running state after stopping 2 0~5 ○ All
3: DB/deceleration stop, maintain
DB state after stopping
4: DB stops and maintains a free
running state after stopping
5: DB stops, maintains DB state
after stopping
P0-30 Stop timeout time 1ms 20000 0~65535 ○ All
P0-31 Deceleration stop time 1ms 25 0~5000 ○ All
P0-33 Set the motor code - 0000 0~65535 ● All
Automatic reading of motor -
parameters alarm shielding switch
P0-53 0: Do not block alarms 0 0/1 ● All
1: Block alarm for not reading valid
motor parameters
- -6000~600
P0-55 Open loop rotation speed 0 ○ All
0
Number of encoder communication -
P0-56 10 1~65535 ○ All
attempts
Selection of encoder speed -
measurement algorithm
0: K-type speed measurement
(default)
1: Speed measurement method 1, S
method
P0-63.0 (Used in conjunction with P0-63.1) 0 0~3 ○ All
2: Speed measurement method 2, P
method
(Used in conjunction with P0-63.2)
3: Speed measurement method 3, T
method (parameter configuration
P0-76,%)
Original position differential right -
P0-63.1 0 0~f ○ All
shift bit numbers in S method
Speed measurement zone total -
P0-63.2~3 0 4~17 ○ All
length L in P method
P0-68.0~ Number of consecutive error -
P0-68.1 alarms in the update sequence of 0x05 0x01~0xFF ● All
xx□□ coded data
P0-68.2~ -
P0-68.3 E-241 Alarm filtering times 0 0~0xFF ● All
□□xx
Fan switch (P0-69.0) -
0- Turn on the fan when the
temperature greater than 45℃ and
turn off the fan when less than
P0-69 1 0/1 √ All
42℃ (hysteresis 3℃)
1 - Turn on the fan after enabling,
turn off the fan when not enabling
Default Suitable
Parameter Function Unit Range Effective
value mode
Large motor thermocouple break
alarm shield switch (P0-69.1)
0-not shield thermocouple
disconnection alarm
1-shield thermocouple
disconnection alarm
0.01
P0-70 Pulse command offset limit value 200 0~65535 √ 8
turns
Selection of bus CSP position -
interpolation mode
P0-71 1 0~1 √ 8
0: Advanced interpolation
1: Normal interpolation
Bus Sync0 offset time
After setting the parameters, the
upper computer needs to be [%]
P0-72 30 0~60 √ 8
reactivated to take effect, and the
modification effect can be observed
through U5-19
1ms As the
P0-74 Blocking alarm time 0-65535 √ All
model
P0-75 Blocking alarm speed 1rpm 50 5~9999 √ All
Battery undervoltage alarm switch -
of absolute encoder (firmware
version 20160304 and later)
P0-79 0 - Used as absolute encoder 1 0~2 ● All
1 - Used as incremental encoder
2 - Used as absolute value encoder,
ignoring multi turn overflow alarm
Motor thermal power protection -
mode
0- Current protection
P0-80 1- Average thermal power 2 0~2 ● All
protection
2 - Analog thermal power
protection
STO status asynchronous alarm
P0-88 0.1ms 60 0~1000 √ All
detection time
STO buffer circuit abnormal alarm
P0-89.0~1 0.1ms 10 0~255 √ All
detection filtering time
P0-89.2~3 STO input detection filtering 0.1ms 12 10~30 √ All
EDM circuit abnormal alarm
P0-90.0~1 0.1ms 200 0~255 √ All
detection filtering
32-bit electronic gear ratio -
1 1~9999
P0-92~P0- numerator.
○ 5, 6
93 take effect when P0-11~P0-14 is 0.
1 1~65535
P0-92*1 + P0-93 *10000
32-bit electronic gear ratio -
1 1~9999
P0-94~P0- denominator.
P0-11~P0-14 is 0. ○ 5, 6
95
1 1~65535
P0-94*1 + P0-95 *10000
(2) P1-XX
Suitable
Parameter Function Unit Default value Range Effective
mode
P1-00 First speed loop gain 0.1Hz 200 10~20000 √ All
P1-01 Integral Time Constant of the First 0.01ms 2653 15~51200 √ All
Suitable
Parameter Function Unit Default value Range Effective
mode
Speed Loop
P1-02 First position loop gain 0.1/s 480 10~20000 √ All
P1-05 Second speed loop gain 0.1Hz 200 10~20000 √ 1|3|5|6|7|
Integral Time Constant of the second
P1-06 0.01ms 3300 15~51200 √ 1|3|5|6|7|
Speed Loop
P1-07 Second position loop gain 0.1/s 200 10~20000 √ 1|3|5|6|7|
P1-10 Speed feedforward gain 1% 0 0~300 √ 5|6|7
P1-11 Speed feedforward filter time 0.01ms 50 0~10000 √ 5|6|7
P1-14 Gain switching mode setting - 0 0~0x00A2 √ All
P1-15 Gain switching waiting time - 5 0~1000 √ All
P1-16 Gain switching level threshold - 50 0~20000 √ All
P1-17 Gain switching level hysteresis - 30 0~20000 √ All
P1-18 Position loop gain switching time - 3 0~1000 √ All
Gap compensation function direction All
P1-19.0 0: Positive direction - 0 0~1 √
1: Reverse direction
Gap compensation function switch All
P1-19.1 0: Close - 0 0~1 √
1: Open
P1-20 Gap compensation quantity 0.1Pref 0 0~65535 √ All
P1-21 Gap compensation filtering time 0.01ms 0 0~65535 √ All
P1-23 Speed instruction filter time 0.1ms 0 0~65535 ○ 3
Position command acceleration and
P1-24 0.1ms 0 0~65535 △ 5|6
deceleration filtering time
Position instruction smooth filter
P1-25 0.1ms 0 0~65535 △ 5|6
time
Switching conditions for speed
control mode
[P-PI switching]
0: Do not use mode switching
1: Switching condition based on
internal torque command <=22P6: 1
P1-26.0 - 0~4 △ All
2: Switching condition based on Others: 0
speed command
3: Switching condition based on
acceleration
4: Switching condition based on
position deviation
Speed control mode switching All
integral holding selection
P1-26.1 0: Clear the integral of 0 Asr - 1 0~1 △
1: Keep the points unchanged and no
longer accumulate
Mode Switching - Torque Command % 200 0~800 △ All
P1-27
Threshold
Mode Switching - Speed Command rpm 0 0~10000 △ All
P1-28
Threshold
Mode Switching - Acceleration rpm/s 0 0~30000 △ All
P1-29
Threshold
Mode switching - Position deviation Command 0 0~10000 △ All
P1-30
threshold unit
Suitable
Parameter Function Unit Default value Range Effective
mode
P1-31 I-P control switching threshold % 100 0~100 △ All
Encoder zero position deviation
P1-74 - 1000 0~65535 √ All
detection cycle
Encoder zero deviation detection
P1-75.0~1 - 0A 0~500 √ All
threshold
Electric angle deviation detection
P1-75.2~3 - 06 0~500 √ 1|2|3|4|5|6|7
filtering frequency
(3) P2-XX
Suitable
Parameter Function Unit Default value Range Effective
mode
Disturbance observer switch
P2-00.0 0- OFF - 0 0~1 ○ All
1- ON
Selection of speed observer
0: Close
P2-00.1 - 0 0~2 ○ All
1: EhVobs
2: Vobs
Electric angle compensation switch
P2-00.3 0: Close - 0 0~1 ○ All
1: Open
Adaptive mode switch
P2-01.0 0- OFF - 0 0~1 ● All
1- ON
Adaptive level
P2-01.1 0-High response - Set as model 0~1 ● All
1-Low noise
Auto-tuning mode
1-Soft
P2-02.0 2-Fast positioning - 3 1~3 √ All
3-Fast positioning, control the
overshoot
Load type (valid only during
auto-tuning)
P2-02.2 1-Synchronous belt - 2 1~3 √ All
2-Screw rod
3-Rigid Connection
Enable speed loop IP control
P2-03.2 0: Close - 0 0~1 √ All
1: Open
Adaptive load type
P2-03.3 0-Small Inertia Mode - 0 0~1 ● All
1-Large Inertia Mode
Adaptive mode speed loop gain
P2-05 0.1Hz 200 1~65535 ○ All
(standard)
P2-07 Adaptive mode inertia ratio (standard) % 0 0~10000 ○ All
Gain of adaptive mode speed observer
P2-08 Hz 30 10~1000 ○ All
(standard)
Maximum Inertia Ratio of Adaptive
P2-12 - 30 1~10000 ○ All
Mode (Standard)
P2-15 Inertia identification and internal 0.01r 100 1~3000 √ All
Suitable
Parameter Function Unit Default value Range Effective
mode
instruction self-tuning maximum
travel
Inertia identification and internal
P2-17 instruction self-tuning maximum - 0 0~65535 √ All
speed
Initial inertia ratio of inertia
P2-18 % 500 1~20000 √ All
identification
P2-19 Adaptive mode bandwidth % 50 1~100 ○ All
Torque command filtering time
P2-35 0.01ms 66 0~65535 √ All
constant 1
Torque command filtering time
P2-36 0.01ms 100 0~65535 √ All
constant 2
Disturbance torque compensation
P2-41 coefficient % 85 0~100 √ All
(Non adaptive mode is valid)
Cut off frequency of disturbance
P2-42 0.1Hz 0 -1000~1000 √ All
torque low-pass filter
Disturbance observer inertia
P2-43 % 100 1~1000 √ All
coefficient
Model Loop Switch
P2-47.0 0-OFF - 1 0~f √ All
1-ON
P2-49 Model loop gain 0.1Hz 480 10~20000 √ 3|4|5|6|7
Active Vibration Suppression Switch
P2-60.0 0-OFF - 0 0~1 √ 3|4|5|6|7
1-ON
Active Suppression Auto-tuning
Switch
0-Active Vibration Suppression is not
P2-60.1 - 1 0~1 √ 3|4|5|6|7
Configured in auto-tuning
1- Configure the Active Vibration
Suppression when auto-tuning
Active Vibration Suppression
P2-61 0.1Hz 10000 10~20000 √ All
frequency
P2-62 Active Vibration Suppression gain % 100 1~1000 √ All
Active Vibration Suppression
P2-63 % 100 0~300 √ All
damping
Filtering time of active vibration
P2-64 - 0 -10000~10000 √ All
suppression 1
Filtering time of active vibration
P2-65 - 0 -10000~10000 √ All
suppression 2
P2-69.0 Notch filter 1 switch - 0 0~1 √ All
P2-69.1 Notch filter 2 switch - 0 0~1 √ All
P2-69.3 Notch filter 3 switch - 0 0~1 √ All
P2-70.0 Notch filter 4 switch - 0 0~1 √ All
P2-70.1 Notch filter 5 switch - 0 0~1 √ All
P2-71 First notch frequency Hz 5000 50~5000 √ All
P2-72 First notch attenuation % 71 50~1000 √ All
P2-73 First notch band width 0.1dB 0 0~1000 √ All
P2-74 Second notch frequency Hz 5000 50~5000 √ All
Suitable
Parameter Function Unit Default value Range Effective
mode
P2-75 Second notch attenuation % 71 50~1000 √ All
P2-76 Second notch band width 0.1dB 0 0~1000 √ All
P2-77 Third notch frequency Hz 5000 50~5000 √ All
P2-78 Third notch attenuation % 71 50~1000 √ All
P2-79 Third notch band width 0.1dB 0 0~1000 √ All
P2-80 Fourth notch frequency Hz 5000 50~5000 √ All
P2-81 Fourth notch attenuation % 71 50~1000 √ All
P2-82 Fourth notch band width 0.1dB 0 0~1000 √ All
P2-83 Fifth notch frequency Hz 5000 50~5000 √ All
P2-84 Fifth notch attenuation % 71 50~1000 √ All
P2-85 Fifth notch band width 0.1dB 0 0~1000 √ All
(4) P3-XX Speed control parameters
Suitable
Parameter Function Unit Default value Range Effective
mode
P3-05 Preset speed 1 rpm 0 -9999~9999 √ 3
P3-06 Preset speed 2 rpm 0 -9999~9999 √ 3
P3-07 Preset speed 3 rpm 0 -9999~9999 √ 3
P3-09 Acceleration time ms 0 0~65535 ○ 3|4|7
P3-10 Deceleration time ms 0 0~65535 ○ 3|4|7
P3-12 Zero-speed clamping mode - 0 0~3 ○ 3|4|7
P3-13 Zero-speed clamping speed rpm 10 0~300 ○ 3|4|7
Forward Maximum Speed Instruction
P3-14 rpm 4000 0~10000 ○ All
Limit
Reverse Maximum Speed Instruction
P3-15 rpm 4000 0~10000 ○ All
Limit
Internal Forward Speed Limitation in
P3-16 rpm 2000 5~10000 √ 1|2
Torque Control
Internal Reverse Speed Limitation in
P3-17 rpm 2000 5~10000 √ 1|2
Torque Control
P3-18 Jogging speed rpm 100 0~1000 ○ All
P3-19 Forward warning speed rpm 3000 0~10000 ○ All
P3-20 Reverse warning speed rpm 3000 0~10000 ○ All
P3-21 Forward alarming speed rpm 4000 0~10000 ○ All
P3-22 Reverse alarming speed rpm 4000 0~10000 ○ All
0~ Motor
P3-28 Internal forward torque limit % As the model overload √ All
multiple
As the model 0~ Motor
P3-29 Internal reverse torque limit % overload √ All
multiple
As the model 0~ Motor
P3-30 External forward torque limit % overload √ All
multiple
External reverse torque limit As the model 0~ Motor
P3-31 % √ All
overload
Suitable
Parameter Function Unit Default value Range Effective
mode
multiple
P3-33 Preset torque % 0 -1000~1000 √ 1
P3-37 Delay in switching torque mode ms 40 0~9999 √ 1|2
0~ Motor All
P3-38 Anti blockage forward torque limit % As the model overload √
multiple
0~ Motor All
P3-39 Anti blockage reverse torque limit % As the model overload √
multiple
P3-40.0 Friction compensation switch - 0 0~1 √ All
Selection of Friction Compensation All
P3-40.1 - 0 0~2 √
Speed Source
P3-45 Friction compensation speed threshold 0.1rpm 20 0~200 √ All
P3-46 Dynamic braking delay enable ms 10 0~50 √ All
(5)P4-XX Internal position parameters
Suitable
Parameter Function Unit Default value Range Effective
mode
Z phase signal numbers
P4-00.0 The Z phase signal numbers after - 2 0~f ○ 5|6
leaving the limit switch (note: stop
when N+1 Z phase signal reached)
Search the origin function
P4-00.1 0-OFF - 0 0~1 ○ 5|6
1-ON
Return to zero overrun prohibition
P4-00.2 0-not prohibit - 0 0~1 ○ 5|6
1-prohibit
P4-01 Speed of hitting the proximity switch rpm 600 0~65535 ○ 5|6
P4-02 Speed of leaving proximity switch rpm 100 0~65535 ○ 5|6
Internal Location Given Mode Sets
Location Monm,de
P4-03.0 - 0 0~1 ○ 5
0-Relative positioning
1-Absolute positioning
Internal position setting mode Set step
change mode
0 - Step change when signal is ON,
recyclable
1 - Step change on the rising edge of
the signal, single step execution
2 - The rising edge of the signal is
started, and all the signals are
P4-03.1 executed in sequence without - 0 0~5 ○ 5
circulation
3 - Communication setting section
number
4 -/CHSTP bilateral edge trigger
5- Terminal/PREFA (P5-57),/PREFB
(P5-58),/PREFC (P5-59) select
segment number, and 1~3 segments
can be selected
Suitable
Parameter Function Unit Default value Range Effective
mode
Internal position mode sets waiting
mode
P4-03.2 - 0 0~1 ○ 5
0-wait positioning completion
1-not wait positioning completion
P4-04 Valid segment number - 0 0~35 ○ 5
-327689999~
P4-10~P4-11 First segment pulse 1pul 0 √ 5
327679999
P4-12 First segment speed 0.1rpm 0 0~65535 √ 5
P4-13 First segment acceleration time 1ms 0 0~65535 √ 5
P4-14 First segment deceleration time 1ms 0 0~65535 √ 5
P4-16 Adjusting time 1ms 0 0~65535 √ 5
P4-10+(n-1)*7
Segment 1 to 35 pulse parameters (n
~ - - - √ 5
is segment number)
P4-16+(n-1)*7
Note:
1) Set pulse number=pulse number (high bit) × 10000+pulses (low order);
2) 35 sections in total; The parameters of sections 1 to 12 can be set through the panel, and the parameters of
sections 13 to 35 need to be written through communication (RS232 and RS485).
(6)P5-XX Signal parameter setting
Default Suitable
Parameter Function Unit Range Effective
value mode
P5-00 Positioning completion width/COIN Command unit 11 1~65535 √ 5|6
Location Completion Detection
P5-01 - 0 0~3 √ 5|6
Mode
P5-02 Location completion retention time ms 0 0~65535 √ 5|6
P5-03 Rotation Detection Speed rpm 50 0~10000 √ All
P5-04 Same speed detection speed rpm 50 0~10000 √ All
P5-05 Reached detection speed rpm 1000 0~10000 √ All
P5-06 Positioning near output width Command unit 50 0~65535 √ 5|6
P5-07 Servo OFF delay time ms 500 -500~9999 ○ All
P5-08 Brake instruction output speed rpm 30 20~10000 ○ All
P5-09 Brake instruction waiting time ms 500 0~65535 ○ All
User-defined output 1 trigger
P5-10 - 0 0~ffff √ All
condition
Set a value that compares with the Related to trigger
P5-11 0 -9999~9999 √ All
trigger condition of custom output 1 condition
P5-12 Select custom output 1 mode - 0 0~3 √ All
Related to trigger
P5-13 Setting custom output 1 hysteresis 0 0~65535 √ All
condition
P5-14 Custom Output 2 Trigger Condition - 0 0~ffff √ All
Set a value that compares with the Related to trigger
P5-15 0 -9999~9999 √ All
trigger condition of custom output 2 condition
P5-16 Select custom output 2 mode - 0 0~3 √ All
Related to trigger
P5-17 Setting custom output 2 hysteresis 0 0~65535 √ All
condition
Default Suitable
Parameter Function Unit Range Effective
value mode
P5-18 IO filter time multiple - 1 0~10000 √ All
P5-19 Z-phase output holding time ms 2 1~65535 √ All
/S-ON: servo signal
00: Set the signal to be invalid all
the time.
01: Input positive signal from SI1
terminal.
02: Input positive signal from SI2
terminal.
03: Input positive signal from SI3
terminal.
04: Input positive signal from SI4
P5-20.0~1 terminal. - 0 0~ff √ All
10: Set the signal to always be
"valid".
11: Inverse signal is input from SI1
terminal.
12: Inverse signal is input from SI2
terminal.
13: Inverse signal is input from SI3
terminal.
14: Inverse signal is input from SI4
terminal.
P5-20.2 SI terminal filtering time ms 0 0~f √ All
/P-CON proportion action
P5-21.0~1 - 00 0~ff √ All
instruction
P5-21.2 SI terminal filtering time ms 0 0~f √ All
In non EtherCAT mode:
/P-OT: Forward drive prohibited
P5-22.0~1 EtherCAT mode: - 01 0~ff √ All
Control mode 6 (return to zero
mode), POT inhibit signal
P5-22.2 SI terminal filtering time ms 0 0~f √ All
In non EtherCAT mode:
/N-OT: Reverse drive prohibited
P5-23.0~1 EtherCAT mode: - 02 0~ff √ All
Control mode 6 (return to zero
mode), NOT inhibit signal
P5-23.2 SI terminal filtering time ms 0 0~f √ All
P5-24.0~1 /ALM-RST: alarm clear - 0 0~ff √ All
P5-24.2 SI terminal filtering time ms 0 0~f √ All
/P-CL: External Torque Limitation
P5-25.0~1 - 00 0~ff √ All
at Forward Rotation Side
P5-25.2 SI terminal filtering time ms 0 0~f √ All
/N-CL:External Torque Limitation
P5-26.0~1 - 00 0~ff √ All
at Reverse Rotation Side
P5-26.2 SI terminal filtering time ms 0 0~f √ All
In non EtherCAT mode:
/SPD-D: Internal Speed Direction
Selection
P5-27.0~1 - 03 0~ff √ 1|2|3|4|7
In EtherCAT mode:
Control mode 6 (return to zero
mode), Home Origin signal
P5-27.2 SI terminal filtering time ms 0 0~f √ 1|2|3|4|7
Default Suitable
Parameter Function Unit Range Effective
value mode
/SPD-A: Internal Setting Speed
P5-28.0~1 - 00 0~ff √ 3|5
Selection
P5-28.2 SI terminal filtering time ms 0 0~f √ 3|5
/SPD-B: Internal Setting Speed
P5-29.0~1 - 00 0~ff √ 3|5
Selection
P5-29.2 SI terminal filtering time ms 0 0~f √ 3|5
P5-30.0~1 /C-SEL: control mode selection - 00 0~ff √ All
P5-30.2 SI terminal filtering time ms 0 0~f √ All
P5-31.0~1 /ZCLAMP: zero position clamping - 00 0~ff √ 3
P5-31.2 SI terminal filtering time ms 0 0~f √ 3
/INHIBIT: Instruction pulse
P5-32.0~1 - 00 0~ff √ 5
prohibition
P5-32.2 SI terminal filtering time ms 0 0~f √ 5
P5-33.0~1 /G-SEL: gain switching - 00 0~ff √ All
P5-33.2 Filtering time of SI terminal ms 0 0~f √ All
P5-34.0~1 /CLR: pulse offset clear - 00 0~ff √ 5|6
P5-34.2 SI terminal filtering time ms 0 0~f √ 5|6
/CHGSTP:internal position mode
P5-35.0~1 - 00 0~ff √ 5
change step signal
P5-35.2 SI terminal filtering time ms 0 0~f √ 5
P5-36.0~1 /I-SEL:Inertia ratio switching - 00 0~ff √ All
P5-36.2 SI terminal filtering time ms 0 0~f √ All
/COIN_HD: Location Completion
Maintenance
00: No output to terminal
01: Output positive signal from SO1
terminal
02: Output positive signal from SO2
terminal
P5-37 03: Output positive signal from SO3 - 0000 0~ffff √ 5|6
terminal
11: Output reverse signal from SO1
terminal
12: Output reverse signal from SO2
terminal.
13: Output reverse Signal from SO3
terminal
P5-38 /COIN: positioning completion - 0001 0~ffff √ 5|6
P5-39 /V-CMP: same speed detection - 0000 0~ffff √ 3|4|7
P5-40 /TGON: rotation detection - 0000 0~ffff √ All
P5-41 /S-RDY: ready - 0000 0~ffff √ All
P5-42 /CLT: torque limit - 0000 0~ffff √ All
P5-43 /VLT: speed limit detection - 0000 0~ffff √ 1|2
P5-44 /BK: brake locking - 0000 0~ffff ○ All
P5-45 /WARN: warning - 0000 0~ffff √ All
P5-46 /NEAR: near - 0000 0~ffff √ 5
P5-47 /ALM: alarm - 0002 0~ffff √ All
P5-48 /Z: encoder Z phase signal output - 0000 0~ffff √ All
/MRUN: internal position mode
P5-50 - 0000 0~ffff √ 5
motion starting signal
P5-51 /V-RDY: speed reached - 0000 0~ffff √ 3|4|7
P5-52 /USER1: User-defined output 1 - 0000 0~ffff √ All
Default Suitable
Parameter Function Unit Range Effective
value mode
P5-53 /USER2: User-defined output 2 - 0000 0~ffff √ All
/PREFA: Intenral position selection ※1 √ 5
P5-57 - 0
signal A
/PREFB: Intenral position selection - 0 ※1 √ 5
P5-58
signal B
/PREFC: Internal position selection - 0 ※1 √ 5
P5-59
signal C
/TRAJ-START: Motion start trigger - 00 0~ff √ 5
P5-61.0~1
signal
- 0 0005 ○ EtherCAT
P5-62 Probe function 1
mode
- 0 0006 ○ EtherCAT
P5-63 Probe function 2
mode
P5-68.0~1 Terminal emergency alarm function - 00 0~ff √ All
P5-68.2 SI terminal filtering time ms 0 0~f √ All
/SRDY: Output Conditions
Selection
0: This terminal is turned on after
P5-70 initialization of the driver is - 0 0~1 √ All
completed
1: This terminal will not turn on
until enabled.
Function Selection of Directional - 0 0~1 √ 7
P5-71
Terminal of Pulse Speed Mode
- 0 EtherCAT
P5-72 Remote input of SI input 1 0~ff √
mode
- 0 EtherCAT
P5-73 Remote input of SI input 2 0~ff √
mode
- 0 EtherCAT
P5-74 Remote input of SI input 3 0~ff √
mode
- 0 EtherCAT
P5-76 Remote input of SO output 1 0~ff √
mode
- 0 EtherCAT
P5-77 Remote input of SO output 2 0~ff √
mode
- 0 EtherCAT
P5-78 Remote input of SO output 3 0~ff √
mode
(11) PE-XX
Default Suitable
Parameter Function Unit Range Effective
value mode
PE-01.3 Weak magnetic control switch — 0 0-1 √ All
PE-80 Weak magnetic control gain Kv Hz 30 10-1000 √ All
PE-81 Weak magnetic control 16 10-1000 √ All
%
integration time constant Ti
PE-82 Weak magnetic control integral 60 0-200 √ All
%
limiting
PE-83 Voltage command limit 115 50-150 √ All
%
threshold
PE-84 IdRef limit % 95 50-150 √ All
PE-85 Smooth filtering time of main 20 0-1000 √ All
0.1ms
cycle voltage
The position, speed, and torque polarity must be exactly the same, that is, bit7-5 must all be set
to 0 or bit7-5 must all be set to 1.
At present, Z-phase triggering mode is not supported, only external signals are supported
as triggering sources;
Do not set the rising and falling edges simultaneously under the same probe.
In TQ mode, modifying the slope type directly used for torque planning has no effect.
WUXI XINJE ELECTRIC CO., LTD.
Address: 816 Jianzhu West Road, Binhu District, Wuxi City, Jiangsu Province
Tel: 0510-85134136 Fax: 0510-85111290
Website: www.xinje.com
Email: [email protected], [email protected]