首次上传

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,309 @@
using Aitex.Core.RT.DataCenter;
using Aitex.Core.RT.Device;
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 System;
using System.Collections.Generic;
using System.Threading;
namespace MECF.Framework.RT.EquipmentLibrary.HardwareUnits.Vacuometer
{
public class Vacuometer : BaseDevice, IConnection,IDevice
{
private VacuometerConnection _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;
public double Pressure { 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 Vacuometer(string module, string name, string scRoot) : base(module, name, name, name)
{
_scRoot = scRoot;
_activeMonitorStatus = true;
}
~Vacuometer()
{
_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 VacuometerQueryHandler(this, "Query Actual1 Temp", 0x1, 0x2, 0x0, 0x0, 0x1));
//_lstHandler.AddLast(new VacuometerQueryHandler(this, "Query Setting1 Temp", 0x1, 0x2, 0x40, 0x0, 0x1));
//_lstHandler.AddLast(new VacuometerQueryHandler(this, "Query Actual2 Temp", 0x1, 0x04, 0x00, 0x00, 0x01));
//_lstHandler.AddLast(new VacuometerQueryHandler(this, "Query Setting2 Temp", 0x1, 0x40, 0x40, 0x00, 0x01));
//_lstHandler.AddLast(new VacuometerQueryHandler(this, "Query Actual3 Temp", 0x1, 0x60, 0x00, 0x00, 0x1));
//_lstHandler.AddLast(new VacuometerQueryHandler(this, "Query Setting3 Temp", 0x1, 0x60, 0x40, 0x00, 0x1));
//_lstHandler.AddLast(new VacuometerQueryHandler(this, "Query Actual4 Temp", 0x1, 0x80, 0x00, 0x00, 0x01));
//_lstHandler.AddLast(new VacuometerQueryHandler(this, "Query Setting4 Temp", 0x1, 0x80, 0x40, 0x00, 0x01));
}
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");
_connection = new VacuometerConnection(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();
Thread.Sleep(sleep * 1000);
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(200, OnTimer, $"{Module}.{Name} MonitorHandler", true);
// _connection.Execute(new VacuometerReciveHandler(this, "Recive Data"));
DATA.Subscribe($"{Module}.{Name}.PressureValue", () => Pressure);
ConnectionManager.Instance.Subscribe($"{Name}", this);
return true;
}
public double A { get; set; }
public int B { get; set; }
public void ReadData(byte[] buffer)
{
if (buffer[1] == 2) B = 32767;
else B = 32000;
bool bit4 = ((Convert.ToInt16(buffer[2]) >> 4) & 0x01)==0;
bool bit5 = ((Convert.ToInt16(buffer[2]) >> 5) & 0x01)==0;
if (bit4 && bit5) A = 1.00;
else if (!bit4 && bit5) A = 1.3332;
else if(bit4&&!bit5) A = 133.32;
var AnalogValue = BitConverter.ToInt16(new byte[] { buffer[5], buffer[4]},0);
Pressure =((AnalogValue* 1.3332)/B) * 1.0 * 1000;
}
public R_TRIG _trigCreateReciveHandler = new R_TRIG();
private bool OnTimer()
{
try
{
_connection.MonitorTimeout();
if (!_connection.IsConnected || _connection.IsCommunicationError)
{
lock (_locker)
{
_trigCreateReciveHandler.RST = true;
_lstHandler.Clear();
}
_trigRetryConnect.CLK = !_connection.IsConnected;
if (_trigRetryConnect.Q)
{
//_connection.SetPortAddress(SC.GetStringValue($"{_scRoot}.{Name}.Address"));
//_connection.SetPortAddress(SC.GetStringValue($"{Name}.Address"));
if (!_connection.Connect())
{
EV.PostAlarmLog(Module, $"Can not connect with {_connection.Address}, {Module}.{Name}");
}
}
//_connection.SetPortAddress(SC.GetStringValue($"{Name}.Address"));
//if (_trigRetryConnect.CLK)
//{
// if (!_connection.Connect())
// {
// if (_trigRetryConnect.Q)
// {
// EV.PostAlarmLog(Module, $"Can not connect with {_connection.Address}, {Module}.{Name}");
// }
// }
// else
// {
// EV.PostAlarmLog(Module, $"Retry connect succee with {_connection.Address}, {Module}.{Name}");
// _trigRetryConnect.CLK = false;
// }
// Thread.Sleep(3000);
//}
//_connection.ForceClear();
//if(_connection.IsConnected && !_connection.IsCommunicationError)
//_connection.Execute(new VacuometerReciveHandler(this, "Recive Data"));
return true;
}
_trigCreateReciveHandler.CLK = true;
if (_trigCreateReciveHandler.Q)
_connection.Execute(new VacuometerReciveHandler(this, "ReciveDataHandler"));
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 Monitor()
{
try
{
_connection.EnableLog(_enableLog);
_trigCommunicationError.CLK = _connection.IsCommunicationError;
if (_trigCommunicationError.Q)
{
Pressure = 0.0;
EV.PostAlarmLog(Module, $"{Module}.{Name} communication error, {_connection.LastCommunicationError}");
}
}
catch (Exception ex)
{
LOG.Write(ex);
}
}
public void Reset()
{
_connection.SetCommunicationError(false, "");
_trigCommunicationError.RST = true;
//_connection.ForceClear();
_enableLog = SC.GetValue<bool>($"{Name}.EnableLogMessage");
_trigRetryConnect.RST = true;
}
public void SetActiveMonitor(bool active)
{
_activeMonitorStatus = active;
}
public void SetErrorCode(int errorCode)
{
_errorCode = errorCode;
}
public void Terminate()
{
_connection.Disconnect();
}
public Dictionary<string, double> dicUnit = new Dictionary<string, double>()
{
{"Torr",1.00},
{"mbar",1.3332},
{"Pa",133.32}
};
}
//public class SensorType
//{
// public string type;
// public int
//}
}
@@ -0,0 +1,169 @@
using MECF.Framework.Common.Communications;
using System;
using System.Collections.Generic;
using System.Linq;
using System.Threading;
namespace MECF.Framework.RT.EquipmentLibrary.HardwareUnits.Vacuometer
{
public class VacuometerMessage : BinaryMessage
{
public byte DeviceAddress { get; set; }
public byte FunctionCode { get; set; }
public byte Length { get; set; }
public byte[] Data { get; set; }
}
class VacuometerConnection : SerialPortConnectionBase
{
private List<byte> _lstCacheBuffer = new List<byte>();
public VacuometerConnection(string portName) : base(portName, 9600, 8, System.IO.Ports.Parity.None, System.IO.Ports.StopBits.One, "\n", false)
{
}
public override bool SendMessage(byte[] message)
{
_lstCacheBuffer.Clear();
return base.SendMessage(message);
}
protected override MessageBase ParseResponse(byte[] rawMessage)
{
_lstCacheBuffer.Clear();
_lstCacheBuffer.AddRange(rawMessage);
byte[] temps = _lstCacheBuffer.ToArray();
// EV.PostInfoLog("VCE","ARR1");
VacuometerMessage msg = new VacuometerMessage();
msg.IsResponse = false;
msg.IsAck = false;
msg.IsComplete = false;
msg.RawMessage = _lstCacheBuffer.ToArray();
if (temps.Length > 9)
{
for(int i= 0;i < temps.Length;i++)
{
if (i + 3 < temps.Length)
{
if (temps[i] == 0x07 && temps[i + 1] == 0x02 && temps[i + 2] == 0x10 && temps[i + 3] == 0x01)
{
temps = temps.Skip(i).Take(9).ToArray();//.Skip(9).ToArray();
break;
}
}
}
}
if(temps.Length<9) return msg;
if (temps[0] != 0x7) return msg;
if(temps[8]!= CheckSum(temps)) return msg;
//msg.DeviceAddress = temps[0];
//msg.FunctionCode = temps[1];
//msg.Length = temps[2];
// if (temps.Length < msg.Length + 5) return msg;
msg.Data = temps; //_lstCacheBuffer.ToArray(); //_lstCacheBuffer.Skip(3).Take(msg.Length).ToArray();
msg.IsResponse = true;
msg.IsAck = true;
msg.IsComplete = true;
return msg;
}
public byte CheckSum(byte[] buffer)
{
int Sum = 0;
var arry = buffer.ToList().Skip(1).Take(7).ToArray();
foreach (var data in arry)
{
Sum += data;
}
return Convert.ToByte(Sum & 0xff);
}
}
public abstract class VacuometerHandler : HandlerBase
{
public Vacuometer Device { get; }
protected VacuometerHandler(Vacuometer device, byte[] commandvalue)
: base(BuildMessage(commandvalue))
{
Device = device;
}
private static byte[] BuildMessage(byte[] commandvalue)
{
if (commandvalue == null) return null;
byte[] crc = ModRTU_CRC(commandvalue);
List<byte> result = commandvalue.ToList();
foreach (byte b in crc)
{
result.Add(b);
}
return result.ToArray();
}
public override bool HandleMessage(MessageBase msg, out bool handled)
{
var result = msg as VacuometerMessage;
ResponseMessage = msg;
handled = true;
return true;
}
private static byte[] ModRTU_CRC(byte[] buffer)
{
ushort crc = 0xFFFF;
// var buf = System.Text.Encoding.UTF8.GetBytes(String.Join(Environment.NewLine, buffer));
var buf = buffer;
var len = buffer.Length;
for (var pos = 0; pos < len; pos++)
{
crc ^= buf[pos]; // XOR byte into least sig. byte of crc
for (var i = 8; i != 0; i--)
// Loop over each bit
if ((crc & 0x0001) != 0)
{
// If the LSB is set
crc >>= 1; // Shift right and XOR 0xA001
crc ^= 0xA001;
}
else // Else LSB is not set
{
crc >>= 1; // Just shift right
}
}
// Note, this number has low and high bytes swapped, so use it accordingly (or swap bytes)
return BitConverter.GetBytes(crc);
}
}
public class VacuometerReciveHandler : VacuometerHandler
{
public VacuometerReciveHandler(Vacuometer device, string name)
: base(device,null)
{
Name = name;//"Query Temp";
}
public override bool HandleMessage(MessageBase msg, out bool handled)
{
var result = msg as VacuometerMessage;
handled = false;
if (!result.IsResponse) return true;
Device.ReadData(result.Data);
ResponseMessage = msg;
SetState(EnumHandlerState.Acked);
handled = true;
Thread.Sleep(10);
//EV.PostInfoLog("VCE", "ARR2");
return true;
}
}
}