ZZ-EFEM/Framework/RTEquipmentLibrary1/HardwareUnits/LoadPorts/TDKB200/TDKB200LoadPortHandler.cs

using System;
using System.Collections.Generic;
using System.Linq;
using System.Text;
using System.Threading.Tasks;
using Aitex.Core.Common.DeviceData;
using Aitex.Core.RT.Event;
using Aitex.Core.RT.Log;
using Aitex.Sorter.Common;
using MECF.Framework.Common.Communications;

namespace MECF.Framework.RT.EquipmentLibrary.HardwareUnits.LoadPorts.TDKB
{
    public class TDKB200LoadPortHandler : HandlerBase
    {
        public TDKB200LoadPort Device { get; set; }
        public string Command;
        protected TDKB200LoadPortHandler(TDKB200LoadPort device, string command, string para) : base(BuildMesage(command, para))
        {
            Device = device;
            Command = command;
            Name = command;
        }
        public static string BuildMesage(string command, string para)
        {
            if(string.IsNullOrEmpty(para))
                return $"s00{command};\r";
            return $"s00{command}{para};\r";
        }
        public override bool HandleMessage(MessageBase msg, out bool transactionComplete)
        {
            TDKB200LoadPortMessage response = msg as TDKB200LoadPortMessage;
            ResponseMessage = msg;
            transactionComplete = false;
            if (response.IsAck)
            {
                SetState(EnumHandlerState.Acked);
                transactionComplete = true;
            }

            if (response.IsError)
            {
                SetState(EnumHandlerState.Completed);
                transactionComplete = true;
            }
            if (response.IsNak)
            {
                SetState(EnumHandlerState.Completed);
                transactionComplete = true;
            }
            if (response.IsEvent)
            {
                SendAck();
                if (response.Command.Contains(Command))
                {
                    SetState(EnumHandlerState.Completed);
                    transactionComplete = true;
                }

            }

            return true;
        }

        public void HandleEvent(string content)
        {

        }
        public void SendAck()
        {
            //Device.Connection.SendMessage(new byte[] { 0x06 });
        }

        public void Retry()
        {

        }
        public virtual bool PaseData(byte[] data)
        {
            return true;
        }
    }

    public class TDKB200SetHandler : TDKB200LoadPortHandler
    {
        private string setcommand;
        public TDKB200SetHandler(TDKB200LoadPort device, string command, string para) : base(device, BuildData(command), para)
        {
            setcommand = command;
        }
        private static string BuildData(string command)
        {
            return "SET:" + command;
        }
        public override bool HandleMessage(MessageBase msg, out bool transactionComplete)
        {
            TDKB200LoadPortMessage response = msg as TDKB200LoadPortMessage;
            ResponseMessage = msg;
            //Device.TaExecuteSuccss = true;
            transactionComplete = false;
            if (response.IsAck)
            {
                SetState(EnumHandlerState.Acked);
                transactionComplete = false;
                if (setcommand.Contains("FSB"))
                    transactionComplete = true;
            }
            if (response.IsBusy)
            {
                SetState(EnumHandlerState.Completed);
                transactionComplete = true;
            }
            if (response.IsNak)
            {
                SetState(EnumHandlerState.Completed);

                transactionComplete = true;
                //ParseError(response.Data);
            }
            if (response.IsError)
            {
                SetState(EnumHandlerState.Completed);

                transactionComplete = true;

            }
            if (response.IsEvent)
            {
                SendAck();
                if (response.Command.Contains(setcommand))
                {
                    SetState(EnumHandlerState.Completed);
                    transactionComplete = true;
                }

                else
                    HandleEvent(response.Command);
                transactionComplete = true;
            }
            //if (setcommand == "RESET")
            //{
            //    transactionComplete = true;
            //}
            return true;
        }
    }

    public class TDKB200GetHandler : TDKB200LoadPortHandler
    {
        public TDKB200GetHandler(TDKB200LoadPort device, string command, string para) : base(device, BuildData(command), para)
        {

        }
        private static string BuildData(string command)
        {
            return "GET:" + command;
        }
        public override bool HandleMessage(MessageBase msg, out bool transactionComplete)
        {
            TDKB200LoadPortMessage response = msg as TDKB200LoadPortMessage;
            ResponseMessage = msg;
            //Device.TaExecuteSuccss = true;
            transactionComplete = false;
            if (response.IsAck)
            {
                SetState(EnumHandlerState.Acked);
                transactionComplete = true;
                ParseData(response.Command);
            }

            if (response.IsNak)
            {
                SetState(EnumHandlerState.Completed);
                transactionComplete = true;
                //ParseError(response.Data);
            }



            return true;
        }


