跳到主要内容

单轴与轴组

SCL MC_* 经 VM dispatch 落到 AxisRuntimeMotionGateway。已注册轴写 StandardAxisImage(CiA-402 控制字 / 目标位置),由 AxisRuntimeEngine 七段 S 曲线推进。未注册轴返回非零,不伪装 Done。

笛卡尔直线 / 圆弧要 RuntimeHost 注入 IK 并 SetRobotAxes。电子凸轮、电子齿轮、相位偏移、力矩、探针:编译可 emit,网关无对应方法则诚实降级(产品口径凸轮为 P4)。SCALE / NORM 是同编译族的工程量映射,不是 PLCopen 运动功能块。

取消探针锁存​

MC_ABORT_TRIGGER · 可执行

取消探针锁存。当前无探针后端,诚实降级。

签名​

rc := MC_ABORT_TRIGGER(axis, TriggerInput);

参数​

axisDINT
  • 输入
  • 必填
已注册轴标识。
TriggerInputDINT
  • 输入
  • 必填
要取消的探针输入通道号。

返回值​

returnDINT
无后端时返回 0,不表示真实取消。

行为​

  • 弹出触发输入参数后降级。
  • 不伪装硬件探针已撤销。

错误与限制​

  • 无硬件触发数据面。

示例​

rc := MC_ABORT_TRIGGER(axis, 1);

凸轮撤出​

MC_CAM_OUT · 可执行

凸轮撤出。电子凸轮产品口径为 P4,当前无凸轮后端。

签名​

FUNCTION MC_CAM_OUT(slave : DINT) : DINT

参数​

slaveDINT
  • 输入
  • 必填
从轴标识。

返回值​

returnDINT
无后端时返回 0,不表示已撤出。

行为​

  • 不伪装真实撤出。

错误与限制​

  • 凸轮后端未接通。

示例​

rc := MC_CAM_OUT(slave);

凸轮表同步​

MC_CAM_TABLE · 可执行

凸轮表投入(PLCopen MC_CamIn 映射到本 opcode)。网关无凸轮方法,返回 -2。

签名​

FUNCTION MC_CAM_TABLE(slave : DINT, CamTableID : DINT, MasterAxis : DINT) : DINT

参数​

slaveDINT
  • 输入
  • 必填
从轴标识。
CamTableIDDINT
  • 输入
  • 必填
凸轮表索引。
MasterAxisDINT
  • 输入
  • 必填
主轴标识。

返回值​

returnDINT
网关无凸轮方法时返回 -2。

行为​

  • 不伪造 Done=0 伪装成功。

错误与限制​

  • -2:未实现。

示例​

rc := MC_CAM_TABLE(slave, 1, master);

数字凸轮开关​

MC_DIGITAL_CAM_SWITCH · 可执行

数字凸轮开关。当前无轴位置数据面判区间,push 0(假 OFF)。

签名​

rc := MC_DIGITAL_CAM_SWITCH(axis, SwitchIdx, OnPos, OffPos);

参数​

axisDINT
  • 输入
  • 必填
已注册轴标识。
SwitchIdxDINT
  • 输入
  • 必填
开关索引。
OnPosLREAL
  • 输入
  • 必填
接通位置。
OffPosLREAL
  • 输入
  • 必填
断开位置。

返回值​

returnDINT
无位置数据面时返回 0(假 OFF)。

行为​

  • 不伪造真实开关状态。

错误与限制​

  • 无位置数据面。

示例​

q := MC_DIGITAL_CAM_SWITCH(axis, 0, 10.0, 20.0);

电子齿轮同步​

MC_GEAR_IN · 可执行

电子齿轮投入。网关无齿轮方法,返回 -2。电子凸轮 / 齿轮产品口径为 P4。

签名​

FUNCTION MC_GEAR_IN(slave : DINT, Ratio : LREAL, MasterAxis : DINT) : DINT

参数​

slaveDINT
  • 输入
  • 必填
从轴标识。
RatioLREAL
  • 输入
  • 必填
齿轮比(主/从)。
MasterAxisDINT
  • 输入
  • 必填
主轴标识。

返回值​

returnDINT
返回 -2(RC_MC_NOT_IMPLEMENTED)。

