Innovenergy_trunk/csharp/Lib/Protocols/Modbus/Protocol/Frames/Commands/WriteCoilsCommandFrame.cs

77 lines
2.7 KiB
C#

using InnovEnergy.Lib.Protocols.Modbus.Protocol.Frames.Accessors;
using InnovEnergy.Lib.Protocols.Modbus.Protocol.Frames.Replies;
using InnovEnergy.Lib.Utils;
using static InnovEnergy.Lib.Protocols.Modbus.Protocol.FunctionCode;
using static InnovEnergy.Lib.Protocols.Modbus.Protocol.Frames.Constants;
namespace InnovEnergy.Lib.Protocols.Modbus.Protocol.Frames.Commands;
using Booleans = IReadOnlyList<Boolean>;
using MbFc = MbByte<FunctionCode>;
public class WriteCoilsCommandFrame : ModbusFrame
{
private new const Int32 MinSize = 7;
private MbWord WriteAddress => Data.WordAt(2);
private MbWord NbOfCoils => Data.WordAt(4);
private MbByte ByteCount => Data.ByteAt(6);
public MbBits CoilsToWrite => Data.BitsAt(7);
public WriteCoilsCommandFrame(Byte slave, UInt16 writeAddress, Booleans coils) : base(MinSize + NbBytes(coils))
{
if (coils.Count > MaxCoils)
throw new ArgumentOutOfRangeException($"Maximum number of Coils to write ({MaxCoils}) exceeded!", nameof(coils));
SlaveAddress.Set(slave);
FunctionCode.Set(WriteMultipleCoils);
WriteAddress.Set(writeAddress);
NbOfCoils .Set(coils.Count);
ByteCount .Set(NbBytes(coils));
CoilsToWrite.Set(coils);
}
private WriteCoilsCommandFrame(ArraySegment<Byte> data) : base(data)
{
if (data.Count < MinSize)
throw new ArgumentOutOfRangeException($"Expecting an array of size {MinSize} or more!", nameof(data));
AssertFunctionCode(WriteMultipleCoils);
var expectedSize = ByteCount + MinSize;
if (data.Count != expectedSize)
throw new ArgumentException($"Expecting an array of size {expectedSize}", nameof(data));
if (ByteCount != CoilsToWrite.Count / 8)
throw new ArgumentException(nameof(CoilsToWrite));
}
public WriteCoilsResponseFrame VerifyResponse(WriteCoilsResponseFrame response)
{
if (response.SlaveAddress != SlaveAddress)
throw new UnexpectedResponseFieldException(nameof(response.SlaveAddress), SlaveAddress.ToString(), response.SlaveAddress);
if (response.NbWritten != NbOfCoils)
throw new UnexpectedResponseFieldException(nameof(response.NbWritten), NbOfCoils, response.NbWritten);
if (response.WriteAddress != WriteAddress)
throw new UnexpectedResponseFieldException(nameof(response.WriteAddress), WriteAddress, response.WriteAddress);
return response;
}
public static WriteCoilsCommandFrame Parse(ArraySegment<Byte> data)
{
return new WriteCoilsCommandFrame(data);
}
private static Int32 NbBytes(Booleans coils)
{
return Math.Ceiling(coils.Count / 8.0).ConvertTo<Int32>();
}
}