refactor: 将Framework库和RT、UI放在同一个解决方案中。
This commit is contained in:
+1285
File diff suppressed because it is too large
Load Diff
+137
@@ -0,0 +1,137 @@
|
||||
using Aitex.Core.RT.Event;
|
||||
using Aitex.Core.RT.Log;
|
||||
using MECF.Framework.Common.Communications;
|
||||
using System;
|
||||
using System.Linq;
|
||||
using System.Text;
|
||||
|
||||
namespace MECF.Framework.RT.EquipmentLibrary.HardwareUnits.Aligners.YaskawaAligner
|
||||
{
|
||||
|
||||
public class YaskawaRobotMessage : AsciiMessage
|
||||
{
|
||||
public int UNo { get; set; }
|
||||
public int SeqNo { get; set; }
|
||||
public string Status { get; set; }
|
||||
public string Ackcd { get; set; }
|
||||
public string Command { get; set; }
|
||||
public string[] Data { get; set; }
|
||||
public string ErrorCode { get; set; }
|
||||
public string EvNo { get; set; }
|
||||
public string EvDate { get; set; }
|
||||
public string EvData { get; set; }
|
||||
|
||||
}
|
||||
public class YaskawaAlignerConnection : TCPPortConnectionBase
|
||||
{
|
||||
private YaskawaAligner _aligner;
|
||||
public YaskawaAlignerConnection(YaskawaAligner pa, string ipaddress)
|
||||
: base(ipaddress, "\r", true)
|
||||
{
|
||||
_aligner = pa;
|
||||
}
|
||||
protected override MessageBase ParseResponse(string rawMessage)
|
||||
{
|
||||
YaskawaRobotMessage msg = new YaskawaRobotMessage();
|
||||
try
|
||||
{
|
||||
msg.RawMessage = rawMessage.Replace("\r", "");
|
||||
string[] msgdata = msg.RawMessage.Split(',');
|
||||
msg.UNo = Convert.ToInt16(msgdata[1]);
|
||||
msg.IsAck = false;
|
||||
msg.IsComplete = false;
|
||||
msg.IsFormatError = false;
|
||||
msg.IsEvent = false;
|
||||
|
||||
if (msgdata[0] == "$") msg.IsAck = true;
|
||||
if (msgdata[0] == "!") msg.IsComplete = true;
|
||||
if (msgdata[0] == "?")
|
||||
{
|
||||
msg.IsFormatError = true;
|
||||
}
|
||||
if (msgdata[0] == ">" && msgdata[2] == "EVNT")
|
||||
{
|
||||
msg.IsEvent = true;
|
||||
msg.EvNo = msgdata[3];
|
||||
msg.EvDate = msgdata[4];
|
||||
msg.EvData = msgdata[5];
|
||||
return msg;
|
||||
}
|
||||
|
||||
if (_aligner.IsEnableSeqNo)
|
||||
{
|
||||
msg.SeqNo = Convert.ToInt16(msgdata[2]);
|
||||
msg.Status = msgdata[3];
|
||||
msg.Ackcd = msgdata[4];
|
||||
msg.Command = msgdata[5];
|
||||
msg.Data = msgdata.Skip(6).Take(msgdata.Length - 6 - (_aligner.IsEnableCheckSum ? 1 : 0)).ToArray();
|
||||
}
|
||||
else
|
||||
{
|
||||
msg.Status = msgdata[2];
|
||||
msg.Ackcd = msgdata[3];
|
||||
msg.Command = msgdata[4];
|
||||
msg.Data = msgdata.Skip(6).Take(msgdata.Length - 5 - (_aligner.IsEnableCheckSum ? 1 : 0)).ToArray();
|
||||
}
|
||||
_aligner.ParseStatus(msg.Status);
|
||||
|
||||
return msg;
|
||||
}
|
||||
catch (Exception ex)
|
||||
{
|
||||
LOG.Write(ex);
|
||||
msg.IsFormatError = true;
|
||||
return msg;
|
||||
}
|
||||
}
|
||||
|
||||
protected override void OnEventArrived(MessageBase msg)
|
||||
{
|
||||
YaskawaRobotMessage evt = msg as YaskawaRobotMessage;
|
||||
|
||||
if (evt.EvNo == "100")
|
||||
{
|
||||
string errocode = evt.EvData.Substring(1, evt.EvData.Length - 1);
|
||||
_aligner.NotifyAlarmByErrorCode(errocode);
|
||||
if (Convert.ToInt32(errocode,16) > 0xF0)
|
||||
_aligner.OnError($"Robot occurred error:{evt.EvData} on {evt.EvDate}.");
|
||||
else
|
||||
EV.PostWarningLog("Robot", $"Robot occurred error:{evt.EvData} on {evt.EvDate}.");
|
||||
|
||||
}
|
||||
if (evt.EvNo == "140")
|
||||
{
|
||||
|
||||
}
|
||||
}
|
||||
|
||||
public void SendAck()
|
||||
{
|
||||
if (_aligner.IsEnableSeqNo)
|
||||
{
|
||||
_aligner.CurrentSeqNo = _aligner.SeqnoGenerator.create();
|
||||
_aligner.SeqnoGenerator.release(_aligner.CurrentSeqNo);
|
||||
}
|
||||
string commandstr = $",{_aligner.UnitNumber}" + (_aligner.IsEnableSeqNo ? $",{_aligner.CurrentSeqNo:D2}" : "") + ",ACKN";
|
||||
if (_aligner.IsEnableCheckSum)
|
||||
{
|
||||
commandstr += ",";
|
||||
commandstr = commandstr + Checksum(Encoding.ASCII.GetBytes(commandstr)) + "\r";
|
||||
}
|
||||
commandstr = "$" + commandstr;
|
||||
SendMessage(commandstr);
|
||||
}
|
||||
|
||||
private string Checksum(byte[] bytes)
|
||||
{
|
||||
int sum = 0;
|
||||
foreach (byte code in bytes)
|
||||
{
|
||||
sum += code;
|
||||
}
|
||||
string hex = String.Format("{0:X2}", sum % 256);
|
||||
return hex;
|
||||
}
|
||||
|
||||
}
|
||||
}
|
||||
+139
@@ -0,0 +1,139 @@
|
||||
using Aitex.Core.RT.Log;
|
||||
using MECF.Framework.Common.Communications;
|
||||
using System;
|
||||
|
||||
namespace MECF.Framework.RT.EquipmentLibrary.HardwareUnits.Aligners.YaskawaAligner
|
||||
{
|
||||
public abstract class YaskawaAlignerHandler : HandlerBase
|
||||
{
|
||||
public YaskawaAligner Device { get; }
|
||||
|
||||
public string _commandType;
|
||||
public string _command;
|
||||
public string _parameter;
|
||||
private int _seqNO;
|
||||
|
||||
public YaskawaAlignerHandler(YaskawaAligner device, string command, string parameter = null)
|
||||
: base(BuildMessage(command, parameter))
|
||||
{
|
||||
Device = device;
|
||||
_command = command;
|
||||
_parameter = parameter;
|
||||
Name = command;
|
||||
|
||||
}
|
||||
protected static string BuildMessage(string command, string parameter)
|
||||
{
|
||||
if (string.IsNullOrEmpty(parameter))
|
||||
return command;
|
||||
return $"{command},{parameter}";
|
||||
|
||||
|
||||
|
||||
}
|
||||
private static string Checksum(byte[] bytes)
|
||||
{
|
||||
int sum = 0;
|
||||
foreach (byte code in bytes)
|
||||
{
|
||||
sum += code;
|
||||
}
|
||||
string hex = String.Format("{0:X2}", sum % 256);
|
||||
return hex;
|
||||
}
|
||||
|
||||
|
||||
public override bool HandleMessage(MessageBase msg, out bool transactionComplete)
|
||||
{
|
||||
YaskawaRobotMessage response = msg as YaskawaRobotMessage;
|
||||
ResponseMessage = msg;
|
||||
if (msg.IsError)
|
||||
{
|
||||
Device.OnError(response.RawMessage);
|
||||
transactionComplete = true;
|
||||
return true;
|
||||
}
|
||||
if (msg.IsAck)
|
||||
{
|
||||
SetState(EnumHandlerState.Acked);
|
||||
}
|
||||
|
||||
if (response.IsComplete)
|
||||
{
|
||||
SetState(EnumHandlerState.Completed);
|
||||
Device.SenACK();
|
||||
Device.OnActionDone(null);
|
||||
transactionComplete = true;
|
||||
return true;
|
||||
}
|
||||
transactionComplete = false;
|
||||
return false;
|
||||
}
|
||||
|
||||
|
||||
protected virtual void NoteCommandResult(YaskawaRobotMessage response)
|
||||
{
|
||||
}
|
||||
|
||||
|
||||
}
|
||||
|
||||
public class YaskawaAlignerReadHandler : YaskawaAlignerHandler
|
||||
{
|
||||
public YaskawaAlignerReadHandler(YaskawaAligner aligner, string command, string parameter = null)
|
||||
: base(aligner, command, parameter)
|
||||
{
|
||||
string temp = string.IsNullOrEmpty(parameter) ? parameter : "";
|
||||
LOG.Write($"{aligner.Name} execute read command {command} {temp} in ASCII.");
|
||||
}
|
||||
public override bool HandleMessage(MessageBase msg, out bool transactionComplete)
|
||||
{
|
||||
YaskawaRobotMessage response = msg as YaskawaRobotMessage;
|
||||
|
||||
if (Device.ParseReadData(_command, response.Data))
|
||||
{
|
||||
Device.OnActionDone(null);
|
||||
transactionComplete = true;
|
||||
return true;
|
||||
}
|
||||
response.IsError = true;
|
||||
return base.HandleMessage(response, out transactionComplete);
|
||||
}
|
||||
|
||||
}
|
||||
public class YaskawaAlignerSetHandler : YaskawaAlignerHandler
|
||||
{
|
||||
public YaskawaAlignerSetHandler(YaskawaAligner pa, string command, string parameter = null)
|
||||
: base(pa, command, parameter)
|
||||
{
|
||||
string temp = string.IsNullOrEmpty(parameter) ? parameter : "";
|
||||
LOG.Write($"{pa.Name} execute set command {command} {temp} in ASCII.");
|
||||
}
|
||||
|
||||
public override bool HandleMessage(MessageBase msg, out bool transactionComplete)
|
||||
{
|
||||
YaskawaRobotMessage response = msg as YaskawaRobotMessage;
|
||||
if (response.IsComplete)
|
||||
{
|
||||
|
||||
Device.OnActionDone(null);
|
||||
transactionComplete = true;
|
||||
return true;
|
||||
}
|
||||
return base.HandleMessage(response, out transactionComplete);
|
||||
}
|
||||
}
|
||||
|
||||
public class YaskawaAlignerMotionHandler : YaskawaAlignerHandler
|
||||
{
|
||||
public YaskawaAlignerMotionHandler(YaskawaAligner pa, string command, string parameter = null)
|
||||
: base(pa, command, parameter)
|
||||
{
|
||||
string temp = string.IsNullOrEmpty(parameter) ? parameter : "";
|
||||
LOG.Write($"{pa.Name} execute motion command {command} {temp} in ASCII.");
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
|
||||
}
|
||||
Reference in New Issue
Block a user