行为​

  • 不伪造 Done=0。

错误与限制​

  • -2:未实现。

示例​

rc := MC_GEAR_IN(slave, 2.0, master);

电子齿轮撤出​

MC_GEAR_OUT · 可执行

电子齿轮撤出。当前无齿轮后端。

签名​

FUNCTION MC_GEAR_OUT(slave : DINT) : DINT

参数​

slaveDINT
  • 输入
  • 必填
从轴标识。

返回值​

returnDINT
无后端时返回 0,不表示已撤出。

行为​

  • 不伪装真实撤出。

错误与限制​

  • 齿轮后端未接通。

示例​

rc := MC_GEAR_OUT(slave);

使能已注册轴​

AxisRuntimeMotionGateway.GroupEnable · 可执行

对已注册标准轴设置使能意图和 CiA-402 Enable Operation 控制字,并解除托管运动内核急停闩。

签名​

int GroupEnable(int axisId)

参数​

axisIdint
  • 输入
  • 必填
AxisRegistry 中的轴标识。

返回值​

returnint
0 表示命令侧已设置;未注册轴返回非零。

行为​

  • 写 EnableIntent 与 ControlWord,解运动内核急停闩。
  • 命令侧成功不等于从站已 Operation Enabled。
  • 未注册轴不伪造成功。SCL 入口是 MC_POWER。

错误与限制​

  • 未注册轴:非零 rc。

示例​

int rc = gateway.GroupEnable(axisId);

单轴回零​

AxisRuntimeMotionGateway.Home · 可执行

运行托管轴最小回零序列,使目标位置收敛到零并设置 Homed。

签名​

int Home(int axisId)

参数​

axisIdint
  • 输入
  • 必填
已注册轴标识。

返回值​

returnint
0 表示回零序列已接受;未注册或规划失败返回非零。

行为​

  • AxisRuntimeEngine 规划回零到零位。
  • 急停闩或未注册轴不伪造 Done。

错误与限制​

  • 未注册 / 急停闩:非零 rc。

示例​

int rc = gateway.Home(axisId);

单轴回零​

MC_HOME · 可执行

SCL 单轴回零,经网关 Home。

签名​

FUNCTION MC_HOME(axis : DINT) : DINT

参数​

axisDINT
  • 输入
  • 必填
已注册轴标识。

返回值​

returnDINT
0 表示回零序列已接受;未注册或规划失败返回非零。

行为​

  • 到位后标准轴 Homed 被设置。
  • 不伪造 Done。

错误与限制​

  • 未注册 / 急停闩:非零 rc。

示例​

rc := MC_HOME(axis);

单轴点动​

AxisRuntimeMotionGateway.Jog · 可执行

按方向和速度持续推进已注册轴的点动目标。

签名​

int Jog(int axisId, double dir, double vel)

参数​

axisIdint
  • 输入
  • 必填
已注册轴标识。
dirdouble
  • 输入
  • 必填
非负正向,负值反向。
veldouble
  • 输入
  • 必填
点动速度绝对幅值来源。

返回值​

returnint
0 表示点动已接受;未注册或内核拒绝返回非零。

行为​

  • 方向符号与 vel 绝对值组成实际点动速度。
  • AdvanceCycle 推进点动目标位置。
  • 未注册或急停闩不伪造 Active。

错误与限制​

  • 未注册 / 急停闩:非零 rc。

示例​

int rc = gateway.Jog(axisId, +1.0, 20.0);

单轴点动​

MC_JOG · 可执行

SCL 单轴点动,经网关 Jog。

签名​

FUNCTION MC_JOG(axis : DINT, Direction : LREAL, Velocity : LREAL) : DINT

参数​

axisDINT
  • 输入
  • 必填
已注册轴标识。
DirectionLREAL
  • 输入
  • 必填
>=0 正向,<0 反向。
VelocityLREAL
  • 输入
  • 必填
点动速度绝对幅值。

返回值​

returnDINT
0 表示点动已接受;未注册或内核拒绝返回非零。

行为​

  • 与 C# Jog 同一路径。

错误与限制​

  • 未注册 / 急停闩:非零 rc。

示例​

