Virgo_D_SLN/Virgo_DRT/Devices/AdTecRF.cs

using System;
using System.Collections;
using System.Text.RegularExpressions;
using Aitex.Core.Common.DeviceData;
using Aitex.Core.RT.DataCenter;
using Aitex.Core.RT.Event;
using Aitex.Core.RT.IOCore;
using Aitex.Core.RT.Log;
using Aitex.Core.RT.OperationCenter;
using Aitex.Core.RT.SCCore;
using Aitex.Core.RT.Tolerance;
using Aitex.Core.Util;
using MECF.Framework.Common.Communications;
using MECF.Framework.Common.Device.Bases;
using MECF.Framework.Common.Equipment;
using Virgo_DCommon;
using Virgo_DRT.Modules;

namespace Virgo_DRT.Devices
{
    #region RFG

    static class AdTecRfMessage
    {
        public static string ANALOG;
        public const string EOF       = "\r";
        public const char DELIMITER   = ' ';
        public const string MANUAL    = "MANUAL";
        public const string RS232     = "***";
        public const string SET_POWER = " W";
        public const string RF_ON     = "G";
        public const string RF_OFF    = "S";
        public const string ERR_RES   = "N";
        public const string QUERY     = "Q";
        public const string RESET     = "RESET";
        public const string CHK_COMM  = "HS";
    }

    class AdTecGenerator : RfPowerBase
    {
        // ----------------------------Fields--------------------------
        //
        private int QUERY_INTERVAL = 5000;
        private const string INFO_PATTERN = @"(\d{7})\s(\d{5})\s(\d{5})\s(\d{5})\s(\d{5})";
        private bool _bRfAlarm = false;
        private readonly AsyncSerialPort   _serial;
        private readonly DeviceTimer       _timerQueryStatus = new DeviceTimer();
        private DateTime                   _powerOnStartTime;
        private TimeSpan                   _powerOnElapsedTime;
        private readonly R_TRIG            _rfOnTrigger = new R_TRIG();
        private readonly R_TRIG            _ErrTrigger = new R_TRIG();
        private readonly R_TRIG            _ErrTest = new R_TRIG();
        private ToleranceChecker           _checkerPower;
        private ToleranceChecker           _checkerReflectPower;
        private readonly double            _scPowerAlarmTime;
        private readonly double            _scPowerAlarmRange;
        private readonly double            _scReflectPowerAlarmTime;
        private readonly double            _scReflectPowerAlarmRange;
        private readonly double            _scPowerRange;
        private readonly DIAccessor        _diIntlk;

        // --------------------------Properties------------------------
        //
        public bool ConnectedStatus { get; set; }
        public float ScalePower => (float)_scPowerRange;

        public GeneratorStatus Status { get; set; }

        public override bool IsPowerOn
        {
            get => Status == GeneratorStatus.ON;
            set { }
        }

        public override bool IsError 
        {
            get => Status == GeneratorStatus.ERROR;
            set { }
        }

        [Subscription("RfAlarm")]
        public bool RfAlarm
        {
            get
            {
                return _bRfAlarm;
            }
        }

        [Subscription("PowerOnTime")]
        public string PowerOnTime
        {
            get
            {
                if (IsPowerOn)
                {
                    _powerOnElapsedTime = DateTime.Now - _powerOnStartTime;

                    //return $"{(int)_powerOnElapsedTime.TotalHours:00}:{_powerOnElapsedTime.Minutes:00}:{_powerOnElapsedTime.Seconds:00}";
                    //return $"{(int)_powerOnElapsedTime.TotalHours:00}:{_powerOnElapsedTime.Minutes:00}:{(_powerOnElapsedTime.Seconds > 0 ? (_powerOnElapsedTime.Seconds + 1) : 0):00}";
                    //return $"{(int)(_powerOnElapsedTime.Hours * 3600 + _powerOnElapsedTime.Minutes * 60 + (_powerOnElapsedTime.Seconds > 0 ? (_powerOnElapsedTime.Seconds + 1) : 0))}";
                    return $"{(int)(_powerOnElapsedTime.Hours * 3600 + _powerOnElapsedTime.Minutes * 60 + _powerOnElapsedTime.Seconds)}";
                }
                else
                {
                    return "0";
                }
            }
        }

