Posted in

By

7 of 20Updated 2026-11-1749 min read中文版

Ladder Motion Commands

To execute Motion Control, the M-PLC Controller realizes the user motion sequence control by using motion flow with point table. When moving at the respective axis point, the JOG or the HOME. M-PLC also provides the ladder motion related block commands to the user.

The M-PLC Motion Control can be achieved through the following three methods: 1. Ladder control (refer to the ladder motion commands described in this chapter); 2. Motion Flow control (refer to Chapter 6: Introduction of Motion Flow); 3. Test Run (refer to Chapter 12: Introduction of Test Run). Described below is the application timing of the aforesaid three control methods:

Motion Control

Content

Application Timing

Remark

Ladder Control

1. Position Control

2. JOG control

3. HOME Return

4. Handwheel

5. Speed Control

6. Torque Control

7. single axis positioning

The Ladder is suitable for the convenient JOG control and the HOME return, etc.

Please use the Motion Flow control method for controlling the complicated or continuous motion flow.

Motion Flow Control

1. Position Control

2. Speed Control

3. Torque control

4. HOME Return

5. Branch Control (the motion behavior required for controlling more than two processes concurrently).

6. Selective Control (conditional control)

7. Standby Setting

8. Merging

9. GoTo Conditional Jumping

The Motion Flow is suitable for controlling complicated motion and continuous motion flow because it is very convenient and easier to use.

The Motion Flow is also suitable for the multi-axis interpolated motion and Cam synchronization.

Test Run

1. Position Control

2. Speed Control

3. Torque Control

4. JOG Control

During Test Run, convenient motion behavior adjustment will be executed or allow the first timer to test the quick motion.

Such mode only applies to the test and inspection or adjustment, and it does not provide motion program control writing function.

There are four types of motion control programming modes in this product:

  1. Basic motion control commands: They are used to start or stop the motion controller, and modify the data within the motion control project.
  2. Motion control mode 1: It is used to start the motion flow control program, and the content of the motion control table in the project is used as the motion parameters.
  3. Motion control mode 2: It is used to perform motion control on the ladder diagram, and the content of the motion control table in the project is still used as the motion parameters.
  4. Motion control mode 3: It is used for ladder program to perform motion control, with PLC registers data as motion parameters.

Through these four types of motion control commands, users can flexibly use them in three control modes according to their usage habits and device functions. It not only improves work efficiency, but also improves the readability of project procedures.

6-1 Motion Control Basic Commands

6-1-1 Fun187 System Initialization (MFSysInit)

Fun187 P

MFSysInit

System Initialization

Fun187 P MFSysInit

Command Description

Ladder Symbol

No Operand

unction Description

  • If you want to control the servo through EtherCAT communication, you must execute this command before executing any motion control.
  • If you want to use Fun 235 to convert the physical axis to the virtual axis, it must be executed before this command.
  • EN = 1: Motion Initialization is enabled (Trigger conditions support up and down differential input)
  • ACT = 1: Motion Initialization is running
  • ERR – 1: Motion Initialization error
  • DN = 1: Motion Initialization is done

Program Example

Ladder

  • When the execution control “EN” = 1, the motion control function initialization action will be executed.
  • If there is no response during execution, please confirm whether the motion link setting is consistent with the actual link.
  • After initialization, the servo needs to be turned on to continue subsequent operations, for example, $ALL_SERVO_ON register (M10520)

6-1-2 Fun177 Motion System Emergency Stop (MFSysStop)

Fun177 P

MFSysStop

Motion System Emergency Stop

Fun177 P

MFSysStop

Command Description

Ladder Symbol

No Opearand

Function Description

  • Stop the entire Motion Flow and stop the EtherCAT communication. To start the flow again, run the ME_INIT again in order to trigger the EtherCAT communication.
  • EN = 1 : Stop the entire Motion Flow
  • EN = 1 : Motion System Emergency Stop is enabled
  • ACT = 1 : The emergency stop is acting
  • ERR = 1 : Emergency Stop error
  • DN = 1 : The emergency stop is done

Program Example

Ladder

  • When the execution control “EN” = 1, the motion control in execution will be stopped in an emergency.
  • If you want to restart the operation after execution, you need to perform initialization and start.

6-1-3 Fun185 Reset Motion Error Alarm (MFSysRstAlm)

Fun185 P

MFSysRstAlm

Reset Motion Error Alarm

Fun185 P

MFSysRstAlm

Command Description

Ladder Symbol

Operand

Function Description

Clears all motion flow and driver error alarms. However, the communication alarm of the driver cannot be cleared by this command and needs to be powered on again.

​

  • EN = 1 : Rising Trigger clears motion error alarm
  • ACT = 1 : Clearing motion error alarm is acting
  • ERR = 1 : Clearing motion error alarm error
  • DN = 1 : Clearing motion error alarm is done

Program Example

Ladder

  • When the execution control “EN” = 1, it will clear the motion flow and errors occurred in the driver.

6-1-4 Fun188 Read Motion Control Recipe

Fun188

MFSysRCPR

Read Motion Control Recipe

Fun188

MFSysRCPR

Command Description

Ladder Symbol

Operand

Md: Mode

D: Initial register of Recipe

Gp: Read the column of the recipe table

Relay and Register

Range

Operand

WX

WY

WM

WS

TMR

CTR

HR

IR

OR

SR

ROR

DR

K

XR

WX0

∣

WX1008

WY0

∣

WY1008

WM0

∣

WM9104

WS0

∣

WS3088

T0

∣

T1023

C0

∣

C1279

R0

∣

R34767

R34768

|

R34895

R35024

|

R35151

R35280

∣

R43223

R43224

∣

R47319

D0

∣

D7999

V, Z

P0 ~ P9

ID

○

○

○

○

○

○

○

○

○

○

○

○

0~1

D

○

○

○

○

○

○

○

○

○

○

○

○

○

Gp

○

○

○

○

○

○

○

○

○

○

○

○

0~100

Function Description

  • [Fun188 Recipe Read] and [Fun189 Recipe Write] are used to read or write a large number of motion control parameters. If you only need to modify a single or a few parameters, you can use [Fun181 Change Motion Control Parameters] or [Fun198 Mapping Table] .
  • Parameters can only be read when the axis action stops.
  • Operand

Md (Mode): 0 uses PLC Register , 1 gets data from the SD card

D (Recipe Initial Register): Md = 0 meaningless , Md = 1 SD card recipe file number

Gp (Read the column of the recipe table): Read the column of the recipe table, 0 read all

  • When the execution control [EN] changes from 0→1, Fun188 will read the specified recipe to the specified register.

When the execution control [EN] changes from 1→0, all output indications are reset.

  • When reading the recipe, the output indication [ACT] will be ON
  • When reading the recipe, if there is an error, the output indication [ERR] will be ON.
  • When the reading of the recipe is done, the output indication [DN] will be ON.

Recipe Table

【Project Management】>【Motion Control】>【Motion Recipe】

  • Motion Recipe Table

Tables: Point table, Axis table, Synchronization table

  • Index: Point table (number of points), axis table (number of axes), synchronization table (number of axes)

Length : consecutive point table or consecuitive axis

Initial Address: The initial address of the register for reading and writing recipes

  • Please refer to the following table for the value definition of the register of the Motion Recipe Table.

Recipe Point Table

Start Addres+N

Item

Size

Type

L

Definition

R+0

Operation Mode

WORD

INT

1

  1. Unuse
  2. Single/ABS
  3. Single/INC
  4. Linear(2Axis)/ABS
  5. Linear(2Axis)/INC
  6. Linear(3Axis)/ABS
  7. Linear(3Axis)/INC
  8. Linear(4Axis)/ABS
  9. Linear(4Axis)/INC
  10. Arc/ABS
  11. Arc/ INC
  12. Arc 3D/ABS
  13. Arc 3D/ INC
  14. Helical/ABS
  15. Helical/ INC
  16. Single Velocity

R+1

Accerlation Profile

WORD

INT

1

  1. T Curve
  2. S Curve

R+2

Master Axis

WORD

INT

1

1~16

Non use = 0

R+3

Interpolation 1

WORD

INT

1

1~16

Non use = 0

R+4

Interpolation 2

WORD

INT

1

1~16

Non use = 0

R+5

Interpolation 3

WORD

INT

1

1~16

Non use = 0

R+6

Target Position

Master Axis

DWORD

INT

2

Precision: Decimal Place

(negative number allow)

R+8

Target Position

Interpolation 1

DWORD

INT

2

Precision: Decimal Place

(negative number allow)

R+10

Target Position

Interpolation 2

DWORD

INT

2

Precision: Decimal Place

(negative number allow)

R+12

Target Position

Interpolation 3

DWORD

INT

2

Precision: Decimal Place

(negative number allow)

R+14

Velocity

DWORD

INT

2

Precision: Decimal Place

(positive number only)

R+16

Acceleration

DWORD

INT

2

Precision: Decimal Place

(positive number only)

R+18

Deceleration

DWORD

INT

2

Precision: Decimal Place

(positive number only)

R+20

Acceleration S Curve

WORD

INT

1

Precision: 0.1

R+21

Deceleration S Curve

WORD

INT

1

Precision: 0.1

R+22

Arc Mode

WORD

INT

1

  1. Border Point
  2. Center
  3. Radius

R+23

Arc Direction

WORD

INT

1

  1. CW
  2. CCW

R+24

Arc (Border/Center) X coordinate

DWORD

INT

2

Precision: Decimal Place

(negative number allow)

R+26

Arc (Border/Center) Y coordinate

DWORD

INT

2

Precision: Decimal Place

(negative number allow)

R+28

Arc Radius

DWORD

INT

2

Precision: Decimal Place

(positive number only)

R+30

Aux Radius

DWORD

INT

2

Precision: Decimal Place

(positive number only)

R+32

Standby Time

DWORD

UINT

2

Unit: ms

R+34

Continuous Point

WORD

INT

1

1~1024

End = 0

R+35

Circle Revolution

WORD

UINT

1

0~65535

R+36

Continuous Mode

WORD

INT

1

  1. Standby
  2. Next Point Speed Continue
  3. Current Point Speed Continue
  4. Starting Speed Continue

R+37-41

Reserve

5

R+42

Arc (Border/Center) Z coordinate

DWORD

INT

2

Precision: Decimal Place

(negative number allow)

Recipe Axis Table

Start Addres+N

Item

Size

Type

L

Definition

R+0

Encoder Type

WORD

1

0 = Incremental

1 = Absolute

R+1

Unit

WORD

1

  1. PLS
  2. Mm
  3. Deg
  4. inch

R+2

Decimal Point

WORD

1

1000: 1

100: 0.1

10: 0.01

1: 0.001

R+3

Pulse/Revolution

DWORD

2

Precision: Decimal Place

R+5

Unit/Revolution

DWORD

2

Precision: Decimal Place

R+7

Velocity Unit

DWORD

1

  1. PLS/Sec
  2. PLS/min
  3. RPM

R+8

Velocity Gain

DWORD

2

Precision: 0.001

R+10

Start Velocity

DWORD

2

Precision: Decimal Place

R+12

Max Motor Velocity

DWORD

2

Precision: 1

Unit: RPM

R+14

Default Acceleration

DWORD

2

Precision: Decimal Place

R+16

Default Deceleration

DWORD

2

Precision: Decimal Place

R+18

Soft Limit(+)

DWORD

2

Precision: Decimal Place

(positive number only)

R+20

Soft Limit(-)

DWORD

2

Precision: Decimal Place

(positive number only)

R+22

Following Error Window

DWORD

2

Precision: Decimal Place

R+24

Following Error Timeout

DWORD

2

Unit: ms

R+26

Pos Done Tolerance

DWORD

2

Precision: Decimal Place

R+28

Pos Done Check Time

DWORD

2

Unit: ms

R+30

Maximum Motor Torque

WORD

1

Precision: 0.1

R+31

Maximum Torque Limit(+)

WORD

1

Precision: 0.1

R+32

Maximum Torque Limit(-)

WORD

1

Precision: 0.1

R+33

Touch Probe1 Source

WORD

