Changes for page 08 Motion Control

Summary

• Page properties (2 modified, 0 added, 0 removed)
• Attachments (0 modified, 17 added, 0 removed)
  • 123.png
  • 1761032781939-478.png
  • 1761032845559-339.png
  • 1761032974104-584.png
  • 1761033004563-270.png
  • 1761033083623-162.png
  • 1761033167971-496.png
  • 1761033264625-188.png
  • 1761033334729-116.png
  • 1761034254689-443.png
  • 1761034304535-743.png
  • 1761034415972-645.png
  • 1761034458765-139.png
  • 1761034544967-630.png
  • 1761034615747-763.png
  • 1770693592357-540.png
  • 234.png

Details

Page properties

Author

...	...	@@ -1,1 +1,1 @@
1		-XWiki.Wecon
	1	+XWiki.Iris

Content

...	...	@@ -15,8 +15,6 @@
15	15
16	16	Device used (only a single device can be used, and device splicing and offset are not supported)
17	17
18		-
19		-
20	20	|=(% rowspan="2" %)**Instruction**|=(% rowspan="2" %)**Parameter**|=(% colspan="24" %)**Devices**|=**Index modification**|=**Pulse expansion**
21	21	|**X**|**Y**|**M**|**S**|**SM**|**T(bit)**|**C(bit)**|**LC(bit)**|**HSC(bit)**|**D.b**|**KnX**|**KnY**|**KnM**|**KnS**|**T**|**C**|**D**|**R**|**SD**|**LC**|**HSC**|**K**|**H**|**E**|**[D]**|**XXP**
22	22	|(% rowspan="8" %)MC_POWER|Enable|●|●|●|●|●| | | | | | | | | | | | | | | | | | | | |
...	...	@@ -36,20 +36,19 @@
36	36
37	37	Variable Type Used
38	38
	37	+|**Instruction**|**Pin type**|**Variable type**|**Variable type**|**Can be empty or not**|**Range**|**Description**
	38	+|(% rowspan="8" %)MC_POWER|(% rowspan="4" %)Input|Enable|BOOL|No|TRUE/FALSE|Enable
	39	+|EnablePositive|BOOL|No|TRUE/FALSE|Allow movement in the positive direction
	40	+|EnableNegative|BOOL|No|TRUE/FALSE|Allow movement in negative direction
	41	+|Axis|WORD|No|[0,65535]|Axis number
	42	+|(% rowspan="4" %)Output|Status|BOOL|Yes|TRUE/FALSE|Enable status
	43	+|Valid|BOOL|Yes|TRUE/FALSE|Data valid or not
	44	+|Error|BOOL|Yes|TRUE/FALSE|Whether there is an error or not
	45	+|ErrorID|DWORD|Yes|-|Error code (See [8.11 Error code comparison table])
39	39
40		-|=**Instruction**|=**Parameter**|=**Variable type**|=**Can be empty or not**|=**Range**|=**Description**
41		-|(% colspan="1" rowspan="8" %)MC_POWER|Enable|BOOL|No|TRUE/FALSE|Enable
42		-|EnablePositive|BOOL|No|TRUE/FALSE|Allow motion in the positive direction
43		-|EnableNegative|BOOL|No|TRUE/FALSE|Allow motion in negative direction
44		-|Axis|WORD|No|0 to 65535|Axis number
45		-|Status|BOOL|No|TRUE/FALSE|Enable status
46		-|Valid|BOOL|No|TRUE/FALSE|Data valid or not
47		-|Error|BOOL|No|TRUE/FALSE|Whether there is an error or not
48		-|ErrorID|DWORD|No|-|[Error code]
49		-
50	50	Function
51	51
52		-* This function block must be enabled if an axis is to participate in motion.
	49	+* This funcion block must be enabled if an axis is to participate in motion.
53	53	* The function is as follows:
54	54
55	55	1. When the Enable input is TRUE, the power to the drive is enabled, not to the function block itself;
...	...	@@ -814,6 +814,9 @@
814	814	Precautions
815	815
816	816	* This function block is not available when the axis does not exist.
	814	+* In profile mode, the STOP command requires the mapper to map the PDOs of 0x6060, 0x6061, 0x60FF, and 0x606C for normal operation;
	815	+* In CST/CSV mode, triggering STOP switches to synchronous velocity mode;
	816	+* In CST/CSV mode, the STOP command requires the mapper to map the PDOs of 0x6060, 0x6061, 0x60FF, and 0x606C for normal operation;
