ZZ-EFEM/Framework/RTEquipmentLibrary1/HardwareUnits/Robots/JEL/JELC5000/JelC5000Robot.cs

using System;
using System.Collections.Generic;
using System.IO.Ports;
using System.Linq;
using System.Text;
using Aitex.Core.Common.DeviceData;
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.Communications;
using MECF.Framework.Common.Device.Bases;
using MECF.Framework.RT.EquipmentLibrary.HardwareUnits.Common;
using Newtonsoft.Json;
using MECF.Framework.RT.EquipmentLibrary.HardwareUnits.Robots.RobotBase;
using MECF.Framework.Common.Equipment;
using MECF.Framework.Common.SubstrateTrackings;
using System.Threading;
using Aitex.Core.Common;
using Aitex.Core.RT.DataCenter;
using System.Text.RegularExpressions;
using MECF.Framework.RT.EquipmentLibrary.HardwareUnits.LoadPorts;
using MECF.Framework.RT.EquipmentLibrary.HardwareUnits.LoadPorts.LoadPortBase;
using MECF.Framework.Common.CommonData;
using MECF.Framework.RT.EquipmentLibrary.HardwareUnits.Flipper.FlipperBase;

namespace MECF.Framework.RT.EquipmentLibrary.HardwareUnits.Robots.JEL
{
    public class JelC5000Robot : RobotBaseDevice, IConnection
    {
        private int _bodyNumber;
        private string _robotModel;    //T-00902H
        public int BodyNumber => SC.GetValue<int>($"{_scRoot}.{Name}.BodyNumber"); 
        private string _address = "";
        public string Address { get => _address; }
        private bool isSimulatorMode;
        private string _scRoot;       
        private PeriodicJob _thread;
        protected JelC5000RobotConnection _connection;
        private R_TRIG _trigError = new R_TRIG();

        private R_TRIG _trigCommunicationError = new R_TRIG();
        private R_TRIG _trigRetryConnect = new R_TRIG();
        private R_TRIG _trigActionDone = new R_TRIG();
        protected LinkedList<HandlerBase> _lstMonitorHandler = new LinkedList<HandlerBase>();
       

        protected object _locker = new object();

        private bool _enableLog;

        public string PortName;
        public bool IsConnected { get; }
        public bool Connect()
        {
            return true;
        }

        private int _lowerArmWaferSensorIndex
        {
            get
            {
                if (SC.ContainsItem($"Robot.{RobotModuleName}.LowerArmWaferSensorIndex"))
                    return SC.GetValue<int>($"Robot.{RobotModuleName}.LowerArmWaferSensorIndex");
                return 1;
            }
        }

        protected bool ResetBeforeCmd
        {
            get
            {
                if (SC.ContainsItem($"Robot.{RobotModuleName}.ResetBeforeCmd") && SC.GetValue<bool>($"Robot.{RobotModuleName}.ResetBeforeCmd"))
                    return true;
                return false;
            }
        }


        public bool Disconnect()
        {
            return true;
        }
        public JelC5000Robot(string module, string name, string scRoot, string robotModel = "",int bladeCount = 2) : base(module, name,scRoot,bladeCount)
        {
            _robotModel = robotModel;
            isSimulatorMode = SC.ContainsItem("System.IsSimulatorMode") ? SC.GetValue<bool>("System.IsSimulatorMode") : false;
            _scRoot = scRoot;

            //base.Initialize();
            ResetPropertiesAndResponses();
            RegisterSpecialData();
           
            _enableLog = SC.GetValue<bool>($"{_scRoot}.{Name}.EnableLogMessage");
            //_bodyNumber = SC.GetValue<int>($"{_scRoot}.{Name}.BodyNumber");
            PortName = SC.GetStringValue($"{_scRoot}.{Name}.PortName");
           
            _connection = new JelC5000RobotConnection(this,PortName);
            _connection.IsEnableHandlerRetry = false;
            _connection.EnableLog(_enableLog);

            if (_connection.Connect())
            {
               
                EV.PostInfoLog(Module, $"{Module}.{Name} connected");
            }
            _thread = new PeriodicJob(5, OnTimer, $"{Module}.{Name} MonitorHandler", true);   
        }

        protected override void SubscribeWaferLocation()
        {
            WaferManager.Instance.SubscribeLocation(Name, BladeCount);
        }

        #region Properties
        public JelAxisStatus JelC5000RobotStatus { get; private set; }
        public JelAxisStatus AxisStatus { get; private set; }
        public float XAxisPostion { get; private set; }
        public float ThetaAxisPostion { get; private set; }
        public float YAxisPostion { get; private set; }
        public float ZAxisPostion { get; private set; }
        public Int32[] AData { get; private set; } = new Int32[1000];
        public JelParameterData[] RobotParameters { get; private set; } = new JelParameterData[2000];
        public string ReadBankNumber { get; set; } = "";
        public int ReadCassetNumber { get; set; }
        public int ReadSlotNumber { get; set; }
        public bool IsVacuumSensorON { get; private set; } = true;
       
        public bool IsEchoBack { get; private set; }
        public JelCommandStatus CurrentCompoundCommandStatus { get; set; }   

        public string StopPostionOfCompoundCommand { get; private set; }
        public string[] MainRoutines { get; private set; } = new string[320];
        public string[] SubRoutines { get; private set; } = new string[16];

        public string CurrentReadRoutine { get; private set; }

        public int HighSpeed { get; private set; }
        public int LowSpeed { get; private set; }
        public int DomainOfAccDec { get; private set; }
        public int AccDecSpeed { get; private set; }
        public int MagnificationOfFrequency { get; private set; }
        public int PulsePostionOfManualSlowDown { get; private set; }
        public int CurrentReadSpeedData { get; private set; }
        public Int32 CurrentReadAData { get; private set; }
        public Int32 ReadPosXAxisPostion { get; private set; }
        public Int32 ReadPosYAxisPostion { get; private set; }
        public Int32 ReadPosThetaAxisPostion { get; private set; }
        public Int32 ReadPosZAxisPostion { get; private set; }

        public float ReadParameterMin { get; private set; }
        public float ReadParameterMax { get; private set; }
        public float ReadParameterValue { get; private set; }      

        //Mapping Data
        public float MappingFirstSlotPosition { get; private set; }
        public float MappingTopSlotPostion { get; private set; }
        public int MappingSlotsNumber { get; private set; }
        public float MappingMinDetectWidth { get; private set; }
        public float MappingMaxDetectWidth { get; private set; }
        public float MappingGateWidth { get; private set; }
        public float MappingStopPostion { get; private set; }
        public float MappingSpeed { get; private set; }
        public bool IsMappingSensorON { get; private set; }
        public string MappingWaferResult { get; private set; } = string.Empty;
        public string MappingWidthResult { get; private set; } = string.Empty;

        public override bool Blade1Enable => true;
        public override bool Blade2Enable => false;

        #endregion

