mirror of
https://github.com/OPCFoundation/UA-.NETStandard.git
synced 2026-10-18 14:43:08 +08:00
cef83550cb
# Description Implements **OPC UA — Vision** and uses it to build the demo the companion specifications were drafted for: an eye-in-hand camera watches a bin of parts, a language model *looks at the frame*, decides which part matches the instruction, and commands the robot through Robot Intent — with the OpenUSD viewer showing the arm move and the bin empty out. > **Draft, and stacked.** [#4195](https://github.com/OPCFoundation/UA-.NETStandard/pull/4195) has merged and master is merged in, so what is left on top of `master` is the Vision work plus the unmerged `marcschier/ai-model-management` branch, which the demo needs for the model/dataset/deployment provenance. Review the Vision commits; the AI Model Management work lands with its own PR. ## What is here **The specification, implemented.** `Opc.Ua.Vision` is generated from the spec's own `Opc.Ua.Vision.NodeSet2.xml`, vendored byte-identically (SHA-256 `79C592C6…`, verified against a fresh download and stored LF-preserved like the Robot Intent NodeSet). `Opc.Ua.Vision.Server` builds the §4.2 discovery object, sensors, the coordinate-frame tree, calibrations, media endpoints, inference pipelines and the §9 feedback methods, with rendering and inference behind injectable providers. `Opc.Ua.Vision.Client` is built on the generated ObjectType proxies and composes transforms across the frame tree, which is what turns a detection in camera coordinates into a pose a robot can act on. **Two perception paths behind one contract**, which is exactly what `InferenceLocationEnum` is for. `OnServer` is a deterministic detector derived from the stage's ground truth — no model, no network, no GPU, so CI can exercise the whole loop. `EdgeOffServer` is the agent: it sees the frame over MCP and calls `SubmitDetections`, and the Server publishes results it did not compute. A client reads `DetectionResultType` identically either way. **The agent's eyes.** `tools/Opc.Ua.Mcp.Vision` adds 22 `vision_*` tools, which with the four shared connection tools makes the `vision` profile 26; `vision_get_frame` returns the camera image as an MCP `ImageContentBlock`, so the model looks at pixels rather than reading a description of them. Tool profiles now compose — `--profile vision,robotics` yields 62 tools — so one agent can both see and act without dragging in the full 136-tool catalogue. **The cell.** `samples/Robotics/BinPickingCell` follows the spec's own Robotics-Vision Addendum: the `world → robot_base → flange → gripper_tcp` frame tree with `camera_eih` on the flange, the `HandEye` extrinsics and the `Intrinsics612x512` intrinsics — the addendum's 2448×2048 calibration scaled to the 4×4-binned grid the camera actually delivers. `samples/Robotics/BinPickingClient` hosts the composed MCP catalogue and optionally the viewer. **Documentation.** `docs/Vision.md` (~800 lines) covers the model, hosting, the build context, every topology builder, both perception paths, feedback, the MCP profile and the limitations; linked from `docs/README.md`, with the profile table in `docs/McpServer.md` and READMEs for both samples. ## Evidence, not assertions Each of these was measured on a running system rather than assumed: | Claim | Evidence | |---|---| | The camera sees the bin | 612×512 frame with the bin and all five parts in view — red `(212,47,47)`, green `(61,193,71)`, blue `(54,85,218)`, yellow `(215,196,58)`, orange `(209,119,55)` | | An agent can act on what it sees | Over MCP, `vision_get_frame` returns a 612×512 PNG that decodes from base64 to 1,254,051 bytes, the descriptor beside the detections says 612×512, and all five `BoundingBox2D` centres land **inside** the frame on the pixel colour their own detection claims | | The geometry is right | A detection composed `camera_eih → world` lands on the authored position, residual **0.0000 m** — on both the on-server and off-server paths | | The detector tracks the world | Placing a part drops the next scan from 5 detections to 4, with that part absent | | The robot obeys the agent | Scripted run took command authority and completed a pick and a place, both `Succeeded` | | Tool catalogues are honest | Counted from a running server: vision 26, robotics 40, `vision,robotics` 62, full 136, **zero duplicates** | | Every node is browsable by NodeId | Eight representative NodeIds — both folders, a pipeline, a frame, the sensor, its Calibrations folder, the HandEye calibration, the Media folder — all `Good` | That tool-count check matters because the profile tests collapse names into a `HashSet` and *cannot see* a duplicate registration — so the new tests count registrations, not names. ## Things that were wrong, and are not now Writing the tests found three defects of one kind — code that answered instead of refusing. A zero-norm quaternion was silently rewritten to identity, so a caller with an all-zero orientation got a confident wrong grasp pose. `SubmitCorrection` rewrote a null `ResultId` to empty and called the sink anyway. A bad `StageIdentifier` **killed the host process** inside native `UsdStage.Open`, via an exception .NET cannot catch. All three now refuse loudly and are pinned by tests. **Nodes that existed but could not be reached.** The node manager indexes the Vision root before configurators run, so everything the fluent builder grafted on afterwards — both folders, the pipelines with their Results and Feedback, the frames, the sensors with their optics, calibrations and media endpoints — was never added to the index. Browsing *forward from a parent* worked, because that walks `NodeState.Children` in memory; browsing any of those nodes *by its own NodeId* returned `BadNodeIdUnknown`, which is how an ordinary client and the MCP discovery tools navigate. Registration is now deferred and flushed after each configurator. The first fix covered only the DI path and left the documented non-DI fallback broken in exactly the same way, so `ConfigureVisionAsync` now exists and registers what it builds. That defect survived a green suite because every test browsed children. The new tests assert by NodeId, and were checked against the broken code — with the flush removed, they fail. **Every Method was uncallable.** The Server passed 426 unit tests while not one of its Methods could be invoked over a real session — `RunInference` returned `Bad_TooManyArguments`, and so did every other Method that takes arguments, which is all of them but `StartContinuous` and `Stop`. Three independent faults, each sufficient on its own: the Method nodes were never created (they are Optional children, and the dispatcher guards every attachment with a null check, so it silently attached nothing); nothing declared the arguments, so the stack concluded none were expected; and `MethodDeclarationId` pointed at a synthesised NodeId rather than the NodeSet declaration a client calls with, so the lookup missed the instance Method entirely. The builder now creates the Methods, the `Results` folder and the `Feedback` object when a provider or sink is configured, declares every signature, and names the right declaration. Unit tests could not have caught this: they invoke the handler delegates directly and never go through `MethodState.Call`. It took an end-to-end test over a real session. Relatedly, children created by the generated `CreateOrReplace` helpers carry no `ReferenceTypeId`, so nothing could reach them — fixed once in the build context rather than at the several dozen call sites. **And one where I was wrong.** Earlier in this branch I reversed my own agents' decision and made `SubmitDetections` accept an empty detection set, reasoning that "I looked and the bin is empty" is a correct observation and refusing it forces a correct agent to invent a detection. The reasoning is sound; it is also an argument *against* the specification rather than an implementation of it. §9.5 is normative and explicit — its StatusCode table lists `Bad_InvalidArgument` for "`Detections` empty; or `SubmitCorrection` supplies both or neither corrected array". Worse, **none of §9.5's argument rules were enforced anywhere** — the dispatcher forwarded every submission straight to the feedback sink, so conformance depended on whichever sink a host installed. They are Server obligations, so they now live in the dispatcher, ahead of the sink, proven by strict mocks that would throw if the sink were consulted. The usability problem is real and does not go away by conforming, so it is raised where it can be fixed: [opcua-drafts#70](https://github.com/marcschier/opcua-drafts/issues/70). ## Tracking the updated drafts The Vision, Robot Intent and AI Model Management NodeSets on `opcua-drafts` `main` have moved, partly because of feedback this branch raised. All three are re-vendored byte-identically — verified by comparing git blob hashes against the upstream files rather than by eye — and the implementations follow. **Two statements that were previously inexpressible now have a wire representation.** `SubmitDetections` takes `SceneIsEmpty` and `SubmitCorrection` takes `RetractAll`, so an agent can report "I examined this frame and there is nothing in it" — the terminating condition of the bin-picking task — and can retract a false positive by correcting a result down to nothing. Both are checked in both directions, because the flag is exactly what separates a deliberate empty observation from a lost payload: an empty array without the flag is refused, and the flag with an array attached is refused as two contradictory claims about one frame. Implemented in the dispatcher, the client, the MCP tools the agent drives, and the sample cell. Also absorbed: `LampType` and `LightingMode` became enums (§66), `ProfileName` became `DefaultProfileName` on the endpoint (distinct from the `ProfileName` a caller passes to `GetStreamEndpoint`, which keeps its name), AI `Invoke`/`InvokeAsync` gained `PayloadUri` under the same exactly-one rule, and AI `ListModels` gained a `ContinuationPoint` — because `MaxResults` alone puts everything past the bound permanently out of reach. **OpenUSD is on `0.9.0-alpha`**, verified on the running cell rather than by restore alone: D3D12 backend, 612×512 frame, the bin and all five parts in view and detected — the same result `0.8.0-alpha` produced. The one local workaround that survives is `VisionMethodArguments`, and its reason has changed rather than gone away: the builder materialises these Methods as Optional children through `CreateOrReplace`, which constructs the state object directly and never runs the generated factory that now carries the signatures. Checked rather than assumed — removing the declarations fails five of the eight `VisionMethodSurfaceTests`. ## Review feedback Three threads, all addressed in `0fe2803a3`: - **The AI Model Management work is now a library family, not a sample.** `src/Opc.Ua.AI` (model), `.Inference` (`IInferenceBackend` and backends), `.Server` (node manager) and `.Client` (discovery, reads, calls, artefact transfer), in the same shape as the Robotics and Vision families; the samples become `samples/AI/ModelManagementServer` and `ModelManagementClient`. The client library needed real work rather than relocation: its browsing surface was `private` inside the sample's scenario runner, so moving the file alone would have produced a library nobody could call. - **No cloud-vendor SDK is referenced anywhere.** Inference goes through `Microsoft.Extensions.AI` — an `IChatClient` is implemented by hosted services and on-device runtimes alike, which is exactly the property clause 8.1 asserts. `Azure.Identity` is gone: workload identity is not an Azure feature, every platform projects a token into a file and each SDK reads that file behind its own API, so the resolver reads it directly. The comment claiming `Microsoft.Extensions.AI` would force a `System.Text.Json` bump was stale — it pins 10.0.10, which this repository already centralises on. - **`BinPickingCell` and `BinPickingClient` moved into `samples/Robotics/`**, which is where they belonged: the cell was already linking the arm, its kinematics and both USD assets out of `IntentEnabledRobot`. ## Upstream Work that belonged elsewhere went elsewhere rather than being worked around locally: - **`openusd-dotnet` [#13](https://github.com/marcschier/openusd-dotnet/pull/13)** — merged and shipped in `0.8.0-alpha`. `SilkFrameCapture.Capture` rendered only the first capture of a session and silently returned a blank frame for every one after it. Also filed [#14](https://github.com/marcschier/openusd-dotnet/issues/14) (no camera-by-prim API) and [#15](https://github.com/marcschier/openusd-dotnet/issues/15) (skipped tests reported as passed — which fooled me for several runs). Both are fixed; this branch takes `0.8.0-alpha` and deletes two workarounds, including 143 lines of hand-rolled projection maths. - **`opcua-drafts` [#66](https://github.com/marcschier/opcua-drafts/issues/66)–[#69](https://github.com/marcschier/opcua-drafts/issues/69)** — a close read of the spec produced 22 candidate ambiguities; 12 were discarded as misreadings with clause citations and the remaining 10 filed. One is concrete: five members exist in the NodeId CSV that no clause documents. - **`opcua-drafts` [#70](https://github.com/marcschier/opcua-drafts/issues/70)** — §9.5 could not express an empty observation or a false-positive retraction. **Adopted**, with the explicit-flag resolution argued for: `SubmitDetections` gained `SceneIsEmpty`, `SubmitCorrection` gained `RetractAll`, and the corrected-array rule relaxed from *exactly one* to *at most one*. - **`opcua-drafts` [#71](https://github.com/marcschier/opcua-drafts/issues/71)** — the Vision NodeSet browse-named all 13 `InputArguments` / `OutputArguments` Properties in the Vision namespace rather than the base namespace, so a stack could not find them and every Method in the specification was uncallable. **Fixed**; this branch now tracks the corrected artefact. ## The defect underneath it all The end-to-end suite was removed earlier in this branch because nine of its fourteen tests failed on one symptom: a client could not open a pipeline's `Feedback` object or enumerate its `Results`, even though browsing the same parent listed both. Restoring it meant explaining that, and the explanation was not in Vision. `RelativePathElement` initialised **`IsInverse` to `true`**. A caller that sets a `ReferenceTypeId` and a `TargetName` — which reads as *"the child reached by this Reference"* — was therefore asking the Server for the **inverse** Reference, and got `Bad_NoMatch` with nothing in the request to suggest why. `ObjectTypeClient.ResolveChildNodeIdAsync` is such a caller, and it is what **every source-generated Optional-child accessor in the stack** is built on — the accessor whose own documentation cites `AlarmConditionTypeClient.GetShelvingStateAsync` as an example. Vision is merely where it surfaced, because Vision puts two Optional children on the path an off-Server agent must take. The sibling helper in `StateMachineTypeClientExtensions` already set `IsInverse = false` by hand, which is the shape of a trap rather than a default. The default is now forward, `ResolveChildNodeIdAsync` says so explicitly, and the existing test that had recorded `true` as *expected* now pins `false` with the reasoning. Of the forty `RelativePathElement` construction sites in the tree, that accessor was **the only one relying on the default at all** — every deliberate caller already set it. Two further defects were found underneath it, both real and both fixed: - The generated `CreateOrReplace` helpers construct a child state object directly and leave **`TypeDefinitionId`** unset as well as `ReferenceTypeId`. A child referenced by nothing cannot be browsed; one with no type definition is a malformed Object that a client filtering by type silently skips — which is exactly what `EnumerateResultsAsync` does. Normalisation moved to `VisionNodeManager`, so it also covers the case the builder cannot see: a result published **at runtime** by an inference provider, long after the address space was built. That path produced results a client could list but not read. - `Opc.Ua.AI` shipped without an `AssemblyInfo`, so the solution built with six `CA1014` warnings. I had initially "fixed" this in the Vision client with Browse-based fallbacks, on the strength of a probe that appeared to show `TranslateBrowsePathsToNodeIds` failing even for `Server → ServerStatus`. That probe was wrong: it used an unqualified `ReferenceTypeIds`, which inside a `Opc.Ua.Vision.*` namespace binds to *Vision's* `ReferenceTypeIds` and yields a nonsense NodeId. Chasing that to the end is what turned up the real cause. **The fallbacks are gone** — they would have hidden a stack-wide bug behind a Vision-shaped workaround, and one of them matched on browse name while ignoring the namespace index. `tests/Opc.Ua.Vision.Intent.Tests` is restored and back in `UA.slnx`, passing **14/14** on its own merit rather than through a client-side workaround. A registration test now pins the pipeline's `Feedback` and `Results` children, which nothing covered before. ## Running it, and what that found The demo's premise is that a language model **looks at the bin and reasons about what it sees**. Running it end to end showed it could not, for reasons no test covered, because every one of them lived between components. **The sample did not compile.** Two `CS8604` nullable errors with `TreatWarningsAsErrors`, so neither the cell server nor the demo could be started at all. Worth recording that my first explanation was wrong: CI *does* build this project - the Linux leg's `net10.0` pass compiles it, log-confirmed - so this is not a coverage gap in the workflow, and no workflow change was made. **`Pick` and `Place` never moved the arm.** They were a delay plus a gripper action, so the operations reported `Succeeded` while nothing travelled. They now solve IK once and interpolate in joint space. **And the parts never moved**: the arm swung but the bin stayed full, because nothing tied the held object to the world state. The connector now creates 11 monitored items where it created 6, and a scripted run delivers `SeqNo=151` across 10 messages where it delivered `SeqNo=3` across 1. **The frame was smuggled through a string field.** The media provider put a base64 *data URI* of the PNG into `VisionImageReferenceDataType.Uri` - a field meant to be a *reference*, while the bytes were already returned in the inline `ByteString`. Every response therefore shipped the image twice, and a 1,311,400-byte PNG became a 1,748,536-character string against a `MaxStringLength` of 65,535: **26.7x over**. That is why raising `MaxByteStringLength`, `MaxArrayLength` and `MaxMessageSize` never helped - none of them govern a `String`. Separately the MCP tool assigned raw bytes where `ImageContentBlock` requires base64, so the wire carried `"data":"�PNG..."` - every non-UTF-8 byte replaced by U+FFFD, destroying the image and inflating the response to 6.8 MB. **The camera was aimed at nothing.** The arm's home pose, the flange scan pose the Vision model declared and the joint angles in the USD stage were three independent claims about where the camera was, and they disagreed - the declared flange orientation pointed the view 86 degrees away from the projection camera. Solving them as one thing exposed two further constraints that are easy to miss: the camera has to sit off the tool axis or it photographs its own gripper, and the IK branch has to be elbow-back or a link parks under the camera and fills the frame with the arm's own upper arm. A third was a regression this branch introduced and `Opc.Ua.Robotics.Tests` caught - aiming a straight-down camera from a point on the base's own X-Z plane puts the wrist on the J4/J6 singularity, so every motion away from home fails to solve. A 15-degree camera roll, free because the camera still looks straight down, gets 25 degrees clear, which is the margin the poses before this branch had. **The frame and the detections were different images.** The sensor declared 2448x2048, the clip endpoint 1280x1024, and the renderer produced 640x512 - not even the same aspect ratio. The ground-truth detector projects through the declared intrinsics, so its boxes lived in 2448x2048 space while an agent was handed a 640x512 picture: *"pick the red cube you can see"* arrived with coordinates that pointed off the image. Everything now agrees at 612x512, an exact 4x4 bin of the native sensor with the intrinsics scaled to match; the native size stays in the model and serial number, where it describes the hardware rather than the image. **`LatestClip` was created and never written**, so it reported `Bad_NoDataAvailable` for the life of the Server and a consumer following the model - read the published frame, call the method only if there is none - never got a frame. The dispatcher now publishes a clip it has just encoded, for every Vision server rather than this sample alone. One genuine API gap turned up on the way: `OpcUaServerOptions` exposes `MaxByteStringLength`, `MaxArrayLength` and `MaxMessageSize` and **no `MaxStringLength`**, so a Server that legitimately needs a long string could not raise the limit through the hosting API at all. Added, with tests. It is not the fix for anything above - that was a design bug - but the missing knob was real. ## Not finished - **Two projects sit below the repository's 80% line coverage.** `Opc.Ua.Vision.OpenUsd` is at 71.1% — what is left only executes with a real OpenUSD stage and plugin tree, which is not on every build agent. `Opc.Ua.AI.Inference` is now at **86.7%**, up from 12.9%: the code this branch *wrote* is covered by 25 tests, and `RestChatCompletionsBackend` — previously the whole of the shortfall — is covered by 18 more against a stubbed `HttpMessageHandler`, exercising success, refusal, throttling, retry-after, timeout and cancellation without a network. Everything else clears the bar — `Opc.Ua.Vision.Server` 92.1%, `Opc.Ua.AI` 91.4%, `.Vision.Client` 88.1%, `Opc.Ua.Vision` 85.7%, `Opc.Ua.AI.Server` 80.1%, all measured with coverlet. The CI coverage gate reports itself as advisory and non-blocking. - **`SamplesCollected` is not counted here, and `docs/Vision.md` now says so.** Section 9.4 requires a Server to count a negative example (`SceneIsEmpty` / `RetractAll` carrying a `GroundTruthLabel`) exactly as it counts one carrying geometry. `VisionNodeManager` does not, and structurally cannot: `SamplesCollected` is a property of `LearningJobType`, which the *AI Model Management* companion defines, and Vision reaches the job through a `NodeId` value rather than a Reference **precisely so this model takes no dependency on the model that defines it**. What the Server does guarantee is that the negative example survives the hop intact — both flags are carried verbatim to `IVisionFeedbackSink` — so a host that binds a learning job has everything it needs to satisfy the clause on the counter it owns. Stated in the limitations rather than left implied. ## Related Issues Was stacked on #4195, now merged. No tracking issue yet for the Vision implementation itself — happy to open one if you would like the design recorded as an ADR before this goes further. ## Checklist - [x] I have signed the [CLA](https://opcfoundation.org/license/cla/ContributorLicenseAgreementv1.0.pdf) and read the [CONTRIBUTING](https://github.com/OPCFoundation/UA-.NETStandard/blob/master/CONTRIBUTING.md) doc. - [x] I have added tests that prove my fix is effective or that my feature works and increased code coverage. — *Types 8562, Server 4072, Client 2123, InformationModel 1063, Robotics 540, Tools 466, Vision 442, AI 74 and the restored Vision+Intent end-to-end suite 14/14, all green on net10.0. Only `.OpenUsd` (71.1%) is below the 80% bar — see Not finished.* - [x] I have added all necessary documentation. - [x] I have verified that my changes do not introduce (new) build or analyzer warnings. — *`dotnet build UA.slnx -c Release`: 0 errors, 0 warnings.* - [x] I ran **all** tests locally using the **UA.slnx** solution against at least .net **framework** and .net **10**, and all passed. — *net48: Types 8555, Client 2126, Vision 385 green. Two net48 Server tests fail (`CreateUserManagementSeamBindsTheModelToTheServerAsync`, and `DurableDataValueQueueVerifyReferenceBatchingAsync` only under parallel load); both were confirmed **pre-existing** by re-running them with the `IsInverse` change reverted, which fails identically.* - [ ] I fixed **all** failing and flaky tests in the CI pipelines and **all** CodeQL warnings. — *The net48 build legs failed because the restored end-to-end project used `ValueTask.FromResult` / `string.Create`, which do not exist on .NET Framework; fixed in `fb57522da` and verified building on every TFM. `DisposeDrainsHeldConnectionCallbackBeforeListenerDisposal` failed once on the Ubuntu Client leg — a 13 ms timing-sensitive reverse-connect disposal test that passes locally 2123/2123 and touches no browse paths.* - [ ] I have addressed **all** PR feedback received. ## Typed Vision-guided Robotics MCP workflows The branch now also makes the demo workflow first-class in the Full MCP profile: - replaces stringified Robotics intent and mission inputs with typed request schemas and exact name-or-NodeId selectors; - adds bounded operation/mission paging, stable step-to-operation identity, retained mission discovery, and `robotics_wait_mission`; - makes `vision_run_inference` return bounded typed detection, inspection, or segmentation summaries in one call; - adds same-session `robotics_vision_pick` to select a detection and submit Pick or Pick/Place work without implicitly taking authority, retrying, cancelling, or waiting; and - starts Publish workers for classic subscriptions so an independently launched OpenUSD viewer receives live robot and part updates. The migration guide documents the intentionally breaking MCP request-schema changes. --------- Co-authored-by: Copilot <223556219+Copilot@users.noreply.github.com> Copilot-Session: 1dab1302-19c5-4a9b-a50c-d97d389713aa Copilot-Session: a248a589-9a20-4372-868e-5d347e57001b Copilot-Session: 99d1ab42-f83a-41ab-bf3e-85bf81fadace Copilot-Session: bcbc8ac9-5abd-42a8-8bac-e10533790e2e
1440 lines
60 KiB
C#
1440 lines
60 KiB
C#
/* ========================================================================
|
|
* Copyright (c) 2005-2026 The OPC Foundation, Inc. All rights reserved.
|
|
*
|
|
* OPC Foundation MIT License 1.00
|
|
*
|
|
* Permission is hereby granted, free of charge, to any person
|
|
* obtaining a copy of this software and associated documentation
|
|
* files (the "Software"), to deal in the Software without
|
|
* restriction, including without limitation the rights to use,
|
|
* copy, modify, merge, publish, distribute, sublicense, and/or sell
|
|
* copies of the Software, and to permit persons to whom the
|
|
* Software is furnished to do so, subject to the following
|
|
* conditions:
|
|
*
|
|
* The above copyright notice and this permission notice shall be
|
|
* included in all copies or substantial portions of the Software.
|
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
|
|
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES
|
|
* OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
|
|
* NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT
|
|
* HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY,
|
|
* WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
|
|
* FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
|
|
* OTHER DEALINGS IN THE SOFTWARE.
|
|
*
|
|
* The complete license agreement can be found here:
|
|
* http://opcfoundation.org/License/MIT/1.00/
|
|
* ======================================================================*/
|
|
|
|
using System;
|
|
using System.Collections.Concurrent;
|
|
using System.Collections.Generic;
|
|
using System.IO;
|
|
using System.Reflection;
|
|
using System.Runtime.CompilerServices;
|
|
using System.Threading;
|
|
using System.Threading.Tasks;
|
|
using Microsoft.Extensions.DependencyInjection;
|
|
using Microsoft.Extensions.Logging;
|
|
using Microsoft.Extensions.Logging.Abstractions;
|
|
using Moq;
|
|
using NUnit.Framework;
|
|
using Opc.Ua.Client;
|
|
using Opc.Ua.Client.Subscriptions.Streaming;
|
|
using Opc.Ua.Robotics.Client.Intent;
|
|
using Opc.Ua.RobotIntent;
|
|
using Opc.Ua.Tests;
|
|
|
|
namespace Opc.Ua.Robotics.Client.Tests
|
|
{
|
|
[TestFixture]
|
|
[Category("Robotics")]
|
|
public sealed class IntentClientRuntimeTests
|
|
{
|
|
[TestCaseSource(nameof(TerminalExecutionStates))]
|
|
public async Task OperationHandleCompletesOnTerminalStates(ExecutionStateEnum state)
|
|
{
|
|
FakeRobotIntentTransport transport = new()
|
|
{
|
|
Snapshot = Snapshot(state)
|
|
};
|
|
RobotIntentControllerClient controller = new(transport);
|
|
|
|
await using IntentOperationHandle handle = await controller.TrackOperationAsync(
|
|
"i1",
|
|
new NodeId(10)).ConfigureAwait(false);
|
|
|
|
IntentResultDataType result = await AwaitWithTimeoutAsync(handle.Completion, s_handshakeTimeout).ConfigureAwait(false);
|
|
|
|
Assert.That(result.State, Is.EqualTo(state));
|
|
}
|
|
|
|
[Test]
|
|
public async Task OperationHandleReadsInitialStateAfterSubscribing()
|
|
{
|
|
FakeRobotIntentTransport transport = new()
|
|
{
|
|
Snapshot = Snapshot(ExecutionStateEnum.Succeeded)
|
|
};
|
|
RobotIntentControllerClient controller = new(transport);
|
|
|
|
await using IntentOperationHandle handle = await controller.TrackOperationAsync(
|
|
"i1",
|
|
new NodeId(10)).ConfigureAwait(false);
|
|
|
|
Assert.That(await AwaitWithTimeoutAsync(handle.Completion, s_handshakeTimeout).ConfigureAwait(false), Is.Not.Null);
|
|
Assert.That(transport.SubscribeCount, Is.EqualTo(1));
|
|
Assert.That(transport.ReadSnapshotCount, Is.EqualTo(1));
|
|
}
|
|
|
|
[Test]
|
|
public async Task OperationHandleWaitsForResultAfterTerminalStateNotification()
|
|
{
|
|
FakeRobotIntentTransport transport = new()
|
|
{
|
|
Snapshot = new IntentOperationSnapshot
|
|
{
|
|
Operation = new NodeId(10),
|
|
ExecutionState = ExecutionStateEnum.Executing
|
|
}
|
|
};
|
|
RobotIntentControllerClient controller = new(transport);
|
|
|
|
await using IntentOperationHandle handle = await controller.TrackOperationAsync(
|
|
"i1",
|
|
new NodeId(10)).ConfigureAwait(false);
|
|
transport.PublishChange("ExecutionState", Variant.From((int)ExecutionStateEnum.Succeeded));
|
|
Task early = await Task.WhenAny(handle.Completion, Task.Delay(100)).ConfigureAwait(false);
|
|
|
|
IntentResultDataType expected = new()
|
|
{
|
|
IntentId = "i1",
|
|
State = ExecutionStateEnum.Succeeded
|
|
};
|
|
transport.PublishChange("Result", Variant.FromStructure(expected));
|
|
IntentResultDataType result = await AwaitWithTimeoutAsync(handle.Completion, s_handshakeTimeout).ConfigureAwait(false);
|
|
|
|
Assert.Multiple(() =>
|
|
{
|
|
Assert.That(early, Is.Not.SameAs(handle.Completion));
|
|
Assert.That(result.IntentId, Is.EqualTo("i1"));
|
|
Assert.That(result.State, Is.EqualTo(ExecutionStateEnum.Succeeded));
|
|
});
|
|
}
|
|
|
|
[Test]
|
|
public async Task OperationHandleRereadsAfterReconnect()
|
|
{
|
|
FakeRobotIntentTransport transport = new()
|
|
{
|
|
Snapshot = Snapshot(ExecutionStateEnum.Executing)
|
|
};
|
|
RobotIntentControllerClient controller = new(transport);
|
|
|
|
await using IntentOperationHandle handle = await controller.TrackOperationAsync(
|
|
"i1",
|
|
new NodeId(10)).ConfigureAwait(false);
|
|
transport.Snapshot = Snapshot(ExecutionStateEnum.Succeeded);
|
|
transport.PublishReconnect();
|
|
IntentResultDataType result = await AwaitWithTimeoutAsync(handle.Completion, s_handshakeTimeout).ConfigureAwait(false);
|
|
|
|
Assert.That(result.State, Is.EqualTo(ExecutionStateEnum.Succeeded));
|
|
Assert.That(transport.ReadSnapshotCount, Is.GreaterThanOrEqualTo(2));
|
|
}
|
|
|
|
[Test]
|
|
public async Task CancelRefusalIsReturnedNotThrown()
|
|
{
|
|
FakeRobotIntentTransport transport = new()
|
|
{
|
|
CancelOutcome = new IntentCommandOutcome(false),
|
|
Snapshot = Snapshot(ExecutionStateEnum.Executing)
|
|
};
|
|
RobotIntentControllerClient controller = new(transport);
|
|
|
|
await using IntentOperationHandle handle = await controller.TrackOperationAsync(
|
|
"i1",
|
|
new NodeId(10)).ConfigureAwait(false);
|
|
IntentCommandOutcome outcome = await handle.CancelAsync(StopModeEnum.QuickStop).ConfigureAwait(false);
|
|
|
|
Assert.Multiple(() =>
|
|
{
|
|
Assert.That(outcome.Accepted, Is.False);
|
|
Assert.That(transport.CancelIntentCount, Is.EqualTo(1));
|
|
Assert.That(transport.LastCancelIntentId, Is.EqualTo("i1"));
|
|
Assert.That(transport.LastCancelStopMode, Is.EqualTo(StopModeEnum.QuickStop));
|
|
});
|
|
}
|
|
|
|
[Test]
|
|
public async Task OperationHandleCommandMethodsDelegateToTransport()
|
|
{
|
|
FakeRobotIntentTransport transport = new()
|
|
{
|
|
PauseOutcome = new IntentCommandOutcome(false),
|
|
ResumeOutcome = new IntentCommandOutcome(true),
|
|
RetryResult = new IntentSubmissionResult
|
|
{
|
|
Accepted = false,
|
|
IntentId = "i1",
|
|
Failure = IntentFailureEnum.Other,
|
|
Message = new LocalizedText("retry refused")
|
|
},
|
|
Snapshot = Snapshot(ExecutionStateEnum.Executing)
|
|
};
|
|
RobotIntentControllerClient controller = new(transport);
|
|
|
|
await using IntentOperationHandle handle = await controller.TrackOperationAsync(
|
|
"i1",
|
|
new NodeId(10)).ConfigureAwait(false);
|
|
|
|
IntentCommandOutcome pause = await handle.PauseAsync().ConfigureAwait(false);
|
|
IntentCommandOutcome resume = await handle.ResumeAsync().ConfigureAwait(false);
|
|
IntentSubmissionResult retry = await handle.RetryAsync().ConfigureAwait(false);
|
|
|
|
Assert.Multiple(() =>
|
|
{
|
|
Assert.That(pause.Accepted, Is.False);
|
|
Assert.That(resume.Accepted, Is.True);
|
|
Assert.That(retry.Accepted, Is.False);
|
|
Assert.That(retry.Message.Text, Is.EqualTo("retry refused"));
|
|
Assert.That(transport.PauseCount, Is.EqualTo(1));
|
|
Assert.That(transport.ResumeCount, Is.EqualTo(1));
|
|
Assert.That(transport.RetryCount, Is.EqualTo(1));
|
|
Assert.That(transport.LastRetryIntentId, Is.EqualTo("i1"));
|
|
});
|
|
}
|
|
|
|
[Test]
|
|
public async Task CancellingDoesNotCompleteOperationHandle()
|
|
{
|
|
FakeRobotIntentTransport transport = new()
|
|
{
|
|
Snapshot = Snapshot(ExecutionStateEnum.Cancelling)
|
|
};
|
|
RobotIntentControllerClient controller = new(transport);
|
|
|
|
await using IntentOperationHandle handle = await controller.TrackOperationAsync(
|
|
"i1",
|
|
new NodeId(10)).ConfigureAwait(false);
|
|
Task completed = await Task.WhenAny(handle.Completion, Task.Delay(100)).ConfigureAwait(false);
|
|
|
|
Assert.That(completed, Is.Not.SameAs(handle.Completion));
|
|
}
|
|
|
|
[Test]
|
|
public async Task MissionHandleReadsInitialStateAfterSubscribing()
|
|
{
|
|
FakeRobotIntentTransport transport = new()
|
|
{
|
|
MissionSnapshot = MissionSnapshot(ExecutionStateEnum.Succeeded)
|
|
};
|
|
RobotIntentControllerClient controller = new(transport);
|
|
|
|
await using MissionHandle handle = await controller.TrackMissionAsync(
|
|
"mission-1",
|
|
new NodeId(20)).ConfigureAwait(false);
|
|
|
|
MissionSnapshot terminal = await AwaitWithTimeoutAsync(handle.Completion, TimeSpan.FromSeconds(1)).ConfigureAwait(false);
|
|
|
|
Assert.Multiple(() =>
|
|
{
|
|
Assert.That(terminal.ExecutionState, Is.EqualTo(ExecutionStateEnum.Succeeded));
|
|
Assert.That(transport.SubscribeCount, Is.EqualTo(1));
|
|
Assert.That(transport.ReadMissionSnapshotCount, Is.EqualTo(1));
|
|
});
|
|
}
|
|
|
|
[Test]
|
|
public async Task MissionHandleRefreshesAfterReconnect()
|
|
{
|
|
FakeRobotIntentTransport transport = new()
|
|
{
|
|
MissionSnapshot = MissionSnapshot(ExecutionStateEnum.Executing)
|
|
};
|
|
RobotIntentControllerClient controller = new(transport);
|
|
|
|
await using MissionHandle handle = await controller.TrackMissionAsync(
|
|
"mission-1",
|
|
new NodeId(20)).ConfigureAwait(false);
|
|
transport.MissionSnapshot = MissionSnapshot(ExecutionStateEnum.Failed) with
|
|
{
|
|
Failure = IntentFailureEnum.Other,
|
|
FailureMessage = new LocalizedText("executor failure")
|
|
};
|
|
transport.PublishReconnect();
|
|
|
|
MissionSnapshot terminal = await AwaitWithTimeoutAsync(handle.Completion, TimeSpan.FromSeconds(1)).ConfigureAwait(false);
|
|
|
|
Assert.Multiple(() =>
|
|
{
|
|
Assert.That(terminal.ExecutionState, Is.EqualTo(ExecutionStateEnum.Failed));
|
|
Assert.That(terminal.Failure, Is.EqualTo(IntentFailureEnum.Other));
|
|
Assert.That(terminal.FailureMessage.Text, Is.EqualTo("executor failure"));
|
|
Assert.That(transport.ReadMissionSnapshotCount, Is.GreaterThanOrEqualTo(2));
|
|
});
|
|
}
|
|
|
|
[Test]
|
|
public async Task MissionHandleTimeoutRemainsIncompleteWhenRefreshObservesTerminalState()
|
|
{
|
|
FakeRobotIntentTransport transport = new()
|
|
{
|
|
MissionSnapshot = MissionSnapshot(ExecutionStateEnum.Executing)
|
|
};
|
|
RobotIntentControllerClient controller = new(transport);
|
|
|
|
await using MissionHandle handle = await controller.TrackMissionAsync(
|
|
"mission-1",
|
|
new NodeId(20)).ConfigureAwait(false);
|
|
transport.MissionSnapshot = MissionSnapshot(ExecutionStateEnum.Succeeded);
|
|
|
|
MissionWaitResult result = await handle.WaitForCompletionAsync(TimeSpan.Zero).ConfigureAwait(false);
|
|
|
|
Assert.Multiple(() =>
|
|
{
|
|
Assert.That(result.Completed, Is.False);
|
|
Assert.That(result.Current.ExecutionState, Is.EqualTo(ExecutionStateEnum.Succeeded));
|
|
Assert.That(handle.Completion.IsCompleted, Is.True);
|
|
});
|
|
}
|
|
|
|
[Test]
|
|
public async Task MissionHandleCancellationDelegatesToTransport()
|
|
{
|
|
FakeRobotIntentTransport transport = new()
|
|
{
|
|
MissionSnapshot = MissionSnapshot(ExecutionStateEnum.Executing),
|
|
CancelMissionOutcome = new IntentCommandOutcome(false)
|
|
};
|
|
RobotIntentControllerClient controller = new(transport);
|
|
|
|
await using MissionHandle handle = await controller.TrackMissionAsync(
|
|
"mission-1",
|
|
new NodeId(20)).ConfigureAwait(false);
|
|
IntentCommandOutcome outcome = await handle.CancelAsync(StopModeEnum.QuickStop).ConfigureAwait(false);
|
|
|
|
Assert.Multiple(() =>
|
|
{
|
|
Assert.That(outcome.Accepted, Is.False);
|
|
Assert.That(transport.CancelMissionCount, Is.EqualTo(1));
|
|
Assert.That(transport.LastCancelMissionId, Is.EqualTo("mission-1"));
|
|
Assert.That(transport.LastCancelMissionStopMode, Is.EqualTo(StopModeEnum.QuickStop));
|
|
});
|
|
}
|
|
|
|
[Test]
|
|
public async Task MissionHandleDisposalStopsItsSubscription()
|
|
{
|
|
FakeRobotIntentTransport transport = new()
|
|
{
|
|
MissionSnapshot = MissionSnapshot(ExecutionStateEnum.Executing)
|
|
};
|
|
RobotIntentControllerClient controller = new(transport);
|
|
MissionHandle handle = await controller.TrackMissionAsync("mission-1", new NodeId(20)).ConfigureAwait(false);
|
|
await WaitUntilAsync(
|
|
() => transport.ActiveSubscriptionCount == 1,
|
|
TimeSpan.FromSeconds(1)).ConfigureAwait(false);
|
|
|
|
await handle.DisposeAsync().ConfigureAwait(false);
|
|
|
|
await WaitUntilAsync(
|
|
() => transport.ActiveSubscriptionCount == 0,
|
|
TimeSpan.FromSeconds(1)).ConfigureAwait(false);
|
|
Assert.That(transport.ActiveSubscriptionCount, Is.Zero);
|
|
}
|
|
|
|
[Test]
|
|
public async Task AuthorityLeaseReleasesOnDisposeAndReportsLoss()
|
|
{
|
|
FakeRobotIntentTransport transport = new()
|
|
{
|
|
AuthorityOutcome = new CommandAuthorityOutcome(true, new NodeId(1)),
|
|
ControlOwner = new NodeId(1)
|
|
};
|
|
RobotIntentControllerClient controller = new(transport);
|
|
|
|
await using (CommandAuthorityLease lease = await controller.RequestAuthorityAsync().ConfigureAwait(false))
|
|
{
|
|
transport.ControlOwner = new NodeId(2);
|
|
transport.PublishOwner(new NodeId(2));
|
|
await WaitUntilAsync(() => Equals(lease.CurrentOwner, new NodeId(2)), s_handshakeTimeout)
|
|
.ConfigureAwait(false);
|
|
|
|
Assert.That(lease.CurrentOwner, Is.EqualTo(new NodeId(2)));
|
|
}
|
|
Assert.That(transport.ReleaseCount, Is.EqualTo(1));
|
|
}
|
|
|
|
[Test]
|
|
public async Task AuthorityLeaseKeepsGrantWhenInitialNotificationIsOwnOwner()
|
|
{
|
|
NodeId owner = new(1);
|
|
FakeRobotIntentTransport transport = new()
|
|
{
|
|
AuthorityOutcome = new CommandAuthorityOutcome(true, owner),
|
|
ControlOwner = owner
|
|
};
|
|
RobotIntentControllerClient controller = new(transport);
|
|
|
|
await using CommandAuthorityLease lease = await controller.RequestAuthorityAsync().ConfigureAwait(false);
|
|
int notifications = 0;
|
|
lease.OwnerChanged += _ => Interlocked.Increment(ref notifications);
|
|
transport.PublishOwner(owner);
|
|
await WaitUntilAsync(() => Volatile.Read(ref notifications) > 0, s_handshakeTimeout)
|
|
.ConfigureAwait(false);
|
|
|
|
Assert.Multiple(() =>
|
|
{
|
|
Assert.That(lease.Granted, Is.True);
|
|
Assert.That(lease.CurrentOwner, Is.EqualTo(owner));
|
|
});
|
|
}
|
|
|
|
[Test]
|
|
public async Task AuthorityLeaseDisposeIsIdempotentAndReleasesOnce()
|
|
{
|
|
FakeRobotIntentTransport transport = new()
|
|
{
|
|
AuthorityOutcome = new CommandAuthorityOutcome(true, new NodeId(1)),
|
|
ControlOwner = new NodeId(1)
|
|
};
|
|
RobotIntentControllerClient controller = new(transport);
|
|
CommandAuthorityLease lease = await controller.RequestAuthorityAsync().ConfigureAwait(false);
|
|
|
|
await lease.DisposeAsync().ConfigureAwait(false);
|
|
Assert.DoesNotThrowAsync(async () => await lease.DisposeAsync().ConfigureAwait(false));
|
|
|
|
Assert.That(transport.ReleaseCount, Is.EqualTo(1));
|
|
}
|
|
|
|
[Test]
|
|
public async Task AuthorityLeaseDisposeAfterClosedSessionDoesNotThrow()
|
|
{
|
|
FakeRobotIntentTransport transport = new()
|
|
{
|
|
AuthorityOutcome = new CommandAuthorityOutcome(true, new NodeId(1)),
|
|
ControlOwner = new NodeId(1),
|
|
ReleaseException = ServiceResultException.Create(StatusCodes.BadSessionClosed, "closed")
|
|
};
|
|
RobotIntentControllerClient controller = new(transport);
|
|
CommandAuthorityLease lease = await controller.RequestAuthorityAsync().ConfigureAwait(false);
|
|
|
|
Assert.DoesNotThrowAsync(async () => await lease.DisposeAsync().ConfigureAwait(false));
|
|
Assert.DoesNotThrowAsync(async () => await lease.DisposeAsync().ConfigureAwait(false));
|
|
|
|
Assert.That(transport.ReleaseCount, Is.EqualTo(1));
|
|
}
|
|
|
|
[Test]
|
|
public async Task AuthorityLeaseDisposeAfterRefusalDoesNotRelease()
|
|
{
|
|
FakeRobotIntentTransport transport = new()
|
|
{
|
|
AuthorityOutcome = new CommandAuthorityOutcome(false, new NodeId(2)),
|
|
ControlOwner = new NodeId(2)
|
|
};
|
|
RobotIntentControllerClient controller = new(transport);
|
|
CommandAuthorityLease lease = await controller.RequestAuthorityAsync().ConfigureAwait(false);
|
|
|
|
await lease.DisposeAsync().ConfigureAwait(false);
|
|
await lease.DisposeAsync().ConfigureAwait(false);
|
|
|
|
Assert.That(transport.ReleaseCount, Is.Zero);
|
|
}
|
|
|
|
[Test]
|
|
public async Task OperationHandleDisposeIsIdempotentDuringCallback()
|
|
{
|
|
FakeRobotIntentTransport transport = new()
|
|
{
|
|
Snapshot = Snapshot(ExecutionStateEnum.Executing)
|
|
};
|
|
RobotIntentControllerClient controller = new(transport);
|
|
IntentOperationHandle handle = await controller.TrackOperationAsync("i1", new NodeId(10)).ConfigureAwait(false);
|
|
var callbackEntered = new TaskCompletionSource<bool>(TaskCreationOptions.RunContinuationsAsynchronously);
|
|
using var allowCallbackToExit = new ManualResetEventSlim(false);
|
|
handle.Changed += _ =>
|
|
{
|
|
callbackEntered.TrySetResult(true);
|
|
Assert.That(allowCallbackToExit.Wait(s_handshakeTimeout), Is.True);
|
|
};
|
|
|
|
transport.PublishChange(Variant.From((int)ExecutionStateEnum.Succeeded));
|
|
await AwaitWithTimeoutAsync(callbackEntered.Task, s_handshakeTimeout).ConfigureAwait(false);
|
|
Task dispose = handle.DisposeAsync().AsTask();
|
|
allowCallbackToExit.Set();
|
|
|
|
Assert.DoesNotThrowAsync(async () => await dispose.ConfigureAwait(false));
|
|
Assert.DoesNotThrowAsync(async () => await handle.DisposeAsync().ConfigureAwait(false));
|
|
}
|
|
|
|
[Test]
|
|
public async Task MissionUpdateRejectsNonIncreasingIdLocally()
|
|
{
|
|
FakeRobotIntentTransport transport = new();
|
|
RobotIntentControllerClient controller = new(transport);
|
|
MissionDataType mission = RobotIntentBuilder.Mission("m1")
|
|
.WithMissionUpdateId(3)
|
|
.HorizonStep("a", RobotIntentBuilder.Wait(1).Build())
|
|
.Build();
|
|
|
|
_ = await controller.SubmitMissionAsync(mission).ConfigureAwait(false);
|
|
|
|
MissionUpdateOutcome outcome = await controller.UpdateMissionAsync("m1", 3, []).ConfigureAwait(false);
|
|
|
|
Assert.That(outcome.Result, Is.EqualTo(MissionUpdateResultEnum.Outdated));
|
|
Assert.That(transport.UpdateMissionCount, Is.Zero);
|
|
}
|
|
|
|
[Test]
|
|
public async Task MissionUpdateIdsAreTrackedPerMission()
|
|
{
|
|
FakeRobotIntentTransport transport = new();
|
|
RobotIntentControllerClient controller = new(transport);
|
|
|
|
_ = await controller.SubmitMissionAsync(RobotIntentBuilder.Mission("a")
|
|
.WithMissionUpdateId(5)
|
|
.HorizonStep("a1", RobotIntentBuilder.Wait(1).Build())
|
|
.Build()).ConfigureAwait(false);
|
|
_ = await controller.SubmitMissionAsync(RobotIntentBuilder.Mission("b")
|
|
.WithMissionUpdateId(1)
|
|
.HorizonStep("b1", RobotIntentBuilder.Wait(1).Build())
|
|
.Build()).ConfigureAwait(false);
|
|
MissionUpdateOutcome accepted = await controller.UpdateMissionAsync("b", 2, []).ConfigureAwait(false);
|
|
MissionUpdateOutcome outdated = await controller.UpdateMissionAsync("a", 4, []).ConfigureAwait(false);
|
|
|
|
Assert.Multiple(() =>
|
|
{
|
|
Assert.That(accepted.Result, Is.EqualTo(MissionUpdateResultEnum.Accepted));
|
|
Assert.That(outdated.Result, Is.EqualTo(MissionUpdateResultEnum.Outdated));
|
|
Assert.That(transport.UpdateMissionCount, Is.EqualTo(1));
|
|
Assert.That(transport.LastUpdateMissionId, Is.EqualTo("b"));
|
|
Assert.That(transport.LastMissionUpdateId, Is.EqualTo(2));
|
|
});
|
|
}
|
|
|
|
[Test]
|
|
public void RobotIntentClientRegistersEncodeablesForSessionFactory()
|
|
{
|
|
var telemetry = new Mock<ITelemetryContext>();
|
|
var sourceContext = ServiceMessageContext.Create(telemetry.Object);
|
|
sourceContext.NamespaceUris.GetIndexOrAppend("http://opcfoundation.org/UA/RobotIntent/");
|
|
sourceContext.Factory.Builder.AddOpcUaRobotIntent().Commit();
|
|
var targetContext = ServiceMessageContext.Create(telemetry.Object);
|
|
targetContext.NamespaceUris.GetIndexOrAppend("http://opcfoundation.org/UA/RobotIntent/");
|
|
var session = new Mock<ISession>();
|
|
session.SetupGet(s => s.Factory).Returns(targetContext.Factory);
|
|
session.SetupGet(s => s.MessageContext).Returns(targetContext);
|
|
|
|
Pose3DDataType pose = CreatePose();
|
|
byte[] encoded = EncodeExtensionObject(sourceContext, new ExtensionObject(pose.BinaryEncodingId, pose));
|
|
ExtensionObject undecoded = DecodeExtensionObject(targetContext, encoded);
|
|
Assert.That(undecoded.TryGetValue(out Pose3DDataType? undecodedPose, targetContext), Is.False);
|
|
|
|
_ = new RobotIntentClient(session.Object, telemetry.Object);
|
|
_ = new RobotIntentClient(session.Object, telemetry.Object);
|
|
|
|
ExtensionObject decoded = DecodeExtensionObject(targetContext, encoded);
|
|
|
|
Assert.That(decoded.TryGetValue(out Pose3DDataType? decodedPose, targetContext), Is.True);
|
|
Assert.That(decodedPose!.FrameId, Is.EqualTo("world"));
|
|
Assert.That(decodedPose.Position.Span[0], Is.EqualTo(1.0d));
|
|
}
|
|
|
|
[Test]
|
|
public async Task ChannelLeaseRenewsAndSurfacesRefusalMessage()
|
|
{
|
|
FakeRobotIntentTransport transport = new()
|
|
{
|
|
ChannelResult = new RealTimeChannelOpenResult
|
|
{
|
|
Granted = true,
|
|
EndpointUrl = "opc.tcp://rt",
|
|
PayloadDescriptor = "payload",
|
|
LeaseExpiry = new DateTimeUtc(DateTime.UtcNow.AddMilliseconds(30)),
|
|
Message = new LocalizedText("ok")
|
|
}
|
|
};
|
|
|
|
await using RealTimeChannelLease lease = new(transport, "rt1", TimeSpan.FromMilliseconds(30));
|
|
await lease.OpenAsync().ConfigureAwait(false);
|
|
await AwaitWithTimeoutAsync(transport.WaitForOpenChannelCountAsync(2), s_handshakeTimeout).ConfigureAwait(false);
|
|
|
|
Assert.That(transport.OpenChannelCount, Is.GreaterThan(1));
|
|
Assert.That(lease.EndpointUrl, Is.EqualTo("opc.tcp://rt"));
|
|
|
|
transport.ChannelResult = transport.ChannelResult with
|
|
{
|
|
Granted = false,
|
|
Message = new LocalizedText("busy")
|
|
};
|
|
await lease.RenewAsync().ConfigureAwait(false);
|
|
|
|
Assert.That(lease.Granted, Is.False);
|
|
Assert.That(lease.Message.Text, Is.EqualTo("busy"));
|
|
}
|
|
|
|
[Test]
|
|
public async Task ChannelLeaseRenewLoopRetriesAfterServiceFailure()
|
|
{
|
|
FakeRobotIntentTransport transport = new()
|
|
{
|
|
ChannelResult = new RealTimeChannelOpenResult
|
|
{
|
|
Granted = true,
|
|
EndpointUrl = "opc.tcp://rt",
|
|
LeaseExpiry = new DateTimeUtc(DateTime.UtcNow.AddMilliseconds(5))
|
|
}
|
|
};
|
|
transport.EnqueueChannelResult(transport.ChannelResult);
|
|
transport.EnqueueChannelFault(ServiceResultException.Create(StatusCodes.BadTimeout, "transient"));
|
|
transport.EnqueueChannelResult(new RealTimeChannelOpenResult
|
|
{
|
|
Granted = true,
|
|
EndpointUrl = "opc.tcp://rt2",
|
|
LeaseExpiry = new DateTimeUtc(DateTime.UtcNow.AddSeconds(1))
|
|
});
|
|
|
|
await using RealTimeChannelLease lease = new(transport, "rt1", TimeSpan.FromMilliseconds(30));
|
|
await lease.OpenAsync().ConfigureAwait(false);
|
|
await WaitUntilAsync(() => transport.OpenChannelCount >= 3, s_handshakeTimeout).ConfigureAwait(false);
|
|
|
|
Assert.That(transport.OpenChannelCount, Is.GreaterThanOrEqualTo(3));
|
|
Assert.That(lease.Granted, Is.True);
|
|
Assert.That(lease.EndpointUrl, Is.EqualTo("opc.tcp://rt2"));
|
|
}
|
|
|
|
[Test]
|
|
public async Task ChannelLeaseDisposeClosesAfterRenewFailure()
|
|
{
|
|
FakeRobotIntentTransport transport = new()
|
|
{
|
|
ChannelResult = new RealTimeChannelOpenResult
|
|
{
|
|
Granted = true,
|
|
EndpointUrl = "opc.tcp://rt",
|
|
LeaseExpiry = new DateTimeUtc(DateTime.UtcNow.AddMilliseconds(5))
|
|
}
|
|
};
|
|
transport.EnqueueChannelResult(transport.ChannelResult);
|
|
transport.EnqueueChannelFault(ServiceResultException.Create(StatusCodes.BadTimeout, "transient"));
|
|
|
|
var lease = new RealTimeChannelLease(transport, "rt1", TimeSpan.FromMilliseconds(30));
|
|
await lease.OpenAsync().ConfigureAwait(false);
|
|
await AwaitWithTimeoutAsync(transport.WaitForOpenChannelCountAsync(2), s_handshakeTimeout).ConfigureAwait(false);
|
|
|
|
Assert.DoesNotThrowAsync(async () => await lease.DisposeAsync().ConfigureAwait(false));
|
|
Assert.That(transport.CloseChannelCount, Is.EqualTo(1));
|
|
}
|
|
|
|
[Test]
|
|
public async Task ChannelLeaseDisposeIsIdempotentAndClosesOnce()
|
|
{
|
|
FakeRobotIntentTransport transport = new()
|
|
{
|
|
ChannelResult = new RealTimeChannelOpenResult
|
|
{
|
|
Granted = true,
|
|
EndpointUrl = "opc.tcp://rt",
|
|
LeaseExpiry = new DateTimeUtc(DateTime.UtcNow.AddSeconds(1))
|
|
}
|
|
};
|
|
|
|
RealTimeChannelLease lease = new(transport, "rt1", TimeSpan.FromMilliseconds(30));
|
|
await lease.OpenAsync().ConfigureAwait(false);
|
|
await lease.DisposeAsync().ConfigureAwait(false);
|
|
Assert.DoesNotThrowAsync(async () => await lease.DisposeAsync().ConfigureAwait(false));
|
|
|
|
Assert.That(transport.CloseChannelCount, Is.EqualTo(1));
|
|
}
|
|
|
|
[Test]
|
|
public async Task ChannelLeaseDisposeAfterClosedSessionDoesNotThrow()
|
|
{
|
|
FakeRobotIntentTransport transport = new()
|
|
{
|
|
ChannelResult = new RealTimeChannelOpenResult
|
|
{
|
|
Granted = true,
|
|
EndpointUrl = "opc.tcp://rt",
|
|
LeaseExpiry = new DateTimeUtc(DateTime.UtcNow.AddSeconds(1))
|
|
},
|
|
CloseException = ServiceResultException.Create(StatusCodes.BadSessionClosed, "closed")
|
|
};
|
|
|
|
RealTimeChannelLease lease = new(transport, "rt1", TimeSpan.FromMilliseconds(30));
|
|
await lease.OpenAsync().ConfigureAwait(false);
|
|
|
|
Assert.DoesNotThrowAsync(async () => await lease.DisposeAsync().ConfigureAwait(false));
|
|
Assert.DoesNotThrowAsync(async () => await lease.DisposeAsync().ConfigureAwait(false));
|
|
Assert.That(transport.CloseChannelCount, Is.EqualTo(1));
|
|
}
|
|
|
|
[Test]
|
|
public async Task ChannelLeaseDisposeAfterRefusalDoesNotClose()
|
|
{
|
|
FakeRobotIntentTransport transport = new()
|
|
{
|
|
ChannelResult = new RealTimeChannelOpenResult
|
|
{
|
|
Granted = false,
|
|
Message = new LocalizedText("busy")
|
|
}
|
|
};
|
|
|
|
RealTimeChannelLease lease = new(transport, "rt1", TimeSpan.FromMilliseconds(30));
|
|
await lease.OpenAsync().ConfigureAwait(false);
|
|
await lease.DisposeAsync().ConfigureAwait(false);
|
|
await lease.DisposeAsync().ConfigureAwait(false);
|
|
|
|
Assert.That(transport.CloseChannelCount, Is.Zero);
|
|
}
|
|
|
|
[Test]
|
|
public async Task SubmitIntentRefusalThrowsAndTrySubmitReturnsRefusal()
|
|
{
|
|
FakeRobotIntentTransport transport = new()
|
|
{
|
|
SubmitResult = new IntentSubmissionResult
|
|
{
|
|
Accepted = false,
|
|
Failure = IntentFailureEnum.QueueFull,
|
|
Message = new LocalizedText("busy")
|
|
}
|
|
};
|
|
RobotIntentControllerClient controller = new(transport);
|
|
|
|
IntentDataType throwingIntent = RobotIntentBuilder.Wait(1).Build();
|
|
IntentDataType refusalAwareIntent = RobotIntentBuilder.Wait(2).Build();
|
|
|
|
ServiceResultException? ex = Assert.ThrowsAsync<ServiceResultException>(
|
|
async () => await controller.SubmitIntentAsync(throwingIntent).ConfigureAwait(false));
|
|
IntentSubmissionResult result = await controller.TrySubmitIntentAsync(refusalAwareIntent).ConfigureAwait(false);
|
|
|
|
Assert.Multiple(() =>
|
|
{
|
|
Assert.That(ex?.StatusCode, Is.EqualTo(StatusCodes.BadRequestNotAllowed));
|
|
Assert.That(result.Accepted, Is.False);
|
|
Assert.That(result.Failure, Is.EqualTo(IntentFailureEnum.QueueFull));
|
|
Assert.That(transport.SubmitIntentCount, Is.EqualTo(2));
|
|
Assert.That(transport.LastSubmittedIntent, Is.SameAs(refusalAwareIntent));
|
|
});
|
|
}
|
|
|
|
[Test]
|
|
public async Task ControllerMissionAndCancelMethodsDelegateToTransport()
|
|
{
|
|
FakeRobotIntentTransport transport = new()
|
|
{
|
|
CancelMissionOutcome = new IntentCommandOutcome(false)
|
|
};
|
|
RobotIntentControllerClient controller = new(transport);
|
|
MissionDataType mission = RobotIntentBuilder.Mission("m1")
|
|
.WithMissionUpdateId(4)
|
|
.HorizonStep("a", RobotIntentBuilder.Wait(1).Build())
|
|
.Build();
|
|
|
|
MissionSubmissionResult submit = await controller.SubmitMissionAsync(mission).ConfigureAwait(false);
|
|
MissionUpdateOutcome update = await controller.UpdateMissionAsync("m1", 5, []).ConfigureAwait(false);
|
|
IntentCommandOutcome cancel = await controller.CancelMissionAsync("m1", StopModeEnum.QuickStop).ConfigureAwait(false);
|
|
|
|
Assert.Multiple(() =>
|
|
{
|
|
Assert.That(submit.Accepted, Is.True);
|
|
Assert.That(update.Result, Is.EqualTo(MissionUpdateResultEnum.Accepted));
|
|
Assert.That(cancel.Accepted, Is.False);
|
|
Assert.That(transport.SubmitMissionCount, Is.EqualTo(1));
|
|
Assert.That(transport.LastSubmittedMission, Is.SameAs(mission));
|
|
Assert.That(transport.UpdateMissionCount, Is.EqualTo(1));
|
|
Assert.That(transport.LastUpdateMissionId, Is.EqualTo("m1"));
|
|
Assert.That(transport.LastMissionUpdateId, Is.EqualTo(5));
|
|
Assert.That(transport.LastUpdateSteps.Count, Is.Zero);
|
|
Assert.That(transport.CancelMissionCount, Is.EqualTo(1));
|
|
Assert.That(transport.LastCancelMissionId, Is.EqualTo("m1"));
|
|
Assert.That(transport.LastCancelMissionStopMode, Is.EqualTo(StopModeEnum.QuickStop));
|
|
});
|
|
}
|
|
|
|
[Test]
|
|
public async Task ChannelLeaseExpiredLeaseUsesNonZeroRenewDelay()
|
|
{
|
|
FakeRobotIntentTransport transport = new()
|
|
{
|
|
ChannelResult = new RealTimeChannelOpenResult
|
|
{
|
|
Granted = true,
|
|
LeaseExpiry = new DateTimeUtc(DateTime.UtcNow.AddSeconds(-1))
|
|
}
|
|
};
|
|
|
|
await using RealTimeChannelLease lease = new(transport, "rt1", TimeSpan.FromSeconds(1));
|
|
await lease.OpenAsync().ConfigureAwait(false);
|
|
TimeSpan delay = InvokeComputeRenewDelay(lease);
|
|
|
|
Assert.That(delay, Is.GreaterThan(TimeSpan.FromMilliseconds(250)));
|
|
}
|
|
|
|
[Test]
|
|
public async Task ControllerOpensRealTimeChannelLease()
|
|
{
|
|
FakeRobotIntentTransport transport = new()
|
|
{
|
|
ChannelResult = new RealTimeChannelOpenResult
|
|
{
|
|
Granted = true,
|
|
EndpointUrl = "opc.tcp://rt",
|
|
LeaseExpiry = new DateTimeUtc(DateTime.UtcNow.AddSeconds(1))
|
|
}
|
|
};
|
|
RobotIntentControllerClient controller = new(transport);
|
|
|
|
await using RealTimeChannelLease lease = await controller.OpenRealTimeChannelAsync(
|
|
"rt1",
|
|
TimeSpan.FromSeconds(1)).ConfigureAwait(false);
|
|
|
|
Assert.Multiple(() =>
|
|
{
|
|
Assert.That(lease.Granted, Is.True);
|
|
Assert.That(lease.EndpointUrl, Is.EqualTo("opc.tcp://rt"));
|
|
Assert.That(transport.OpenChannelCount, Is.EqualTo(1));
|
|
Assert.That(transport.LastOpenChannelId, Is.EqualTo("rt1"));
|
|
Assert.That(transport.LastRequestedLease, Is.EqualTo(1000.0).Within(1e-9));
|
|
});
|
|
}
|
|
|
|
[Test]
|
|
public void RobotIntentExtensionMethodsCreateClientsAndValidateNulls()
|
|
{
|
|
Mock<ISession> session = CreateSession();
|
|
var telemetry = new Mock<ITelemetryContext>();
|
|
var streaming = new Mock<IStreamingSubscription>();
|
|
|
|
RobotIntentClient fromSession = session.Object.RobotIntent(telemetry.Object, streaming.Object);
|
|
var robotics = new RoboticsClient(session.Object, telemetry.Object);
|
|
RobotIntentClient fromRobotics = robotics.RobotIntent(streaming.Object);
|
|
RobotIntentControllerClient controller = robotics.RobotIntentController(new NodeId(123), streaming.Object);
|
|
|
|
Assert.That(fromSession, Is.Not.Null);
|
|
Assert.That(fromRobotics, Is.Not.Null);
|
|
Assert.That(controller.ControllerId, Is.EqualTo(new NodeId(123)));
|
|
Assert.Throws<ArgumentNullException>(() => SessionRobotIntentExtensions.RobotIntent(
|
|
null!,
|
|
telemetry.Object));
|
|
Assert.Throws<ArgumentNullException>(() => session.Object.RobotIntent(null!));
|
|
}
|
|
|
|
[Test]
|
|
public void RobotIntentDiRegistrationIsIdempotent()
|
|
{
|
|
var services = new ServiceCollection();
|
|
var builder = new TestClientBuilder(services);
|
|
|
|
builder.AddRobotIntentClient();
|
|
builder.AddRobotIntentClient();
|
|
builder.AddRoboticsClient();
|
|
builder.AddRoboticsClient();
|
|
|
|
Assert.That(CountService<Func<CancellationToken, Task<RobotIntentClient>>>(services), Is.EqualTo(1));
|
|
Assert.That(CountService<RoboticsClientFactory>(services), Is.EqualTo(1));
|
|
Assert.That(CountService<Func<CancellationToken, Task<RoboticsClient>>>(services), Is.EqualTo(1));
|
|
}
|
|
|
|
[Test]
|
|
public void RobotIntentDiFactoriesResolveWhenTheSessionFactoryIsRegistered()
|
|
{
|
|
var services = new ServiceCollection();
|
|
ITelemetryContext telemetry = NUnitTelemetryContext.Create(true);
|
|
services.AddSingleton(telemetry);
|
|
Func<CancellationToken, Task<ManagedSession>> sessionFactory =
|
|
_ => throw new InvalidOperationException("not connected");
|
|
services.AddSingleton(sessionFactory);
|
|
var builder = new TestClientBuilder(services);
|
|
|
|
builder.AddRobotIntentClient();
|
|
builder.AddRoboticsClient();
|
|
|
|
using ServiceProvider provider = services.BuildServiceProvider();
|
|
|
|
Assert.Multiple(() =>
|
|
{
|
|
Assert.That(
|
|
provider.GetRequiredService<Func<CancellationToken, Task<RobotIntentClient>>>(),
|
|
Is.Not.Null);
|
|
Assert.That(provider.GetRequiredService<RoboticsClientFactory>(), Is.Not.Null);
|
|
Assert.That(
|
|
provider.GetRequiredService<Func<CancellationToken, Task<RoboticsClient>>>(),
|
|
Is.Not.Null);
|
|
});
|
|
}
|
|
|
|
[Test]
|
|
public void RobotIntentDiFactoriesExplainThatAddClientMustComeFirst()
|
|
{
|
|
var services = new ServiceCollection();
|
|
ITelemetryContext telemetry = NUnitTelemetryContext.Create(true);
|
|
services.AddSingleton(telemetry);
|
|
var builder = new TestClientBuilder(services);
|
|
|
|
builder.AddRobotIntentClient();
|
|
builder.AddRoboticsClient();
|
|
|
|
using ServiceProvider provider = services.BuildServiceProvider();
|
|
|
|
InvalidOperationException? intent = Assert.Throws<InvalidOperationException>(
|
|
() => provider.GetRequiredService<Func<CancellationToken, Task<RobotIntentClient>>>());
|
|
InvalidOperationException? robotics = Assert.Throws<InvalidOperationException>(
|
|
() => provider.GetRequiredService<RoboticsClientFactory>());
|
|
|
|
Assert.Multiple(() =>
|
|
{
|
|
Assert.That(intent!.Message, Does.Contain("AddClient"));
|
|
Assert.That(robotics!.Message, Does.Contain("AddClient"));
|
|
});
|
|
}
|
|
|
|
[Test]
|
|
public void RobotIntentDiRegistrationRejectsANullBuilder()
|
|
{
|
|
Assert.Multiple(() =>
|
|
{
|
|
Assert.Throws<ArgumentNullException>(
|
|
() => OpcUaRoboticsClientBuilderExtensions.AddRobotIntentClient(null!));
|
|
Assert.Throws<ArgumentNullException>(
|
|
() => OpcUaRoboticsClientBuilderExtensions.AddRoboticsClient(null!));
|
|
});
|
|
}
|
|
|
|
private static TimeSpan InvokeComputeRenewDelay(RealTimeChannelLease lease)
|
|
{
|
|
MethodInfo? method = typeof(RealTimeChannelLease).GetMethod(
|
|
"ComputeRenewDelay",
|
|
BindingFlags.Instance | BindingFlags.NonPublic);
|
|
Assert.That(method, Is.Not.Null);
|
|
return (TimeSpan)method!.Invoke(lease, [])!;
|
|
}
|
|
|
|
/// <summary>
|
|
/// Generous scheduling/handshake timeout used for AwaitWithTimeoutAsync and WaitUntilAsync
|
|
/// calls only. Does not affect behavioral lease durations or expiry times.
|
|
/// </summary>
|
|
private static readonly TimeSpan s_handshakeTimeout = TimeSpan.FromSeconds(30);
|
|
|
|
private static async Task AwaitWithTimeoutAsync(Task task, TimeSpan timeout)
|
|
{
|
|
Task completed = await Task.WhenAny(task, Task.Delay(timeout)).ConfigureAwait(false);
|
|
Assert.That(completed, Is.SameAs(task));
|
|
await task.ConfigureAwait(false);
|
|
}
|
|
|
|
private static async Task<T> AwaitWithTimeoutAsync<T>(Task<T> task, TimeSpan timeout)
|
|
{
|
|
Task completed = await Task.WhenAny(task, Task.Delay(timeout)).ConfigureAwait(false);
|
|
Assert.That(completed, Is.SameAs(task));
|
|
return await task.ConfigureAwait(false);
|
|
}
|
|
|
|
private static async Task WaitUntilAsync(Func<bool> predicate, TimeSpan timeout)
|
|
{
|
|
DateTime deadline = DateTime.UtcNow + timeout;
|
|
while (!predicate() && DateTime.UtcNow < deadline)
|
|
{
|
|
await Task.Delay(10).ConfigureAwait(false);
|
|
}
|
|
Assert.That(predicate(), Is.True);
|
|
}
|
|
|
|
private static int CountService<T>(IServiceCollection services)
|
|
{
|
|
int count = 0;
|
|
foreach (ServiceDescriptor descriptor in services)
|
|
{
|
|
if (descriptor.ServiceType == typeof(T))
|
|
{
|
|
count++;
|
|
}
|
|
}
|
|
return count;
|
|
}
|
|
|
|
private static Mock<ISession> CreateSession()
|
|
{
|
|
var telemetry = new Mock<ITelemetryContext>();
|
|
ServiceMessageContext context = ServiceMessageContext.Create(telemetry.Object);
|
|
context.NamespaceUris.GetIndexOrAppend("http://opcfoundation.org/UA/RobotIntent/");
|
|
var session = new Mock<ISession>();
|
|
session.SetupGet(s => s.NamespaceUris).Returns(context.NamespaceUris);
|
|
session.SetupGet(s => s.MessageContext).Returns(context);
|
|
session.SetupGet(s => s.Factory).Returns(context.Factory);
|
|
return session;
|
|
}
|
|
|
|
private static Pose3DDataType CreatePose()
|
|
{
|
|
return new Pose3DDataType
|
|
{
|
|
FrameId = "world",
|
|
Position = ArrayOf.Create([1.0d, 2.0d, 3.0d]),
|
|
Orientation = ArrayOf.Create([0.0d, 0.0d, 0.0d, 1.0d])
|
|
};
|
|
}
|
|
|
|
private static byte[] EncodeExtensionObject(
|
|
IServiceMessageContext context,
|
|
ExtensionObject extensionObject)
|
|
{
|
|
using var stream = new MemoryStream();
|
|
using (var encoder = new BinaryEncoder(stream, context, leaveOpen: true))
|
|
{
|
|
encoder.WriteExtensionObject("Value", extensionObject);
|
|
}
|
|
return stream.ToArray();
|
|
}
|
|
|
|
private static ExtensionObject DecodeExtensionObject(IServiceMessageContext context, byte[] encoded)
|
|
{
|
|
using var stream = new MemoryStream(encoded);
|
|
using var decoder = new BinaryDecoder(stream, context);
|
|
return decoder.ReadExtensionObject("Value");
|
|
}
|
|
|
|
private static IntentOperationSnapshot Snapshot(ExecutionStateEnum state)
|
|
{
|
|
return new IntentOperationSnapshot
|
|
{
|
|
Operation = new NodeId(10),
|
|
ExecutionState = state,
|
|
Result = new IntentResultDataType
|
|
{
|
|
IntentId = "i1",
|
|
State = state
|
|
}
|
|
};
|
|
}
|
|
|
|
private static MissionSnapshot MissionSnapshot(ExecutionStateEnum state)
|
|
{
|
|
return new MissionSnapshot
|
|
{
|
|
MissionNode = new NodeId(20),
|
|
MissionId = "mission-1",
|
|
ExecutionState = state
|
|
};
|
|
}
|
|
|
|
private static IEnumerable<TestCaseData> TerminalExecutionStates()
|
|
{
|
|
yield return new TestCaseData(ExecutionStateEnum.Succeeded);
|
|
yield return new TestCaseData(ExecutionStateEnum.Failed);
|
|
yield return new TestCaseData(ExecutionStateEnum.Cancelled);
|
|
yield return new TestCaseData(ExecutionStateEnum.Retriable);
|
|
}
|
|
|
|
private sealed class TestClientBuilder(IServiceCollection services) : IOpcUaClientBuilder
|
|
{
|
|
public IServiceCollection Services { get; } = services;
|
|
}
|
|
|
|
private sealed class FakeRobotIntentTransport : IRobotIntentTransport, IDisposable
|
|
{
|
|
public event RobotIntentReconnectHandler? Reconnected;
|
|
|
|
public NodeId ControllerId { get; } = new(100);
|
|
|
|
public NamespaceTable NamespaceUris { get; } = new();
|
|
|
|
public IServiceMessageContext MessageContext { get; } =
|
|
ServiceMessageContext.CreateEmpty(NUnitTelemetryContext.Create(true));
|
|
|
|
public ILogger Logger { get; } = NullLogger.Instance;
|
|
|
|
public IntentOperationSnapshot Snapshot { get; set; } = new();
|
|
|
|
public RobotIntentControllerState ControllerState { get; set; } = new();
|
|
|
|
public ArrayOf<IntentOperationSnapshot> Operations { get; set; } = [];
|
|
|
|
public ArrayOf<MissionSnapshot> Missions { get; set; } = [];
|
|
|
|
public IntentCommandOutcome CancelOutcome { get; set; } = new(true);
|
|
|
|
public IntentSubmissionResult SubmitResult { get; set; } = new()
|
|
{
|
|
Accepted = true,
|
|
IntentId = "i1",
|
|
Operation = new NodeId(10)
|
|
};
|
|
|
|
public IntentCommandOutcome PauseOutcome { get; set; } = new(true);
|
|
|
|
public IntentCommandOutcome ResumeOutcome { get; set; } = new(true);
|
|
|
|
public IntentSubmissionResult RetryResult { get; set; } = new() { Accepted = true };
|
|
|
|
public IntentCommandOutcome CancelMissionOutcome { get; set; } = new(true);
|
|
|
|
public CommandAuthorityOutcome AuthorityOutcome { get; set; } = new(false, NodeId.Null);
|
|
|
|
public NodeId ControlOwner { get; set; } = NodeId.Null;
|
|
|
|
public RealTimeChannelOpenResult ChannelResult { get; set; } = new()
|
|
{
|
|
Granted = true,
|
|
LeaseExpiry = new DateTimeUtc(DateTime.UtcNow.AddSeconds(1))
|
|
};
|
|
|
|
public int SubscribeCount { get; private set; }
|
|
|
|
public int ReadSnapshotCount { get; private set; }
|
|
|
|
public int ReadMissionSnapshotCount { get; private set; }
|
|
|
|
public int ActiveSubscriptionCount => Volatile.Read(ref m_activeSubscriptionCount);
|
|
|
|
public int ReleaseCount { get; private set; }
|
|
|
|
public int UpdateMissionCount { get; private set; }
|
|
|
|
public int OpenChannelCount { get; private set; }
|
|
|
|
public int CloseChannelCount { get; private set; }
|
|
|
|
public int PauseCount { get; private set; }
|
|
|
|
public int ResumeCount { get; private set; }
|
|
|
|
public int RetryCount { get; private set; }
|
|
|
|
public int CancelMissionCount { get; private set; }
|
|
|
|
public int CancelAllCount { get; private set; }
|
|
|
|
public int SubmitIntentCount { get; private set; }
|
|
|
|
public int CancelIntentCount { get; private set; }
|
|
|
|
public int SubmitMissionCount { get; private set; }
|
|
|
|
public IntentDataType? LastSubmittedIntent { get; private set; }
|
|
|
|
public string? LastCancelIntentId { get; private set; }
|
|
|
|
public StopModeEnum LastCancelStopMode { get; private set; }
|
|
|
|
public string? LastRetryIntentId { get; private set; }
|
|
|
|
public MissionDataType? LastSubmittedMission { get; private set; }
|
|
|
|
public string? LastUpdateMissionId { get; private set; }
|
|
|
|
public uint LastMissionUpdateId { get; private set; }
|
|
|
|
public ArrayOf<MissionStepDataType> LastUpdateSteps { get; private set; } = [];
|
|
|
|
public string? LastCancelMissionId { get; private set; }
|
|
|
|
public StopModeEnum LastCancelMissionStopMode { get; private set; }
|
|
|
|
public string? LastOpenChannelId { get; private set; }
|
|
|
|
public double LastRequestedLease { get; private set; }
|
|
|
|
public string? LastCloseChannelId { get; private set; }
|
|
|
|
public Queue<Func<RealTimeChannelOpenResult>> ChannelResponses { get; } = new();
|
|
|
|
public Exception? ReleaseException { get; set; }
|
|
|
|
public Exception? CloseException { get; set; }
|
|
|
|
private ConcurrentQueue<RobotIntentDataChange> ChangeNotifications { get; } = new();
|
|
|
|
public Task WaitForOpenChannelCountAsync(int count)
|
|
{
|
|
lock (m_stateLock)
|
|
{
|
|
if (OpenChannelCount >= count)
|
|
{
|
|
return Task.CompletedTask;
|
|
}
|
|
m_openChannelCountTarget = count;
|
|
m_openChannelCountReached = new TaskCompletionSource<bool>(
|
|
TaskCreationOptions.RunContinuationsAsynchronously);
|
|
return m_openChannelCountReached.Task;
|
|
}
|
|
}
|
|
|
|
public void EnqueueChannelResult(RealTimeChannelOpenResult result)
|
|
{
|
|
ChannelResponses.Enqueue(() => result);
|
|
}
|
|
|
|
public void EnqueueChannelFault(Exception exception)
|
|
{
|
|
ChannelResponses.Enqueue(() => throw exception);
|
|
}
|
|
|
|
public void PublishOwner(NodeId owner)
|
|
{
|
|
m_ownerNotifications.Enqueue(owner);
|
|
m_notificationAvailable.Release();
|
|
}
|
|
|
|
public void PublishChange(Variant value)
|
|
{
|
|
PublishChange("ExecutionState", value);
|
|
}
|
|
|
|
public void PublishChange(string browseName, Variant value)
|
|
{
|
|
ChangeNotifications.Enqueue(new RobotIntentDataChange(ChildNode(browseName), value));
|
|
m_notificationAvailable.Release();
|
|
}
|
|
|
|
public void PublishReconnect()
|
|
{
|
|
Reconnected?.Invoke();
|
|
}
|
|
|
|
public void Dispose()
|
|
{
|
|
m_notificationAvailable.Dispose();
|
|
}
|
|
|
|
public ValueTask<ArrayOf<RobotIntentNodeLookupEntry>> BrowseControllersAsync(CancellationToken ct = default)
|
|
{
|
|
return new ValueTask<ArrayOf<RobotIntentNodeLookupEntry>>([]);
|
|
}
|
|
|
|
public ValueTask<RobotIntentControllerInfo> ReadControllerAsync(CancellationToken ct = default)
|
|
{
|
|
return new ValueTask<RobotIntentControllerInfo>(new RobotIntentControllerInfo());
|
|
}
|
|
|
|
public ValueTask<RobotIntentControllerState> ReadControllerStateAsync(CancellationToken ct = default)
|
|
{
|
|
return new ValueTask<RobotIntentControllerState>(ControllerState);
|
|
}
|
|
|
|
public ValueTask<ArrayOf<IntentOperationSnapshot>> ListOperationsAsync(CancellationToken ct = default)
|
|
{
|
|
return new ValueTask<ArrayOf<IntentOperationSnapshot>>(Operations);
|
|
}
|
|
|
|
public ValueTask<ArrayOf<MissionSnapshot>> ListMissionsAsync(CancellationToken ct = default)
|
|
{
|
|
return new ValueTask<ArrayOf<MissionSnapshot>>(Missions);
|
|
}
|
|
|
|
public ValueTask<IntentSubmissionResult> SubmitIntentAsync(
|
|
IntentDataType intent,
|
|
CancellationToken ct = default)
|
|
{
|
|
SubmitIntentCount++;
|
|
LastSubmittedIntent = intent;
|
|
return new ValueTask<IntentSubmissionResult>(SubmitResult);
|
|
}
|
|
|
|
public ValueTask<IntentCommandOutcome> CancelIntentAsync(
|
|
string intentId,
|
|
StopModeEnum stopMode,
|
|
CancellationToken ct = default)
|
|
{
|
|
CancelIntentCount++;
|
|
LastCancelIntentId = intentId;
|
|
LastCancelStopMode = stopMode;
|
|
return new ValueTask<IntentCommandOutcome>(CancelOutcome);
|
|
}
|
|
|
|
public ValueTask<uint> CancelAllAsync(StopModeEnum stopMode, CancellationToken ct = default)
|
|
{
|
|
CancelAllCount++;
|
|
return new ValueTask<uint>(2u);
|
|
}
|
|
|
|
public ValueTask<IntentCommandOutcome> PauseAsync(CancellationToken ct = default)
|
|
{
|
|
PauseCount++;
|
|
return new ValueTask<IntentCommandOutcome>(PauseOutcome);
|
|
}
|
|
|
|
public ValueTask<IntentCommandOutcome> ResumeAsync(CancellationToken ct = default)
|
|
{
|
|
ResumeCount++;
|
|
return new ValueTask<IntentCommandOutcome>(ResumeOutcome);
|
|
}
|
|
|
|
public ValueTask<IntentSubmissionResult> RetryAsync(string intentId, CancellationToken ct = default)
|
|
{
|
|
RetryCount++;
|
|
LastRetryIntentId = intentId;
|
|
return new ValueTask<IntentSubmissionResult>(RetryResult);
|
|
}
|
|
|
|
public ValueTask<MissionSubmissionResult> SubmitMissionAsync(
|
|
MissionDataType mission,
|
|
CancellationToken ct = default)
|
|
{
|
|
SubmitMissionCount++;
|
|
LastSubmittedMission = mission;
|
|
return new ValueTask<MissionSubmissionResult>(new MissionSubmissionResult
|
|
{
|
|
Accepted = true,
|
|
MissionId = mission.MissionId ?? string.Empty,
|
|
Operation = new NodeId(20)
|
|
});
|
|
}
|
|
|
|
public ValueTask<MissionUpdateOutcome> UpdateMissionAsync(
|
|
string missionId,
|
|
uint missionUpdateId,
|
|
ArrayOf<MissionStepDataType> steps,
|
|
CancellationToken ct = default)
|
|
{
|
|
UpdateMissionCount++;
|
|
LastUpdateMissionId = missionId;
|
|
LastMissionUpdateId = missionUpdateId;
|
|
LastUpdateSteps = steps;
|
|
return new ValueTask<MissionUpdateOutcome>(new MissionUpdateOutcome(
|
|
MissionUpdateResultEnum.Accepted,
|
|
LocalizedText.Null));
|
|
}
|
|
|
|
public ValueTask<IntentCommandOutcome> CancelMissionAsync(
|
|
string missionId,
|
|
StopModeEnum stopMode,
|
|
CancellationToken ct = default)
|
|
{
|
|
CancelMissionCount++;
|
|
LastCancelMissionId = missionId;
|
|
LastCancelMissionStopMode = stopMode;
|
|
return new ValueTask<IntentCommandOutcome>(CancelMissionOutcome);
|
|
}
|
|
|
|
public ValueTask<CommandAuthorityOutcome> RequestControlAsync(CancellationToken ct = default)
|
|
{
|
|
return new ValueTask<CommandAuthorityOutcome>(AuthorityOutcome);
|
|
}
|
|
|
|
public ValueTask ReleaseControlAsync(CancellationToken ct = default)
|
|
{
|
|
ReleaseCount++;
|
|
if (ReleaseException != null)
|
|
{
|
|
throw ReleaseException;
|
|
}
|
|
return default;
|
|
}
|
|
|
|
public ValueTask<RealTimeChannelOpenResult> OpenRealTimeChannelAsync(
|
|
string channelId,
|
|
double requestedLease,
|
|
CancellationToken ct = default)
|
|
{
|
|
lock (m_stateLock)
|
|
{
|
|
OpenChannelCount++;
|
|
LastOpenChannelId = channelId;
|
|
LastRequestedLease = requestedLease;
|
|
if (OpenChannelCount >= m_openChannelCountTarget)
|
|
{
|
|
m_openChannelCountReached?.TrySetResult(true);
|
|
}
|
|
}
|
|
if (ChannelResponses.Count > 0)
|
|
{
|
|
return new ValueTask<RealTimeChannelOpenResult>(ChannelResponses.Dequeue()());
|
|
}
|
|
return new ValueTask<RealTimeChannelOpenResult>(ChannelResult);
|
|
}
|
|
|
|
public ValueTask<bool> CloseRealTimeChannelAsync(string channelId, CancellationToken ct = default)
|
|
{
|
|
CloseChannelCount++;
|
|
LastCloseChannelId = channelId;
|
|
if (CloseException != null)
|
|
{
|
|
throw CloseException;
|
|
}
|
|
return new ValueTask<bool>(true);
|
|
}
|
|
|
|
public ValueTask<NodeId> ResolveChildAsync(NodeId root, string browseName, CancellationToken ct = default)
|
|
{
|
|
return new ValueTask<NodeId>(ChildNode(browseName));
|
|
}
|
|
|
|
public ValueTask<IntentOperationSnapshot> ReadOperationSnapshotAsync(
|
|
NodeId operation,
|
|
CancellationToken ct = default)
|
|
{
|
|
ReadSnapshotCount++;
|
|
return new ValueTask<IntentOperationSnapshot>(Snapshot);
|
|
}
|
|
|
|
public MissionSnapshot MissionSnapshot { get; set; } = new();
|
|
|
|
public ValueTask<MissionSnapshot> ReadMissionSnapshotAsync(
|
|
NodeId mission,
|
|
CancellationToken ct = default)
|
|
{
|
|
ReadMissionSnapshotCount++;
|
|
return new ValueTask<MissionSnapshot>(MissionSnapshot with { MissionNode = mission });
|
|
}
|
|
|
|
public ValueTask<NodeId> ReadControlOwnerAsync(CancellationToken ct = default)
|
|
{
|
|
return new ValueTask<NodeId>(ControlOwner);
|
|
}
|
|
|
|
public async IAsyncEnumerable<RobotIntentDataChange> SubscribeDataChangesAsync(
|
|
ArrayOf<NodeId> nodeIds,
|
|
[EnumeratorCancellation] CancellationToken ct = default)
|
|
{
|
|
SubscribeCount++;
|
|
Interlocked.Increment(ref m_activeSubscriptionCount);
|
|
try
|
|
{
|
|
while (!ct.IsCancellationRequested)
|
|
{
|
|
await m_notificationAvailable.WaitAsync(ct).ConfigureAwait(false);
|
|
if (ChangeNotifications.TryDequeue(out RobotIntentDataChange change))
|
|
{
|
|
yield return change;
|
|
}
|
|
else if (m_ownerNotifications.TryDequeue(out NodeId owner))
|
|
{
|
|
yield return new RobotIntentDataChange(new NodeId(1), Variant.From(owner));
|
|
}
|
|
}
|
|
}
|
|
finally
|
|
{
|
|
Interlocked.Decrement(ref m_activeSubscriptionCount);
|
|
}
|
|
}
|
|
|
|
private readonly ConcurrentQueue<NodeId> m_ownerNotifications = new();
|
|
private readonly SemaphoreSlim m_notificationAvailable = new(0);
|
|
private readonly System.Threading.Lock m_stateLock = new();
|
|
private int m_activeSubscriptionCount;
|
|
private TaskCompletionSource<bool>? m_openChannelCountReached;
|
|
private int m_openChannelCountTarget = int.MaxValue;
|
|
|
|
private static NodeId ChildNode(string browseName)
|
|
{
|
|
return browseName switch
|
|
{
|
|
"ExecutionState" => new NodeId(1),
|
|
"Progress" => new NodeId(2),
|
|
"CurrentPose" => new NodeId(3),
|
|
"Result" => new NodeId(4),
|
|
"ControlOwner" => new NodeId(5),
|
|
_ => new NodeId((uint)Math.Abs(browseName.GetHashCode(StringComparison.Ordinal)))
|
|
};
|
|
}
|
|
}
|
|
}
|
|
}
|