HamBook – Rev 46

Subversion Repositories:
Rev:
using System;
using System.Collections.Generic;
using System.ComponentModel;
using System.IO.Ports;
using System.Linq;
using System.Text;
using System.Threading.Tasks;
using HamBook.Radios.Generic;
using static HamBook.Radios.Yaesu.FT_891.Constants;
using RJCP.IO.Ports;
using System.Text.RegularExpressions;
using System.Threading;
using System.Diagnostics;

namespace HamBook.Radios.Yaesu.FT_891.CAT
{
    [Radio("Yaesu FT-891")]
    public class MT : Generic.CAT.MT
    {
        private readonly Regex readRegex;

        public override CatLength CatLength => new CatLength { Set = 41, Read = 6, Answer = 41};

        public MT(SerialPortStream serialPort) : base(serialPort)
        {
            /// MTP9U026965000+0000004100001AAAAAAAAAAAA;
            ///                       ^---- fixed: 0 in manual, but responds 1; looks like a radio bug
            readRegex = new Regex($"^{Name}(?<currentLocation>[0-9PLU]{{3}})(?<frequency>[0-9]{{9}})(?<clarifierDirection>[\\+\\-]{{1}})(?<clarifierOffset>[0-9]{{4}})(?<clar>[01]{{1}})0(?<mode>[123456789ABCD]{{1}})[0-9]{{1}}(?<ctcss>[012]{{1}})00(?<phase>[012]{{1}})(?<tag>[01]{{1}})(?<text>[\x20-\x7E]{{0,12}}){Constants.EOT}$", RegexOptions.Compiled);
        }

        public override Generic.MemoryChannel Read(string location)
        {
            SerialPort.Write($"{Name}{location}{Constants.EOT}");
            var buffer = new byte[CatLength.Answer];
            if (SerialPort.Read(buffer, 0, CatLength.Answer) != CatLength.Answer)
            {
                throw new UnexpectedRadioResponseException(Name, buffer);
            }

            var answer = Constants.Encoding.GetString(buffer);

            return Parse(answer);
        }

        public override async Task<Generic.MemoryChannel> ReadAsync(string location, CancellationToken cancellationToken)
        {
            var payload = Constants.Encoding.GetBytes($"{Name}{location}{Constants.EOT}");
            await SerialPort.WriteAsync(payload, 0, payload.Length);
            var buffer = new byte[CatLength.Answer];
            if (await SerialPort.ReadAsync(buffer, 0, CatLength.Answer) != CatLength.Answer)
            {
                throw new UnexpectedRadioResponseException(Name, buffer);
            }

            var answer = Constants.Encoding.GetString(buffer);

            return Parse(answer);
        }

        public override bool Set(Generic.MemoryChannel channel)
        {
            var payload = Constants.Encoding.GetBytes(Compose(new MemoryChannel(channel)));

            SerialPort.Write(payload, 0, payload.Length);

            return Read(channel.CurrentLocation).Equals(channel);
        }

        public override async Task<bool> SetAsync(Generic.MemoryChannel channel, CancellationToken cancellationToken)
        {
            var compose = Compose(new MemoryChannel(channel));

            var payload = Constants.Encoding.GetBytes(compose);

            await SerialPort.WriteAsync(payload, 0, payload.Length, cancellationToken);

            var result = await ReadAsync(channel.CurrentLocation, cancellationToken);

            return result.Equals(channel);
        }

        private string Compose(MemoryChannel channel)
        {
            return $"{Name}{channel.CurrentLocation}{channel.Frequency:000000000}{(char)channel.ClarifierDirection}{channel.ClarifierOffset:0000}{(channel.Clar ? 1 : 0)}0{channel.MemoryRadioMode.Code}1{(int)channel.Ctcss.Mode}00{(int)channel.Phase.Mode}{(channel.Tag ? 1 : 0)}{channel.Text,-12}{Constants.EOT}";
        }

        private MemoryChannel Parse(string input)
        {
            var match = readRegex.Match(input);

            if (!match.Success)
            {
                throw new UnmatchedRadioResponseException(Name, input);
            }

            var currentLocation = match.Result("${currentLocation}");
            var frequency = int.Parse(match.Result("${frequency}"));
            var clarifierDirection = char.Parse(match.Result("${clarifierDirection}"));
            var clarifierOffset = int.Parse(match.Result("${clarifierOffset}"));
            var clar = int.Parse(match.Result("${clar}")) == 0 ? false : true;
            var radioMode = char.Parse(match.Result("${mode}"));
            var ctcss = int.Parse(match.Result("${ctcss}"));
            var phase = int.Parse(match.Result("${phase}"));
            var tag = int.Parse(match.Result("${tag}")) == 0 ? false : true;
            var text = match.Result("${text}");

            var memoryChannel = new MemoryChannel
            {
                CurrentLocation = currentLocation,
                Frequency = frequency,
                ClarifierDirection = clarifierDirection,
                ClarifierOffset = clarifierOffset,
                Clar = clar,
                MemoryRadioMode = new MemoryRadioMode(radioMode),
                Ctcss = new Ctcss(ctcss),
                Phase = new Phase(phase),
                Tag = tag,
                Text = text

            };

            return memoryChannel;
        }

        public override void Write(Generic.MemoryChannel channel)
        {
            var payload = Constants.Encoding.GetBytes(Compose(new MemoryChannel(channel)));

            SerialPort.Write(payload, 0, payload.Length);
        }

        public override async Task WriteAsync(Generic.MemoryChannel channel, CancellationToken cancellationToken)
        {
            var compose = Compose(new MemoryChannel(channel));

            var payload = Constants.Encoding.GetBytes(compose);

            await SerialPort.WriteAsync(payload, 0, payload.Length, cancellationToken);
        }
    }
}