using Aitex.Core.Common; using Aitex.Core.RT.DataCenter; using Aitex.Core.RT.Device; using Aitex.Core.RT.Device.Unit; using Aitex.Core.RT.Event; using Aitex.Core.RT.Log; using Aitex.Core.RT.OperationCenter; using Aitex.Core.RT.SCCore; using Aitex.Core.Util; using MECF.Framework.Common.CommonData; using MECF.Framework.Common.Communications; using MECF.Framework.Common.Equipment; using MECF.Framework.Common.SubstrateTrackings; using MECF.Framework.RT.EquipmentLibrary.HardwareUnits.LoadPorts.LoadPortBase; using MECF.Framework.RT.EquipmentLibrary.HardwareUnits.Robot; using MECF.Framework.RT.EquipmentLibrary.HardwareUnits.Robots.RobotBase; using System; using System.Collections.Generic; using System.Diagnostics; using System.Linq; using System.Text; using System.Threading; using EventType = Aitex.Core.RT.Event.EventType; namespace MECF.Framework.RT.EquipmentLibrary.HardwareUnits.Robots.HRC100Robots.GM201LVPRobot { public class YaskawaRobotMessage : AsciiMessage { public int UNo { get; set; } public int SeqNo { get; set; } public string Status { get; set; } public string Ackcd { get; set; } public string Command { get; set; } public string[] Data { get; set; } public string ErrorCode { get; set; } public string EvNo { get; set; } public string EvDate { get; set; } public string EvData { get; set; } } public class GM201LVPRobot : RobotBaseDevice, IConnection { //public int UnitNumber //{ // get; private set; //} private bool isSimulatorMode; private string _scRoot; private bool _isError; public GM201LVPTokenGenerator SeqnoGenerator { get; private set; } public bool IsEnableSeqNo { get; private set; } public bool IsEnableCheckSum { get; private set; } public int CurrentSeqNo { get; set; } public string PortName; private string _address; private bool _enableLog; private GM201LVPRobotConnection _connection; private R_TRIG _trigError = new R_TRIG(); private R_TRIG _trigCommunicationError = new R_TRIG(); private R_TRIG _trigRetryConnect = new R_TRIG(); public string Address => _address; private PeriodicJob _thread; private object _locker = new object(); private LinkedList _lstHandlers = new LinkedList(); private LinkedList _lstMonitorHandler = new LinkedList(); private IoSensor _diRobotReady = null; //Normal ON private IoSensor _diRobotBlade1WaferOn = null; //Off when wafer present private IoSensor _diRobotBlade2WaferOn = null; private IoSensor _diRobotError = null; //Normal ON private IoSensor _diTPinUse = null; private IoTrigger _doRobotHold = null; // Normal ON public ModuleName CurrentInteractiveModule { get; private set; } public bool IsConnected => throw new NotImplementedException(); public float CurrentThetaPosition { get; private set; } public float CurrentExtensionPosition { get; private set; } public float CurrentArm1Position { get; private set; } public float CurrentArm2Position { get; private set; } public float CurrentZPosition { get; private set; } public float CommandThetaPosition { get; private set; } public float CommandExtensionPosition { get; private set; } public float CommandArm1Position { get; private set; } public float CommandArm2Position { get; private set; } public float CommandZPosition { get; private set; } public int SpeedLevel { get; private set; } public int SpeedLevelSetting => SC.GetValue($"{Name}.RobotSpeed"); public string ReadMemorySpec { get; private set; } public string ReadTransferStation { get; private set; } public int ReadSlotNumber { get; private set; } public string ReadArmPosture { get; private set; } public RobotArmEnum ReadBladeNo { get; private set; } public GM201LVPPositonEnum ReadPositionType { get; private set; } public float ReadThetaPosition { get; private set; } public float ReadExtensionPosition { get; private set; } public float ReadArm1Position { get; private set; } public float ReadArm2Position { get; private set; } public float ReadZPosition { get; private set; } public Dictionary ReadStationItemValues { get; private set; } = new Dictionary(); public Dictionary ReadStationItemContents { get; private set; } = new Dictionary(); public string ReadParameterType { get; private set; } public string ReadParameterNo { get; private set; } public string ReadParameterValue { get; private set; } public bool IsManipulatorBatteryLow { get; private set; } public bool IsCommandExecutionReady { get; private set; } public bool IsServoON { get; private set; } public bool IsErrorOccurred { get; private set; } public bool IsControllerBatteryLow { get; private set; } public bool IsCheckInterlockWaferPresenceOnBlade1 { get; private set; } public bool IsCheckInterlockWaferPresenceOnBlade2 { get; private set; } public bool IsCheckInterlockWaferPresenceOnBlade3 { get; private set; } public bool IsCheckInterlockWaferPresenceOnBlade4 { get; private set; } public bool IsCheckInterlockWaferPresenceOnBlade5 { get; private set; } public string RobotSoftwareVersion { get; private set; } public string ReadMappingTransferStation { get; private set; } public int ReadMappingSlotNumbers { get; private set; } public string ReadSlotMap { get; private set; } public MaterialType _MaterialType { get; set; } private int _timeLimitPick => SC.GetValue($"{Name}.PickTimeout"); private int _timeLimitPlace => SC.GetValue($"{Name}.PlaceTimeout"); private int _timeLimitHome => SC.GetValue($"{Name}.HomeTimeout"); private int _timeLimitMotion => SC.GetValue($"{Name}.MotionTimeout"); public Dictionary ReadMappingCalibrationResult { get; private set; } public Dictionary ReadRobotParameterResult { get; private set; } = new Dictionary(); public enum MaterialType { Carrier, Wafer } private Dictionary _moduleAssociateStationDic; public Dictionary ModuleAssociateStationDic { get { return _moduleAssociateStationDic; } set { _moduleAssociateStationDic = value; } } private Dictionary _moduleAssociateHandDic; public Dictionary ModuleAssociateHandDic { get { return _moduleAssociateHandDic; } set { _moduleAssociateHandDic = value; } } private IoAlarmSignal _tpStatus = null; public GM201LVPRobot(string module, string name, string scRoot, MaterialType material, IoSensor[] dis, IoTrigger[] dos) : base(module, name) { Module = module; Name = name; _MaterialType = material; isSimulatorMode = SC.ContainsItem("System.IsSimulatorMode") ? SC.GetValue("System.IsSimulatorMode") : false; _scRoot = scRoot; _address = SC.GetStringValue($"{Name}.Address"); _enableLog = SC.GetValue($"{Name}.EnableLogMessage"); //UnitNumber = SC.GetValue($"{_scRoot}.{Name}.UnitNumber"); //IsEnableCheckSum = SC.GetValue($"{_scRoot}.{Name}.EnableCheckSum"); //IsEnableSeqNo = SC.GetValue($"{_scRoot}.{Name}.EnableSeqNo"); //SpeedLevelSetting = SC.GetValue($"{Name}.SpeedLevel"); _connection = new GM201LVPRobotConnection(this, _address); _connection.EnableLog(_enableLog); //SeqnoGenerator = new GM201LVPTokenGenerator($"{_scRoot}.{Name}.CommunicationToken"); if (dis != null && dis.Length >= 5) { _diRobotReady = dis[0]; _diRobotBlade1WaferOn = dis[1]; _diRobotBlade2WaferOn = dis[2]; _diRobotError = dis[3]; _diTPinUse = dis[4]; _diRobotError.OnSignalChanged += _diRobotError_OnSignalChanged; _diTPinUse.OnSignalChanged += _diTPinUse_OnSignalChanged; } if (dos != null && dos.Length >= 1) { _doRobotHold = dos[0]; } ConnectionManager.Instance.Subscribe($"{Name}", _connection); _thread = new PeriodicJob(10, OnTimer, $"{Module}.{Name} MonitorHandler", true); ReadStationItemContents.Add("00", "Upward offset"); ReadStationItemContents.Add("01", "Downward offset"); ReadStationItemContents.Add("02", "Grip position offset"); ReadStationItemContents.Add("06", "G2/P3 offset in the extending direction"); ReadStationItemContents.Add("08", "Put downward offset"); ReadStationItemContents.Add("70", "Get operation Movet_grip function yes/no"); ReadStationItemContents.Add("71", "Get operation rising pattern"); ReadStationItemContents.Add("80", "Put operation Move_grip function yes/no"); ReadStationItemContents.Add("81", "Put operation dropping pattern"); ReadStationItemContents.Add("50", "Slot Numbers"); ReadStationItemContents.Add("30", "Slot pitch(Left elbow,Blade1)"); ReadStationItemContents.Add("31", "Slot pitch(Left elbow,Blade2)"); ReadStationItemContents.Add("32", "Slot pitch(Right elbow,Blade1)"); ReadStationItemContents.Add("33", "Slot pitch(Right elbow,Blade2)"); if (Name == "CarrierRobot") { _tpStatus = DEVICE.GetDevice($"PM1.AlarmSignaFOUPRobotTPStatusWarning"); } else { _tpStatus = DEVICE.GetDevice($"PM1.AlarmSignaWaferRobotTPStatusWarning"); } ResetPropertiesAndResponses(); RegisterSpecialData(); RegisterAlarm(); } protected override void SubscribeWaferLocation() { } private void RegisterAlarm() { EV.Subscribe(new EventItem("Alarm", $"{Name}Error020", $"{Name} Robot Occurred Error:Secondary power off.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error021", $"{Name} Robot Occurred Error:Secondary power on.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error040", $"{Name} Robot Occurred Error:In TEACH Mode.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error050", $"{Name} Robot Occurred Error:Unit is in motion.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error051", $"{Name} Robot Occurred Error:Unable to set pitch between slots.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error052", $"{Name} Robot Occurred Error:Unable to restart motion.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error053", $"{Name} Robot Occurred Error:Ready position move incomplete.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error054", $"{Name} Robot Occurred Error:Alignment Ready position move incomplete.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error055", $"{Name} Robot Occurred Error:Improper station type.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error058", $"{Name} Robot Occurred Error:Command not supported 1-1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error059", $"{Name} Robot Occurred Error:Invalid transfer point.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error05A", $"{Name} Robot Occurred Error:Linear motion failed.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error05C", $"{Name} Robot Occurred Error:Unable to reference wafer alignment result.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error05D", $"{Name} Robot Occurred Error:Unable to perform arm calibration.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error05E", $"{Name} Robot Occurred Error:Unable to read mapping data.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error05F", $"{Name} Robot Occurred Error:Data Upload/Download in progress.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error061", $"{Name} Robot Occurred Error:Unable to motion.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error064", $"{Name} Robot Occurred Error:Lifter interference error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error070", $"{Name} Robot Occurred Error:Bottom slot position record incomplete.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error071", $"{Name} Robot Occurred Error:Top slot position record incomplete.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error088", $"{Name} Robot Occurred Error:Position generating error 1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error089", $"{Name} Robot Occurred Error:Position generating error 2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error08A", $"{Name} Robot Occurred Error:Position generating error 3.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error08B", $"{Name} Robot Occurred Error:Position generating error 4.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error08C", $"{Name} Robot Occurred Error:Position generating error 5.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error08D", $"{Name} Robot Occurred Error:Position generating error 6.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error090", $"{Name} Robot Occurred Error:Host parameter out of range.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error0A0", $"{Name} Robot Occurred Error:Alignment motion error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error0E0", $"{Name} Robot Occurred Error:Teach position adjustmentoffset amount limit error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error0F0", $"{Name} Robot Occurred Error:Voltage drop warning.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*06", $"{Name} Robot Occurred Error:Amplifier Type Mismatch.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*07", $"{Name} Robot Occurred Error:Encoder Type Mismatch.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*10", $"{Name} Robot Occurred Error:Overflow Current.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*30", $"{Name} Robot Occurred Error:Regeneration Error Detected.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*40", $"{Name} Robot Occurred Error:Excess Voltage (converter).", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*41", $"{Name} Robot Occurred Error:Insufficient Voltage.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*45", $"{Name} Robot Occurred Error:Brake circuit error 1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*46", $"{Name} Robot Occurred Error:Converter ready signal error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*47", $"{Name} Robot Occurred Error:Input power error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*48", $"{Name} Robot Occurred Error:Converter main circuit chargeerror.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*49", $"{Name} Robot Occurred Error:Amplifier ready signal error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*51", $"{Name} Robot Occurred Error:Excessive Speed.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*71", $"{Name} Robot Occurred Error:Momentary Overload (Motor).", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*72", $"{Name} Robot Occurred Error:Continuous Overload (Motor).", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*78", $"{Name} Robot Occurred Error:Overload (Converter).", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*7B", $"{Name} Robot Occurred Error:Amplifier overheat.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*7C", $"{Name} Robot Occurred Error:Continuous Overload(Amplifier).", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*7D", $"{Name} Robot Occurred Error:Momentary Overload.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*81", $"{Name} Robot Occurred Error:Absolute Encoder Back-upError.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*83", $"{Name} Robot Occurred Error:Absolute Encoder Battery.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*84", $"{Name} Robot Occurred Error:Encoder Data Error 2-1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*85", $"{Name} Robot Occurred Error:Encoder Excessive Speed.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*86", $"{Name} Robot Occurred Error:Encoder Overheat.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*88", $"{Name} Robot Occurred Error:Encoder error 1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*89", $"{Name} Robot Occurred Error:Encoder Command failed.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*8A", $"{Name} Robot Occurred Error:Encoder multi-turn range.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*8C", $"{Name} Robot Occurred Error:Encoder Reset not completed.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*98", $"{Name} Robot Occurred Error:Servo parameter error 1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*9A", $"{Name} Robot Occurred Error:Feedback Over Flow.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*B4", $"{Name} Robot Occurred Error:Servo Control Board Failure.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*BC", $"{Name} Robot Occurred Error:Encoder error 2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*C1", $"{Name} Robot Occurred Error:Motor runaway detection.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*C9", $"{Name} Robot Occurred Error:Encoder Communication.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*CE", $"{Name} Robot Occurred Error:Encoder error 3.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*CF", $"{Name} Robot Occurred Error:Encoder error 4.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*D0", $"{Name} Robot Occurred Error:Position deviation error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*D1", $"{Name} Robot Occurred Error:Position deviation saturation.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*D2", $"{Name} Robot Occurred Error:Motor directive position error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*D4", $"{Name} Robot Occurred Error:Servo Tracking Error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error*F1", $"{Name} Robot Occurred Error:Phase loss.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorE*1", $"{Name} Robot Occurred Error:Positioning Timeout.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorE*D", $"{Name} Robot Occurred Error:Command not supported 1-2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorE*E", $"{Name} Robot Occurred Error:Communication Error(internal controller) 1-1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorE*F", $"{Name} Robot Occurred Error:Servo control board responsetimeout 1..", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error701", $"{Name} Robot Occurred Error:ROM Error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error703", $"{Name} Robot Occurred Error:Communication Error(internal controller) 2-1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error704", $"{Name} Robot Occurred Error:Communication Error (internal controller) 2-2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error705", $"{Name} Robot Occurred Error:Communication Error(internal controller) 2-3.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error706", $"{Name} Robot Occurred Error:Servo system error 1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error707", $"{Name} Robot Occurred Error:Servo system error 2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error709", $"{Name} Robot Occurred Error:Current feedback error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error70A", $"{Name} Robot Occurred Error:Power Lost.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error70B", $"{Name} Robot Occurred Error:Rush Current PreventionRelay Abnormal.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error70C", $"{Name} Robot Occurred Error:Converter mismatch.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error70F", $"{Name} Robot Occurred Error:Servo control board response timeout 2..", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error713", $"{Name} Robot Occurred Error:DB error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error714", $"{Name} Robot Occurred Error:Converter charge Error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error715", $"{Name} Robot Occurred Error:Servo OFF Status Error 1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error716", $"{Name} Robot Occurred Error:Servo ON Status Error 1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error717", $"{Name} Robot Occurred Error:Servo OFF Status Error 2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error718", $"{Name} Robot Occurred Error:Servo ON Status Error 2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error719", $"{Name} Robot Occurred Error:Servo On Abnormal.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error71A", $"{Name} Robot Occurred Error:Brake circuit error 2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error71B", $"{Name} Robot Occurred Error:Brake circuit error 3.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error71C", $"{Name} Robot Occurred Error:Power relay error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error721", $"{Name} Robot Occurred Error:Servo parameter error 2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error722", $"{Name} Robot Occurred Error:Servo parameter error 3.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error725", $"{Name} Robot Occurred Error:Converter Overheat.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error726", $"{Name} Robot Occurred Error:Communication Error(internal controller) 2-4.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error727", $"{Name} Robot Occurred Error:Command not supported 1-2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error728", $"{Name} Robot Occurred Error:Communication Error(internal controller) 2-5.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error729", $"{Name} Robot Occurred Error:Servo system error 3.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error72A", $"{Name} Robot Occurred Error:Servo system error 4.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error72B", $"{Name} Robot Occurred Error:Servo parameter error 4.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error730", $"{Name} Robot Occurred Error:Amp module disconnected..", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error732", $"{Name} Robot Occurred Error:Servo parameter error 5.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error733", $"{Name} Robot Occurred Error:Servo parameter error 6.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error734", $"{Name} Robot Occurred Error:Servo parameter error 7.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error735", $"{Name} Robot Occurred Error:Servo parameter error 8.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error73F", $"{Name} Robot Occurred Error:Undefined Error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error740", $"{Name} Robot Occurred Error:Encoder Status Error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error741", $"{Name} Robot Occurred Error:Servo system error 5.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error742", $"{Name} Robot Occurred Error:Servo system error 6.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error743", $"{Name} Robot Occurred Error:Servo system error 7.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error744", $"{Name} Robot Occurred Error:Servo system error 8.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error745", $"{Name} Robot Occurred Error:Servo system error 9.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error746", $"{Name} Robot Occurred Error:Servo system error 10.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error74A", $"{Name} Robot Occurred Error:Servo system error 11.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error74B", $"{Name} Robot Occurred Error:Servo system error 12.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error74C", $"{Name} Robot Occurred Error:Servo system error 13.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error74D", $"{Name} Robot Occurred Error:Servo system error 14.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error7A0", $"{Name} Robot Occurred Error:Communication Error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error7A1", $"{Name} Robot Occurred Error:Communication Error(internal controller) 3-2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error7A2", $"{Name} Robot Occurred Error:Command not supported 3-1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error7A3", $"{Name} Robot Occurred Error:Data buffer full.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error7A4", $"{Name} Robot Occurred Error:Command not supported 3-2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error7A5", $"{Name} Robot Occurred Error:Encoder data error 3-1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error7A6", $"{Name} Robot Occurred Error:Command not supported 3-3.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error7AE", $"{Name} Robot Occurred Error:Communication Error(internal controller) 1-2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error7AF", $"{Name} Robot Occurred Error:Communication Error(internal controller) 1-3.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error7B0", $"{Name} Robot Occurred Error:CCD sensor abnormal 1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error7B4", $"{Name} Robot Occurred Error:CCD sensor abnormal 2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error7B5", $"{Name} Robot Occurred Error:CCD sensor abnormal 3.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error7C0", $"{Name} Robot Occurred Error:PAIF board Failure 1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error7C1", $"{Name} Robot Occurred Error:PAIF board Failure 2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error7C2", $"{Name} Robot Occurred Error:PAIF board Failure 3.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error7C3", $"{Name} Robot Occurred Error:CCD sensor abnormal 4.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error7CF", $"{Name} Robot Occurred Error:PAIF board disconnected.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error7D0", $"{Name} Robot Occurred Error:PAIF board Failure 4.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error7D1", $"{Name} Robot Occurred Error:PAIF board Failure 5.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error900", $"{Name} Robot Occurred Error:Character Interval Timeout.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error910", $"{Name} Robot Occurred Error:Received Data ChecksumError.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error920", $"{Name} Robot Occurred Error:Unit Number Error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error930", $"{Name} Robot Occurred Error:Undefined CommandReceived.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error940", $"{Name} Robot Occurred Error:Message Parameter Error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error950", $"{Name} Robot Occurred Error:Receiving Time-out Error for Confirmation of Execution Completion.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error960", $"{Name} Robot Occurred Error:Incorrect sequence number.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error961", $"{Name} Robot Occurred Error:Duplicated message.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error970", $"{Name} Robot Occurred Error:Delimiter error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error9A1", $"{Name} Robot Occurred Error:Message buffer overflow.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error9C0", $"{Name} Robot Occurred Error:LAN device setting error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error9C1", $"{Name} Robot Occurred Error:IP address error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error9C2", $"{Name} Robot Occurred Error:Subnet mask error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error9C3", $"{Name} Robot Occurred Error:Default gateway error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error9D0", $"{Name} Robot Occurred Error:Ethernet receive error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error9E0", $"{Name} Robot Occurred Error:During operation themaintenance tool.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}Error9E1", $"{Name} Robot Occurred Error:The data abnormal.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorA01", $"{Name} Robot Occurred Error:Re-detection of a powerSupply voltage fall.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorA10", $"{Name} Robot Occurred Error:External emergency stop.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorA20", $"{Name} Robot Occurred Error:T.P emergency stop.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorA21", $"{Name} Robot Occurred Error:Interlock board failure 0.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorA30", $"{Name} Robot Occurred Error:Emergency stop.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorA40", $"{Name} Robot Occurred Error:Controller Fan 1 Error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorA41", $"{Name} Robot Occurred Error:Controller Fan 2 Error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorA42", $"{Name} Robot Occurred Error:Controller Fan 3 Error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorA45", $"{Name} Robot Occurred Error:Unit fan 1 error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorA46", $"{Name} Robot Occurred Error:Unit fan 2 error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorA4F", $"{Name} Robot Occurred Error:Controller Battery Alarm.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorAC0", $"{Name} Robot Occurred Error:Safety fence signal detection.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorAC9", $"{Name} Robot Occurred Error:Protection stop signal.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorAE0", $"{Name} Robot Occurred Error:HOST Mode Switching error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorAE1", $"{Name} Robot Occurred Error:TEACH Mode Switching Error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorAE8", $"{Name} Robot Occurred Error:Deadman switch error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorAF0", $"{Name} Robot Occurred Error:Interlock board failure 1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorAF1", $"{Name} Robot Occurred Error:Interlock board failure 2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorAF2", $"{Name} Robot Occurred Error:Interlock board failure 3.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorAF3", $"{Name} Robot Occurred Error:Interlock board failure 4.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorAF4", $"{Name} Robot Occurred Error:Interlock board failure 5.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorAF5", $"{Name} Robot Occurred Error:Interlock board failure 6.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorAF6", $"{Name} Robot Occurred Error:Interlock board failure 7.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorAF8", $"{Name} Robot Occurred Error:Input compare error 1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorAF9", $"{Name} Robot Occurred Error:Input compare error 2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorAFA", $"{Name} Robot Occurred Error:Input compare error 3.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorAFB", $"{Name} Robot Occurred Error:Input compare error 4.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorAFC", $"{Name} Robot Occurred Error:Input compare error 5.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorAFD", $"{Name} Robot Occurred Error:Input compare error 6.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorAFE", $"{Name} Robot Occurred Error:Input compare error 7.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorAFF", $"{Name} Robot Occurred Error:Input compare error 8.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB10", $"{Name} Robot Occurred Error:Axis-1 Speed Limit Detection.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB11", $"{Name} Robot Occurred Error:Axis-2 Speed Limit Detection.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB12", $"{Name} Robot Occurred Error:Axis-3 Speed Limit Detection.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB13", $"{Name} Robot Occurred Error:Axis-4 Speed Limit Detection.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB14", $"{Name} Robot Occurred Error:Axis-5 Speed Limit Detection.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB20", $"{Name} Robot Occurred Error:Axis-1 Positive (+) DirectionSoftware-limit Detection 1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB21", $"{Name} Robot Occurred Error:Axis-2 Positive (+) DirectionSoftware-limit Detection 1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB22", $"{Name} Robot Occurred Error:Axis-3 Positive (+) DirectionSoftware-limit Detection 1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB23", $"{Name} Robot Occurred Error:Axis-4 Positive (+) DirectionSoftware-limit Detection 1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB24", $"{Name} Robot Occurred Error:Axis-5 Positive (+) DirectionSoftware-limit Detection 1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB28", $"{Name} Robot Occurred Error:Axis-1 Positive (+) Direction Software-limit Detection 2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB29", $"{Name} Robot Occurred Error:Axis-2 Positive (+) DirectionSoftware-limit Detection 2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB2A", $"{Name} Robot Occurred Error:Axis-3 Positive (+) DirectionSoftware-limit Detection 2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB2B", $"{Name} Robot Occurred Error:Axis-4 Positive (+) DirectionSoftware-limit Detection 2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB2C", $"{Name} Robot Occurred Error:Axis-5 Positive (+) DirectionSoftware-limit Detection 2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB30", $"{Name} Robot Occurred Error:Axis-1 Negative (-) DirectionSoftware-limit Detection 1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB31", $"{Name} Robot Occurred Error:Axis-2 Negative (-) DirectionSoftware-limit Detection 1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB32", $"{Name} Robot Occurred Error:Axis-3 Negative (-) Direction Software-limit Detection 1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB33", $"{Name} Robot Occurred Error:Axis-4 Negative (-) DirectionSoftware-limit Detection 1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB34", $"{Name} Robot Occurred Error:Axis-5 Negative (-) DirectionSoftware-limit Detection 1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB38", $"{Name} Robot Occurred Error:Axis-1 Negative (-) DirectionSoftware-limit Detection 2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB39", $"{Name} Robot Occurred Error:Axis-2 Negative (-) DirectionSoftware-limit Detection 2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB3A", $"{Name} Robot Occurred Error:Axis-3 Negative (-) Direction Software-limit Detection 2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB3B", $"{Name} Robot Occurred Error:Axis-4 Negative (-) DirectionSoftware-limit Detection 2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB3C", $"{Name} Robot Occurred Error:Axis-5 Negative (-) DirectionSoftware-limit Detection 2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB40", $"{Name} Robot Occurred Error:Access Permission Signal 1Time-out Error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB41", $"{Name} Robot Occurred Error:Access Permission Signal 2Time-out Error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB42", $"{Name} Robot Occurred Error:Access Permission Signal 3Time-out Error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB43", $"{Name} Robot Occurred Error:Access Permission Signal 4Time-out Error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB44", $"{Name} Robot Occurred Error:Access Permission Signal 5 Time-out Error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB45", $"{Name} Robot Occurred Error:Access Permission Signal 6Time-out Error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB46", $"{Name} Robot Occurred Error:Access Permission Signal 7Time-out Error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB47", $"{Name} Robot Occurred Error:Access Permission Signal 8Time-out Error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB48", $"{Name} Robot Occurred Error:Access Permission Signal 9Time-out Error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB49", $"{Name} Robot Occurred Error:Access Permission Signal 10 Time-out Error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB4A", $"{Name} Robot Occurred Error:Access Permission Signal 11Time-out Error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB4B", $"{Name} Robot Occurred Error:Access Permission Signal 12Time-out Error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB4C", $"{Name} Robot Occurred Error:Access Permission Signal 13Time-out Error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB4D", $"{Name} Robot Occurred Error:Access Permission Signal 14Time-out Error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB4E", $"{Name} Robot Occurred Error:Access Permission Signal 15Time-out Error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB4F", $"{Name} Robot Occurred Error:Access Permission Signal 16Time-out Error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB60", $"{Name} Robot Occurred Error:Access Permission to P/A Stage Time-out Error 1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB61", $"{Name} Robot Occurred Error:Access Permission to P/AStage Time-out Error 2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB62", $"{Name} Robot Occurred Error:Access Permission to P/A Stage Time-out Error 3.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB63", $"{Name} Robot Occurred Error:Access Permission to P/A Stage Time-out Error 4.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB64", $"{Name} Robot Occurred Error:Access Permission to P/AStage Time-out Error 5.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB65", $"{Name} Robot Occurred Error:Access Permission to P/AStage Time-out Error 6.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB66", $"{Name} Robot Occurred Error:Access Permission to P/AStage Time-out Error 7.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB68", $"{Name} Robot Occurred Error:P/A motion permission timeout error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB70", $"{Name} Robot Occurred Error:SS signal detection.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB80", $"{Name} Robot Occurred Error:Fork 1/Pre-aligner: Wafer Presence Confirmation Time-out Error 1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB81", $"{Name} Robot Occurred Error:Fork 1/Pre-aligner: WaferAbsence Confirmation Time- out Error 1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB82", $"{Name} Robot Occurred Error:Fork 1/Pre-aligner: Wafer Presence Confirmation Time-out Error 2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB83", $"{Name} Robot Occurred Error:Fork 1/Pre-aligner: WaferAbsence Confirmation Time- out Error 2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB88", $"{Name} Robot Occurred Error:Wafer is not found on the Wafer transfer after having completed the wafer pick operation from source (by sensor information).Check the wafer status on the Wafer transfer.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB89", $"{Name} Robot Occurred Error:Wafer is not found on the Wafer transfer after having completed the wafer pick operation from source (by sensor information).Check the wafer status on the Wafer transfer.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB8A", $"{Name} Robot Occurred Error:Wafer is not found on the Wafer transfer after having completed the wafer place operation to the target(by sensor information).Check the wafer status on the Wafer transfer.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB8B", $"{Name} Robot Occurred Error:Wafer is not found on the Wafer transfer after having completed the wafer place operation to the target(by sensor information).Check the wafer status on the Wafer transfer.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB8F", $"{Name} Robot Occurred Error:Fork 1: Plunger non-operationerror.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB90", $"{Name} Robot Occurred Error:Fork 2: Wafer Presence Confirmation Time-out Error 1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB91", $"{Name} Robot Occurred Error:Fork 2: Wafer AbsenceConfirmation Time-out Error 1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB92", $"{Name} Robot Occurred Error:Fork 2: Wafer PresenceConfirmation Time-out Error 2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB93", $"{Name} Robot Occurred Error:Fork 2: Wafer AbsenceConfirmation Time-out Error 2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB98", $"{Name} Robot Occurred Error:Lifter up sensor Time-outError 1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB99", $"{Name} Robot Occurred Error:Lifter up sensor Time-out Error 2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB9A", $"{Name} Robot Occurred Error:Lifter down sensor Time-outError 1.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB9B", $"{Name} Robot Occurred Error:Lifter down sensor Time-outError 2.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorB9F", $"{Name} Robot Occurred Error:Fork 2: Plunger non-operationerror.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorBA0", $"{Name} Robot Occurred Error:Fork 1/Pre-aligner: WaferAbsence Error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorBA1", $"{Name} Robot Occurred Error:Fork 1: Sensor StatusMismatch.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorBA8", $"{Name} Robot Occurred Error:Wafer is found on the Wafer transfer when started the wafer pick operation from source (by sensor information).Check the wafer status on the Wafer transfer.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorBA9", $"{Name} Robot Occurred Error:Wafer is found on the Wafer transfer when started the wafer pick operation from source (by sensor information).Check the wafer status on the Wafer transfer.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorBAA", $"{Name} Robot Occurred Error:Wafer is found on the Wafer transfer when started the wafer place operation to the target(by sensor information).Check the wafer status on the Wafer transfer.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorBAB", $"{Name} Robot Occurred Error:Wafer is found on the Wafer transfer when started the wafer place operation to the target(by sensor information).Check the wafer status on the Wafer transfer.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorBAC", $"{Name} Robot Occurred Error:Grip sensor status mismatch.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorBAD", $"{Name} Robot Occurred Error:Lifter/Grip sensor statusmismatch.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorBB0", $"{Name} Robot Occurred Error:Fork 2: Wafer Absence Error.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorBB1", $"{Name} Robot Occurred Error:Fork 2: Sensor StatusMismatch.", EventLevel.Alarm, EventType.EventUI_Notify)); EV.Subscribe(new EventItem("Alarm", $"{Name}ErrorBB8", $"{Name} Robot Occurred Error:Lifter up sensor status Error 1.", EventLevel.Alarm, EventType.EventUI_Notify)); } public void NotifyAlarmByErrorCode(string errorcode) { EV.Notify($"{Name}Error{errorcode}"); } private void _diTPinUse_OnSignalChanged(IoSensor arg1, bool arg2) { SetMaintenanceMode(!arg1.Value); } private void _diRobotError_OnSignalChanged(IoSensor arg1, bool arg2) { if (arg1.Value == false) { lock (_locker) { _lstHandlers.AddLast(new GM201LVPRobotReadHandler(this, "RSTS")); } OnError("RobotError"); } } private void ResetPropertiesAndResponses() { } private void RegisterSpecialData() { if (Name != "CarrierRobot") { DATA.Subscribe($"{Name}.CurrentArm1Position", () => CurrentArm1Position); DATA.Subscribe($"{Name}.CurrentArm2Position", () => CurrentArm2Position); DATA.Subscribe($"{Name}.CurrentZPosition", () => CurrentZPosition); DATA.Subscribe($"{Name}.IsWaferPresenceOnBlade2", () => IsWaferPresenceOnBlade2); DATA.Subscribe($"{Name}.IsWaferPresenceOnBlade3", () => IsWaferPresenceOnBlade3); DATA.Subscribe($"{Name}.IsWaferPresenceOnBlade4", () => IsWaferPresenceOnBlade4); DATA.Subscribe($"{Name}.IsWaferPresenceOnBlade5", () => IsWaferPresenceOnBlade5); } DATA.Subscribe($"{Name}.TPStatus", () => _tpStatus.Value); DATA.Subscribe($"{Name}.CurrentExtensionPosition", () => CurrentExtensionPosition); DATA.Subscribe($"{Name}.CurrentThetaPosition", () => CurrentThetaPosition); DATA.Subscribe($"{Name}.IsManipulatorBatteryLow", () => IsManipulatorBatteryLow); DATA.Subscribe($"{Name}.IsCommandExecutionReady", () => IsCommandExecutionReady); DATA.Subscribe($"{Name}.IsServoON", () => IsServoON); DATA.Subscribe($"{Name}.IsErrorOccurred", () => IsErrorOccurred); DATA.Subscribe($"{Name}.IsControllerBatteryLow", () => IsControllerBatteryLow); DATA.Subscribe($"{Name}.IsWaferPresenceOnBlade1", () => IsWaferPresenceOnBlade1); DATA.Subscribe($"{Name}.MappingResult", () => ReadSlotMap); DATA.Subscribe($"{Name}.ReadRobotParameterResultDict", () => ReadRobotParameterResult); DATA.Subscribe($"{Name}.ErrorCode", () => ErrorCode); DATA.Subscribe($"{Name}.RobotSpeed", () => SpeedLevelSetting.ToString()); OP.Subscribe($"{Name}.SetSpeed", InvokeSetSpeed); } private bool OnTimer() { try { _connection.MonitorTimeout(); if (!_connection.IsConnected || _connection.IsCommunicationError) { lock (_locker) { _lstHandlers.Clear(); _lstMonitorHandler.Clear(); } _trigRetryConnect.CLK = !_connection.IsConnected; if (_trigRetryConnect.Q) { if (!_connection.Connect()) { EV.PostAlarmLog(RobotModuleName.ToString(), $"Can not connect with {_connection.Address}, {Name}"); } else { //_lstHandler.AddLast(new RobotHirataR4QueryPinHandler(this, _deviceAddress)); //_lstHandler.AddLast(new RobotHirataR4SetCommModeHandler(this, _deviceAddress, EnumRfPowerCommunicationMode.Host)); } } return true; } HandlerBase handler = null; lock (_locker) { if (!_connection.IsBusy) { if (_lstHandlers.Count > 0) { handler = _lstHandlers.First.Value; _connection.Execute(handler); _lstHandlers.RemoveFirst(); } else { if (_lstMonitorHandler.Count > 0) { handler = _lstMonitorHandler.First.Value; _connection.Execute(handler); _lstMonitorHandler.RemoveFirst(); } } } else { _connection.MonitorTimeout(); _trigCommunicationError.CLK = _connection.IsCommunicationError; if (_trigCommunicationError.Q) { _lstHandlers.Clear(); _lstMonitorHandler.Clear(); //EV.PostAlarmLog(RobotModuleName.ToString(), $"{Module}.{Name} communication error, {_connection.LastCommunicationError}"); OnError($"{Name} communication error, {_connection.LastCommunicationError}"); //_trigActionDone.CLK = true; } } } } catch (Exception ex) { LOG.Write(ex); } return true; } public bool Connect() { return _connection.Connect(); } public bool Disconnect() { return _connection.Disconnect(); } public override bool IsReady() { //if (_diRobotReady!=null && !_diRobotReady.Value) // return false; if (_diRobotError != null && !_diRobotError.Value) return false; if (_diTPinUse != null && !_diTPinUse.Value) return false; return RobotState == RobotStateEnum.Idle && !IsBusy && !_connection.IsBusy && _lstHandlers.Count == 0 && !_connection.IsCommunicationError && _connection.IsConnected; } public override bool IsReady(out string reason) { reason = ""; //if (_diRobotReady!=null && !_diRobotReady.Value) // return false; if (_diRobotError != null && !_diRobotError.Value) return false; if (_diTPinUse != null && !_diTPinUse.Value) return false; var ret = RobotState == RobotStateEnum.Idle && !IsBusy && !_connection.IsBusy && _lstHandlers.Count == 0 && !_connection.IsCommunicationError && _connection.IsConnected; if (!ret) { if (RobotState != RobotStateEnum.Idle) reason = "RobotState != RobotStateEnum.Idle"; if (IsBusy) reason = "IsBusy"; if (_lstHandlers.Count != 0) reason = "_lstHandlers.Count != 0"; if (_connection.IsCommunicationError) reason = "_connection.IsCommunicationError"; if (!_connection.IsConnected) reason = "!_connection.IsConnected"; } return ret; } public bool ParseReadData(string _command, string[] rdata) { try { if (_command == "RSTS") { return ((rdata.Length == 3 || rdata.Length == 2) && ParseRSTSStatus(rdata)); } if (_command == "RSLV") //Read the speed level { return (rdata.Length == 3 && ParseSpeedLevel(rdata[2])); } if (_command == "RPOS") //Reference current postion { return (rdata.Length > 1 && ParsePositionData(rdata)); } if (_command == "RSTP") //Reference registered position, read the save postion for station { // return (rdata.Length > 6 && ParseRegisteredPositionData(rdata)); return (rdata.Length == 7 && ParsePositionAxisData(rdata)); } if (_command == "RSTR") //Reference station item value { return (rdata.Length == 4 && ParseStationData(rdata)); } if (_command == "RPRM") //Reference the parameter values of the specified unit { return (rdata.Length == 3 && ParseParameterData(rdata)); } if (_command == "RMSK") //Reference the interlock information { return (rdata.Length == 1 && ParseInterlockInfo(rdata)); } if (_command == "RVER") //Reference the software version { return (rdata.Length == 2 && ParseSoftwareVersion(rdata)); } if (_command == "RMAP") //Reference the slot map { return (rdata.Length > 2 && ParseSlotMap(rdata)); } if (_command == "RMPD") //reference the mapping data { return (rdata.Length > 1 && ParseMappingData(rdata)); } if (_command == "RMCA") // Reference the mapping calibration result { return (rdata.Length > 1 && ParseMappingCalibrationResult(rdata)); } if (_command == "RERR") // Request ERR { return (rdata.Length > 2 && ParseERR(rdata)); } return true; } catch (Exception ex) { LOG.Write(ex); return true; } } public bool ParseRSTSStatus(string[] status) { try { if (status.Length > 2) { //wafer robot int intstatus = Convert.ToInt16(status[2].Substring(5, 2), 16); IsWaferPresenceOnBlade5 = (((intstatus >> 4) & 0x1) == 0x1); IsWaferPresenceOnBlade4 = (((intstatus >> 3) & 0x1) == 0x1); IsWaferPresenceOnBlade3 = (((intstatus >> 2) & 0x1) == 0x1); IsWaferPresenceOnBlade2 = (((intstatus >> 1) & 0x1) == 0x1); IsWaferPresenceOnBlade1 = (((intstatus >> 0) & 0x1) == 0x1); } else { //foup robot int intstatus = Convert.ToInt16(status[1].Substring(5, 2), 16); IsWaferPresenceOnBlade5 = (((intstatus >> 4) & 0x1) == 0x1); IsWaferPresenceOnBlade4 = (((intstatus >> 3) & 0x1) == 0x1); IsWaferPresenceOnBlade3 = (((intstatus >> 2) & 0x1) == 0x1); IsWaferPresenceOnBlade2 = (((intstatus >> 1) & 0x1) == 0x1); IsWaferPresenceOnBlade1 = (((intstatus >> 0) & 0x1) == 0x1); } return true; } catch (Exception ex) { LOG.Write(ex); return true; } } public bool ParseSpeedLevel(string speedlevel) { try { int level = Convert.ToInt32(speedlevel); if (level < 1 || level > 100) return false; SpeedLevel = level; return true; } catch (Exception ex) { LOG.Write(ex); return false; } } public bool ParsePositionData(string[] pdata) { try { if (pdata[1] == "R" || pdata[1] == "F") { CommandZPosition = Convert.ToSingle(pdata[1]) / 1000; CommandThetaPosition = Convert.ToSingle(pdata[2]) / 1000; CommandExtensionPosition = Convert.ToSingle(pdata[3]) / 1000; return true; } return false; } catch (Exception ex) { LOG.Write(ex); return false; } } public bool ParsePositionAxisData(string[] pdata) { try { ReadMemorySpec = pdata[0]; ReadTransferStation = pdata[1]; if (ReadStationItemValues.ContainsKey(pdata[2])) ReadStationItemValues.Remove(pdata[2]); ReadStationItemValues.Add(pdata[2], pdata[3]); if (ReadRobotParameterResult.ContainsKey(ReadTransferStation)) { ReadRobotParameterResult[ReadTransferStation] = $"{pdata[2]},{pdata[3]},{pdata[4]},{pdata[5]},{pdata[6]}"; } else { ReadRobotParameterResult.Add(ReadTransferStation, $"{pdata[2]},{pdata[3]},{pdata[4]},{pdata[5]},{pdata[6]}"); } return true; } catch (Exception ex) { LOG.Write(ex); return false; } } public bool ParseRegisteredPositionData(string[] pdata) { try { ReadMemorySpec = pdata[0]; ReadTransferStation = pdata[1]; ReadSlotNumber = Convert.ToInt16(pdata[2]); ReadArmPosture = pdata[3]; ReadBladeNo = (RobotArmEnum)(Convert.ToInt16(pdata[4]) - 1); if (pdata[5] == "S") ReadPositionType = GM201LVPPositonEnum.RegisteredPosition; if (pdata[5] == "R") ReadPositionType = GM201LVPPositonEnum.ReadyPosition; if (pdata[5] == "M") ReadPositionType = GM201LVPPositonEnum.IntermediatePosition; if (pdata[5] == "B") ReadPositionType = GM201LVPPositonEnum.MappingStartPosition; if (pdata[5] == "E") ReadPositionType = GM201LVPPositonEnum.MappingFinishPosition; return true; } catch (Exception ex) { LOG.Write(ex); return false; } } public bool ParseStationData(string[] pdata) { try { ReadMemorySpec = pdata[0]; ReadTransferStation = pdata[1]; if (ReadStationItemValues.ContainsKey(pdata[2])) ReadStationItemValues.Remove(pdata[2]); ReadStationItemValues.Add(pdata[2], pdata[3]); if (ReadRobotParameterResult.ContainsKey(ReadTransferStation)) { ReadRobotParameterResult[ReadTransferStation] = $"{pdata[2]},{pdata[3]}"; } else { ReadRobotParameterResult.Add(ReadTransferStation, $"{pdata[2]},{pdata[3]}"); } return true; } catch (Exception ex) { LOG.Write(ex); return false; } } public bool ParseParameterData(string[] pdata) { try { ReadParameterType = pdata[0]; ReadParameterNo = pdata[1]; ReadParameterValue = pdata[2]; if (ReadRobotParameterResult.ContainsKey(ReadParameterNo)) { ReadRobotParameterResult[ReadParameterNo] = ReadParameterValue; } else { ReadRobotParameterResult.Add(ReadParameterNo, ReadParameterValue); } return true; } catch (Exception ex) { LOG.Write(ex); return false; } } public bool ParseInterlockInfo(string[] pdata) { try { int intdata = Convert.ToInt16(pdata[1]); IsCheckInterlockWaferPresenceOnBlade1 = (intdata & 0x1) == 0; IsCheckInterlockWaferPresenceOnBlade2 = (intdata & 0x2) == 0; IsCheckInterlockWaferPresenceOnBlade3 = (intdata & 0x4) == 0; IsCheckInterlockWaferPresenceOnBlade4 = (intdata & 0x8) == 0; IsCheckInterlockWaferPresenceOnBlade5 = (intdata & 0x16) == 0; return true; } catch (Exception ex) { LOG.Write(ex); return false; } } public bool ParseSoftwareVersion(string[] pdata) { try { //RobotSystemVersion = pdata[0]; RobotSoftwareVersion = pdata[1]; return true; } catch (Exception ex) { LOG.Write(ex); return false; } } public bool ParseERR(string[] pdata) { try { var index = pdata[1]; var code = pdata[2]; if (code != "000") { EV.Notify($"{Name}Error{code}"); LOG.Write($"{Name} Error {index} {code}"); _isError = true; } else { _isError = false; } return true; } catch (Exception ex) { LOG.Write(ex); return false; } } public bool ParseSlotMap(string[] pdata) { try { ReadMappingTransferStation = pdata[1]; ReadMappingSlotNumbers = pdata[2].Length - 1; StringBuilder sb = new StringBuilder(); for (int i = 1; i < pdata[2].Length; i++) { string value = pdata[2][i].ToString(); switch (value) { case "0": sb.Append("0"); break; case "1": sb.Append("1"); break; case "C": sb.Append("C"); break; case "D": sb.Append("D"); break; } } SlotMap = ReadSlotMap = sb.ToString(); NotifySlotMapResult(CurrentInteractiveModule, ReadSlotMap); return true; } catch (Exception ex) { LOG.Write(ex); return false; } } public bool ParseMappingData(string[] pdata) { try { ReadMappingTransferStation = pdata[0]; List lstupdata = new List(); List lstdowndata = new List(); for (int i = 0; i < (pdata.Length - 1) / 2; i++) { lstupdata.Add(pdata[2 * i + 1].Remove(0, 3)); lstdowndata.Add(pdata[2 * i + 2]); } ReadMappingDownData = lstdowndata.ToArray(); ReadMappingUpData = lstupdata.ToArray(); return true; } catch (Exception ex) { LOG.Write(ex); return false; } } public bool ParseMappingCalibrationResult(string[] pdata) { try { ReadMappingTransferStation = pdata[0]; ReadMappingCalibrationResult.Clear(); ReadMappingCalibrationResult.Add("LowestLaySlotPosition", Convert.ToInt32(pdata[1]) / 1000); ReadMappingCalibrationResult.Add("HighestLaySlotPosition", Convert.ToInt32(pdata[2]) / 1000); ReadMappingCalibrationResult.Add("WaferWidth", Convert.ToInt32(pdata[3]) / 1000); ReadMappingCalibrationResult.Add("ThreshhholdValueofDoubleInsertion", Convert.ToInt32(pdata[4]) / 1000); ReadMappingCalibrationResult.Add("ThreshhholdValueofSlantingInsertion1", Convert.ToInt32(pdata[5]) / 1000); ReadMappingCalibrationResult.Add("ThreshhholdValueofSlantingInsertion2", Convert.ToInt32(pdata[6]) / 1000); return true; } catch (Exception ex) { LOG.Write(ex); return false; } } protected override bool fClear(object[] param) { if (!_connection.IsConnected) { EV.PostAlarmLog(RobotModuleName.ToString(), $"{RobotModuleName} clear failed for not connect with {_connection.Address}"); return false; } lock (_locker) { _lstHandlers.Clear(); _connection.ForceClear(); //_lstHandlers.AddLast(new GM201LVPRobotMotionHandler(this, "CCLR", "E")); string strpara = "1,1,N"; _lstHandlers.AddLast(new GM201LVPRobotMotionHandler(this, "INIT", strpara)); _lstHandlers.AddLast(new GM201LVPRobotReadHandler(this, "RSTS")); } return true; } protected override bool fStartReadData(object[] param) { if (!_connection.IsConnected) { EV.PostAlarmLog(RobotModuleName.ToString(), $"{RobotModuleName} read data failed for not connect with {_connection.Address}"); return false; } if (param.Length < 1) return false; string readcommand = param[0].ToString(); switch (readcommand) { case "CurrentStatus": lock (_locker) { _lstHandlers.AddLast(new GM201LVPRobotReadHandler(this, "RSTS")); //_lstHandlers.AddLast(new GM201LVPRobotReadHandler(this, "RPOS", "F")); //_lstHandlers.AddLast(new GM201LVPRobotReadHandler(this, "RPOS", "R")); } break; case "CurrentRobotParameters": lock (_locker) { var parameters = param[1].ToString().Split(';').ToList(); foreach (var item in parameters) { _lstMonitorHandler.AddLast(new GM201LVPRobotReadHandler(this, "RPRM", item)); } } break; case "CurrentRobotPositionConfig": lock (_locker) { var parameters = param[1].ToString().Split(';').ToList(); foreach (var item in parameters) { _lstMonitorHandler.AddLast(new GM201LVPRobotReadHandler(this, "RSTR", item)); } } break; case "CurrentRobotPositionAxis": lock (_locker) { var parameters = param[1].ToString().Split(';').ToList(); foreach (var item in parameters) { _lstMonitorHandler.AddLast(new GM201LVPRobotReadHandler(this, "RSTP", item)); } } break; default: break; } return true; } protected override bool fMonitorReadData(object[] param) { IsBusy = false; return _lstHandlers.Count == 0 && !_connection.IsBusy; } private void ExecuteHandler(HandlerBase handler) { _connection.Execute(handler); } private string Checksum(byte[] bytes) { int sum = 0; foreach (byte code in bytes) { sum += code; } string hex = String.Format("{0:X2}", sum % 256); return hex; } private Stopwatch _timerActionMonitor = new Stopwatch(); protected override bool fStartSetParameters(object[] param) { if (!_connection.IsConnected) { EV.PostAlarmLog(RobotModuleName.ToString(), $"{RobotModuleName} set parameter failed for not connect with {_connection.Address}"); return false; } try { string strParameter; string setcommand = param[0].ToString(); switch (setcommand) { case "SetSpeed": // SSPD Set the motion speed int speedLevel = Convert.ToInt32(param[1]); if (speedLevel > 100) speedLevel = 100; if (speedLevel < 1) speedLevel = 1; lock (_locker) { _lstHandlers.AddLast(new GM201LVPRobotSetHandler(this, "SSLV", $"1,{SpeedLevelSetting.ToString("D3")}")); } break; case "SetParameter": // SPRM lock (_locker) { var data = param[1].ToString().Split(';').ToList(); foreach (var item in data) { if (!string.IsNullOrEmpty(item)) { _lstMonitorHandler.AddLast(new GM201LVPRobotSetHandler(this, "SPRM", item)); } } } break; case "SetPositionConfig": //SSTR,C01,000,00000000025 lock (_locker) { var data = param[1].ToString().Split(';').ToList(); foreach (var item in data) { if (!string.IsNullOrEmpty(item)) { _lstMonitorHandler.AddLast(new GM201LVPRobotSetHandler(this, "SSTR", item)); } } } break; case "SetPositionAxis": //SABS,C01,00000100000,00000090000,00000000000,00000450000,00000010000 lock (_locker) { var data = param[1].ToString().Split(';').ToList(); foreach (var item in data) { if (!string.IsNullOrEmpty(item)) { _lstMonitorHandler.AddLast(new GM201LVPRobotSetHandler(this, "SABS", item)); } } } break; case "EnableInterLock": //SMSK int smskValid = Convert.ToInt16(param[1].ToString()); lock (_locker) { _lstHandlers.AddLast(new GM201LVPRobotSetHandler(this, "SPRM", smskValid.ToString("D4"))); } break; } _timerActionMonitor.Restart(); } catch (Exception) { string reason = ""; if (param != null) { foreach (var para in param) { reason += para.ToString() + ","; } } EV.PostAlarmLog(Name, "Set command parameter invalid:" + reason); return false; } return true; } protected override bool fMonitorSetParamter(object[] param) { IsBusy = false; if (_timerActionMonitor.IsRunning && _timerActionMonitor.Elapsed > TimeSpan.FromSeconds(_timeLimitMotion)) { _timerActionMonitor.Stop(); OnError("SetParameterTimeOut"); return true; } if (_lstHandlers.Count == 0 && !_connection.IsBusy) { //EV.PostInfoLog(Name, "SetParameter complete"); return true; } return false; } protected override bool fStartTransferWafer(object[] param) { return false; } protected override bool fStartUnGrip(object[] param) { if (!_connection.IsConnected) { EV.PostAlarmLog(RobotModuleName.ToString(), $"{RobotModuleName} ungrip failed for not connect with {_connection.Address}"); return false; } lock (_locker) { RobotArmEnum arm = (RobotArmEnum)param[0]; string strpara = (arm == RobotArmEnum.Both ? "F" : ((int)arm + 1).ToString()) + ",0,0"; _lstHandlers.AddLast(new GM201LVPRobotMotionHandler(this, "CSOL", strpara)); } _timerActionMonitor.Restart(); return true; } protected override bool fMonitorUnGrip(object[] param) { IsBusy = false; if (_timerActionMonitor.IsRunning && _timerActionMonitor.Elapsed > TimeSpan.FromSeconds(_timeLimitMotion)) { _timerActionMonitor.Stop(); OnError("UngripTimeOut"); return true; } if (_lstHandlers.Count == 0 && !_connection.IsBusy) { //EV.PostInfoLog(Name, "Ungrip complete"); return true; } return false; } protected override bool fStartGrip(object[] param) { if (!_connection.IsConnected) { EV.PostAlarmLog(RobotModuleName.ToString(), $"{RobotModuleName} grip failed for not connect with {_connection.Address}"); return false; } lock (_locker) { RobotArmEnum arm = (RobotArmEnum)param[0]; string strpara = (arm == RobotArmEnum.Both ? "F" : ((int)arm + 1).ToString()) + ",1,0"; _lstHandlers.AddLast(new GM201LVPRobotMotionHandler(this, "CSOL", strpara)); } return true; } protected override bool fMonitorGrip(object[] param) { IsBusy = false; if (_timerActionMonitor.IsRunning && _timerActionMonitor.Elapsed > TimeSpan.FromSeconds(_timeLimitMotion)) { _timerActionMonitor.Stop(); OnError("GripTimeOut"); return true; } if (_lstHandlers.Count == 0 && !_connection.IsBusy) { //EV.PostInfoLog(Name, "Grip complete"); return true; } return false; } protected override bool fStartInit(object[] param) { if (!_connection.IsConnected) { EV.PostAlarmLog(RobotModuleName.ToString(), $"{RobotModuleName} init failed for not connect with {_connection.Address}"); return false; } lock (_locker) { if (_doRobotHold != null) { _doRobotHold.SetTrigger(true, out _); Thread.Sleep(100); } //ExecuteHandler(new GM201LVPRobotReadHandler(this, "RERR", "001")); if (_isError) { string strparaReset = "1,1,N"; _lstHandlers.AddLast(new GM201LVPRobotMotionHandler(this, "INIT", strparaReset)); _isError = false; } string strpara = "1,1,G"; _lstHandlers.AddLast(new GM201LVPRobotMotionHandler(this, "INIT", strpara)); if (SpeedLevelSetting >= 1 && SpeedLevelSetting <= 100) _lstHandlers.AddLast(new GM201LVPRobotSetHandler(this, "SSLV", $"1,{SpeedLevelSetting.ToString("D3")}")); _lstHandlers.AddLast(new GM201LVPRobotReadHandler(this, "RSTS")); } _timerActionMonitor.Restart(); return true; } protected override bool fMonitorInit(object[] param) { IsBusy = false; if (_timerActionMonitor.IsRunning && _timerActionMonitor.Elapsed > TimeSpan.FromSeconds(_timeLimitHome)) { _timerActionMonitor.Stop(); OnError("InitTimeOut"); return true; } if (_lstHandlers.Count == 0 && !_connection.IsBusy) { BladeTarget = ModuleName.System; Blade1Target = ModuleName.System; Blade2Target = ModuleName.System; CmdTarget = ModuleName.System; MoveInfo = new RobotMoveInfo() { Action = RobotAction.Moving, ArmTarget = CmdRobotArm == RobotArmEnum.Lower ? RobotArm.ArmA : RobotArm.ArmB, BladeTarget = BuildBladeTarget(), }; //EV.PostInfoLog(Name, "Init complete"); return true; } return false; } protected override bool fStartHome(object[] param) { if (!_connection.IsConnected) { EV.PostAlarmLog(RobotModuleName.ToString(), $"{RobotModuleName} init failed for not connect with {_connection.Address}"); return false; } lock (_locker) { if (_doRobotHold != null) { _doRobotHold.SetTrigger(true, out _); Thread.Sleep(100); } //ExecuteHandler(new GM201LVPRobotReadHandler(this, "RERR", "001")); if (_isError) { string strparaReset = "1,1,N"; _lstHandlers.AddLast(new GM201LVPRobotMotionHandler(this, "INIT", strparaReset)); _isError = false; } string strpara = "1,1,G"; _lstHandlers.AddLast(new GM201LVPRobotMotionHandler(this, "INIT", strpara, _timeLimitHome)); if (SpeedLevelSetting >= 1 && SpeedLevelSetting <= 100) _lstHandlers.AddLast(new GM201LVPRobotSetHandler(this, "SSLV", $"1,{SpeedLevelSetting.ToString("D3")}")); _lstHandlers.AddLast(new GM201LVPRobotReadHandler(this, "RSTS")); } _timerActionMonitor.Restart(); return true; } protected override bool fMonitorHome(object[] param) { IsBusy = false; if (_timerActionMonitor.IsRunning && _timerActionMonitor.Elapsed > TimeSpan.FromSeconds(_timeLimitHome)) { _timerActionMonitor.Stop(); OnError("HomeTimeOut"); return true; } if (_lstHandlers.Count == 0 && !_connection.IsBusy) { BladeTarget = ModuleName.System; Blade1Target = ModuleName.System; Blade2Target = ModuleName.System; CmdTarget = ModuleName.System; MoveInfo = new RobotMoveInfo() { Action = RobotAction.Moving, ArmTarget = CmdRobotArm == RobotArmEnum.Lower ? RobotArm.ArmA : RobotArm.ArmB, BladeTarget = BuildBladeTarget(), }; //EV.PostInfoLog(Name, "Home complete"); return true; } return false; } protected override bool fStartGoTo(object[] param) { if (!_connection.IsConnected) { EV.PostAlarmLog(RobotModuleName.ToString(), $"{RobotModuleName} move failed for not connect with {_connection.Address}"); return false; } try { RobotArmEnum arm = (RobotArmEnum)param[0]; ModuleName module = (ModuleName)Enum.Parse(typeof(ModuleName), param[1].ToString()); BladeTarget = module; Blade1Target = module; Blade2Target = module; int slot = (int)param[2] + 1; //RobotPostionEnum postype = (RobotPostionEnum)param[3]; RobotPostionEnum postype = (RobotPostionEnum)Enum.Parse(typeof(RobotPostionEnum), param[3].ToString()); string strpara = string.Empty; //bool isFromOriginal = (bool)param[8]; //bool isJumpToNextMotion = (bool)param[9]; //if ((int)postype >= 0 && (int)postype < 10) //{ // strpara = "G"; //} //if ((int)postype >= 10 && (int)postype < 20) //{ // strpara = "P"; //} //if ((int)postype >= 20 && (int)postype < 30) //{ // strpara = "E"; //} string trsSt = GetStationsName(module); if (string.IsNullOrEmpty(trsSt)) { LOG.Write("invalid transfer paramter"); return false; } string TrsPnt = string.Empty; if (postype == RobotPostionEnum.PickReady) { TrsPnt = "G"; } if (postype == RobotPostionEnum.PlaceReady) { TrsPnt = "P"; } //strCmd = "MTCH"; if (_MaterialType == MaterialType.Wafer) { int bladeNo = (arm == RobotArmEnum.Blade1 || arm == RobotArmEnum.Lower) ? 4 : 31; strpara += $"{TrsPnt},{trsSt},{slot:D3},{bladeNo:D3}"; } else if (_MaterialType == MaterialType.Carrier) { //strpara = $"{TrsPnt},{trsSt},001,000"; string strHand = GetHandsName(module); if (string.IsNullOrEmpty(strHand)) { LOG.Write("Invalid Paramter."); return false; } strpara = $"{TrsPnt},{trsSt},001,{strHand},001"; } lock (_locker) { { _lstHandlers.AddLast(new GM201LVPRobotMotionHandler(this, "MTCH", strpara)); _lstHandlers.AddLast(new GM201LVPRobotReadHandler(this, "RSTS")); } } _timerActionMonitor.Restart(); return true; } catch (Exception ex) { LOG.Write(ex); return false; } } protected override bool fMonitorGoTo(object[] param) { if (_timerActionMonitor.IsRunning && _timerActionMonitor.Elapsed > TimeSpan.FromSeconds(_timeLimitMotion)) { _timerActionMonitor.Stop(); OnError("GotoTimeOut"); return true; } if (_lstHandlers.Count != 0 || _connection.IsBusy) return false; IsBusy = false; return true; } protected override bool fGoToComplete(object[] param) { try { if (_lstHandlers.Count > 0) return false; RobotArmEnum arm = (RobotArmEnum)CurrentParamter[0]; ModuleName sourcemodule = (ModuleName)Enum.Parse(typeof(ModuleName), CurrentParamter[1].ToString()); int SourceslotIndex = (int)CurrentParamter[2]; RobotPostionEnum postype = (RobotPostionEnum)CurrentParamter[3]; //bool isFromOriginal = (bool)CurrentParamter[8]; //bool isJumpToNextMotion = (bool)CurrentParamter[9]; } catch (Exception ex) { LOG.Write(ex); } return base.fGoToComplete(param); } protected override bool fStop(object[] param) { lock (_locker) { if (_doRobotHold != null) _doRobotHold.SetTrigger(false, out _); _lstHandlers.Clear(); _connection.ForceClear(); //ExecuteHandler(new GM201LVPRobotMotionHandler(this, "CSTP", "E")); } return true; ; } protected override bool fMonitorStop(object[] param) { return true; } protected override bool fStartMove(object[] param) { if (!_connection.IsConnected) { EV.PostAlarmLog(RobotModuleName.ToString(), $"{RobotModuleName} move failed for not connect with {_connection.Address}"); return false; } try { string strCmd = param[0].ToString(); string strpara = string.Empty; for (int i = 1; i < param.Length; i++) { if (i == 1) strpara += param[i].ToString(); else strpara += "," + param[i].ToString(); } lock (_locker) { _lstHandlers.AddLast(new GM201LVPRobotMotionHandler(this, strCmd, strpara)); _lstHandlers.AddLast(new GM201LVPRobotReadHandler(this, "RPOS", "F")); } _timerActionMonitor.Restart(); return true; } catch (Exception ex) { LOG.Write(ex); return false; } } private string GetStationsName(ModuleName chamber) { if (!_moduleAssociateStationDic.ContainsKey(chamber.ToString())) { LOG.Error($"not define teach position {chamber}"); return ""; } var moduleIndex = _moduleAssociateStationDic[chamber.ToString()]; return moduleIndex.ToString(); } private string GetHandsName(ModuleName chamber) { if (!_moduleAssociateHandDic.ContainsKey(chamber.ToString())) { LOG.Error($"not define teach position {chamber}"); return ""; } var moduleIndex = _moduleAssociateHandDic[chamber.ToString()]; return moduleIndex.ToString(); } private int GetSlotsNumber(ModuleName module) { try { if (ModuleHelper.IsLoadPort(module)) { return DEVICE.GetDevice(module.ToString()).ValidSlotsNumber; } return SC.GetValue($"CarrierInfo.{module}SlotsNumber"); } catch (Exception ex) { LOG.Write(ex); return -1; } } private bool _isNeedMappignData { get { if (SC.ContainsItem($"Robot.{RobotModuleName}.NeedReadMapData")) return SC.GetValue($"Robot.{RobotModuleName}.NeedReadMapData"); return true; } } protected override bool fStartMapWafer(object[] param) { if (!_connection.IsConnected) { EV.PostAlarmLog(RobotModuleName.ToString(), $"{RobotModuleName} map failed for not connect with {_connection.Address}"); return false; } try { ReadSlotMap = ""; //RobotArmEnum pickarm = (RobotArmEnum)param[0]; ModuleName module = (ModuleName)Enum.Parse(typeof(ModuleName), param[0].ToString()); BladeTarget = module; Blade1Target = module; Blade2Target = module; //int slotsNumber = GetSlotsNumber(module); //if (slotsNumber == -1) //{ // LOG.Write("Invalid mapping paramter slots number"); // return false; //} string TrsSt = GetStationsName(module); if (string.IsNullOrEmpty(TrsSt)) { LOG.Write("Invalid Paramter."); return false; } string strpara = $"{TrsSt},1"; lock (_locker) { CurrentInteractiveModule = module; _lstHandlers.AddLast(new GM201LVPRobotMotionHandler(this, "MMAP", strpara, _timeLimitMotion)); //if (_isNeedMappignData) // _lstHandlers.AddLast(new GM201LVPRobotReadHandler(this, "RMPD", $"{GetStationsName(module)},025")); _lstHandlers.AddLast(new GM201LVPRobotReadHandler(this, "RMAP", $"{GetStationsName(module)}")); } _timerActionMonitor.Restart(); return true; } catch (Exception ex) { LOG.Write(ex); return false; } } protected override bool fMonitorMap(object[] param) { if (_timerActionMonitor.IsRunning && _timerActionMonitor.Elapsed > TimeSpan.FromSeconds(_timeLimitMotion)) { _timerActionMonitor.Stop(); OnError("PlaceTimeOut"); return true; } if (_lstHandlers.Count != 0 || _connection.IsBusy) return false; IsBusy = false; BladeTarget = ModuleName.System; Blade1Target = ModuleName.System; Blade2Target = ModuleName.System; CmdTarget = ModuleName.System; MoveInfo = new RobotMoveInfo() { Action = RobotAction.Moving, ArmTarget = CmdRobotArm == RobotArmEnum.Lower ? RobotArm.ArmA : RobotArm.ArmB, BladeTarget = BuildBladeTarget(), }; return true; } protected override bool fStartSwapWafer(object[] param) { if (!_connection.IsConnected) { EV.PostAlarmLog(RobotModuleName.ToString(), $"{RobotModuleName} move failed for not connect with {_connection.Address}"); return false; } try { RobotArmEnum arm = (RobotArmEnum)param[0]; ModuleName module = (ModuleName)Enum.Parse(typeof(ModuleName), param[1].ToString()); BladeTarget = module; Blade1Target = module; Blade2Target = module; if (ModuleHelper.IsLoadPort(module)) { var lp = DEVICE.GetDevice(module.ToString()); if (lp != null) lp.NoteTransferStart(); } int slot = (int)param[2] + 1; float x = 0, y = 0, z = 0, w = 0; if (param.Length > 3) { x = (float)param[3]; y = (float)param[4]; z = (float)param[5]; w = (float)param[6]; } int intXvalue = (int)(x * 1000); int intYvalue = (int)(y * 1000); int intZvalue = (int)(z * 1000); int intWvalue = (int)(w * 1000); string TrsSt = GetStationsName(module); if (string.IsNullOrEmpty(TrsSt)) { LOG.Write("Invalid Paramter."); return false; } string strpara = $"E,{TrsSt},{slot:D2},A,{(arm == RobotArmEnum.Both ? "F" : ((int)arm + 1).ToString())},P4"; if (x != 0 || y != 0 || z != 0) { strpara += $",{intXvalue:D8},{intYvalue:D8},{intZvalue:D8}"; } if (w != 0) { strpara += $",{intWvalue:D8}"; } lock (_locker) { if (_lstHandlers.Count == 0 && !_connection.IsBusy) { ExecuteHandler(new GM201LVPRobotMotionHandler(this, "MTRS", strpara, _timeLimitMotion)); } else { _lstHandlers.AddLast(new GM201LVPRobotMotionHandler(this, "MTRS", strpara)); } } return true; } catch (Exception ex) { LOG.Write(ex); return false; } } protected override bool fSwapComplete(object[] param) { RobotArmEnum arm = (RobotArmEnum)CurrentParamter[0]; ModuleName sourcemodule; if (!Enum.TryParse(CurrentParamter[1].ToString(), out sourcemodule)) return false; int Sourceslotindex; if (!int.TryParse(CurrentParamter[2].ToString(), out Sourceslotindex)) return false; int delayCount = 0; if (arm == RobotArmEnum.Lower) { //WaferManager.Instance.WaferMoved(sourcemodule, Sourceslotindex, RobotModuleName, 0); //WaferManager.Instance.WaferMoved(RobotModuleName, 1, sourcemodule, Sourceslotindex); while (!isSimulatorMode && !(GetWaferState(RobotArmEnum.Lower) == RobotArmWaferStateEnum.Present && GetWaferState(RobotArmEnum.Upper) == RobotArmWaferStateEnum.Absent)) { delayCount++; Thread.Sleep(50); LOG.Write($"{RobotModuleName} delay {delayCount} time to detect wafer"); if (delayCount > 100) { OnError("Wafer detect error"); return true; } } WaferManager.Instance.WaferMoved(sourcemodule, Sourceslotindex, RobotModuleName, 0); WaferManager.Instance.WaferMoved(RobotModuleName, 1, sourcemodule, Sourceslotindex); } if (arm == RobotArmEnum.Upper) { //WaferManager.Instance.WaferMoved(sourcemodule, Sourceslotindex, RobotModuleName, 1); //WaferManager.Instance.WaferMoved(RobotModuleName, 0, sourcemodule, Sourceslotindex); delayCount = 0; while (!isSimulatorMode && !(GetWaferState(RobotArmEnum.Upper) == RobotArmWaferStateEnum.Present && GetWaferState(RobotArmEnum.Lower) == RobotArmWaferStateEnum.Absent)) { delayCount++; Thread.Sleep(50); LOG.Write($"{RobotModuleName} delay {delayCount} time to detect wafer"); if (delayCount > 100) { OnError("Wafer detect error"); return true; } } WaferManager.Instance.WaferMoved(sourcemodule, Sourceslotindex, RobotModuleName, 1); WaferManager.Instance.WaferMoved(RobotModuleName, 0, sourcemodule, Sourceslotindex); } return base.fSwapComplete(param); } protected override bool fStartPlaceWafer(object[] param) { if (!_connection.IsConnected) { EV.PostAlarmLog(RobotModuleName.ToString(), $"{RobotModuleName} place failed for not connect with {_connection.Address}"); return false; } try { RobotArmEnum arm = (RobotArmEnum)param[0]; ModuleName module = (ModuleName)Enum.Parse(typeof(ModuleName), param[1].ToString()); if (ModuleHelper.IsLoadPort(module)) { var lp = DEVICE.GetDevice(module.ToString()); if (lp != null) lp.NoteTransferStart(); } BladeTarget = module; Blade1Target = module; Blade2Target = module; int slot = (int)param[2] + 1; string TrsSt = GetStationsName(module); if (string.IsNullOrEmpty(TrsSt)) { LOG.Write("Invalid Parameter."); return false; } string strpara = ""; if (_MaterialType == MaterialType.Wafer) { int bladeNo = (arm == RobotArmEnum.Blade1 || arm == RobotArmEnum.Lower) ? 4 : 31; strpara = $"P,{TrsSt},{slot:D3},{bladeNo:D3}"; } else if (_MaterialType == MaterialType.Carrier) { string strHand = GetHandsName(module); if (string.IsNullOrEmpty(strHand)) { LOG.Write("Invalid Paramter."); return false; } strpara = $"P,{TrsSt},001,{strHand}"; } lock (_locker) { { _lstHandlers.AddLast(new GM201LVPRobotMotionHandler(this, "MTRS", strpara, _timeLimitPlace)); _lstHandlers.AddLast(new GM201LVPRobotReadHandler(this, "RSTS")); } } CmdTarget = module; MoveInfo = new RobotMoveInfo() { Action = RobotAction.Moving, ArmTarget = CmdRobotArm == RobotArmEnum.Lower ? RobotArm.ArmA : RobotArm.ArmB, BladeTarget = BuildBladeTarget(), }; _timerActionMonitor.Restart(); return true; } catch (Exception ex) { LOG.Write(ex); return false; } } protected override bool fMonitorPlace(object[] param) { IsBusy = false; if (_timerActionMonitor.IsRunning && _timerActionMonitor.Elapsed > TimeSpan.FromSeconds(_timeLimitPlace)) { _timerActionMonitor.Stop(); OnError("PlaceTimeOut"); return true; } if (_lstHandlers.Count == 0 && !_connection.IsBusy) { _timerActionMonitor.Stop(); //EV.PostInfoLog(Name, "Place complete"); fPlaceComplete(param); BladeTarget = ModuleName.System; Blade1Target = ModuleName.System; Blade2Target = ModuleName.System; CmdTarget = ModuleName.System; MoveInfo = new RobotMoveInfo() { Action = RobotAction.Moving, ArmTarget = CmdRobotArm == RobotArmEnum.Lower ? RobotArm.ArmA : RobotArm.ArmB, BladeTarget = BuildBladeTarget(), }; return true; } return false; } protected override bool fPlaceComplete(object[] param) { if (_isError) { OnError("RobotError"); return true; } if (_lstHandlers.Count > 0) return false; RobotArmEnum arm = (RobotArmEnum)CurrentParamter[0]; ModuleName sourcemodule; if (!Enum.TryParse(CurrentParamter[1].ToString(), out sourcemodule)) return false; int Sourceslotindex; if (!int.TryParse(CurrentParamter[2].ToString(), out Sourceslotindex)) return false; int delayCount = 0; if (arm == RobotArmEnum.Lower || arm == RobotArmEnum.Blade1) { //WaferManager.Instance.WaferMoved(RobotModuleName, 0, sourcemodule, Sourceslotindex); while (!isSimulatorMode && GetWaferState(arm) != RobotArmWaferStateEnum.Absent) { delayCount++; Thread.Sleep(50); LOG.Write($"{RobotModuleName} delay {delayCount} time to detect wafer"); if (delayCount > 100) { OnError("Wafer detect error"); return true; } } if (_MaterialType == MaterialType.Wafer) { WaferManager.Instance.WaferMoved(RobotModuleName, 2, sourcemodule, Sourceslotindex); } else if (_MaterialType == MaterialType.Carrier) { if (CarrierManager.Instance.CheckHasCarrier(RobotModuleName.ToString(), 0)) { CarrierManager.Instance.CarrierMoved(RobotModuleName.ToString(), sourcemodule.ToString(), true); for (int i = 0; i < WaferManager.Instance.GetWafers(RobotModuleName).Length; i++) { if (WaferManager.Instance.CheckHasWafer(RobotModuleName, i)) WaferManager.Instance.WaferMoved(RobotModuleName, i, sourcemodule, i, false); } } } } if (arm == RobotArmEnum.Upper || arm == RobotArmEnum.Blade2) { //WaferManager.Instance.WaferMoved(RobotModuleName, 1, sourcemodule, Sourceslotindex); delayCount = 0; while (!isSimulatorMode && GetWaferState(arm) != RobotArmWaferStateEnum.Absent) { delayCount++; Thread.Sleep(50); LOG.Write($"{RobotModuleName} delay {delayCount} time to detect wafer"); if (delayCount > 100) { OnError("Wafer detect error"); return true; } } WaferManager.Instance.WaferMoved(RobotModuleName, 1, sourcemodule, Sourceslotindex); } if (arm == RobotArmEnum.Both) { //WaferManager.Instance.WaferMoved(RobotModuleName, 0, sourcemodule, Sourceslotindex); //WaferManager.Instance.WaferMoved(RobotModuleName, 1, sourcemodule, Sourceslotindex); while (!isSimulatorMode && GetWaferState(arm) != RobotArmWaferStateEnum.Absent) { delayCount++; Thread.Sleep(50); LOG.Write($"{RobotModuleName} delay {delayCount} time to detect wafer"); if (delayCount > 100) { OnError("Wafer detect error"); return true; } } WaferManager.Instance.WaferMoved(RobotModuleName, 0, sourcemodule, Sourceslotindex); WaferManager.Instance.WaferMoved(RobotModuleName, 1, sourcemodule, Sourceslotindex + 1); WaferManager.Instance.WaferMoved(RobotModuleName, 2, sourcemodule, Sourceslotindex + 2); WaferManager.Instance.WaferMoved(RobotModuleName, 3, sourcemodule, Sourceslotindex + 3); WaferManager.Instance.WaferMoved(RobotModuleName, 4, sourcemodule, Sourceslotindex + 4); } return base.fPlaceComplete(param); } protected override bool fStartPickWafer(object[] param) { if (!_connection.IsConnected) { EV.PostAlarmLog(RobotModuleName.ToString(), $"{RobotModuleName} move failed for not connect with {_connection.Address}"); return false; } try { RobotArmEnum arm = (RobotArmEnum)param[0]; ModuleName module = (ModuleName)Enum.Parse(typeof(ModuleName), param[1].ToString()); if (ModuleHelper.IsLoadPort(module)) { var lp = DEVICE.GetDevice(module.ToString()); if (lp != null) lp.NoteTransferStart(); } BladeTarget = module; Blade1Target = module; Blade2Target = module; int slot = (int)param[2] + 1; string TrsSt = GetStationsName(module); if (string.IsNullOrEmpty(TrsSt)) { LOG.Write("Invalid Paramter."); return false; } string strpara = ""; if (_MaterialType == MaterialType.Wafer) { int bladeNo = (arm == RobotArmEnum.Blade1 || arm == RobotArmEnum.Lower) ? 4 : 31; strpara = $"G,{TrsSt},{slot:D3},{bladeNo:D3}"; } else if (_MaterialType == MaterialType.Carrier) { string strHand = GetHandsName(module); if (string.IsNullOrEmpty(strHand)) { LOG.Write("Invalid Paramter."); return false; } strpara = $"G,{TrsSt},001,{strHand}"; } lock (_locker) { _lstHandlers.AddLast(new GM201LVPRobotMotionHandler(this, "MTRS", strpara, _timeLimitPick)); _lstHandlers.AddLast(new GM201LVPRobotReadHandler(this, "RSTS")); } CmdTarget = module; MoveInfo = new RobotMoveInfo() { Action = RobotAction.Moving, ArmTarget = CmdRobotArm == RobotArmEnum.Lower ? RobotArm.ArmA : RobotArm.ArmB, BladeTarget = BuildBladeTarget(), }; _timerActionMonitor.Restart(); return true; } catch (Exception ex) { LOG.Write(ex); return false; } } protected override bool fMonitorPick(object[] param) { IsBusy = false; if (_timerActionMonitor.IsRunning && _timerActionMonitor.Elapsed > TimeSpan.FromSeconds(_timeLimitPick)) { _timerActionMonitor.Stop(); OnError("PickTimeOut"); return true; } if (_lstHandlers.Count == 0 && !_connection.IsBusy) { _timerActionMonitor.Stop(); //EV.PostInfoLog(Name, "Pick complete"); fPickComplete(param); BladeTarget = ModuleName.System; Blade1Target = ModuleName.System; Blade2Target = ModuleName.System; CmdTarget = ModuleName.System; MoveInfo = new RobotMoveInfo() { Action = RobotAction.Moving, ArmTarget = CmdRobotArm == RobotArmEnum.Lower ? RobotArm.ArmA : RobotArm.ArmB, BladeTarget = BuildBladeTarget(), }; return true; } return false; } protected override bool fPickComplete(object[] param) { if (_isError) { OnError("RobotError"); return true; } RobotArmEnum arm = (RobotArmEnum)CurrentParamter[0]; ModuleName module = (ModuleName)Enum.Parse(typeof(ModuleName), CurrentParamter[1].ToString()); ModuleName sourcemodule; if (!Enum.TryParse(CurrentParamter[1].ToString(), out sourcemodule)) return false; int SourceslotIndex; if (!int.TryParse(CurrentParamter[2].ToString(), out SourceslotIndex)) return false; int delayCount = 0; if (arm == RobotArmEnum.Lower || arm == RobotArmEnum.Blade1) { //WaferManager.Instance.WaferMoved(sourcemodule, SourceslotIndex, RobotModuleName, 0); while (!isSimulatorMode && GetWaferState(arm) != RobotArmWaferStateEnum.Present) { delayCount++; LOG.Write($"{RobotModuleName} delay {delayCount} time to detect wafer"); Thread.Sleep(50); if (delayCount > 100) { OnError("Wafer detect error"); return true; } } if (_MaterialType == MaterialType.Wafer) { WaferManager.Instance.WaferMoved(sourcemodule, SourceslotIndex, RobotModuleName, 2); } else if (_MaterialType == MaterialType.Carrier) { if (CarrierManager.Instance.CheckHasCarrier(sourcemodule.ToString(), 0)) { CarrierManager.Instance.CarrierMoved(sourcemodule.ToString(), RobotModuleName.ToString(), true); for (int i = 0; i < WaferManager.Instance.GetWafers(sourcemodule).Length; i++) { if (WaferManager.Instance.CheckHasWafer(sourcemodule, i)) WaferManager.Instance.WaferMoved(sourcemodule, i, RobotModuleName, i, false); } } } } if (arm == RobotArmEnum.Upper || arm == RobotArmEnum.Blade2) { //WaferManager.Instance.WaferMoved(sourcemodule, SourceslotIndex, RobotModuleName, 1); while (!isSimulatorMode && GetWaferState(arm) != RobotArmWaferStateEnum.Present) { delayCount++; LOG.Write($"{RobotModuleName} delay {delayCount} time to detect wafer"); Thread.Sleep(50); if (delayCount > 100) { OnError("Wafer detect error"); return true; } } WaferManager.Instance.WaferMoved(sourcemodule, SourceslotIndex, RobotModuleName, 1); } if (arm == RobotArmEnum.Both) { //WaferManager.Instance.WaferMoved(sourcemodule, SourceslotIndex, RobotModuleName, 0); //WaferManager.Instance.WaferMoved(sourcemodule, SourceslotIndex, RobotModuleName, 1); while (!isSimulatorMode && GetWaferState(arm) != RobotArmWaferStateEnum.Present) { delayCount++; LOG.Write($"{RobotModuleName} delay {delayCount} time to detect wafer"); Thread.Sleep(50); if (delayCount > 100) { OnError("Wafer detect error"); return true; } } WaferManager.Instance.WaferMoved(sourcemodule, SourceslotIndex, RobotModuleName, 0); WaferManager.Instance.WaferMoved(sourcemodule, SourceslotIndex + 1, RobotModuleName, 1); WaferManager.Instance.WaferMoved(sourcemodule, SourceslotIndex + 2, RobotModuleName, 2); WaferManager.Instance.WaferMoved(sourcemodule, SourceslotIndex + 3, RobotModuleName, 3); WaferManager.Instance.WaferMoved(sourcemodule, SourceslotIndex + 4, RobotModuleName, 4); } return base.fPickComplete(param); } protected override bool fResetToReady(object[] param) { if (_doRobotHold != null) _doRobotHold.SetTrigger(true, out _); return true; } protected override bool fReset(object[] param) { _isError = false; if (!_connection.IsConnected) { _address = SC.GetStringValue($"{Name}.Address"); _enableLog = SC.GetValue($"{Name}.EnableLogMessage"); _connection = new GM201LVPRobotConnection(this, _address); _connection.EnableLog(_enableLog); _connection.Connect(); } if (!_isError) { lock (_locker) { string strpara = "1,1,N"; _lstHandlers.AddLast(new GM201LVPRobotMotionHandler(this, "INIT", strpara)); } return true; } lock (_locker) { if (_doRobotHold != null) _doRobotHold.SetTrigger(true, out _); _lstHandlers.Clear(); _connection.ForceClear(); //_lstHandlers.AddLast(new GM201LVPRobotMotionHandler(this, "CCLR", "E", _timeLimitMotion)); string strpara = "1,1,N"; _lstHandlers.AddLast(new GM201LVPRobotMotionHandler(this, "INIT", strpara)); //string strpara = "1,0,N"; //_lstHandlers.AddLast(new GM201LVPRobotMotionHandler(this, "INIT", strpara, _timeLimitMotion)); //_lstHandlers.AddLast(new GM201LVPRobotReadHandler(this, "RSTS")); _timerActionMonitor.Restart(); } return true; } protected override bool fMonitorReset(object[] param) { IsBusy = false; if (_timerActionMonitor.IsRunning && _timerActionMonitor.Elapsed > TimeSpan.FromSeconds(_timeLimitMotion)) { _timerActionMonitor.Stop(); OnError("ResetTimeOut"); return true; } if (_lstHandlers.Count == 0 && !_connection.IsBusy) { return true; } return false; } protected override bool fError(object[] param) { return true; } protected override bool fStartExtendForPick(object[] param) { return false; } protected override bool fStartExtendForPlace(object[] param) { return false; } protected override bool fStartRetractFromPick(object[] param) { return false; } protected override bool fStartRetractFromPlace(object[] param) { return false; } public void CheckWaferPresentAndGrip() { if (GetWaferState(RobotArmEnum.Lower) == RobotArmWaferStateEnum.Present) { if (WaferManager.Instance.CheckNoWafer(RobotModuleName, 0)) { EV.PostWarningLog($"{RobotModuleName}", $"System detec wafer on lower arm, will create wafer automatically."); WaferManager.Instance.CreateWafer(RobotModuleName, 0, WaferStatus.Normal); } } if (GetWaferState(RobotArmEnum.Lower) == RobotArmWaferStateEnum.Absent) { _lstHandlers.AddLast(new GM201LVPRobotMotionHandler(this, "CSOL", "1,0,0")); if (WaferManager.Instance.CheckHasWafer(RobotModuleName, 0)) { EV.PostWarningLog($"{RobotModuleName}", $"System didn't detect wafer on lower arm, but it has record."); } } if (GetWaferState(RobotArmEnum.Upper) == RobotArmWaferStateEnum.Present) { if (WaferManager.Instance.CheckNoWafer(RobotModuleName, 1)) { EV.PostWarningLog($"{RobotModuleName}", $"System detect wafer on upper arm, will create wafer automatically."); WaferManager.Instance.CreateWafer(RobotModuleName, 1, WaferStatus.Normal); } } if (GetWaferState(RobotArmEnum.Upper) == RobotArmWaferStateEnum.Absent) { _lstHandlers.AddLast(new GM201LVPRobotMotionHandler(this, "CSOL", "2,0,0")); if (WaferManager.Instance.CheckHasWafer(RobotModuleName, 1)) { EV.PostWarningLog($"{RobotModuleName}", $"System didn't detect wafer on upper arm, but it has record."); } } } public override RobotArmWaferStateEnum GetWaferState(RobotArmEnum arm) { if (arm == RobotArmEnum.Lower || arm == RobotArmEnum.Blade1) { if (_diRobotBlade1WaferOn != null) { if (_diRobotBlade1WaferOn.Value) return RobotArmWaferStateEnum.Absent; else return RobotArmWaferStateEnum.Present; } var waferPresenceOnBlade1 = _MaterialType == MaterialType.Wafer ? IsWaferPresenceOnBlade3 : IsWaferPresenceOnBlade1; return waferPresenceOnBlade1 ? RobotArmWaferStateEnum.Present : RobotArmWaferStateEnum.Absent; } if (arm == RobotArmEnum.Upper || arm == RobotArmEnum.Blade2) { if (_diRobotBlade2WaferOn != null) { if (_diRobotBlade2WaferOn.Value) return RobotArmWaferStateEnum.Absent; else return RobotArmWaferStateEnum.Present; } return IsWaferPresenceOnBlade2 ? RobotArmWaferStateEnum.Present : RobotArmWaferStateEnum.Absent; } if (arm == RobotArmEnum.Both) { if (_diRobotBlade1WaferOn != null && _diRobotBlade2WaferOn != null) { if (_diRobotBlade2WaferOn.Value && _diRobotBlade1WaferOn.Value) return RobotArmWaferStateEnum.Absent; else if (!_diRobotBlade2WaferOn.Value && !_diRobotBlade1WaferOn.Value) return RobotArmWaferStateEnum.Present; else return RobotArmWaferStateEnum.Unknown; } if (IsWaferPresenceOnBlade1 && IsWaferPresenceOnBlade2 && IsWaferPresenceOnBlade3 && IsWaferPresenceOnBlade4 && IsWaferPresenceOnBlade5) { return RobotArmWaferStateEnum.Present; } if ((!IsWaferPresenceOnBlade1) && !IsWaferPresenceOnBlade2 && !IsWaferPresenceOnBlade3 && !IsWaferPresenceOnBlade4 && !IsWaferPresenceOnBlade5) { return RobotArmWaferStateEnum.Absent; } } return RobotArmWaferStateEnum.Unknown; } public override void NoteError(string errortext) { _isError = true; if (!string.IsNullOrEmpty(errortext)) OnError(errortext); //lock (_locker) { _lstHandlers.Clear(); _connection.ForceClear(); if (_tpStatus != null && !_tpStatus.Value) { //False是TP状态 //TP状态,不需要发 } else { _lstHandlers.AddLast(new GM201LVPRobotReadHandler(this, "RERR", "001")); } } } //public void SenACK() //{ // _connection.SendAck(); //} public override bool OnActionDone(object[] param) { return true; } public override void Terminate() { _thread.Stop(); if (!SC.ContainsItem($"{Name}.CloseConnectionOnShutDown") || SC.GetValue($"{Name}.CloseConnectionOnShutDown")) { LOG.Write("Close connection for" + RobotModuleName.ToString()); _connection.Disconnect(); } base.Terminate(); } private string BuildBladeTarget() { return (CmdRobotArm == RobotArmEnum.Upper ? "ArmB" : "ArmA") + "." + CmdTarget; } public override void SetPauseResume(bool isPause) { _connection.SendMessage($"{(isPause ? "CSTP,H" : "CRSM")}\r"); if (_connection.ActiveHandler != null) { if (isPause) { _connection.ActiveHandler.TimerAck?.Stop(); _connection.ActiveHandler.TimerComplete?.Stop(); } else { _connection.ActiveHandler.TimerAck?.Start(); _connection.ActiveHandler.TimerComplete?.Start(); } } } public void NotePause(bool isPause) { IsPause = isPause; } } public class GM201LVPTokenGenerator { private int _last = 0; List _pool = new List(); SCConfigItem scToken = null; public int CurrentToken => _last; public GM201LVPTokenGenerator(string scName) { scToken = SC.GetConfigItem(scName); if (scToken == null) _last = scToken.IntValue; Random r = new Random(); _last = r.Next() % 20; } public int create() { int first = _last; int token = first; do { token = (token + 1) % 100; if (_pool.Contains(token)) continue; _pool.Add(token); _last = token; scToken.IntValue = _last; return _last; } while (token != first); throw (new ExcuteFailedException("Get token failed,pool is full")); } public void release(int token) { _pool.Remove(token); } public void release() { _last = 0; _pool.Clear(); } } public enum GM201LVPPositonEnum { RegisteredPosition, ReadyPosition, IntermediatePosition, MappingStartPosition, MappingFinishPosition, } }