internal abstract ModbusResponse DeserializeWriteResponse(ResponseBuffer buffer, ModbusWriteHoldingRegisterRequest request, int timeout);
internal override ModbusResponse DeserializeWriteResponse(ResponseBuffer buffer, ModbusWriteHoldingRegisterRequest request, int timeout) { if (IsException(buffer, request, timeout, out var responseMessage)) { return(responseMessage); } if (IsErrorCRC(buffer, 6, request, timeout)) { throw new ModbusCommException(ModbusCommErrorCode.ErrorCRC, buffer, request); } if (Read(buffer, 0, timeout) != request.SlaveAddress) { throw new ModbusCommException(ModbusCommErrorCode.ResponseSlaveAddressDoNotMatch, buffer, request); } if ((Read(buffer, 1, timeout) & 0x7f) != (byte)request.Function) { throw new ModbusCommException(ModbusCommErrorCode.ResponseFunctionDoNotMatch, buffer, request); } if (ToUInt16(buffer, 2) != request.Address) { throw new ModbusCommException(ModbusCommErrorCode.ResponseAddressDoNotMatch, buffer, request); } ushort value = ToUInt16(buffer, 4); switch (request.Function) { case ModbusFunction.WriteSingleHoldingRegister: if (value != request.SingleRegisterValue) { throw new ModbusCommException(ModbusCommErrorCode.ResponseWritedValueDoNotMatch, buffer, request); } break; case ModbusFunction.WriteMultipleHoldingRegisters: if (value != request.Length) { throw new ModbusCommException(ModbusCommErrorCode.ResponseWritedLengthDoNotMatch, buffer, request); } break; } return(new ModbusWriteResponse(request)); }
internal override ModbusRequest DeserializeRequest(RequestBuffer buffer) { ModbusRequest result = null; while (!buffer.Channel.IsDisposed) { if (errorBuffer.Count >= 256) { RaiseUnrecognized(buffer.Channel, errorBuffer.ToArray()); errorBuffer.Clear(); } while (buffer.Count < 8 && !buffer.Channel.IsDisposed) { buffer.Read(); } if (buffer.Channel.IsDisposed) { break; } var slaveAddress = buffer[0]; int messageLength = 0; if (buffer.ModbusSlave.IsValidSlaveAddress(slaveAddress, buffer.Channel) && Enum.IsDefined(typeof(ModbusFunction), buffer[1])) { ModbusFunction function = (ModbusFunction)buffer[1]; var address = ToUInt16(buffer, 2); var valueOrLength = ToUInt16(buffer, 4); switch (function) { case ModbusFunction.ReadCoils: case ModbusFunction.ReadDiscreteInputs: case ModbusFunction.ReadHoldingRegisters: case ModbusFunction.ReadInputRegisters: case ModbusFunction.WriteSingleCoil: case ModbusFunction.WriteSingleHoldingRegister: if (CalculateCrc(buffer.Take(6)).SequenceEqual(buffer.Skip(6).Take(2))) { messageLength = 8; switch (function) { case ModbusFunction.ReadCoils: case ModbusFunction.ReadDiscreteInputs: case ModbusFunction.ReadHoldingRegisters: case ModbusFunction.ReadInputRegisters: result = new ModbusReadRequest(slaveAddress, (ModbusObjectType)(byte)function, address, valueOrLength); break; case ModbusFunction.WriteSingleCoil: if (valueOrLength != 0xff00 && valueOrLength != 0) { result = new ModbusWriteCoilRequest(slaveAddress, address); } else { result = new ModbusWriteCoilRequest(slaveAddress, address, valueOrLength == 0xff00); } break; case ModbusFunction.WriteSingleHoldingRegister: result = new ModbusWriteHoldingRegisterRequest(slaveAddress, address, valueOrLength); break; } } break; case ModbusFunction.WriteMultipleCoils: case ModbusFunction.WriteMultipleHoldingRegisters: if (buffer.Count < 7 && !buffer.Channel.IsDisposed) { buffer.Read(); } if (buffer.Channel.IsDisposed) { break; } var byteLength = buffer[6]; messageLength = byteLength + 9; if (function == ModbusFunction.WriteMultipleCoils && byteLength == Math.Ceiling(valueOrLength / 8d) || function == ModbusFunction.WriteMultipleHoldingRegisters && byteLength == valueOrLength * 2) { while (buffer.Count < messageLength && !buffer.Channel.IsDisposed) { buffer.Read(); } if (buffer.Channel.IsDisposed) { break; } if (CalculateCrc(buffer.Take(byteLength + 7)).SequenceEqual(buffer.Skip(byteLength + 7).Take(2))) { switch (function) { case ModbusFunction.WriteMultipleCoils: result = new ModbusWriteCoilRequest(slaveAddress, address, buffer.Skip(7).Take(byteLength).SelectMany(b => ByteToBooleanArray(b)).Take(valueOrLength).ToArray()); break; case ModbusFunction.WriteMultipleHoldingRegisters: result = new ModbusWriteHoldingRegisterRequest(slaveAddress, address, buffer.Skip(7).Take(byteLength).ToArray()); break; } } } break; } } if (result != null) { if (errorBuffer.Count > 0) { RaiseUnrecognized(buffer.Channel, errorBuffer.ToArray()); errorBuffer.Clear(); } return(result); } else { errorBuffer.Add(buffer[0]); buffer.RemoveAt(0); continue; } } return(null); }
internal override ModbusRequest DeserializeRequest(RequestBuffer rawBuffer) { ModbusRequest result = null; while (!rawBuffer.Channel.IsDisposed) { if (errorBuffer.Count >= 256) { RaiseUnrecognized(rawBuffer.Channel, errorBuffer.ToArray()); errorBuffer.Clear(); } while (rawBuffer.Count < 17 && !rawBuffer.Channel.IsDisposed) { rawBuffer.Read(); } if (rawBuffer.Channel.IsDisposed) { break; } int messageLength = 0; if (rawBuffer[0] == 0x3a) { List <byte> buffer = new List <byte>(); for (int i = 0; i < 7; i++) { if (TryParseFromHex(rawBuffer, i * 2 + 1, out var byteValue)) { buffer.Add(byteValue); } else { break; } } if (buffer.Count < 7) { errorBuffer.AddRange(rawBuffer.Take((buffer.Count + 1) * 2 + 1)); rawBuffer.RemoveRange(0, (buffer.Count + 1) * 2 + 1); continue; } var slaveAddress = buffer[0]; if (rawBuffer.ModbusSlave.IsValidSlaveAddress(slaveAddress, rawBuffer.Channel) && Enum.IsDefined(typeof(ModbusFunction), buffer[1])) { ModbusFunction function = (ModbusFunction)buffer[1]; var address = ToUInt16(buffer, 2); var valueOrLength = ToUInt16(buffer, 4); switch (function) { case ModbusFunction.ReadCoils: case ModbusFunction.ReadDiscreteInputs: case ModbusFunction.ReadHoldingRegisters: case ModbusFunction.ReadInputRegisters: case ModbusFunction.WriteSingleCoil: case ModbusFunction.WriteSingleHoldingRegister: if ((-buffer.Take(6).Sum(b => b) & 0xff) == buffer[6] && rawBuffer[15] == '\r' && rawBuffer[16] == '\n') { messageLength = 17; switch (function) { case ModbusFunction.ReadCoils: case ModbusFunction.ReadDiscreteInputs: case ModbusFunction.ReadHoldingRegisters: case ModbusFunction.ReadInputRegisters: result = new ModbusReadRequest(slaveAddress, (ModbusObjectType)(byte)function, address, valueOrLength); break; case ModbusFunction.WriteSingleCoil: if (valueOrLength != 0xff00 && valueOrLength != 0) { result = new ModbusWriteCoilRequest(slaveAddress, address); } else { result = new ModbusWriteCoilRequest(slaveAddress, address, valueOrLength == 0xff00); } break; case ModbusFunction.WriteSingleHoldingRegister: result = new ModbusWriteHoldingRegisterRequest(slaveAddress, address, valueOrLength); break; } } break; case ModbusFunction.WriteMultipleCoils: case ModbusFunction.WriteMultipleHoldingRegisters: var byteLength = buffer[6]; messageLength = byteLength * 2 + 19; if (function == ModbusFunction.WriteMultipleCoils && byteLength == Math.Ceiling(valueOrLength / 8d) || function == ModbusFunction.WriteMultipleHoldingRegisters && byteLength == valueOrLength * 2) { while (rawBuffer.Count < messageLength && !rawBuffer.Channel.IsDisposed) { rawBuffer.Read(); } if (rawBuffer.Channel.IsDisposed) { break; } for (int i = 0; i < byteLength + 1; i++) { if (TryParseFromHex(rawBuffer, i * 2 + 15, out var byteValue)) { buffer.Add(byteValue); } else { break; } } if (buffer.Count < 8 + byteLength) { errorBuffer.AddRange(rawBuffer.Take((buffer.Count + 1) * 2 + 1)); rawBuffer.RemoveRange(0, (buffer.Count + 1) * 2 + 1); continue; } if ((-buffer.Take(7 + byteLength).Sum(b => b) & 0xff) == buffer[6] && rawBuffer[15] == '\r' && rawBuffer[16] == '\n') { switch (function) { case ModbusFunction.WriteMultipleCoils: result = new ModbusWriteCoilRequest(slaveAddress, address, buffer.Skip(7).Take(byteLength).SelectMany(b => ByteToBooleanArray(b)).Take(valueOrLength).ToArray()); break; case ModbusFunction.WriteMultipleHoldingRegisters: result = new ModbusWriteHoldingRegisterRequest(slaveAddress, address, buffer.Skip(7).Take(byteLength).ToArray()); break; } } } break; } } } if (result != null) { if (errorBuffer.Count > 0) { RaiseUnrecognized(rawBuffer.Channel, errorBuffer.ToArray()); errorBuffer.Clear(); } return(result); } else { errorBuffer.Add(rawBuffer[0]); rawBuffer.RemoveAt(0); continue; } } return(null); }