-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathController.cs
89 lines (81 loc) · 3.3 KB
/
Controller.cs
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
using System.Buffers;
using System.Buffers.Binary;
using System.Net.WebSockets;
using System.Runtime.InteropServices;
using Nefarius.ViGEm.Client;
using Nefarius.ViGEm.Client.Targets;
using Nefarius.ViGEm.Client.Targets.Xbox360;
internal sealed class Controller : IDisposable
{
private static ReadOnlySpan<byte> PING => "ping"u8;
private static readonly ArraySegment<byte> PONG = "pong"u8.ToArray();
public Controller()
{
client = new();
controller = client.CreateXbox360Controller();
controller.Connect();
}
readonly ViGEmClient client;
readonly IXbox360Controller controller;
internal async Task Connect(WebSocket webSocket, ILogger<Controller> logger, CancellationToken ct)
{
using var owner = MemoryPool<byte>.Shared.Rent(1024);
var mem = owner.Memory;
var mslice = mem[..2];
// Receive first message indicating client's native byte order
var result = await webSocket.ReceiveAsync(mem, ct);
CheckResult(result);
Func<Memory<byte>, short> cast = m => MemoryMarshal.Cast<byte, short>(m.Span)[0];
short endiannessTest = cast(mslice);
if (endiannessTest != 1)
{
cast = m => BinaryPrimitives.ReadInt16BigEndian(m.Span);
if (cast(mslice) != 1) cast = m => BinaryPrimitives.ReadInt16LittleEndian(m.Span);
if (cast(mslice) != 1) throw new InvalidDataException("Client didn't send the expected byte alignment message: " + Convert.ToHexString(mslice.Span));
logger.LogWarning("Congrats, client and server byte order are different, you win extra work :(");
}
while (!ct.IsCancellationRequested && webSocket.State is WebSocketState.Open)
{
result = await webSocket.ReceiveAsync(mem, ct);
switch (result.MessageType)
{
case WebSocketMessageType.Close:
logger.LogInformation("Client disconnected");
await webSocket.CloseAsync(WebSocketCloseStatus.NormalClosure, "Bye!", ct);
return;
case WebSocketMessageType.Binary:
CheckResult(result);
short axis = cast(mslice);
logger.LogInformation($"Axis value: {axis}");
// TODO: use channels
controller.SetAxisValue(Xbox360Axis.LeftThumbX, axis);
break;
case WebSocketMessageType.Text:
if (mem[..result.Count].Span.SequenceEqual(PING))
await webSocket.SendAsync(PONG, WebSocketMessageType.Text, true, ct);
break;
}
}
}
private static void CheckResult(ValueWebSocketReceiveResult result)
{
switch (result)
{
case { EndOfMessage: false }:
throw new InvalidDataException("Received a partial message... Surely this will never happen in practice?");
case { MessageType: WebSocketMessageType.Binary, Count: not 2 }:
throw new InvalidDataException($"Message length was invalid: {result.Count} (should always be 2)");
}
}
public void Dispose()
{
try
{
controller.Disconnect();
}
finally
{
client.Dispose();
}
}
}