6 Commits

Author SHA1 Message Date
nikzori
4137a84fa3 rc1: fixed write timeouts 2025-04-09 15:26:50 +03:00
nikzori
96b77d4181 added data byte counter for incoming port data 2025-04-08 17:11:57 +03:00
nikzori
8587ad9d3d added line break polling 2025-04-02 12:40:39 +03:00
nikzori
3d4a97b4e9 fixed and optimized port data processing 2025-03-27 12:57:40 +03:00
nikzori
3a3fd60a00 fixed and optimized port data processing 2025-03-27 12:53:14 +03:00
nikzori
5c2a9973f0 fixed and optimized port data processing 2025-03-27 12:52:24 +03:00
5 changed files with 261 additions and 239 deletions

View File

@@ -18,7 +18,7 @@ namespace Gidrolock_Modbus_Scanner
byte modbusID;
Device device;
ModbusResponseEventArgs latestMessage;
public static ModbusResponseEventArgs latestMessage;
SerialPort port = Modbus.port;
bool isPolling = false;
@@ -26,7 +26,7 @@ namespace Gidrolock_Modbus_Scanner
static bool responseReceived = false;
bool isValveClosed = false;
bool isValveClosed = false;
bool alarmStatus = false;
bool cleaningStatus = false;
@@ -34,9 +34,7 @@ namespace Gidrolock_Modbus_Scanner
List<WirelessSensor> wirelessSensors;
public static string firmwarePath;
static int timeout = 1000;
Stopwatch stopwatch = new Stopwatch();
Thread fileThread = new Thread((ThreadStart)delegate
{
OpenFileDialog ofd = new OpenFileDialog();
@@ -117,144 +115,165 @@ namespace Gidrolock_Modbus_Scanner
private async void buttonPoll_Click(object sender, EventArgs e)
{
if (isPolling)
return;
// hardcoded for now, probably easier to keep it like this in the future
try
{
bool res = await PollEntry(device.firmware);
Console.WriteLine("Polling for alarm status, poll success: " + res);
if (res)
await Task.Run(() =>
{
labelFirmware.Text = App.ByteArrayToUnicode(latestMessage.Data);
}
if (device.hasBattery)
{
res = await PollEntry(device.batteryCharge);
bool res = PollEntry(device.firmware);
Console.WriteLine("Polling for alarm status, poll success: " + res);
if (res)
{
labelBattery.Text = latestMessage.Data.Last().ToString();
this.Invoke(new MethodInvoker(delegate { labelFirmware.Text = App.ByteArrayToUnicode(latestMessage.Data); }));
}
}
res = await PollEntry(device.valveStatus);
Console.WriteLine("Polling for valve status, poll success: " + res);
if (res)
{
if (latestMessage.Data.Last() > 0)
if (device.hasBattery)
{
isValveClosed = true;
labelValve.Text = "Закрыт";
buttonValve.Text = "Открыть";
res = PollEntry(device.batteryCharge);
if (res)
{
this.Invoke(new MethodInvoker(delegate { labelBattery.Text = latestMessage.Data.Last().ToString(); }));
}
}
else
{
isValveClosed = false;
labelValve.Text = "Открыт";
buttonValve.Text = "Закрыть";
}
}
res = await PollEntry(device.alarmStatus);
Console.WriteLine("Polling for alarm status, poll success: " + res);
if (res)
{
Console.WriteLine("Alarm data: " + Modbus.ByteArrayToString(latestMessage.Data));
Console.WriteLine("Alarm data.last: " + latestMessage.Data.Last().ToString());
if (latestMessage.Data.Last() > 0)
{
alarmStatus = true;
buttonAlarm.Text = "Выключить";
labelAlarm.Text = "Протечка!";
}
else
{
alarmStatus = false;
buttonAlarm.Text = "Авария";
labelAlarm.Text = "нет";
}
}
if (device.hasCleaningMode)
{
res = await PollEntry(device.cleaningMode);
res = PollEntry(device.valveStatus);
Console.WriteLine("Polling for valve status, poll success: " + res);
if (res)
{
if (latestMessage.Data.Last() > 0)
{
cleaningStatus = true;
buttonCleaning.Text = "Выключить";
labelCleaning.Text = "вкл";
isValveClosed = true;
this.Invoke(new MethodInvoker(delegate { labelValve.Text = "Закрыт"; }));
this.Invoke(new MethodInvoker(delegate { buttonValve.Text = "Открыть"; }));
}
else
{
cleaningStatus = false;
buttonCleaning.Text = "Включить";
labelCleaning.Text = "выкл";
isValveClosed = false;
this.Invoke(new MethodInvoker(delegate { labelValve.Text = "Открыт"; }));
this.Invoke(new MethodInvoker(delegate { buttonValve.Text = "Закрыть"; }));
}
}
}
res = await PollEntry(device.sensorAlarm);
if (res)
{
BitArray bArray = new BitArray(latestMessage.Data);
bool[] bools = new bool[bArray.Length];
bArray.CopyTo(bools, 0);
for (int i = 0; i < sensorPanel.Controls.Count; i++)
res = PollEntry(device.alarmStatus);
Console.WriteLine("Polling for alarm status, poll success: " + res);
if (res)
{
Sensor snsr = sensorPanel.Controls[i] as Sensor;
snsr.labelLeak.Text = bools[i] ? "Протечка!" : "нет";
}
}
Console.WriteLine("Polling for radio status");
res = await PollEntry(device.radioStatus);
if (res)
{
List<byte> values = new List<byte>(latestMessage.Data.Length / 2);
for (int i = 1; i < latestMessage.Data.Length; i += 2)
values.Add(latestMessage.Data[i]);
int add = device.wiredSensors + (device.hasScenarioSensor ? 1 : 0);
for (int i = 0; i < sensorPanel.Controls.Count - add; i++)
{
WirelessSensor snsr = sensorPanel.Controls[i + add] as WirelessSensor;
string txt = "нет";
switch (values[i])
Console.WriteLine("Alarm data: " + Modbus.ByteArrayToString(latestMessage.Data));
Console.WriteLine("Alarm data.last: " + latestMessage.Data.Last().ToString());
if (latestMessage.Data.Last() > 0)
{
case 1:
txt = "норма";
break;
case 2:
txt = "протечка";
break;
case 3:
txt = "разряжен";
break;
case 4:
txt = "потеря";
break;
alarmStatus = true;
this.Invoke(new MethodInvoker(delegate { buttonAlarm.Text = "Выключить"; }));
this.Invoke(new MethodInvoker(delegate { labelAlarm.Text = "Протечка!"; }));
}
else
{
alarmStatus = false;
this.Invoke(new MethodInvoker(delegate { buttonAlarm.Text = "Авария"; }));
this.Invoke(new MethodInvoker(delegate { labelAlarm.Text = "нет"; }));
}
snsr.labelStatus.Text = txt;
}
}
if (device.hasCleaningMode)
{
res = PollEntry(device.cleaningMode);
if (res)
{
if (latestMessage.Data.Last() > 0)
{
cleaningStatus = true;
this.Invoke(new MethodInvoker(delegate { buttonCleaning.Text = "Выключить"; }));
this.Invoke(new MethodInvoker(delegate { labelCleaning.Text = "вкл"; }));
}
else
{
cleaningStatus = false;
this.Invoke(new MethodInvoker(delegate { buttonCleaning.Text = "Включить"; }));
this.Invoke(new MethodInvoker(delegate { labelCleaning.Text = "выкл"; }));
}
}
}
if (device.wiredLineBreak != null || device.wiredLineBreak.Count > 0)
{
for (int i = 0; i < device.wiredLineBreak.Count; i++)
{
res = PollEntry(device.wiredLineBreak[i]);
if (res)
{
bool value = latestMessage.Data[0] > 0x00 ? true : false;
WiredSensor snsr = sensorPanel.Controls[i] as WiredSensor;
snsr.Invoke(new MethodInvoker(delegate { snsr.labelBreak.Text = value ? "Обрыв!" : "ОК"; }));
}
}
}
res = PollEntry(device.sensorAlarm);
if (res)
{
BitArray bArray = new BitArray(latestMessage.Data);
bool[] bools = new bool[bArray.Length];
bArray.CopyTo(bools, 0);
for (int i = 0; i < sensorPanel.Controls.Count; i++)
{
Sensor snsr = sensorPanel.Controls[i] as Sensor;
snsr.Invoke(new MethodInvoker(delegate { snsr.labelLeak.Text = bools[i] ? "Протечка!" : "нет"; }));
}
}
Console.WriteLine("Polling for radio status");
res = PollEntry(device.radioStatus);
if (res)
{
List<byte> values = new List<byte>(latestMessage.Data.Length / 2);
for (int i = 1; i < latestMessage.Data.Length; i += 2)
values.Add(latestMessage.Data[i]);
int add = device.wiredSensors + (device.hasScenarioSensor ? 1 : 0);
for (int i = 0; i < sensorPanel.Controls.Count - add; i++)
{
WirelessSensor snsr = sensorPanel.Controls[i + add] as WirelessSensor;
string txt = "нет";
switch (values[i])
{
case 1:
txt = "норма";
break;
case 2:
txt = "протечка";
break;
case 3:
txt = "разряжен";
break;
case 4:
txt = "потеря";
break;
}
snsr.Invoke(new MethodInvoker(delegate { snsr.labelStatus.Text = txt; }));
}
}
});
}
catch (Exception err) { MessageBox.Show(err.Message); }
}
//Опрос всех записей
async Task<bool> PollEntry(Entry entry)
bool PollEntry(Entry entry)
{
latestMessage = null;
bool res = false;
isAwaitingResponse = true;
Modbus.ReadRegAsync(modbusID, (FunctionCode)entry.registerType, entry.address, entry.length);
isPolling = true;
Modbus.ReadRegAsync(modbusID, (FunctionCode)entry.registerType, entry.address, entry.length);
stopwatch.Restart();
while (isAwaitingResponse)
while (isAwaitingResponse && latestMessage == null)
{
if (stopwatch.ElapsedMilliseconds > 1000)
if (stopwatch.ElapsedMilliseconds > 5000)
{
Console.WriteLine("Response timed out.");
break;
@@ -265,6 +284,34 @@ namespace Gidrolock_Modbus_Scanner
res = true;
Console.WriteLine("Poll attempt finished");
isPolling = false;
return res;
}
bool SetEntry(Entry entry, ushort value)
{
latestMessage = null;
bool res = false;
isAwaitingResponse = true;
isPolling = true;
FunctionCode fc = FunctionCode.WriteCoil;
if (entry.registerType == RegisterType.Holding)
fc = FunctionCode.WriteRegister;
Modbus.WriteSingleAsync(fc, modbusID, entry.address, value);
stopwatch.Restart();
while (isAwaitingResponse && latestMessage == null)
{
if (stopwatch.ElapsedMilliseconds > port.ReadTimeout)
{
Console.WriteLine("Response timed out.");
break;
}
}
if (latestMessage != null && latestMessage.Status == ModbusStatus.WriteSuccess)
res = true;
isPolling = false;
return res;
}
@@ -273,12 +320,13 @@ namespace Gidrolock_Modbus_Scanner
{
byte newID = (byte)nudModbusID.Value; // should prevent assigning wrong ID if UpDown is fiddled with in the middle of request
isAwaitingResponse = true;
latestMessage = null;
Modbus.WriteSingleAsync(FunctionCode.WriteRegister, modbusID, 128, newID);
stopwatch.Restart();
while (isAwaitingResponse)
{
if (stopwatch.ElapsedMilliseconds > 1000)
if (stopwatch.ElapsedMilliseconds > 10000)
{
Console.WriteLine("Response timed out.");
break;
@@ -292,46 +340,30 @@ namespace Gidrolock_Modbus_Scanner
// Кран
private async void buttonValve_Click(object sender, EventArgs e)
{
ushort value = isValveClosed ? (ushort)0 : (ushort)0xFF00;
isAwaitingResponse = true;
Modbus.WriteSingleAsync(FunctionCode.WriteCoil, modbusID, device.valveStatus.address, value);
stopwatch.Restart();
while (isAwaitingResponse)
try
{
if (stopwatch.ElapsedMilliseconds > 1000)
await Task.Run(() =>
{
Console.WriteLine("Response timed out.");
break;
}
ushort value = isValveClosed ? (ushort)0 : (ushort)0xFF00;
if (SetEntry(device.valveStatus, value))
{
isValveClosed = !isValveClosed;
labelValve.Invoke(new MethodInvoker(delegate { labelValve.Text = isValveClosed ? "Закрыт" : "Открыт"; }));
buttonValve.Invoke(new MethodInvoker(delegate { buttonValve.Text = isValveClosed ? "Открыть" : "Закрыть"; }));
}
});
}
if (latestMessage != null && latestMessage.Status != ModbusStatus.Error)
catch (Exception err)
{
isValveClosed = !isValveClosed;
labelValve.Text = isValveClosed ? "Закрыт" : "Открыт";
buttonValve.Text = isValveClosed ? "Открыть" : "Закрыть";
MessageBox.Show(err.Message, "Valve Set Error");
}
}
// Авария
private async void buttonAlarm_Click(object sender, EventArgs e)
private void buttonAlarm_Click(object sender, EventArgs e)
{
ushort value = alarmStatus ? (ushort)0 : (ushort)0xFF00;
isAwaitingResponse = true;
Modbus.WriteSingleAsync(FunctionCode.WriteCoil, modbusID, device.alarmStatus.address, value);
stopwatch.Restart();
while (isAwaitingResponse)
{
if (stopwatch.ElapsedMilliseconds > 1000)
{
Console.WriteLine("Response timed out.");
break;
}
}
if (latestMessage != null && latestMessage.Status != ModbusStatus.Error)
if (SetEntry(device.alarmStatus, value))
{
alarmStatus = !alarmStatus;
labelAlarm.Text = alarmStatus ? "Протечка!" : "Нет";
@@ -340,23 +372,10 @@ namespace Gidrolock_Modbus_Scanner
}
// Режим уборки
private async void buttonCleaning_Click(object sender, EventArgs e)
private void buttonCleaning_Click(object sender, EventArgs e)
{
ushort value = cleaningStatus ? (ushort)0 : (ushort)0xFF00;
isAwaitingResponse = true;
Modbus.WriteSingleAsync(FunctionCode.WriteCoil, modbusID, device.cleaningMode.address, value);
stopwatch.Restart();
while (isAwaitingResponse)
{
if (stopwatch.ElapsedMilliseconds > 1000)
{
Console.WriteLine("Response timed out.");
break;
}
}
if (latestMessage != null && latestMessage.Status != ModbusStatus.Error)
if (SetEntry(device.cleaningMode, value))
{
cleaningStatus = !cleaningStatus;
labelCleaning.Text = cleaningStatus ? "вкл" : "выкл";
@@ -365,35 +384,19 @@ namespace Gidrolock_Modbus_Scanner
}
// Задать скорость передачи данных для устройства
private async void buttonSetSpeed_Click(object sender, EventArgs e)
private void buttonSetSpeed_Click(object sender, EventArgs e)
{
try
{
string str = cBoxSpeed.Items[cBoxSpeed.SelectedIndex].ToString();
str = str.Substring(0, str.Length - 2); //clip off two zeroes at the end
ushort newSpeed = (ushort)Int16.Parse(str);
//Console.WriteLine("Baudrate: " + newSpeed);
// send speed value to device
// await for response
isAwaitingResponse = true;
Modbus.WriteSingleAsync(FunctionCode.WriteRegister, modbusID, device.baudRate.address, newSpeed);
stopwatch.Restart();
while (isAwaitingResponse)
Console.WriteLine("new speed: " + newSpeed);
if (SetEntry(device.baudRate, newSpeed))
{
if (stopwatch.ElapsedMilliseconds > 1000)
{
Console.WriteLine("Response timed out.");
break;
}
}
if (latestMessage != null && latestMessage.Status != ModbusStatus.Error)
{
port.Close();
port.BaudRate = newSpeed;
port.Open();
//port.Close();
port.BaudRate = newSpeed * 100;
//port.Open();
}
}
catch (Exception ex) { MessageBox.Show(ex.Message); }
@@ -496,13 +499,14 @@ namespace Gidrolock_Modbus_Scanner
return;
}
isAwaitingResponse = true;
latestMessage = null;
Console.WriteLine("Outgoing firmware message: " + Modbus.ByteArrayToString(message.ToArray()));
port.Write(message.ToArray(), 0, message.Count);
stopwatch.Restart();
while (isAwaitingResponse)
{
if (stopwatch.ElapsedMilliseconds > 1000)
if (stopwatch.ElapsedMilliseconds > port.ReadTimeout)
{
Console.WriteLine("Response timed out.");
cntr++;

25
Main.cs
View File

@@ -129,11 +129,12 @@ namespace Gidrolock_Modbus_Scanner
if (stopwatch.ElapsedMilliseconds > 1000)
{
AddLog("Истекло время ожидания ответа от устройства. Повторный запрос...");
isAwaitingResponse = false;
stopwatch.Restart();
counter++;
if (counter > 3)
{
AddLog("Устройство не отвечает. Проверьте соединение с устройством.");
isAwaitingResponse = false;
return;
}
}
@@ -316,7 +317,11 @@ namespace Gidrolock_Modbus_Scanner
d.wiredSensors = 2;
d.hasScenarioSensor = true;
d.sensorAlarm = new Entry(RegisterType.Discrete, 1343, 24);
d.wiredLineBreak = new List<Entry>()
{
new Entry(RegisterType.Discrete, 1205),
new Entry(RegisterType.Discrete, 1207)
};
d.radioStatus = new Entry(RegisterType.Input, 1215, 21);
break;
@@ -338,7 +343,11 @@ namespace Gidrolock_Modbus_Scanner
d.wiredSensors = 2;
d.hasScenarioSensor = false;
d.sensorAlarm = new Entry(RegisterType.Discrete, 1343, 23);
d.wiredLineBreak = new List<Entry>()
{
new Entry(RegisterType.Discrete, 1205),
new Entry(RegisterType.Discrete, 1207)
};
d.radioStatus = new Entry(RegisterType.Input, 1215, 21);
break;
@@ -367,6 +376,16 @@ namespace Gidrolock_Modbus_Scanner
d.wiredSensors = 7;
d.hasScenarioSensor = true;
d.sensorAlarm = new Entry(RegisterType.Discrete, 1343, 29);
d.wiredLineBreak = new List<Entry>()
{
new Entry(RegisterType.Discrete, 1025),
new Entry(RegisterType.Discrete, 1026),
new Entry(RegisterType.Discrete, 1027),
new Entry(RegisterType.Discrete, 1028),
new Entry(RegisterType.Discrete, 1029),
new Entry(RegisterType.Discrete, 1030),
new Entry(RegisterType.Discrete, 1031),
};
d.radioStatus = new Entry(RegisterType.Input, 1215, 21);
break;
case DeviceType.Premium:

119
Modbus.cs
View File

@@ -14,7 +14,7 @@ namespace Gidrolock_Modbus_Scanner
public static class Modbus
{
public static SerialPort port = new SerialPort();
public static event EventHandler<ModbusResponseEventArgs> ResponseReceived = delegate { };
public static void Init()
@@ -257,84 +257,84 @@ namespace Gidrolock_Modbus_Scanner
return false;
}
#endregion
/*
static byte[] buffer = new byte[255];
static int offset = 0;
static Thread timer = new Thread(new ThreadStart(() =>
{
Thread.Sleep(50);
offset = 0;
buffer = new byte[255];
port.DiscardInBuffer();
}));
*/
static Stopwatch stopwatch = new Stopwatch();
static byte[] buffer = new byte[255];
static int offset = 0;
static int count = 0;
static ModbusStatus responseStatus;
static bool bytecountFound = false;
static int expectedBytes = 0;
static void PortDataReceived(object sender, EventArgs e)
{
//reset values on every event call;
buffer = new byte[255];
offset = 0;
bytecountFound = false;
expectedBytes = 0;
try
{
stopwatch.Restart();
while (stopwatch.ElapsedMilliseconds < 20)
while (stopwatch.ElapsedMilliseconds < port.ReadTimeout)
{
if (bytecountFound && offset >= expectedBytes)
break;
if (port.BytesToRead > 0)
{
stopwatch.Restart();
count = port.BytesToRead;
port.Read(buffer, offset, port.BytesToRead);
port.Read(buffer, offset, count);
offset += count;
if (offset >= 1)
{
if (buffer[1] < 0x05)
responseStatus = ModbusStatus.ReadSuccess;
else if (buffer[1] < 0x10)
{
responseStatus = ModbusStatus.WriteSuccess;
expectedBytes = 8;
bytecountFound = true;
}
else
{
responseStatus = ModbusStatus.Error;
expectedBytes = 5;
bytecountFound = true;
}
}
if (responseStatus == ModbusStatus.ReadSuccess && !bytecountFound && offset >= 2)
{
expectedBytes = buffer[2] + 5;
Console.WriteLine("Found data byte count: " + expectedBytes);
bytecountFound = true;
}
if (bytecountFound && offset >= expectedBytes) // reached end of message
{
Console.WriteLine("Reached end of message");
break;
}
stopwatch.Restart();
}
}
// Console.WriteLine("Buffer: " + ByteArrayToString(buffer, false));
// assume that the message ended
offset = 0;
List <byte> message = new List <byte>();
int endOfMessage = buffer.Length - 1;
for (int i = buffer.Length-1; i >= 0; i--)
{
if (buffer[i] != 0x00)
{
endOfMessage = i;
break;
}
}
for (int i = 0; i < endOfMessage + 1; i++)
{
message.Add(buffer[i]);
}
if (message.Count == 0)
return;
Console.WriteLine("Incoming message: " + ByteArrayToString(message.ToArray(), false));
/*
if (!CheckResponse(message.ToArray()))
{
Console.WriteLine("Message reception ended");
byte[] message = new byte[expectedBytes];
for (int i = 0; i < expectedBytes; i++)
message[i] = buffer[i];
Console.WriteLine("Incoming message: " + ByteArrayToString(message, false));
if (!CheckResponse(message))
Console.WriteLine("Bad CRC or not a modbus message!");
}
*/
if (message[1] <= 0x04) // read functions
{
//Console.WriteLine("It's a read message");
ResponseReceived.Invoke(null, new ModbusResponseEventArgs(message.ToArray(), ModbusStatus.ReadSuccess));
}
else
{
if (message[1] <= 0x10) // write functions
{
//Console.WriteLine("It's a write message");
ResponseReceived.Invoke(null, new ModbusResponseEventArgs(message.ToArray(), ModbusStatus.WriteSuccess));
}
else // error codes
{
//Console.WriteLine("It's an error");
ResponseReceived.Invoke(null, new ModbusResponseEventArgs(message.ToArray(), ModbusStatus.Error));
}
}
ResponseReceived.Invoke(null, new ModbusResponseEventArgs(message, responseStatus));
}
catch (Exception err)
{
@@ -345,7 +345,6 @@ namespace Gidrolock_Modbus_Scanner
}
}
public class ModbusResponseEventArgs : EventArgs
{
public byte[] Message { get; set; }
@@ -365,7 +364,7 @@ namespace Gidrolock_Modbus_Scanner
}
//Console.WriteLine("Read data: " + Modbus.ByteArrayToString(Data, false));
}
else Data = new byte[1] {0x0F};
else Data = new byte[1] { 0x0F };
}
}

View File

@@ -26,7 +26,7 @@ namespace Gidrolock_Modbus_Scanner
public Entry sensorAlarm;
public List<Entry> wiredLineBreak;
public Entry radioStatus;
}

View File

@@ -30,6 +30,6 @@ using System.Runtime.InteropServices;
// Build Number
// Revision
//
[assembly: AssemblyVersion("0.9.3.0")]
[assembly: AssemblyFileVersion("0.9.3.0")]
[assembly: AssemblyVersion("0.9.5.0")]
[assembly: AssemblyFileVersion("0.9.5.0")]
[assembly: NeutralResourcesLanguage("en")]