OHV/Dev/Connection/OHVProtocolServer/OHVConnector/Manager.cs

using System;
using System.Collections.Generic;
using System.IO;
using System.Linq;
using System.Text;
using System.Threading;
using System.Threading.Tasks;
using GSG.NET.Concurrent;
using GSG.NET.LINQ;
using GSG.NET.Logging;
using GSG.NET.Quartz;
using GSG.NET.TCP;
using GSG.NET.Utils;
using GSG.NET.Extensions;

namespace OHVConnector
{
    public partial class Manager
    {
        const byte STX = 0x02;
        const byte ETX = 0x03;

        const long INIT_CTRL_SYSBYTE = 0x40000000;
        long sysbyte = 0;
        long ctrl_sysbyte = INIT_CTRL_SYSBYTE;

        static Logger logger = Logger.GetLogger();

        TsQueue<QueueObject> qQ = new TsQueue<QueueObject>();
        TsQueue<OCSMessage> qqW = new TsQueue<OCSMessage>();

        byte[] crcTable = ChksumUtils.Crc8GenTable(0xD5);

        TimerTemplate<byte, OCSMessage> quzT3 = new TimerTemplate<byte, OCSMessage>();
        TsMap<long, SyncObject> ddReq = new TsMap<long, SyncObject>(); //sync 통신을 위함.

        TcpConnector h = new TcpConnector();

        Thread _TQ; //pumping queue thread
        Thread _TW; //write
        Thread _TR; //read
        Thread _TLINK; //Link test

        bool ModeActive { get; set; }
        bool? inited;

        public Config Config { get; set; }

        #region Properties
        public bool Connected
        {
            get { return h.Connected; }
        }

        /// <summary>
        /// 연결 시도 가능여부 체크
        /// <para>Connect 호출 or 연결중: true</para>
        /// <para>최초 or Disconnect 호출: false</para>
        /// </summary>
        public bool Connecting
        {
            get { return inited.HasValue ? inited.Value : false; }
        }

        #endregion

        #region Constactor
        public Manager()
        {
            ModeActive = true;
            Config = new Config();
            quzT3.OnTimeout += _OnTimeout;
            h.OnTcpStateChanged += _OnLog;
        }
        #endregion

        #region Connection Method
        public void Connect(bool active = false)
        {
            ModeActive = active;
            if (!inited.HasValue)//최초 한번 실행.
            {
                _TQ = ThreadUtils.Invoke(_ThPullQueue);
                inited = false;
            }
            Assert.IsFalse(inited.Value, "Already connecting");

            inited = true;

            _TW = ThreadUtils.Invoke(_ThWriteTcp);
            _TR = ThreadUtils.Invoke(_ThReadTcp);
            _TLINK = ThreadUtils.Invoke(_ThLinkQuz);

            _OnLog("OHV CONNECT REQ " + Config);
        }

        public void Disconnect()
        {
            //if (inited.HasValue && inited.Value)
            _OnLog("OCS DISCONNECT REQ " + Config);

            inited = false;
            quzT3.StopAll();

            ThreadUtils.Kill(_TLINK);
            ThreadUtils.Kill(_TW);
            h.StopListen();
            ThreadUtils.Kill(_TR);

            h.CloseSocket();//Kill 을 사용할 경우 뒤에 존재해야 한다.
        }

        void _OnDicontd(Exception e)
        {
            _OnLog("OHV DISCONNECTED");
            sysbyte = 0;
            ctrl_sysbyte = INIT_CTRL_SYSBYTE;
            //quzT3.StopAll(); //2020.08.261. Kang. 재연결 시 다시 Send 를 위해.
            ddReq.Clear();

            qQ.Enqueue(new QoNotComm { Arg0 = e });
        }

        void _OnContd()
        {
            _OnLog("OHV CONNECTED");
            qQ.Enqueue(new QoComm());
        }

        void TcpConnect()
        {
            h.Connect(new TcpComm
            {
                Active = ModeActive,
                RetryCnt = 1, //T5를 처리해야 함.
                Ip = Config.IpAddress,
                PortNo = Config.Port,
                T5 = Config.T5,
                T6 = Config.T6,//Config.TcpRecdTimeout,
            });

            if (!h.Connected)
            {
                if (ModeActive)
                    _OnLog("T5 TIMEOUT " + Config.ID);
                return;
            }
            _OnContd();

            ChgTcpTimeout(true);
            //if (ModeActive)
            //SendCtrlMsg(1);//무조건 HSMS Active
        }

