refactor: 将Framework库和RT、UI放在同一个解决方案中。
This commit is contained in:
+677
@@ -0,0 +1,677 @@
|
||||
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;
|
||||
using Newtonsoft.Json;
|
||||
|
||||
namespace MECF.Framework.RT.EquipmentLibrary.HardwareUnits.Aligners.SiasunAligner
|
||||
{
|
||||
|
||||
|
||||
public class SiasunAligner : SerialPortDevice, IConnection
|
||||
{
|
||||
public string Address { get; }
|
||||
public bool IsConnected { get; }
|
||||
public bool Connect()
|
||||
{
|
||||
return true;
|
||||
}
|
||||
|
||||
public bool Disconnect()
|
||||
{
|
||||
return true;
|
||||
}
|
||||
|
||||
public string PortStatus { get; set; } = "Closed";
|
||||
|
||||
private SiasunAlignerConnection _connection;
|
||||
public SiasunAlignerConnection 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 _scRoot;
|
||||
public SiasunAligner(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;
|
||||
|
||||
_enableLog = SC.GetValue<bool>($"{_scRoot}.{Module}.{Name}.EnableLogMessage");
|
||||
_connection = new SiasunAlignerConnection(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 SiasunAlignerConnection(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 SiasunAlignerQueryPinHandler(this, _deviceAddress));
|
||||
//_lstHandler.AddLast(new SiasunAlignerSetCommModeHandler(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;
|
||||
}
|
||||
|
||||
|
||||
|
||||
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 comandArgument)
|
||||
{
|
||||
lock (_locker)
|
||||
{
|
||||
_lstHandler.AddLast(new SiasunAlignerRawCommandHandler(this, command, comandArgument));
|
||||
}
|
||||
}
|
||||
|
||||
public void PerformRawCommand(string command)
|
||||
{
|
||||
lock (_locker)
|
||||
{
|
||||
_lstHandler.AddLast(new SiasunAlignerRawCommandHandler(this, command));
|
||||
}
|
||||
}
|
||||
|
||||
public void Align()
|
||||
{
|
||||
lock (_locker)
|
||||
{
|
||||
_lstHandler.AddLast(new SiasunAlignerSimpleActionHandler(this,"ALIGN"));
|
||||
}
|
||||
}
|
||||
public void Rotate(string angle)
|
||||
{
|
||||
lock (_locker)
|
||||
{
|
||||
_lstHandler.AddLast(new SiasunAlignerSimpleActionHandler(this, "ROTATE",angle));
|
||||
}
|
||||
}
|
||||
|
||||
public void SevoOn()
|
||||
{
|
||||
lock (_locker)
|
||||
{
|
||||
_lstHandler.AddLast(new SiasunAlignerSevoOnOffHandler(this, true));
|
||||
}
|
||||
}
|
||||
|
||||
public void SevoOff()
|
||||
{
|
||||
lock (_locker)
|
||||
{
|
||||
_lstHandler.AddLast(new SiasunAlignerSevoOnOffHandler(this, false));
|
||||
}
|
||||
}
|
||||
public void SetAlignAngle(string angle)
|
||||
{
|
||||
lock (_locker)
|
||||
{
|
||||
_lstHandler.AddLast(new SiasunAlignerSimpleSetHandler(this, "SWAA", angle));
|
||||
}
|
||||
}
|
||||
public void SetWaferSize(string waferSize)
|
||||
{
|
||||
lock (_locker)
|
||||
{
|
||||
_lstHandler.AddLast(new SiasunAlignerSimpleSetHandler(this, "SWS", waferSize));
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
|
||||
public void Transfer(XferArgument gotoArg)
|
||||
{
|
||||
lock (_locker)
|
||||
{
|
||||
_lstHandler.AddLast(new SiasunAlignerXferHandler(this, JsonConvert.SerializeObject(gotoArg)));
|
||||
}
|
||||
}
|
||||
public void Transfer(object gotoArg)
|
||||
{
|
||||
lock (_locker)
|
||||
{
|
||||
_lstHandler.AddLast(new SiasunAlignerXferHandler(this, gotoArg.ToString()));
|
||||
}
|
||||
}
|
||||
|
||||
public void HomeAligner()
|
||||
{
|
||||
lock (_locker)
|
||||
{
|
||||
_lstHandler.AddLast(new SiasunAlignerSimpleActionHandler(this, "ALIGNER HOME/SCAN/ALGN"));
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
public void Pick(PickPlaceArgument pickArg)
|
||||
{
|
||||
lock (_locker)
|
||||
{
|
||||
_lstHandler.AddLast(new SiasunAlignerPickHandler(this, JsonConvert.SerializeObject(pickArg)));
|
||||
}
|
||||
}
|
||||
public void Pick(object gotoArg)
|
||||
{
|
||||
lock (_locker)
|
||||
{
|
||||
_lstHandler.AddLast(new SiasunAlignerPickHandler(this, gotoArg.ToString()));
|
||||
}
|
||||
}
|
||||
public void Place(PickPlaceArgument placeArg)
|
||||
{
|
||||
lock (_locker)
|
||||
{
|
||||
_lstHandler.AddLast(new SiasunAlignerPlaceHandler(this, JsonConvert.SerializeObject(placeArg)));
|
||||
}
|
||||
}
|
||||
public void Place(object placeArg)
|
||||
{
|
||||
lock (_locker)
|
||||
{
|
||||
_lstHandler.AddLast(new SiasunAlignerPlaceHandler(this, placeArg.ToString()));
|
||||
}
|
||||
}
|
||||
|
||||
internal void NoteActionCompleted(string command)
|
||||
{
|
||||
if(command == "ALIGN")
|
||||
{
|
||||
AlignCompleted = true;
|
||||
}
|
||||
else if(command == "ROTATE")
|
||||
{
|
||||
RotatedCompleted = true;
|
||||
}
|
||||
else if(command == "XFER")
|
||||
{
|
||||
XferCompleted = true;
|
||||
}
|
||||
else if(command == "ALIGNER HOME/SCAN/ALGN")
|
||||
{
|
||||
HomeCompleted = true;
|
||||
}
|
||||
}
|
||||
|
||||
internal void NoteQueryResult(string command, string parameter, string queryResult)
|
||||
{
|
||||
if (command == "HELLO")
|
||||
{
|
||||
if(queryResult == "AG")
|
||||
{
|
||||
CommunicationIsOK = true;
|
||||
}
|
||||
else
|
||||
{
|
||||
CommunicationIsOK = false;
|
||||
}
|
||||
}
|
||||
else if (command == "RWAA")
|
||||
{
|
||||
var resultArray = queryResult.Split(',');
|
||||
if(resultArray.Count() == 1)
|
||||
{
|
||||
AlignedAngle = double.Parse(queryResult);
|
||||
}
|
||||
}
|
||||
else if (command == "RWS")
|
||||
{
|
||||
var resultArray = queryResult.Split(',');
|
||||
if (resultArray.Count() == 1)
|
||||
{
|
||||
WaferSize = double.Parse(queryResult);
|
||||
}
|
||||
}
|
||||
else if (command == "RBIASXY")
|
||||
{
|
||||
var resultArray = queryResult.Split(',');
|
||||
if (resultArray.Count() == 2)
|
||||
{
|
||||
BaisX = double.Parse(queryResult.Split(',')[0]);
|
||||
BaisY = double.Parse(queryResult.Split(',')[1]);
|
||||
}
|
||||
}
|
||||
else if (command == "RBIASRT")
|
||||
{
|
||||
var resultArray = queryResult.Split(',');
|
||||
if (resultArray.Count() == 2)
|
||||
{
|
||||
BaisR = double.Parse(queryResult.Split(',')[0]);
|
||||
BaisT = double.Parse(queryResult.Split(',')[1]);
|
||||
}
|
||||
}
|
||||
else if (command == "RNOTCH")
|
||||
{
|
||||
var resultArray = queryResult.Split(',');
|
||||
if (resultArray.Count() == 1)
|
||||
{
|
||||
Notch = double.Parse(queryResult);
|
||||
}
|
||||
}
|
||||
else if (command == "REER")
|
||||
{
|
||||
var resultArray = queryResult.Split(',');
|
||||
if (resultArray.Count() == 1)
|
||||
{
|
||||
Error = "_ERR " + queryResult;
|
||||
}
|
||||
}
|
||||
else if (command == "RWK")
|
||||
{
|
||||
var resultArray = queryResult.Split(',');
|
||||
if (resultArray.Count() == 1)
|
||||
{
|
||||
WafeOnOff = queryResult == "1";
|
||||
}
|
||||
}
|
||||
else if (command == "RAR")
|
||||
{
|
||||
var resultArray = queryResult.Split(',');
|
||||
if (resultArray.Count() == 1)
|
||||
{
|
||||
IsReady = queryResult == "1";
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
internal void NoteSetCompleted(string command, string parameter)
|
||||
{
|
||||
if(command == "SWAA")
|
||||
{
|
||||
AlignAngleSet = double.Parse(parameter);
|
||||
}
|
||||
else if(command == "SWS")
|
||||
{
|
||||
WaferSizeSet = double.Parse(parameter);
|
||||
}
|
||||
}
|
||||
|
||||
public void MonitorRawCommand(bool isSelected, string command, string comandArgument)
|
||||
{
|
||||
lock (_locker)
|
||||
{
|
||||
var existHandlers = _lstMonitorHandler.Where(handler => handler.GetType() == typeof(SiasunAlignerRawCommandHandler) && ((SiasunAlignerHandler)handler)._command == command);
|
||||
if (isSelected)
|
||||
{
|
||||
if (!existHandlers.Any())
|
||||
_lstMonitorHandler.AddFirst(new SiasunAlignerRawCommandHandler(this, command, comandArgument));
|
||||
}
|
||||
else
|
||||
{
|
||||
if (existHandlers.Any())
|
||||
{
|
||||
_lstMonitorHandler.Remove(existHandlers.First());
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
public void MonitorRawCommand(bool isSelected, string command)
|
||||
{
|
||||
lock (_locker)
|
||||
{
|
||||
var existHandlers = _lstMonitorHandler.Where(handler => handler.GetType() == typeof(SiasunAlignerRawCommandHandler) && ((SiasunAlignerHandler)handler)._command == command);
|
||||
if (isSelected)
|
||||
{
|
||||
if (!existHandlers.Any())
|
||||
_lstMonitorHandler.AddFirst(new SiasunAlignerRawCommandHandler(this, command));
|
||||
}
|
||||
else
|
||||
{
|
||||
if (existHandlers.Any())
|
||||
{
|
||||
_lstMonitorHandler.Remove(existHandlers.First());
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
public void RequestAlignAngle(bool isSelected)
|
||||
{
|
||||
SimpleRequest(isSelected, "RWAA");
|
||||
}
|
||||
public void RequestWaferSize(bool isSelected)
|
||||
{
|
||||
SimpleRequest(isSelected, "RWS");
|
||||
}
|
||||
public void RequestBiasXY(bool isSelected)
|
||||
{
|
||||
SimpleRequest(isSelected, "RBIASXY");
|
||||
}
|
||||
public void RequestBiasRT(bool isSelected)
|
||||
{
|
||||
SimpleRequest(isSelected, "RBIASRT");
|
||||
}
|
||||
|
||||
public void RequestNotchAngle(bool isSelected)
|
||||
{
|
||||
SimpleRequest(isSelected, "RNOTCH");
|
||||
}
|
||||
public void RequestErrorCode(bool isSelected)
|
||||
{
|
||||
SimpleRequest(isSelected, "REER");
|
||||
}
|
||||
public void RequestHello(bool isSelected)
|
||||
{
|
||||
SimpleRequest(isSelected, "HELLO");
|
||||
}
|
||||
|
||||
public void RequestWaferOnOff(bool isSelected)
|
||||
{
|
||||
SimpleRequest(isSelected, "RWK");
|
||||
}
|
||||
public void RequestReady(bool isSelected)
|
||||
{
|
||||
SimpleRequest(isSelected, "RAR");
|
||||
}
|
||||
|
||||
private void SimpleRequest(bool isSelected, string command)
|
||||
{
|
||||
lock (_locker)
|
||||
{
|
||||
var existHandlers = _lstMonitorHandler.Where(handler => handler.GetType() == typeof(SiasunAlignerSimpleQueryHandler) && ((SiasunAlignerSimpleQueryHandler)handler)._command == command);
|
||||
if (isSelected)
|
||||
{
|
||||
if (!existHandlers.Any())
|
||||
_lstMonitorHandler.AddFirst(new SiasunAlignerSimpleQueryHandler(this, command));
|
||||
}
|
||||
else
|
||||
{
|
||||
if (existHandlers.Any())
|
||||
{
|
||||
_lstMonitorHandler.Remove(existHandlers.First());
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
#endregion
|
||||
|
||||
#region Properties
|
||||
public string Error { get; private set; }
|
||||
public bool SevoOnOff { get; private set; }
|
||||
public bool AlignCompleted { get; private set; }
|
||||
public bool RotatedCompleted { get; private set; }
|
||||
public double AlignAngleSet { get; private set; }
|
||||
public double WaferSizeSet { get; private set; }
|
||||
public double WaferSize { get; private set; }
|
||||
public bool XferCompleted { get; private set; }
|
||||
public bool HomeCompleted { get; private set; }
|
||||
public bool CommunicationIsOK { get; private set; }
|
||||
public double AlignedAngle { get; private set; }
|
||||
public double BaisX { get; private set; }
|
||||
public double BaisY { get; private set; }
|
||||
public double BaisR { get; private set; }
|
||||
public double BaisT { get; private set; }
|
||||
public double Notch { get; private set; }
|
||||
public bool WafeOnOff { get; private set; }
|
||||
public bool IsReady { get; private set; }
|
||||
public string LastPickInfo { get; private set; }
|
||||
public string LastPlaceInfo { get; private set; }
|
||||
|
||||
#endregion
|
||||
|
||||
|
||||
#region Note Functions
|
||||
private R_TRIG _trigWarningMessage = new R_TRIG();
|
||||
|
||||
|
||||
|
||||
public void NoteError(string reason)
|
||||
{
|
||||
CommunicationIsOK = false;
|
||||
if (reason != null)
|
||||
{
|
||||
_trigWarningMessage.CLK = true;
|
||||
if (_trigWarningMessage.Q)
|
||||
{
|
||||
EV.PostWarningLog(Module, $"{Module}.{Name} error, {reason}");
|
||||
}
|
||||
Error = reason;
|
||||
}
|
||||
else
|
||||
{
|
||||
Error = null;
|
||||
}
|
||||
}
|
||||
|
||||
internal void NoteLastPickInfo(string sendText)
|
||||
{
|
||||
LastPickInfo = sendText;
|
||||
}
|
||||
internal void NoteLastPlaceInfo(string sendText)
|
||||
{
|
||||
LastPlaceInfo = sendText;
|
||||
}
|
||||
internal void NoteSevoOnOff(bool isOn)
|
||||
{
|
||||
SevoOnOff = isOn;
|
||||
}
|
||||
|
||||
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 });
|
||||
}
|
||||
|
||||
#endregion
|
||||
}
|
||||
|
||||
|
||||
public class XferArgument
|
||||
{
|
||||
public string Arm { get; set; }
|
||||
public int FromStation { get; set; }
|
||||
public int FromSlot { get; set; }
|
||||
public int ToStation { get; set; }
|
||||
public int ToSlot { get; set; }
|
||||
public string AlignCommand { get; set; }
|
||||
}
|
||||
public class PickPlaceArgument
|
||||
{
|
||||
|
||||
/// <summary>
|
||||
///
|
||||
/// </summary>
|
||||
public int Station { get; set; }
|
||||
/// <summary>
|
||||
///
|
||||
/// </summary>
|
||||
public int Slot { get; set; }
|
||||
/// <summary>
|
||||
///
|
||||
/// </summary>
|
||||
public string Arm { get; set; }
|
||||
/// <summary>
|
||||
///
|
||||
/// </summary>
|
||||
public int Step { get; set; }
|
||||
/// <summary>
|
||||
///
|
||||
/// </summary>
|
||||
public string Offset { get; set; }
|
||||
|
||||
public string AlignCommand { get; set; }
|
||||
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
}
|
||||
+103
@@ -0,0 +1,103 @@
|
||||
using System.IO.Ports;
|
||||
using System.Linq;
|
||||
using Aitex.Core.RT.Log;
|
||||
using MECF.Framework.Common.Communications;
|
||||
|
||||
namespace MECF.Framework.RT.EquipmentLibrary.HardwareUnits.Aligners.SiasunAligner
|
||||
{
|
||||
public class SiasunAlignerMessage : AsciiMessage
|
||||
{
|
||||
public string Data { get; set; }
|
||||
public string ErrorText { get; set; }
|
||||
}
|
||||
|
||||
public class SiasunAlignerConnection : SerialPortConnectionBase
|
||||
{
|
||||
private static char _endLine = (char)3;
|
||||
//private bool _isAckMode = false;//should read from config file
|
||||
|
||||
private string _cachedBuffer = string.Empty;
|
||||
|
||||
public SiasunAlignerConnection(string portName, int baudRate = 9600, int dataBits = 8, Parity parity = Parity.None, StopBits stopBits = StopBits.One)
|
||||
: base(portName, baudRate, dataBits, parity, stopBits, _endLine.ToString(), true)
|
||||
{
|
||||
|
||||
}
|
||||
|
||||
public override bool SendMessage(byte[] message)
|
||||
{
|
||||
return base.SendMessage(message);
|
||||
}
|
||||
|
||||
protected override MessageBase ParseResponse(string rawText)
|
||||
{
|
||||
SiasunAlignerMessage msg = new SiasunAlignerMessage();
|
||||
msg.RawMessage = rawText;
|
||||
|
||||
if (rawText.Length <= 0)
|
||||
{
|
||||
LOG.Error($"empty response,");
|
||||
msg.IsFormatError = true;
|
||||
return msg;
|
||||
}
|
||||
if (rawText.Length <= 4)
|
||||
{
|
||||
LOG.Error($"too short response,");
|
||||
msg.IsFormatError = true;
|
||||
return msg;
|
||||
}
|
||||
rawText = rawText.Substring(1, rawText.Length - 2);//remove start char and end char
|
||||
|
||||
if(!CheckSum(rawText))
|
||||
{
|
||||
LOG.Error($"check sum failed,");
|
||||
msg.IsFormatError = true;
|
||||
return msg;
|
||||
}
|
||||
|
||||
rawText = rawText.Substring(2, rawText.Length - 4);// remove length and sum
|
||||
if (rawText.Contains("_ERR"))
|
||||
{
|
||||
msg.IsError = true;
|
||||
|
||||
var rewTextArray = rawText.Split(' ');
|
||||
msg.Data = rewTextArray[1];
|
||||
}
|
||||
else if (rawText == "_RDY")
|
||||
{
|
||||
msg.Data = rawText;
|
||||
|
||||
msg.IsResponse = true;
|
||||
msg.IsAck = true;
|
||||
msg.IsComplete = true;
|
||||
}
|
||||
else
|
||||
{
|
||||
msg.Data = rawText;
|
||||
msg.IsResponse = true;
|
||||
msg.IsAck = true;
|
||||
msg.IsComplete = true;
|
||||
}
|
||||
|
||||
return msg;
|
||||
}
|
||||
|
||||
private bool CheckSum(string responseContent)
|
||||
{
|
||||
string responseSum = responseContent.Substring(responseContent.Length - 2);
|
||||
string checkContent = responseContent.Substring(0, responseContent.Length - 2);
|
||||
var charArray = checkContent.ToArray();
|
||||
int sum = charArray.Sum(chr => (int)chr);
|
||||
string sSum = sum.ToString("X");
|
||||
|
||||
if (sSum.Length < 2)
|
||||
sSum = "0" + sSum;
|
||||
else
|
||||
sSum = sSum.Substring(sSum.Length - 2);
|
||||
|
||||
return responseSum == sSum;
|
||||
}
|
||||
|
||||
|
||||
}
|
||||
}
|
||||
+351
@@ -0,0 +1,351 @@
|
||||
using MECF.Framework.Common.Communications;
|
||||
using System.Linq;
|
||||
using System.Text;
|
||||
using Newtonsoft.Json.Linq;
|
||||
|
||||
namespace MECF.Framework.RT.EquipmentLibrary.HardwareUnits.Aligners.SiasunAligner
|
||||
{
|
||||
public abstract class SiasunAlignerHandler : HandlerBase
|
||||
{
|
||||
public SiasunAligner Device { get; }
|
||||
|
||||
public string _command;
|
||||
protected string _parameter;
|
||||
|
||||
|
||||
protected SiasunAlignerHandler(SiasunAligner device, string command, string parameter = null)
|
||||
: base(BuildMessage(command, parameter))
|
||||
{
|
||||
Device = device;
|
||||
_command = command;
|
||||
_parameter = parameter;
|
||||
Name = command;
|
||||
}
|
||||
|
||||
private static char _startLine = (char)1;
|
||||
private static char _endLine = (char)3;
|
||||
private static string BuildMessage( string command, string parameter)
|
||||
{
|
||||
command = "ALIG " + command;
|
||||
string commandContent = parameter == null ? $"{command}" : $"{command} {parameter}";
|
||||
|
||||
string sLength = commandContent.Length.ToString("D2");
|
||||
var charArray = (sLength + commandContent).ToArray();
|
||||
int sum = charArray.Sum(chr => (int)chr);
|
||||
string sSum = sum.ToString("X");
|
||||
|
||||
if (sSum.Length < 2)
|
||||
return _startLine + sLength + commandContent + "0" + sSum + _endLine.ToString();
|
||||
else
|
||||
return _startLine + sLength + commandContent + sSum.Substring(sSum.Length - 2) + _endLine.ToString();
|
||||
}
|
||||
|
||||
public override bool HandleMessage(MessageBase msg, out bool transactionComplete)
|
||||
{
|
||||
SiasunAlignerMessage response = msg as SiasunAlignerMessage;
|
||||
ResponseMessage = msg;
|
||||
|
||||
if (response.IsAck)
|
||||
{
|
||||
SetState(EnumHandlerState.Acked);
|
||||
}
|
||||
|
||||
|
||||
if (response.IsResponse)
|
||||
{
|
||||
SetState(EnumHandlerState.Completed);
|
||||
transactionComplete = true;
|
||||
return true;
|
||||
}
|
||||
|
||||
transactionComplete = false;
|
||||
return false;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
public class SiasunAlignerRawCommandHandler : SiasunAlignerHandler
|
||||
{
|
||||
public SiasunAlignerRawCommandHandler(SiasunAligner device, string command, string parameter = null)
|
||||
: base(device, command, parameter)
|
||||
{
|
||||
}
|
||||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||||
{
|
||||
var result = msg as SiasunAlignerMessage;
|
||||
Device.NoteRawCommandInfo(_command, result.RawMessage);
|
||||
|
||||
ResponseMessage = msg;
|
||||
handled = true;
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
|
||||
}
|
||||
|
||||
public class SiasunAlignerXferHandler : SiasunAlignerHandler
|
||||
{
|
||||
public SiasunAlignerXferHandler(SiasunAligner device, string jsonParameter)
|
||||
: base(device, "XFER", BuildCommandParameter(jsonParameter))
|
||||
{
|
||||
|
||||
}
|
||||
static string BuildCommandParameter(string jsonParameter)
|
||||
{
|
||||
JObject jsonObject = JObject.Parse(jsonParameter);
|
||||
StringBuilder paraBuilder = new StringBuilder();
|
||||
foreach (var item in jsonObject)
|
||||
{
|
||||
if (item.Key.Contains("Slot") || item.Key == "Arm")
|
||||
paraBuilder.Append(" " + item.Key.ToUpper() + " " + item.Value);
|
||||
else if(item.Value!=null && item.Value.ToString().Length > 0)
|
||||
paraBuilder.Append(" " + item.Value);
|
||||
}
|
||||
|
||||
return paraBuilder.Length > 0 ? paraBuilder.ToString() : null;
|
||||
|
||||
}
|
||||
|
||||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||||
{
|
||||
var result = msg as SiasunAlignerMessage;
|
||||
if (result.IsError)
|
||||
{
|
||||
Device.NoteError(result.Data);
|
||||
}
|
||||
else
|
||||
{
|
||||
Device.NoteError(null);
|
||||
Device.NoteActionCompleted(_command);
|
||||
}
|
||||
|
||||
ResponseMessage = msg;
|
||||
handled = true;
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
}
|
||||
public class SiasunAlignerPickHandler : SiasunAlignerHandler
|
||||
{
|
||||
public SiasunAlignerPickHandler(SiasunAligner device, string jsonParameter)
|
||||
: base(device, "PICK", BuildCommandParameter(jsonParameter))
|
||||
{
|
||||
}
|
||||
|
||||
//N 2 R EX Z DOWN SLOT 1 ARM A
|
||||
static string BuildCommandParameter(string jsonParameter)
|
||||
{
|
||||
JObject jsonObject = JObject.Parse(jsonParameter);
|
||||
StringBuilder paraBuilder = new StringBuilder();
|
||||
foreach (var item in jsonObject)
|
||||
{
|
||||
if (paraBuilder.Length == 0)
|
||||
{
|
||||
paraBuilder.Append(item.Value);
|
||||
}
|
||||
else
|
||||
{
|
||||
if(item.Key == "Slot" || item.Key == "Arm")
|
||||
paraBuilder.Append(" " + item.Key.ToUpper() + " " + item.Value);
|
||||
else
|
||||
paraBuilder.Append(" " + item.Value);
|
||||
}
|
||||
}
|
||||
|
||||
return paraBuilder.Length > 0 ? paraBuilder.ToString() : null;
|
||||
|
||||
}
|
||||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||||
{
|
||||
var result = msg as SiasunAlignerMessage;
|
||||
if (result.IsError)
|
||||
{
|
||||
Device.NoteError(result.Data);
|
||||
}
|
||||
else
|
||||
{
|
||||
Device.NoteError(null);
|
||||
Device.NoteLastPickInfo(SendText);
|
||||
}
|
||||
|
||||
ResponseMessage = msg;
|
||||
handled = true;
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
public class SiasunAlignerPlaceHandler : SiasunAlignerHandler
|
||||
{
|
||||
public SiasunAlignerPlaceHandler(SiasunAligner device, string jsonParameter)
|
||||
: base(device, "PLACE", BuildCommandParameter(jsonParameter))
|
||||
{
|
||||
}
|
||||
|
||||
static string BuildCommandParameter(string jsonParameter)
|
||||
{
|
||||
JObject jsonObject = JObject.Parse(jsonParameter);
|
||||
StringBuilder paraBuilder = new StringBuilder();
|
||||
foreach (var item in jsonObject)
|
||||
{
|
||||
if (paraBuilder.Length == 0)
|
||||
{
|
||||
paraBuilder.Append(item.Value);
|
||||
}
|
||||
else
|
||||
{
|
||||
if (item.Key == "Slot" || item.Key == "Arm")
|
||||
paraBuilder.Append(" " + item.Key.ToUpper() + " " + item.Value);
|
||||
else
|
||||
paraBuilder.Append(" " + item.Value);
|
||||
}
|
||||
}
|
||||
|
||||
return paraBuilder.Length > 0 ? paraBuilder.ToString() : null;
|
||||
|
||||
}
|
||||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||||
{
|
||||
var result = msg as SiasunAlignerMessage;
|
||||
if (result.IsError)
|
||||
{
|
||||
Device.NoteError(result.Data);
|
||||
}
|
||||
else
|
||||
{
|
||||
Device.NoteError(null);
|
||||
Device.NoteLastPlaceInfo(SendText);
|
||||
}
|
||||
|
||||
ResponseMessage = msg;
|
||||
handled = true;
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
|
||||
public class SiasunAlignerSimpleActionHandler : SiasunAlignerHandler
|
||||
{
|
||||
public SiasunAlignerSimpleActionHandler(SiasunAligner device, string command, string parameter = null)
|
||||
: base(device, command, parameter)
|
||||
{
|
||||
}
|
||||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||||
{
|
||||
var result = msg as SiasunAlignerMessage;
|
||||
if (result.IsError)
|
||||
{
|
||||
Device.NoteError(result.Data);
|
||||
}
|
||||
else
|
||||
{
|
||||
Device.NoteError(null);
|
||||
Device.NoteActionCompleted(_command);
|
||||
}
|
||||
|
||||
ResponseMessage = msg;
|
||||
handled = true;
|
||||
|
||||
return true;
|
||||
}
|
||||
}
|
||||
public class SiasunAlignerSimpleSetHandler : SiasunAlignerHandler
|
||||
{
|
||||
public SiasunAlignerSimpleSetHandler(SiasunAligner device, string command, string parameter = null)
|
||||
: base(device, command, parameter)
|
||||
{
|
||||
}
|
||||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||||
{
|
||||
var result = msg as SiasunAlignerMessage;
|
||||
if (result.IsError)
|
||||
{
|
||||
Device.NoteError(result.Data);
|
||||
}
|
||||
else
|
||||
{
|
||||
Device.NoteError(null);
|
||||
Device.NoteSetCompleted(_command,_parameter);
|
||||
}
|
||||
|
||||
ResponseMessage = msg;
|
||||
handled = true;
|
||||
|
||||
return true;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
public class SiasunAlignerSevoOnOffHandler : SiasunAlignerHandler
|
||||
{
|
||||
public SiasunAlignerSevoOnOffHandler(SiasunAligner device, bool isOn)
|
||||
: base(device, isOn ? "SVON" : "SVOFF")
|
||||
{
|
||||
|
||||
}
|
||||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||||
{
|
||||
var result = msg as SiasunAlignerMessage;
|
||||
if (result.IsError)
|
||||
{
|
||||
Device.NoteError(result.Data);
|
||||
}
|
||||
else
|
||||
{
|
||||
Device.NoteError(null);
|
||||
Device.NoteSevoOnOff(_command == "SVON");
|
||||
}
|
||||
|
||||
ResponseMessage = msg;
|
||||
handled = true;
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
|
||||
public class SiasunAlignerSimpleQueryHandler : SiasunAlignerHandler
|
||||
{
|
||||
public SiasunAlignerSimpleQueryHandler(SiasunAligner device, string command, string parameter = null)
|
||||
: base(device, command, parameter)
|
||||
{
|
||||
}
|
||||
public override bool HandleMessage(MessageBase msg, out bool handled)
|
||||
{
|
||||
var result = msg as SiasunAlignerMessage;
|
||||
|
||||
if (result.IsError)
|
||||
{
|
||||
Device.NoteError(result.Data);
|
||||
}
|
||||
else
|
||||
{
|
||||
var resultArray = result.Data.Split(' ');
|
||||
if(resultArray.Count() >= 2 && resultArray[0] == _command)
|
||||
{
|
||||
Device.NoteError(null);
|
||||
Device.NoteQueryResult(_command, _parameter, string.Join(",", resultArray, 1, resultArray.Count()-1));
|
||||
}
|
||||
else
|
||||
{
|
||||
Device.NoteError($"Invalid Response '{result.Data}' for command: {_command}");
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
ResponseMessage = msg;
|
||||
handled = true;
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
|
||||
}
|
||||
Reference in New Issue
Block a user