1

  1. Disable
  2. Input
  3. Z Signal

R+34

Touch Probe1 Mode

WORD

1

  1. Rising Edge Single
  2. Rising Edge Continue
  3. Falling Edge Single
  4. Falling Edge Continue

R+35

Touch Probe2 Source

WORD

1

  1. Disable
  2. Input
  3. Z Signal

R+36

Touch Probe2 Mode

WORD

1

  1. Rising Edge Single
  2. Rising Edge Continue
  3. Falling Edge Single
  4. Falling Edge Continue

R+37-40

Reserve

4

R+41

Stop Mode

WORD

1

5. Deceleration Stop

7. Immediately Stop

R+42

Stop Deceleration

DWORD

2

Precision: Decimal Place

R+44

Homing Mode

WORD

1

99. Homing on current position
100. Forward-Falling Trigger
101. Backward-Falling Trigger
102. Z Signal-Forward-Rising Trigger
103. Z Signal-Forward-Falling Trigger

104. Forward- Rising Trigger

105. Backward-Rising Trigger

106. Z Signal-Backward-Rising Trigger

107. Z Signal-Backward-Falling Trigger

R+45

Homing IO Source

WORD

1

  1. From Servo Driver
  2. From PLC

R+46

Homing Start Direction

WORD

1

  1. Negative
  2. Positive

R+47

Homing Origin Offset

DWORD

2

Precision: Decimal Place

(negative number allow)

R+49

Homing Find Velocity

DWORD

2

Precision: Decimal Place

R+51

Homing Creep Velocity

DWORD

2

Precision: Decimal Place

R+53

Homing Deceleration

DWORD

2

Precision: Decimal Place

R+55

Limit Switch(-)(DI)

WORD

1

R+56

Limit Switch(+)(DI)

WORD

1

R+57

Homing Switch(DI)

WORD

1

R+58

Homing Z Count

DWORD

2

R+60

Jogging Base Velocity

DWORD

2

Precision: Decimal Place

R+62

Jogging Velocity

DWORD

2

Precision: Decimal Place

R+64

Jogging Acceleration

DWORD

2

Precision: Decimal Place

R+66

Jogging Deceleration

DWORD

2

Precision: Decimal Place

R+68

Inching Distance

DWORD

2

Precision: Decimal Place

Recipe Synchronous Table

Start Addres+N

Item

Size

Type

L

Definition

R+0

Input axis coordinate Unit

WORD

1

R+1

Input axis coordinate decimal point

WORD

1

R+2

Input axis period

DWORD

2

Precision: Decimal Place

R+4

Clutch OFF sliding time at deceleration stop

DWORD

2

R+6

Input axis phase init method

WORD

1

R+7

Sync master axis phase default value

DWORD

2

Precision: Decimal Place

R+9

Master axis phase default value after phase compensation

DWORD

2

Precision: Decimal Place

R+11

Main clutch input axis phase default value

DWORD

2

Precision: Decimal Place

R+13

Auxiliary clutch input axis phase default value

DWORD

2

Precision: Decimal Place

R+15

Cam input axis/clutch output axis phase init method

WORD

1

R+16

Main clutch output axis phase default value

DWORD

2

Precision: Decimal Place

R+18

Auxiliary clutch output axis phase default value

DWORD

2

Precision: Decimal Place

R+20

Reserve

DWORD

2

R+22

Cam input axis phase default value

DWORD

2

Precision: Decimal Place

R+24

Cam output axis base coordinate

DWORD

2

Precision: Decimal Place

R+26

Master Axis 1 input selection

WORD

1

R+27

Master Axis 1 external reference number

WORD

1

R+28

Master Axis 1 prevent reverse

WORD

1

R+29

Master Axis 1 coordinate transformation setting

WORD

1

R+30

Master Axis 1 coordinate transformation numerator

DWORD

2

R+32

Master Axis 1 coordinate transformation denominator

DWORD

2

R+34

Master Axis 2 input selection

WORD

1

R+35

Master Axis 2 external reference number

WORD

1

R+36

Master Axis 2 prevent reverse

WORD

1

R+37

Master Axis 2 coordinate transformation setting

WORD

1

R+38

Master Axis 2 coordinate transformation numerator

DWORD

2

R+40

Master Axis 2 coordinate transformation denominator

DWORD

2

R+42

Aux Axis input selection

WORD

1

R+43

Aux Axis external reference number

WORD

1

R+44

Aux Axis prevent reverse

WORD

1

R+45

Aux Axis coordinate transformation setting

WORD

1

R+46

Aux Axis

coordinate transformation numerator

DWORD

2

R+48

Aux Axis coordinate transformation denominator

DWORD

2

R+50

Master Axis compensation command value

DWORD

2

Precision: Decimal Place

R+52

Master Axis compensation change mode

WORD

1

R+53

Master Axis compensation change time

DWORD

2

R+55

Aux Axis compensation command value

DWORD

2

Precision: Decimal Place

R+57

Aux Axis compensation change mode

WORD

1

R+58

Aux Axis compensation change time

DWORD

2

R+60

Variable gear retio numerator

DWORD

2

R+62

Variable gear retio denominator

DWORD

2

R+64

Gear retio change mode

WORD

1

R+65

Variable gear retio change time

DWORD

2

R+67

Main clutch ON condition

WORD

1

R+68

Main clutch ON setting value

DWORD

2

Precision: Decimal Place

R+70

Main clutch ON delay

DWORD

2

Precision: Decimal Place

R+72

Reserve

WORD

1

R+73

Main clutch ON connection method

WORD

1

R+74

Reserve

WORD

1

R+75

Main clutch ON sliding curve

WORD

1

R+76

Reserve

DWORD

2

R+78

Main clutch ON sliding time

DWORD

2

R+80

Main clutch ON following time

DWORD

2

R+82

Main clutch ON follow-ups

DWORD

2

Precision: Decimal Place

R+84

Main clutch OFF condition

WORD

1

R+85

Main clutch OFF setting value

DWORD

2

Precision: Decimal Place

R+87

Main clutch OFF delay

DWORD

2

Precision: Decimal Place

R+87

Reserve

WORD

1

R+90

Main clutch OFF connection method

WORD

1

R+91

Reserve

WORD

1

R+92

Main clutch OFF sliding curve

WORD

1

R+93

Reserve

DWORD

2

R+95

Main clutch OFF sliding time

DWORD

2

R+97

Aux clutch ON condition

WORD

1

R+98

Aux clutch ON setting value

DWORD

2

Precision: Decimal Place

R+100

Aux clutch ON delay

DWORD

2

Precision: Decimal Place

R+102

Reserve

WORD

1

R+103

Aux clutch ON connection method

WORD

1

R+104

Reserve

WORD

1

R+105

Aux clutch ON sliding curve

WORD

1

R+106

Reserve

DWORD

2

R+108

Aux clutch ON sliding time

DWORD

2

R+110

Aux clutch ON following time

DWORD

2

R+112

Aux clutch ON follow-ups

DWORD

2

Precision: Decimal Place

R+114

Aux clutch OFF condition

WORD

1

R+115

Aux clutch OFF setting value

DWORD

2

Precision: Decimal Place

R+117

Aux clutch OFF delay

DWORD

2

Precision: Decimal Place

R+119

Reserve

WORD

1

R+120

Aux clutch OFF connection method

WORD

1

R+121

Reserve

WORD

1

R+122

Aux clutch OFF sliding curve

WORD

1

R+123

Reserve

DWORD

2

R+125

Aux clutch OFF sliding time

DWORD

2

R+127

Reserve

WORD*5

5

R+132

Step Angle Compensation Base speed

DWORD

2

Precision: Decimal Place

R+134

Step Angle Compensation Base value

DWORD

2

Precision: Decimal Place

R+136

Step Angle Compensation value change mode

WORD

1

R+137

Step Angle Compensation value change time

DWORD

2

R+139

Cam data No.

WORD

1

R+140

Cam stroke

DWORD

2

Precision: Decimal Place

R+142

Cam contact output No.

WORD

1

R+143

Output filter time constant

DWORD

2

R+145-149

Reserve

Program Example

Ladder

  • When M1000 is from OFF→ON, read all recipe tables and store them in R1000.
  • Read the parameters of PLC point table 1 and store them in R1000-R1049
  • Read the parameters of the PLC axis table (axis 1) and store them in R1050-R1119
  • Read the parameters of the PLC synchronous table (axis 1) and store them in R1120-R1269

6-1-5 Fun189 Write Motion Control Recipe

Fun189

MFSysRCPW

Write Motion Control Recipe

Fun189

MFSysRCPW

Command Description

Ladder Symbol

Operands

Md: Mode

D: Initial Recipe Register

Gp: Write to the column of the recipe table

Relay and Register

Ranga

Operand

WX

WY

WM

WS

TMR

CTR

HR

IR

OR

SR

ROR

DR

K

XR

WX0

∣

WX1008

WY0

∣

WY1008

WM0

∣

WM9104

WS0

∣

WS3088

T0

∣

T1023

C0

∣

C1279

R0

∣

R34767

R34768

|

R34895

R35024

|

R35151

R35280

∣

R43223

R43224

∣

R47319

D0

∣

D7999

V, Z

P0 ~ P9

Md

○

○

○

○

○

○

○

○

○

○

○

○

0~1

D

○

○

○

○

○

○

○

○

○

○

○

○

Gp

○

○

○

○

○

○

○

○

○

○

○

○

0~100

Function Description

  • [Fun188 Read Recipe] and [Fun189 Write Recipe] are used to read or write a large number of motion control parameters. If you only need to modify a single or a few parameters, you can use [Fun181 Change Motion Control Parameters] or [Fun198 Mapping Table].
  • Parameters can only be written when the axis action stops.
  • Operands

Md (Mode): 0 uses PLC Register , 1 gets data from the SD card

D (Initial Recipe Register): Md = 0 meaningless , Md = 1 SD card recipe file number

Gp (Write to the column of the recipe table): Write to the column of the recipe table, 0 Write into the all.

  • When the execution control [EN] changes from 0→1, Fun188 will write the specified register to the specified recipe.
  • When the execution control [EN] changes from 1→0, all output indications are reset.
  • When writing into the recipe, the output indication [ACT] is ON.
  • When writing in the recipe, if there is an error, the output indication [ERR] is ON.
  • When writing the recipe is completed, the output indication [DN] is ON.

Recipe Table

【Project Management】>【Motion Control】>【Motion Recipe】

  • Motion Recipe Table

Table: Point Table, Axis Table, Synchronous Table

Index : Point Table (Point No.), Axis Table (Axis No.), Synchronous Table (Axis No.)

Length :Consecutive point table or consecutive axis

Initial Address :Initial address of recipe register

  • Please refer to the following table for the definition of the register value of the motion recipe table

Recipe Point Table

Start Addres+N

Item

Size

Type

L

Definition

R+0

Operation Mode

WORD

INT

1

  1. Unuse
  2. Single/ABS
  3. Single/INC
  4. Linear(2Axis)/ABS
  5. Linear(2Axis)/INC
  6. Linear(3Axis)/ABS
  7. Linear(3Axis)/INC
  8. Linear(4Axis)/ABS
  9. Linear(4Axis)/INC
  10. Arc/ABS
  11. Arc/ INC
  12. Arc 3D/ABS
  13. Arc 3D/ INC
  14. Helical/ABS
  15. Helical/ INC
  16. Single Velocity

R+1

Accerlation Profile

WORD

INT

1

  1. T Curve
  2. S Curve

R+2

Master Axis

WORD

INT

1

1~16

Non use = 0

R+3

Interpolation 1

WORD

INT

1

1~16

Non use = 0

R+4

Interpolation 2

WORD

INT

1

1~16

Non use = 0

R+5

Interpolation 3

WORD

INT

1

1~16

Non use = 0

R+6

Target Position

Master Axis

DWORD

INT

2

Precision: Decimal Place

(negative number allow)

R+8

Target Position

Interpolation 1

DWORD

INT

2

Precision: Decimal Place

(negative number allow)

R+10

Target Position

Interpolation 2

DWORD

INT

2