        public void ParseData(string cmddata)
        {
            try
            {

                if (cmddata.Contains("STATE"))
                {
                    byte[] data = Encoding.ASCII.GetBytes(cmddata.Replace("STATE/", ""));
                    if (data.Length < 20) return;
                    Device.SystemStatus = (TDKSystemStatus)data[0];
                    Device.Mode = (TDKMode)data[1];
                    Device.InitPosMovement = (TDKInitPosMovement)data[2];
                    Device.OperationStatus = (TDKOperationStatus)data[3];
                    Device.ErrorCode = Encoding.ASCII.GetString(new byte[] { data[4], data[5] });

                    Device.ContainerStatus = (TDKContainerStatus)data[6];
                    Device.ClampPosition = (TDKPosition)data[7];
                    Device.LPDoorLatchPosition = (TDKPosition)data[8];
                    Device.VacuumStatus = (TDKVacummStatus)data[9];
                    Device.LPDoorState = (TDKPosition)data[10];
                    Device.WaferProtrusion = (TDKWaferProtrusion)data[11];
                    Device.ElevatorAxisPosition = (TDKElevatorAxisPosition)data[12];
                    Device.DockPosition = (TDKDockPosition)data[13];


                    Device.MapperPostion = (TDKMapPosition)data[14];
                    Device.MappingStatus = (TDKMappingStatus)data[17];
                    Device.Model = (TDKModel)data[18];
                    if (Device.InfoPadType == 0 && Device.IsAutoDetectCarrierType)
                    {
                        int infopadstatus = Convert.ToInt16($"0x{Encoding.ASCII.GetString(new byte[] { data[19] })}", 16);
                        if ((infopadstatus & 1) != 0) Device.IsInfoPadAOn = true;
                        else Device.IsInfoPadAOn = false;
                        if ((infopadstatus & 2) != 0) Device.IsInfoPadBOn = true;
                        else Device.IsInfoPadBOn = false;
                        if ((infopadstatus & 4) != 0) Device.IsInfoPadCOn = true;
                        else Device.IsInfoPadCOn = false;
                        if ((infopadstatus & 8) != 0) Device.IsInfoPadDOn = true;
                        else Device.IsInfoPadDOn = false;

                        Device.InfoPadCarrierIndex = (Device.IsInfoPadAOn? 8:0) + (Device.IsInfoPadBOn ? 4 : 0) +
                            (Device.IsInfoPadCOn ? 2 : 0) + (Device.IsInfoPadDOn ? 1 : 0);
                    }
                    Device.IsError = Device.SystemStatus != TDKSystemStatus.Normal;
                    Device.ErrorCode = Encoding.ASCII.GetString(new byte[] { data[4], data[5] });
                    LoadportCassetteState st = LoadportCassetteState.None;
                    if (Device.ContainerStatus == TDKContainerStatus.Absence) st = LoadportCassetteState.Absent;
                    if (Device.ContainerStatus == TDKContainerStatus.NormalMount) st = LoadportCassetteState.Normal;
                    if (Device.ContainerStatus == TDKContainerStatus.MountError) st = LoadportCassetteState.Unknown;
                    Device.SetCassetteState(st);

                    if (Device.ClampPosition == TDKPosition.Close)
                        Device.ClampState = FoupClampState.Close;
                    else if (Device.ClampPosition == TDKPosition.Open)
                        Device.ClampState = FoupClampState.Open;
                    else if (Device.ClampPosition == TDKPosition.TBD)
                        Device.ClampState = FoupClampState.Unknown;

                    if (Device.LPDoorState == TDKPosition.Close)
                        Device.DoorState = FoupDoorState.Close;
                    if (Device.LPDoorState == TDKPosition.Open)
                        Device.DoorState = FoupDoorState.Open;
                    if (Device.LPDoorState == TDKPosition.TBD)
                        Device.DoorState = FoupDoorState.Unknown;

                    Device.DockState = ConvertTDKDockPositin(Device.DockPosition);  // Load port dock state

                    if (Device.ElevatorAxisPosition == TDKElevatorAxisPosition.UP)
                        Device.DoorPosition = FoupDoorPostionEnum.Up;
                    if (Device.ElevatorAxisPosition == TDKElevatorAxisPosition.Down)
                        Device.DoorPosition = FoupDoorPostionEnum.Down; // = TDKZ_AxisPos.Down;
                    if (Device.ElevatorAxisPosition == TDKElevatorAxisPosition.MappingEndPos)
                        Device.DoorPosition = FoupDoorPostionEnum.MapEnd;// = TDKZ_AxisPos.End;
                    if (Device.ElevatorAxisPosition == TDKElevatorAxisPosition.MappingStartPos)
                        Device.DoorPosition = FoupDoorPostionEnum.MapStart;// = TDKZ_AxisPos.Start;
                    if (Device.ElevatorAxisPosition == TDKElevatorAxisPosition.TBD)
                        Device.DoorPosition = FoupDoorPostionEnum.Unknown;// = TDKZ_AxisPos.Unknown;




                }
                if (cmddata.Contains("VERSN/"))
                {

                }
                if (cmddata.Contains("LEDST/"))
                {
                    IndicatorState[] lpledstate = new IndicatorState[]
                    {
                    Device.IndicatiorPresence,
                    Device.IndicatiorPlacement,
                    Device.IndicatiorLoad,
                    Device.IndicatiorUnload,
                    Device.IndicatiorOpAccess,
                    Device.IndicatiorStatus1,
                    Device.IndicatiorStatus2,

                    };
                    char[] ledstate = cmddata.Replace("LEDST/", "").ToArray();
                    for (int i = 0; i < (lpledstate.Length > ledstate.Length ? ledstate.Length : lpledstate.Length); i++)
                    {
                        if (ledstate[i] == '0') SetIEDValue(i, IndicatorState.OFF);
                        if (ledstate[i] == '1') SetIEDValue(i, IndicatorState.ON);
                        if (ledstate[i] == '2') SetIEDValue(i, IndicatorState.BLINK);
                    }
                }
                if (cmddata.Contains("MAPRD/"))
                {
                    string str1 = cmddata.Replace("MAPRD/", "");



                    Device.OnSlotMapRead(str1);
                }
                if (cmddata.Contains("WFCNT/"))
                {

                    Device.WaferCount = Convert.ToInt16(cmddata.Replace("WFCNT/", ""));
                }
                if (cmddata.Contains("MDAH/"))
                {

                }
                if (cmddata.Contains("LPIOI/"))
                {

                }
                if (cmddata.Contains("FSBxx/"))
                {
                    if (cmddata.Contains("ON"))
                        Device.IsFosbModeActual = true;
                    if (cmddata.Contains("OF"))
                        Device.IsFosbModeActual = false;
                }
            }
            catch(Exception ex)
            {
                LOG.Write(ex);
            }
        }

