using System; using System.Diagnostics; using System.Collections.Generic; using System.Collections.Concurrent; using System.Text.RegularExpressions; using MECF.Framework.Common.Communications; using MECF.Framework.Common.Equipment; using Aitex.Core.RT.SCCore; using Aitex.Core.RT.Event; using Aitex.Core.RT.Device; using Aitex.Core.RT.Log; using Venus_Core; using MECF.Framework.Common.Device.Bases; namespace Venus_RT.Devices { class AdixenTurboPump : TurboPump { public enum Operation { SetAddress, GetChecksum, GetFaultList, SetDatalogInterval, EnableDatalog, EnableEcho, DisableEcho, IdentifyDevice, IdentifyProduct, GetCurrentValues, SwitchSpeedToNormal, SwitchSpeedToStandbyValue, SetStandbySpeed, GetParametersState, GetIntervalParametersState, SetPumpWorkingTime, SetElectronicWorkingTime, SetStartDelay, SetTimeToVent, SetVentingTime, SetSpeedThreshold, SetControlTemperatrue, StopPumpThermostage, SetBearingThreshold, GetCurrentSpeed, StartPumpRotation, StopPump, SetVersions, SetAnalogOutput, SetTemperatureUnit, SetBuzzerOpt, SetCommandMode, SetBraking, Invalid, } private readonly Dictionary<Operation, string> _noneParaCommandOp = new Dictionary<Operation, string> { {Operation.EnableDatalog, "#{0:D3}DLR\r" }, {Operation.EnableEcho, "#{0:D3}ECHON\r" }, {Operation.DisableEcho, "#{0:D3}ECHOFF\r" }, {Operation.SwitchSpeedToNormal, "#{0:D3}NSP\r" }, {Operation.SwitchSpeedToStandbyValue, "#{0:D3}SBY\r" }, {Operation.StopPumpThermostage, "#{0:D3}SET31,30\r" }, {Operation.StartPumpRotation, "#{0:D3}TMPON\r" }, {Operation.StopPump, "#{0:D3}TMPOFF\r" }, }; private readonly Dictionary<Operation, string> _readDataCommandOp = new Dictionary<Operation, string> { {Operation.GetChecksum, "#{0:D3}CHKVS\r" }, {Operation.GetFaultList, "#{0:D3}DEF\r" }, {Operation.IdentifyDevice, "#{0:D3}IDN\r" }, {Operation.IdentifyProduct, "#{0:D3}IDP\r" }, {Operation.GetCurrentValues, "#{0:D3}LEV10\r" }, {Operation.GetParametersState, "#{0:D3}SEL10\r" }, {Operation.GetCurrentSpeed, "#{0:D3}SPD\r" }, {Operation.GetIntervalParametersState, "#{0:D3}STA\r" }, }; private readonly Dictionary<Operation, string> _setDataCommandOp = new Dictionary<Operation, string> { {Operation.SetAddress, "#{0:D3}ADR {1:D3}\r" }, {Operation.SetDatalogInterval, "#{0:D3}DLI {1:D3}\r" }, {Operation.SetStandbySpeed, "#{0:D3}RPM,{1:D4}\r" }, {Operation.SetPumpWorkingTime, "#{0:D3}SET10,{1:D5}\r" }, {Operation.SetElectronicWorkingTime, "#{0:D3}SET11,{1:D5}\r" }, {Operation.SetStartDelay, "#{0:D3}SET13,{1:D5}\r" }, {Operation.SetTimeToVent, "#{0:D3}SET14,{1:D5}\r" }, {Operation.SetVentingTime, "#{0:D3}SET15,{1:D4}\r" }, {Operation.SetSpeedThreshold, "#{0:D3}SET30,{1:D2}\r" }, {Operation.SetControlTemperatrue, "#{0:D3}SET31,{1:D2}\r" }, {Operation.SetBearingThreshold, "#{0:D3}SET32,{1:D3}\r" }, {Operation.SetAnalogOutput, "#{0:D3}OPT01,{1:D1}\r" }, {Operation.SetTemperatureUnit, "#{0:D3}OPT02,{1:D1}\r" }, {Operation.SetBuzzerOpt, "#{0:D3}OPT11,{1:D1}\r" }, {Operation.SetCommandMode, "#{0:D3}OPT14,{1:D1}\r" }, {Operation.SetBraking, "#{0:D3}OPT25,{1:D1}\r" }, }; private readonly Dictionary<string, string> _comError = new Dictionary<string, string> { {"Err0", "adjustment error(out of bounds)" }, {"Err1", "command error (syntax) " }, {"Err2", "parameter error (e.g. non hexadecimal character)" }, {"Err3", "context error" }, {"Err4", "checksum error" }, }; private readonly ushort PUMP_ON_FLAG = 0x02; private readonly ushort PUMP_ERROR_FLAG = 0x40; private readonly ushort ISO_VALVE_OPEN_FLAG = 0x01; private readonly ushort WATER_VALVE_OEPN_FLAG = 0x08; private readonly ushort VALVE_AT_SPEED_FLAG = 0x40; public override bool IsRunning { get { return (_pumpStatus & PUMP_ON_FLAG) == PUMP_ON_FLAG; } } public override bool IsError { get { return (_pumpStatus & PUMP_ERROR_FLAG) == PUMP_ERROR_FLAG; } } public bool IsISOValveOpen { get { return (_valveStatus & ISO_VALVE_OPEN_FLAG) == ISO_VALVE_OPEN_FLAG; } } public bool IsWaterValveOpen { get { return (_valveStatus & WATER_VALVE_OEPN_FLAG) == WATER_VALVE_OEPN_FLAG; } } public bool AtSpeed { get { return (_valveStatus & VALVE_AT_SPEED_FLAG) == VALVE_AT_SPEED_FLAG; } } public string sTemperature { get { return Temperature.ToString(); } } public string RotationalSpeed { get { return Speed.ToString(); } } private readonly int _timeout = 2000; private readonly int _address = 0; private readonly int _internal_parameters_length = 78; private readonly AsyncSerialPort _serial; private Stopwatch _queryWatch = new Stopwatch(); private ConcurrentQueue<Operation> _queCommands = new ConcurrentQueue<Operation>(); private Operation _lastCommand = Operation.Invalid; private string _lastAlarmString = string.Empty; private Regex _rex_ok = new Regex(@"#\d{1,3},OK"); private Regex _rex_err = new Regex(@"#\d{1,3},Err"); private byte _pumpStatus = 0; private byte _valveStatus = 0; public AdixenTurboPump(ModuleName mod) { Name = VenusDevice.TurboPump.ToString(); Module = mod.ToString(); var _PortNum = SC.GetStringValue($"{mod}.TurboPump.Port"); _serial = new AsyncSerialPort(_PortNum, 9600, 8, System.IO.Ports.Parity.None, System.IO.Ports.StopBits.One, "\r", false); } public override bool Initialize() { if (!_serial.Open()) { LOG.Write(eEvent.ERR_TURBO_PUMP, Module, "Adixen Turbo Pump 串口无法打开"); return false; } _serial.OnDataChanged += OnPortDataChanged; _serial.OnBinaryDataChanged += OnPortBinaryDataChanged; _serial.OnErrorHappened += OnErrorOccurred; return true; } public override void Monitor() { if(_lastCommand == Operation.Invalid) { if(_queCommands.IsEmpty) { _sendCommand(Operation.GetIntervalParametersState); _lastCommand = Operation.GetIntervalParametersState; } else { Operation command; if(_queCommands.TryDequeue(out command)) { _sendCommand(command); _lastCommand = command; } } } else if(_queryWatch.ElapsedMilliseconds >= _timeout) { _noRepeatAlarm($"last command: {_lastCommand} timeout"); Reset(); } } public override void Reset() { Operation result; while (_queCommands.TryDequeue(out result)) ; //_serial.ClearPortBuffer(); _lastCommand = Operation.Invalid; } public override void Terminate() { _serial?.Close(); } private void OnErrorOccurred(string obj) { _noRepeatAlarm($"[{Module}] Adixen Turbo Pump serial port error: [{obj}]"); } private void OnPortDataChanged(string obj) { try { if (obj.Substring(0, 2) == "OK") { _lastCommand = Operation.Invalid; return; } if(obj.Substring(0, 3) == "Err") { if (_comError.ContainsKey(obj.Substring(0, 4))) { _noRepeatAlarm($"Adixen Turbo Pump communication error: {_comError[obj.Substring(0, 4)]}"); } else { _noRepeatAlarm($"Adixen Turbo Pump unknown communication error: {obj}"); } _lastCommand = Operation.Invalid; return; } if(_lastCommand == Operation.Invalid) { LOG.Write(eEvent.ERR_TURBO_PUMP, Module, $"Adixen Turbo Pump unexpected communication data: {obj}"); return; } var result_data = obj.Trim().Split(','); switch(_lastCommand) { case Operation.GetCurrentSpeed: if(result_data.Length >= 2) { var str_speed = result_data[1].Split(); int speed = 0; if (int.TryParse(str_speed[0], out speed)) { Speed = speed; } } break; case Operation.GetIntervalParametersState: if(result_data.Length >= 9) { int speed = 0; int temp = 0; if(int.TryParse(result_data[0], out speed)) { Speed = speed; } if(int.TryParse(result_data[8], out temp)) { Temperature = temp; } } break; } _lastCommand = Operation.Invalid; } catch (Exception ex) { _noRepeatAlarm($"[{Module}] Adixen Turbo Pump error: [{ex.Message}], Data: {obj}"); } } private void OnPortBinaryDataChanged(byte[] obj) { bool bValidate = false; for(int i=0; i< obj.Length; i++) { if(obj[i] == (byte)'#') { int nOffset = 5; if(_lastCommand == Operation.GetIntervalParametersState && obj.Length - i >= _internal_parameters_length) { _pumpStatus = obj[i + 6]; _valveStatus = obj[i + 7]; nOffset = 9; } byte[] array = new byte[obj.Length - i - nOffset]; Array.Copy(obj, i + nOffset, array, 0, obj.Length - i - nOffset); var strData = System.Text.Encoding.Default.GetString(array); OnPortDataChanged(strData); bValidate = true; break; } } if(!bValidate) { var strData = System.Text.Encoding.Default.GetString(obj); _noRepeatAlarm($"Receive invalidate data:{strData} "); } } public override void SetPumpOnOff(bool on) { _queCommands.Enqueue(on ? Operation.StartPumpRotation : Operation.StopPump); } private bool _sendCommand(Operation op) { if (_noneParaCommandOp.ContainsKey(op)) { var cmd = string.Format(_noneParaCommandOp[op], _address); return _sendCmd(cmd); } else if (_readDataCommandOp.ContainsKey(op)) { var cmd = string.Format(_readDataCommandOp[op], _address); return _sendCmd(cmd); } _noRepeatAlarm($"Adixen Turbo Pump: The {op} command need parameters"); return false; } private bool _sendCommand(Operation op, int data) { if (_setDataCommandOp.ContainsKey(op)) { var cmd = string.Format(_setDataCommandOp[op], _address, data); return _sendCmd(cmd); } _noRepeatAlarm($"Adixen Turbo Pump: The command {op} does not need one parameter"); return false; } private bool _sendCmd(string cmd) { _queryWatch.Restart(); return _serial.Write(cmd); } private void _noRepeatAlarm(string alarm) { if(_lastAlarmString != alarm) { _lastAlarmString = alarm; LOG.Write(eEvent.ERR_TURBO_PUMP, Module, alarm); } } } }