Precision: Decimal Place

(negative number allow)

R+12

Target Position

Interpolation 3

DWORD

INT

2

Precision: Decimal Place

(negative number allow)

R+14

Velocity

DWORD

INT

2

Precision: Decimal Place

(positive number only)

R+16

Acceleration

DWORD

INT

2

Precision: Decimal Place

(positive number only)

R+18

Deceleration

DWORD

INT

2

Precision: Decimal Place

(positive number only)

R+20

Acceleration S Curve

WORD

INT

1

Precision: 0.1

R+21

Deceleration S Curve

WORD

INT

1

Precision: 0.1

R+22

Arc Mode

WORD

INT

1

  1. Border Point
  2. Center
  3. Radius

R+23

Arc Direction

WORD

INT

1

  1. CW
  2. CCW

R+24

Arc (Border/Center) X coordinate

DWORD

INT

2

Precision: Decimal Place

(negative number allow)

R+26

Arc (Border/Center) Y coordinate

DWORD

INT

2

Precision: Decimal Place

(negative number allow)

R+28

Arc Radius

DWORD

INT

2

Precision: Decimal Place

(positive number only)

R+30

Aux Radius

DWORD

INT

2

Precision: Decimal Place

(positive number only)

R+32

Standby Time

DWORD

UINT

2

Unit: ms

R+34

Continuous Point

WORD

INT

1

1~1024

End = 0

R+35

Circle Revolution

WORD

UINT

1

0~65535

R+36

Continuous Mode

WORD

INT

1

  1. Standby
  2. Next Point Speed Continue
  3. Current Point Speed Continue
  4. Starting Speed Continue

R+37-41

Reserve

5

R+42

Arc (Border/Center) Z coordinate

DWORD

INT

2

Precision: Decimal Place

(negative number allow)

Recipe Axis Table

Start Addres+N

Item

Size

Type

L

Definition

R+0

Encoder Type

WORD

1

0 = Incremental

1 = Absolute

R+1

Unit

WORD

1

  1. PLS
  2. Mm
  3. Deg
  4. inch

R+2

Decimal Point

WORD

1

1000: 1

100: 0.1

10: 0.01

1: 0.001

R+3

Pulse/Revolution

DWORD

2

Precision: Decimal Place

R+5

Unit/Revolution

DWORD

2

Precision: Decimal Place

R+7

Velocity Unit

DWORD

1

  1. PLS/Sec
  2. PLS/min
  3. RPM

R+8

Velocity Gain

DWORD

2

Precision: 0.001

R+10

Start Velocity

DWORD

2

Precision: Decimal Place

R+12

Max Motor Velocity

DWORD

2

Precision: 1

Unit: RPM

R+14

Default Acceleration

DWORD

2

Precision: Decimal Place

R+16

Default Deceleration

DWORD

2

Precision: Decimal Place

R+18

Soft Limit(+)

DWORD

2

Precision: Decimal Place

(positive number only)

R+20

Soft Limit(-)

DWORD

2

Precision: Decimal Place

(positive number only)

R+22

Following Error Window

DWORD

2

Precision: Decimal Place

R+24

Following Error Timeout

DWORD

2

Unit: ms

R+26

Pos Done Tolerance

DWORD

2

Precision: Decimal Place

R+28

Pos Done Check Time

DWORD

2

Unit: ms

R+30

Maximum Motor Torque

WORD

1

Precision: 0.1

R+31

Maximum Torque Limit(+)

WORD

1

Precision: 0.1

R+32

Maximum Torque Limit(-)

WORD

1

Precision: 0.1

R+33

Touch Probe1 Source

WORD

1

  1. Disable
  2. Input
  3. Z Signal

R+34

Touch Probe1 Mode

WORD

1

  1. Rising Edge Single
  2. Rising Edge Continue
  3. Falling Edge Single
  4. Falling Edge Continue

R+35

Touch Probe2 Source

WORD

1

  1. Disable
  2. Input
  3. Z Signal

R+36

Touch Probe2 Mode

WORD

1

  1. Rising Edge Single
  2. Rising Edge Continue
  3. Falling Edge Single
  4. Falling Edge Continue

R+37-40

Reserve

4

R+41

Stop Mode

WORD

1

5. Deceleration Stop

7. Immediately Stop

R+42

Stop Deceleration

DWORD

2

Precision: Decimal Place

R+44

Homing Mode

WORD

1

99. Homing on current position
100. Forward-Falling Trigger
101. Backward-Falling Trigger
102. Z Signal-Forward-Rising Trigger
103. Z Signal-Forward-Falling Trigger

104. Forward- Rising Trigger

105. Backward-Rising Trigger

106. Z Signal-Backward-Rising Trigger

107. Z Signal-Backward-Falling Trigger

R+45

Homing IO Source

WORD

1

  1. From Servo Driver
  2. From PLC

R+46

Homing Start Direction

WORD

1

  1. Negative
  2. Positive

R+47

Homing Origin Offset

DWORD

2

Precision: Decimal Place

(negative number allow)

R+49

Homing Find Velocity

DWORD

2

Precision: Decimal Place

R+51

Homing Creep Velocity

DWORD

2

Precision: Decimal Place

R+53

Homing Deceleration

DWORD

2

Precision: Decimal Place

R+55

Limit Switch(-)(DI)

WORD

1

R+56

Limit Switch(+)(DI)

WORD

1

R+57

Homing Switch(DI)

WORD

1

R+58

Homing Z Count

DWORD

2

R+60

Jogging Base Velocity

DWORD

2

Precision: Decimal Place

R+62

Jogging Velocity

DWORD

2

Precision: Decimal Place

R+64

Jogging Acceleration

DWORD

2

Precision: Decimal Place

R+66

Jogging Deceleration

DWORD

2

Precision: Decimal Place

R+68

Inching Distance

DWORD

2

Precision: Decimal Place

Recipe Synchronous Table

Start Addres+N

Item

Size

Type

L

Definition

R+0

Input axis coordinate Unit

WORD

1

R+1

Input axis coordinate decimal point

WORD

1

R+2

Input axis period

DWORD

2

Precision: Decimal Place

R+4

Clutch OFF sliding time at deceleration stop

DWORD

2

R+6

Input axis phase init method

WORD

1

R+7

Sync master axis phase default value

DWORD

2

Precision: Decimal Place

R+9

Master axis phase default value after phase compensation

DWORD

2

Precision: Decimal Place

R+11

Main clutch input axis phase default value

DWORD

2

Precision: Decimal Place

R+13

Auxiliary clutch input axis phase default value

DWORD

2

Precision: Decimal Place

R+15

Cam input axis/clutch output axis phase init method

WORD

1

R+16

Main clutch output axis phase default value

DWORD

2

Precision: Decimal Place

R+18

Auxiliary clutch output axis phase default value

DWORD

2

Precision: Decimal Place

R+20

Reserve

DWORD

2

R+22

Cam input axis phase default value

DWORD

2

Precision: Decimal Place

R+24

Cam output axis base coordinate

DWORD

2

Precision: Decimal Place

R+26

Master Axis 1 input selection

WORD

1

R+27

Master Axis 1 external reference number

WORD

1

R+28

Master Axis 1 prevent reverse

WORD

1

R+29

Master Axis 1 coordinate transformation setting

WORD

1

R+30

Master Axis 1 coordinate transformation numerator

DWORD

2

R+32

Master Axis 1 coordinate transformation denominator

DWORD

2

R+34

Master Axis 2 input selection

WORD

1

R+35

Master Axis 2 external reference number

WORD

1

R+36

Master Axis 2 prevent reverse

WORD

1

R+37

Master Axis 2 coordinate transformation setting

WORD

1

R+38

Master Axis 2 coordinate transformation numerator

DWORD

2

R+40

Master Axis 2 coordinate transformation denominator

DWORD

2

R+42

Aux Axis input selection

WORD

1

R+43

Aux Axis external reference number

WORD

1

R+44

Aux Axis prevent reverse

WORD

1

R+45

Aux Axis coordinate transformation setting

WORD

1

R+46

Aux Axis

coordinate transformation numerator

DWORD

2

R+48

Aux Axis coordinate transformation denominator

DWORD

2

R+50

Master Axis compensation command value

DWORD

2

Precision: Decimal Place

R+52

Master Axis compensation change mode

WORD

1

R+53

Master Axis compensation change time

DWORD

2

R+55

Aux Axis compensation command value

DWORD

2

Precision: Decimal Place

R+57

Aux Axis compensation change mode

WORD

1

R+58

Aux Axis compensation change time

DWORD

2

R+60

Variable gear retio numerator

DWORD

2

R+62

Variable gear retio denominator

DWORD

2

R+64

Gear retio change mode

WORD

1

R+65

Variable gear retio change time

DWORD

2

R+67

Main clutch ON condition

WORD

1

R+68

Main clutch ON setting value

DWORD

2

Precision: Decimal Place

R+70

Main clutch ON delay

DWORD

2

Precision: Decimal Place

R+72

Reserve

WORD

1

R+73

Main clutch ON connection method

WORD

1

R+74

Reserve

WORD

1

R+75

Main clutch ON sliding curve

WORD

1

R+76

Reserve

DWORD

2

R+78

Main clutch ON sliding time

DWORD

2

R+80

Main clutch ON following time

DWORD

2

R+82

Main clutch ON follow-ups

DWORD

2

Precision: Decimal Place

R+84

Main clutch OFF condition

WORD

1

R+85

Main clutch OFF setting value

DWORD

2

Precision: Decimal Place

R+87

Main clutch OFF delay

DWORD

2

Precision: Decimal Place

R+87

Reserve

WORD

1

R+90

Main clutch OFF connection method

WORD

1

R+91

Reserve

WORD

1

R+92

Main clutch OFF sliding curve

WORD

1

R+93

Reserve

DWORD

2

R+95

Main clutch OFF sliding time

DWORD

2

R+97

Aux clutch ON condition

WORD

1

R+98

Aux clutch ON setting value

DWORD

2

Precision: Decimal Place

R+100

Aux clutch ON delay

DWORD

2

Precision: Decimal Place

R+102

Reserve

WORD

1

R+103

Aux clutch ON connection method

WORD

1

R+104

Reserve

WORD

1

R+105

Aux clutch ON sliding curve

WORD

1

R+106

Reserve

DWORD

2

R+108

Aux clutch ON sliding time

DWORD

2

R+110

Aux clutch ON following time

DWORD

2

R+112

Aux clutch ON follow-ups

DWORD

2

Precision: Decimal Place

R+114

Aux clutch OFF condition

WORD

1

R+115

Aux clutch OFF setting value

DWORD

2

Precision: Decimal Place

R+117

Aux clutch OFF delay

DWORD

2

Precision: Decimal Place

R+119

Reserve

WORD

1

R+120

Aux clutch OFF connection method

WORD

1

R+121

Reserve

WORD

1

R+122

Aux clutch OFF sliding curve

WORD

1

R+123

Reserve

DWORD

2

R+125

Aux clutch OFF sliding time

DWORD

2

R+127

Reserve

WORD*5

5

R+132

Step Angle Compensation Base speed

DWORD

2

Precision: Decimal Place

R+134

Step Angle Compensation Base value

DWORD

2

Precision: Decimal Place

R+136

Step Angle Compensation value change mode

WORD

1

R+137

Step Angle Compensation value change time

DWORD

2

R+139

Cam data No.

WORD

1

R+140

Cam stroke

DWORD

2

Precision: Decimal Place

R+142

Cam contact output No.

WORD

1

R+143

Output filter time constant

DWORD

2

R+145-149

Reserve

Program Example

Ladder

  • When M1000 is from OFF to ON, write all recipe tables from R1000.

6-1-6 Fun191 Read Motion Control Cam

Fun191

MFSysCAMR

Read Motion Control Cam

Fun191

MFSysCAMR

Command Description

Ladder Symbol

Operands

Md: Mode

D: Initial Cam Register

ID: Cam Number

L: Cam Resolution

Relay and Register

Ranga

Operand

WX

WY

WM

WS

TMR

CTR

HR

IR

OR

SR

ROR

DR

K

XR