        public bool RFInterlock => _diIntlk == null || _diIntlk.Value;

        public new AITRfData DeviceData =>
            new AITRfData
            {
                Module             = Module,
                DeviceName         = Name,
                ScalePower         = ScalePower,
                ForwardPower       = ForwardPower,
                ReflectPower       = ReflectPower,
                IsRfOn             = IsPowerOn,
                PowerSetPoint      = PowerSetPoint,
                PowerOnElapsedTime = PowerOnTime,
                IsInterlockOk      = RFInterlock,
            };

        // --------------------------Constructor-----------------------
        //
        public AdTecGenerator(ModuleName mod) : base(mod.ToString(), Virgo_DDevice.Rf.ToString())
        {
            var portNum = SC.GetStringValue($"{mod}.Rf.Port");
            this.Status = GeneratorStatus.Unknown;

            _serial = new AsyncSerialPort(portNum, 9600, 8, System.IO.Ports.Parity.None, System.IO.Ports.StopBits.One, "\r\r");

            _scPowerAlarmTime         = SC.GetValue<double>($"{Module}.{Name}.PowerAlarmTime");
            _scPowerAlarmRange        = SC.GetValue<double>($"{Module}.{Name}.PowerAlarmRange");
            _scReflectPowerAlarmTime  = SC.GetValue<double>($"{Module}.{Name}.ReflectPowerAlarmTime");
            _scReflectPowerAlarmRange = SC.GetValue<double>($"{Module}.{Name}.ReflectPowerAlarmRange");
            _scPowerRange             = SC.GetValue<double>($"{Module}.{Name}.PowerRange");

            _diIntlk = IO.DI[$"{Module}.DI_Generator_Hardware_Interlock"];
        }

        ~AdTecGenerator()
        {
            _serial?.Close();
        }

        public override bool Initialize()
        {
            base.Initialize();
            
            DATA.Subscribe($"{Module}.{Name}.DeviceData", () => DeviceData);

            if (_serial.Open())
            {
                this.ConnectedStatus = true;
                _serial.OnDataChanged += SerialPortDataReceived;
                _serial.OnErrorHappened += SerialPortErrorOccurred;
            }
            else
            {
                this.ConnectedStatus = false;
                EV.PostAlarmLog(this.Module, "AD TEC 射频发生器串口无法打开");
                return false;
            }

            _timerQueryStatus.Start(QUERY_INTERVAL);

            _checkerPower = new ToleranceChecker(_scPowerAlarmTime);
            _checkerReflectPower = new ToleranceChecker(_scReflectPowerAlarmTime);

            OP.Subscribe($"{Module}.{Name}.{AITRfOperation.SetPowerOnOff}", (out string reason, int time, object[] param) =>
            {
                SetPowerOnOff(Convert.ToBoolean((string)param[0]), out reason);
                return true;
            });
            OP.Subscribe($"{Module}.{Name}.{AITRfOperation.SetPower}", (out string reason, int time, object[] param) =>
            {
                reason = "";
                ushort val = Convert.ToUInt16(param[0]);
                SetPower(val);
                return true;
            });
            OP.Subscribe($"{Module}.{Name}.{AITRfOperation.SetContinuousPower}", (out string reason, int time, object[] param) =>
            {
                reason = "";
                ushort val = Convert.ToUInt16(param[0]);
                SetPower(val);
                return true;
            });

            SetCommunicationMode(1);
            return true;
        }

