2023-02-16 12:57:06 +00:00
|
|
|
using System.Diagnostics;
|
|
|
|
using InnovEnergy.Lib.Protocols.Modbus.Connections;
|
|
|
|
using InnovEnergy.Lib.Protocols.Modbus.Protocol.Frames.Commands;
|
|
|
|
using InnovEnergy.Lib.Protocols.Modbus.Protocol.Frames.Replies;
|
|
|
|
using InnovEnergy.Lib.Protocols.Modbus.Tcp;
|
2023-04-20 13:03:13 +00:00
|
|
|
using InnovEnergy.Lib.Utils;
|
2023-04-04 12:51:06 +00:00
|
|
|
|
2023-02-16 12:57:06 +00:00
|
|
|
|
|
|
|
namespace InnovEnergy.Lib.Protocols.Modbus.Clients;
|
|
|
|
|
|
|
|
using UInt16s = IReadOnlyList<UInt16>;
|
2023-04-20 13:03:13 +00:00
|
|
|
|
2023-02-16 12:57:06 +00:00
|
|
|
|
|
|
|
public class ModbusTcpClient : ModbusClient
|
|
|
|
{
|
|
|
|
public const UInt16 DefaultPort = 502;
|
|
|
|
private UInt16 _Id;
|
|
|
|
|
|
|
|
[DebuggerStepThrough]
|
|
|
|
private UInt16 NextId() => unchecked(++_Id);
|
|
|
|
|
|
|
|
|
2023-04-04 12:51:06 +00:00
|
|
|
public ModbusTcpClient(ModbusConnection connection, Byte slaveId) : base(connection, slaveId)
|
2023-02-16 12:57:06 +00:00
|
|
|
{
|
|
|
|
}
|
|
|
|
|
2023-04-20 13:03:13 +00:00
|
|
|
public override IReadOnlyList<Boolean> ReadCoils(UInt16 readAddress, UInt16 nValues)
|
|
|
|
{
|
|
|
|
var id = NextId(); // TODO: check response id
|
|
|
|
|
|
|
|
var cmd = new ReadCoilsCommandFrame(SlaveId, readAddress, nValues);
|
|
|
|
var hdr = new MbapHeader(id, cmd.Data.Count);
|
|
|
|
var frm = new ModbusTcpFrame(hdr, cmd);
|
|
|
|
|
|
|
|
Connection.Transmit(frm.Data);
|
|
|
|
|
|
|
|
var hData = Connection.Receive(MbapHeader.Size).ToArray(); // TODO: optimize .ToArray() ?
|
|
|
|
var rxHdr = new MbapHeader(hData);
|
|
|
|
|
|
|
|
var fData = Connection.Receive(rxHdr.FrameLength).ToArray(); // TODO: optimize .ToArray() ?
|
|
|
|
var rxFrm = ReadCoilsResponseFrame.Parse(fData);
|
|
|
|
|
|
|
|
return cmd.VerifyResponse(rxFrm).Inputs;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
2023-02-16 12:57:06 +00:00
|
|
|
public override IReadOnlyList<Boolean> ReadDiscreteInputs(UInt16 readAddress, UInt16 nValues)
|
|
|
|
{
|
|
|
|
var id = NextId(); // TODO: check response id
|
|
|
|
|
2023-04-04 12:51:06 +00:00
|
|
|
var cmd = new ReadDiscreteInputsCommandFrame(SlaveId, readAddress, nValues);
|
2023-02-16 12:57:06 +00:00
|
|
|
var hdr = new MbapHeader(id, cmd.Data.Count);
|
|
|
|
var frm = new ModbusTcpFrame(hdr, cmd);
|
|
|
|
|
|
|
|
Connection.Transmit(frm.Data);
|
|
|
|
|
|
|
|
var hData = Connection.Receive(MbapHeader.Size).ToArray(); // TODO: optimize .ToArray() ?
|
|
|
|
var rxHdr = new MbapHeader(hData);
|
|
|
|
|
|
|
|
var fData = Connection.Receive(rxHdr.FrameLength).ToArray(); // TODO: optimize .ToArray() ?
|
2023-04-20 13:03:13 +00:00
|
|
|
var rxFrm = ReadDiscreteInputsResponseFrame.Parse(fData);
|
2023-02-16 12:57:06 +00:00
|
|
|
|
|
|
|
return cmd.VerifyResponse(rxFrm).Inputs;
|
|
|
|
}
|
|
|
|
|
2023-04-20 13:03:13 +00:00
|
|
|
public override IReadOnlyList<UInt16> ReadInputRegisters(UInt16 readAddress, UInt16 nValues)
|
2023-02-16 12:57:06 +00:00
|
|
|
{
|
|
|
|
var id = NextId(); // TODO: check response id
|
2023-03-10 12:57:39 +00:00
|
|
|
|
2023-04-04 12:51:06 +00:00
|
|
|
var cmd = new ReadInputRegistersCommandFrame(SlaveId, readAddress, nValues);
|
2023-02-16 12:57:06 +00:00
|
|
|
var hdr = new MbapHeader(id, cmd.Data.Count);
|
|
|
|
var frm = new ModbusTcpFrame(hdr, cmd);
|
|
|
|
|
|
|
|
Connection.Transmit(frm.Data);
|
|
|
|
|
|
|
|
var hData = Connection.Receive(MbapHeader.Size).ToArray();
|
|
|
|
var rxHdr = new MbapHeader(hData);
|
|
|
|
|
|
|
|
var fData = Connection.Receive(rxHdr.FrameLength).ToArray();
|
|
|
|
var rxFrm = ReadInputRegistersResponseFrame.Parse(fData);
|
|
|
|
|
|
|
|
var verified = cmd.VerifyResponse(rxFrm);
|
|
|
|
|
2023-04-20 13:03:13 +00:00
|
|
|
return verified.RegistersRead;
|
2023-02-16 12:57:06 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
|
2023-04-20 13:03:13 +00:00
|
|
|
public override IReadOnlyList<UInt16> ReadHoldingRegisters(UInt16 readAddress, UInt16 nValues)
|
2023-02-16 12:57:06 +00:00
|
|
|
{
|
|
|
|
var id = NextId(); // TODO: check response id
|
2023-04-04 12:51:06 +00:00
|
|
|
var cmd = new ReadHoldingRegistersCommandFrame(SlaveId, readAddress, nValues);
|
2023-02-16 12:57:06 +00:00
|
|
|
var hdr = new MbapHeader(id, cmd.Data.Count);
|
|
|
|
var frm = new ModbusTcpFrame(hdr, cmd);
|
|
|
|
|
|
|
|
Connection.Transmit(frm.Data);
|
|
|
|
|
2023-04-20 13:03:13 +00:00
|
|
|
var hData = Connection.Receive(MbapHeader.Size).ToArray(MbapHeader.Size);
|
2023-02-16 12:57:06 +00:00
|
|
|
var rxHdr = new MbapHeader(hData);
|
|
|
|
|
2023-04-20 13:03:13 +00:00
|
|
|
var fData = Connection.Receive(rxHdr.FrameLength).ToArray(rxHdr.FrameLength);
|
2023-02-16 12:57:06 +00:00
|
|
|
var rxFrm = ReadHoldingRegistersResponseFrame.Parse(fData);
|
|
|
|
|
|
|
|
var verified = cmd.VerifyResponse(rxFrm);
|
|
|
|
|
2023-04-20 13:03:13 +00:00
|
|
|
return verified.RegistersRead; // TODO
|
2023-02-16 12:57:06 +00:00
|
|
|
}
|
|
|
|
|
2023-04-20 13:03:13 +00:00
|
|
|
public override UInt16 WriteCoils(UInt16 writeAddress, IReadOnlyList<Boolean> coils)
|
2023-02-16 12:57:06 +00:00
|
|
|
{
|
2023-04-20 13:03:13 +00:00
|
|
|
var id = NextId(); // TODO: check response id
|
2023-04-04 12:51:06 +00:00
|
|
|
var cmd = new WriteCoilsCommandFrame(SlaveId, writeAddress, coils);
|
2023-02-16 12:57:06 +00:00
|
|
|
var hdr = new MbapHeader(id, cmd.Data.Count);
|
|
|
|
var frm = new ModbusTcpFrame(hdr, cmd);
|
|
|
|
|
|
|
|
Connection.Transmit(frm.Data);
|
|
|
|
|
|
|
|
var hData = Connection.Receive(MbapHeader.Size).ToArray();
|
|
|
|
var rxHdr = new MbapHeader(hData);
|
|
|
|
|
|
|
|
var fData = Connection.Receive(rxHdr.FrameLength).ToArray();
|
|
|
|
var rxFrm = WriteCoilsResponseFrame.Parse(fData);
|
|
|
|
|
|
|
|
return cmd.VerifyResponse(rxFrm).NbWritten;
|
|
|
|
}
|
2023-04-20 13:03:13 +00:00
|
|
|
|
|
|
|
|
2023-02-16 12:57:06 +00:00
|
|
|
public override UInt16 WriteRegisters(UInt16 writeAddress, UInt16s values)
|
|
|
|
{
|
|
|
|
var id = NextId(); // TODO: check response id
|
2023-04-04 12:51:06 +00:00
|
|
|
var cmd = new WriteRegistersCommandFrame(SlaveId, writeAddress, values);
|
2023-02-16 12:57:06 +00:00
|
|
|
var hdr = new MbapHeader(id, cmd.Data.Count);
|
|
|
|
var frm = new ModbusTcpFrame(hdr, cmd);
|
|
|
|
|
|
|
|
Connection.Transmit(frm.Data);
|
|
|
|
|
|
|
|
var hData = Connection.Receive(MbapHeader.Size).ToArray();
|
|
|
|
var rxHdr = new MbapHeader(hData);
|
|
|
|
|
|
|
|
var fData = Connection.Receive(rxHdr.FrameLength).ToArray();
|
|
|
|
var rxFrm = WriteRegistersResponseFrame.Parse(fData);
|
|
|
|
|
|
|
|
var verified = cmd.VerifyResponse(rxFrm);
|
|
|
|
|
|
|
|
return verified.NbWritten;
|
|
|
|
}
|
|
|
|
|
2023-04-20 13:03:13 +00:00
|
|
|
public override IReadOnlyList<UInt16> ReadWriteRegisters(UInt16 readAddress, UInt16 nbToRead, UInt16 writeAddress, UInt16s registersToWrite)
|
2023-02-16 12:57:06 +00:00
|
|
|
{
|
|
|
|
var id = NextId(); // TODO: check response id
|
|
|
|
|
2023-03-10 12:57:39 +00:00
|
|
|
var cmd = new ReadWriteRegistersCommandFrame(SlaveId,
|
2023-04-04 12:51:06 +00:00
|
|
|
readAddress,
|
2023-03-10 12:57:39 +00:00
|
|
|
nbToRead,
|
2023-04-04 12:51:06 +00:00
|
|
|
writeAddress,
|
2023-03-10 12:57:39 +00:00
|
|
|
registersToWrite);
|
|
|
|
|
2023-02-16 12:57:06 +00:00
|
|
|
var hdr = new MbapHeader(id, cmd.Data.Count);
|
|
|
|
var frm = new ModbusTcpFrame(hdr, cmd);
|
|
|
|
|
|
|
|
Connection.Transmit(frm.Data);
|
|
|
|
|
2023-04-20 13:03:13 +00:00
|
|
|
var hData = Enumerable.ToArray(Connection.Receive(MbapHeader.Size));
|
2023-02-16 12:57:06 +00:00
|
|
|
var rxHdr = new MbapHeader(hData);
|
|
|
|
|
2023-04-20 13:03:13 +00:00
|
|
|
var fData = Enumerable.ToArray(Connection.Receive(rxHdr.FrameLength));
|
2023-02-16 12:57:06 +00:00
|
|
|
var rxFrm = ReadWriteRegistersResponseFrame.Parse(fData);
|
|
|
|
|
|
|
|
var verified = cmd.VerifyResponse(rxFrm);
|
|
|
|
|
2023-04-20 13:03:13 +00:00
|
|
|
return verified.RegistersRead; // TODO
|
2023-02-16 12:57:06 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
}
|