rc := MC_JOG(axis, 1.0, 20.0);

单轴绝对定位​

MC_MOVE_ABS · 可执行

SCL 单轴绝对定位。VM 经网关 MoveLinear 一维分支,七段 S 曲线到目标位置。

签名​

FUNCTION MC_MOVE_ABS(axis : DINT, Position : LREAL, Velocity : LREAL) : DINT

参数​

axisDINT
  • 输入
  • 必填
已注册轴标识。
PositionLREAL
  • 输入
  • 必填
绝对目标位置。
VelocityLREAL
  • 输入
  • 必填
工程速度上限。

返回值​

returnDINT
0 表示轨迹已被托管运动内核接受;未注册或规划失败返回非零。

行为​

  • AdvanceCycle 在生产周期相位推进并写 TargetPosition。
  • 未注册或内核拒绝时不伪造 Done。

错误与限制​

  • 未注册 / 急停闩 / 规划失败:非零 rc。

示例​

rc := MC_MOVE_ABS(axis, 120.0, 50.0);

叠加运动​

MC_MOVE_ADD · 可执行

PLCopen MC_MoveSuperImposed。当前网关无叠加方法,退化为 MoveLinear 单轴绝对定位,不伪造叠加效果。

签名​

FUNCTION MC_MOVE_ADD(axis : DINT, Distance : LREAL, Velocity : LREAL) : DINT

参数​

axisDINT
  • 输入
  • 必填
已注册轴标识。
DistanceLREAL
  • 输入
  • 必填
叠加距离(带符号)。退化路径当作绝对目标。
VelocityLREAL
  • 输入
  • 必填
工程速度上限。

返回值​

returnDINT
0 表示退化定位被接受;未注册或规划失败返回非零。

行为​

  • 不是真正的叠加运动。

错误与限制​

  • 无叠加后端。

示例​

rc := MC_MOVE_ADD(axis, 10.0, 30.0);

轴组笛卡尔圆弧​

MC_MOVE_CIRCULAR · 可执行

轴组笛卡尔圆弧。网关 MoveCircular:途经点 + 终点 6 维位姿,三点定圆 + 弧长 S 曲线 + 姿态 SLERP。无 IK 或不配关节轴不退化为直线。

签名​

rc := MC_MOVE_CIRCULAR(groupId, Vx, Vy, Vz, Vrx, Vry, Vrz, Ex, Ey, Ez, Erx, Ery, Erz, Vel, Acc);

参数​

groupIdDINT
  • 输入
  • 必填
轴组标识。
VxLREAL
  • 输入
  • 必填
途经点 X(mm)。
VyLREAL
  • 输入
  • 必填
途经点 Y(mm)。
VzLREAL
  • 输入
  • 必填
途经点 Z(mm)。
VrxLREAL
  • 输入
  • 必填
途经点 Rx(度)。
VryLREAL
  • 输入
  • 必填
途经点 Ry(度)。
VrzLREAL
  • 输入
  • 必填
途经点 Rz(度)。
ExLREAL
  • 输入
  • 必填
终点 X(mm)。
EyLREAL
  • 输入
  • 必填
终点 Y(mm)。
EzLREAL
  • 输入
  • 必填
终点 Z(mm)。
ErxLREAL
  • 输入
  • 必填
终点 Rx(度)。
EryLREAL
  • 输入
  • 必填
终点 Ry(度)。
ErzLREAL
  • 输入
  • 必填
终点 Rz(度)。
VelLREAL
  • 输入
  • 必填
工程速度上限。
AccLREAL
  • 输入
  • 必填
加速度。

返回值​

returnDINT
轨迹已接受返回 Busy/0;未配关节轴或不支持 IK 返回非零。

行为​

  • via 与终点都必须 ≥6 维。
  • 不伪造圆弧已完成。

错误与限制​

  • 无 IK / 未配关节轴:非零 rc。

示例​

rc := MC_MOVE_CIRCULAR(group, 50.0, 50.0, 250.0, 180.0, 0.0, 0.0,
100.0, 0.0, 250.0, 180.0, 0.0, 0.0, 80.0, 200.0);

单轴绝对定位​

AxisRuntimeMotionGateway.MoveLinear · 可执行