        public override void Monitor()
        {
            // 状态查询
            if (_timerQueryStatus.IsTimeout())
            {
                this.SendCmd(AdTecRfMessage.QUERY);
                _timerQueryStatus.Start(QUERY_INTERVAL);
            }

            // power on triggered
            _rfOnTrigger.CLK = IsPowerOn;
            if (_rfOnTrigger.Q)
            {
                _powerOnStartTime = DateTime.Now;
                _checkerPower.Reset(_scPowerAlarmTime);
                _checkerReflectPower.Reset(_scReflectPowerAlarmTime);
            }

            if (_rfOnTrigger.M)
            {
                _checkerPower.Monitor(ForwardPower, PowerSetPoint - _scPowerAlarmRange, PowerSetPoint + _scPowerAlarmRange, _scPowerAlarmTime);

                if (_checkerPower.Trig)
                {
                    EV.PostAlarmLog($"{Module} {Display}",
                        $"Forward power {ForwardPower:0} out of range[{PowerSetPoint - _scPowerAlarmRange:0},{PowerSetPoint + _scPowerAlarmRange:0}] in {_scPowerAlarmTime:0} seconds");
                    _bRfAlarm = true;
                    SetPowerOnOff(false, out _);
                }

                _checkerReflectPower.Monitor(ReflectPower, double.MinValue, _scReflectPowerAlarmRange, _scReflectPowerAlarmTime);

                if (_checkerReflectPower.Trig)
                {
                    EV.PostAlarmLog($"{Module} {Display}",
                        $"Reflect power {ReflectPower:0} out of range[0,{_scReflectPowerAlarmRange:0}] in {_scReflectPowerAlarmTime:0} seconds");
                    _bRfAlarm = true;
                    SetPowerOnOff(false, out _);
                }
            }

            if (!_rfOnTrigger.CLK)
            {
                ForwardPower = 0;
                ReflectPower = 0;
            }

            // 通信 checking, 2 second 一次
            //if (_timerComm.IsTimeout() && !_bQueryComm)
            //{
            //    this.SendCmd(AdTecRfMessage.CHK_COMM);
            //    _bQueryComm = true;
            //    _timerComm.Start(CHK_COMM_INTERVAL);
            //}
        }

        public override void Terminate()
        {
            _serial?.Close();
        }

        public override void Reset()
        {
            _bRfAlarm = false;
            _rfOnTrigger.RST = true;
            _ErrTrigger.RST = true;
            _ErrTest.RST = true;
            this.SendCmd(AdTecRfMessage.RESET);
            this.Status = GeneratorStatus.OFF;

        }

        public void SetRfMode(RfMode mode)
        {
            throw new NotImplementedException();
        }

        public override void SetCommunicationMode(int mode)
        {
            CommunicationType t1 = (CommunicationType)mode;
            switch (t1)
            {
            case CommunicationType.Analogue:
                this.SendCmd(AdTecRfMessage.ANALOG);
                break;
            case CommunicationType.RS232:
                this.SendCmd(AdTecRfMessage.RS232);
                break;
            default:
                throw new ArgumentOutOfRangeException("Communication mode error");
            }
        }

        public override void SetPower(float val)
        {
            if (!(this.ControlMode == EnumRfPowerControlMode.RS232Mode)) SetCommunicationMode(1);

            ushort a = (ushort)val;
            if (SendCmd($"{a:D4}{AdTecRfMessage.SET_POWER}"))
            {
                PowerSetPoint = val;
            }
        }

        public override bool SetPowerOnOff(bool on, out string str)
        {
            if (!(this.ControlMode == EnumRfPowerControlMode.RS232Mode)) SetCommunicationMode(1);

            str = "";
            if (on)
            {
                SendCmd(AdTecRfMessage.RF_ON);
                Status = GeneratorStatus.ON;
                QUERY_INTERVAL = 500;
            }
            else
            {
                SendCmd(AdTecRfMessage.RF_OFF);
                Status = GeneratorStatus.OFF;
                ForwardPower = 0;
                ReflectPower = 0;
                QUERY_INTERVAL = 5000;
                _ErrTrigger.RST = true;
            }

            _timerQueryStatus.Start(QUERY_INTERVAL);
            return true;
        }

