45 lines
1.3 KiB
C#
45 lines
1.3 KiB
C#
using Sick.SafetyScanners.DataStructures;
|
|
using Sick.SafetyScanners.Helpers;
|
|
using System.Text;
|
|
|
|
namespace Sick.SafetyScanners.DataProcessing;
|
|
|
|
/// <summary>
|
|
/// Parser for FirmwareVersion response from COLA2 variable command
|
|
/// Thread-safe implementation
|
|
/// </summary>
|
|
public sealed class ParseFirmwareVersion
|
|
{
|
|
/// <summary>
|
|
/// Parses the firmware version from a TCP sequence (COLA2 response)
|
|
/// Matches: ParseFirmwareVersion::parseTCPSequence in C++
|
|
/// </summary>
|
|
public static FirmwareVersion ParseTcpSequence(PacketBuffer buffer)
|
|
{
|
|
var span = buffer.GetBufferSpan();
|
|
return new FirmwareVersion
|
|
{
|
|
Version = ReadFirmwareVersion(span)
|
|
};
|
|
}
|
|
|
|
/// <summary>
|
|
/// Reads firmware version from buffer
|
|
/// Matches: ParseFirmwareVersion::readFirmwareVersion in C++
|
|
/// </summary>
|
|
private static string ReadFirmwareVersion(ReadOnlySpan<byte> span)
|
|
{
|
|
ushort stringLength = ReadWriteHelper.ReadUint16LittleEndian(span, 0);
|
|
|
|
var versionBuilder = new StringBuilder(stringLength);
|
|
for (ushort i = 0; i < stringLength; i++)
|
|
{
|
|
ushort ch = ReadWriteHelper.ReadUint8(span, 2 + i);
|
|
versionBuilder.Append((char)ch);
|
|
}
|
|
|
|
return versionBuilder.ToString();
|
|
}
|
|
}
|
|
|