一维:七段 S 曲线推进 TargetPosition。targetPose 长度 ≥6 且该 group 已配 IK / 关节轴时走笛卡尔直线。

签名​

int MoveLinear(int axisId, double[] targetPose, double vel, double acc)

参数​

axisIdint
  • 输入
  • 必填
已注册轴或轴组标识。
targetPosedouble[]
  • 输入
  • 必填
长度 1 为单轴绝对目标;长度 ≥6 为笛卡尔位姿。
veldouble
  • 输入
  • 必填
工程速度,换算运动内核速度倍率。
accdouble
  • 输入
  • 必填
加速度;≤0 时用网关默认。

返回值​

returnint
0 或 Busy 表示已接受;未注册、急停闩、空目标或规划失败返回非零。

行为​

  • 空或零长 targetPose 返回网关不可用。
  • 未注册轴不伪造 Done。

错误与限制​

  • 未注册 / 急停闩:非零 rc。

示例​

int rc = gateway.MoveLinear(axisId, new[] { 120.0 }, 50.0, 200.0);

轴组笛卡尔直线​

MC_MOVE_LINEAR · 可执行

SCL 轴组笛卡尔直线。经网关 MoveLinear 6 维分支;IK 依赖关节轴配置。

签名​

rc := MC_MOVE_LINEAR(groupId, X, Y, Z, Rx, Ry, Rz, Vel, Acc);

参数​

groupIdDINT
  • 输入
  • 必填
轴组标识。
XLREAL
  • 输入
  • 必填
目标 X(mm)。
YLREAL
  • 输入
  • 必填
目标 Y(mm)。
ZLREAL
  • 输入
  • 必填
目标 Z(mm)。
RxLREAL
  • 输入
  • 必填
目标 Rx(度)。
RyLREAL
  • 输入
  • 必填
目标 Ry(度)。
RzLREAL
  • 输入
  • 必填
目标 Rz(度)。
VelLREAL
  • 输入
  • 必填
工程速度上限。
AccLREAL
  • 输入
  • 必填
加速度。

返回值​

returnDINT
轨迹已接受返回 Busy/0;未配关节轴或不支持 IK 返回非零。

行为​

  • 与机器人 MoveL 同管线。
  • 不伪造笛卡尔运动已完成。

错误与限制​

  • 无 IK / 未配关节轴:非零 rc。

示例​

rc := MC_MOVE_LINEAR(group, 400.0, 0.0, 300.0, 180.0, 0.0, 0.0, 80.0, 200.0);

单轴相对定位​

MC_MOVE_REL · 可执行

SCL 单轴相对定位。VM 读反馈实际位置 + Distance 得到绝对目标,再经 MoveLinear。

签名​

FUNCTION MC_MOVE_REL(axis : DINT, Distance : LREAL, Velocity : LREAL) : DINT

参数​

axisDINT
  • 输入
  • 必填
已注册轴标识。
DistanceLREAL
  • 输入
  • 必填
相对距离(带符号)。
VelocityLREAL
  • 输入
  • 必填
工程速度上限。

返回值​

returnDINT
0 表示轨迹已接受;未注册或规划失败返回非零。

行为​

  • 用反馈侧实际位置,不用命令侧冒充。
  • 不伪造相对运动后的绝对位置。

错误与限制​

  • 未注册轴:非零 rc。

示例​

rc := MC_MOVE_REL(axis, 5.0, 20.0);

单轴速度控制​

MC_MOVE_VEL · 可执行

SCL 单轴速度控制。经网关 MoveVelocity 切入 CSV,周期积分位置。

签名​

FUNCTION MC_MOVE_VEL(axis : DINT, Velocity : LREAL) : DINT

参数​

axisDINT
  • 输入
  • 必填
已注册轴标识。
VelocityLREAL
  • 输入
  • 必填
带符号工程速度。

返回值​

returnDINT
0 表示速度模式已建立;未注册或内核拒绝返回非零。

行为​

  • 写标准轴 CSV 模式和目标速度。
  • 急停闩或未注册轴不返回假成功。

错误与限制​

  • 未注册 / 急停闩:非零 rc。

示例​