        #region ParseHandler
        public void ParseData(string command,string parameter,string data)
        {
            try
            {
                string datavalue = data.Replace($"${BodyNumber}", "").Replace("\r", "");
                if(command == "SPA")
                {
                    CurrentReadSpeedData = Convert.ToInt32(datavalue);
                }

                if (command == "") ParseRobotStatus(datavalue);     // Read Robot Status
                if (command == "6" || command == "6M") ParseRobotPostion(parameter, datavalue); //Read Postion Data
                if (command == "A")     // Read A data
                {
                    int _index;
                    if (!int.TryParse(parameter.Replace("D", ""), out _index)) return;
                    AData[_index] = Convert.ToInt32(datavalue);
                    CurrentReadAData = Convert.ToInt32(datavalue);
                }
                if (command == "BC")
                {
                    ReadBankNumber = datavalue;
                }
                if (command == "WCP")
                {
                    string[] strvalues = datavalue.Split(',');                    
                    ReadCassetNumber = Convert.ToInt32(strvalues[0]);
                    ReadSlotNumber = Convert.ToInt32(strvalues[1]);
                }
                if (command == $"CS{_lowerArmWaferSensorIndex}")
                {
                    IsVacuumSensorON = datavalue == "1";
                   
                }
                if (command == "DTD")
                {
                    int _index;
                    if (!int.TryParse(parameter, out _index)) return;
                    string[] paradata = datavalue.Split(',');
                    //if (paradata.Length < 3) return;
                    RobotParameters[_index].Value = paradata[0];
                    RobotParameters[_index].MinValue = paradata[1];
                    RobotParameters[_index].MaxValue = paradata[2];
                }
                if (command == "EE")
                {
                    IsEchoBack = datavalue == "E";
                }
                if (command == "G")
                {
                    if (datavalue == "0") CurrentCompoundCommandStatus = JelCommandStatus.NormalEnd;
                    if (datavalue == "1") CurrentCompoundCommandStatus = JelCommandStatus.InExecution;
                    if (datavalue == "P") CurrentCompoundCommandStatus = JelCommandStatus.InPause;
                    if (datavalue == "E") CurrentCompoundCommandStatus = JelCommandStatus.InError;
                }
                if (command == "GER")
                {
                    LOG.Write("Compaund command stop postion:" + datavalue);
                }
                if (command == "IR")
                {
                    int _index;
                    if (!int.TryParse(parameter, out _index)) return;
                    if (_index < 0 || _index > 319) return;
                    MainRoutines[_index] = datavalue;
                    CurrentReadRoutine = datavalue;
                }
                if (command == "IRS")
                {
                    int _index = Convert.ToInt32(parameter, 16);
                    if (_index < 0 || _index > 15) return;
                    SubRoutines[_index] = datavalue;
                    CurrentReadRoutine = datavalue;
                }
                if (command == "O")
                {
                    CurrentReadSpeedData = Convert.ToInt32(datavalue);
                    if (parameter == "H")
                        HighSpeed = Convert.ToInt32(datavalue);
                    if (parameter == "L")
                        LowSpeed = Convert.ToInt32(datavalue);
                    if (parameter == "S")
                        DomainOfAccDec = Convert.ToInt32(datavalue);
                    if (parameter == "G")
                        AccDecSpeed = Convert.ToInt32(datavalue);
                    if (parameter == "X")
                        MagnificationOfFrequency = Convert.ToInt32(datavalue);
                    if (parameter == "D")
                        PulsePostionOfManualSlowDown = Convert.ToInt32(datavalue);
                }
                if (command == "PSD")
                {
                    string[] stradata = datavalue.Split(',');    
                    ReadPosXAxisPostion = Convert.ToInt32(stradata[0].ToString());
                    ReadPosYAxisPostion = Convert.ToInt32(stradata[1].ToString());
                    ReadPosThetaAxisPostion = Convert.ToInt32(stradata[2].ToString());
                    ReadPosZAxisPostion = Convert.ToInt32(stradata[3].ToString()); 
                }
                if (command == "DTD")
                {
                    string[] stradata = datavalue.Split(',');                   
                    ReadParameterValue = Convert.ToSingle(stradata[0].ToString());
                    ReadParameterMin = Convert.ToSingle(stradata[1].ToString());
                    ReadParameterMax = Convert.ToSingle(stradata[2].ToString());
                }
                if (command == "WLO") // Obtaining the postion data of mapping 1st slot detected
                   MappingFirstSlotPosition = Convert.ToSingle(datavalue);
                if(command == "WHI")
                    MappingTopSlotPostion = Convert.ToSingle(datavalue);
                if(command == "WFC")
                    MappingSlotsNumber = Convert.ToInt32(datavalue);
                if(command == "WWN")
                    MappingMinDetectWidth = Convert.ToSingle(datavalue);
                if(command == "WWM")
                    MappingMaxDetectWidth = Convert.ToSingle(datavalue);
                if(command == "WWG")
                    MappingGateWidth = Convert.ToSingle(datavalue);
                if(command == "WEND")
                    MappingStopPostion = Convert.ToSingle(datavalue);
                if(command == "WSP")
                    MappingSpeed = Convert.ToSingle(datavalue);
                if(command == "WFK")
                {
                    MappingWaferResult = datavalue;
                    NotifySlotMapResult(CurrentInteractModule, datavalue.Replace(",", "").Replace("E", "?"));
                }
                if (command == "WFW")
                    MappingWidthResult = datavalue;


            }
            catch(Exception ex)
            {
                LOG.Write($"Parse {command}.{parameter??parameter} data {data} error:" + ex.ToString());
                OnError($"Parse data error:{command}.{parameter ?? parameter} data {data}");
            }
            
        }
        private void ParseRobotStatus(string data)
        {
            if (data.Length < 2) return;
            int intRobostatus = Convert.ToInt16(data.ToArray()[0].ToString(), 16);
            if (intRobostatus == 0)
                JelC5000RobotStatus = (JelAxisStatus)Convert.ToInt16(data.ToArray()[0].ToString(), 16);
            if((intRobostatus & 0x1) == 0x1)
            {
                JelC5000RobotStatus = JelAxisStatus.InOperation;
            }
            if ((intRobostatus & 0x2) == 0x2)
            {
                JelC5000RobotStatus = JelAxisStatus.SensorError;
                OnError(JelC5000RobotStatus.ToString());
            }
            if ((intRobostatus & 0x4) == 0x4)
            {
                JelC5000RobotStatus = JelAxisStatus.SensorErrorOrStoppedByAlarm;
                OnError(JelC5000RobotStatus.ToString());
            }
            if ((intRobostatus & 0x8) == 0x8)
            {
                JelC5000RobotStatus = JelAxisStatus.CommandError;
                OnError(JelC5000RobotStatus.ToString());
            }

            if (data.ToArray()[1] == '0')
                AxisStatus = JelAxisStatus.NormalEnd;
            else
                AxisStatus = JelAxisStatus.InOperation;
        }
        private void ParseRobotPostion(string axis,string data)
        {
            float _floatvalue;
            if (!float.TryParse(data, out _floatvalue)) return;
            if (axis == "1")
            {
                PositionAxis1 = _floatvalue;
            }
            if (axis == "2")
            {                
                PositionAxis2 = _floatvalue;
            }
            if (axis == "3")
            {               
                PositionAxis3 = _floatvalue;
            }
            if (axis == "4")
            {                
                PositionAxis4 = _floatvalue;
            }

            if (axis == "X")
            {
                XAxisPostion = _floatvalue;
            }
            if (axis == "Y")
            {
                YAxisPostion = _floatvalue;
            }
            if (axis == "U")
            {
                ThetaAxisPostion = _floatvalue;
            }
            if (axis == "Z")
            {
                ZAxisPostion = _floatvalue;
            }
        }

        #endregion

        private bool OnTimer()
        {
            try
            {
                if (!_connection.IsConnected || _connection.IsCommunicationError)
                {
                    lock (_locker)
                    {
                        _lstMonitorHandler.Clear();
                    }

                    _trigRetryConnect.CLK = !_connection.IsConnected;
                    if (_trigRetryConnect.Q)
                    {
                        _connection.SetPortAddress(SC.GetStringValue($"{_scRoot}.{Name}.PortName"));
                        if (!_connection.Connect())
                        {
                            EV.PostAlarmLog(Module, $"Can not connect with {_connection.Address}, {Module}.{Name}");
                        }
                        else
                        {

                        }
                    }
                    return true;
                }

                HandlerBase handler = null;
                DateTime dtstart = DateTime.Now;

                lock (_locker)
                {
                    if(_lstMonitorHandler.Count > 0)
                    {
                        if (!_connection.IsBusy)
                        {                           
                                handler = _lstMonitorHandler.First.Value;
                                _connection.Execute(handler);
                            _lstMonitorHandler.RemoveFirst();                           
                        }
                        else
                        {
                            _connection.MonitorTimeout();

                            _trigCommunicationError.CLK = _connection.IsCommunicationError;
                            if (_trigCommunicationError.Q)
                            {
                                _lstMonitorHandler.Clear();
                                OnError($"{Module}.{Name} communication error, {_connection.LastCommunicationError}");
                            }
                        }
                       
                    }


                }

            }
            catch (Exception ex)
            {
                LOG.Write(ex);
            }

            return true;
        }

