455 lines
14 KiB
C#
455 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.Util;
|
|
using MECF.Framework.Common.Communications;
|
|
using System;
|
|
using System.Collections.Generic;
|
|
using System.Collections;
|
|
using System.Threading;
|
|
|
|
|
|
namespace MECF.Framework.RT.EquipmentLibrary.HardwareUnits.Temps.AE
|
|
{
|
|
public class AETemp : BaseDevice, IConnection,IDevice
|
|
{
|
|
private AETempConnection _connection;
|
|
private bool _activeMonitorStatus;
|
|
private int _errorCode;
|
|
private R_TRIG _trigCommunicationError = new R_TRIG();
|
|
private R_TRIG _trigRetryConnect = 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;
|
|
private int _iInterval = 500;
|
|
public double AETemp1 { get; set; }
|
|
public double AETemp2 { get; set; }
|
|
public double AETemp3 { 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 TempOmron(string module, string name, string scRoot) : base(module, name, name, name)
|
|
//{
|
|
// //tempCount = count;
|
|
// _scRoot = scRoot;
|
|
// _activeMonitorStatus = true;
|
|
//}
|
|
|
|
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 portName = SC.GetStringValue($"{_scRoot}.{Module}.{Name}.Address");
|
|
string portName = SC.GetStringValue($"{Name}.Address");
|
|
Address = portName;
|
|
//int address = SC.GetValue<int>($"{_scRoot}.{Name}.DeviceAddress");
|
|
|
|
_enableLog = SC.GetValue<bool>($"{Name}.EnableLogMessage");
|
|
_iInterval = SC.GetValue<int>($"{Name}.DataPollingInterval");
|
|
|
|
_connection = new AETempConnection(portName);
|
|
_connection.EnableLog(_enableLog);
|
|
|
|
|
|
|
|
int count = SC.ContainsItem("System.ComPortRetryCount") ? SC.GetValue<int>("System.ComPortRetryCount") : 5;
|
|
int sleep = SC.ContainsItem("System.ComPortRetryDelayTime") ? SC.GetValue<int>("System.ComPortRetryDelayTime") : 2;
|
|
if (sleep <= 0 || sleep > 10)
|
|
sleep = 2;
|
|
int retry = 0;
|
|
do
|
|
{
|
|
_connection.Disconnect();
|
|
//
|
|
if (_connection.Connect())
|
|
{
|
|
EV.PostInfoLog(Module, $"{Name} connected");
|
|
break;
|
|
}
|
|
|
|
if (count > 0 && retry++ > count)
|
|
{
|
|
LOG.Write($"Retry connect {Module}.{Name} stop retry.");
|
|
EV.PostAlarmLog(Module, $"Can't connect to {Module}.{Name}.");
|
|
break;
|
|
}
|
|
|
|
//Thread.Sleep(sleep * 1000);
|
|
LOG.Write($"Retry connect {Module}.{Name} for the {retry + 1} time.");
|
|
|
|
} while (true);
|
|
|
|
_thread = new PeriodicJob(_iInterval, OnTimer, $"{Module}.{Name} MonitorHandler", true);
|
|
DATA.Subscribe($"{Module}.{Name}.AETemp1", () => AETemp1);
|
|
DATA.Subscribe($"{Module}.{Name}.AETemp2", () => AETemp2);
|
|
DATA.Subscribe($"{Module}.{Name}.AETemp3", () => AETemp3);
|
|
//DATA.Subscribe($"{Module}.{Name}.SettingTemp", () => SettingTemp);
|
|
//OP.Subscribe($"{Module}.{Name}.WriteConfigData", SetCofig);
|
|
|
|
//
|
|
ConnectionManager.Instance.Subscribe($"{Name}", this);
|
|
|
|
return true;
|
|
}
|
|
|
|
private bool OnTimer()
|
|
{
|
|
try
|
|
{
|
|
_connection.MonitorTimeout();
|
|
|
|
if (!_connection.IsConnected || _connection.IsCommunicationError)
|
|
{
|
|
|
|
//
|
|
lock (_locker)
|
|
{
|
|
_lstHandler.Clear();
|
|
}
|
|
|
|
//_connection.SetPortAddress(SC.GetStringValue($"{_scRoot}.{Name}.Address"));
|
|
if (!_connection.Connect())
|
|
{
|
|
_trigRetryConnect.CLK = !_connection.IsConnected;
|
|
if (_trigRetryConnect.Q)
|
|
{
|
|
//OP.DoOperation($"{Module}.PMAETemp.SetPyroCommunicationError", true);
|
|
LOG.Write($"{Module}.PMAETemp.SetPyroCommunicationError");
|
|
|
|
//在Process模式和PreProcess模式下AE掉线直接Abort
|
|
string moduleStatus = DATA.Poll($"{Module}.Status").ToString();
|
|
if (moduleStatus == "PreProcess" || moduleStatus == "Process")
|
|
{
|
|
OP.DoOperation($"{Module}.Abort");
|
|
EV.PostAlarmLog(Module, $"Can not connect with {_connection.Address}, {Module}.{Name}, Abort!");
|
|
}
|
|
else
|
|
{
|
|
//EV.PostAlarmLog(Module, $"Can not connect with {_connection.Address}, {Module}.{Name}");
|
|
LOG.Write(Module + $"Can not connect with {_connection.Address}, {Module}.{Name}");
|
|
}
|
|
}
|
|
_connection.ForceClear();
|
|
return true;
|
|
}
|
|
else
|
|
{
|
|
//OP.DoOperation($"{Module}.PMAETemp.SetPyroCommunicationError", false);
|
|
LOG.Write($"{Module}.PMAETemp.SetPyroCommunicationError,reconnected.");
|
|
}
|
|
}
|
|
|
|
HandlerBase handler = null;
|
|
//if (!_connection.IsBusy)
|
|
//{
|
|
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)
|
|
{
|
|
switch (command)
|
|
{
|
|
case "OUT":
|
|
{
|
|
if(Message!=null)
|
|
{
|
|
if (Message.Contains(" "))
|
|
{
|
|
var strs = Message.Split(' ');
|
|
AETemp1 = Convert.ToDouble(strs[0]);
|
|
AETemp2 = Convert.ToDouble(strs[1]);
|
|
AETemp3 = Convert.ToDouble(strs[2]);
|
|
|
|
//AETemp1 = TempFilter2("AETemp1", Convert.ToDouble(strs[0]));
|
|
//AETemp2 = TempFilter2("AETemp2", Convert.ToDouble(strs[1]));
|
|
//AETemp3 = TempFilter2("AETemp3", Convert.ToDouble(strs[2]));
|
|
}
|
|
}
|
|
}
|
|
break;
|
|
}
|
|
}
|
|
|
|
#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 "AETemp1":
|
|
qTempData = qWafInner;
|
|
break;
|
|
case "AETemp2":
|
|
qTempData = qWafMiddle;
|
|
break;
|
|
case "AETemp3":
|
|
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 "AETemp1":
|
|
qTempData = qWafInner;
|
|
break;
|
|
case "AETemp2":
|
|
qTempData = qWafMiddle;
|
|
break;
|
|
case "AETemp3":
|
|
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(Module, $"{Module}.{Name} communication error, {_connection.LastCommunicationError}");
|
|
}
|
|
}
|
|
catch (Exception ex)
|
|
{
|
|
LOG.Write(ex);
|
|
}
|
|
|
|
}
|
|
|
|
public void Reset()
|
|
{
|
|
_connection.SetCommunicationError(false, "");
|
|
_enableLog = SC.GetValue<bool>($"{Name}.EnableLogMessage");
|
|
_trigCommunicationError.RST = true;
|
|
_trigRetryConnect.RST = true;
|
|
}
|
|
|
|
public void SetActiveMonitor(bool active)
|
|
{
|
|
_activeMonitorStatus = active;
|
|
}
|
|
|
|
public void SetErrorCode(int errorCode)
|
|
{
|
|
_errorCode = errorCode;
|
|
}
|
|
|
|
public void Terminate()
|
|
{
|
|
_connection.Disconnect();
|
|
}
|
|
|
|
|
|
}
|
|
}
|