@@ -1,7 +1,9 @@
|
||||
using System.Collections.Concurrent;
|
||||
using System.Runtime.CompilerServices;
|
||||
using System.Text;
|
||||
using TwinCAT;
|
||||
using TwinCAT.Ads;
|
||||
using TwinCAT.Ads.SumCommand;
|
||||
using TwinCAT.Ads.TypeSystem;
|
||||
using TwinCAT.TypeSystem;
|
||||
|
||||
@@ -347,6 +349,111 @@ internal sealed class AdsTwinCATClient : ITwinCATClient
|
||||
return true;
|
||||
}
|
||||
|
||||
public async Task<IReadOnlyList<(object? value, uint status)>> ReadValuesAsync(
|
||||
IReadOnlyList<TwinCATBulkReadItem> reads, CancellationToken cancellationToken)
|
||||
{
|
||||
if (reads.Count == 0) return Array.Empty<(object?, uint)>();
|
||||
|
||||
// Build the (path, AnyTypeSpecifier) request envelope. SumInstancePathAnyTypeRead
|
||||
// batches all paths into a single ADS Sum-read round-trip (IndexGroup 0xF080 = read
|
||||
// multiple items by symbol name with ANY-type marshalling).
|
||||
var typeSpecs = new List<(string instancePath, AnyTypeSpecifier spec)>(reads.Count);
|
||||
foreach (var r in reads)
|
||||
typeSpecs.Add((r.SymbolPath, BuildAnyTypeSpecifier(r.Type, r.StringLength)));
|
||||
|
||||
var sumCmd = new SumInstancePathAnyTypeRead(_client, typeSpecs);
|
||||
|
||||
try
|
||||
{
|
||||
var sumResult = await sumCmd.ReadAsync(cancellationToken).ConfigureAwait(false);
|
||||
|
||||
// ResultSumValues2.ValueResults is a per-item array with Source / Value /
|
||||
// ErrorCode. Even when the overall ADS request succeeds, individual sub-items can
|
||||
// carry their own ADS error (e.g. SymbolNotFound).
|
||||
var output = new (object? value, uint status)[reads.Count];
|
||||
var valueResults = sumResult.ValueResults;
|
||||
for (var i = 0; i < reads.Count; i++)
|
||||
{
|
||||
var vr = valueResults[i];
|
||||
if (vr.ErrorCode != 0)
|
||||
{
|
||||
output[i] = (null, TwinCATStatusMapper.MapAdsError((uint)vr.ErrorCode));
|
||||
continue;
|
||||
}
|
||||
var raw = vr.Value;
|
||||
output[i] = (PostProcessIecTime(reads[i].Type, raw), TwinCATStatusMapper.Good);
|
||||
}
|
||||
return output;
|
||||
}
|
||||
catch (AdsErrorException ex)
|
||||
{
|
||||
// Whole-batch failure (no symbol-server ack, router unreachable, etc.). Map the
|
||||
// overall ADS status onto every entry so callers see uniform status — partial-
|
||||
// success marshalling lives in the success branch above.
|
||||
var status = TwinCATStatusMapper.MapAdsError((uint)ex.ErrorCode);
|
||||
var failed = new (object? value, uint status)[reads.Count];
|
||||
for (var i = 0; i < reads.Count; i++) failed[i] = (null, status);
|
||||
return failed;
|
||||
}
|
||||
}
|
||||
|
||||
public async Task<IReadOnlyList<uint>> WriteValuesAsync(
|
||||
IReadOnlyList<TwinCATBulkWriteItem> writes, CancellationToken cancellationToken)
|
||||
{
|
||||
if (writes.Count == 0) return Array.Empty<uint>();
|
||||
|
||||
// SumWriteBySymbolPath internally requests symbol handles + issues a single sum-write
|
||||
// (IndexGroup 0xF081) carrying all values. One AMS round-trip for N writes.
|
||||
var paths = new List<string>(writes.Count);
|
||||
var values = new object[writes.Count];
|
||||
for (var i = 0; i < writes.Count; i++)
|
||||
{
|
||||
paths.Add(writes[i].SymbolPath);
|
||||
values[i] = ConvertForWrite(writes[i].Type, writes[i].Value);
|
||||
}
|
||||
|
||||
var sumCmd = new SumWriteBySymbolPath(_client, paths);
|
||||
|
||||
try
|
||||
{
|
||||
var result = await sumCmd.WriteAsync(values, cancellationToken).ConfigureAwait(false);
|
||||
var output = new uint[writes.Count];
|
||||
var subErrors = result.SubErrors;
|
||||
for (var i = 0; i < writes.Count; i++)
|
||||
{
|
||||
// SubErrors can be null when the overall request failed before sub-dispatch —
|
||||
// surface the OverallError on every slot in that case.
|
||||
var code = subErrors is { Length: > 0 } && i < subErrors.Length
|
||||
? (uint)subErrors[i]
|
||||
: (uint)result.ErrorCode;
|
||||
output[i] = TwinCATStatusMapper.MapAdsError(code);
|
||||
}
|
||||
return output;
|
||||
}
|
||||
catch (AdsErrorException ex)
|
||||
{
|
||||
var status = TwinCATStatusMapper.MapAdsError((uint)ex.ErrorCode);
|
||||
var failed = new uint[writes.Count];
|
||||
for (var i = 0; i < writes.Count; i++) failed[i] = status;
|
||||
return failed;
|
||||
}
|
||||
}
|
||||
|
||||
/// <summary>
|
||||
/// Build an <see cref="AnyTypeSpecifier"/> for one bulk-read entry. STRING uses ASCII +
|
||||
/// the supplied <paramref name="stringLength"/>; WSTRING uses Unicode (UTF-16). All other
|
||||
/// types resolve to a primitive CLR type via <see cref="MapToClrType"/>. IEC time/date
|
||||
/// symbols flow as their underlying UDINT (matching the per-tag path in
|
||||
/// <see cref="ReadValueAsync"/>) and are post-processed CLR-side after the sum-read.
|
||||
/// </summary>
|
||||
private static AnyTypeSpecifier BuildAnyTypeSpecifier(TwinCATDataType type, int stringLength) =>
|
||||
type switch
|
||||
{
|
||||
TwinCATDataType.String => new AnyTypeSpecifier(typeof(string), stringLength, Encoding.ASCII),
|
||||
TwinCATDataType.WString => new AnyTypeSpecifier(typeof(string), stringLength, Encoding.Unicode),
|
||||
_ => new AnyTypeSpecifier(MapToClrType(type)),
|
||||
};
|
||||
|
||||
public void Dispose()
|
||||
{
|
||||
_client.AdsNotificationEx -= OnAdsNotificationEx;
|
||||
|
||||
Reference in New Issue
Block a user