Compare commits
21 Commits
7daad2dfaf
...
dangnv
| Author | SHA1 | Date | |
|---|---|---|---|
|
|
b7e7d70855 | ||
|
|
5c1851e92f | ||
|
|
49c0c1ab39 | ||
|
|
8362713dcc | ||
|
|
15a61fd986 | ||
|
|
b3f765d261 | ||
|
|
2785a8f161 | ||
|
|
a51cfe80c8 | ||
|
|
e4e135e35f | ||
|
|
30732b4b9f | ||
|
|
b2eeb8cb3f | ||
| 7ce770404c | |||
|
|
128600c4ed | ||
|
|
b006c5b197 | ||
|
|
4ceec9abd5 | ||
|
|
1289a6c331 | ||
|
|
f1a7be15f2 | ||
| d2cf86f34e | |||
|
|
d4af3b8707 | ||
| 909e147be1 | |||
| dc837e5488 |
66
.dockerignore
Normal file
66
.dockerignore
Normal file
@@ -0,0 +1,66 @@
|
||||
# Build artifacts
|
||||
**/bin/
|
||||
**/obj/
|
||||
**/out/
|
||||
|
||||
# Visual Studio files
|
||||
**/.vs/
|
||||
**/.vscode/
|
||||
**/*.user
|
||||
**/*.suo
|
||||
**/*.userosscache
|
||||
**/*.sln.docstates
|
||||
|
||||
# User-specific files
|
||||
**/.user
|
||||
**/.suo
|
||||
**/.userosscache
|
||||
|
||||
# Build results
|
||||
[Dd]ebug/
|
||||
[Dd]ebugPublic/
|
||||
[Rr]elease/
|
||||
[Rr]eleases/
|
||||
x64/
|
||||
x86/
|
||||
[Aa][Rr][Mm]/
|
||||
[Aa][Rr][Mm]64/
|
||||
bld/
|
||||
[Bb]in/
|
||||
[Oo]bj/
|
||||
[Ll]og/
|
||||
[Ll]ogs/
|
||||
|
||||
# NuGet packages
|
||||
**/packages/
|
||||
**/*.nupkg
|
||||
**/*.snupkg
|
||||
|
||||
# Test results
|
||||
**/[Tt]est[Rr]esult*/
|
||||
**/[Bb]uild[Ll]og.*
|
||||
|
||||
# Docker files
|
||||
Dockerfile*
|
||||
docker-compose*
|
||||
.dockerignore
|
||||
|
||||
# Git
|
||||
.git/
|
||||
.gitignore
|
||||
.gitattributes
|
||||
|
||||
# IDE
|
||||
.idea/
|
||||
*.swp
|
||||
*.swo
|
||||
*~
|
||||
|
||||
# OS
|
||||
.DS_Store
|
||||
Thumbs.db
|
||||
|
||||
# Data and logs (will be mounted as volumes)
|
||||
data/
|
||||
logs/
|
||||
|
||||
57
Dockerfile
Normal file
57
Dockerfile
Normal file
@@ -0,0 +1,57 @@
|
||||
# Stage 1: Build
|
||||
# Note: Project files specify net10.0, but using .NET 9.0 based on package versions (9.0.9)
|
||||
# Adjust version if needed: 8.0 (LTS), 9.0 (current), or future 10.0
|
||||
FROM mcr.microsoft.com/dotnet/aspnet:10.0 AS base
|
||||
WORKDIR /app
|
||||
|
||||
FROM mcr.microsoft.com/dotnet/sdk:10.0 AS build
|
||||
WORKDIR /src
|
||||
|
||||
# Copy solution file
|
||||
COPY RobotApp.sln .
|
||||
|
||||
# Copy project files
|
||||
COPY RobotApp/RobotApp.csproj RobotApp/
|
||||
COPY RobotApp.Client/RobotApp.Client.csproj RobotApp.Client/
|
||||
COPY RobotApp.Common.Shares/RobotApp.Common.Shares.csproj RobotApp.Common.Shares/
|
||||
COPY RobotApp.VDA5050/RobotApp.VDA5050.csproj RobotApp.VDA5050/
|
||||
|
||||
# Restore dependencies
|
||||
RUN dotnet restore RobotApp.sln
|
||||
|
||||
# Copy all source files
|
||||
COPY RobotApp/ RobotApp/
|
||||
COPY RobotApp.Client/ RobotApp.Client/
|
||||
COPY RobotApp.Common.Shares/ RobotApp.Common.Shares/
|
||||
COPY RobotApp.VDA5050/ RobotApp.VDA5050/
|
||||
|
||||
RUN rm -rf ./RobotApp/RobotApp/bin
|
||||
RUN rm -rf ./RobotApp/RobotApp/obj
|
||||
RUN rm -rf ./RobotApp.Client/RobotApp.Client/bin
|
||||
RUN rm -rf ./RobotApp.Client/RobotApp.Client/obj
|
||||
RUN rm -rf ./RobotApp.Common.Shares/RobotApp.Common.Shares/bin
|
||||
RUN rm -rf ./RobotApp.Common.Shares/RobotApp.Common.Shares/obj
|
||||
RUN rm -rf ./RobotApp.VDA5050/RobotApp.VDA5050/bin
|
||||
RUN rm -rf ./RobotApp.VDA5050/RobotApp.VDA5050/obj
|
||||
|
||||
# Build the solution
|
||||
WORKDIR /src/RobotApp
|
||||
RUN dotnet build -c Release -o /app/build
|
||||
|
||||
# Stage 2: Publish
|
||||
FROM build AS publish
|
||||
WORKDIR /src/RobotApp
|
||||
RUN dotnet publish -c Release -o /app/publish /p:UseAppHost=false
|
||||
|
||||
# Copy published files
|
||||
FROM base AS final
|
||||
WORKDIR /app
|
||||
COPY --from=publish /app/publish ./
|
||||
|
||||
# Set environment variables
|
||||
#ENV ASPNETCORE_URLS=http://+:8080
|
||||
ENV ASPNETCORE_ENVIRONMENT=Production
|
||||
|
||||
# Run the application
|
||||
ENTRYPOINT ["dotnet", "RobotApp.dll"]
|
||||
|
||||
@@ -1,2 +1,5 @@
|
||||
# RobotApp
|
||||
|
||||
docker build -t robotics.doc/robotnet/robotapp_dde:2.7 .
|
||||
docker save -o robotapp-dde.2.7.tar robotics.doc/robotnet/robotapp_dde:2.7
|
||||
scp .\robotapp-dde.2.7.tar robotics@172.20.235.176:~/DDE
|
||||
@@ -17,12 +17,26 @@
|
||||
<i class="mdi mdi-fit-to-screen-outline icon-button"></i>
|
||||
</button>
|
||||
</MudTooltip>
|
||||
<div class="auto-follow-control">
|
||||
<MudTooltip Text="Auto Follow Robot" Placement="Placement.Bottom" Color="Color.Info">
|
||||
<MudSwitch T="bool" Value="AutoFollowRobot" ValueChanged="OnAutoFollowRobotChanged" Color="Color.Info" Size="Size.Small">
|
||||
<span style="color: white; font-size: 14px; margin-left: 8px;">Follow Robot</span>
|
||||
</MudSwitch>
|
||||
</MudTooltip>
|
||||
</div>
|
||||
<MudSpacer />
|
||||
@if (MonitorData?.RobotPosition != null)
|
||||
{
|
||||
<div class="robot-position-info">
|
||||
<i class="mdi mdi-map-marker"></i>
|
||||
<span>X: @MonitorData.RobotPosition.X.ToString("F2")m | Y: @MonitorData.RobotPosition.Y.ToString("F2")m | θ: @((MonitorData.RobotPosition.Theta * 180 / Math.PI).ToString("F1"))°</span>
|
||||
<span>Robot: X: @MonitorData.RobotPosition.X.ToString("F2")m | Y: @MonitorData.RobotPosition.Y.ToString("F2")m | θ: @((MonitorData.RobotPosition.Theta * 180 / Math.PI).ToString("F1"))°</span>
|
||||
</div>
|
||||
}
|
||||
@if (MouseWorldX.HasValue && MouseWorldY.HasValue)
|
||||
{
|
||||
<div class="mouse-position-info">
|
||||
<i class="mdi mdi-cursor-pointer"></i>
|
||||
<span>Mouse: X: @MouseWorldX.Value.ToString("F2")m | Y: @MouseWorldY.Value.ToString("F2")m</span>
|
||||
</div>
|
||||
}
|
||||
@* <MudChip T="string" Color="@(IsConnected? Color.Success: Color.Error)" Size="Size.Small">
|
||||
@@ -36,18 +50,52 @@
|
||||
@onmousemove="HandleMouseMove"
|
||||
@onmouseup="HandleMouseUp"
|
||||
@onmouseleave="HandleMouseLeave">
|
||||
@* Arrow markers for origin *@
|
||||
<defs>
|
||||
<marker id="arrowhead-x" markerWidth="10" markerHeight="10"
|
||||
refX="9" refY="3" orient="auto" markerUnits="strokeWidth">
|
||||
<path d="M0,0 L0,6 L9,3 z" fill="#FF0000" />
|
||||
</marker>
|
||||
<marker id="arrowhead-y" markerWidth="10" markerHeight="10"
|
||||
refX="9" refY="3" orient="auto" markerUnits="strokeWidth">
|
||||
<path d="M0,0 L0,6 L9,3 z" fill="#00FF00" />
|
||||
</marker>
|
||||
</defs>
|
||||
<g transform="@GetTransform()">
|
||||
@* Background Map Image *@
|
||||
@if (MapImageLoaded && MapImageWidth > 0 && MapImageHeight > 0)
|
||||
{
|
||||
@* Image origin is at bottom-left corner (MapImageOriginX, MapImageOriginY) in world coordinates
|
||||
In SVG (after Y flip), image top-left corner is at (MapImageOriginX, -MapImageOriginY - MapImageHeight)
|
||||
So we render image at: x = MapImageOriginX, y = -MapImageOriginY - MapImageHeight *@
|
||||
<image href="@MapImageUrl"
|
||||
x="@WorldToSvgX(MapImageOriginX)"
|
||||
y="@WorldToSvgY(MapImageOriginY + MapImageHeight)"
|
||||
width="@MapImageWidth"
|
||||
height="@MapImageHeight"
|
||||
preserveAspectRatio="none"
|
||||
opacity="0.8"
|
||||
style="pointer-events: none; image-rendering: pixelated;"
|
||||
id="map-background-image" />
|
||||
}
|
||||
|
||||
@* Origin Marker (2 arrows: X+ and Y+) at (MapImageOriginX, MapImageOriginY) *@
|
||||
<g transform="@GetOriginMarkerTransform()">
|
||||
@* X+ Arrow (pointing right) *@
|
||||
<line x1="0" y1="0" x2="@GetOriginMarkerSize()" y2="0"
|
||||
stroke="#FF0000" stroke-width="@GetOriginMarkerStrokeWidth()"
|
||||
marker-end="url(#arrowhead-x)" />
|
||||
@* Y+ Arrow (pointing up in world, down in SVG) *@
|
||||
<line x1="0" y1="0" x2="0" y2="@(-GetOriginMarkerSize())"
|
||||
stroke="#00FF00" stroke-width="@GetOriginMarkerStrokeWidth()"
|
||||
marker-end="url(#arrowhead-y)" />
|
||||
@* Origin point *@
|
||||
<circle cx="0" cy="0" r="@(GetOriginMarkerSize() * 0.12)"
|
||||
fill="#FFFF00" stroke="#000" stroke-width="@(GetOriginMarkerStrokeWidth() * 0.5)" />
|
||||
</g>
|
||||
|
||||
@if (MonitorData?.HasOrder == true)
|
||||
{
|
||||
@* @for (int i = 0; i < MonitorData.EdgeStates.Length; i++)
|
||||
{
|
||||
var edge = MonitorData.EdgeStates[i];
|
||||
var (startX, startY, endX, endY) = GetEdgeEndpoints(i, edge);
|
||||
<path d="@GetPathFromTrajectory(edge.Trajectory, startX, startY, endX, endY)"
|
||||
fill="none"
|
||||
stroke="#42A5F5"
|
||||
stroke-width="0.08" />
|
||||
} *@
|
||||
<path d="@PathView"
|
||||
fill="none"
|
||||
stroke="#42A5F5"
|
||||
@@ -86,6 +134,7 @@
|
||||
</div>
|
||||
|
||||
@code {
|
||||
|
||||
[Parameter] public RobotMonitorDto? MonitorData { get; set; }
|
||||
[Parameter] public bool IsConnected { get; set; }
|
||||
|
||||
@@ -106,7 +155,7 @@
|
||||
private ElementReference SvgRef;
|
||||
private ElementReference SvgContainerRef;
|
||||
|
||||
private double ZoomScale = 2.0; // Zoom vào robot hơn khi mở
|
||||
private double ZoomScale = 1.5; // Zoom vào robot hơn khi mở
|
||||
private const double MIN_ZOOM = 0.1;
|
||||
private const double MAX_ZOOM = 5.0;
|
||||
private const double BASE_PIXELS_PER_METER = 50.0;
|
||||
@@ -124,14 +173,44 @@
|
||||
private string PathView = "";
|
||||
private string PathIsNot = "hidden";
|
||||
|
||||
// Mouse world coordinates
|
||||
private double? MouseWorldX = null;
|
||||
private double? MouseWorldY = null;
|
||||
|
||||
// Auto-follow robot
|
||||
private bool AutoFollowRobot = false;
|
||||
|
||||
private void OnAutoFollowRobotChanged(bool value)
|
||||
{
|
||||
AutoFollowRobot = value;
|
||||
if (AutoFollowRobot && MonitorData?.RobotPosition != null)
|
||||
{
|
||||
UpdateViewToFollowRobot();
|
||||
StateHasChanged();
|
||||
}
|
||||
}
|
||||
|
||||
// Map image properties
|
||||
private const double MapImageOriginX = -20.0; // OriginX in world coordinates (meters)
|
||||
private const double MapImageOriginY = -20.0; // OriginY in world coordinates (meters)
|
||||
private const double MapImageResolution = 0.1; // Resolution: meters per pixel
|
||||
private const string MapImageUrl = "images/gara20250309.png";
|
||||
|
||||
private bool MapImageLoaded = false;
|
||||
private double MapImageWidth = 0; // Width in world coordinates (meters)
|
||||
private double MapImageHeight = 0; // Height in world coordinates (meters)
|
||||
|
||||
protected override async Task OnAfterRenderAsync(bool firstRender)
|
||||
{
|
||||
if (firstRender)
|
||||
{
|
||||
var containerSize = await JS.InvokeAsync<ElementSize>("getElementSize", SvgContainerRef);
|
||||
var containerSize = await JS.InvokeAsync<ElementSize>("robotMonitor.getElementSize", SvgContainerRef);
|
||||
SvgWidth = containerSize.Width;
|
||||
SvgHeight = containerSize.Height;
|
||||
|
||||
// Load map image and get dimensions
|
||||
await LoadMapImage();
|
||||
|
||||
// Center view on robot if available with initial zoom
|
||||
if (MonitorData?.RobotPosition != null)
|
||||
{
|
||||
@@ -150,8 +229,37 @@
|
||||
}
|
||||
}
|
||||
|
||||
private async Task LoadMapImage()
|
||||
{
|
||||
try
|
||||
{
|
||||
var imageDimensions = await JS.InvokeAsync<ElementSize>("robotMonitor.loadImageAndGetDimensions", MapImageUrl);
|
||||
|
||||
// Convert pixel dimensions to world coordinates (meters)
|
||||
MapImageWidth = imageDimensions.Width * MapImageResolution;
|
||||
MapImageHeight = imageDimensions.Height * MapImageResolution;
|
||||
|
||||
if (MapImageWidth > 0 && MapImageHeight > 0)
|
||||
{
|
||||
MapImageLoaded = true;
|
||||
await InvokeAsync(StateHasChanged); // Force re-render after image is loaded
|
||||
}
|
||||
}
|
||||
catch (Exception ex)
|
||||
{
|
||||
MapImageLoaded = false;
|
||||
Console.WriteLine($"Failed to load map image: {ex.Message}");
|
||||
}
|
||||
}
|
||||
|
||||
private string GetTransform()
|
||||
{
|
||||
// Transform applies: first translate (in screen pixels), then scale (pixels per meter)
|
||||
// World coordinates are in meters
|
||||
// After transform: screenX = TranslateX + worldX * (ZoomScale * BASE_PIXELS_PER_METER)
|
||||
// screenY = TranslateY + worldY * (ZoomScale * BASE_PIXELS_PER_METER)
|
||||
// But we need to flip Y: screenY = TranslateY - worldY * (ZoomScale * BASE_PIXELS_PER_METER)
|
||||
// This is handled by WorldToSvgY which flips Y before applying transform
|
||||
return $"translate({TranslateX}, {TranslateY}) scale({ZoomScale * BASE_PIXELS_PER_METER})";
|
||||
}
|
||||
|
||||
@@ -171,16 +279,17 @@
|
||||
// Kích thước robot trong world coordinates (mét)
|
||||
const double RobotWidthMeters = 0.606;
|
||||
const double RobotLengthMeters = 1.106;
|
||||
|
||||
|
||||
// Điều chỉnh kích thước dựa trên ZoomScale
|
||||
// Tăng kích thước lên 1.5x để robot to hơn
|
||||
double scaleFactor = 3 / ZoomScale; // Tăng kích thước hiển thị
|
||||
|
||||
double scaleFactor = 2 / ZoomScale; // Tăng kích thước hiển thị
|
||||
scaleFactor = scaleFactor < 1 ? 1 : scaleFactor;
|
||||
|
||||
double width = RobotWidthMeters * scaleFactor;
|
||||
double height = RobotLengthMeters * scaleFactor;
|
||||
double x = -width / 2;
|
||||
double y = -height / 2;
|
||||
|
||||
|
||||
return (x, y, width, height);
|
||||
}
|
||||
|
||||
@@ -217,6 +326,53 @@
|
||||
return -worldY;
|
||||
}
|
||||
|
||||
private string GetOriginMarkerTransform()
|
||||
{
|
||||
// Origin is at (MapImageOriginX, MapImageOriginY) in world coordinates (bottom-left corner of image)
|
||||
// In SVG coordinates (after Y flip): (MapImageOriginX, -MapImageOriginY)
|
||||
// Note: Image is rendered at (MapImageOriginX, -MapImageOriginY - MapImageHeight) in SVG
|
||||
// So origin marker should be at (MapImageOriginX, -MapImageOriginY) in SVG
|
||||
var x = WorldToSvgX(0);
|
||||
var y = WorldToSvgY(0);
|
||||
|
||||
return $"translate({x}, {y})";
|
||||
}
|
||||
|
||||
private double GetOriginMarkerSize()
|
||||
{
|
||||
// Marker size in world coordinates (meters)
|
||||
const double BaseMarkerSize = 1; // 1 meter
|
||||
double scaleFactor = 1.0 / ZoomScale; // Keep visual size constant
|
||||
return BaseMarkerSize * scaleFactor;
|
||||
}
|
||||
|
||||
private double GetOriginMarkerStrokeWidth()
|
||||
{
|
||||
// Stroke width in world coordinates
|
||||
const double BaseStrokeWidth = 0.05; // 5cm
|
||||
double scaleFactor = 1.0 / ZoomScale; // Keep visual size constant
|
||||
return BaseStrokeWidth * scaleFactor;
|
||||
}
|
||||
|
||||
public void OnMonitorDataUpdated()
|
||||
{
|
||||
// Auto-follow robot when MonitorData changes
|
||||
if (AutoFollowRobot && !IsPanning && MonitorData?.RobotPosition != null)
|
||||
{
|
||||
UpdateViewToFollowRobot();
|
||||
}
|
||||
}
|
||||
|
||||
private void UpdateViewToFollowRobot()
|
||||
{
|
||||
if (MonitorData?.RobotPosition == null) return;
|
||||
|
||||
// Center view on robot
|
||||
TranslateX = SvgWidth / 2 - MonitorData.RobotPosition.X * BASE_PIXELS_PER_METER * ZoomScale;
|
||||
TranslateY = SvgHeight / 2 + MonitorData.RobotPosition.Y * BASE_PIXELS_PER_METER * ZoomScale;
|
||||
StateHasChanged();
|
||||
}
|
||||
|
||||
public void UpdatePath()
|
||||
{
|
||||
if (MonitorData is not null && MonitorData.EdgeStates.Length > 0)
|
||||
@@ -291,14 +447,26 @@
|
||||
PanStartY = e.ClientY - TranslateY;
|
||||
}
|
||||
|
||||
private void HandleMouseMove(MouseEventArgs e)
|
||||
private async Task HandleMouseMove(MouseEventArgs e)
|
||||
{
|
||||
// Calculate world coordinates of mouse
|
||||
var svgRect = await JS.InvokeAsync<ElementBoundingRect>("robotMonitor.getElementBoundingRect", SvgRef);
|
||||
double mouseX = e.ClientX - svgRect.X;
|
||||
double mouseY = e.ClientY - svgRect.Y;
|
||||
|
||||
// Convert to world coordinates
|
||||
// World X = (mouseX - TranslateX) / (ZoomScale * BASE_PIXELS_PER_METER)
|
||||
MouseWorldX = (mouseX - TranslateX) / (ZoomScale * BASE_PIXELS_PER_METER);
|
||||
// World Y = -(mouseY - TranslateY) / (ZoomScale * BASE_PIXELS_PER_METER) (flip Y axis)
|
||||
MouseWorldY = -(mouseY - TranslateY) / (ZoomScale * BASE_PIXELS_PER_METER);
|
||||
|
||||
if (IsPanning)
|
||||
{
|
||||
TranslateX = e.ClientX - PanStartX;
|
||||
TranslateY = e.ClientY - PanStartY;
|
||||
StateHasChanged();
|
||||
}
|
||||
|
||||
StateHasChanged();
|
||||
}
|
||||
|
||||
private void HandleMouseUp(MouseEventArgs e)
|
||||
@@ -309,6 +477,9 @@
|
||||
private void HandleMouseLeave(MouseEventArgs e)
|
||||
{
|
||||
IsPanning = false;
|
||||
MouseWorldX = null;
|
||||
MouseWorldY = null;
|
||||
StateHasChanged();
|
||||
}
|
||||
|
||||
private async Task HandleWheel(WheelEventArgs e)
|
||||
@@ -324,7 +495,7 @@
|
||||
if (Math.Abs(ZoomScale - oldZoom) < 0.001) return;
|
||||
|
||||
// Zoom at mouse position
|
||||
var svgRect = await JS.InvokeAsync<ElementBoundingRect>("getElementBoundingRect", SvgRef);
|
||||
var svgRect = await JS.InvokeAsync<ElementBoundingRect>("robotMonitor.getElementBoundingRect", SvgRef);
|
||||
double mouseX = e.ClientX - svgRect.X;
|
||||
double mouseY = e.ClientY - svgRect.Y;
|
||||
|
||||
|
||||
@@ -54,19 +54,39 @@
|
||||
gap: 8px;
|
||||
}
|
||||
|
||||
.mouse-position-info {
|
||||
color: #fff;
|
||||
font-size: 14px;
|
||||
font-family: 'Segoe UI', Tahoma, Geneva, Verdana, sans-serif;
|
||||
padding: 4px 12px;
|
||||
background-color: #3d3d3d;
|
||||
border-radius: 4px;
|
||||
display: flex;
|
||||
align-items: center;
|
||||
gap: 8px;
|
||||
}
|
||||
|
||||
.auto-follow-control {
|
||||
display: flex;
|
||||
align-items: center;
|
||||
padding: 4px 8px;
|
||||
background-color: #3d3d3d;
|
||||
border-radius: 4px;
|
||||
}
|
||||
|
||||
.svg-container {
|
||||
flex: 1;
|
||||
overflow: hidden;
|
||||
position: relative;
|
||||
background-color: #fafafa;
|
||||
background-color: #808080;
|
||||
}
|
||||
|
||||
.svg-container svg {
|
||||
width: 100%;
|
||||
height: 100%;
|
||||
cursor: grab;
|
||||
background-color: dimgray;
|
||||
}
|
||||
.svg-container svg {
|
||||
width: 100%;
|
||||
height: 100%;
|
||||
cursor: grab;
|
||||
background-color: #808080;
|
||||
}
|
||||
|
||||
.svg-container svg:active {
|
||||
cursor: grabbing;
|
||||
|
||||
@@ -5,7 +5,6 @@
|
||||
@using MudBlazor
|
||||
|
||||
@implements IDisposable
|
||||
@attribute [Authorize]
|
||||
|
||||
@inject RobotStateClient RobotStateClient
|
||||
@rendermode InteractiveWebAssemblyNoPrerender
|
||||
@@ -14,7 +13,7 @@
|
||||
<!-- Header Dashboard -->
|
||||
<MudPaper Class="pa-6 mb-4 d-flex align-center justify-space-between" Elevation="3">
|
||||
<div>
|
||||
<MudText Typo="Typo.h3" Class="mb-2" >Robot Dashboard</MudText>
|
||||
<MudText Typo="Typo.h3" Class="mb-2">Robot Dashboard</MudText>
|
||||
@if (CurrentState != null)
|
||||
{
|
||||
<MudText Typo="Typo.subtitle1">
|
||||
@@ -38,17 +37,15 @@
|
||||
@if (CurrentState != null)
|
||||
{
|
||||
<MudChip T="string"
|
||||
Icon="@(IsConnected
|
||||
? Icons.Material.Filled.CheckCircle
|
||||
: Icons.Material.Filled.Error)"
|
||||
Size="Size.Large"
|
||||
Color="@(IsConnected ? Color.Success : Color.Error)"
|
||||
Variant="Variant.Filled"
|
||||
Class="px-6 py-4 text-white"
|
||||
Style="font-weight: bold; font-size: 1.1rem;">
|
||||
@(IsConnected ? "ONLINE" : "OFFLINE")
|
||||
</MudChip>
|
||||
}
|
||||
Icon="@(IsConnected ? Icons.Material.Filled.CheckCircle : Icons.Material.Filled.Error)"
|
||||
Size="Size.Large"
|
||||
Color="@(IsConnected ? Color.Success : Color.Error)"
|
||||
Variant="Variant.Filled"
|
||||
Class="px-6 py-4 text-white"
|
||||
Style="font-weight: bold; font-size: 1.1rem;">
|
||||
@(IsConnected ? "ONLINE" : "OFFLINE")
|
||||
</MudChip>
|
||||
}
|
||||
|
||||
</MudPaper>
|
||||
|
||||
@@ -153,7 +150,7 @@
|
||||
Rounded="true"
|
||||
Striped="true"
|
||||
Color="@(msg.BatteryState.BatteryCharge > 50 ? Color.Success :
|
||||
msg.BatteryState.BatteryCharge > 20 ? Color.Warning : Color.Error)"
|
||||
msg.BatteryState.BatteryCharge > 20 ? Color.Warning : Color.Error)"
|
||||
Class="mb-4"
|
||||
Style="height: 28px;" />
|
||||
|
||||
@@ -267,13 +264,13 @@
|
||||
<MudChip T="string"
|
||||
Size="Size.Small"
|
||||
Color="@(context.Level.Contains("ERROR", StringComparison.OrdinalIgnoreCase) ? Color.Error :
|
||||
context.Level.Contains("WARN", StringComparison.OrdinalIgnoreCase) ? Color.Warning : Color.Info)"
|
||||
context.Level.Contains("WARN", StringComparison.OrdinalIgnoreCase) ? Color.Warning : Color.Info)"
|
||||
Variant="@Variant.Filled">
|
||||
@context.Level
|
||||
</MudChip>
|
||||
</MudTd>
|
||||
<MudTd>
|
||||
<MudText Typo="Typo.body2" Class="text-truncate" Style="max-width: 300px;" Title="@context.Description">
|
||||
<MudText Typo="Typo.body2" Class="text-truncate" Style="max-width: 300px;">
|
||||
@context.Description
|
||||
</MudText>
|
||||
</MudTd>
|
||||
@@ -312,14 +309,14 @@
|
||||
<MudTh Style="text-align:right">Status</MudTh>
|
||||
</HeaderContent>
|
||||
<RowTemplate>
|
||||
<MudTd><MudText Typo="Typo.body2" Class="text-truncate" Title="@context.ActionType">@context.ActionType</MudText></MudTd>
|
||||
<MudTd><MudText Typo="Typo.body2" Class="text-truncate">@context.ActionType</MudText></MudTd>
|
||||
<MudTd><MudText Typo="Typo.caption">@context.ActionId</MudText></MudTd>
|
||||
<MudTd Style="text-align:right">
|
||||
<MudChip T="string"
|
||||
Size="Size.Small"
|
||||
Color="@(context.ActionStatus == "RUNNING" ? Color.Info :
|
||||
context.ActionStatus == "FINISHED" ? Color.Success :
|
||||
context.ActionStatus == "FAILED" ? Color.Error : Color.Default)"
|
||||
context.ActionStatus == "FINISHED" ? Color.Success :
|
||||
context.ActionStatus == "FAILED" ? Color.Error : Color.Default)"
|
||||
Variant="@Variant.Filled">
|
||||
@context.ActionStatus
|
||||
</MudChip>
|
||||
@@ -374,45 +371,34 @@
|
||||
|
||||
private StateMsg? CurrentState;
|
||||
private bool IsConnected;
|
||||
private readonly string RobotSerial = "T800-002";
|
||||
private List<MessageRow> MessageRows = new();
|
||||
|
||||
protected override async Task OnInitializedAsync()
|
||||
protected override async Task OnAfterRenderAsync(bool firstRender)
|
||||
{
|
||||
await base.OnAfterRenderAsync(firstRender);
|
||||
if (!firstRender) return;
|
||||
RobotStateClient.OnStateReceived += OnRobotStateReceived;
|
||||
RobotStateClient.OnRobotConnectionChanged += OnRobotConnectionChanged;
|
||||
|
||||
if (RobotStateClient.ConnectionState == RobotClientState.Disconnected)
|
||||
{
|
||||
await RobotStateClient.StartAsync();
|
||||
}
|
||||
|
||||
await RobotStateClient.SubscribeRobotAsync(RobotSerial);
|
||||
|
||||
CurrentState = RobotStateClient.GetLatestState(RobotSerial);
|
||||
await RobotStateClient.StartAsync();
|
||||
CurrentState = RobotStateClient.GetLatestState();
|
||||
IsConnected = RobotStateClient.IsRobotConnected;
|
||||
|
||||
UpdateMessageRows();
|
||||
}
|
||||
|
||||
private void OnRobotConnectionChanged(bool connected)
|
||||
{
|
||||
InvokeAsync(() =>
|
||||
{
|
||||
IsConnected = connected;
|
||||
StateHasChanged();
|
||||
});
|
||||
IsConnected = connected;
|
||||
StateHasChanged();
|
||||
}
|
||||
|
||||
|
||||
private void OnRobotStateReceived(string serialNumber, StateMsg state)
|
||||
{
|
||||
if (serialNumber != RobotSerial) return;
|
||||
InvokeAsync(() =>
|
||||
{
|
||||
CurrentState = state;
|
||||
UpdateMessageRows();
|
||||
StateHasChanged();
|
||||
});
|
||||
CurrentState = state;
|
||||
UpdateMessageRows();
|
||||
StateHasChanged();
|
||||
}
|
||||
|
||||
private void UpdateMessageRows()
|
||||
|
||||
@@ -1,6 +1,5 @@
|
||||
@page "/logs"
|
||||
@rendermode InteractiveWebAssemblyNoPrerender
|
||||
@attribute [Authorize]
|
||||
|
||||
@using Microsoft.AspNetCore.Components.WebAssembly.Authentication
|
||||
@using RobotApp.Client.Models
|
||||
@@ -78,6 +77,13 @@
|
||||
</div>
|
||||
</div>
|
||||
|
||||
<script>
|
||||
window.ScrollToBottom = (element) => {
|
||||
if (element) {
|
||||
element.scrollTop = element.scrollHeight;
|
||||
}
|
||||
};
|
||||
</script>
|
||||
|
||||
@code {
|
||||
private DateTime DateLog = DateTime.Today;
|
||||
|
||||
@@ -23,7 +23,7 @@
|
||||
|
||||
.log-level {
|
||||
display: inline-block;
|
||||
width: 46px;
|
||||
width: 60px;
|
||||
}
|
||||
|
||||
.log-head {
|
||||
|
||||
@@ -2,8 +2,6 @@
|
||||
|
||||
@rendermode InteractiveWebAssemblyNoPrerender
|
||||
|
||||
@attribute [Authorize]
|
||||
|
||||
<PageTitle>Map Manager</PageTitle>
|
||||
|
||||
<div class="d-flex w-100 h-100 p-2 overflow-hidden flex-row">
|
||||
|
||||
@@ -38,8 +38,7 @@
|
||||
<MudIconButton Icon="@Icons.Material.Filled.Delete"
|
||||
Color="Color.Error"
|
||||
Size="Size.Small"
|
||||
OnClick="@(() => RemoveEdgeAsync(edge))"
|
||||
StopPropagation="true" />
|
||||
OnClick="@(() => RemoveEdgeAsync(edge))" />
|
||||
</div>
|
||||
</TitleContent>
|
||||
|
||||
@@ -88,47 +87,6 @@
|
||||
}
|
||||
</MudSelect>
|
||||
</MudItem>
|
||||
|
||||
<!-- Radius -->
|
||||
<MudItem xs="6">
|
||||
<MudNumericField T="double"
|
||||
Value="@edge.Radius"
|
||||
ValueChanged="@((double v) => SetValue(() => edge.Radius = v))"
|
||||
Immediate="true"
|
||||
Min="0"
|
||||
Step="0.1"
|
||||
Label="Radius (0 = straight line)" />
|
||||
</MudItem>
|
||||
|
||||
<!-- Quadrant -->
|
||||
@if (edge.Radius > 0)
|
||||
{
|
||||
<MudItem xs="6">
|
||||
<MudSelect T="Quadrant"
|
||||
Value="@edge.Quadrant"
|
||||
ValueChanged="@((Quadrant v) => SetValue(() => edge.Quadrant = v))"
|
||||
Label="Quadrant">
|
||||
<MudSelectItem Value="Quadrant.I">I</MudSelectItem>
|
||||
<MudSelectItem Value="Quadrant.II">II</MudSelectItem>
|
||||
<MudSelectItem Value="Quadrant.III">III</MudSelectItem>
|
||||
<MudSelectItem Value="Quadrant.IV">IV</MudSelectItem>
|
||||
</MudSelect>
|
||||
</MudItem>
|
||||
}
|
||||
|
||||
<!-- Apply Curve -->
|
||||
@if (!edge.HasTrajectory && edge.Radius > 0 && !edge.Expanded)
|
||||
{
|
||||
<MudItem xs="12">
|
||||
<MudButton Color="Color.Primary"
|
||||
Variant="Variant.Outlined"
|
||||
StartIcon="@Icons.Material.Filled.Merge"
|
||||
OnClick="@(() => ApplyCurveAsync(edge))">
|
||||
Apply Curve (generate node)
|
||||
</MudButton>
|
||||
</MudItem>
|
||||
}
|
||||
|
||||
</MudGrid>
|
||||
</ChildContent>
|
||||
</MudExpansionPanel>
|
||||
@@ -141,8 +99,7 @@
|
||||
[Parameter] public OrderMessage Order { get; set; } = default!;
|
||||
|
||||
[Parameter] public EventCallback OnAddEdge { get; set; }
|
||||
[Parameter] public EventCallback<UiEdge> OnRemoveEdge { get; set; }
|
||||
[Parameter] public EventCallback<UiEdge> OnApplyCurve { get; set; }
|
||||
[Parameter] public EventCallback<VDA5050.Order.Edge> OnRemoveEdge { get; set; }
|
||||
|
||||
[Parameter] public EventCallback OnOrderChanged { get; set; }
|
||||
|
||||
@@ -158,15 +115,9 @@
|
||||
await OnOrderChanged.InvokeAsync();
|
||||
}
|
||||
|
||||
private async Task RemoveEdgeAsync(UiEdge edge)
|
||||
private async Task RemoveEdgeAsync(VDA5050.Order.Edge edge)
|
||||
{
|
||||
await OnRemoveEdge.InvokeAsync(edge);
|
||||
await OnOrderChanged.InvokeAsync();
|
||||
}
|
||||
|
||||
private async Task ApplyCurveAsync(UiEdge edge)
|
||||
{
|
||||
await OnApplyCurve.InvokeAsync(edge);
|
||||
await OnOrderChanged.InvokeAsync();
|
||||
}
|
||||
}
|
||||
|
||||
@@ -10,12 +10,6 @@
|
||||
<MudItem xs="12">
|
||||
<MudTextField @bind-Value="Node.NodeId" Label="Node ID" Required="true" />
|
||||
</MudItem>
|
||||
<MudItem xs="12">
|
||||
<MudNumericField T="int" @bind-Value="Node.SequenceId" Label="Sequence ID" Required="true" />
|
||||
</MudItem>
|
||||
<MudItem xs="12">
|
||||
<MudSwitch T="bool" @bind-Checked="Node.Released" Label="Released" />
|
||||
</MudItem>
|
||||
<MudItem xs="6">
|
||||
<MudNumericField T="double" @bind-Value="Node.NodePosition.X" Label="X" />
|
||||
</MudItem>
|
||||
|
||||
@@ -132,17 +132,17 @@
|
||||
|
||||
try
|
||||
{
|
||||
using var doc = JsonDocument.Parse(JsonText);
|
||||
var root = doc.RootElement;
|
||||
|
||||
// ===== BASIC STRUCTURE CHECK =====
|
||||
if (!root.TryGetProperty("nodes", out _) ||
|
||||
!root.TryGetProperty("edges", out _))
|
||||
var order = JsonSerializer.Deserialize<OrderMsg>(JsonText, new JsonSerializerOptions
|
||||
{
|
||||
throw new Exception("Missing 'nodes' or 'edges' field.");
|
||||
WriteIndented = true,
|
||||
PropertyNamingPolicy = JsonNamingPolicy.CamelCase,
|
||||
});
|
||||
if(order is null)
|
||||
{
|
||||
ShowWarning = true;
|
||||
ErrorMessage = "Can not convert file to Order message";
|
||||
return;
|
||||
}
|
||||
|
||||
var order = OrderMessage.FromSchemaObject(root);
|
||||
ValidateOrder(order);
|
||||
|
||||
MudDialog.Close(DialogResult.Ok(order));
|
||||
@@ -160,15 +160,15 @@
|
||||
}
|
||||
|
||||
// ================= DOMAIN VALIDATION =================
|
||||
private void ValidateOrder(OrderMessage order)
|
||||
private void ValidateOrder(OrderMsg order)
|
||||
{
|
||||
if (order.Nodes.Count == 0)
|
||||
if (order.Nodes.Length == 0)
|
||||
throw new Exception("Order must contain at least one node.");
|
||||
|
||||
if (order.Nodes.Count != order.Edges.Count + 1)
|
||||
if (order.Nodes.Length != order.Edges.Length + 1)
|
||||
throw new Exception(
|
||||
$"Invalid path structure: Nodes count ({order.Nodes.Count}) " +
|
||||
$"must equal Edges count + 1 ({order.Edges.Count + 1})."
|
||||
$"Invalid path structure: Nodes count ({order.Nodes.Length}) " +
|
||||
$"must equal Edges count + 1 ({order.Edges.Length + 1})."
|
||||
);
|
||||
|
||||
var nodeIds = order.Nodes
|
||||
|
||||
@@ -1,7 +1,7 @@
|
||||
<MudPaper Class="pa-4 h-100 d-flex flex-column overflow-hidden" Elevation="2">
|
||||
<MudStack Row AlignItems="AlignItems.Center" Justify="Justify.SpaceBetween"
|
||||
Class="mb-4 flex-shrink-0">
|
||||
<MudText Typo="Typo.h6">📄 JSON Output (/order)</MudText>
|
||||
<MudText Typo="Typo.h6">Output (/order)</MudText>
|
||||
|
||||
<div class="d-flex gap-2">
|
||||
|
||||
@@ -14,6 +14,16 @@
|
||||
Import JSON
|
||||
</MudButton>
|
||||
|
||||
<!-- CANCEL -->
|
||||
<MudButton Variant="Variant.Filled"
|
||||
Color="@CancelButtonColor"
|
||||
StartIcon="@CancelButtonIcon"
|
||||
Disabled="@DisableCancel"
|
||||
OnClick="OnCancel">
|
||||
@CancelButtonText
|
||||
</MudButton>
|
||||
|
||||
|
||||
<!-- SEND -->
|
||||
<MudButton Variant="Variant.Filled"
|
||||
Color="@SendButtonColor"
|
||||
@@ -37,8 +47,10 @@
|
||||
|
||||
<div class="flex-grow-1">
|
||||
<MudTextField Value="@OrderJson"
|
||||
ReadOnly
|
||||
T="string"
|
||||
ValueChanged="OrderJsonChange"
|
||||
Variant="Variant.Filled"
|
||||
Immediate=true
|
||||
Lines="50"
|
||||
Style="font-family: 'Roboto Mono', Consolas, monospace;
|
||||
font-size: 0.85rem;
|
||||
@@ -51,10 +63,15 @@
|
||||
[Parameter] public string OrderJson { get; set; } = "";
|
||||
[Parameter] public bool Copied { get; set; }
|
||||
[Parameter] public bool? SendSuccess { get; set; }
|
||||
[Parameter] public bool DisableCancel { get; set; }
|
||||
[Parameter] public bool? CancelSuccess { get; set; }
|
||||
|
||||
[Parameter] public EventCallback<string> OrderJsonChanged { get; set; }
|
||||
|
||||
[Parameter] public EventCallback OnCopy { get; set; }
|
||||
[Parameter] public EventCallback OnSend { get; set; }
|
||||
[Parameter] public EventCallback OnImport { get; set; }
|
||||
[Parameter] public EventCallback OnCancel { get; set; }
|
||||
|
||||
private string SendButtonText =>
|
||||
SendSuccess switch
|
||||
@@ -79,4 +96,36 @@
|
||||
false => Icons.Material.Filled.Error,
|
||||
_ => Icons.Material.Filled.Send
|
||||
};
|
||||
|
||||
private string CancelButtonText =>
|
||||
CancelSuccess switch
|
||||
{
|
||||
true => "Done",
|
||||
false => "Error",
|
||||
_ => "Cancel"
|
||||
};
|
||||
|
||||
private Color CancelButtonColor =>
|
||||
CancelSuccess switch
|
||||
{
|
||||
true => Color.Success,
|
||||
false => Color.Error,
|
||||
_ => Color.Error
|
||||
};
|
||||
|
||||
private string CancelButtonIcon =>
|
||||
CancelSuccess switch
|
||||
{
|
||||
true => Icons.Material.Filled.CheckCircle,
|
||||
false => Icons.Material.Filled.Error,
|
||||
_ => Icons.Material.Filled.Cancel
|
||||
};
|
||||
|
||||
|
||||
private void OrderJsonChange(string value)
|
||||
{
|
||||
OrderJson = value;
|
||||
OrderJsonChanged.InvokeAsync(OrderJson);
|
||||
StateHasChanged();
|
||||
}
|
||||
}
|
||||
|
||||
@@ -21,13 +21,11 @@
|
||||
<MudIconButton Icon="@Icons.Material.Filled.Edit"
|
||||
Color="Color.Primary"
|
||||
Size="Size.Small"
|
||||
OnClick="@(() => EditNodeAsync(node))"
|
||||
StopPropagation />
|
||||
OnClick="@(() => EditNodeAsync(node))" />
|
||||
<MudIconButton Icon="@Icons.Material.Filled.Delete"
|
||||
Color="Color.Error"
|
||||
Size="Size.Small"
|
||||
OnClick="@(() => RemoveNodeAsync(node))"
|
||||
StopPropagation />
|
||||
OnClick="@(() => RemoveNodeAsync(node))" />
|
||||
</div>
|
||||
</div>
|
||||
</TitleContent>
|
||||
@@ -78,22 +76,22 @@
|
||||
Label="Y" />
|
||||
</MudItem>
|
||||
|
||||
<MudItem xs="12">
|
||||
@* <MudItem xs="12">
|
||||
<MudTextField Value="@node.NodePosition.MapId"
|
||||
ValueChanged="@((string v) => SetValue(() => node.NodePosition.MapId = v))"
|
||||
Immediate="true"
|
||||
Label="Map ID" />
|
||||
</MudItem>
|
||||
</MudItem> *@
|
||||
|
||||
<MudItem xs="6">
|
||||
@* <MudItem xs="6">
|
||||
<MudNumericField T="double"
|
||||
Value="@node.NodePosition.Theta"
|
||||
ValueChanged="@((double v) => SetValue(() => node.NodePosition.Theta = v))"
|
||||
Immediate="true"
|
||||
Label="Theta (rad)" />
|
||||
</MudItem>
|
||||
</MudItem> *@
|
||||
|
||||
<MudItem xs="6">
|
||||
@* <MudItem xs="6">
|
||||
<MudNumericField T="double"
|
||||
Value="@node.NodePosition.AllowedDeviationXY"
|
||||
ValueChanged="@((double v) => SetValue(() => node.NodePosition.AllowedDeviationXY = v))"
|
||||
@@ -107,7 +105,7 @@
|
||||
ValueChanged="@((double v) => SetValue(() => node.NodePosition.AllowedDeviationTheta = v))"
|
||||
Immediate="true"
|
||||
Label="Allowed Dev Theta" />
|
||||
</MudItem>
|
||||
</MudItem> *@
|
||||
|
||||
<!-- Actions -->
|
||||
<MudItem xs="12">
|
||||
|
||||
@@ -1,6 +1,5 @@
|
||||
@page "/robot-order"
|
||||
|
||||
@attribute [Authorize]
|
||||
@rendermode InteractiveWebAssemblyNoPrerender
|
||||
|
||||
@using System.Text.Json
|
||||
@@ -9,6 +8,7 @@
|
||||
@inject IJSRuntime JS
|
||||
@inject IDialogService DialogService
|
||||
@inject HttpClient Http
|
||||
@inject ISnackbar Snackbar
|
||||
|
||||
<MudMainContent Class="pa-0 ma-0">
|
||||
<div style="height:100vh; overflow:hidden;">
|
||||
@@ -37,7 +37,6 @@
|
||||
<EdgesPanel Order="Order"
|
||||
OnAddEdge="AddEdge"
|
||||
OnRemoveEdge="RemoveEdge"
|
||||
OnApplyCurve="ApplyCurve"
|
||||
OnOrderChanged="OnOrderChanged" />
|
||||
</MudItem>
|
||||
|
||||
@@ -46,13 +45,14 @@
|
||||
|
||||
<!-- ================= RIGHT ================= -->
|
||||
<MudItem xs="12" md="5" Class="h-100">
|
||||
<JsonOutputPanel OrderJson="@OrderJson"
|
||||
<JsonOutputPanel @bind-OrderJson="@OrderJson"
|
||||
Copied="@copied"
|
||||
SendSuccess="@sendSuccess"
|
||||
CancelSuccess="@cancelSuccess"
|
||||
OnCopy="CopyJsonToClipboard"
|
||||
OnSend="SendOrderToServer"
|
||||
OnImport="OpenImportDialog" />
|
||||
|
||||
OnImport="OpenImportDialog"
|
||||
OnCancel="CancelOrder" />
|
||||
</MudItem>
|
||||
|
||||
</MudGrid>
|
||||
@@ -66,7 +66,7 @@
|
||||
private string OrderJson = ""; // 🔥 CACHE JSON (QUAN TRỌNG)
|
||||
private bool copied;
|
||||
private bool? sendSuccess;
|
||||
private bool sending;
|
||||
private bool? cancelSuccess;
|
||||
private CancellationTokenSource? _copyCts;
|
||||
|
||||
// ================= INIT =================
|
||||
@@ -83,9 +83,10 @@
|
||||
new JsonSerializerOptions
|
||||
{
|
||||
WriteIndented = true,
|
||||
DefaultIgnoreCondition = JsonIgnoreCondition.WhenWritingNull
|
||||
PropertyNamingPolicy = JsonNamingPolicy.CamelCase,
|
||||
});
|
||||
}
|
||||
|
||||
private async Task OpenImportDialog()
|
||||
{
|
||||
var dialog = await DialogService.ShowAsync<ImportOrderDialog>(
|
||||
@@ -98,9 +99,9 @@
|
||||
|
||||
var result = await dialog.Result;
|
||||
|
||||
if (!result.Canceled && result.Data is OrderMessage imported)
|
||||
if (result is not null && !result.Canceled && result.Data is OrderMsg imported)
|
||||
{
|
||||
Order = imported;
|
||||
Order.Import(imported);
|
||||
RebuildOrderJson();
|
||||
StateHasChanged();
|
||||
}
|
||||
@@ -148,7 +149,7 @@
|
||||
? Order.Nodes[1].NodeId
|
||||
: start; // 👈 1 node thì start = end
|
||||
|
||||
Order.Edges.Add(new UiEdge
|
||||
Order.Edges.Add(new VDA5050.Order.Edge
|
||||
{
|
||||
EdgeId = $"EDGE_{Order.Edges.Count + 1}",
|
||||
StartNodeId = start,
|
||||
@@ -157,25 +158,10 @@
|
||||
}
|
||||
|
||||
|
||||
void RemoveEdge(UiEdge edge)
|
||||
void RemoveEdge(VDA5050.Order.Edge edge)
|
||||
{
|
||||
Order.Edges.Remove(edge);
|
||||
}
|
||||
|
||||
void ApplyCurve(UiEdge edge)
|
||||
{
|
||||
if (edge.Radius <= 0 || edge.Expanded) return;
|
||||
|
||||
var startNode = Order.Nodes.First(n => n.NodeId == edge.StartNodeId);
|
||||
var newNode = OrderMessage.CreateCurveNode(startNode, edge);
|
||||
|
||||
Order.Nodes.Add(newNode);
|
||||
edge.EndNodeId = newNode.NodeId;
|
||||
edge.MarkExpanded(); // ✅
|
||||
|
||||
ResequenceNodes();
|
||||
}
|
||||
|
||||
// ================= ACTION =================
|
||||
void AddAction(Node node)
|
||||
{
|
||||
@@ -192,22 +178,19 @@
|
||||
|
||||
void RemoveAction(Node node, VDA5050.InstantAction.Action action)
|
||||
{
|
||||
node.Actions = node.Actions?.Where(a => a != action).ToArray()
|
||||
?? Array.Empty<VDA5050.InstantAction.Action>();
|
||||
node.Actions = node.Actions?.Where(a => a != action).ToArray() ?? [];
|
||||
}
|
||||
|
||||
void AddActionParameter(VDA5050.InstantAction.Action act)
|
||||
{
|
||||
var list = (act.ActionParameters ?? Array.Empty<ActionParameter>()).ToList();
|
||||
var list = (act.ActionParameters ?? []).ToList();
|
||||
list.Add(new UiActionParameter());
|
||||
act.ActionParameters = list.ToArray();
|
||||
}
|
||||
|
||||
void RemoveActionParameter(VDA5050.InstantAction.Action act, ActionParameter param)
|
||||
{
|
||||
act.ActionParameters =
|
||||
act.ActionParameters?.Where(p => p != param).ToArray()
|
||||
?? Array.Empty<ActionParameter>();
|
||||
act.ActionParameters = act.ActionParameters?.Where(p => p != param).ToArray() ?? [];
|
||||
}
|
||||
|
||||
// ================= SEND / COPY =================
|
||||
@@ -219,16 +202,53 @@
|
||||
|
||||
try
|
||||
{
|
||||
var response = await Http.PostAsJsonAsync(
|
||||
"/api/order",
|
||||
JsonSerializer.Deserialize<JsonElement>(OrderJson)
|
||||
);
|
||||
var orderMsg = JsonSerializer.Deserialize<OrderMsg>(OrderJson,
|
||||
new JsonSerializerOptions
|
||||
{
|
||||
WriteIndented = true,
|
||||
PropertyNamingPolicy = JsonNamingPolicy.CamelCase,
|
||||
});
|
||||
if (orderMsg is null)
|
||||
{
|
||||
Snackbar.Add("Unable to convert JSON to Order", Severity.Warning);
|
||||
return;
|
||||
}
|
||||
if (orderMsg.Nodes.Length < 1)
|
||||
{
|
||||
Snackbar.Add("The order must contain at least one node (number of nodes > 0)", Severity.Warning);
|
||||
return;
|
||||
}
|
||||
if (orderMsg.Nodes.Length - 1 != orderMsg.Edges.Length)
|
||||
{
|
||||
Snackbar.Add("Order must have a number of edges equal to the number of nodes minus 1", Severity.Warning);
|
||||
return;
|
||||
}
|
||||
|
||||
foreach(var edge in orderMsg.Edges)
|
||||
{
|
||||
if (!orderMsg.Nodes.Any(n => n.NodeId == edge.StartNodeId))
|
||||
{
|
||||
Snackbar.Add($"The edge {edge.EdgeId} references a startNodeId {edge.StartNodeId} that does not exist in the list of nodes", Severity.Warning);
|
||||
return;
|
||||
}
|
||||
if (!orderMsg.Nodes.Any(n => n.NodeId == edge.EndNodeId))
|
||||
{
|
||||
Snackbar.Add($"The edge {edge.EdgeId} references a startNodeId {edge.EndNodeId} that does not exist in the list of nodes", Severity.Warning);
|
||||
return;
|
||||
}
|
||||
}
|
||||
|
||||
var response = await Http.PostAsJsonAsync("/api/order",orderMsg);
|
||||
|
||||
sendSuccess = response.IsSuccessStatusCode;
|
||||
|
||||
}
|
||||
catch(JsonException jsonEx)
|
||||
{
|
||||
Snackbar.Add($"Json to Order failed: {jsonEx.Message}", Severity.Warning);
|
||||
}
|
||||
catch (Exception ex)
|
||||
{
|
||||
Snackbar.Add($"Send Order failed: {ex.Message}", Severity.Warning);
|
||||
sendSuccess = false;
|
||||
}
|
||||
|
||||
@@ -246,6 +266,33 @@
|
||||
});
|
||||
}
|
||||
|
||||
async Task CancelOrder()
|
||||
{
|
||||
// reset trạng thái trước khi gửi
|
||||
cancelSuccess = null;
|
||||
StateHasChanged();
|
||||
|
||||
try
|
||||
{
|
||||
var res = await Http.PostAsync("/api/order/cancel", null);
|
||||
cancelSuccess = res.IsSuccessStatusCode;
|
||||
}
|
||||
catch
|
||||
{
|
||||
cancelSuccess = false;
|
||||
}
|
||||
|
||||
StateHasChanged();
|
||||
|
||||
// 🔥 AUTO RESET SAU 2 GIÂY
|
||||
_ = Task.Run(async () =>
|
||||
{
|
||||
await Task.Delay(2000);
|
||||
cancelSuccess = null;
|
||||
await InvokeAsync(StateHasChanged);
|
||||
});
|
||||
}
|
||||
|
||||
|
||||
|
||||
async Task CopyJsonToClipboard()
|
||||
@@ -253,7 +300,7 @@
|
||||
_copyCts?.Cancel();
|
||||
_copyCts = new();
|
||||
|
||||
await JS.InvokeVoidAsync("navigator.clipboard.writeText", OrderJson);
|
||||
await JS.InvokeVoidAsync("copyToClipboardFallback", OrderJson);
|
||||
|
||||
copied = true;
|
||||
StateHasChanged();
|
||||
|
||||
@@ -1,6 +1,5 @@
|
||||
@page "/robot-config"
|
||||
@rendermode InteractiveWebAssemblyNoPrerender
|
||||
@attribute [Authorize]
|
||||
|
||||
@inject HttpClient Http
|
||||
@inject ISnackbar Snackbar
|
||||
|
||||
@@ -560,10 +560,14 @@ public partial class RobotConfigManager
|
||||
|
||||
private async Task LoadConfig()
|
||||
{
|
||||
IsLoading = true;
|
||||
StateHasChanged();
|
||||
var response = await (await Http.PostAsync($"api/RobotConfigs/load", null)).Content.ReadFromJsonAsync<MessageResult>();
|
||||
if (response is null) Snackbar.Add("Failed to load config", Severity.Warning);
|
||||
else if (!response.IsSuccess) Snackbar.Add(response.Message ?? "Failed to load config", Severity.Warning);
|
||||
else Snackbar.Add("Config loaded", Severity.Success);
|
||||
|
||||
IsLoading = false;
|
||||
StateHasChanged();
|
||||
}
|
||||
}
|
||||
|
||||
@@ -1,6 +1,5 @@
|
||||
@page "/robot-monitor"
|
||||
@rendermode InteractiveWebAssemblyNoPrerender
|
||||
@attribute [Authorize]
|
||||
@inject RobotApp.Client.Services.RobotMonitorService MonitorService
|
||||
@implements IAsyncDisposable
|
||||
|
||||
@@ -18,6 +17,7 @@
|
||||
|
||||
protected override async Task OnAfterRenderAsync(bool firstRender)
|
||||
{
|
||||
await base.OnAfterRenderAsync(firstRender);
|
||||
if (firstRender)
|
||||
{
|
||||
MonitorService.OnDataReceived += OnMonitorDataReceived;
|
||||
@@ -29,7 +29,8 @@
|
||||
{
|
||||
_monitorData = data;
|
||||
RobotMonitorViewRef?.UpdatePath();
|
||||
InvokeAsync(StateHasChanged);
|
||||
RobotMonitorViewRef?.OnMonitorDataUpdated();
|
||||
StateHasChanged();
|
||||
}
|
||||
|
||||
public async ValueTask DisposeAsync()
|
||||
@@ -40,3 +41,11 @@
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
@@ -107,7 +107,7 @@ public sealed class RobotStateClient : IAsyncDisposable
|
||||
// ================= SIGNALR HANDLERS =================
|
||||
|
||||
// VDA5050 State
|
||||
_connection.On<string>("ReceiveState", HandleState);
|
||||
_connection.On<StateMsg>("ReceiveState", HandleState);
|
||||
|
||||
// Robot connection (bool only)
|
||||
_connection.On<bool>("ReceiveRobotConnection", HandleRobotConnection);
|
||||
@@ -125,22 +125,8 @@ public sealed class RobotStateClient : IAsyncDisposable
|
||||
}
|
||||
|
||||
// ================= HANDLE STATE =================
|
||||
private void HandleState(string stateJson)
|
||||
private void HandleState(StateMsg state)
|
||||
{
|
||||
StateMsg? state;
|
||||
|
||||
try
|
||||
{
|
||||
state = JsonSerializer.Deserialize<StateMsg>(
|
||||
stateJson,
|
||||
JsonOptionExtends.Read
|
||||
);
|
||||
}
|
||||
catch
|
||||
{
|
||||
return;
|
||||
}
|
||||
|
||||
if (state?.SerialNumber == null)
|
||||
return;
|
||||
|
||||
@@ -189,10 +175,10 @@ public sealed class RobotStateClient : IAsyncDisposable
|
||||
}
|
||||
|
||||
// ================= GET CACHE =================
|
||||
public StateMsg? GetLatestState(string serialNumber)
|
||||
public StateMsg? GetLatestState()
|
||||
{
|
||||
LatestStates.TryGetValue(serialNumber, out var state);
|
||||
return state;
|
||||
if (!LatestStates.IsEmpty) return LatestStates.First().Value;
|
||||
return null;
|
||||
}
|
||||
|
||||
// ================= DISPOSE =================
|
||||
|
||||
@@ -1,435 +1,63 @@
|
||||
using RobotApp.VDA5050.InstantAction;
|
||||
using RobotApp.VDA5050.Order;
|
||||
using System.Text.Json;
|
||||
using System.Text.Json.Serialization;
|
||||
|
||||
namespace RobotApp.Client.Services;
|
||||
|
||||
// ======================================================
|
||||
// EDGE UI
|
||||
// ======================================================
|
||||
public class UiEdge
|
||||
{
|
||||
public string EdgeId { get; set; } = "";
|
||||
public int SequenceId { get; set; }
|
||||
public bool Released { get; set; } = true;
|
||||
|
||||
public string StartNodeId { get; set; } = "";
|
||||
public string EndNodeId { get; set; } = "";
|
||||
|
||||
// ===== CURVE (EDITOR GENERATED) =====
|
||||
public double Radius { get; set; } = 0;
|
||||
public Quadrant Quadrant { get; set; }
|
||||
|
||||
// ===== IMPORTED TRAJECTORY =====
|
||||
public bool HasTrajectory { get; set; } = false;
|
||||
public UiTrajectory? Trajectory { get; set; }
|
||||
|
||||
// ===== UI STATE =====
|
||||
public bool Expanded { get; private set; } = false;
|
||||
|
||||
public void MarkExpanded()
|
||||
{
|
||||
Expanded = true;
|
||||
}
|
||||
}
|
||||
|
||||
public class UiTrajectory
|
||||
{
|
||||
public int Degree { get; set; }
|
||||
public double[] KnotVector { get; set; } = Array.Empty<double>();
|
||||
public List<Point> ControlPoints { get; set; } = new();
|
||||
}
|
||||
|
||||
public enum Quadrant
|
||||
{
|
||||
I,
|
||||
II,
|
||||
III,
|
||||
IV
|
||||
}
|
||||
|
||||
// ======================================================
|
||||
// GEOMETRY MODELS
|
||||
// ======================================================
|
||||
public record Point(double X, double Y);
|
||||
|
||||
public record QuarterResult(
|
||||
Point EndPoint,
|
||||
object Trajectory
|
||||
);
|
||||
|
||||
// ======================================================
|
||||
// GEOMETRY HELPER (QUARTER CIRCLE)
|
||||
// ======================================================
|
||||
public static class QuarterGeometry
|
||||
{
|
||||
private const double K = 0.5522847498307936;
|
||||
|
||||
public static QuarterResult BuildQuarterTrajectory(
|
||||
Point A,
|
||||
double r,
|
||||
Quadrant q
|
||||
)
|
||||
{
|
||||
Point P1, P2, C;
|
||||
|
||||
switch (q)
|
||||
{
|
||||
case Quadrant.I:
|
||||
P1 = new(A.X, A.Y + K * r);
|
||||
P2 = new(A.X + K * r, A.Y + r);
|
||||
C = new(A.X + r, A.Y + r);
|
||||
break;
|
||||
|
||||
case Quadrant.II:
|
||||
P1 = new(A.X - K * r, A.Y);
|
||||
P2 = new(A.X - r, A.Y + K * r);
|
||||
C = new(A.X - r, A.Y + r);
|
||||
break;
|
||||
|
||||
case Quadrant.III:
|
||||
P1 = new(A.X, A.Y - K * r);
|
||||
P2 = new(A.X - K * r, A.Y - r);
|
||||
C = new(A.X - r, A.Y - r);
|
||||
break;
|
||||
|
||||
case Quadrant.IV:
|
||||
P1 = new(A.X + K * r, A.Y);
|
||||
P2 = new(A.X + r, A.Y - K * r);
|
||||
C = new(A.X + r, A.Y - r);
|
||||
break;
|
||||
|
||||
default:
|
||||
throw new ArgumentOutOfRangeException(nameof(q));
|
||||
}
|
||||
|
||||
return new QuarterResult(
|
||||
C,
|
||||
new
|
||||
{
|
||||
degree = 3,
|
||||
knotVector = new[] { 0, 0, 0, 0, 1, 1, 1, 1 },
|
||||
controlPoints = new[]
|
||||
{
|
||||
new { x = A.X, y = A.Y }, // P0
|
||||
new { x = P1.X, y = P1.Y }, // P1
|
||||
new { x = P2.X, y = P2.Y }, // P2
|
||||
new { x = C.X, y = C.Y } // P3
|
||||
}
|
||||
}
|
||||
);
|
||||
}
|
||||
}
|
||||
// ======================================================
|
||||
// ORDER MESSAGE
|
||||
// ======================================================
|
||||
public class OrderMessage
|
||||
{
|
||||
public int HeaderId { get; set; }
|
||||
public string Timestamp { get; set; } = "";
|
||||
public string Version { get; set; } = "v1";
|
||||
public string Manufacturer { get; set; } = "PNKX";
|
||||
public string SerialNumber { get; set; } = "T800-002";
|
||||
public string OrderId { get; set; } = Guid.NewGuid().ToString();
|
||||
public uint HeaderId { get; set; }
|
||||
public string Timestamp { get; set; } = DateTime.UtcNow.ToString("yyyy-MM-ddTHH:mm:ss.fffZ");
|
||||
public string Version { get; set; } = "2.1.0";
|
||||
public string Manufacturer { get; set; } = "PhenikaaX";
|
||||
public string SerialNumber { get; set; } = "T800-003";
|
||||
public string OrderId { get; set; } = "";
|
||||
public int OrderUpdateId { get; set; }
|
||||
public string? ZoneSetId { get; set; }
|
||||
|
||||
public List<Node> Nodes { get; set; } = new();
|
||||
public List<UiEdge> Edges { get; set; } = new();
|
||||
public static Node CreateCurveNode(Node startNode, UiEdge edge)
|
||||
public List<Node> Nodes { get; set; } = [];
|
||||
public List<Edge> Edges { get; set; } = [];
|
||||
|
||||
public OrderMsg ToSchemaObject()
|
||||
{
|
||||
var A = new Point(
|
||||
startNode.NodePosition.X,
|
||||
startNode.NodePosition.Y
|
||||
);
|
||||
|
||||
var result = QuarterGeometry.BuildQuarterTrajectory(
|
||||
A,
|
||||
edge.Radius,
|
||||
edge.Quadrant
|
||||
);
|
||||
|
||||
return new Node
|
||||
return new OrderMsg
|
||||
{
|
||||
NodeId = $"NODE_C{Guid.NewGuid():N}".Substring(0, 12),
|
||||
Released = true,
|
||||
NodePosition = new NodePosition
|
||||
{
|
||||
X = result.EndPoint.X,
|
||||
Y = result.EndPoint.Y,
|
||||
Theta = startNode.NodePosition.Theta,
|
||||
MapId = startNode.NodePosition.MapId
|
||||
}
|
||||
};
|
||||
}
|
||||
public static OrderMessage FromSchemaObject(JsonElement root)
|
||||
{
|
||||
var order = new OrderMessage
|
||||
{
|
||||
HeaderId = root.GetProperty("headerId").GetInt32(),
|
||||
Timestamp = root.GetProperty("timestamp").GetString(),
|
||||
Version = root.GetProperty("version").GetString(),
|
||||
Manufacturer = root.GetProperty("manufacturer").GetString(),
|
||||
SerialNumber = root.GetProperty("serialNumber").GetString(),
|
||||
OrderId = root.GetProperty("orderId").GetString(),
|
||||
OrderUpdateId = root.GetProperty("orderUpdateId").GetInt32()
|
||||
};
|
||||
HeaderId = (uint)HeaderId++,
|
||||
|
||||
// ================= NODES =================
|
||||
foreach (var n in root.GetProperty("nodes").EnumerateArray())
|
||||
{
|
||||
var node = new Node
|
||||
{
|
||||
NodeId = n.GetProperty("nodeId").GetString()!,
|
||||
SequenceId = n.GetProperty("sequenceId").GetInt32(),
|
||||
Released = n.GetProperty("released").GetBoolean(),
|
||||
Timestamp = DateTime.UtcNow.ToString("yyyy-MM-ddTHH:mm:ss.fffZ"),
|
||||
|
||||
NodePosition = new NodePosition
|
||||
{
|
||||
X = n.GetProperty("nodePosition").GetProperty("x").GetDouble(),
|
||||
Y = n.GetProperty("nodePosition").GetProperty("y").GetDouble(),
|
||||
Theta = n.GetProperty("nodePosition").GetProperty("theta").GetDouble(),
|
||||
AllowedDeviationXY = n.GetProperty("nodePosition").GetProperty("allowedDeviationXY").GetDouble(),
|
||||
AllowedDeviationTheta = n.GetProperty("nodePosition").GetProperty("allowedDeviationTheta").GetDouble(),
|
||||
MapId = n.GetProperty("nodePosition").GetProperty("mapId").GetString()
|
||||
},
|
||||
Version = Version,
|
||||
Manufacturer = Manufacturer,
|
||||
SerialNumber = SerialNumber,
|
||||
|
||||
Actions = ParseActions(n)
|
||||
};
|
||||
OrderId = OrderId= Guid.NewGuid().ToString(),
|
||||
OrderUpdateId = OrderUpdateId,
|
||||
|
||||
order.Nodes.Add(node);
|
||||
}
|
||||
|
||||
foreach (var e in root.GetProperty("edges").EnumerateArray())
|
||||
{
|
||||
var edge = new UiEdge
|
||||
{
|
||||
EdgeId = e.GetProperty("edgeId").GetString()!,
|
||||
SequenceId = e.GetProperty("sequenceId").GetInt32(),
|
||||
Released = e.GetProperty("released").GetBoolean(),
|
||||
StartNodeId = e.GetProperty("startNodeId").GetString()!,
|
||||
EndNodeId = e.GetProperty("endNodeId").GetString()!,
|
||||
};
|
||||
|
||||
// ===== IMPORT TRAJECTORY =====
|
||||
if (e.TryGetProperty("trajectory", out var traj))
|
||||
{
|
||||
edge.HasTrajectory = true;
|
||||
edge.Trajectory = new UiTrajectory
|
||||
{
|
||||
Degree = traj.GetProperty("degree").GetInt32(),
|
||||
KnotVector = traj.GetProperty("knotVector")
|
||||
.EnumerateArray()
|
||||
.Select(x => x.GetDouble())
|
||||
.ToArray(),
|
||||
|
||||
ControlPoints = traj.GetProperty("controlPoints")
|
||||
.EnumerateArray()
|
||||
.Select(p => new Point(
|
||||
p.GetProperty("x").GetDouble(),
|
||||
p.GetProperty("y").GetDouble()
|
||||
))
|
||||
.ToList()
|
||||
};
|
||||
|
||||
// 🔥 IMPORTED CURVE → LOCK APPLY
|
||||
edge.MarkExpanded();
|
||||
}
|
||||
|
||||
order.Edges.Add(edge);
|
||||
}
|
||||
|
||||
return order;
|
||||
}
|
||||
|
||||
// ================= ACTION PARSER =================
|
||||
private static VDA5050.InstantAction.Action[] ParseActions(JsonElement parent)
|
||||
{
|
||||
if (!parent.TryGetProperty("actions", out var acts))
|
||||
return Array.Empty<VDA5050.InstantAction.Action>();
|
||||
|
||||
return acts.EnumerateArray().Select(a =>
|
||||
new VDA5050.InstantAction.Action
|
||||
{
|
||||
ActionId = a.GetProperty("actionId").GetString(),
|
||||
ActionType = a.GetProperty("actionType").GetString(),
|
||||
BlockingType = a.GetProperty("blockingType").GetString(),
|
||||
|
||||
ActionParameters = a.TryGetProperty("actionParameters", out var ps)
|
||||
? ps.EnumerateArray()
|
||||
.Select(p => new ActionParameter
|
||||
{
|
||||
Key = p.GetProperty("key").GetString(),
|
||||
Value = p.GetProperty("value").GetString()
|
||||
})
|
||||
.ToArray()
|
||||
: Array.Empty<ActionParameter>()
|
||||
}
|
||||
).ToArray();
|
||||
}
|
||||
public object ToSchemaObject()
|
||||
{
|
||||
// ================= SORT NODES BY UI SEQUENCE =================
|
||||
var orderedNodes = Nodes
|
||||
.OrderBy(n => n.SequenceId)
|
||||
.ToList();
|
||||
|
||||
// ================= BUILD NODE OBJECTS =================
|
||||
var nodeObjects = orderedNodes
|
||||
.Select((n, index) => new
|
||||
{
|
||||
nodeId = n.NodeId,
|
||||
sequenceId = index * 2, // ✅ NODE = EVEN
|
||||
released = n.Released,
|
||||
|
||||
nodePosition = new
|
||||
{
|
||||
x = n.NodePosition.X,
|
||||
y = n.NodePosition.Y,
|
||||
theta = n.NodePosition.Theta,
|
||||
|
||||
allowedDeviationXY = n.NodePosition.AllowedDeviationXY,
|
||||
allowedDeviationTheta = n.NodePosition.AllowedDeviationTheta,
|
||||
|
||||
mapId = string.IsNullOrWhiteSpace(n.NodePosition.MapId)
|
||||
? "MAP_01"
|
||||
: n.NodePosition.MapId
|
||||
},
|
||||
|
||||
actions = n.Actions?
|
||||
.Select(a => new
|
||||
{
|
||||
actionId = a.ActionId,
|
||||
actionType = a.ActionType,
|
||||
blockingType = a.BlockingType,
|
||||
|
||||
actionParameters = a.ActionParameters?
|
||||
.Select(p => new
|
||||
{
|
||||
key = p.Key,
|
||||
value = p.Value
|
||||
})
|
||||
.ToArray()
|
||||
?? Array.Empty<object>()
|
||||
})
|
||||
.ToArray()
|
||||
?? Array.Empty<object>()
|
||||
})
|
||||
.ToArray();
|
||||
|
||||
// ================= BUILD EDGE OBJECTS =================
|
||||
var edgeObjects = Edges
|
||||
.Select<UiEdge, object>((e, index) =>
|
||||
{
|
||||
int sequenceId = index * 2 + 1; // ✅ EDGE = ODD
|
||||
|
||||
// ---------- BASE ----------
|
||||
var baseEdge = new
|
||||
{
|
||||
edgeId = e.EdgeId,
|
||||
sequenceId,
|
||||
released = true,
|
||||
startNodeId = e.StartNodeId,
|
||||
endNodeId = e.EndNodeId
|
||||
};
|
||||
|
||||
// =================================================
|
||||
// 1️⃣ IMPORTED TRAJECTORY
|
||||
// =================================================
|
||||
if (e.HasTrajectory && e.Trajectory != null)
|
||||
{
|
||||
return new
|
||||
{
|
||||
baseEdge.edgeId,
|
||||
baseEdge.sequenceId,
|
||||
baseEdge.released,
|
||||
baseEdge.startNodeId,
|
||||
baseEdge.endNodeId,
|
||||
|
||||
trajectory = new
|
||||
{
|
||||
degree = e.Trajectory.Degree,
|
||||
knotVector = e.Trajectory.KnotVector,
|
||||
controlPoints = e.Trajectory.ControlPoints
|
||||
.Select(p => new { x = p.X, y = p.Y })
|
||||
.ToArray()
|
||||
},
|
||||
|
||||
actions = Array.Empty<object>()
|
||||
};
|
||||
}
|
||||
|
||||
// =================================================
|
||||
// 2️⃣ STRAIGHT EDGE
|
||||
// =================================================
|
||||
if (e.Radius <= 0)
|
||||
{
|
||||
return new
|
||||
{
|
||||
baseEdge.edgeId,
|
||||
baseEdge.sequenceId,
|
||||
baseEdge.released,
|
||||
baseEdge.startNodeId,
|
||||
baseEdge.endNodeId,
|
||||
actions = Array.Empty<object>()
|
||||
};
|
||||
}
|
||||
|
||||
// =================================================
|
||||
// 3️⃣ GENERATED CURVE (EDITOR)
|
||||
// =================================================
|
||||
var startNode = orderedNodes.First(n => n.NodeId == e.StartNodeId);
|
||||
|
||||
var A = new Point(
|
||||
startNode.NodePosition.X,
|
||||
startNode.NodePosition.Y
|
||||
);
|
||||
|
||||
var result = QuarterGeometry.BuildQuarterTrajectory(
|
||||
A,
|
||||
e.Radius,
|
||||
e.Quadrant
|
||||
);
|
||||
|
||||
return new
|
||||
{
|
||||
baseEdge.edgeId,
|
||||
baseEdge.sequenceId,
|
||||
baseEdge.released,
|
||||
baseEdge.startNodeId,
|
||||
baseEdge.endNodeId,
|
||||
|
||||
trajectory = result.Trajectory,
|
||||
actions = Array.Empty<object>()
|
||||
};
|
||||
})
|
||||
.ToArray();
|
||||
|
||||
// ================= FINAL SCHEMA OBJECT =================
|
||||
return new
|
||||
{
|
||||
headerId = HeaderId++,
|
||||
|
||||
timestamp = string.IsNullOrWhiteSpace(Timestamp)
|
||||
? DateTime.UtcNow.ToString("O")
|
||||
: Timestamp,
|
||||
|
||||
version = Version,
|
||||
manufacturer = Manufacturer,
|
||||
serialNumber = SerialNumber,
|
||||
|
||||
orderId = OrderId,
|
||||
orderUpdateId = OrderUpdateId,
|
||||
|
||||
zoneSetId = string.IsNullOrWhiteSpace(ZoneSetId)
|
||||
ZoneSetId = string.IsNullOrWhiteSpace(ZoneSetId)
|
||||
? null
|
||||
: ZoneSetId,
|
||||
|
||||
nodes = nodeObjects,
|
||||
edges = edgeObjects
|
||||
Nodes = [..Nodes],
|
||||
Edges = [..Edges],
|
||||
};
|
||||
}
|
||||
|
||||
public void Import(OrderMsg order)
|
||||
{
|
||||
HeaderId = order.HeaderId;
|
||||
Timestamp = order.Timestamp;
|
||||
Version = order.Version;
|
||||
Manufacturer = order.Manufacturer;
|
||||
SerialNumber = order.SerialNumber;
|
||||
OrderId = order.OrderId;
|
||||
ZoneSetId = order.ZoneSetId;
|
||||
OrderUpdateId = order.OrderUpdateId;
|
||||
Nodes = [.. order.Nodes];
|
||||
Edges = [.. order.Edges];
|
||||
}
|
||||
}
|
||||
|
||||
// ======================================================
|
||||
|
||||
BIN
RobotApp.Client/wwwroot/images/gara20250309.png
Normal file
BIN
RobotApp.Client/wwwroot/images/gara20250309.png
Normal file
Binary file not shown.
|
After Width: | Height: | Size: 25 KiB |
@@ -1 +1,10 @@
|
||||
|
||||
window.copyToClipboardFallback = function (text) {
|
||||
const textarea = document.createElement('textarea');
|
||||
textarea.value = text;
|
||||
textarea.style.position = 'fixed';
|
||||
textarea.style.opacity = '0';
|
||||
document.body.appendChild(textarea);
|
||||
textarea.select();
|
||||
document.execCommand('copy');
|
||||
document.body.removeChild(textarea);
|
||||
}
|
||||
@@ -55,7 +55,31 @@ window.robotMonitor = {
|
||||
}
|
||||
|
||||
return `M ${startX} ${startY} L ${endX} ${endY}`;
|
||||
},
|
||||
|
||||
// Load image and get dimensions
|
||||
loadImageAndGetDimensions: function (imageUrl) {
|
||||
return new Promise((resolve, reject) => {
|
||||
const img = new Image();
|
||||
img.onload = () => {
|
||||
resolve({
|
||||
Width: img.naturalWidth || img.width,
|
||||
Height: img.naturalHeight || img.height
|
||||
});
|
||||
};
|
||||
img.onerror = () => {
|
||||
reject(new Error(`Failed to load image: ${imageUrl}`));
|
||||
};
|
||||
img.src = imageUrl;
|
||||
});
|
||||
}
|
||||
};
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
@@ -2,7 +2,6 @@
|
||||
|
||||
namespace RobotApp.VDA5050.Order;
|
||||
|
||||
#nullable disable
|
||||
|
||||
public class Edge
|
||||
{
|
||||
@@ -26,7 +25,7 @@ public class Edge
|
||||
public bool RotationAllowed { get; set; }
|
||||
public double MaxRotationSpeed { get; set; }
|
||||
public double Length { get; set; }
|
||||
public Trajectory Trajectory { get; set; }
|
||||
public Trajectory? Trajectory { get; set; }
|
||||
public Corridor Corridor { get; set; } = new();
|
||||
[Required]
|
||||
public InstantAction.Action[] Actions { get; set; } = [];
|
||||
|
||||
@@ -13,5 +13,5 @@ public class EdgeState
|
||||
public string EdgeDescription { get; set; } = string.Empty;
|
||||
[Required]
|
||||
public bool Released { get; set; }
|
||||
public Trajectory Trajectory { get; set; } = new();
|
||||
public Trajectory? Trajectory { get; set; }
|
||||
}
|
||||
|
||||
@@ -21,7 +21,7 @@ public enum ActionType
|
||||
//liftUp,
|
||||
//liftDown,
|
||||
//liftRotate,
|
||||
//rotate,
|
||||
rotate,
|
||||
//rotateKeepLift,
|
||||
//mutedBaseOn,
|
||||
//mutedBaseOff,
|
||||
|
||||
@@ -42,6 +42,7 @@
|
||||
<script src="@Assets["_content/MudBlazor/MudBlazor.min.js"]"></script>
|
||||
<script src="@Assets["js/canvas.js"]"></script>
|
||||
<script src="@Assets["js/app.js"]"></script>
|
||||
<script src="@Assets["js/robotMonitor.js"]"></script>
|
||||
</body>
|
||||
|
||||
</html>
|
||||
|
||||
@@ -3,8 +3,6 @@
|
||||
|
||||
@rendermode InteractiveServer
|
||||
|
||||
@attribute [Authorize]
|
||||
|
||||
@inject NavigationManager Nav
|
||||
|
||||
@code
|
||||
|
||||
@@ -6,7 +6,8 @@ namespace RobotApp.Controllers;
|
||||
|
||||
[Route("api/[controller]")]
|
||||
[ApiController]
|
||||
[Authorize]
|
||||
//[Authorize]
|
||||
[AllowAnonymous]
|
||||
public class FileController(Services.Logger<FileController> Logger) : ControllerBase
|
||||
{
|
||||
private readonly string certificatesPath = "MqttCertificates";
|
||||
|
||||
@@ -5,6 +5,7 @@ namespace RobotApp.Controllers;
|
||||
|
||||
[Route("api/[controller]")]
|
||||
[ApiController]
|
||||
//[Authorize]
|
||||
[AllowAnonymous]
|
||||
public class ImagesController(Services.Logger<ImagesController> Logger) : ControllerBase
|
||||
{
|
||||
|
||||
@@ -5,7 +5,8 @@ namespace RobotApp.Controllers;
|
||||
|
||||
[Route("api/[controller]")]
|
||||
[ApiController]
|
||||
[Authorize]
|
||||
//[Authorize]
|
||||
[AllowAnonymous]
|
||||
public class LogsManagerController(Services.Logger<LogsManagerController> Logger) : ControllerBase
|
||||
{
|
||||
private readonly string LoggerDirectory = "logs";
|
||||
|
||||
@@ -1,5 +1,6 @@
|
||||
using Microsoft.AspNetCore.Mvc;
|
||||
using RobotApp.Services.Robot;
|
||||
using Microsoft.AspNetCore.Authorization;
|
||||
using Microsoft.AspNetCore.Mvc;
|
||||
using RobotApp.Interfaces;
|
||||
using RobotApp.VDA5050.Order;
|
||||
using System.Text.Json;
|
||||
|
||||
@@ -7,30 +8,30 @@ namespace RobotApp.Controllers;
|
||||
|
||||
[ApiController]
|
||||
[Route("api/order")]
|
||||
public class OrderController : ControllerBase
|
||||
//[Authorize]
|
||||
[AllowAnonymous]
|
||||
public class OrderController(IOrder robotOrderController, IInstantActions instantActions) : ControllerBase
|
||||
{
|
||||
private readonly RobotOrderController robotOrderController;
|
||||
|
||||
public OrderController(RobotOrderController robotOrderController)
|
||||
{
|
||||
this.robotOrderController = robotOrderController;
|
||||
}
|
||||
|
||||
[HttpPost]
|
||||
public IActionResult SendOrder([FromBody] OrderMsg order)
|
||||
{
|
||||
Console.WriteLine("===== ORDER RECEIVED =====");
|
||||
Console.WriteLine(JsonSerializer.Serialize(order, new JsonSerializerOptions
|
||||
{
|
||||
WriteIndented = true
|
||||
}));
|
||||
|
||||
robotOrderController.UpdateOrder(order);
|
||||
|
||||
return Ok(new
|
||||
{
|
||||
success = true,
|
||||
message = "Order received"
|
||||
});
|
||||
}
|
||||
}
|
||||
|
||||
[HttpPost("cancel")]
|
||||
public IActionResult CancelOrder()
|
||||
{
|
||||
robotOrderController.StopOrder();
|
||||
instantActions.StopOrderAction();
|
||||
return Ok(new
|
||||
{
|
||||
success = true,
|
||||
message = "Order and actions have been cancelled"
|
||||
});
|
||||
}
|
||||
}
|
||||
|
||||
@@ -10,7 +10,8 @@ namespace RobotApp.Controllers;
|
||||
|
||||
[Route("api/[controller]")]
|
||||
[ApiController]
|
||||
[Authorize]
|
||||
//[Authorize]
|
||||
[AllowAnonymous]
|
||||
public class RobotConfigsController(Services.Logger<RobotConfigsController> Logger, ApplicationDbContext AppDb, RobotConfiguration RobotConfiguration) : ControllerBase
|
||||
{
|
||||
[HttpGet]
|
||||
|
||||
@@ -155,7 +155,7 @@ public static class ApplicationDbExtensions
|
||||
VDA5050EnableTls = false,
|
||||
VDA5050UserName = "robotics",
|
||||
VDA5050Password = "robotics",
|
||||
VDA5050TopicPrefix = "uagv/v2"
|
||||
VDA5050TopicPrefix = "uagv/v2",
|
||||
IsActive = true,
|
||||
CreatedAt = DateTime.Now,
|
||||
UpdatedAt = DateTime.Now,
|
||||
|
||||
@@ -21,8 +21,8 @@ namespace RobotApp.Hubs
|
||||
// Phương thức này sẽ được gọi từ service để broadcast
|
||||
public async Task SendState(string serialNumber, StateMsg state)
|
||||
{
|
||||
var json = JsonSerializer.Serialize(state, JsonOptionExtends.Write);
|
||||
await Clients.Group(serialNumber).SendAsync("ReceiveState", json);
|
||||
//var json = JsonSerializer.Serialize(state, JsonOptionExtends.Write);
|
||||
await Clients.Group(serialNumber).SendAsync("ReceiveState", state);
|
||||
}
|
||||
}
|
||||
}
|
||||
@@ -11,3 +11,10 @@ public class RobotMonitorHub : Hub
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
@@ -63,7 +63,7 @@ builder.Services.AddRobot();
|
||||
builder.Services.AddSingleton<RobotApp.Services.RobotMonitorService>();
|
||||
builder.Services.AddHostedService(sp => sp.GetRequiredService<RobotApp.Services.RobotMonitorService>());
|
||||
|
||||
builder.Services.AddScoped<RobotStateClient>();
|
||||
//builder.Services.AddScoped<RobotStateClient>();
|
||||
builder.Services.AddHostedService<RobotStatePublisher>();
|
||||
|
||||
var app = builder.Build();
|
||||
|
||||
@@ -6,22 +6,22 @@
|
||||
"dotnetRunMessages": true,
|
||||
"launchBrowser": true,
|
||||
"workingDirectory": "$(TargetDir)",
|
||||
"inspectUri": "{wsProtocol}://{url.hostname}:{url.port}/_framework/debug/ws-proxy?browser={browserInspectUri}",
|
||||
//"inspectUri": "{wsProtocol}://{url.hostname}:{url.port}/_framework/debug/ws-proxy?browser={browserInspectUri}",
|
||||
"applicationUrl": "http://localhost:5229",
|
||||
"environmentVariables": {
|
||||
"ASPNETCORE_ENVIRONMENT": "Development"
|
||||
}
|
||||
},
|
||||
"https": {
|
||||
"commandName": "Project",
|
||||
"dotnetRunMessages": true,
|
||||
"launchBrowser": true,
|
||||
"workingDirectory": "$(TargetDir)",
|
||||
//"inspectUri": "{wsProtocol}://{url.hostname}:{url.port}/_framework/debug/ws-proxy?browser={browserInspectUri}",
|
||||
"applicationUrl": "https://0.0.0.0:7150;http://localhost:5229",
|
||||
"environmentVariables": {
|
||||
"ASPNETCORE_ENVIRONMENT": "Development"
|
||||
}
|
||||
}
|
||||
//"https": {
|
||||
// "commandName": "Project",
|
||||
// "dotnetRunMessages": true,
|
||||
// "launchBrowser": true,
|
||||
// "workingDirectory": "$(TargetDir)",
|
||||
// //"inspectUri": "{wsProtocol}://{url.hostname}:{url.port}/_framework/debug/ws-proxy?browser={browserInspectUri}",
|
||||
// "applicationUrl": "https://0.0.0.0:7150;http://localhost:5229",
|
||||
// "environmentVariables": {
|
||||
// "ASPNETCORE_ENVIRONMENT": "Development"
|
||||
// }
|
||||
//}
|
||||
}
|
||||
}
|
||||
|
||||
@@ -116,7 +116,7 @@ public class HighPrecisionTimer<T>(int Interval, Action Callback, Logger<T>? Log
|
||||
Thread.Start();
|
||||
}
|
||||
}
|
||||
else throw new ObjectDisposedException(nameof(WatchTimer<T>));
|
||||
else throw new ObjectDisposedException(nameof(HighPrecisionTimer<T>));
|
||||
}
|
||||
|
||||
public void Stop()
|
||||
|
||||
@@ -147,11 +147,11 @@ public class MQTTClient : IAsyncDisposable
|
||||
|
||||
MqttClient = MqttClientFactory.CreateMqttClient();
|
||||
|
||||
//MqttClient.ApplicationMessageReceivedAsync -= OnMessageReceived;
|
||||
MqttClient.ApplicationMessageReceivedAsync -= OnMessageReceived;
|
||||
MqttClient.ApplicationMessageReceivedAsync += OnMessageReceived;
|
||||
//MqttClient.DisconnectedAsync -= OnDisconnected;
|
||||
MqttClient.DisconnectedAsync -= OnDisconnected;
|
||||
MqttClient.DisconnectedAsync += OnDisconnected;
|
||||
while (!cancellationToken.IsCancellationRequested)
|
||||
while (!cancellationToken.IsCancellationRequested && !IsDisposed)
|
||||
{
|
||||
try
|
||||
{
|
||||
@@ -168,7 +168,11 @@ public class MQTTClient : IAsyncDisposable
|
||||
{
|
||||
Logger.Error($"Lỗi khi tạo MQTT client: {ex.Message}");
|
||||
}
|
||||
await Task.Delay(3000, cancellationToken);
|
||||
try
|
||||
{
|
||||
await Task.Delay(3000, cancellationToken);
|
||||
}
|
||||
catch { }
|
||||
}
|
||||
}
|
||||
else throw new ObjectDisposedException(nameof(MQTTClient));
|
||||
@@ -195,17 +199,6 @@ public class MQTTClient : IAsyncDisposable
|
||||
arg.Chain.ChainPolicy.VerificationFlags = X509VerificationFlags.AllowUnknownCertificateAuthority;
|
||||
|
||||
var isValid = arg.Chain.Build((X509Certificate2)arg.Certificate);
|
||||
|
||||
if (isValid)
|
||||
{
|
||||
Console.WriteLine("Broker CERTIFICATE VALID");
|
||||
}
|
||||
else
|
||||
{
|
||||
Console.WriteLine("Broker CERTIFICATE INVALID");
|
||||
foreach (var status in arg.Chain.ChainStatus)
|
||||
Console.WriteLine($" -> Chain error: {status.Status} - {status.StatusInformation}");
|
||||
}
|
||||
return isValid;
|
||||
}
|
||||
}
|
||||
@@ -230,10 +223,10 @@ public class MQTTClient : IAsyncDisposable
|
||||
var tlsOptions = new MqttClientTlsOptionsBuilder()
|
||||
.UseTls(true)
|
||||
.WithSslProtocols(System.Security.Authentication.SslProtocols.Tls12 | System.Security.Authentication.SslProtocols.Tls13)
|
||||
//.WithCertificateValidationHandler(ValidateCertificates)
|
||||
.WithCertificateValidationHandler(ValidateCertificates)
|
||||
.WithClientCertificatesProvider(new MQTTClientCertificatesProvider(VDA5050Setting.CerFile, VDA5050Setting.KeyFile))
|
||||
.Build();
|
||||
builder = builder.WithTlsOptions(tlsOptions);
|
||||
builder = builder.WithTlsOptions(tlsOptions);
|
||||
}
|
||||
MqttClientOptions = builder.Build();
|
||||
}
|
||||
@@ -262,42 +255,42 @@ public class MQTTClient : IAsyncDisposable
|
||||
{
|
||||
//if (!IsDisposed)
|
||||
//{
|
||||
if (MqttClient is null) throw new Exception("Kết nối tới broker chưa được khởi tạo nhưng đã yêu cầu subscribe");
|
||||
if (!MqttClient.IsConnected) throw new Exception("Kết nối tới broker chưa thành công nhưng đã yêu cầu subscribe");
|
||||
if (MqttClient is null) throw new Exception("Kết nối tới broker chưa được khởi tạo nhưng đã yêu cầu subscribe");
|
||||
if (!MqttClient.IsConnected) throw new Exception("Kết nối tới broker chưa thành công nhưng đã yêu cầu subscribe");
|
||||
|
||||
|
||||
while (!cancellationToken.IsCancellationRequested)
|
||||
while (!cancellationToken.IsCancellationRequested)
|
||||
{
|
||||
try
|
||||
{
|
||||
try
|
||||
var response = await MqttClient.SubscribeAsync(MqttClientSubscribeOptions, cancellationToken);
|
||||
bool isSuccess = true;
|
||||
foreach (var item in response.Items)
|
||||
{
|
||||
var response = await MqttClient.SubscribeAsync(MqttClientSubscribeOptions, cancellationToken);
|
||||
bool isSuccess = true;
|
||||
foreach (var item in response.Items)
|
||||
if (item.ResultCode == MqttClientSubscribeResultCode.GrantedQoS0 ||
|
||||
item.ResultCode == MqttClientSubscribeResultCode.GrantedQoS1 ||
|
||||
item.ResultCode == MqttClientSubscribeResultCode.GrantedQoS2)
|
||||
{
|
||||
if (item.ResultCode == MqttClientSubscribeResultCode.GrantedQoS0 ||
|
||||
item.ResultCode == MqttClientSubscribeResultCode.GrantedQoS1 ||
|
||||
item.ResultCode == MqttClientSubscribeResultCode.GrantedQoS2)
|
||||
{
|
||||
Logger.Info($"Subscribe thành công cho topic: {item.TopicFilter.Topic} với QoS: {item.ResultCode}");
|
||||
}
|
||||
else
|
||||
{
|
||||
Logger.Warning($"Subscribe thất bại cho topic: {item.TopicFilter.Topic}. Lý do: {response.ReasonString}");
|
||||
isSuccess = false;
|
||||
break;
|
||||
}
|
||||
Logger.Info($"Subscribe thành công cho topic: {item.TopicFilter.Topic} với QoS: {item.ResultCode}");
|
||||
}
|
||||
else
|
||||
{
|
||||
Logger.Warning($"Subscribe thất bại cho topic: {item.TopicFilter.Topic}. Lý do: {response.ReasonString}");
|
||||
isSuccess = false;
|
||||
break;
|
||||
}
|
||||
if (isSuccess) break;
|
||||
}
|
||||
catch (Exception ex)
|
||||
{
|
||||
Logger.Error($"Lỗi khi subscribe: {ex.Message}");
|
||||
}
|
||||
if (!cancellationToken.IsCancellationRequested && !IsDisposed)
|
||||
{
|
||||
await Task.Delay(3000, cancellationToken);
|
||||
}
|
||||
if (isSuccess) break;
|
||||
}
|
||||
catch (Exception ex)
|
||||
{
|
||||
Logger.Error($"Lỗi khi subscribe: {ex.Message}");
|
||||
}
|
||||
if (!cancellationToken.IsCancellationRequested && !IsDisposed)
|
||||
{
|
||||
await Task.Delay(3000, cancellationToken);
|
||||
}
|
||||
}
|
||||
//}
|
||||
//else throw new ObjectDisposedException(nameof(MQTTClient));
|
||||
}
|
||||
|
||||
@@ -27,7 +27,6 @@ public class MQTTClientCertificatesProvider(string? CerFile, string? KeyFile) :
|
||||
var cert = X509Certificate2.CreateFromPem(File.ReadAllText(certLocal), File.ReadAllText(keyLocal));
|
||||
var pfxBytes = cert.Export(X509ContentType.Pfx);
|
||||
var pfxCert = X509CertificateLoader.LoadPkcs12(pfxBytes, "", X509KeyStorageFlags.Exportable | X509KeyStorageFlags.PersistKeySet);
|
||||
Console.WriteLine($"Client cert loaded: {pfxCert.Subject}, HasPrivateKey: {pfxCert.HasPrivateKey}, PrivateKey Type: {pfxCert.GetRSAPrivateKey()?.GetType()}");
|
||||
return [pfxCert];
|
||||
}
|
||||
}
|
||||
|
||||
@@ -96,7 +96,6 @@ public abstract class RobotAction(IServiceProvider serviceProvider) : IDisposabl
|
||||
|
||||
protected virtual Task StopAction()
|
||||
{
|
||||
Console.WriteLine($"StopAction {Type}");
|
||||
Status = ActionStatus.FAILED;
|
||||
ResultDescription = "Action bị hủy bỏ.";
|
||||
return Task.CompletedTask;
|
||||
|
||||
@@ -21,7 +21,7 @@ public class RobotActionStorage(IServiceProvider ServiceProvider)
|
||||
ActionType.drop => new RobotDropAction(ServiceProvider),
|
||||
ActionType.pick => new RobotPickAction(ServiceProvider),
|
||||
//ActionType.liftRotate => new RobotLiftRotateAction(ServiceProvider),
|
||||
//ActionType.rotate => new RobotRotateAction(ServiceProvider),
|
||||
ActionType.rotate => new RobotRotateAction(ServiceProvider),
|
||||
//ActionType.rotateKeepLift => new RobotRotateKeepLift(ServiceProvider),
|
||||
//ActionType.mutedBaseOn => new RobotMutedBaseOnAction(ServiceProvider),
|
||||
//ActionType.mutedBaseOff => new RobotMutedBaseOffAction(ServiceProvider),
|
||||
|
||||
@@ -57,8 +57,8 @@ public class RobotConfiguration(IServiceProvider ServiceProvider, Logger<RobotCo
|
||||
if (IsReady)
|
||||
{
|
||||
var robotConnection = scope.ServiceProvider.GetRequiredService<RobotConnection>();
|
||||
await robotConnection.StopConnection();
|
||||
_ = Task.Run(async () => await robotConnection.StartConnection(CancellationToken.None));
|
||||
robotConnection.StartConnection();
|
||||
await Task.Delay(1000);
|
||||
}
|
||||
}
|
||||
else throw new Exception("Chưa có cấu hình VDA5050.");
|
||||
|
||||
@@ -3,19 +3,21 @@ using RobotApp.VDA5050;
|
||||
using RobotApp.VDA5050.InstantAction;
|
||||
using RobotApp.VDA5050.Order;
|
||||
using System.Text.Json;
|
||||
using System.Threading;
|
||||
|
||||
namespace RobotApp.Services.Robot;
|
||||
|
||||
public class RobotConnection(RobotConfiguration RobotConfiguration,
|
||||
public class RobotConnection(RobotConfiguration RobotConfiguration,
|
||||
Logger<RobotConnection> Logger,
|
||||
Logger<MQTTClient> MQTTClientLogger)
|
||||
{
|
||||
private readonly VDA5050Setting VDA5050Setting = RobotConfiguration.VDA5050Setting;
|
||||
private MQTTClient? MqttClient;
|
||||
|
||||
public bool IsConnected => MqttClient is not null && MqttClient.IsConnected;
|
||||
public event Action<OrderMsg>? OrderUpdated;
|
||||
public event Action<InstantActionsMsg>? ActionUpdated;
|
||||
private readonly SemaphoreSlim _connectionSemaphore = new(1, 1);
|
||||
private CancellationTokenSource? _connectionCancel;
|
||||
|
||||
|
||||
private void OrderChanged(string data)
|
||||
@@ -24,12 +26,16 @@ public class RobotConnection(RobotConfiguration RobotConfiguration,
|
||||
{
|
||||
//Logger.Debug($"Nhận Order: {data}");
|
||||
var msg = JsonSerializer.Deserialize<OrderMsg>(data, JsonOptionExtends.Read);
|
||||
if (msg is null || string.IsNullOrEmpty(msg.SerialNumber) || msg.SerialNumber != RobotConfiguration.SerialNumber) return;
|
||||
if (msg is null || string.IsNullOrEmpty(msg.SerialNumber) || msg.SerialNumber != RobotConfiguration.SerialNumber)
|
||||
{
|
||||
Logger.Warning($"SerialNumber cuả order không hợp lệ: message SerialNumber {msg?.SerialNumber}");
|
||||
return;
|
||||
}
|
||||
OrderUpdated?.Invoke(msg);
|
||||
}
|
||||
catch (Exception ex)
|
||||
{
|
||||
Logger.Warning($"Nhận Order xảy ra lỗi: {ex.Message} - {ex.StackTrace}");
|
||||
Logger.Warning($"Nhận Order xảy ra lỗi: {ex.Message}");
|
||||
}
|
||||
}
|
||||
|
||||
@@ -39,28 +45,52 @@ public class RobotConnection(RobotConfiguration RobotConfiguration,
|
||||
{
|
||||
//Logger.Debug($"Nhận InstanceActions: {data}");
|
||||
var msg = JsonSerializer.Deserialize<InstantActionsMsg>(data, JsonOptionExtends.Read);
|
||||
if (msg is null || string.IsNullOrEmpty(msg.SerialNumber) || msg.SerialNumber != RobotConfiguration.SerialNumber) return;
|
||||
if (msg is null || string.IsNullOrEmpty(msg.SerialNumber) || msg.SerialNumber != RobotConfiguration.SerialNumber)
|
||||
{
|
||||
Logger.Warning($"SerialNumber của action không hợp lệ: message SerialNumber {msg?.SerialNumber}");
|
||||
return;
|
||||
}
|
||||
ActionUpdated?.Invoke(msg);
|
||||
}
|
||||
catch (Exception ex)
|
||||
{
|
||||
Logger.Warning($"Nhận InstanceActions xảy ra lỗi: {ex.Message} - {ex.StackTrace}");
|
||||
Logger.Warning($"Nhận InstanceActions xảy ra lỗi: {ex.Message}");
|
||||
}
|
||||
}
|
||||
|
||||
public async Task<MessageResult> Publish(string topic, string data)
|
||||
{
|
||||
if (MqttClient is not null && MqttClient.IsConnected) return await MqttClient.PublishAsync($"{VDA5050Setting.TopicPrefix}/{VDA5050Setting.Manufacturer}/{RobotConfiguration.SerialNumber}/{topic}", data);
|
||||
if (MqttClient is not null && MqttClient.IsConnected) return await MqttClient.PublishAsync($"{RobotConfiguration.VDA5050Setting.TopicPrefix}/{RobotConfiguration.VDA5050Setting.Manufacturer}/{RobotConfiguration.SerialNumber}/{topic}", data);
|
||||
return new(false, "Chưa có kết nối tới broker");
|
||||
}
|
||||
|
||||
public async Task StartConnection(CancellationToken cancellationToken)
|
||||
public void StartConnection()
|
||||
{
|
||||
MqttClient = new MQTTClient(RobotConfiguration.SerialNumber, VDA5050Setting, MQTTClientLogger);
|
||||
MqttClient.OrderChanged += OrderChanged;
|
||||
MqttClient.InstanceActionsChanged += InstanceActionsChanged;
|
||||
await MqttClient.ConnectAsync(cancellationToken);
|
||||
await MqttClient.SubscribeAsync(cancellationToken);
|
||||
Task.Run(async () =>
|
||||
{
|
||||
await StartConnectionAsync(CancellationToken.None);
|
||||
if(IsConnected)Logger.Info("Robot đã kết nối tới Fleet Manager.");
|
||||
});
|
||||
}
|
||||
public async Task StartConnectionAsync(CancellationToken cancellationToken)
|
||||
{
|
||||
try
|
||||
{
|
||||
await StopConnection();
|
||||
_connectionCancel?.Cancel();
|
||||
if (_connectionSemaphore.Wait(1000, cancellationToken))
|
||||
{
|
||||
_connectionCancel = CancellationTokenSource.CreateLinkedTokenSource(cancellationToken);
|
||||
MqttClient = new MQTTClient(RobotConfiguration.SerialNumber, RobotConfiguration.VDA5050Setting, MQTTClientLogger);
|
||||
MqttClient.OrderChanged += OrderChanged;
|
||||
MqttClient.InstanceActionsChanged += InstanceActionsChanged;
|
||||
await MqttClient.ConnectAsync(_connectionCancel.Token);
|
||||
if(MqttClient is not null) await MqttClient.SubscribeAsync(_connectionCancel.Token);
|
||||
}
|
||||
}
|
||||
finally
|
||||
{
|
||||
_connectionSemaphore.Release();
|
||||
}
|
||||
}
|
||||
|
||||
public async Task StopConnection()
|
||||
|
||||
@@ -39,8 +39,7 @@ public partial class RobotController
|
||||
|
||||
ConnectionManager.OrderUpdated += NewOrderUpdated;
|
||||
ConnectionManager.ActionUpdated += NewInstantActionUpdated;
|
||||
await ConnectionManager.StartConnection(cancellationToken);
|
||||
Logger.Info("Robot đã kết nối tới Fleet Manager.");
|
||||
ConnectionManager.StartConnection();
|
||||
StateManager.TransitionTo(SystemStateType.Standby);
|
||||
|
||||
if (!RobotConfiguration.IsSimulation)
|
||||
|
||||
@@ -105,7 +105,10 @@ public class RobotErrors : IError
|
||||
=> CreateError(ErrorType.INITIALIZE_ORDER, "Vui lòng kiểm tra lại order", ErrorLevel.WARNING, $"Order mới nhận được không phải là nối tiếp của order khi LastNodeSequenceId: {lastNodeSequenceId} mà node đầu tiên của order mới có sequence: {newStartNodeSequenceId}");
|
||||
public static Error Error1018(int oldOrderUpdateId, int newOrderUpdateId)
|
||||
=> CreateError(ErrorType.INITIALIZE_ORDER, "Vui lòng kiểm tra lại OrderUpdateId", ErrorLevel.WARNING, $"OrderUpdateId {newOrderUpdateId} nhận được nhỏ hơn OrderUpdateId hiện tại là {oldOrderUpdateId}");
|
||||
|
||||
public static Error Error1019()
|
||||
=> CreateError(ErrorType.INITIALIZE_ORDER, "Vui lòng kiểm tra lại Order", ErrorLevel.WARNING, "Order có node đầu tiên quá xa robot");
|
||||
public static Error Error1020()
|
||||
=> CreateError(ErrorType.INITIALIZE_ORDER, "", ErrorLevel.WARNING, "Robot đang ở đích của Order");
|
||||
|
||||
public static Error Error2001()
|
||||
=> CreateError(ErrorType.READ_PERIPHERAL_FAILURE, "2001", ErrorLevel.FATAL, "Có lỗi xảy ra trong quá trình đọc tín hiệu từ hệ thống ngoại vi(PLC)");
|
||||
|
||||
@@ -25,7 +25,7 @@ public class RobotFactsheet(RobotConnection RobotConnection, RobotConfiguration
|
||||
{ ActionType.pick, Pick},
|
||||
{ ActionType.drop, Drop},
|
||||
//{ ActionType.liftRotate, LiftRotate},
|
||||
//{ ActionType.rotate, Rotate},
|
||||
{ ActionType.rotate, Rotate},
|
||||
//{ ActionType.rotateKeepLift, RotateKeepLift},
|
||||
//{ ActionType.mutedBaseOn, MutedBaseOn},
|
||||
//{ ActionType.mutedBaseOff, MutedBaseOff},
|
||||
@@ -224,22 +224,22 @@ public class RobotFactsheet(RobotConnection RobotConnection, RobotConfiguration
|
||||
// BlockingTypes = [BlockingType.HARD.ToString()],
|
||||
//};
|
||||
|
||||
//public readonly static AgvAction Rotate = new()
|
||||
//{
|
||||
// ActionType = ActionType.rotate.ToString(),
|
||||
// ActionDescription = "Xoay robot tại chỗ.",
|
||||
// ActionScopes = [ActionScopes.INSTANT.ToString(), ActionScopes.NODE.ToString()],
|
||||
// ActionParameters = [
|
||||
// new()
|
||||
// {
|
||||
// Key = "angle",
|
||||
// Description = "Góc xoay của robot. (rad)",
|
||||
// ValueDataType = ValueDataType.FLOAT.ToString(),
|
||||
// IsOptional = false,
|
||||
// }],
|
||||
// ResultDescription = "Robot đã xoay tại chỗ.",
|
||||
// BlockingTypes = [BlockingType.HARD.ToString()],
|
||||
//};
|
||||
public readonly static AgvAction Rotate = new()
|
||||
{
|
||||
ActionType = ActionType.rotate.ToString(),
|
||||
ActionDescription = "Xoay robot tại chỗ.",
|
||||
ActionScopes = [ActionScopes.INSTANT.ToString(), ActionScopes.NODE.ToString()],
|
||||
ActionParameters = [
|
||||
new()
|
||||
{
|
||||
Key = "angle",
|
||||
Description = "Góc xoay của robot. (rad)",
|
||||
ValueDataType = ValueDataType.FLOAT.ToString(),
|
||||
IsOptional = false,
|
||||
}],
|
||||
ResultDescription = "Robot đã xoay tại chỗ.",
|
||||
BlockingTypes = [BlockingType.HARD.ToString()],
|
||||
};
|
||||
|
||||
//public readonly static AgvAction RotateKeepLift = new()
|
||||
//{
|
||||
|
||||
@@ -3,7 +3,7 @@ using RobotApp.VDA5050.State;
|
||||
|
||||
namespace RobotApp.Services.Robot;
|
||||
|
||||
public class RobotLoads(IPeripheral PeriperalManager) : ILoad
|
||||
public class RobotLoads() : ILoad
|
||||
{
|
||||
//public Load[] Load => PeriperalManager.HasLoad ? [GetLoad()] : [];
|
||||
public Load[] Load { get; private set; } = [];
|
||||
|
||||
@@ -274,32 +274,37 @@ public class RobotLocalization(RobotConfiguration RobotConfiguration, Simulation
|
||||
{
|
||||
try
|
||||
{
|
||||
var xyzw = QuaternionToXYZW(0, 0, theta);
|
||||
var response = XlocClient.SetInitialPose(new SetInitialPoseRequest()
|
||||
{
|
||||
InitialPose = new Pose()
|
||||
{
|
||||
Position = new Point()
|
||||
{
|
||||
X = x,
|
||||
Y = y,
|
||||
Z = 0,
|
||||
},
|
||||
Orientation = new Quaternion()
|
||||
{
|
||||
X = xyzw.x,
|
||||
Y = xyzw.y,
|
||||
Z = xyzw.z,
|
||||
W = xyzw.w
|
||||
}
|
||||
}
|
||||
});
|
||||
if (response.Status.Code == StatusResponse.Types.StatusCode.Ok) return new(true);
|
||||
if (IsSimulation) SimVisualization.LocalizationInitialize(x, y, theta);
|
||||
else
|
||||
{
|
||||
Logger.Warning("Khởi tạo vị trí cho robot thất bại. Kết quả trả về: {response.Status.Code} - {response.Status.Message}");
|
||||
return new(false, "Khởi tạo vị trí cho robot thất bại");
|
||||
var xyzw = QuaternionToXYZW(0, 0, theta);
|
||||
var response = XlocClient.SetInitialPose(new SetInitialPoseRequest()
|
||||
{
|
||||
InitialPose = new Pose()
|
||||
{
|
||||
Position = new Point()
|
||||
{
|
||||
X = x,
|
||||
Y = y,
|
||||
Z = 0,
|
||||
},
|
||||
Orientation = new Quaternion()
|
||||
{
|
||||
X = xyzw.x,
|
||||
Y = xyzw.y,
|
||||
Z = xyzw.z,
|
||||
W = xyzw.w
|
||||
}
|
||||
}
|
||||
});
|
||||
if (response.Status.Code == StatusResponse.Types.StatusCode.Ok) return new(true);
|
||||
else
|
||||
{
|
||||
Logger.Warning("Khởi tạo vị trí cho robot thất bại. Kết quả trả về: {response.Status.Code} - {response.Status.Message}");
|
||||
return new(false, "Khởi tạo vị trí cho robot thất bại");
|
||||
}
|
||||
}
|
||||
return new(true);
|
||||
}
|
||||
catch (Exception ex)
|
||||
{
|
||||
|
||||
@@ -1,5 +1,4 @@
|
||||
using MudBlazor;
|
||||
using RobotApp.Common.Shares.Dtos;
|
||||
using RobotApp.Common.Shares.Dtos;
|
||||
using RobotApp.Common.Shares.Enums;
|
||||
using RobotApp.Interfaces;
|
||||
using RobotApp.Services.Exceptions;
|
||||
@@ -30,7 +29,7 @@ public class RobotOrderController(INavigation NavigationManager,
|
||||
public int LastNodeSequenceId => LastNode is null ? 0 : LastNode.SequenceId;
|
||||
public (NodeState[], EdgeStateDto[]) CurrentPath => GetCurrentPath();
|
||||
|
||||
private const int CycleHandlerMilliseconds = 100;
|
||||
private const int CycleHandlerMilliseconds = 200;
|
||||
private WatchTimer<RobotOrderController>? OrderTimer;
|
||||
|
||||
private readonly Dictionary<string, Action[]> OrderActions = [];
|
||||
@@ -247,11 +246,6 @@ public class RobotOrderController(INavigation NavigationManager,
|
||||
UpdateState();
|
||||
}
|
||||
|
||||
private bool IsNewPath()
|
||||
{
|
||||
return true;
|
||||
}
|
||||
|
||||
private void ClearLastNode()
|
||||
{
|
||||
if (LastNode is null) return;
|
||||
@@ -292,6 +286,7 @@ public class RobotOrderController(INavigation NavigationManager,
|
||||
|
||||
private void HandleOrder()
|
||||
{
|
||||
if (Nodes.Length <= 0) return;
|
||||
if (IsCancelOrder)
|
||||
{
|
||||
NavigationManager.CancelMovement();
|
||||
@@ -309,9 +304,13 @@ public class RobotOrderController(INavigation NavigationManager,
|
||||
{
|
||||
var action = FinalAction[0];
|
||||
var robotAction = ActionManager[action.ActionId];
|
||||
if (robotAction is null) return;
|
||||
if (robotAction.IsCompleted) FinalAction.Remove(action);
|
||||
if (robotAction.Status == ActionStatus.WAITING) ActionManager.StartOrderAction(action.ActionId);
|
||||
if (robotAction is null)
|
||||
{
|
||||
FinalAction.Remove(action);
|
||||
return;
|
||||
}
|
||||
if (robotAction.IsCompleted)
|
||||
if (robotAction.Status == ActionStatus.WAITING) ActionManager.StartOrderAction(action.ActionId);
|
||||
}
|
||||
else
|
||||
{
|
||||
@@ -398,6 +397,18 @@ public class RobotOrderController(INavigation NavigationManager,
|
||||
if (NodeStates.Length != 0 || EdgeStates.Length != 0) HandleUpdateOrder(NewOrderHandler);
|
||||
else
|
||||
{
|
||||
Node startNode = NewOrderHandler.Nodes[0];
|
||||
var nodeDeviation = startNode.NodePosition.AllowedDeviationXY == 0.0 ? NewOrderHandler.Nodes.Length == 1 ? 0.3 : 0.5 : startNode.NodePosition.AllowedDeviationXY;
|
||||
var distance = Localization.DistanceTo(startNode.NodePosition.X, startNode.NodePosition.Y);
|
||||
if (distance > nodeDeviation) throw new OrderException(RobotErrors.Error1019());
|
||||
|
||||
if (NewOrderHandler.Nodes.Length > 1)
|
||||
{
|
||||
Node endNode = NewOrderHandler.Nodes[^1];
|
||||
nodeDeviation = endNode.NodePosition.AllowedDeviationXY == 0.0 ? 0.2 : endNode.NodePosition.AllowedDeviationXY;
|
||||
distance = Localization.DistanceTo(endNode.NodePosition.X, endNode.NodePosition.Y);
|
||||
if (distance < nodeDeviation) throw new OrderException(RobotErrors.Error1020());
|
||||
}
|
||||
HandleNewOrder(NewOrderHandler);
|
||||
}
|
||||
}
|
||||
@@ -409,6 +420,7 @@ public class RobotOrderController(INavigation NavigationManager,
|
||||
{
|
||||
ErrorManager.AddError(orEx.Error, TimeSpan.FromSeconds(10));
|
||||
Logger.Warning($"Lỗi khi xử lí Order: {orEx.Error.ErrorDescription}");
|
||||
if (Nodes.Length == 0) HandleOrderStop();
|
||||
}
|
||||
else Logger.Warning($"Lỗi khi xử lí Order: {orEx.Message}");
|
||||
}
|
||||
@@ -421,7 +433,7 @@ public class RobotOrderController(INavigation NavigationManager,
|
||||
private EdgeStateDto[] SplitChecking(Node lastNode, Node nearLastNode, VDA5050.Order.Edge edge)
|
||||
{
|
||||
List<EdgeStateDto> pathEdges = [];
|
||||
var splitStartPath = RobotPathPlanner.PathSplit([lastNode, nearLastNode], [edge], 0.1);
|
||||
var splitStartPath = RobotPathPlanner.PathSplit([lastNode, nearLastNode], [edge], 0.5);
|
||||
if (splitStartPath is not null && splitStartPath.Length > 0)
|
||||
{
|
||||
int index = 0;
|
||||
@@ -436,17 +448,31 @@ public class RobotOrderController(INavigation NavigationManager,
|
||||
index = i;
|
||||
}
|
||||
}
|
||||
for (int i = index; i < splitStartPath.Length - 1; i++)
|
||||
if (edge.Trajectory is null || edge.Trajectory.Degree == 1)
|
||||
{
|
||||
pathEdges.Add(new()
|
||||
{
|
||||
StartX = splitStartPath[i].NodePosition.X,
|
||||
StartY = splitStartPath[i].NodePosition.Y,
|
||||
EndX = splitStartPath[i + 1].NodePosition.X,
|
||||
EndY = splitStartPath[i + 1].NodePosition.Y,
|
||||
StartX = splitStartPath[index].NodePosition.X,
|
||||
StartY = splitStartPath[index].NodePosition.Y,
|
||||
EndX = nearLastNode.NodePosition.X,
|
||||
EndY = nearLastNode.NodePosition.Y,
|
||||
Degree = 1,
|
||||
});
|
||||
}
|
||||
else
|
||||
{
|
||||
for (int i = index; i < splitStartPath.Length - 1; i++)
|
||||
{
|
||||
pathEdges.Add(new()
|
||||
{
|
||||
StartX = splitStartPath[i].NodePosition.X,
|
||||
StartY = splitStartPath[i].NodePosition.Y,
|
||||
EndX = splitStartPath[i + 1].NodePosition.X,
|
||||
EndY = splitStartPath[i + 1].NodePosition.Y,
|
||||
Degree = 1,
|
||||
});
|
||||
}
|
||||
}
|
||||
}
|
||||
return [.. pathEdges];
|
||||
}
|
||||
@@ -465,17 +491,23 @@ public class RobotOrderController(INavigation NavigationManager,
|
||||
var edges = NewOrderEdges.ToList().GetRange(lastNodeIndex + 1, nodes.Count - 1);
|
||||
for (int i = 0; i < nodes.Count - 1; i++)
|
||||
{
|
||||
if (edges[i] is null) return (NodeStates, [.. pathEdges]);
|
||||
|
||||
var trajectory = edges[i].Trajectory;
|
||||
var controlPoints = trajectory?.ControlPoints;
|
||||
|
||||
|
||||
pathEdges.Add(new()
|
||||
{
|
||||
StartX = nodes[i].NodePosition.X,
|
||||
StartY = nodes[i].NodePosition.Y,
|
||||
EndX = nodes[i + 1].NodePosition.X,
|
||||
EndY = nodes[i + 1].NodePosition.Y,
|
||||
ControlPoint1X = edges[i].Trajectory is not null && edges[i].Trajectory.ControlPoints.Length > 2 ? edges[i].Trajectory.ControlPoints[1].X : 0,
|
||||
ControlPoint1Y = edges[i].Trajectory is not null && edges[i].Trajectory.ControlPoints.Length > 2 ? edges[i].Trajectory.ControlPoints[1].Y : 0,
|
||||
ControlPoint2X = edges[i].Trajectory is not null && edges[i].Trajectory.ControlPoints.Length > 3 ? edges[i].Trajectory.ControlPoints[2].X : 0,
|
||||
ControlPoint2Y = edges[i].Trajectory is not null && edges[i].Trajectory.ControlPoints.Length > 3 ? edges[i].Trajectory.ControlPoints[2].Y : 0,
|
||||
Degree = edges[i].Trajectory.Degree,
|
||||
ControlPoint1X = controlPoints is { Length: > 2 } ? controlPoints[1].X : 0,
|
||||
ControlPoint1Y = controlPoints is { Length: > 2 } ? controlPoints[1].Y : 0,
|
||||
ControlPoint2X = controlPoints is { Length: > 3 } ? controlPoints[2].X : 0,
|
||||
ControlPoint2Y = controlPoints is { Length: > 3 } ? controlPoints[2].Y : 0,
|
||||
Degree = trajectory is null ? 1 : trajectory.Degree,
|
||||
});
|
||||
}
|
||||
}
|
||||
|
||||
@@ -21,11 +21,11 @@ public class RobotPathPlanner(IConfiguration Configuration)
|
||||
Y1 = inNode.NodePosition.Y,
|
||||
X2 = futureNode.NodePosition.X,
|
||||
Y2 = futureNode.NodePosition.Y,
|
||||
ControlPoint1X = edge.Trajectory.ControlPoints.Length > 2 ? edge.Trajectory.ControlPoints[1].X : 0,
|
||||
ControlPoint1Y = edge.Trajectory.ControlPoints.Length > 2 ? edge.Trajectory.ControlPoints[1].Y : 0,
|
||||
ControlPoint2X = edge.Trajectory.ControlPoints.Length > 3 ? edge.Trajectory.ControlPoints[2].X : 0,
|
||||
ControlPoint2Y = edge.Trajectory.ControlPoints.Length > 3 ? edge.Trajectory.ControlPoints[2].Y : 0,
|
||||
TrajectoryDegree = edge.Trajectory.Degree == 1 ? TrajectoryDegree.One : edge.Trajectory.Degree == 2 ? TrajectoryDegree.Two : TrajectoryDegree.Three,
|
||||
ControlPoint1X = edge.Trajectory is not null && edge.Trajectory.ControlPoints.Length > 2 ? edge.Trajectory.ControlPoints[1].X : 0,
|
||||
ControlPoint1Y = edge.Trajectory is not null && edge.Trajectory.ControlPoints.Length > 2 ? edge.Trajectory.ControlPoints[1].Y : 0,
|
||||
ControlPoint2X = edge.Trajectory is not null && edge.Trajectory.ControlPoints.Length > 3 ? edge.Trajectory.ControlPoints[2].X : 0,
|
||||
ControlPoint2Y = edge.Trajectory is not null && edge.Trajectory.ControlPoints.Length > 3 ? edge.Trajectory.ControlPoints[2].Y : 0,
|
||||
TrajectoryDegree = edge.Trajectory is null ? TrajectoryDegree.One : edge.Trajectory.Degree == 1 ? TrajectoryDegree.One : edge.Trajectory.Degree == 2 ? TrajectoryDegree.Two : TrajectoryDegree.Three,
|
||||
});
|
||||
(double robotx, double roboty) =
|
||||
(
|
||||
@@ -61,30 +61,46 @@ public class RobotPathPlanner(IConfiguration Configuration)
|
||||
navigationNodes[0].Direction = GetDirectionInNode(currentTheta, nodes[0], nodes[1], edges[0]);
|
||||
for (int i = 1; i < nodes.Length - 1; i++)
|
||||
{
|
||||
var trajectory = edges[i - 1].Trajectory;
|
||||
var controlPoints = trajectory?.ControlPoints;
|
||||
(double lastx, double lasty) = MathExtensions.Curve(0.1, new()
|
||||
{
|
||||
X1 = nodes[i - 1].NodePosition.X,
|
||||
Y1 = nodes[i - 1].NodePosition.Y,
|
||||
X2 = nodes[i].NodePosition.X,
|
||||
Y2 = nodes[i].NodePosition.Y,
|
||||
ControlPoint1X = edges[i - 1].Trajectory.ControlPoints.Length > 2 ? edges[i - 1].Trajectory.ControlPoints[1].X : 0,
|
||||
ControlPoint1Y = edges[i - 1].Trajectory.ControlPoints.Length > 2 ? edges[i - 1].Trajectory.ControlPoints[1].Y : 0,
|
||||
ControlPoint2X = edges[i - 1].Trajectory.ControlPoints.Length > 3 ? edges[i - 1].Trajectory.ControlPoints[2].X : 0,
|
||||
ControlPoint2Y = edges[i - 1].Trajectory.ControlPoints.Length > 3 ? edges[i - 1].Trajectory.ControlPoints[2].Y : 0,
|
||||
TrajectoryDegree = edges[i - 1].Trajectory.Degree == 1 ? TrajectoryDegree.One : edges[i - 1].Trajectory.Degree == 2 ? TrajectoryDegree.Two : TrajectoryDegree.Three,
|
||||
ControlPoint1X = controlPoints is { Length: > 2 } ? controlPoints[1].X : 0,
|
||||
ControlPoint1Y = controlPoints is { Length: > 2 } ? controlPoints[1].Y : 0,
|
||||
ControlPoint2X = controlPoints is { Length: > 3 } ? controlPoints[2].X : 0,
|
||||
ControlPoint2Y = controlPoints is { Length: > 3 } ? controlPoints[2].Y : 0,
|
||||
TrajectoryDegree = trajectory?.Degree switch
|
||||
{
|
||||
1 => TrajectoryDegree.One,
|
||||
2 => TrajectoryDegree.Two,
|
||||
_ => TrajectoryDegree.Three
|
||||
},
|
||||
});
|
||||
|
||||
trajectory = edges[i].Trajectory;
|
||||
controlPoints = trajectory?.ControlPoints;
|
||||
(double futurex, double futurey) = MathExtensions.Curve(0.1, new()
|
||||
{
|
||||
X1 = nodes[i].NodePosition.X,
|
||||
Y1 = nodes[i].NodePosition.Y,
|
||||
X2 = nodes[i + 1].NodePosition.X,
|
||||
Y2 = nodes[i + 1].NodePosition.Y,
|
||||
ControlPoint1X = edges[i].Trajectory.ControlPoints.Length > 2 ? edges[i].Trajectory.ControlPoints[1].X : 0,
|
||||
ControlPoint1Y = edges[i].Trajectory.ControlPoints.Length > 2 ? edges[i].Trajectory.ControlPoints[1].Y : 0,
|
||||
ControlPoint2X = edges[i].Trajectory.ControlPoints.Length > 3 ? edges[i].Trajectory.ControlPoints[2].X : 0,
|
||||
ControlPoint2Y = edges[i].Trajectory.ControlPoints.Length > 3 ? edges[i].Trajectory.ControlPoints[2].Y : 0,
|
||||
TrajectoryDegree = edges[i].Trajectory.Degree == 1 ? TrajectoryDegree.One : edges[i].Trajectory.Degree == 2 ? TrajectoryDegree.Two : TrajectoryDegree.Three,
|
||||
ControlPoint1X = controlPoints is { Length: > 2 } ? controlPoints[1].X : 0,
|
||||
ControlPoint1Y = controlPoints is { Length: > 2 } ? controlPoints[1].Y : 0,
|
||||
ControlPoint2X = controlPoints is { Length: > 3 } ? controlPoints[2].X : 0,
|
||||
ControlPoint2Y = controlPoints is { Length: > 3 } ? controlPoints[2].Y : 0,
|
||||
TrajectoryDegree = trajectory?.Degree switch
|
||||
{
|
||||
1 => TrajectoryDegree.One,
|
||||
2 => TrajectoryDegree.Two,
|
||||
_ => TrajectoryDegree.Three
|
||||
},
|
||||
});
|
||||
|
||||
var angle = MathExtensions.GetVectorAngle(
|
||||
nodes[i].NodePosition.X,
|
||||
nodes[i].NodePosition.Y,
|
||||
@@ -128,11 +144,11 @@ public class RobotPathPlanner(IConfiguration Configuration)
|
||||
Y1 = startNode.Y,
|
||||
X2 = endNode.X,
|
||||
Y2 = endNode.Y,
|
||||
ControlPoint1X = edge.Trajectory.ControlPoints.Length > 2 ? edge.Trajectory.ControlPoints[1].X : 0,
|
||||
ControlPoint1Y = edge.Trajectory.ControlPoints.Length > 2 ? edge.Trajectory.ControlPoints[1].Y : 0,
|
||||
ControlPoint2X = edge.Trajectory.ControlPoints.Length > 3 ? edge.Trajectory.ControlPoints[2].X : 0,
|
||||
ControlPoint2Y = edge.Trajectory.ControlPoints.Length > 3 ? edge.Trajectory.ControlPoints[2].Y : 0,
|
||||
TrajectoryDegree = edge.Trajectory.Degree == 1 ? TrajectoryDegree.One : edge.Trajectory.Degree == 2 ? TrajectoryDegree.Two : TrajectoryDegree.Three
|
||||
ControlPoint1X = edge.Trajectory is not null && edge.Trajectory.ControlPoints.Length > 2 ? edge.Trajectory.ControlPoints[1].X : 0,
|
||||
ControlPoint1Y = edge.Trajectory is not null && edge.Trajectory.ControlPoints.Length > 2 ? edge.Trajectory.ControlPoints[1].Y : 0,
|
||||
ControlPoint2X = edge.Trajectory is not null && edge.Trajectory.ControlPoints.Length > 3 ? edge.Trajectory.ControlPoints[2].X : 0,
|
||||
ControlPoint2Y = edge.Trajectory is not null && edge.Trajectory.ControlPoints.Length > 3 ? edge.Trajectory.ControlPoints[2].Y : 0,
|
||||
TrajectoryDegree = edge.Trajectory is null ? TrajectoryDegree.One : edge.Trajectory.Degree == 1 ? TrajectoryDegree.One : edge.Trajectory.Degree == 2 ? TrajectoryDegree.Two : TrajectoryDegree.Three
|
||||
};
|
||||
|
||||
double length = EdgeCalculatorModel.GetEdgeLength();
|
||||
@@ -194,11 +210,11 @@ public class RobotPathPlanner(IConfiguration Configuration)
|
||||
Y1 = startNode.NodePosition.Y,
|
||||
X2 = endNode.NodePosition.X,
|
||||
Y2 = endNode.NodePosition.Y,
|
||||
ControlPoint1X = edge.Trajectory.ControlPoints.Length > 2 ? edge.Trajectory.ControlPoints[1].X : 0,
|
||||
ControlPoint1Y = edge.Trajectory.ControlPoints.Length > 2 ? edge.Trajectory.ControlPoints[1].Y : 0,
|
||||
ControlPoint2X = edge.Trajectory.ControlPoints.Length > 3 ? edge.Trajectory.ControlPoints[2].X : 0,
|
||||
ControlPoint2Y = edge.Trajectory.ControlPoints.Length > 3 ? edge.Trajectory.ControlPoints[2].Y : 0,
|
||||
TrajectoryDegree = edge.Trajectory.Degree == 1 ? TrajectoryDegree.One : edge.Trajectory.Degree == 2 ? TrajectoryDegree.Two : TrajectoryDegree.Three
|
||||
ControlPoint1X = edge.Trajectory is not null && edge.Trajectory.ControlPoints.Length > 2 ? edge.Trajectory.ControlPoints[1].X : 0,
|
||||
ControlPoint1Y = edge.Trajectory is not null && edge.Trajectory.ControlPoints.Length > 2 ? edge.Trajectory.ControlPoints[1].Y : 0,
|
||||
ControlPoint2X = edge.Trajectory is not null && edge.Trajectory.ControlPoints.Length > 3 ? edge.Trajectory.ControlPoints[2].X : 0,
|
||||
ControlPoint2Y = edge.Trajectory is not null && edge.Trajectory.ControlPoints.Length > 3 ? edge.Trajectory.ControlPoints[2].Y : 0,
|
||||
TrajectoryDegree = edge.Trajectory is null ? TrajectoryDegree.One : edge.Trajectory.Degree == 1 ? TrajectoryDegree.One : edge.Trajectory.Degree == 2 ? TrajectoryDegree.Two : TrajectoryDegree.Three
|
||||
};
|
||||
|
||||
double length = EdgeCalculatorModel.GetEdgeLength();
|
||||
|
||||
@@ -1,191 +1,35 @@
|
||||
using Microsoft.AspNetCore.SignalR;
|
||||
using Microsoft.Extensions.Hosting;
|
||||
using Microsoft.Extensions.Logging;
|
||||
using RobotApp.Common.Shares;
|
||||
using RobotApp.Hubs;
|
||||
using RobotApp.Interfaces;
|
||||
using RobotApp.Services.State;
|
||||
using RobotApp.VDA5050.State;
|
||||
using RobotApp.VDA5050.Type;
|
||||
using RobotApp.VDA5050.Visualization;
|
||||
using System.Text.Json;
|
||||
|
||||
namespace RobotApp.Services.Robot;
|
||||
|
||||
public class RobotStatePublisher : BackgroundService
|
||||
public class RobotStatePublisher(
|
||||
IHubContext<RobotHub> _hubContext,
|
||||
RobotStates _robotState,
|
||||
RobotConnection _robotConnection) : BackgroundService
|
||||
{
|
||||
private readonly IHubContext<RobotHub> _hubContext;
|
||||
private readonly RobotConfiguration _robotConfig;
|
||||
private readonly IOrder _orderManager;
|
||||
private readonly IInstantActions _actionManager;
|
||||
private readonly IPeripheral _peripheralManager;
|
||||
private readonly IInfomation _infoManager;
|
||||
private readonly IError _errorManager;
|
||||
private readonly ILocalization _localizationManager;
|
||||
private readonly IBattery _batteryManager;
|
||||
private readonly ILoad _loadManager;
|
||||
private readonly INavigation _navigationManager;
|
||||
private readonly RobotStateMachine _stateManager;
|
||||
private readonly RobotConnection _robotConnection;
|
||||
private bool? _lastRobotConnectionState;
|
||||
|
||||
private uint _headerId = 0;
|
||||
private readonly PeriodicTimer _timer = new(TimeSpan.FromMilliseconds(1000)); // 1 giây/lần
|
||||
|
||||
public RobotStatePublisher(
|
||||
IHubContext<RobotHub> hubContext,
|
||||
RobotConfiguration robotConfig,
|
||||
IOrder orderManager,
|
||||
IInstantActions actionManager,
|
||||
IPeripheral peripheralManager,
|
||||
IInfomation infoManager,
|
||||
IError errorManager,
|
||||
ILocalization localizationManager,
|
||||
IBattery batteryManager,
|
||||
ILoad loadManager,
|
||||
INavigation navigationManager,
|
||||
RobotStateMachine stateManager,
|
||||
RobotConnection robotConnection)
|
||||
{
|
||||
_hubContext = hubContext;
|
||||
_robotConfig = robotConfig;
|
||||
_orderManager = orderManager;
|
||||
_actionManager = actionManager;
|
||||
_peripheralManager = peripheralManager;
|
||||
_infoManager = infoManager;
|
||||
_errorManager = errorManager;
|
||||
_localizationManager = localizationManager;
|
||||
_batteryManager = batteryManager;
|
||||
_loadManager = loadManager;
|
||||
_navigationManager = navigationManager;
|
||||
_stateManager = stateManager;
|
||||
_robotConnection = robotConnection;
|
||||
}
|
||||
|
||||
private StateMsg GetStateMsg()
|
||||
{
|
||||
return new StateMsg
|
||||
{
|
||||
HeaderId = _headerId++,
|
||||
Timestamp = DateTime.UtcNow.ToString("o"), // ISO 8601
|
||||
Manufacturer = _robotConfig.VDA5050Setting.Manufacturer,
|
||||
Version = _robotConfig.VDA5050Setting.Version,
|
||||
SerialNumber = _robotConfig.SerialNumber,
|
||||
Maps = [],
|
||||
OrderId = _orderManager.OrderId,
|
||||
OrderUpdateId = _orderManager.OrderUpdateId,
|
||||
ZoneSetId = "",
|
||||
LastNodeId = _orderManager.LastNodeId,
|
||||
LastNodeSequenceId = _orderManager.LastNodeSequenceId,
|
||||
Driving = Math.Abs(_navigationManager.VelocityX) > 0.01 || Math.Abs(_navigationManager.Omega) > 0.01,
|
||||
Paused = false,
|
||||
NewBaseRequest = true,
|
||||
DistanceSinceLastNode = 0,
|
||||
OperatingMode = _peripheralManager.PeripheralMode.ToString(),
|
||||
NodeStates = _orderManager.NodeStates,
|
||||
EdgeStates = _orderManager.EdgeStates,
|
||||
ActionStates = _actionManager.ActionStates,
|
||||
Information = [General, .. _infoManager.InformationState],
|
||||
Errors = _errorManager.ErrorsState,
|
||||
AgvPosition = new AgvPosition
|
||||
{
|
||||
X = _localizationManager.X,
|
||||
Y = _localizationManager.Y,
|
||||
Theta = _localizationManager.Theta,
|
||||
LocalizationScore = _localizationManager.MatchingScore,
|
||||
MapId = _localizationManager.CurrentActiveMap,
|
||||
DeviationRange = _localizationManager.Reliability,
|
||||
PositionInitialized = _localizationManager.IsReady,
|
||||
},
|
||||
BatteryState = new BatteryState
|
||||
{
|
||||
Charging = _batteryManager.IsCharging,
|
||||
BatteryHealth = _batteryManager.SOH,
|
||||
Reach = 0,
|
||||
BatteryVoltage = _batteryManager.Voltage,
|
||||
BatteryCharge = _batteryManager.SOC,
|
||||
},
|
||||
Loads = _loadManager.Load,
|
||||
Velocity = new Velocity
|
||||
{
|
||||
Vx = _navigationManager.VelocityX,
|
||||
Vy = _navigationManager.VelocityY,
|
||||
Omega = _navigationManager.Omega,
|
||||
},
|
||||
SafetyState = new SafetyState
|
||||
{
|
||||
FieldViolation = _peripheralManager.LidarBackProtectField ||
|
||||
_peripheralManager.LidarFrontProtectField ||
|
||||
_peripheralManager.LidarFrontTimProtectField,
|
||||
EStop = (_peripheralManager.Emergency || _peripheralManager.Bumper)
|
||||
? EStop.AUTOACK.ToString()
|
||||
: EStop.NONE.ToString(),
|
||||
}
|
||||
};
|
||||
}
|
||||
|
||||
private Information General => new()
|
||||
{
|
||||
InfoType = InformationType.robot_general.ToString(),
|
||||
InfoDescription = "Thông tin chung của robot",
|
||||
InfoLevel = InfoLevel.INFO.ToString(),
|
||||
InfoReferences =
|
||||
[
|
||||
new InfomationReferences
|
||||
{
|
||||
ReferenceKey = InformationReferencesKey.robot_state.ToString(),
|
||||
ReferenceValue = _stateManager.CurrentStateName,
|
||||
}
|
||||
]
|
||||
};
|
||||
|
||||
protected override async Task ExecuteAsync(CancellationToken stoppingToken)
|
||||
{
|
||||
while (await _timer.WaitForNextTickAsync(stoppingToken))
|
||||
{
|
||||
try
|
||||
{
|
||||
var serialNumber = _robotConfig.SerialNumber;
|
||||
|
||||
// ===== SEND STATE =====
|
||||
var state = GetStateMsg();
|
||||
var json = JsonSerializer.Serialize(state, JsonOptionExtends.Write);
|
||||
|
||||
await _hubContext.Clients
|
||||
.Group(serialNumber)
|
||||
.SendAsync("ReceiveState", json, stoppingToken);
|
||||
|
||||
// ===== SEND ROBOT CONNECTION (ONLY WHEN CHANGED) =====
|
||||
var isConnected = _robotConnection.IsConnected;
|
||||
|
||||
if (_lastRobotConnectionState != isConnected)
|
||||
{
|
||||
_lastRobotConnectionState = isConnected;
|
||||
|
||||
await _hubContext.Clients
|
||||
.Group(serialNumber) // routing only
|
||||
.SendAsync(
|
||||
"ReceiveRobotConnection",
|
||||
isConnected, // payload only bool
|
||||
stoppingToken
|
||||
);
|
||||
|
||||
Console.WriteLine(
|
||||
$"[RobotStatePublisher] Robot connection changed → {(isConnected ? "ONLINE" : "OFFLINE")}"
|
||||
);
|
||||
}
|
||||
await _hubContext.Clients.All.SendAsync("ReceiveState", _robotState.GetStateMsg(), stoppingToken);
|
||||
await _hubContext.Clients.All.SendAsync("ReceiveRobotConnection", _robotConnection.IsConnected, stoppingToken);
|
||||
}
|
||||
catch (Exception ex)
|
||||
catch
|
||||
{
|
||||
Console.WriteLine(ex);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
public override void Dispose()
|
||||
public override Task StopAsync(CancellationToken cancellationToken)
|
||||
{
|
||||
_timer?.Dispose();
|
||||
base.Dispose();
|
||||
return base.StopAsync(cancellationToken);
|
||||
}
|
||||
}
|
||||
@@ -36,7 +36,7 @@ public class RobotStates(RobotConfiguration RobotConfiguration,
|
||||
catch { }
|
||||
}
|
||||
|
||||
private StateMsg GetStateMsg()
|
||||
public StateMsg GetStateMsg()
|
||||
{
|
||||
return new StateMsg
|
||||
{
|
||||
|
||||
@@ -23,8 +23,8 @@ public class SimulationNavigation : INavigation, IDisposable
|
||||
|
||||
protected const int CycleHandlerMilliseconds = 50;
|
||||
private const double Scale = 1;
|
||||
//private WatchTimer<SimulationNavigation>? NavigationTimer;
|
||||
private HighPrecisionTimer<SimulationNavigation>? NavigationTimer;
|
||||
private WatchTimer<SimulationNavigation>? NavigationTimer;
|
||||
//private HighPrecisionTimer<SimulationNavigation>? NavigationTimer;
|
||||
|
||||
protected double TargetAngle = 0;
|
||||
protected PID? RotatePID;
|
||||
@@ -158,14 +158,12 @@ public class SimulationNavigation : INavigation, IDisposable
|
||||
|
||||
public void Pause()
|
||||
{
|
||||
Console.WriteLine($"Nav Pause");
|
||||
ResumeState = State;
|
||||
NavState = NavigationState.Paused;
|
||||
}
|
||||
|
||||
public void Resume()
|
||||
{
|
||||
Console.WriteLine($"Nav Resume");
|
||||
NavState = ResumeState;
|
||||
}
|
||||
|
||||
|
||||
@@ -68,7 +68,7 @@ public class WatchTimerAsync<T>(int Interval, Func<Task> Callback, Logger<T>? Lo
|
||||
Timer.Change(Interval, Timeout.Infinite);
|
||||
}
|
||||
}
|
||||
else throw new ObjectDisposedException(nameof(WatchTimer<T>));
|
||||
else throw new ObjectDisposedException(nameof(WatchTimerAsync<T>));
|
||||
}
|
||||
|
||||
public void Stop()
|
||||
|
||||
35
docker-compose.yaml
Normal file
35
docker-compose.yaml
Normal file
@@ -0,0 +1,35 @@
|
||||
version: '3.8'
|
||||
|
||||
services:
|
||||
robotapp:
|
||||
build:
|
||||
context: .
|
||||
dockerfile: Dockerfile
|
||||
container_name: robotapp
|
||||
restart: unless-stopped
|
||||
ports:
|
||||
- "8080:8080"
|
||||
environment:
|
||||
- ASPNETCORE_ENVIRONMENT=Production
|
||||
- ASPNETCORE_URLS=http://+:8080
|
||||
- ConnectionStrings__DefaultConnection=Data Source=/app/data/robot.db
|
||||
volumes:
|
||||
# Persist database
|
||||
- ./data:/app/data
|
||||
# Persist maps
|
||||
- ./maps:/app/maps
|
||||
# Persist logs (if needed)
|
||||
- ./logs:/app/logs
|
||||
networks:
|
||||
- robotapp-network
|
||||
healthcheck:
|
||||
test: ["CMD-SHELL", "wget --no-verbose --tries=1 --spider http://localhost:8080 || exit 1"]
|
||||
interval: 30s
|
||||
timeout: 10s
|
||||
retries: 3
|
||||
start_period: 40s
|
||||
|
||||
networks:
|
||||
robotapp-network:
|
||||
driver: bridge
|
||||
|
||||
Reference in New Issue
Block a user