using Aitex.Core.RT.Device; 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 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 LoaderSideVacuumRoutine : RoutineBase, IRoutine { private enum VacuumStep { WriteVacuum, End } #region 常量 private const string CRS_VACUUM = "CRSVacuum"; #endregion #region 内部变量 private int _timeout = 5000; private LoaderSideDevice _loaderSide; private bool _vacuum = false; #endregion /// <summary> /// 构造函数 /// </summary> /// <param name="module"></param> public LoaderSideVacuumRoutine(string module) : base(module) { } /// <summary> /// 中止 /// </summary> public void Abort() { Runner.Stop("Manual Abort"); } /// <summary> /// 监控 /// </summary> /// <returns></returns> public RState Monitor() { Runner.Run(VacuumStep.WriteVacuum, WriteVacuum, CheckVacuum,_timeout) .End(VacuumStep.End,NullFun,100); return Runner.Status; } /// <summary> /// 写入Vacuum数值 /// </summary> /// <returns></returns> private bool WriteVacuum() { string ioName = BeckhoffModuleIOManager.Instance.GetIoNameByInnerModuleName($"{Module}.{CRS_VACUUM}"); return IOModuleManager.Instance.WriteIoValue(ioName, _vacuum); } /// <summary> /// 检验Door Lock状态 /// </summary> /// <returns></returns> private bool CheckVacuum() { return _loaderSide.SideData.CRSVacuum == _vacuum; } /// <summary> /// 启动 /// </summary> /// <param name="objs"></param> /// <returns></returns> public RState Start(params object[] objs) { if (SC.ContainsItem($"{ModuleName.Loader1}.LSVacuumTimeout")) { _timeout = SC.GetValue<int>($"{ModuleName.Loader1}.LSVacuumTimeout"); } _loaderSide = DEVICE.GetDevice<LoaderSideDevice>(Module); _vacuum = (bool)objs[0]; return Runner.Start(Module, "Vacuum"); } } }