Files
SlimeVR-Server/src/main/java/dev/slimevr/platform/windows/WindowsNamedPipeBridge.java
T

300 lines
7.8 KiB
Java

package dev.slimevr.platform.windows;
import com.google.protobuf.CodedOutputStream;
import com.sun.jna.platform.win32.Kernel32;
import com.sun.jna.platform.win32.WinBase;
import com.sun.jna.platform.win32.WinError;
import com.sun.jna.ptr.IntByReference;
import dev.slimevr.Main;
import dev.slimevr.bridge.BridgeThread;
import dev.slimevr.bridge.PipeState;
import dev.slimevr.bridge.ProtobufBridge;
import dev.slimevr.bridge.ProtobufMessages.ProtobufMessage;
import dev.slimevr.bridge.ProtobufMessages.TrackerAdded;
import dev.slimevr.util.ann.VRServerThread;
import dev.slimevr.vr.trackers.*;
import io.eiren.util.logging.LogManager;
import java.io.IOException;
import java.util.List;
public class WindowsNamedPipeBridge extends ProtobufBridge<VRTracker> implements Runnable {
protected final String pipeName;
protected final String bridgeSettingsKey;
protected final Thread runnerThread;
private final TrackerRole[] defaultRoles = new TrackerRole[] { TrackerRole.WAIST,
TrackerRole.LEFT_FOOT, TrackerRole.RIGHT_FOOT };
private final byte[] buffArray = new byte[2048];
private final List<? extends ShareableTracker> shareableTrackers;
protected WindowsPipe pipe;
public WindowsNamedPipeBridge(
HMDTracker hmd,
String bridgeSettingsKey,
String bridgeName,
String pipeName,
List<? extends ShareableTracker> shareableTrackers
) {
super(bridgeName, hmd);
this.pipeName = pipeName;
this.bridgeSettingsKey = bridgeSettingsKey;
this.runnerThread = new Thread(this, "Named pipe thread");
this.shareableTrackers = shareableTrackers;
}
@Override
@VRServerThread
public void startBridge() {
for (TrackerRole role : defaultRoles) {
changeShareSettings(
role,
Main.vrServer.config
.getBoolean(
"bridge." + bridgeSettingsKey + ".trackers." + role.name().toLowerCase(),
true
)
);
}
for (ShareableTracker tr : shareableTrackers) {
TrackerRole role = tr.getTrackerRole();
changeShareSettings(
role,
Main.vrServer.config
.getBoolean(
"bridge." + bridgeSettingsKey + ".trackers." + role.name().toLowerCase(),
false
)
);
}
runnerThread.start();
}
@VRServerThread
public boolean getShareSetting(TrackerRole role) {
for (ShareableTracker tr : shareableTrackers) {
if (tr.getTrackerRole() == role) {
return sharedTrackers.contains(tr);
}
}
return false;
}
@VRServerThread
public void changeShareSettings(TrackerRole role, boolean share) {
if (role == null)
return;
for (ShareableTracker tr : shareableTrackers) {
if (tr.getTrackerRole() == role) {
if (share) {
addSharedTracker(tr);
} else {
removeSharedTracker(tr);
}
Main.vrServer.config
.setProperty(
"bridge." + bridgeSettingsKey + ".trackers." + role.name().toLowerCase(),
share
);
Main.vrServer.saveConfig();
}
}
}
@Override
@VRServerThread
protected VRTracker createNewTracker(TrackerAdded trackerAdded) {
VRTracker tracker = new VRTracker(
trackerAdded.getTrackerId(),
trackerAdded.getTrackerSerial(),
trackerAdded.getTrackerName(),
true,
true
);
TrackerRole role = TrackerRole.getById(trackerAdded.getTrackerRole());
if (role != null) {
tracker.setBodyPosition(TrackerPosition.getByTrackerRole(role).get());
}
return tracker;
}
@Override
@BridgeThread
public void run() {
try {
createPipe();
while (true) {
boolean pipesUpdated = false;
if (pipe.state == PipeState.CREATED) {
tryOpeningPipe(pipe);
}
if (pipe.state == PipeState.OPEN) {
pipesUpdated = updatePipe();
updateMessageQueue();
}
if (pipe.state == PipeState.ERROR) {
resetPipe();
}
if (!pipesUpdated) {
try {
Thread.sleep(5); // Up to 200Hz
} catch (InterruptedException e) {
e.printStackTrace();
}
}
}
} catch (IOException e) {
// TODO Auto-generated catch block
e.printStackTrace();
}
}
@Override
@BridgeThread
protected boolean sendMessageReal(ProtobufMessage message) {
if (pipe.state == PipeState.OPEN) {
try {
int size = message.getSerializedSize();
CodedOutputStream os = CodedOutputStream.newInstance(buffArray, 4, size);
message.writeTo(os);
size += 4;
buffArray[0] = (byte) (size & 0xFF);
buffArray[1] = (byte) ((size >> 8) & 0xFF);
buffArray[2] = (byte) ((size >> 16) & 0xFF);
buffArray[3] = (byte) ((size >> 24) & 0xFF);
if (Kernel32.INSTANCE.WriteFile(pipe.pipeHandle, buffArray, size, null, null)) {
return true;
}
pipe.state = PipeState.ERROR;
LogManager
.severe("[" + bridgeName + "] Pipe error: " + Kernel32.INSTANCE.GetLastError());
} catch (IOException e) {
e.printStackTrace();
}
}
return false;
}
private boolean updatePipe() throws IOException {
if (pipe.state == PipeState.OPEN) {
boolean readAnything = false;
IntByReference bytesAvailable = new IntByReference(0);
while (
Kernel32.INSTANCE
.PeekNamedPipe(pipe.pipeHandle, buffArray, 4, null, bytesAvailable, null)
) {
if (bytesAvailable.getValue() >= 4) { // Got size
int messageLength = (buffArray[3] << 24)
| (buffArray[2] << 16)
| (buffArray[1] << 8)
| buffArray[0];
if (messageLength > 1024) { // Overflow
LogManager
.severe(
"["
+ bridgeName
+ "] Pipe overflow. Message length: "
+ messageLength
);
pipe.state = PipeState.ERROR;
return readAnything;
}
if (bytesAvailable.getValue() >= messageLength) {
if (
Kernel32.INSTANCE
.ReadFile(
pipe.pipeHandle,
buffArray,
messageLength,
bytesAvailable,
null
)
) {
ProtobufMessage message = ProtobufMessage
.parser()
.parseFrom(buffArray, 4, messageLength - 4);
messageReceived(message);
readAnything = true;
} else {
pipe.state = PipeState.ERROR;
LogManager
.severe(
"["
+ bridgeName
+ "] Pipe error: "
+ Kernel32.INSTANCE.GetLastError()
);
return readAnything;
}
} else {
return readAnything; // Wait for more data
}
} else {
return readAnything; // Wait for more data
}
}
pipe.state = PipeState.ERROR;
LogManager
.severe("[" + bridgeName + "] Pipe error: " + Kernel32.INSTANCE.GetLastError());
}
return false;
}
private void resetPipe() {
WindowsPipe.safeDisconnect(pipe);
pipe.state = PipeState.CREATED;
Main.vrServer.queueTask(this::disconnected);
}
private void createPipe() throws IOException {
try {
pipe = new WindowsPipe(
Kernel32.INSTANCE
.CreateNamedPipe(
pipeName,
WinBase.PIPE_ACCESS_DUPLEX, // dwOpenMode
WinBase.PIPE_TYPE_BYTE | WinBase.PIPE_READMODE_BYTE | WinBase.PIPE_WAIT, // dwPipeMode
1, // nMaxInstances,
1024 * 16, // nOutBufferSize,
1024 * 16, // nInBufferSize,
0, // nDefaultTimeOut,
null
),
pipeName
); // lpSecurityAttributes
LogManager.info("[" + bridgeName + "] Pipe " + pipe.name + " created");
if (WinBase.INVALID_HANDLE_VALUE.equals(pipe.pipeHandle))
throw new IOException(
"Can't open " + pipeName + " pipe: " + Kernel32.INSTANCE.GetLastError()
);
LogManager.info("[" + bridgeName + "] Pipes are created");
} catch (IOException e) {
WindowsPipe.safeDisconnect(pipe);
throw e;
}
}
private boolean tryOpeningPipe(WindowsPipe pipe) {
if (
Kernel32.INSTANCE.ConnectNamedPipe(pipe.pipeHandle, null)
|| Kernel32.INSTANCE.GetLastError() == WinError.ERROR_PIPE_CONNECTED
) {
pipe.state = PipeState.OPEN;
LogManager.info("[" + bridgeName + "] Pipe " + pipe.name + " is open");
Main.vrServer.queueTask(this::reconnected);
return true;
}
LogManager
.info(
"["
+ bridgeName
+ "] Error connecting to pipe "
+ pipe.name
+ ": "
+ Kernel32.INSTANCE.GetLastError()
);
return false;
}
}