SafeDispatch/CPlus_GW/WatcherServerThread.cs

663 lines
24 KiB
C#
Raw Permalink Normal View History

2024-02-22 16:43:59 +00:00
using System;
using System.Collections.Generic;
using System.Text;
using System.Threading;
using System.Net.Sockets;
using System.Net;
using SafeMobileLib;
using System.Linq;
namespace CPlus_GW
{
class WatcherServerThread
{
private TcpClient client;
private IPEndPoint serverEndPoint;
private Thread listenThread;
private NetworkStream clientStream;
private UdpMulticast udpMulticast;
byte[] message;
private string ctrIP;
private int port;
string gwID;
string report;
int totalUsers;
private bool isRunning = false;
public WatcherServerThread(string ctrlIP, int port, string p_gwID, string p_report)
{
try
{
SafeMobileLib.Utils.WriteLine("WatcherServerThread Constructor");
message = new byte[128];
ctrIP = ctrlIP;
this.port = port;
totalUsers = 0;
gwID = p_gwID;
report = p_report;
client = new TcpClient();
serverEndPoint = new IPEndPoint(IPAddress.Parse(ctrIP), port);
client.Connect(serverEndPoint);
SafeMobileLib.Utils.WriteLine("TCP WatcherServerThread connected on " + port, ConsoleColor.Cyan);
CPlusGW.TextQueue.PostItem("WatcherServerThread connected on " + port);
clientStream = client.GetStream();
//set read timeout to 35 seconds, according to Motorola Connect Plus PN_Watcher specifications
clientStream.ReadTimeout = 35000;
//CPlusGW.status = true;
}
catch (Exception ex)
{
SM.Debug(ex.ToString());
}
}
public void Stop()
{
isRunning = false;
if (clientStream != null)
{
clientStream.Close();
}
if (listenThread.IsAlive)
{
listenThread.Abort();
}
}
public void Start()
{
isRunning = true;
try
{
udpMulticast = new UdpMulticast(Program.cfg.multi_IP, Program.cfg.multi_port);
//udpMulticast.OnNewDataRecv += new UdpMulticast.newData4Send(udpMulticast_OnNewDataRecv);
SafeMobileLib.Utils.WriteLine("WatcherServerThread successfully registered to multicast group");
//udpMulticast.StartListen();
}
catch (Exception ex)
{
SafeMobileLib.Utils.WriteLine("WatcherServerThread exception while joining the multicast group: " + ex.ToString(), ConsoleColor.Red);
}
listenThread = new Thread(new ThreadStart(HandleClientComm));
listenThread.IsBackground = true;
listenThread.Start();
SafeMobileLib.Utils.WriteLine("============WatcherServerThread Listenning=====================================");
}
public void RestartTCP()
{
try
{
SafeMobileLib.Utils.WriteLine($"Reconnecting to controller ip:{ctrIP} port:{port}");
if (client != null)
{
if (client.Connected)
client.Close();
}
client = new TcpClient();
serverEndPoint = new IPEndPoint(IPAddress.Parse(ctrIP), port);
client.Connect(serverEndPoint);
SafeMobileLib.Utils.WriteLine("WatcherServerThread connected on " + port);
clientStream = client.GetStream();
//set read timeout to 35 seconds, according to Motorola Connect Plus PN_Watcher specifications
clientStream.ReadTimeout = 35000;
//resend subscribe all
Thread.Sleep(100);
SubscribeALL(1234);
}
catch (Exception ex)
{
SafeMobileLib.Utils.WriteLine("Restart FAILED!!!! " + ex.Message);
}
}
bool connDown = false;
private void HandleClientComm()
{
while (isRunning)
{
try
{
//Console.WriteLine("Waiting for stuff...");
//read LEN first
byte[] msgLen = new byte[2];
int result = clientStream.Read(msgLen, 0, msgLen.Length);
int msgLength = msgLen[0] * 265 + msgLen[1];
message = new byte[msgLength];
result = clientStream.Read(message, 0, msgLength);
//Console.Write(DateTime.Now + "-> ");
//if we got PING send Pong
if (message[0] == 0xff)
{
//Print(message, result, true, "PING");
SafeMobileLib.Utils.WriteLine("PING received");
CPlusGW.TextQueue.PostItem("PING received.");
PONG();
}
else
{
//Print(message, result, true);
NotifyRespons resp = Decode(message, result);
int reportingInterval = 60;
Int32.TryParse(report, out reportingInterval);
Vehicles veh = MainForm.vehicles.FirstOrDefault(d => d.Imei.Equals(resp.SUID));
if (veh == null)
{
SafeMobileLib.Utils.WriteLine($"Units {resp.SUID} not defined in the admin", ConsoleColor.White);
Thread.Sleep(100);
continue;
}
else if (!veh.Active)
{
SafeMobileLib.Utils.WriteLine($"Units {resp.SUID} not defined in the admin", ConsoleColor.White);
Thread.Sleep(100);
continue;
}
else
reportingInterval = veh.GpsInterval;
if (resp.Active)
{
totalUsers++;
//SM.Debug("SU " + resp.SUID + " ON ### Total users: " + totalUsers);
//CPlusGW.TextQueue.PostItem("Unit " + resp.SUID + " ON");
MotoTRBOcmdMsg msg = new MotoTRBOcmdMsg();
msg.m_cmd = (byte)MotoTRBOcmd.SET_REPORT_INTERVAL;
msg.m_suid = resp.SUID;
msg.m_payload = reportingInterval+"";
CPlusGW.locationQueue.PostItem(msg);
SendARSOnMultiCast(resp.SUID, true);
//send sms reg msq
SendSMSThread.Send_Reg_msg(resp.SUID + ".1");
}
else
{
totalUsers++;
SendARSOnMultiCast(resp.SUID, false);
//SM.Debug("SU " + resp.SUID + " OFF ### Total users: " + totalUsers);
//CPlusGW.TextQueue.PostItem("Unit " + resp.SUID + " OFF");
}
String consoleMessage = "ARS " + (resp.Active ? "ON" : "OFF") + " for " + resp.SUID;
SafeMobileLib.Utils.WriteLine("»»» " + consoleMessage, ConsoleColor.Green);
CPlusGW.TextQueue.PostItem(consoleMessage);
}
}
catch (ThreadAbortException tex)
{
SafeMobileLib.Utils.WriteLine("Watch server thread closed!!!", ConsoleColor.Red);
}
catch (Exception ex)
{
SafeMobileLib.Utils.WriteLine(ex.ToString(), ConsoleColor.Red);
int count = 0;
while(count < 300)
{
if (!isRunning)
break;
count++;
Thread.Sleep(100);
}
connDown = true;
}
try
{
if (connDown)
{
RestartTCP();
connDown = false;
Thread.Sleep(1000);
}
}
catch (Exception ex)
{
Console.WriteLine(ex.ToString());
connDown = true;
}
Thread.Sleep(100);
}
}
private void SendARSOnMultiCast(string SUID, bool onOff)
{
//send ARS ON
string seqID = "0.0";
string test = "#130#" + SUID + "#" +((onOff)?"ON#":"OFF#");
String cmdok = "#" + seqID + test; Int32 tmp = cmdok.Length + 1; tmp += tmp.ToString().Length; cmdok = "#" + tmp.ToString() + cmdok;
System.Text.Encoding enc = System.Text.Encoding.ASCII;
byte[] buf = enc.GetBytes(cmdok);
//send to messagebus
udpMulticast.Send(buf, buf.Length);
//SM.Debug("TX:" + cmdok);
if (onOff)//send system location just on "ON"
{
//send Subscriber system location
seqID = "0.0";
//build string
string fullSource = Program.cfg.gatewayID.ToString() + "#1#" + SUID;//Main.GWID.ToString() + "#" + trboRemoteIP + "#" + suid;
test = "#139#" + fullSource + "#";
cmdok = "#" + seqID + test; tmp = cmdok.Length + 1; tmp += tmp.ToString().Length; cmdok = "#" + tmp.ToString() + cmdok;
enc = System.Text.Encoding.ASCII;
byte[] buf2 = enc.GetBytes(cmdok);
//send to messagebus
udpMulticast.Send(buf2, buf2.Length);
//SM.Debug("TX:" + cmdok);
}
}
public delegate void MessageRecv(NotifyRespons resp);
public event MessageRecv OnMessageRecv;
private NotifyRespons Decode(byte[] data, int recv)
{
//Console.WriteLine("Got notify message");
NotifyRespons nResp = new NotifyRespons();
nResp.Active = false; nResp.DialogID = 0; nResp.Error = true; nResp.SUID = "0";
//int msgLength = data[0] * 265 + data[1];
//length doesent match... return error
//if (msgLength != recv-2) { Console.WriteLine("Received length({0}) doesent match with message length({1})..returning errror!!!",recv-2,msgLength); return nResp; }
//test if we got at least msgLen, msgID,dialogID,subscription state
if (recv < 6)
{
SafeMobileLib.Utils.WriteLine("Incorect message.Message does not have the minimum size of 6bytes. actual length=" + recv);
SafeMobileLib.Utils.WriteLine("!!!!!!!!!!!!subscription state TLV missing!!!!!!!!!!!");
return nResp;
}
//decode message ID
int msgID = data[0];
if (msgID != 4)
{
SafeMobileLib.Utils.WriteLine($"Incorect msgID:{msgID}. MsgID must be 4(reliable notify message)");
return nResp;
}
//decode dialog ID
int dialogID = data[1] * 256 + data[2];
nResp.DialogID = dialogID;
//Console.WriteLine("DialogID:" + dialogID);
//next TLV are optional
for (int i = 3; i < data.Length; i++)
{
switch (data[i])
{
case 3:
//decode subscription state TLV
byte tag = data[i];
byte len = data[i + 1];
byte value = data[i + 2];
if (tag == 0x03 && len == 0x01)
{
switch (value)
{
case (byte)SubscriptionState.Accepted:
//Console.WriteLine("Subscription State:" + SubscriptionState.Accepted + " value:" + value);
break;
case (byte)SubscriptionState.RefreshAccepted:
//Console.WriteLine("Subscription State:" + SubscriptionState.RefreshAccepted + " value:" + value);
break;
case (byte)SubscriptionState.Rejected:
//Console.WriteLine("Subscription State:" + SubscriptionState.Rejected + " value:" + value);
break;
case (byte)SubscriptionState.Terminated:
//Console.WriteLine("Subscription State:" + SubscriptionState.Terminated + " value:" + value);
break;
}
}
else
{
SafeMobileLib.Utils.WriteLine("Unknown subscription state:" + value);
}
//jump to next tlv
i += 1 + len;
break;
//decode Expires TLV
case 1:
tag = data[i];
len = data[i + 1];
byte[] value_arr = new byte[len];
Array.Copy(data, i + 2, value_arr, 0, len);
int expireTime = ConvertByteArr2Int(value_arr);
//Console.WriteLine("Expire time:" + expireTime);
//jump to next tlv
i += 1 + len;
break;
//Decode Entity TLV
case 10:
tag = data[i];
len = data[i + 1];
value_arr = new byte[len];
Array.Copy(data, i + 2, value_arr, 0, len);
string suid = Encoding.Unicode.GetString(value_arr);
nResp.SUID = suid;
//Console.WriteLine("Entity(SUID):" + suid);
//jump to next tlv
i += 1 + len;
nResp.Error = false;
break;
//Decode Event TLV ... "1" - Present, "2" - Absent
case 2:
tag = data[i];
len = data[i + 1];
value_arr = new byte[len];
Array.Copy(data, i + 2, value_arr, 0, len);
string event_string = Encoding.Unicode.GetString(value_arr);
//nResp.Active = (event_string == "1");
//Console.WriteLine("Event TLV:" + event_string);
//jump to next tlv
i += 1 + len;
break;
case 14:
tag = data[i];
len = data[i + 1];
value_arr = new byte[len];
Array.Copy(data, i + 2, value_arr, 0, len);
string presence = Encoding.Unicode.GetString(value_arr);
switch (presence)
{
case "0":
//Console.WriteLine("Presence state TLV: unknown value:" + presence);
break;
case "1":
nResp.Active = true;
//Console.WriteLine("Presence state TLV: present value:" + presence);
break;
case "2":
nResp.Active = false;
//Console.WriteLine("Presence state TLV: absent value:" + presence);
break;
}
//jump to next tlv
i += 1 + len;
break;
}
}
return nResp;
}
public void Send(byte[] data, int len)
{
if (clientStream != null)
{
clientStream.Write(data, 0, len);
clientStream.Flush();
}
}
#region Subscribe messages and PONG message
/// <summary>
/// Send the subcribe message to the controler
/// </summary>
/// <param name="dialogID">unique dialog ID</param>
/// <param name="ID">ID of radio subscriber that is being watched</param>
/// <param name="expiresTime">time to live of the subscription</param>
public void Subscribe(int dialogID, int ID, byte expiresTime)
{
byte[] tempID = convertInt2ByteLE(ID);
byte[] msg = new byte[18 + tempID.Length];
//length
msg[0] = 0x00;
msg[1] = Convert.ToByte(0x10 + tempID.Length);
// message ID
msg[2] = 0x03;
// Dialog ID
byte[] tempDialogID = BitConverter.GetBytes(dialogID);
msg[3] = tempDialogID[1];
msg[4] = tempDialogID[0];
//Message BODY
//The Expires TLV Field
msg[5] = 0x01;
msg[6] = 0x01;
msg[7] = expiresTime;
//The TCPPort TLV Field
msg[8] = 0x06;
msg[9] = 0x02;
byte[] tempPort = BitConverter.GetBytes(0x3344);
msg[10] = tempPort[1];
msg[11] = tempPort[0];
//The Entities TLV Field
msg[12] = 0x0a;
msg[13] = Convert.ToByte(tempID.Length);
// ID
for (int i = 0; i < tempID.Length; i++)
{
msg[14 + i] = tempID[i];
}
//The Events TLV Field
msg[14 + tempID.Length] = 0x02;
msg[14 + tempID.Length + 1] = 0x02;
msg[14 + tempID.Length + 2] = 0x31;
msg[14 + tempID.Length + 3] = 0x00;
Send(msg, msg.Length);
//Console.WriteLine("-----------Sent Subscribe to the controller-----");
//Print(msg, msg.Length, false);
}
public void SubscribeALL(int dialogID)
{
byte[] msg = new byte[17];
//length
msg[0] = 0x00;
msg[1] = 0x0f;
// message ID
msg[2] = 0x03;
// Dialog ID
byte[] tempDialogID = BitConverter.GetBytes(dialogID);
msg[3] = tempDialogID[1];
msg[4] = tempDialogID[0];
//Message BODY
//The Entities TLV Field
msg[5] = 0x0a;
msg[6] = 0x02;
// ID:all
msg[7] = 0x2a;
msg[8] = 0x00;
//The Events TLV Field
msg[9] = 0x02;
msg[10] = 0x06;
msg[11] = (byte)'1';
msg[12] = 0x00;
msg[13] = (byte)',';
msg[14] = 0x00;
msg[15] = (byte)'2';
msg[16] = 0x00;
Send(msg, msg.Length);
//Console.WriteLine("-----------Sent Subscribe ALL to the controller-----");
//Print(msg, msg.Length, false);
}
public void SubscribeALL()
{
byte[] msg = new byte[20];
//length
msg[0] = 0x00;
msg[1] = 0x12;
// message ID
msg[2] = 0x03;
// Dialog ID
msg[3] = 0x33;
msg[4] = 0x44;
//Message BODY
//The Expires TLV Field
msg[5] = 0x01;
msg[6] = 0x01;
msg[7] = 0xff;
//The TCPPort TLV Field
msg[8] = 0x06;
msg[9] = 0x02;
byte[] temp = BitConverter.GetBytes(0x3344);
msg[10] = temp[1];
msg[11] = temp[0];
//The Entities TLV Field
msg[12] = 0x0a;
msg[13] = 0x02;
// ID:all
msg[14] = 0x2a;
msg[15] = 0x00;
//The Events TLV Field
msg[16] = 0x02;
msg[17] = 0x02;
msg[18] = 0x2a;
msg[19] = 0x00;
Send(msg, msg.Length);
SafeMobileLib.Utils.WriteLine("-----------Sent Subscribe to the controller-----");
//Print(msg, msg.Length, false);
}
//send PONG back to controller
public void PONG()
{
byte[] msg = new byte[12];
//length
msg[0] = 0x00;
msg[1] = 0x0a;
// message ID
msg[2] = 0xff;
// body length
msg[3] = 0x08;
//PONG -utf16 LE string
//P
msg[4] = 0x50;
msg[5] = 0x00;
//O
msg[6] = 0x4f;
msg[7] = 0x00;
//N
msg[8] = 0x4e;
msg[9] = 0x00;
//G
msg[10] = 0x47;
msg[11] = 0x00;
Send(msg, msg.Length);
//Console.WriteLine("-----------Sent PONG to the controller-----");
//Print(msg, msg.Length, false, "PONG:");
}
#endregion
#region AUX methods
private void Print(byte[] data, int length, bool inOut)
{
//Console.Clear();
Console.WriteLine("--------------------------------------------------------------------------- " + length);
Console.Write("Data (" + ((inOut) ? "RECEIVED" : "SENT") + "): ");
for (int i = 0; i < length; i++)
Console.Write(" 0x" + data[i].ToString("X2"));
Console.WriteLine("");
Console.WriteLine("--------------------------------------------------------------------------- ");
}
private void Print(byte[] data, int length, bool inOut, string txt)
{
if (Program.cfg.ping)
{
//Console.Clear();
Console.WriteLine("--------------------------------------------------------------------------- " + length);
Console.Write(txt + " (" + ((inOut) ? "RECEIVED" : "SENT") + "): ");
for (int i = 0; i < length; i++)
Console.Write(" 0x" + data[i].ToString("X2"));
Console.WriteLine("");
Console.WriteLine("--------------------------------------------------------------------------- ");
}
}
private static byte[] convertInt2ByteLE(int id)
{
Byte[] retBytes = Encoding.Unicode.GetBytes(id.ToString());
return retBytes;
}
private int ConvertByteArr2Int(byte[] arr)
{
byte[] worker = new byte[4];
arr.CopyTo(worker, 0);
return BitConverter.ToInt32(worker, 0);
}
#endregion
}
public class NotifyRespons
{
private string suid;
public string SUID
{
get { return suid; }
set { suid = value; }
}
private bool active;
public bool Active
{
get { return active; }
set { active = value; }
}
private int dialogID;
public int DialogID
{
get { return dialogID; }
set { dialogID = value; }
}
private bool error;
public bool Error
{
get { return error; }
set { error = value; }
}
}
public enum SubscriptionState
{
Rejected = 1,
Accepted = 2,
Terminated = 3,
RefreshAccepted = 4
}
}