Virgo_Mask/VirgoRT/Modules/LPs/LoadPortHomeRoutine.cs

using System;
using Aitex.Core.RT.Device;
using Aitex.Core.RT.Log;
using Aitex.Core.RT.Routine;
using Aitex.Core.RT.SCCore;
using MECF.Framework.RT.EquipmentLibrary.HardwareUnits.LoadPorts;

namespace VirgoRT.Modules.LPs
{
    class LoadPortHomeRoutine : ModuleRoutine, IRoutine
    {
        enum RoutineStep
        {
             
            Home,
            QueryStatus,

        }

        private int _timeout = 0;
 
        private LoadPortModule _lpModule;

        public LoadPortHomeRoutine(LoadPortModule lpModule)
        {
            _lpModule = lpModule;
            Module = lpModule.Module;

            Name = "Home";
 
        }
 
        public Result Start(params object[] objs)
        {
            Reset();

            _timeout = SC.GetValue<int>("EFEM.LoadPort.HomeTimeout");

            Notify($"Start");

            return Result.RUN;
        }


        public Result Monitor()
        {
            try
            {
                 
                Home((int)RoutineStep.Home, _timeout);
                QueryStatus((int)RoutineStep.QueryStatus, _timeout);
            }
            catch (RoutineBreakException)
            {
                return Result.RUN;
            }
            catch (RoutineFaildException  )
            {
                 
                return Result.FAIL;
            }

            Notify("Finished");
            return Result.DONE;
        }
 
        public void Home(int id,  int timeout)
        {
            Tuple<bool, Result> ret = ExecuteAndWait(id, () =>
            {
                Notify($"Start home {_lpModule.Name}");

                _lpModule.LPDevice.Home();

                return true;
            }, () =>
                {
                    if (_lpModule.LPDevice.IsError)
                        return null;

                    if (_lpModule.LPDevice.IsBusy)
                        return false;

                    return true;
                }, timeout * 1000);

            if (ret.Item1)
            {
                if (ret.Item2 == Result.FAIL)
                {
                    Stop(string.Format("Home failed."));
                    throw (new RoutineFaildException());
                }
                else if (ret.Item2 == Result.TIMEOUT) //timeout
                {
                    Stop(string.Format("Home timeout, can not complete in {0} seconds", timeout));
                    throw (new RoutineFaildException());
                }
                else
                    throw (new RoutineBreakException());
            }
        }

        public void QueryStatus(int id, int timeout)
        {
            Tuple<bool, Result> ret = ExecuteAndWait(id, () =>
            {
                Notify($"Start SIGSTAT {_lpModule.Name}");

                _lpModule.LPDevice.SIGSTAT();

                return true;
            }, () =>
            {
                if (_lpModule.LPDevice.IsError)
                    return null;

                if (_lpModule.LPDevice.IsBusy)
                    return false;

                return true;
            }, timeout * 1000);

            if (ret.Item1)
            {
                if (ret.Item2 == Result.FAIL)
                {
                    Stop(string.Format("SIGSTAT failed."));
                    throw (new RoutineFaildException());
                }
                else if (ret.Item2 == Result.TIMEOUT) //timeout
                {
                    Stop(string.Format("SIGSTAT timeout, can not complete in {0} seconds", timeout));
                    throw (new RoutineFaildException());
                }
                else
                    throw (new RoutineBreakException());
            }
        }


        public void Abort()
        {

        }

    }
}