///
/// Copyright (c) 2018 Sensus Slovensko a.s.
///
using System;
using System.Collections.Generic;
using log4net;
using TBF.BenchControl.Generic;
using TBF.Boxes;
using Config.Entities;
using System.Diagnostics;

namespace TBF.BenchControl.Modbus.UltrasoundLevelMeter
{
    public class LevelMeter : ComponentBase, GenericDevices.ILevelMeter, GenericDevices.ITempMeter, IDevice
	{
		private static readonly ILog log = LogManager.GetLogger(typeof(LevelMeter));
        public override string ToString() { return string.Format("LevelMeter({0})", Cfg.ToString(1)); }

		readonly LevelMeterCfg myCfg;
	    readonly GenericDevices.IModbus modbus;

        /// <summary>The state of the measurement</summary>
        MsrmntState msrmntState;

        ///
        /// Measured values when MsrmntState == MsrmntState.Valid
        ///
        double distance;        /// [mm]
        double level;           /// [mm]
        double percentage;      /// [%]
        double temperature;     /// [°C]
        ushort state;

        public double Level { get { return level; } }

        /// <summary>Measurement time stamp when MsrmntState == MsrmntState.Valid</summary>
        int msrmntTimeStamp;


		public LevelMeter()
		{
		}

		public LevelMeter(Generic.IComponentCfg cfg, IList<Generic.IComponent> components)
            : base(cfg)
		{
			myCfg = cfg as LevelMeterCfg;

			modbus = (GenericDevices.IModbus)TbfComponents.FindComponent(cfg.ParentName, components);
			if (modbus == null) throw new Exception("Cannot find " + Name + " parent");

			/// Connect to handler
			//ModbusAddress.MeretRS485Address[Idx0] = ModbusAddress;

			log.Warn(this.ToString());
		}

        /// <summary>Initialize this device</summary>
        public void Initialize()
        {
            if (myCfg.DebugLevel == DebugMode.Simulate)
            {
                distance = 200.0;
                level = 0;
                percentage = 0;
                temperature = 20.0;
                state = 0;

                msrmntTimeStamp = StateMachine.Time;
                msrmntState = MsrmntState.Valid;
                return;
            }

            msrmntState = MsrmntState.Busy;

            log.FatalFormat("Successfully initialized device {0}", ToString());
        }


        public double ReadLevel() { return level; }                 /// Returns water level in mm
        public double ReadTemperature() { return temperature; }     /// Returns temperature in °C

        public IOperation ReadLevelOp(ref DoubleBox level) { return new ReadLevelOp(this, ref level); }
        public IOperation ReadStableLevelOp(ref DoubleBox level, double sdev) { return new ReadStableLevelOp(this, ref level, sdev); }
        public IOperation ManualReadLevelOp(ref DoubleBox level) { return null; }
        public IOperation ReadTempOp(ref DoubleBox temperature) { return new ReadTempOp(this, ref temperature); }
        public IOperation ReadTempOp(ref DoubleBox temperature, Event eventDone) { return new ReadTempOp(this, ref temperature, eventDone); }


        /// <summary>Run this device</summary>
        public void RunDeviceBefore()
        {
            if (myCfg.DebugLevel == Config.Entities.DebugMode.Simulate ||
                myCfg.DebugLevel == Config.Entities.DebugMode.FailureDuringOperation)
            {
                msrmntTimeStamp = StateMachine.Time;
                return;
            }

            if (modbus.ReceivedTelegrams[myCfg.ModbusAddress].Count > 0)
			{
				byte[] telegram = modbus.ReceivedTelegrams[myCfg.ModbusAddress].Dequeue();

				if (telegram.Length == 15 && telegram[1] == 3 && telegram[2] == 10)
				{
                    double _distance    = (double)(256 * telegram[3] + telegram[4]);    /// [mm]
                    double _level       = (double)(256 * telegram[5] + telegram[6]);    /// [mm]
                    double _percentage  = (double)(256 * telegram[7] + telegram[8]);    /// [%]
                    double _temperature = (double)(256 * telegram[9] + telegram[10]);   /// [°C]
                    ushort _state       = (ushort)(256 * telegram[11] + telegram[12]);

                    string line = string.Format("dist={0} mm level={1} mm, %={2} %, temp={3} °C, state={4}",
                                                _distance, _level, _percentage, _temperature, _state);
                    if (_distance > 0)
                    {
                        distance    = _distance;
                        level       = _level;
                        percentage  = _percentage;
                        temperature = _temperature;
                        state       = _state;
                    }

                    log.Debug(line);
                    Debug.WriteLine(line);
				}
			}


            byte[] msg = new byte[8];   /// Buffer for data to send

            if ((StateMachine.Time % 3) == 0)           /// Each 3 seconds
            {
                ///
                /// Read distance, level, quantity, percentage and temperature in IEEE754 (DWORD-s)
                /// 
                UInt16 regAddr = 100;
                UInt16 count = 5;

                /// Prepare data to be sent
                msg[0] = myCfg.ModbusAddress;
                msg[1] = 3;                             /// CMD = 
                msg[2] = (byte)(regAddr >> 8);		    /// Control Word Hi
                msg[3] = (byte)(regAddr & 0xFF);	    /// Control Word Lo
                msg[4] = (byte)(count >> 8);		    /// Serial Com Reference Hi
                msg[5] = (byte)(count & 0xFF);		    /// Serial Com Reference Lo

                modbus.SendMessage(msg);
            }
            else if ((StateMachine.Time % 3) == 1)      /// Each 3 seconds
            {
                /////
                ///// Read STATUS1
                ///// 
                //UInt16 regAddr = 104;
                //UInt16 count = 1;

                ///// Prepare data to be sent
                //msg[0] = myCfg.ModbusAddress;
                //msg[1] = 3;                           /// CMD = 
                //msg[2] = (byte)(regAddr >> 8);		/// Control Word Hi
                //msg[3] = (byte)(regAddr & 0xFF);	    /// Control Word Lo
                //msg[4] = (byte)(count >> 8);		    /// Serial Com Reference Hi
                //msg[5] = (byte)(count & 0xFF);		/// Serial Com Reference Lo

                //modbus.SendMessage(msg);
            }
            else if ((StateMachine.Time % 3) == 2)      /// Each 3 seconds
            {
                /////
                ///// Read distance, level, quantity, percentage and temperature in IEEE754 (DWORD-s)
                ///// 
                //UInt16 regAddr = 300;
                //UInt16 count = 10;

                ///// Prepare data to be sent
                //msg[0] = myCfg.ModbusAddress;
                //msg[1] = 3;                             /// CMD = 
                //msg[2] = (byte)(regAddr >> 8);		    /// Control Word Hi
                //msg[3] = (byte)(regAddr & 0xFF);	    /// Control Word Lo
                //msg[4] = (byte)(count >> 8);		    /// Serial Com Reference Hi
                //msg[5] = (byte)(count & 0xFF);		    /// Serial Com Reference Lo

                //modbus.SendMessage(msg);
            }
        }

        public void RunDeviceAfter() { }
		public void StopDevice() { }
		public void StopDevice2() { }
	}
}