rc := MC_MOVE_VEL(axis, 30.0);

单轴速度模式​

AxisRuntimeMotionGateway.MoveVelocity · 可执行

把已注册轴切入 CSV 速度模式,由托管周期积分目标位置。

签名​

int MoveVelocity(int axisId, double vel)

参数​

axisIdint
  • 输入
  • 必填
已注册轴标识。
veldouble
  • 输入
  • 必填
带符号工程速度。

返回值​

returnint
0 表示速度模式已建立;未注册或内核拒绝返回非零。

行为​

  • 与 SCL MC_MOVE_VEL 同一路径。

错误与限制​

  • 未注册 / 急停闩:非零 rc。

示例​

int rc = gateway.MoveVelocity(axisId, 30.0);

绝对相位偏移​

MC_PHASING_ABS · 可执行

绝对相位偏移。当前无后端。

签名​

rc := MC_PHASING_ABS(axis, PhaseShift, Velocity);

参数​

axisDINT
  • 输入
  • 必填
已注册轴标识。
PhaseShiftLREAL
  • 输入
  • 必填
绝对相位偏移量。
VelocityLREAL
  • 输入
  • 必填
偏移速度。

返回值​

returnDINT
无后端时返回 0,不表示相位已偏移。

行为​

  • 不伪装真实相位偏移。

错误与限制​

  • 无相位后端。

示例​

rc := MC_PHASING_ABS(axis, 10.0, 5.0);

相对相位偏移​

MC_PHASING_REL · 可执行

相对相位偏移。当前无后端。

签名​

rc := MC_PHASING_REL(axis, PhaseShift, Velocity);

参数​

axisDINT
  • 输入
  • 必填
已注册轴标识。
PhaseShiftLREAL
  • 输入
  • 必填
相对相位偏移量。
VelocityLREAL
  • 输入
  • 必填
偏移速度。

返回值​

returnDINT
无后端时返回 0,不表示相位已偏移。

行为​

  • 不伪装真实相位偏移。

错误与限制​

  • 无相位后端。

示例​

rc := MC_PHASING_REL(axis, 2.0, 5.0);

单轴伺服使能​

MC_POWER · 可执行

SCL 单轴伺服使能 / 失能。经 GroupEnable / GroupDisable 写 CiA-402 控制字。

签名​

FUNCTION MC_POWER(axis : DINT, Enable : BOOL) : DINT

参数​

axisDINT
  • 输入
  • 必填
已注册轴标识。
EnableBOOL
  • 输入
  • 必填
TRUE=使能,FALSE=失能。

返回值​

returnDINT
0 表示命令侧已设置;未注册轴返回非零。

行为​

  • TRUE:Enable Operation 并解急停闩。
  • FALSE:清 Enable Operation,停轨迹。
  • 未注册轴不伪造成功。

错误与限制​

  • 未注册轴:非零 rc。

示例​

rc := MC_POWER(axis, TRUE);

读取单轴实际位置​

AxisRuntimeMotionGateway.ReadActualPosition · 可执行

从 StandardAxisImage 反馈侧读取周期层回填的实际位置。

签名​

double ReadActualPosition(int axisId)

参数​

axisIdint
  • 输入
  • 必填
已注册轴标识。

返回值​

returndouble
反馈侧实际位置;未注册轴返回 double.NaN。

行为​

  • 不用命令侧 TargetPosition 冒充实际值。
  • NaN 与真实零位置区分。

错误与限制​

  • 未注册轴:NaN。

示例​

double pos = gateway.ReadActualPosition(axisId);

读取单轴实际速度​

AxisRuntimeMotionGateway.ReadActualVelocity · 可执行

从反馈侧读取周期层回填的实际速度。

签名​

double ReadActualVelocity(int axisId)

参数​

axisIdint
  • 输入
  • 必填
已注册轴标识。

返回值​

returndouble
反馈侧实际速度;未注册轴返回 double.NaN。

行为​

  • 未注册轴不返回伪造的 0。

错误与限制​

  • 未注册轴:NaN。

示例​

double vel = gateway.ReadActualVelocity(axisId);

读单轴位置​

MC_READ_POS · 可执行

SCL 读取单轴实际位置,经 ReadActualPosition。

