123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879 |
- using Aitex.Core.RT.DataCenter;
- using Aitex.Core.RT.Device;
- using Aitex.Core.RT.Log;
- using Aitex.Core.RT.OperationCenter;
- using Aitex.Core.RT.Routine;
- using Aitex.Core.RT.SCCore;
- using Aitex.Core.Util;
- using MECF.Framework.Common.Algorithm;
- using MECF.Framework.Common.Beckhoff.ModuleIO;
- using MECF.Framework.Common.CommonData.Prewet;
- using MECF.Framework.Common.CommonData.Vpw;
- using MECF.Framework.Common.IOCore;
- using MECF.Framework.Common.Persistent.Prewet;
- using MECF.Framework.Common.Persistent.VpwMain;
- using PunkHPX8_Core;
- using PunkHPX8_RT.Modules;
- using PunkHPX8_RT.Modules.VpwCelMain;
- using PunkHPX8_RT.Modules.VpwMain;
- using System;
- using System.Collections.Generic;
- using System.Linq;
- using System.Net.NetworkInformation;
- using System.Reflection;
- using System.Text;
- using System.Threading.Tasks;
- namespace PunkHPX8_RT.Devices.VpwMain
- {
- public class VpwMainDevice : BaseDevice, IDevice
- {
- #region 常量
- private const string COMMON_DATA = "CommonData";
- private const string PERSISTENT_VALUE = "PersistentValue";
- private const string CHAMBER_CLOSED = "ChamberClosed";
- private const string CHAMBER_OPENED = "ChamberOpened";
- private const string CHAMBER_CLOSE = "ChamberClose";
- private const string LEAK_DETECTED = "LeakDetected";
- private const string VACUUM_PUMP_PRESSURE = "VacuumPumpPressure";
- private const string VACUUM_PUMP_POWER = "VacuumPumpPower";
- private const string VACUUM_PUMP_ENABLE = "VacuumPumpEnable";
- private const string VACUUM_PUMP_SPEED_ENABLE = "VacuumPumpSpeedEnable";
- private const string VACUUM_PUMP_SPEED = "VacuumPumpSpeed";
- private const string BOOSTER_PUMP_SPEED = "BoosterPumpSpeed";
- private const string BOOSTER_PUMP_CURRENT = "BoosterPumpCurrent";
- private const string BOOSTER_PUMP_ENABLE = "BoosterPumpEnable";
- private const string BOOSTER_PUMP_STATUS = "BoosterPumpStatus";
- private const string DIW_ENABLE = "DiwEnable";
- private const string DIW_PROCESS = "DiwProcess";
- private const string DIW_DEGAS = "DiwDegas";
- private const string DIW_TOTAL_FLOW = "DiwTotalFlow";
- private const string DIW_PRESSURE = "DiwPressure";
- private const string DEGAS_ADJUST = "DegasAdjust";
- private const string DEGAS_PURGE = "DegasPurge";
- private const string DEGAS_PUMP_ENABLE = "DegasPumpEnable";
- private const string DEGAS_PUMP_PRESSURE = "DegasPumpPressure";
- #endregion
- private enum VPWOperation
- {
- None,
- PumpEnable,
- PumpDisable,
- HomeAllRotation
- }
- #region 内部变量
- /// <summary>
- /// 变量是否初始化字典
- /// </summary>
- private Dictionary<string, bool> _variableInitializeDic = new Dictionary<string, bool>();
- /// <summary>
- /// 数据
- /// </summary>
- private VpwMainCommonData _commonData=new VpwMainCommonData();
- /// <summary>
- /// 持久性数值
- /// </summary>
- private VpwMainPersistentValue _vpwMainPersistentValue;
- /// <summary>
- /// Pump Enable routine
- /// </summary>
- private BoosterPumpEnableRoutine _boosterPumpEnableRoutine;
- /// <summary>
- /// Pump Disable routine
- /// </summary>
- private BoosterPumpDisableRoutine _boosterPumpDisableRoutine;
- /// <summary>
- /// 上一次Booster泵速
- /// </summary>
- private short _lastBoosterPumpSpeed = 0;
- /// <summary>
- /// 定时器任务
- /// </summary>
- private PeriodicJob _periodicJob;
- /// <summary>
- /// 是否数据完成初台化
- /// </summary>
- private bool _isDataInitialized;
- /// <summary>
- /// pdi控制中的p
- /// </summary>
- private double _pumpKp;
- /// <summary>
- /// pdi控制中的i
- /// </summary>
- private double _pumpKi;
- /// <summary>
- /// pdi控制中的d
- /// </summary>
- private double _pumpKd;
- /// <summary>
- /// 操作当前状态
- /// </summary>
- private RState _status;
- /// <summary>
- /// 当前操作
- /// </summary>
- private VPWOperation _currentOperation;
- /// <summary>
- /// 启动自动调泵速
- /// </summary>
- private bool _isStartAutoSpeed;
- /// <summary>
- /// Home 电机
- /// </summary>
- private VpwSimpleHomeRoutine _simpleHomeRoutine;
- #endregion
- #region 属性
- /// <summary>
- /// 数据
- /// </summary>
- public VpwMainCommonData CommonData { get { return _commonData; } }
- #endregion
- /// <summary>
- /// 构造函数
- /// </summary>
- /// <param name="moduleName"></param>
- public VpwMainDevice(string moduleName) : base(moduleName, moduleName, moduleName, moduleName)
- {
- }
- #region 初始化
- /// <summary>
- /// 初始化
- /// </summary>
- /// <returns></returns>
- public bool Initialize()
- {
- InitializeParameter();
- InitializeRoutine();
- SubscribeData();
- SubscribeValueAction();
- InitializeOperation();
- return true;
- }
- /// <summary>
- /// 初始化参数
- /// </summary>
- private void InitializeParameter()
- {
- _vpwMainPersistentValue = VpwMainPersistentManager.Instance.GetPersistentValue(Module);
- if (_vpwMainPersistentValue != null)
- {
- _lastBoosterPumpSpeed = _vpwMainPersistentValue.Speed;
- }
- else
- {
- LOG.WriteLog(eEvent.ERR_PREWET, Module, "Persistent Value Object is not exist");
- }
- _commonData.BoosterPumpPressureData = new MECF.Framework.Common.CommonData.CommonLimitData();
- }
- /// <summary>
- /// 初始化Routine
- /// </summary>
- private void InitializeRoutine()
- {
- _boosterPumpEnableRoutine = new BoosterPumpEnableRoutine(Module, this);
- _boosterPumpDisableRoutine = new BoosterPumpDisableRoutine(Module, this);
- _simpleHomeRoutine = new VpwSimpleHomeRoutine(Module.ToString());
- }
- /// <summary>
- /// 订阅
- /// </summary>
- private void SubscribeData()
- {
- DATA.Subscribe($"{Module}.{PERSISTENT_VALUE}", () => _vpwMainPersistentValue, SubscriptionAttribute.FLAG.IgnoreSaveDB);
- DATA.Subscribe($"{Module}.{COMMON_DATA}", () => CommonData, SubscriptionAttribute.FLAG.IgnoreSaveDB);
- }
- /// <summary>
- /// 订阅数据
- /// </summary>
- private void SubscribeValueAction()
- {
- IoSubscribeUpdateVariable(CHAMBER_CLOSED);
- IoSubscribeUpdateVariable(CHAMBER_OPENED);
- IoSubscribeUpdateVariable(BOOSTER_PUMP_STATUS);
- IoSubscribeUpdateVariable(BOOSTER_PUMP_SPEED);
- IoSubscribeUpdateVariable(BOOSTER_PUMP_ENABLE);
- IoSubscribeUpdateVariable(BOOSTER_PUMP_CURRENT);
- IoSubscribeUpdateVariable(DEGAS_PURGE);
- IoSubscribeUpdateVariable(DEGAS_ADJUST);
- IoSubscribeUpdateVariable(DEGAS_PUMP_PRESSURE);
- IoSubscribeUpdateVariable(DEGAS_PUMP_ENABLE);
- IoSubscribeUpdateVariable(DIW_ENABLE);
- IoSubscribeUpdateVariable(DIW_PROCESS);
- IoSubscribeUpdateVariable(DIW_PRESSURE);
- IoSubscribeUpdateVariable(DIW_DEGAS);
- IoSubscribeUpdateVariable(DIW_TOTAL_FLOW);
- IoSubscribeUpdateVariable(VACUUM_PUMP_ENABLE);
- IoSubscribeUpdateVariable(VACUUM_PUMP_POWER);
- IoSubscribeUpdateVariable(VACUUM_PUMP_PRESSURE);
- IoSubscribeUpdateVariable(VACUUM_PUMP_SPEED);
- IoSubscribeUpdateVariable(VACUUM_PUMP_SPEED_ENABLE);
- IoSubscribeUpdateVariable(LEAK_DETECTED);
- }
- /// <summary>
- /// 初始化变量
- /// </summary>
- /// <param name="variable"></param>
- private void IoSubscribeUpdateVariable(string variable)
- {
- _variableInitializeDic[variable] = false;
- IOModuleManager.Instance.SubscribeModuleVariable(Module, variable, UpdateVariableValue);
- }
- /// <summary>
- /// 更新变量数值
- /// </summary>
- /// <param name="variable"></param>
- /// <param name="value"></param>
- private void UpdateVariableValue(string variable, object value)
- {
- if (!_commonData.IsDataInitialized)
- {
- _commonData.IsDataInitialized = true;
- _commonData.BoosterPumpModel = "Manual";
- }
- PropertyInfo property = _commonData.GetType().GetProperty(variable);
- if (property != null)
- {
- property.SetValue(_commonData, value);
- }
- if (_variableInitializeDic.ContainsKey(variable) && !_variableInitializeDic[variable])
- {
- _variableInitializeDic[variable] = true;
- }
- switch (variable)
- {
- case BOOSTER_PUMP_STATUS:
- string statusContent = _commonData.BoosterPumpStatus ? "On" : "Off";
- _commonData.BoosterPumpStatusContent = $"{_commonData.BoosterPumpModel}: {statusContent}";
- break;
- case DIW_PRESSURE:
- if (double.TryParse(value.ToString(), out var pressure))
- {
- _commonData.BoosterPumpPressureData.Value = pressure;
- }
- break;
- }
- }
- /// <summary>
- /// 初始化OP
- /// </summary>
- private void InitializeOperation()
- {
- OP.Subscribe($"{Module}.VacuumPumpPowerOn", (cmd,para)=> { return VacuumPumpPowerOn(); });
- OP.Subscribe($"{Module}.VacuumPumpPowerOff", (cmd, para) => { return VacuumPumpPowerOff(); });
- OP.Subscribe($"{Module}.VacuumPumpEnable", (cmd, para) => { return VacuumPumpEnable(); });
- OP.Subscribe($"{Module}.VacuumPumpDisable", (cmd, para) => { return VacuumPumpDisable(); });
- OP.Subscribe($"{Module}.VacuumPumpSpeedEnable", (cmd, para) => { return VacuumSpeedEnable(); });
- OP.Subscribe($"{Module}.VacuumPumpSpeedDisable", (cmd, para) => { return VacuumSpeedDisable(); });
- OP.Subscribe($"{Module}.VacuumPumpSpeed", (cmd, para) => { return WriteVacuumSpeedOperation(cmd, para); });
- OP.Subscribe($"{Module}.DegasPumpEnable", (cmd, para) => { return DegasPumpEnable(); });
- OP.Subscribe($"{Module}.DegasPumpDisable", (cmd, para) => { return DegasPumpDisable(); });
- OP.Subscribe($"{Module}.DegasAdjustOn", (cmd, para) => { return DegasAdjustOn(); });
- OP.Subscribe($"{Module}.DegasAdjustOff", (cmd, para) => { return DegasAdjustOff(); });
- OP.Subscribe($"{Module}.DiwDegasValveOn", (cmd, para) => { return DiwDegasValveOn(); });
- OP.Subscribe($"{Module}.DiwDegasValveOff", (cmd, para) => { return DiwDegasValveOff(); });
- OP.Subscribe($"{Module}.DiwEnable", (cmd, para) => { return DiwEnable(); });
- OP.Subscribe($"{Module}.DiwDisable", (cmd, para) => { return DiwDisable(); });
- OP.Subscribe($"{Module}.DiwProcessOn", (cmd, para) => { return DiwProcessOn(); });
- OP.Subscribe($"{Module}.DiwProcessOff", (cmd, para) => { return DiwProcessOff(); });
- OP.Subscribe($"{Module}.BoosterPumpEnable", BoosterPumpEnableOperation);
- OP.Subscribe($"{Module}.BoosterPumpDisable", BoosterPumpDisableOperation);
- OP.Subscribe($"{Module}.BoosterPumpSpeed", BoosterPumpSpeedKeyDownOperation);
- OP.Subscribe($"{Module}.ChamberUp", (cmd, para) => { return ChamberUp(); });
- OP.Subscribe($"{Module}.ChamberDown", (cmd, para) => { return ChamberDown(); });
-
- OP.Subscribe($"{Module}.BoosterPumpSpeedAuto", (cmd, para) => { return BoosterPumpSpeedAutoOperation(); });
- OP.Subscribe($"{Module}.BoosterPumpSpeedManual", (cmd, para) => { return BoosterPumpSpeedManualOperation(); });
- OP.Subscribe($"{Module}.DisabledAction", DisabledOperation);
- OP.Subscribe($"{Module}.ManualAction", ManualOperation);
- OP.Subscribe($"{Module}.AutoAction", AutoOperation);
- OP.Subscribe($"{Module}.EngineeringModeAction", EngineeringModeOperation);
- OP.Subscribe($"{Module}.ProductionModeAction", ProductionModeOperation);
-
- OP.Subscribe($"{Module}.HomeAllRotation", HomeAllRotation);
- }
- #endregion
- #region Action
- #region HomeAllRotation
- public bool HomeAllRotation(string cmd, object[] param)
- {
- if (_status == RState.Running)
- {
- LOG.WriteLog(eEvent.ERR_PREWET, Module.ToString(), $"{Module} current execute {_currentOperation},cannot home all rotation");
- return false;
- }
- _status = _simpleHomeRoutine.Start();
- _currentOperation = VPWOperation.HomeAllRotation;
- return _status == RState.Running;
- }
- #endregion
- #region Vacum Pump
- /// <summary>
- /// Pump Power On
- /// </summary>
- /// <returns></returns>
- public bool VacuumPumpPowerOn()
- {
- return WriteVariableValue(VACUUM_PUMP_POWER, true);
- }
- /// <summary>
- /// Pump Power Off
- /// </summary>
- /// <returns></returns>
- public bool VacuumPumpPowerOff()
- {
- return WriteVariableValue(VACUUM_PUMP_POWER, false);
- }
- /// <summary>
- /// Pump Enable
- /// </summary>
- /// <returns></returns>
- public bool VacuumPumpEnable()
- {
- return WriteVariableValue(VACUUM_PUMP_ENABLE, true);
- }
- /// <summary>
- /// Pump Disable
- /// </summary>
- /// <returns></returns>
- public bool VacuumPumpDisable()
- {
- return WriteVariableValue(VACUUM_PUMP_ENABLE, false);
- }
- /// <summary>
- /// Speed Enable
- /// </summary>
- /// <returns></returns>
- public bool VacuumSpeedEnable()
- {
- return WriteVariableValue(VACUUM_PUMP_SPEED_ENABLE, true);
- }
- /// <summary>
- /// Speed disable
- /// </summary>
- /// <returns></returns>
- public bool VacuumSpeedDisable()
- {
- return WriteVariableValue(VACUUM_PUMP_SPEED_ENABLE, false);
- }
- /// <summary>
- /// 写入Vacuum速度
- /// </summary>
- /// <param name="speed"></param>
- /// <returns></returns>
- private bool WriteVacuumSpeedOperation(string cmd, object[] param)
- {
- if (short.TryParse(param[0].ToString(), out var speed))
- {
- return WriteVariableValue(VACUUM_PUMP_SPEED, speed);
- }
- else
- {
- LOG.WriteLog(eEvent.ERR_VPWMAIN, Module, $"Write VacuumSpeed {param[0]} is not short");
- return false;
- }
- }
- /// <summary>
- /// 写入速度
- /// </summary>
- /// <param name="speed"></param>
- /// <returns></returns>
- public bool WriteVacuumSpeed(short speed)
- {
- return WriteVariableValue(VACUUM_PUMP_SPEED, speed);
- }
- #endregion
- #region Degas Pump
- /// <summary>
- /// Degas Pump Enable
- /// </summary>
- /// <returns></returns>
- public bool DegasPumpEnable()
- {
- return WriteVariableValue(DEGAS_PUMP_ENABLE, true);
- }
- /// <summary>
- /// Degas Pump disable
- /// </summary>
- /// <returns></returns>
- public bool DegasPumpDisable()
- {
- return WriteVariableValue(DEGAS_PUMP_ENABLE, false);
- }
- /// <summary>
- /// Degas Adjust On
- /// </summary>
- /// <returns></returns>
- public bool DegasAdjustOn()
- {
- return WriteVariableValue(DEGAS_ADJUST, true);
- }
- /// <summary>
- /// Degas Adjust Off
- /// </summary>
- /// <returns></returns>
- public bool DegasAdjustOff()
- {
- return WriteVariableValue(DEGAS_ADJUST, false);
- }
- #endregion
- #region Booster Pump
- /// <summary>
- /// Pump Enable操作
- /// </summary>
- /// <param name="cmd"></param>
- /// <param name="param"></param>
- /// <returns></returns>
- public bool BoosterPumpEnableOperation(string cmd, object[] param)
- {
- if (_status == RState.Running)
- {
- LOG.WriteLog(eEvent.ERR_PREWET, Module.ToString(), $"{Module} current execute {_currentOperation},cannot Pump enable");
- return false;
- }
- _status = _boosterPumpEnableRoutine.Start();
- _currentOperation = VPWOperation.PumpEnable;
- return _status == RState.Running;
- }
- /// <summary>
- /// pump disable 操作
- /// </summary>
- /// <param name="cmd"></param>
- /// <param name="param"></param>
- /// <returns></returns>
- public bool BoosterPumpDisableOperation(string cmd, object[] param)
- {
- if (_status == RState.Running)
- {
- LOG.WriteLog(eEvent.ERR_PREWET, Module.ToString(), $"{Module} current execute {_currentOperation},cannot Pump disable");
- return false;
- }
- _status = _boosterPumpDisableRoutine.Start();
- _currentOperation = VPWOperation.PumpDisable;
- return _status == RState.Running;
- //return PumpDisable();
- }
- /// <summary>
- /// Booster Pump enable
- /// </summary>
- /// <returns></returns>
- public bool BoosterPumpEnable()
- {
- return WriteVariableValue(BOOSTER_PUMP_ENABLE, true);
- }
- /// <summary>
- /// Booster Pump Disable
- /// </summary>
- /// <returns></returns>
- public bool BoosterPumpDisable()
- {
- return WriteVariableValue(BOOSTER_PUMP_ENABLE, false);
- }
- /// <summary>
- /// 写入Booster泵速
- /// </summary>
- /// <param name="speed"></param>
- /// <returns></returns>
- public bool BoosterPumpSpeed(short speed=0)
- {
- return WriteVariableValue(BOOSTER_PUMP_SPEED, speed == 0 ? _lastBoosterPumpSpeed : speed);
- }
- /// Booster Pump Speed回车操作
- /// </summary>
- /// <param name="cmd"></param>
- /// <param name="param"></param>
- /// <returns></returns>
- private bool BoosterPumpSpeedKeyDownOperation(string cmd, object[] param)
- {
- if (_commonData.BoosterPumpSpeedAuto)
- {
- LOG.WriteLog(eEvent.ERR_PREWET, Module, "Pump speed is auto,cannot change speed");
- return false;
- }
- short speed = (short)param[0];
- bool result = BoosterPumpSpeed(speed);
- if (result)
- {
- _vpwMainPersistentValue.Speed = speed;
- _lastBoosterPumpSpeed = speed;
- VpwMainPersistentManager.Instance.UpdatePersistentValue(Module);
- }
- return true;
- }
- /// <summary>
- /// Pump Speed手动模式
- /// </summary>
- /// <param name="cmd"></param>
- /// <param name="param"></param>
- /// <returns></returns>
- private bool BoosterPumpSpeedManualOperation()
- {
- _commonData.BoosterPumpSpeedAuto = false;
- _commonData.BoosterPumpModel = "Manual";
- string statusContent = _commonData.BoosterPumpStatus ? "On" : "Off";
- _commonData.BoosterPumpStatusContent = $"{_commonData.BoosterPumpModel}: {statusContent}";
- return true;
- }
- /// <summary>
- /// Pump Speed自动模式
- /// </summary>
- /// <param name="cmd"></param>
- /// <param name="param"></param>
- /// <returns></returns>
- private bool BoosterPumpSpeedAutoOperation()
- {
- _commonData.BoosterPumpSpeedAuto = true;
- _commonData.BoosterPumpModel = "Auto";
- string statusContent = _commonData.BoosterPumpStatus ? "On" : "Off";
- _commonData.BoosterPumpStatusContent = $"{_commonData.BoosterPumpModel}: {statusContent}";
- return true;
- }
- #endregion
- #region Chamber
- /// <summary>
- /// 上升
- /// </summary>
- /// <returns></returns>
- public bool ChamberUp()
- {
- return WriteVariableValue(CHAMBER_CLOSE, false);
- }
- /// <summary>
- /// 下降
- /// </summary>
- /// <returns></returns>
- public bool ChamberDown()
- {
- return WriteVariableValue(CHAMBER_CLOSE, true);
- }
- #endregion
- #region Mode switch
- /// <summary>
- /// DisabledAction
- /// </summary>
- /// <param name="cmd"></param>
- /// <param name="param"></param>
- /// <returns></returns>
- private bool DisabledOperation(string cmd, object[] args)
- {
- string currentOperation = "Disabled";
- VpwMainEntity vpwMainEntity = Singleton<RouteManager>.Instance.GetModule<VpwMainEntity>(Module);
- if (vpwMainEntity != null && _vpwMainPersistentValue != null && _vpwMainPersistentValue.OperatingMode != currentOperation)
- {
- string preOperation = _vpwMainPersistentValue.OperatingMode;
- if (vpwMainEntity.IsBusy)
- {
- LOG.WriteLog(eEvent.ERR_VPWMAIN, Module, $"{Module} is Busy, can't switch to Disabled mode");
- return false;
- }
- vpwMainEntity.EnterInit();
- _vpwMainPersistentValue.OperatingMode = currentOperation;
- LOG.WriteLog(eEvent.INFO_VPWMAIN, Module, $"Operating mode is switched from {preOperation} to {currentOperation}");
- }
- VpwMainPersistentManager.Instance.UpdatePersistentValue(Module);
- return true;
- }
- /// <summary>
- /// ManualAction
- /// </summary>
- /// <param name="cmd"></param>
- /// <param name="param"></param>
- /// <returns></returns>
- private bool ManualOperation(string cmd, object[] args)
- {
- string currentOperation = "Manual";
- VpwMainEntity vpwMainEntity = Singleton<RouteManager>.Instance.GetModule<VpwMainEntity>(Module);
- if (vpwMainEntity != null && _vpwMainPersistentValue != null && _vpwMainPersistentValue.OperatingMode != currentOperation)
- {
- string preOperation = _vpwMainPersistentValue.OperatingMode;
- if (vpwMainEntity.IsBusy)
- {
- LOG.WriteLog(eEvent.ERR_VPWMAIN, Module, $"{Module} is Busy, can't switch to Manual mode");
- return false;
- }
- vpwMainEntity.EnterInit();
- _vpwMainPersistentValue.OperatingMode = currentOperation;
- LOG.WriteLog(eEvent.INFO_VPWMAIN, Module, $"Operating mode is switched from {preOperation} to {currentOperation}");
- }
- VpwMainPersistentManager.Instance.UpdatePersistentValue(Module);
- return true;
- }
- /// <summary>
- /// AutoAction
- /// </summary>
- /// <param name="cmd"></param>
- /// <param name="param"></param>
- /// <returns></returns>
- private bool AutoOperation(string cmd, object[] args)
- {
- string currentOperation = "Auto";
- VpwMainEntity vpwMainEntity = Singleton<RouteManager>.Instance.GetModule<VpwMainEntity>(Module);
- if (vpwMainEntity != null && _vpwMainPersistentValue != null && _vpwMainPersistentValue.OperatingMode != currentOperation)
- {
- string preOperation = _vpwMainPersistentValue.OperatingMode;
- if (vpwMainEntity.IsBusy)
- {
- LOG.WriteLog(eEvent.ERR_VPWMAIN, Module, $"{Module} is Busy, can't switch to Auto mode");
- return false;
- }
- vpwMainEntity.EnterInit();
- _vpwMainPersistentValue.OperatingMode = currentOperation;
- LOG.WriteLog(eEvent.INFO_VPWMAIN, Module, $"Operating mode is switched from {preOperation} to {currentOperation}");
- }
- VpwMainPersistentManager.Instance.UpdatePersistentValue(Module);
- return true;
- }
- /// <summary>
- /// EngineeringModeAction
- /// </summary>
- /// <param name="cmd"></param>
- /// <param name="param"></param>
- /// <returns></returns>
- private bool EngineeringModeOperation(string cmd, object[] args)
- {
- string currentRecipeOperation = "Engineering";
- if (_vpwMainPersistentValue != null)
- {
- _vpwMainPersistentValue.RecipeOperatingMode = currentRecipeOperation;
- }
- VpwMainPersistentManager.Instance.UpdatePersistentValue(Module);
- return true;
- }
- /// <summary>
- /// ProductionAction
- /// </summary>
- /// <param name="cmd"></param>
- /// <param name="param"></param>
- /// <returns></returns>
- private bool ProductionModeOperation(string cmd, object[] args)
- {
- string currentRecipeOperation = "Production";
- if (_vpwMainPersistentValue != null)
- {
- _vpwMainPersistentValue.RecipeOperatingMode = currentRecipeOperation;
- }
- VpwMainPersistentManager.Instance.UpdatePersistentValue(Module);
- return true;
- }
- #endregion
- #region DIW
- /// <summary>
- /// DIW Enable
- /// </summary>
- /// <returns></returns>
- public bool DiwEnable()
- {
- return WriteVariableValue(DIW_ENABLE, true);
- }
- /// <summary>
- /// DIW Disable
- /// </summary>
- /// <returns></returns>
- public bool DiwDisable()
- {
- return WriteVariableValue(DIW_ENABLE, false);
- }
- /// <summary>
- /// DIW Process On
- /// </summary>
- /// <returns></returns>
- public bool DiwProcessOn()
- {
- return WriteVariableValue(DIW_PROCESS, true);
- }
- /// <summary>
- /// DIW Process On
- /// </summary>
- /// <returns></returns>
- public bool DiwProcessOff()
- {
- return WriteVariableValue(DIW_PROCESS, false);
- }
- /// <summary>
- /// DIW Degas Valve On
- /// </summary>
- /// <returns></returns>
- public bool DiwDegasValveOn()
- {
- return WriteVariableValue(DIW_DEGAS, true);
- }
- /// <summary>
- /// DIW Degas Valve Off
- /// </summary>
- /// <returns></returns>
- public bool DiwDegasValveOff()
- {
- return WriteVariableValue(DIW_DEGAS, false);
- }
- #endregion
- #region N2Purge
- /// <summary>
- /// 打开N2 Purge
- /// </summary>
- /// <returns></returns>
- public bool N2PurgeValveOn()
- {
- return WriteVariableValue(DEGAS_PURGE, true);
- }
- /// <summary>
- /// 关闭N2 Purge
- /// </summary>
- /// <returns></returns>
- public bool N2PurgeValveOff()
- {
- return WriteVariableValue(DEGAS_PURGE, false);
- }
- #endregion
- /// <summary>
- /// 写变量
- /// </summary>
- /// <param name="variable"></param>
- /// <param name="value"></param>
- /// <returns></returns>
- private bool WriteVariableValue(string variable, object value)
- {
- string ioName = BeckhoffModuleIOManager.Instance.GetIoNameByInnerModuleName($"{Module}.{variable}");
- return IOModuleManager.Instance.WriteIoValue(ioName, value);
- }
- #endregion
- /// <summary>
- /// 定时器
- /// </summary>
- /// <returns></returns>
- public bool OnTimer()
- {
- _commonData.BoosterPumpPressureData.MinError = SC.GetValue<double>($"VPWMain.PumpPressure.Error_Min");
- _commonData.BoosterPumpPressureData.MinWarning = SC.GetValue<double>($"VPWMain.PumpPressure.Warning_Min");
- _commonData.BoosterPumpPressureData.MaxError = SC.GetValue<double>($"VPWMain.PumpPressure.Error_Max");
- _commonData.BoosterPumpPressureData.MaxWarning = SC.GetValue<double>($"VPWMain.PumpPressure.Warning_Max");
- _commonData.PressureTarget = SC.GetValue<double>($"VPWMain.PressureTarget");
- if (_status == RState.Running)
- {
- IRoutine routine = GetCurrentRoutine();
- if (routine != null)
- {
- RState rsState = routine.Monitor();
- if (rsState == RState.Failed || rsState == RState.Timeout)
- {
- _status = RState.Failed;
- _currentOperation = VPWOperation.None;
- LOG.WriteLog(eEvent.ERR_VPWMAIN, Module.ToString(), $"{_currentOperation} error");
- _isStartAutoSpeed = false;
- }
- else if (rsState == RState.End)
- {
- if (_currentOperation == VPWOperation.PumpEnable)
- {
- _isStartAutoSpeed = true;
- }
- else if (_currentOperation == VPWOperation.PumpDisable)
- {
- _isStartAutoSpeed = false;
- }
- _status = RState.End;
- _currentOperation = VPWOperation.None;
- }
- }
- }
- if (_isStartAutoSpeed)
- {
- AdjustPumpSpeed();
- }
- return true;
- }
- /// <summary>
- /// 调速
- /// </summary>
- public void AdjustPumpSpeed()
- {
- //Speed Auto模式同时pump enbled,根据kdi调整泵速
- if (_commonData.BoosterPumpSpeedAuto && _commonData.BoosterPumpEnable)
- {
- _pumpKp = SC.GetValue<double>($"VPWMain.PumpKp");
- _pumpKd = SC.GetValue<double>($"VPWMain.PumpKd");
- _pumpKi = SC.GetValue<double>($"VPWMain.PumpKi");
- double limit = SC.GetValue<double>("VPWMain.PrewetTargetLimit");
- double downLimit = SC.GetValue<double>("VPWMain.PrewetDownTargetLimit");
- double minSpeedDelta = SC.GetValue<double>("VPWMain.MinSpeedDelta");
- short speed = PdiAlgorithm.Instance.CalculateSpeed(_pumpKp, _pumpKi, _pumpKd, _commonData.PressureTarget,
- _commonData.BoosterPumpPressureData.Value, _lastBoosterPumpSpeed, limit, downLimit, minSpeedDelta);
- //short speed = PdiAlgorithm.Instance.CalculateSpeed(PrewetPumpData.PressureTarget, PrewetPumpData.PumpPressureData.Value,
- // _lastPumpSpeed, limit, downLimit);
- if (Math.Abs(speed - _lastBoosterPumpSpeed) >= 1)
- {
- _lastBoosterPumpSpeed = speed;
- BoosterPumpSpeed(speed);
- }
- }
- }
- /// <summary>
- /// 当前Routine;
- /// </summary>
- /// <returns></returns>
- private IRoutine GetCurrentRoutine()
- {
- switch (_currentOperation)
- {
- case VPWOperation.PumpEnable:
- return _boosterPumpEnableRoutine;
- case VPWOperation.PumpDisable:
- return _boosterPumpDisableRoutine;
- case VPWOperation.HomeAllRotation:
- return _simpleHomeRoutine;
- default:
- return null;
- }
- }
- /// <summary>
- /// 监控
- /// </summary>
- public void Monitor()
- {
- }
- public void Reset()
- {
- }
- public void Terminate()
- {
- }
- }
- }
|