package dev.slimevr.gui; import java.awt.Color; import java.awt.Font; import java.awt.GridBagConstraints; import java.awt.event.ActionEvent; import java.awt.event.ActionListener; import java.util.List; import javax.swing.BorderFactory; import javax.swing.Box; import javax.swing.BoxLayout; import javax.swing.JComboBox; import javax.swing.JLabel; 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.ComputedTracker; import dev.slimevr.vr.trackers.HMDTracker; import dev.slimevr.vr.trackers.IMUTracker; import dev.slimevr.vr.trackers.ReferenceAdjustedTracker; import dev.slimevr.vr.trackers.Tracker; import dev.slimevr.vr.trackers.TrackerConfig; import dev.slimevr.vr.trackers.TrackerMountingRotation; import dev.slimevr.vr.trackers.TrackerPosition; import dev.slimevr.vr.trackers.TrackerWithBattery; import dev.slimevr.vr.trackers.TrackerWithTPS; import io.eiren.util.StringUtils; import io.eiren.util.ann.AWTThread; import io.eiren.util.ann.ThreadSafe; import io.eiren.util.collections.FastList; public class TrackersList extends EJBoxNoStretch { private static final long UPDATE_DELAY = 50; Quaternion q = new Quaternion(); Vector3f v = new Vector3f(); float[] angles = new float[3]; private List trackers = new FastList<>(); private final VRServer server; private final VRServerGUI gui; private long lastUpdate = 0; 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); } @AWTThread private void build() { removeAll(); trackers.sort((tr1, tr2) -> getTrackerSort(tr1.t) - getTrackerSort(tr2.t)); Class currentClass = null; EJBoxNoStretch line = null; boolean first = true; for(int i = 0; i < trackers.size(); ++i) { TrackerPanel tr = trackers.get(i); 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(int i = 0; i < trackers.size(); ++i) trackers.get(i).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 correction; JLabel signalStrength; @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) 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 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); 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; TrackerMountingRotation tr = imu.getMountingRotation(); JComboBox 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()); } if(tr != null) { mountSelect.setSelectedItem(tr.name()); } else { mountSelect.setSelectedItem(TrackerMountingRotation.BACK.name()); } mountSelect.addActionListener(new ActionListener() { @Override public void actionPerformed(ActionEvent e) { TrackerMountingRotation tr = TrackerMountingRotation.valueOf(String.valueOf(mountSelect.getSelectedItem())); imu.setMountingRotation(tr); 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("RSSI"), 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)); row++; /* if(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)); 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)); row++; } //*/ /* if(t instanceof ReferenceAdjustedTracker) { add(new JLabel("Adj:"), 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("AdjY:"), c(2, row, 2, GridBagConstraints.FIRST_LINE_START)); add(adjYaw = new JLabel("0 0 0 0"), 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) 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) bat.setText(String.format("%d%% (%sV)", Math.round(((TrackerWithBattery) realTracker).getBatteryLevel()), StringUtils.prettyNumber(((TrackerWithBattery) realTracker).getBatteryVoltage(), 2))); if(t instanceof ReferenceAdjustedTracker) { ((ReferenceAdjustedTracker) t).attachmentFix.toAngles(angles); if(adj != null) 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)); ((ReferenceAdjustedTracker) t).yawFix.toAngles(angles); if(adjYaw != null) 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(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(String.valueOf(percentage) + "% " + "(" + String.valueOf(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) realTracker).rotMagQuaternion.toAngles(angles); if(rawMag != null) 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(((IMUTracker) realTracker).calibrationStatus + " / " + ((IMUTracker) realTracker).magCalibrationStatus); if(magAccuracy != null) magAccuracy.setText(StringUtils.prettyNumber(((IMUTracker) realTracker).magnetometerAccuracy * FastMath.RAD_TO_DEG, 1) + "°"); ((IMUTracker) realTracker).getCorrection(q); q.toAngles(angles); if(correction != null) 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)); } } } 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; } }