CyberX8/CyberX8_RT/Devices/TransPorter/TransporterExtendRoutine.cs

using Aitex.Core.RT.Device;
using Aitex.Core.RT.IOCore;
using Aitex.Core.RT.Routine;
using Aitex.Core.RT.SCCore;
using MECF.Framework.Common.Beckhoff.ModuleIO;
using MECF.Framework.Common.CommonData.PUF;
using MECF.Framework.Common.Equipment;
using MECF.Framework.Common.Routine;
using MECF.Framework.Common.TwinCat;
using CyberX8_Core;
using CyberX8_RT.Devices.Loader;
using CyberX8_RT.Devices.TransPorter;
using System;
using System.Collections.Generic;
using System.Linq;
using System.Text;
using System.Threading.Tasks;
using MECF.Framework.Common.IOCore;

namespace CyberX8_RT.Devices.AXIS.CANOpen
{
   
    public class TransporterExtendRoutine : RoutineBase, IRoutine
    {
        private enum ExtendStep
        {
            CheckInUpPosition,
            WriteExtend,
            End
        }

        #region 常量 
        private const string IMMOBILIZE_ACTIVE = "ImmobilizeActive";
        private const string IMMOBILIZE_ACTIVE2 = "ImmobilizeActive2";
        #endregion

        #region 内部变量
        private int _timeout = 5000;
        private TransporterCommon _transporterCommon;
        #endregion
        /// <summary>
        /// 构造函数
        /// </summary>
        /// <param name="module"></param>
        public TransporterExtendRoutine(string module) : base(module)
        {
            if (SC.ContainsItem($"Transporter.{module}.ExtendCheckTime"))
            {
                _timeout = SC.GetValue<int>($"Transporter.{module}.ExtendCheckTime")*1000;
            }
        }
        /// <summary>
        /// 中止
        /// </summary>
        public void Abort()
        {
            Runner.Stop("Manual Abort");
        }
        /// <summary>
        /// 监控
        /// </summary>
        /// <returns></returns>
        public RState Monitor()
        {
            Runner.Run(ExtendStep.CheckInUpPosition, CheckPosition, _delay_1ms)
                .Run(ExtendStep.WriteExtend, WriteExtend, CheckExtend,_timeout)
                .End(ExtendStep.End,NullFun,100);
            return Runner.Status;
        }
        /// <summary>
        /// 检查Elevate当前是否在UP Place
        /// </summary>
        /// <returns></returns>
        private bool CheckPosition()
        {
            JetAxisBase elevatorAxis = DEVICE.GetDevice<JetAxisBase>($"{Module}.Elevator");
            if (elevatorAxis != null && !elevatorAxis.CurrentStation.Contains("UP"))
            {
                return false;
            }
            return true;
        }
        /// <summary>
        /// 写入Retract数值
        /// </summary>
        /// <returns></returns>
        private bool WriteExtend()
        {
            bool active = WriteIo(IMMOBILIZE_ACTIVE, true);
            if (active)
            {
                return WriteIo(IMMOBILIZE_ACTIVE2, true);
            }
            return false;
        }
        /// <summary>
        /// 写入IO
        /// </summary>
        /// <param name="name"></param>
        /// <param name="value"></param>
        /// <returns></returns>
        private bool WriteIo(string name,bool value)
        {
            string ioName = BeckhoffModuleIOManager.Instance.GetIoNameByInnerModuleName($"{Module}.{name}");
            if (!string.IsNullOrEmpty(ioName))
            {
                return IOModuleManager.Instance.WriteIoValue(ioName, value);
            }
            else
            {
                return false;
            }
        }
        /// <summary>
        /// 检验Retract状态
        /// </summary>
        /// <returns></returns>
        private bool CheckExtend()
        {
            return _transporterCommon.TransporterData.ImmobilizeExtended1 && _transporterCommon.TransporterData.ImmobilizeExtended2;
        }
        /// <summary>
        /// 启动
        /// </summary>
        /// <param name="objs"></param>
        /// <returns></returns>
        public RState Start(params object[] objs)
        {
            _transporterCommon = DEVICE.GetDevice<TransporterCommon>($"{Module}.Common");
            return Runner.Start(Module, "Extend");
        }
    }
}