TedsAccessMessage.cs

using System;
using System.IO;
using System.Text;
using System.Threading.Tasks;
using Waher.Networking;
using Waher.Security;
using Waher.Things.Ieee1451.Ieee1451_0.TEDS;
using Waher.Things.Ieee1451.Ieee1451_0.TEDS.FieldTypes;
using Waher.Things.Metering;
 
namespace Waher.Things.Ieee1451.Ieee1451_0.Messages
{
    public class TedsAccessMessage : Message
    {
        private Teds data;
        private ushort errorCode;
 
        public TedsAccessMessage(NetworkServiceType NetworkServiceType, TedsAccessService TedsAccessService,
            MessageType MessageType, byte[] Body, byte[] Tail, ICommunicationLayer ComLayer)
            : base(NetworkServiceType, (byte)TedsAccessService, MessageType, Body, Tail, ComLayer)
        {
            this.TedsAccessService = TedsAccessService;
        }
 
        public TedsAccessService TedsAccessService { get; }
 
        public override string NetworkServiceIdName => this.TedsAccessService.ToString();
 
        public bool TryParseTeds(out ushort ErrorCode, out Teds Teds)
        {
            return this.TryParseTeds(true, out ErrorCode, out Teds);
        }
 
        public bool TryParseTeds(bool CheckChecksum, out ushort ErrorCode, out Teds Teds)
        {
            if (!(this.data is null))
            {
                ErrorCode = this.errorCode;
                Teds = this.data;
                return true;
            }
 
            try
            {
                if (this.MessageType == MessageType.Reply)
                    ErrorCode = this.NextUInt16(nameof(ErrorCode));
                else
                    ErrorCode = 0;
 
                ChannelAddress ChannelInfo = this.NextChannelId(true);
                uint TedsOffset = this.NextUInt32(nameof(TedsOffset));
                int Start = this.Position;
                uint Len = this.NextUInt32(nameof(Len));
                if (Len < 2)
                {
                    Teds = null;
                    return false;
                }
 
                Len -= 2;
                if (Len > int.MaxValue)
                {
                    Teds = null;
                    return false;
                }
 
                byte[] Data = this.NextUInt8Array(nameof(Data), (int)Len);
                ushort CheckSum = 0;
 
                while (Start < this.Position)
                    CheckSum += this.Body[Start++];
 
                CheckSum ^= 0xffff;
 
                ushort CheckSum2 = this.NextUInt16(nameof(CheckSum));
                if (CheckChecksum && CheckSum != CheckSum2)
                {
                    Teds = null;
                    return false;
                }
 
                Binary TedsBlock = new Binary(Data, this.ComLayer, true);
                ParsingState State = new ParsingState();
 
                this.data = Teds = new Teds(ChannelInfo, TedsBlock.ParseTedsRecords(State));
                this.errorCode = ErrorCode;
 
                if (this.HasSniffers)
                    TedsBlock.LogInformationToSniffer();
 
                return true;
            }
            catch (Exception ex)
            {
                if (this.HasSniffers)
                    this.ComLayer.Exception(ex);
 
                ErrorCode = 0xffff;
                Teds = null;
                return false;
            }
        }
 
        public bool TryParseRequest(out ChannelAddress Channel, out TedsAccessCode TedsAccessCode,
            out uint TedsOffset, out double TimeoutSeconds)
        {
            try
            {
                Channel = this.NextChannelId(true);
                TedsAccessCode = this.NextUInt8<TedsAccessCode>(nameof(TedsAccessCode));
                TedsOffset = this.NextUInt32(nameof(TedsOffset));
                TimeoutSeconds = this.NextTimeDurationSeconds(nameof(TimeoutSeconds));
 
                return true;
            }
            catch (Exception)
            {
                Channel = null;
                TedsAccessCode = 0;
                TedsOffset = 0;
                TimeoutSeconds = 0;
 
                return false;
            }
        }
 
        public static byte[] SerializeRequest(byte[] NcapId, byte[] TimId, ushort ChannelId,
            TedsAccessCode TedsAccessCode, uint TedsOffset, double TimeoutSeconds, StringBuilder SnifferOutput)
        {
            using (MemoryStream ms = new MemoryStream())
            {
                byte[] AppId = MeteringTopology.Root.ObjectId.ToByteArray();
 
                ms.Write(AppId, 0, 16);
                ms.Write(NcapId ?? EmptyUuid, 0, 16);
                ms.Write(TimId ?? EmptyUuid, 0, 16);
                ms.WriteByte((byte)(ChannelId >> 8));
                ms.WriteByte((byte)ChannelId);
                ms.WriteByte((byte)TedsAccessCode);
 
                byte[] Bin = BitConverter.GetBytes(TedsOffset);
                Array.Reverse(Bin);
                ms.Write(Bin, 0, 4);
 
                TimeoutSeconds *= 1e9 * 65536;
                ulong l = (ulong)TimeoutSeconds;
                Bin = BitConverter.GetBytes(l);
                Array.Reverse(Bin);
                ms.Write(Bin, 0, 8);
 
                byte[] Result = Ieee1451Parser.SerializeMessage(TedsAccessService.Read, MessageType.Command, ms.ToArray(), SnifferOutput);
 
                if (!(SnifferOutput is null))
                {
                    SnifferOutput.Append("App ID: ");
                    SnifferOutput.AppendLine(Hashes.BinaryToString(AppId));
                    SnifferOutput.Append("NCAP ID: ");
                    SnifferOutput.AppendLine(Hashes.BinaryToString(NcapId ?? EmptyUuid));
                    SnifferOutput.Append("TIM ID: ");
                    SnifferOutput.AppendLine(Hashes.BinaryToString(TimId ?? EmptyUuid));
                    SnifferOutput.Append("Channel ID: ");
                    SnifferOutput.AppendLine(ChannelId.ToString());
                    SnifferOutput.Append("TEDS Access Code: ");
                    SnifferOutput.AppendLine(TedsAccessCode.ToString());
                    SnifferOutput.Append("TEDS Offset: ");
                    SnifferOutput.AppendLine(TedsOffset.ToString());
                    SnifferOutput.Append("Timeout (s): ");
                    SnifferOutput.AppendLine(TimeoutSeconds.ToString());
                }
 
                return Result;
            }
        }
 
