Joseph Doherty
e5122c546b
Add CPU-aware overload S7AddressParser.Parse(string, CpuType?) that accepts the V area letter for S7-200 / S7-200 Smart / LOGO! 0BA8 and maps it to DataBlock DB1. V is rejected on S7-300/400/1200/1500 and on the legacy CPU-agnostic Parse(string) overload. Width suffixes mirror M/I/Q (VB/VW/VD/V0.0). S7Driver passes _options.CpuType so live tag config picks up family-aware parsing. Tests cover S7200/S7200Smart/Logo0BA8 positive cases, modern-family rejection, and CPU-agnostic rejection. Closes #291
957 lines
47 KiB
C#
957 lines
47 KiB
C#
using System.Buffers.Binary;
|
||
using S7.Net;
|
||
using ZB.MOM.WW.OtOpcUa.Core.Abstractions;
|
||
|
||
namespace ZB.MOM.WW.OtOpcUa.Driver.S7;
|
||
|
||
/// <summary>
|
||
/// Siemens S7 native driver — speaks S7comm over ISO-on-TCP (port 102) via the S7netplus
|
||
/// library. First implementation of <see cref="IDriver"/> for an in-process .NET Standard
|
||
/// PLC protocol that is NOT Modbus, validating that the v2 driver-capability interfaces
|
||
/// generalize beyond Modbus + Galaxy.
|
||
/// </summary>
|
||
/// <remarks>
|
||
/// <para>
|
||
/// PR 62 ships the scaffold: <see cref="IDriver"/> only (Initialize / Reinitialize /
|
||
/// Shutdown / GetHealth). <see cref="ITagDiscovery"/>, <see cref="IReadable"/>,
|
||
/// <see cref="IWritable"/>, <see cref="ISubscribable"/>, <see cref="IHostConnectivityProbe"/>
|
||
/// land in PRs 63-65 once the address parser (PR 63) is in place.
|
||
/// </para>
|
||
/// <para>
|
||
/// <b>Single-connection policy</b>: S7netplus documented pattern is one
|
||
/// <c>Plc</c> instance per PLC, serialized with a <see cref="SemaphoreSlim"/>.
|
||
/// Parallelising reads against a single S7 CPU doesn't help — the CPU scans the
|
||
/// communication mailbox at most once per cycle (2-10 ms) and queues concurrent
|
||
/// requests wire-side anyway. Multiple client-side connections just waste the CPU's
|
||
/// 8-64 connection-resource budget.
|
||
/// </para>
|
||
/// </remarks>
|
||
public sealed class S7Driver(S7DriverOptions options, string driverInstanceId)
|
||
: IDriver, ITagDiscovery, IReadable, IWritable, ISubscribable, IHostConnectivityProbe, IDisposable, IAsyncDisposable
|
||
{
|
||
// ---- ISubscribable + IHostConnectivityProbe state ----
|
||
|
||
private readonly System.Collections.Concurrent.ConcurrentDictionary<long, SubscriptionState> _subscriptions = new();
|
||
private long _nextSubscriptionId;
|
||
private readonly object _probeLock = new();
|
||
private HostState _hostState = HostState.Unknown;
|
||
private DateTime _hostStateChangedUtc = DateTime.UtcNow;
|
||
private CancellationTokenSource? _probeCts;
|
||
|
||
public event EventHandler<DataChangeEventArgs>? OnDataChange;
|
||
public event EventHandler<HostStatusChangedEventArgs>? OnHostStatusChanged;
|
||
|
||
/// <summary>OPC UA StatusCode used when the tag name isn't in the driver's tag map.</summary>
|
||
private const uint StatusBadNodeIdUnknown = 0x80340000u;
|
||
/// <summary>OPC UA StatusCode used when the tag's data type isn't implemented yet.</summary>
|
||
private const uint StatusBadNotSupported = 0x803D0000u;
|
||
/// <summary>OPC UA StatusCode used when the tag is declared read-only.</summary>
|
||
private const uint StatusBadNotWritable = 0x803B0000u;
|
||
/// <summary>OPC UA StatusCode used when write fails validation (e.g. out-of-range value).</summary>
|
||
private const uint StatusBadInternalError = 0x80020000u;
|
||
/// <summary>OPC UA StatusCode used for socket / timeout / protocol-layer faults.</summary>
|
||
private const uint StatusBadCommunicationError = 0x80050000u;
|
||
/// <summary>OPC UA StatusCode used when S7 returns <c>ErrorCode.WrongCPU</c> / PUT/GET disabled.</summary>
|
||
private const uint StatusBadDeviceFailure = 0x80550000u;
|
||
|
||
/// <summary>
|
||
/// Hard upper bound on <see cref="S7TagDefinition.ElementCount"/>. The S7 PDU envelope
|
||
/// for negotiated default 240-byte and extended 960-byte payloads cannot fit a single
|
||
/// byte-range read larger than ~960 bytes, so a Float64 array of more than ~120
|
||
/// elements is already lossy. 8000 is an order-of-magnitude generous ceiling that still
|
||
/// rejects obvious config typos (e.g. ElementCount = 65535) at init time.
|
||
/// </summary>
|
||
internal const int MaxArrayElements = 8000;
|
||
|
||
private readonly Dictionary<string, S7TagDefinition> _tagsByName = new(StringComparer.OrdinalIgnoreCase);
|
||
private readonly Dictionary<string, S7ParsedAddress> _parsedByName = new(StringComparer.OrdinalIgnoreCase);
|
||
|
||
private readonly S7DriverOptions _options = options;
|
||
private readonly SemaphoreSlim _gate = new(1, 1);
|
||
|
||
/// <summary>
|
||
/// Per-connection gate. Internal so PRs 63-65 (read/write/subscribe) can serialize on
|
||
/// the same semaphore without exposing it publicly. Single-connection-per-PLC is a
|
||
/// hard requirement of S7netplus — see class remarks.
|
||
/// </summary>
|
||
internal SemaphoreSlim Gate => _gate;
|
||
|
||
/// <summary>
|
||
/// Active S7.Net PLC connection. Null until <see cref="InitializeAsync"/> returns; null
|
||
/// after <see cref="ShutdownAsync"/>. Read-only outside this class; PR 64's Read/Write
|
||
/// will take the <see cref="_gate"/> before touching it.
|
||
/// </summary>
|
||
internal Plc? Plc { get; private set; }
|
||
|
||
private DriverHealth _health = new(DriverState.Unknown, null, null);
|
||
private bool _disposed;
|
||
|
||
public string DriverInstanceId => driverInstanceId;
|
||
public string DriverType => "S7";
|
||
|
||
public async Task InitializeAsync(string driverConfigJson, CancellationToken cancellationToken)
|
||
{
|
||
_health = new DriverHealth(DriverState.Initializing, null, null);
|
||
try
|
||
{
|
||
// Parse + validate every tag before opening the TCP socket so config bugs
|
||
// (bad address, oversized array, unsupported array element) surface as
|
||
// FormatException without waiting on a connect timeout. Per the v1 driver-config
|
||
// story this lets the Admin UI's "Save" round-trip stay sub-second on bad input.
|
||
_tagsByName.Clear();
|
||
_parsedByName.Clear();
|
||
foreach (var t in _options.Tags)
|
||
{
|
||
// Pass CpuType so V-memory addresses (S7-200 / S7-200 Smart / LOGO!) resolve
|
||
// against the device's family-specific DB mapping.
|
||
var parsed = S7AddressParser.Parse(t.Address, _options.CpuType); // throws FormatException
|
||
if (t.ElementCount is int n && n > 1)
|
||
{
|
||
// Array sanity: cap at S7 PDU realistic limit, reject variable-width
|
||
// element types and BOOL (packed-bit layout) up-front so a config typo
|
||
// fails at init instead of surfacing as BadInternalError on every read.
|
||
if (n > MaxArrayElements)
|
||
throw new FormatException(
|
||
$"S7 tag '{t.Name}' ElementCount {n} exceeds S7 PDU realistic limit ({MaxArrayElements})");
|
||
if (!IsArrayElementSupported(t.DataType))
|
||
throw new FormatException(
|
||
$"S7 tag '{t.Name}' DataType {t.DataType} not supported as an array element " +
|
||
$"(variable-width string types and BOOL packed-bit arrays are a follow-up)");
|
||
}
|
||
_tagsByName[t.Name] = t;
|
||
_parsedByName[t.Name] = parsed;
|
||
}
|
||
|
||
var plc = new Plc(_options.CpuType, _options.Host, _options.Port, _options.Rack, _options.Slot);
|
||
// S7netplus writes timeouts into the underlying TcpClient via Plc.WriteTimeout /
|
||
// Plc.ReadTimeout (milliseconds). Set before OpenAsync so the handshake itself
|
||
// honours the bound.
|
||
plc.WriteTimeout = (int)_options.Timeout.TotalMilliseconds;
|
||
plc.ReadTimeout = (int)_options.Timeout.TotalMilliseconds;
|
||
|
||
using var cts = CancellationTokenSource.CreateLinkedTokenSource(cancellationToken);
|
||
cts.CancelAfter(_options.Timeout);
|
||
await plc.OpenAsync(cts.Token).ConfigureAwait(false);
|
||
|
||
Plc = plc;
|
||
|
||
_health = new DriverHealth(DriverState.Healthy, DateTime.UtcNow, null);
|
||
|
||
// Kick off the probe loop once the connection is up. Initial HostState stays
|
||
// Unknown until the first probe tick succeeds — avoids broadcasting a premature
|
||
// Running transition before any PDU round-trip has happened.
|
||
if (_options.Probe.Enabled)
|
||
{
|
||
_probeCts = new CancellationTokenSource();
|
||
_ = Task.Run(() => ProbeLoopAsync(_probeCts.Token), _probeCts.Token);
|
||
}
|
||
}
|
||
catch (Exception ex)
|
||
{
|
||
// Clean up a partially-constructed Plc so a retry from the caller doesn't leak
|
||
// the TcpClient. S7netplus's Close() is best-effort and idempotent.
|
||
try { Plc?.Close(); } catch { }
|
||
Plc = null;
|
||
_health = new DriverHealth(DriverState.Faulted, null, ex.Message);
|
||
throw;
|
||
}
|
||
}
|
||
|
||
public async Task ReinitializeAsync(string driverConfigJson, CancellationToken cancellationToken)
|
||
{
|
||
await ShutdownAsync(cancellationToken).ConfigureAwait(false);
|
||
await InitializeAsync(driverConfigJson, cancellationToken).ConfigureAwait(false);
|
||
}
|
||
|
||
public Task ShutdownAsync(CancellationToken cancellationToken)
|
||
{
|
||
try { _probeCts?.Cancel(); } catch { }
|
||
_probeCts?.Dispose();
|
||
_probeCts = null;
|
||
|
||
foreach (var state in _subscriptions.Values)
|
||
{
|
||
try { state.Cts.Cancel(); } catch { }
|
||
state.Cts.Dispose();
|
||
}
|
||
_subscriptions.Clear();
|
||
|
||
try { Plc?.Close(); } catch { /* best-effort — tearing down anyway */ }
|
||
Plc = null;
|
||
_health = new DriverHealth(DriverState.Unknown, _health.LastSuccessfulRead, null);
|
||
return Task.CompletedTask;
|
||
}
|
||
|
||
public DriverHealth GetHealth() => _health;
|
||
|
||
/// <summary>
|
||
/// Approximate memory footprint. The Plc instance + one 240-960 byte PDU buffer is
|
||
/// under 4 KB; return 0 because the <see cref="IDriver"/> contract asks for a
|
||
/// driver-attributable growth number and S7.Net doesn't expose one.
|
||
/// </summary>
|
||
public long GetMemoryFootprint() => 0;
|
||
|
||
public Task FlushOptionalCachesAsync(CancellationToken cancellationToken) => Task.CompletedTask;
|
||
|
||
// ---- IReadable ----
|
||
|
||
public async Task<IReadOnlyList<DataValueSnapshot>> ReadAsync(
|
||
IReadOnlyList<string> fullReferences, CancellationToken cancellationToken)
|
||
{
|
||
var plc = RequirePlc();
|
||
var now = DateTime.UtcNow;
|
||
var results = new DataValueSnapshot[fullReferences.Count];
|
||
|
||
await _gate.WaitAsync(cancellationToken).ConfigureAwait(false);
|
||
try
|
||
{
|
||
for (var i = 0; i < fullReferences.Count; i++)
|
||
{
|
||
var name = fullReferences[i];
|
||
if (!_tagsByName.TryGetValue(name, out var tag))
|
||
{
|
||
results[i] = new DataValueSnapshot(null, StatusBadNodeIdUnknown, null, now);
|
||
continue;
|
||
}
|
||
try
|
||
{
|
||
var value = await ReadOneAsync(plc, tag, cancellationToken).ConfigureAwait(false);
|
||
results[i] = new DataValueSnapshot(value, 0u, now, now);
|
||
_health = new DriverHealth(DriverState.Healthy, now, null);
|
||
}
|
||
catch (NotSupportedException)
|
||
{
|
||
results[i] = new DataValueSnapshot(null, StatusBadNotSupported, null, now);
|
||
}
|
||
catch (global::S7.Net.PlcException pex)
|
||
{
|
||
// S7.Net's PlcException carries an ErrorCode; PUT/GET-disabled on
|
||
// S7-1200/1500 surfaces here. Map to BadDeviceFailure so operators see a
|
||
// device-config problem (toggle PUT/GET in TIA Portal) rather than a
|
||
// transient fault — per driver-specs.md §5.
|
||
results[i] = new DataValueSnapshot(null, StatusBadDeviceFailure, null, now);
|
||
_health = new DriverHealth(DriverState.Degraded, _health.LastSuccessfulRead, pex.Message);
|
||
}
|
||
catch (Exception ex)
|
||
{
|
||
results[i] = new DataValueSnapshot(null, StatusBadCommunicationError, null, now);
|
||
_health = new DriverHealth(DriverState.Degraded, _health.LastSuccessfulRead, ex.Message);
|
||
}
|
||
}
|
||
}
|
||
finally { _gate.Release(); }
|
||
return results;
|
||
}
|
||
|
||
private async Task<object> ReadOneAsync(global::S7.Net.Plc plc, S7TagDefinition tag, CancellationToken ct)
|
||
{
|
||
var addr = _parsedByName[tag.Name];
|
||
|
||
// 1-D array path: one byte-range read covering N×elementBytes, sliced client-side.
|
||
// Init-time validation guarantees only fixed-width element types reach here.
|
||
if (tag.ElementCount is int n && n > 1)
|
||
{
|
||
var elemBytes = ArrayElementBytes(tag.DataType);
|
||
var totalBytes = checked(n * elemBytes);
|
||
if (addr.Size == S7Size.Bit)
|
||
throw new System.IO.InvalidDataException(
|
||
$"S7 Read type-mismatch: tag '{tag.Name}' is array of {tag.DataType} but address '{tag.Address}' " +
|
||
$"parsed as bit-access; arrays require byte-addressing");
|
||
|
||
var arrBytes = await plc.ReadBytesAsync(MapArea(addr.Area), addr.DbNumber, addr.ByteOffset, totalBytes, ct)
|
||
.ConfigureAwait(false);
|
||
if (arrBytes is null || arrBytes.Length != totalBytes)
|
||
throw new System.IO.InvalidDataException(
|
||
$"S7.Net returned {arrBytes?.Length ?? 0} bytes for array '{tag.Address}' (n={n}), expected {totalBytes}");
|
||
|
||
return SliceArray(arrBytes, tag.DataType, n, elemBytes);
|
||
}
|
||
|
||
// String-shaped types (STRING/WSTRING/CHAR/WCHAR): S7.Net's string-keyed ReadAsync
|
||
// has no syntax for these, so the driver issues a raw byte read and decodes via
|
||
// S7StringCodec. Wire order is big-endian for the WSTRING/WCHAR UTF-16 payload.
|
||
if (tag.DataType is S7DataType.String or S7DataType.WString or S7DataType.Char or S7DataType.WChar)
|
||
{
|
||
if (addr.Size == S7Size.Bit)
|
||
throw new System.IO.InvalidDataException(
|
||
$"S7 Read type-mismatch: tag '{tag.Name}' declared {tag.DataType} but address '{tag.Address}' " +
|
||
$"parsed as bit-access; string-shaped types require byte-addressing (e.g. DBB / MB / IB / QB)");
|
||
|
||
var (area, dbNum, off) = (addr.Area, addr.DbNumber, addr.ByteOffset);
|
||
switch (tag.DataType)
|
||
{
|
||
case S7DataType.Char:
|
||
{
|
||
var b = await plc.ReadBytesAsync(MapArea(area), dbNum, off, 1, ct).ConfigureAwait(false);
|
||
if (b is null || b.Length != 1)
|
||
throw new System.IO.InvalidDataException($"S7.Net returned {b?.Length ?? 0} bytes for CHAR '{tag.Address}', expected 1");
|
||
return S7StringCodec.DecodeChar(b);
|
||
}
|
||
case S7DataType.WChar:
|
||
{
|
||
var b = await plc.ReadBytesAsync(MapArea(area), dbNum, off, 2, ct).ConfigureAwait(false);
|
||
if (b is null || b.Length != 2)
|
||
throw new System.IO.InvalidDataException($"S7.Net returned {b?.Length ?? 0} bytes for WCHAR '{tag.Address}', expected 2");
|
||
return S7StringCodec.DecodeWChar(b);
|
||
}
|
||
case S7DataType.String:
|
||
{
|
||
var max = tag.StringLength;
|
||
var size = S7StringCodec.StringBufferSize(max);
|
||
var b = await plc.ReadBytesAsync(MapArea(area), dbNum, off, size, ct).ConfigureAwait(false);
|
||
if (b is null || b.Length != size)
|
||
throw new System.IO.InvalidDataException($"S7.Net returned {b?.Length ?? 0} bytes for STRING '{tag.Address}', expected {size}");
|
||
return S7StringCodec.DecodeString(b, max);
|
||
}
|
||
case S7DataType.WString:
|
||
{
|
||
var max = tag.StringLength;
|
||
var size = S7StringCodec.WStringBufferSize(max);
|
||
var b = await plc.ReadBytesAsync(MapArea(area), dbNum, off, size, ct).ConfigureAwait(false);
|
||
if (b is null || b.Length != size)
|
||
throw new System.IO.InvalidDataException($"S7.Net returned {b?.Length ?? 0} bytes for WSTRING '{tag.Address}', expected {size}");
|
||
return S7StringCodec.DecodeWString(b, max);
|
||
}
|
||
}
|
||
}
|
||
|
||
// Date/time-shaped types (DTL/DT/S5TIME/TIME/TOD/DATE): S7.Net has no native size
|
||
// suffix for any of these, so the driver issues a raw byte read at the address's
|
||
// ByteOffset and decodes via S7DateTimeCodec. All require byte-addressing — bit-
|
||
// access against a date/time tag is a config bug worth surfacing as a hard error.
|
||
if (tag.DataType is S7DataType.Dtl or S7DataType.DateAndTime or S7DataType.S5Time
|
||
or S7DataType.Time or S7DataType.TimeOfDay or S7DataType.Date)
|
||
{
|
||
if (addr.Size == S7Size.Bit)
|
||
throw new System.IO.InvalidDataException(
|
||
$"S7 Read type-mismatch: tag '{tag.Name}' declared {tag.DataType} but address '{tag.Address}' " +
|
||
$"parsed as bit-access; date/time types require byte-addressing");
|
||
|
||
int size = tag.DataType switch
|
||
{
|
||
S7DataType.Dtl => S7DateTimeCodec.DtlSize,
|
||
S7DataType.DateAndTime => S7DateTimeCodec.DtSize,
|
||
S7DataType.S5Time => S7DateTimeCodec.S5TimeSize,
|
||
S7DataType.Time => S7DateTimeCodec.TimeSize,
|
||
S7DataType.TimeOfDay => S7DateTimeCodec.TodSize,
|
||
S7DataType.Date => S7DateTimeCodec.DateSize,
|
||
_ => throw new InvalidOperationException(),
|
||
};
|
||
|
||
var b = await plc.ReadBytesAsync(MapArea(addr.Area), addr.DbNumber, addr.ByteOffset, size, ct).ConfigureAwait(false);
|
||
if (b is null || b.Length != size)
|
||
throw new System.IO.InvalidDataException(
|
||
$"S7.Net returned {b?.Length ?? 0} bytes for {tag.DataType} '{tag.Address}', expected {size}");
|
||
|
||
return tag.DataType switch
|
||
{
|
||
S7DataType.Dtl => S7DateTimeCodec.DecodeDtl(b),
|
||
S7DataType.DateAndTime => S7DateTimeCodec.DecodeDt(b),
|
||
// S5TIME/TIME/TOD surface as Int32 ms — DriverDataType has no Duration type;
|
||
// OPC UA clients see a millisecond integer matching the IEC-1131 convention.
|
||
S7DataType.S5Time => (int)S7DateTimeCodec.DecodeS5Time(b).TotalMilliseconds,
|
||
S7DataType.Time => (int)S7DateTimeCodec.DecodeTime(b).TotalMilliseconds,
|
||
S7DataType.TimeOfDay => (int)S7DateTimeCodec.DecodeTod(b).TotalMilliseconds,
|
||
S7DataType.Date => S7DateTimeCodec.DecodeDate(b),
|
||
_ => throw new InvalidOperationException(),
|
||
};
|
||
}
|
||
|
||
// 64-bit types: S7.Net's string-based ReadAsync has no LWord size suffix, so issue an
|
||
// 8-byte ReadBytesAsync and convert big-endian in-process. Wire order on S7 is BE.
|
||
if (tag.DataType is S7DataType.Int64 or S7DataType.UInt64 or S7DataType.Float64)
|
||
{
|
||
if (addr.Size != S7Size.LWord)
|
||
throw new System.IO.InvalidDataException(
|
||
$"S7 Read type-mismatch: tag '{tag.Name}' declared {tag.DataType} but address '{tag.Address}' " +
|
||
$"parsed as Size={addr.Size}; 64-bit types require an LD/DBL/DBLD suffix");
|
||
|
||
var bytes = await plc.ReadBytesAsync(MapArea(addr.Area), addr.DbNumber, addr.ByteOffset, 8, ct)
|
||
.ConfigureAwait(false);
|
||
if (bytes is null || bytes.Length != 8)
|
||
throw new System.IO.InvalidDataException($"S7.Net returned {bytes?.Length ?? 0} bytes for '{tag.Address}', expected 8");
|
||
return tag.DataType switch
|
||
{
|
||
S7DataType.Int64 => BinaryPrimitives.ReadInt64BigEndian(bytes),
|
||
S7DataType.UInt64 => BinaryPrimitives.ReadUInt64BigEndian(bytes),
|
||
S7DataType.Float64 => BitConverter.UInt64BitsToDouble(BinaryPrimitives.ReadUInt64BigEndian(bytes)),
|
||
_ => throw new InvalidOperationException(),
|
||
};
|
||
}
|
||
|
||
// S7.Net's string-based ReadAsync returns object where the boxed .NET type depends on
|
||
// the size suffix: DBX=bool, DBB=byte, DBW=ushort, DBD=uint. Our S7DataType enum
|
||
// specifies the SEMANTIC type (Int16 vs UInt16 vs Float32 etc.); the reinterpret below
|
||
// converts the raw unsigned boxed value into the requested type without issuing an
|
||
// extra PLC round-trip.
|
||
var raw = await plc.ReadAsync(tag.Address, ct).ConfigureAwait(false)
|
||
?? throw new System.IO.InvalidDataException($"S7.Net returned null for '{tag.Address}'");
|
||
|
||
return (tag.DataType, addr.Size, raw) switch
|
||
{
|
||
(S7DataType.Bool, S7Size.Bit, bool b) => b,
|
||
(S7DataType.Byte, S7Size.Byte, byte by) => by,
|
||
(S7DataType.UInt16, S7Size.Word, ushort u16) => u16,
|
||
(S7DataType.Int16, S7Size.Word, ushort u16) => unchecked((short)u16),
|
||
(S7DataType.UInt32, S7Size.DWord, uint u32) => u32,
|
||
(S7DataType.Int32, S7Size.DWord, uint u32) => unchecked((int)u32),
|
||
(S7DataType.Float32, S7Size.DWord, uint u32) => BitConverter.UInt32BitsToSingle(u32),
|
||
|
||
(S7DataType.DateTime, _, _) => throw new NotSupportedException("S7 DateTime reads land in a follow-up PR"),
|
||
|
||
_ => throw new System.IO.InvalidDataException(
|
||
$"S7 Read type-mismatch: tag '{tag.Name}' declared {tag.DataType} but address '{tag.Address}' " +
|
||
$"parsed as Size={addr.Size}; S7.Net returned {raw.GetType().Name}"),
|
||
};
|
||
}
|
||
|
||
/// <summary>Map driver-internal <see cref="S7Area"/> to S7.Net's <see cref="global::S7.Net.DataType"/>.</summary>
|
||
private static global::S7.Net.DataType MapArea(S7Area area) => area switch
|
||
{
|
||
S7Area.DataBlock => global::S7.Net.DataType.DataBlock,
|
||
S7Area.Memory => global::S7.Net.DataType.Memory,
|
||
S7Area.Input => global::S7.Net.DataType.Input,
|
||
S7Area.Output => global::S7.Net.DataType.Output,
|
||
S7Area.Timer => global::S7.Net.DataType.Timer,
|
||
S7Area.Counter => global::S7.Net.DataType.Counter,
|
||
_ => throw new InvalidOperationException($"Unknown S7Area {area}"),
|
||
};
|
||
|
||
// ---- IWritable ----
|
||
|
||
public async Task<IReadOnlyList<WriteResult>> WriteAsync(
|
||
IReadOnlyList<WriteRequest> writes, CancellationToken cancellationToken)
|
||
{
|
||
var plc = RequirePlc();
|
||
var results = new WriteResult[writes.Count];
|
||
|
||
await _gate.WaitAsync(cancellationToken).ConfigureAwait(false);
|
||
try
|
||
{
|
||
for (var i = 0; i < writes.Count; i++)
|
||
{
|
||
var w = writes[i];
|
||
if (!_tagsByName.TryGetValue(w.FullReference, out var tag))
|
||
{
|
||
results[i] = new WriteResult(StatusBadNodeIdUnknown);
|
||
continue;
|
||
}
|
||
if (!tag.Writable)
|
||
{
|
||
results[i] = new WriteResult(StatusBadNotWritable);
|
||
continue;
|
||
}
|
||
try
|
||
{
|
||
await WriteOneAsync(plc, tag, w.Value, cancellationToken).ConfigureAwait(false);
|
||
results[i] = new WriteResult(0u);
|
||
}
|
||
catch (NotSupportedException)
|
||
{
|
||
results[i] = new WriteResult(StatusBadNotSupported);
|
||
}
|
||
catch (global::S7.Net.PlcException)
|
||
{
|
||
results[i] = new WriteResult(StatusBadDeviceFailure);
|
||
}
|
||
catch (Exception)
|
||
{
|
||
results[i] = new WriteResult(StatusBadInternalError);
|
||
}
|
||
}
|
||
}
|
||
finally { _gate.Release(); }
|
||
return results;
|
||
}
|
||
|
||
private async Task WriteOneAsync(global::S7.Net.Plc plc, S7TagDefinition tag, object? value, CancellationToken ct)
|
||
{
|
||
// 1-D array path: pack all N elements into a single buffer then push via WriteBytesAsync.
|
||
// Init-time validation guarantees only fixed-width element types reach here.
|
||
if (tag.ElementCount is int n && n > 1)
|
||
{
|
||
var addr = _parsedByName[tag.Name];
|
||
if (addr.Size == S7Size.Bit)
|
||
throw new InvalidOperationException(
|
||
$"S7 Write type-mismatch: tag '{tag.Name}' is array of {tag.DataType} but address '{tag.Address}' " +
|
||
$"parsed as bit-access; arrays require byte-addressing");
|
||
if (value is null)
|
||
throw new ArgumentNullException(nameof(value));
|
||
var elemBytes = ArrayElementBytes(tag.DataType);
|
||
var buf = PackArray(value, tag.DataType, n, elemBytes, tag.Name);
|
||
await plc.WriteBytesAsync(MapArea(addr.Area), addr.DbNumber, addr.ByteOffset, buf, ct).ConfigureAwait(false);
|
||
return;
|
||
}
|
||
|
||
// String-shaped types: encode via S7StringCodec then push via WriteBytesAsync. The
|
||
// codec rejects out-of-range lengths and non-ASCII for CHAR — we let the resulting
|
||
// ArgumentException bubble out so the WriteAsync caller maps it to BadInternalError.
|
||
if (tag.DataType is S7DataType.String or S7DataType.WString or S7DataType.Char or S7DataType.WChar)
|
||
{
|
||
var addr = _parsedByName[tag.Name];
|
||
if (addr.Size == S7Size.Bit)
|
||
throw new InvalidOperationException(
|
||
$"S7 Write type-mismatch: tag '{tag.Name}' declared {tag.DataType} but address '{tag.Address}' " +
|
||
$"parsed as bit-access; string-shaped types require byte-addressing (e.g. DBB / MB / IB / QB)");
|
||
|
||
byte[] payload = tag.DataType switch
|
||
{
|
||
S7DataType.Char => S7StringCodec.EncodeChar(Convert.ToChar(value ?? throw new ArgumentNullException(nameof(value)))),
|
||
S7DataType.WChar => S7StringCodec.EncodeWChar(Convert.ToChar(value ?? throw new ArgumentNullException(nameof(value)))),
|
||
S7DataType.String => S7StringCodec.EncodeString(Convert.ToString(value) ?? string.Empty, tag.StringLength),
|
||
S7DataType.WString => S7StringCodec.EncodeWString(Convert.ToString(value) ?? string.Empty, tag.StringLength),
|
||
_ => throw new InvalidOperationException(),
|
||
};
|
||
await plc.WriteBytesAsync(MapArea(addr.Area), addr.DbNumber, addr.ByteOffset, payload, ct).ConfigureAwait(false);
|
||
return;
|
||
}
|
||
|
||
// Date/time-shaped types: encode via S7DateTimeCodec and push as raw bytes. S5TIME /
|
||
// TIME / TOD accept an integer-ms input (matching the read surface); DTL / DT / DATE
|
||
// accept a DateTime. ArgumentException from the codec bubbles to BadInternalError.
|
||
if (tag.DataType is S7DataType.Dtl or S7DataType.DateAndTime or S7DataType.S5Time
|
||
or S7DataType.Time or S7DataType.TimeOfDay or S7DataType.Date)
|
||
{
|
||
var addr = _parsedByName[tag.Name];
|
||
if (addr.Size == S7Size.Bit)
|
||
throw new InvalidOperationException(
|
||
$"S7 Write type-mismatch: tag '{tag.Name}' declared {tag.DataType} but address '{tag.Address}' " +
|
||
$"parsed as bit-access; date/time types require byte-addressing");
|
||
if (value is null)
|
||
throw new ArgumentNullException(nameof(value));
|
||
|
||
byte[] payload = tag.DataType switch
|
||
{
|
||
S7DataType.Dtl => S7DateTimeCodec.EncodeDtl(Convert.ToDateTime(value)),
|
||
S7DataType.DateAndTime => S7DateTimeCodec.EncodeDt(Convert.ToDateTime(value)),
|
||
S7DataType.S5Time => S7DateTimeCodec.EncodeS5Time(value is TimeSpan ts1 ? ts1 : TimeSpan.FromMilliseconds(Convert.ToInt32(value))),
|
||
S7DataType.Time => S7DateTimeCodec.EncodeTime(value is TimeSpan ts2 ? ts2 : TimeSpan.FromMilliseconds(Convert.ToInt32(value))),
|
||
S7DataType.TimeOfDay => S7DateTimeCodec.EncodeTod(value is TimeSpan ts3 ? ts3 : TimeSpan.FromMilliseconds(Convert.ToInt64(value))),
|
||
S7DataType.Date => S7DateTimeCodec.EncodeDate(Convert.ToDateTime(value)),
|
||
_ => throw new InvalidOperationException(),
|
||
};
|
||
await plc.WriteBytesAsync(MapArea(addr.Area), addr.DbNumber, addr.ByteOffset, payload, ct).ConfigureAwait(false);
|
||
return;
|
||
}
|
||
|
||
// 64-bit types: S7.Net has no LWord-aware WriteAsync(string, object) overload, so emit
|
||
// the value as 8 big-endian bytes via WriteBytesAsync. Wire order on S7 is BE so a
|
||
// BinaryPrimitives.Write*BigEndian round-trips with the matching ReadOneAsync path.
|
||
if (tag.DataType is S7DataType.Int64 or S7DataType.UInt64 or S7DataType.Float64)
|
||
{
|
||
var addr = _parsedByName[tag.Name];
|
||
if (addr.Size != S7Size.LWord)
|
||
throw new InvalidOperationException(
|
||
$"S7 Write type-mismatch: tag '{tag.Name}' declared {tag.DataType} but address '{tag.Address}' " +
|
||
$"parsed as Size={addr.Size}; 64-bit types require an LD/DBL/DBLD suffix");
|
||
|
||
var buf = new byte[8];
|
||
switch (tag.DataType)
|
||
{
|
||
case S7DataType.Int64:
|
||
BinaryPrimitives.WriteInt64BigEndian(buf, Convert.ToInt64(value));
|
||
break;
|
||
case S7DataType.UInt64:
|
||
BinaryPrimitives.WriteUInt64BigEndian(buf, Convert.ToUInt64(value));
|
||
break;
|
||
case S7DataType.Float64:
|
||
BinaryPrimitives.WriteUInt64BigEndian(buf, BitConverter.DoubleToUInt64Bits(Convert.ToDouble(value)));
|
||
break;
|
||
}
|
||
await plc.WriteBytesAsync(MapArea(addr.Area), addr.DbNumber, addr.ByteOffset, buf, ct).ConfigureAwait(false);
|
||
return;
|
||
}
|
||
|
||
// S7.Net's Plc.WriteAsync(string address, object value) expects the boxed value to
|
||
// match the address's size-suffix type: DBX=bool, DBB=byte, DBW=ushort, DBD=uint.
|
||
// Our S7DataType lets the caller pass short/int/float; convert to the unsigned
|
||
// wire representation before handing off.
|
||
var boxed = tag.DataType switch
|
||
{
|
||
S7DataType.Bool => (object)Convert.ToBoolean(value),
|
||
S7DataType.Byte => (object)Convert.ToByte(value),
|
||
S7DataType.UInt16 => (object)Convert.ToUInt16(value),
|
||
S7DataType.Int16 => (object)unchecked((ushort)Convert.ToInt16(value)),
|
||
S7DataType.UInt32 => (object)Convert.ToUInt32(value),
|
||
S7DataType.Int32 => (object)unchecked((uint)Convert.ToInt32(value)),
|
||
S7DataType.Float32 => (object)BitConverter.SingleToUInt32Bits(Convert.ToSingle(value)),
|
||
|
||
S7DataType.DateTime => throw new NotSupportedException("S7 DateTime writes land in a follow-up PR"),
|
||
_ => throw new InvalidOperationException($"Unknown S7DataType {tag.DataType}"),
|
||
};
|
||
await plc.WriteAsync(tag.Address, boxed, ct).ConfigureAwait(false);
|
||
}
|
||
|
||
private global::S7.Net.Plc RequirePlc() =>
|
||
Plc ?? throw new InvalidOperationException("S7Driver not initialized");
|
||
|
||
// ---- ITagDiscovery ----
|
||
|
||
public Task DiscoverAsync(IAddressSpaceBuilder builder, CancellationToken cancellationToken)
|
||
{
|
||
ArgumentNullException.ThrowIfNull(builder);
|
||
var folder = builder.Folder("S7", "S7");
|
||
foreach (var t in _options.Tags)
|
||
{
|
||
var isArr = t.ElementCount is int ec && ec > 1;
|
||
folder.Variable(t.Name, t.Name, new DriverAttributeInfo(
|
||
FullName: t.Name,
|
||
DriverDataType: MapDataType(t.DataType),
|
||
IsArray: isArr,
|
||
ArrayDim: isArr ? (uint)t.ElementCount!.Value : null,
|
||
SecurityClass: t.Writable ? SecurityClassification.Operate : SecurityClassification.ViewOnly,
|
||
IsHistorized: false,
|
||
IsAlarm: false,
|
||
WriteIdempotent: t.WriteIdempotent));
|
||
}
|
||
return Task.CompletedTask;
|
||
}
|
||
|
||
/// <summary>
|
||
/// True when <paramref name="t"/> can be used as an array element. Variable-width string
|
||
/// types and BOOL (packed-bit layout) are rejected — both need bespoke addressing
|
||
/// beyond a flat <c>N × elementBytes</c> byte-range read and ship as a follow-up.
|
||
/// </summary>
|
||
internal static bool IsArrayElementSupported(S7DataType t) => t is
|
||
S7DataType.Byte or
|
||
S7DataType.Int16 or S7DataType.UInt16 or
|
||
S7DataType.Int32 or S7DataType.UInt32 or
|
||
S7DataType.Int64 or S7DataType.UInt64 or
|
||
S7DataType.Float32 or S7DataType.Float64 or
|
||
S7DataType.Date or S7DataType.Time or S7DataType.TimeOfDay;
|
||
|
||
/// <summary>
|
||
/// On-wire bytes per array element for the supported fixed-width element types. DATE
|
||
/// is a 16-bit days-since-1990 counter, TIME and TOD are 32-bit ms counters.
|
||
/// </summary>
|
||
internal static int ArrayElementBytes(S7DataType t) => t switch
|
||
{
|
||
S7DataType.Byte => 1,
|
||
S7DataType.Int16 or S7DataType.UInt16 or S7DataType.Date => 2,
|
||
S7DataType.Int32 or S7DataType.UInt32 or S7DataType.Float32
|
||
or S7DataType.Time or S7DataType.TimeOfDay => 4,
|
||
S7DataType.Int64 or S7DataType.UInt64 or S7DataType.Float64 => 8,
|
||
_ => throw new InvalidOperationException($"S7 array element bytes undefined for {t}"),
|
||
};
|
||
|
||
/// <summary>
|
||
/// Slice a flat S7 byte buffer into a typed array using the existing big-endian scalar
|
||
/// codec for each element. Returns the typed array boxed as <c>object</c> so the
|
||
/// <see cref="DataValueSnapshot"/> surface can carry it without further conversion.
|
||
/// </summary>
|
||
internal static object SliceArray(byte[] bytes, S7DataType t, int n, int elemBytes)
|
||
{
|
||
switch (t)
|
||
{
|
||
case S7DataType.Byte:
|
||
{
|
||
var a = new byte[n];
|
||
Buffer.BlockCopy(bytes, 0, a, 0, n);
|
||
return a;
|
||
}
|
||
case S7DataType.Int16:
|
||
{
|
||
var a = new short[n];
|
||
for (var i = 0; i < n; i++) a[i] = BinaryPrimitives.ReadInt16BigEndian(bytes.AsSpan(i * elemBytes, 2));
|
||
return a;
|
||
}
|
||
case S7DataType.UInt16:
|
||
{
|
||
var a = new ushort[n];
|
||
for (var i = 0; i < n; i++) a[i] = BinaryPrimitives.ReadUInt16BigEndian(bytes.AsSpan(i * elemBytes, 2));
|
||
return a;
|
||
}
|
||
case S7DataType.Int32:
|
||
{
|
||
var a = new int[n];
|
||
for (var i = 0; i < n; i++) a[i] = BinaryPrimitives.ReadInt32BigEndian(bytes.AsSpan(i * elemBytes, 4));
|
||
return a;
|
||
}
|
||
case S7DataType.UInt32:
|
||
{
|
||
var a = new uint[n];
|
||
for (var i = 0; i < n; i++) a[i] = BinaryPrimitives.ReadUInt32BigEndian(bytes.AsSpan(i * elemBytes, 4));
|
||
return a;
|
||
}
|
||
case S7DataType.Int64:
|
||
{
|
||
var a = new long[n];
|
||
for (var i = 0; i < n; i++) a[i] = BinaryPrimitives.ReadInt64BigEndian(bytes.AsSpan(i * elemBytes, 8));
|
||
return a;
|
||
}
|
||
case S7DataType.UInt64:
|
||
{
|
||
var a = new ulong[n];
|
||
for (var i = 0; i < n; i++) a[i] = BinaryPrimitives.ReadUInt64BigEndian(bytes.AsSpan(i * elemBytes, 8));
|
||
return a;
|
||
}
|
||
case S7DataType.Float32:
|
||
{
|
||
var a = new float[n];
|
||
for (var i = 0; i < n; i++)
|
||
a[i] = BitConverter.UInt32BitsToSingle(BinaryPrimitives.ReadUInt32BigEndian(bytes.AsSpan(i * elemBytes, 4)));
|
||
return a;
|
||
}
|
||
case S7DataType.Float64:
|
||
{
|
||
var a = new double[n];
|
||
for (var i = 0; i < n; i++)
|
||
a[i] = BitConverter.UInt64BitsToDouble(BinaryPrimitives.ReadUInt64BigEndian(bytes.AsSpan(i * elemBytes, 8)));
|
||
return a;
|
||
}
|
||
case S7DataType.Date:
|
||
{
|
||
var a = new DateTime[n];
|
||
for (var i = 0; i < n; i++)
|
||
a[i] = S7DateTimeCodec.DecodeDate(bytes.AsSpan(i * elemBytes, 2));
|
||
return a;
|
||
}
|
||
case S7DataType.Time:
|
||
{
|
||
// Surface as Int32 ms — matches the scalar Time read path (driver-specs §5).
|
||
var a = new int[n];
|
||
for (var i = 0; i < n; i++)
|
||
a[i] = (int)S7DateTimeCodec.DecodeTime(bytes.AsSpan(i * elemBytes, 4)).TotalMilliseconds;
|
||
return a;
|
||
}
|
||
case S7DataType.TimeOfDay:
|
||
{
|
||
var a = new int[n];
|
||
for (var i = 0; i < n; i++)
|
||
a[i] = (int)S7DateTimeCodec.DecodeTod(bytes.AsSpan(i * elemBytes, 4)).TotalMilliseconds;
|
||
return a;
|
||
}
|
||
default:
|
||
throw new InvalidOperationException($"S7 array slice undefined for {t}");
|
||
}
|
||
}
|
||
|
||
/// <summary>
|
||
/// Pack a caller-supplied array (object) into the on-wire S7 byte layout for
|
||
/// <paramref name="elementType"/>. Accepts both the strongly-typed array
|
||
/// (<c>short[]</c>, <c>int[]</c>, ...) and a generic <c>System.Array</c> / <c>IEnumerable</c>
|
||
/// so OPC UA Variant-boxed values flow through unchanged.
|
||
/// </summary>
|
||
internal static byte[] PackArray(object value, S7DataType elementType, int n, int elemBytes, string tagName)
|
||
{
|
||
if (value is not System.Collections.IEnumerable enumerable)
|
||
throw new ArgumentException($"S7 Write tag '{tagName}' is array but value is not enumerable (got {value.GetType().Name})", nameof(value));
|
||
|
||
var buf = new byte[n * elemBytes];
|
||
var i = 0;
|
||
foreach (var raw in enumerable)
|
||
{
|
||
if (i >= n)
|
||
throw new ArgumentException($"S7 Write tag '{tagName}': value has more than ElementCount={n} elements", nameof(value));
|
||
var span = buf.AsSpan(i * elemBytes, elemBytes);
|
||
switch (elementType)
|
||
{
|
||
case S7DataType.Byte: span[0] = Convert.ToByte(raw); break;
|
||
case S7DataType.Int16: BinaryPrimitives.WriteInt16BigEndian(span, Convert.ToInt16(raw)); break;
|
||
case S7DataType.UInt16: BinaryPrimitives.WriteUInt16BigEndian(span, Convert.ToUInt16(raw)); break;
|
||
case S7DataType.Int32: BinaryPrimitives.WriteInt32BigEndian(span, Convert.ToInt32(raw)); break;
|
||
case S7DataType.UInt32: BinaryPrimitives.WriteUInt32BigEndian(span, Convert.ToUInt32(raw)); break;
|
||
case S7DataType.Int64: BinaryPrimitives.WriteInt64BigEndian(span, Convert.ToInt64(raw)); break;
|
||
case S7DataType.UInt64: BinaryPrimitives.WriteUInt64BigEndian(span, Convert.ToUInt64(raw)); break;
|
||
case S7DataType.Float32: BinaryPrimitives.WriteUInt32BigEndian(span, BitConverter.SingleToUInt32Bits(Convert.ToSingle(raw))); break;
|
||
case S7DataType.Float64: BinaryPrimitives.WriteUInt64BigEndian(span, BitConverter.DoubleToUInt64Bits(Convert.ToDouble(raw))); break;
|
||
case S7DataType.Date:
|
||
S7DateTimeCodec.EncodeDate(Convert.ToDateTime(raw)).CopyTo(span);
|
||
break;
|
||
case S7DataType.Time:
|
||
S7DateTimeCodec.EncodeTime(raw is TimeSpan ts ? ts : TimeSpan.FromMilliseconds(Convert.ToInt32(raw))).CopyTo(span);
|
||
break;
|
||
case S7DataType.TimeOfDay:
|
||
S7DateTimeCodec.EncodeTod(raw is TimeSpan tod ? tod : TimeSpan.FromMilliseconds(Convert.ToInt64(raw))).CopyTo(span);
|
||
break;
|
||
default:
|
||
throw new InvalidOperationException($"S7 array pack undefined for {elementType}");
|
||
}
|
||
i++;
|
||
}
|
||
if (i != n)
|
||
throw new ArgumentException($"S7 Write tag '{tagName}': value had {i} elements, expected ElementCount={n}", nameof(value));
|
||
return buf;
|
||
}
|
||
|
||
private static DriverDataType MapDataType(S7DataType t) => t switch
|
||
{
|
||
S7DataType.Bool => DriverDataType.Boolean,
|
||
S7DataType.Byte => DriverDataType.Int32, // no 8-bit in DriverDataType yet
|
||
S7DataType.Int16 => DriverDataType.Int16,
|
||
S7DataType.UInt16 => DriverDataType.UInt16,
|
||
S7DataType.Int32 => DriverDataType.Int32,
|
||
S7DataType.UInt32 => DriverDataType.UInt32,
|
||
S7DataType.Int64 => DriverDataType.Int64,
|
||
S7DataType.UInt64 => DriverDataType.UInt64,
|
||
S7DataType.Float32 => DriverDataType.Float32,
|
||
S7DataType.Float64 => DriverDataType.Float64,
|
||
S7DataType.String => DriverDataType.String,
|
||
S7DataType.WString => DriverDataType.String,
|
||
S7DataType.Char => DriverDataType.String,
|
||
S7DataType.WChar => DriverDataType.String,
|
||
S7DataType.DateTime => DriverDataType.DateTime,
|
||
S7DataType.Dtl => DriverDataType.DateTime,
|
||
S7DataType.DateAndTime => DriverDataType.DateTime,
|
||
S7DataType.Date => DriverDataType.DateTime,
|
||
// S5TIME/TIME/TOD have no Duration type in DriverDataType — surface as Int32 ms
|
||
// (matching the IEC-1131 representation).
|
||
S7DataType.S5Time => DriverDataType.Int32,
|
||
S7DataType.Time => DriverDataType.Int32,
|
||
S7DataType.TimeOfDay => DriverDataType.Int32,
|
||
_ => DriverDataType.Int32,
|
||
};
|
||
|
||
// ---- ISubscribable (polling overlay) ----
|
||
|
||
public Task<ISubscriptionHandle> SubscribeAsync(
|
||
IReadOnlyList<string> fullReferences, TimeSpan publishingInterval, CancellationToken cancellationToken)
|
||
{
|
||
var id = Interlocked.Increment(ref _nextSubscriptionId);
|
||
var cts = new CancellationTokenSource();
|
||
// Floor at 100 ms — S7 CPUs scan 2-10 ms but the comms mailbox is processed at most
|
||
// once per scan; sub-100 ms polling just queues wire-side with worse latency.
|
||
var interval = publishingInterval < TimeSpan.FromMilliseconds(100)
|
||
? TimeSpan.FromMilliseconds(100)
|
||
: publishingInterval;
|
||
var handle = new S7SubscriptionHandle(id);
|
||
var state = new SubscriptionState(handle, [.. fullReferences], interval, cts);
|
||
_subscriptions[id] = state;
|
||
_ = Task.Run(() => PollLoopAsync(state, cts.Token), cts.Token);
|
||
return Task.FromResult<ISubscriptionHandle>(handle);
|
||
}
|
||
|
||
public Task UnsubscribeAsync(ISubscriptionHandle handle, CancellationToken cancellationToken)
|
||
{
|
||
if (handle is S7SubscriptionHandle h && _subscriptions.TryRemove(h.Id, out var state))
|
||
{
|
||
state.Cts.Cancel();
|
||
state.Cts.Dispose();
|
||
}
|
||
return Task.CompletedTask;
|
||
}
|
||
|
||
private async Task PollLoopAsync(SubscriptionState state, CancellationToken ct)
|
||
{
|
||
// Initial-data push per OPC UA Part 4 convention.
|
||
try { await PollOnceAsync(state, forceRaise: true, ct).ConfigureAwait(false); }
|
||
catch (OperationCanceledException) { return; }
|
||
catch { /* first-read error — polling continues */ }
|
||
|
||
while (!ct.IsCancellationRequested)
|
||
{
|
||
try { await Task.Delay(state.Interval, ct).ConfigureAwait(false); }
|
||
catch (OperationCanceledException) { return; }
|
||
|
||
try { await PollOnceAsync(state, forceRaise: false, ct).ConfigureAwait(false); }
|
||
catch (OperationCanceledException) { return; }
|
||
catch { /* transient polling error — loop continues, health surface reflects it */ }
|
||
}
|
||
}
|
||
|
||
private async Task PollOnceAsync(SubscriptionState state, bool forceRaise, CancellationToken ct)
|
||
{
|
||
var snapshots = await ReadAsync(state.TagReferences, ct).ConfigureAwait(false);
|
||
for (var i = 0; i < state.TagReferences.Count; i++)
|
||
{
|
||
var tagRef = state.TagReferences[i];
|
||
var current = snapshots[i];
|
||
var lastSeen = state.LastValues.TryGetValue(tagRef, out var prev) ? prev : default;
|
||
|
||
if (forceRaise || !Equals(lastSeen?.Value, current.Value) || lastSeen?.StatusCode != current.StatusCode)
|
||
{
|
||
state.LastValues[tagRef] = current;
|
||
OnDataChange?.Invoke(this, new DataChangeEventArgs(state.Handle, tagRef, current));
|
||
}
|
||
}
|
||
}
|
||
|
||
private sealed record SubscriptionState(
|
||
S7SubscriptionHandle Handle,
|
||
IReadOnlyList<string> TagReferences,
|
||
TimeSpan Interval,
|
||
CancellationTokenSource Cts)
|
||
{
|
||
public System.Collections.Concurrent.ConcurrentDictionary<string, DataValueSnapshot> LastValues { get; }
|
||
= new(StringComparer.OrdinalIgnoreCase);
|
||
}
|
||
|
||
private sealed record S7SubscriptionHandle(long Id) : ISubscriptionHandle
|
||
{
|
||
public string DiagnosticId => $"s7-sub-{Id}";
|
||
}
|
||
|
||
// ---- IHostConnectivityProbe ----
|
||
|
||
/// <summary>
|
||
/// Host identifier surfaced in <see cref="GetHostStatuses"/>. <c>host:port</c> format
|
||
/// matches the Modbus driver's convention so the Admin UI dashboard renders both
|
||
/// family's rows uniformly.
|
||
/// </summary>
|
||
public string HostName => $"{_options.Host}:{_options.Port}";
|
||
|
||
public IReadOnlyList<HostConnectivityStatus> GetHostStatuses()
|
||
{
|
||
lock (_probeLock)
|
||
return [new HostConnectivityStatus(HostName, _hostState, _hostStateChangedUtc)];
|
||
}
|
||
|
||
private async Task ProbeLoopAsync(CancellationToken ct)
|
||
{
|
||
while (!ct.IsCancellationRequested)
|
||
{
|
||
var success = false;
|
||
try
|
||
{
|
||
// Probe via S7.Net's low-cost GetCpuStatus — returns the CPU state (Run/Stop)
|
||
// and is intentionally light on the comms mailbox. Single-word Plc.ReadAsync
|
||
// would also work but GetCpuStatus doubles as a "PLC actually up" check.
|
||
using var probeCts = CancellationTokenSource.CreateLinkedTokenSource(ct);
|
||
probeCts.CancelAfter(_options.Probe.Timeout);
|
||
|
||
var plc = Plc;
|
||
if (plc is null) throw new InvalidOperationException("Plc dropped during probe");
|
||
|
||
await _gate.WaitAsync(probeCts.Token).ConfigureAwait(false);
|
||
try
|
||
{
|
||
_ = await plc.ReadStatusAsync(probeCts.Token).ConfigureAwait(false);
|
||
success = true;
|
||
}
|
||
finally { _gate.Release(); }
|
||
}
|
||
catch (OperationCanceledException) when (ct.IsCancellationRequested) { return; }
|
||
catch { /* transport/timeout/exception — treated as Stopped below */ }
|
||
|
||
TransitionTo(success ? HostState.Running : HostState.Stopped);
|
||
|
||
try { await Task.Delay(_options.Probe.Interval, ct).ConfigureAwait(false); }
|
||
catch (OperationCanceledException) { return; }
|
||
}
|
||
}
|
||
|
||
private void TransitionTo(HostState newState)
|
||
{
|
||
HostState old;
|
||
lock (_probeLock)
|
||
{
|
||
old = _hostState;
|
||
if (old == newState) return;
|
||
_hostState = newState;
|
||
_hostStateChangedUtc = DateTime.UtcNow;
|
||
}
|
||
OnHostStatusChanged?.Invoke(this, new HostStatusChangedEventArgs(HostName, old, newState));
|
||
}
|
||
|
||
public void Dispose() => DisposeAsync().AsTask().GetAwaiter().GetResult();
|
||
|
||
public async ValueTask DisposeAsync()
|
||
{
|
||
if (_disposed) return;
|
||
_disposed = true;
|
||
try { await ShutdownAsync(CancellationToken.None).ConfigureAwait(false); }
|
||
catch { /* disposal is best-effort */ }
|
||
_gate.Dispose();
|
||
}
|
||
}
|