        private void RegisterSpecialData()
        {
            DATA.Subscribe($"{Module}.{Name}.CurrentReadRoutine", () => CurrentReadRoutine); 
            DATA.Subscribe($"{Module}.{Name}.CurrentReadSpeedData", () => CurrentReadSpeedData);
            

            DATA.Subscribe($"{Module}.{Name}.CurrentReadAData", () => CurrentReadAData);
            DATA.Subscribe($"{Module}.{Name}.IsVacuumSensorON", () => IsVacuumSensorON);
            DATA.Subscribe($"{Module}.{Name}.JelC5000RobotStatus", () => JelC5000RobotStatus.ToString());
            DATA.Subscribe($"{Module}.{Name}.AxisStatus", () => AxisStatus.ToString());
            DATA.Subscribe($"{Module}.{Name}.CurrentCompoundCommandStatus", () => CurrentCompoundCommandStatus.ToString());
            DATA.Subscribe($"{Module}.{Name}.ReadCassetNumber", () => ReadCassetNumber.ToString());
            DATA.Subscribe($"{Module}.{Name}.ReadSlotNumber", () => ReadSlotNumber.ToString());
            DATA.Subscribe($"{Module}.{Name}.ReadBankNumber", () => ReadBankNumber.ToString());

            DATA.Subscribe($"{Module}.{Name}.ReadPosXAxisPostion", () => ReadPosXAxisPostion);
            DATA.Subscribe($"{Module}.{Name}.ReadPosYAxisPostion", () => ReadPosYAxisPostion);
            DATA.Subscribe($"{Module}.{Name}.ReadPosZAxisPostion", () => ReadPosZAxisPostion);
            DATA.Subscribe($"{Module}.{Name}.ReadPosThetaAxisPostion", () => ReadPosThetaAxisPostion);

            DATA.Subscribe($"{Module}.{Name}.ReadParameterMax", () => ReadParameterMax.ToString());
            DATA.Subscribe($"{Module}.{Name}.ReadParameterMin", () => ReadParameterMin.ToString());
            DATA.Subscribe($"{Module}.{Name}.ReadParameterValue", () => ReadParameterValue.ToString());

            DATA.Subscribe($"{Module}.{Name}.MappingFirstSlotPosition", () => MappingFirstSlotPosition.ToString());
            DATA.Subscribe($"{Module}.{Name}.MappingGateWidth", () => MappingGateWidth.ToString());
            DATA.Subscribe($"{Module}.{Name}.MappingMaxDetectWidth", () => MappingMaxDetectWidth.ToString());
            DATA.Subscribe($"{Module}.{Name}.MappingMinDetectWidth", () => MappingMinDetectWidth.ToString());
            DATA.Subscribe($"{Module}.{Name}.MappingSlotsNumber", () => MappingSlotsNumber.ToString());
            DATA.Subscribe($"{Module}.{Name}.MappingSpeed", () => MappingSpeed.ToString());
            DATA.Subscribe($"{Module}.{Name}.MappingStopPostion", () => MappingStopPostion.ToString());
            DATA.Subscribe($"{Module}.{Name}.MappingTopSlotPostion", () => MappingTopSlotPostion.ToString());
            DATA.Subscribe($"{Module}.{Name}.IsMappingSensorON", () => IsMappingSensorON.ToString());
            DATA.Subscribe($"{Module}.{Name}.MappingWaferResult", () => MappingWaferResult.ToString());
            DATA.Subscribe($"{Module}.{Name}.MappingWidthResult", () => MappingWidthResult.ToString());

            DATA.Subscribe($"{Name}.RobotSpeed", () => CurrentReadSpeedData);
            DATA.Subscribe($"{Name}.CurrentReadRoutine", () => CurrentReadRoutine);
            DATA.Subscribe($"{Name}.CurrentReadSpeedData", () => CurrentReadSpeedData);


            DATA.Subscribe($"{Name}.CurrentReadAData", () => CurrentReadAData);
            DATA.Subscribe($"{Name}.IsVacuumSensorON", () => IsVacuumSensorON);
            DATA.Subscribe($"{Name}.JelC5000RobotStatus", () => JelC5000RobotStatus.ToString());
            DATA.Subscribe($"{Name}.AxisStatus", () => AxisStatus.ToString());
            DATA.Subscribe($"{Name}.CurrentCompoundCommandStatus", () => CurrentCompoundCommandStatus.ToString());
            DATA.Subscribe($"{Name}.ReadCassetNumber", () => ReadCassetNumber.ToString());
            DATA.Subscribe($"{Name}.ReadSlotNumber", () => ReadSlotNumber.ToString());
            DATA.Subscribe($"{Name}.ReadBankNumber", () => ReadBankNumber.ToString());

            DATA.Subscribe($"{Name}.ReadPosXAxisPostion", () => ReadPosXAxisPostion.ToString());
            DATA.Subscribe($"{Name}.ReadPosYAxisPostion", () => ReadPosYAxisPostion.ToString());
            DATA.Subscribe($"{Name}.ReadPosZAxisPostion", () => ReadPosZAxisPostion.ToString());
            DATA.Subscribe($"{Name}.ReadPosThetaAxisPostion", () => ReadPosThetaAxisPostion.ToString());

            DATA.Subscribe($"{Name}.XAxisPostion", () => XAxisPostion.ToString());
            DATA.Subscribe($"{Name}.YAxisPostion", () => YAxisPostion.ToString());
            DATA.Subscribe($"{Name}.ZAxisPostion", () => ZAxisPostion.ToString());
            DATA.Subscribe($"{Name}.ThetaAxisPostion", () => ThetaAxisPostion.ToString());

            DATA.Subscribe($"{Name}.ReadParameterMax", () => ReadParameterMax.ToString());
            DATA.Subscribe($"{Name}.ReadParameterMin", () => ReadParameterMin.ToString());
            DATA.Subscribe($"{Name}.ReadParameterValue", () => ReadParameterValue.ToString());

            DATA.Subscribe($"{Name}.MappingFirstSlotPosition", () => MappingFirstSlotPosition.ToString());
            DATA.Subscribe($"{Name}.MappingGateWidth", () => MappingGateWidth.ToString());
            DATA.Subscribe($"{Name}.MappingMaxDetectWidth", () => MappingMaxDetectWidth.ToString());
            DATA.Subscribe($"{Name}.MappingMinDetectWidth", () => MappingMinDetectWidth.ToString());
            DATA.Subscribe($"{Name}.MappingSlotsNumber", () => MappingSlotsNumber.ToString());
            DATA.Subscribe($"{Name}.MappingSpeed", () => MappingSpeed.ToString());
            DATA.Subscribe($"{Name}.MappingStopPostion", () => MappingStopPostion.ToString());
            DATA.Subscribe($"{Name}.MappingTopSlotPostion", () => MappingTopSlotPostion.ToString());
            DATA.Subscribe($"{Name}.IsMappingSensorON", () => IsMappingSensorON.ToString());
            DATA.Subscribe($"{Name}.MappingWaferResult", () => MappingWaferResult.ToString());
            DATA.Subscribe($"{Name}.MappingWidthResult", () => MappingWidthResult.ToString());



        }

