663 lines
24 KiB
C#
663 lines
24 KiB
C#
|
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
|
|||
|
|
}
|
|||
|
|
}
|