save
This commit is contained in:
10
BlazorApp/Models/Canopen/Eds/EdsDevice.cs
Normal file
10
BlazorApp/Models/Canopen/Eds/EdsDevice.cs
Normal file
@@ -0,0 +1,10 @@
|
||||
namespace BlazorApp.Models.Canopen.Eds
|
||||
{
|
||||
public class EdsDevice
|
||||
{
|
||||
public int NodeId { get; set; }
|
||||
public string DeviceName { get; set; } = "";
|
||||
|
||||
public Dictionary<int, EdsTpdo> Tpdos { get; set; } = new();
|
||||
}
|
||||
}
|
||||
47
BlazorApp/Models/Canopen/Eds/EdsDeviceDecoder.cs
Normal file
47
BlazorApp/Models/Canopen/Eds/EdsDeviceDecoder.cs
Normal file
@@ -0,0 +1,47 @@
|
||||
using BlazorApp.Models.Canopen;
|
||||
using BlazorApp.Models.Canopen.Eds;
|
||||
namespace BlazorApp.Models.Canopen.Eds
|
||||
{
|
||||
public class EdsDeviceDecoder : ICanopenDeviceDecoder
|
||||
{
|
||||
private readonly EdsDevice _device;
|
||||
|
||||
public int NodeId => _device.NodeId;
|
||||
|
||||
public EdsDeviceDecoder(EdsDevice device)
|
||||
{
|
||||
_device = device;
|
||||
}
|
||||
|
||||
public string DecodeTpdo(int pdoIndex, byte[] data, byte length)
|
||||
{
|
||||
if (!_device.Tpdos.TryGetValue(pdoIndex, out var tpdo))
|
||||
return "-";
|
||||
|
||||
var results = new List<string>();
|
||||
|
||||
foreach (var obj in tpdo.Objects)
|
||||
{
|
||||
ulong raw = ReadBits(data, obj.BitOffset, obj.BitLength);
|
||||
double value = raw * obj.Factor;
|
||||
|
||||
results.Add($"{obj.Name}: {value:F2} {obj.Unit}");
|
||||
}
|
||||
|
||||
return string.Join(" | ", results);
|
||||
}
|
||||
|
||||
private static ulong ReadBits(byte[] data, int bitOffset, int bitLength)
|
||||
{
|
||||
ulong value = 0;
|
||||
int byteOffset = bitOffset / 8;
|
||||
|
||||
for (int i = 0; i < bitLength / 8; i++)
|
||||
{
|
||||
value |= (ulong)data[byteOffset + i] << (8 * i);
|
||||
}
|
||||
|
||||
return value;
|
||||
}
|
||||
}
|
||||
}
|
||||
13
BlazorApp/Models/Canopen/Eds/EdsObject.cs
Normal file
13
BlazorApp/Models/Canopen/Eds/EdsObject.cs
Normal file
@@ -0,0 +1,13 @@
|
||||
namespace BlazorApp.Models.Canopen.Eds
|
||||
{
|
||||
public class EdsObject
|
||||
{
|
||||
public ushort Index { get; set; }
|
||||
public byte SubIndex { get; set; }
|
||||
public string Name { get; set; } = "";
|
||||
public double Factor { get; set; } = 1.0;
|
||||
public string Unit { get; set; } = "";
|
||||
public int BitOffset { get; set; }
|
||||
public int BitLength { get; set; }
|
||||
}
|
||||
}
|
||||
8
BlazorApp/Models/Canopen/Eds/EdsTpdo.cs
Normal file
8
BlazorApp/Models/Canopen/Eds/EdsTpdo.cs
Normal file
@@ -0,0 +1,8 @@
|
||||
namespace BlazorApp.Models.Canopen.Eds
|
||||
{
|
||||
public class EdsTpdo
|
||||
{
|
||||
public int PdoIndex { get; set; }
|
||||
public List<EdsObject> Objects { get; set; } = new();
|
||||
}
|
||||
}
|
||||
Reference in New Issue
Block a user