        //----------------------------------Private Method-------------------------------
        //
        private void SerialPortDataReceived(string str)
        {
            if (string.IsNullOrEmpty(str))
            {
                EV.PostAlarmLog(Module, "AdTec RFG 无数据反馈");
                return;
            }

            string str2 = str.Trim('\r');
            if (str2 == AdTecRfMessage.ERR_RES)
            {
                EV.PostWarningLog(this.Module, $"AdTEC 收到 [{str2}]");
                return;
            }

            try
            {
                LOG.Info($"{Module} Generator rec [{str2}]");
                if (string.IsNullOrEmpty(str2))
                {
                    _ErrTest.CLK = true;
                    if (_ErrTest.Q)
                        return;
                }
                Match match1 = Regex.Match(str2, INFO_PATTERN);
                if (!match1.Success)
                {
                    EV.PostAlarmLog(Module, "AdTec 数据格式错误");
                    return;
                }

                string[] str1 =
                {
                    match1.Groups[1].Value,
                    match1.Groups[2].Value,
                    match1.Groups[3].Value,
                    match1.Groups[4].Value,
                    match1.Groups[5].Value
                };

                this.ParseQueryData(str1);
                _ErrTest.RST = true;
            }
            catch (Exception ex)
            {
                LOG.Write(ex);
            }
        }

        private void ParseQueryData(string[] strInfo)
        {
            // Control mode
            string s2 = strInfo[0].Substring(0, 1);
            this.ControlMode = (EnumRfPowerControlMode)Convert.ToUInt16(s2);

            // output mode
            string s0 = strInfo[0].Substring(1, 1);
            this.WorkMode = (EnumRfPowerWorkMode)Convert.ToUInt16(s0);

            // ON/OFF
            char s1 = strInfo[0][1];
            this.IsPowerOn = s1 == '1';

            // error code
            string alarm = strInfo[0].Substring(5, 2);
            byte errCode = Convert.ToByte(alarm);

            _ErrTrigger.CLK = errCode > 0;
            if (_ErrTrigger.Q)
            {
                string code = errCode == 1 ? "Ref Over" : errCode == 2 ? "Ref Limit" :
                    errCode == 3 ? "Cur Over" :
                    errCode == 4 ? "Cur Limit" :
                    errCode == 5 ? "Temp Over" :
                    errCode == 6 ? "Temp Sensor Short" :
                    errCode == 7 ? "Temp Sensor Open" :
                    errCode == 8 ? "Sensor Error" :
                    errCode == 9 ? "Fwd Power Over" :
                    errCode == 10 ? "RF ON Timer" :
                    errCode == 11 ? "RS232C error" :
                    errCode == 12 ? "Amp Unbalance" :
                    errCode == 14 ? "Fan error" :
                    errCode == 15 ? "Coolant Error" :
                    errCode == 16 ? "Voltage Error" :
                    errCode == 17 ? "Fwd Power Down" :
                    errCode == 22 ? "PD Over" :
                    errCode == 23 ? "PD Limit" :
                    errCode == 26 ? "Dew Condensation" :
                    errCode == 29 ? "SW Failure" :
                    errCode == 99 ? "Safety Lock" : string.Empty;

                if (!string.IsNullOrEmpty(code))
                {
                    if (errCode == 99)
                        EV.PostWarningLog(Module, "Generator " + code);
                    else
                        EV.PostAlarmLog(Module, "Generator " + code);
                }
            }

            // forward power
            this.ForwardPower = Convert.ToUInt16(strInfo[2]);

            // reflect power
            this.ReflectPower = Convert.ToUInt16(strInfo[3]);
        }

        private void SerialPortErrorOccurred(string obj)
        {
            Status = GeneratorStatus.ERROR;
            EV.PostAlarmLog(this.Module, $"AdTec RFG 串口出错, [{obj}]");
        }

        private bool SendCmd(string str)
        {
            if (str != AdTecRfMessage.QUERY)
            {
                EV.PostInfoLog(Module, $"Generator send [{str}]");
            }
            return _serial.Write(str + "\r");
        }
    }

    #endregion RFG

    #region match

    static class AdTecMatchMessage
    {
        public const string PRESET       = "G";
        public const string AUTO         = "L";
        public const string MANUAL       = "M";
        public const string PRESET_MEM   = "P";
        public const string START_QUERY  = "S3";
        public const string STOP_QUERY   = "SP";
        public const string WRITE_POS    = "$APGR";
        public const string READ_POS     = "$APRR";
    }