WX0

∣

WX1008

WY0

∣

WY1008

WM0

∣

WM9104

WS0

∣

WS3088

T0

∣

T1023

C0

∣

C1279

R0

∣

R34767

R34768

|

R34895

R35024

|

R35151

R35280

∣

R43223

R43224

∣

R47319

D0

∣

D7999

V, Z

P0 ~ P9

Md

○

○

○

○

○

○

○

○

○

○

○

○

0~1

D

○

○

○

○

○

○

○

○

○

○

○

○

ID

○

○

○

○

○

○

○

○

○

○

○

○

1~16

L

2048~32767

Function Description

  • Operands

Md (Mode): 0 uses PLC Register , 1 gets data from the SD card

D (Initial Cam Register): Md = 0 The initial address of the register to be stored after reading the Cam , Md = 1 SD card recipe file number

ID (Cam Number): Cam number

L (Cam Resolution): The length of the register to be stored after reading the Cam

  • When the execution control [EN] changes from 0→1, Fun191 will read the specified Cam to the specified register.

When the execution control [EN] changes from 1→0, all output indications are reset

  • When the Cam is being read, the output indication [ACT] is ON.
  • When reading the Cam, if there is an error, the output indication [ERR] will be ON.
  • When the reading of the Cam is completed, the output indication [DN] is ON.

Program Example

Ladder

CAM

Datagram

  • When M1000 is from OFF→ON, Read cam table 1 (ID:1), save 2048 cam data to DR1000~DR5094.

6-1-7 Fun192 Write Motion Control Cam

Fun192

MFSysCAMW

Write Motion Control Cam

Fun192

MFSysCAMW

Symbol

Ladder Symbol

Operands

Md: Mode

D: C Initial am Address

ID: Cam Number

L: Cam Resolution

Relay and Register

Range

Operand

WX

WY

WM

WS

TMR

CTR

HR

IR

OR

SR

ROR

DR

K

XR

WX0

∣

WX1008

WY0

∣

WY1008

WM0

∣

WM9104

WS0

∣

WS3088

T0

∣

T1023

C0

∣

C1279

R0

∣

R34767

R34768

|

R34895

R35024

|

R35151

R35280

∣

R43223

R43224

∣

R47319

D0

∣

D7999

V, Z

P0 ~ P9

Md

○

○

○

○

○

○

○

○

○

○

○

○

0~1

D

○

○

○

○

○

○

○

○

○

○

○

○

ID

○

○

○

○

○

○

○

○

○

○

○

○

1~16

L

2048~32767

Function Description

  • Operands

Md (Mode): 0 use PLC register , 1 gets data from the SD card

D (Initial Cam Register): Md = 0 Write the initial address of the initial register of the cam , Md = 1 SD card recipe file number

ID (Cam Number): Cam number

L (Cam Resolution): The initial length of the register written to the cam

  • When the execution control [EN] changes from 0 to 1, Fun191 will write the designated register to the designated Cam.

When the execution control [EN] changes from 1→0, all output indications are reset.

  • When writing to the Cam, the output indication [ACT] is ON.
  • When writing to the Cam, if there is an error, the output indication [ERR] is ON.
  • When writing to the Cam is completed, the output indication [DN] is ON.

Program Example

Ladder

CAM

Datagram

  • When M1000 is from OFF to ON, write 2048 cam data (DR1000~DR5094) to cam 1 (ID = 1)

6-1-8 Fun196 Generate Cam (MFSysCAMGen)

Fun196 D

MFSysCAMGen

Generate Cam

Fun196 D

MFSysCAMGen

Command Description

Ladder Symbol

Operands

ID: Cam No.

Md: Cam Generating Mode

D: Register Starting Address

L: Cam Curve Stage No.

Relay and Register

Range

Operand

WX

WY

WM

WS

TMR

CTR

HR

IR

OR

SR

ROR

DR

K

XR

WX0

∣

WX1008

WY0

∣

WY1008

WM0

∣

WM9104

WS0

∣

WS3088

T0

∣

T1023

C0

∣

C1279

R0

∣

R34767

R34768

|

R34895

R35024

|

R35151

R35280

∣

R43223

R43224

∣

R47319

D0

∣

D7999

V, Z

P0 ~ P9

ID

○

○

○

○

○

○

○

○

○

○

○

○

1~16

Md

0~2

D

○

○

○

○

○

○

○

○

○

○

○

○

L

○

○

○

○

○

○

○

○

○

○

○

○

Function Description

  • Operands

ID (Cam No.): 1-16

Md (Cam Generating Mode): 0 same as the cam table, 2 (Under development)

D (Register Starting Address): Set starting register of the Cam

L (Cam Curve Stage No.): Only Mode 0 has the setting of each stage of the Cam, and other modes do not need to be set.

  • When the execution control [EN] changes from 0→1, Fun196 will generate Cams according to the set mode.

When the execution control [EN] changes from 1→0, all output indications are reset.

  • When the Cam is being generated, the output indication [ACT] will be ON
  • When the Cam is generating, if an error occurs, the output indication [ERR] will be ON
  • When the Cam generation is completed, the output indication [DN] will be ON.

Mode 0

Program Example

Ladder

CAM

CAM Parameters

D

  • When M1000 is from OFF to ON, the Cam is generated according to the current Fun196 number (ID: Cam number 1, Md: Mode 0, D: Setting the cam generation parameters from R1000, L: second stage cam curve).

Mode 1

Type 0:Fly Saw / 1:Rotary Cut

  • Speed Ratio Numerator:input "Input period"

Speed Ratio Denominator:input "Cam stroke"

  • Assume the cam stroke is two times the input period, the speed of slave axis is also two times the speed of master axis. Thus, setting the velocity ratio as left-hand side can make both master and slave axes in the same speed.

Mode 1

Type 2:Rotary Cut with initial speed

Program Example

Ladder

D (Cutter Number:1)

Input period (mm)

  • When EN switches from OFF to ON, a flying shear motion with initial speed is executed for a cut count of 1, according to the current Fun196 settings (ID: Cam number 1; Md: Mode 1 (cutter type: 2); D: cam generation parameters configured starting from R200).

D (Cutter Number:2)

Input period (mm)

Mode1

Type 3:Specific point of sync Fly Saw / 4:Specific point of sync Rotary Cut

Program Example

Ladder

D

Input period (mm)

  • When EN switches from OFF to ON, the flying shear operation at the specified synchronous position is executed according to the current Fun196 settings (ID: Cam No. 1; Md: Mode 1 (Type 4); D: cam generation parameters starting from R200).

6-1-9 Fun235 Set Axis to Virtual (MFSysSetVirt)

Fun235 P

MFSysSetVirt

Set Axis to Virtual

Fun235 P

MFSysSetVirt

Command Description

Ladder Symbol

Operands

AX : Axis Number

Relay and Register

範圍

Operands

WX

WY

WM

WS

TMR

CTR

HR

IR

OR

SR

ROR

DR

K

XR

WX0

∣

WX1008

WY0

∣

WY1008

WM0

∣

WM9104

WS0

∣

WS3088

T0

∣

T1023

C0

∣

C1279

R0

∣

R34767

R34768

|

R34895

R35024

|

R35151

R35280

∣

R43223

R43224

∣

R47319

D0

∣

D7999

V, Z

P0 ~ P9

AX

○

○

○

○

○

○

○

○

○

○

○

○

1~16

Function Description

  • Operands

AX : The Axis number that will be convert to virtual axis. Range: 1~16

  • Trigger EN in upper edge to execute.
  • This function should be executed before initialize the motion controller (Fun187).
  • When the function is in operating, the coil ACT will be set to ON.
  • When the function is in error, the coil ERR will be set to ON.
  • When the function is finished, the coil DN will be set to ON.

Program Example

Ladder

  • When enable M0, the motion controller will convert axis 1 to virtual axis.

7

6-1-10 Fun236 EtherCAT SDO Read (MFSDOR)

Fun236 P

MFSDOR

EtherCAT SDO Read

Fun236 P

MFSDOR

Command Description

Ladder Symbol

Operands

S : Slave Number

I : Index

SI : Sub-index

LN : Length

EC : Register for error code

D : Data Register (DWORD)

Relay and Register

Range

Operand

WX

WY

WM

WS

TMR

CTR

HR

IR

OR

SR

ROR

DR

K

XR

WX0

∣

WX1008

WY0

∣

WY1008

WM0

∣

WM9104

WS0

∣

WS3088

T0

∣

T1023

C0

∣

C1279

R0

∣

R34767

R34768

|

R34895

R35024

|

R35151

R35280

∣

R43223

R43224

∣

R47319

D0

∣

D7999

V, Z

P0 ~ P9

S

○

○

○

○

○

○

○

○

○

○

○

○

I

○

○

○

○

○

○

○

○

○

○

○

○

SI

○

○

○

○

○

○

○

○

○

○

○

○

LN

○

○

○

○

○

○

○

○

○

○

○

○

EC

○

○

○

○

○

○

○

○

○

○

○

○

D

○

○

○

○

○

○

○

○

○

○

○

○

Function Description

  • Operands

S : Slave Number in EtherCAT

I : Index of parameter in slave memory

SI : Sub-index of parameter in slave memory

LN : Length of the parameter

EC : Register for error code

D : Data Register (DWORD)

  • When execution control (EN) is triggered in upper edge, the function will be executed for SDO reading.
  • When the function is in operating, the coil ACT will be set to ON.
  • When the function is in error, the coil ERR will be set to ON.
  • When the function is finished, the coil DN will be set to ON.

Program Example

Ladder

  • Assume we want to read the status word of slave 1. The parameters will be: S = 1, I = 0x6041, SI = 0, LN = 2. After trigger the pin EN, the status word will be showed at R10 (D = R10).

6-1-11 Fun237 EtherCAT SDO Write (MFSDOW)

Fun237 P

MFSDOW

EtherCAT SDO Write

Fun237 P

MFSDOW

Command Description

Ladder Symbol

Operands

S : Slave Number

I : Index

SI : Sub-index

LN : Length

EC : Register for error code

D : Data Register (DWORD)

Relay and Register

Range

Operand

WX

WY

WM

WS

TMR

CTR

HR

IR

OR

SR

ROR

DR

K

XR

WX0

∣

WX1008

WY0

∣

WY1008

WM0

∣

WM9104

WS0

∣

WS3088

T0

∣

T1023

C0

∣

C1279

R0

∣

R34767

R34768

|

R34895

R35024

|

R35151

R35280

∣

R43223

R43224

∣

R47319

D0

∣

D7999

V, Z

P0 ~ P9

S

○

○

○

○

○

○

○

○

○

○

○

○

I

○

○

○

○

○

○

○

○

○

○

○

○

SI

○

○

○

○

○

○

○

○

○

○

○

○

LN

○

○

○

○

○

○

○

○

○

○

○

○

EC

○

○

○

○

○

○

○

○

○

○

○

○

D

○

○

○

○

○

○

○

○

○

○

○

○

Function Description

  • Operands

S : Slave Number in EtherCAT

I : Index of parameter in slave memory

SI : Sub-index of parameter in slave memory

LN : Length of the parameter

EC : Register for error code

D : Data Register (DWORD)

  • When execution control (EN) is triggered in upper edge, the function will be executed for SDO writing.
  • When the function is in operating, the coil ACT will be set to ON.
  • When the function is in error, the coil ERR will be set to ON.
  • When the function is finished, the coil DN will be set to ON.

Program Example

Ladder

  • Assume we want to write the servo data of slave 1 as 0x1011. The data address in slave 1 is 0x3000. The parameters will be: S = 1, I = 0x3000, SI = 0, LN = 2, R10 = 0x1011. After trigger the pin EN, you can use FUN236 to read the parameter or use software tool of servo to check the data is rewritten or not.

  • After executing the instruction,user can use the SDO read instruction for checking, or check through the drive software to see if the parameter has been written.

6-2 Motion Control Parameter Mapping

6-2-1 Fun181 Change Motion Control Parameter

Fun181

MFChgTbPrm

Change Motion Control Parameter

Fun181

MFChgTbPrm

Command Description