签名​

FUNCTION MC_READ_POS(axis : DINT) : LREAL

参数​

axisDINT
  • 输入
  • 必填
已注册轴标识。

返回值​

returnLREAL
反馈侧实际位置;未注册轴返回 NaN。

行为​

  • 读 ActualPosition,不用 TargetPosition 冒充。

错误与限制​

  • 未注册轴:NaN。

示例​

pos := MC_READ_POS(axis);

读取单轴状态字​

AxisRuntimeMotionGateway.ReadStatusWord · 可执行

读取周期层回填的 CiA-402 0x6041 原始状态字。

签名​

double ReadStatusWord(int axisId)

参数​

axisIdint
  • 输入
  • 必填
已注册轴标识。

返回值​

returndouble
0x6041 原始 16 位状态字的数值;未注册轴返回 NaN。

行为​

  • NaN 区分反馈不可用与状态字真实为零。

错误与限制​

  • 未注册轴:NaN。

示例​

double sw = gateway.ReadStatusWord(axisId);

读单轴状态字​

MC_READ_STS · 可执行

SCL 读取 CiA-402 0x6041 状态字,经 ReadStatusWord。

签名​

FUNCTION MC_READ_STS(axis : DINT) : LREAL

参数​

axisDINT
  • 输入
  • 必填
已注册轴标识。

返回值​

returnLREAL
0x6041 原始 16 位状态字的数值;未注册轴返回 NaN。

行为​

  • 与 C# ReadStatusWord 同一路径。

错误与限制​

  • 未注册轴:NaN。

示例​

sts := MC_READ_STS(axis);

读单轴速度​

MC_READ_VEL · 可执行

SCL 读取单轴实际速度,经 ReadActualVelocity。

签名​

FUNCTION MC_READ_VEL(axis : DINT) : LREAL

参数​

axisDINT
  • 输入
  • 必填
已注册轴标识。

返回值​

returnLREAL
反馈侧实际速度;未注册轴返回 NaN。

行为​

  • 未注册轴不返回伪造的 0。

错误与限制​

  • 未注册轴:NaN。

示例​

vel := MC_READ_VEL(axis);

单轴错误复位​

MC_RESET · 可执行

SCL 单轴错误复位。桥接到 GroupEnable 写 CiA-402 FaultReset(bit7)。

签名​

FUNCTION MC_RESET(axis : DINT) : DINT

参数​

axisDINT
  • 输入
  • 必填
已注册轴标识。

返回值​

returnDINT
0 表示故障复位命令已下发;未注册轴返回非零。

行为​

  • 命令侧成功不等于从站已退出 Fault。
  • 未注册轴不伪造成功。

错误与限制​

  • 未注册轴:非零 rc。

示例​

rc := MC_RESET(axis);

设定单轴位置​

MC_SET_POS · 可执行

SCL 软零点。经 SetPosition 直接写命令侧 TargetPosition,不产生运动。

签名​

FUNCTION MC_SET_POS(axis : DINT, Position : LREAL) : DINT

参数​

axisDINT
  • 输入
  • 必填
已注册轴标识。
PositionLREAL
  • 输入
  • 必填
新的命令侧位置。

返回值​

returnDINT
0 表示命令侧位置已写入;未注册或内核拒绝返回非零。

行为​

  • 不创建轨迹,也不隐式移动轴。

错误与限制​

  • 未注册轴:非零 rc。

示例​

rc := MC_SET_POS(axis, 0.0);

设置单轴命令位置​

AxisRuntimeMotionGateway.SetPosition · 可执行

直接设置标准轴命令侧 TargetPosition,不生成运动轨迹。

签名​

int SetPosition(int axisId, double newPos)

参数​

axisIdint
  • 输入
  • 必填
已注册轴标识。
newPosdouble
  • 输入
  • 必填
新的命令侧位置。

返回值​

returnint
0 表示命令侧位置已写入;未注册或内核拒绝返回非零。

行为​

  • 与 SCL MC_SET_POS 同一路径。

错误与限制​

  • 未注册轴:非零 rc。

示例​

int rc = gateway.SetPosition(axisId, 0.0);

单轴受控停止​