    class AdTecMatch : RfMatchBase
    {
        // ----------------------------Fields--------------------------
        //
        private readonly AsyncSerialPort _serial;
        private const ushort             S3_HEAD_LENGTH = 2;
        private readonly DeviceTimer     _timerQueryStatus = new DeviceTimer();
        private int QUERY_INTERVAL = 1000;
        //private int                      _scMatchPresetMode;
        //private int                      _scMatchMode;
        //private readonly SCConfigItem    _scMatchPositionC1;
        //private readonly SCConfigItem    _scMatchPositionC2;
        //private readonly bool            _scEnableC1C2Position;

        // --------------------------Properties------------------------
        //
        [Subscription("MatchWorkMode")]
        public EnumRfMatchTuneMode WorkMode { get; set; }
        public float C1 { get; set; }
        public float C2 { get; set; }

        [Subscription("VPP")]
        public ushort VPP { get; set; }

        public override AITRfMatchData DeviceData
        {
            get
            {
                return new AITRfMatchData
                {
                };
            }
        }

        // --------------------------Constructor-----------------------
        //
        public AdTecMatch(ModuleName mod) : base(mod.ToString(), Virgo_DDevice.Match.ToString())
        {
            var portNum = SC.GetStringValue($"{mod}.match.Port");

            _serial = new AsyncSerialPort(portNum, 9600, 8);

            //_scMatchPresetMode    = SC.GetValue<int>($"{Module}.Rf.PresetMode");
            //_scMatchMode          = SC.GetValue<int>($"{Module}.Rf.MatchMode");
            //_scMatchPositionC1    = SC.GetConfigItem($"{Module}.Rf.MatchPositionC1");
            //_scMatchPositionC2    = SC.GetConfigItem($"{Module}.Rf.MatchPositionC2");
            //_scEnableC1C2Position = SC.GetValue<bool>($"{Module}.Rf.EnableC1C2Position");
        }

        ~AdTecMatch()
        {
            _serial?.Close();
        }

        public override bool Initialize()
        {
            base.Initialize();

            if (_serial.Open())
            {
                _serial.OnDataChanged += SerialPortDataReceived;
                _serial.OnErrorHappened += SerialPortErrorOccurred;
            }
            else
            {
                EV.PostAlarmLog(Module, "Match 串口无法打开");
                return false;
            }

            DATA.Subscribe($"{Module}.{Name}.C1", () => C1);
            DATA.Subscribe($"{Module}.{Name}.C2", () => C2);

            OP.Subscribe($"{Module}.{Name}.SetC1", (func, args) =>
            {
                return true;
            });
            OP.Subscribe($"{Module}.{Name}.SetC2", (func, args) =>
            {
                return true;
            });

            OP.Subscribe($"{Module}.{Name}.{AITRfOperation.SetMatchPositionC1}", (out string reason, int time, object[] param) =>
            {
                SetMatchPositionC1((float)Convert.ToDouble(param[0]), out reason);
                return true;
            });

            OP.Subscribe($"{Module}.{Name}.{AITRfOperation.SetMatchPositionC2}", (out string reason, int time, object[] param) =>
            {
                SetMatchPositionC2((float)Convert.ToDouble(param[0]), out reason);
                return true;
            });

            OP.Subscribe($"{Module}.{Name}.{AITRfOperation.SetMatchPosition}", (out string reason, int time, object[] param) =>
            {
                SetMatchPosition((float)Convert.ToDouble(param[0]), (float)Convert.ToDouble(param[1]), out reason);
                return true;
            });

            OP.Subscribe($"{Module}.{Name}.{AITRfOperation.SetMatchProcessMode}", (out string reason, int time, object[] param) =>
            {
                SetMatchMode((string)param[0], out reason);
                return true;
            });

            _timerQueryStatus.Start(QUERY_INTERVAL);
            this.SendCmd(AdTecMatchMessage.START_QUERY);
            return true;
        }

