Merge pull request #83 from Louka3000/hip-tracker

Hip tracker support
This commit is contained in:
Eiren Rain authored and GitHub committed 2021-11-23 04:00:14 +03:00
commit 77f048c48e
8 files changed
+128 -57

No files matched your search

@@ -72,8 +72,7 @@ public class AutoBone {
public final HashMap<String, Float> configs = new HashMap<String, Float>();
public final HashMap<String, Float> staticConfigs = new HashMap<String, Float>();
public final FastList<String> heightConfigs = new FastList<String>(new String[]{"Neck", "Waist", "Legs length"
});
public final FastList<String> heightConfigs = new FastList<String>(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");
@@ -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<String, Float> 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);
@@ -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");
@@ -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));
@@ -71,13 +71,13 @@ public class HumanSkeletonWithLegs extends HumanSkeletonWithWaist {
public HumanSkeletonWithLegs(VRServer server, List<ComputedHumanPoseTracker> computedTrackers) {
super(server, computedTrackers);
List<Tracker> 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<Tracker> 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);
@@ -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<ComputedHumanPoseTracker> computedTrackers) {
List<Tracker> allTracekrs = server.getAllTrackers();
this.waistTracker = TrackerUtils.findTrackerForBodyPositionOrEmpty(allTracekrs, TrackerPosition.WAIST, TrackerPosition.CHEST);
this.chestTracker = TrackerUtils.findTrackerForBodyPositionOrEmpty(allTracekrs, TrackerPosition.CHEST, TrackerPosition.WAIST);
List<Tracker> 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);
}
}
@@ -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),
@@ -32,18 +32,24 @@ public class TrackerUtils {
return findTrackerForBodyPosition(allTrackers, altPosition);
}
public static <T extends Tracker> T findTrackerForBodyPosition(T[] allTrackers, TrackerPosition position, TrackerPosition altPosition) {
public static <T extends Tracker> 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<? extends Tracker> allTrackers, TrackerPosition position, TrackerPosition altPosition) {
public static Tracker findTrackerForBodyPositionOrEmpty(List<? extends Tracker> 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);