Omron NY532-1500 User Manual page 351

ST Programming
// If the input parameters for the instructions are not set, the target values and other parameters are set.
IF InitFlag=FALSE THEN
// The input parameters for the MC_MoveVelocity (Velocity Control) instruction are set.
Vel_Vel
Vel_Acc
Vel_Dec
Vel_Jrk
// The input parameters for the MC_SetPosition instruction are set.
Set_Pos_Pos
// The Input Parameter Initialization Completed Flag is changed to TRUE.
InitFlag:=TRUE;
END_IF;
// If the Servo Drive is ready when StartPg is TRUE, turn ON the Servo for axis 0.
// If the Servo Drive is not ready, turn OFF the Servo.
IF (StartPg=TRUE)
AND (MC_Axis000.DrvStatus.Ready=TRUE) THEN
Pwr_En:=TRUE;
ELSE
Pwr_En:=FALSE;
END_IF;
// If a minor fault level error occurs for axis 0, the error handler for the device (FaultHandler) is executed.
// Program the FaultHandler according to the device.
IF MC_Axis000.MFaultLvl.Active=TRUE THEN
FaultHandler();
END_IF;
// If the Servo is ON for axis 0, velocity control is executed for axis 0.
IF Pwr_Status=TRUE THEN
Vel_Ex:=TRUE;
END_IF;
// If StartSetPos is TRUE while the Servo is ON, the Set Position instruction is executed.
IF (Pwr_Status=TRUE)
AND (StartSetPos=TRUE) THEN
Set_Pos_Ex:=TRUE;
END_IF;
//MC_Power
PWR(
Axis
Enable := Pwr_En,
Status
Busy
Error
ErrorID => Pwr_ErrID
);
//MC_MC_MoveVelocity
VEL(
Axis
Execute
Velocity
Acceleration
NY-series Industrial Panel PC / Industrial Box PC Motion Control User's Manual (W559)
:= LREAL#36.0;
:= LREAL#1000.0;
:= LREAL#1000.0;
:= LREAL#100.0;
:= LREAL#0.0;
:= MC_Axis000,
=> Pwr_Status,
=> Pwr_Bsy,
=> Pwr_Err,
:= MC_Axis000,
:= Vel_Ex,
:= Vel_Vel,
:= Vel_Acc,
10 Sample Programming
10
10-75