机器自动化控制器——第三章 轴指令 6

• • MC_MoveVelocity
  • • 变量
    • • ▶输入变量
      • ▶输出变量
      • ▶输入输出变量
  • 功能说明
  • • • ▶指令详情
      • ▶时序图
      • ▶重启运动指令
      • ▶多重启动运动指令
      • ▶异常
    • 动作示例
    • • ▶动作示例
      • ▶梯形图
      • ▶结构文本(ST)

MC_MoveVelocity

• 使用伺服驱动器的位置控制模式，进行模拟速度控制。

指令	名称	FB/ FUN	图形表现	ST表现
MC_MoveVelocity	速度控制	FB		MC_MoveVelocity_instance ( Axis :=《参数》 , Execute :=《参数》 , Velocity :=《参数》 , Acceleration :=《参数》 , Deceleration :=《参数》 , Jerk :=《参数》 , Direction :=《参数》 , Continuous :=《参数》 , BufferMode :=《参数》 , InVelocity =>《参数》 , Busy =>《参数》 , Active =>《参数》 , CommandAborted =>《参数》 , Error =>《参数》 , ErrorID =>《参数》 );

变量

▶输入变量

• 1.关于指令单位，请参阅“NJ/NX系列CPU单元用户手册运动控制篇(SBCE-363)”或“NY系列工业用平板电脑/工业用台式电脑用户手册运动控制篇(SBCE-379)”的“单位转换设定”。
• 2.有效范围为枚举体的变量，其实际初始值不是数值，而是枚举元素。

▶输出变量

• 请参阅“A-1错误代码一览(P.A-2)”。

▶输入输出变量

• 1. 请使用在Sysmac Studio的轴基本设定画面中创建的用户定义变量的轴变量名称(默认 “MC_Axis***”)或系统定义变量的 轴变量名称(_MC_AX[], _MC1_AX[], _MC2_AX[*])。

功能说明

▶指令详情

    ► Direction(方向选择)

▶时序图

▶重启运动指令

▶多重启动运动指令

    ► 其它指令执行中的本指令启动

    ► 本指令执行中的其它指令启动

▶异常

    ► 发生异常时的时序图

    ► 错误代码

动作示例

• 下面，对转盘或离心分离器之类的速度控制中的示例程序进行说明。

    ► 轴参数的设定

    轴种类

▶动作示例

    ► 动作模式

1 速度控制的开始

2 变更为第2速度

3 变更为第3速度

4 速度控制的停止

▶梯形图

    ► 主要变量

    ► 时序图

    ► 示例程序

    ► 内联ST的内容

// 根据传感器的状态设置速度因子
IF (Sensor2 = FALSE) AND (Sensor3 = FALSE) THEN
  Set_Ov_Velfct := LREAL#100.0;
ELSIF (Sensor2 = TRUE) AND (Sensor3 = FALSE) THEN
  Set_Ov_Velfct := LREAL#500.0;
ELSIF (Sensor2 = FALSE) AND (Sensor3 = TRUE) THEN
  Set_Ov_Velfct := LREAL#200.0;
ELSE
  Set_Ov_Velfct := LREAL#200.0;
END_IF;

▶结构文本(ST)

    ► 主要变量

    ► 时序图

    ► 示例程序

// 未设定输入参数时的处理
IF InitFlag = FALSE THEN
  // MC_MoveVelocity 参数
  Vel_Vel := LREAL#1048576.0;
  Vel_Acc := LREAL#1048576.0;
  Vel_Dec := LREAL#1048576.0;
  Vel_Dir := _eMC_DIRECTION#_mcPositiveDirection;

  // MC_SetOverride 参数
  Set_Ov_Velfct := LREAL#100.0;

  // MC_Stop 参数
  Stp_Dec := LREAL#524288.0;

  // 设定输入参数后，将 InitFlag 设为 TRUE
  InitFlag := TRUE;
END_IF;

// StartPg 为 TRUE 时，确认伺服驱动器处于伺服准备就绪状态，
// 将轴1设为伺服 ON 状态。
// 如果未处于伺服准备就绪状态，则设为伺服 OFF。
IF (StartPg = TRUE) AND (MC_Axis000.DrvStatus.Ready = TRUE) THEN
  Pwr_En := TRUE;
ELSE
  Pwr_En := FALSE;
END_IF;

// 轴1发生轻度故障后，执行异常时处理 FaultHandler。
// 发生异常时的处理 (FaultHandler) 由客户根据装置进行编程。
IF MC_Axis000.MFaultLvl.Active = TRUE THEN
  FaultHandler();
END_IF;

// 轴1处于伺服 ON 状态，且触点 Sensor1 为 TRUE 时，启动 MC_MoveVelocity。
IF (Pwr_Status = TRUE) AND (Sensor1 = TRUE) THEN
  Vel_Ex := TRUE;
END_IF;

// 在 MC_MoveVelocity 控制中，根据触点 Sensor2 和触点 Sensor3 的 ON/OFF，变更超调值。
IF Vel_Act = TRUE THEN
  IF (Sensor2 = FALSE) AND (Sensor3 = FALSE) THEN
    Set_Ov_Velfct := LREAL#100.0;
  ELSIF (Sensor2 = TRUE) AND (Sensor3 = FALSE) THEN
    Set_Ov_Velfct := LREAL#500.0;
  ELSIF (Sensor2 = FALSE) AND (Sensor3 = TRUE) THEN
    Set_Ov_Velfct := LREAL#200.0;
  ELSE
    Set_Ov_Velfct := LREAL#200.0;
  END_IF;
END_IF;

// 在 MC_MoveVelocity 控制中启动 MC_SetOverride。
IF Vel_Act = TRUE THEN
  Set_Ov_En := TRUE;
END_IF;

// StopTrig 为 TRUE 时启动 MC_Stop。
IF StopTrig = TRUE THEN
  Stp_Ex := TRUE;
END_IF;

// MC_Power
PWR(
  Axis := MC_Axis000,
  Enable := Pwr_En,
  Status => Pwr_Status,
  Busy => Pwr_Bsy,
  Error => Pwr_Err,
  ErrorID => Pwr_ErrID
);

// MC_MoveVelocity
VEL(
  Axis := MC_Axis000,
  Execute := Vel_Ex,
  Velocity := Vel_Vel,
  Acceleration := Vel_Acc,
  Deceleration := Vel_Dec,
  Direction := Vel_Dir,
  InVelocity => Vel_Invel,
  Busy => Vel_Bsy,
  Active => Vel_Act,
  CommandAborted => Vel_Ca,
  Error => Vel_Err,
  ErrorID => Vel_ErrID
);

// MC_SetOverride
SET_OV(
  Axis := MC_Axis000,
  Enable := Set_Ov_En,
  VelFactor := Set_Ov_Velfct,
  AccFactor := Set_Ov_Accfct,
  JerkFactor := Set_Ov_Jfct,
  Busy => Set_Ov_Bsy,
  Enabled => Set_Ov_End,
  Error => Set_Ov_Err,
  ErrorID => Set_Ov_ErrID
);

// MC_Stop
STP(
  Axis := MC_Axis000,
  Execute := Stp_Ex,
  Deceleration := Stp_Dec,
  Done => Stp_D,
  Busy => Stp_Bsy,
  Active => Stp_Act,
  CommandAborted => Stp_Ca,
  Error => Stp_Err,
  ErrorID => Stp_ErrID
);