        private void SetIEDValue(int index, IndicatorState state)
        {
            switch (index)
            {
                case 0:
                    Device.IndicatiorPresence = state;
                    break;
                case 1:
                    Device.IndicatiorPlacement = state;
                    break;
                case 2:
                    Device.IndicatiorLoad = state;
                    break;
                case 3:
                    Device.IndicatiorUnload = state;
                    break;
                case 4:
                    Device.IndicatiorOpAccess = state;
                    break;
                case 5:
                    Device.IndicatiorStatus1 = state;
                    break;
                case 6:
                    Device.IndicatiorStatus2 = state;
                    break;
                default:
                    break;
            }
        }

        private FoupDockState ConvertTDKDockPositin(TDKDockPosition dockPosition)
        {
            if (dockPosition == TDKDockPosition.Dock) return FoupDockState.Docked;
            if (dockPosition == TDKDockPosition.Undock) return FoupDockState.Undocked;
            return FoupDockState.Unknown;
        }
    }

    public class TDKB200ModHandler : TDKB200LoadPortHandler
    {
        public TDKB200ModHandler(TDKB200LoadPort device, string command, string para) : base(device, BuildData(command), para)
        {

        }
        private static string BuildData(string command)
        {
            return "MOD:" + command;
        }
        public override bool HandleMessage(MessageBase msg, out bool transactionComplete)
        {
            TDKBLoadPortMessage response = msg as TDKBLoadPortMessage;
            ResponseMessage = msg;
            //Device.TaExecuteSuccss = true;
            transactionComplete = false;
            if (response.IsAck)
            {
                SetState(EnumHandlerState.Acked);
                transactionComplete = true;
            }

            if (response.IsNak)
            {
                SetState(EnumHandlerState.Completed);
                transactionComplete = true;
                //ParseError(response.Data);
            }



            return true;
        }


        public void ParseData(byte[] cmd)
        {


        }
    }

    public class TDKB200MoveHandler : TDKB200LoadPortHandler
    {
        private string moveCommand;
        public TDKB200MoveHandler(TDKB200LoadPort device, string command, string para) : base(device, BuildData(command), para)
        {
            moveCommand = command;
        }
        private static string BuildData(string command)
        {
            return "MOV:" + command;
        }
        public override bool HandleMessage(MessageBase msg, out bool transactionComplete)
        {
            TDKB200LoadPortMessage response = msg as TDKB200LoadPortMessage;
            ResponseMessage = msg;
            //Device.TaExecuteSuccss = true;
            transactionComplete = false;
            if (response.IsAck)
            {
                SetState(EnumHandlerState.Acked);
                transactionComplete = false;
            }

            if (response.IsNak)
            {

                SetState(EnumHandlerState.Completed);
                transactionComplete = true;
                //ParseError(response.Data);
            }
            if (response.IsError)
            {

                SetState(EnumHandlerState.Completed);
                transactionComplete = true;
            }
            if (response.IsEvent)
            {
                if (response.Command.Contains("ORGSH") || response.Command.Contains("ABORG"))
                {
                    Device.OnHomed();
                }
                if (response.Command.Contains(moveCommand))
                {
                    SetState(EnumHandlerState.Completed);
                    transactionComplete = true;
                }
            }

            return true;
        }


        public void ParseData(byte[] cmd)
        {


        }
    }

}