diff --git a/Client/Client.cs b/Client/Client.cs index 123d222..1a3392a 100644 --- a/Client/Client.cs +++ b/Client/Client.cs @@ -14,6 +14,9 @@ namespace Client private bool connected; private byte[] totalBuffer = new byte[1024]; private int totalBufferReceived = 0; + private EngineConnection engineConnection; + private bool sessionRunning = false; + private IHandler handler = null; public Client() : this("localhost", 5555) @@ -28,10 +31,26 @@ namespace Client client.BeginConnect(adress, port, new AsyncCallback(OnConnect), null); } + private void initEngine() + { + engineConnection = EngineConnection.INSTANCE; + engineConnection.OnNoTunnelId = retryEngineConnection; + if (!engineConnection.Connected) engineConnection.Connect(); + } + + private void retryEngineConnection() + { + Console.WriteLine("-- Could not connect to the VR engine. Please make sure you are running the simulation!"); + Console.WriteLine("-- Press any key to retry connecting to the VR engine."); + Console.ReadKey(); + + engineConnection.CreateConnection(); + } + private void OnConnect(IAsyncResult ar) { this.client.EndConnect(ar); - Console.WriteLine("Verbonden!"); + Console.WriteLine("TCP client Verbonden!"); this.stream = this.client.GetStream(); @@ -75,6 +94,7 @@ namespace Client if (responseStatus == "OK") { this.connected = true; + initEngine(); } else { @@ -82,6 +102,26 @@ namespace Client tryLogin(); } break; + case DataParser.START_SESSION: + this.sessionRunning = true; + sendMessage(DataParser.getStartSessionJson()); + break; + case DataParser.STOP_SESSION: + this.sessionRunning = false; + sendMessage(DataParser.getStopSessionJson()); + break; + case DataParser.SET_RESISTANCE: + if (this.handler == null) + { + Console.WriteLine("handler is null"); + sendMessage(DataParser.getSetResistanceResponseJson(false)); + } + else + { + this.handler.setResistance(DataParser.getResistanceFromJson(payloadbytes)); + sendMessage(DataParser.getSetResistanceResponseJson(true)); + } + break; default: Console.WriteLine($"Received json with identifier {identifier}:\n{Encoding.ASCII.GetString(payloadbytes)}"); break; @@ -100,6 +140,11 @@ namespace Client } + private void sendMessage(byte[] message) + { + stream.BeginWrite(message, 0, message.Length, new AsyncCallback(OnWrite), null); + } + private void OnWrite(IAsyncResult ar) { this.stream.EndWrite(ar); @@ -109,6 +154,10 @@ namespace Client //maybe move this to other place public void BPM(byte[] bytes) { + if (!sessionRunning) + { + return; + } if (bytes == null) { throw new ArgumentNullException("no bytes"); @@ -119,6 +168,10 @@ namespace Client public void Bike(byte[] bytes) { + if (!sessionRunning) + { + return; + } if (bytes == null) { throw new ArgumentNullException("no bytes"); @@ -141,9 +194,18 @@ namespace Client Console.WriteLine("enter password"); string password = Console.ReadLine(); - byte[] message = DataParser.getJsonMessage(DataParser.GetLoginJson(username, password)); + string hashUser = Hashing.Hasher.HashString(username); + string hashPassword = Hashing.Hasher.HashString(password); + byte[] message = DataParser.getJsonMessage(DataParser.GetLoginJson(hashUser, hashPassword)); + + this.stream.BeginWrite(message, 0, message.Length, new AsyncCallback(OnWrite), null); } + + public void setHandler(IHandler handler) + { + this.handler = handler; + } } } diff --git a/Client/Client.csproj b/Client/Client.csproj index dd9af6e..6aa0290 100644 --- a/Client/Client.csproj +++ b/Client/Client.csproj @@ -12,6 +12,9 @@ + + + diff --git a/Client/DataParser.cs b/Client/DataParser.cs index c83b86a..8eddb4c 100644 --- a/Client/DataParser.cs +++ b/Client/DataParser.cs @@ -3,6 +3,7 @@ using Newtonsoft.Json.Serialization; using System; using System.Globalization; using System.Linq; +using System.Runtime.InteropServices.WindowsRuntime; using System.Text; namespace Client @@ -10,7 +11,10 @@ namespace Client public class DataParser { public const string LOGIN = "LOGIN"; - public const string LOGIN_RESPONSE = "LOGIN_RESPONSE"; + public const string LOGIN_RESPONSE = "LOGIN RESPONSE"; + public const string START_SESSION = "START SESSION"; + public const string STOP_SESSION = "STOP SESSION"; + public const string SET_RESISTANCE = "SET RESISTANCE"; /// /// makes the json object with LOGIN identifier and username and password /// @@ -59,6 +63,15 @@ namespace Client return getMessage(Encoding.ASCII.GetBytes(JsonConvert.SerializeObject(json)), 0x01); } + private static byte[] getJsonMessage(string mIdentifier) + { + dynamic json = new + { + identifier = mIdentifier, + }; + return getMessage(Encoding.ASCII.GetBytes(JsonConvert.SerializeObject(json)), 0x01); + } + public static byte[] getLoginResponse(string mStatus) { return getJsonMessage(LOGIN_RESPONSE, new { status = mStatus }); @@ -150,15 +163,42 @@ namespace Client return getMessage(payload, 0x01); } - /// - /// constructs a message with the message and clientId - /// - /// - /// - /// the message ready for sending - public static byte[] getJsonMessage(string message) + public static byte[] getStartSessionJson() { - return getJsonMessage(Encoding.ASCII.GetBytes(message)); + return getJsonMessage(START_SESSION); + } + + public static byte[] getStopSessionJson() + { + return getJsonMessage(STOP_SESSION); + } + + public static byte[] getSetResistanceJson(float mResistance) + { + dynamic data = new + { + resistance = mResistance + }; + return getJsonMessage(SET_RESISTANCE, data); + } + + public static byte[] getSetResistanceResponseJson(bool mWorked) + { + dynamic data = new + { + worked = mWorked + }; + return getJsonMessage(SET_RESISTANCE, data); + } + + public static float getResistanceFromJson(byte[] json) + { + return ((dynamic)JsonConvert.DeserializeObject(Encoding.ASCII.GetString(json))).data.resistance; + } + + public static bool getResistanceFromResponseJson(byte[] json) + { + return ((dynamic)JsonConvert.DeserializeObject(Encoding.ASCII.GetString(json))).data.worked; } diff --git a/Client/EngineConnection.cs b/Client/EngineConnection.cs new file mode 100644 index 0000000..4905911 --- /dev/null +++ b/Client/EngineConnection.cs @@ -0,0 +1,180 @@ +using System; +using System.Collections.Generic; +using System.Text; +using RH_Engine; +using System.Net.Sockets; + +namespace Client +{ + public delegate void HandleSerial(string message); + public delegate void HandleNoTunnelId(); + + public sealed class EngineConnection + { + private static EngineConnection instance = null; + private static readonly object padlock = new object(); + public HandleNoTunnelId OnNoTunnelId; + + + private static PC[] PCs = { + //new PC("DESKTOP-M2CIH87", "Fabian"), + //new PC("T470S", "Shinichi"), + //new PC("DESKTOP-DHS478C", "semme"), + new PC("HP-ZBOOK-SEM", "Sem") + //new PC("DESKTOP-TV73FKO", "Wouter"), + //new PC("DESKTOP-SINMKT1", "Ralf van Aert"), + //new PC("NA", "Bart") + }; + + private static ServerResponseReader serverResponseReader; + private static string sessionId = string.Empty; + private static string tunnelId = string.Empty; + private static string routeId = string.Empty; + private static string panelId = string.Empty; + private static string bikeId = string.Empty; + + private static NetworkStream stream; + + private static Dictionary serialResponses = new Dictionary(); + private Command mainCommand; + + public bool Connected = false; + + EngineConnection() + { + + } + + public static EngineConnection INSTANCE + { + get + { + lock (padlock) + { + if (instance == null) + { + instance = new EngineConnection(); + } + } + return instance; + } + } + + public void Connect() + { + TcpClient client = new TcpClient("145.48.6.10", 6666); + stream = client.GetStream(); + initReader(); + CreateConnection(); + } + + /// + /// connects to the server and creates the tunnel + /// + /// the network stream to use + public void CreateConnection() + { + + WriteTextMessage( "{\r\n\"id\" : \"session/list\",\r\n\"serial\" : \"list\"\r\n}"); + + // wait until we have got a sessionId + while (sessionId == string.Empty) { } + + string tunnelCreate = "{\"id\" : \"tunnel/create\", \"data\" : {\"session\" : \"" + sessionId + "\"}}"; + + WriteTextMessage(tunnelCreate); + + // wait until we have a tunnel id + while (tunnelId == string.Empty) { } + if (tunnelId != null) + { + Write("got tunnel id! " + tunnelId); + } + mainCommand = new Command(tunnelId); + + } + /// + /// initializes and starts the reading of the responses from the vr server + /// + /// the networkstream + private void initReader() + { + serverResponseReader = new ServerResponseReader(stream); + serverResponseReader.callback = HandleResponse; + serverResponseReader.StartRead(); + Connected = true; + } + + /// + /// callback method that handles responses from the server + /// + /// the response message from the server + public void HandleResponse(string message) + { + string id = JSONParser.GetID(message); + + // because the first messages don't have a serial, we need to check on the id + if (id == "session/list") + { + sessionId = JSONParser.GetSessionID(message, PCs); + } + else if (id == "tunnel/create") + { + tunnelId = JSONParser.GetTunnelID(message); + if (tunnelId == null) + { + Write("could not find a valid tunnel id!"); + OnNoTunnelId?.Invoke(); + Connected = false; + return; + } + } + + if (message.Contains("serial")) + { + //Console.WriteLine("GOT MESSAGE WITH SERIAL: " + message + "\n\n\n"); + string serial = JSONParser.GetSerial(message); + //Console.WriteLine("Got serial " + serial); + if (serialResponses.ContainsKey(serial)) serialResponses[serial].Invoke(message); + } + } + + /// + /// method that sends the speciefied message with the specified serial, and executes the given action upon receivind a reply from the server with this serial. + /// + /// the networkstream to use + /// the message to send + /// the serial to check for + /// the code to be executed upon reveiving a reply from the server with the specified serial + public void SendMessageAndOnResponse(string message, string serial, HandleSerial action) + { + serialResponses.Add(serial, action); + WriteTextMessage(message); + } + + /// + /// writes a message to the server + /// + /// the network stream to use + /// the message to send + public void WriteTextMessage(string message) + { + byte[] msg = Encoding.ASCII.GetBytes(message); + byte[] res = new byte[msg.Length + 4]; + + Array.Copy(BitConverter.GetBytes(msg.Length), 0, res, 0, 4); + Array.Copy(msg, 0, res, 4, msg.Length); + + stream.Write(res); + + //Write("sent message " + message); + } + public void Write(string msg) + { + Console.WriteLine( "[ENGINECONNECT] " + msg); + } + + } + + +} diff --git a/Client/Program.cs b/Client/Program.cs index 7b722f5..89ed605 100644 --- a/Client/Program.cs +++ b/Client/Program.cs @@ -1,6 +1,9 @@ using System; using Hardware; using Hardware.Simulators; +using RH_Engine; +using System.Security.Cryptography; +using System.Text; namespace Client { @@ -11,7 +14,6 @@ namespace Client Console.WriteLine("Hello World!"); //connect fiets? - Client client = new Client(); @@ -19,13 +21,18 @@ namespace Client { } - //BLEHandler bLEHandler = new BLEHandler(client); + BLEHandler bLEHandler = new BLEHandler(client); - //bLEHandler.Connect(); + bLEHandler.Connect(); - BikeSimulator bikeSimulator = new BikeSimulator(client); + client.setHandler(bLEHandler); - bikeSimulator.StartSimulation(); + + //BikeSimulator bikeSimulator = new BikeSimulator(client); + + //bikeSimulator.StartSimulation(); + + //client.setHandler(bikeSimulator); while (true) { diff --git a/Hashing/Hasher.cs b/Hashing/Hasher.cs new file mode 100644 index 0000000..270faa3 --- /dev/null +++ b/Hashing/Hasher.cs @@ -0,0 +1,27 @@ +using System; +using System.Collections.Generic; +using System.Security.Cryptography; +using System.Text; + +namespace Hashing +{ + class Hasher + { + public static byte[] GetHash(string input) + { + using (HashAlgorithm algorithm = SHA256.Create()) + { + return algorithm.ComputeHash(Encoding.UTF8.GetBytes(input)); + } + } + + public static string HashString(string input) + { + StringBuilder sb = new StringBuilder(); + foreach (byte b in GetHash(input)) { + sb.Append(b.ToString("X2")); + } + return sb.ToString(); + } + } +} diff --git a/Hashing/Hashing.projitems b/Hashing/Hashing.projitems new file mode 100644 index 0000000..127b36a --- /dev/null +++ b/Hashing/Hashing.projitems @@ -0,0 +1,14 @@ + + + + $(MSBuildAllProjects);$(MSBuildThisFileFullPath) + true + 70277749-d423-4871-b692-2efc5a6ed932 + + + Hashing + + + + + \ No newline at end of file diff --git a/Hashing/Hashing.shproj b/Hashing/Hashing.shproj new file mode 100644 index 0000000..e427bd6 --- /dev/null +++ b/Hashing/Hashing.shproj @@ -0,0 +1,13 @@ + + + + 70277749-d423-4871-b692-2efc5a6ed932 + 14.0 + + + + + + + + diff --git a/ProftaakRH/BLEHandler.cs b/ProftaakRH/BLEHandler.cs index 6baf843..269b0a1 100644 --- a/ProftaakRH/BLEHandler.cs +++ b/ProftaakRH/BLEHandler.cs @@ -11,7 +11,7 @@ namespace Hardware /// /// BLEHandler class that handles connection and traffic to and from the bike /// - public class BLEHandler + public class BLEHandler : IHandler { List dataReceivers; private BLE bleBike; @@ -25,11 +25,13 @@ namespace Hardware public BLEHandler(IDataReceiver dataReceiver) { this.dataReceivers = new List { dataReceiver }; + } public BLEHandler(List dataReceivers) { this.dataReceivers = dataReceivers; + } public void addDataReceiver(IDataReceiver dataReceiver) @@ -43,6 +45,7 @@ namespace Hardware public void Connect() { BLE bleBike = new BLE(); + Thread.Sleep(1000); // We need some time to list available devices // List available devices @@ -170,6 +173,11 @@ namespace Hardware /// The precentage of resistance to set public void setResistance(float percentage) { + if (!this.Running) + { + Console.WriteLine("BLE is not running"); + return; + } byte[] antMessage = new byte[13]; antMessage[0] = 0x4A; antMessage[1] = 0x09; diff --git a/ProftaakRH/BikeSimulator.cs b/ProftaakRH/BikeSimulator.cs index daea355..3d11209 100644 --- a/ProftaakRH/BikeSimulator.cs +++ b/ProftaakRH/BikeSimulator.cs @@ -98,32 +98,7 @@ namespace Hardware.Simulators return hartByte; } - //Generate an ANT message for resistance - public byte[] GenerateResistance(float percentage) - { - byte[] antMessage = new byte[13]; - antMessage[0] = 0x4A; - antMessage[1] = 0x09; - antMessage[2] = 0x4E; - antMessage[3] = 0x05; - antMessage[4] = 0x30; - for (int i = 5; i < 11; i++) - { - antMessage[i] = 0xFF; - } - antMessage[11] = (byte)Math.Max(Math.Min(Math.Round(percentage / 0.5), 255), 0); - //antMessage[11] = 50; //hardcoded for testing - byte checksum = 0; - for (int i = 0; i < 12; i++) - { - checksum ^= antMessage[i]; - } - - antMessage[12] = checksum;//reminder that i am dumb :P - - return antMessage; - } //Calculates the needed variables //Input perlin value @@ -143,20 +118,11 @@ namespace Hardware.Simulators } //Set resistance in simulated bike - public void setResistance(byte[] bytes) + public void setResistance(float percentage) { - //TODO check if message is correct - if (bytes.Length == 13) - { - this.resistance = Convert.ToDouble(bytes[11]) / 2; - } + this.resistance = (byte)Math.Max(Math.Min(Math.Round(percentage / 0.5), 255), 0); } - } - - //Interface for receiving a message on the simulated bike - interface IHandler - { - void setResistance(byte[] bytes); } + } diff --git a/ProftaakRH/IHandler.cs b/ProftaakRH/IHandler.cs new file mode 100644 index 0000000..4f52042 --- /dev/null +++ b/ProftaakRH/IHandler.cs @@ -0,0 +1,11 @@ +using System; +using System.Collections.Generic; +using System.Text; + +namespace ProftaakRH +{ + public interface IHandler + { + void setResistance(float percentage); + } +} diff --git a/ProftaakRH/Main.cs b/ProftaakRH/Main.cs index 5ffcab4..41780f0 100644 --- a/ProftaakRH/Main.cs +++ b/ProftaakRH/Main.cs @@ -14,7 +14,7 @@ namespace ProftaakRH IDataReceiver dataReceiver = new DataConverter(); BLEHandler bLEHandler = new BLEHandler(dataReceiver); BikeSimulator bikeSimulator = new BikeSimulator(dataReceiver); - bikeSimulator.setResistance(bikeSimulator.GenerateResistance(1f)); + bikeSimulator.setResistance(1); bikeSimulator.StartSimulation(); diff --git a/ProftaakRH/ProftaakRH.sln b/ProftaakRH/ProftaakRH.sln index 5d13d46..f05bff3 100644 --- a/ProftaakRH/ProftaakRH.sln +++ b/ProftaakRH/ProftaakRH.sln @@ -15,7 +15,14 @@ Project("{9A19103F-16F7-4668-BE54-9A1E7A4F7556}") = "Message", "..\Message\Messa EndProject Project("{9A19103F-16F7-4668-BE54-9A1E7A4F7556}") = "DokterApp", "..\DokterApp\DokterApp.csproj", "{B150F08B-13DA-4D17-BD96-7E89F52727C6}" EndProject +Project("{D954291E-2A0B-460D-934E-DC6B0785DB48}") = "Hashing", "..\Hashing\Hashing.shproj", "{70277749-D423-4871-B692-2EFC5A6ED932}" +EndProject Global + GlobalSection(SharedMSBuildProjectFiles) = preSolution + ..\Hashing\Hashing.projitems*{5759dd20-7a4f-4d8d-b986-a70a7818c112}*SharedItemsImports = 5 + ..\Hashing\Hashing.projitems*{70277749-d423-4871-b692-2efc5a6ed932}*SharedItemsImports = 13 + ..\Hashing\Hashing.projitems*{b1ab6f51-a20d-4162-9a7f-b3350b7510fd}*SharedItemsImports = 5 + EndGlobalSection GlobalSection(SolutionConfigurationPlatforms) = preSolution Debug|Any CPU = Debug|Any CPU Release|Any CPU = Release|Any CPU diff --git a/RH-Engine/Command.cs b/RH-Engine/Command.cs index 3ef3bc1..110965f 100644 --- a/RH-Engine/Command.cs +++ b/RH-Engine/Command.cs @@ -4,7 +4,7 @@ using System; namespace RH_Engine { - class Command + public class Command { public const string STANDARD_HEAD = "Head"; public const string STANDARD_GROUND = "GroundPlane"; @@ -83,11 +83,12 @@ namespace RH_Engine return JsonConvert.SerializeObject(Payload(payload)); } - public string DeleteNode(string uuid) + public string DeleteNode(string uuid, string serialCode) { dynamic payload = new { id = "scene/node/delete", + serial = serialCode, data = new { id = uuid, @@ -105,14 +106,13 @@ namespace RH_Engine data = new { name = "dashboard", - parent = uuidBike, components = new { panel = new { size = new int[] { 1, 1 }, resolution = new int[] { 512, 512 }, - background = new int[] { 1, 0, 0, 0 }, + background = new int[] { 1, 1, 1, 1 }, castShadow = false } } @@ -151,17 +151,18 @@ namespace RH_Engine return JsonConvert.SerializeObject(Payload(payload)); } - public string bikeSpeed(string uuidPanel, double speed) + public string bikeSpeed(string uuidPanel, string serialCode, double speed) { dynamic payload = new { id = "scene/panel/drawtext", + serial = serialCode, data = new { id = uuidPanel, - text = "Bike speed placeholder", - position = new int[] { 0, 0 }, - size = 32.0, + text = "Speed: " + speed.ToString(), + position = new int[] { 4, 24 }, + size = 36.0, color = new int[] { 0, 0, 0, 1 }, font = "segoeui" } @@ -250,16 +251,17 @@ namespace RH_Engine return JsonConvert.SerializeObject(Payload(payload)); } - public string MoveTo(string uuid, float[] positionVector, float rotateValue, float speedValue, float timeValue) + public string MoveTo(string uuid, string serial, float[] positionVector, string rotateValue, int speedValue, int timeValue) { - return MoveTo(uuid, "idk", positionVector, rotateValue, "linear", false, speedValue, timeValue); + return MoveTo(uuid, serial, "stop", positionVector, rotateValue, "linear", false, speedValue, timeValue); } - private string MoveTo(string uuid, string stopValue, float[] positionVector, float rotateValue, string interpolateValue, bool followHeightValue, float speedValue, float timeValue) + private string MoveTo(string uuid, string serialCode, string stopValue, float[] positionVector, string rotateValue, string interpolateValue, bool followHeightValue, int speedValue, int timeValue) { dynamic payload = new { id = "scene/node/moveto", + serial = serialCode, data = new { id = uuid, @@ -319,7 +321,7 @@ namespace RH_Engine } } }; - Console.WriteLine("route command: " + JsonConvert.SerializeObject(Payload(payload))); + //Console.WriteLine("route command: " + JsonConvert.SerializeObject(Payload(payload))); return JsonConvert.SerializeObject(Payload(payload)); } @@ -350,7 +352,7 @@ namespace RH_Engine { return RouteFollow(routeID, nodeID, speedValue, 0, "XYZ", 1, true, new float[] { 0, 0, 0 }, positionOffsetVector); } - private string RouteFollow(string routeID, string nodeID, float speedValue, float offsetValue, string rotateValue, float smoothingValue, bool followHeightValue, float[] rotateOffsetVector, float[] positionOffsetVector) + public string RouteFollow(string routeID, string nodeID, float speedValue, float offsetValue, string rotateValue, float smoothingValue, bool followHeightValue, float[] rotateOffsetVector, float[] positionOffsetVector) { dynamic payload = new { diff --git a/RH-Engine/JSONParser.cs b/RH-Engine/JSONParser.cs index 8621aff..725defd 100644 --- a/RH-Engine/JSONParser.cs +++ b/RH-Engine/JSONParser.cs @@ -3,7 +3,7 @@ using System; namespace RH_Engine { - class JSONParser + public class JSONParser { /// /// returns all the users from the given response @@ -25,6 +25,20 @@ namespace RH_Engine return res; } + public static string GetIdSceneInfoChild(string msg, string nodeName) + { + dynamic jsonData = JsonConvert.DeserializeObject(msg); + Newtonsoft.Json.Linq.JArray children = jsonData.data.data.data.children; + foreach (dynamic d in children) + { + if (d.name == nodeName) + { + return d.uuid; + } + } + return null; + } + public static string GetSessionID(string msg, PC[] PCs) { dynamic jsonData = JsonConvert.DeserializeObject(msg); @@ -36,7 +50,7 @@ namespace RH_Engine { if (d.clientinfo.host == pc.host && d.clientinfo.user == pc.user) { - Console.WriteLine("connecting to {0}, on {1} with id {2}", pc.user, pc.host, d.id); + Console.WriteLine("[JSONPARSER] connecting to {0}, on {1} with id {2}", pc.user, pc.host, d.id); return d.id; } } @@ -45,6 +59,12 @@ namespace RH_Engine return null; } + public static bool GetStatus(string json) + { + dynamic jsonData = JsonConvert.DeserializeObject(json); + return jsonData.data.data.status == "ok"; + } + public static string GetSerial(string json) { dynamic jsonData = JsonConvert.DeserializeObject(json); diff --git a/RH-Engine/Program.cs b/RH-Engine/Program.cs index 63c86fb..52c29a6 100644 --- a/RH-Engine/Program.cs +++ b/RH-Engine/Program.cs @@ -1,4 +1,5 @@ using LibNoise.Primitive; +using Microsoft.VisualBasic.FileIO; using Newtonsoft.Json; using Newtonsoft.Json.Linq; using System; @@ -10,13 +11,13 @@ namespace RH_Engine { public delegate void HandleSerial(string message); - class Program + public class Program { private static PC[] PCs = { //new PC("DESKTOP-M2CIH87", "Fabian"), //new PC("T470S", "Shinichi"), //new PC("DESKTOP-DHS478C", "semme"), - new PC("HP-ZBOOK-SEM", "Sem"), + //new PC("HP-ZBOOK-SEM", "Sem"), //new PC("DESKTOP-TV73FKO", "Wouter"), new PC("DESKTOP-SINMKT1", "Ralf van Aert"), //new PC("NA", "Bart") @@ -25,9 +26,11 @@ namespace RH_Engine private static ServerResponseReader serverResponseReader; private static string sessionId = string.Empty; private static string tunnelId = string.Empty; + private static string cameraId = string.Empty; private static string routeId = string.Empty; private static string panelId = string.Empty; private static string bikeId = string.Empty; + private static string headId = string.Empty; private static Dictionary serialResponses = new Dictionary(); @@ -55,6 +58,7 @@ namespace RH_Engine /// the response message from the server public static void HandleResponse(string message) { + //Console.WriteLine(message); string id = JSONParser.GetID(message); // because the first messages don't have a serial, we need to check on the id @@ -109,7 +113,7 @@ namespace RH_Engine stream.Write(res); - Console.WriteLine("sent message " + message); + //Console.WriteLine("sent message " + message); } /// @@ -144,23 +148,86 @@ namespace RH_Engine { Command mainCommand = new Command(tunnelID); + // Reset scene WriteTextMessage(stream, mainCommand.ResetScene()); + //headId = GetId("Root", stream, mainCommand); + //while (headId == string.Empty) { } + + //Get sceneinfo + SendMessageAndOnResponse(stream, mainCommand.GetSceneInfoCommand("sceneinfo"), "sceneinfo", + (message) => + { + //Console.WriteLine("\r\n\r\n\r\nscene info" + message); + cameraId = JSONParser.GetIdSceneInfoChild(message, "Camera"); + string headId = JSONParser.GetIdSceneInfoChild(message, "Head"); + string handLeftId = JSONParser.GetIdSceneInfoChild(message, "LeftHand"); + string handRightId = JSONParser.GetIdSceneInfoChild(message, "RightHand"); + + //Force(stream, mainCommand.DeleteNode(handLeftId, "deleteHandL"), "deleteHandL", (message) => Console.WriteLine("Left hand deleted")); + //Force(stream, mainCommand.DeleteNode(handRightId, "deleteHandR"), "deleteHandR", (message) => Console.WriteLine("Right hand deleted")); + }); + + //Add route, bike and put camera and bike to follow route at same speed. SendMessageAndOnResponse(stream, mainCommand.RouteCommand("routeID"), "routeID", (message) => routeId = JSONParser.GetResponseUuid(message)); + SendMessageAndOnResponse(stream, mainCommand.AddBikeModel("bikeID"), "bikeID", + (message) => + { + bikeId = JSONParser.GetResponseUuid(message); + SendMessageAndOnResponse(stream, mainCommand.addPanel("panelAdd", bikeId), "panelAdd", + (message) => + { + bool speedReplied = false; + bool moveReplied = true; + panelId = JSONParser.getPanelID(message); + WriteTextMessage(stream, mainCommand.ClearPanel(panelId)); + + + SendMessageAndOnResponse(stream, mainCommand.MoveTo(panelId, "panelMove", new float[] { 0f, 0f, 0f }, "Z", 1, 5), "panelMove", + (message) => + { + Console.WriteLine(message); + SendMessageAndOnResponse(stream, mainCommand.bikeSpeed(panelId, "bikeSpeed", 5.0), "bikeSpeed", + (message) => + { + WriteTextMessage(stream, mainCommand.SwapPanel(panelId)); + }); + }); + + + //while (!(speedReplied && moveReplied)) { } + + while (cameraId == string.Empty) { } + SetFollowSpeed(5.0f, stream, mainCommand); + }); + }); + + //Force(stream, mainCommand.addPanel("panelID", bikeId), "panelID", + // (message) => + // { + // Console.WriteLine("panel response: " + message); + // panelId = JSONParser.GetResponseUuid(message); + // while(bikeId == string.Empty) { } + // SetFollowSpeed(5.0f, stream, mainCommand); + // }); + //SendMessageAndOnResponse(stream, maincommand.addpanel("panelid", bikeid), "panelid", + // (message) => + // { + // console.writeline("panelid: " + message); + // //panelid = jsonparser.getpanelid(message); + // panelid = jsonparser.getresponseuuid(message); + // while (bikeid == string.empty) { } + // setfollowspeed(5.0f, stream, maincommand); + // }); + + //WriteTextMessage(stream, mainCommand.TerrainCommand(new int[] { 256, 256 }, null)); //string command; - SendMessageAndOnResponse(stream, mainCommand.AddBikeModel("bikeID"), "bikeID", (message) => bikeId = JSONParser.GetResponseUuid(message)); - SendMessageAndOnResponse(stream, mainCommand.addPanel("panelID", bikeId), "panelID", - (message) => - { - panelId = JSONParser.GetResponseUuid(message); - while (bikeId == string.Empty) { } - WriteTextMessage(stream, mainCommand.RouteFollow(routeId, bikeId, 5, new float[] { 0, -(float)Math.PI / 2f, 0 }, new float[] { 0, 0, 0 })); - }); - Console.WriteLine("id of head " + GetId(Command.STANDARD_HEAD, stream, mainCommand)); +<<<<<<< HEAD + //Console.WriteLine("id of head " + GetId(Command.STANDARD_HEAD, stream, mainCommand)); //command = mainCommand.AddModel("car", "data\\customModels\\TeslaRoadster.fbx"); //WriteTextMessage(stream, command); @@ -178,6 +245,9 @@ namespace RH_Engine // Console.WriteLine("Color panel: " + ReadPrefMessage(stream)); // WriteTextMessage(stream, mainCommand.SwapPanel(uuidPanel)); // Console.WriteLine("Swap panel: " + ReadPrefMessage(stream)); +======= + Console.WriteLine("id of head " + GetId(Command.STANDARD_HEAD, stream, mainCommand)); +>>>>>>> develop } /// @@ -255,6 +325,30 @@ namespace RH_Engine return res; } + + private static void SetFollowSpeed(float speed, NetworkStream stream, Command mainCommand) + { + WriteTextMessage(stream, mainCommand.RouteFollow(routeId, bikeId, speed, new float[] { 0, -(float)Math.PI / 2f, 0 }, new float[] { 0, 0, 0 })); + WriteTextMessage(stream, mainCommand.RouteFollow(routeId, cameraId, speed)); + WriteTextMessage(stream, mainCommand.RouteFollow(routeId, panelId, speed, 0, "XYZ", 1, false, new float[] { 0, 0, 0 }, new float[] { 0f, 0f, 150f })); + } + //string routeID, string nodeID, float speedValue, float offsetValue, string rotateValue, float smoothingValue, bool followHeightValue, float[] rotateOffsetVector, float[] positionOffsetVector) + private static void Force(NetworkStream stream, string message, string serial, HandleSerial action) + { + SendMessageAndOnResponse(stream, message, serial, + (message) => + { + if (!JSONParser.GetStatus(message)) + { + serialResponses.Remove(serial); + Force(stream, message, serial,action); + } else + { + action(message); + } + } + ); + } } /// diff --git a/RH-Engine/Properties/launchSettings.json b/RH-Engine/Properties/launchSettings.json new file mode 100644 index 0000000..cb21041 --- /dev/null +++ b/RH-Engine/Properties/launchSettings.json @@ -0,0 +1,8 @@ +{ + "profiles": { + "RH-Engine": { + "commandName": "Project", + "nativeDebugging": true + } + } +} \ No newline at end of file diff --git a/RH-Engine/ServerResponseReader.cs b/RH-Engine/ServerResponseReader.cs index 85e7f00..17e86ba 100644 --- a/RH-Engine/ServerResponseReader.cs +++ b/RH-Engine/ServerResponseReader.cs @@ -7,7 +7,7 @@ namespace RH_Engine { public delegate void OnResponse(string response); - class ServerResponseReader + public class ServerResponseReader { public OnResponse callback { @@ -31,7 +31,7 @@ namespace RH_Engine } else { - Console.WriteLine("Starting loop for reading"); + Console.WriteLine("[SERVERRESPONSEREADER] Starting loop for reading"); while (true) { string res = ReadPrefMessage(Stream); diff --git a/Server/Client.cs b/Server/Client.cs index 5e385be..0151e87 100644 --- a/Server/Client.cs +++ b/Server/Client.cs @@ -5,6 +5,7 @@ using System.Net.Sockets; using System.Text; using Client; using Newtonsoft.Json; +using System.Security.Cryptography; namespace Server { @@ -19,6 +20,7 @@ namespace Server private SaveData saveData; private string username = null; private DateTime sessionStart; + private string fileName; @@ -30,6 +32,7 @@ namespace Server this.communication = communication; this.tcpClient = tcpClient; this.stream = this.tcpClient.GetStream(); + this.fileName = Directory.GetCurrentDirectory() + "/userInfo.dat"; stream.BeginRead(buffer, 0, buffer.Length, new AsyncCallback(OnRead), null); } @@ -103,45 +106,120 @@ namespace Server { Console.WriteLine("Log in"); this.username = username; - byte[] response = DataParser.getLoginResponse("OK"); - stream.BeginWrite(response, 0, response.Length, new AsyncCallback(OnWrite), null); - this.saveData = new SaveData(Directory.GetCurrentDirectory() + "/" + username, sessionStart.ToString("yyyy-MM-dd HH-mm-ss")); + sendMessage(DataParser.getLoginResponse("OK")); + sendMessage(DataParser.getStartSessionJson()); } else { - byte[] response = DataParser.getLoginResponse("wrong username or password"); - stream.BeginWrite(response, 0, response.Length, new AsyncCallback(OnWrite), null); + sendMessage(DataParser.getLoginResponse("wrong username or password")); } } else { - byte[] response = DataParser.getLoginResponse("invalid json"); - stream.BeginWrite(response, 0, response.Length, new AsyncCallback(OnWrite), null); + sendMessage(DataParser.getLoginResponse("invalid json")); } break; + case DataParser.START_SESSION: + this.saveData = new SaveData(Directory.GetCurrentDirectory() + "/" + this.username + "/" + sessionStart.ToString("yyyy-MM-dd HH-mm-ss")); + break; + case DataParser.STOP_SESSION: + this.saveData = null; + break; + case DataParser.SET_RESISTANCE: + worked = DataParser.getResistanceFromResponseJson(payloadbytes); + Console.WriteLine($"set resistance worked is " + worked); + //set resistance on doctor GUI + break; default: Console.WriteLine($"Received json with identifier {identifier}:\n{Encoding.ASCII.GetString(payloadbytes)}"); break; } + saveData?.WriteDataJSON(Encoding.ASCII.GetString(payloadbytes)); + Array.Copy(message, 5, payloadbytes, 0, message.Length - 5); dynamic json = JsonConvert.DeserializeObject(Encoding.ASCII.GetString(payloadbytes)); - saveData.WriteDataJSON(Encoding.ASCII.GetString(payloadbytes)); } else if (DataParser.isRawData(message)) { - Console.WriteLine(BitConverter.ToString(message)); - saveData.WriteDataRAW(ByteArrayToString(message)); + Console.WriteLine(BitConverter.ToString(payloadbytes)); + if (payloadbytes.Length == 8) + { + saveData?.WriteDataRAWBike(payloadbytes); + } + else if (payloadbytes.Length == 2) + { + saveData?.WriteDataRAWBPM(payloadbytes); + } + else + { + Console.WriteLine("received raw data with weird lenght " + BitConverter.ToString(payloadbytes)); + } } } + private void sendMessage(byte[] message) + { + stream.BeginWrite(message, 0, message.Length, new AsyncCallback(OnWrite), null); + } + private bool verifyLogin(string username, string password) { - return username == password; + Console.WriteLine("got hashes " + username + "\n" + password); + + + if (!File.Exists(fileName)) + { + File.Create(fileName); + Console.WriteLine("file doesnt exist"); + newUsers(username, password); + Console.WriteLine("true"); + return true; + } + else + { + Console.WriteLine("file exists, located at " + Path.GetFullPath(fileName)); + string[] usernamesPasswords = File.ReadAllLines(fileName); + if (usernamesPasswords.Length == 0) + { + newUsers(username, password); + return true; + } + + foreach (string s in usernamesPasswords) + { + string[] combo = s.Split(" "); + if (combo[0] == username) + { + Console.WriteLine("correct info"); + return combo[1] == password; + } + + } + Console.WriteLine("combo was not found in file"); + + } + Console.WriteLine("false"); + return false; + } + private void newUsers(string username, string password) + { + + Console.WriteLine("creating new entry in file"); + using (StreamWriter sw = File.AppendText(fileName)) + { + sw.WriteLine(username + " " + password); + } + } + + + + + public static string ByteArrayToString(byte[] ba) { StringBuilder hex = new StringBuilder(ba.Length * 2); diff --git a/Server/SaveData.cs b/Server/SaveData.cs index b26ea9e..bcabb1f 100644 --- a/Server/SaveData.cs +++ b/Server/SaveData.cs @@ -2,17 +2,19 @@ using System.Collections.Generic; using System.IO; using System.Text; +using System.Threading; namespace Server { class SaveData { private string path; - private string filename; - public SaveData(string path, string filename) + private const string jsonFilename = "/json.txt"; + private const string rawBikeFilename = "/rawBike.bin"; + private const string rawBPMFilename = "/rawBPM.bin"; + public SaveData(string path) { this.path = path; - this.filename = filename; if (!Directory.Exists(path)) { Directory.CreateDirectory(path); @@ -22,21 +24,103 @@ namespace Server /// /// Every line is a new data entry /// - + public void WriteDataJSON(string data) { - using (StreamWriter sw = File.AppendText(this.path + "/json"+filename+".txt")) + using (StreamWriter sw = File.AppendText(this.path + jsonFilename)) { sw.WriteLine(data); } } - public void WriteDataRAW(string data) + public void WriteDataRAWBPM(byte[] data) { - using (StreamWriter sw = File.AppendText(this.path + "/rawFiets" + filename + ".txt")) + if (data.Length != 2) { - sw.WriteLine(data); + throw new ArgumentException("data should have length of 2"); + } + WriteRawData(data, this.path + rawBPMFilename); + } + + public void WriteDataRAWBike(byte[] data) + { + if (data.Length != 8) + { + throw new ArgumentException("data should have length of 8"); + } + WriteRawData(data, this.path + rawBikeFilename); + } + + private void WriteRawData(byte[] data, string fileLocation) + { + int length = 0; + try + { + FileInfo fi = new FileInfo(fileLocation); + length = (int)fi.Length; + } + catch + { + // do nothing + } + using (BinaryWriter sw = new BinaryWriter(File.Open(fileLocation, FileMode.Create))) + { + sw.Seek(length, SeekOrigin.End); + sw.Write(data); + sw.Flush(); } } + + /// + /// gets BPM graph data out of file. + /// if you want 100 datapoints but here are onlny 50, de last 50 datapoint will be 0 + /// if you want 100 datapoints where it takes the average of 2, the last 75 will be 0 + /// if the file isn't created yet it will retun null + /// + /// the amount of data points for the output + /// the amount of data points form the file for one data point in the output + /// byte array with data points from file + public byte[] getBPMgraphData(int outputSize, int averageOver) + { + if (File.Exists(this.path + rawBPMFilename)) + { + FileInfo fi = new FileInfo(this.path + rawBPMFilename); + int length = (int)fi.Length; + + byte[] output = new byte[outputSize]; + + int messageSize = 2; + int readSize = messageSize * averageOver; + byte[] readBuffer = new byte[readSize]; + + using (FileStream fileStream = new FileStream(this.path + rawBPMFilename, FileMode.Open, FileAccess.Read)) + { + for (int i = 1; i >= outputSize; i++) + { + if (length - (i * readSize) < 0) + { + break; + } + fileStream.Read(readBuffer, length - (i * readSize), readSize); + + //handling data + int total = 0; + for (int j = 0; j < averageOver; j++) + { + total += readBuffer[j * messageSize + 1]; + } + output[i - 1] = (byte)(total / averageOver); + } + } + + return output; + } + else + { + return null; + } + } + + } } diff --git a/Server/Server.csproj b/Server/Server.csproj index a91c176..cd7c7da 100644 --- a/Server/Server.csproj +++ b/Server/Server.csproj @@ -13,4 +13,6 @@ + +