Stubs of Hart.Common and Hart.Nivotrack components added.

2018-09-14 12:13:15 +02:00
parent 64646486e9
commit cef8d3ff95
10 changed files with 1065 additions and 1 deletions
@@ -0,0 +1,211 @@
+///
+/// Copyright (c) 2018 Sensus Slovensko a.s.
+///
+using System;
+using System.Collections.Generic;
+using System.Diagnostics;
+using System.Globalization;
+using System.IO.Ports;
+using System.Text;
+using System.Threading;
+using Config.Entities;
+using log4net;
+using TBF.BenchControl.Generic;
+using TBF.Boxes;
+
+namespace TBF.BenchControl.Hart.Common
+{
+    /// <summary>
+	/// Root component for Modbus communication via serial port (RS485)
+	/// </summary>
+	public class Hart : ComponentBase, IDevice, GenericDevices.IModbus
+    {
+		private static readonly ILog log = LogManager.GetLogger(typeof(Hart));
+		public override string ToString() { return string.Format("Modbus({0})", Cfg.ToString(1)); }
+
+		private readonly HartCfg modbusCommonCfg;
+
+		/// Private fields
+		SerialPort serialPort;
+        DateTime lastSerialPortWrite;
+
+		public Queue<byte[]>[] ReceivedTelegrams
+		{
+			get { return receivedTelegrams; }
+		}
+		Queue<byte[]>[] receivedTelegrams;
+
+        Queue<byte[]> telegramsToSend;
+
+		public Hart()
+		{
+		}
+
+		/// <summary>
+		/// Ambient temperature / humidity / pressure meter 'Greco' connected via serial interface (RS232)
+		/// Connection settings: 19200 Bd 8-bits No-parity 1-stop-bit Flow control: none or hardware.
+		/// </summary>
+		public Hart(Generic.IComponentCfg cfg)
+            : base(cfg)
+        {
+			receivedTelegrams = new Queue<byte[]>[256];
+			for (int i = 0; i < receivedTelegrams.Length; i++)
+			{
+				receivedTelegrams[i] = new Queue<byte[]>();
+			}
+            telegramsToSend = new Queue<byte[]>();
+
+			serialPort = null;
+			modbusCommonCfg = cfg as HartCfg;
+			log.Debug(this.ToString());
+		}
+
+		~Hart()
+		{
+		}
+
+		public void Initialize()
+		{
+			if (modbusCommonCfg.DebugLevel == DebugMode.Simulate)
+			{
+				serialPort = null;
+				log.FatalFormat("{0} - Device simulated", Name);
+				return;
+			}
+
+			string comPortName = "COM" + modbusCommonCfg.ComPortNr.ToString();
+			serialPort = new SerialPort(comPortName, modbusCommonCfg.BaudRate, modbusCommonCfg.Parity, modbusCommonCfg.DataBits, modbusCommonCfg.StopBits);
+			serialPort.Handshake = modbusCommonCfg.Handshake;
+			serialPort.Open();
+
+			//stopWorkerThread = false;
+			//workerThread = new Thread(Worker);
+			//workerThread.Start();
+
+            log.FatalFormat("{0} - Device successfully initialized", Name);
+		}
+
+
+		/// <summary>
+		/// Send an arbitrary modbus message.
+		/// When the message length is N, however only bytes 1..N-2 have to be set.
+		/// The last two message bytes (CRC) may be uninitialized or zero.
+		/// They are calculated inside this function as required by Modbus specification.
+		/// </summary>
+		/// <param name="message">Message incl CRC fields, CRC bytes dont have to be set</param>
+		public void SendMessage(byte[] message)
+		{
+			if (serialPort == null) return;
+
+			Telegram.UpdateTelegramCRC(message);
+
+            if ((DateTime.Now - lastSerialPortWrite) > new TimeSpan(0, 0, 0, 0, 100))
+            {
+                /// More then 100 ms since last 'send' --> do not enqueue the message
+                SendMessageNow(message);
+            }
+            else
+            {
+                telegramsToSend.Enqueue(message);
+
+                string s = Telegram.LogTelegram(string.Format("{0} - Enqueueing message ", Name), message);
+                Debug.WriteLine(s);
+                log.Debug(s);
+            }
+        }
+
+
+		/// <summary>
+		/// Send a structured modbus message.
+		/// </summary>
+		/// <param name="modbusAddress">Device address (1..255) or 0 = broadcast</param>
+		/// <param name="function">Function (0..127)</param>
+		/// <param name="dataAddress">Address of data to be transferred (0..65535)</param>
+		/// <param name="dataCount">Count of data bytes to be transferred (0..65535)</param>
+		public void SendMessage(byte modbusAddress, byte function, ushort dataAddress, ushort dataCount)
+		{
+			if (serialPort == null) return;
+
+			byte[] message = new byte[8]
+			{
+				modbusAddress,
+				function,
+				(byte)(dataAddress / 256),
+				(byte)(dataAddress % 256),
+				(byte)(dataCount / 256),
+				(byte)(dataCount % 256),
+				0,
+				0,
+			};
+
+            SendMessage(message);
+        }
+
+        public void SendMessageNow(byte[] message)
+        {
+            serialPort.Write(message, 0, message.Length);
+            lastSerialPortWrite = DateTime.Now;
+
+            string s = Telegram.LogTelegram(string.Format("{0} - Sending message ", Name), message);
+            Debug.WriteLine(s);
+            log.Debug(s);
+        }
+
+
+        /// <summary>Run this device</summary>
+        public void RunDeviceBefore()
+        {
+			if (serialPort == null) return;
+
+			int nrBytes = serialPort.BytesToRead;
+			if (nrBytes > 0)
+			{
+				byte[] buffer = new byte[nrBytes];
+				serialPort.Read(buffer, 0, nrBytes);
+
+				int deviceAddress = (nrBytes >= 1) ? buffer[0] : 0;
+				int function = (nrBytes >= 2) ? buffer[1] : 0;
+
+				if ((nrBytes >= 4) && Telegram.VerifyTelegramCRC(buffer))
+				{
+					receivedTelegrams[deviceAddress].Enqueue(buffer);
+
+					string s = string.Format("{0} - {1} address={2} count={3}", Name, Telegram.LogTelegram("Telegram received: ", buffer), deviceAddress, receivedTelegrams[deviceAddress].Count);
+					Debug.WriteLine(s);
+					log.Debug(s);
+				}
+				else
+				{
+					string s = Telegram.LogTelegram(string.Format("{0} - Invalid data received ", Name), buffer);
+					Debug.WriteLine(s);
+					log.Debug(s);
+				}
+			}
+		}
+
+        /// <summary>Run this device</summary>
+        public void RunDeviceAfter()
+        {
+            if (serialPort == null) return;
+
+            if (telegramsToSend.Count > 0 && (DateTime.Now - lastSerialPortWrite) > new TimeSpan(0, 0, 0, 0, 500))
+            {
+                SendMessageNow(telegramsToSend.Dequeue());
+            }
+        }
+
+        /// <summary>Stop this device</summary>
+        public void StopDevice()
+        {
+			if (serialPort != null)
+			{
+				//stopWorkerThread = true;
+				//workerThread.Join(2000);
+				serialPort.Close();
+				serialPort = null;
+			}
+		}
+
+		public void StopDevice2() { }
+	}
+}