Ladder Symbol

Operand

TM: Table Number

PN: Point Number

S: Item Number

PV: Written Value

Relay and Register

Range

Operand

HR

IR

OR

SR

ROR

DR

K

XR

R0

∣

R34767

R34768

|

R34895

R35024

|

R35151

R35280

∣

R43223

R43224

∣

R47319

D0

∣

D7999

V, Z

P0 ~ P9

TM

0~128

PN

1~4096

S

○

○

○

○

○

○

0~50

PV

○

○

○

○

○

○

-2147483648

~2147482647

Function Description

  • Operand

TM (Table Number): 0 Point Table, 1 Axis Table, 2 Synchronous Table, 128 Flow Table

PN (Point Number): According to the table to be modified by TM, it corresponds to different types of numbers, such as Point Table Number, Axis Number, and Flow Block Number.

S (Item Number): Please refer to the table below.

PV (Written Value): The value to write, with fixed Double Word.

  • When the execution control [EN] changes from 0→1, Fun181 will write the PV value into the specified motion control parameter.
  • When the execution control [EN] changes from 1→0, all output indications are reset
  • When there is an error while writing in the motion control parameters, the output indication shows [ERR] ON.
  • When the writing of motion control parameters is done, the output indication shows [DN] ON.

Program Example

Ladder

  • When M1000 OFF→ON, change the point table parameters (TM: 0 point table, PN: 1 point table 1, S: 2 master axis coordinates, PV: change to 1000.000mm), and change the master axis movement distance of point table 1 to 1000.000mm.

Fun181 Parameter Table

TM

PN

S

PV Type

0

Motion Point Table

1-1024

Point Table No.

0

Operantion Mode

16Bit

UINT

1

Acceleration Curve Type

16Bit

UINT

2

Master Axis Coordinates

32Bit

INT

3

Interpolation Axis 1 Coordinates

32Bit

INT

4

Interpolation Axis 2 Coordinates

32Bit

INT

5

Interpolation Axis 3 Coordinates

32Bit

INT

6

Speed

32Bit

UINT

7

Accelearation

32Bit

UINT

8

Deceleration

32Bit

UINT

9

S Acceleration Percentage

16Bit

UINT

10

S Deceleration Percentage

16Bit

UINT

11

Arc Mode

16Bit

UINT

12

Arc Direction

16Bit

UINT

13

Arc X Coordinate

32Bit

INT

14

Arc Y Coordinate

32Bit

INT

15

Arc Radius

32Bit

UINT

16

Auxiliary Arc Radius

32Bit

UINT

17

Waiting Time

32Bit

UINT

18

Next Point No.

16Bit

UINT

19

Revolution No.

16Bit

UINT

20

Consecutive Point Mode

16Bit

UINT

21

Arc Z Coordinate

32Bit

INT

22

3D Consecutive Point Percentage

16Bit

UINT

1

Motion Axis Table

1-16

Axis No.

0

Start Speed

32Bit

UINT

1

Max. Rotating Speed

32Bit

UINT

2

Default Acceleration

32Bit

UINT

3

Default Ceceleration

32Bit

UINT

4

Soft Limit(+)

32Bit

INT

5

Soft Limit(-)

32Bit

INT

6

Following Error Window

32Bit

UINT

7

Following Error Timeout

32Bit

UINT

8

Pos Done Tolerance

32Bit

UINT

9

Pos Done Check Time

32Bit

UINT

10

Maximum Motor Torque

16Bit

UINT

11

Maximum Torque Limit(+)

16Bit

UINT

12

Maximum Torque Limit(-)

16Bit

UINT

13

HOME Return Mode

16Bit

UINT

14

HOME Return Direction

16Bit

UINT

15

HOME Return Movement

32Bit

INT

16

Home Return Speed

32Bit

UINT

17

HOME Return Crawl Speed

32Bit

UINT

18

JOG Initial Speed

32Bit

UINT

19

JOG Speed

32Bit

UINT

20

JOG Acceleration

32Bit

UINT

21

JOG Deceleration

32Bit

UINT

22

JOG Distannce

32Bit

UINT

2

Synchronous Parameter Table

1-16

Axis No.

0

Sync OFF time at deceleration stop

32Bit

UINT

1

Master Axis compensation change mode

32Bit

INT

2

Master Axis compensation change time

16Bit

UINT

3

Aux Axis compensation command value

32Bit

UINT

4

Aux Axis compensation change mode

32Bit

INT

5

Aux Axis compensation change time

16Bit

UINT

6

Master Axis compensation change mode

32Bit

UINT

7

Variable gear retio numerator

32Bit

INT

8

Variable gear retio denominator

32Bit

INT

9

Gear retio change mode

16Bit

UINT

10

Variable gear retio change time

32Bit

UINT

11

Main clutch ON setting value

32Bit

UINT

12

Main clutch ON delay

32Bit

INT

13

Main clutch ON sliding curve

32Bit

INT

14

Main clutch ON sliding time

32Bit

UINT

15

Main clutch ON following time

32Bit

UINT

16

Main clutch ON follow-ups

32Bit

INT

17

Main clutch OFF setting value

32Bit

UINT

18

Main clutch OFF delay

32Bit

INT

19

Main clutch OFF sliding curve

32Bit

INT

20

Main clutch OFF sliding time

32Bit

UINT

21

Aux clutch ON setting value

32Bit

UINT

22

Aux clutch ON delay

32Bit

INT

23

Aux clutch ON sliding curve

32Bit

INT

24

Aux clutch ON sliding time

32Bit

UINT

25

Aux clutch ON following time

32Bit

UINT

26

Aux clutch ON follow-ups

32Bit

INT

27

Aux clutch OFF setting value

32Bit

UINT

28

Aux clutch OFF delay

32Bit

INT

29

Aux clutch OFF sliding curve

32Bit

INT

30

Aux clutch OFF sliding time

32Bit

UINT

31

Reserve

32

Reserve

33

Step Angle Compensation Base speed

32Bit

UINT

34

Step Angle Compensation Base value

32Bit

INT

35

Step Angle Compensation value change mode

16Bit

UINT

36

Step Angle Compensation value change time

32Bit

UINT

37

Eletronic Cam Number

16Bit

UINT

38

Sync contact output No.

16Bit

UINT

39

Filter Pulse Time

32Bit

UINT

40

Input Axis Cyclic

32Bit

UINT

41

Sync master axis phase default value

32Bit

UINT

42

Master axis phase default value after phase compensation

32Bit

UINT

43

Main clutch input axis phase default value

32Bit

UINT

44

Auxiliary clutch input axis phase default value

32Bit

UINT

45

Main clutch output axis phase default value

32Bit

UINT

46

Auxiliary clutch output axis phase default value

32Bit

UINT

47

Reserve

48

Cam input axis phase default value

32Bit

UINT

49

Cam output axis base coordinate

32Bit

UINT

50

Cam stroke

32Bit

UINT

3

Reserve

4

Axis Velocity Mode Parameter

1-16

Axis No.

0

Target Rotating Speed

32Bit

INT

1

Torque Limit

16Bit

UINT

5

Axis Torque Mode Parameter

1-16

Axis No.

0

Target Torque

16Bit

INT

1

Rotating Speed Limit

32Bit

UINT

128

Flow Table

1-4096

Flow Block No.

0

Modify Standby Time

32Bit

UINT

116

Modify the positioning control block axis number

32Bit

INT

17

Modify the set speed value

32Bit

UINT

6-2-2 Fun198 Set Mapping Table (MFMapTbPrm)

Fun198

MFMapTbPrm

Set Mapping Table

Fun198

MFMapTbPrm

Command Description

Ladder Symbol

Operands

Gp: Mapping Table Group No.

N: Mapping Starting Table No.

L: Consecutive Mapping Length

Relay and Register

Range

Operand

WX

WY

WM

WS

TMR

CTR

HR

IR

OR

SR

ROR

DR

K

XR

WX0

∣

WX1008

WY0

∣

WY1008

WM0

∣

WM9104

WS0

∣

WS3088

T0

∣

T1023

C0

∣

C1279

R0

∣

R34767

R34768

|

R34895

R35024

|

R35151

R35280

∣

R43223

R43224

∣

R47319

D0

∣

D7999

V, Z

P0 ~ P9

Gp

0~64

N

○

○

○

○

○

○

○

○

○

○

○

○

0~1024

L

○

○

○

○

○

○

○

○

○

○

○

○

1~1024

Function Description

  • Operands

Gp (Mapping Table Groups No.): Group 1-16, 0 means all groups.

N (Mapping Table Starting Table No.): Mapping table number 1-1024, 0 means the entire mapping table.

L (Consecutive Mapping Length): Number of consecutive mapping items, 0 means mapping to the last item in the page.

  • When the execution control [EN] changes from 0→1, Fun198 will map (write) the PLC register to the motion control parameters.

When the execution control [EN] changes from 1→0, all output indications are reset.

  • When the mapping is being written, the output indication [ACT] will be ON.
  • When the mapping is being written, if an error occurs, the output indication [ERR] will be ON.
  • When the mapping is written in, the output indication [DN] will be ON..

Program Example

Ladder

Mapping Table

Motion Axis Setting Table

  • When M1000 is turned from OFF to ON, write the mapping table according to the current Fun198 parameters (Gp 1: mapping table 1(1:PM), N: starting from the first line of the mapping table (1:PM1), L: length 1). It can be seen from the motion axis setting table that the JOG speed has been modified to 2.000, and the JOG distance has been modified to 6.000.

6-3 Mode 1: Motion Flow Control

6-3-1 Fun176 Start Motion Flow (MFFlowStart)

Fun176 P

MFFlowStart

Start Motion Flow

Fun176 P

MFFlowStart

Command Description

Ladder Symbol

Operand

ID: Motion Flow ID

Relay and Register

Range

Operand

WX

WY

WM

WS

TMR

CTR

HR

IR

OR

SR

ROR

DR

K

XR

WX0

∣

WX1008

WY0

∣

WY1008

WM0

∣

WM9104

WS0

∣

WS3088

T0

∣

T1023

C0

∣

C1279

R0

∣

R34767

R34768

|

R34895

R35024

|

R35151

R35280

∣

R43223

R43224

∣

R47319

D0

∣

D7999

V, Z

P0 ~ P9

ID

○

○

○

○

○

○

○

○

○

○

○

○

1~16

Function Description

Enable the Motion Flow with designated ID.

  • EN = 1: Motion Flow is enabled
  • ACT = 1: Motion Flow is running
  • ERR = 1: Motion Flow error
  • DN = 1: Motion Flow is done
  • ID: The Flow ID to be triggered

Program Example

Ladder

  • When the execution control “EN” = 1, the motion flow corresponding to the ID will be executed.
  • If the ID does not correspond to the motion flow, ERR = 1 will be triggered.

6-3-2 Fun186 Stop Motion Flow (MFFlowStop)

Fun186 P

MFFlowStop

Stop Motion Flow

Fun186 P

MFFlowStop

Command Description

Ladder Symbol

Operand

ID: Motion Flow ID

Relay and Register

Range

Operand

WX

WY

WM

WS

TMR

CTR

HR

IR

OR

SR

ROR

DR

K

XR

WX0

∣

WX1008

WY0

∣

WY1008

WM0

∣

WM9104

WS0

∣

WS3088

T0

∣

T1023

C0

∣

C1279

R0

∣

R34767

R34768

|

R34895

R35024

|

R35151

R35280

∣

R43223

R43224

∣

R47319

D0

∣

D7999

V, Z

P0 ~ P9

ID

○

○

○

○

○

○

○

○

○

○

○

○

1-16

Function Description

Immediately stop the motion flow of the specified ID.

When execution of this command is done, MFFlowResume cannot be used to resume execution. Need to use MFFlowStart to restart the process.

  • EN = 1 : Rising Trigger Motion Flow stops
  • ACT = 1 : Stopping motion flow is acting
  • ERR = 1 : Stopping motion flow error
  • DN = 1 : Stopping motion flow is done

Program Example

Ladder

  • When the execution control “EN” = 1, the motion flow of the specified ID end immediately.