        public override void Monitor()
        {
            try
            {
                if (_timerQueryStatus.IsTimeout())
                {
                    this.SendCmd(AdTecMatchMessage.READ_POS);
                    _timerQueryStatus.Start(QUERY_INTERVAL);
                }
            }
            catch (Exception ex)
            {
                LOG.Write(ex);
            }
        }

        public override void Terminate()
        {
            this.SendCmd(AdTecMatchMessage.STOP_QUERY);
        }

        public override void Reset()
        {
            //SendCmd(AdTecMatchMessage.STOP_QUERY);
        }

        /// <summary>
        ///
        /// </summary>
        /// <param name="c1,c2">百分比数字</param>
        /// <param name="c2"></param>
        public override void SetMatchPosition(float c1, float c2, out string reason)
        {
            //base.SetMatchPosition(c1, c2, out reason);

            ////this.SetWorkMode(EnumRfMatchTuneMode.Manual);
            //this.SetPosition(c1, c2);
            ////this.SetPresetMemory(0);
            ////this.SetWorkMode(EnumRfMatchTuneMode.Auto);

            //TunePosition1 = c1;
            //TunePosition2 = c2;
            reason = "";
        }

        public void SetPresetMode(RfMatchPresetMode mode)
        {
        }

        // -----------------------Private Method-------------------------
        //
        private void SerialPortDataReceived(string strOrg)
        {
            if (string.IsNullOrWhiteSpace(strOrg))
            {
                EV.PostAlarmLog(Module, "收到 Match 数据为空");
                return;
            }

            string[] sContent = strOrg.Split('\r');

            foreach (var sItem in sContent)
            {
                string sItem1 = sItem.TrimStart('\n');

                if (sItem1.Contains(AdTecMatchMessage.START_QUERY))
                {
                    // BYTE 3,4; bit 7
                    string s0 = sItem1.Substring(2 + S3_HEAD_LENGTH, 2);
                    ushort status0 = Convert.ToUInt16(s0);
                    byte[] a1 = BitConverter.GetBytes(status0);

                    BitArray ba1 = new BitArray(a1);

                    this.WorkMode = ba1[7] ? EnumRfMatchTuneMode.Manual : EnumRfMatchTuneMode.Auto;

                    TuneMode1 = WorkMode;
                    TuneMode2 = WorkMode;

                    string sVpp = sItem1.Substring(42 + S3_HEAD_LENGTH, 3);
                    this.VPP = Convert.ToUInt16(sVpp, 16);
                }
                else if (sItem1.Contains(AdTecMatchMessage.READ_POS))
                {
                    string s1 = sItem1.Substring(5);
                    string sLoad = s1.Substring(0, 3);
                    string sPhase = s1.Substring(3, 3);

                    this.TunePosition1 = Convert.ToUInt16(sLoad, 16) * 0.1f;
                    this.TunePosition2 = Convert.ToUInt16(sPhase, 16) * 0.1f;
                }
            }
        }

        private void SerialPortErrorOccurred(string str)
        {
            EV.PostAlarmLog(Module, $"AdTec Match error [{str}]");
        }

        private void SendCmd(string str)
        {
            _serial?.Write(str + "\r");
            //EV.PostInfoLog(Module.ToString(), $"Match send [{str}]");
        }

        private void SetPosition(float c1val, float c2val)
        {
            ushort val1 = (ushort)(c1val * 10);
            ushort val2 = (ushort)(c2val * 10);

            string cmd = AdTecMatchMessage.WRITE_POS + val1.ToString("X3") + val2.ToString("X3");
            this.SendCmd(cmd);
        }

        private void SetWorkMode(EnumRfMatchTuneMode mode)
        {
            this.SendCmd(mode == EnumRfMatchTuneMode.Auto ? AdTecMatchMessage.AUTO :
                mode == EnumRfMatchTuneMode.Manual ? AdTecMatchMessage.MANUAL : "");
        }

        private void SetPresetMemory(byte gear)
        {
            this.SendCmd(AdTecMatchMessage.PRESET_MEM + gear.ToString());
        }
    }

    #endregion match
}