diff --git a/src/main/java/dev/slimevr/autobone/AutoBone.java b/src/main/java/dev/slimevr/autobone/AutoBone.java index dfed39e9e..501677f22 100644 --- a/src/main/java/dev/slimevr/autobone/AutoBone.java +++ b/src/main/java/dev/slimevr/autobone/AutoBone.java @@ -72,8 +72,7 @@ public class AutoBone { public final HashMap configs = new HashMap(); public final HashMap staticConfigs = new HashMap(); - public final FastList heightConfigs = new FastList(new String[]{"Neck", "Waist", "Legs length" - }); + public final FastList heightConfigs = new FastList(new String[]{"Neck", "Waist", "Hip", "Legs length"}); public AutoBone(VRServer server) { this.server = server; @@ -91,15 +90,22 @@ public class AutoBone { // Load waist configs staticConfigs.put("Head", server.config.getFloat("body.headShift", HumanSkeletonWithWaist.HEAD_SHIFT_DEFAULT)); staticConfigs.put("Neck", server.config.getFloat("body.neckLength", HumanSkeletonWithWaist.NECK_LENGTH_DEFAULT)); - configs.put("Waist", server.config.getFloat("body.waistDistance", 0.85f)); - + configs.put("Waist", server.config.getFloat("body.waistDistance", 0.6f)); if(server.config.getBoolean("autobone.forceChestTracker", false) || (frame != null && TrackerUtils.findTrackerForBodyPosition(frame, TrackerPosition.CHEST) != null) || TrackerUtils.findTrackerForBodyPosition(server.getAllTrackers(), TrackerPosition.CHEST) != null) { // If force enabled or has a chest tracker - configs.put("Chest", server.config.getFloat("body.chestDistance", 0.42f)); + configs.put("Chest", server.config.getFloat("body.chestDistance", 0.35f)); } else { // Otherwise, make sure it's not used configs.remove("Chest"); - staticConfigs.put("Chest", server.config.getFloat("body.chestDistance", 0.42f)); + staticConfigs.put("Chest", server.config.getFloat("body.chestDistance", 0.35f)); + } + if(server.config.getBoolean("autobone.forceHipTracker", false) || (frame != null && TrackerUtils.findTrackerForBodyPosition(frame, TrackerPosition.HIP) != null) || TrackerUtils.findTrackerForBodyPosition(server.getAllTrackers(), TrackerPosition.HIP) != null) { + // If force enabled or has a hip tracker + configs.put("Hip", server.config.getFloat("body.hipDistance", 0.1f)); + } else { + // Otherwise, make sure it's not used + configs.remove("Hip"); + staticConfigs.put("Hip", server.config.getFloat("body.hipDistance", 0.1f)); } // Load leg configs @@ -150,6 +156,7 @@ public class AutoBone { setConfig("Neck", "body.neckLength"); setConfig("Waist", "body.waistDistance"); setConfig("Chest", "body.chestDistance"); + setConfig("Hip", "body.hipDistance"); setConfig("Hips width", "body.hipsWidth"); setConfig("Legs length", "body.legsLength"); setConfig("Knee height", "body.kneeHeight"); diff --git a/src/main/java/dev/slimevr/autobone/SimpleSkeleton.java b/src/main/java/dev/slimevr/autobone/SimpleSkeleton.java index cf34c7db6..c15585c8f 100644 --- a/src/main/java/dev/slimevr/autobone/SimpleSkeleton.java +++ b/src/main/java/dev/slimevr/autobone/SimpleSkeleton.java @@ -23,12 +23,17 @@ public class SimpleSkeleton { protected final TransformNode neckNode = new TransformNode("Neck", false); protected final TransformNode waistNode = new TransformNode("Waist", false); protected final TransformNode chestNode = new TransformNode("Chest", false); + protected final TransformNode hipNode = new TransformNode("Hip", false); - protected float chestDistance = 0.42f; + protected float chestDistance = 0.35f; /** * Distance from eyes to waist */ - protected float waistDistance = 0.85f; + protected float waistDistance = 0.6f; + /** + * Distance from waist to hip + */ + protected float hipDistance = 0.1f; /** * Distance from eyes to the base of the neck */ @@ -77,12 +82,15 @@ public class SimpleSkeleton { chestNode.attachChild(waistNode); waistNode.localTransform.setTranslation(0, -(waistDistance - chestDistance), 0); + + waistNode.attachChild(hipNode); + hipNode.localTransform.setTranslation(0, -hipDistance, 0); // Assemble skeleton to feet - waistNode.attachChild(leftHipNode); + hipNode.attachChild(leftHipNode); leftHipNode.localTransform.setTranslation(-hipsWidth / 2, 0, 0); - waistNode.attachChild(rightHipNode); + hipNode.attachChild(rightHipNode); rightHipNode.localTransform.setTranslation(hipsWidth / 2, 0, 0); leftHipNode.attachChild(leftKneeNode); @@ -133,17 +141,17 @@ public class SimpleSkeleton { hmdNode.localTransform.setTranslation(hmd.position); } } - - TrackerFrame chest = TrackerUtils.findTrackerForBodyPosition(frame, TrackerPosition.CHEST, TrackerPosition.WAIST); + TrackerFrame chest = TrackerUtils.findTrackerForBodyPosition(frame, TrackerPosition.CHEST, TrackerPosition.WAIST, TrackerPosition.HIP); setRotation(chest, neckNode); - TrackerFrame waist = TrackerUtils.findTrackerForBodyPosition(frame, TrackerPosition.WAIST, TrackerPosition.CHEST); + TrackerFrame waist = TrackerUtils.findTrackerForBodyPosition(frame, TrackerPosition.WAIST, TrackerPosition.CHEST, TrackerPosition.HIP); setRotation(waist, chestNode); TrackerFrame leftLeg = TrackerUtils.findTrackerForBodyPosition(frame, TrackerPosition.LEFT_LEG); TrackerFrame rightLeg = TrackerUtils.findTrackerForBodyPosition(frame, TrackerPosition.RIGHT_LEG); - averagePelvis(waist, leftLeg, rightLeg); + TrackerFrame hip = TrackerUtils.findTrackerForBodyPosition(frame, TrackerPosition.HIP, TrackerPosition.WAIST, TrackerPosition.CHEST); + averagePelvis(hip, leftLeg, rightLeg); setRotation(leftLeg, leftHipNode); setRotation(rightLeg, rightHipNode); @@ -163,19 +171,18 @@ public class SimpleSkeleton { } } - public void averagePelvis(TrackerFrame waist, TrackerFrame leftLeg, TrackerFrame rightLeg) { + public void averagePelvis(TrackerFrame hip, TrackerFrame leftLeg, TrackerFrame rightLeg) { if((leftLeg == null || rightLeg == null) || (!leftLeg.hasData(TrackerFrameData.ROTATION) || !rightLeg.hasData(TrackerFrameData.ROTATION))) { - setRotation(waist, waistNode); + setRotation(hip, waistNode); return; } - - if(waist == null || !waist.hasData(TrackerFrameData.ROTATION)) { + if(hip == null || !hip.hasData(TrackerFrameData.ROTATION)) { if(leftLeg.hasData(TrackerFrameData.ROTATION) && rightLeg.hasData(TrackerFrameData.ROTATION)) { leftLeg.getRotation(rotBuf1); rightLeg.getRotation(rotBuf2); rotBuf1.nlerp(rotBuf2, 0.5f); - waistNode.localTransform.setRotation(rotBuf1); + hipNode.localTransform.setRotation(rotBuf1); } return; @@ -185,11 +192,10 @@ public class SimpleSkeleton { leftLeg.getRotation(rotBuf1); rightLeg.getRotation(rotBuf2); rotBuf1.nlerp(rotBuf2, 0.5f); - - waist.getRotation(rotBuf2); + hip.getRotation(rotBuf2); rotBuf1.nlerp(rotBuf2, 0.3333333f); - waistNode.localTransform.setRotation(rotBuf1); + hipNode.localTransform.setRotation(rotBuf1); } public void setSkeletonConfigs(Map configs) { @@ -231,6 +237,13 @@ public class SimpleSkeleton { chestNode.update(); } break; + case "Hip": + hipDistance = newLength; + hipNode.localTransform.setTranslation(0, -hipDistance, 0); + if(updatePose) { + hipNode.update(); + } + break; case "Hips width": hipsWidth = newLength; leftHipNode.localTransform.setTranslation(-hipsWidth / 2, 0, 0); @@ -273,6 +286,8 @@ public class SimpleSkeleton { return waistDistance; case "Chest": return chestDistance; + case "Hip": + return hipDistance; case "Hips width": return hipsWidth; case "Knee height": @@ -308,6 +323,8 @@ public class SimpleSkeleton { return rotationNode ? neckNode : chestNode; case WAIST: return rotationNode ? chestNode : waistNode; + case HIP: + return rotationNode ? hipNode : waistNode; //TODO check, need 3? case LEFT_LEG: return rotationNode ? leftHipNode : leftKneeNode; @@ -343,6 +360,7 @@ public class SimpleSkeleton { config.setProperty("body.neckLength", neckLength); config.setProperty("body.waistDistance", waistDistance); config.setProperty("body.chestDistance", chestDistance); + config.setProperty("body.hipDistance", hipDistance); // Save leg configs config.setProperty("body.hipsWidth", hipsWidth); diff --git a/src/main/java/dev/slimevr/gui/AutoBoneWindow.java b/src/main/java/dev/slimevr/gui/AutoBoneWindow.java index 41aea4752..d5a18f694 100644 --- a/src/main/java/dev/slimevr/gui/AutoBoneWindow.java +++ b/src/main/java/dev/slimevr/gui/AutoBoneWindow.java @@ -342,6 +342,7 @@ public class AutoBoneWindow extends JFrame { Float neckLength = autoBone.getConfig("Neck"); Float chestLength = autoBone.getConfig("Chest"); Float waistLength = autoBone.getConfig("Waist"); + Float hipLength = autoBone.getConfig("Hip"); Float hipWidth = autoBone.getConfig("Hips width"); Float legsLength = autoBone.getConfig("Legs length"); Float kneeHeight = autoBone.getConfig("Knee height"); diff --git a/src/main/java/dev/slimevr/gui/SkeletonConfig.java b/src/main/java/dev/slimevr/gui/SkeletonConfig.java index 7632d1c24..75170241f 100644 --- a/src/main/java/dev/slimevr/gui/SkeletonConfig.java +++ b/src/main/java/dev/slimevr/gui/SkeletonConfig.java @@ -117,6 +117,13 @@ public class SkeletonConfig extends EJBagNoStretch { add(new TimedResetButton("Reset", "Waist"), c(4, row, 2)); row++; + add(new JLabel("Hip"), c(0, row, 2)); + add(new AdjButton("+", "Hip", 0.01f), c(1, row, 2)); + add(new SkeletonLabel("Hip"), c(2, row, 2)); + add(new AdjButton("-", "Hip", -0.01f), c(3, row, 2)); + add(new ResetButton("Reset", "Hip"), c(4, row, 2)); + row++; + add(new JLabel("Hips width"), c(0, row, 2)); add(new AdjButton("+", "Hips width", 0.01f), c(1, row, 2)); add(new SkeletonLabel("Hips width"), c(2, row, 2)); diff --git a/src/main/java/io/eiren/vr/processor/HumanSkeletonWithLegs.java b/src/main/java/io/eiren/vr/processor/HumanSkeletonWithLegs.java index bc251dfd4..c612dbc82 100644 --- a/src/main/java/io/eiren/vr/processor/HumanSkeletonWithLegs.java +++ b/src/main/java/io/eiren/vr/processor/HumanSkeletonWithLegs.java @@ -71,13 +71,13 @@ public class HumanSkeletonWithLegs extends HumanSkeletonWithWaist { public HumanSkeletonWithLegs(VRServer server, List computedTrackers) { super(server, computedTrackers); - List allTracekrs = server.getAllTrackers(); - this.leftLegTracker = TrackerUtils.findTrackerForBodyPositionOrEmpty(allTracekrs, TrackerPosition.LEFT_LEG, TrackerPosition.LEFT_ANKLE); - this.leftAnkleTracker = TrackerUtils.findTrackerForBodyPositionOrEmpty(allTracekrs, TrackerPosition.LEFT_ANKLE, TrackerPosition.LEFT_LEG); - this.leftFootTracker = TrackerUtils.findTrackerForBodyPosition(allTracekrs, TrackerPosition.LEFT_FOOT); - this.rightLegTracker = TrackerUtils.findTrackerForBodyPositionOrEmpty(allTracekrs, TrackerPosition.RIGHT_LEG, TrackerPosition.RIGHT_ANKLE); - this.rightAnkleTracker = TrackerUtils.findTrackerForBodyPositionOrEmpty(allTracekrs, TrackerPosition.RIGHT_ANKLE, TrackerPosition.RIGHT_LEG); - this.rightFootTracker = TrackerUtils.findTrackerForBodyPosition(allTracekrs, TrackerPosition.RIGHT_FOOT); + List allTrackers = server.getAllTrackers(); + this.leftLegTracker = TrackerUtils.findTrackerForBodyPositionOrEmpty(allTrackers, TrackerPosition.LEFT_LEG, TrackerPosition.LEFT_ANKLE, null); + this.leftAnkleTracker = TrackerUtils.findTrackerForBodyPositionOrEmpty(allTrackers, TrackerPosition.LEFT_ANKLE, TrackerPosition.LEFT_LEG, null); + this.leftFootTracker = TrackerUtils.findTrackerForBodyPosition(allTrackers, TrackerPosition.LEFT_FOOT); + this.rightLegTracker = TrackerUtils.findTrackerForBodyPositionOrEmpty(allTrackers, TrackerPosition.RIGHT_LEG, TrackerPosition.RIGHT_ANKLE, null); + this.rightAnkleTracker = TrackerUtils.findTrackerForBodyPositionOrEmpty(allTrackers, TrackerPosition.RIGHT_ANKLE, TrackerPosition.RIGHT_LEG, null); + this.rightFootTracker = TrackerUtils.findTrackerForBodyPosition(allTrackers, TrackerPosition.RIGHT_FOOT); ComputedHumanPoseTracker lat = null; ComputedHumanPoseTracker rat = null; ComputedHumanPoseTracker rkt = null; @@ -111,10 +111,10 @@ public class HumanSkeletonWithLegs extends HumanSkeletonWithWaist { //extendedPelvisModel = server.config.getBoolean("body.model.extendedPelvis", extendedPelvisModel); extendedKneeModel = server.config.getBoolean("body.model.extendedKnee", extendedKneeModel); - waistNode.attachChild(leftHipNode); + hipNode.attachChild(leftHipNode); leftHipNode.localTransform.setTranslation(-hipsWidth / 2, 0, 0); - waistNode.attachChild(rightHipNode); + hipNode.attachChild(rightHipNode); rightHipNode.localTransform.setTranslation(hipsWidth / 2, 0, 0); leftHipNode.attachChild(leftKneeNode); @@ -167,7 +167,7 @@ public class HumanSkeletonWithLegs extends HumanSkeletonWithWaist { hmdTracker.getPosition(vec); float height = vec.y; if(height > 0.5f) { // Reset only if floor level is right, todo: read floor level from SteamVR if it's not 0 - setSkeletonConfig(joint, height - neckLength - waistDistance - DEFAULT_FLOOR_OFFSET); + setSkeletonConfig(joint, height - neckLength - waistDistance - hipDistance - DEFAULT_FLOOR_OFFSET); } resetSkeletonConfig("Knee height"); break; @@ -290,9 +290,10 @@ public class HumanSkeletonWithLegs extends HumanSkeletonWithWaist { kneeBuf.nlerp(hipBuf, 0.5f); chestNode.localTransform.getRotation(hipBuf); kneeBuf.nlerp(hipBuf, 0.3333333f); - waistNode.localTransform.setRotation(kneeBuf); - // TODO : Use vectors to add like 50% of wasit tracker yaw to waist node to reduce drift and let user take weird poses - // TODO Set virtual waist node yaw to that of waist node + hipNode.localTransform.setRotation(kneeBuf); + //trackerWaistNode.localTransform.setRotation(kneeBuf); // <== Provides cursed results from my test in VRChat when sitting or laying down -Erimel + // TODO : Correct the trackerWaistNode without getting cursed results (only correct yaw?) + // TODO : Use vectors to add like 50% of waist tracker yaw to waist node to reduce drift and let user take weird poses } } @@ -370,7 +371,7 @@ public class HumanSkeletonWithLegs extends HumanSkeletonWithWaist { super.resetTrackersFull(); // Start with waist, it was reset in the parent Quaternion referenceRotation = new Quaternion(); - this.waistTracker.getRotation(referenceRotation); + this.hipTracker.getRotation(referenceRotation); this.leftLegTracker.resetFull(referenceRotation); this.rightLegTracker.resetFull(referenceRotation); @@ -401,7 +402,7 @@ public class HumanSkeletonWithLegs extends HumanSkeletonWithWaist { super.resetTrackersYaw(); // Start with waist, it was reset in the parent Quaternion referenceRotation = new Quaternion(); - this.waistTracker.getRotation(referenceRotation); + this.hipTracker.getRotation(referenceRotation); this.leftLegTracker.resetYaw(referenceRotation); this.rightLegTracker.resetYaw(referenceRotation); diff --git a/src/main/java/io/eiren/vr/processor/HumanSkeletonWithWaist.java b/src/main/java/io/eiren/vr/processor/HumanSkeletonWithWaist.java index e1ea128c8..a90204287 100644 --- a/src/main/java/io/eiren/vr/processor/HumanSkeletonWithWaist.java +++ b/src/main/java/io/eiren/vr/processor/HumanSkeletonWithWaist.java @@ -29,6 +29,7 @@ public class HumanSkeletonWithWaist extends HumanSkeleton { protected final Tracker waistTracker; protected final Tracker chestTracker; + protected final Tracker hipTracker; protected final HMDTracker hmdTracker; protected final ComputedHumanPoseTracker computedWaistTracker; protected final ComputedHumanPoseTracker computedChestTracker; @@ -38,12 +39,17 @@ public class HumanSkeletonWithWaist extends HumanSkeleton { protected final TransformNode waistNode = new TransformNode("Waist", false); protected final TransformNode chestNode = new TransformNode("Chest", false); protected final TransformNode trackerWaistNode = new TransformNode("Waist-Tracker", false); + protected final TransformNode hipNode = new TransformNode("Hip", false); - protected float chestDistance = 0.42f; + protected float chestDistance = 0.35f; /** * Distance from eyes to waist */ - protected float waistDistance = 0.85f; + protected float waistDistance = 0.6f; + /** + * Distance from waist to hip + */ + protected float hipDistance = 0.1f; /** * Distance from eyes to waist, defines reported * tracker position, if you want to move resulting @@ -60,9 +66,10 @@ public class HumanSkeletonWithWaist extends HumanSkeleton { protected float headShift = HEAD_SHIFT_DEFAULT; public HumanSkeletonWithWaist(VRServer server, List computedTrackers) { - List allTracekrs = server.getAllTrackers(); - this.waistTracker = TrackerUtils.findTrackerForBodyPositionOrEmpty(allTracekrs, TrackerPosition.WAIST, TrackerPosition.CHEST); - this.chestTracker = TrackerUtils.findTrackerForBodyPositionOrEmpty(allTracekrs, TrackerPosition.CHEST, TrackerPosition.WAIST); + List allTrackers = server.getAllTrackers(); + this.waistTracker = TrackerUtils.findTrackerForBodyPositionOrEmpty(allTrackers, TrackerPosition.WAIST, TrackerPosition.CHEST, TrackerPosition.HIP); + this.chestTracker = TrackerUtils.findTrackerForBodyPositionOrEmpty(allTrackers, TrackerPosition.CHEST, TrackerPosition.WAIST, TrackerPosition.HIP); + this.hipTracker = TrackerUtils.findTrackerForBodyPositionOrEmpty(allTrackers, TrackerPosition.HIP, TrackerPosition.WAIST, TrackerPosition.CHEST); this.hmdTracker = server.hmdTracker; this.server = server; ComputedHumanPoseTracker cwt = null; @@ -81,6 +88,7 @@ public class HumanSkeletonWithWaist extends HumanSkeleton { neckLength = server.config.getFloat("body.neckLength", neckLength); chestDistance = server.config.getFloat("body.chestDistance", chestDistance); waistDistance = server.config.getFloat("body.waistDistance", waistDistance); + hipDistance = server.config.getFloat("body.hipDistance", hipDistance); trackerWaistDistance = server.config.getFloat("body.trackerWaistDistance", trackerWaistDistance); // Build skeleton hmdNode.attachChild(headNode); @@ -94,15 +102,19 @@ public class HumanSkeletonWithWaist extends HumanSkeleton { chestNode.attachChild(waistNode); waistNode.localTransform.setTranslation(0, -(waistDistance - chestDistance), 0); - - chestNode.attachChild(trackerWaistNode); - trackerWaistNode.localTransform.setTranslation(0, -(waistDistance + trackerWaistDistance - chestDistance), 0); + + waistNode.attachChild(hipNode); + hipNode.localTransform.setTranslation(0, -hipDistance, 0); + + hipNode.attachChild(trackerWaistNode); + trackerWaistNode.localTransform.setTranslation(0, trackerWaistDistance, 0); configMap.put("Head", headShift); configMap.put("Neck", neckLength); configMap.put("Chest", chestDistance); configMap.put("Waist", waistDistance); configMap.put("Virtual waist", trackerWaistDistance); + configMap.put("Hip", hipDistance); } @Override @@ -112,6 +124,7 @@ public class HumanSkeletonWithWaist extends HumanSkeleton { resetSkeletonConfig("Head"); resetSkeletonConfig("Neck"); resetSkeletonConfig("Virtual waist"); + resetSkeletonConfig("Hip"); resetSkeletonConfig("Waist"); resetSkeletonConfig("Chest"); break; @@ -124,15 +137,18 @@ public class HumanSkeletonWithWaist extends HumanSkeleton { case "Virtual waist": setSkeletonConfig(joint, 0.0f); break; - case "Chest": - setSkeletonConfig(joint, waistDistance / 2.0f); + case "Chest": //Chest is half of the upper body (half of the waist with the hip) + setSkeletonConfig(joint, (waistDistance + hipDistance) / 2.0f); break; - case "Waist": // Puts Waist in the middle of the height + case "Hip": // Distance between waist and hip + setSkeletonConfig(joint, 0.1f); + break; + case "Waist": // waist length is from shoulders (bottom of neck) to waist (right above the hip) Vector3f vec = new Vector3f(); hmdTracker.getPosition(vec); float height = vec.y; - if(height > 0.5f) { // Reset only if floor level is right, todo: read floor level from SteamVR if it's not 0 - setSkeletonConfig(joint, (height) / 2.0f); + if(height > 0.5f) { // Reset only if floor level is right, TODO: read floor level from SteamVR if it's not 0 + setSkeletonConfig(joint, ((height) / 2.0f) - hipDistance - neckLength); } break; } @@ -161,19 +177,24 @@ public class HumanSkeletonWithWaist extends HumanSkeleton { waistDistance = newLength; server.config.setProperty("body.waistDistance", waistDistance); waistNode.localTransform.setTranslation(0, -(waistDistance - chestDistance), 0); - trackerWaistNode.localTransform.setTranslation(0, -(waistDistance + trackerWaistDistance - chestDistance), 0); break; case "Chest": chestDistance = newLength; server.config.setProperty("body.chestDistance", chestDistance); chestNode.localTransform.setTranslation(0, -chestDistance, 0); waistNode.localTransform.setTranslation(0, -(waistDistance - chestDistance), 0); - trackerWaistNode.localTransform.setTranslation(0, -(waistDistance + trackerWaistDistance - chestDistance), 0); + trackerWaistNode.localTransform.setTranslation(0, trackerWaistDistance, 0); + break; + case "Hip": + hipDistance = newLength; + server.config.setProperty("body.hipDistance", hipDistance); + hipNode.localTransform.setTranslation(0, -hipDistance, 0); + trackerWaistNode.localTransform.setTranslation(0, trackerWaistDistance, 0); break; case "Virtual waist": trackerWaistDistance = newLength; server.config.setProperty("body.trackerWaistDistance", trackerWaistDistance); - trackerWaistNode.localTransform.setTranslation(0, -(waistDistance + trackerWaistDistance - chestDistance), 0); + trackerWaistNode.localTransform.setTranslation(0, trackerWaistDistance, 0); break; } } @@ -211,9 +232,12 @@ public class HumanSkeletonWithWaist extends HumanSkeleton { neckNode.localTransform.setRotation(qBuf); if(waistTracker.getRotation(qBuf)) { - trackerWaistNode.localTransform.setRotation(qBuf); chestNode.localTransform.setRotation(qBuf); + } + if(hipTracker.getRotation(qBuf)) { waistNode.localTransform.setRotation(qBuf); + trackerWaistNode.localTransform.setRotation(qBuf); + hipNode.localTransform.setRotation(qBuf); } } @@ -243,6 +267,9 @@ public class HumanSkeletonWithWaist extends HumanSkeleton { this.chestTracker.getRotation(referenceRotation); this.waistTracker.resetFull(referenceRotation); + this.waistTracker.getRotation(referenceRotation); + + this.hipTracker.resetFull(referenceRotation); } @Override @@ -257,5 +284,8 @@ public class HumanSkeletonWithWaist extends HumanSkeleton { this.chestTracker.getRotation(referenceRotation); this.waistTracker.resetYaw(referenceRotation); + this.waistTracker.getRotation(referenceRotation); + + this.hipTracker.resetYaw(referenceRotation); } } diff --git a/src/main/java/io/eiren/vr/trackers/TrackerPosition.java b/src/main/java/io/eiren/vr/trackers/TrackerPosition.java index b03c60ebf..b2be77088 100644 --- a/src/main/java/io/eiren/vr/trackers/TrackerPosition.java +++ b/src/main/java/io/eiren/vr/trackers/TrackerPosition.java @@ -10,6 +10,7 @@ public enum TrackerPosition { HMD("HMD", TrackerRole.HMD), CHEST("body:chest", TrackerRole.CHEST), WAIST("body:waist", TrackerRole.WAIST), + HIP("body:hip", null), LEFT_LEG("body:left_leg", TrackerRole.LEFT_KNEE), RIGHT_LEG("body:right_leg", TrackerRole.RIGHT_KNEE), LEFT_ANKLE("body:left_ankle", null), diff --git a/src/main/java/io/eiren/vr/trackers/TrackerUtils.java b/src/main/java/io/eiren/vr/trackers/TrackerUtils.java index e02e382e1..944ccb24e 100644 --- a/src/main/java/io/eiren/vr/trackers/TrackerUtils.java +++ b/src/main/java/io/eiren/vr/trackers/TrackerUtils.java @@ -32,18 +32,24 @@ public class TrackerUtils { return findTrackerForBodyPosition(allTrackers, altPosition); } - public static T findTrackerForBodyPosition(T[] allTrackers, TrackerPosition position, TrackerPosition altPosition) { + public static T findTrackerForBodyPosition(T[] allTrackers, TrackerPosition position, TrackerPosition altPosition, TrackerPosition secondAltPosition) { T t = findTrackerForBodyPosition(allTrackers, position); if(t != null) return t; - return findTrackerForBodyPosition(allTrackers, altPosition); + t = findTrackerForBodyPosition(allTrackers, altPosition); + if(t != null) + return t; + return findTrackerForBodyPosition(allTrackers, secondAltPosition); } - public static Tracker findTrackerForBodyPositionOrEmpty(List allTrackers, TrackerPosition position, TrackerPosition altPosition) { + public static Tracker findTrackerForBodyPositionOrEmpty(List allTrackers, TrackerPosition position, TrackerPosition altPosition, TrackerPosition secondAltPosition) { Tracker t = findTrackerForBodyPosition(allTrackers, position); if(t != null) return t; t = findTrackerForBodyPosition(allTrackers, altPosition); + if(t != null) + return t; + t = findTrackerForBodyPosition(allTrackers, secondAltPosition); if(t != null) return t; return new ComputedTracker(Tracker.getNextLocalTrackerId(), "Empty tracker", false, false);