6-3-3 Fun182 Pause Motion Flow (MFFlowPause)

Fun182 P

MFFlowPause

Pause Motion Flow

Fun182 P

MFFlowPause

Command Description

Ladder Symbol

Operand

ID: Motion Flow ID

Relay and Register

Type

WX

WY

WM

WS

TMR

CTR

HR

IR

OR

SR

ROR

DR

K

XR

Range

WX0

∣

WX1008

WY0

∣

WY1008

WM0

∣

WM9104

WS0

∣

WS3088

T0

∣

T1023

C0

∣

C1279

R0

∣

R34767

R34768

|

R34895

R35024

|

R35151

R35280

∣

R43223

R43224

∣

R47319

D0

∣

D7999

V, Z

P0 ~ P9

ID

○

○

○

○

○

○

○

○

○

○

○

○

1-16

Function Description

Pause the motion flow with specified ID, and stop after executing the current flow block; to resume the paused motion flow, execute “Fun183 MFFlowResume” function.

  • EN = 1 : Stop entering the next step after executing the current flow block
  • ACT = 1 : Pause is acting
  • ERR = 1 : Pause error
  • DN = 1 : Pause is dine
  • ID : Motion Flow UID to be paused

Program Example

Ladder

  • When the execution control "EN" = 1, it will pause and not execute the next step after executing the current motion flow block.

6-3-4 Fun184 Halt Motion Flow (MFFlowHalt)

Fun184 P

MFFlowHalt

Halt Motion Flow

Fun184 P

MFFlowHalt

Command Description

Ladder Symbol

Operand

ID: Motion Flow ID

Relay and Register

Range

Operand

WX

WY

WM

WS

TMR

CTR

HR

IR

OR

SR

ROR

DR

K

XR

WX0

∣

WX1008

WY0

∣

WY1008

WM0

∣

WM9104

WS0

∣

WS3088

T0

∣

T1023

C0

∣

C1279

R0

∣

R34767

R34768

|

R34895

R35024

|

R35151

R35280

∣

R43223

R43224

∣

R47319

D0

∣

D7999

V, Z

P0 ~ P9

ID

○

○

○

○

○

○

○

○

○

○

○

○

1-16

Function Description

Immediately stop the currently executing process block; to continue the stopped motion flow, use “Fun183 MFFlowResume” to resume execution.

  • EN = 1 : Stop Motion Flow
  • ACT = 1 : Stop is acting
  • ERR = 1 : Stop error
  • DN = 1 : Stop is done
  • ID : Motion Flow UID to be halted

Program Example

Ladder

  • When the execution control “EN” = 1, it will immediately halt the execution of the motion flow block.

6-3-5 Fun183 Resume Motion Flow (MFFlowResume)

Fun183 P

MFFlowResume

Resume Motion Flow

Fun183 P

MFFlowResume

Command Description

Ladder Symbol

Operand

ID: Motion Flow ID

Relay and Register

Range

Operand

WX

WY

WM

WS

TMR

CTR

HR

IR

OR

SR

ROR

DR

K

XR

WX0

∣

WX1008

WY0

∣

WY1008

WM0

∣

WM9104

WS0

∣

WS3088

T0

∣

T1023

C0

∣

C1279

R0

∣

R34767

R34768

|

R34895

R35024

|

R35151

R35280

∣

R43223

R43224

∣

R47319

D0

∣

D7999

V, Z

P0 ~ P9

ID

○

○

○

○

○

○

○

○

○

○

○

○

1-16

Function Description

Resume and continue the execution of the paused or halted motion flow.

  • EN = 1 : Resume the motion flow
  • ACT = 1 : Resume is acting
  • ERR = 1 : Resume error
  • DN = 1 : Resume is done

Program Example

Ladder

  • When the execution control “EN” = 1, the motion flow suspended due to the execution of Fun182 (MFFlowPause) or Fun184 (MFFlowHalt) will be resumed.

6-4 Mode 2: Ladder Control

6-4-1 Fun179 Position Control (MFPointMov)

Fun179 P

MFPointMov

Position Control

Fun179 P

MFPointMov

Command Description

Ladder Symbol

Operand

PT : Point number of the executing position control point table

AX : Master axis of the executing position control

Relay and Register

Type

WX

WY

WM

WS

TMR

CTR

HR

IR

OR

SR

ROR

DR

K

XR

Range

WX0

∣

WX1008

WY0

∣

WY1008

WM0

∣

WM9104

WS0

∣

WS3088

T0

∣

T1023

C0

∣

C1279

R0

∣

R34767

R34768

|

R34895

R35024

|

R35151

R35280

∣

R43223

R43224

∣

R47319

D0

∣

D7999

V, Z

P0 ~ P9

ID

○

○

○

○

○

○

○

○

○

○

○

○

1~256

AX

○

○

○

○

○

○

○

○

○

○

○

○

1~16

Function Description

Execute the point table position control commands.

  • EN = 1: Position control is triggered
  • ACT = 1: Position control is acting
  • ERR = 1: Position control error
  • DN = 1: Position control is done
  • PT: Select the motion point related parameter position
  • ID: The Flow ID to be executed.
  • Special Register:
  • Axis 1: Position control is running – M10623
  • Axis 1: Position control is done – M10624

Program Example

Ladder

  • When the execution control “EN” = 1, the axis specified by AX will execute the point table with the number specified by PT.
  • When the execution control “EN” = 0, the motion will stop immediately.
  • The following table is used as an example.

When PT = 1 and AX = 1, axis 1 will run according to the parameters in point table 1.

However, if PT=2 and AX=1 are set, it will fail due to the difference from the point table setting, and ERR will be triggered.

Axis

1

M: Axis_1

2

M: Axis_2

3

M: Axis_1

6-4-2 Fun178 HOME Return (MFHome)

Fun178 P

MFHome

HOME Return

Fun178 P

MFHome

Command Description

Ladder Symbol

Operand

AX : Axis to execute HOME Return

Relay and Register

Type

WX

WY

WM

WS

TMR

CTR

HR

IR

OR

SR

ROR

DR

K

XR

Range

WX0

∣

WX1008

WY0

∣

WY1008

WM0

∣

WM9104

WS0

∣

WS3088

T0

∣

T1023

C0

∣

C1279

R0

∣

R34767

R34768

|

R34895

R35024

|

R35151

R35280

∣

R43223

R43224

∣

R47319

D0

∣

D7999

V, Z

P0 ~ P9

AX

○

○

○

1~16

Function Description

Specify a motion axis to execute HOME Return.

  • EN = 1 : Trigger HOME Return
  • ACT = 1 : HOME Return is acting
  • ERR = 1 : HOME Return error
  • DN = 1 : HOME Return is done
  • AX : Axis to be executed

Special Register

Axis 1: HOME Return is acting – M10621

Axis 1: HOME Return is done – M10622

  • For the modes and details of the HOME command, please refer to Chapter 10.

Program Example

Ladder

  • When the execution control “EN” = 1, the HOME Return will be performed according to the parameters on the motion axis setting page.

6-4-3 Fun180 JOG Control (MFJog)

Fun180 P

MFJog

JOG Control

Fun180 P

MFJog

Command Description

Ladder Symbol

Operand

AX : Axis to execute JOG control

MD : Execution mode

Relay and Register

Type

WX

WY

WM

WS

TMR

CTR

HR

IR

OR

SR

ROR

DR

K

XR

Range

WX0

∣

WX1008

WY0

∣

WY1008

WM0

∣

WM9104

WS0

∣

WS3088

T0

∣

T1023

C0

∣

C1279

R0

∣

R34767

R34768

|

R34895

R35024

|

R35151

R35280

∣

R43223

R43224

∣

R47319

D0

∣

D7999

V, Z

P0 ~ P9

AX

○

○

○

○

○

○

○

○

○

○

○

○

1~16

MD

0~3

Function Description

Specify a motion axis to execute JOG function according to JOG parameters and setting modes.

  • EN = 1 : Trigger JOG control
  • D/R = 1 Forward / = 0 Backward
  • ACT = 1 : JOG is acting
  • ERR = 1 : JOG error
  • DN = 1 : JOG is done
  • AX : Axis to be executed
  • MD : Mode 0 – Mode 3

Mode 0 : Continue going at JOG initial speed.

Mode 1 : Advance at the JOG initial speed, advance the JOG distance and then stop.

Mode 2 : Start at the JOG initial speed, accelerate to the JOG speed with the JOG acceleration and continue moving forward。

Mode 3 : Start at the JOG initial speed, accelerate to the JOG speed with the JOG acceleration, and stop after moving forward with JOG distance.

  • Special Register
  • Axis 1 : JOG is acting – M10625
  • Axis 1 : JOG is done – M10626
  • Please refer to Chapter 11 for JOG instruction modes and details.

Program Example

Ladder

  • When the execution control “EN” = 1, the axis specified by AX will execute the mode specified by MD.
  • When the execution control “EN” = 0, the motion will stop immediately.
  • Take the following table as an example:

When AX = 1 and MD = 1, it means axis 1 will run a distance of 100mm at a speed of 1mm/s.

Axis 1

JOG Initial Speed

1mm/s

JOG Speed

10mm/s

JOG Acceleration

1000mm/s²

JOG Deceleration

1000mm/s²

JOG Distance

100mm

6-5 Mode 3: Ladder Direct Control

6-5-1 Fun193 EtherCAT Handwheel (MFGearMPG)

Fun193 D

MFGearMPG

EtherCAT Handwheel

Fun193 D

MFGearMPG

Command Description

Ladder Symbol

Operands

M : Master Axis Input Source

S: Slave Axis Output Target

N: Variable Gear Ratio Numerator

D: Variable Gear Ratio Denominator

T: Transition Time (ms)

Relay and Register

Range

Operand

WX

WY

WM

WS

TMR

CTR

HR

IR

OR

SR

ROR

DR

K

XR

WX0

∣

WX1008

WY0

∣

WY1008

WM0

∣

WM9104

WS0

∣

WS3088

T0

∣

T1023

C0

∣

C1279

R0

∣

R34767

R34768

|

R34895

R35024

|

R35151

R35280

∣

R43223

R43224

∣

R47319

D0

∣

D7999

V, Z

P0 ~ P9

M

○

○

○

○

○

○

○

○

○

○

○

○

1~16,100~108

S

○

○

○

○

○

○

○

○

○

○

○

○

1~16

N

○

○

○

○

○

○

○

○

○

○

○

○

D

○

○

○

○

○

○

○

○

○

○

○

○

T

○

○

○

○

○

○

○

○

○

○

○

○

Function Description

  • Fun 193 (EtherCAT Handwheel) integrates the relevant settings of the handwheel for position synchronization, providing users with quick setting of the handwheel.
  • Operands

M (Master Axis Input Source): EtherCAT_Axis Number 1-16

: Encoder_Gray Code 100 (X8-X15)

: Encoder_Hardware High-speed Counter Number 101-108 ( HSC0~HSC7 )

S (Slave Axis Output Target): EtherCAT_Axis Number 1-16 ([M Master Input Source] cannot be the same as [S Slave Axis Output Target])

N (Variable Gear Ratio Numerator): Positive and negative numbers, including the [Decimal Point Position] of [Motion Axis Setting] in [Motion Control]. ([Axis unit] set mm, [Decimal point position] set 0.001, N: DR0 = 1000 is equal to 1.000mm)

D (Variable Gear Ratio Denominator): Positive number (a real number greater than zero), including the [Decimal Point Position] of [Motion Axis Setting] in [Motion Control]

T (Transition Time (ms)): Positive number (real number greater than zero), the unit is ms

  • When the execution control [EN] changes from 0→1, Fun193 uses the current parameters to start the synchronous control of the handwheel position
  • When the execution control [EN] changes from 1 to 0, Fun193 stops the synchronous control of the handwheel position and resets all output indications
  • In handwheel synchronous control, if the update parameter [UPD] changes to 1, this command will update the handwheel parameters (N, D, T) immediately.
  • When the handwheel is under synchronous control, the output indication [ACT] is ON.
  • During the synchronous control of the manual wheel, if an error occurs, the output indication [ERR] will be ON.
  • When the update of the manual wheel parameters is completed, the output indication [UPD] will be ON.