817	817
818	818	Error code
819	819
...	...	@@ -1497,7 +1497,7 @@
1497	1497	Variable type used
1498	1498
1499	1499	|=**Instruction**|=**Pin**|=**Parameter**|=**Variable type**|=**Can it be empty**|=**Range**|=**Description**
1500		-|(% colspan="1" rowspan="10" %)(((
	1500	+|(% colspan="1" rowspan="11" %)(((
1501	1501
1502	1502
1503	1503
...	...	@@ -1540,7 +1540,7 @@
1540	1540
1541	1541	Others: Reserved
1542	1542	)))
1543		-|(% colspan="1" rowspan="5" %)(((
	1543	+|(% colspan="1" rowspan="6" %)(((
1544	1544
1545	1545
1546	1546
...	...	@@ -1548,6 +1548,7 @@
1548	1548	)))|Done|BOOL|Yes|TRUE/FALSE|Busy flag
1549	1549	|BusY|BOOL|Yes|TRUE/FALSE|Aborted flag
1550	1550	|InstructionAborted|BOOL|Yes|TRUE/FALSE|Abortion flag
	1551	+|ReadyUpdate|BOOL|Yes|TRUE/FALSE|Cam table update comp flag
1551	1551	|Error|BOOL|Yes| |Whether there is an error or not
1552	1552	|ErrorID|DWORD|Yes| |Error Code (Please check [8.10 Error Code Cross-reference Table] )
1553	1553
...	...	@@ -1622,9 +1622,9 @@
1622	1622	MC_SAVECAMTABLE
1623	1623	)))|(% colspan="1" rowspan="2" %)Input|Execute|BOOL|No|TRUE/FALSE|Enable
1624	1624	|CamTableID|INT|No|-|Cam tableID
1625		-|(% colspan="1" rowspan="5" %)Output|Done|BOOL|Yes|TRUE/FALSE|Busy flag
1626		-|BusY|BOOL|Yes|TRUE/FALSE|Aborted flag
1627		-|InstructionAborted|BOOL|Yes|TRUE/FALSE|Abortion flag
	1626	+|(% colspan="1" rowspan="5" %)Output|Done|BOOL|Yes|TRUE/FALSE|Completion flag
	1627	+|BusY|BOOL|Yes|TRUE/FALSE|Busy flag
	1628	+|InstructionAborted|BOOL|Yes|TRUE/FALSE|Abort flag
1628	1628	|Error|BOOL|Yes|-|Whether there is an error or not
1629	1629	|ErrorID|DWORD|Yes|-|Error Code (Please check [8.10 Error Code Cross-reference Table]
1630	1630
...	...	@@ -2199,6 +2199,20 @@
2199	2199	)))
2200	2200
2201	2201
	2203	+
	2204	+
	2205	+
	2206	+
	2207	+
	2208	+
	2209	+
	2210	+
	2211	+
	2212	+
	2213	+
	2214	+
	2215	+
	2216	+
2202	2202	== **Management functions of axis group motion control** ==
2203	2203
2204	2204	----
...	...	@@ -3732,6 +3732,665 @@
3732	3732	|=**Error code**|=**Content**
3733	3733	|4084H|Input data beyond the specifiable range
3734	3734
	3750	+=== **MC _ MOVEVELOCITY _ CSV** ===
	3751	+
	3752	+MC _ MOVEVELOCITY _ CSV-Sets motion according to the speed specified by the function block
	3753	+
	3754	+[[image:1761032781939-478.png]]
	3755	+
	3756	+The function block is used to continue the motion of the previous function block and move according to the speed specified by the function block.
	3757	+
	3758	+**Device used (only a single device can be used, device splicing and index are not supported)**
	3759	+
	3760	+|(% rowspan="2" %)**Instruction**|(% rowspan="2" %)**Parameter**|(% colspan="24" %)**Device**|(((
	3761	+**Index**
	3762	+
	3763	+**Modification**
	3764	+)))|(((
	3765	+**Pulse**
	3766	+
	3767	+**Expansion**
	3768	+)))
	3769	+|**X**|**Y**|**M**|**S**|**SM**|**T(bit)**|**C(bit)**|**LC(bit)**|**HSC(bit)**|**D.b**|**KnX**|**KnY**|**KnM**|**KnS**|**T**|**C**|**D**|**R**|**SD**|**LC**|**HSC**|**K**|**H**|**E**|**[D]**|**XXP**
	3770	+|(% rowspan="15" %)(((
	3771	+MC _ MOVEVELOCITY
	3772	+
	3773	+_ CSV
	3774	+)))|Execute|●|●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	3775	+|ContinuousUpdate|●|●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	3776	+|Velocity| | | | | | | | | | | | | | | | | | | | | | | | | |
	3777	+|Acceleration| | | | | | | | | | | | | | | | | | | | | | | | | |
	3778	+|Deceleration| | | | | | | | | | | | | | | | | | | | | | | | | |
	3779	+|Jerk| | | | | | | | | | | | | | | | | | | | | | | | | |
	3780	+|Direction| | | | | | | | | | | | | | | | | | | | | | | | | |
	3781	+|BufferMode| | | | | | | | | | | | | | | | | | | | | | | | | |
	3782	+|Axis| | | | | | | | | | | | | | | | | | | | | | | | | |
	3783	+|InVelocity| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	3784	+|Busy| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	3785	+|Active| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	3786	+|CommandAborted| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	3787	+|Error| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	3788	+|Error ID| | | | | | | | | | | | | | | | | | | | | | | | | |
	3789	+
	3790	+**Notes:**
	3791	+
	3792	+* LC and HSC are signed 32-bit data types;
	3793	+* T, C, D, R and SD are signed 16-bit data types.
	3794	+
	3795	+**Variable type used**
	3796	+
	3797	+|**Instruction**|**Parameter**|**Variable type**|**Can it be empty**|**Range**|**Description**
	3798	+|(% rowspan="15" %)(((
	3799	+MC _ MOVE
	3800	+
	3801	+VELOCITY _ CSV
	3802	+)))|Execute|BOOL|No|TRUE/FALSE|Enable
	3803	+|ContinuousUpdate|BOOL|Yes|TRUE/FALSE|Whether update continuously or not
	3804	+|Velocity|LREAL|No|[0,999999999.999999]|Setting velocity
	3805	+|Acceleration|LREAL|No|[0,999999999.999999]|Setting acceleration
	3806	+|Deceleration|LREAL|No|[0,999999999.999999]|Set deceleration
	3807	+|Jerk|LREAL|Yes|[0,999999999.999999]|The set jerk is only effective in S-curve.
	3808	+|Direction|WORD|No|[1,4]|(((
	3809	+Direction flag bit (Only rotation mode takes effect）。
	3810	+
	3811	+~1. Positive direction;
	3812	+
	3813	+2. Negative direction;
	3814	+
	3815	+3. The current direction;
	3816	+
	3817	+4. The shortest path (reserved).
	3818	+)))
	3819	+|BufferMode|WORD|Yes|[0]|BufferMode
	3820	+|Axis|WORD|No|[0,65535]|Axis number and built-in variable of axis
	3821	+|InVelocity|BOOL|Yes|TRUE/FALSE|Reach the set velocity flag bit
	3822	+|Busy|BOOL|Yes|TRUE/FALSE|Busy flag
	3823	+|Active|BOOL|Yes|TRUE/FALSE|Activity flag
	3824	+|Command aborted|BOOL|Yes|TRUE/FALSE|Interrupt flag bit
	3825	+|Error|BOOL|Yes|TRUE/FALSE|Whether there is an error or not
	3826	+|Error ID|DWORD|Yes|-|Error code (Please refer to ~[[[8.11 Error code comparison table>>path:#错误码对照表]]])
	3827	+
	3828	+**Function**
	3829	+
	3830	+* The MC_ MOVEVELOCITY_CSV function block is used to continue the movement of the previous function block and move according to the speed specified by the function block. The input values of acceleration, deceleration and jerk are used to monitor whether the corresponding values of the controlled axis are within the input values.
	3831	+* Since there is no input signal of position or distance, the function block will move until other function block sends a new command to stop movement of this function block;
	3832	+* When the speed of the controlled axis reaches the input parameter ‘Velocity’ setpoint, the output parameter ‘InVelocity’ is set. Once the input ‘Execute’ signal detects a falling edge or other function block to abort this function block, the output parameter InVelocity is reset;
	3833	+* The MC_ MOVEVELOCITY_CSV function block shall be in a stopped motion state or a single-axis operation state when the controlled axis is operated. After this function block is triggered, the controlled axis transitions to the ‘Continuous Motion’ state. If the controlled axis is not in the above state, the function block is not executed, Error output is set;
	3834	+* The MC_ MOVEVELOCITY_CSV function block can be triggered repeatedly multiple times.
	3835	+
	3836	+**Error code**
	3837	+
	3838	+|**Error code**|**Content**
	3839	+|4084H|Input data beyond the specifiable range
	3840	+
	3841	+**Precautions**
	3842	+
	3843	+* Different from the MC _ MOVEVELOCITY function block, this function block will automatically switch the servo mode to CSV (Synchronous Cycle Speed) mode;
	3844	+* Using this function block requires adding four object dictionaries, H60FF, H6060, H6061, and H606C, to the PDO.
	3845	+
	3846	+**Timing diagram**
	3847	+
	3848	+
	3849	+(% style="text-align:center" %)
	3850	+[[image:1761032845559-339.png||height="306" width="520"]]
	3851	+
	3852	+=== **MC _ SYNCMOVEVELOCITY** ===
	3853	+
	3854	+MC _ SYNCMOVEVELOCITY-Sets motion according to the speed specified by the function block
	3855	+
	3856	+[[image:1761032974104-584.png]]
	3857	+
	3858	+The function block is used to continue the motion of the previous function block and move according to the speed specified by the function block.
	3859	+
	3860	+**Device used (only a single device can be used, and device splicing and Index are not supported)**
	3861	+
	3862	+|(% rowspan="2" %)**Instruction**|(% rowspan="2" %)**Parameter**|(% colspan="24" %)**Device**|**Index modification**|**Pulse expansion**
	3863	+|**X**|**Y**|**M**|**S**|**SM**|**T(bit)**|**C(bit)**|**LC(bit)**|**HSC(bit)**|**D.b**|**KnX**|**KnY**|**KnM**|**KnS**|**T**|**C**|**D**|**R**|**SD**|**LC**|**HSC**|**K**|**H**|**E**|**[D]**|**XXP**
	3864	+|(% rowspan="8" %)(((
	3865	+MC _ SYNCMOVE
	3866	+
	3867	+VELOCITY
	3868	+)))|Execute|●|●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	3869	+|Velocity| | | | | | | | | | | | | | | | | | | | | | | | | |
	3870	+|Axis| | | | | | | | | | | | | | | | | | | | | | | | | |
	3871	+|InVelocity| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	3872	+|Busy| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	3873	+|CommandAborted| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	3874	+|Error| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	3875	+|ErrorID| | | | | | | | | | | | | | | | | | | | | | | | | |
	3876	+
	3877	+**Notes for using devices**
	3878	+
	3879	+* LC and HSC are signed 32-bit data types;
	3880	+* T, C, D, R and SD are signed 16-bit data types.
	3881	+
	3882	+**Variable type used**
	3883	+
	3884	+|**Instruction**|**Parameter**|**Variable type**|**Empty or not**|**Range**|**Description**
	3885	+|(% rowspan="8" %)(((
	3886	+MC _ SYNCMOVE
	3887	+
	3888	+VELOCITY
	3889	+)))|Execute|BOOL|No|TRUE/FALSE|Enable
	3890	+|Velocity|LREAL|No|(((
	3891	+[-999999999.999999,99999
	3892	+
	3893	+9999.999999]
	3894	+)))|Setting velocity
	3895	+|Axis|(((
	3896	+WORD
	3897	+
	3898	+
	3899	+)))|No|[0,65535]|Axis number and built-in variable of axis
	3900	+|InVelocity|BOOL|Yes|TRUE/FALSE|Reach the set velocity flag bit
	3901	+|Busy|BOOL|Yes|TRUE/FALSE|Busy flag
	3902	+|CommandAborted|BOOL|Yes|TRUE/FALSE|Interrupt flag bit
	3903	+|Error|BOOL|Yes|TRUE/FALSE|Whether there is an error or not
	3904	+|ErrorID|DWORD|Yes|-|(((
	3905	+Error code (Please refer to
	3906	+
	3907	+[[8.11 Error Code>>path:#错误码对照表]]
	3908	+)))
	3909	+
	3910	+**Function**
	3911	+
	3912	+* The MC _ SYNCMOVEVELOCITY function block function block is used to continue the movement of the previous function block and move according to the speed specified by the function block.
	3913	+* Since there is no input signal of position or distance, the function block will move until other function block sends a new command to stop movement of this function block;
	3914	+* When the speed of the controlled axis reaches the input parameter Velocity setpoint, the output parameter InVelocity is set. Once the input ‘Execute’ signal detects a falling edge or other function block to abort this function block, the output parameter ‘InVelocity’ is reset;
	3915	+* The MC _ SYNCMOVEVELOCITY function block shall be in a stopped motion state or a single-axis operation state when the controlled axis is operated. After this function block is triggered, the controlled axis transitions to the ‘Continuous Motion’ state. If the controlled axis is not in the above state, the function block is not executed, Error output is set;
	3916	+* The MC _ SYNCMOVEVELOCITY function block can be triggered repeatedly multiple times.
	3917	+
	3918	+**✎Note:** After using MC _ SYNCMOVEVELOCITY , the servo mode is automatically switched to the synchronous cycle speed mode.
	3919	+
	3920	+
	3921	+**Error code**
	3922	+
	3923	+|**Error code**|**Content**
	3924	+|4084H|Input data beyond the specifiable range
	3925	+
	3926	+**Timing diagram**
	3927	+
	3928	+(% style="text-align:center" %)
	3929	+[[image:1761033004563-270.png]]
	3930	+
	3931	+=== **MC _ SETTORQUE** ===
	3932	+
	3933	+MC _ SETTORQUE-Synchronous torque instruction
	3934	+
	3935	+[[image:1761033083623-162.png]]
	3936	+
	3937	+**Device used (only a single device can be used, and device splicing and Index are not supported)**
	3938	+
	3939	+|(% rowspan="2" %)**Instruction**|(% rowspan="2" %)**Parameter**|(% colspan="24" %)**Device**|(((
	3940	+**Index**
	3941	+
	3942	+**Modification**
	3943	+)))|(((
	3944	+**Pulse**
	3945	+
	3946	+**Expansion**
	3947	+)))
	3948	+|**X**|**Y**|**M**|**S**|**SM**|**T(bit)**|**C(bit)**|**LC(bit)**|**HSC(bit)**|**D.b**|**KnX**|**KnY**|**KnM**|**KnS**|**T**|**C**|**D**|**R**|**SD**|**LC**|**HSC**|**K**|**H**|**E**|**[D]**|**XXP**
	3949	+|(% rowspan="11" %)MC _ SETTORQUE|Execute|●|●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	3950	+|TORQUE| | | | | | | | | | | | | | | | | | | | | | | | | |
	3951	+|MaxVelocity| | | | | | | | | | | | | | | | | | | | | | | | | |
	3952	+|BufferMode| | | | | | | | | | | | | | | | | | | | | | | | | |
	3953	+|Axis| | | | | | | | | | | | | | | | | | | | | | | | | |
	3954	+|InTorque| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	3955	+|Busy| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	3956	+|Active| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	3957	+|CommandAborted| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	3958	+|Error| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	3959	+|ErrorID| | | | | | | | | | | | | | | | | | | | | | | | | |
	3960	+
	3961	+**Notes for using devices**
	3962	+
	3963	+* LC and HSC are signed 32-bit data types;
	3964	+* T, C, D, R and SD are signed 16-bit data types.
	3965	+
	3966	+**Variable type used**
	3967	+
	3968	+|**Instruction**|**Pin Type**|**Parameter**|**Variable type**|**Empty or not**|**Range**|**Description**
	3969	+|(% rowspan="12" %)MC _ SETTORQUE|(% rowspan="6" %)Input|Execute|BOOL|No|TRUE/FALSE|Enable
	3970	+|ContinuousUpdate|BOOL|Yes|TRUE/FALSE|Updated during operation
	3971	+|Torque|LREAL|No|[-32768,32767]|Target torque (unit is 0.1%)
	3972	+|MaxVelocity|LREAL|No|[0,999999999.999999]|Maximum speed
	3973	+|BufferMode|WORD|Yes|[0]|Currently only interrupts are supported
	3974	+|Axis|WORD|No|[0,65535]|Axis number
	3975	+|(% rowspan="6" %)Output|InTorque|BOOL|Yes|TRUE/FALSE|Completion flag
	3976	+|Busy|BOOL|Yes|TRUE/FALSE|Busy flag
	3977	+|Active|BOOL|Yes|TRUE/FALSE|Valid flag
	3978	+|CommandAborted|BOOL|Yes|TRUE/FALSE|Abortion flag
	3979	+|Error|BOOL|Yes|TRUE/FALSE|Error or not
	3980	+|ErrorID|DWORD|Yes|-|Error code ( Please refer to ~[[[8.11 Error code comparison table>>path:#错误码对照表]]])
	3981	+
	3982	+**Function**
	3983	+
	3984	+* This instruction is used to implement the synchronous torque control function and is only used for the bus servo axis. The rising edge and high level of the command are valid, and the virtual axis mode is not supported.
	3985	+* The following PDOs need to be configured in CST mode;
	3986	+
	3987	+0x1600: 0x6060, 0x6071, 607f (optional), 6040
	3988	+
	3989	+0x1A00: 0x6061, 0x6077, 0x6041
	3990	+
	3991	+* If you use VD3E, you need to configure the startup parameter 2001: 9 value to 2;
	3992	+* When Enable = ON, the function block converts TarTorque and MaxVelocity from user units to pulse units and sends them to the servo driver from time to time. The shaft is in the Continuous Motion state and performs synchronous torque motion. When the falling edge of Eanble, the function block performs synchronous torque motion with the TarTorque and Velocity latched during the high level, and it is invalid to modify the TarTorque and Velocity in real time;
	3993	+* This instruction can only be invoked if the axis is switched to the enabled state using the MC _ Power instruction;
	3994	+* This instruction uses the driver synchronous torque mode to realize the torque control function. When Enable = ON, the function block converts TarTorque and Velocity from user units to pulse units and sends them to the servo driver from time to time. The shaft is in the Continuous Motion state and performs synchronous torque motion;
	3995	+
	3996	+TarTorque: The target torque, the unit is 0.1%. One decimal place after the decimal point is valid in the program, and the latter ones are directly discarded. The actual torque of the driver is limited by the maximum positive and negative torques set in the configuration parameters.
	3997	+
	3998	+**Note**
	3999	+
	4000	+* This function block is not available when the axis does not exist.
	4001	+
	4002	+=== **MC _ TORQUECONTROL** ===
	4003	+
	4004	+MC _ TORQUECONTROL-Torque control command
	4005	+
	4006	+[[image:1761033167971-496.png||height="206" width="262"]]
	4007	+
	4008	+**Device used (only a single device can be used, and device splicing and Index are not supported)**
	4009	+
	4010	+|(% rowspan="2" %)**Instruction**|(% rowspan="2" %)**Parameter**|(% colspan="24" %)**Device**|(((
	4011	+**Index**
	4012	+
	4013	+**Modification**
	4014	+)))|(((
	4015	+**Pulse**
	4016	+
	4017	+**Expansion**
	4018	+)))
	4019	+|**X**|**Y**|**M**|**S**|**SM**|**T(bit)**|**C(bit)**|**LC(bit)**|**HSC(bit)**|**D.b**|**KnX**|**KnY**|**KnM**|**KnS**|**T**|**C**|**D**|**R**|**SD**|**LC**|**HSC**|**K**|**H**|**E**|**[D]**|**XXP**
	4020	+|(% rowspan="13" %)(((
	4021	+MC _ TORQUE
	4022	+
	4023	+CONTROL
	4024	+)))|Execute|●|●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	4025	+|ContinuousUpdate|●|●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	4026	+|TORQUE| | | | | | | | | | | | | | | | | | | | | | | | | |
	4027	+|TorqueRamp| | | | | | | | | | | | | | | | | | | | | | | | | |
	4028	+|MaxVelocity| | | | | | | | | | | | | | | | | | | | | | | | | |
	4029	+|BufferMode| | | | | | | | | | | | | | | | | | | | | | | | | |
	4030	+|Axis| | | | | | | | | | | | | | | | | | | | | | | | | |
	4031	+|InTorque| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	4032	+|Busy| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	4033	+|Active| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	4034	+|CommandAborted| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	4035	+|Error| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	4036	+|ErrorID| | | | | | | | | | | | | | | | | | | | | | | | | |
	4037	+
	4038	+**Notes for using devices**
	4039	+
	4040	+* LC and HSC are signed 32-bit data types;
	4041	+* T, C, D, R and SD are signed 16-bit data types.
	4042	+
	4043	+**Variable type used**
	4044	+
	4045	+|**Instruction**|**Pin Type**|**Parameter**|**Variable type**|**Empty or not**|**Range**|**Description**
	4046	+|(% rowspan="13" %)MC _ TORQUECONTROL|(% rowspan="7" %)Input|Execute|BOOL|No|TRUE/FALSE|Enable
	4047	+|ContinuousUpdate|BOOL|Yes|TRUE/FALSE|Updated during operation
	4048	+|Torque|LREAL|No|[-32768,32767]|Target torque (unit is 0.1%）
	4049	+|MaxVelocity|LREAL|No|[0,999999999.999999]|Maximum speed
	4050	+|TorqueRamp|LREAL|No|[0,999999999.999999]|Torque slope
	4051	+|BufferMode|WORD|Yes|[0]|Only interrupt mode supported
	4052	+|Axis|WORD|No|[0,65535]|Axis number
	4053	+|(% rowspan="6" %)Output|InTorque|BOOL|Yes|TRUE/FALSE|Completion flag
	4054	+|Busy|BOOL|Yes|TRUE/FALSE|Busy flag
	4055	+|Active|BOOL|Yes|TRUE/FALSE|Valid flag
	4056	+|CommandAborted|BOOL|Yes|TRUE/FALSE|Abortion flag
	4057	+|Error|BOOL|Yes|TRUE/FALSE|Error or not
	4058	+|ErrorID|DWORD|Yes|-|Error code (Please refer to ~[[[8.11 Error code comparison table>>path:#错误码对照表]]])
	4059	+
	4060	+**Function**
	4061	+
	4062	+* This instruction is used to realize the torque control function and is only used for the EtherCAT bus axis. The rising edge of the instruction is valid, and the imaginary axis mode is not supported.
	4063	+* The following PDOs need to be configured in CST mode:
	4064	+
	4065	+0x1600: 0x6060, 0x6071, 607f (optional), 6040
	4066	+
	4067	+0x1A00: 0x6061, 0x6077, 0x6041
	4068	+
	4069	+* If VD3E is used, the value of startup parameter 2001:9 is 2;
	4070	+
	4071	+**Function description**
	4072	+
	4073	+* This instruction can only be invoked if the axis is switched to the enabled state using the MC _ Power instruction;
	4074	+* This instruction uses the driver synchronous torque mode to realize the torque control function;
	4075	+* On the rising edge of the instruction, the function block latches the input parameters of TarTorque, TorqueSlope and MaxVelocity, and the axis is in the ContinuousMotion state and performs torque motion;
	4076	+
	4077	+TarTorque: Target torque, the unit is 0.1%, one decimal place after the decimal point is valid in the program, and the latter ones are discarded. The actual torque of the driver is limited by the maximum positive and negative torques set in the configuration parameters;
	4078	+
	4079	+TorqueSlope: Moment slope, the unit is 1%, one decimal place after the decimal point is valid in the program, and the latter ones are directly discarded;
	4080	+
	4081	+* Speed control in torque mode
	4082	+
	4083	+For servo drives, if 0x607f is mapped in the axis parameter, this instruction limits the maximum speed of the servo motor by 0x607f, if 0x607f is not mapped, the speed limit is invalid;
	4084	+
	4085	+On the rising edge of Execute, the instruction converts the speed limit set by Velocity into pulse units and writes it into 0x607f through PDO;
	4086	+
	4087	+When the torque instruction is interrupted by others, the maximum speed of the axis will be limited by the "Maximum speed" in the configuration interface;
	4088	+
	4089	+For third-party drives, Velocity can only be used as a speed limit under the following conditions:
	4090	+
	4091	+The maximum speed of the servomotor can be limited by 0x607F;
	4092	+
	4093	+0x607F can be configured into the PDO;
	4094	+
	4095	+The unit of 0x607F is pulse unit, non-speed unit.
	4096	+
	4097	+* Stop control on torque mode
	4098	+
	4099	+In the torque mode, the MC _ Stop instruction is called to perform the shut down, and after receiving the Stop instruction, the driver switches to the synchronous position mode, and performs deceleration according to the deceleration set by the Stop instruction.
	4100	+
	4101	+* Interrupt
	4102	+
	4103	+In PLCOpen, when the instruction is valid, the axis will be in the Continuous Motion state. Other instructions that can make the axis in Discrete motion or comply with PLCOpen state machine switching can interrupt the instruction. When the instruction is interrupted, CommandAboarted is valid;
	4104	+
	4105	+CommandAboarted is valid when Execute=ON and Done signal is invalid and is about to hit the limit signal execution needs to perform deceleration;
	4106	+
	4107	+The axis de-enable CommandAboarted is valid when Execute=ON and the Done signal is invalid.
	4108	+
	4109	+**Timing diagram**
	4110	+
	4111	+After setting the target torque, the command is triggered, and the actual output torque can reach the target torque.
	4112	+
	4113	+(% style="text-align:center" %)
	4114	+[[image:1761033264625-188.png]]
	4115	+
	4116	+
	4117	+After setting the target torque, the command is triggered, and finally the actual output torque cannot reach the target torque.
	4118	+
	4119	+(% style="text-align:center" %)
	4120	+[[image:1761033334729-116.png]]
	4121	+
	4122	+=== **MC _ MOVEABSRELPP** ===
	4123	+
	4124	+MC _ MOVEABSRELPP-Positioning instruction based on contour position mode
	4125	+
	4126	+[[image:1761034254689-443.png]]
	4127	+
	4128	+**Device used (only a single device can be used, and device splicing and Index are not supported)**
	4129	+
	4130	+|(% rowspan="2" %)**Instruction**|(% rowspan="2" %)**Parameter**|(% colspan="24" %)**Device**|**Index modification**|(((
	4131	+**Pulse**
	4132	+
	4133	+**Expansion**
	4134	+)))
	4135	+|**X**|**Y**|**M**|**S**|**SM**|**T(bit)**|**C(bit)**|**LC(bit)**|**HSC(bit)**|**D.b**|**KnX**|**KnY**|**KnM**|**KnS**|**T**|**C**|**D**|**R**|**SD**|**LC**|**HSC**|**K**|**H**|**E**|**[D]**|**XXP**
	4136	+|(% rowspan="13" %)(((
	4137	+MC _ MOVEA
	4138	+
	4139	+BSRELPP
	4140	+)))|Execute|●|●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	4141	+|Position| | | | | | | | | | | | | | | | | | | | | | | | | |
	4142	+|Velocity| | | | | | | | | | | | | | | | | | | | | | | | | |
	4143	+|Acceleration| | | | | | | | | | | | | | | | | | | | | | | | | |
	4144	+|Deceleration| | | | | | | | | | | | | | | | | | | | | | | | | |
	4145	+|Mode| | | | | | | | | | | | | | | | | | | | | | | | | |
	4146	+|Axis| | | | | | | | | | | | | | | | | | | | | | | | | |
	4147	+|Done| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	4148	+|Busy| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	4149	+|Active| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	4150	+|CommandAborted| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	4151	+|Error| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	4152	+|ErrorID| | | | | | | | | | | | | | | | | | | | | | | | | |
	4153	+
	4154	+**Notes for using devices**
	4155	+
	4156	+* LC and HSC are signed 32-bit data types;
	4157	+* T, C, D, R and SD are signed 16-bit data types.
	4158	+
	4159	+**Variable type used**
	4160	+
	4161	+|**Instruction**|**Pin Type**|**Parameter**|**Variable type**|**Empty or not**|**Range**|**Description**
	4162	+|(% rowspan="13" %)(((
	4163	+MC _ MOVE
	4164	+
	4165	+ABSRELPP
	4166	+)))|(% rowspan="7" %)Input|Execute|BOOL|No|TRUE/FALSE|Enable
	4167	+|Mode|INT|No|0,1|(((
	4168	+1: Absolute mode.
	4169	+
	4170	+1: Relative mode
	4171	+)))
	4172	+|Position|LREAL|No|(((
	4173	+-999999999.999999
	4174	+
	4175	+999999999.999999
	4176	+)))|Target location
	4177	+|Velocity|LREAL|No|（0,999999999.999999]|Velocity
	4178	+|Acceleration|LREAL|No|（0,999999999.999999]|Acceleration
	4179	+|Deceleration|LREAL|No|（0,999999999.999999]|Deceleration
	4180	+|Axis|WORD|No|[0,65535]|Axis number
	4181	+|(% rowspan="6" %)Output|Done|BOOL|Yes|TRUE/FALSE|Completion flag
	4182	+|Busy|BOOL|Yes|TRUE/FALSE|Busy flag
	4183	+|Active|BOOL|Yes|TRUE/FALSE|Valid flag
	4184	+|CommandAborted|BOOL|Yes|TRUE/FALSE|Abortion flag
	4185	+|Error|BOOL|Yes|TRUE/FALSE|Error or not
	4186	+|ErrorID|DWORD|Yes|-|Error code (Please refer to ~[[[8.11 Error code comparison table>>path:#_8.11 错误码对照表]]])
	4187	+
	4188	+**Function**
	4189	+
	4190	+* This command is used to control the EtherCAT bus contour axis to realize the absolute/relative positioning function in contour position mode. In the basic settings of axis configuration, the contour mode option needs to be checked before it can be called, and the rising edge is valid.
	4191	+* Contour Position Mode requires the following PDOs:
	4192	+
	4193	+0x1600: 0x6081, 0x6083, 0x6084, 0x607A, 0x6060, 0x6040
	4194	+
	4195	+0x1A00: 0x6061, 0x6064, 0x6041
	4196	+
	4197	+**Function description**
	4198	+
	4199	+* This instruction can only be invoked if the axis is switched to the enabled state using the MC _ Power instruction;
	4200	+* At the rising edge of the Execute input, the instruction latches the input parameters on the left side such as Position and Velocity, triggers the absolute/relative positioning function, and switches the PLCOpen state machine of the axis to the DiscreteMotion state;
	4201	+* When Mode = 0, the positioning Mode is absolute positioning Mode, and Position is used to set the target Position of absolute positioning. If the axis Mode is configured as rotation Mode, the target Position is positioned according to the shortest distance;
	4202	+* When Mode = 1, the positioning Mode is a relative positioning Mode, and Position is used to set the target distance of relative positioning;
	4203	+* Interrupt
	4204	+
	4205	+When this instruction is valid in PLCOpen, the axis will be in the Discretemotion state. Other outline mode instructions that can make the axis in Discretemotion or comply with PLCOpen state machine switching can interrupt this instruction. CommandAboarted is valid when the instruction is interrupted. The instruction of periodic synchronization mode cannot be called, otherwise a fault will be reported;
	4206	+
	4207	+CommandAboarted is valid when the MC _ Power instruction is invalid when Execute = TRUE and the Busy signal is valid causes the axis to be de-enabled.
	4208	+
	4209	+**Timing diagram**
	4210	+
	4211	+
	4212	+(% style="text-align:center" %)
	4213	+[[image:1761034304535-743.png]]
	4214	+
	4215	+=== **MC _ MOVEVELOCITYPV** ===
	4216	+
	4217	+MC _ MOVEVELOCITYPV-Contour Speed Command
	4218	+
	4219	+[[image:1761034415972-645.png]]
	4220	+
	4221	+**Device used (only a single device can be used, and device splicing and Index are not supported)**
	4222	+
	4223	+|(% rowspan="2" %)**Instruction**|(% rowspan="2" %)**Parameter**|(% colspan="24" %)**Device**|(((
	4224	+**Index**
	4225	+
	4226	+**Modification**
	4227	+)))|(((
	4228	+**Pulse**
	4229	+
	4230	+**Expansion**
	4231	+)))
	4232	+|**X**|**Y**|**M**|**S**|**SM**|**T(bit)**|**C(bit)**|**LC(bit)**|**HSC(bit)**|**D.b**|**KnX**|**KnY**|**KnM**|**KnS**|**T**|**C**|**D**|**R**|**SD**|**LC**|**HSC**|**K**|**H**|**E**|**[D]**|**XXP**
	4233	+|(% rowspan="11" %)(((
	4234	+MC _ MOVEVELO
	4235	+
	4236	+CITYPV
	4237	+)))|Execute|●|●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	4238	+|Velocity| | | | | | | | | | | | | | | | | | | | | | | | | |
	4239	+|Acceleration| | | | | | | | | | | | | | | | | | | | | | | | | |
	4240	+|Deceleration| | | | | | | | | | | | | | | | | | | | | | | | | |
	4241	+|Axis| | | | | | | | | | | | | | | | | | | | | | | | | |
	4242	+|InVelocity| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	4243	+|Busy| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	4244	+|Active| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	4245	+|CommandAborted| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	4246	+|Error| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	4247	+|ErrorID| | | | | | | | | | | | | | | | | | | | | | | | | |
	4248	+
	4249	+**Notes for using devices**
	4250	+
	4251	+* LC and HSC are signed 32-bit data types;
	4252	+* T, C, D, R and SD are signed 16-bit data types.
	4253	+
	4254	+**Variable type used**
	4255	+
	4256	+|**Instruction**|(((
	4257	+**Pin**
	4258	+
	4259	+**type**
	4260	+)))|**Parameter**|(((
	4261	+**Variable**
	4262	+
	4263	+**Type**
	4264	+)))|(((
	4265	+**Can you**
	4266	+
	4267	+**Is empty**
	4268	+)))|**Range**|**Description**
	4269	+|(% rowspan="11" %)(((
	4270	+MC _ MOVEVE
	4271	+
	4272	+LOCITYPV
	4273	+)))|(% rowspan="5" %)Input|Execute|BOOL|No|TRUE/FALSE|Enable
	4274	+|Velocity|LREAL|No|(((
	4275	+-999999999.999999
	4276	+
	4277	+999999999.999999
	4278	+)))|Velocity
	4279	+|Acceleration|LREAL|No|（0,999999999.999999]|Acceleration
	4280	+|Deceleration|LREAL|No|The QPS Exceeds Maximum Limit 5|Deceleration
	4281	+|Axis|WORD|No|[0,65535]|Axis number
	4282	+|(% rowspan="6" %)Output|InVelocity|BOOL|Yes|TRUE/FALSE|Completion flag
	4283	+|Busy|BOOL|Yes|TRUE/FALSE|Busy flag
	4284	+|Active|BOOL|Yes|TRUE/FALSE|Valid flag
	4285	+|CommandAborted|BOOL|Yes|TRUE/FALSE|Abortion flag
	4286	+|Error|BOOL|Yes|TRUE/FALSE|Error or not
	4287	+|ErrorID|DWORD|Yes|-|Error code (Please refer to ~[[[8.11 Error code comparison table>>path:#错误码对照表]]])
	4288	+
	4289	+**Function**
	4290	+
	4291	+* This command is used to realize the continuous motion function of EtherCAT bus contour axis in contour speed mode. In the basic settings of axis configuration, the contour mode option needs to be checked before it can be called, and the rising edge is valid;
	4292	+* This instruction is a simulated velocity instruction based on the profile velocity (PV) mode;
	4293	+* The following PDOs are required for the profile speed mode:
	4294	+
	4295	+0x1600: 0x6083, 0x6084, 0x60FF, 0x6060, 0x6040
	4296	+
	4297	+0x1A00: 0x6061, 0x606c, 0x6041
	4298	+
	4299	+**Function description**
	4300	+
	4301	+* This instruction can only be invoked if the axis is switched to the STANDSTILL state using the MC _ Power instruction;
	4302	+* When Execute = TRUE, the instruction latches the input parameters on the left side such as Velocity and Acceleration, the axis continuously runs according to the target speed set by Velocity, and switches the PLCOpen state machine of the axis to the ContinuousMotion state.
	4303	+
	4304	+**Timing diagram**
	4305	+
	4306	+
	4307	+(% style="text-align:center" %)
	4308	+[[image:1761034458765-139.png]]
	4309	+
	4310	+=== **MC _ TORQUECONTROLPT** ===
	4311	+
	4312	+MC _ TORQUECONTROLPT-Contour torque control command
	4313	+
	4314	+[[image:1761034544967-630.png]]
	4315	+
	4316	+**Device used (only a single device can be used, and device splicing and Index are not supported)**
	4317	+
	4318	+|(% rowspan="2" %)**Instruction**|(% rowspan="2" %)**Parameter**|(% colspan="24" %)**Device**|**Index modification**|**Pulse expansion**
	4319	+|**X**|**Y**|**M**|**S**|**SM**|**T(bit)**|**C(bit)**|**LC(bit)**|**HSC(bit)**|**D.b**|**KnX**|**KnY**|**KnM**|**KnS**|**T**|**C**|**D**|**R**|**SD**|**LC**|**HSC**|**K**|**H**|**E**|**[D]**|**XXP**
	4320	+|(% rowspan="11" %)(((
	4321	+MC _ TORQUE
	4322	+
	4323	+CONTROLPT
	4324	+)))|Execute|●|●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	4325	+|TORQUE| | | | | | | | | | | | | | | | | | | | | | | | | |
	4326	+|TorqueRamp| | | | | | | | | | | | | | | | | | | | | | | | | |
	4327	+|MaxVelocity| | | | | | | | | | | | | | | | | | | | | | | | | |
	4328	+|Axis| | | | | | | | | | | | | | | | | | | | | | | | | |
	4329	+|InTorque| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	4330	+|Busy| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	4331	+|Active| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	4332	+|CommandAborted| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	4333	+|Error| |●|●|●|●| | | | | | | | | | | | | | | | | | | | |
	4334	+|ErrorID| | | | | | | | | | | | | | | | | | | | | | | | | |
	4335	+
	4336	+**Notes for using devices**
	4337	+
	4338	+* LC and HSC are signed 32-bit data types;
	4339	+* T, C, D, R and SD are signed 16-bit data types.
	4340	+
	4341	+**Variable type used**
	4342	+
	4343	+|**Instruction**|**Pin Type**|**Parameter**|**Variable type**|**Empty or not**|**Range**|**Description**
	4344	+|(% rowspan="11" %)MC_ TORQUECONTROLPT|(% rowspan="5" %)Input|Execute|BOOL|No|TRUE/FALSE|Enable
	4345	+|Torque|LREAL|No|[-32768,32767]|Target torque (unit is 0.1%)
	4346	+|TorqueRamp|LREAL|No|（0,999999999.999999]|Torque slope
	4347	+|MaxVelocity|LREAL|No|[0,999999999.999999]|Maximum speed
	4348	+|Axis|WORD|No|[0,65535]|Axis number
	4349	+|(% rowspan="6" %)Output|InTorque|BOOL|Yes|TRUE/FALSE|Completion flag
	4350	+|Busy|BOOL|Yes|TRUE/FALSE|Busy flag
	4351	+|Active|BOOL|Yes|TRUE/FALSE|Valid flag
	4352	+|CommandAborted|BOOL|Yes|TRUE/FALSE|Abortion flag
	4353	+|Error|BOOL|Yes|TRUE/FALSE|Error or not
	4354	+|ErrorID|DWORD|Yes|-|Error code (Please refer to ~[[[8.11 Error code comparison table>>path:#错误码对照表]]])
	4355	+
	4356	+**Function**
	4357	+
	4358	+* This instruction is used to control the EtherCAT bus profile axis to realize the absolute/relative positioning function in profile position mode. In the basic settings of axis configuration, the profile mode option needs to be checked before it can be called, and the rising edge is valid;
	4359	+* This instruction is used to realize the torque control function and is only used for the EtherCAT bus axis. The rising edge of the instruction is valid and the virtual axis mode is not supported;
	4360	+* Profile torque mode needs to be configured with the following PDOs:
	4361	+
	4362	+0x1600: 0x6087 (optional), 0x6060, 0x6071, 0x607f (optional), 0x6040
	4363	+
	4364	+0x1A00: 0x6061, 0x6077, 0x6041
	4365	+
	4366	+**Function description**
	4367	+
	4368	+* This instruction can only be invoked if the axis is switched to the enabled state using the MC _ Power instruction. Otherwise, report a fault;
	4369	+* This instruction uses the driver synchronous torque mode to realize the torque control function;
	4370	+* On the rising edge of the instruction, the function block latches the input parameters of TarTorque, TorqueSlope and MaxVelocity, and the axis is in the ContinuousMotion state and performs torque motion;
	4371	+
	4372	+TarTorque: Target torque, the unit is 0.1%, one decimal place after the decimal point is valid in the program, and the latter ones are directly discarded. The actual torque of the driver is limited by the maximum positive and negative torques set in the configuration parameters;
	4373	+
	4374	+TorqueRamp: Torque ramp, the unit is 1%, one decimal place after the decimal point is valid in the program, and the latter ones are directly discarded.
	4375	+
	4376	+* Speed control in torque mode
	4377	+
	4378	+For servo drives, if 0x607f is mapped in the axis parameter, this instruction limits the maximum speed of the servo motor by 0x607f, if 0x607f is not mapped, the speed limit is invalid;
	4379	+
	4380	+On the rising edge of Execute, the instruction converts the speed limit set by Velocity into pulse units and writes it into 0x607f through PDO;
	4381	+
	4382	+When the torque instruction is interrupted by others, the maximum speed of the axis will be limited by the "Maximum speed" in the configuration interface;
	4383	+
	4384	+For third-party drives, Velocity can only be used as a speed limit under the following conditions:
	4385	+
	4386	+The maximum speed of the servomotor can be limited by 0x607F;
	4387	+
	4388	+0x607F can be configured into the PDO;
	4389	+
	4390	+The unit of 0x607F is pulse unit, non-speed unit.
	4391	+
	4392	+* Stop control on torque mode
	4393	+
	4394	+In the torque mode, the MC _ Stop instruction is called to perform the shut down, and after receiving the Stop instruction, the driver switches to the synchronous position mode, and performs deceleration according to the deceleration set by the Stop instruction.
	4395	+
	4396	+* Interrupt
	4397	+
	4398	+In PLCOpen, when the instruction is valid, the axis will be in the Continuous Motion state. Other instructions that can make the axis in Discrete motion or comply with PLCOpen state machine switching can interrupt the instruction. When the instruction is interrupted, CommandAboarted is valid;
	4399	+
	4400	+CommandAboarted is valid when Execute=ON and Done signal is invalid and is about to hit the limit signal execution needs to perform deceleration;
	4401	+
	4402	+The axis de-enable CommandAboarted is valid when Execute=ON and the Done signal is invalid.
	4403	+
	4404	+**Timing diagram**
	4405	+
	4406	+(% style="text-align:center" %)
	4407	+[[image:1761034615747-763.png]]
	4408	+
3735	3735	== **SDO instruction** ==
3736	3736
3737	3737	----
...	...	@@ -4222,16 +4222,41 @@
4222	4222	----
4223	4223
4224	4224	(% style="text-align:center" %)
4225		-[[image:1709016272018-406.png||height="669" width="631"]]
	4899	+[[image:123.png||height="659" width="621"]]
4226	4226
	4901	+**✎Note**: Continuous line arrows indicate transitions via command. Dashed line arrows indicate automatic transitions, which occur when a command on an axis ends or a related system transition occurs (e.g., a related error).
	4902	+
	4903	+① The transition condition for any state to fault stop or deceleration stop is: a fault occurs on the axis.
	4904	+
	4905	+② The transition condition for any state to off is: MC_Power.Enable = FALSE and there is no fault on the axis.
	4906	+
	4907	+③ MC_Reset = FALSE and MC_Power.Status = FALSE.
	4908	+
	4909	+④ MC_Reset = TRUE, MC_Power.Status = TRUE, and MC_Power.Enable = TRUE.
	4910	+
	4911	+⑤ MC_Power.Enable = TRUE and MC_Power.Status = TRUE.
	4912	+
	4913	+⑥ MC_Stop.Done = TRUE and MC_Stop.Execute = FALSE.
	4914	+
4227	4227	=== **Axis group motion control status diagram** ===
4228	4228
4229	4229	----
4230	4230
4231	4231	(% style="text-align:center" %)
4232		-[[image:1709016323709-202.png]]
	4920	+[[image:234.png||height="405" width="669"]]
4233	4233
	4922	+**✎Note**: For all states in the diagram could be transitioned to GroupDisabled state by MC_GroupDisable or MC_UngroupAllAxes.
4234	4234
	4924	+① Applies to all non-administrative (i.e., motion control) function blocks.
	4925	+
	4926	+② In the GroupErrorStop or GroupStopping state, all function blocks can be invoked, although they are not executed (except that MC_GroupReset is executed in the GroupErrorStop state and any other errors are generated). In exceptional cases, GroupErrorStop or GroupStopping will transition to GroupStandby or GroupErrorStop accordingly.
	4927	+
	4928	+③ MC_GroupStop.Done = TRUE and MC_GroupStop.Execute = FALSE.
	4929	+
	4930	+④ The state transition is available if the last axis is removed from the axis group.
	4931	+
	4932	+⑤ The transition is available when the axis group is non-empty.
	4933	+
4235	4235	=== **Arc mode description** ===
4236	4236
4237	4237	----
...	...	@@ -4243,22 +4243,20 @@
4243	4243
4244	4244	Features
4245	4245	)))|(((
4246		-The arc composed of starting point, auxiliary point and ending point is regarded as the trajectory circle of motion.
4247		-
4248		-
	4945	+The arc path consists of the starting point, auxiliary points, and ending point.
4249	4249	)))|(((
4250	4250
4251	4251
4252		-The auxiliary point is defined as the center of the motion trajectory, so the auxiliary point should be on the perpendicular line connecting the starting point and the ending point.
	4949	+The arc path consists of the starting point, the center point, and theending point.
4253	4253
4254	4254
4255	4255
4256	4256	)))|(((
4257		-According to the right-hand grip rule, the ending point and the vector perpendicular to the plane of the circle are defined, and the length of the vector corresponds to the radius of the circle.
	4954	+The arc is determined by its starting point, ending point, and the normal vector of the plane containing the circle.
4258	4258
4259	4259	The direction of the vector determines the direction of CW and CCW circles.
4260	4260
4261		-The major arc and minor arc are determined by path choice.
	4958	+The vector length is the radius of the arc.
4262	4262	)))
4263	4263	|(((
4264	4264
...	...	@@ -4508,6 +4508,7 @@
4508	4508	|0x00400005|MC_ERROR_ID_POSITION_OVER_POSITIVE_LIMIT|Position over positive limit
4509	4509	|0x00400006|MC_ERROR_ID_POSITION_OVER_NEGATIVE_LIMIT|Position over negative limit
4510	4510	|0x00400007|MC_ERROR_ID_POSITION_LAG_OVERLIMIT|Position lag over limit
	5208	+|0x00400008|MC_ERROR_ID_TORQUE_OVER_LIMIT|Torque over limit
4511	4511	|(% colspan="3" %)**Error Stop**
4512	4512	|0x00500000|MC_ERROR_ID_AXIS_ERROR_STOP|Axis error stopped
4513	4513	|(% colspan="3" %)**Error from servo**
...	...	@@ -4531,6 +4531,25 @@
4531	4531	|0x00600011|MC_ERROR_ID_SERVO_PARAWRITE|Write Servo parameter error
4532	4532	|0x00600012|MC_ERROR_ID_LOCAL_PULSE_HOME_TIMEOUT|Time out when origin regression
4533	4533	|0x00600013|MC_ERROR_ID_LOCAL_PULSE_HOME_NOT_TOUCH_LIMI|The execution has not encountered the limit
	5232	+|0x00600014|(((
	5233	+MC_ERROR_ID_LOCAL_PULSE_HOME_VELOCITY_
	5234	+
	5235	+OVER_LIMIT
	5236	+)))|Pulse shaft HOME Velocity over limit
	5237	+|0x00600015|(((
	5238	+MC_ERROR_ID_LOCAL_PULSE_HOME_ACC_
	5239	+
	5240	+OVER_LIMIT
	5241	+)))|Pulse shaft HOME Acceleration over limit
	5242	+|0x00600020|(((
	5243	+MC_ERROR_ID_MODE_SWITCH_NEEDPDO_
	5244	+
	5245	+NOTMAP
	5246	+)))|(((
	5247	+There is no required PDO for the mode
	5248	+
	5249	+corresponding to mode switching.
	5250	+)))
4534	4534	|0x006000FF|MC_ERROR_ID_SERVO_LOST|Servo lost
4535	4535	|(% colspan="3" %)**Axis’s error**
4536	4536	|0x00700000|MC_ERROR_ID_AXIS_GENERAL_ERROR|Axis's general error

123.png

Author

...	...	@@ -1,0 +1,1 @@
	1	+XWiki.Iris

Size

...	...	@@ -1,0 +1,1 @@
	1	+292.1 KB

Content

1761032781939-478.png

Author

...	...	@@ -1,0 +1,1 @@
	1	+XWiki.Iris

Size

...	...	@@ -1,0 +1,1 @@
	1	+27.1 KB

Content

1761032845559-339.png

Author

...	...	@@ -1,0 +1,1 @@
	1	+XWiki.Iris

Size

...	...	@@ -1,0 +1,1 @@
	1	+67.2 KB

Content

1761032974104-584.png

Author

...	...	@@ -1,0 +1,1 @@
	1	+XWiki.Iris

Size

...	...	@@ -1,0 +1,1 @@
	1	+16.7 KB

Content

1761033004563-270.png

Author

...	...	@@ -1,0 +1,1 @@
	1	+XWiki.Iris

Size

...	...	@@ -1,0 +1,1 @@
	1	+45.4 KB

Content

1761033083623-162.png

Author

...	...	@@ -1,0 +1,1 @@
	1	+XWiki.Iris

Size

...	...	@@ -1,0 +1,1 @@
	1	+23.7 KB

Content

1761033167971-496.png

Author

...	...	@@ -1,0 +1,1 @@
	1	+XWiki.Iris

Size

...	...	@@ -1,0 +1,1 @@
	1	+17.6 KB

Content

1761033264625-188.png

Author

...	...	@@ -1,0 +1,1 @@
	1	+XWiki.Iris

Size

...	...	@@ -1,0 +1,1 @@
	1	+36.1 KB

Content

1761033334729-116.png

Author

...	...	@@ -1,0 +1,1 @@
	1	+XWiki.Iris

Size

...	...	@@ -1,0 +1,1 @@
	1	+31.4 KB

Content

1761034254689-443.png

Author

...	...	@@ -1,0 +1,1 @@
	1	+XWiki.Iris

Size

...	...	@@ -1,0 +1,1 @@
	1	+35.3 KB

Content

1761034304535-743.png

Author

...	...	@@ -1,0 +1,1 @@
	1	+XWiki.Iris

Size

...	...	@@ -1,0 +1,1 @@
	1	+32.6 KB

Content

1761034415972-645.png

Author

...	...	@@ -1,0 +1,1 @@
	1	+XWiki.Iris

Size

...	...	@@ -1,0 +1,1 @@
	1	+34.2 KB

Content

1761034458765-139.png

Author

...	...	@@ -1,0 +1,1 @@
	1	+XWiki.Iris

Size

...	...	@@ -1,0 +1,1 @@
	1	+37.2 KB

Content

1761034544967-630.png

Author

...	...	@@ -1,0 +1,1 @@
	1	+XWiki.Iris

Size

...	...	@@ -1,0 +1,1 @@
	1	+29.7 KB

Content

1761034615747-763.png

Author

...	...	@@ -1,0 +1,1 @@
	1	+XWiki.Iris

Size

...	...	@@ -1,0 +1,1 @@
	1	+38.8 KB

Content

1770693592357-540.png

Author

...	...	@@ -1,0 +1,1 @@
	1	+XWiki.Iris

Size

...	...	@@ -1,0 +1,1 @@
	1	+133.1 KB

Content

234.png

Author

...	...	@@ -1,0 +1,1 @@
	1	+XWiki.Iris

Size

...	...	@@ -1,0 +1,1 @@
	1	+223.0 KB

Content