        #endregion

        private void _OnLog(string obj)
        {
            qQ.Enqueue(new QoLog { Arg0 = obj });
        }

        private void _OnTimeout(byte crc, OCSMessage msg)
        {
            if (null == msg)
            {
                logger.W("T3 [{0}] attachment is null", crc);
                return;
            }

            qQ.Enqueue(new QoTimeout { Arg0 = msg });
            _OnLog($"T3 TIMEOUT {msg.LogFormat()}");
        }

        #region Thread Method
        readonly object lockLink = new object();
        void _ThLinkQuz()
        {
            for (; ; )
            {
                try
                {
                    bool waked;

                    if (Config.LinkOn)
                        waked = LockUtils.Wait(Config.TLink, lockLink);
                    else
                        waked = LockUtils.Wait(lockLink);

                    if (waked)
                        continue;//notify: 패킷을 수신할때마다 reset 함.

                    if (Connected)//연결여부와 상관없이 thread 가 기동되므로 연결시에만.
                    {
                        //SendCtrlMsg(5);
                    }
                }
                catch (ThreadAbortException)
                {
                    break;
                }
                catch (Exception e)
                {
                    logger.E(e);
                }
            }
        }

        void _ThWriteTcp()
        {
            logger.I("Write {0}", ThreadUtils.GetCurrThreadID());
            for (; ; )
            {
                try
                {
                    var v = qqW.Dequeue();

                    this.TcpWriteMsg(v);
                    //v.IsRecd = false;

                    //if (v.AfterMillis > 0)
                    //    LockUtils.Wait(v.AfterMillis);

                    //if (v.CtrlMsg)
                    //    TcpWriteCtrlMsg(v);
                    //else
                    //    TcpWriteNormalMsg(v);
                }
                catch (ThreadAbortException)
                {
                    break;
                }
                catch (Exception e)
                {
                    logger.E(e);
                }
            }
        }

        void _ThReadTcp()
        {
            for (; ; )
            {
                try
                {
                    if (!h.Connected)
                    {
                        TcpConnect();
                        continue;
                    }
                    ReadSocket();
                }
                catch (ObjectDisposedException e)
                {
                    TcpError(e);
                }
                catch (IOException e)
                {
                    TcpError(e);
                }
                catch (ThreadAbortException)
                {
                    _OnLog("DISCONNECT REQUEST APPLIED " + Config);
                    TcpError(new IOException("DISCONNECT REQUEST"));
                    break;
                }
                catch (Exception e)
                {
                    TcpError(e);
                    logger.E(e);
                }
            }
        }

        void _ThPullQueue()
        {
            for (; ; )
            {
                try
                {
                    var qo = this.qQ.Dequeue();

                    if (qo is QoRecdUnk)
                    {
                        DelegateUtils.Invoke(OnRecdUnk, qo.Arg0, qo.Arg1);
                        //if (AutoS9Fy)
                        //{
                        //    var v = qo.Arg0 as SFMessage;
                        //    Send(v.S9Fy);
                        //}
                    }
                    else if (qo is QoComm)
                        DelegateUtils.Invoke(OnContd, Config.ID);
                    else if (qo is QoNotComm)
                        DelegateUtils.Invoke(OnDiscontd, Config.ID, qo.Arg0);
                    else if (qo is QoLog)
                        DelegateUtils.Invoke(OnLog, Config.ID, qo.Arg0);
                    else if (qo is QoRecd)
                        DelegateUtils.Invoke(OnRecd, qo.Arg0);
                    else if (qo is QoTimeout)
                    {
                        DelegateUtils.Invoke(OnT3Timeout, qo.Arg0);
                        //if (AutoS9Fy)
                        //{
                        //    var v = qo.Arg0 as SFMessage;
                        //    Send(MessageSupport.MakeS9FX(9, v));
                        //}
                    }
                    else if (qo is QoSent)
                        DelegateUtils.Invoke(OnSent, qo.Arg0);
                    else
                        Assert.Fail("Unk Object {0}", qo);
                }
                catch (ThreadAbortException)
                {
                    break;
                }
                catch (Exception e)
                {
                    logger.E(e);
                }
            }
        }

        #endregion

