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 LoaderSideBernoulliN2PressureRoutine : RoutineBase, IRoutine
{
private enum BernoulliN2Step
{
WriteBernoulliN2,
End
}
#region 常量
private const string BERNOULLI_N2 = "BernoulliN2";
#endregion
#region 内部变量
private int _timeout = 5000;
private LoaderSideDevice _loaderSide;
private bool _bernoulliN2 = false;
private double _minBernoulliN2Pressure = 0;
#endregion
///
/// 构造函数
///
///
public LoaderSideBernoulliN2PressureRoutine(string module) : base(module)
{
}
///
/// 中止
///
public void Abort()
{
Runner.Stop("Manual Abort");
}
///
/// 监控
///
///
public RState Monitor()
{
Runner.Run(BernoulliN2Step.WriteBernoulliN2, WriteBernoulliN2, CheckBernoulliN2,_timeout)
.End(BernoulliN2Step.End,NullFun,100);
return Runner.Status;
}
///
/// 写入Bernoulli N2数值
///
///
private bool WriteBernoulliN2()
{
string ioName = BeckhoffModuleIOManager.Instance.GetIoNameByInnerModuleName($"{Module}.{BERNOULLI_N2}");
return IOModuleManager.Instance.WriteIoValue(ioName, _bernoulliN2);
}
///
/// 检验Bernoulli N2状态
///
///
private bool CheckBernoulliN2()
{
if (_bernoulliN2)
{
return _loaderSide.SideData.BernoulliN2 == _bernoulliN2&& _loaderSide.SideData.BernoulliPressure > _minBernoulliN2Pressure;
}
else
{
return _loaderSide.SideData.BernoulliN2 == _bernoulliN2;
}
}
///
/// 启动
///
///
///
public RState Start(params object[] objs)
{
_loaderSide = DEVICE.GetDevice(Module);
if (SC.ContainsItem($"{ModuleName.Loader1}.MinBernoulliN2Pressure"))
{
_minBernoulliN2Pressure = SC.GetValue($"{ModuleName.Loader1}.MinBernoulliN2Pressure");
}
_bernoulliN2 = (bool)objs[0];
return Runner.Start(Module, "Bernoulli N2");
}
}
}