        public static byte[] SerializeResponse(ushort ErrorCode, byte[] NcapId, byte[] TimId,
            ushort ChannelId, StringBuilder SnifferOutput, TedsId TedsHeader, params TedsRecord[] Records)
        {
            if (NcapId is null)
                NcapId = new byte[16];
            else if (NcapId.Length != 16)
                throw new ArgumentException("Invalid NCAP UUID.", nameof(NcapId));
 
            if (TimId is null)
                TimId = new byte[16];
            else if (TimId.Length != 16)
                throw new ArgumentException("Invalid TIM UUID.", nameof(TimId));
 
            using (MemoryStream ms = new MemoryStream())
            {
                byte[] AppId = MeteringTopology.Root.ObjectId.ToByteArray();
 
                ms.WriteByte((byte)(ErrorCode >> 8));
                ms.WriteByte((byte)ErrorCode);
                ms.Write(AppId, 0, 16);
                ms.Write(NcapId, 0, 16);
                ms.Write(TimId, 0, 16);
                ms.WriteByte((byte)(ChannelId >> 8));
                ms.WriteByte((byte)ChannelId);
                ms.WriteByte(0);    // TedsOffset MSB
                ms.WriteByte(0);
                ms.WriteByte(0);
                ms.WriteByte(0);    // TedsOffset LSB
 
                using (MemoryStream ms2 = new MemoryStream())
                {
                    Append(ms2, TedsHeader);
 
                    foreach (TedsRecord Record in Records)
                        Append(ms2, Record);
 
                    byte[] Bin = ms2.ToArray();
                    int Len = Bin.Length;
                    ushort Checksum = 0;
                    int i, j, k;
                    byte b;
 
                    j = Len + 2;
                    k = 0;
                    for (i = 0; i < 4; i++)
                    {
                        k <<= 8;
                        b = (byte)j;
                        k |= b;
                        Checksum += b;
                        j >>= 8;
                    }
 
                    for (i = 0; i < 4; i++)
                    {
                        ms.WriteByte((byte)k);
                        k >>= 8;
                    }
 
                    if (Len > 0)
                    {
                        ms.Write(Bin, 0, Len);
 
                        for (i = 0; i < Len; i++)
                            Checksum += Bin[i];
                    }
 
                    Checksum ^= 0xffff;
 
                    ms.WriteByte((byte)(Checksum >> 8));
                    ms.WriteByte((byte)Checksum);
 
                    byte[] Result = Ieee1451Parser.SerializeMessage(TedsAccessService.Read, MessageType.Reply, ms.ToArray(), SnifferOutput);
 
                    if (!(SnifferOutput is null))
                    {
                        SnifferOutput.Append("Error Code: ");
                        SnifferOutput.AppendLine(ErrorCode.ToString());
                        SnifferOutput.Append("App ID: ");
                        SnifferOutput.AppendLine(Hashes.BinaryToString(AppId));
                        SnifferOutput.Append("NCAP ID: ");
                        SnifferOutput.AppendLine(Hashes.BinaryToString(NcapId));
                        SnifferOutput.Append("TIM ID: ");
                        SnifferOutput.AppendLine(Hashes.BinaryToString(TimId));
                        SnifferOutput.Append("Channel ID: ");
                        SnifferOutput.AppendLine(ChannelId.ToString());
                        SnifferOutput.AppendLine("TEDS Offset: 0");
 
                        TedsHeader.Append(SnifferOutput);
 
                        foreach (TedsRecord Record in Records)
                            Record.Append(SnifferOutput);
 
                        SnifferOutput.AppendLine(Checksum.ToString());
                        SnifferOutput.AppendLine("TEDS Offset: 0");
                    }
 
                    return Result;
                }
            }
        }
 
        private static void Append(MemoryStream ms2, TedsRecord Record)
        {
            byte[] Bin = Record.RawValue;
            int RecordLen = Bin?.Length ?? 0;
            if (RecordLen > 255)
                throw new Exception("Record length exceeds 255 bytes in length.");
 
            ms2.WriteByte(Record.Type);
            ms2.WriteByte((byte)RecordLen);
 
            if (RecordLen > 0)
                ms2.Write(Bin, 0, RecordLen);
        }
    }
}