Initial commit

srcs/RobotNet10/RobotApp/Communication/Sick.SafetyScanners/DataProcessing/ParseFirmwareVersion.cs

@@ -0,0 +1,44 @@
+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();
+    }
+}
+