Program Example

Ladder

Axis Parameter Setting

  • When M1000 is from OFF to ON, start the handwheel according to the current Fun193 parameters (M: EtherCAT Axis 1, N: EtherCAT Axis 2, N: Variable gear ratio numerator 0.001, D Variable gear ratio denominator 0.001, T: 1ms) to start synchronizing.

Ladder

  • After changing the parameters (D Variable gear ratio denominator 0.002), when M1005 is from OFF to ON, update the handwheel according to the changed parameters. After the parameter update is completed, the output indication [UPD] is ON, and the stroke of the slave axis of the handwheel is halved. .

6-5-2 Fun194 Velocity Control (MFVelCtl)

Fun194 D

MFVelCtl

Velocity Control Mode

Fun194 D

MFVelCtl

Command Description

Ladder Symbol

Operands

S: EtherCAT Velocity Control Axis

V: Velocity

MX: Max. Torque Limit

Relay and Register

Range

Operand

WX

WY

WM

WS

TMR

CTR

HR

IR

OR

SR

ROR

DR

K

XR

WX0

∣

WX1008

WY0

∣

WY1008

WM0

∣

WM9104

WS0

∣

WS3088

T0

∣

T1023

C0

∣

C1279

R0

∣

R34767

R34768

|

R34895

R35024

|

R35151

R35280

∣

R43223

R43224

∣

R47319

D0

∣

D7999

V, Z

P0 ~ P9

S

○

○

○

○

○

○

○

○

○

○

○

○

1~16

V

○

○

○

○

○

○

○

○

○

○

○

○

MX

○

○

○

○

○

○

○

○

○

○

○

○

Function Description

  • Operands

S (Speed Control Axis): EtherCAT_ Axis Number 1-16

V (Velocity): Setting velocity value, unit: Pulses/s

MX (Maximum Torque Limit): The maximum torque limit when the speed cannot reach the speed setting value, 0 equals no limit, unit 0.0%

  • When the execution control [EN] changes from 0→1, Fun194 uses the current parameter to start the axis velocity control.

When the execution control [EN] changes from 1→0, Fun194 stops the axis velocity control and resets all output indications.

  • In axis velocity control, if the update parameter [UPD] becomes 1, this command will update the speed control parameters (V, MX) immediately.
  • When the axis velocity is under control, the output indicator [ACT] woll be ON.
  • During axis velocity control, if an error occurs, the output indication [ERR] will be ON.
  • When updating the velocity control parameters is completed, the output indication [UPD] will be ON.

Program Example

Ladder

  • When M1000 is from OFF→ON, start the speed control according to the current Fun194 parameters (S: EtherCAT Axis 1, V: 131072 pulses per second, MX: No torque limit).

Ladder

  • After changing the parameter (V: 262144 pulses per second), when M1005 changes from OFF to ON, the parameter update is completed according to the changed parameter update speed, and the output indicator M1004 [UPD] ON is turned on, and the speed doubles.

6-5-3 Fun195 Torque Control (MFTorqCtl)

Fun195 D

MFTorqCtl

Torque Control Mode

Fun195 D

MFTorqCtl

Command Description

Ladder Symbol

Operands

S: EtherCAT Torque Control Axis

T: Set Torque

MX: Max. Speed Limit

Relay and Register

Range

Operand

WX

WY

WM

WS

TMR

CTR

HR

IR

OR

SR

ROR

DR

K

XR

WX0

∣

WX1008

WY0

∣

WY1008

WM0

∣

WM9104

WS0

∣

WS3088

T0

∣

T1023

C0

∣

C1279

R0

∣

R34767

R34768

|

R34895

R35024

|

R35151

R35280

∣

R43223

R43224

∣

R47319

D0

∣

D7999

V, Z

P0 ~ P9

S

○

○

○

○

○

○

○

○

○

○

○

○

1~16

T

○

○

○

○

○

○

○

○

○

○

○

○

MX

○

○

○

○

○

○

○

○

○

○

○

○

Function Description

  • Operands

S (Torque Control Axis): EtherCAT_ Axis Number 1-16

T (Torque): Torque setting value, unit: 0.0%

MX (Maximum Speed Limit): The maximum speed limit when the torque cannot reach the torque setting value, 0 equals no limit, the unit is rpm.

  • When the execution control [EN] changes from 0→1, Fun195 uses the current parameters to start the axis torque control.

When the execution control [EN] changes from 1→0, Fun195 stops the axis torque control and resets all output indications.

  • In axis torque control, if the update parameter [UPD] becomes 1, this command will update the torque control parameters (T, MX) immediately.
  • When the axis torque is under control, the output indicator [ACT] will be ON.
  • During axis torque control, if an error occurs, the output indication [ERR] will be ON.
  • When updating the torque control parameters is completed, the output indication [UPD] will be ON.

Program Example

Ladder

  • When M1000 is from OFF to ON, torque control is started according to the current Fun194 parameters (S: EtherCAT Axis 1, T: 5.0%, MX: No speed limit).

Ladder

  • After changing the parameter (T : 10.0%), when M1005 is turned from OFF to ON, the torque will be updated according to the changed parameter. After the parameter update is completed, the output indication M1004 [UPD] ON, and will double the torque.

6-5-4 Fun197 Single Axis Positioning(MFAxMov)

Fun197 D P

MFAxMov

Single Axis Positioning

Fun197 D P

MFAxMov

Command Description

Ladder Symbol

Operands

S: EtherCAT Control Axis

MD: Opearating Mode

PS: Target Position

V: Velocity

A: Acceleration

D: Deceleration

SA: S Acceleration Curve %

SD: S Deceleration Curve %

DR: Direction

BF: Consecutive Velocity Mode

Relay and Register

Range

Operand

WX

WY

WM

WS

TMR

CTR

HR

IR

OR

SR

ROR

DR

K

XR

WX0

∣

WX1008

WY0

∣

WY1008

WM0

∣

WM9104

WS0

∣

WS3088

T0

∣

T1023

C0

∣

C1279

R0

∣

R34767

R34768

|

R34895

R35024

|

R35151

R35280

∣

R43223

R43224

∣

R47319

D0

∣

D7999

V, Z

P0 ~ P9

S

○

○

○

○

○

○

○

○

○

○

○

○

1~16

MD

0~2

Ps

○

○

○

○

○

○

○

○

○

○

○

○

V

○

○

○

○

○

○

○

○

○

○

○

○

A

○

○

○

○

○

○

○

○

○

○

○

○

D

○

○

○

○

○

○

○

○

○

○

○

○

SA

○

○

○

○

○

○

○

○

○

○

○

○

SD

○

○

○

○

○

○

○

○

○

○

○

○

DR

○

○

○

○

○

○

○

○

○

○

○

○

1~2

BF

0~5

Function Description

  • Operands

S (EtherCAT Control Axis): EtherCAT_Axis No.1-16

MD (Operating Mode): 0 Absolute, 1 Relative, 2 Infinite distance mode

PS )Target Position): Positive and negative numbers, including the [Decimal Point Position] of the [Motion Axis Setting] in [Motion Control].

([Axis Unit]: mm, [Decimal Point Position]: 0.001, PS: DR0 = 1000 is equal to 1.000mm)

V (Velocity): Positive number (a real number greater than zero), including the [Decimal Point Position] of the [Motion Axis Setting] in [Motion Control].

A (Acceleration): Positive number (a real number greater than zero), including the [Decimal Point Position] of the [Motion Axis Setting] in [Motion Control].

D (Deceleration): Positive number (a real number greater than zero), including the [Decimal Point Position] of the [Motion Axis Setting] in [Motion Control].

SA (S Acceleration Curve %): Positive integer, 0-1000 ‰

SD (S Deceleration Curve %): Positive integer, 0-1000 ‰

DR (Direction): 1 positive direction, 2 negative direction

BF(Consecutive Velocity Mode): 0 executes the current command immediately, 1 waits for the end of the previous command, 2 selects the lower consecutive speed, 3 selects the previous consecutive command speed, 4 selects the current consecutive command speed, 5 selects the higher consecutive speed.

  • When the execution control [EN] is triggered by the upper differential, Fun197 executes the axis position control.

When the execution control [EN] is triggered by the lower differential, Fun197 stops the axis position control and resets all output indications.

  • In axis position control, if the Update Parameter [UPD] becomes 1, this command will immediately update the position control parameters (S, PS, V, A, D, SA, SD, DR).
  • When the axis position is under control, the output indicator [ACT] will be ON.
  • During axis position control, if an error occurs, the output indication [ERR] will be ON.
  • When the axis position control is completed, the output indication [DN] will be ON.
  • When updating the position control parameters is completed, the output indication [UPD] ON.

Program Example

Ladder

Axis Parameter Setting

  • When M0 is from OFF→ON, according to the current Fun197 parameters (S: EtherCAT axis 1, MD: Absolute position, PS: Move to 500.000mm, V: Velocity 80.000mm/s, A: Acceleration 10000.000 , D: Deceleration 10000.000 , SA: S Acceleration Curve 0.0%, SD: S Deceleration Curve 0.0%, DR: Forward Direction, BF: Execute current command immediately) to execute position control.

Interrupt Constant Feed

  • Using two Fun197 to implement an interrupt constant feed application.
  • When M0 is from OFF→ON, according to the first Fun197 parameters (S: EtherCAT axis 1, MD: Infinite distance mode, PS: Meaningless, set to 0, V: Velocity 80.000mm/s, A: Acceleration 10000.000 , D: Deceleration 10000.000 , SA: S Acceleration Curve 0.0%, SD: S Deceleration Curve 0.0%, DR: Forward Direction, BF: Execute current command immediately) to execute position control.
  • When M6 is from OFF→ON, according to the second Fun197 parameters (S: EtherCAT axis 1, MD: Relative position, PS: Move to 50.000mm, V: Velocity 15.000mm/s, A: Acceleration 10000.000 , D: Deceleration 10000.000 , SA: S Acceleration Curve 0.0%, SD: S Deceleration Curve 0.0%, DR: Forward Direction, BF: Execute current command immediately) to execute position control, that is, interrupt constant feed.

  • The cursor range is set to the interrupt constant feed distance in PS(register R1008).

6-5-5 Fun238 Linear Interpolation (MFAxLMov)

Fun238 D P

MFAxLMov

Linear Interpolation

Fun238 D P

MFAxLMov

Command Description

Ladder Symbol

Operands

TAX : Total Axis Number

MD : Operation Mode

DR : Direction

BF : Continuous Mode

D : Parameter Register Start Address

EC : Register for Error code

Relay and Register

Range

Operand

WX

WY

WM

WS

TMR

CTR

HR

IR

OR

SR

ROR

DR

K

XR

WX0

∣

WX1008

WY0

∣

WY1008

WM0

∣

WM9104

WS0

∣

WS3088

T0

∣

T1023

C0

∣

C1279

R0

∣

R34767

R34768

|

R34895

R35024

|

R35151

R35280

∣

R43223

R43224

∣

R47319

D0

∣

D7999

V, Z

P0 ~ P9

TAX

○

○

○

○

○

○

○

○

○

○

○

○

1~4

MD

0~1

DR

○

○

○

○

○

○

○

○

○

○

○

○

1~2

BF

○

○

○

○

○

○

○

○

○

○

○

○

D

○

○

○

○

○

○

○

○

○

○

○

○

EC

○

○

○

○

○

○

○

○

○

○

○

○

Function Description

  • Operands

TAX (Total Axis Number) : Axes number in movement – 1 ~ 4

MD (Operation Mode) : 0 – Absolute Positioning, 1 – Relative Positioning.

DR (Direction) : 1 – Positive, 2 – Negative.

BF (Continuous Mode) : 0: Stop Current Movement

1: Wait Current Mov Finish

2: Continue with Lower Speed

3: Continue with Current Speed

4: Continue with New Speed

5: Continue with higher Speed

D : First Register Address of Data.

EC : Register for Error Code.

  • When execution control (EN) is triggered in upper edge, the Fun238 will be executed for linear interpolation.

