汇川使用笔记5：伺服点动测试

1、用户程序创建

1.1 创建程序

1.2 程序添加到任务中

2、伺服功能块测试

1、用户程序创建

1.1 创建程序

在Application目录下添加新的文件夹“用户程序”，添加程序 : MotionTest

1.2 程序添加到任务中

将新创建的程序MotionTest，添加到任务配置中

2、伺服功能块测试

伺服的功能块，使用IEC61131-3标准的PLCOpen方式开发。功能块分为单轴控制、多轴控制、伺服状态等。功能块库保存在库文件：SM3_Basic=SM3_Basic,4.2.2.0中。

2.1 伺服使能程序

输入助手使用：在程序编辑框中，按键盘F2。

然后生成功能块程序，添加关联变量

下载程序、运行。然后监视环境下测试

2.2 添加其他轴控功能

使用上述方法分别添加MC_JOG、MC_Stop、MC_Reset功能块，添加其它相关变量

PROGRAM MotionTest
VAR
	//轴控变量
	bi_Power:							BOOL;				//控制使能		
	bi_Reset:							BOOL;
	bi_Stop:							BOOL;
	bi_Jog_Forward:						BOOL;				//正向点动
	bi_Jog_Reverse:						BOOL;				//反向点动	
	bi_MoveAdditive:					BOOL;
	
	//轴控参数
	di_Jog_Velocity:					LREAL:=10;			//单位	转/秒
	di_Jog_Acceleration:				LREAL:=20;
	di_Jog_Deceleration:				LREAL:=20;
	di_Jog_Jerk:						LREAL:=0;
	di_MoveAdditive_Distance:			LREAL:=1000;
	di_MoveAdditive_Velocity:			LREAL:=20;
	di_MoveAdditive_Acceleration:		LREAL:=10;
	di_MoveAdditive_Deceleration:		LREAL:=10;
	di_MoveAdditive_Jerk:				LREAL:=0;
	di_Stop_Deceleration:				LREAL:=4000;		//停机减速度
	di_Stop_Jerk:						LREAL:=0;			//停机减减速度
	
	//轴控变量	
	MC_Power_0:							MC_Power;			//MC_Power功能块变量
	MC_JOG_0:							MC_JOG;	
	MC_Reset_0:							MC_Reset;
	MC_Stop_0:							MC_Stop;		
	MC_MoveAdditive_0:					MC_MoveAdditive;
			
END_VAR

轴控功能块代码实现如下



//轴使能
MC_Power_0(
	Axis:= Axis_1, 							//轴变量
	Enable:= TRUE, 
	bRegulatorOn:= bi_Power, 
	bDriveStart:= bi_Power, 
	Status=> , 
	bRegulatorRealState=> , 
	bDriveStartRealState=> , 
	Busy=> , 
	Error=> , 
	ErrorID=> );
	
//轴点动	
MC_JOG_0(
	Axis:= Axis_1, 
	JogForward:= bi_Jog_Forward, 			//正向dJog,	TRUE旋转 FALSE停止
	JogBackward:= bi_Jog_Reverse, 			//反向Jog,	TRUE旋转 FALSE停止
	Velocity:= di_Jog_Velocity,             //单位	转/秒
	Acceleration:= di_Jog_Acceleration, 
	Deceleration:= di_Jog_Deceleration, 
	Jerk:= di_Jog_Jerk, 
	Busy=> , 
	CommandAborted=> , 
	Error=> , 
	ErrorId=> );
	
//轴停止	
MC_Stop_0(
	Axis:= Axis_1, 
	Execute:= bi_Stop, 
	Deceleration:= di_Stop_Deceleration, 
	Jerk:= di_Stop_Jerk, 
	Done=> , 
	Busy=> , 
	Error=> , 
	ErrorID=> );	

//轴复位	
MC_Reset_0(
	Axis:= Axis_1, 
	Execute:= bi_Reset, 
	Done=> , 
	Busy=> , 
	Error=> , 
	ErrorID=> );	
	
//轴增量运动	
MC_MoveAdditive_0(
	Axis:= Axis_1, 
	Execute:= bi_MoveAdditive,                   //上升沿信号触发,执行完成再次给上升沿有效
	Distance:= di_MoveAdditive_Distance, 
	Velocity:= di_MoveAdditive_Velocity, 
	Acceleration:= di_MoveAdditive_Acceleration, 
	Deceleration:= di_MoveAdditive_Deceleration, 
	Jerk:= di_MoveAdditive_Jerk, 
	Done=> , 
	Busy=> , 
	CommandAborted=> , 
	Error=> , 
	ErrorID=> );

然后保存工程、编译、下载、在线运行。