MC_STOP · 可执行

SCL 单轴受控停止。MC_HALT 映射同一 opcode 0xE2。经 GroupStop 停当前运动。

签名​

FUNCTION MC_STOP(axis : DINT) : DINT

参数​

axisDINT
  • 输入
  • 必填
已注册轴标识。

返回值​

returnDINT
0 表示停止命令已下发;未注册轴返回非零。

行为​

  • 命令侧冻结当前,不冲到终点。
  • HaltIntent / GroupStop 不等于 paused / homed。
  • 未注册轴不伪造 Done。

错误与限制​

  • 未注册轴:非零 rc。

示例​

rc := MC_STOP(axis);

力矩控制​

MC_TORQUE_CONTROL · 可执行

力矩控制(CiA-402 PT/CST)。当前网关无力矩方法,push 0(假 InTorque=未达)。

签名​

rc := MC_TORQUE_CONTROL(axis, Torque, TorqueRamp);

参数​

axisDINT
  • 输入
  • 必填
已注册轴标识。
TorqueLREAL
  • 输入
  • 必填
目标力矩值。
TorqueRampLREAL
  • 输入
  • 必填
力矩斜坡。

返回值​

returnDINT
无力矩方法时返回 0,不表示已进入力矩模式。

行为​

  • 不伪装力矩模式已建立。

错误与限制​

  • 无力矩后端。

示例​

rc := MC_TORQUE_CONTROL(axis, 1.2, 0.1);

探针锁存​

MC_TOUCH_PROBE · 可执行

探针锁存。当前无硬件触发数据面,返回 NaN。

签名​

FUNCTION MC_TOUCH_PROBE(axis : DINT, TriggerInput : DINT) : LREAL

参数​

axisDINT
  • 输入
  • 必填
已注册轴标识。
TriggerInputDINT
  • 输入
  • 必填
探针输入通道号。

返回值​

returnLREAL
锁存位置;无硬件触发时返回 NaN。

行为​

  • 用 IsNaN 判断锁存不可用,不要把 0 当锁存位置。

错误与限制​

  • 无硬件触发数据面:NaN。

示例​

latched := MC_TOUCH_PROBE(axis, 1);

归一化 ∈ [0,1]​

NORM · 可执行

SCL 工程量归一化:[Min,Max] → [0,1]。与运动编译族同文件,不是 PLCopen 轴功能。

签名​

FUNCTION NORM(In : LREAL, Min : LREAL, Max : LREAL) : LREAL

参数​

InLREAL
  • 输入
  • 必填
输入值。
MinLREAL
  • 输入
  • 必填
范围下限。
MaxLREAL
  • 输入
  • 必填
  • 约束 Max != Min。
范围上限。

返回值​

returnLREAL
∈[0,1] 归一化值。Max=Min 时返回 NaN。

行为​

  • norm = (In-Min)/(Max-Min)。
  • Max=Min 时 NaN,不返回 0 装成功。

错误与限制​

  • 除零区间:NaN。

示例​

n := NORM(raw, 0.0, 4095.0);

线性映射(ADC 转工程量)​

SCALE · 可执行

SCL 工程量线性映射:in∈[inLo,inHi] → out∈[outLo,outHi]。VM opcode 已实装。

签名​

FUNCTION SCALE(In : LREAL, InLo : LREAL, InHi : LREAL, OutLo : LREAL, OutHi : LREAL) : LREAL

参数​

InLREAL
  • 输入
  • 必填
输入值。
InLoLREAL
  • 输入
  • 必填
输入下限。
InHiLREAL
  • 输入
  • 必填
  • 约束 InHi != InLo。
输入上限。
OutLoLREAL
  • 输入
  • 必填
输出下限。
OutHiLREAL
  • 输入
  • 必填
输出上限。

返回值​

returnLREAL
映射后的工程值。InHi=InLo 时返回 NaN。

行为​

  • out = OutLo + (In-InLo)/(InHi-InLo) * (OutHi-OutLo)。
  • UNSCALE 交换区间后复用同一 opcode,无新指令。

错误与限制​

  • 除零区间:NaN。

示例​

eng := SCALE(adc, 0.0, 4095.0, 0.0, 10.0);