单轴与轴组
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- 范围上限。
返回值
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- 输入上限。
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);