        private void ResetPropertiesAndResponses()
        {
            
        }
        protected override bool fReset(object[] param)
        {
            _trigError.RST = true;

            _connection.SetCommunicationError(false, "");
            _trigCommunicationError.RST = true;

            _enableLog = SC.GetValue<bool>($"{_scRoot}.{Name}.EnableLogMessage");
            _connection.EnableLog(_enableLog);

            _trigRetryConnect.RST = true;

            _lstMonitorHandler.Clear();
            //_lstMonitorHandler.Clear();
            _connection.ForceClear();
            lock (_locker)
            {
                _lstMonitorHandler.AddLast(new JelC5000RobotRawCommandHandler(this, $"RD"));
                _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, ""));
                _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "BC"));     // Read bank number
                _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "WCP"));    // Read Cassette Number
            }
            return true;
        }



        protected override bool fMonitorReset(object[] param)
        {
            IsBusy = false;
            if (JelC5000RobotStatus == JelAxisStatus.NormalEnd
                && (AxisStatus == JelAxisStatus.NormalEnd)
                && _lstMonitorHandler.Count == 0 
                && !_connection.IsBusy)
            {
                IsBusy = false;
                return true;
            }
            if (_lstMonitorHandler.Count == 0 && !_connection.IsBusy)
                _connection.Execute(new JelC5000RobotReadHandler(this, ""));
            return false;
        }
        protected override bool fStartMove(object[] param)
        {
            if (param.Length < 4) return false;
            int axis,intdirect;
            if (!int.TryParse(param[0].ToString(), out axis)) return false;
            if (axis > 4 || axis < 0) return false;
            if (!int.TryParse(param[1].ToString(), out intdirect)) return false;
            if (intdirect > 1 || intdirect < 0) return false;
            RobotMoveDirectionEnum direction = (RobotMoveDirectionEnum)Convert.ToInt16(param[1].ToString());
            uint instance;
            if (!uint.TryParse(param[2].ToString(), out instance)) return false;
            if (instance > 8388607) instance = 8388607;
            string movebasetype = Regex.Replace(param[3].ToString().Replace("（", "(").Replace("）", ")"), @"\([^\(]*\)", "");
            if (movebasetype != "0" && movebasetype != "1") return false;
            string commandstr = "";
            if (movebasetype == "0") commandstr = "3";
            if(movebasetype == "1")
            {
                if (direction == RobotMoveDirectionEnum.Fwd) commandstr = "4";
                else commandstr = "5";
            }
            if (string.IsNullOrEmpty(commandstr)) return false;
            string speedtype = string.Empty;
            if (param.Length > 4) 
                speedtype = Regex.Replace(param[4].ToString().Replace("（", "(").Replace("）", ")"), @"\([^\(]*\)", "");
            
            if (speedtype != "" && speedtype != "M" && speedtype != "L") return false;

            lock (_locker)
            {
                _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "2", instance.ToString()));
                _lstMonitorHandler.AddLast(new JelC5000RobotMoveHandler(this, commandstr + "M", axis.ToString() + speedtype));
                _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, ""));
            }
            return true;
        }
        protected override bool fMonitorMoving(object[] param)
        {
            if (JelC5000RobotStatus == JelAxisStatus.NormalEnd
                && (AxisStatus == JelAxisStatus.NormalEnd)                
                && _lstMonitorHandler.Count == 0
                && !_connection.IsBusy)
            {
                IsBusy = false;
                return true;
            }
            if (_lstMonitorHandler.Count == 0 && !_connection.IsBusy)
                _connection.Execute(new JelC5000RobotReadHandler(this, ""));
            return false;
        }

        
        protected override bool fStartInit(object[] param)
        {
            //string speedtype = string.Empty;
            //if (param != null && param.Length >0)
            //    speedtype = Regex.Replace(param[0].ToString().Replace("（", "(").Replace("）", ")"), @"\([^\(]*\)", "");

            //if (speedtype != "" && speedtype != "M" && speedtype != "L") return false;
            _dtActionStart = DateTime.Now;
            int compaundcmdNO = SC.GetValue<int>($"Robot.{Name}.InitCmdNO");
            int Robotspeed = SC.GetValue<int>($"Robot.{Name}.RobotSpeed");
            if (Robotspeed < 0)
                Robotspeed = 0;
            if (Robotspeed > 99)
                Robotspeed = 99;
            lock (_locker)
            {
                _lstMonitorHandler.AddLast(new JelC5000RobotRawCommandHandler(this, $"RD"));
                _lstMonitorHandler.AddLast(new JelC5000RobotCompaundCommandHandler(this, compaundcmdNO.ToString()));
                _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, ""));
                _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "G"));
                _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, $"CS{_lowerArmWaferSensorIndex}"));
                _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "BC"));     // Read bank number
                _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "WCP"));    // Read Cassette Number
                _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "6", "1"));
                _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "6", "2"));
                _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "6", "3"));
                _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "6", "4"));
                //_lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "6", "X"));
                //_lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "6", "Y"));
                //_lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "6", "U"));
                //_lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "6", "Z"));
                _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "SPA", Robotspeed.ToString()));
                _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "SPA"));
            }
            return true;
        }
        protected override bool fMonitorInit(object[] param)
        {
            IsBusy = false;
            if (DateTime.Now - _dtActionStart > TimeSpan.FromSeconds(RobotCommandTimeout))
            {
                HandlerError("InitTimeout");
                return true;
            }

           
            if (_lstMonitorHandler.Count ==0 && !_connection.IsBusy)
            {
                if (CurrentCompoundCommandStatus == JelCommandStatus.NormalEnd && 
                    JelC5000RobotStatus == JelAxisStatus.NormalEnd
                && AxisStatus == JelAxisStatus.NormalEnd)               
                {
                        Blade1Target = ModuleName.System;
                        Blade2Target = ModuleName.System;



                    CmdTarget = ModuleName.System;
                    MoveInfo = new RobotMoveInfo()
                    {
                        Action = RobotAction.Picking,
                        ArmTarget = CmdRobotArm == RobotArmEnum.Lower ? RobotArm.ArmA : RobotArm.ArmB,
                        BladeTarget = BuildBladeTarget(),
                    };

                    if(IsVacuumSensorON && WaferManager.Instance.CheckNoWafer(RobotModuleName,0))
                    {
                        EV.PostAlarmLog("Robot", $"There's unknown wafer on {RobotModuleName}.");
                        WaferManager.Instance.CreateWafer(RobotModuleName, 0, WaferStatus.Normal);      
                    }

                    if (!IsVacuumSensorON && WaferManager.Instance.CheckHasWafer(RobotModuleName, 0))
                    {
                        EV.PostAlarmLog("Robot", $"There's a wafer on {RobotModuleName} but robot didn't detect.");                       
                    }


                    return true;  
                }
                if (CurrentCompoundCommandStatus != JelCommandStatus.NormalEnd)
                {
                    if (CurrentCompoundCommandStatus == JelCommandStatus.InError)
                    {
                        OnError("Init Compaund command execution error");
                        return false;
                    }                  
                }
            }
            return false;            
        }
        protected override bool fStartReadData(object[] param)
        {
            if(param.Length <1) return false;
            string readcommand = param[0].ToString();
            switch(readcommand)
            {
                case "CurrentStatus":
                    lock (_locker)
                    {
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, ""));
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, $"CS{_lowerArmWaferSensorIndex}"));

                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "G"));      // Read out the compaund command status 
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "BC"));     // Read bank number
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "WCP"));    // Read Cassette Number
                    }

                    break;
                case "CurrentPositionData":
                    lock(_locker)
                    {
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "6", "1"));
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "6", "2"));
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "6", "3"));
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "6", "4"));
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "6", "X"));
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "6", "Y"));
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "6", "U"));
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "6", "Z"));
                    }
                    break;
                case "CompaundCommand":
                    if (param.Length < 3) return false;
                    string routineselction = param[1].ToString();                    
                    if(routineselction == "MainRoutine")
                    {
                        int routineno;
                        if (!int.TryParse(param[2].ToString(), out routineno)) return false;
                        if (routineno > 319 || routineno < 1) return false;
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "IR",routineno.ToString().PadLeft(3,'0')));
                    }
                    if (routineselction == "SubRoutine")
                    {
                        char routineno;
                        if (!char.TryParse(param[2].ToString(), out routineno)) return false;
                        if (routineno > 'F' || routineno < 1) return false;
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "IRS", routineno.ToString()));
                    }
                    break;
                case "RobotSpeed":                    
                    _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "SPA"));
                    break;
                case "AData":
                    if (param.Length < 2) return false;
                    int datano;
                    if (!int.TryParse(param[1].ToString(), out datano)) return false;
                    if (datano < 0 || datano > 999) return false;
                    lock(_locker)
                    {
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "A", datano.ToString("D3")+"D"));
                    }
                    break;
                case "EPData":
                    if (param.Length < 2) return false;
                    if (param[1].ToString() == "AData")
                    {
                        lock (_locker)
                        {
                            _lstMonitorHandler.AddLast(new JelC5000RobotRawCommandHandler (this, $"AL"));
                        }
                    }
                    break;
                case "PositionData":
                    if (param.Length < 2) return false;
                    int posNO;
                    if (!int.TryParse(param[1].ToString(), out posNO)) return false;
                    if (posNO > 999 || posNO < 0) return false;
                    lock (_locker)
                    {
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "PSD", posNO.ToString("D3")));
                    }
                    break;
                case "RobotParameter":
                    if (param.Length < 2) return false;
                    uint parano;
                    if(!uint.TryParse(param[1].ToString(), out parano)) return false;
                    lock(_locker)
                    {
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "DTD", parano.ToString()));
                    }
                    break;
                case "MappingData":
                    lock(_locker)
                    {
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "WLO"));
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "WHI"));
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "WFC"));
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "WWN"));
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "WWM"));
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "WWG"));
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "WEND"));
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "WSP"));
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "WFK"));
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "WFW"));
                    }
                    break;

            }
            return true;


        }
        protected override bool fMonitorReadData(object[] param)
        {
            if (_lstMonitorHandler.Count == 0 && !_connection.IsBusy)
            {
                IsBusy = false;
                return true;
            }
            return false;
        }
        protected override bool fStartSetParameters(object[] param)
        {
            try 
            { 
            
            string setcommand = param[0].ToString();
                switch (setcommand)
                {
                    case "CompaundCommand":
                        if (param.Length < 4) return false;
                        string routineselction = param[1].ToString();
                        if (routineselction == "MainRoutine")
                        {
                            int routineno;
                            if (!int.TryParse(param[2].ToString(), out routineno)) return false;
                            if (routineno > 319 || routineno < 1) return false;
                            _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "I", routineno.ToString().PadLeft(3, '0')));
                            _lstMonitorHandler.AddLast(new JelC5000RobotRawCommandHandler(this, param[3].ToString()));

                        }
                        if (routineselction == "SubRoutine")
                        {
                            char routineno;
                            if (!char.TryParse(param[2].ToString(), out routineno)) return false;
                            if (routineno > 'F' || routineno < 1) return false;
                            _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "IS", routineno.ToString()));
                            _lstMonitorHandler.AddLast(new JelC5000RobotRawCommandHandler(this, param[3].ToString()));

                        }
                        break;
                    case "RobotSpeed":
                        //if (param.Length < 3) return false;
                        //string speedtype = param[1].ToString().Split('(')[0];
                        //Int32 speedvalue;
                        //if (!Int32.TryParse(param[2].ToString(), out speedvalue)) return false;
                        //_lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "O" + speedtype, speedvalue.ToString().PadLeft(5, '0')));
                        Int32 speedvalue;
                        if (!Int32.TryParse(param[2].ToString(), out speedvalue)) return false;

                        if(SC.ContainsItem($"Robot.{RobotModuleName}.RobotSpeed"))
                        {
                            SC.SetItemValue($"Robot.{RobotModuleName}.RobotSpeed", speedvalue);
                        }


                        if (speedvalue < 0)
                            speedvalue = 0;
                        if (speedvalue > 99)
                            speedvalue = 99;
                        _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "SPA" , speedvalue.ToString()));
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "SPA"));

                        break;

                    case "AData":
                        if (param.Length < 3) return false;
                        Int32 datano, datavalue;
                        if (!Int32.TryParse(param[1].ToString(), out datano)) return false;
                        if (!Int32.TryParse(param[2].ToString(), out datavalue)) return false;
                        if (datano > 999 || datano < 0) return false;
                        if (datavalue > 8388607 || datavalue < -8388608) return false;
                        lock (_locker)
                        {
                            _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "A", datano.ToString("D3") + datavalue.ToString()));
                        }
                        break;
                    case "EPData":
                        if (param.Length < 2) return false;
                        if (param[1].ToString() == "AData")
                        {
                            lock (_locker)
                            {
                                _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "AW"));
                            }
                        }
                        break;
                    case "PositionData":
                        if (param.Length < 6) return false;
                        Int32 posno, rightarmpos, thetapos, leftarmpos, zpos;
                        if (!Int32.TryParse(param[1].ToString(), out posno)) return false;
                        if (!Int32.TryParse(param[2].ToString(), out rightarmpos)) return false;
                        if (!Int32.TryParse(param[3].ToString(), out thetapos)) return false;
                        if (!Int32.TryParse(param[4].ToString(), out leftarmpos)) return false;
                        if (!Int32.TryParse(param[5].ToString(), out zpos)) return false;
                        if (posno > 999 || posno < 0) return false;
                        lock (_locker)
                        {
                            _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "PS",
                                $"{posno.ToString("D3")}{rightarmpos},{thetapos},{leftarmpos},{zpos}"));
                        }
                        return true;
                    case "CurrentPositionData":
                        Int32 currentpos = Int32.Parse(param[1].ToString());
                        if (currentpos > 999 || currentpos < 0) return false;
                        lock (_locker)
                        {
                            _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "PS",
                                $"{currentpos.ToString("D3")}"));
                        }
                        break;

                    case "RobotParameter":
                        if (param.Length < 3) return false;
                        Int32 parano, paravalue;
                        if (!Int32.TryParse(param[1].ToString(), out parano)) return false;
                        if (!Int32.TryParse(param[2].ToString(), out paravalue)) return false;
                        lock (_locker)
                        {
                            _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "DTSVAL", $"{parano},{paravalue}"));
                            _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "DW"));
                        }
                        break;

                    case "MappingData":
                        lock(_locker)
                        {
                            
                            if (!string.IsNullOrEmpty(param[1].ToString()))
                            {
                                float tempvalue = float.Parse(param[1].ToString());
                                string strtempvalue;
                                if (tempvalue <0)
                                {
                                    strtempvalue = "-" +(-tempvalue).ToString().PadLeft(7, '0');
                                }
                                else
                                    strtempvalue = tempvalue.ToString().PadLeft(8, '0');
                                _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "WLO",strtempvalue));
                            }

                            if (!string.IsNullOrEmpty(param[2].ToString()))
                            {
                                float tempvalue = float.Parse(param[2].ToString());
                                string strtempvalue;
                                if (tempvalue < 0)
                                {
                                    strtempvalue = "-" + (-tempvalue).ToString().PadLeft(7, '0');
                                }
                                else
                                    strtempvalue = tempvalue.ToString().PadLeft(8, '0');
                                _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "WHI",strtempvalue));
                            }

                            if (!string.IsNullOrEmpty(param[3].ToString()))
                                _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "WFC",
                                    (Convert.ToInt16(param[3].ToString()).ToString("D2"))));

                            if (!string.IsNullOrEmpty(param[4].ToString()))
                            {
                                float tempvalue = float.Parse(param[4].ToString());
                                string strtempvalue;
                                if (tempvalue < 0)
                                {
                                    strtempvalue = "-" + (-tempvalue).ToString().PadLeft(7, '0');
                                }
                                else
                                    strtempvalue = tempvalue.ToString().PadLeft(8, '0');
                                _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "WWN", strtempvalue));
                            }

                            if (!string.IsNullOrEmpty(param[5].ToString()))
                            {
                                float tempvalue = float.Parse(param[5].ToString());
                                string strtempvalue;
                                if (tempvalue < 0)
                                {
                                    strtempvalue = "-" + (-tempvalue).ToString().PadLeft(7, '0');
                                }
                                else
                                    strtempvalue = tempvalue.ToString().PadLeft(8, '0');
                                _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "WWM", strtempvalue));
                            }

                            if (!string.IsNullOrEmpty(param[6].ToString()))
                            {
                                float tempvalue = float.Parse(param[6].ToString());
                                string strtempvalue;
                                if (tempvalue < 0)
                                {
                                    strtempvalue = "-" + (-tempvalue).ToString().PadLeft(7, '0');
                                }
                                else
                                    strtempvalue = tempvalue.ToString().PadLeft(8, '0');
                                _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "WWG", strtempvalue));
                            }

                            if (!string.IsNullOrEmpty(param[7].ToString()))
                            {
                                float tempvalue = float.Parse(param[7].ToString());
                                string strtempvalue;
                                if (tempvalue < 0)
                                {
                                    strtempvalue = "-" + (-tempvalue).ToString().PadLeft(7, '0');
                                }
                                else
                                    strtempvalue = tempvalue.ToString().PadLeft(8, '0');
                                _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "WEND", strtempvalue));
                            }

                            if (!string.IsNullOrEmpty(param[8].ToString()))
                            {
                                float tempvalue = float.Parse(param[8].ToString());
                                string strtempvalue;
                                if (tempvalue < 0)
                                {
                                    strtempvalue = "-" + (-tempvalue).ToString().PadLeft(7, '0');
                                }
                                else
                                    strtempvalue = tempvalue.ToString().PadLeft(8, '0');
                                _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "WSP", strtempvalue));
                            }

                        }
                        break;
                    case "MappingCommand":
                        lock(_locker)
                        {
                            //_lstMonitorHandler.AddLast(new JelC5000RobotMoveHandler(this, "WFS"));
                            //_lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "WFK"));
                            //_lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "WFW"));
                        }
                        break;
                    case "BankNumber":
                        lock (_locker)
                        {
                            if (param.Length > 1 && !string.IsNullOrEmpty(param[1].ToString()))
                            {
                                int bankno = Convert.ToInt16(param[1].ToString());
                                if (bankno <= 15 && bankno >= 0)
                                    _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "BC", bankno.ToString("X")));
                            }
                            if (param.Length > 2 && !string.IsNullOrEmpty(param[2].ToString()))
                            {
                                int cassetteno = Convert.ToInt16(param[2].ToString());
                                if (cassetteno <=5 && cassetteno <= 1) 
                                    _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "WCP", cassetteno.ToString()));
                            }
                            if (param.Length > 3 && !string.IsNullOrEmpty(param[3].ToString()))
                            {
                                int slotno = Convert.ToInt16(param[3].ToString());
                                if (slotno <= 25 && slotno >= 1)
                                    _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "WCD", slotno.ToString()));
                            }
                            _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "BC"));
                            _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "WCP"));
                        }
                        break;
                }
            }
            catch (Exception )
            {
                string reason = "";
                if(param!=null)
                {
                    foreach(var para in param)
                    {
                        reason += para.ToString() + ",";
                    }
                }
                EV.PostAlarmLog(Name, "Set command parameter valid:" + reason);
                return false;
            }
            return true;



        }
        protected override bool fMonitorSetParamter(object[] param)
        {
            if (_lstMonitorHandler.Count == 0 && !_connection.IsBusy)
            {
                IsBusy = false;
                return true;
            }

            return base.fMonitorSetParamter(param);
        }


        public override bool IsReady()
        {
            return RobotState == RobotStateEnum.Idle && !IsBusy;
        }

        protected override bool fClear(object[] param)
        {
            return true;
        }     

        protected override bool fStartTransferWafer(object[] param)
        {
            return false;
        }

        protected override bool fStartUnGrip(object[] param)
        {
            if (param == null || param.Length < 1) return false;
            RobotArmEnum arm = (RobotArmEnum)((int)param[0]);
            lock (_locker)
            {               
                _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "DS", "10"));
                _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, ""));
            }
            return true;

        }
        protected override bool fMonitorUnGrip(object[] param)
        {
            IsBusy = false;

            if (_lstMonitorHandler.Count == 0 && !_connection.IsBusy)
            {
                if (JelC5000RobotStatus != JelAxisStatus.NormalEnd
                || AxisStatus != JelAxisStatus.NormalEnd)
                {
                    lock (_locker)
                    {
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, ""));
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, $"CS{_lowerArmWaferSensorIndex}"));
                    }
                    return false;
                }
                RobotArmEnum arm = (RobotArmEnum)((int)CurrentParamter[0]);
                //if(IsVacuumSensorON)
                //    HandlerError("UnGrip wafer failed!");  
                    IsBusy = false;
                    return true;                
            }
            return false;
        }

        protected override bool fStartGrip(object[] param)
        {            
            if(param == null || param.Length <1) return false;

            RobotArmEnum arm = (RobotArmEnum)((int)param[0]);
            lock (_locker)
            {
                _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "DS", "11"));
                _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, ""));

            }
            return true;
        }
        protected override bool fMonitorGrip(object[] param)
        {
            IsBusy = false;
            if (_lstMonitorHandler.Count == 0 && !_connection.IsBusy)
            {
                if (JelC5000RobotStatus != JelAxisStatus.NormalEnd
                || AxisStatus != JelAxisStatus.NormalEnd)
                {
                    lock (_locker)
                    {
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, ""));
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, $"CS{_lowerArmWaferSensorIndex}"));
                    }
                    return false;
                }
                //if (!IsVacuumSensorON)
                //    HandlerError("UnGrip wafer failed!");

                IsBusy = false;
                return true;           
            }
                
            return false;
        }
        protected override bool fStop(object[] param)
        {
            IsBusy = false;
            _lstMonitorHandler.Clear();            
            _connection.ForceClear();
            _connection.Execute(new JelC5000RobotSetHandler(this, "S"));
            _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "GE"));
            return ReadStatus();
            
        }

        protected override bool fStartGoTo(object[] param)
        {
            try
            {
                _dtActionStart = DateTime.Now;
                RobotArmEnum arm = (RobotArmEnum)param[0];
                ModuleName tempmodule = (ModuleName)Enum.Parse(typeof(ModuleName), param[1].ToString());
                BladeTarget = tempmodule;
                Blade1Target = tempmodule;
                Blade2Target = tempmodule;
                int slot = (int)param[2] + 1;
                RobotPostionEnum postype = (RobotPostionEnum)param[3];

                var wz = WaferManager.Instance.GetWaferSize(RobotModuleName, (int)arm);
                if (!GetBankAndCassetteNumber(tempmodule, wz, out int bankno, out int cassetteNO))
                {
                    EV.PostAlarmLog("Robot", $"{RobotModuleName} can't find the bankno or cassette no for {tempmodule}");
                    OnError("ParseStationError");
                    return false;
                }

                //int wzindex = 0;
                //if (wz == WaferSize.WS12) wzindex = 12;
                //if (wz == WaferSize.WS8) wzindex = 8;
                //if (wz == WaferSize.WS6) wzindex = 6;
                //if (wz == WaferSize.WS5) wzindex = 5;
                //if (wz == WaferSize.WS4) wzindex = 4;
                //if (wz == WaferSize.WS3) wzindex = 3;
                //if (wz == WaferSize.WS2) wzindex = 2;

                //if (ModuleHelper.IsLoadPort(tempmodule))
                //{
                //    var lp = DEVICE.GetDevice<LoadPortBaseDevice>(tempmodule.ToString());
                //    if (lp != null) lp.NoteTransferStart();
                //    wzindex = lp.InfoPadCarrierIndex;
                //}
                //int bankno = SC.GetValue<int>($"CarrierInfo.{tempmodule}BankNumber{wzindex}");
                //int cassetteNO = SC.GetValue<int>($"CarrierInfo.{tempmodule}CassetteNumber{wzindex}");
                int compaundcmdNO = SC.GetValue<int>($"Robot.{Name}.{arm}Goto{postype}CmdNO");
                int compaundcmdNOforSafe = SC.GetValue<int>($"Robot.{Name}.SafeCmdNO");


                lock (_locker)
                {
                    if (ResetBeforeCmd)
                        _lstMonitorHandler.AddLast(new JelC5000RobotRawCommandHandler(this, $"RD"));
                    if (compaundcmdNOforSafe!=0 &&
                        (ReadBankNumber != bankno.ToString("X") || cassetteNO != ReadCassetNumber))
                    {
                        _lstMonitorHandler.AddLast(new JelC5000RobotCompaundCommandHandler(this, compaundcmdNOforSafe.ToString()));
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "G"));
                    }
                    _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "BC", bankno.ToString("X")));
                    _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "WCP", cassetteNO.ToString()));
                    _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "WCD", slot.ToString()));
                    _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "BC"));
                    _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "WCP"));
                    _lstMonitorHandler.AddLast(new JelC5000RobotCompaundCommandHandler(this, compaundcmdNO.ToString()));
                    _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "G"));
                }

                Blade1Target = tempmodule;
                Blade2Target = tempmodule;


                CmdTarget = tempmodule;
                MoveInfo = new RobotMoveInfo()
                {
                    Action = RobotAction.Picking,
                    ArmTarget = CmdRobotArm == RobotArmEnum.Lower ? RobotArm.ArmA : RobotArm.ArmB,
                    BladeTarget = BuildBladeTarget(),
                };





                return true;
            }
            catch (Exception ex)
            {
                LOG.Write(ex);
                return false;
            }
        }

        protected override bool fMonitorGoTo(object[] param)
        {
            IsBusy = false;
            if (DateTime.Now - _dtActionStart > TimeSpan.FromSeconds(RobotCommandTimeout))
            {
                OnError("Robot Goto timeout");
                return true;
            }
            if (_lstMonitorHandler.Count == 0 && !_connection.IsBusy)
            {
                if (CurrentCompoundCommandStatus == JelCommandStatus.NormalEnd)
                {
                    RobotArmEnum arm = (RobotArmEnum)CurrentParamter[0];
                    ModuleName tempmodule = (ModuleName)Enum.Parse(typeof(ModuleName), CurrentParamter[1].ToString());

                 
                    Blade1Target = tempmodule;
                    Blade2Target = tempmodule;


                    IsBusy = false;

                    CmdTarget = tempmodule;
                    MoveInfo = new RobotMoveInfo()
                    {
                        Action = RobotAction.Moving,
                        ArmTarget = CmdRobotArm == RobotArmEnum.Lower ? RobotArm.ArmA : RobotArm.ArmB,
                        BladeTarget = BuildBladeTarget(),
                    };


                    return true;

                }

                if (CurrentCompoundCommandStatus == JelCommandStatus.InError)
                {
                    _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "GER"));
                    HandlerError("GoToFailed");
                }

            }
            return false;
        }

        protected override bool fStartMapWafer(object[] param)
        {
            try
            {
                _dtActionStart = DateTime.Now;
                ModuleName tempmodule = (ModuleName)Enum.Parse(typeof(ModuleName), param[0].ToString());


                //int carrierindex = 0;

                if (ModuleHelper.IsLoadPort(tempmodule))
                {
                    LoadPortBaseDevice lp = DEVICE.GetDevice<LoadPortBaseDevice>(tempmodule.ToString());

                    if (lp != null)
                        lp.NoteTransferStart();
                    //carrierindex = lp.InfoPadCarrierIndex;
                }
                WaferSize wz = WaferManager.Instance.GetWaferSize(tempmodule, 0);
                if (!GetBankAndCassetteNumber(tempmodule, wz, out int bankno, out int cassetteNO))
                {
                    EV.PostAlarmLog("Robot", $"{RobotModuleName} can't find the bankno or cassette no for {tempmodule}");
                    OnError("ParseStationError");
                    return false;
                }


                //else
                //{
                //    WaferSize wz = WaferManager.Instance.GetWaferSize(tempmodule, 0);
                //    if (param.Length >= 3)
                //    {
                //        wz = (WaferSize)Enum.Parse(typeof(WaferSize), param[2].ToString());
                //    }
                //    if (wz == WaferSize.WS12) carrierindex = 12;
                //    if (wz == WaferSize.WS8) carrierindex = 8;
                //    if (wz == WaferSize.WS6) carrierindex = 6;
                //    if (wz == WaferSize.WS4) carrierindex = 4;
                //    if (wz == WaferSize.WS3) carrierindex = 3;                    
                //}
                //int bankno = SC.GetValue<int>($"CarrierInfo.{tempmodule}BankNumber{carrierindex}");
                //int cassetteNO = SC.GetValue<int>($"CarrierInfo.{tempmodule}CassetteNumber{carrierindex}");


                int compaundcmdNO = SC.GetValue<int>($"Robot.{Name}.MapCmdNO");

                lock (_locker)
                {
                    _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "BC", bankno.ToString("X")));
                    _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "WCP", cassetteNO.ToString()));
                    _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "WCD", "1"));
                    _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "BC"));
                    _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "WCP"));
                    _lstMonitorHandler.AddLast(new JelC5000RobotRawCommandHandler(this, $"RD"));


                }
                DateTime readstarttime = DateTime.Now;
                while (_lstMonitorHandler.Count != 0 || _connection.IsBusy)
                {
                    if (DateTime.Now - readstarttime > TimeSpan.FromSeconds(20))
                    {
                        OnError("Set Timeout.");
                        return false;
                    }
                }
                if (ReadBankNumber != bankno.ToString("X") || cassetteNO != ReadCassetNumber)
                {
                    OnError("Set data failed.");
                    return false;
                }
                lock (_locker)
                {
                    _lstMonitorHandler.AddLast(new JelC5000RobotCompaundCommandHandler(this, compaundcmdNO.ToString()));
                    _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "G"));
                    _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "WFK"));
                    _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "WFW"));
                }
            }
            catch (Exception ex)
            {
                string reason = "";
                if (param != null)
                    foreach (var strpara in param)
                        reason += strpara.ToString();
                OnError($"{Name} Map command valid:" + reason);
                LOG.Write(ex);
                return false;
            }
            return true;

        }

        protected override bool fMonitorMap(object[] param)
        {
            IsBusy = false;
            //return true;
            if (_lstMonitorHandler.Count == 0 && !_connection.IsBusy)
            {
                //RobotArmEnum arm = (RobotArmEnum)CurrentParamter[0];
                ModuleName sourcemodule;
                if (!Enum.TryParse(CurrentParamter[0].ToString(), out sourcemodule)) return false;

                if (ModuleHelper.IsLoadPort(sourcemodule))
                {
                    //LoadPortBaseDevice lp = DEVICE.GetDevice<LoadPortBaseDevice>(sourcemodule.ToString());
                    //if (lp != null && !lp.NoteTransferStop())
                    //    return false;                   
                }
                IsBusy = false;
                return true;

            }
            return false;
        }

        protected override bool fStartSwapWafer(object[] param)
        {
            return false;
           
        }
        protected DateTime _dtActionStart;
        protected override bool fMonitorSwap(object[] param)
        {
            if (_lstMonitorHandler.Count == 0 && !_connection.IsBusy)
            {
                if (CurrentCompoundCommandStatus == JelCommandStatus.NormalEnd)
                {
                    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;
                    if (arm == RobotArmEnum.Lower)
                    {
                        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);
                    }
                    if (arm == RobotArmEnum.Both)
                    {
                        
                    }
                    
                        IsBusy = false;
                        return true;
                    
                }
                if (CurrentCompoundCommandStatus == JelCommandStatus.InExecution ||
                    CurrentCompoundCommandStatus == JelCommandStatus.None)
                {
                    _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "G"));
                }
                if (CurrentCompoundCommandStatus == JelCommandStatus.InError)
                {
                    _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "GER"));
                    OnError("Compaund Comand execution failed");
                }
            }

            return false;
        }

        protected override bool fStartPlaceWafer(object[] param)
        {
            _dtActionStart = DateTime.Now;
            try
            {
                RobotArmEnum arm = (RobotArmEnum)param[0];
                ModuleName tempmodule = (ModuleName)Enum.Parse(typeof(ModuleName), param[1].ToString());

                int slotindex = int.Parse(param[2].ToString());

                var wz = WaferManager.Instance.GetWaferSize(RobotModuleName, arm == RobotArmEnum.Both ? 0 : (int)arm);
                if (!GetBankAndCassetteNumber(tempmodule, wz, out int bankno, out int cassetteNO))
                {
                    EV.PostAlarmLog("Robot", $"{RobotModuleName} can't find the bankno or cassette no for {tempmodule}");
                    OnError("ParseStationError");
                    return false;
                }

                //int wzindex = 0;
                //if (wz == WaferSize.WS12) wzindex = 12;
                //if (wz == WaferSize.WS8) wzindex = 8;
                //if (wz == WaferSize.WS6) wzindex = 6;
                //if (wz == WaferSize.WS5) wzindex = 5;
                //if (wz == WaferSize.WS4) wzindex = 4;
                //if (wz == WaferSize.WS3) wzindex = 3;
                //if (wz == WaferSize.WS2) wzindex = 2;
                //if (ModuleHelper.IsLoadPort(tempmodule))
                //{
                //    var lp = DEVICE.GetDevice<LoadPortBaseDevice>(tempmodule.ToString());
                //    if (lp != null)
                //        lp.NoteTransferStart();
                //    wzindex = DEVICE.GetDevice<LoadPortBaseDevice>(tempmodule.ToString()).InfoPadCarrierIndex;

                //}
                //int bankno = SC.GetValue<int>($"CarrierInfo.{tempmodule}BankNumber{wzindex}");
                //int cassetteNO = SC.GetValue<int>($"CarrierInfo.{tempmodule}CassetteNumber{wzindex}");
                int compaundcmdNO = SC.GetValue<int>($"Robot.{Name}.PlaceCmdNO");
                int compaundcmdNOforSafe = SC.GetValue<int>($"Robot.{Name}.SafeCmdNO");

                if (ModuleHelper.IsAligner(tempmodule))
                {
                    if (SC.ContainsItem($"Robot.{Name}.PlaceAtAlignerCmdNO"))
                    {
                        compaundcmdNO = SC.GetValue<int>($"Robot.{Name}.PlaceAtAlignerCmdNO");
                    }
                }

                lock (_locker)
                {
                    if(ResetBeforeCmd)
                        _lstMonitorHandler.AddLast(new JelC5000RobotRawCommandHandler(this, $"RD"));
                    if (compaundcmdNOforSafe!=0 &&
                        (ReadBankNumber != bankno.ToString("X") || cassetteNO != ReadCassetNumber))
                    {
                        _lstMonitorHandler.AddLast(new JelC5000RobotCompaundCommandHandler(this, compaundcmdNOforSafe.ToString()));
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "G"));
                    }
                    if(ReadBankNumber != bankno.ToString("X"))
                        _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "BC", bankno.ToString("X")));
                    _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "WCP", cassetteNO.ToString()));
                    _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "WCD", (slotindex+1).ToString()));
                    //_lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "BC"));
                    //_lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "WCP"));               
                    _lstMonitorHandler.AddLast(new JelC5000RobotCompaundCommandHandler(this, compaundcmdNO.ToString()));
                    _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "G"));
                    _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, $"CS{_lowerArmWaferSensorIndex}"));
                }
                Blade1Target = tempmodule;
                Blade2Target = tempmodule;
                CmdTarget = tempmodule;

                MoveInfo = new RobotMoveInfo()
                {
                    Action = RobotAction.Placing,
                    ArmTarget = RobotArm.Both,  // CmdRobotArm == RobotArmEnum.Lower ? RobotArm.ArmA : RobotArm.ArmB,
                    BladeTarget = BuildBladeTarget(),
                };
            }
            catch (Exception ex)
            {
                string reason = "";
                if (param != null)
                    foreach (var strpara in param)
                        reason += strpara.ToString();
                OnError($"{Name} Pick command valid:" + reason);
                LOG.Write(ex);
                return false;
            }
            return true;
        }

        protected override bool fStartPickWafer(object[] param)
        {
            _dtActionStart = DateTime.Now;
            try
            {
                ModuleName tempmodule = (ModuleName)Enum.Parse(typeof(ModuleName), param[1].ToString());
                
                int slotindex = int.Parse(param[2].ToString());          

                var wz = WaferManager.Instance.GetWaferSize(tempmodule, slotindex);

                if(!GetBankAndCassetteNumber(tempmodule,wz,out int bankno,out int cassetteNO))
                {
                    EV.PostAlarmLog("Robot", $"{RobotModuleName} can't find the bankno or cassette no for {tempmodule}");
                    OnError("ParseStationError");
                    return false;
                }

                //int wzindex = 0;
                //if (wz == WaferSize.WS12) wzindex = 12;
                //if (wz == WaferSize.WS8) wzindex = 8;
                //if (wz == WaferSize.WS6) wzindex = 6;
                //if (wz == WaferSize.WS5) wzindex = 5;
                //if (wz == WaferSize.WS4) wzindex = 4;
                //if (wz == WaferSize.WS3) wzindex = 3;
                //if (wz == WaferSize.WS2) wzindex = 2;
                
                //if (ModuleHelper.IsLoadPort(tempmodule))
                //{
                //    var lp = DEVICE.GetDevice<LoadPortBaseDevice>(tempmodule.ToString());
                //    if (lp != null) lp.NoteTransferStart();
                //    wzindex = lp.InfoPadCarrierIndex;
                //}

                //int bankno = SC.GetValue<int>($"CarrierInfo.{tempmodule}BankNumber{wzindex}");
                //int cassetteNO = SC.GetValue<int>($"CarrierInfo.{tempmodule}CassetteNumber{wzindex}");
                
                
                
                int compaundcmdNO = SC.GetValue<int>($"Robot.{Name}.PickCmdNO");
                if(ModuleHelper.IsAligner(tempmodule))
                {
                    if(SC.ContainsItem($"Robot.{Name}.PickAtAlignerCmdNO"))
                    {
                        compaundcmdNO = SC.GetValue<int>($"Robot.{Name}.PickAtAlignerCmdNO");
                    }
                }

                int compaundcmdNOforSafe = SC.GetValue<int>($"Robot.{Name}.SafeCmdNO");
                //lock (_locker)
                //{
                //    _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "BC"));
                //    _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "WCP"));
                //}
                //DateTime readstarttime = DateTime.Now;
                //while (_lstMonitorHandler.Count != 0 || _connection.IsBusy)
                //{
                //    if (DateTime.Now - readstarttime > TimeSpan.FromSeconds(20))
                //    {
                //        OnError("Read bankno and cassette no for pick Timeout.");
                //        return false;
                //    }
                //}
                
               lock (_locker)
               {
                    if (ResetBeforeCmd)
                        _lstMonitorHandler.AddLast(new JelC5000RobotRawCommandHandler(this, $"RD"));
                    if (compaundcmdNOforSafe!=0
                        &&(ReadBankNumber != bankno.ToString("X") || cassetteNO != ReadCassetNumber))
                    {
                        _lstMonitorHandler.AddLast(new JelC5000RobotCompaundCommandHandler(this, compaundcmdNOforSafe.ToString()));
                        _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "G"));
                    }
                    _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "BC", bankno.ToString("X")));
                    _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "WCP", cassetteNO.ToString()));
                    _lstMonitorHandler.AddLast(new JelC5000RobotSetHandler(this, "WCD", (slotindex+1).ToString()));
                    //_lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "BC"));
                    //_lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "WCP"));
                    _lstMonitorHandler.AddLast(new JelC5000RobotCompaundCommandHandler(this,compaundcmdNO.ToString()));
                    _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "G"));
                    _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, $"CS{_lowerArmWaferSensorIndex}"));

                    
                }
                Blade1Target = tempmodule;
                Blade2Target = tempmodule;


                CmdTarget = tempmodule;
                MoveInfo = new RobotMoveInfo()
                {
                    Action = RobotAction.Picking,
                    ArmTarget = CmdRobotArm == RobotArmEnum.Lower ? RobotArm.ArmA : RobotArm.ArmB,
                    BladeTarget = BuildBladeTarget(),
                };
            }
            catch (Exception ex)
            {
                string reason =  "";
                if (param != null)
                {
                    foreach (var strpara in param)
                        reason += strpara.ToString();
                }
                LOG.Write(ex);
                OnError($"{Name} Pick command valid:" + reason);
                
                return false;
            }

            return true;
        }
        protected override bool fMonitorPlace(object[] param)
        {
            IsBusy = false;
            if(DateTime.Now - _dtActionStart > TimeSpan.FromSeconds(RobotCommandTimeout))
            {
                OnError("Place wafer timeout");
                return true;
            }
           
            if (_lstMonitorHandler.Count == 0 && !_connection.IsBusy)
            {
                if (CurrentCompoundCommandStatus == JelCommandStatus.NormalEnd)
                {
                    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;

                    if (IsVacuumSensorON)
                    {
                        OnError("Vacuum sensor on blade is ON");
                        return false;
                    }
                    if (arm == RobotArmEnum.Lower)
                        WaferManager.Instance.WaferMoved(RobotModuleName, 0, sourcemodule, Sourceslotindex);
                    if (arm == RobotArmEnum.Upper)
                        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);
                    }
                    Blade1Target = ModuleName.System;
                    Blade2Target = ModuleName.System;

                    if (ModuleHelper.IsLoadPort(sourcemodule))
                    {
                        var lp = DEVICE.GetDevice<LoadPortBaseDevice>(sourcemodule.ToString());
                        if (lp != null)
                            lp.NoteTransferStop();
                    }

                    IsBusy = false;

                    CmdTarget = ModuleName.System;
                    MoveInfo = new RobotMoveInfo()
                    {
                        Action = RobotAction.Picking,
                        ArmTarget = CmdRobotArm == RobotArmEnum.Lower ? RobotArm.ArmA : RobotArm.ArmB,
                        BladeTarget = BuildBladeTarget(),
                    };








                    return true;
                    
                }   
                
                if (CurrentCompoundCommandStatus == JelCommandStatus.InError)
                {
                    _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "GER"));
                    HandlerError("PlaceFailed");
                }
             
            }
            return false;
        }
        protected override bool fMonitorPick(object[] param)
        {
            IsBusy = false;
            if (DateTime.Now - _dtActionStart > TimeSpan.FromSeconds(RobotCommandTimeout))
            {
                OnError("Pick wafer timeout");
                return true;
            }
            if (_lstMonitorHandler.Count == 0 && !_connection.IsBusy)
            {
                if (CurrentCompoundCommandStatus == JelCommandStatus.NormalEnd)
                {
                    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;

                    if(!IsVacuumSensorON)
                    {
                        OnError("Vacuum sensor is not ON");
                        return false;
                    }

                    if (arm == RobotArmEnum.Lower)
                         WaferManager.Instance.WaferMoved(sourcemodule, SourceslotIndex, RobotModuleName, 0);
                    if (arm == RobotArmEnum.Upper)
                        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);
                    }
                    Blade1Target = ModuleName.System;
                    Blade2Target = ModuleName.System;

                    if (ModuleHelper.IsLoadPort(sourcemodule))
                    {
                        var lp = DEVICE.GetDevice<LoadPortBaseDevice>(sourcemodule.ToString());
                        if (lp != null)
                            lp.NoteTransferStop();
                    }
                    IsBusy = false;


                    CmdTarget = ModuleName.System;
                    MoveInfo = new RobotMoveInfo()
                    {
                        Action = RobotAction.Picking,
                        ArmTarget = CmdRobotArm == RobotArmEnum.Lower ? RobotArm.ArmA : RobotArm.ArmB,
                        BladeTarget = BuildBladeTarget(),
                    };



                    return true;
                    
                }
                

                if(CurrentCompoundCommandStatus == JelCommandStatus.InError)
                {
                    _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "GER"));
                    OnError("Compaund Comand execution failed");
                }
                else
                {
                    _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "G"));
                    _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, $"CS{_lowerArmWaferSensorIndex}"));
                }
                
            }
            return false;
        }

        protected override bool fStartExecuteCommand(object[] param)
        {
            string command = param[0].ToString();
            if (string.IsNullOrEmpty(command))
                return false;
            lock(_locker)
            {
                _lstMonitorHandler.AddLast(new JelC5000RobotRawCommandHandler(this, command));
            }
            _dtActionStart = DateTime.Now;
            return true;
        }

        protected override bool fMonitorExecuting(object[] param)
        {
            IsBusy = false;
            if (DateTime.Now - _dtActionStart > TimeSpan.FromSeconds(RobotCommandTimeout))
            {
                OnError("Command execution timeout");
                return true;
            }
            if (_lstMonitorHandler.Count == 0 && !_connection.IsBusy)
                return true;

            return false;
        }

        protected override bool fResetToReady(object[] param)
        {
            return true;
        }

        

        protected override bool fError(object[] param)
        {
            return true;
        }

        protected override bool fStartExtendForPick(object[] param)
        {
            return true;
        }

        protected override bool fStartExtendForPlace(object[] param)
        {
            return true;
        }

        protected override bool fStartRetractFromPick(object[] param)
        {
            return true;
        }

        protected override bool fStartRetractFromPlace(object[] param)
        {
            return true;
        }

        public override RobotArmWaferStateEnum GetWaferState(RobotArmEnum arm)
        {
            bool ispresent = WaferManager.Instance.CheckHasWafer(RobotModuleName, 0);
            if (ispresent) return RobotArmWaferStateEnum.Present;
            return RobotArmWaferStateEnum.Absent;
            //if (IsVacuumSensorON == ispresent)
            //    return ispresent ? RobotArmWaferStateEnum.Present : RobotArmWaferStateEnum.Absent;
            //return RobotArmWaferStateEnum.Unknown;
        }

        public bool ReadStatus()
        {
            lock(_locker)
            {
                _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, ""));
                _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, $"CS{_lowerArmWaferSensorIndex}"));
                _lstMonitorHandler.AddLast(new JelC5000RobotReadHandler(this, "G"));

            }
            return true;
        }

        public override bool SetWaferSize(RobotArmEnum arm, WaferSize size)
        {
            if (WaferManager.Instance.CheckHasWafer(RobotModuleName, 0))
                WaferManager.Instance.UpdateWaferSize(RobotModuleName, 0, size);
            return true;
        }

        public override WaferSize GetCurrentWaferSize()
        {
            if (WaferManager.Instance.CheckHasWafer(RobotModuleName, 0))
                return WaferManager.Instance.GetWaferSize(RobotModuleName, 0);
           return WaferSize.WS0;
        }


        public void HandlerError(string errorMsg)
        {
            _lstMonitorHandler.Clear();            
            OnError(errorMsg);
        }

        private string BuildBladeTarget()
        {
            return (CmdRobotArm == RobotArmEnum.Upper ? "ArmB" : "ArmA") + "." + CmdTarget;
        }

        public bool GetBankAndCassetteNumber(ModuleName module, WaferSize wz, out int BankNum, out int CassetteNum)
        {
            BankNum = 0;
            CassetteNum = 0;
            int wzindex = 0;
            if (ModuleHelper.IsLoadPort(module))
            {

                var lp = DEVICE.GetDevice<LoadPortBaseDevice>(module.ToString());
                if (lp != null)
                {
                    wzindex = lp.InfoPadCarrierIndex;
                }
                else
                {
                    var lp1 = DEVICE.GetDevice<LoadPort>(module.ToString());
                    wzindex = lp.InfoPadCarrierIndex;
                }


                if (SC.ContainsItem($"CarrierInfo.{module}BankNumber{wzindex}"))
                    BankNum = SC.GetValue<int>($"CarrierInfo.{module}BankNumber{wzindex}");

                else if (SC.ContainsItem($"CarrierInfo.Carrier{wzindex}.{module}BankNumber"))
                    BankNum = SC.GetValue<int>($"CarrierInfo.Carrier{wzindex}.{module}BankNumber");
                
                else if (SC.ContainsItem($"CarrierInfo.Carrier{wzindex}.{module}Station"))
                {
                    string[] stationInfo = SC.GetStringValue($"CarrierInfo.Carrier{wzindex}.{module}Station").Split('.');

                    if (stationInfo.Length < 2) return false;

                    if (!int.TryParse(stationInfo[0], out BankNum))
                    {
                        EV.PostAlarmLog("Robot", $"{RobotModuleName} parse bank number failed");
                        return false;
                    }

                    if (!int.TryParse(stationInfo[1], out CassetteNum))
                    {
                        EV.PostAlarmLog("Robot", $"{RobotModuleName} parse cassette number failed");
                        return false;
                    }
                    return true;
                }
                else
                {
                    return false;
                }
                

                if (SC.ContainsItem($"CarrierInfo.{module}CassetteNumber{wzindex}"))
                    CassetteNum = SC.GetValue<int>($"CarrierInfo.{module}CassetteNumber{wzindex}");

                else if (SC.ContainsItem($"CarrierInfo.Carrier{wzindex}.{module}CassetteNumber"))
                    CassetteNum = SC.GetValue<int>($"CarrierInfo.Carrier{wzindex}.{module}CassetteNumber");

                else
                {
                    EV.PostAlarmLog("Robot", $"{RobotModuleName} parse cassette number failed");
                    return false;
                }
                return true;
            }

            if (ModuleHelper.IsTurnOverStation(module))
            {
                var flipper = DEVICE.GetDevice<FlipperBaseDevice>(module.ToString());

                if (SC.ContainsItem($"CarrierInfo.{module}{flipper.CurrentFlipperPosition}Station"))
                {
                    string[] stationInfo = SC.GetStringValue($"CarrierInfo.{module}{flipper.CurrentFlipperPosition}Station").Split('.');

                    if (stationInfo.Length < 2) return false;

                    if (!int.TryParse(stationInfo[0], out BankNum))
                    {
                        EV.PostAlarmLog("Robot", $"{RobotModuleName} parse bank number failed");
                        return false;
                    }

                    if (!int.TryParse(stationInfo[1], out CassetteNum))
                    {
                        EV.PostAlarmLog("Robot", $"{RobotModuleName} parse cassette number failed");
                        return false;
                    }
                    return true;
                }
            }

            if (wz == WaferSize.WS12) wzindex = 12;
            if (wz == WaferSize.WS8) wzindex = 8;
            if (wz == WaferSize.WS6) wzindex = 6;
            if (wz == WaferSize.WS4) wzindex = 4;
            if (wz == WaferSize.WS3) wzindex = 3;


            if (SC.ContainsItem($"CarrierInfo.{module}Station"))
            {
                string[] stationInfo = SC.GetStringValue($"CarrierInfo.{module}Station").Split('.');

                if (stationInfo.Length < 2) return false;

                if (!int.TryParse(stationInfo[0], out BankNum))
                {
                    EV.PostAlarmLog("Robot", $"{RobotModuleName} parse bank number failed");
                    return false;
                }

                if (!int.TryParse(stationInfo[1], out CassetteNum))
                {
                    EV.PostAlarmLog("Robot", $"{RobotModuleName} parse cassette number failed");
                    return false;
                }
                return true;
            }


            if (SC.ContainsItem($"CarrierInfo.{module}Station{wzindex}"))
            {
                string[] stationInfo = SC.GetStringValue($"CarrierInfo.{module}Station{wzindex}").Split('.');

                if (stationInfo.Length < 2) return false;

                if (!int.TryParse(stationInfo[0], out BankNum))
                {
                    EV.PostAlarmLog("Robot", $"{RobotModuleName} parse bank number failed");
                    return false;
                }

                if (!int.TryParse(stationInfo[1], out CassetteNum))
                {
                    EV.PostAlarmLog("Robot", $"{RobotModuleName} parse cassette number failed");
                    return false;
                }
                return true;
            }

            if (SC.ContainsItem($"CarrierInfo.{module}BankNumber{wzindex}"))
                BankNum = SC.GetValue<int>($"CarrierInfo.{module}BankNumber{wzindex}");
            else
                return false;

            if (SC.ContainsItem($"CarrierInfo.{module}CassetteNumber{wzindex}"))
                CassetteNum = SC.GetValue<int>($"CarrierInfo.{module}CassetteNumber{wzindex}");
            else
                return false;

            return true;
        }


    }

}