63 lines
2.4 KiB
C#
63 lines
2.4 KiB
C#
using System;
|
|
|
|
namespace SharpModbus
|
|
{
|
|
public class ModbusF15WriteCoils : IModbusCommand
|
|
{
|
|
private readonly byte slave;
|
|
private readonly ushort address;
|
|
private readonly bool[] values;
|
|
|
|
public byte Code { get { return 15; } }
|
|
public byte Slave { get { return slave; } }
|
|
public ushort Address { get { return address; } }
|
|
public bool[] Values { get { return ModbusUtils.Clone(values); } }
|
|
public int RequestLength { get { return 7 + ModbusUtils.BytesForBools(values.Length); } }
|
|
public int ResponseLength { get { return 6; } }
|
|
|
|
public ModbusF15WriteCoils(byte slave, ushort address, bool[] values)
|
|
{
|
|
this.slave = slave;
|
|
this.address = address;
|
|
this.values = values;
|
|
}
|
|
|
|
public void FillRequest(byte[] request, int offset)
|
|
{
|
|
FillResponse(request, offset, null);
|
|
var bytes = ModbusUtils.EncodeBools(values);
|
|
request[offset + 6] = (byte)bytes.Length;
|
|
ModbusUtils.Copy(bytes, 0, request, offset + 7, bytes.Length);
|
|
}
|
|
|
|
public object ParseResponse(byte[] response, int offset)
|
|
{
|
|
Tools.AssertEqual(response[offset + 0], slave, "Slave mismatch got {0} expected {1}");
|
|
Tools.AssertEqual(response[offset + 1], 15, "Function mismatch got {0} expected {1}");
|
|
Tools.AssertEqual(ModbusUtils.GetUShort(response, offset + 2), address, "Address mismatch got {0} expected {1}");
|
|
Tools.AssertEqual(ModbusUtils.GetUShort(response, offset + 4), values.Length, "Coil count mismatch got {0} expected {1}");
|
|
return null;
|
|
}
|
|
|
|
public object ApplyTo(IModbusModel model)
|
|
{
|
|
model.setDOs(slave, address, values);
|
|
return null;
|
|
}
|
|
|
|
public void FillResponse(byte[] response, int offset, object value)
|
|
{
|
|
response[offset + 0] = slave;
|
|
response[offset + 1] = 15;
|
|
response[offset + 2] = ModbusUtils.High(address);
|
|
response[offset + 3] = ModbusUtils.Low(address);
|
|
response[offset + 4] = ModbusUtils.High(values.Length);
|
|
response[offset + 5] = ModbusUtils.Low(values.Length);
|
|
}
|
|
|
|
public override string ToString()
|
|
{
|
|
return string.Format("[ModbusF15WriteCoils Slave={0}, Address={1}, Values={2}]", slave, address, values);
|
|
}
|
|
}
|
|
} |