Innovenergy_trunk/csharp/Lib/Protocols/Modbus/Clients/ModbusTcpClient.cs

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;
using InnovEnergy.Lib.Utils;


namespace InnovEnergy.Lib.Protocols.Modbus.Clients;

using UInt16s = IReadOnlyList<UInt16>;


public class ModbusTcpClient : ModbusClient
{
    public const UInt16 DefaultPort = 502;
    private UInt16 _Id;
    
    [DebuggerStepThrough]
    private UInt16 NextId() => unchecked(++_Id);


    public ModbusTcpClient(ModbusConnection connection, Byte slaveId) : base(connection, slaveId)
    {
    }

    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;
    }


    public override IReadOnlyList<Boolean> ReadDiscreteInputs(UInt16 readAddress, UInt16 nValues)
    {
        var id  = NextId(); // TODO: check response id
        
        var cmd = new ReadDiscreteInputsCommandFrame(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 = ReadDiscreteInputsResponseFrame.Parse(fData);

        return cmd.VerifyResponse(rxFrm).Inputs;
    }

    public override IReadOnlyList<UInt16> ReadInputRegisters(UInt16 readAddress, UInt16 nValues)
    {
        var id  = NextId(); // TODO: check response id

        var cmd = new ReadInputRegistersCommandFrame(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();
        var rxHdr = new MbapHeader(hData);

        var fData = Connection.Receive(rxHdr.FrameLength).ToArray();
        var rxFrm = ReadInputRegistersResponseFrame.Parse(fData);

        var verified = cmd.VerifyResponse(rxFrm);

        return verified.RegistersRead;
    }


    public override IReadOnlyList<UInt16> ReadHoldingRegisters(UInt16 readAddress, UInt16 nValues)
    {
        var id  = NextId(); // TODO: check response id
        var cmd = new ReadHoldingRegistersCommandFrame(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(MbapHeader.Size);
        var rxHdr = new MbapHeader(hData);

        var fData = Connection.Receive(rxHdr.FrameLength).ToArray(rxHdr.FrameLength);
        var rxFrm = ReadHoldingRegistersResponseFrame.Parse(fData);

        var verified = cmd.VerifyResponse(rxFrm);

        return verified.RegistersRead; // TODO
    }

    public override UInt16 WriteCoils(UInt16 writeAddress, IReadOnlyList<Boolean> coils)
    {
        var id  = NextId(); // TODO: check response id
        var cmd = new WriteCoilsCommandFrame(SlaveId, writeAddress, coils);
        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;
    }


    public override UInt16 WriteRegisters(UInt16 writeAddress, UInt16s values)
    {
        var id  = NextId(); // TODO: check response id
        var cmd = new WriteRegistersCommandFrame(SlaveId, writeAddress, values);
        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;
    }

    public override IReadOnlyList<UInt16> ReadWriteRegisters(UInt16 readAddress, UInt16 nbToRead, UInt16 writeAddress, UInt16s registersToWrite)
    {
        var id  = NextId(); // TODO: check response id
        
        var cmd = new ReadWriteRegistersCommandFrame(SlaveId, 
                                                     readAddress, 
                                                     nbToRead, 
                                                     writeAddress, 
                                                     registersToWrite);
        
        var hdr = new MbapHeader(id, cmd.Data.Count);
        var frm = new ModbusTcpFrame(hdr, cmd);

        Connection.Transmit(frm.Data);

        var hData = Enumerable.ToArray(Connection.Receive(MbapHeader.Size));
        var rxHdr = new MbapHeader(hData);

        var fData = Enumerable.ToArray(Connection.Receive(rxHdr.FrameLength));
        var rxFrm = ReadWriteRegistersResponseFrame.Parse(fData);

        var verified = cmd.VerifyResponse(rxFrm);

        return verified.RegistersRead; // TODO
    }

}