mirror of
https://github.com/SlimeVR/SlimeVR-Server.git
synced 2026-11-20 17:11:20 -08:00
530 lines
16 KiB
Java
530 lines
16 KiB
Java
package dev.slimevr.gui;
|
|
|
|
import com.jme3.math.FastMath;
|
|
import com.jme3.math.Quaternion;
|
|
import com.jme3.math.Vector3f;
|
|
import dev.slimevr.VRServer;
|
|
import dev.slimevr.gui.swing.EJBagNoStretch;
|
|
import dev.slimevr.gui.swing.EJBoxNoStretch;
|
|
import dev.slimevr.vr.trackers.*;
|
|
import io.eiren.util.StringUtils;
|
|
import io.eiren.util.ann.AWTThread;
|
|
import io.eiren.util.ann.ThreadSafe;
|
|
import io.eiren.util.collections.FastList;
|
|
|
|
import javax.swing.*;
|
|
import java.awt.*;
|
|
import java.awt.event.ActionEvent;
|
|
import java.awt.event.ActionListener;
|
|
import java.util.List;
|
|
import java.util.Objects;
|
|
|
|
|
|
public class TrackersList extends EJBoxNoStretch {
|
|
|
|
private static final long UPDATE_DELAY = 50;
|
|
private final VRServer server;
|
|
private final VRServerGUI gui;
|
|
private final List<TrackerPanel> trackers = new FastList<>();
|
|
Quaternion q = new Quaternion();
|
|
Vector3f v = new Vector3f();
|
|
float[] angles = new float[3];
|
|
private long lastUpdate = 0;
|
|
private boolean debug = false;
|
|
|
|
public TrackersList(VRServer server, VRServerGUI gui) {
|
|
super(BoxLayout.PAGE_AXIS, false, true);
|
|
this.server = server;
|
|
this.gui = gui;
|
|
|
|
setAlignmentY(TOP_ALIGNMENT);
|
|
|
|
server.addNewTrackerConsumer(this::newTrackerAdded);
|
|
}
|
|
|
|
private static int getTrackerSort(Tracker t) {
|
|
if (t instanceof ReferenceAdjustedTracker)
|
|
t = ((ReferenceAdjustedTracker<?>) t).getTracker();
|
|
if (t instanceof IMUTracker)
|
|
return 0;
|
|
if (t instanceof HMDTracker)
|
|
return 100;
|
|
if (t instanceof ComputedTracker)
|
|
return 200;
|
|
return 1000;
|
|
}
|
|
|
|
@AWTThread
|
|
public void setDebug(boolean debug) {
|
|
this.debug = debug;
|
|
build();
|
|
}
|
|
|
|
@AWTThread
|
|
private void build() {
|
|
removeAll();
|
|
|
|
trackers.sort((tr1, tr2) -> getTrackerSort(tr1.t) - getTrackerSort(tr2.t));
|
|
|
|
Class<? extends Tracker> currentClass = null;
|
|
|
|
EJBoxNoStretch line = null;
|
|
boolean first = true;
|
|
|
|
for (TrackerPanel tr : trackers) {
|
|
Tracker t = tr.t;
|
|
if (t instanceof ReferenceAdjustedTracker)
|
|
t = ((ReferenceAdjustedTracker<?>) t).getTracker();
|
|
if (currentClass != t.getClass()) {
|
|
currentClass = t.getClass();
|
|
if (line != null)
|
|
line.add(Box.createHorizontalGlue());
|
|
line = null;
|
|
line = new EJBoxNoStretch(BoxLayout.LINE_AXIS, false, true);
|
|
line.add(Box.createHorizontalGlue());
|
|
JLabel nameLabel;
|
|
line.add(nameLabel = new JLabel(currentClass.getSimpleName()));
|
|
nameLabel.setFont(nameLabel.getFont().deriveFont(Font.BOLD));
|
|
line.add(Box.createHorizontalGlue());
|
|
add(line);
|
|
line = null;
|
|
}
|
|
|
|
if (line == null) {
|
|
line = new EJBoxNoStretch(BoxLayout.LINE_AXIS, false, true);
|
|
add(Box.createVerticalStrut(3));
|
|
add(line);
|
|
first = true;
|
|
} else {
|
|
line.add(Box.createHorizontalStrut(3));
|
|
first = false;
|
|
}
|
|
tr.build();
|
|
line.add(tr);
|
|
if (!first)
|
|
line = null;
|
|
}
|
|
validate();
|
|
gui.refresh();
|
|
}
|
|
|
|
@ThreadSafe
|
|
public void updateTrackers() {
|
|
if (lastUpdate + UPDATE_DELAY > System.currentTimeMillis())
|
|
return;
|
|
lastUpdate = System.currentTimeMillis();
|
|
java.awt.EventQueue.invokeLater(() -> {
|
|
for (TrackerPanel tr : trackers) {
|
|
tr.update();
|
|
}
|
|
});
|
|
}
|
|
|
|
@ThreadSafe
|
|
public void newTrackerAdded(Tracker t) {
|
|
java.awt.EventQueue.invokeLater(() -> {
|
|
trackers.add(new TrackerPanel(t));
|
|
build();
|
|
});
|
|
}
|
|
|
|
private class TrackerPanel extends EJBagNoStretch {
|
|
|
|
final Tracker t;
|
|
JLabel position;
|
|
JLabel rotation;
|
|
JLabel status;
|
|
JLabel tps;
|
|
JLabel bat;
|
|
JLabel ping;
|
|
JLabel raw;
|
|
JLabel rawMag;
|
|
JLabel calibration;
|
|
JLabel magAccuracy;
|
|
JLabel adj;
|
|
JLabel adjYaw;
|
|
JLabel adjGyro;
|
|
JLabel correction;
|
|
JLabel signalStrength;
|
|
JLabel rotQuat;
|
|
JLabel rotAdj;
|
|
JLabel temperature;
|
|
|
|
@AWTThread
|
|
public TrackerPanel(Tracker t) {
|
|
super(false, true);
|
|
|
|
this.t = t;
|
|
}
|
|
|
|
@SuppressWarnings("unchecked")
|
|
@AWTThread
|
|
public TrackerPanel build() {
|
|
int row = 0;
|
|
|
|
Tracker realTracker = t;
|
|
if (t instanceof ReferenceAdjustedTracker)
|
|
realTracker = ((ReferenceAdjustedTracker<? extends Tracker>) t).getTracker();
|
|
removeAll();
|
|
JLabel nameLabel;
|
|
add(
|
|
nameLabel = new JLabel(t.getDescriptiveName()),
|
|
s(c(0, row, 2, GridBagConstraints.FIRST_LINE_START), 4, 1)
|
|
);
|
|
nameLabel.setFont(nameLabel.getFont().deriveFont(Font.BOLD));
|
|
row++;
|
|
|
|
if (t.userEditable()) {
|
|
TrackerConfig cfg = server.getTrackerConfig(t);
|
|
JComboBox<String> desSelect;
|
|
add(
|
|
desSelect = new JComboBox<>(),
|
|
s(c(0, row, 2, GridBagConstraints.FIRST_LINE_START), 2, 1)
|
|
);
|
|
for (TrackerPosition p : TrackerPosition.values) {
|
|
desSelect.addItem(p.name());
|
|
}
|
|
if (cfg.designation != null) {
|
|
TrackerPosition p = TrackerPosition.getByDesignation(cfg.designation).get();
|
|
if (p != null)
|
|
desSelect.setSelectedItem(p.name());
|
|
}
|
|
desSelect.addActionListener(new ActionListener() {
|
|
@Override
|
|
public void actionPerformed(ActionEvent e) {
|
|
TrackerPosition p = TrackerPosition
|
|
.valueOf(String.valueOf(desSelect.getSelectedItem()));
|
|
t.setBodyPosition(p);
|
|
server.trackerUpdated(t);
|
|
}
|
|
});
|
|
if (realTracker instanceof IMUTracker) {
|
|
IMUTracker imu = (IMUTracker) realTracker;
|
|
JComboBox<String> mountSelect;
|
|
add(
|
|
mountSelect = new JComboBox<>(),
|
|
s(c(2, row, 2, GridBagConstraints.FIRST_LINE_START), 2, 1)
|
|
);
|
|
for (TrackerMountingRotation p : TrackerMountingRotation.values) {
|
|
mountSelect.addItem(p.name());
|
|
}
|
|
|
|
TrackerMountingRotation selected = TrackerMountingRotation
|
|
.fromQuaternion(imu.getMountingRotation());
|
|
mountSelect
|
|
.setSelectedItem(
|
|
Objects
|
|
.requireNonNullElse(selected, TrackerMountingRotation.BACK)
|
|
.name()
|
|
);
|
|
mountSelect.addActionListener(new ActionListener() {
|
|
@Override
|
|
public void actionPerformed(ActionEvent e) {
|
|
TrackerMountingRotation tr = TrackerMountingRotation
|
|
.valueOf(String.valueOf(mountSelect.getSelectedItem()));
|
|
imu.setMountingRotation(tr.quaternion);
|
|
server.trackerUpdated(t);
|
|
}
|
|
});
|
|
}
|
|
row++;
|
|
}
|
|
if (t.hasRotation())
|
|
add(new JLabel("Rotation"), c(0, row, 2, GridBagConstraints.FIRST_LINE_START));
|
|
if (t.hasPosition())
|
|
add(new JLabel("Position"), c(1, row, 2, GridBagConstraints.FIRST_LINE_START));
|
|
add(new JLabel("TPS"), c(3, row, 2, GridBagConstraints.FIRST_LINE_START));
|
|
if (realTracker instanceof IMUTracker) {
|
|
add(new JLabel("Ping"), c(2, row, 2, GridBagConstraints.FIRST_LINE_START));
|
|
add(new JLabel("Signal"), c(4, row, 2, GridBagConstraints.FIRST_LINE_START));
|
|
}
|
|
row++;
|
|
if (t.hasRotation())
|
|
add(
|
|
rotation = new JLabel("0 0 0"),
|
|
c(0, row, 2, GridBagConstraints.FIRST_LINE_START)
|
|
);
|
|
if (t.hasPosition())
|
|
add(
|
|
position = new JLabel("0 0 0"),
|
|
c(1, row, 2, GridBagConstraints.FIRST_LINE_START)
|
|
);
|
|
if (realTracker instanceof IMUTracker) {
|
|
add(ping = new JLabel(""), c(2, row, 2, GridBagConstraints.FIRST_LINE_START));
|
|
add(
|
|
signalStrength = new JLabel(""),
|
|
c(4, row, 2, GridBagConstraints.FIRST_LINE_START)
|
|
);
|
|
}
|
|
if (realTracker instanceof TrackerWithTPS) {
|
|
add(tps = new JLabel("0"), c(3, row, 2, GridBagConstraints.FIRST_LINE_START));
|
|
} else {
|
|
add(new JLabel(""), c(3, row, 2, GridBagConstraints.FIRST_LINE_START));
|
|
}
|
|
row++;
|
|
add(new JLabel("Status:"), c(0, row, 2, GridBagConstraints.FIRST_LINE_START));
|
|
add(
|
|
status = new JLabel(t.getStatus().toString().toLowerCase()),
|
|
c(1, row, 2, GridBagConstraints.FIRST_LINE_START)
|
|
);
|
|
if (realTracker instanceof TrackerWithBattery) {
|
|
add(new JLabel("Battery:"), c(2, row, 2, GridBagConstraints.FIRST_LINE_START));
|
|
add(bat = new JLabel("0"), c(3, row, 2, GridBagConstraints.FIRST_LINE_START));
|
|
}
|
|
row++;
|
|
add(new JLabel("Raw:"), c(0, row, 2, GridBagConstraints.FIRST_LINE_START));
|
|
add(
|
|
raw = new JLabel("0 0 0"),
|
|
s(c(1, row, 2, GridBagConstraints.FIRST_LINE_START), 3, 1)
|
|
);
|
|
|
|
if (debug && realTracker instanceof IMUTracker) {
|
|
add(new JLabel("Quat:"), c(2, row, 2, GridBagConstraints.FIRST_LINE_START));
|
|
add(rotQuat = new JLabel("0"), c(3, row, 2, GridBagConstraints.FIRST_LINE_START));
|
|
}
|
|
row++;
|
|
|
|
if (debug && realTracker instanceof IMUTracker) {
|
|
add(new JLabel("Raw mag:"), c(0, row, 2, GridBagConstraints.FIRST_LINE_START));
|
|
add(
|
|
rawMag = new JLabel("0 0 0"),
|
|
s(c(1, row, 2, GridBagConstraints.FIRST_LINE_START), 3, 1)
|
|
);
|
|
add(new JLabel("Gyro fix:"), c(2, row, 2, GridBagConstraints.FIRST_LINE_START));
|
|
add(
|
|
new JLabel(String.format("0x%8x", realTracker.hashCode())),
|
|
s(c(3, row, 2, GridBagConstraints.FIRST_LINE_START), 3, 1)
|
|
);
|
|
row++;
|
|
add(new JLabel("Cal:"), c(0, row, 2, GridBagConstraints.FIRST_LINE_START));
|
|
add(
|
|
calibration = new JLabel("0"),
|
|
c(1, row, 2, GridBagConstraints.FIRST_LINE_START)
|
|
);
|
|
add(new JLabel("Mag acc:"), c(2, row, 2, GridBagConstraints.FIRST_LINE_START));
|
|
add(
|
|
magAccuracy = new JLabel("0°"),
|
|
c(3, row, 2, GridBagConstraints.FIRST_LINE_START)
|
|
);
|
|
row++;
|
|
add(new JLabel("Correction:"), c(0, row, 2, GridBagConstraints.FIRST_LINE_START));
|
|
add(
|
|
correction = new JLabel("0 0 0"),
|
|
s(c(1, row, 2, GridBagConstraints.FIRST_LINE_START), 3, 1)
|
|
);
|
|
add(new JLabel("RotAdj:"), c(2, row, 2, GridBagConstraints.FIRST_LINE_START));
|
|
add(rotAdj = new JLabel("0"), c(3, row, 2, GridBagConstraints.FIRST_LINE_START));
|
|
row++;
|
|
}
|
|
|
|
if (debug && t instanceof ReferenceAdjustedTracker) {
|
|
add(new JLabel("Att fix:"), c(0, row, 2, GridBagConstraints.FIRST_LINE_START));
|
|
add(adj = new JLabel("0 0 0 0"), c(1, row, 2, GridBagConstraints.FIRST_LINE_START));
|
|
add(new JLabel("Yaw Fix:"), c(2, row, 2, GridBagConstraints.FIRST_LINE_START));
|
|
add(
|
|
adjYaw = new JLabel("0 0 0 0"),
|
|
c(3, row, 2, GridBagConstraints.FIRST_LINE_START)
|
|
);
|
|
row++;
|
|
add(new JLabel("Gyro Fix:"), c(0, row, 2, GridBagConstraints.FIRST_LINE_START));
|
|
add(
|
|
adjGyro = new JLabel("0 0 0 0"),
|
|
c(1, row, 2, GridBagConstraints.FIRST_LINE_START)
|
|
);
|
|
add(new JLabel("Temp:"), c(2, row, 2, GridBagConstraints.FIRST_LINE_START));
|
|
add(
|
|
temperature = new JLabel("?"),
|
|
c(3, row, 2, GridBagConstraints.FIRST_LINE_START)
|
|
);
|
|
}
|
|
|
|
setBorder(BorderFactory.createLineBorder(new Color(0x663399), 2, false));
|
|
TrackersList.this.add(this);
|
|
return this;
|
|
}
|
|
|
|
@SuppressWarnings("unchecked")
|
|
@AWTThread
|
|
public void update() {
|
|
if (position == null && rotation == null)
|
|
return;
|
|
Tracker realTracker = t;
|
|
if (t instanceof ReferenceAdjustedTracker)
|
|
realTracker = ((ReferenceAdjustedTracker<? extends Tracker>) t).getTracker();
|
|
t.getRotation(q);
|
|
t.getPosition(v);
|
|
q.toAngles(angles);
|
|
|
|
if (position != null)
|
|
position
|
|
.setText(
|
|
StringUtils.prettyNumber(v.x, 1)
|
|
+ " "
|
|
+ StringUtils.prettyNumber(v.y, 1)
|
|
+ " "
|
|
+ StringUtils.prettyNumber(v.z, 1)
|
|
);
|
|
if (rotation != null)
|
|
rotation
|
|
.setText(
|
|
StringUtils.prettyNumber(angles[0] * FastMath.RAD_TO_DEG, 0)
|
|
+ " "
|
|
+ StringUtils.prettyNumber(angles[1] * FastMath.RAD_TO_DEG, 0)
|
|
+ " "
|
|
+ StringUtils.prettyNumber(angles[2] * FastMath.RAD_TO_DEG, 0)
|
|
);
|
|
status.setText(t.getStatus().toString().toLowerCase());
|
|
|
|
if (realTracker instanceof TrackerWithTPS) {
|
|
tps.setText(StringUtils.prettyNumber(((TrackerWithTPS) realTracker).getTPS(), 1));
|
|
}
|
|
if (realTracker instanceof TrackerWithBattery) {
|
|
TrackerWithBattery twb = (TrackerWithBattery) realTracker;
|
|
float level = twb.getBatteryLevel();
|
|
float voltage = twb.getBatteryVoltage();
|
|
if (level == 0.0f) {
|
|
bat.setText(String.format("%sV", StringUtils.prettyNumber(voltage, 2)));
|
|
} else if (voltage == 0.0f) {
|
|
bat.setText(String.format("%d%%", Math.round(level)));
|
|
} else {
|
|
bat
|
|
.setText(
|
|
String
|
|
.format(
|
|
"%d%% (%sV)",
|
|
Math.round(level),
|
|
StringUtils.prettyNumber(voltage, 2)
|
|
)
|
|
);
|
|
}
|
|
}
|
|
if (t instanceof ReferenceAdjustedTracker) {
|
|
ReferenceAdjustedTracker<Tracker> rat = (ReferenceAdjustedTracker<Tracker>) t;
|
|
if (adj != null) {
|
|
rat.attachmentFix.toAngles(angles);
|
|
adj
|
|
.setText(
|
|
StringUtils.prettyNumber(angles[0] * FastMath.RAD_TO_DEG, 0)
|
|
+ " "
|
|
+ StringUtils.prettyNumber(angles[1] * FastMath.RAD_TO_DEG, 0)
|
|
+ " "
|
|
+ StringUtils.prettyNumber(angles[2] * FastMath.RAD_TO_DEG, 0)
|
|
);
|
|
}
|
|
if (adjYaw != null) {
|
|
rat.yawFix.toAngles(angles);
|
|
adjYaw
|
|
.setText(
|
|
StringUtils.prettyNumber(angles[0] * FastMath.RAD_TO_DEG, 0)
|
|
+ " "
|
|
+ StringUtils.prettyNumber(angles[1] * FastMath.RAD_TO_DEG, 0)
|
|
+ " "
|
|
+ StringUtils.prettyNumber(angles[2] * FastMath.RAD_TO_DEG, 0)
|
|
);
|
|
}
|
|
if (adjGyro != null) {
|
|
rat.gyroFix.toAngles(angles);
|
|
adjGyro
|
|
.setText(
|
|
StringUtils.prettyNumber(angles[0] * FastMath.RAD_TO_DEG, 0)
|
|
+ " "
|
|
+ StringUtils.prettyNumber(angles[1] * FastMath.RAD_TO_DEG, 0)
|
|
+ " "
|
|
+ StringUtils.prettyNumber(angles[2] * FastMath.RAD_TO_DEG, 0)
|
|
);
|
|
}
|
|
}
|
|
if (realTracker instanceof IMUTracker) {
|
|
if (ping != null)
|
|
ping.setText(String.valueOf(((IMUTracker) realTracker).ping));
|
|
if (signalStrength != null) {
|
|
int signal = ((IMUTracker) realTracker).signalStrength;
|
|
if (signal == -1) {
|
|
signalStrength.setText("N/A");
|
|
} else {
|
|
// -40 dBm is excellent, -95 dBm is very poor
|
|
int percentage = (signal - -95) * (100 - 0) / (-40 - -95) + 0;
|
|
percentage = Math.max(Math.min(percentage, 100), 0);
|
|
signalStrength.setText(percentage + "% " + "(" + signal + " dBm" + ")");
|
|
}
|
|
}
|
|
}
|
|
realTracker.getRotation(q);
|
|
q.toAngles(angles);
|
|
raw
|
|
.setText(
|
|
StringUtils.prettyNumber(angles[0] * FastMath.RAD_TO_DEG, 0)
|
|
+ " "
|
|
+ StringUtils.prettyNumber(angles[1] * FastMath.RAD_TO_DEG, 0)
|
|
+ " "
|
|
+ StringUtils.prettyNumber(angles[2] * FastMath.RAD_TO_DEG, 0)
|
|
);
|
|
if (realTracker instanceof IMUTracker) {
|
|
IMUTracker imu = (IMUTracker) realTracker;
|
|
if (rawMag != null) {
|
|
imu.rotMagQuaternion.toAngles(angles);
|
|
rawMag
|
|
.setText(
|
|
StringUtils.prettyNumber(angles[0] * FastMath.RAD_TO_DEG, 0)
|
|
+ " "
|
|
+ StringUtils.prettyNumber(angles[1] * FastMath.RAD_TO_DEG, 0)
|
|
+ " "
|
|
+ StringUtils.prettyNumber(angles[2] * FastMath.RAD_TO_DEG, 0)
|
|
);
|
|
}
|
|
if (calibration != null)
|
|
calibration.setText(imu.calibrationStatus + " / " + imu.magCalibrationStatus);
|
|
if (magAccuracy != null)
|
|
magAccuracy
|
|
.setText(
|
|
StringUtils
|
|
.prettyNumber(imu.magnetometerAccuracy * FastMath.RAD_TO_DEG, 1)
|
|
+ "°"
|
|
);
|
|
if (correction != null) {
|
|
imu.getCorrection(q);
|
|
q.toAngles(angles);
|
|
correction
|
|
.setText(
|
|
StringUtils.prettyNumber(angles[0] * FastMath.RAD_TO_DEG, 0)
|
|
+ " "
|
|
+ StringUtils.prettyNumber(angles[1] * FastMath.RAD_TO_DEG, 0)
|
|
+ " "
|
|
+ StringUtils.prettyNumber(angles[2] * FastMath.RAD_TO_DEG, 0)
|
|
);
|
|
}
|
|
if (rotQuat != null) {
|
|
imu.rotQuaternion.toAngles(angles);
|
|
rotQuat
|
|
.setText(
|
|
StringUtils.prettyNumber(angles[0] * FastMath.RAD_TO_DEG, 0)
|
|
+ " "
|
|
+ StringUtils.prettyNumber(angles[1] * FastMath.RAD_TO_DEG, 0)
|
|
+ " "
|
|
+ StringUtils.prettyNumber(angles[2] * FastMath.RAD_TO_DEG, 0)
|
|
);
|
|
}
|
|
if (rotAdj != null) {
|
|
imu.rotAdjust.toAngles(angles);
|
|
rotAdj
|
|
.setText(
|
|
StringUtils.prettyNumber(angles[0] * FastMath.RAD_TO_DEG, 0)
|
|
+ " "
|
|
+ StringUtils.prettyNumber(angles[1] * FastMath.RAD_TO_DEG, 0)
|
|
+ " "
|
|
+ StringUtils.prettyNumber(angles[2] * FastMath.RAD_TO_DEG, 0)
|
|
);
|
|
}
|
|
if (temperature != null) {
|
|
if (imu.temperature == 0.0f) {
|
|
// Can't be exact 0, so no info received
|
|
temperature.setText("?");
|
|
} else {
|
|
temperature.setText(StringUtils.prettyNumber(imu.temperature, 1) + "∘C");
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|