        #region Read Method
        void ReadSocket()
        {
            byte stx = 0x0;
            do
            {
                stx = h.ReadByte(); //STX
                //logger.D( $"[OCS] - {stx}" );
            }
            while (stx != STX);

            string revID = string.Empty;
            string sendID = string.Empty;

            if (ModeActive)
            {
                revID = h.ReadAscii(2);
                sendID = h.ReadAscii(5);
            }
            else
            {
                revID = h.ReadAscii(5);
                sendID = h.ReadAscii(2);
            }

            if (!this.Config.ID.Equals(revID))
                OnLog(this.Config.ID, $"RevID Not Equals");

            var ocsMeg = new OCSMessage();
            ocsMeg.RevID = revID;
            ocsMeg.SendID = sendID;
            ocsMeg.Kind = h.ReadAscii(1).ToEnum<eKind>(eKind.Unknown);

            if (ocsMeg.Kind == eKind.M) //M Command 가변으로 들어 온다.
            {
                ocsMeg.Tag = h.ReadAscii(4);
                ocsMeg.SubCode = h.ReadAscii(3);
                var viaCount = Convert.ToInt16(h.ReadAscii(4)); //4byte
                for (int i = 0; i < viaCount; i++)
                {
                    ocsMeg.ViaRouteList.Add(h.ReadAscii(4));
                }
                ocsMeg.CheckSum = h.ReadAscii(1);
                h.ReadUntil(ETX);
            }
            else
            {
                if (ocsMeg.Kind == eKind.D) //시간동기화 메시지 
                {
                    ocsMeg.Tag = h.ReadAscii(4);
                    ocsMeg.SubCode = h.ReadAscii(13);
                    ocsMeg.CheckSum = h.ReadAscii(1);
                    h.ReadUntil(ETX);
                }
                else
                {
                    ocsMeg.Tag = h.ReadAscii(4);
                    ocsMeg.SubCode = h.ReadAscii(3);

                    if (ocsMeg.Kind == eKind.B)
                        ocsMeg.BatterySOH = h.ReadAscii(3);

                    //CheckSum 을 해야 하나??
                    ocsMeg.CheckSum = h.ReadAscii(1);
                    h.ReadUntil(ETX);
                }

            }

            //Todo: 응답으로 온건지 그냥 보낸건지 분류가 필요. = CheckSum 을 저장 했다가 이용하자.

            //if (!len.FwBtw(10, MAX_SIZE))
            //    throw new IOException("HSMS ABNORMAL LENGTH:" + len);

            //var head = h.ReadBytes(10);
            //var body = h.ReadBytes(len - 10);

            ChgTcpTimeout(true);//무언가 받으면

            LockUtils.NotifyAll(lockLink);//Linktest thread 변환의 notify

            //var v = new OCSMessage { Header = head, Body = body, IsRecd = true };
            //v.Decoding();

            _OnRecd(ocsMeg);
        }

        void _OnRecd(OCSMessage recd)
        {
            //Alive Check Reply
            if (recd.Kind == eKind.A && !ModeActive) //자동으로 응답을 보낸다. OCS 가 Active 상태
            {
                var reply = new OCSMessage()
                {
                    Id = this.Config.ID,
                    RevID = recd.SendID,
                    SendID = this.Config.ID,
                    Kind = eKind.A,
                    Tag = recd.Tag,
                    SubCode = recd.SubCode,
                };
                Reply(reply);
                return;
            }

            if (recd.Kind == eKind.M && !ModeActive) //M Code 응답은 없음 
            {
                this.qQ.Enqueue(new QoRecd { Arg0 = recd });
                return;
            }

            //Send 한 Message 의 Reply 로 판단.
            var crc = MakeCRC8CheckSum(recd, false);
            if (this.quzT3.HasId(crc))
            {
                //Send 목록에서 삭제한다.
                this.quzT3.Stop(crc);
                this._OnLog($"[Reply] - {recd.LogFormat()}");
                return;
            }

            this.qQ.Enqueue(new QoRecd { Arg0 = recd });
        }

        void TcpError(Exception e)
        {
            _OnLog(TcpUtils.GetTcpErrMsg(h.IPClient, e));

            h.CloseSocket();
            _OnDicontd(e);

            var waitTime = (this.Config.T3 + 2) * ConstUtils.ONE_SECOND;
            LockUtils.Wait(waitTime);//잠시대기.
        }

        #endregion

