895 lines
31 KiB
C#
895 lines
31 KiB
C#
using Aitex.Sorter.Common;
|
||
using MECF.Framework.Common.CommonData;
|
||
using MECF.Framework.Common.Communications;
|
||
using MECF.Framework.Common.Equipment;
|
||
using Newtonsoft.Json.Linq;
|
||
using System;
|
||
using System.Linq;
|
||
using System.Text;
|
||
|
||
namespace MECF.Framework.RT.EquipmentLibrary.HardwareUnits.Robots.SiasunPhoenixB
|
||
{
|
||
public abstract class RobotSiasunPhoenixBHandler : HandlerBase
|
||
{
|
||
public RobotSiasunPhoenixB Device { get; }
|
||
public bool HasResponse { get; set; } = true;
|
||
|
||
protected string _command;
|
||
protected string _parameter;
|
||
protected string _target;
|
||
protected RobotArmEnum _blade;
|
||
|
||
|
||
protected string _requestResponse = "";
|
||
|
||
protected RobotSiasunPhoenixBHandler(RobotSiasunPhoenixB device, string command, string parameter = null)
|
||
: base(BuildMessage(command, parameter))
|
||
{
|
||
Device = device;
|
||
_command = command;
|
||
_parameter = parameter;
|
||
Name = command;
|
||
}
|
||
private static string BuildMessage(string command, string parameter)
|
||
{
|
||
string msg = parameter == null ? $"{command}" : $"{command} {parameter}";
|
||
if (msg.Contains("GOTO N 5 ") || msg.Contains("PLACE 5 ") || msg.Contains("PICK 5 "))
|
||
{
|
||
msg = msg.Replace("SLOT 3 ", "SLOT 1 ");
|
||
msg = msg.Replace("SLOT 2 ", "SLOT 1 ");
|
||
}
|
||
else if (msg.Contains("GOTO N 4 ") || msg.Contains("PLACE 4 ") || msg.Contains("PICK 4 "))
|
||
{
|
||
msg = msg.Replace("SLOT 3 ", "SLOT 1 ");
|
||
msg = msg.Replace("SLOT 2 ", "SLOT 1 ");
|
||
}
|
||
|
||
return msg + "\r";
|
||
}
|
||
|
||
public override bool HandleMessage(MessageBase msg, out bool transactionComplete)
|
||
{
|
||
RobotSiasunPhoenixBMessage response = msg as RobotSiasunPhoenixBMessage;
|
||
ResponseMessage = msg;
|
||
|
||
if (response.IsError)
|
||
{
|
||
Device.NoteError(response.Data);
|
||
}
|
||
|
||
if (response.IsComplete)
|
||
{
|
||
SetState(EnumHandlerState.Completed);
|
||
transactionComplete = true;
|
||
return true;
|
||
}
|
||
if (response.IsResponse)
|
||
{
|
||
_requestResponse = response.Data;
|
||
}
|
||
|
||
transactionComplete = false;
|
||
return false;
|
||
}
|
||
}
|
||
|
||
public class RobotSiasunPhoenixBRawCommandHandler : RobotSiasunPhoenixBHandler
|
||
{
|
||
public RobotSiasunPhoenixBRawCommandHandler(RobotSiasunPhoenixB device, string command, string parameter = null)
|
||
: base(device, command, parameter)
|
||
{
|
||
}
|
||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||
{
|
||
if (base.HandleMessage(msg, out handled))
|
||
{
|
||
var result = msg as RobotSiasunPhoenixBMessage;
|
||
var rawMsg = _requestResponse != null ? _requestResponse + "$" + result.RawMessage : result.RawMessage;
|
||
Device.NoteRawCommandInfo(_command, rawMsg);
|
||
}
|
||
|
||
return true;
|
||
}
|
||
}
|
||
|
||
public class RobotSiasunPhoenixBGotoHandler : RobotSiasunPhoenixBHandler
|
||
{
|
||
//GOTO N station [R (EX|RE)] [Z (UP|DN)] [SLOT num] [[ARM] arm]
|
||
public RobotSiasunPhoenixBGotoHandler(RobotSiasunPhoenixB device, ModuleName module, int slot, RobotArmEnum blade,
|
||
bool isRetract = true, bool isZaxisDown = true, int timeout = 60)
|
||
: base(device, "GOTO", $"N {device.GetStationByModule(module,slot)} R {(isRetract ? "RE" : "EX")}" +
|
||
$" Z {(isZaxisDown ? "DN" : "UP")} SLOT {slot} ARM {(blade == RobotArmEnum.Blade1 ? "A" : "B")}")
|
||
{
|
||
AckTimeout = TimeSpan.FromSeconds(timeout);
|
||
CompleteTimeout = TimeSpan.FromSeconds(timeout);
|
||
_target = (blade == RobotArmEnum.Blade2 ? "ArmB" : "ArmA") + "." + module;
|
||
_blade = blade;
|
||
|
||
device.MoveInfo = new RobotMoveInfo()
|
||
{
|
||
Action = isRetract ? RobotAction.Moving : RobotAction.Picking,
|
||
ArmTarget = blade == RobotArmEnum.Blade1 ? RobotArm.ArmA : RobotArm.ArmB,
|
||
BladeTarget = _target,
|
||
};
|
||
}
|
||
|
||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||
{
|
||
var result = msg as RobotSiasunPhoenixBMessage;
|
||
if (result.IsError)
|
||
{
|
||
Device.NoteError(result.Data);
|
||
}
|
||
else
|
||
{
|
||
Device.NoteError(null);
|
||
}
|
||
|
||
ResponseMessage = msg;
|
||
handled = true;
|
||
Device.NoteActionCompleted();
|
||
|
||
return true;
|
||
}
|
||
|
||
}
|
||
public class RobotSiasunPhoenixBPickHandler : RobotSiasunPhoenixBHandler
|
||
{
|
||
//PICK station [SLOT slot] [[ARM] arm][ENRT|STRT NR][RO x TO x]
|
||
public RobotSiasunPhoenixBPickHandler(RobotSiasunPhoenixB device, string module, int slot, RobotArmEnum blade,
|
||
int ro = 0, int to = 0, int timeout = 60, bool isDisableInterlock = false)
|
||
: base(device, "PICK", $"{device.GetStationByModule(module, slot)} SLOT {slot}" +
|
||
$" ARM {(blade == RobotArmEnum.Blade1 ? "A" : "B")}{(ro == 0 ? "" : $" RO {ro}")}{(to == 0 ? "" : $" TO {to}")}{(isDisableInterlock ? " INTLCK DIS" : "")}")
|
||
{
|
||
AckTimeout = TimeSpan.FromSeconds(timeout);
|
||
CompleteTimeout = TimeSpan.FromSeconds(timeout);
|
||
|
||
var moduleArr = module.Split('.');
|
||
_target = (blade == RobotArmEnum.Blade2 ? "ArmB" : "ArmA") + "." + moduleArr[0];
|
||
_blade = blade;
|
||
|
||
device.MoveInfo = new RobotMoveInfo()
|
||
{
|
||
Action = RobotAction.Picking,
|
||
ArmTarget = blade == RobotArmEnum.Blade2 ? RobotArm.ArmB : RobotArm.ArmA, //blade == RobotArmEnum.Blade1 ? RobotArm.ArmA : RobotArm.ArmB,
|
||
BladeTarget = _target,
|
||
};
|
||
}
|
||
|
||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||
{
|
||
var result = msg as RobotSiasunPhoenixBMessage;
|
||
if (result.IsError)
|
||
{
|
||
Device.NoteError(result.Data);
|
||
}
|
||
else
|
||
{
|
||
Device.NoteError(null);
|
||
Device.MoveInfo = new RobotMoveInfo()
|
||
{
|
||
Action = RobotAction.Moving,
|
||
ArmTarget = _blade == RobotArmEnum.Blade1 ? RobotArm.ArmA : RobotArm.ArmB,
|
||
BladeTarget = _target,
|
||
};
|
||
}
|
||
|
||
ResponseMessage = msg;
|
||
handled = true;
|
||
Device.NoteActionCompleted();
|
||
|
||
return true;
|
||
}
|
||
}
|
||
|
||
public class RobotSiasunPhoenixBPickExtendHandler : RobotSiasunPhoenixBHandler
|
||
{
|
||
//PICK station [SLOT slot] [[ARM] arm][ENRT|STRT NR][RO x TO x]
|
||
public RobotSiasunPhoenixBPickExtendHandler(RobotSiasunPhoenixB device, ModuleName module, int slot, RobotArmEnum blade,
|
||
int ro = 0, int to = 0, int timeout = 60, bool isDisableInterlock = false)
|
||
: base(device, "PICK", $"{device.GetStationByModule(module, slot)} SLOT {slot}" +
|
||
$" ARM {(blade == RobotArmEnum.Blade1 ? "A" : "B")} ENRT NR {(ro == 0 ? "" : $" RO {ro}")}{(to == 0 ? "" : $" TO {to}")}{(isDisableInterlock ? " INTLCK DIS" : "")}")
|
||
{
|
||
AckTimeout = TimeSpan.FromSeconds(timeout);
|
||
CompleteTimeout = TimeSpan.FromSeconds(timeout);
|
||
|
||
_target = (blade == RobotArmEnum.Blade2 ? "ArmB" : "ArmA") + "." + module;
|
||
_blade = blade;
|
||
|
||
device.MoveInfo = new RobotMoveInfo()
|
||
{
|
||
Action = RobotAction.Picking,
|
||
ArmTarget = blade == RobotArmEnum.Blade2 ? RobotArm.ArmB : RobotArm.ArmA, //blade == RobotArmEnum.Blade1 ? RobotArm.ArmA : RobotArm.ArmB,
|
||
BladeTarget = _target,
|
||
};
|
||
}
|
||
|
||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||
{
|
||
var result = msg as RobotSiasunPhoenixBMessage;
|
||
if (result.IsError)
|
||
{
|
||
Device.NoteError(result.Data);
|
||
}
|
||
else
|
||
{
|
||
Device.NoteError(null);
|
||
}
|
||
|
||
ResponseMessage = msg;
|
||
handled = true;
|
||
Device.NoteActionCompleted();
|
||
|
||
return true;
|
||
}
|
||
}
|
||
|
||
public class RobotSiasunPhoenixBPickRetractHandler : RobotSiasunPhoenixBHandler
|
||
{
|
||
//PICK station [SLOT slot] [[ARM] arm][ENRT|STRT NR][RO x TO x]
|
||
public RobotSiasunPhoenixBPickRetractHandler(RobotSiasunPhoenixB device, ModuleName module, int slot, RobotArmEnum blade, int ro = 0, int to = 0, int timeout = 60, bool isDisableInterlock = false)
|
||
: base(device, "PICK", $"{device.GetStationByModule(module, slot)} SLOT {slot} ARM {(blade == RobotArmEnum.Blade1 ? "A" : "B")} STRT NR {(ro == 0 ? "" : $" RO {ro}")}{(to == 0 ? "" : $" TO {to}")}{(isDisableInterlock ? " INTLCK DIS" : "")}")
|
||
{
|
||
AckTimeout = TimeSpan.FromSeconds(timeout);
|
||
CompleteTimeout = TimeSpan.FromSeconds(timeout);
|
||
|
||
_target = (blade == RobotArmEnum.Blade2 ? "ArmB" : "ArmA") + "." + module;
|
||
_blade = blade;
|
||
|
||
device.MoveInfo = new RobotMoveInfo()
|
||
{
|
||
Action = RobotAction.Moving,
|
||
ArmTarget = blade == RobotArmEnum.Blade1 ? RobotArm.ArmA : RobotArm.ArmB,
|
||
BladeTarget = _target,
|
||
};
|
||
}
|
||
|
||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||
{
|
||
var result = msg as RobotSiasunPhoenixBMessage;
|
||
if (result.IsError)
|
||
{
|
||
Device.NoteError(result.Data);
|
||
}
|
||
else
|
||
{
|
||
Device.NoteError(null);
|
||
}
|
||
|
||
ResponseMessage = msg;
|
||
handled = true;
|
||
Device.NoteActionCompleted();
|
||
|
||
return true;
|
||
}
|
||
}
|
||
|
||
public class RobotSiasunPhoenixBPlaceHandler : RobotSiasunPhoenixBHandler
|
||
{
|
||
public RobotSiasunPhoenixBPlaceHandler(RobotSiasunPhoenixB device, string module, int slot, RobotArmEnum blade,
|
||
int ro = 0, int to = 0, int timeout = 60, bool isDisableInterlock = false)
|
||
: base(device, "PLACE", $"{device.GetStationByModule(module, slot)} SLOT {slot}" +
|
||
$" ARM {(blade == RobotArmEnum.Blade1 ? "A" : "B")}{(ro == 0 ? "" : $" RO {ro}")}{(to == 0 ? "" : $" TO {to}")}{(isDisableInterlock ? " INTLCK DIS" : "")}")
|
||
{
|
||
AckTimeout = TimeSpan.FromSeconds(timeout);
|
||
CompleteTimeout = TimeSpan.FromSeconds(timeout);
|
||
|
||
var moduleArr = module.Split('.');
|
||
_target = (blade == RobotArmEnum.Blade2 ? "ArmB" : "ArmA") + "." + moduleArr[0];
|
||
_blade = blade;
|
||
|
||
device.MoveInfo = new RobotMoveInfo()
|
||
{
|
||
Action = RobotAction.Placing,
|
||
ArmTarget = blade == RobotArmEnum.Blade2 ? RobotArm.ArmB : RobotArm.ArmA,//RobotArmEnum.Blade1 ? RobotArm.ArmA : RobotArm.ArmB,
|
||
BladeTarget = _target,
|
||
};
|
||
}
|
||
|
||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||
{
|
||
var result = msg as RobotSiasunPhoenixBMessage;
|
||
if (result.IsError)
|
||
{
|
||
Device.NoteError(result.Data);
|
||
Device.NoteActionCompleted();
|
||
}
|
||
else
|
||
{
|
||
Device.NoteError(null);
|
||
Device.MoveInfo = new RobotMoveInfo()
|
||
{
|
||
Action = RobotAction.Moving,
|
||
ArmTarget = _blade == RobotArmEnum.Blade1 ? RobotArm.ArmA : RobotArm.ArmB,
|
||
BladeTarget = _target,
|
||
};
|
||
Device.NoteActionCompleted();
|
||
}
|
||
|
||
ResponseMessage = msg;
|
||
handled = true;
|
||
|
||
|
||
return true;
|
||
}
|
||
}
|
||
|
||
public class RobotSiasunPhoenixBPlaceExtendHandler : RobotSiasunPhoenixBHandler
|
||
{
|
||
public RobotSiasunPhoenixBPlaceExtendHandler(RobotSiasunPhoenixB device, ModuleName module, int slot, RobotArmEnum blade, int ro = 0, int to = 0, int timeout = 60, bool isDisableInterlock = false)
|
||
: base(device, "PLACE", $"{device.GetStationByModule(module, slot)} SLOT {slot} ARM {(blade == RobotArmEnum.Blade1 ? "A" : "B")} ENRT NR {(ro == 0 ? "" : $" RO {ro}")}{(to == 0 ? "" : $" TO {to}")}{(isDisableInterlock ? " INTLCK DIS" : "")}")
|
||
{
|
||
AckTimeout = TimeSpan.FromSeconds(timeout);
|
||
CompleteTimeout = TimeSpan.FromSeconds(timeout);
|
||
|
||
_target = (blade == RobotArmEnum.Blade2 ? "ArmB" : "ArmA") + "." + module;
|
||
_blade = blade;
|
||
|
||
device.MoveInfo = new RobotMoveInfo()
|
||
{
|
||
Action = RobotAction.Placing,
|
||
ArmTarget = blade == RobotArmEnum.Blade1 ? RobotArm.ArmA : RobotArm.ArmB,
|
||
BladeTarget = _target,
|
||
};
|
||
}
|
||
|
||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||
{
|
||
var result = msg as RobotSiasunPhoenixBMessage;
|
||
if (result.IsError)
|
||
{
|
||
Device.NoteError(result.Data);
|
||
}
|
||
else
|
||
{
|
||
Device.NoteError(null);
|
||
}
|
||
|
||
ResponseMessage = msg;
|
||
handled = true;
|
||
Device.NoteActionCompleted();
|
||
|
||
return true;
|
||
}
|
||
}
|
||
|
||
public class RobotSiasunPhoenixBPlaceRetractHandler : RobotSiasunPhoenixBHandler
|
||
{
|
||
public RobotSiasunPhoenixBPlaceRetractHandler(RobotSiasunPhoenixB device, ModuleName module, int slot, RobotArmEnum blade, int ro = 0, int to = 0, int timeout = 60, bool isDisableInterlock = false)
|
||
: base(device, "PLACE", $"{device.GetStationByModule(module, slot)} SLOT {slot} ARM {(blade == RobotArmEnum.Blade1 ? "A" : "B")} STRT NR {(ro == 0 ? "" : $" RO {ro}")}{(to == 0 ? "" : $" TO {to}")}{(isDisableInterlock ? " INTLCK DIS" : "")}")
|
||
{
|
||
AckTimeout = TimeSpan.FromSeconds(timeout);
|
||
CompleteTimeout = TimeSpan.FromSeconds(timeout);
|
||
|
||
_target = (blade == RobotArmEnum.Blade2 ? "ArmB" : "ArmA") + "." + module;
|
||
_blade = blade;
|
||
|
||
device.MoveInfo = new RobotMoveInfo()
|
||
{
|
||
Action = RobotAction.Moving,
|
||
ArmTarget = blade == RobotArmEnum.Blade1 ? RobotArm.ArmA : RobotArm.ArmB,
|
||
BladeTarget = _target,
|
||
};
|
||
}
|
||
|
||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||
{
|
||
var result = msg as RobotSiasunPhoenixBMessage;
|
||
if (result.IsError)
|
||
{
|
||
Device.NoteError(result.Data);
|
||
}
|
||
else
|
||
{
|
||
Device.NoteError(null);
|
||
}
|
||
|
||
ResponseMessage = msg;
|
||
handled = true;
|
||
Device.NoteActionCompleted();
|
||
|
||
return true;
|
||
}
|
||
}
|
||
|
||
public class RobotSiasunPhoenixBTransferHandler : RobotSiasunPhoenixBHandler
|
||
{
|
||
//XFER [[ARM]arm] station-a station-b
|
||
public RobotSiasunPhoenixBTransferHandler(RobotSiasunPhoenixB device, int fromStation, int toStation, RobotArmEnum blade, int timeout)
|
||
: base(device, "XFER", $"ARM {(blade == RobotArmEnum.Blade1 ? "A" : "B")} {fromStation} {toStation}")
|
||
{
|
||
AckTimeout = TimeSpan.FromSeconds(timeout);
|
||
CompleteTimeout = TimeSpan.FromSeconds(timeout);
|
||
}
|
||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||
{
|
||
var result = msg as RobotSiasunPhoenixBMessage;
|
||
if (result.IsError)
|
||
{
|
||
Device.NoteError(result.Data);
|
||
}
|
||
else
|
||
{
|
||
Device.NoteError(null);
|
||
}
|
||
|
||
ResponseMessage = msg;
|
||
handled = true;
|
||
Device.NoteActionCompleted();
|
||
|
||
return true;
|
||
}
|
||
}
|
||
|
||
public class RobotSiasunPhoenixBRetractHandler : RobotSiasunPhoenixBHandler
|
||
{
|
||
public RobotSiasunPhoenixBRetractHandler(RobotSiasunPhoenixB device, int timeout)
|
||
: base(device, "RETRACT")
|
||
{
|
||
AckTimeout = TimeSpan.FromSeconds(timeout);
|
||
CompleteTimeout = TimeSpan.FromSeconds(timeout);
|
||
}
|
||
|
||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||
{
|
||
var result = msg as RobotSiasunPhoenixBMessage;
|
||
if (result.IsError)
|
||
{
|
||
Device.NoteError(result.Data);
|
||
}
|
||
else
|
||
{
|
||
Device.NoteError(null);
|
||
}
|
||
|
||
ResponseMessage = msg;
|
||
handled = true;
|
||
Device.NoteActionCompleted();
|
||
|
||
return true;
|
||
}
|
||
|
||
}
|
||
|
||
public class RobotSiasunPhoenixBResetHandler : RobotSiasunPhoenixBHandler
|
||
{
|
||
//RESET
|
||
public RobotSiasunPhoenixBResetHandler(RobotSiasunPhoenixB device)
|
||
: base(device, "RESET")
|
||
{
|
||
HasResponse = false;
|
||
}
|
||
|
||
//no return message
|
||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||
{
|
||
handled = true;
|
||
|
||
return true;
|
||
}
|
||
}
|
||
|
||
public class RobotSiasunPhoenixBHaltHandler : RobotSiasunPhoenixBHandler
|
||
{
|
||
public RobotSiasunPhoenixBHaltHandler(RobotSiasunPhoenixB device)
|
||
: base(device, "HALT")
|
||
{
|
||
|
||
}
|
||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||
{
|
||
var result = msg as RobotSiasunPhoenixBMessage;
|
||
if (result.IsError)
|
||
{
|
||
Device.NoteError(result.Data);
|
||
}
|
||
else
|
||
{
|
||
Device.NoteError(null);
|
||
}
|
||
|
||
ResponseMessage = msg;
|
||
handled = true;
|
||
|
||
return true;
|
||
}
|
||
|
||
}
|
||
public class RobotSiasunPhoenixBHELLOtHandler : RobotSiasunPhoenixBHandler
|
||
{
|
||
public RobotSiasunPhoenixBHELLOtHandler(RobotSiasunPhoenixB device)
|
||
: base(device, "HLLO")
|
||
{
|
||
|
||
}
|
||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||
{
|
||
var result = msg as RobotSiasunPhoenixBMessage;
|
||
if (result.IsError)
|
||
{
|
||
Device.NoteError(result.Data);
|
||
}
|
||
else
|
||
{
|
||
Device.NoteError(null);
|
||
}
|
||
|
||
ResponseMessage = msg;
|
||
handled = true;
|
||
|
||
return true;
|
||
}
|
||
|
||
}
|
||
public class RobotSiasunPhoenixBSetCommunicationEchoHandler : RobotSiasunPhoenixBHandler
|
||
{
|
||
public RobotSiasunPhoenixBSetCommunicationEchoHandler(RobotSiasunPhoenixB device, bool isEchoOn)
|
||
: base(device, "SET IO ECHO", isEchoOn ? "Y" : "N")
|
||
{
|
||
|
||
}
|
||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||
{
|
||
if (base.HandleMessage(msg, out handled))
|
||
{
|
||
Device.NoteSetCommEchoCompleted(true);
|
||
}
|
||
|
||
return true;
|
||
}
|
||
|
||
}
|
||
|
||
public class RobotSiasunPhoenixBSetLoadHandler : RobotSiasunPhoenixBHandler
|
||
{
|
||
public RobotSiasunPhoenixBSetLoadHandler(RobotSiasunPhoenixB device, RobotArmEnum blade, bool isWaferPresent)
|
||
: base(device, "SET LOAD", $"{(blade == RobotArmEnum.Blade1 ? "A" : "B")} {(isWaferPresent ? "ON" : "OFF")}")
|
||
{
|
||
|
||
}
|
||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||
{
|
||
if (base.HandleMessage(msg, out handled))
|
||
{
|
||
Device.NoteSetParametersComplete();
|
||
}
|
||
|
||
return true;
|
||
}
|
||
}
|
||
|
||
public class RobotSiasunPhoenixBSevoOnOffHandler : RobotSiasunPhoenixBHandler
|
||
{
|
||
public RobotSiasunPhoenixBSevoOnOffHandler(RobotSiasunPhoenixB device, bool isOn)
|
||
: base(device, isOn ? "SVON" : "SVOFF")
|
||
{
|
||
|
||
}
|
||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||
{
|
||
var result = msg as RobotSiasunPhoenixBMessage;
|
||
if (result.IsError)
|
||
{
|
||
Device.NoteError(result.Data);
|
||
}
|
||
else
|
||
{
|
||
Device.NoteError(null);
|
||
Device.NoteSevoOnOff(_command == "SVON");
|
||
}
|
||
|
||
ResponseMessage = msg;
|
||
handled = true;
|
||
|
||
return true;
|
||
}
|
||
|
||
}
|
||
|
||
public class RobotSiasunPhoenixBHomeAxisHandler : RobotSiasunPhoenixBHandler
|
||
{
|
||
public RobotSiasunPhoenixBHomeAxisHandler(RobotSiasunPhoenixB device, int timeout)
|
||
: base(device, "HOME", "ALL")
|
||
{
|
||
AckTimeout = TimeSpan.FromSeconds(timeout);
|
||
CompleteTimeout = TimeSpan.FromSeconds(timeout);
|
||
device.MoveInfo = new RobotMoveInfo()
|
||
{
|
||
Action = RobotAction.Moving,
|
||
ArmTarget = RobotArm.Both,
|
||
BladeTarget = "ArmA.System",
|
||
};
|
||
}
|
||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||
{
|
||
var result = msg as RobotSiasunPhoenixBMessage;
|
||
if (result.IsError)
|
||
{
|
||
Device.NoteError(result.Data);
|
||
}
|
||
else
|
||
{
|
||
Device.NoteError(null);
|
||
Device.NoteAxisHomed();
|
||
}
|
||
|
||
ResponseMessage = msg;
|
||
handled = true;
|
||
|
||
return true;
|
||
}
|
||
|
||
}
|
||
|
||
public class RobotSiasunPhoenixBCheckLoadHandler : RobotSiasunPhoenixBHandler
|
||
{
|
||
//CHECK LOAD station [[ARM] arm]
|
||
//_RDY
|
||
public RobotSiasunPhoenixBCheckLoadHandler(RobotSiasunPhoenixB device, int station, RobotArmEnum blade, int timeout)
|
||
: base(device, "CHECK LOAD", $"{station} {(blade == RobotArmEnum.Blade1 ? "A" : "B")}")
|
||
{
|
||
AckTimeout = TimeSpan.FromSeconds(timeout);
|
||
CompleteTimeout = TimeSpan.FromSeconds(timeout);
|
||
}
|
||
|
||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||
{
|
||
RobotSiasunPhoenixBMessage response = msg as RobotSiasunPhoenixBMessage;
|
||
ResponseMessage = msg;
|
||
handled = false;
|
||
|
||
if (response.IsError)
|
||
{
|
||
Device.NoteError(response.Data);
|
||
}
|
||
|
||
if (response.IsResponse)
|
||
{
|
||
_requestResponse = response.Data;
|
||
}
|
||
|
||
if (response.IsComplete)
|
||
{
|
||
SetState(EnumHandlerState.Completed);
|
||
handled = true;
|
||
Device.NoteReadDataComplete();
|
||
return true;
|
||
}
|
||
|
||
return true;
|
||
}
|
||
}
|
||
|
||
public class RobotSiasunPhoenixBQueryWaferPresentHandler : RobotSiasunPhoenixBHandler
|
||
{
|
||
public RobotSiasunPhoenixBQueryWaferPresentHandler(RobotSiasunPhoenixB device, RobotArmEnum blade)
|
||
: base(device, "RQ LOAD", blade == RobotArmEnum.Blade1 ? "A" : "B")
|
||
{
|
||
}
|
||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||
{
|
||
RobotSiasunPhoenixBMessage response = msg as RobotSiasunPhoenixBMessage;
|
||
ResponseMessage = msg;
|
||
handled = false;
|
||
|
||
if (response.IsError)
|
||
{
|
||
Device.NoteError(response.Data);
|
||
}
|
||
|
||
if (response.IsResponse)
|
||
{
|
||
_requestResponse = response.Data;
|
||
}
|
||
|
||
if (_requestResponse != null && _requestResponse.Contains(" B"))
|
||
{
|
||
Device.NoteWafeOnOff("B", _requestResponse.ToUpper().Contains("ON"), _requestResponse.ToUpper().Contains("UNKNOW"));
|
||
}
|
||
else if (_requestResponse != null && _requestResponse.Contains(" A"))
|
||
{
|
||
Device.NoteWafeOnOff("A", _requestResponse.ToUpper().Contains("ON"), _requestResponse.ToUpper().Contains("UNKNOW"));
|
||
}
|
||
|
||
if (response.IsComplete)
|
||
{
|
||
SetState(EnumHandlerState.Completed);
|
||
handled = true;
|
||
Device.NoteReadDataComplete();
|
||
return true;
|
||
}
|
||
|
||
return true;
|
||
}
|
||
}
|
||
|
||
public class RobotSiasunPhoenixBRequestWaferCentDataHandler : RobotSiasunPhoenixBHandler
|
||
{
|
||
public RobotSiasunPhoenixBRequestWaferCentDataHandler(RobotSiasunPhoenixB device)
|
||
: base(device, "RQ WAF_CEN DATA")
|
||
{
|
||
}
|
||
|
||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||
{
|
||
RobotSiasunPhoenixBMessage response = msg as RobotSiasunPhoenixBMessage;
|
||
ResponseMessage = msg;
|
||
handled = false;
|
||
|
||
if (response.IsError)
|
||
{
|
||
Device.NoteError(response.Data);
|
||
}
|
||
|
||
|
||
if (response.IsResponse)
|
||
{
|
||
_requestResponse = response.Data;
|
||
}
|
||
//WAF_CEN RT value1x value1y value4x value4y LFT value2x value2y value3x value3y offset_r offset_t
|
||
Device.NoteWafeCenData(_requestResponse);
|
||
|
||
if (response.IsComplete)
|
||
{
|
||
SetState(EnumHandlerState.Completed);
|
||
handled = true;
|
||
Device.NoteReadDataComplete();
|
||
return true;
|
||
}
|
||
|
||
return true;
|
||
}
|
||
}
|
||
|
||
public class RobotSiasunPhoenixBSetWaferCentModeHandler : RobotSiasunPhoenixBHandler
|
||
{
|
||
//SET WAF_CEN MODE SINGLE_SENS|RL_SENS
|
||
public RobotSiasunPhoenixBSetWaferCentModeHandler(RobotSiasunPhoenixB device, bool isSingleSensorMode)
|
||
: base(device, "SET WAF_CEN MODE", isSingleSensorMode ? "SINGLE_SENS" : "RL_SENS")
|
||
{
|
||
}
|
||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||
{
|
||
if (base.HandleMessage(msg, out handled))
|
||
{
|
||
Device.NoteSetParametersComplete();
|
||
}
|
||
|
||
return true;
|
||
}
|
||
}
|
||
|
||
public class RobotSiasunPhoenixBSetWaferCentEnableHandler : RobotSiasunPhoenixBHandler
|
||
{
|
||
//SET STN station [[ARM]arm] WAF_CEN ENABLE Y|N
|
||
public RobotSiasunPhoenixBSetWaferCentEnableHandler(RobotSiasunPhoenixB device, int station, RobotArmEnum blade, bool isEnable)
|
||
: base(device, "SET STN", $"{station} ARM {(blade == RobotArmEnum.Blade1 ? "A" : "B")} WAF_CEN ENABLE {(isEnable ? "Y" : "N")}")
|
||
{
|
||
}
|
||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||
{
|
||
if (base.HandleMessage(msg, out handled))
|
||
{
|
||
Device.NoteSetParametersComplete();
|
||
}
|
||
|
||
return true;
|
||
}
|
||
}
|
||
|
||
public class RobotSiasunPhoenixBSetWaferCentWaferSizeHandler : RobotSiasunPhoenixBHandler
|
||
{
|
||
//SET STN station [[ARM]arm] WAF_CEN WAF_SIZE value
|
||
//SET STN 1 ARM A WAF_CEN WAF_SIZE 300000
|
||
public RobotSiasunPhoenixBSetWaferCentWaferSizeHandler(RobotSiasunPhoenixB device, int station, RobotArmEnum blade, int waferSize)
|
||
: base(device, "SET STN", $"{station} ARM {(blade == RobotArmEnum.Blade1 ? "A" : "B")} WAF_CEN WAF_SIZE {waferSize}")
|
||
{
|
||
}
|
||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||
{
|
||
if (base.HandleMessage(msg, out handled))
|
||
{
|
||
Device.NoteSetParametersComplete();
|
||
}
|
||
|
||
return true;
|
||
}
|
||
}
|
||
|
||
public class RobotSiasunPhoenixBSetWaferCentAutoNotchHandler : RobotSiasunPhoenixBHandler
|
||
{
|
||
//SET STN station [[ARM]arm] WAF_CEN AUTO_NOTCH Y|N
|
||
//SET STN 1 ARM A WAF_CEN WAF_SIZE 300000
|
||
public RobotSiasunPhoenixBSetWaferCentAutoNotchHandler(RobotSiasunPhoenixB device, int station, RobotArmEnum blade, bool isAutoNotch)
|
||
: base(device, "SET STN", $"{station} ARM {(blade == RobotArmEnum.Blade1 ? "A" : "B")} WAF_CEN AUTO_NOTCH {(isAutoNotch ? "Y" : "N")}")
|
||
{
|
||
}
|
||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||
{
|
||
if (base.HandleMessage(msg, out handled))
|
||
{
|
||
Device.NoteSetParametersComplete();
|
||
}
|
||
|
||
return true;
|
||
}
|
||
}
|
||
|
||
#region Aligner
|
||
public class RobotSiasunPhoenixBTransferAndAlignHandler : RobotSiasunPhoenixBHandler
|
||
{
|
||
//XFER [[ARM] arm] station [SLOT num] station [SLOT num] ALGN
|
||
public RobotSiasunPhoenixBTransferAndAlignHandler(RobotSiasunPhoenixB device, int fromStation, int formSlot, int toStation, int toSlot, Hand blade)
|
||
: base(device, "XFER", $"ARM {(blade == Hand.Blade1 ? "A" : "B")} {fromStation} SLOT {formSlot} {toStation} SLOT {toSlot} ALGN")
|
||
{
|
||
}
|
||
}
|
||
|
||
public class RobotSiasunPhoenixBAlignAndPickHandler : RobotSiasunPhoenixBHandler
|
||
{
|
||
//PICK station [SLOT num] [[ARM] arm][ENRT|STRT NR][RO x TO x][ALGN][PALGN]
|
||
//align and then pick it
|
||
public RobotSiasunPhoenixBAlignAndPickHandler(RobotSiasunPhoenixB device, int alignerStation, int alignerSlot, Hand blade, int ro = 0, int to = 0)
|
||
: base(device, "PICK", $" {alignerStation} SLOT {alignerSlot} ARM {(blade == Hand.Blade1 ? "A" : "B")}{(ro == 0 ? "" : $" RO {ro}")}{(to == 0 ? "" : $" TO {to}")} ALGN")
|
||
{
|
||
}
|
||
}
|
||
|
||
public class RobotSiasunPhoenixBPlaceAndAlignHandler : RobotSiasunPhoenixBHandler
|
||
{
|
||
//PLACEstation [SLOT num] [[ARM] arm][ENRT|STRT NR][RO x TO x][ALGN]
|
||
//place to aligner and align
|
||
public RobotSiasunPhoenixBPlaceAndAlignHandler(RobotSiasunPhoenixB device, int alignerStation, int alignerSlot, Hand blade, int ro = 0, int to = 0)
|
||
: base(device, "PLACE", $" {alignerStation} SLOT {alignerSlot} ARM {(blade == Hand.Blade1 ? "A" : "B")}{(ro == 0 ? "" : $" RO {ro}")}{(to == 0 ? "" : $" TO {to}")} ALGN")
|
||
{
|
||
}
|
||
}
|
||
|
||
//两个aligner怎么区分
|
||
public class RobotSiasunPhoenixBRequestAlignerOffsetHandler : RobotSiasunPhoenixBHandler
|
||
{
|
||
//RQ ALGN 00 OFFSETS
|
||
//RO 0.000 TO 0.000
|
||
//_RDY
|
||
public RobotSiasunPhoenixBRequestAlignerOffsetHandler(RobotSiasunPhoenixB device)
|
||
: base(device, "RQ ALGN 00 OFFSETS")
|
||
{
|
||
}
|
||
}
|
||
|
||
//两个aligner怎么区分
|
||
public class RobotSiasunPhoenixBRequestAlignerWaferPresentHandler : RobotSiasunPhoenixBHandler
|
||
{
|
||
//RQ ALIGNER RQWPRS
|
||
//WFR PRS YES/NO
|
||
//_RDY
|
||
public RobotSiasunPhoenixBRequestAlignerWaferPresentHandler(RobotSiasunPhoenixB device)
|
||
: base(device, "RQ ALIGNER RQWPRS")
|
||
{
|
||
}
|
||
}
|
||
|
||
//默认选用哪个index对应的angle？
|
||
public class RobotSiasunPhoenixBSetAlignerAlignAngleHandler : RobotSiasunPhoenixBHandler
|
||
{
|
||
//SET ALIGNER 1 POSTPOS %i POS %i
|
||
//_RDY
|
||
//eg. SET ALIGNER 1 POSTPOS 1 POS 27.1
|
||
public RobotSiasunPhoenixBSetAlignerAlignAngleHandler(RobotSiasunPhoenixB device, int alignerID, int index, int angle)
|
||
: base(device, "SET ALIGNER", $"{alignerID} POSTPOS {index} POS {angle}")
|
||
{
|
||
}
|
||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||
{
|
||
if (base.HandleMessage(msg, out handled))
|
||
{
|
||
Device.NoteSetParametersComplete();
|
||
}
|
||
|
||
return true;
|
||
}
|
||
}
|
||
#endregion
|
||
|
||
}
|