- 1.0.1.7 - 2025/12/17
* 124V RS-485 Thread Improved
This commit is contained in:
@@ -1,13 +1,12 @@
|
|||||||
using System;
|
using DevExpress.XtraGauges.Core.Model;
|
||||||
|
|
||||||
using System.Threading;
|
|
||||||
using System.IO.Ports;
|
|
||||||
using System.Windows.Forms;
|
|
||||||
|
|
||||||
using LFP_Manager.DataStructure;
|
using LFP_Manager.DataStructure;
|
||||||
using LFP_Manager.Function;
|
using LFP_Manager.Function;
|
||||||
using LFP_Manager.Utils;
|
using LFP_Manager.Utils;
|
||||||
using DevExpress.XtraGauges.Core.Model;
|
using System;
|
||||||
|
using System.IO.Ports;
|
||||||
|
using System.Threading;
|
||||||
|
using System.Threading.Tasks;
|
||||||
|
using System.Windows.Forms;
|
||||||
|
|
||||||
namespace LFP_Manager.Threads
|
namespace LFP_Manager.Threads
|
||||||
{
|
{
|
||||||
@@ -17,9 +16,10 @@ namespace LFP_Manager.Threads
|
|||||||
|
|
||||||
private readonly CommConfig Config;
|
private readonly CommConfig Config;
|
||||||
private DeviceSystemData[] SystemData;
|
private DeviceSystemData[] SystemData;
|
||||||
private Thread serialComm = null;
|
private Task serialCommTask = null;
|
||||||
|
private CancellationTokenSource _cts;
|
||||||
private SerialPort sPort = null;
|
private SerialPort sPort = null;
|
||||||
private bool SerialPortThreadEnd = true;
|
private volatile bool SerialPortThreadEnd = true;
|
||||||
|
|
||||||
public int ModuleID = 1;
|
public int ModuleID = 1;
|
||||||
private bool UartPolling = false;
|
private bool UartPolling = false;
|
||||||
@@ -28,7 +28,7 @@ namespace LFP_Manager.Threads
|
|||||||
private int addr_ch = 0;
|
private int addr_ch = 0;
|
||||||
private ushort RequestRegAddr = 0x0000; //Byul Init 0x0000
|
private ushort RequestRegAddr = 0x0000; //Byul Init 0x0000
|
||||||
private ushort RequestRegLen = 50;
|
private ushort RequestRegLen = 50;
|
||||||
private bool rFlag = false;
|
private volatile bool rFlag = false;
|
||||||
private int wFlag = 0;
|
private int wFlag = 0;
|
||||||
private int rFlag2 = 0;
|
private int rFlag2 = 0;
|
||||||
|
|
||||||
@@ -56,29 +56,20 @@ namespace LFP_Manager.Threads
|
|||||||
SystemData = aSystemData;
|
SystemData = aSystemData;
|
||||||
|
|
||||||
UartTxBuff = new TUartTxBuff();
|
UartTxBuff = new TUartTxBuff();
|
||||||
|
_cts = new CancellationTokenSource();
|
||||||
serialComm = new Thread(uartCommThread);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
public void disposeThread()
|
public void disposeThread()
|
||||||
{
|
{
|
||||||
if (sPort != null)
|
try
|
||||||
{
|
{
|
||||||
if (sPort.IsOpen)
|
Stop();
|
||||||
{
|
|
||||||
sPort.Close();
|
|
||||||
}
|
|
||||||
sPort = null;
|
|
||||||
}
|
|
||||||
SerialPortThreadEnd = true;
|
|
||||||
if (serialComm != null)
|
|
||||||
{
|
|
||||||
if (serialComm.IsAlive)
|
|
||||||
{
|
|
||||||
serialComm.Abort();
|
|
||||||
}
|
|
||||||
serialComm = null;
|
|
||||||
}
|
}
|
||||||
|
catch { }
|
||||||
|
|
||||||
|
Close();
|
||||||
|
_cts?.Dispose();
|
||||||
|
_cts = null;
|
||||||
}
|
}
|
||||||
|
|
||||||
public bool Start(ref CommConfig aConfig, int mID, bool aPolling)
|
public bool Start(ref CommConfig aConfig, int mID, bool aPolling)
|
||||||
@@ -88,10 +79,15 @@ namespace LFP_Manager.Threads
|
|||||||
ModuleID = mID;
|
ModuleID = mID;
|
||||||
UartPolling = aPolling;
|
UartPolling = aPolling;
|
||||||
|
|
||||||
if (Open(aConfig.UartPort, 9600)) //Byul Init 9600
|
// Port open with configured baudrate (fallback to 9600)
|
||||||
|
int baud = (aConfig?.UartBaudrate > 0) ? aConfig.UartBaudrate : 9600;
|
||||||
|
if (Open(aConfig.UartPort, baud))
|
||||||
{
|
{
|
||||||
SerialPortThreadEnd = false;
|
SerialPortThreadEnd = false;
|
||||||
serialComm.Start();
|
// recreate CTS for this run
|
||||||
|
_cts?.Dispose();
|
||||||
|
_cts = new CancellationTokenSource();
|
||||||
|
serialCommTask = Task.Run(() => uartCommThread(_cts.Token), _cts.Token);
|
||||||
result = true;
|
result = true;
|
||||||
}
|
}
|
||||||
return result;
|
return result;
|
||||||
@@ -99,38 +95,57 @@ namespace LFP_Manager.Threads
|
|||||||
|
|
||||||
public void Stop()
|
public void Stop()
|
||||||
{
|
{
|
||||||
SerialPortThreadEnd = true;
|
try
|
||||||
Close();
|
{
|
||||||
|
SerialPortThreadEnd = true;
|
||||||
|
if (_cts != null && !_cts.IsCancellationRequested)
|
||||||
|
_cts.Cancel();
|
||||||
|
|
||||||
|
serialCommTask?.Wait(TimeSpan.FromSeconds(5));
|
||||||
|
}
|
||||||
|
catch (AggregateException) { }
|
||||||
|
catch (OperationCanceledException) { }
|
||||||
|
catch { }
|
||||||
|
finally
|
||||||
|
{
|
||||||
|
Close();
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
#endregion
|
#endregion
|
||||||
|
|
||||||
#region COMMPORT CONTROLS
|
#region COMMPORT CONTROLS
|
||||||
|
|
||||||
|
private readonly object _rxLock = new object();
|
||||||
|
private readonly object _portLock = new object();
|
||||||
|
|
||||||
private void sDataReceived(object sender, System.IO.Ports.SerialDataReceivedEventArgs e)
|
private void sDataReceived(object sender, System.IO.Ports.SerialDataReceivedEventArgs e)
|
||||||
{
|
{
|
||||||
byte[] sRead = new byte[1024];
|
|
||||||
int rLen = 0;
|
|
||||||
|
|
||||||
try
|
try
|
||||||
{
|
{
|
||||||
rLen = ((SerialPort)sender).Read(sRead, 0, 1024);
|
if (sPort == null || !sPort.IsOpen) return;
|
||||||
|
|
||||||
for (int i = 0; i < rLen; i++)
|
byte[] sRead = new byte[1024];
|
||||||
|
int rLen = sPort.Read(sRead, 0, sRead.Length);
|
||||||
|
|
||||||
|
lock (_rxLock)
|
||||||
{
|
{
|
||||||
PutBuff(sRead[i]);
|
for (int i = 0; i < rLen; i++)
|
||||||
|
{
|
||||||
|
PutBuff(sRead[i]);
|
||||||
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
catch (Exception)
|
catch (Exception ex)
|
||||||
{
|
{
|
||||||
|
// 무시하지 말고 로그 출력
|
||||||
|
OnPrint?.Invoke(this, $"DataRecv Error: {ex.Message}");
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
private void sErrorReceived(object sender, System.IO.Ports.SerialErrorReceivedEventArgs e)
|
private void sErrorReceived(object sender, System.IO.Ports.SerialErrorReceivedEventArgs e)
|
||||||
{
|
{
|
||||||
//
|
OnPrint?.Invoke(this, $"Serial Error: {e.EventType}");
|
||||||
//csMakeDataFunction.SetData()
|
|
||||||
}
|
}
|
||||||
|
|
||||||
private void sPinChanged(object sender, System.IO.Ports.SerialPinChangedEventArgs e)
|
private void sPinChanged(object sender, System.IO.Ports.SerialPinChangedEventArgs e)
|
||||||
@@ -140,34 +155,73 @@ namespace LFP_Manager.Threads
|
|||||||
|
|
||||||
private bool Open(string cPort, int cBaudrate)
|
private bool Open(string cPort, int cBaudrate)
|
||||||
{
|
{
|
||||||
sPort = new SerialPort();
|
lock (_portLock)
|
||||||
sPort.PortName = cPort;
|
|
||||||
sPort.BaudRate = cBaudrate;
|
|
||||||
sPort.DataReceived += sDataReceived;
|
|
||||||
sPort.ErrorReceived += sErrorReceived;
|
|
||||||
sPort.PinChanged += sPinChanged;
|
|
||||||
|
|
||||||
try
|
|
||||||
{
|
{
|
||||||
sPort.Open();
|
try
|
||||||
}
|
{
|
||||||
catch (Exception ex)
|
if (sPort != null)
|
||||||
{
|
{
|
||||||
throw new Exception("Error Open - " + ex.Message);
|
if (sPort.IsOpen) sPort.Close();
|
||||||
}
|
sPort.Dispose();
|
||||||
|
sPort = null;
|
||||||
|
}
|
||||||
|
|
||||||
return sPort.IsOpen;
|
sPort = new SerialPort
|
||||||
|
{
|
||||||
|
PortName = cPort,
|
||||||
|
BaudRate = cBaudrate,
|
||||||
|
DataBits = 8,
|
||||||
|
Parity = Parity.None,
|
||||||
|
StopBits = StopBits.One,
|
||||||
|
ReadTimeout = 500,
|
||||||
|
WriteTimeout = 500
|
||||||
|
};
|
||||||
|
|
||||||
|
sPort.DataReceived += sDataReceived;
|
||||||
|
sPort.ErrorReceived += sErrorReceived;
|
||||||
|
sPort.PinChanged += sPinChanged;
|
||||||
|
|
||||||
|
sPort.Open();
|
||||||
|
return sPort.IsOpen;
|
||||||
|
}
|
||||||
|
catch (Exception ex)
|
||||||
|
{
|
||||||
|
OnPrint?.Invoke(this, $"Error Open - {ex.Message}");
|
||||||
|
if (sPort != null)
|
||||||
|
{
|
||||||
|
try { sPort.Dispose(); } catch { }
|
||||||
|
sPort = null;
|
||||||
|
}
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
private void Close()
|
private void Close()
|
||||||
{
|
{
|
||||||
if (sPort != null)
|
lock (_portLock)
|
||||||
{
|
{
|
||||||
if (sPort.IsOpen)
|
try
|
||||||
{
|
{
|
||||||
sPort.Close();
|
if (sPort != null)
|
||||||
|
{
|
||||||
|
try
|
||||||
|
{
|
||||||
|
sPort.DataReceived -= sDataReceived;
|
||||||
|
sPort.ErrorReceived -= sErrorReceived;
|
||||||
|
sPort.PinChanged -= sPinChanged;
|
||||||
|
}
|
||||||
|
catch { }
|
||||||
|
|
||||||
|
if (sPort.IsOpen) sPort.Close();
|
||||||
|
sPort.Dispose();
|
||||||
|
sPort = null;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
catch (Exception ex)
|
||||||
|
{
|
||||||
|
OnPrint?.Invoke(this, $"Port Close Fail: {ex.Message}");
|
||||||
}
|
}
|
||||||
sPort = null;
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -180,7 +234,8 @@ namespace LFP_Manager.Threads
|
|||||||
ModuleID = mID;
|
ModuleID = mID;
|
||||||
UartPolling = flag;
|
UartPolling = flag;
|
||||||
SystemData = aSystemData;
|
SystemData = aSystemData;
|
||||||
SystemData[ModuleID - 1].mNo = ModuleID;
|
if (SystemData != null && ModuleID - 1 >= 0 && ModuleID - 1 < SystemData.Length)
|
||||||
|
SystemData[ModuleID - 1].mNo = ModuleID;
|
||||||
}
|
}
|
||||||
|
|
||||||
public void SetAutoTx(bool autoTx)
|
public void SetAutoTx(bool autoTx)
|
||||||
@@ -188,27 +243,16 @@ namespace LFP_Manager.Threads
|
|||||||
AutoUartTx = autoTx;
|
AutoUartTx = autoTx;
|
||||||
}
|
}
|
||||||
|
|
||||||
public void SetWriteCoilReg(ushort WriteAddr, short WriteData)
|
|
||||||
{
|
|
||||||
wFlag = 2;
|
|
||||||
WriteRegAddr = WriteAddr;
|
|
||||||
WriteCoilRegData = WriteData;
|
|
||||||
|
|
||||||
for (int i = 0; i < 500; i += 10)
|
|
||||||
{
|
|
||||||
Thread.Sleep(10);
|
|
||||||
Application.DoEvents();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
public void SetWriteReg(ushort WriteAddr, byte[] WriteData, bool ReplyFlag, int type)
|
public void SetWriteReg(ushort WriteAddr, byte[] WriteData, bool ReplyFlag, int type)
|
||||||
{
|
{
|
||||||
WriteRegAddr = WriteAddr;
|
WriteRegAddr = WriteAddr;
|
||||||
|
|
||||||
TUartTRxData uartTRxData = new TUartTRxData();
|
var uartTRxData = new TUartTRxData
|
||||||
uartTRxData.type = type;
|
{
|
||||||
//uartTRxData.data = CsRs485CommFunction124050.MakeWriteRegisterData((ushort)ModuleID, WriteRegAddr, WriteData);
|
type = type,
|
||||||
uartTRxData.data = WriteData;
|
data = WriteData,
|
||||||
uartTRxData.length = uartTRxData.data.Length;
|
length = WriteData?.Length ?? 0
|
||||||
|
};
|
||||||
|
|
||||||
UartTxBuff?.PutBuff(uartTRxData);
|
UartTxBuff?.PutBuff(uartTRxData);
|
||||||
}
|
}
|
||||||
@@ -219,10 +263,7 @@ namespace LFP_Manager.Threads
|
|||||||
|
|
||||||
if (sData != null)
|
if (sData != null)
|
||||||
{
|
{
|
||||||
TUartTRxData aData = new TUartTRxData();
|
var aData = new TUartTRxData { length = sData.Length, data = sData };
|
||||||
aData.length = sData.Length;
|
|
||||||
aData.data = sData;
|
|
||||||
|
|
||||||
UartTxBuff.PutBuff(aData);
|
UartTxBuff.PutBuff(aData);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
@@ -233,12 +274,8 @@ namespace LFP_Manager.Threads
|
|||||||
|
|
||||||
if (sData != null)
|
if (sData != null)
|
||||||
{
|
{
|
||||||
TUartTRxData aData = new TUartTRxData();
|
var aData = new TUartTRxData { length = sData.Length, data = sData };
|
||||||
aData.length = sData.Length;
|
|
||||||
aData.data = sData;
|
|
||||||
|
|
||||||
ExtReqRegAddr = WriteAddr;
|
ExtReqRegAddr = WriteAddr;
|
||||||
|
|
||||||
UartTxBuff.PutBuff(aData);
|
UartTxBuff.PutBuff(aData);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
@@ -255,66 +292,47 @@ namespace LFP_Manager.Threads
|
|||||||
|
|
||||||
private void PutBuff(byte c)
|
private void PutBuff(byte c)
|
||||||
{
|
{
|
||||||
rBuffer[rBufStart++] = c;
|
// called from DataReceived event -> lock to be safe
|
||||||
rBufStart %= BUFFER_SIZE;
|
lock (_rxLock)
|
||||||
|
|
||||||
if (rBufStart == rBufEnd)
|
|
||||||
{
|
{
|
||||||
rBufEnd++;
|
rBuffer[rBufStart++] = c;
|
||||||
rBufEnd %= BUFFER_SIZE;
|
rBufStart %= BUFFER_SIZE;
|
||||||
|
|
||||||
|
if (rBufStart == rBufEnd)
|
||||||
|
{
|
||||||
|
rBufEnd++;
|
||||||
|
rBufEnd %= BUFFER_SIZE;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
private int GetBuff()
|
private int GetBuff()
|
||||||
{
|
{
|
||||||
int result = 0;
|
lock (_rxLock)
|
||||||
|
|
||||||
if (rBufStart != rBufEnd)
|
|
||||||
{
|
{
|
||||||
result = 0x0100 + rBuffer[rBufEnd++];
|
int result = -1;
|
||||||
rBufEnd %= BUFFER_SIZE;
|
|
||||||
|
if (rBufStart != rBufEnd)
|
||||||
|
{
|
||||||
|
result = 0x0100 + rBuffer[rBufEnd++];
|
||||||
|
rBufEnd %= BUFFER_SIZE;
|
||||||
|
}
|
||||||
|
return result;
|
||||||
}
|
}
|
||||||
return result;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
private void FlushBuff()
|
private void FlushBuff()
|
||||||
{
|
{
|
||||||
rBufStart = rBufEnd = 0;
|
lock (_rxLock)
|
||||||
|
{
|
||||||
|
rBufStart = rBufEnd = 0;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
#endregion
|
#endregion
|
||||||
|
|
||||||
#region TX BUFFERING
|
#region TX BUFFERING
|
||||||
|
|
||||||
private byte[] MakeWriteRegData(ushort DevID, ushort WriteAddr, ushort WriteLen, ref ushort[] WriteData)
|
|
||||||
{
|
|
||||||
byte[] wData = null;
|
|
||||||
|
|
||||||
if (WriteLen > 0)
|
|
||||||
{
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
return wData;
|
|
||||||
}
|
|
||||||
|
|
||||||
private string MakeCheckSum(byte[] sData, int len)
|
|
||||||
{
|
|
||||||
string result = "";
|
|
||||||
int checksum = 0;
|
|
||||||
|
|
||||||
for (int i = 0; i < len; i++)
|
|
||||||
{
|
|
||||||
checksum += sData[i + 1];
|
|
||||||
}
|
|
||||||
|
|
||||||
checksum = ~checksum + 1;
|
|
||||||
|
|
||||||
result = String.Format("{0:X2}{1:X2}", (byte)(checksum >> 8), (byte)checksum);
|
|
||||||
|
|
||||||
return result;
|
|
||||||
}
|
|
||||||
|
|
||||||
private byte[] MakeTxDataDelta(bool wData)
|
private byte[] MakeTxDataDelta(bool wData)
|
||||||
{
|
{
|
||||||
byte[] sData = null;
|
byte[] sData = null;
|
||||||
@@ -360,13 +378,6 @@ namespace LFP_Manager.Threads
|
|||||||
sCmd = CsSerialCommFunctionDelta.READ_INPUT_REG; // Command 0x19
|
sCmd = CsSerialCommFunctionDelta.READ_INPUT_REG; // Command 0x19
|
||||||
rFlag = true;
|
rFlag = true;
|
||||||
break;
|
break;
|
||||||
//case 3:
|
|
||||||
// addr_ch = 4;
|
|
||||||
// RequestRegAddr = 0x0000;
|
|
||||||
// RequestRegLen = 1;
|
|
||||||
// sCmd = CsSerialCommFunctionDelta.READ_DEV_ID; // Command 0x2B
|
|
||||||
// rFlag = true;
|
|
||||||
// break;
|
|
||||||
case 3:
|
case 3:
|
||||||
addr_ch = 4;
|
addr_ch = 4;
|
||||||
RequestRegAddr = 100;
|
RequestRegAddr = 100;
|
||||||
@@ -389,9 +400,9 @@ namespace LFP_Manager.Threads
|
|||||||
break;
|
break;
|
||||||
default:
|
default:
|
||||||
addr_ch = 0;
|
addr_ch = 0;
|
||||||
RequestRegAddr = 0x0FFF; //Byul Init 0x0000
|
RequestRegAddr = 0x0FFF;
|
||||||
RequestRegLen = 27;
|
RequestRegLen = 27;
|
||||||
sCmd = CsSerialCommFunctionDelta.READ_INPUT_REG; // Command 0x04
|
sCmd = CsSerialCommFunctionDelta.READ_INPUT_REG;
|
||||||
rFlag = true;
|
rFlag = true;
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
@@ -426,140 +437,160 @@ namespace LFP_Manager.Threads
|
|||||||
rPosition = 0;
|
rPosition = 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
private void uartCommThread()
|
private void uartCommThread(CancellationToken token)
|
||||||
{
|
{
|
||||||
int RecvTimeout = Config.RecvWaitTime;
|
try
|
||||||
int getData = 0;
|
|
||||||
byte cData = 0;
|
|
||||||
int[] TimeOutCount = new int[csConstData.SystemInfo.MAX_MODULE_SIZE];
|
|
||||||
|
|
||||||
StartSend:
|
|
||||||
while (SerialPortThreadEnd == false)
|
|
||||||
{
|
{
|
||||||
if ((sPort == null) || (sPort.IsOpen == false)) continue;
|
int RecvTimeout = (Config != null) ? Config.RecvWaitTime : 1500;
|
||||||
|
int getData = 0;
|
||||||
|
byte cData = 0;
|
||||||
|
int[] TimeOutCount = new int[csConstData.SystemInfo.MAX_MODULE_SIZE];
|
||||||
|
|
||||||
FlushBuff();
|
StartSend:
|
||||||
byte[] txData = MakeTxDataDelta(false);
|
while (!token.IsCancellationRequested && SerialPortThreadEnd == false)
|
||||||
if (sPort == null) return;
|
|
||||||
if (txData != null)
|
|
||||||
{
|
{
|
||||||
sPort.Write(txData, 0, txData.Length);
|
if ((sPort == null) || (sPort.IsOpen == false))
|
||||||
OnPrint?.Invoke(this, csLog.trx_data_print(txData, txData.Length, 0));
|
|
||||||
}
|
|
||||||
|
|
||||||
if (rFlag == true)
|
|
||||||
{
|
|
||||||
DateTime rDateTime = DateTime.Now;
|
|
||||||
|
|
||||||
RecvPacketInit();
|
|
||||||
|
|
||||||
while (true)
|
|
||||||
{
|
{
|
||||||
DateTime nDateTime = rDateTime.AddMilliseconds(RecvTimeout);
|
Thread.Sleep(100);
|
||||||
if (nDateTime < DateTime.Now) break;
|
continue;
|
||||||
|
}
|
||||||
|
|
||||||
if (((getData = GetBuff()) & 0x0100) != 0x0000)
|
FlushBuff();
|
||||||
|
byte[] txData = MakeTxDataDelta(false);
|
||||||
|
if (sPort == null) return;
|
||||||
|
if (txData != null)
|
||||||
|
{
|
||||||
|
try
|
||||||
{
|
{
|
||||||
rDateTime = DateTime.Now;
|
sPort.Write(txData, 0, txData.Length);
|
||||||
|
OnPrint?.Invoke(this, csLog.trx_data_print(txData, txData.Length, 0));
|
||||||
|
}
|
||||||
|
catch (Exception ex)
|
||||||
|
{
|
||||||
|
OnPrint?.Invoke(this, $"Write error: {ex.Message}");
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
cData = (byte)(getData & 0x00FF);
|
if (rFlag == true)
|
||||||
|
{
|
||||||
|
DateTime rDateTime = DateTime.Now;
|
||||||
|
|
||||||
if (rPosition >= BUFFER_SIZE) RecvPacketInit();
|
RecvPacketInit();
|
||||||
|
|
||||||
if (BuffStart == false)
|
while (!token.IsCancellationRequested)
|
||||||
|
{
|
||||||
|
DateTime nDateTime = rDateTime.AddMilliseconds(RecvTimeout);
|
||||||
|
if (nDateTime < DateTime.Now) break;
|
||||||
|
|
||||||
|
getData = GetBuff();
|
||||||
|
if ((getData & 0x0100) != 0x0000)
|
||||||
{
|
{
|
||||||
if ((cData == (byte)ModuleID) || (cData == (byte)0x7F))
|
rDateTime = DateTime.Now;
|
||||||
|
|
||||||
|
cData = (byte)(getData & 0x00FF);
|
||||||
|
|
||||||
|
if (rPosition >= BUFFER_SIZE) RecvPacketInit();
|
||||||
|
|
||||||
|
if (!BuffStart)
|
||||||
{
|
{
|
||||||
rPosition = 0;
|
if ((cData == (byte)ModuleID) || (cData == (byte)0x7F))
|
||||||
ReadBuf[rPosition++] = cData;
|
{
|
||||||
BuffStart = true;
|
rPosition = 0;
|
||||||
|
ReadBuf[rPosition++] = cData;
|
||||||
|
BuffStart = true;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
ReadBuf[rPosition++] = cData;
|
||||||
|
|
||||||
|
int chk = CsRs485CommFunction124050.ModbusPacketFromSlaveCheck(ReadBuf, rPosition);
|
||||||
|
switch (chk)
|
||||||
|
{
|
||||||
|
case 0: // Need more data
|
||||||
|
break;
|
||||||
|
case 1: // Packet OK, no error
|
||||||
|
OnPrint?.Invoke(this, csLog.trx_data_print(ReadBuf, rPosition, 1));
|
||||||
|
|
||||||
|
TimeOutCount[ModuleID - 1] = 0;
|
||||||
|
|
||||||
|
int mID = ReadBuf[0];
|
||||||
|
if (mID > 0) mID--;
|
||||||
|
|
||||||
|
SystemData[mID].CommFail = false;
|
||||||
|
SystemData[mID].ShelfCommFail = false;
|
||||||
|
short[] result_code = CsRs485CommFunction124050.SerialRxProcess(ReadBuf, RequestRegAddr, rPosition, ref SystemData[mID]);
|
||||||
|
|
||||||
|
OnUpdate?.Invoke(this, ref SystemData);
|
||||||
|
|
||||||
|
Thread.Sleep(5);
|
||||||
|
goto StartSend;
|
||||||
|
case 2: // Fw Update Packet OK
|
||||||
|
OnPrint?.Invoke(this, csLog.trx_data_print(ReadBuf, rPosition, 1));
|
||||||
|
|
||||||
|
TimeOutCount[ModuleID - 1] = 0;
|
||||||
|
rFlag = false;
|
||||||
|
if (OnDataRecv != null)
|
||||||
|
{
|
||||||
|
var adata = new byte[rPosition];
|
||||||
|
Array.Copy(ReadBuf, 0, adata, 0, rPosition);
|
||||||
|
OnDataRecv(adata);
|
||||||
|
}
|
||||||
|
goto StartSend;
|
||||||
|
case -1: // Packet error
|
||||||
|
RecvPacketInit();
|
||||||
|
Thread.Sleep(100);
|
||||||
|
goto StartSend;
|
||||||
|
default:
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
Thread.Sleep(1);
|
||||||
}
|
}
|
||||||
else
|
else
|
||||||
{
|
{
|
||||||
ReadBuf[rPosition++] = cData;
|
Thread.Sleep(1);
|
||||||
|
|
||||||
switch (CsRs485CommFunction124050.ModbusPacketFromSlaveCheck(ReadBuf, rPosition))
|
|
||||||
{
|
|
||||||
case 0: // Need more data
|
|
||||||
break;
|
|
||||||
case 1: // Packet OK, no error
|
|
||||||
OnPrint?.Invoke(this, csLog.trx_data_print(ReadBuf, rPosition, 1));
|
|
||||||
|
|
||||||
TimeOutCount[ModuleID - 1] = 0;
|
|
||||||
|
|
||||||
int mID = ReadBuf[0];
|
|
||||||
if (mID > 0) mID--;
|
|
||||||
|
|
||||||
SystemData[mID].CommFail = false;
|
|
||||||
SystemData[mID].ShelfCommFail = false;
|
|
||||||
short[] result_code = CsRs485CommFunction124050.SerialRxProcess(ReadBuf, RequestRegAddr, rPosition, ref SystemData[mID]);
|
|
||||||
|
|
||||||
OnUpdate?.Invoke(this, ref SystemData);
|
|
||||||
|
|
||||||
Thread.Sleep(5);
|
|
||||||
goto StartSend;
|
|
||||||
case 2: // Fw Update Packet OK
|
|
||||||
OnPrint?.Invoke(this, csLog.trx_data_print(ReadBuf, rPosition, 1));
|
|
||||||
|
|
||||||
TimeOutCount[ModuleID - 1] = 0;
|
|
||||||
rFlag = false;
|
|
||||||
if (OnDataRecv != null)
|
|
||||||
{
|
|
||||||
byte[] adata = new byte[rPosition + 1];
|
|
||||||
for (int j = 0; j < adata.Length; j++)
|
|
||||||
{
|
|
||||||
adata[j] = ReadBuf[j];
|
|
||||||
}
|
|
||||||
OnDataRecv(adata);
|
|
||||||
}
|
|
||||||
goto StartSend;
|
|
||||||
case -1: // Packet error
|
|
||||||
RecvPacketInit();
|
|
||||||
Thread.Sleep(100);
|
|
||||||
goto StartSend;
|
|
||||||
default:
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
if (rPosition > 0)
|
||||||
|
{
|
||||||
|
OnPrint?.Invoke(this, csLog.trx_data_print(ReadBuf, rPosition, 1));
|
||||||
Thread.Sleep(1);
|
Thread.Sleep(1);
|
||||||
}
|
}
|
||||||
else
|
else
|
||||||
{
|
{
|
||||||
Thread.Sleep(1);
|
TimeOutCount[ModuleID - 1]++;
|
||||||
|
if (TimeOutCount[ModuleID - 1] >= 10)
|
||||||
|
{
|
||||||
|
TimeOutCount[ModuleID - 1] = 10;
|
||||||
|
if (SystemData[ModuleID - 1].ShelfCommFail == false)
|
||||||
|
{
|
||||||
|
SystemData[ModuleID - 1].ShelfCommFail = true;
|
||||||
|
csUtils.DataInit(Config, ref SystemData[ModuleID - 1]);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
Thread.Sleep(100);
|
||||||
}
|
}
|
||||||
}
|
OnUpdate?.Invoke(this, ref SystemData);
|
||||||
|
|
||||||
if (rPosition > 0)
|
|
||||||
{
|
|
||||||
OnPrint?.Invoke(this, csLog.trx_data_print(ReadBuf, rPosition, 1));
|
|
||||||
|
|
||||||
Thread.Sleep(1);
|
Thread.Sleep(1);
|
||||||
}
|
}
|
||||||
else
|
else
|
||||||
{
|
{
|
||||||
TimeOutCount[ModuleID - 1]++;
|
Thread.Sleep(10);
|
||||||
if (TimeOutCount[ModuleID - 1] >= 10)
|
} /* if (rFlag == true) */
|
||||||
{
|
rPosition = 0;
|
||||||
TimeOutCount[ModuleID - 1] = 10;
|
Thread.Sleep(100);
|
||||||
//SystemData[0].CommFail = true;
|
|
||||||
if (SystemData[ModuleID - 1].ShelfCommFail == false)
|
|
||||||
{
|
|
||||||
SystemData[ModuleID - 1].ShelfCommFail = true;
|
|
||||||
csUtils.DataInit(Config, ref SystemData[ModuleID - 1]);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
Thread.Sleep(100);
|
|
||||||
}
|
|
||||||
OnUpdate?.Invoke(this, ref SystemData);
|
|
||||||
Thread.Sleep(1);
|
|
||||||
}
|
}
|
||||||
else
|
}
|
||||||
{
|
catch (OperationCanceledException) { }
|
||||||
Thread.Sleep(10);
|
catch (Exception ex)
|
||||||
} /* if (rFlag == true) */
|
{
|
||||||
rPosition = 0;
|
OnPrint?.Invoke(this, $"Comm thread error: {ex.Message}");
|
||||||
Thread.Sleep(100);
|
}
|
||||||
|
finally
|
||||||
|
{
|
||||||
|
SerialPortThreadEnd = true;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user