        #region Write Method
        void TcpWriteMsg(OCSMessage msg)
        {
            this.h.WriteFlush(msg.ToMemoryBuffer().ToBytes);
            qQ.Enqueue(new QoSent { Arg0 = msg });
        }

        void TcpWriteNormalMsg(OCSMessage nm)
        {
            //nm.Encoding();

            //if (nm.IsPrimary && nm.IsWbit)
            //    quzT3.StartOnce(Config.T3 * ConstUtils.ONE_SECOND, nm.Systembyte, nm);

            //int len = nm.Header.Length + nm.Body.Length + 10;
            //var mb = new MemoryBuffer(len);
            //mb.AppendBeInt(nm.Length);
            //mb.Append(nm.Header);
            //mb.Append(nm.Body);

            //qQ.Enqueue(new QoSent { Arg0 = nm });

            //h.WriteFlush(mb.ToBytes);
        }

        void TcpWriteCtrlMsg(OCSMessage ctrl)
        {
            //var mb = new MemoryBuffer(16);
            //mb.AppendBeInt(10);
            //mb.Append(ctrl.Header);

            //bool skip = ctrl.CtrlLinkTest && Config.HideLogLink;
            //if (!skip)
            //    _OnLog(ctrl.LogFormat());

            //h.WriteFlush(mb.ToBytes);
        }

        void SendCtrlMsg(int stype)
        {
            //Send(new OCSMessage { SType = stype });
        }

        public void Send(OCSMessage msg, int after)
        {
            if (after > 0)
                TimerUtils.Once(after, Send, msg);
            else
                Send(msg);
        }

        public void Send(OCSMessage msg)
        {
            //msg.Id = Config.ID;

            msg.RevID = Config.HostID;
            msg.SendID = Config.ID;

            if (!Connected)
            {
                _OnLog("Send fail not connected" + msg.LogFormat());
                return;
            }

            if (msg.Kind == eKind.C) // Control Message 는 페어로 응답이 오지 않는다.
            {
                qqW.Enqueue(msg);
                return;
            }

            #region 2020.08.25. Kang. OCS에서 응답 안하는 것에 대해 Retry 를 위해 추가. 
            if (msg.Kind == eKind.L || msg.Kind == eKind.U)
            {
                var crc = MakeCRC8CheckSum(msg, true);
                if (this.quzT3.HasId(crc))
                {
                    _OnLog("quzT3 Has ID" + msg.LogFormat());
                    return;
                }

                this.quzT3.StartOnce(Config.T3 * ConstUtils.ONE_SECOND, crc, msg);
            }
            #endregion

            //if (msg.CtrlMsg)
            //{
            //    if (msg.CtrlSelectReq || msg.CtrlLinkReq)
            //    {
            //        msg.Systembyte = Interlocked.Increment(ref ctrl_sysbyte);
            //        ChgTcpTimeout(false);//select, linktest req
            //    }
            //}
            //else
            //{
            //    msg.DeviceId = msg.SessID.HasValue ? msg.SessID.Value : Config.DeviceID;

            //    if (msg.IsPrimary && msg.NeedSetSysbyte)
            //        msg.Systembyte = Interlocked.Increment(ref sysbyte);
            //}

            qqW.Enqueue(msg);
        }

        /// <summary>
        /// 응답을 보낼 때 사용.
        /// </summary>
        /// <param name="msg"></param>
        public void Reply(OCSMessage msg)
        {
            msg.RevID = Config.HostID;
            msg.SendID = Config.ID;

            if (!Connected)
            {
                _OnLog("Reply fail not connected" + msg.LogFormat());
                return;
            }

            qqW.Enqueue(msg);
        }

        #endregion

        #region HelpMothed
        byte MakeCRC8CheckSum(OCSMessage msg, bool isSend)
        {
            if (isSend)
                return ChksumUtils.Crc8(this.crcTable, msg.ToCRC8Byte4Send());
            else
                return ChksumUtils.Crc8(this.crcTable, msg.ToCRC8Byte4Received());
        }
        void ChgTcpTimeout(bool infinite)
        {
            if (h.Connected)
            {
                if (infinite)
                {
                    if (h.Socket.ReceiveTimeout != Timeout.Infinite)
                        h.ChangeRecvTimeout(Timeout.Infinite);
                }
                else
                {
                    if (Config.LinkOn)
                        h.ChangeRecvTimeout(Config.T6 * ConstUtils.ONE_SECOND);
                }
            }
        }
        #endregion`

    }
}