ModbusMasterTcpConnection.cs 5.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128
  1. using System;
  2. using System.Diagnostics;
  3. using System.IO;
  4. using System.Linq;
  5. using System.Net;
  6. using System.Net.Sockets;
  7. using System.Threading.Tasks;
  8. using NModbus.IO;
  9. using NModbus.Message;
  10. using NModbus.Logging;
  11. namespace NModbus.Device
  12. {
  13. using Extensions;
  14. /// <summary>
  15. /// Represents an incoming connection from a Modbus master. Contains the slave's logic to process the connection.
  16. /// </summary>
  17. internal class ModbusMasterTcpConnection : ModbusDevice, IDisposable
  18. {
  19. private readonly TcpClient _client;
  20. private readonly string _endPoint;
  21. private readonly Stream _stream;
  22. private readonly IModbusSlaveNetwork _slaveNetwork;
  23. private readonly IModbusFactory _modbusFactory;
  24. private readonly Task _requestHandlerTask;
  25. private readonly byte[] _mbapHeader = new byte[6];
  26. private byte[] _messageFrame;
  27. public ModbusMasterTcpConnection(TcpClient client, IModbusSlaveNetwork slaveNetwork, IModbusFactory modbusFactory, IModbusLogger logger)
  28. : base(new ModbusIpTransport(new TcpClientAdapter(client), modbusFactory, logger))
  29. {
  30. Logger = logger ?? throw new ArgumentNullException(nameof(logger));
  31. _client = client ?? throw new ArgumentNullException(nameof(client));
  32. _endPoint = client.Client.RemoteEndPoint.ToString();
  33. _stream = client.GetStream();
  34. _slaveNetwork = slaveNetwork ?? throw new ArgumentNullException(nameof(slaveNetwork));
  35. _modbusFactory = modbusFactory ?? throw new ArgumentNullException(nameof(modbusFactory));
  36. _requestHandlerTask = Task.Run((Func<Task>)HandleRequestAsync);
  37. }
  38. /// <summary>
  39. /// Occurs when a Modbus master TCP connection is closed.
  40. /// </summary>
  41. public event EventHandler<TcpConnectionEventArgs> ModbusMasterTcpConnectionClosed;
  42. public IModbusLogger Logger { get; }
  43. public string EndPoint => _endPoint;
  44. public Stream Stream => _stream;
  45. public TcpClient TcpClient => _client;
  46. protected override void Dispose(bool disposing)
  47. {
  48. if (disposing)
  49. {
  50. _stream.Dispose();
  51. }
  52. base.Dispose(disposing);
  53. }
  54. private async Task HandleRequestAsync()
  55. {
  56. try
  57. {
  58. while (true)
  59. {
  60. Logger.Debug($"Begin reading header from Master at IP: {EndPoint}");
  61. int readBytes = await Stream.ReadAsync(_mbapHeader, 0, 6).ConfigureAwait(false);
  62. if (readBytes == 0)
  63. {
  64. Logger.Debug($"0 bytes read, Master at {EndPoint} has closed Socket connection.");
  65. ModbusMasterTcpConnectionClosed?.Invoke(this, new TcpConnectionEventArgs(EndPoint));
  66. return;
  67. }
  68. ushort frameLength = (ushort)IPAddress.HostToNetworkOrder(BitConverter.ToInt16(_mbapHeader, 4));
  69. Logger.Debug($"Master at {EndPoint} sent header: \"{string.Join(", ", _mbapHeader)}\" with {frameLength} bytes in PDU");
  70. _messageFrame = new byte[frameLength];
  71. readBytes = await Stream.ReadAsync(_messageFrame, 0, frameLength).ConfigureAwait(false);
  72. if (readBytes == 0)
  73. {
  74. Logger.Debug($"0 bytes read, Master at {EndPoint} has closed Socket connection.");
  75. ModbusMasterTcpConnectionClosed?.Invoke(this, new TcpConnectionEventArgs(EndPoint));
  76. return;
  77. }
  78. Logger.Debug($"Read frame from Master at {EndPoint} completed {readBytes} bytes");
  79. byte[] frame = _mbapHeader.Concat(_messageFrame).ToArray();
  80. Logger.Trace($"RX from Master at {EndPoint}: {string.Join(", ", frame)}");
  81. var request = _modbusFactory.CreateModbusRequest(_messageFrame);
  82. request.TransactionId = (ushort)IPAddress.NetworkToHostOrder(BitConverter.ToInt16(frame, 0));
  83. IModbusSlave slave = _slaveNetwork.GetSlave(request.SlaveAddress);
  84. if (slave != null)
  85. {
  86. //TODO: Determine if this is appropriate
  87. // perform action and build response
  88. IModbusMessage response = slave.ApplyRequest(request);
  89. response.TransactionId = request.TransactionId;
  90. // write response
  91. byte[] responseFrame = Transport.BuildMessageFrame(response);
  92. Logger.Information($"TX to Master at {EndPoint}: {string.Join(", ", responseFrame)}");
  93. await Stream.WriteAsync(responseFrame, 0, responseFrame.Length).ConfigureAwait(false);
  94. }
  95. }
  96. }
  97. // If an exception occurs (such as IOException in case of disconnect, or other failures), handle it as if the connection was gracefully closed
  98. catch(Exception e)
  99. {
  100. Logger.Warning($"{e.GetType().Name} occured with Master at {EndPoint}. Closing connection.");
  101. ModbusMasterTcpConnectionClosed?.Invoke(this, new TcpConnectionEventArgs(EndPoint));
  102. return;
  103. }
  104. }
  105. }
  106. }