458 lines
14 KiB
C#
458 lines
14 KiB
C#
|
using Aitex.Core.RT.DataCenter;
|
|||
|
|
using Aitex.Core.RT.Device;
|
|||
|
|
using Aitex.Core.RT.Event;
|
|||
|
|
using Aitex.Core.RT.Log;
|
|||
|
|
using Aitex.Core.RT.OperationCenter;
|
|||
|
|
using Aitex.Core.RT.SCCore;
|
|||
|
|
using Aitex.Core.RT.IOCore;
|
|||
|
|
using Aitex.Core.Util;
|
|||
|
|
using MECF.Framework.Common.Communications;
|
|||
|
|
using MECF.Framework.RT.EquipmentLibrary.HardwareUnits.Temps.Omron;
|
|||
|
|
using System;
|
|||
|
|
using System.Collections.Generic;
|
|||
|
|
using System.Collections;
|
|||
|
|
|
|||
|
|
using System.Linq;
|
|||
|
|
using System.Reflection;
|
|||
|
|
using System.Text;
|
|||
|
|
using System.Threading;
|
|||
|
|
using System.Threading.Tasks;
|
|||
|
|
|
|||
|
|
|
|||
|
|
namespace MECF.Framework.RT.EquipmentLibrary.HardwareUnits.Temps.AE
|
|||
|
|
{
|
|||
|
|
public class AETemp : BaseDevice, IConnection, IDevice, ITempData
|
|||
|
|
{
|
|||
|
|
private AETempConnection _connection;
|
|||
|
|
private bool _activeMonitorStatus;
|
|||
|
|
private int _errorCode;
|
|||
|
|
private R_TRIG _trigCommunicationError = new R_TRIG();
|
|||
|
|
private R_TRIG _trigRetryConnect = new R_TRIG();
|
|||
|
|
private R_TRIG _trigFewChannels = new R_TRIG();
|
|||
|
|
private PeriodicJob _thread;
|
|||
|
|
private int tempCount = 1;
|
|||
|
|
|
|||
|
|
private LinkedList<HandlerBase> _lstHandler = new LinkedList<HandlerBase>();
|
|||
|
|
|
|||
|
|
private object _locker = new object();
|
|||
|
|
|
|||
|
|
private bool _enableLog = true;
|
|||
|
|
|
|||
|
|
private string _scRoot;
|
|||
|
|
public double TempData1 { get; set; }
|
|||
|
|
public double TempData2 { get; set; }
|
|||
|
|
public double TempData3 { get; set; }
|
|||
|
|
public double TempData4 { get; set; }
|
|||
|
|
|
|||
|
|
public string Address
|
|||
|
|
{
|
|||
|
|
get; set;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public bool IsConnected
|
|||
|
|
{
|
|||
|
|
get
|
|||
|
|
{
|
|||
|
|
return _connection != null && _connection.IsConnected;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|
|||
|
|
public bool Connect()
|
|||
|
|
{
|
|||
|
|
return true;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public bool Disconnect()
|
|||
|
|
{
|
|||
|
|
return true;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public AETemp(string module, string name, string scRoot) : base(module, name, name, name)
|
|||
|
|
{
|
|||
|
|
_scRoot = scRoot;
|
|||
|
|
_activeMonitorStatus = true;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
~AETemp()
|
|||
|
|
{
|
|||
|
|
_connection.Disconnect();
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public void QueryTemp()
|
|||
|
|
{
|
|||
|
|
_lstHandler.AddLast(new AETempReadCommandHandler(this, "OUT", "1"));
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|
|||
|
|
public void ResetDevice()
|
|||
|
|
{
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public void QueryError()
|
|||
|
|
{
|
|||
|
|
EV.PostInfoLog(Module, "Query error");
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public bool Initialize(string address, bool enableLogMessage)
|
|||
|
|
{
|
|||
|
|
DATA.Subscribe($"PM1.{Name}.Middle", () => TempData1);
|
|||
|
|
DATA.Subscribe($"PM1.{Name}.Outer", () => TempData2);
|
|||
|
|
DATA.Subscribe($"PM2.{Name}.Middle", () => TempData3);
|
|||
|
|
DATA.Subscribe($"PM2.{Name}.Outer", () => TempData4);
|
|||
|
|
Address = address;
|
|||
|
|
_enableLog = enableLogMessage;
|
|||
|
|
_connection = new AETempConnection(address);
|
|||
|
|
_connection.EnableLog(enableLogMessage);
|
|||
|
|
_thread = new PeriodicJob(400, OnTimer, $"{Module}.{Name} MonitorHandler", true);
|
|||
|
|
ConnectionManager.Instance.Subscribe($"{Name}", this);
|
|||
|
|
return true;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
private bool OnTimer()
|
|||
|
|
{
|
|||
|
|
try
|
|||
|
|
{
|
|||
|
|
_connection.MonitorTimeout();
|
|||
|
|
|
|||
|
|
|
|||
|
|
//
|
|||
|
|
if (!_connection.IsConnected || _connection.IsCommunicationError)
|
|||
|
|
{
|
|||
|
|
lock (_locker)
|
|||
|
|
{
|
|||
|
|
_lstHandler.Clear();
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
//只要断开，就进行连接
|
|||
|
|
if (!_connection.Connect())
|
|||
|
|
{
|
|||
|
|
_trigRetryConnect.CLK = !_connection.IsConnected;
|
|||
|
|
if (_trigRetryConnect.Q)
|
|||
|
|
{
|
|||
|
|
LOG.Write($"{Module}.PMAETemp.SetPyroCommunicationError");
|
|||
|
|
EV.PostAlarmLog(Module, $"Can not connect with {_connection.Address}, {Module}.{Name}");
|
|||
|
|
//在Process模式和PreProcess模式下AE掉线直接Abort
|
|||
|
|
object objStatus = DATA.Poll($"{Module}.Status");
|
|||
|
|
if (objStatus != null)
|
|||
|
|
{
|
|||
|
|
string moduleStatus = objStatus.ToString();
|
|||
|
|
if (moduleStatus == "PreProcess" || moduleStatus == "Process")
|
|||
|
|
{
|
|||
|
|
OP.DoOperation($"{Module}.Abort");
|
|||
|
|
EV.PostAlarmLog("PM1", $"Can not connect with {_connection.Address}, {Module}.{Name}, Abort!");
|
|||
|
|
EV.PostAlarmLog("PM2", $"Can not connect with {_connection.Address}, {Module}.{Name}, Abort!");
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
//EV.PostWarningLog(Module, $"Can not connect with {_connection.Address}, {Module}.{Name}");
|
|||
|
|
LOG.Write(Module + $"Can not connect with {_connection.Address}, {Module}.{Name}");
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
LOG.Write(Module + $"Can not connect with {_connection.Address}, {Module}.{Name}");
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
_connection.ForceClear();
|
|||
|
|
Thread.Sleep(1000);//重连延时
|
|||
|
|
return true;
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
//连接成功后不会再进入，所以也只是写入一次LOG
|
|||
|
|
LOG.Write($"{Module} {Name} Connected");
|
|||
|
|
EV.PostInfoLog(Module, $"{Name} Connected");
|
|||
|
|
}
|
|||
|
|
_trigRetryConnect.CLK = !_connection.IsConnected;
|
|||
|
|
_connection.ForceClear();
|
|||
|
|
return true;
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
//
|
|||
|
|
|
|||
|
|
HandlerBase handler = null;
|
|||
|
|
lock (_locker)
|
|||
|
|
{
|
|||
|
|
if (_lstHandler.Count == 0)
|
|||
|
|
QueryTemp();
|
|||
|
|
if (_lstHandler.Count > 0 && !_connection.IsBusy)
|
|||
|
|
{
|
|||
|
|
handler = _lstHandler.First.Value;
|
|||
|
|
_lstHandler.RemoveFirst();
|
|||
|
|
if (handler != null)
|
|||
|
|
{
|
|||
|
|
_connection.Execute(handler);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
catch (Exception ex)
|
|||
|
|
{
|
|||
|
|
LOG.Write(ex);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
return true;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
internal void NoteError()
|
|||
|
|
{
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
public void ParseCommandInfo(string command, string Message)
|
|||
|
|
{
|
|||
|
|
try
|
|||
|
|
{
|
|||
|
|
switch (command)
|
|||
|
|
{
|
|||
|
|
case "OUT":
|
|||
|
|
{
|
|||
|
|
if (Message != null)
|
|||
|
|
{
|
|||
|
|
if (Message.Contains(" "))
|
|||
|
|
{
|
|||
|
|
var strs = Message.Split(' ');
|
|||
|
|
if (strs.Length >= 4)
|
|||
|
|
{
|
|||
|
|
_trigFewChannels.CLK = false;
|
|||
|
|
//
|
|||
|
|
TempData1 = Convert.ToDouble(strs[0]);
|
|||
|
|
TempData2 = Convert.ToDouble(strs[1]);
|
|||
|
|
TempData3 = Convert.ToDouble(strs[2]);
|
|||
|
|
TempData4 = Convert.ToDouble(strs[3]);
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
_trigFewChannels.CLK = true;
|
|||
|
|
if (_trigFewChannels.Q)
|
|||
|
|
{
|
|||
|
|
EV.PostAlarmLog("PM1", "AE Error: Too few channels.");
|
|||
|
|
EV.PostAlarmLog("PM2", "AE Error: Too few channels.");
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
break;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
catch (Exception ex)
|
|||
|
|
{
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
#region 滤波
|
|||
|
|
//qbh 20220309
|
|||
|
|
const int iQueCap = 10;
|
|||
|
|
static Queue qWafInner = new Queue(iQueCap);
|
|||
|
|
//static Queue qSusInner = new Queue(iQueCap);
|
|||
|
|
|
|||
|
|
static Queue qWafMiddle = new Queue(iQueCap);
|
|||
|
|
//static Queue qSusMiddle = new Queue(iQueCap);
|
|||
|
|
|
|||
|
|
static Queue qWafOuter = new Queue(iQueCap);
|
|||
|
|
//static Queue qSusOuter = new Queue(iQueCap);
|
|||
|
|
|
|||
|
|
const double dbThres = 20.0;
|
|||
|
|
public static double TempFilter(string sName, double dbNewTemp)
|
|||
|
|
{
|
|||
|
|
//
|
|||
|
|
Queue qTempData = new Queue();
|
|||
|
|
|
|||
|
|
switch (sName)
|
|||
|
|
{
|
|||
|
|
case "TempData1":
|
|||
|
|
qTempData = qWafInner;
|
|||
|
|
break;
|
|||
|
|
case "TempData2":
|
|||
|
|
qTempData = qWafMiddle;
|
|||
|
|
break;
|
|||
|
|
case "TempData3":
|
|||
|
|
qTempData = qWafOuter;
|
|||
|
|
break;
|
|||
|
|
|
|||
|
|
default:
|
|||
|
|
break;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
//
|
|||
|
|
qTempData.Enqueue(dbNewTemp);
|
|||
|
|
//
|
|||
|
|
if (qTempData.Count < iQueCap)
|
|||
|
|
{
|
|||
|
|
return dbNewTemp;
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
//
|
|||
|
|
while (qTempData.Count > iQueCap)
|
|||
|
|
{
|
|||
|
|
qTempData.Dequeue();
|
|||
|
|
}
|
|||
|
|
//
|
|||
|
|
List<double> liTemp = new List<double>();
|
|||
|
|
object[] objs = qTempData.ToArray();
|
|||
|
|
foreach (object obj in objs)
|
|||
|
|
{
|
|||
|
|
liTemp.Add((double)obj);
|
|||
|
|
}
|
|||
|
|
liTemp.Sort();
|
|||
|
|
if (liTemp.Count > 0)
|
|||
|
|
{
|
|||
|
|
liTemp.RemoveAt(0);
|
|||
|
|
}
|
|||
|
|
liTemp.Reverse();
|
|||
|
|
if (liTemp.Count > 0)
|
|||
|
|
{
|
|||
|
|
liTemp.RemoveAt(0);
|
|||
|
|
}
|
|||
|
|
//
|
|||
|
|
double dbAvg = 0.0;
|
|||
|
|
foreach (double data in liTemp)
|
|||
|
|
{
|
|||
|
|
dbAvg += data;
|
|||
|
|
}
|
|||
|
|
dbAvg /= liTemp.Count;
|
|||
|
|
|
|||
|
|
|
|||
|
|
//
|
|||
|
|
return dbAvg;
|
|||
|
|
}
|
|||
|
|
//
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
/// <summary>
|
|||
|
|
/// 均方根值法
|
|||
|
|
/// </summary>
|
|||
|
|
/// <param name="sName"></param>
|
|||
|
|
/// <param name="dbNewTemp"></param>
|
|||
|
|
/// <returns></returns>
|
|||
|
|
public static double TempFilter2(string sName, double dbNewTemp)
|
|||
|
|
{
|
|||
|
|
//
|
|||
|
|
Queue qTempData = new Queue();
|
|||
|
|
|
|||
|
|
switch (sName)
|
|||
|
|
{
|
|||
|
|
case "TempData1":
|
|||
|
|
qTempData = qWafInner;
|
|||
|
|
break;
|
|||
|
|
case "TempData2":
|
|||
|
|
qTempData = qWafMiddle;
|
|||
|
|
break;
|
|||
|
|
case "TempData3":
|
|||
|
|
qTempData = qWafOuter;
|
|||
|
|
break;
|
|||
|
|
|
|||
|
|
default:
|
|||
|
|
break;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
//
|
|||
|
|
qTempData.Enqueue(dbNewTemp);
|
|||
|
|
//
|
|||
|
|
if (qTempData.Count < iQueCap)
|
|||
|
|
{
|
|||
|
|
return dbNewTemp;
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
//
|
|||
|
|
while (qTempData.Count > iQueCap)
|
|||
|
|
{
|
|||
|
|
qTempData.Dequeue();
|
|||
|
|
}
|
|||
|
|
//
|
|||
|
|
List<double> liTemp = new List<double>();
|
|||
|
|
object[] objs = qTempData.ToArray();
|
|||
|
|
foreach (object obj in objs)
|
|||
|
|
{
|
|||
|
|
liTemp.Add((double)obj);
|
|||
|
|
}
|
|||
|
|
liTemp.Sort();
|
|||
|
|
if (liTemp.Count > 0)
|
|||
|
|
{
|
|||
|
|
liTemp.RemoveAt(0);
|
|||
|
|
}
|
|||
|
|
liTemp.Reverse();
|
|||
|
|
if (liTemp.Count > 0)
|
|||
|
|
{
|
|||
|
|
liTemp.RemoveAt(0);
|
|||
|
|
}
|
|||
|
|
//均方根
|
|||
|
|
double dbAvg = 0.0;
|
|||
|
|
foreach (double data in liTemp)
|
|||
|
|
{
|
|||
|
|
dbAvg += data * data;
|
|||
|
|
}
|
|||
|
|
dbAvg /= liTemp.Count;
|
|||
|
|
dbAvg = Math.Sqrt(dbAvg);
|
|||
|
|
|
|||
|
|
//
|
|||
|
|
return dbAvg;
|
|||
|
|
}
|
|||
|
|
//
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
#endregion
|
|||
|
|
|
|||
|
|
public void Monitor()
|
|||
|
|
{
|
|||
|
|
try
|
|||
|
|
{
|
|||
|
|
_connection.EnableLog(_enableLog);
|
|||
|
|
|
|||
|
|
_trigCommunicationError.CLK = _connection.IsCommunicationError;
|
|||
|
|
if (_trigCommunicationError.Q)
|
|||
|
|
{
|
|||
|
|
EV.PostAlarmLog("PM1", $"{Module}.{Name} communication error, {_connection.LastCommunicationError}");
|
|||
|
|
EV.PostAlarmLog("PM2", $"{Module}.{Name} communication error, {_connection.LastCommunicationError}");
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
catch (Exception ex)
|
|||
|
|
{
|
|||
|
|
LOG.Write(ex);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public void Reset()
|
|||
|
|
{
|
|||
|
|
_connection.SetCommunicationError(false, "");
|
|||
|
|
_enableLog = SC.GetValue<bool>($"AETemp.EnableLogMessage");
|
|||
|
|
_trigCommunicationError.RST = true;
|
|||
|
|
//_trigRetryConnect.RST = true;
|
|||
|
|
_trigFewChannels.RST = true;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public void SetActiveMonitor(bool active)
|
|||
|
|
{
|
|||
|
|
_activeMonitorStatus = active;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public void SetErrorCode(int errorCode)
|
|||
|
|
{
|
|||
|
|
_errorCode = errorCode;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public void Terminate()
|
|||
|
|
{
|
|||
|
|
_connection.Disconnect();
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public bool Initialize()
|
|||
|
|
{
|
|||
|
|
return true;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|