首次上传

This commit is contained in:
hanqiangqiang
2026-06-15 10:56:30 +08:00
commit b0213b94d6
4160 changed files with 736101 additions and 0 deletions
@@ -0,0 +1,912 @@
using System;
using System.Collections.Generic;
using System.IO.Ports;
using System.Linq;
using Aitex.Core.RT.Event;
using Aitex.Core.RT.Log;
using Aitex.Core.RT.SCCore;
using Aitex.Core.Util;
using MECF.Framework.Common.Communications;
using MECF.Framework.RT.EquipmentLibrary.HardwareUnits.Common;
namespace MECF.Framework.RT.EquipmentLibrary.HardwareUnits.RFMatchs.Comet
{
public class CometRFMatch : SerialPortDevice, IConnection
{
public string Address { get { return _address; } }
public bool IsConnected { get; }
public bool Connect()
{
return true;
}
public bool Disconnect()
{
return true;
}
public string PortStatus { get; set; } = "Closed";
private CometRFMatchConnection _connection;
public CometRFMatchConnection Connection
{
get { return _connection; }
}
private R_TRIG _trigError = new R_TRIG();
private R_TRIG _trigCommunicationError = new R_TRIG();
private R_TRIG _trigRetryConnect = new R_TRIG();
private PeriodicJob _thread;
private LinkedList<HandlerBase> _lstHandler = new LinkedList<HandlerBase>();
private LinkedList<HandlerBase> _lstMonitorHandler = new LinkedList<HandlerBase>();
public List<IOResponse> IOResponseList { get; set; } = new List<IOResponse>();
private object _locker = new object();
private bool _enableLog;
private string _address;
private string _scRoot;
public CometRFMatch(string module, string name, string scRoot, string portName) : base(module, name)
{
_scRoot = scRoot;
PortName = portName;
}
private void ResetPropertiesAndResponses()
{
foreach (var ioResponse in IOResponseList)
{
ioResponse.ResonseContent = null;
ioResponse.ResonseRecievedTime = DateTime.Now;
}
}
public override bool Initialize(string portName)
{
base.Initialize(portName);
ResetPropertiesAndResponses();
if (_connection != null && _connection.IsConnected && PortName == portName)
return true;
if (_connection != null && _connection.IsConnected)
_connection.Disconnect();
PortName = portName;
_address = SC.GetStringValue($"{_scRoot}.{Module}.{Name}.DeviceAddress");
_enableLog = SC.GetValue<bool>($"{_scRoot}.{Module}.{Name}.EnableLogMessage");
_connection = new CometRFMatchConnection(PortName);
_connection.EnableLog(_enableLog);
if (_connection.Connect())
{
PortStatus = "Open";
EV.PostInfoLog(Module, $"{Module}.{Name} connected");
}
_thread = new PeriodicJob(100, OnTimer, $"{Module}.{Name} MonitorHandler", true);
return true;
}
public bool InitConnection(string portName, int bautRate, int dataBits, Parity parity, StopBits stopBits)
{
_connection = new CometRFMatchConnection(portName, bautRate, dataBits, parity, stopBits);
if (_connection.Connect())
{
EV.PostInfoLog(Module, $"{Module}.{Name} connected");
}
_thread = new PeriodicJob(100, OnTimer, $"{Module}.{Name} MonitorHandler", true);
return true;
}
private bool OnTimer()
{
try
{
//_connection.MonitorTimeout();
if (!_connection.IsConnected || _connection.IsCommunicationError)
{
lock (_locker)
{
_lstHandler.Clear();
}
_trigRetryConnect.CLK = !_connection.IsConnected;
if (_trigRetryConnect.Q)
{
_connection.SetPortAddress(SC.GetStringValue($"{ScBasePath}.{Name}.Address"));
if (!_connection.Connect())
{
EV.PostAlarmLog(Module, $"Can not connect with {_connection.Address}, {Module}.{Name}");
}
else
{
//_lstHandler.AddLast(new CommetRFMatchQueryPinHandler(this, _deviceAddress));
//_lstHandler.AddLast(new CommetRFMatchSetCommModeHandler(this, _deviceAddress, EnumRfPowerCommunicationMode.Host));
}
}
return true;
}
HandlerBase handler = null;
if (!_connection.IsBusy)
{
lock (_locker)
{
if (_lstHandler.Count == 0)
{
foreach (var monitorHandler in _lstMonitorHandler)
{
_lstHandler.AddLast(monitorHandler);
}
}
if (_lstHandler.Count > 0)
{
handler = _lstHandler.First.Value;
_lstHandler.RemoveFirst();
}
}
if (handler != null)
{
_connection.Execute(handler);
}
}
}
catch (Exception ex)
{
LOG.Write(ex);
}
return true;
}
internal void NoteNAK(ResponseNAK nak)
{
ResponseNAK = nak;
}
public override void Monitor()
{
try
{
//_connection.EnableLog(_enableLog);
_trigCommunicationError.CLK = _connection.IsCommunicationError;
if (_trigCommunicationError.Q)
{
EV.PostAlarmLog(Module, $"{Module}.{Name} communication error, {_connection.LastCommunicationError}");
}
}
catch (Exception ex)
{
LOG.Write(ex);
}
}
public override void Reset()
{
_trigError.RST = true;
_connection.SetCommunicationError(false, "");
_trigCommunicationError.RST = true;
//_enableLog = SC.GetValue<bool>($"{ScBasePath}.{Name}.EnableLogMessage");
_trigRetryConnect.RST = true;
base.Reset();
}
public override bool Home(out string reason)
{
return base.Home(out reason);
}
#region Command Functions
public void PerformRawCommand(string command, string completeEvent, string comandArgument)
{
lock (_locker)
{
_lstHandler.AddLast(new CommetRFMatchRawCommandHandler(this, command, completeEvent, comandArgument));
}
}
public void TriggerFullRefRun()
{
lock (_locker)
{
_lstHandler.AddLast(new CommetRFMatchTriggerHandler(this, "10,00", "10,01", "FullRefRunCompleted"));
}
}
public void TriggerGotoCap()
{
lock (_locker)
{
_lstHandler.AddLast(new CommetRFMatchTriggerHandler(this, "20,00", "20,01", "GotoCapCompleted"));
}
}
public void TriggerGotoFullStepPos()
{
lock (_locker)
{
_lstHandler.AddLast(new CommetRFMatchTriggerHandler(this, "21,00", "21,01", "GotoFullStepPosCompleted"));
}
}
public void TriggerMoveFullSteps()
{
lock (_locker)
{
_lstHandler.AddLast(new CommetRFMatchTriggerHandler(this, "22,00", "22,01", "MoveFullStepsCompleted"));
}
}
public void TriggerGotoCmin()
{
lock (_locker)
{
_lstHandler.AddLast(new CommetRFMatchTriggerHandler(this, "23,00", "23,01", "GotoCminCompleted"));
}
}
public void TriggerGotoCmax()
{
lock (_locker)
{
_lstHandler.AddLast(new CommetRFMatchTriggerHandler(this, "24,00", "24,01", "GotoCmaxCompleted"));
}
}
public void TriggerGotoMicroStepPos()
{
lock (_locker)
{
_lstHandler.AddLast(new CommetRFMatchTriggerHandler(this, "25,00", "25,01", "GotoMicroStepPosCompleted"));
}
}
public void TriggerMoveMicroSteps()
{
lock (_locker)
{
_lstHandler.AddLast(new CommetRFMatchTriggerHandler(this, "26,00", "26,01", "MoveMicroStepsCompleted"));
}
}
public void TriggerGotoStoredPos()
{
lock (_locker)
{
_lstHandler.AddLast(new CommetRFMatchTriggerHandler(this, "27,00", "27,01", "GotoStoredPosCompleted"));
}
}
public void SetAccelerationSpeedIndex(byte acceleration, byte speed)
{
lock (_locker)
{
_lstHandler.AddLast(new CommetRFMatchSetHandler(this, "43,00", acceleration.ToString("X2") + "," + speed.ToString("X2")));
}
}
public void SetAccelerationSpeedIndex(string acceleration, string speed)
{
lock (_locker)
{
_lstHandler.AddLast(new CommetRFMatchSetHandler(this, "43,00", acceleration + "," + speed));
}
}
public void SetCurrent(byte idleCurrent, byte driveCurrent)
{
lock (_locker)
{
_lstHandler.AddLast(new CommetRFMatchSetHandler(this, "45,00", idleCurrent.ToString("X2") + "," + driveCurrent.ToString("X2")));
}
}
public void SetCurrent(string idleCurrent, string driveCurrent)
{
lock (_locker)
{
_lstHandler.AddLast(new CommetRFMatchSetHandler(this, "45,00", idleCurrent + "," + driveCurrent));
}
}
public void SetLowerCustomerLimit(short lowerLimit)
{
lock (_locker)
{
_lstHandler.AddLast(new CommetRFMatchSetHandler(this, "72,01", lowerLimit));
}
}
public void SetLowerCustomerLimit(string lowerLimit)
{
lock (_locker)
{
_lstHandler.AddLast(new CommetRFMatchSetHandler(this, "72,01", short.Parse(lowerLimit)));
}
}
public void SetUpperCustomerLimit(short upperLimit)
{
lock (_locker)
{
_lstHandler.AddLast(new CommetRFMatchSetHandler(this, "72,02", upperLimit));
}
}
public void SetUpperCustomerLimit(string upperLimit)
{
lock (_locker)
{
_lstHandler.AddLast(new CommetRFMatchSetHandler(this, "72,02", short.Parse(upperLimit)));
}
}
public void StoreIndexedPosition(byte index, short positon)
{
lock (_locker)
{
_lstHandler.AddLast(new CommetRFMatchSetHandler(this, "75,00", index, positon));
}
}
public void StoreIndexedPosition(string index, string positon)
{
lock (_locker)
{
_lstHandler.AddLast(new CommetRFMatchSetHandler(this, "75,00", byte.Parse(index), short.Parse(positon)));
}
}
public double ActualCap { get; set; }
public void GetActualCap(bool isSelected)
{
lock (_locker)
{
string propName = "ActualCap";
var existHandlers = _lstMonitorHandler.Where(handler => handler.GetType() == typeof(CommetRFMatchGetDoubleValueHandler) && ((CometRFMatchHandler)handler).DevicePropName == propName);
if (isSelected)
{
if (!existHandlers.Any())
_lstMonitorHandler.AddFirst(new CommetRFMatchGetDoubleValueHandler(this, "40,01", "41,01", propName, 0.1));
}
else
{
if (existHandlers.Any())
{
_lstMonitorHandler.Remove(existHandlers.First());
}
}
}
}
public short ActualFullStepPos { get; set; }
public void GetActualFullStepPos(bool isSelected)
{
lock (_locker)
{
string propName = "ActualFullStepPos";
var existHandlers = _lstMonitorHandler.Where(handler => handler.GetType() == typeof(CommetRFMatchGetShortValueHandler) && ((CometRFMatchHandler)handler).DevicePropName == propName);
if (isSelected)
{
if (!existHandlers.Any())
_lstMonitorHandler.AddFirst(new CommetRFMatchGetShortValueHandler(this, "40,02", "41,02", propName));
}
else
{
if (existHandlers.Any())
{
_lstMonitorHandler.Remove(existHandlers.First());
}
}
}
}
public double MinimumCap { get; set; }
public void GetMinimumCap(bool isSelected)
{
lock (_locker)
{
string propName = "MinimumCap";
var existHandlers = _lstMonitorHandler.Where(handler => handler.GetType() == typeof(CommetRFMatchGetDoubleValueHandler) && ((CometRFMatchHandler)handler).DevicePropName == propName);
if (isSelected)
{
if (!existHandlers.Any())
_lstMonitorHandler.AddFirst(new CommetRFMatchGetDoubleValueHandler(this, "40,10", "41,10", propName, 0.1));
}
else
{
if (existHandlers.Any())
{
_lstMonitorHandler.Remove(existHandlers.First());
}
}
}
}
public double MaximumCap { get; set; }
public void GetMaximumCap(bool isSelected)
{
lock (_locker)
{
string propName = "MaximumCap";
var existHandlers = _lstMonitorHandler.Where(handler => handler.GetType() == typeof(CommetRFMatchGetDoubleValueHandler) && ((CometRFMatchHandler)handler).DevicePropName == propName);
if (isSelected)
{
if (!existHandlers.Any())
_lstMonitorHandler.AddFirst(new CommetRFMatchGetDoubleValueHandler(this, "40,11", "41,11", propName, 0.1));
}
else
{
if (existHandlers.Any())
{
_lstMonitorHandler.Remove(existHandlers.First());
}
}
}
}
public short MinimumFullStepPos { get; set; }
public void GetMinimumFullStepPos(bool isSelected)
{
lock (_locker)
{
string propName = "MinimumFullStepPos";
var existHandlers = _lstMonitorHandler.Where(handler => handler.GetType() == typeof(CommetRFMatchGetShortValueHandler) && ((CometRFMatchHandler)handler).DevicePropName == propName);
if (isSelected)
{
if (!existHandlers.Any())
_lstMonitorHandler.AddFirst(new CommetRFMatchGetShortValueHandler(this, "40,12", "41,12", propName));
}
else
{
if (existHandlers.Any())
{
_lstMonitorHandler.Remove(existHandlers.First());
}
}
}
}
public short MaximumFullStepPos { get; set; }
public void GetMaximumFullStepPos(bool isSelected)
{
lock (_locker)
{
string propName = "MaximumFullStepPos";
var existHandlers = _lstMonitorHandler.Where(handler => handler.GetType() == typeof(CommetRFMatchGetShortValueHandler) && ((CometRFMatchHandler)handler).DevicePropName == propName);
if (isSelected)
{
if (!existHandlers.Any())
_lstMonitorHandler.AddFirst(new CommetRFMatchGetShortValueHandler(this, "40,13", "41,13", propName));
}
else
{
if (existHandlers.Any())
{
_lstMonitorHandler.Remove(existHandlers.First());
}
}
}
}
//parse
public short AccelerationSpeed { get; set; }
public void GetAccelerationSpeed(bool isSelected)
{
lock (_locker)
{
string propName = "AccelerationSpeed";
var existHandlers = _lstMonitorHandler.Where(handler => handler.GetType() == typeof(CommetRFMatchGetShortValueHandler) && ((CometRFMatchHandler)handler).DevicePropName == propName);
if (isSelected)
{
if (!existHandlers.Any())
_lstMonitorHandler.AddFirst(new CommetRFMatchGetShortValueHandler(this, "40,21", "41,21", propName));
}
else
{
if (existHandlers.Any())
{
_lstMonitorHandler.Remove(existHandlers.First());
}
}
}
}
//parse
public int Status { get; set; }
public void GetStatus(bool isSelected)
{
lock (_locker)
{
string propName = "Status";
var existHandlers = _lstMonitorHandler.Where(handler => handler.GetType() == typeof(CommetRFMatchGetDoubleValueHandler) && ((CometRFMatchHandler)handler).DevicePropName == propName);
if (isSelected)
{
if (!existHandlers.Any())
_lstMonitorHandler.AddFirst(new CommetRFMatchGetShortValueHandler(this, "40,22", "41,22", propName));
}
else
{
if (existHandlers.Any())
{
_lstMonitorHandler.Remove(existHandlers.First());
}
}
}
}
//need special handler ??
public short CcurveIndexedFullStepCap { get; set; }
public void GetCcurveIndexedFullStepCap(bool isSelected, int tableIndex)
{
lock (_locker)
{
string propName = "CcurveIndexedFullStepCap";
var existHandlers = _lstMonitorHandler.Where(handler => handler.GetType() == typeof(CommetRFMatchGetShortValueHandler) && ((CometRFMatchHandler)handler).DevicePropName == propName);
if (isSelected)
{
if (!existHandlers.Any())
_lstMonitorHandler.AddFirst(new CommetRFMatchGetShortValueHandler(this, "40,30", "41,30", propName));
}
else
{
if (existHandlers.Any())
{
_lstMonitorHandler.Remove(existHandlers.First());
}
}
}
}
public byte ControllerTemp { get; set; }
public void GetControllerTemp(bool isSelected)
{
lock (_locker)
{
string propName = "ControllerTemp";
var existHandlers = _lstMonitorHandler.Where(handler => handler.GetType() == typeof(CommetRFMatchGetByteValueHandler) && ((CometRFMatchHandler)handler).DevicePropName == propName);
if (isSelected)
{
if (!existHandlers.Any())
_lstMonitorHandler.AddFirst(new CommetRFMatchGetByteValueHandler(this, "40,32", "41,32", propName));
}
else
{
if (existHandlers.Any())
{
_lstMonitorHandler.Remove(existHandlers.First());
}
}
}
}
public uint MicroStepPos { get; set; }
public void GetMicroStepPos(bool isSelected)
{
lock (_locker)
{
string propName = "MicroStepPos";
var existHandlers = _lstMonitorHandler.Where(handler => handler.GetType() == typeof(CommetRFMatchGetIntValueHandler) && ((CometRFMatchHandler)handler).DevicePropName == propName);
if (isSelected)
{
if (!existHandlers.Any())
_lstMonitorHandler.AddFirst(new CommetRFMatchGetIntValueHandler(this, "40,36", "41,36", propName));
}
else
{
if (existHandlers.Any())
{
_lstMonitorHandler.Remove(existHandlers.First());
}
}
}
}
public double CminNom { get; set; }
public void GetCminNom(bool isSelected)
{
lock (_locker)
{
string propName = "CminNom";
var existHandlers = _lstMonitorHandler.Where(handler => handler.GetType() == typeof(CommetRFMatchGetDoubleValueHandler) && ((CometRFMatchHandler)handler).DevicePropName == propName);
if (isSelected)
{
if (!existHandlers.Any())
_lstMonitorHandler.AddFirst(new CommetRFMatchGetDoubleValueHandler(this, "40,70", "41,70", propName, 0.1));
}
else
{
if (existHandlers.Any())
{
_lstMonitorHandler.Remove(existHandlers.First());
}
}
}
}
public double CmaxNom { get; set; }
public void GetCmaxNom(bool isSelected)
{
lock (_locker)
{
string propName = "CmaxNom";
var existHandlers = _lstMonitorHandler.Where(handler => handler.GetType() == typeof(CommetRFMatchGetDoubleValueHandler) && ((CometRFMatchHandler)handler).DevicePropName == propName);
if (isSelected)
{
if (!existHandlers.Any())
_lstMonitorHandler.AddFirst(new CommetRFMatchGetDoubleValueHandler(this, "40,11", "41,11", propName, 0.1));
}
else
{
if (existHandlers.Any())
{
_lstMonitorHandler.Remove(existHandlers.First());
}
}
}
}
public double LowerCustomerLimit { get; set; }
public void GetLowerCustomerLimit(bool isSelected)
{
lock (_locker)
{
string propName = "LowerCustomerLimit";
var existHandlers = _lstMonitorHandler.Where(handler => handler.GetType() == typeof(CommetRFMatchGetLimitHandler) && ((CometRFMatchHandler)handler).DevicePropName == propName);
if (isSelected)
{
if (!existHandlers.Any())
_lstMonitorHandler.AddFirst(new CommetRFMatchGetLimitHandler(this, "40,72", "41,72", propName,"01"));
}
else
{
if (existHandlers.Any())
{
_lstMonitorHandler.Remove(existHandlers.First());
}
}
}
}
public double UpperCustomerLimit { get; set; }
public void GetUpperCustomerLimit(bool isSelected)
{
lock (_locker)
{
string propName = "UpperCustomerLimit";
var existHandlers = _lstMonitorHandler.Where(handler => handler.GetType() == typeof(CommetRFMatchGetLimitHandler) && ((CometRFMatchHandler)handler).DevicePropName == propName);
if (isSelected)
{
if (!existHandlers.Any())
_lstMonitorHandler.AddFirst(new CommetRFMatchGetLimitHandler(this, "40,72", "41,72", propName, "02"));
}
else
{
if (existHandlers.Any())
{
_lstMonitorHandler.Remove(existHandlers.First());
}
}
}
}
public double LowerFactoryLimit { get; set; }
public void GetLowerFactoryLimit(bool isSelected)
{
lock (_locker)
{
string propName = "LowerFactoryLimit";
var existHandlers = _lstMonitorHandler.Where(handler => handler.GetType() == typeof(CommetRFMatchGetLimitHandler) && ((CometRFMatchHandler)handler).DevicePropName == propName);
if (isSelected)
{
if (!existHandlers.Any())
_lstMonitorHandler.AddFirst(new CommetRFMatchGetLimitHandler(this, "40,72", "41,72", propName, "03"));
}
else
{
if (existHandlers.Any())
{
_lstMonitorHandler.Remove(existHandlers.First());
}
}
}
}
public double UpperFactoryLimit { get; set; }
public void GetUpperFactoryLimit(bool isSelected)
{
lock (_locker)
{
string propName = "UpperFactoryLimit";
var existHandlers = _lstMonitorHandler.Where(handler => handler.GetType() == typeof(CommetRFMatchGetLimitHandler) && ((CometRFMatchHandler)handler).DevicePropName == propName);
if (isSelected)
{
if (!existHandlers.Any())
_lstMonitorHandler.AddFirst(new CommetRFMatchGetLimitHandler(this, "40,72", "41,72", propName, "04"));
}
else
{
if (existHandlers.Any())
{
_lstMonitorHandler.Remove(existHandlers.First());
}
}
}
}
public double PresetCap { get; set; }
public void GetPresetCap(bool isSelected)
{
lock (_locker)
{
string propName = "PresetCap";
var existHandlers = _lstMonitorHandler.Where(handler => handler.GetType() == typeof(CommetRFMatchGetLimitHandler) && ((CometRFMatchHandler)handler).DevicePropName == propName);
if (isSelected)
{
if (!existHandlers.Any())
_lstMonitorHandler.AddFirst(new CommetRFMatchGetLimitHandler(this, "40,73", "41,73", propName, "00"));
}
else
{
if (existHandlers.Any())
{
_lstMonitorHandler.Remove(existHandlers.First());
}
}
}
}
public short PresetFullStepPos { get; set; }
public void GetPresetFullStepPos(bool isSelected)
{
lock (_locker)
{
string propName = "PresetFullStepPos";
var existHandlers = _lstMonitorHandler.Where(handler => handler.GetType() == typeof(CommetRFMatchGet3ByteHandler) && ((CometRFMatchHandler)handler).DevicePropName == propName);
if (isSelected)
{
if (!existHandlers.Any())
_lstMonitorHandler.AddFirst(new CommetRFMatchGet3ByteHandler(this, "40,73", "41,73", propName, "01"));
}
else
{
if (existHandlers.Any())
{
_lstMonitorHandler.Remove(existHandlers.First());
}
}
}
}
public short StoredFullStepPos { get; set; }
public void GetStoredFullStepPos(bool isSelected, int index)
{
lock (_locker)
{
string propName = "PresetFullStepPos";
var existHandlers = _lstMonitorHandler.Where(handler => handler.GetType() == typeof(CommetRFMatchGet3ByteHandler) && ((CometRFMatchHandler)handler).DevicePropName == propName);
if (isSelected)
{
if (!existHandlers.Any())
_lstMonitorHandler.AddFirst(new CommetRFMatchGet3ByteHandler(this, "40,75", "41,75", propName, index.ToString("X2")));
}
else
{
if (existHandlers.Any())
{
_lstMonitorHandler.Remove(existHandlers.First());
}
}
}
}
public void MonitorRawCommand(bool isSelected, string command, string completeEvent, string comandArgument)
{
lock (_locker)
{
var existHandlers = _lstMonitorHandler.Where(handler => handler.GetType() == typeof(CommetRFMatchRawCommandHandler) && ((CometRFMatchHandler)handler)._command == command);
if (isSelected)
{
if (!existHandlers.Any())
_lstMonitorHandler.AddFirst(new CommetRFMatchRawCommandHandler(this, command, completeEvent, comandArgument));
}
else
{
if (existHandlers.Any())
{
_lstMonitorHandler.Remove(existHandlers.First());
}
}
}
}
#endregion
#region Properties
public string Error { get; private set; }
public ResponseNAK ResponseNAK { get; private set; }
public bool FullRefRunCompleted { get; private set; }
public bool GotoCapCompleted { get; private set; }
public bool GotoFullStepPosCompleted { get; private set; }
public bool MoveFullStepsCompleted { get; private set; }
public bool GotoCminCompleted { get; private set; }
public bool GotoCmaxCompleted { get; private set; }
public bool GotoMicroStepPosCompleted { get; private set; }
public bool MoveMicroStepsCompleted { get; private set; }
public bool GotoStoredPosCompleted { get; private set; }
public byte Acceleration { get; private set; }
public byte SpeedIndex { get; private set; }
public bool SetCommandCompleted { get; private set; }
#endregion
#region Note Functions
private R_TRIG _trigWarningMessage = new R_TRIG();
public void NoteError(string reason)
{
if (reason != null)
{
_trigWarningMessage.CLK = true;
if (_trigWarningMessage.Q)
{
EV.PostWarningLog(Module, $"{Module}.{Name} error, {reason}");
}
Error = reason;
}
else
{
Error = null;
}
}
internal void NoteRawCommandInfo(string command, string data)
{
var curIOResponse = IOResponseList.Find(res => res.SourceCommandName == command);
if (curIOResponse != null)
{
IOResponseList.Remove(curIOResponse);
}
IOResponseList.Add(new IOResponse() { SourceCommand = command, ResonseContent = data, ResonseRecievedTime = DateTime.Now });
}
internal void NoteSetComplted()
{
SetCommandCompleted = true;
}
#endregion
}
public enum ResponseNAK
{
NotNak,
CommandNotDefined,
CheckSumFailed,
PositionOverLimit,
IndexOutOfRange
}
}
@@ -0,0 +1,83 @@
using System.IO.Ports;
using System.Linq;
using Aitex.Core.RT.Log;
using MECF.Framework.Common.Communications;
namespace MECF.Framework.RT.EquipmentLibrary.HardwareUnits.RFMatchs.Comet
{
public class CometRFMatchMessage : BinaryMessage
{
public string Command { get; set; }
public string ErrorCode { get; set; }
public byte[] Data { get; set; }
}
public class CometRFMatchConnection : SerialPortConnectionBase
{
private static byte _start = 0xAA;
private static byte _address = 0x21;
public CometRFMatchConnection(string portName, int baudRate = 9600, int dataBits = 8, Parity parity = Parity.None, StopBits stopBits = StopBits.One)
: base(portName, baudRate, dataBits, parity, stopBits, "", false)
{
}
public override bool SendMessage(byte[] message)
{
return base.SendMessage(message);
}
protected override MessageBase ParseResponse(byte[] rawMessage)
{
CometRFMatchMessage msg = new CometRFMatchMessage();
msg.RawMessage = rawMessage;
//msg.Data = rawMessage;
if (rawMessage.Length < 4)
{
msg.IsFormatError = true;
LOG.Error($"invalid response");
return msg;
}
if (rawMessage[0] != _start )
{
msg.IsFormatError = true;
LOG.Error($"invalid start byte");
return msg;
}
if (rawMessage[1] != _address)
{
msg.IsFormatError = true;
LOG.Error($"invalid address byte");
return msg;
}
byte checkSum = 0;
for (int i = 0; i < rawMessage.Length-1; i++)
{
checkSum += rawMessage[i];
}
var recSum = rawMessage[rawMessage.Length - 1];
if (recSum != checkSum)
{
LOG.Error($"check sum failed,");
msg.IsFormatError = true;
return msg;
}
//command&data
msg.Data = rawMessage.Skip(2).Take(rawMessage.Length - 3).ToArray();
msg.IsResponse = true;
msg.IsAck = true;
msg.IsComplete = true;
return msg;
}
}
}
@@ -0,0 +1,618 @@
using MECF.Framework.Common.Communications;
using System;
using System.Collections.Generic;
using System.Linq;
namespace MECF.Framework.RT.EquipmentLibrary.HardwareUnits.RFMatchs.Comet
{
public enum RFMatchResponseResult
{
InvalidResonse,
TriggerAck,
TriggerNAK,
CheckInProcess,
CheckCompleted
}
public abstract class CometRFMatchHandler : HandlerBase
{
public CometRFMatch Device { get; }
public string _command;
protected string _parameter;
protected string _completeEvent;
protected CometRFMatchHandler(CometRFMatch device, string command, string completeEvent, string parameter)
: base(BuildMessage(StringToByteArray(command), StringToByteArray(parameter)))
{
Device = device;
_command = command;
_completeEvent = completeEvent;
_parameter = parameter;
_address = Convert.ToByte(Device.Address, 16);
Name = command;
}
protected CometRFMatchHandler(CometRFMatch device, string command)
: base(BuildMessage(StringToByteArray(command)))
{
Device = device;
_command = command;
_address = Convert.ToByte(Device.Address, 16);
Name = command;
}
protected CometRFMatchHandler(CometRFMatch device, string command, string parameter)
: base(BuildMessage(StringToByteArray(command), StringToByteArray(parameter)))
{
Device = device;
_command = command;
_parameter = parameter;
_address = Convert.ToByte(Device.Address, 16);
Name = command;
}
protected CometRFMatchHandler(CometRFMatch device, string command, byte[] parameter)
: base(BuildMessage(StringToByteArray(command), parameter))
{
Device = device;
_command = command;
//_parameter = parameter;
Name = command;
}
private static byte _start = 0xAA;
private static byte _address = 0x21;
protected static byte[] BuildMessage(byte[] commandArray, byte[] argumentArray = null)
{
List<byte> buffer = new List<byte>();
buffer.Add(_start);
buffer.Add(_address);
if (commandArray != null && commandArray.Length > 0)
{
buffer.AddRange(commandArray);
}
if (argumentArray != null && argumentArray.Length > 0)
{
buffer.AddRange(argumentArray);
}
byte checkSum = 0;
for(int i = 0; i < buffer.Count; i++)
{
checkSum += buffer[i];
}
buffer.Add(checkSum);
return buffer.ToArray();
}
protected static byte[] BuildMessage(string commandStr, byte[] argumentArray = null)
{
byte[] commandArray = StringToByteArray(commandStr);
List<byte> buffer = new List<byte>();
buffer.Add(_start);
buffer.Add(_address);
if (commandArray != null && commandArray.Length > 0)
{
buffer.AddRange(commandArray);
}
if (argumentArray != null && argumentArray.Length > 0)
{
buffer.AddRange(argumentArray);
}
byte checkSum = 0;
for (int i = 0; i < buffer.Count; i++)
{
checkSum += buffer[i];
}
buffer.Add(checkSum);
return buffer.ToArray();
}
protected static byte[] BuildByteArray(byte para1, short para2)
{
List<byte> buffer = new List<byte>();
buffer.Add(para1);
buffer.AddRange(IntToByteArray(para2));
return buffer.ToArray();
}
//public override bool HandleMessage(MessageBase msg, out bool transactionComplete)
//{
// CometRFMatchMessage response = msg as CometRFMatchMessage;
// ResponseMessage = msg;
// string reponseData = string.Join(",", response.Data.Select(bt => bt.ToString("X2")).ToArray());
// if(_completeEvent.Contains("|"))
// {
// var eventArray = _completeEvent.Split('|');
// var subRes = reponseData.Substring(0, eventArray[0].Length);
// if(!eventArray.Contains(subRes))
// {
// Device.NoteError($"Invalid response, no expected command feedback: {reponseData}");
// msg.IsFormatError = true;
// transactionComplete = false;
// return false;
// }
// }
// else if (reponseData.IndexOf(_completeEvent) == -1)
// {
// Device.NoteError($"Invalid response, no expected command feedback: {reponseData}");
// msg.IsFormatError = true;
// transactionComplete = false;
// return false;
// }
// if (response.IsAck)
// {
// SetState(EnumHandlerState.Acked);
// }
// if (this.IsAcked && response.IsComplete)
// {
// SetState(EnumHandlerState.Completed);
// transactionComplete = true;
// return true;
// }
// transactionComplete = false;
// return false;
//}
protected ResponseNAK CheckNak(string reponseData)
{
if (reponseData.IndexOf("90") >= 0)
{
return ResponseNAK.CommandNotDefined;
}
if (reponseData.IndexOf("92") >= 0)
{
return ResponseNAK.CheckSumFailed;
}
if (reponseData.IndexOf("93") >= 0)
{
return ResponseNAK.PositionOverLimit;
}
if (reponseData.IndexOf("93") >= 0)
{
return ResponseNAK.IndexOutOfRange;
}
return ResponseNAK.NotNak;
}
bool _startWaitCheckResonse = false;
protected RFMatchResponseResult HandleTriggerMessage(MessageBase msg)
{
CometRFMatchMessage response = msg as CometRFMatchMessage;
string triggerAck = "50";
string[] checkResponseArray = new string[] { "53", "52", "51" };
string reponseData = string.Join(",", response.Data.Select(bt => bt.ToString("X2")).ToArray());
if (!_startWaitCheckResonse)
{
if (reponseData.IndexOf(triggerAck) >= 0)
{
_startWaitCheckResonse = true;
return RFMatchResponseResult.TriggerAck;
}
else if (CheckNak(reponseData) != ResponseNAK.NotNak)
{
Device.NoteNAK(CheckNak(reponseData));
return RFMatchResponseResult.TriggerNAK;
}
else
{
Device.NoteError($"Invalid response, no expected command feedback: {reponseData}");
msg.IsFormatError = true;
return RFMatchResponseResult.InvalidResonse;
}
}
else
{
var subRes = reponseData.Substring(0, checkResponseArray[0].Length);
if (checkResponseArray.Contains(subRes))
{
if(subRes == checkResponseArray[2])
{
return RFMatchResponseResult.CheckCompleted;
}
else
{
return RFMatchResponseResult.CheckInProcess;
}
}
else
{
Device.NoteError($"Invalid response, no expected command feedback: {reponseData}");
msg.IsFormatError = true;
return RFMatchResponseResult.InvalidResonse;
}
}
}
protected bool HandleSetMessage(MessageBase msg)
{
CometRFMatchMessage response = msg as CometRFMatchMessage;
string setOK = _command;
string[] checkResponseArray = new string[] { "53", "52", "51" };
string reponseData = string.Join(",", response.Data.Select(bt => bt.ToString("X2")).ToArray());
if (reponseData.IndexOf(setOK) >= 0)
{
return true;
}
else if (CheckNak(reponseData) != ResponseNAK.NotNak)
{
Device.NoteNAK(CheckNak(reponseData));
return false;
}
else
{
Device.NoteError($"Invalid response, no expected command feedback: {reponseData}");
msg.IsFormatError = true;
return false;
}
}
protected bool HandleGetMessage(MessageBase msg)
{
CometRFMatchMessage response = msg as CometRFMatchMessage;
string setOK = _completeEvent;
string reponseData = string.Join(",", response.Data.Select(bt => bt.ToString("X2")).ToArray());
if (reponseData.IndexOf(setOK) >= 0)
{
return true;
}
else
{
Device.NoteError($"Invalid response, no expected command feedback: {reponseData}");
msg.IsFormatError = true;
return false;
}
}
protected static byte[] StringToByteArray(string parameter)
{
if (parameter == null)
return new byte[] { };
return parameter.Split(',').Select(para => Convert.ToByte(para, 16)).ToArray();
}
protected static byte[] IntToByteArray(int num)
{
byte[] bytes = BitConverter.GetBytes(num);
return bytes;
}
protected static byte[] ShortToByteArray(short num)
{
byte[] bytes = BitConverter.GetBytes(num);
return bytes;
}
protected uint ByteArrayToUInt(byte[] bytes)
{
uint temp = BitConverter.ToUInt32(bytes.Reverse().ToArray(), 0);
return temp;
}
protected short ByteArrayToShort(byte[] bytes)
{
short temp = BitConverter.ToInt16(bytes.Reverse().ToArray(), 0);
return temp;
}
protected void SetDevicePropValue<T>(string propName, T value)
{
try
{
Type objType = Device.GetType();
objType.GetProperty(propName).SetValue(Device, value, null);
}
catch
{
}
}
public string DevicePropName;
}
public class CommetRFMatchRawCommandHandler : CometRFMatchHandler
{
public CommetRFMatchRawCommandHandler(CometRFMatch device, string command, string completeEvent, string parameter)
: base(device, command, completeEvent, parameter)
{
}
public override bool HandleMessage(MessageBase msg, out bool transactionComplete)
{
CometRFMatchMessage response = msg as CometRFMatchMessage;
ResponseMessage = msg;
string reponseData = string.Join(",", response.Data.Select(bt => bt.ToString("X2")).ToArray());
if (_completeEvent.Contains("|"))
{
var eventArray = _completeEvent.Split('|');
var subRes = reponseData.Substring(0, eventArray[0].Length);
if (!eventArray.Contains(subRes))
{
Device.NoteError($"Invalid response, no expected command feedback: {reponseData}");
msg.IsFormatError = true;
transactionComplete = false;
return false;
}
}
else if (reponseData.IndexOf(_completeEvent) == -1)
{
Device.NoteError($"Invalid response, no expected command feedback: {reponseData}");
msg.IsFormatError = true;
transactionComplete = false;
return false;
}
else if (CheckNak(reponseData) != ResponseNAK.NotNak)
{
Device.NoteNAK(CheckNak(reponseData));
transactionComplete = false;
return false;
}
if (response.IsAck)
{
SetState(EnumHandlerState.Acked);
}
if (this.IsAcked && response.IsComplete)
{
SetState(EnumHandlerState.Completed);
transactionComplete = true;
Device.NoteRawCommandInfo(_command, string.Join(",", response.RawMessage.Select(bt => bt.ToString("X2")).ToArray()));
return true;
}
transactionComplete = false;
return false;
}
}
public class CommetRFMatchTriggerHandler : CometRFMatchHandler
{
string _checkCommand;
public CommetRFMatchTriggerHandler(CometRFMatch device, string triggerCommand, string checkCommand, string propName)
: base(device, triggerCommand)
{
_checkCommand = checkCommand;
DevicePropName = propName;
}
public override bool HandleMessage(MessageBase msg, out bool handled)
{
var resonseResult = HandleTriggerMessage(msg);
if (resonseResult == RFMatchResponseResult.TriggerAck || resonseResult == RFMatchResponseResult.CheckInProcess)
{
Device.Connection.SendMessage(BuildMessage(_checkCommand, null));
}
else if (resonseResult == RFMatchResponseResult.CheckCompleted)
{
SetDevicePropValue<bool>(DevicePropName, true);
handled = true;
return true;
}
else if (resonseResult == RFMatchResponseResult.TriggerNAK || resonseResult == RFMatchResponseResult.InvalidResonse)
{
handled = true;
return true;
}
handled = false;
return false;
}
}
public class CommetRFMatchSetHandler : CometRFMatchHandler
{
public CommetRFMatchSetHandler(CometRFMatch device,string command, string parameter)
: base(device, command, parameter)
{
}
public CommetRFMatchSetHandler(CometRFMatch device, string command, short parameter)
: base(device, command, ShortToByteArray(parameter))
{
}
public CommetRFMatchSetHandler(CometRFMatch device, string command, byte para1, short para2)
: base(device, command, BuildByteArray(para1, para2))
{
}
public override bool HandleMessage(MessageBase msg, out bool handled)
{
if (HandleSetMessage(msg))
{
Device.NoteSetComplted();
handled = true;
return true;
}
handled = false;
return false;
}
}
public class CommetRFMatchGet3ByteHandler : CometRFMatchHandler
{
public CommetRFMatchGet3ByteHandler(CometRFMatch device, string command, string completeEvent, string propName, string parameter)
: base(device, command, completeEvent, parameter)
{
DevicePropName = propName;
}
public override bool HandleMessage(MessageBase msg, out bool handled)
{
if (HandleGetMessage(msg))
{
var result = msg as CometRFMatchMessage;
if (result.Data[3].ToString("X2") != _parameter)
{
handled = false;
return false;
}
short oriValue = ByteArrayToShort(result.Data.Skip(3).ToArray());
SetDevicePropValue<short>(DevicePropName, oriValue);
handled = true;
return true;
}
handled = false;
return false;
}
}
public class CommetRFMatchGetLimitHandler : CometRFMatchHandler
{
public CommetRFMatchGetLimitHandler(CometRFMatch device, string command, string completeEvent, string propName, string parameter)
: base(device, command, completeEvent, parameter)
{
DevicePropName = propName;
}
public override bool HandleMessage(MessageBase msg, out bool handled)
{
if (HandleGetMessage(msg))
{
var result = msg as CometRFMatchMessage;
if (result.Data[3].ToString("X2") != _parameter)
{
handled = false;
return false;
}
short oriValue = ByteArrayToShort(result.Data.Skip(3).ToArray());
SetDevicePropValue<double>(DevicePropName, oriValue * 0.1);
handled = true;
return true;
}
handled = false;
return false;
}
}
public class CommetRFMatchGetDoubleValueHandler : CometRFMatchHandler
{
double _factor = 1.0f;
public CommetRFMatchGetDoubleValueHandler(CometRFMatch device, string command, string completeEvent, string propName, double factor)
: base(device, command, completeEvent, null)
{
DevicePropName = propName;
_factor = factor;
}
public override bool HandleMessage(MessageBase msg, out bool handled)
{
if (HandleGetMessage(msg))
{
var result = msg as CometRFMatchMessage;
short oriValue = ByteArrayToShort(result.Data.Skip(2).ToArray());
SetDevicePropValue<double>(DevicePropName, oriValue * _factor);
handled = true;
return true;
}
handled = false;
return false;
}
}
public class CommetRFMatchGetIntValueHandler : CometRFMatchHandler
{
public CommetRFMatchGetIntValueHandler(CometRFMatch device, string command, string completeEvent, string propName)
: base(device, command, completeEvent, null)
{
DevicePropName = propName;
}
public override bool HandleMessage(MessageBase msg, out bool handled)
{
if (HandleGetMessage(msg))
{
var result = msg as CometRFMatchMessage;
uint oriValue = ByteArrayToUInt(result.Data.Skip(2).ToArray());
SetDevicePropValue<uint>(DevicePropName, oriValue);
handled = true;
return true;
}
handled = false;
return false;
}
}
public class CommetRFMatchGetShortValueHandler : CometRFMatchHandler
{
public CommetRFMatchGetShortValueHandler(CometRFMatch device, string command, string completeEvent, string propName)
: base(device, command, completeEvent, null)
{
DevicePropName = propName;
}
public override bool HandleMessage(MessageBase msg, out bool handled)
{
if (HandleGetMessage(msg))
{
var result = msg as CometRFMatchMessage;
short oriValue = ByteArrayToShort(result.Data.Skip(2).ToArray());
SetDevicePropValue<short>(DevicePropName, oriValue);
handled = true;
return true;
}
handled = false;
return false;
}
}
public class CommetRFMatchGetByteValueHandler : CometRFMatchHandler
{
public CommetRFMatchGetByteValueHandler(CometRFMatch device, string command, string completeEvent, string propName)
: base(device, command, completeEvent, null)
{
DevicePropName = propName;
}
public override bool HandleMessage(MessageBase msg, out bool handled)
{
if (HandleGetMessage(msg))
{
var result = msg as CometRFMatchMessage;
SetDevicePropValue<byte>(DevicePropName, result.Data[2]);
handled = true;
return true;
}
handled = false;
return false;
}
}
}