When execution control (EN) is triggered in lower edge, the Fun238 will be stopped, and all the coils will be reset.

  • When the function is in operating, if the update parameter is trigger in upper edge, current value of in the parameter D and the value DR will be updated immediately.
  • When the function is in operating, the coil ACT will be set to ON.
  • When the function is in error, the coil ERR will be set to ON.
  • When the function is finished, the coil DN will be set to ON.
  • When the parameter update is success, the coil UPDN will be set to ON.

Motion data in parameter D:

Register Address

Parameter

Date Type

Note

R+0

Axis 1

WORD

Main Axis

R+1

Axis 2

WORD

Interpolation Axis

R+2

Axis 3

WORD

Interpolation Axis

R+3

Axis 4

WORD

Interpolation Axis

R+4

Target Position 1

DWORD

Decimal point of Axis 1

R+6

Target Position 2

DWORD

Decimal point of Axis 2

R+8

Target Position 3

DWORD

Decimal point of Axis 3

R+10

Target Position 4

DWORD

Decimal point of Axis 4

R+12

Maximum Velocity

DWORD

Decimal point of Axis 1, positive

R+14

Acceleration Time (ms)

DWORD

Time from 0 to maximum

R+16

Deceleration Time (ms)

DWORD

Time from maximum to 0

R+18

Acc S curve (‰)

WORD

Range: 0~1000 ‰

R+19

Dec S curve (‰)

WORD

Range: 0~1000 ‰

Program Example

Ladder

  • When M0 is triggered in upper edge, the 2 axis linear interpolation movement will be executed in absolute mode (MD = 0). The parameter is in positive direction (DR = 1), and the movement will interrupt the current movement (BF = 0).
  • The movement will follow the parameters in R0 to R19 (D = R0) and the error code will be showed in R100 (EC = R100).
  • Motion data

Register Address

Parameter

Value

R0

Axis 1

1

R1

Axis 2

2

R2

Axis 3

0

R3

Axis 4

0

DR4

Target Position 1

60000

DR6

Target Position 2

80000

DR8

Target Position 3

0

DR10

Target Position 4

0

DR12

Maximum Velocity

10000

DR14

Acceleration Time (ms)

2

DR16

Deceleration Time (ms)

2

R18

Acc S curve (‰)

0

R19

Dec S curve (‰)

0

  • When entering the target position and maximum velocity on the status page, the decimal point position set in the axis table must be taken into account. In this example, the decimal point position is set to three decimal places, so three zeros must be added.

6-5-6 Fun239 Arc Interpolation (MFAxCirMov)

Fun239D P

MFAxCirMov

Arc Interpolation

Fun239 D P

MFAxCirMov

Command Description

Ladder Symbol

Operands

TAX : Total Axis Number

MD : Operation Mode

DR : Direction

BF : Continuous Mode

D : Parameter Register Start Address

EC : Register for Error code

Relay and Register

Range

Operand

WX

WY

WM

WS

TMR

CTR

HR

IR

OR

SR

ROR

DR

K

XR

WX0

∣

WX1008

WY0

∣

WY1008

WM0

∣

WM9104

WS0

∣

WS3088

T0

∣

T1023

C0

∣

C1279

R0

∣

R34767

R34768

|

R34895

R35024

|

R35151

R35280

∣

R43223

R43224

∣

R47319

D0

∣

D7999

V, Z

P0 ~ P9

TAX

○

○

○

○

○

○

○

○

○

○

○

○

2~3

MD

0~1

DR

○

○

○

○

○

○

○

○

○

○

○

○

1~2

BF

○

○

○

○

○

○

○

○

○

○

○

○

D

○

○

○

○

○

○

○

○

○

○

○

○

EC

○

○

○

○

○

○

○

○

○

○

○

○

Function Description

  • Operands

TAX (Total Axis Number) : Axes number in movement – 2 ~ 3

MD (Operation Mode) : 0 – Absolute Positioning, 1 – Relative Positioning.

DR (Direction) : 1 – Positive, 2 – Negative.

BF (Continuous Mode) : 0: Stop Current Movement

1: Wait Current Mov Finish

2: Continue with Lower Speed

3: Continue with Current Speed

4: Continue with New Speed

5: Continue with higher Speed

D : First Register Address of Data.

EC : Register for Error Code.

  • When execution control (EN) is triggered in upper edge, the Fun239 will be executed for arc interpolation.

When execution control (EN) is triggered in lower edge, the Fun239 will be stopped, and all the coils will be reset.

  • When the function is in operating, if the update parameter is trigger in upper edge, current value of in the parameter D and the value DR will be updated immediately.
  • When the function is in operating, the coil ACT will be set to ON.
  • When the function is in error, the coil ERR will be set to ON.
  • When the function is finished, the coil DN will be set to ON.
  • When the parameter update is success, the coil UPDN will be set to ON.

Motion data in parameter D:

Register Address

Parameter

Data Type

Note

R+0

Axis 1

WORD

R+1

Axis 2

WORD

R+2

Axis 3

WORD

R+3

Target Position 1

WORD

Decimal point of Axis 1

R+5

Target Position 2

DWORD

Decimal point of Axis 2

R+7

Target Position 3

DWORD

Decimal point of Axis 3

R+9

Maximum Velocity

DWORD

Decimal point of Axis 1, positive

R+11

Acceleration Time (ms)

DWORD

Time from 0 to maximum

R+13

Deceleration Time (ms)

DWORD

Time from maximum to 0

R+15

Acc S curve (‰)

WORD

Range: 0~1000 ‰

R+16

Dec S curve (‰)

WORD

Range: 0~1000 ‰

R+17

Circular (Arc) Mode

WORD

0: Border, mode,

1: Center, Clockwise,

2: Center, Counterclockwise,

3: Radius, Clockwise,

4: Radius, Counterclockwise,

R+18

X Coordinate / Radius

DWORD

Decimal point of Axis 1

R+20

Y Coordinate

DWORD

Decimal point of Axis 1

R+22

Z Coordinate

DWORD

Decimal point of Axis 1

Program Example

Ladder

  • When M0 is triggered in upper edge, the 2 axis arc interpolation movement will be executed in relative mode (MD = 1). The parameter is in positive direction (DR = 1), and the movement will interrupt the current movement (BF = 0).
  • The movement will follow the parameters in R0 to DR22 (D = R0) and the error code will be showed in R100 (EC = R100).
  • Motion data

Register Address

Parameter

Value

R0

Axis 1

1

R1

Axis 2

2

R2

Axis 3

0

DR3

Target Position 1

100000

DR5

Target Position 2

0

DR7

Target Position 3

0

DR9

Maximum Velocity

20000

DR11

Acceleration Time (ms)

2

DR13

Deceleration Time (ms)

2

R15

Acc S curve (‰)

0

R16

Dec S curve (‰)

0

R17

Circular (Arc) Mode

1

DR18

X Coordinate / Radius

50000

DR20

Y Coordinate

0

DR22

Z Coordinate

0

  • When entering the target position, maximum velocity and X coordinate / radius on the status page, the decimal point position set in the axis table must be taken into account. In this example, the decimal point position is set to three decimal places, so three zeros must be added.

Combining the use of Fun238 and Fun239

  • When M0 of Fun238 is triggered in upper edge, the 2 axis linear interpolation movement will be executed in absolute mode (MD = 1). The parameter is in positive direction (DR = 1), and the movement will interrupt the current movement (BF = 0).
  • Motion data

Register Address

Parameter

Value

R0

Axis 1

1

R1

Axis 2

2

R2

Axis 3

0

R3

Axis 4

0

DR4

Target Position 1

40000

DR6

Target Position 2

30000

DR8

Target Position 3

0

DR10

Target Position 4

0

DR12

Maximum Velocity

10000

DR14

Acceleration Time (ms)

2

DR16

Deceleration Time (ms)

2

R18

Acc S curve (‰)

0

R19

Dec S curve (‰)

0

  • When M4 of Fun239 is triggered in upper edge, the 2 axis linear interpolation movement will be executed in absolute mode (MD = 1). The parameter is in positive direction (DR = 1), and the movement will interrupt the current movement (BF = 0).
  • Motion data

Register Address

Parameter

Value

R50

Axis 1

1

R51

Axis 2

2

R52

Axis 3

0

DR53

Target Position 1

50000

DR55

Target Position 2

0

DR57

Target Position 3

0

DR59

Maximum Velocity

10000

DR61

Acceleration Time (ms)

2

DR63

Deceleration Time (ms)

2

R65

Acc S curve (‰)

0

R66

Dec S curve (‰)

0

R67

Circular (Arc) Mode

3

DR68

X Coordinate / Radius

25000

DR70

Y Coordinate

0

DR72

Z Coordinate

0

6-5-7 Fun240 Path Movement (MFPathMov)

Fun240 D P

MFPathMov

Path Movement

Fun240 D P

MFPathMov

Command Description

Ladder Symbol

Operands

AX1 : Axis 1 Number

AX2 : Axis 2 Number

AX3 : Axis 3 Number

PT : Path Number

V : Velocity

TA : Acceleration Time

TD : Deceleration Time

SA : Acceleration S Curve Percentage

SD : Deceleration S Curve Percentage

EC : Register for Error Code

Relay and Register

Range

Operand

WX

WY

WM

WS

TMR

CTR

HR

IR

OR

SR

ROR

DR

K

XR

WX0

∣

WX1008

WY0

∣

WY1008

WM0

∣

WM9104

WS0

∣

WS3088

T0

∣

T1023

C0

∣

C1279

R0

∣

R34767

R34768

|

R34895

R35024

|

R35151

R35280

∣

R43223

R43224

∣

R47319

D0

∣

D7999

V, Z

P0 ~ P9

AX1

○

○

○

○

○

○

○

○

○

○

○

○

0~16

AX2

○

○

○

○

○

○

○

○

○

○

○

○

0~16

AX3

○

○

○

○

○

○

○

○

○

○

○

○

0~16

PT

○

○

○

○

○

○

○

○

○

○

○

○

0~10

V

○

○

○

○

○

○

○

○

○

○

○

○

TA

○

○

○

○

○

○

○

○

○

○

○

○

TD

○

○

○

○

○

○

○

○

○

○

○

○

SA

○

○

○

○

○

○

○

○

○

○

○

○

SD

○

○

○

○

○

○

○

○

○

○

○

○

EC

○

○

○

○

○

○

○

○

○

○

○

○

Function Description

  • Operands

AX1 : EtherCAT axis number range 1~16

AX2 : EtherCAT axis number range 1~16

AX3 : EtherCAT axis number range 1~16r

PT : Path Number range 1~10

V : Velocity is positive integer and include the decimal point in the axis table of the main axis (AX1).

TA : Acceleration time of the interpolation. The unit is milli-second.

TD : Deceleration time of the interpolation. The unit is milli-second.

SA : The percentage of the S curve in acceleration. The range is 0~1000‰.

SD : The percentage of the S curve in acceleration. The range is 0~1000‰.

EC : Register for Error Code.

  • When execution control (EN) is triggered in upper edge, the Fun240 will move to the first point of the path.

When execution control (EN) is triggered in lower edge, the Fun240 will be stopped, and all the coils will be reset.

  • When start movement (ACT) is triggered in upper edge, the Fun240 will start the path movement.

When start movement (ACT) is triggered in lower edge, the Fun240 will be halt. And the function will be resumed when ACT is back to high level.

  • When the function is in operating, if the update parameter is trigger in upper edge, current value of in the parameter D and the value DR will be updated immediately.
  • When the function is in operating, the coil ACT will be set to ON.
  • When the function is in error, the coil ERR will be set to ON.
  • When the function is finished, the coil DN will be set to ON.
  • When the parameter update is success, the coil UPDN will be set to ON.

Program Example

Ladder

  • When the EN is triggered in upper edge, the axis 1 and axis 2 will move to the first point of Path number 1. The path velocity and other motion parameters will follow the parameters in function 240.
  • After the ACT is triggered in upper edge, the path control will start.
Was this page helpful?

Tip: press ← → to switch chapters, Ctrl+K to search